A Weighted Generalized Inverse Obstacle Avoidance Algorithm for Redundant Manipulator
-
摘要: 针对冗余机械臂末端轨迹跟踪与避障运动冲突的情况,提出一种基于加权广义逆的避障方法。该方法对机械臂与障碍物之间危险程度评估的评价函数-危险场进行改进,将危险程度评估得到的危险场的值,反馈给修改后的冗余机械臂闭环逆运动学算法,以实现避障,同时对雅可比矩阵和梯度项加权处理来避关节极限。为保证避障效率,对闭环控制参数进行优化设计。根据危险场的值与预先设定的阈值之间的大小关系,机械臂在避障过程中具有任务中断和恢复能力。最后利用Robotics Toolbox for MATLAB工具箱进行数值仿真,验证提出方法的有效性。Abstract: To resolve the conflict between the end trajectory tracking and the obstacle avoidance of a redundant manipulator, a weighted generalized inverse obstacle avoidance algorithm was presented. Its evaluation function called danger field was improved. By weighting the Jacobian matrix and gradient and feeding back the value of the danger field to an improved closed-loop inverse kinematics (CLIK) algorithm, the obstacle avoidance algorithm can avoid joint limits and obstacles. In order to enhance avoidance efficiency, the closed-loop control parameter was designed. In the process of obstacle avoidance, the manipulator can, in advance, cope with task suspension and resumption according to the relationship between value of danger field and threshold set. The numerical simulations results prove that the proposed algorithm is effective by means of Robotics Toolbox for MATLAB.
-
Key words:
- redundant manipulator /
- danger field /
- weighted least-norm solution /
- obstacle avoidance /
- joint limit
-
[1] 王鹏程,沈惠平,孟庆梅,等.一种冗余自由度机械臂逆运动学解析算法[J].机械科学与技术,2016,35(5):706-710 Wang P C, Shen H P, Meng Q M, et al. An analytical algorithm of inverse kinematics for manipulator with redundancy[J]. Mechanical Science and Technology for Aerospace Engineering, 2016,35(5):706-710(in Chinese) [2] 祖迪,吴镇炜,谈大龙.一种冗余机器人逆运动学求解的有效方法[J].机械工程学报,2005,41(6):71-75 Zu D, Wu Z W, Tan D L. Efficient inverse kinematic solution for redundant manipulators[J]. Chinese Journal of Mechanical Engineering, 2005,41(6):71-75(in Chinese) [3] 廖柏林,杨喜,梁平元.冗余机械臂优化控制新方法[J].计算机工程与应用,2013,49(14):236-240 Liao B L, Yang X, Liang P Y. New optimization control scheme for redundant robot manipulators[J]. Computer Engineering and Applications, 2013,49(14):236-240(in Chinese) [4] 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 [5] Chan T F, Dubey R V. A weighted least-norm solution based scheme for avoiding joint limits for redundant joint manipulators[C]//Proceedings of 1993 IEEE International Conference on Robotics and Automation. Atlanta, GA, USA:IEEE, 1993:395-402 [6] 申浩宇,吴洪涛,陈柏,等.基于主从任务转化的冗余度机器人避障算法[J].机器人,2014,36(4):425-429 Shen H Y, Wu H T, Chen B, et al. Obstacle avoidance algorithm for redundant robots based on transition between the primary and secondary tasks[J]. Robot, 2014,36(4):425-429(in Chinese) [7] Khatib O. Real-time obstacle avoidance for manipulators and mobile robots[J]. The International Journal of Robotics Research, 1986,5(1):90-98 [8] Lacevic B, Rocco P. Kinetostatic danger Field-a novel safety assessment for human-robot interaction[C]//Proceedings of 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems. Taipei, Taiwan:IEEE, 2010:2169-2174 [9] Siciliano B, Sciavicco L, Villani L, et al. Robotics:modelling, planning and control[M]. London:Springer-Verlag, 2009 [10] 陆震,何广平.冗余自由度机器人原理及应用[M].北京:机械工业出版社,2007:50-53 Lu Z, He G P. Principle and application of redundant robots[M]. Beijing:China Machine Press, 2007:50-53(in Chinese) [11] Lacevic B, Rocco P, Zanchettin A M. Safety assessment and control of robotic manipulators using Danger Field[J]. IEEE Transactions on Robotics, 2013,29(5):1257-1270
点击查看大图
计量
- 文章访问数: 457
- HTML全文浏览量: 33
- PDF下载量: 126
- 被引次数: 0