空间机器人由末端执行器向基座的动力学建模方法与流程

本发明涉及一种空间机器人动力学建模方法，特别涉及一种空间机器人由末端执行器向基座的动力学建模方法。

背景技术：

空间机器人具备执行在轨航天器维修、空间碎片清理等精细空间任务的能力，因而自20世纪90年代中期开始研究，至今不断引起各航天大国及研究人员的关注。与地面机械臂不同，由于基座航天器在空间微重力环境中自由漂浮，机械臂运动对基座产生的反作用力可能会引起基座位置和姿态的显著变化，而基座的运动反过来又会影响机械臂的运动，称之为基座和机械臂的动力学耦合作用。这种动力学耦合作用使得与地面机械臂相比，空间机器人的动力学建模难度显著增大。

如果忽略连杆的柔性效应，空间机器人系统可以视为多刚体系统。多刚体系统动力学建模依据原理大致可以分为基于牛顿-欧拉法和基于第二类拉格朗日方程法。其中，牛顿欧拉法下需要将系统的各个组成部分视为独立的刚体，分别进行受力分析。而在基于拉格朗日方程下，多刚体组成的对象被视为完整的系统，通过计算系统的动能和势能之和，并代入第二类拉格朗日方程就可得到系统的动力学方程。对于空间机器人系统，由于系统不受重力作用，因此系统的势能为零，结合动能定理和第二类拉格朗日方程，就可以得到系统的动力学模型。这种建模方法原理清晰，反映了空间机器人的动力学特性，因而已成为大部分空间机器人研究文献中选择的建模方法。同时，方程中包含的与速度相关的非线性项涉及对系统惯性矩阵求导，很难直接给出解析的表达式，因而该项常常利用递推牛顿-欧拉方法数值计算获得。目前，基于动能定理、拉格朗日方程和递推牛顿-欧拉法的框架建立空间机器人系统的动力学方程已经很成熟并被广泛使用。然而需要指出的是，该方程由基座向末端执行器推导得到，即每个连杆的速度被表示为基座速度和基座与该连杆间各关节角速度的组合，因而动力学方程中包含的广义坐标为基座速度和各关节角速度。另一方面，空间机器人的控制任务大多涉及末端执行器跟踪期望轨迹，因为现有动力学方程中不包含末端执行器的运动变量，因而在已有的大多数空间机器人控制方法研究中，需要借助逆运动学将末端执行器的任务分解到各个关节，在关节空间下设计控制方法。本发明中，基于空间机器人系统没有固定基座，同样可以将末端执行器视为系统“基座”的思想，进行系统由末端执行器向基座建模，得到的动力学方程中将直接包含末端执行器的运动变量，从而有助于简化空间机器人控制方法的研究。

技术实现要素：

针对空间机器人现有动力学模型不利于设计空间机器人末端执行器控制方法的问题，提出一种空间机器人由末端执行器向基座航天器建模的动力学建模方法，使得动力学模型中包含末端执行器的运动状态变量，从而不需要进行逆运动学求解，可以直接针对末端执行器的运动状态设计控制律。

本发明提出了一种空间机器人的动力学建模方法，包括定义了代表基座、末端执行器和各连杆的本体坐标系，使空间机器人系统具有对称性；推导和建立了空间机器人由末端执行器向基座建模方式下的动力学模型；建立了得到的新模型中控制输入与传统由基座向末端执行器动力学建模下控制输入的关系；最后通过在实例下对比新模型和传统模型的作用效果验证了本发明提出的方法的有效性。该发明的实施主要包括以下三个步骤：

步骤一、定义空间机器人基座、末端执行器和各连杆本体坐标系。

空间机器人系统是由基座航天器和n自由度的机械臂组成的多刚体系统，在动力学建模中，通过定义基座、各连杆和末端执行器的本体坐标系并实施坐标变换来描述各刚体的位姿信息。在由基座向末端执行器建模中(第i个连杆的速度由基座速度和第1～(i-1)个关节的旋转速度计算得到)，往往将基座的本体坐标系建立在其质心处。在本发明中，考虑自由漂浮的空间机器人系统没有固定的基座，从建模的角度考虑，机械臂的末端执行器也可以视为系统的“基座”，而基座航天器则可以视为系统的“末端”，从而可以进行系统由末端执行器向基座建模(第i个连杆的速度由末端执行器速度和第(i+1)～n个关节的旋转速度计算得到)。因为现有的建模方法中，代表末端执行器的本体坐标系大都建立在最后一个连杆的末端，本发明将基座的本体坐标系由其质心处移动至基座一端，使得空间机器人系统成为一个对称的系统，从而由末端执行器向基座建模下得到的动力学模型将与由基座向末端执行器建模下得到的动力学模型具有相同的结构。

本发明中各刚体的本体坐标系具体定义如下：

