航空学报 > 2022, Vol. 43 Issue (2): 325398-325398   doi: 10.7527/S1000-6893.2021.25398

空间双臂机器人抓捕非合作目标后的协调稳定控制

夏鹏程1,2, 罗建军1,2, 王明明1,2, 谭龙玉3   

  1. 1. 西北工业大学 深圳研究院, 深圳 518057;
    2. 西北工业大学 航天动力学国家重点实验室, 西安 710072;
    3. 上海航天控制技术研究所, 上海 201109
  • 收稿日期:2021-02-08 修回日期:2021-03-15 发布日期:2021-06-29
  • 通讯作者: 王明明 E-mail:mwang@nwpu.edu.cn
  • 基金资助:
    深圳市科技研发资金(JCYJ20190806154412671);国家自然科学基金(12072269,61973256,61690211);上海市青年科技英才扬帆计划(18YF1410200)

Coordinated stabilization control for dual-arm space robot capturing a non-cooperative target

XIA Pengcheng1,2, LUO Jianjun1,2, WANG Mingming1,2, TAN Longyu3   

  1. 1. Research & Development Institute of Northwestern Polytechnical University in Shenzhen, Shenzhen 518057, China;
    2. School of Astronautics, National Key Laboratory of Aerospace Flight Dynamics, Northwestern Polytechnical University, Xi'an 710072, China;
    3. Shanghai Aerospace Control Technology Institute, Shanghai 201109, China
  • Received:2021-02-08 Revised:2021-03-15 Published:2021-06-29
  • Supported by:
    Science, Technology and Innovation Commission of Shenzhen Municipality (JCYJ20190806154412671); National Natural Science Foundation of China (12072269, 61973256, 61690211); Shanghai Sailing Program(18YF1410200)

摘要: 由于非合作目标惯性参数的不确定性以及双臂操控目标的拉扯/挤压作用,空间双臂机器人稳定非合作目标的过程中机械臂末端与目标可能产生过大的接触力与力矩,从而可能对目标造成损伤。针对该问题,提出了一种协调稳定控制方法,通过协调双臂期望运动实现双臂末端与目标交互的柔顺,降低稳定过程中产生的接触力与力矩。首先,利用目标惯性参数的估值规划稳定运动轨迹;然后,利用柔顺等式建立调整稳定运动轨迹的内外双环,分别针对目标惯性参数不确定性的影响和双臂末端对目标的拉扯/挤压,对期望运动进行调整,得到实现机械臂末端与目标接触柔顺的安全稳定运动轨迹;最后,基于障碍李雅普诺夫函数设计控制性能可约束的跟踪控制器,对双臂的运动进行协调控制,实现机械臂末端与目标交互柔顺的安全稳定控制。仿真算例验证了本文协调稳定控制方法的有效性。

关键词: 非合作目标, 空间双臂机器人, 柔顺控制, 协调控制, 障碍李雅普诺夫函数

Abstract: Due to the uncertain target inertia parameters and the internal stress at grasping points, excessive contact wrenches may be applied to the target at grasping points during the stabilization of the non-cooperative target, and therefore the safety of the dual-arm space robot end-effectors cannot be guaranteed. To solve this problem, a coordinated stabilization control scheme is proposed. The desired trajectory of the dual-arm space robot is coordinately adjusted to achieve compliant interactions at grasping points, where the contact wrenches can be reduced during the stabilization process. To realize this coordinated stabilization control, firstly, a desired trajectory is planned with inaccurate parameters of the target. Then, to achieve compliant interactions, a safe stabilization trajectory is obtained by adjusting the desired trajectory with the help of a dual loop structure constructed by compliant equations considering the influences of the uncertain inertia parameters and the internal stress respectively. Finally, to achieve the safe stabilization with compliant interactions, a barrier Lyapunov function based tracking controller is developed to coordinately control the dual-arm space robot, where the control performance can be restrained. The effectiveness and feasibility of the proposed coordinated stabilization control scheme are validated via digital simulations.

Key words: non-cooperative target, dual-arm space robot, compliant control, coordinated control, barrier Lyapunov function

中图分类号: