吉林大学学报(工学版) ›› 2025, Vol. 55 ›› Issue (11): 3507-3520.doi: 10.13229/j.cnki.jdxbgxb.20240133

• 车辆工程·机械工程 • 上一篇    

考虑任务优先级的冗余轮式移动机械臂位形优化

邢宏军1(),徐宇哲1,周忠歌1,刘彦清1,丁亮2,陈金宝1   

  1. 1.南京航空航天大学 宇航空间机构全国重点实验室,南京 210016
    2.哈尔滨工业大学 机器人技术与系统全国重点实验室,哈尔滨 150080
  • 收稿日期:2024-02-13 出版日期:2025-11-01 发布日期:2026-02-03
  • 作者简介:邢宏军(1992-),男,副研究员,博士. 研究方向:移动机械臂操控.E-mail: xinghj@nuaa.edu.cn
  • 基金资助:
    国家自然科学基金项目(52405025);国家自然科学基金项目(U21B6002);江苏省自然科学基金项目(BK20230889);机器人技术与系统全国重点实验室开放基金项目(SKLRS-2023-KF-04)

Configuration optimization of redundant wheeled mobile manipulators considering task priority

Hong-jun XING1(),Yu-zhe XU1,Zhong-ge ZHOU1,Yan-qing LIU1,Liang DING2,Jin-bao CHEN1   

  1. 1.National Key Laboratory of Aerospace Mechanism,Nanjing University of Aeronautics and Astronautics,Nanjing 210016,China
    2.State Key Laboratory of Robotics and System,Harbin Institute of Technology,Harbin 150080,China
  • Received:2024-02-13 Online:2025-11-01 Published:2026-02-03

摘要:

针对轮式移动机械臂在复杂环境中灵巧作业的需求,开展了面向冗余轮式移动机械臂(WMM)考虑任务优先级的位形优化研究。为实现该目标,首先,分别建立轮式移动平台和多自由度机械臂运动学模型,并在此基础上构建WMM整机运动学模型;然后,基于任务优先级框架设计WMM逆运动学求解方法,并开展面向车-臂双轨迹跟踪、避奇异位形、避关节极限等多任务目标的WMM位形优化研究;最后,结合SolidWorks、Matlab/Simulink软件进行WMM复杂工况仿真,仿真结果验证了该方法的有效性。

关键词: 轮式移动机械臂, 任务优先级, 逆运动学, 位形优化, 轨迹跟踪

Abstract:

To facilitate the dexterous operation of a mobile manipulator in a complex environment, we conducted configuration optimization based on task priority for a redundant wheeled mobile manipulator (WMM). To achieve this objective, we initially established the kinematic models for the wheeled mobile base and the multi-degree-of-freedom manipulator separately. Subsequently, we constructed the kinematic model for the WMM system based on these foundations. Subsequently, we designed an inverse kinematic model for the WMM using the task priority framework. Configuration optimization was then performed for various targets, including vehicle-arm dual trajectory tracking, singularity avoidance, and joint limit avoidance. Finally, the performance of the WMM in a complex environment is simulated using SolidWorks and Matlab/Simulink. The simulation results validate the effectiveness of the proposed method.

Key words: wheeled mobile manipulator, task priority, inverse kinematics, configuration optimization, trajectory tracking

中图分类号: 

  • TP242

图1

双轮非完整约束移动机械臂"

图2

非完整约束移动平台模型"

图3

Kinova Gen 3机械臂结构图"

表1

Kinova Gen 3机械臂D-H参数表"

杆件序号连杆扭转角/(°)连杆长度/m连杆偏距/m关节角/(°)
1000.284 8θ1
2π/200.011 8θ2
3-π/200.420 8θ3
4π/200.012 8θ4
5-π/200.314 3θ5
6π/200θ6
7-π/200θ7
EE000.237 40

表2

Kinova Gen 3机械臂关节运动范围"

运动范围θ1θ2θ3θ4θ5θ6θ7
上限θ /(°)+∞+126+∞+147+∞+117+∞
下限θ/(°)-∞-126-∞-147-∞-117-∞

图4

D-H法连杆参数的定义"

图5

面向圆形轨迹跟踪主任务仿真结果"

图6

面向“8”字形轨迹跟踪主任务仿真结果"

图7

WMM末端轨迹跟踪中的机械臂关节运动"

图8

“双轨迹跟踪”仿真结果"

图9

“仅末端跟踪”仿真结果"

图10

主从复合轨迹跟踪中的机械臂关节运动"

图11

避机械臂关节极限仿真结果"

图12

避机械臂奇异位形优化结果"

图13

WMM可视化仿真平台"

图14

WMM任务场景设置"

图15

可视化仿真中的轨迹设定"

图16

WMM可视化运动时序叠加图"

表3

可视化仿真任务时序表"

任务序号时刻t/sWMM的状态
10WMM以初始姿态位于起点处
289.8WMM完成目标物体的抓取
3153.1WMM通过房门:前轮轴线与墙中性面重合
4213.8WMM完成目标物体的放置
5319.0WMM通过侧门:前轮轴线与墙中性面重合
6350.0WMM运动至任务终点处