基座和末端执行器的本体坐标系分别位于基座和最后一个连杆的末端，记为σo和σe，坐标轴选为与刚体惯量主轴平行；各连杆的本体坐标系σi位于与连杆相连的前一个关节处，z轴与关节轴重合，x轴指向与连杆相连的下一个关节或惯性张量容易计算的方向，y轴符合右手准则。在由末端执行器向基座建模时，使用同样的坐标系集合，其中σo，σe和σi分别变为σ'e，σ'o和σ'(n-i+1)。

步骤二、建立空间机器人由末端执行器向基座建模下的动力学模型。

空间机器人由基座向末端执行器建模时，选取基座线/角速度和各个关节的转速作为广义变量，使用第二类拉格朗日方程可以得到系统的动力学模型如下：

其中，为基座的线/角速度，是各关节转速组成的向量，hb,hm为基座和机械臂惯量矩阵，hbm为末端执行器和机械臂之间的耦合惯量矩阵cb,cm为与速度相关的非线性项，fb,fe为基座和末端执行器受到的外力和外力矩，τ为机械臂关节处的作用力矩。

通过在步骤一中适当地定义了基座、各连杆和末端执行器的本体坐标系，空间机器人系统被描述为对称的多刚体系统。应用相同的原理，由末端执行器向基座建模得到的动力学模型将与方程(4)具有相同的结构，然而，动力学模型中的广义变量将变为末端执行器的线/角速度和每个关节的旋转速度：

其中，为末端执行器的线/角速度，符号‘～’代表方程由末端执行器向基座建模得到。

需要指出的是，因为动力学方程由将系统的动能代入拉格朗日方程得到，而本发明在步骤一中将基座的坐标系建立在基座的一端，计算基座的动能时需要使用基座质心的线速度：

v′b＝vb+ωb×a0(6)

而不是直接使用vb，a0是基座本体坐标系原点到基座质心的位置矢量，符号‘×’表示叉乘运算。同时，动力学方程中与速度相关的非线性项cb通过递推牛顿-欧拉法数值计算得到，其中包含计算基座的惯性力，此时，需要使用基座质心的线加速度：

而不是直接使用ab。在进行由末端执行器向基座建模时，上述改动同样适用于对末端执行器动能和惯性力的计算。

步骤三、建立两类动力学模型中系统控制输入的关系。

动力学方程中输入的力和力矩包括基座控制力和力矩fb，末端执行器所受的外力、外力矩fe，以及关节作用力矩τ与显然，在由末端执行器向基座建模时，在由基座向末端执行器建模下的fe和fb将分别变为作用在“基座”和“末端执行器”上的外力、外力矩，该关系已经体现在建立的动力学方程中。关节作用力矩τ与的关系分析如下：

在由基座向末端执行器建模中，关节ji连接连杆bi-1和连杆bi。如果关节ji处电机对连杆bi作用的力矩为τi，显然，同样会对连杆bi-1作用力矩-τi。因为在由末端执行器向基座建模时，关节ji，连杆bi和bi-1分别变为关节jn-i+1，连杆bn-i和bn-i+1，引入的符号中，表示关节jn-i+1对连杆bn-i+1施加的力矩，因而，存在如下关系：

基于同样的原因，关节变量和具有上式表示的关系。

本发明的有益效果是：提出了一种空间机器人由末端执行器向基座建模的动力学建模方法，其中，得到的动力学方程以末端执行器的线/角速度和各关节的转速作为广义变量。因为空间机器人的大多数控制任务都有关于机械臂末端执行器跟踪期望轨迹的要求，新的动力学方程中直接包含末端执行器的运动变量，因而更方便在其基础上设计空间机器人末端执行器相关任务的控制方法。

附图说明

图1空间机器人系统示意图

图2两种动力学方程下末端执行器运动轨迹

图3两种动力学方程下各关节角运动轨迹

具体实施方式

表1带6自由度机械臂空间机器人的运动学/动力学参数

表1为实例中使用的空间机器人系统的运动学和动力学参数，图1为空间机器人系统示意图，图2、图3分别为两种动力学方程下末端执行器和各关节角的运动轨迹。

以对带6自由度机械臂的空间机器人动力学建模为例，分别使用由基座向末端执行器建模和由末端执行器向基座建模两种方式推导系统动力学模型，将相同的作用力/作用力矩施加在两种模型上，观察空间机器人系统的运动情形。空间机器人的运动学/动力学参数如表1所示。

在由基座向末端执行器建模得到的动力学模型中，对基座施加作用力fb＝[5,4,3]n，各关节依次施加力矩τ＝-[4,3,2,1,0.5,1]n·m，末端执行器受到外力fe＝[1,2,3]n；在由末端执行器向基座建模得到的动力学模型中，对“基座”(末端执行器)施加外力fb＝[1,2,3]n，各关节依次施加力矩“末端执行器”(基座)受到外力fe＝[5,4,3]n。

图2和图3分别为两种动力学模型下，系统施加相同的作用力/力矩后末端执行器与各关节的运动轨迹，可以看出，系统在两种动力学建模方式下具有相同的运动状态，其中，仿真末尾出现的微小偏差由程序数值积分误差引起，从而说明了本发明提出的空间机器人由末端执行器向基座建模下动力学模型的正确性。