大范围平动并联机器人运动学解耦与速度自适应规划

赵新华; 刘培昌; 赵磊; 李彬

doi:10.37188/OPE.20212902.0305

您当前的位置：

首页 >

文章列表页 >

大范围平动并联机器人运动学解耦与速度自适应规划

微纳技术与精密机械 | 更新时间：2021-03-05

- 大范围平动并联机器人运动学解耦与速度自适应规划
- Kinematic decoupling and velocity adaptive planning of parallel robot in large overall translation
- 光学精密工程 2021年29卷第2期页码：305-315
- 作者机构：
  
  1.天津理工大学天津市先进机电系统设计与智能控制重点实验室，天津 300384
  2.天津理工大学机电工程国家级实验教学示范中心，天津 300384
  3.天津理工大学机械工程学院，天津 300384
- 作者简介：
  
  [ "赵新华（1962-），男，博士，吉林辽源人，教授，博士生导师，2000年于天津大学获得博士学位，主要研究方向为机器人技术和机电一体化技术。E-mail： xinhuazhao@tjut.edu.cn" ]
  [ "赵　磊（1983-），男，吉林辽源人，博士，副教授，2012年毕业于天津大学获得博士学位，主要研究方向为机器人和机电一体化技术研究。E-mail：leizhaotjut@163.com" ]
- 基金信息：
  
  国家重点研发计划资助项目(2017YFB1303502);国家自然基金面上项目资助(51975412);天津市自然科学基金资助项目(18JCYBJC87900)
- DOI：10.37188/OPE.20212902.0305
  中图分类号： TP242;TP202.2
- 收稿日期：2020-05-13，
  
  修回日期：2020-12-30，
  
  纸质出版日期：2021-02-15
- 稿件说明：
移动端阅览
赵新华,刘培昌,赵磊等.大范围平动并联机器人运动学解耦与速度自适应规划[J].光学精密工程,2021,29(02):305-315.

ZHAO Xin-hua,LIU Pei-chang,ZHAO Lei,et al.Kinematic decoupling and velocity adaptive planning of parallel robot in large overall translation[J].Optics and Precision Engineering,2021,29(02):305-315.
赵新华,刘培昌,赵磊等.大范围平动并联机器人运动学解耦与速度自适应规划[J].光学精密工程,2021,29(02):305-315. DOI： 10.37188/OPE.20212902.0305.

ZHAO Xin-hua,LIU Pei-chang,ZHAO Lei,et al.Kinematic decoupling and velocity adaptive planning of parallel robot in large overall translation[J].Optics and Precision Engineering,2021,29(02):305-315. DOI： 10.37188/OPE.20212902.0305.

摘要

并联机器人是一种多支链、多关节、强耦合非线性系统，具有高速、高刚度和大负载等明显优势而被广泛应用到工业领域。然而，随着关节数量的增加导致该类机器人运动学解耦和高精度平稳控制的难度较大。为实现大范围平动3-RRRU并联机器人自动化轨迹跟踪和控制的平稳性，针对运动学解耦和速度自适应规划方法展开了系统、深入地研究。首先，应用DH法建立了机器人运动学模型，基于结构约束条件完成运动学解耦计算，并在S型控制策略中加入速度自适应修正机制，依据不同轨迹可自动计算并修正最大速度参数，实现自适应优化；其次，采用激光跟踪仪对机器人轨迹进行动态跟踪，对比分析了S型速度和梯型速度控制策略下的跟踪精度，梯型速度规划下其最大误差高达4.513 mm，是S型控制策略的3倍，且位置误差曲线出现多个尖峰值，说明因速度突变导致运动平稳性较差；最后，测试S型速度规划下采用自适应修正机制前、后机器人的平稳性以及轨迹跟踪精度。实验结果表明：当规划路径难以实现机器人加速到原预设最大速度时，在轨迹末端存在较大的惯性速度，产生位置尖峰误差为2.676 mm，是修正后最大误差的2.4倍，且伴随着明显的冲击效应。引入自适应修正机制后圆轨迹的起点和终点位置误差分别为0.722 mm和0.382 mm，二者相对位置偏差仅为0.34 mm，且末端定位误差相比修正前降低了一个数量级，有效解决了机器人存在惯性冲击效应的难题，大幅提高了机器人整体轨迹跟踪的精度和控制的平稳性。

Abstract

