基于可操作度优化的冗余机械臂逆运动学求解方法

doi:10.3901/JME.2024.07.022

机械工程学报 ›› 2024, Vol. 60 ›› Issue (7): 22-33.doi: 10.3901/JME.2024.07.022

扫码分享

基于可操作度优化的冗余机械臂逆运动学求解方法

杨晓航, 赵智远, 李云涛, 徐梓淳, 赵京东

哈尔滨工业大学机器人技术与系统国家重点实验室哈尔滨 150001

收稿日期:2023-04-13 修回日期:2023-11-15 出版日期:2024-04-05 发布日期:2024-06-07
通讯作者: 赵京东，男，1977年出生，博士，教授，博士研究生导师。主要研究方向为空间机器人技术、生机电一体化技术。E-mail：zhaojingdong@hit.edu.cn
作者简介:杨晓航，男，1996年出生，博士研究生。主要研究方向为空间机械臂运动学与控制。E-mail：yxh9606@163.com
基金资助:
国家自然科学基金资助项目(92148203)。

Inverse Kinematics Solution of Redundant Manipulator Based on Manipulability Optimization

YANG Xiaohang, ZHAO Zhiyuan, LI Yuntao, XU Zichun, ZHAO Jingdong

State Key Laboratory of Robotics and System, Harbin Institute of Technology, Harbin 150001

Received:2023-04-13 Revised:2023-11-15 Online:2024-04-05 Published:2024-06-07

摘要/Abstract

摘要： 在运动规划和控制中提升机械臂的灵活性和避免奇异至关重要，一种有效的方法是使可操作度指标最大化。然而可操作度指标是关节角度的非凸函数，优化该指标是一个巨大的挑战，为此提出一种加速度级可操作度最大化(ALMM)方法。首先，通过一种新的多层次同时最小化方案将位置级别的非线性优化问题转化到速度级别和加速度级别，在加速度水平重构最大化可操作度问题。其次，引入最小化速度指标保证系统的稳定性，并使关节角速度维持在较低水平。然后，结合关节的物理极限，将上述问题表述为标准的二次规划(QP)形式进行求解。以SSRMS构型冗余空间机械臂为例进行仿真验证，实验结果表明ALMM方法可以在完成轨迹跟踪任务的同时实现可操作度优化，对比实验证明ALMM方法的有效性和优越性。

关键词: 冗余机械臂, 逆运动学, 可操作度, 二次规划

Abstract: It is significant to improve flexibility of the manipulator and avoid singularity in the motion planning and control. An effective method is to maximize the manipulability index. However, the manipulability index is a non-convex function of joint angle, and optimizing this index is a great challenge. Therefore, an acceleration level manipulability maximization (ALMM) method is proposed. Firstly, the nonlinear optimization problem in position level is transformed to velocity level and acceleration level by a new multi-level simultaneous minimization scheme, and the problem of maximization manipulability is reconstructed in acceleration level. Secondly, the minimum velocity index is introduced to ensure the stability of the system and keep the joint angular velocity at a low level. Then, combined with the physical limits of the joint, the above problem is formulated as a standard quadratic programming (QP) problem to solve. Taking SSRMS configuration redundant space manipulator as an example, the simulation results show that the ALMM method can achieve the optimization of manipulability while completing the trajectory tracking task, and the comparative experiment proves the effectiveness and superiority of the ALMM method.

Key words: redundant manipulator, inverse kinematics, manipulability, quadratic programming (QP)

中图分类号:

TP242

杨晓航, 赵智远, 李云涛, 徐梓淳, 赵京东. 基于可操作度优化的冗余机械臂逆运动学求解方法[J]. 机械工程学报, 2024, 60(7): 22-33.

YANG Xiaohang, ZHAO Zhiyuan, LI Yuntao, XU Zichun, ZHAO Jingdong. Inverse Kinematics Solution of Redundant Manipulator Based on Manipulability Optimization[J]. Journal of Mechanical Engineering, 2024, 60(7): 22-33.

参考文献

