在轨服务航天器多冗余机械臂协同控制方法
摘要:
本发明提出在轨服务航天器多冗余机械臂协同控制方法,所述方法首先针对搭载4条7自由度机械臂的多臂航天器进行运动学与动力学建模,并进行工作空间分析,以确保目标轨迹始终处于机械臂可达范围内;随后,在航天器展开阶段,当目标臂构型为单臂或对位双臂时,通过非目标机械臂的运动抵消目标机械臂运动对基座位姿的影响以节约燃料与工质;在任务执行阶段,通过雅克比矩阵的伪逆可完成末端空间到关节空间的映射,并通过迭代逐步完成对理想轨迹的逼近,最终得到符合要求的关节解算结果;且通过机械臂与基座的协同,防止机械臂陷入奇异状态,保证其可操作性;最后,在任务完成后的回收阶段采用关节空间的控制,确保系统能够较为精确地回归初始构型。
公开/授权文献
0/0