申请/专利权人：中国运载火箭技术研究院

申请日：2017-11-21

公开（公告）日：2021-04-13

公开（公告）号：CN107967241B

主分类号：G06F17/16(20060101)

分类号：G06F17/16(20060101);B25J19/00(20060101);B64G1/10(20060101)

优先权：

专利状态码：有效-授权

法律状态：2021.04.13#授权;2018.05.22#实质审查的生效;2018.04.27#公开

摘要：一种空间自由漂浮机器人的基座扰动计算方法，包括如下步骤：步骤一、确定空间自由漂浮机器人的系统参数和任务参数；确定计算总时长及计算周期T；步骤二、根据空间自由漂浮机器人的系统参数和任务参数，计算空间自由漂浮机器人的初始线动量P0和初始角动量L0；步骤三、计算当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ；步骤四、根据初始线动量P0和初始角动量L0、当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ，确定当前时刻的基座角速度矢量ω0；步骤五、根据当前时刻的基座姿态角矢量θt和姿态角速度矢量ω0，计算下一周期的基座姿态角矢量θt+T；然后转入步骤三进行下一计算周期直到达到计算总时长。

主权项：1.一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：包括如下步骤：步骤一、确定空间自由漂浮机器人的系统参数和任务参数；确定计算总时长及单步计算周期T；步骤二、根据步骤一中空间自由漂浮机器人的系统参数和任务参数，计算空间自由漂浮机器人的初始线动量P0和初始角动量L0；步骤三、计算当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ；步骤四、根据步骤二中的初始线动量P0和初始角动量L0、步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ，确定当前时刻的基座角速度矢量ω0；步骤五、根据当前时刻的基座姿态角矢量θt和姿态角速度矢量ω0，计算下一周期的基座姿态角矢量θt+T；然后转入步骤三进行下一计算周期直到达到计算总时长；所述步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ为： 其中，M为系统总质量，r0g为基座质心与系统质心的相对位置矢量，Hω为转动惯量矩阵，Hωφ为角动量矩阵，JTω为旋转惯性矩阵，～表示向量叉乘；所述步骤四中当前时刻基座角速度矢量ω0为： 其中，P0和L0为空间自由漂浮机器人的初始线动量和初始角动量，r0g为基座相对于质心的相对位置矢量，为机械臂关节角速度；所述步骤五中下一计算周期的基座姿态角矢量θt+T为： 式中 其中，θt为t时刻基座姿态角矢量，为t时刻基座姿态角矢量变化率，分别为基座的滚动角变化率、偏航角变化率及俯仰角变化率，γ、ψ、分别为基座的滚动角、偏航角及俯仰角。

