工程科学学报.第44卷，第2期：244-253.2022年2月 Chinese Journal of Engineering,Vol.44,No.2:244-253,February 2022 https://doi.org/10.13374/j.issn2095-9389.2020.08.07.002;http://cje.ustb.edu.cn 面向六关节机器人的位置域控制 崔旭东”，邓少丰)，王平江2) 1)鞍山师范学院计算中心，鞍山1140072)华中科技大学机械科学与工程学院，武汉430074 ☒通信作者，E-mail:Pi_wang@hust.edu.cn 摘要多轴联动下的串联多关节工业机器人在空间轨迹运动时，在时间上保证各关节轴单独具有良好的跟踪性能，而由于 机械电气的迟滞效应，并不能完全保证理想的轮廓轨迹，这说明各个伺服轴的运动在几何空间中的同步非常重要.针对运动 指令与实际位置之间的迟滞所带来的机器人末端轮廓精度不高的问题，本文结合工业机器人现有的运动学和动力学以及传 统的PD控制理论，研究了六关节机器人位置域控制算法.将机器人空间轮廓轨迹的控制，通过采用主-从运动关系实时建 立的方法，将时域中的各个同服关节的同步控制方法，变换到位置域的各个同服关节的主一从跟随的控制方法，在实现位置域 的同步控制的同时，引入基于位置域的PD控制，减少了主-从跟随控制的跟随误差，从而整体提高机器人末端的轮廓运动精 度.该方法在Linux CNC(Computerized Numerical Control)数控系统上，以某公司HSR-JR6Os机器人为对象进行了实验，证明 采用位置域控制方法对六关节机器人空间运动轨迹精度的提高有积极作用. 关键词轮廓跟踪；六关节机器人；位置域控制：PID控制：LinuxCNC 分类号TP242.2 Position domain control technology for six-joint robots CUI Xu-dong,DENG Shao-feng,WANG Ping-jiang 1)Computing Center,Anshan Normal University,Anshan 114007,China 2)School of Mechanical Science Engineering,Huazhong University of Science and Technology,Wuhan 430074,China Corresponding author,E-mail:pj_wang @hust.edu.cn ABSTRACT In the context of the rapid development of intelligent manufacturing,high-precision motion control of industrial robots has attracted increasing research attention.High-speed and high-precision motion control is a development trend associated with the current industrial robots.Industrial transformation and upgradation can be accelerated only via the independent research and development of robot core technologies,including robot high-precision control systems,ensuring the transition of the manufacturing industry in China toward intelligent and digital development.Currently,the contour tracking error associated with majority of the multiaxes CNC machine tools and multijoint industrial robots is a common problem.A good tracking performance can be achieved in time with respect to each joint axis when the space trajectory of the serial multijoint industrial robot changes under multiaxes linkage. The ideal contour trajectory cannot be fully ensured because of the mechanical and electrical hysteresis effects.Therefore,the synchronization of the motion of each servo axis in the geometric space is very important.In this paper,the existing kinematics and dynamics of industrial robots were combined with the traditional PID control theory for studying position domain control algorithm of the six-joint robot to resolve the problem of low accuracy associated with the robot end profile,which can be attributed to the lag between the motion instruction and the actual position.The algorithm uses the method of real-time establishment of the master-slave motion relation for controlling the spatial contour trajectory of the robot.It further transforms the synchronization control method of each 收稿日期：2020-08-07 基金项目：国家科技重大(04)专项“核工业专用零部件制造装备换脑工程”资助项目(2017ZX04011006-005):国家科技重大(04)专项“高 档数控系统关键共性技术创新能力平台（二期）”资助项目(2015ZX04005007)面向六关节机器人的位置域控制 崔旭东1)，邓少丰2)，王平江2) 苣 1) 鞍山师范学院计算中心，鞍山 114007    2) 华中科技大学机械科学与工程学院，武汉 430074 苣通信作者， E-mail：pj_wang@hust.edu.cn 摘    要    多轴联动下的串联多关节工业机器人在空间轨迹运动时，在时间上保证各关节轴单独具有良好的跟踪性能，而由于 机械电气的迟滞效应，并不能完全保证理想的轮廓轨迹，这说明各个伺服轴的运动在几何空间中的同步非常重要. 针对运动 指令与实际位置之间的迟滞所带来的机器人末端轮廓精度不高的问题，本文结合工业机器人现有的运动学和动力学以及传 统的 PID 控制理论，研究了六关节机器人位置域控制算法. 将机器人空间轮廓轨迹的控制，通过采用主−从运动关系实时建 立的方法，将时域中的各个伺服关节的同步控制方法，变换到位置域的各个伺服关节的主−从跟随的控制方法，在实现位置域 的同步控制的同时，引入基于位置域的 PD 控制，减少了主−从跟随控制的跟随误差，从而整体提高机器人末端的轮廓运动精 度. 该方法在 Linux CNC(Computerized Numerical Control) 数控系统上，以某公司 HSR-JR605 机器人为对象进行了实验，证明 采用位置域控制方法对六关节机器人空间运动轨迹精度的提高有积极作用. 关键词    轮廓跟踪；六关节机器人；位置域控制；PID 控制；LinuxCNC 分类号    TP242.2 Position domain control technology for six-joint robots CUI Xu-dong1) ，DENG Shao-feng2) ，WANG Ping-jiang2) 苣 1) Computing Center, Anshan Normal University, Anshan 114007, China 2) School of Mechanical Science & Engineering, Huazhong University of Science and Technology, Wuhan 430074, China 苣 Corresponding author, E-mail: pj_wang@hust.edu.cn ABSTRACT    In the context of the rapid development of intelligent manufacturing, high-precision motion control of industrial robots has  attracted  increasing  research  attention.  High-speed  and  high-precision  motion  control  is  a  development  trend  associated  with  the current  industrial  robots.  Industrial  transformation  and  upgradation  can  be  accelerated  only via the  independent  research  and development  of  robot  core  technologies,  including  robot  high-precision  control  systems,  ensuring  the  transition  of  the  manufacturing industry  in  China  toward  intelligent  and  digital  development.  Currently,  the  contour  tracking  error  associated  with  majority  of  the multiaxes CNC machine tools and multijoint industrial robots is a common problem. A good tracking performance can be achieved in time with respect to each joint axis when the space trajectory of the serial multijoint industrial robot changes under multiaxes linkage. The  ideal  contour  trajectory  cannot  be  fully  ensured  because  of  the  mechanical  and  electrical  hysteresis  effects.  Therefore,  the synchronization of the motion of each servo axis in the geometric space is very important. In this paper, the existing kinematics and dynamics of industrial robots were combined with the traditional PID control theory for studying position domain control algorithm of the  six-joint  robot  to  resolve  the  problem  of  low  accuracy  associated  with  the  robot  end  profile,  which  can  be  attributed  to  the  lag between the motion instruction and the actual position. The algorithm uses the method of real-time establishment of the master–slave motion relation for controlling the spatial contour trajectory of the robot. It further transforms the synchronization control method of each 收稿日期: 2020−08−07 基金项目: 国家科技重大（04）专项“核工业专用零部件制造装备换脑工程” 资助项目（2017ZX04011006-005）；国家科技重大（04）专项“高 档数控系统关键共性技术创新能力平台（二期）” 资助项目（2015ZX04005007） 工程科学学报，第 44 卷，第 2 期：244−253，2022 年 2 月 Chinese Journal of Engineering, Vol. 44, No. 2: 244−253, February 2022 https://doi.org/10.13374/j.issn2095-9389.2020.08.07.002; http://cje.ustb.edu.cn