基于多任务转换的冗余度机器人控制算法

doi:10.3901/JME.2023.15.083

机械工程学报 ›› 2023, Vol. 59 ›› Issue (15): 83-93.doi: 10.3901/JME.2023.15.083

扫码分享

基于多任务转换的冗余度机器人控制算法

武毅, 胥超, 刘力源, 刘今越, 贾晓辉, 李铁军

河北工业大学机械工程学院天津 300401

收稿日期:2022-08-13 修回日期:2022-12-24 出版日期:2023-08-05 发布日期:2023-09-27
通讯作者: 刘今越(通信作者),男,1977年出生,教授,博士研究生导师。主要研究方向为建筑机器人、机器人环境感知、智能检测与控制。E-mail:ljy@hebut.edu.cn
作者简介:武毅,男,1998年出生,博士研究生。主要研究方向为冗余机器人运动规划与控制。E-mail:wuyiii2022@163.com
基金资助:
国家自然科学基金(U1813222,U20A20283)资助项目

Redundant Robot Control Algorithm Based on Multi-task Transformation

WU Yi, XU Chao, LIU Liyuan, LIU Jinyue, JIA Xiaohui, LI Tiejun

School of Mechanical Engineering, Hebei University of Technology, Tianjin 300401

Received:2022-08-13 Revised:2022-12-24 Online:2023-08-05 Published:2023-09-27

摘要/Abstract

摘要： 针对基于梯度投影的冗余度机器人传统避障算法无法实现机器人在任务空间避障的问题,提出一种基于多任务转换的冗余度机器人控制算法。首先,基于传统算法中的H_m避障指标,提出投影矢量指标预筛选方法,利用障碍物在机器人连杆上的投影矢量筛选掉非避碰杆件,计算可能避碰杆件与障碍物的距离并通过距离比较得出最短距离,减少最短距离的运算量。其次,根据避障标志点与障碍物最短距离的变化,引入多任务转换因子,实现冗余度机器人在任务空间避障、关节空间避障、末端轨迹补偿任务之间的平稳转换。最后,采用平面三自由度机器人和七自由度冗余机器人分别进行对比仿真分析和试验验证。结果表明,机器人可以有效躲避不同位置下的障碍物,并实现运动过程中机器人关节角及关节角速度的平稳、连续变化。

关键词: 冗余度机器人, 多任务转换, 实时避障, 投影矢量指标预筛选

Abstract: Aiming at the problem that the traditional obstacle avoidance algorithm of the redundant robot based on gradient projection cannot achieve obstacle avoidance in task space, a redundant robot control algorithm based on multi-task transformation is proposed. Firstly, based on the obstacle avoidance index H_m in the traditional algorithm, the projection vector index pre-screening method is proposed. The non-collision avoidance links are screened by the projection vector of the obstacle on the robot links. Then distances between possible collision avoidance links and the obstacle are calculated and the shortest distance is obtained by comparing the distances, which reduces the computation of the shortest distance. Secondly, according to the changes of the shortest distance between the obstacle avoidance mark points and the obstacle, the multi-task conversion factors are introduced to realize the smooth transformation of the redundant robot among task space obstacle avoidance, joint space obstacle avoidance, and end-effector trajectory compensation tasks. Finally, a planar 3-DOF redundant robot and a 7-DOF redundant robot are respectively used for comparative simulation analysis and experimental verification. The results show that the robot can effectively avoid obstacles in different positions, and the joint angles and joint angular velocities of the robot can change smoothly and continuously during the movement.

Key words: redundant robot, multi-task conversion, real-time obstacle avoidance, projection vector index pre-screening

中图分类号:

TP242

武毅, 胥超, 刘力源, 刘今越, 贾晓辉, 李铁军. 基于多任务转换的冗余度机器人控制算法[J]. 机械工程学报, 2023, 59(15): 83-93.

WU Yi, XU Chao, LIU Liyuan, LIU Jinyue, JIA Xiaohui, LI Tiejun. Redundant Robot Control Algorithm Based on Multi-task Transformation[J]. Journal of Mechanical Engineering, 2023, 59(15): 83-93.

参考文献