全文数据：一种空间自由漂浮机器人的基座扰动计算方法技术领域[0001]本发明涉及一种空间自由漂浮机器人的基座扰动计算方法，属于空间操作领域。背景技术[0002]空间机器人通常由基座航天器简称为基座和一个或多个机械臂构成，能够代替宇航员执行各类在轨操作任务，近年来已成为各航天大国的研究热点。空间机器人根据基座位姿受控与否分为三种控制模式，即基座受控模式、自由飞行模式及自由漂浮模式。其中，自由漂浮空间机器人模式因其基座位姿均不受控，仅通过电机驱动机械臂各关节实现末端执行器的运动。相比于其它控制模式，自由漂浮机器人能够保证空间近距离操作任务的安全性、并能够节省主动能源，因而受到了广泛关注与研究。[0003]然而，自由漂浮机器人由于不受外力作用，系统角动量与线动量守恒，因此，机械臂的运动会引起基座位姿的变化，这对有姿态要求的任务如测控通信、高精度成像、惯性定向等存在较大的影响。有鉴于此，正确预测及分析机械臂运动对基座的姿态扰动，对于机械臂运动规划、基座姿态补偿等设计工作具有重要意义。传统的做法是基于动力学模型的数值方法来预测并分析基座姿态扰动，该方法需要不断数值求解动力学模型，计算量较大，且涉及多次矩阵求逆运算，不利于实时在线计算与预测。发明内容[0004]本发明要解决的技术问题是：克服现有技术的不足，提供了一种空间自由漂浮机器人的基座扰动计算方法，采用关节角速度与角度指令完成计算，降低数值运算量，同时也降低了控制参数带来的控制回路不确定性，有效提升了计算效率。[0005]本发明目的通过以下技术方案予以实现：[0006]—种空间自由漂浮机器人的基座扰动计算方法，包括如下步骤：[0007]步骤一、确定空间自由漂浮机器人的系统参数和任务参数;确定计算总时长及单步计算周期T;[0008]步骤二、根据步骤一中空间自由漂浮机器人的系统参数和任务参数，计算空间自由漂浮机器人的初始线动量Po和初始角动量L0;[0009]步骤三、计算当前时刻空间自由漂浮机器人的平动耦合矩阵凡和转动耦合矩阵He;[0010]步骤四、根据步骤二中的初始线动量Po和初始角动量L〇、步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵和转动耦合矩阵出，确定当前时刻的基座角速度矢量ω〇;[0011]步骤五、根据当前时刻的基座姿态角矢量0t和姿态角速度矢量ω〇,计算下一周期的基座姿态角矢量9t+T;然后转入步骤三进行下一计算周期直到达到计算总时长。[0012]上述空间自由漂浮机器人的基座扰动计算方法，所述步骤一中的系统参数包括：基座质量mo、机械臂关节数η、第k个臂杆质量mk、机械臂第k个关节质量mjk、关节传动比λ、第k个关节Jk至第k个臂杆质心Ck位置矢量ak、第k个臂杆质心Ck至第k+Ι个关节Jk+1的位置矢量bk、机械臂第k个臂杆惯性矩阵Ik、机械臂第k个关节惯性矩阵Ilk、基座惯性矩阵1〇、关节1的安装位置矢量bo、第k个关节Jk的电机质心偏移矢量Δnk。[0013]上述空间自由漂浮机器人的基座扰动计算方法，所述步骤一中的任务参数包括：基座初始线速度矢量v〇〇、基座初始角速度矢量ω〇0、及机械臂各关节初始角速度#:0及初始关节角度Θ〇，基座位置矢量r〇0。[0014]上述空间自由漂浮机器人的基座扰动计算方法，所述步骤二中空间自由漂浮机器人的初始线动量Po和初始角动量Lo为：[0015][0016][0017]其中，mo为基座质量、ro为基座位置矢量、，为基座位置矢量变化率、η为机械臂关节数、mk为第k个臂杆质量.为第k个臂杆的质心位置矢量变化率、nyk为机械臂第k个关节质量t为机械臂第k个关节电机质心位置矢量变化率、Io为基座惯性矩阵、ω〇为基座角速度矢量、Ik为机械臂第k个臂杆惯性矩阵、cok为机械臂第k个臂杆角速度矢量、rk为第k个臂杆质心位置矢量、为第k个臂杆质心位置矢量变化率、为机械臂第k个关节惯性矩阵、«jk为机械臂第k个关节角速度矢量、nk为机械臂第k个关节电机质心位置矢量。[0018]上述空间自由漂浮机器人的基座扰动计算方法，所述步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵咏为：[0019][0020][0021]其中，M为系统总质量，r〇g为基座质心与系统质心的相对位置矢量，Ηω为转动惯量矩阵，Ηωφ为角动量矩阵，1^为旋转惯性矩阵，〜表示向量叉乘。[0022]上述空间自由漂浮机器人的基座扰动计算方法，所述步骤四中当前时刻基座角速度矢量ω〇为：[0023][0024]其中，Po和Lo为空间自由漂浮机器人的初始线动量和初始角动量，rQg为基座相对于质心的相对位置矢量，、出分别为平动耦合矩阵和转动耦合矩阵，为机械臂关节角速度，〜表示向量叉乘。[0025]上述空间自由漂浮机器人的基座扰动计算方法，所述步骤五中下一计算周期的基座姿态角矢量θt+T为：[0026][0027]式中[0028][0029]其中，ω〇为当前时刻基座的姿态角速度矢量，Θ⑴为t时刻基座姿态角矢量，以为t时刻基座姿态角矢量变化率1分别为基座的滚动角变化率、偏航角变化率及俯仰角变化率，分别为基座的滚动角、偏航角及俯仰角。[0030]本发明相比于现有技术具有如下有益效果：[0031]1避免了通过动力学模型解算来更新机械臂关节角速度与角度，取而代之的是用关节角速度与角度指令完成相关计算，大大降低数值运算量；[0032]2本技术仅仅使用了平动耦合矩阵的逆矩阵，但是该矩阵在理论上能够确保非奇异性，从而有效避免每个计算周期内对动力学惯性矩阵的求逆判断及奇异处理，本质上提升算法可靠性及精度；[0033]3本技术利用关节角速度作为输入开展计算，避免关节力矩的求取，降低了控制参数带来的控制回路不确定性，同时有效提升计算效率；[0034]4本技术考虑了空间自由漂浮机器人初始角动量和线动量的影响，计算覆盖范围更广。附图说明[0035]图1为本发明空间自由漂浮机器人建模示意图；[0036]图2为本发明基于运动学模型的基座姿态分析流程图；[0037]图3为本发明的步骤流程图；[0038]图4为本发明仿真结果与传统方法的对比图。具体实施方式[0039]为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明的实施方式作进一步详细描述。[0040]本发明可应用于含有空间机械臂的空间飞行器系统或空间机器人系统，解决自由漂浮模式下机械臂运动带来的基座姿态扰动预测与分析问题。[0041]图1为本发明空间自由漂浮机器人建模示意图，空间机器人系统由基座和机械臂构成，运动模式采用自由漂浮模式，即机械臂运动时，基座不进行位姿控制，仅通过关节控制器驱动机械臂各关节实现机械臂运动并带动末端执行器完成空间操作任务。相比于基座受控下的运动模式，自由漂浮模式能够保证空间近距离操作任务的安全性并能够节省主动能源位姿控制所需的推进剂），因而常被应用于基于机械臂的空间操作任务。[0042]然而，根据角动量守恒定律及空间机器人的非完整约束特性，自由漂浮模式下的空间机械臂运动会引发基座的姿态变化，这会带来几类风险：[0043]1机械臂在实施典型动作后，基座姿态大幅偏转，导致姿控初始条件严重超差，存在控制系统在有限时间内无法完成姿态程序角跟踪的风险；[0044]2以双目立体视觉相机为代表的目标探测系统固定安装于飞行器基座上，若基座姿态偏差较大，探测目标有可能偏出相机探测视场，存在探测系统探测失败的风险；[0045]3天基数传天线同样固定安装于飞行器基座上，若基座姿态出现大幅翻转，导致天线超出测控覆盖区域，天线无法对准中继卫星，存在通信链路中断的风险。[0046]因此，根据机械臂预定的运动序列，正确预测及分析机械臂运动带来基座的姿态扰动，对规避上述几类风险，确保在轨任务成功具有重要意义。有鉴于此，本发明提出了一种基于运动学模型的数值预测方法，用于快速计算与分析机械臂运动对飞行器基座姿态扰动，本算法有效避免动力学模型的求解，大大降低计算复杂度，显著提升计算效率。[0047]首先，定义惯性系及基座本体系分别为O1X1Y1Z1和OoXoYoZo，如图1所示，关节坐标系为OkXkYkZk,k=l，2,…，η〇[0048]图2为本发明基于运动学模型的基座姿态分析流程图；图3为本发明的步骤流程图。[0049]步骤101，确定空间自由漂浮机器人的系统参数和任务参数;确定计算总时长及单步计算周期Τ。[0050]空间自由漂浮机器人的系统参数包括:基座质量mo、机械臂关节数η、第k个臂杆质量mk、机械臂第k个关节质量mjk、关节传动比λ、第k个关节Jk至第k个臂杆质心Ck位置矢量ak、第k个臂杆质心Ck至第k+1个关节Jk+1的位置矢量bk、机械臂第k个臂杆惯性矩阵Ik、机械臂第k个关节惯性矩阵Ijk、基座惯性矩阵1〇、关节1的安装位置矢量bo、第k个关节Jk的电机质心偏移矢量AHk。[0051]空间自由漂浮机器人的任务参数，基座初始线速度矢量Vo0、基座初始角速度矢量ω〇0、及机械臂各关节初始角速度）及初始关节角度Θ〇，基座位置矢量ro〇，并确定计算总时长Tmax，单步计算周期Τ。[0052]步骤102,根据步骤101中空间自由漂浮机器人的系统参数和任务参数，计算空间自由漂浮机器人的初始线动量Po和初始角动量L0。[0053][0054][0055]其中，mo为基座质量、r〇为基座位置矢量.„为基座位置矢量变化率、η为机械臂关节数、mk为第k个臂杆质量..为第k个臂杆的质心位置矢量变化率、nyk为机械臂第k个关节质量为机械臂第k个关节电机质心位置矢量变化率、Io为基座惯性矩阵、ω〇为基座角速度矢量、Ik为机械臂第k个臂杆惯性矩阵、cok为机械臂第k个臂杆角速度矢量、rk为第k个臂杆质心位置矢量、..为第k个臂杆质心位置矢量变化率、Ijk为机械臂第k个关节惯性矩阵、«jk为机械臂第k个关节角速度矢量、nk为机械臂第k个关节电机质心位置矢量。[0056]步骤103,计算当前时刻空间自由漂浮机器人的平动耦合矩阵和转动耦合矩阵He〇[0057][0058]—τ〇[0059]其中，M为系统总质量，r〇g为基座质心与系统质心的相对位置矢量，Ηω为转动惯量矩阵，ΗωΦ为角动量矩阵，1^为旋转惯性矩阵，可由下式确定：[0060][0061][0062][0063]JTk=[giXrk-pi,...,gkXrk~pk,0,...,0][0064]Juk=[giXrjk-pi,...,gk-iXrjk-pk-i,0,...,0][0065]Jk=[gi,g2,·'Sgk1O,···,0][0066]Jjk=[gi,g2,···,,0,···,0][0067]r〇k=rk-r〇[0068]rj〇k=rjk-r〇[0069][0070][0071][0072]式中，gk为机械臂第k个关节的转轴矢量，pk为第k个关节的位置矢量;JTk、JUk均为中间矢量，元素个数均为k个;ai为第i个关节至第i个臂杆质心的位置矢量，Id1为第i个臂杆质心至第i+1个关节的位置矢量，〜表示向量叉乘。[0073]步骤104,根据步骤102中的初始线动量Po和初始角动量Lo、步骤103中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵咏，确定当前时刻的基座角速度矢量ω〇。计算当前时刻平动耦合矩阵凡的逆矩阵..并根据质心相对基座位置矢量rQg，系统初始线动量Po和初始角动量Lo,转动耦合矩阵He，机械臂各关节角速度諺，根据下式确定当前时刻基座角速度矢量ω〇。[0074][0075]式中，转动耦合矩阵咏由下式确定[0076][0077]步骤105,根据当前时刻的基座姿态角矢量0t和姿态角速度矢量coQt，根据下式计算下一周期的基座姿态角矢量Θt+T;[0078][0079][0080]其中，ω〇为当前时刻基座的姿态角速度矢量，0t为t时刻基座姿态角矢量，#的为t时刻基座姿态角矢量变化率，分别为基座的滚动角变化率、偏航角变化率及俯仰角变化率，分别为基座的滚动角、偏航角及俯仰角。[0081]然后转入步骤103进行下一周期的计算直到基座扰动结束。判断是否到达运动结束时间Tmax，若是，则结束，并输出基座姿态角矢量序列;若否，则转入步骤103进行下一周期的计算。[0082]图4所示为本发明与传统方法下计算的基座姿态变化与某试验中基座真实姿态变化值的对比，本发明方法的理论结果与试验结果更为接近，且优于传统方法的理论结果，验证了本方法的可行性和有效性。[0083]本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

