基于主从任务转化的闭环控制避障算法*

doi:10.3901/JME.2017.01.021

机械工程学报 ›› 2017, Vol. 53 ›› Issue (1): 21-27.doi: 10.3901/JME.2017.01.021

扫码分享

基于主从任务转化的闭环控制避障算法^*

张建华¹, 胡平¹, 张小俊¹, 刘进长², 刘璇¹

1. 河北工业大学机械工程学院天津 300130；
2．科技部高技术研究发展中心北京 100044

出版日期:2017-01-05 发布日期:2017-01-05
作者简介:张建华，男，1979年出生，副教授。主要研究方向为智能机器人技术。E-mail：jhzhang@hebut.edu.cn刘进长(通信作者)，男，1964年出生，研究员。主要研究方向为智能机器人技术。E-mail：liujc@htrdc.com
基金资助:
* 国家自然科学基金(E51575157)、机器人学国家重点实验室基金(2015002)和河北省自然科学基金重点(E2016202342)资助项目; 20160531收到初稿，20161011收到修改稿;

Closed Loop Control Algorithm for Obstacle Avoidance Based on the Transformation of Master and Slave Tasks

ZHANG Jianhua¹, HU Ping¹, ZHANG Xiaojun¹, LIU Jinchang², LIU Xuan¹

1. School of Mechanical Engineering， Hebei University of Technology， Tianjin 300130;
2. High Technology Center of Ministry of Science and Technology， Beijing 100044

Online:2017-01-05 Published:2017-01-05

摘要/Abstract

摘要：

冗余度机械臂避障算法研究一直是机器人领域的研究热点之一。针对传统算法的不足提出一种基于主从任务转化的闭环控制避障算法。主从任务转化通过监测机械臂各杆件与障碍物之间的最小距离变化实现避障任务和期望轨迹跟踪任务的主从切换，从而解决当障碍物位于机械臂末端期望轨迹上时避障运动和期望轨迹跟踪运动存在的相互冲突问题。考虑到机械臂避障时其末端跟踪精度差的问题，引入对冗余度机器臂末端期望位置和实际位置的误差控制，使得机械臂末端跟踪精度显著提高。同时，该算法还适用于多障碍物避障和动态避障且具有计算量小和躲避速度变化连续等优点。通过三自由度平面冗余度机器臂的仿真试验，验证了该算法的正确性。仿真结果表明，该算法能够有效解决当障碍物位于机械臂末端期望轨迹上时存在的冲突问题，而且机械臂在避障的同时也能够高精度跟踪末端期望轨迹，且能够完成多障碍物避障和动态避障。

关键词: 闭环控制, 避障, 主从任务转化, 冗余度机械臂

Abstract: The research on obstacle avoidance algorithm of redundant manipulator has always been one of the hotspots in the field of robot. A closed loop control algorithm for obstacle avoidance based on the transformation of master and slave tasks is proposed aiming at the shortcomings of the traditional algorithm. It achieves the switch of the task of obstacle avoidance and the task of the desired trajectory tracking by monitoring the minimum distance between the mechanical arm and the obstacle, thus it can solve the conflict between obstacle avoidance and desired trajectory tracking. When mechanical arms avoid obstacle, the end tracking accuracy is poor, based on this, the error control between the desired and actual end effector locations is introduced which makes the tracking accuracy significantly improved. In addition, the algorithm also has the advantages of small amount of computation and continuous variation of the velocity of escape and it can also be applied to collision avoidance of many obstacles and dynamic obstacle. The algorithm is verified by the simulation experiment of planar redundant robot with three degrees of freedom. The results show that the algorithm can effectively solve the conflict when the obstacle is on the desired tracking and the accuracy is high. It can also finish the obstacle avoidance of many obstacles and dynamic obstacle.

Key words: closed-loop control, master slave task transformation, obstacle avoidance, redundant manipulator

张建华, 胡平, 张小俊, 刘进长, 刘璇. 基于主从任务转化的闭环控制避障算法^*[J]. 机械工程学报, 2017, 53(1): 21-27.

ZHANG Jianhua, HU Ping, ZHANG Xiaojun, LIU Jinchang, LIU Xuan. Closed Loop Control Algorithm for Obstacle Avoidance Based on the Transformation of Master and Slave Tasks[J]. Journal of Mechanical Engineering, 2017, 53(1): 21-27.

参考文献

[1] 孙立宁，赵建文，杜志江. 单冗余度机器人避障能力指标的建立及在7自由度冗余手臂上的实践[J]. 机器人，2007，43(5)：223-229.

SUN Lining，ZHAO Jianwen，DU Zhijiang. Concept and application on 7-DOF redundant manipulator of index to measure capability of collision-avoidance for single redundant manipulator[J]. Robot，2007，43(5)：223-229.

[2] 管小清，常青，梁冠豪，等. 一种冗余机械臂的多运动障碍物避障算法[J]. 计算机测量与控制，2015，23(8)： 2802-2805.

GUAN Xiaoqing，CHANG Qing，LIANG Guanhao，et al. Multiple mobile obstacles avoidance algorithm for redundant manipulator[J]. Computer Measurement & Control，2015，23(8)：2802-2805.

