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

说明书

技术领域

本发明涉及一种空间机器人星臂协调控制方法。

背景技术

空间机器人执行空间任务时面临的一个实际问题是任何空间机械臂的运动都会改变载体卫星的位置和姿态，而载体卫星位置姿态的改变也会反过来影响空间机械臂的定位，同时也会放大空间机械臂末端操作器的定位误差，不利于空间机械臂的高精度控制。为了满足空间机器人工作过程中对地通信和对太阳能帆板朝向等条件的实际需要，往往要求机械臂运动的同时载体卫星的姿态应保持稳定。如今，随着空间在轨维护和深空探索等科学应用的开展，越来越需要空间机器人替代人类实现在轨操作。空间机械臂与基座卫星的整体协调控制是其在轨应用首要考虑的问题。

一些学者基于空间机械臂建模中的VM（Virtual Manipulator）方法，规划了一系列连续的螺旋空间机械臂轨迹，希望通过这种方式能够最小化空间机械臂运动时对载体卫星姿态的扰动，但是这样一来就使机械臂的运动方式受到了严重的限制，运动路线也很复杂，不利于直接完成空间任务。通过空间机器人结构上的改变也可以实现载体卫星姿态保持不变，一些研究认为可以引入一条额外的空间机械臂专门用于补偿空间机器人执行任务时产生的载体卫星扰动力矩，但是这使整个空间机器人系统更复杂，从概率上讲也更容易陷入故障状态，并且很不经济。通过动力学计算获得空间机械臂运动对载体卫星姿态的扰动力矩，并通过反作用飞轮对扰动力矩进行补偿是一种很好的方法，但是这种方法往往需要借助复杂的动力学计算，算法结构复杂，实时性不强，而且存在反作用飞轮输出力矩小，响应较慢的问题。因此，提出一种简单的空间机器人协调控制的方法，是非常迫切和必要的。

发明内容

本发明提供一种基于扩展雅克比矩阵的空间机器人星臂协调控制方法，以解决空间机械臂在轨工作时与基座卫星整体协同控制问题，进而实现在机械臂完成空间任务的同时保证载体卫星姿态基本不变；同时通过优化机械臂的运动轨迹，使基座卫星在补偿机械臂产生的反作用力矩时消耗的能量最小。

基于扩展雅可比矩阵的空间机器人整体协调的优化控制方法由以下步骤完成：

步骤一、通过ProE建模计算出包括机械臂和基座卫星的空间机器人的运动学和动力学参数；

步骤二、建立基于扩展雅克比矩阵的空间机器人整体数学模型；

步骤三、利用Moore-Penrose伪逆求解方法设计空间机器人星臂协调控制器（见式（6））；

步骤四、空间机械臂末端轨迹参数化；

步骤五、基于粒子群优化方法，根据空间机器人协调控制器得到的单框架控制力矩陀螺系统角动量的表达式构建的优化目标函数（见式（12）），利用构建的优化目标函数对经过参数化的空间机械臂末端轨迹进行优化；

步骤六、将空间机械臂优化轨迹数据输入给空间机器人星臂协调控制器，得到单框架控制力矩陀螺系统的角动量，利用得到的角动量计算出单框架控制力矩陀螺系统的角速度指令（利用式（19）计算）。

本发明具有以下有益效果：本发明通过建立的空间机器人（空间机器人包括机械臂和基座卫星）的整体数学模型，根据输入的机械臂末端轨迹，可直接计算出卫星需补偿机械臂运动的单框架控制力矩陀螺系统的角速度指令，实现了空间机械臂与卫星基座的整体协调控制；通过对执行同样任务的空间机械臂轨迹进行优化，可使卫星姿态控制系统补偿机械臂反作用力矩消耗的能量较小。

本发明方法不需要卫星根据姿态测量进行滞后的反馈控制，而是通过将臂星的耦合运动进行整体数学建模，根据输入的机械臂末端轨迹，可直接计算出卫星需补偿机械臂运动的单框架控制力矩陀螺系统的角速度指令，实现臂星的整体协调控制；同时机械臂末端轨迹经过优化，可使卫星态控制系统补偿机械臂反作用力矩所消耗的能量较小；该方法避免了复杂的动力学计算，方法结构简单，便于实现载体卫星姿态的高精度控制，可用于空间机器人在轨维护、空间碎片清理、深空探测操做等空间应用领域。

附图说明

图1为空间机器人星臂协调控制流程图；

图2为空间机器人系统各坐标系示意图；

图3为利用粒子群方法对机械臂轨迹进行优化的流程图；

图4为空间机器人机械臂关节轨迹图，图4中：图4a为空间机器人第一关节角轨迹图，图4b为第二关节轨迹图，图4c为第三关节轨迹图，图4d为第四关节轨迹图，图4e为第五关节轨迹图，图4f为第六关节轨迹图；