不用减速机的机器人多关节传动结构的制作方法
【技术领域】
[0001]本实用新型属于多关节机器人技术领域，尤其涉及一种不用减速机的机器人多关节传动结构。
【背景技术】
[0002]1、现在市场上的多关节机器人，都采用伺服电机+减速机的传动方法，以达到降低输出速度提高输出扭矩的功能。
[0003]2、由于多关节机器人对传动精度要求很高，所以减速机的机械传动误差必须控制在“Mi”级范围内。国产的减速机达不到这个水平，满足不了和多关节机器人配套的要求。
[0004]3、目前国产多关节机器人的传动部件，绝大多数都采用进口的高性能伺服电机和高精度谐波或RV减速机，价格昂贵。两个关键部件就占了整个多关节机器人生产成本的50%。
[0005]4、高性能伺服电机和高精度减速机已经成了制约国内多关节机器人产业发展的瓶颈。
【发明内容】
[0006]本实用新型的目的在于克服现有技术存在的不足，而提供一种结构简单、精度更高的不用减速机的机器人多关节传动结构。
[0007]本实用新型的目的是通过如下技术方案来完成的，包括电机、机械臂，所述的电机的转子轴由前轴和后轴组成，该电机的前轴与机械臂相连接，电机的后轴上装有编码器，编码器的信号输出线与电子闭环控制器的信号输入接口相连接，电机的输入电源线与电子闭环控制器的电源输出接口相连接，电子闭环控制器的输入电缆线与电源线相连接。
[0008]作为优选，所述的电子闭环控制器内的控制系统包括LM629芯片和PIC16F877单片机，PIC16F877单片机通过数据线和控制线与LM629芯片内的数据和控制口模块相连接，LM629芯片内的PID控制器通过PffM幅度和方向信号模块控制于L298N功率芯片，该L298N功率芯片与电机相连，电机通过其后轴上所相连的编码器将反馈信号传输至LM629芯片内的指令位置模块，该指令位置模块与PID控制器相连，同时该指令位置模块还与LM629芯片内的数据和控制口模块相连接。
[0009]作为优选，所述的LM629芯片通过6位数据线和6根控制线与PIC16F877单片机的I/O相连。
[0010]作为优选，所述的PIC16F877单片机通过无线通信方式与PC机相连。
[0011]本实用新型的有益效果为:机电一体化结构新技术超越了现有市场上所有用伺服电机+减速机结构传动的技术水平，使多关节机器人的传动系统精度达到一个新的高度，特别适用于高精度传动设备的运行工况需要，可广泛应用于汽车、电焊、搬运、堆架、机床、机械加工、纺织、印染、印刷、包装、冶金、医疗、传动等行业，具有很大的应用价值和应用市场。
【附图说明】
[0012]图1是本实用新型的电机结构和运行原理示意图。
[0013]图2是本实用新型的电子闭环控制器系统和运行原理示意图。
[0014]图3是本实用新型的电子闭环控制器驱动电机及机械臂示意图。
[0015]图4是本实用新型的机器人多关节传动结构示意图。
[0016]附图中的标号分别为:1、电机;2、编码器;3、电子闭环控制器;4、机械臂；11、前轴；12、后轴。
【具体实施方式】
[0017]下面将结合附图对本实用新型做详细的介绍:如附图1至4所示，本实用新型包括电机1、机械臂4，所述的电机I的转子轴由前轴11和后轴12组成，该电机的前轴11与机械臂4相连接，电机的后轴12上装有编码器2，编码器2的信号输出线与电子闭环控制器3的信号输入接口相连接，电机I的输入电源线与电子闭环控制器3的电源输出接口相连接，电子闭环控制器3的输入电缆线与电源线相连接。
[0018]所述的电机I为低速大转矩伺服电机，该电机I的特点在于:既具有高性能伺服电机的响应快、恒转矩、控制精度高、过载能力强、运行速度稳的特点，又具有谐波和RV减速机那种转速低、扭矩大、传动精密的特点，可以满足机器人多关节手臂运动的特定工况需要，简化和替代传统机器人多关节用的高性能伺服电机+精密减速机的传动方式。
[0019]电子闭环控制器3内装有多关节机器人手臂的传动程序，电子闭环控制器3可存储控制程序和运行数据，可驱动和控制电机I的运转变化;能接受电机I的后轴12上编码器2输出的转子反馈信号；能自动检测、计算、比较电机I上编码器反馈信号的数据与存储在电子闭环控制器中的运行参数和要求的差别；能自动改变电机的输出转速，来修正输出轴的转速和定位精度。
[0020]电子闭环控制器3通过电机转子轴上的编码器2反馈信号对电机I输出转速和定位角度进行闭环控制，使电机输出轴的转速和定位角度达到程序所设定的精确无误的要求。
[0021]电子闭环控制器3可按各种使用情况运行要求，自由设定和改变各种程序参数，对电机I运行情况进行闭环精确控制，进而达到对连接在电机I的前轴11上的机械臂4的运行情况进行闭环精确控制。
[0022]所述的电子闭环控制器3内的控制系统包括LM629芯片和PIC16F877单片机，PIC16F877单片机通过数据线和控制线与LM629芯片内的数据和控制口模块相连接，LM629芯片内的PID控制器通过PffM幅度和方向信号模块控制于L298N功率芯片，该L298N功率芯片与电机I相连，电机I通过其后轴12上所相连的编码器2将反馈信号传输至LM629芯片内的指令位置模块，该指令位置模块与PID控制器相连，同时该指令位置模块还与LM629芯片内的数据和控制口模块相连接;所述的LM629芯片通过6位数据线和6根控制线与PIC16F877单片机的I/O相连。
[0023]PIC16F877单片机通过数据线向LM629芯片发送位置或速度命令，设定PID控制器调节参数，并从LM629芯片中读取速度、加速度等数值。LM629芯片输出的脉宽调制幅度信号和方向信号直接驱动L298N功率芯片，经过功率放大后驱动电机。电机拖动机器人手臂运转时，电机轴上的编码器提供闭环控制所需的反馈信号(A.B.1N)，梯形图发生器计算出位置或速度模式下所需控制的运行轨迹。
[0024]PIC16F877单片机为LM629芯片提供加速度、速度和目标位置量，在每个采样周期用这些值来计算出新的命令和位置给定值，将其作为指令值。
[0025]由编码器2检测电机轴的实际位置，其输出信号经过LM629芯片四倍频后进行解码，形成位置反馈值。
[0026]指令值与反馈值的差值作为数字PID控制器校正环节的输入，通过数PID控制器计算，LM629芯片输出脉宽调制信号PffMM和方向信号PWMS，用于控制L298N功率芯片，进而驱动电机I运动到指定位置，再由电机I拖动机器人关节手臂达到指定位置。
[0027]LM629芯片在进行位置控制的同时，还对速度进行控制，LM629芯片在接收到主机送来的位置信号后，按梯形图生成加速、匀速、减速的速度曲线，曲线与坐标横幅所包围的面积就是指定位置。
[0028]PID控制器算法中的比例、积分和微分系数有时需要进行修改，因此，将它们存储在PIC16F877单片机的E2PR0M中，PIC16F877单片机和PC机通过无线发射和接收模块进行串行通信。
[0029]本实用新型的运行原理为:
[0030]①电子闭环控制器3向电机I发出程序指令驱动电机I按程序要求转动；
[0031]②电机I的前轴11拖动机器人关节手臂作上、下、左、右、前进、后退、旋转动作；
[0032]③电机I的后轴12上的编码器2将电机I的转动信号反馈给电子闭环控制器3;
[0033]④电子闭环控制器3从每个反馈信号中计算出电机I的实际运行速度和位置角度；
[0034]⑤将计算出的数据与存储在电子闭环控制器3的运行参数进行比较、自动修正，改变电机I的转速、位置和角度的精度，达到程序所设定的精确无误的要求；
[0035]⑥发出新的指令值给电机I，命令电机I拖动机器人关节手臂，按精确定速定位转动。
[0036]本实用新型不局限于上述实施方式，不论在其形状或材料构成上作任何变化，凡是采用本实用新型所提供的结构设计，都是本实用新型的一种变形，均应认为在本实用新型保护范围之内。
【主权项】
1.一种不用减速机的机器人多关节传动结构，包括电机(I)、机械臂(4)，其特征在于:所述的电机(I)的转子轴由前轴(11)和后轴(12)组成，该电机的前轴(11)与机械臂(4)相连接，电机的后轴(12)上装有编码器(2)，编码器(2)的信号输出线与电子闭环控制器(3)的信号输入接口相连接，电机(I)的输入电源线与电子闭环控制器(3)的电源输出接口相连接，电子闭环控制器(3)的输入电缆线与电源线相连接。2.根据权利要求1所述的不用减速机的机器人多关节传动结构，其特征在于:所述的电子闭环控制器(3)内的控制系统包括LM629芯片和PIC16F877单片机，PIC16F877单片机通过数据线和控制线与LM629芯片内的数据和控制口模块相连接，LM629芯片内的PID控制器通过PWM幅度和方向信号模块控制于L298N功率芯片，该L298N功率芯片与电机(I)相连，电机(I)通过其后轴(12)上所相连的编码器(2)将反馈信号传输至LM629芯片内的指令位置模块，该指令位置模块与PID控制器相连，同时该指令位置模块还与LM629芯片内的数据和控制口模块相连接。3.根据权利要求2所述的不用减速机的机器人多关节传动结构，其特征在于:所述的LM629芯片通过6位数据线和6根控制线与PIC16F877单片机的I/O相连。4.根据权利要求2所述的不用减速机的机器人多关节传动结构，其特征在于:所述的PIC16F877单片机通过无线通信方式与PC机相连。
【专利摘要】本实用新型涉及一种不用减速机的机器人多关节传动结构，包括电机、机械臂，所述的电机的转子轴由前轴和后轴组成，该电机的前轴与机械臂相连接，电机的后轴上装有编码器，编码器的信号输出线与电子闭环控制器的信号输入接口相连接，电机的输入电源线与电子闭环控制器的电源输出接口相连接，电子闭环控制器的输入电缆线与电源线相连接；所述的电子闭环控制器内的控制系统包括LM629芯片和PIC16F877单片机；本实用新型具有传动灵活、精度高、结构简单、制造容易、可靠性好、寿命长、价格便宜、维护工作量少、使用方便等优点。
【IPC分类】B25J9/16
【公开号】CN205325690
【申请号】CN201620037005
【发明人】徐伟业, 柴晓峰, 章华群
【申请人】杭州史宾纳机械设备有限公司
【公开日】2016年6月22日
【申请日】2016年1月15日