[1] 周健,郑联语,樊伟,等. 工业机器人定位误差在线自适应补偿[J]. 机械工程学报,2023,59(5):53-66. ZHOU Jian,ZHENG Lianyu,FAN Wei,et al. Adaptive online compensation for industrial robot positioning error[J]. Journal of Mechanical Engineering,2023,59(5):53-66.
[2] LI Junyang,LI Xiaojian,LUO Tao,et al. Development of a magnetic microrobot for carrying and delivering targeted cells[J]. Science Robotics,2018,3(19):eaat8829.
[3] GAO Yang,CHIEN S. Review on space robotics:Toward top-level science through space exploration[J]. Science Robotics,2017,2(7):eaan5074.
[4] 陶永,刘海涛,王田苗,等. 我国服务机器人技术研究进展与产业化发展趋势[J]. 机械工程学报,2022,58(18):56-74. TAO Yong,LIU Haitao,WANG Tianmiao,et al. Research progress and industrialization development trend of Chinese service robot[J]. Journal of Mechanical Engineering,2022,58(18):56-74.
[5] NANOS K,PAPADOPOULOS E. Avoiding dynamic singularities in Cartesian motions of free-floating manipulators[J]. IEEE Transactions on Aerospace and Electronic Systems,2015,51(3):2305-2318.
[6] 万俊,姚佳烽,余亮,等. 基于伪距离的冗余机器人避障算法[J]. 机械工程学报,2020,56(17):59-70. WAN Jun,YAO Jiafeng,YU Liang,et al. Obstacle avoidance algorithm for redundant manipulators based on pseudo-distance method[J]. Journal of Mechanical Engineering,2020,56(17):59-70.
[7] ZHAO Jingdong,YANG Xiaohang,ZHAO Zhiyuan,et al. A trajectory planning method for load-carrying capacity improvement of redundant space manipulator with large external force[C]//Intelligent Robotics and Applications:14th International Conference,ICIRA 2021,Yantai,China,October 22-25,2021,Proceedings,Part IV 14. Springer International Publishing,2021:371-382.
[8] LEE S,BEJCZY A. Redundant arm kinematic control based on parameterization[C]//Proceedings. 1991 IEEE International Conference on Robotics and Automation,IEEE Computer Society,1991:458-465.
[9] 徐文福,张金涛,闫磊,等. 偏置式冗余空间机械臂逆运动学求解的参数化方法[J]. 宇航学报,2015,36(1):33-39. XU Wenfu,ZHANG Jintao,YAN Lei,et al. Parameterized inverse kinematics resolution method for a redundant space manipulator with link offset[J]. Journal of Astronautics,2015,36(1):33-39.
[10] SHIMIZU M,KAKUYA H,YOON W,et al. Analytical inverse kinematic computation for 7-DOF redundant manipulators with joint limits and its application to redundancy resolution[J]. IEEE Transactions on Robotics,2008,24(5):1131-1142.
[11] SICILIANO B,OUSSAMA K. Springer handbook of robotics[M]. Berlin:Springer,2016
[12] JIN Minghe,ZHUO Cheng,LIU Yechao,et al. Analysis of reaction torque-based control of a redundant free-floating space robot[J]. Chinese Journal of Aeronautics,2017,30(5):1765-1776.
[13] 廖柏林,梁平元,杨喜. 基于伪逆的冗余机械臂运动控制的优化方案[J]. 信息与控制,2013,42(5):645-651. LIAO Bolin,LIANG Pingyuan,YANG Xi. Pseudoinverse-based optimization scheme for motion control of redundant robot manipulators[J]. Information and Control,2013,42(5):645-651.
[14] WOOLFREY J,LU Wenjie,LIU Dikai. A control method for joint torque minimization of redundant manipulators handling large external forces[J]. Journal of Intelligent & Robotic Systems,2019,96:3-16.
[15] QIU Binbin,LI Xiaodong,GUO Jinjin,et al. New Jerk-level configuration adjustment schemes applied to constrained redundant robots[J]. IEEE Transactions on Industrial Informatics,2021,18(4):2528-2538.
[16] ZHANG Zhijun,CHEN Siyuan,ZHU Xupeng,et al. Two hybrid end-effector posture-maintaining and obstacle-limits avoidance schemes for redundant robot manipulators[J]. IEEE Transactions on Industrial Informatics,2019,16(2):754-763.
[17] YOSHIKAWA T. Analysis and control of robot manipulators with redundancy[J]. The first Int. Symp. of Robotics Research,1984(1):735-747.
[18] YOSHIKAWA T. Manipulability of robotic mechanisms[J]. The international journal of Robotics Research,1985,4(2):3-9.
[19] MARANI G,KIM J,YUH J,et al. A real-time approach for singularity avoidance in resolved motion rate control of robotic manipulators[C]//Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No. 02CH37292),IEEE,2002:1973-1978.
[20] ZHANG Yunong,YAN Xiaogang,CHEN Dechao,et al. QP-based refined manipulability-maximizing scheme for coordinated motion planning and control of physically constrained wheeled mobile redundant manipulators[J]. Nonlinear Dynamics,2016,85:245-261.
[21] LEORO J,HSIAO T. Motion planning of nonholonomic mobile manipulators with manipulability maximization considering joints physical constraints and self-collision avoidance[J]. Applied Sciences,2021,11(14):6509.
[22] DUFOUR K,SULEIMAN W. On integrating manipulability index into inverse kinematics solver[C]//2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS),IEEE,2017:6967-6972.
[23] DUFOUR K,SULEIMAN W. On maximizing manipulability index while solving a kinematics task[J]. Journal of Intelligent & Robotic Systems,2020,100:3-13.
[24] XU Ruonan,LUO Jianjun,WANG Mingming. Manipulability optimization for coordinated motion control of multi-arm space robots[J]. IFAC-PapersOnLine,2020,53(2):9853-9858.
[25] JIN Long,LI Shuai,LA H,et al. Manipulability optimization of redundant manipulators using dynamic neural networks[J]. IEEE Transactions on Industrial Electronics,2017,64(6):4710-4720.
[26] HU Yingbai,SU Hang,CHEN Guang,et al. Hierarchical optimization control of redundant manipulator for robot-assisted minimally invasive surgery[C]//2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS),IEEE,2020:2929-2934.
[27] ZHANG Jiazheng,JIN Long,CHENG Long. RNN for perturbed manipulability optimization of manipulators based on a distributed scheme:A game-theoretic perspective[J]. IEEE Transactions on Neural Networks and Learning Systems,2020,31(12):5116-5126.
[28] WANG Liuping. Model predictive control system design and implementation using MATLAB[M]. London:Springer Science & Business Media,2009.
[29] ANGLADA J M,BOFILL J M. How good is a Broyden-Fletcher-Goldfarb-Shanno like update hessian formula to locate transition structures? Specific reformulation of Broyden-Fletcher-Goldfarb-Shanno for optimizing saddle points[J]. Journal of Computational Chemistry,1998,19(3):349-362.