[1] HE Z,YUAN F,CHEN D,et al. Dynamic obstacle avoidance planning for manipulators of home[C]//IEEE International Conference on Robotics and Biomimetics (ROBIO),December 06-08,2019,Dali,China,New York:IEEE,2019:2737-2742.
[2] 李亚昕,王国磊,张剑辉,等. 基于碰撞反馈的冗余机器人避障规划算法[J]. 清华大学学报,2022,62(3):408-415. Li Yaxin,WANG Guolei,ZHANG Jianhui,et al. Obstacle avoidance algorithm for redundant robots based on collision feedback[J]. Journal of Tsinghua University,2022,62(3):408-415.
[3] 叶平,孙汉旭,张秋豪. 基于自运动控制的冗余度机器人运动学优化[J]. 机械工程学报,2004,40(12):128-132. YE Ping,SUN Hanxu,ZHANG Qiuhao. Kinematic optimization of redundant robot based on self-motion control[J]. Journal of Mechanical Engineering,2004,40(12):128-132.
[4] MU Z,XU W,LIANG B. Avoidance of multiple moving obstacles during active debris removal using a redundant space manipulator[J]. International Journal of Control Automation and Systems,2017,15(2):815-826.
[5] CAO H R,GU X Q,YU C H. Obstacle avoidance algorithm for redundant manipulators based on weighted generalized inverse[J]. Applied Mechanics and Materials,2017,872:303-309.
[6] 贾庆轩,张倩茹,高欣,等. 预选择最小距离指标的冗余机器人动态避障算法[J]. 机器人,2013,35(1):17-22. JIA Qingxuan,ZHANG Qianru,GAO Xin,et al. Dynamic obstacle avoidance algorithm for redundant robots with pre-selected minimum distance index[J]. Robot,2013,35(1):17-22.
[7] CHEN Y J,JU M Y,HWANG K S. A virtual torque based approach to kinematic control of redundant manipulators[J]. IEEE Transactions on Industrial Electronics,2016,64(2):1728-1736.
[8] WAN J,YAO J,ZHANG L,et al. A weighted gradient projection method for inverse kinematics of redundant manipulators considering multiple performance criteria[J]. Strojniski Vestnik/Journal of Mechanical Engineering, 2018,64(7/8):475-487.
[9] 方承,赵京. 新颖的基于梯度投影法的混合指标动态避障算法[J]. 机械工程学报,2010,46(19):30-37. FANG Cheng,ZHAO Jing. New dynamic obstacle avoidance algorithm with hybrid index based on gradient projection method[J]. Journal of Mechanical Engineering, 2010,46(19):30-37.
[10] LIEGEOIS A. Automatic supervisory control of the configuration and behavior of multibody mechanisms[J]. IEEE Transactions on Systems,Man,and Cybernetics,1977,7(12):868-871.
[11] MACIEJEWSKI A A,KLEIN C A. Obstacle avoidance for kinematically redundant manipulators in dynamically varying environments[J]. International Journal of Robotics Research,1985,4(3):109-117.
[12] ZLAJPAH L,NEMEC B. Kinematic control algorithms for on-line obstacle avoidance for redundant manipulators[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems,30 December 2002-04 Octobor 2002,Lausanne,Switzerland,New York:IEEE,2002:1898-1903.
[13] 申浩宇,吴洪涛,陈柏,等. 基于主从任务转化的冗余度机器人避障算法[J]. 机器人,2014,36(4):425-429. SHEN Haoyu,WU Hongtao,CHEN Bai,et al. Obstacle avoidance algorithm for redundant robots based on transition between the primary and secondary tasks[J]. Robot,2014,36(4):425-429.
[14] 张建华,胡平,张小俊,等. 基于主从任务转化的闭环控制避障算法[J]. 机械工程学报,2017,53(1):21-27. ZHANG Jianhua,HU Ping,ZHANG Xiaojun,et al. Closed loop control algorithm for obstacle avoidance based on the transformation between master and slave tasks[J]. Journal of Mechanical Engineering,2017,53(1):21-27.
[15] 高涵,张明路,张小俊,等. 冗余机器人的任务优先级轨迹规划方法[J]. 机械科学与技术,2018,37(1):27-29. GAO Han,ZHANG Minglu,ZHANG Xiaojun,et al. Task priority trajectory planning method for redundant robots[J]. Mechanical Science and Technology,2018,37(1):27-29.

基于多任务转换的冗余度机器人控制算法

Redundant Robot Control Algorithm Based on Multi-task Transformation

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 13

编辑推荐

Metrics

本文评价

[1]	王明强, 王震坡, 张雷. 基于碰撞风险评估的智能汽车局部路径规划方法研究[J]. 机械工程学报, 2021, 57(10): 28-41.
[2]	葛新锋;赵东标. 7自由度自动铺丝机器人参数化的自运动流形[J]. , 2012, 48(13): 27-31.
[3]	邵君奕;张传清;刘召;陈恳. 考虑振动抑制的多冗余度特种操作机器人轨迹优化方法[J]. , 2012, 48(1): 13-18.
[4]	谢碧云;赵京. 基于条件数约束的方向可操作度[J]. , 2010, 46(23): 8-15.
[5]	赵建文;杜志江;孙立宁. 7自由度冗余手臂的自运动流形[J]. , 2007, 43(9): 132-137.
[6]	孙立宁;赵建文;杜志江. 单冗余度机器人避障能力指标的建立及在7自由度冗余手臂上的实践[J]. , 2007, 43(5): 223-229.
[7]	赵京;魏珊珊. 基于容错性能的冗余度机器人结构综合[J]. , 2007, 43(10): 82-88.
[8]	李立;张登材. 空间刚性冗余度机器人混沌运动控制的延迟反馈控制法[J]. , 2005, 41(9): 122-127.
[9]	叶平;孙汉旭;张秋豪. 基于自运动控制的冗余度机器人运动学优化[J]. , 2004, 40(12): 128-132.
[10]	宋轶民;余跃庆;张策;吴振勇. 柔性冗余度机器人残余振动随机最优控制[J]. , 2002, 38(9): 33-37.
[11]	李健;李剑锋;武桢;张启先. 冗余度机器人多关节故障的运动学容错性及其优化[J]. , 2002, 38(7): 111-115.
[12]	唐世明;张启先. 冗余度机器人容错控制研究[J]. , 2000, 36(7): 34-38.
[13]	唐世明;张启先. 冗余度机器人优化的自运动控制方法[J]. , 2000, 36(1): 41-44.