图17

WMM运动轨迹"

图18

WMM运动误差"

图19

机械臂关节和移动平台车轮运动轨迹"

图20

WMM系统性能优化仿真结果"

[1] Xing H, Torabi A, Ding L, et al. An admittance-controlled wheeled mobile manipulator for mobility assistance: human–robot interaction estimation and redundancy resolution for enhanced force exertion ability[J]. Mechatronics, 2021, 74: No.102497.
[2] 罗欣, 丁晓军. 地面移动作业机器人运动规划与控制研究综述[J]. 哈尔滨工业大学学报, 2021, 53(1): 1-15.
Luo Xin, Ding Xiao-jun. Research and prospective on motion planning and control of ground mobile manipulators[J]. Journal of Harbin Institute of Technology, 2021, 53(1): 1-15.
[3] 邢宏军. 面向救灾任务的轮式移动作业机器人柔顺控制及遥操作[D]. 哈尔滨: 哈尔滨工业大学机电工程学院, 2022.
Xing Hong-jun. Compliance control and teleoperation of wheeled mobile manipulators for disaster rescue tasks[D]. Harbin: School of Mechatronics Engineering, Harbin Institute of Technology, 2022.
[4] Picard G, Lenain R, Mezouar Y, et al. Multi-trajectory approach for a generic coordination paradigm of wheeled mobile manipulators[J]. IEEE Robotics and Automation Letters, 2022, 7(2): 2329-2336.
[5] Teka B, Dutta A. Modeling and simulation of cooperative transport of an object by two mobile manipulators on an uneven terrain using KSOM network[J]. International Journal of Modelling and Simulation, 2021, 41(1): 39-51.
[6] Chung G B, Yi B, Lim D J, et al. An efficient dynamic modeling methodology for general type of hybrid robotic systems[C]∥IEEE International Conference on Robotics and Automation, New Orleans,USA, 2004: 1795-1802.
[7] 陈杰, 莫玮. 履带式移动机械臂的自适应模糊滑模控制[J]. 吉林大学学报:工学版, 2015, 45(3): 892-898.
Chen Jie, Mo Wei. Adaptive fuzzy sliding mode control for crawler-type mobile manipulators[J]. Journal of Jilin University (Engineering and Technology Edition), 2015, 45(3): 892-898.
[8] Seraji H. A unified approach to motion control of mobile manipulators[J]. The International Journal of Robotics Research, 1998, 17(2): 107-118.
[9] 陈良港, 张方, 张建光, 等. 移动机械臂运动学建模与控制[J]. 国外电子测量技术, 2022, 41(1): 35-40.
Chen Liang-gang, Zhang Fang, Zhang Jian-guang, et al. Kinematic molding and control for mobile manipulator[J]. Foreign Electronic Measurement Technology, 2022, 41(1): 35-40.
[10] De Luca A, Oriolo G, Giordano P R. Kinematic modeling and redundancy resolution for nonholonomic mobile manipulators[C]∥IEEE International Conference on Robotics and Automation, Orlando,USA, 2006: 1867-1873.
[11] De Luca A, Oriolo G, Giordano P R. Kinematic control of nonholonomic mobile manipulators in the presence of steering wheels[C]∥IEEE International Conference on Robotics and Automation, Anchorage, USA, 2010: 1792-1798.
[12] Chen F, Selvaggio M, Caldwell D G. Dexterous grasping by manipulability selection for mobile manipulator with visual guidance[J]. IEEE Transactions on Industrial Informatics, 2019, 15(2): 1202-1210.
[13] Li M, Yang Z, Zha F, et al. Design and analysis of a whole-body controller for a velocity controlled robot mobile manipulator[J]. Science China Information Sciences, 2020, 63(7): 1-15.
[14] Xing H, Ding L, Gao H, et al. Dual-user haptic teleoperation of complementary motions of a redundant wheeled mobile manipulator considering task priority[J]. IEEE Transactions on Systems, Man, and Cybernetics: Systems, 2022, 52(10): 6283-6295.
[15] Jia Y, Xi N, Cheng Y, et al. Coordinated motion control of a nonholonomic mobile manipulator for accurate motion tracking[C]∥IEEE/RSJ International Conference on Intelligent Robots and Systems, Chicago, USA, 2014: 1635-1640.
[16] Xing H, Torabi A, Ding L, et al. Enhancement of force exertion capability of a mobile manipulator by kinematic reconfiguration[J]. IEEE Robotics and Automation Letters, 2020, 5(4): 5842-5849.
[17] 张铮, 朱齐丹, 吕晓龙, 等. 冗余机械臂运动学逆解的求解优化方法[J]. 吉林大学学报: 工学版, 2023, 53(12): 3379-3387.
Zhang Zheng, Zhu Qi-dan, Xiao-long Lyu, et al. Optimized method for solving inverse kinematics of redundant manipulator[J]. Journal of Jilin University (Engineering and Technology Edition), 2023, 53(12): 3379-3387.
[18] 武毅, 胥超, 刘力源, 等. 基于多任务转换的冗余度机器人控制算法[J]. 机械工程学报, 2023, 59(15): 83-93.
Wu Yi, Xu Chao, Liu Li-yuan, et al. Redundant robot control algorithm based on multi-task transformation[J]. Journal of Mechanical Engineering, 2023, 59(15): 83-93.
[19] Farelo F, Alqasemi R, Dubey R. Optimized dual-trajectory tracking control of a 9-DoF WMRA system for ADL tasks[C]∥IEEE International Conference on Robotics and Automation, Anchorag, USA, 2010: 1786-1791.
[20] Mashali M, Alqasemi R, Dubey R. Task priority based dual-trajectory control for redundant mobile manipulators[C]∥IEEE International Conference on Robotics and Biomimetics, Bali, Indonesia, 2014: 1457-1462.
[21] 齐志刚, 黄攀峰, 刘正雄, 等. 空间冗余机械臂路径规划方法研究[J]. 自动化学报, 2019, 45(6): 1103-1110.
Qi Zhi-gang, Huang Pan-feng, Liu Zheng-xiong, et al. Research on path planning method of spatial redundant manipulator[J]. Acta Automatica Sinica, 2019, 45(6): 1103-1110.
[22] 李洋, 冯适意, 朱德良, 等. 面向移乘护理的冗余双臂机器人行为安全控制[J]. 机械工程学报, 2023, 59(9): 76-89.
Li Yang, Feng Shi-yi, Zhu De-liang, et al. Safety control of a redundant dual-arm robot for transfer-care task[J]. Journal of Mechanical Engineering, 2023, 59(9): 76-89.
[23] Lian J, Yu W, Xiao K, et al. Cubic spline interpolation-based robot path planning using a chaotic adaptive particle swarm optimization algorithm[J]. Mathematical Problems in Engineering, 2020, 2: 1-20.
[1] 张宇飞,王丽敏,赵建平,贾智尧,李明洋. 基于中心选择大逃杀优化算法的机器人逆运动学求解[J]. 吉林大学学报(工学版), 2025, 55(8): 2703-2710.
[2] 胡云峰,李佳敏,唐志国. 移动装弹机械臂的逆运动学多种群灰狼算法求解方法[J]. 吉林大学学报(工学版), 2025, 55(4): 1443-1452.
[3] 沈鹏,李小华,刘辉. 具有输入缓冲的机械臂预设定有限时间跟踪控制[J]. 吉林大学学报(工学版), 2025, 55(1): 63-73.
[4] 田彦涛,庾文彦,季言实,谢波. 面向不同驾驶行为模型的共享控制器设计[J]. 吉林大学学报(工学版), 2024, 54(9): 2676-2686.
[5] 谢宪毅,王禹涵,金立生,赵鑫,郭柏苍,廖亚萍,周彬,李克强. 基于改变控制时域时间步长的智能车轨迹跟踪控制[J]. 吉林大学学报(工学版), 2024, 54(3): 620-630.
[6] 刘果,熊坚,杨秀建,何扬帆. 基于曲率增广的智能车辆轨迹跟踪控制[J]. 吉林大学学报(工学版), 2024, 54(12): 3717-3728.
[7] 侯胜杰,汪忠来,智鹏鹏,郑皓,徐璟. 考虑模型-环境不确定性的仿生飞行器轨迹跟踪控制[J]. 吉林大学学报(工学版), 2024, 54(12): 3699-3710.
[8] 王德军,张凯然,徐鹏,顾添骠,于文雅. 基于车辆执行驱动能力的复杂路况速度规划及控制[J]. 吉林大学学报(工学版), 2023, 53(3): 643-652.
[9] 张铮,朱齐丹,吕晓龙,樊星. 冗余机械臂运动学逆解的求解优化方法[J]. 吉林大学学报(工学版), 2023, 53(12): 3379-3387.
[10] 聂光明,谢波,田彦涛. 基于Frenet框架的协同自适应巡航控制算法设计[J]. 吉林大学学报(工学版), 2022, 52(7): 1687-1695.
[11] 陈吉清,蓝庆生,兰凤崇,刘照麟. 基于轮胎力预判与拟合的轨迹跟踪控制[J]. 吉林大学学报(工学版), 2020, 50(5): 1565-1573.
[12] 吴爱国,韩俊庆,董娜. 基于极局部模型的机械臂自适应滑模控制[J]. 吉林大学学报(工学版), 2020, 50(5): 1905-1912.
[13] 陈东良,臧睿,段鹏,赵伟鹏,翁旭涛,孙杨,唐艺鹏. 基于新月鱼尾推进理论的多连杆鱼骨仿生设计[J]. 吉林大学学报(工学版), 2019, 49(4): 1246-1257.
[14] 顾万里,王萍,胡云峰,蔡硕,陈虹. 具有H性能的轮式移动机器人非线性控制器设计[J]. 吉林大学学报(工学版), 2018, 48(6): 1811-1819.
[15] 叶锦华,李迪,叶峰. 轮式移动机器人的双强化学习自适应模糊控制[J]. 吉林大学学报(工学版), 2014, 44(3): 742-749.
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
No Suggested Reading articles found!