基于可操作度优化的冗余机械臂逆运动学求解方法

Inverse Kinematics Solution of Redundant Manipulator Based on Manipulability Optimization

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	李鸿濠, 卢志荣, 王晓明, 谭述君, 周文雅. 基于加速度表征目标函数的主动反射器最优动态变形控制[J]. 机械工程学报, 2024, 60(19): 32-39.
[2]	石建平, 徐永驰, 古训, 陈冬云. 面向冗余机械臂逆运动学问题的人工蜂群算法改进[J]. 机械工程学报, 2024, 60(15): 60-70.
[3]	赵京, 周振勇, 张自强. 冗余度机械臂的自运动流形计算及关节轨迹规划[J]. 机械工程学报, 2023, 59(5): 77-88.
[4]	金贤球, 雷涛, 闵志豪, 宋丽娜, 张星雨, 张晓斌. 分布式电推进飞机能量优化动态管理技术研究^*[J]. 电气工程学报, 2023, 18(3): 315-331.
[5]	张英, 冯征征, 李剑, 魏世民, 廖启征. 基于CGA的7自由度冗余机械臂逆运动学臂型角参数化方法[J]. 机械工程学报, 2023, 59(23): 68-75.
[6]	吴志伟, 王博文, 闫磊, 徐文福. 绳驱7自由度仿人机械臂设计及其刚度建模与性能分析[J]. 机械工程学报, 2023, 59(17): 17-32.
[7]	钟献有, 王鹤霖, 刘成菊, 陈启军. 基于最小运动变换的臂角参数化冗余机械臂逆运动学求解方法[J]. 机械工程学报, 2023, 59(15): 40-49.
[8]	陈菲菲, 居鹤华, 刘潇晗. 一种高精度求解多轴机器人逆运动学的方法[J]. 机械工程学报, 2023, 59(1): 50-58.
[9]	张建华, 任宝珍, 赵岩, 徐永强, 刘璇. 基于二分试探的平面冗余机械臂碰撞检测与避障[J]. 机械工程学报, 2023, 59(1): 113-122.
[10]	张俊, 鲍雨菲, 方汉良, 宋亚庆. 新型5轴混联加工单元的后置处理算法[J]. 机械工程学报, 2023, 59(1): 298-308.
[11]	陈菲菲, 居鹤华, 余萌, 康杰, 孙帅. 一种分析四元数及其在6R机械臂逆运动学中的应用[J]. 机械工程学报, 2022, 58(9): 31-40.
[12]	赵智远, 赵京东, 赵亮亮, 杨晓航, 刘宏. 求解SSRMS构型空间机械臂逆运动学的方法[J]. 机械工程学报, 2022, 58(3): 21-35.
[13]	张英, 黄起能, 廖启征, 杨旭, 魏世民. 空间6R串联机械手逆运动学分析的新方法研究[J]. 机械工程学报, 2022, 58(19): 1-11.
[14]	罗任峰, 王旭浩, 张大卫, 张培伦, 赵臣. 一种6R非球型手腕机器人逆运动学算法研究[J]. 机械工程学报, 2022, 58(19): 68-76.
[15]	白明, 张明路, 张赫, 庞淋峻, 赵杰. 面向高精度显微手术机器人的RCM机械臂误差补偿方法[J]. 机械工程学报, 2022, 58(18): 170-180.