CN106514650A - 一种基于CANopen的多机械臂同步跟随控制方法 - Google Patents
一种基于CANopen的多机械臂同步跟随控制方法 Download PDFInfo
- Publication number
- CN106514650A CN106514650A CN201610700192.6A CN201610700192A CN106514650A CN 106514650 A CN106514650 A CN 106514650A CN 201610700192 A CN201610700192 A CN 201610700192A CN 106514650 A CN106514650 A CN 106514650A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- joint
- follow
- motor
- control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1658—Programme controls characterised by programming, planning systems for manipulators characterised by programming language
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1682—Dual arm manipulator; Coordination of several manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration of manipulator
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Software Systems (AREA)
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种基于CANopen的多机械臂同步跟随控制方法。解决现有技术中一般控制方法难以建立多机械臂之间同步关系的问题。方法包括结合对象字典,基于PDO协议对多机械臂进行PDO配置;分别设置主、从机械臂的运动模式以及各关节电机的运动模式;设定多机械臂各关节参考位置;计算得到从机械臂各关节跟随力矩控制量;对从机械臂各关节电机发送控制指令。本发明的优点是适用于多种总线形式下支持CANopen协议的电机伺服多机械臂系统,基于本方法的系统结构简单、易于实现。对于主机械臂关节电机控制模式没有限制要求。
Description
技术领域
本发明涉及一种机械臂控制技术领域,尤其是涉及一种基于CANopen的多机械臂同步跟随控制方法。
背景技术
CANopen是一种架构在控制局域网路(Controller Area Network,CAN)上的高层通讯协定,包括通讯子协定及设备子协定常在嵌入式系统中使用,也是工业控制常用到的一种现场总线。CANopen设备都需要具备对象字典,用来设定设备组态及进行非即时的通讯。通过CANopen协议的支持,能够对不同电机伺服驱动、不同厂商、不同型号的机械臂通过总线进行配置。
多机械臂同步跟随运动能够实现远距离、大数量机械臂的同步跟踪控制,对于机械臂的统一化控制与高精度协同场合应用有较大意义。
现有技术中实现多机械臂同步跟随运动控制相关方法基本没有,一般机械臂关节采用采用的CANopen位置控制模式下的PTP方法难以实现实时的同步跟随,难以建立多机械臂之间的同步关系,因此如何基于CANopen实现多机械臂同步跟随运动是有待解决的问题。
发明内容
本发明主要是解决现有技术中一般控制方法难以建立多机械臂之间同步关系的问题,提供了一种基于CANopen的多机械臂同步跟随控制方法。
本发明的上述技术问题主要是通过下述技术方案得以解决的:一种基于CANopen的多机械臂同步跟随控制方法,该多机械臂至少包括一个主机械臂和一个从机械臂,包括以下步骤:
S1.结合对象字典,基于PDO协议对多机械臂进行PDO配置;
CANopen设备均具备对象字典,用于进行通讯,通讯可以基于多种协议。
S2.分别设置主、从机械臂的运动模式以及各关节电机的运动模式;
S3.获取主、从机械臂运动状态,以及各关节反馈数据,设定多机械臂各关节参考位置;
S4.根据主、从机械臂反馈量计算得到从机械臂各关节跟随力矩控制量;
S5.对从机械臂各关节电机发送控制指令,一个同步跟随控制周期结束,重复步骤S1-S5,完成对主机械臂的同步跟随控制。本方法基于CANopen技术来实现对多机械臂同步跟随控制,适用于多种总线形式下支持CANopen协议的电机伺服多机械臂系统,包括所有的CAN与EtherCAT等总线形式,并且不局限总线形式,也适用于多品牌多种机械臂。基于本方法的系统结构简单、易于实现,且对于主机械臂关节电机控制模式没有限制要求,主机械臂可以是位置控制、速度控制或者力矩控制中的一种,本方法均能实现从机械臂的同步跟随力矩控制。
作为一种优选方案,所述步骤S1中进行PDO配置过程包括:
对主机械臂各关节电机伺服TPDO设置至少包含状态字、实际位置、实际速度对象映射,对主机械臂各关节电机伺服RPDO无要求;
对从机械臂各关节电机伺服TPDO设置至少包含状态字、实际位置、实际速度对象映射,对从机械臂各关节电机伺服RPDO设置至少包括控制字、力矩、速度上限、速度下限对象映射。PDO协议中包括传送用的TPDO以及接收用的RPDO。RPDO中需要设置各关节的速度上下限,防止加速度过大保证系统安全。
作为一种优选方案,所述步骤S2中设置主、从机械臂的运动模式以及各关节电机的运动模式包括以下内容:
对主机械臂运动模式、关节电机运动模式均无要求;
对从机械臂运动模式设置为绝对跟随或相对跟随,关节电机运动模式设置为力矩控制模式,其中
绝对跟随:从机械臂的各关节运动参考零位B与主机械臂各关节参考零位BM相同,B=BM;
相对跟随:从机械臂的各关节运动参考零位B为从机械臂各关节当前位置。
作为一种优选方案,所述步骤S3中设置多机械臂各关节参考位置的具体内容包括:
若从机械臂运动模式为绝对跟随模式,设定从机械臂的各关节运动参考零位B为主机械臂各关节参考零位BM,
若从机械臂运动模式为相对跟随模式,设定从从机械臂的各关节运动参考零位B为从机械臂各关节的当前位置。
作为一种优选方案,所述步骤S4中从机械臂各关节跟随力矩控制量计算包括以下过程:
主机械臂开始运动,通过主、从机械臂TPDO中各关节实际位置反馈数据xM、x,将主机械臂的相对运动量作为从机械臂的期望相对轨迹,计算得到从机械臂在相对跟随模式下的位置同步误差e=x-B-(xM-BM),在绝对跟随模式下的位置同步误差e=x-xM;
xM为主机械臂实际位置数据,x为从机械臂实际位置数据,BM为主机械臂各关节参考零位,B为从机械臂的各关节运动参考零位。
结合主、从机械臂TPDO中各个关节速度反馈数据vM、v,将主机械臂的实际速度作为从机械臂的期望速度轨迹,计算相应各关节速度同步误差eV=v-vM;
计算得到从机械臂各个关节的力矩控制量τ=KDeV+KPe+KJ(vM+sgn(e)),其中KD、KP、KJ均为正常数,sgn为符号函数。
作为一种优选方案,所述步骤S5中对从机械臂各关节电机发送控制指令的过程包括:
根据获得的从机械臂各个关节的同步跟随力矩控制量,转换后通过从机械臂RPDO力矩对象下发给各关节伺服。
因此,本发明的优点是:1.基于CANopen技术来实现对多机械臂同步跟随控制,适用于多种总线形式下支持CANopen协议的电机伺服多机械臂系统,包括所有的CAN与EtherCAT等总线形式,并且不局限总线形式,也适用于多品牌多种机械臂。2.基于本方法的系统结构简单、易于实现。3.对于主机械臂关节电机控制模式没有限制要求,主机械臂可以是位置控制、速度控制或者力矩控制中的一种,本方法均能实现从机械臂的同步跟随力矩控制。
附图说明
附图1是本发明中主电路的一种流程示意图;
附图2是本发明中主、从机械臂测试关节的位置实际反馈图。
具体实施方式
下面通过实施例,并结合附图,对本发明的技术方案作进一步具体的说明。
实施例:
本实施例一种基于CANopen的多机械臂同步跟随控制方法,该多机械臂至少包括一个主机械臂和一个从机械臂,本实施例中以2个同型号的6个自由度机械臂的第6关节为测试对象,任选其一为主机械臂,另一为从机械臂。如图1所示,方法包括以下步骤:
S1.结合对象字典,基于PDO协议对多机械臂进行PDO配置;
对主机械臂各关节电机伺服TPDO设置至少包含状态字(0x6041)、实际位置(0x6064)、实际速度(0x606C)对象映射,对主机械臂各关节电机伺服RPDO无要求;
对从机械臂各关节电机伺服TPDO设置至少包含状态字、实际位置、实际速度对象映射,对从机械臂各关节电机伺服RPDO设置至少包括控制字(0x6040)、力矩(0x6071)、速度上下限(0x2946)对象映射。在此对主、从机械臂关节进行相同PDO配置如下表,
S2.分别设置主、从机械臂的运动模式以及各关节电机的运动模式;
考虑常用运行模式为位置控制模式,实现容易,为突出对主机械臂各关节的运动模式没有特殊要求,结合上述PDO设置,选用较少使用的力矩控制模式进行测试,设置主机械臂测试关节电机运动模式均为力矩控制模式;
对从机械臂运动模式设置为相对跟随,关节电机运动模式设置为力矩控制模式;
相对跟随:从机械臂的各关节运动参考零位B为从机械臂各关节当前位置。
S3.获取主、从机械臂运动状态,以及各关节反馈数据,设定多机械臂各关节参考位置;
设置主机械臂测试关节电机的目标力矩为0,由于设定为相对跟随模式,多机械臂初始化过程中,设定从机械臂的各关节运动参考零位B为从机械臂各关节的当前位置。
S4.根据主、从机械臂反馈量计算得到从机械臂各关节跟随力矩控制量;
主机械臂开始运动,通过主、从机械臂TPDO中各关节实际位置(0x6064)反馈数据xM、x,将主机械臂的相对运动量作为从机械臂的期望相对轨迹,计算得到从机械臂在相对跟随模式下的位置同步误差e=x-B-(xM-BM),在绝对跟随模式下的位置同步误差e=x-xM;xM为主机械臂实际位置数据,x为从机械臂实际位置数据,BM为主机械臂各关节参考零位,B为从机械臂的各关节运动参考零位。
结合主、从机械臂TPDO中各个关节速度反馈数据vM、v,将主机械臂的实际熟读作为从机械臂的期望速度轨迹,计算相应各关节速度同步误差eV=v-vM;
计算得到从机械臂各个关节的力矩控制量τ=KDeV+KPe+KJ(vM+sgn(e)),其中KD、KP、KJ分别设置为0.00001、0.001、0.00001,sgn为符号函数。
S5.对从机械臂各关节电机发送控制指令,一个同步跟随控制周期结束,重复步骤S1-S5,完成对主机械臂的同步跟随控制。
根据获得的从机械臂各个关节的同步跟随力矩控制量,转换后通过从机械臂RPDO力矩对象下发给各关节伺服,RPDO中设置各关节的速度上下限,防止速度过大保证系统安全。步骤S1-S5一个同步跟随控制周期结束,循环进行直至完成对主机械臂的同步跟随控制。
如图2所示,为主、从机械臂测试关节的位置实际反馈,其中横轴、竖轴分别对应周期数和关机实际反馈角度,下方曲线对应主机械臂,上方曲线对应从机械被,可见本方法的有效性。
本文中所描述的具体实施例仅仅是对本发明精神作举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代,但并不会偏离本发明的精神或者超越所附权利要求书所定义的范围。
尽管本文较多地使用了主机械臂、从机械臂、关节电机等术语,但并不排除使用其它术语的可能性。使用这些术语仅仅是为了更方便地描述和解释本发明的本质;把它们解释成任何一种附加的限制都是与本发明精神相违背的。
Claims (6)
1.一种基于CANopen的多机械臂同步跟随控制方法,该多机械臂至少包括一个主机械臂和一个从机械臂,其特征在于:包括以下步骤:
S1.结合对象字典,基于PDO协议对多机械臂进行PDO配置;
S2.分别设置主、从机械臂的运动模式以及各关节电机的运动模式;
S3.获取主、从机械臂运动状态,以及各关节反馈数据,设定多机械臂各关节参考位置;
S4.根据主、从机械臂反馈量计算得到从机械臂各关节跟随力矩控制量;
S5.对从机械臂各关节电机发送控制指令,一个同步跟随控制周期结束,重复步骤S1-S5,完成对主机械臂的同步跟随控制。
2.根据权利要求1所述的一种基于CANopen的多机械臂同步跟随控制方法,其特征是所述步骤S1中进行PDO配置过程包括:
对主机械臂各关节电机伺服TPDO设置至少包含状态字、实际位置、实际速度对象映射,对主机械臂各关节电机伺服RPDO无要求;
对从机械臂各关节电机伺服TPDO设置至少包含状态字、实际位置、实际速度对象映射,对从机械臂各关节电机伺服RPDO设置至少包括控制字、力矩、速度上限、速度下限对象映射。
3.根据权利要求1或2所述的一种基于CANopen的多机械臂同步跟随控制方法,其特征是所述步骤S2中设置主、从机械臂的运动模式以及各关节电机的运动模式包括以下内容:
对主机械臂运动模式、关节电机运动模式均无要求;
对从机械臂运动模式设置为绝对跟随或相对跟随,关节电机运动模式设置为力矩控制模式,其中
绝对跟随:从机械臂的各关节运动参考零位B与主机械臂各关节参考零位BM相同,B=BM;
相对跟随:从机械臂的各关节运动参考零位B为从机械臂各关节当前位置。
4.根据权利要求3所述的一种基于CANopen的多机械臂同步跟随控制方法,其特征是所述步骤S3中设置多机械臂各关节参考位置的具体内容包括:
若从机械臂运动模式为绝对跟随模式,设定从机械臂的各关节运动参考零位B为主机械臂各关节参考零位BM,
若从机械臂运动模式为相对跟随模式,设定从从机械臂的各关节运动参考零位B为从机械臂各关节的当前位置。
5.根据权利要求1或2所述的一种基于CANopen的多机械臂同步跟随控制方法,其特征是所述步骤S4中从机械臂各关节跟随力矩控制量计算包括以下过程:
主机械臂开始运动,通过主、从机械臂TPDO中各关节实际位置反馈数据xM、x,将主机械臂的相对运动量作为从机械臂的期望相对轨迹,计算得到从机械臂在相对跟随模式下的位置同步误差e=x-B-(xM-BM),在绝对跟随模式下的位置同步误差e=x-xM;
结合主、从机械臂TPDO中各个关节速度反馈数据vM、v,将主机械臂的实际熟读作为从机械臂的期望速度轨迹,计算相应各关节速度同步误差eV=v-vM;
计算得到从机械臂各个关节的力矩控制量τ=KDeV+KPe+KJ(vM+sgn(e)),其中KD、KP、KJ均为正常数,sgn为符号函数。
6.根据权利要求1或2所述的一种基于CANopen的多机械臂同步跟随控制方法,其特征是所述步骤S5中对从机械臂各关节电机发送控制指令的过程包括:
根据获得的从机械臂各个关节的同步跟随力矩控制量,转换后通过从机械臂RPDO力矩对象下发给各关节伺服。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610700192.6A CN106514650B (zh) | 2016-08-20 | 2016-08-20 | 一种基于CANopen的多机械臂同步跟随控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610700192.6A CN106514650B (zh) | 2016-08-20 | 2016-08-20 | 一种基于CANopen的多机械臂同步跟随控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106514650A true CN106514650A (zh) | 2017-03-22 |
CN106514650B CN106514650B (zh) | 2019-02-15 |
Family
ID=58343560
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610700192.6A Active CN106514650B (zh) | 2016-08-20 | 2016-08-20 | 一种基于CANopen的多机械臂同步跟随控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106514650B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108638015A (zh) * | 2018-05-16 | 2018-10-12 | 南京邮电大学 | 基于量化通信的主从机械臂同步跟踪控制方法 |
CN109739189A (zh) * | 2018-12-26 | 2019-05-10 | 深圳市路远智能装备有限公司 | 基于CANopen通讯协议多轴电机控制方法 |
CN109782601A (zh) * | 2019-01-31 | 2019-05-21 | 浙江大学 | 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法 |
CN114102588A (zh) * | 2021-11-23 | 2022-03-01 | 上海景吾智能科技有限公司 | 基于EtherCAT的单控制器-双机械臂装置和控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2368853A (en) * | 2000-11-07 | 2002-05-15 | Truetzschler Gmbh & Co Kg | Control and display arrangement at a spinning preparation system |
CN102371414A (zh) * | 2010-08-20 | 2012-03-14 | 中国海洋石油总公司 | 基于网络的管线全位置焊接控制系统 |
CN104290096A (zh) * | 2014-09-16 | 2015-01-21 | 湖南大学 | 一种基于CANopen的机械臂关节电机控制方法及系统 |
-
2016
- 2016-08-20 CN CN201610700192.6A patent/CN106514650B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2368853A (en) * | 2000-11-07 | 2002-05-15 | Truetzschler Gmbh & Co Kg | Control and display arrangement at a spinning preparation system |
CN102371414A (zh) * | 2010-08-20 | 2012-03-14 | 中国海洋石油总公司 | 基于网络的管线全位置焊接控制系统 |
CN104290096A (zh) * | 2014-09-16 | 2015-01-21 | 湖南大学 | 一种基于CANopen的机械臂关节电机控制方法及系统 |
Non-Patent Citations (4)
Title |
---|
代训康: "机械臂控制系统中CANopen协议的应用与开发", 《制造业自动化》 * |
李澄等: "基于CANpoen协议实现多电机系统实时控制", 《微机电》 * |
胡景良: "基于虚拟现实主从遥操作机器人系统研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
赵飞: "基于STM32的CANopen运动控制主从站开发", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108638015A (zh) * | 2018-05-16 | 2018-10-12 | 南京邮电大学 | 基于量化通信的主从机械臂同步跟踪控制方法 |
CN109739189A (zh) * | 2018-12-26 | 2019-05-10 | 深圳市路远智能装备有限公司 | 基于CANopen通讯协议多轴电机控制方法 |
CN109782601A (zh) * | 2019-01-31 | 2019-05-21 | 浙江大学 | 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法 |
CN114102588A (zh) * | 2021-11-23 | 2022-03-01 | 上海景吾智能科技有限公司 | 基于EtherCAT的单控制器-双机械臂装置和控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106514650B (zh) | 2019-02-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106514650A (zh) | 一种基于CANopen的多机械臂同步跟随控制方法 | |
CN104552311B (zh) | 基于EtherCAT的智能工业机器人总线模块及其操作方法 | |
DK2569129T4 (en) | Procedure for controlling an automated work cell | |
DK2569130T4 (en) | Procedure for controlling an automated work cell | |
CN106060058A (zh) | 基于互联网的工业机器人远程控制方法 | |
CN108638015A (zh) | 基于量化通信的主从机械臂同步跟踪控制方法 | |
JP2017027501A (ja) | 工作機械とロボットのリアルタイム干渉確認システム | |
CN103135536A (zh) | 一种dcs系统与计算机生产仿真模型信息处理方法 | |
CN104290096A (zh) | 一种基于CANopen的机械臂关节电机控制方法及系统 | |
CN105128010B (zh) | 一种scara机器人分布式控制系统及其控制方法 | |
US20030114938A1 (en) | Device and method for synchronizing a plurality of electric drive units in a paper processing machine | |
CN104908041B (zh) | 一种串联六轴工业机器人控制装置及方法 | |
CN205766165U (zh) | 机器人控制系统 | |
CN108015771A (zh) | 一种工业机器人控制系统 | |
CN105965509A (zh) | 机器人控制系统及控制方法 | |
JP4733695B2 (ja) | 自動化システムのシミュレーションのための方法及び装置 | |
JP7453268B2 (ja) | 多軸サーボ制御システム | |
CN105223868A (zh) | 一种Delta机器人分布式控制系统及控制方法 | |
CN106671110A (zh) | 一种机器人头部行程控制方法及其系统 | |
CN111381612A (zh) | 一种基于can总线的多轴同步控制系统及方法 | |
TWI823408B (zh) | 機械設備雲端控制系統 | |
WO2023138536A1 (zh) | 电机控制系统、电机控制方法和电机驱动和转发装置 | |
TW201416814A (zh) | 控制多個驅動器同步工作的方法及其裝置 | |
Ning | DESIGN AND RESEARCH OF MULTI AXIS MOTION CONTROL SYSTEM BASED ON PLC. | |
TWI834071B (zh) | 多軸伺服控制系統 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |