一种空间机器人在轨抓捕过程的柔顺与协调控制方法

摘要

本发明公开了一种空间机器人在轨抓捕过程的柔顺与协调控制方法，包括：根据动力学和运动学方程，建立面向控制的空间机器人模型；根据面向控制的空间机器人模型，建立机械臂柔顺抓捕控制律；确定基于基座喷气装置的基座位姿控制律；根据机械臂柔顺抓捕控制律，建立机械臂柔顺控制回路；根据所述基座位姿控制律和PSR伪速率脉冲调制器，建立基座位姿控制回路；将所述机械臂柔顺控制回路和基座位姿控制回路计算得到的控制量分别作为空间机器人系统的机械臂和基座喷气装置的控制输入；同时，将基座的控制力作为前馈项，输入给机械臂控制律，以补偿基座控制对机械臂末端柔顺控制的干扰。本发明在实现对目标的稳定抓捕的同时保证了基座的稳定性。