[发明专利]基于扩展雅克比矩阵的空间机器人星臂协调控制方法

摘要

基于扩展雅克比矩阵的空间机器人星臂协调控制方法，解决在轨工作的空间机械臂与基座卫星整体协同控制问题。包括计算空间机器人的运动学和动力学参数；建立基于扩展雅可比矩阵的空间机器人数学模型；设计空间机器人星臂协调控制器；对机械臂末端轨迹进行参数化；对机械臂轨迹进行优化；计算空间机器人单框架控制力矩陀螺系统的角速度指令。本发明不需要卫星根据姿态测量进行滞后的反馈控制，通过将臂星的耦合运动进行整体数学建模，根据输入的机械臂末端轨迹，直接计算出卫星需补偿机械臂运动的单框架控制力矩陀螺系统的角速度指令，实现臂星的整体协调控制；机械臂末端轨迹经过优化使卫星态控制系统补偿机械臂反作用力矩所消耗的能量较小。

主权项

基于扩展雅克比矩阵的空间机器人星臂协调控制方法，其特征在于它由以下步骤完成：步骤一、通过ProE建模计算出包括机械臂和基座卫星的空间机器人的运动学和动力学参数；步骤二、建立基于扩展雅克比矩阵的空间机器人整体数学模型；步骤三、利用Moore‑Penrose伪逆求解方法设计空间机器人星臂协调控制器；步骤四、空间机械臂末端轨迹参数化；步骤五、基于粒子群优化方法，根据空间机器人协调控制器得到的单框架控制力矩陀螺系统角动量的表达式构建优化目标函数，利用构建的优化目标函数对经过参数化的空间机械臂末端轨迹进行优化；步骤六、将空间机械臂优化轨迹数据输入给空间机器人星臂协调控制器，得到单框架控制力矩陀螺系统的角动量，利用得到的角动量计算出单框架控制力矩陀螺系统的角速度指令。