Parallel robot is a kind of nonlinear strong coupling system with many branches and joints. It has obvious advantages of high speed， high stiffness and large load. So， it is widely used to industrial field. However， with the number of joints increasing， it becomes more difficult to finish kinematic decoupling and precision control. In order to realize automatic trajectory tracking and stable control of 3-RRRU parallel robot， kinematic decoupling and velocity adaptive planning method are systematically and deeply researched. The kinematic equations are derived by DH theory and space vector method. Inverse kinematics calculation is completed based on structural constraints. The velocity correction mechanism is added to the S-type control strategy， and the maximum speed parameters can be calculated and revised automatically according to different trajectories. It realizes the adaptive optimization ofthe speed control strategy. The laser tracker is used to track the robot's path， and the accuracy is compared and analyzed under control of standard S-type and ladder type. The maximum error reaches to 4.513 mm， which is 3 times of the S-type control strategy. There are several error peaks on the position curve which shows that the motion stability is poorer due to the sudden change of speed. On this basis， the second experiment is carried out. We test the stability and tracking error of the robot before and after adopting correction mechanism for the S-type speed control under the circular trajectory. The experimental results have shown that when robot can’t achieve the maximum speed on the preset path， the original max speed is still control parameter which cause the asymmetric distribution of the speed control curve. Therefore， when the robot reaches the end of the trajectory， it also owns a large inertia speed and results in a peak error of 2.676 mm which is 2.4 times of the after correction. Robot stops accompanied by obvious shaking. After adaptive correction， the position errors of the starting point and the ending point are 0.722 mm and 0.382 mm respectively， and the relative position errors of the two position are only 0.34 mm. It effectively solves the inertia speed problem when the robot reaches the end of the trajectory， and greatly improves the overall tracking accuracy and motion stability of the robot.

关键词

Keywords

references

田小玲 . 基于末端圆周标定的软体机器人刚度独立控制研究［J］. 电子测量技术， 2019 （ 6 ）： 105 - 109 .

TIAN X L . Research on independent stiffness control of soft robot based on end cylindrical calibration ［J］. Electronic measurement technology ， 2019 （ 6 ）： 105 - 109 . （in Chinese）

NGUYEN H N ， ZHOU J ， KANG H J . A calibration method for enhancing robot accuracy through integration of an extended Kalman filter algorithm and an artificial neural network ［J］. Neurocomputing ， 2015 ， 151 ： 996 - 1005 .

JOUBAIR A ， BONEV I A . Kinematic calibration of a six-axis serial robot using distance and sphere constraints ［J］. International Journal of Advanced Manufacturing Technology ， 2015 ， 77 （ 1 ）： 515 - 523 .

许允斗，王超，赵春霖，等 . 2RPU/UPR+RP五自由度混联机器人参数标定研究［J］. 光学精密工程， 2020 ， 28 （ 1 ）： 119 - 129 .

XU Y D ， WANG CH ， ZHAO CH L ， et al . . Parameter calibration of five degree of freedom hybrid robot 2RPU/UPR+RP ［J］. Opt. Precision Eng. ， 2020 ， 28 （ 1 ）： 119 - 129 . （in Chinese）

余跃庆，田浩 . 运动副间隙引起的并联机器人误差及其补偿［J］. 光学精密工程， 2015 ， 23 （ 5 ）： 1331 - 1339 .

YU Y Q ， TIAN H . Error and compensation of parallel robot with joint clearances ［J］. Opt. Precision Eng. ， 2015 ， 23 （ 5 ）： 1331 - 1339 . （in Chinese）

HU J ， XIAO L J ， WANG Y H ， et al . . An optimal feedrate model and solution algorithm for a high-speed machine of small line blocks with look-ahead ［J］. The international journal of advanced manufacturing technology ， 2006 ， 28 （ 10 ）： 930 – 935 .

赵磊，赵新华，周海波，等 . 并联测量机柔性动力学建模与误差耦合［J］. 光学精密工程， 2016 ， 24 （ 10 ）： 2471 - 2479 .

ZHAO L ， ZHAO X H ， ZHOU H B ， et al . . Flexible dynamic modeling and error coupling of parallel measuring machine ［J］. Opt. Precision Eng. ， 2016 ， 24 （ 10 ）： 2471 - 2479 . （in Chinese）

陆艺，于丽梅，郭斌 . 基于封闭尺寸链的工业机器人结构参数标定［J］. 仪器仪表学报， 2018 ， 39 （ 2 ）： 38 - 46 .

LU Y ， YU L M ， GUO B . Calibration of industrial robot structure parameters based on closed dimensional chain ［J］. Chinese Journal of Scientific Instrument ， 2018 ， 39 （ 2 ）： 38 - 46 . （in Chinese）

赵新华，栾倩倩，赵磊，等 . 3-RRRU并联机器人运动学建模与误差分析［J］. 机械设计与制造， 2020 （ 1 ）： 274 - 280 .

ZHAO X H ， LUAN Q Q ， ZHAO L ， et al . . Kinematics modeling and error analysis of 3-RRRU parallel manipulator ［J］. Machinery Design & Manufacture ， 2020 （ 1 ）： 274 - 280 . （in Chinese）

王雷，石鑫 . 基于改进蚁群算法的移动机器人动态路径规划［J］. 南京理工大学学报， 2019 ， 43 （ 6 ）： 700 - 707 .