[3] 申浩宇，吴洪涛，陈柏，等. 基于主从任务转化的冗余度机器人避障算法[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.

[4] JIA Q X，ZHANG Q R，GAO X，et al. Dynamic obstacle avoidance algorithm for redundant robots with pre-selected minimum distance index[J]. Robot，2013，35(1)：17-22.

[5] 鲍庆勇，李舜酩，沈峘，等. 自主移动机器人局部路径规划综述[J]. 传感器与微系统，2009，28(9)：1-4.

BAO Qingyong，LI Shunming，SHEN Xuan，et al. Survey of local path planning of autonomous mobile robot[J]. Transducer and Microsystem Technologies，2009，28(9)：1-4.

[6] 徐进. 基于蚁群算法的移动机器人路径规划算法研究[D]. 北京：北京化工大学，2009.

XU Jin. The research of mobile robot path planning algorithm based on antcolony algorithm[D]. Beijing：Beijing University of Chemical Technology，2009.

[7] 马仁利，关正西. 路径规划技术的现状与发展综述[J]. 现代机械，2008(3)：22 -24.

MA Renli，GUAN Zhengxi. Summarization for present situation and future development of path planning technology[J]. Modern Machinery，2008(3)：22-24.

[8] 姜力，周扬，孙奎，等. 七自由度冗余机械臂避障控制[J]. 光学精密工程，2013，21(7)：1795-1801．

JIANG Li，ZHOU Yang，SUN Kui，et al. Obstacle avoidance control for 7-DOF redundant manipulations[J]. Optics and Precision Engineering，2013，21(7)：1795-1801.

[9] SHUKLA A，SINGLA E，WAHI P，et al. A direct variational method for planning monotonically optimal paths for redundant manipulators in constrained workspaces[J]. Robotics and Autonomous Systems，2013，61(2)：209-220.

[10] MACIEJEWSKI A，KLEIN C. Obstacle avoidance for kinematically redundant manipulators in dynamically varying environments[J]. International Journal of Robotics Research，1985，4(3)：109-117.

[11] GUO Z Y，HSIA T C. Joint trajectory generation for redundant robots in an environment with obstacles[J]. Journal of Robotic Systems，1993，10(2)：199-215.

[12] 方承，赵京. 新颖的基于梯度投影法的混合指标动态避障算法[J]. 机械工程学报，2010，46(10)：46-49.

FANG Cheng，ZHAO Jing. New dynamic obstacle avoidance algorithm with hybrid index based on gradient projection method[J]. Journal of Mechanical Engineering， 2010，46(10)：46-49.

[1]	赵京, 周振勇, 张自强. 冗余度机械臂的自运动流形计算及关节轨迹规划[J]. 机械工程学报, 2023, 59(5): 77-88.
[2]	武毅, 胥超, 刘力源, 刘今越, 贾晓辉, 李铁军. 基于多任务转换的冗余度机器人控制算法[J]. 机械工程学报, 2023, 59(15): 83-93.
[3]	钱东升, 田汉, 邓加东. 面向极大尺度环件径-轴向稳定轧制的环件匀速长大状态精准闭环控制方法[J]. 机械工程学报, 2023, 59(10): 85-95.
[4]	张建华, 任宝珍, 赵岩, 徐永强, 刘璇. 基于二分试探的平面冗余机械臂碰撞检测与避障[J]. 机械工程学报, 2023, 59(1): 113-122.
[5]	姜武华, 辛鑫, 陈无畏, 崔卫卫. 基于信息融合的自动泊车系统多工况车位识别和决策规划[J]. 机械工程学报, 2021, 57(6): 131-141.
[6]	王明强, 王震坡, 张雷. 基于碰撞风险评估的智能汽车局部路径规划方法研究[J]. 机械工程学报, 2021, 57(10): 28-41.
[7]	于嘉鹏, 袁鹤翔, 杨永华, 张硕, 费强. 基于自适应天牛须算法的航空发动机管路布局优化[J]. 机械工程学报, 2020, 56(20): 174-184.
[8]	万俊, 姚佳烽, 余亮, 张良安, 吴洪涛. 基于伪距离的冗余机器人避障算法[J]. 机械工程学报, 2020, 56(17): 59-70.
[9]	王学武, 汤彬, 顾幸生. 焊接机器人避障策略研究[J]. 机械工程学报, 2019, 55(17): 77-84.
[10]	闫毅平,崔凯楠,袁懿,张玥红. 误差消除型里程计定位方法的分析与研究[J]. 电气工程学报, 2018, 13(6): 20-27.
[11]	王俊刚, 汤磊, 谷国迎, 朱向阳. 超冗余度机械臂跟随末端轨迹运动算法及其性能分析[J]. 机械工程学报, 2018, 54(3): 18-25.
[12]	张驰, 尚伟伟, 丛爽, 刘宜. 机器人平滑抓取移动物体的运动规划方法[J]. 机械工程学报, 2018, 54(19): 10-17.
[13]	杨利坡, 于华鑫, 张永顺, 刘宏民. 冷轧带钢虚拟仪器板形测控系统及其应用[J]. 机械工程学报, 2018, 54(14): 1-7.
[14]	张军. 电压型PWM整流器控制现状及发展趋势分析[J]. 电气工程学报, 2018, 13(10): 29-34.
[15]	王伯荣,丁新平,王天兵,苑红. 集成耦合电感升压–反激变换器的建模及控制研究[J]. 电气工程学报, 2015, 10(6): 33-40.

基于主从任务转化的闭环控制避障算法^*

Closed Loop Control Algorithm for Obstacle Avoidance Based on the Transformation of Master and Slave Tasks

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价