权利要求：1.一种空间自由漂浮机器人的基座扰动计算方法，其特征在于:包括如下步骤：步骤一、确定空间自由漂浮机器人的系统参数和任务参数;确定计算总时长及单步计算周期T;步骤二、根据步骤一中空间自由漂浮机器人的系统参数和任务参数，计算空间自由漂浮机器人的初始线动量Po和初始角动量L0;步骤三、计算当前时刻空间自由漂浮机器人的平动耦合矩阵凡和转动耦合矩阵He;步骤四、根据步骤二中的初始线动量Po和初始角动量L〇、步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵咏，确定当前时刻的基座角速度矢量ω〇;步骤五、根据当前时刻的基座姿态角矢量9t和姿态角速度矢量ω〇,计算下一周期的基座姿态角矢量9t+T;然后转入步骤三进行下一计算周期直到达到计算总时长。2.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤一中的系统参数包括:基座质量mo、机械臂关节数n、第k个臂杆质量mk、机械臂第k个关节质量mjk、关节传动比λ、第k个关节Jk至第k个臂杆质心Ck位置矢量ak、第k个臂杆质心Ck至第k+1个关节jk+1的位置矢量bk、机械臂第k个臂杆惯性矩阵11{、机械臂第k个关节惯性矩阵Ijk、基座惯性矩阵1〇、关节1的安装位置矢量b〇、第k个关节Jk的电机质心偏移矢量Ank。3.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤一中的任务参数包括:基座初始线速度矢量VQ⑼、基座初始角速度矢量ω〇⑼、及机械臂各关节初始角速度及初始关节角度©〇，基座位置矢量ro0。4.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤二中空间自由漂浮机器人的初始线动量Po和初始角动量Lo为：其中，mQ为基座质量、Π为基座位置矢量、％为基座位置矢量变化率、η为机械臂关节数、Hik为第k个臂杆质量、4为第k个臂杆的质心位置矢量变化率、mjk为机械臂第k个关节质量、4为机械臂第k个关节电机质心位置矢量变化率、Io为基座惯性矩阵、ω〇为基座角速度矢量、Ik为机械臂第k个臂杆惯性矩阵、cok为机械臂第k个臂杆角速度矢量、rk为第k个臂杆质心位置矢量、4为第k个臂杆质心位置矢量变化率、Ilk为机械臂第k个关节惯性矩阵、Cojk为机械臂第k个关节角速度矢量、nk为机械臂第k个关节电机质心位置矢量。5.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵咏为：其中，M为系统总质量为基座质心与系统质心的相对位置矢量，Ηω为转动惯量矩阵，为角动量矩阵，Jtu为旋转惯性矩阵，〜表示向量叉乘。6.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤四中当前时刻基座角速度矢量ωο为：其中，Po和Lq为空间自由漂浮机器人的初始线动量和初始角动量为基座相对于质心的相对位置矢量，HS、H^V别为平动耦合矩阵和转动耦合矩阵为机械臂关节角速度，〜表示向量叉乘。7.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤五中下一计算周期的基座姿态角矢量Θt+T为：式中其中，ω〇为当前时刻基座的姿态角速度矢量，0t为t时刻基座姿态角矢量为t时刻基座姿态角矢量变化率分别为基座的滚动角变化率、偏航角变化率及俯仰角变化率分别为基座的滚动角、偏航角及俯仰角。

百度查询： 中国运载火箭技术研究院 一种空间自由漂浮机器人的基座扰动计算方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD