考虑航天器本体姿态运动的机械臂轨迹规划方法

摘要

本发明公开的考虑航天器本体姿态运动的机械臂轨迹规划方法，属于多体系统轨迹规划领域。本发明具体实现方法如下：首先在航天器初始状态下，通过五次多项式路径规划方法确定机械臂末端的位置和姿态指向的变化轨迹；根据航天器中心体姿态运动的规划，求取航天器本体坐标系下原期望位置与指向由于中心体姿态运动而产生的变化量，以此对机械臂的运动规划进行补偿；将机械臂末端的原轨迹规划与补偿规划对应求和，记为最终机械臂末端点轨迹，通过运动学伪逆算法对机械臂各关节角的运动轨迹进行规划，进而实现考虑航天器本体姿态运动的机械臂轨迹规划；本发明具有减轻星载计算机实时计算压力，提高轨迹规划效率等优点。