WANG L ， SHI X . Dynamic path planning of mobile robot based on improved ant colony algorithm ［J］. Journal of Nanjing University of Science and Technology ， 2019 ， 43 （ 6 ）： 700 - 707 . （in Chinese）

孙波，姜平，周根荣，等 . 改进遗传算法在移动机器人路径规划中的应用［J］. 计算机工程与应用， 2019 ， 55 （ 17 ）： 162 - 168 .

SONG B ， JIANG P ， ZHOU G R ， et al . . Application of improved genetic algorithm in path planning of mobile robots ［J］. Computer Engineering and Applications ， 2019 ， 55 （ 17 ）： 162 - 168 . （in Chinese）

JH HAN ， DJ CHOI ， SU PARK ， et al . . Hyperparameter optimization using a genetic algorithm considering verification time in a convolutional neural network ［J］. Journal of Electrical Engineering & Technology ， 2020 ， 15 （ 2 ）： 721 - 726 .

GIBERTI H ， SBAGLIA L ， URGO M . A path planning algorithm for industrial processes under velocity constraints with an application to additive manufacturing ［J］. Journal of manufacturing systems ， 2017 ， 43 ： 160 - 167 .

ABU-DAKKA F J ， ASSAD I F ， ALKHDOUR R M ， et al . . Statistical evaluation of an evolutionary algorithm for minimum time trajectory planning problem for industrial robots ［J］. The international journal of advanced manufacturing technology ， 2017 ， 89 （ 1-4 ）： 389 - 406 .

李振娜，王涛，王斌锐，等 . 基于带约束 S 型速度曲线的机械手笛卡尔空间轨迹规划［J］. 智能系统学报， 2019 ， 14 （ 4 ）： 655 – 661 .

LI ZH N ， WANG T ， WANG B R ， et al . . Trajectory planning for manipulator in Cartesian space based on constrained S-curve velocity ［J］. CAAI transactions on intelligent systems ， 2019 ， 14 （ 4 ）： 655 - 661 . （in Chinese）

史步海，孙会会 . 基于新S型速度规划的B样条曲线算法研究［J］. 机床与液压， 2016 ， 2016 ， 44 （ 15 ）： 72 - 79 .

SHI B H ， SUN H H . B-spline curve algorithm research based on new S velocity planning ［J］. Machine tool and hydraulics ， 2016 ， 2016 ， 44 （ 15 ）： 72 - 79 . （in Chinese）

张娜，李娟霞，王欢 . NURBS曲线 S 型加减速反向修正插补算法研究［J］. 数控技术， 2019 ，（ 9 ）： 162 - 167 .

ZHANG N ， LI J X ， WANG H . Research on the algorithm of NUＲBS curve reverse correction interpolation with S-type acceleration and deceleration control ［J］. NC Technology ， 2019 ，（ 9 ）： 162 - 167 . （in Chinese）

龚兰芳，曹成涛，许伦辉 . 下肢康复训练机器人协作控制与Ｓ型规划算法研究［J］. 中国机械工程学报， 2019 ， 17 （ 6 ）： 482 - 487 .

GONG L F ， CAO CH T ， XU L H . Research on collaborative control of lower limb rehabilitation training robot and S-type programming algorithm ［J］. Chinese Journal of Construction Machinery ， 2019 ， 17 （ 6 ）： 482 - 487 . （in Chinese）

栾倩倩 . 3-RRRU并联机器人运动学误差建模及自标定方法研究［D］. 天津：天津理工大学， 2018 .

LUAN Q Q . Research on Kinematics Error Modeling and Self - Calibration Technology of 3-RRRU Parallel Manipulator ［D］. Tianjin ： Tianjin University of Technology ， 2018 . （in Chinese）

王文瑞，刘克俭，顾金麟，等 . 有关节约束超冗余机械臂的增益优化轨迹规划［J］. 光学精密工程， 2019 ， 27 （ 5 ）： 1075 - 1086 .

WANG W R ， LIU K J ， GU J L ， et al . .Gain-optimization trajectory planning method for hyper-redundant manipulator with joint constraints ［J］. Opt. Precision Eng. ， 2019 ， 27 （ 5 ）： 1075 - 1086 . （in Chinese）

张旭，曾祥鑫，郎博 . 基于控制变量参数化方法的自由漂浮空间机器人路径规划研究［J］. 光学精密工程， 2019 ， 27 （ 2 ）： 372 - 378 .

ZHANG X ， ZENG X X ， LANG B . Path planning of free-floating space robot based on control variable parameterization method ［J］. Opt. Precision Eng. ， 2019 ， 27 （ 2 ）： 372 - 378 . （in Chinese）

浏览量

1030

下载量

CSCD

文章被引用时，请邮件提醒。

提交

工具集

关联资源

压电平台高精度自适应分数阶滑模跟踪控制

并联机器人工作空间的区间离散法

光电跟踪平台的观测自适应控制器

运动副间隙引起的并联机器人误差及其补偿

主被动磁悬浮转子的不平衡振动自适应控制