CN107967241A - 一种空间自由漂浮机器人的基座扰动计算方法 - Google Patents
一种空间自由漂浮机器人的基座扰动计算方法 Download PDFInfo
- Publication number
- CN107967241A CN107967241A CN201711162977.3A CN201711162977A CN107967241A CN 107967241 A CN107967241 A CN 107967241A CN 201711162977 A CN201711162977 A CN 201711162977A CN 107967241 A CN107967241 A CN 107967241A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- pedestal
- robot
- mover
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/10—Artificial satellites; Systems of such satellites; Interplanetary vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Remote Sensing (AREA)
- Theoretical Computer Science (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Pure & Applied Mathematics (AREA)
- Computing Systems (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Algebra (AREA)
- Astronomy & Astrophysics (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Manipulator (AREA)
Abstract
一种空间自由漂浮机器人的基座扰动计算方法，包括如下步骤：步骤一、确定空间自由漂浮机器人的系统参数和任务参数；确定计算总时长及计算周期T；步骤二、根据空间自由漂浮机器人的系统参数和任务参数，计算空间自由漂浮机器人的初始线动量P0和初始角动量L0；步骤三、计算当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ；步骤四、根据初始线动量P0和初始角动量L0、当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ，确定当前时刻的基座角速度矢量ω0；步骤五、根据当前时刻的基座姿态角矢量θ(t)和姿态角速度矢量ω0，计算下一周期的基座姿态角矢量θ(t+T)；然后转入步骤三进行下一计算周期直到达到计算总时长。
Description
技术领域
本发明涉及一种空间自由漂浮机器人的基座扰动计算方法，属于空间操作领域。
背景技术
空间机器人通常由基座航天器(简称为基座)和一个或多个机械臂构成，能够代替宇航员执行各类在轨操作任务，近年来已成为各航天大国的研究热点。空间机器人根据基座位姿受控与否分为三种控制模式，即基座受控模式、自由飞行模式及自由漂浮模式。其中，自由漂浮空间机器人模式因其基座位姿均不受控，仅通过电机驱动机械臂各关节实现末端执行器的运动。相比于其它控制模式，自由漂浮机器人能够保证空间近距离操作任务的安全性、并能够节省主动能源，因而受到了广泛关注与研究。
然而，自由漂浮机器人由于不受外力作用，系统角动量与线动量守恒，因此，机械臂的运动会引起基座位姿的变化，这对有姿态要求的任务如测控通信、高精度成像、惯性定向等存在较大的影响。有鉴于此，正确预测及分析机械臂运动对基座的姿态扰动，对于机械臂运动规划、基座姿态补偿等设计工作具有重要意义。传统的做法是基于动力学模型的数值方法来预测并分析基座姿态扰动，该方法需要不断数值求解动力学模型，计算量较大，且涉及多次矩阵求逆运算，不利于实时在线计算与预测。
发明内容
本发明要解决的技术问题是：克服现有技术的不足，提供了一种空间自由漂浮机器人的基座扰动计算方法，采用关节角速度与角度指令完成计算，降低数值运算量，同时也降低了控制参数带来的控制回路不确定性，有效提升了计算效率。
本发明目的通过以下技术方案予以实现：
一种空间自由漂浮机器人的基座扰动计算方法，包括如下步骤：
步骤一、确定空间自由漂浮机器人的系统参数和任务参数；确定计算总时长及单步计算周期T；
步骤二、根据步骤一中空间自由漂浮机器人的系统参数和任务参数，计算空间自由漂浮机器人的初始线动量P0和初始角动量L0；
步骤三、计算当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ；
步骤四、根据步骤二中的初始线动量P0和初始角动量L0、步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ，确定当前时刻的基座角速度矢量ω0；
步骤五、根据当前时刻的基座姿态角矢量θ(t)和姿态角速度矢量ω0，计算下一周期的基座姿态角矢量θ(t+T)；然后转入步骤三进行下一计算周期直到达到计算总时长。
上述空间自由漂浮机器人的基座扰动计算方法，所述步骤一中的系统参数包括：基座质量m0、机械臂关节数n、第k个臂杆质量mk、机械臂第k个关节质量mJk、关节传动比λ、第k个关节Jk至第k个臂杆质心Ck位置矢量ak、第k个臂杆质心Ck至第k+1个关节Jk+1的位置矢量bk、机械臂第k个臂杆惯性矩阵Ik、机械臂第k个关节惯性矩阵IJk、基座惯性矩阵I0、关节1的安装位置矢量b0、第k个关节Jk的电机质心偏移矢量ΔrJk。
上述空间自由漂浮机器人的基座扰动计算方法，所述步骤一中的任务参数包括：基座初始线速度矢量v0(0)、基座初始角速度矢量ω0(0)、及机械臂各关节初始角速度及初始关节角度Θ(0)，基座位置矢量r0(0)。
上述空间自由漂浮机器人的基座扰动计算方法，所述步骤二中空间自由漂浮机器人的初始线动量P0和初始角动量L0为：
其中，m0为基座质量、r0为基座位置矢量、为基座位置矢量变化率、n为机械臂关节数、mk为第k个臂杆质量、为第k个臂杆的质心位置矢量变化率、mJk为机械臂第k个关节质量、为机械臂第k个关节电机质心位置矢量变化率、I0为基座惯性矩阵、ω0为基座角速度矢量、Ik为机械臂第k个臂杆惯性矩阵、ωk为机械臂第k个臂杆角速度矢量、rk为第k个臂杆质心位置矢量、为第k个臂杆质心位置矢量变化率、IJk为机械臂第k个关节惯性矩阵、ωJk为机械臂第k个关节角速度矢量、rJk为机械臂第k个关节电机质心位置矢量。
上述空间自由漂浮机器人的基座扰动计算方法，所述步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ为：
其中，M为系统总质量，r0g为基座质心与系统质心的相对位置矢量，Hω为转动惯量矩阵，Hωφ为角动量矩阵，JTω为旋转惯性矩阵，～表示向量叉乘。
上述空间自由漂浮机器人的基座扰动计算方法，所述步骤四中当前时刻基座角速度矢量ω0为：
其中，P0和L0为空间自由漂浮机器人的初始线动量和初始角动量，r0g为基座相对于质心的相对位置矢量，Hs、Hθ分别为平动耦合矩阵和转动耦合矩阵，为机械臂关节角速度，～表示向量叉乘。
上述空间自由漂浮机器人的基座扰动计算方法，所述步骤五中下一计算周期的基座姿态角矢量θ(t+T)为：
式中
其中，ω0为当前时刻基座的姿态角速度矢量，θ(t)为t时刻基座姿态角矢量，为t时刻基座姿态角矢量变化率，分别为基座的滚动角变化率、偏航角变化率及俯仰角变化率，分别为基座的滚动角、偏航角及俯仰角。
本发明相比于现有技术具有如下有益效果：
(1)避免了通过动力学模型解算来更新机械臂关节角速度与角度，取而代之的是用关节角速度与角度指令完成相关计算，大大降低数值运算量；
(2)本技术仅仅使用了平动耦合矩阵的逆矩阵，但是该矩阵在理论上能够确保非奇异性，从而有效避免每个计算周期内对动力学惯性矩阵的求逆判断及奇异处理，本质上提升算法可靠性及精度；
(3)本技术利用关节角速度作为输入开展计算，避免关节力矩的求取，降低了控制参数带来的控制回路不确定性，同时有效提升计算效率；
(4)本技术考虑了空间自由漂浮机器人初始角动量和线动量的影响，计算覆盖范围更广。
附图说明
图1为本发明空间自由漂浮机器人建模示意图；
图2为本发明基于运动学模型的基座姿态分析流程图；
图3为本发明的步骤流程图；
图4为本发明仿真结果与传统方法的对比图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明的实施方式作进一步详细描述。
本发明可应用于含有空间机械臂的空间飞行器系统或空间机器人系统，解决自由漂浮模式下机械臂运动带来的基座姿态扰动预测与分析问题。
图1为本发明空间自由漂浮机器人建模示意图，空间机器人系统由基座和机械臂构成，运动模式采用自由漂浮模式，即机械臂运动时，基座不进行位姿控制，仅通过关节控制器驱动机械臂各关节实现机械臂运动并带动末端执行器完成空间操作任务。相比于基座受控下的运动模式，自由漂浮模式能够保证空间近距离操作任务的安全性并能够节省主动能源(位姿控制所需的推进剂)，因而常被应用于基于机械臂的空间操作任务。
然而，根据角动量守恒定律及空间机器人的非完整约束特性，自由漂浮模式下的空间机械臂运动会引发基座的姿态变化，这会带来几类风险：
(1)机械臂在实施典型动作后，基座姿态大幅偏转，导致姿控初始条件严重超差，存在控制系统在有限时间内无法完成姿态程序角跟踪的风险；
(2)以双目立体视觉相机为代表的目标探测系统固定安装于飞行器基座上，若基座姿态偏差较大，探测目标有可能偏出相机探测视场，存在探测系统探测失败的风险；
(3)天基数传天线同样固定安装于飞行器基座上，若基座姿态出现大幅翻转，导致天线超出测控覆盖区域，天线无法对准中继卫星，存在通信链路中断的风险。
因此，根据机械臂预定的运动序列，正确预测及分析机械臂运动带来基座的姿态扰动，对规避上述几类风险，确保在轨任务成功具有重要意义。有鉴于此，本发明提出了一种基于运动学模型的数值预测方法，用于快速计算与分析机械臂运动对飞行器基座姿态扰动，本算法有效避免动力学模型的求解，大大降低计算复杂度，显著提升计算效率。
首先，定义惯性系及基座本体系分别为OIXIYIZI和O0X0Y0Z0，如图1所示，关节坐标系为OkXkYkZk,k＝1,2,...,n。
图2为本发明基于运动学模型的基座姿态分析流程图；图3为本发明的步骤流程图。
步骤101，确定空间自由漂浮机器人的系统参数和任务参数；确定计算总时长及单步计算周期T。
空间自由漂浮机器人的系统参数包括：基座质量m0、机械臂关节数n、第k个臂杆质量mk、机械臂第k个关节质量mJk、关节传动比λ、第k个关节Jk至第k个臂杆质心Ck位置矢量ak、第k个臂杆质心Ck至第k+1个关节Jk+1的位置矢量bk、机械臂第k个臂杆惯性矩阵Ik、机械臂第k个关节惯性矩阵IJk、基座惯性矩阵I0、关节1的安装位置矢量b0、第k个关节Jk的电机质心偏移矢量ΔrJk。
空间自由漂浮机器人的任务参数，基座初始线速度矢量v0(0)、基座初始角速度矢量ω0(0)、及机械臂各关节初始角速度及初始关节角度Θ(0)，基座位置矢量r0(0)，并确定计算总时长Tmax，单步计算周期T。
步骤102，根据步骤101中空间自由漂浮机器人的系统参数和任务参数，计算空间自由漂浮机器人的初始线动量P0和初始角动量L0。
其中，m0为基座质量、r0为基座位置矢量、为基座位置矢量变化率、n为机械臂关节数、mk为第k个臂杆质量、为第k个臂杆的质心位置矢量变化率、mJk为机械臂第k个关节质量、为机械臂第k个关节电机质心位置矢量变化率、I0为基座惯性矩阵、ω0为基座角速度矢量、Ik为机械臂第k个臂杆惯性矩阵、ωk为机械臂第k个臂杆角速度矢量、rk为第k个臂杆质心位置矢量、为第k个臂杆质心位置矢量变化率、IJk为机械臂第k个关节惯性矩阵、ωJk为机械臂第k个关节角速度矢量、rJk为机械臂第k个关节电机质心位置矢量。
步骤103，计算当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ。
其中，M为系统总质量，r0g为基座质心与系统质心的相对位置矢量，Hω为转动惯量矩阵，Hωφ为角动量矩阵，JTω为旋转惯性矩阵，可由下式确定：
JTk＝[g1×(rk-p1),...,gk×(rk-pk),0,...,0]
JTJk＝[g1×(rJk-p1),...,gk-1×(rJk-pk-1),0,...,0]
Jk＝[g1,g2,…,gk,0,…,0]
JJk＝[g1,g2,…,λgk,0,…,0]
r0k＝rk-r0
rJ0k＝rJk-r0
式中，gk为机械臂第k个关节的转轴矢量，pk为第k个关节的位置矢量；JTk、JTJk均为中间矢量，元素个数均为k个；ai为第i个关节至第i个臂杆质心的位置矢量，bi为第i个臂杆质心至第i+1个关节的位置矢量，～表示向量叉乘。
步骤104，根据步骤102中的初始线动量P0和初始角动量L0、步骤103中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ，确定当前时刻的基座角速度矢量ω0。计算当前时刻平动耦合矩阵Hs的逆矩阵并根据质心相对基座位置矢量r0g，系统初始线动量P0和初始角动量L0，转动耦合矩阵Hθ，机械臂各关节角速度根据下式确定当前时刻基座角速度矢量ω0。
式中，转动耦合矩阵Hθ由下式确定
步骤105，根据当前时刻的基座姿态角矢量θ(t)和姿态角速度矢量ω0(t)，根据下式计算下一周期的基座姿态角矢量θ(t+T)；
其中，ω0为当前时刻基座的姿态角速度矢量，θ(t)为t时刻基座姿态角矢量，为t时刻基座姿态角矢量变化率，分别为基座的滚动角变化率、偏航角变化率及俯仰角变化率，分别为基座的滚动角、偏航角及俯仰角。
然后转入步骤103进行下一周期的计算直到基座扰动结束。判断是否到达运动结束时间Tmax，若是，则结束，并输出基座姿态角矢量序列；若否，则转入步骤103进行下一周期的计算。
图4所示为本发明与传统方法下计算的基座姿态变化与某试验中基座真实姿态变化值的对比，本发明方法的理论结果与试验结果更为接近，且优于传统方法的理论结果，验证了本方法的可行性和有效性。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (7)
1.一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：包括如下步骤：
步骤一、确定空间自由漂浮机器人的系统参数和任务参数；确定计算总时长及单步计算周期T；
步骤二、根据步骤一中空间自由漂浮机器人的系统参数和任务参数，计算空间自由漂浮机器人的初始线动量P0和初始角动量L0；
步骤三、计算当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ；
步骤四、根据步骤二中的初始线动量P0和初始角动量L0、步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ，确定当前时刻的基座角速度矢量ω0；
步骤五、根据当前时刻的基座姿态角矢量θ(t)和姿态角速度矢量ω0，计算下一周期的基座姿态角矢量θ(t+T)；然后转入步骤三进行下一计算周期直到达到计算总时长。
2.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤一中的系统参数包括：基座质量m0、机械臂关节数n、第k个臂杆质量mk、机械臂第k个关节质量mJk、关节传动比λ、第k个关节Jk至第k个臂杆质心Ck位置矢量ak、第k个臂杆质心Ck至第k+1个关节Jk+1的位置矢量bk、机械臂第k个臂杆惯性矩阵Ik、机械臂第k个关节惯性矩阵IJk、基座惯性矩阵I0、关节1的安装位置矢量b0、第k个关节Jk的电机质心偏移矢量ΔrJk。
3.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤一中的任务参数包括：基座初始线速度矢量v0(0)、基座初始角速度矢量ω0(0)、及机械臂各关节初始角速度及初始关节角度Θ(0)，基座位置矢量r0(0)。
4.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤二中空间自由漂浮机器人的初始线动量P0和初始角动量L0为：
<mrow>
<msub>
<mi>P</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msub>
<mi>m</mi>
<mn>0</mn>
</msub>
<msub>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>0</mn>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<msub>
<mi>m</mi>
<mi>k</mi>
</msub>
<msub>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>k</mi>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<msub>
<mi>m</mi>
<mrow>
<mi>J</mi>
<mi>k</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>J</mi>
<mi>k</mi>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>L</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msub>
<mi>I</mi>
<mn>0</mn>
</msub>
<msub>
<mi>&omega;</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<msub>
<mi>r</mi>
<mn>0</mn>
</msub>
<mo>&times;</mo>
<msub>
<mi>m</mi>
<mn>0</mn>
</msub>
<msub>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>0</mn>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mi>k</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>k</mi>
</msub>
<mo>+</mo>
<msub>
<mi>r</mi>
<mi>k</mi>
</msub>
<mo>&times;</mo>
<msub>
<mi>m</mi>
<mi>k</mi>
</msub>
<msub>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mrow>
<mi>J</mi>
<mi>k</mi>
</mrow>
</msub>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>J</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>r</mi>
<mrow>
<mi>J</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>&times;</mo>
<msub>
<mi>m</mi>
<mrow>
<mi>J</mi>
<mi>k</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>J</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
其中，m0为基座质量、r0为基座位置矢量、为基座位置矢量变化率、n为机械臂关节数、mk为第k个臂杆质量、为第k个臂杆的质心位置矢量变化率、mJk为机械臂第k个关节质量、为机械臂第k个关节电机质心位置矢量变化率、I0为基座惯性矩阵、ω0为基座角速度矢量、Ik为机械臂第k个臂杆惯性矩阵、ωk为机械臂第k个臂杆角速度矢量、rk为第k个臂杆质心位置矢量、为第k个臂杆质心位置矢量变化率、IJk为机械臂第k个关节惯性矩阵、ωJk为机械臂第k个关节角速度矢量、rJk为机械臂第k个关节电机质心位置矢量。
5.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤三中当前时刻空间自由漂浮机器人的平动耦合矩阵Hs和转动耦合矩阵Hθ为：
<mrow>
<msub>
<mi>H</mi>
<mi>s</mi>
</msub>
<mo>=</mo>
<mi>M</mi>
<msub>
<mover>
<mi>r</mi>
<mo>~</mo>
</mover>
<mrow>
<mn>0</mn>
<mi>g</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>r</mi>
<mo>~</mo>
</mover>
<mrow>
<mn>0</mn>
<mi>g</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>H</mi>
<mi>&omega;</mi>
</msub>
</mrow>
<mrow>
<msub>
<mi>H</mi>
<mi>&theta;</mi>
</msub>
<mo>=</mo>
<msub>
<mi>H</mi>
<mrow>
<mi>&omega;</mi>
<mi>&phi;</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>r</mi>
<mo>~</mo>
</mover>
<mrow>
<mn>0</mn>
<mi>g</mi>
</mrow>
</msub>
<msub>
<mi>J</mi>
<mrow>
<mi>T</mi>
<mi>&omega;</mi>
</mrow>
</msub>
</mrow>
其中，M为系统总质量，为基座质心与系统质心的相对位置矢量，Hω为转动惯量矩阵，Hωφ为角动量矩阵，JTω为旋转惯性矩阵，～表示向量叉乘。
6.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤四中当前时刻基座角速度矢量ω0为：
<mrow>
<msub>
<mi>&omega;</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msubsup>
<mi>H</mi>
<mi>s</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mi>L</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>r</mi>
<mo>~</mo>
</mover>
<mrow>
<mn>0</mn>
<mi>g</mi>
</mrow>
</msub>
<msub>
<mi>P</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<msub>
<mi>H</mi>
<mi>&theta;</mi>
</msub>
<mover>
<mi>&Theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
其中，P0和L0为空间自由漂浮机器人的初始线动量和初始角动量，为基座相对于质心的相对位置矢量，Hs、Hθ分别为平动耦合矩阵和转动耦合矩阵，为机械臂关节角速度，～表示向量叉乘。
7.根据权利要求1所述的一种空间自由漂浮机器人的基座扰动计算方法，其特征在于：所述步骤五中下一计算周期的基座姿态角矢量θ(t+T)为：
<mrow>
<mi>&theta;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&theta;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>T</mi>
<mo>&CenterDot;</mo>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
式中
其中，ω0为当前时刻基座的姿态角速度矢量，θ(t)为t时刻基座姿态角矢量，为t时刻基座姿态角矢量变化率，分别为基座的滚动角变化率、偏航角变化率及俯仰角变化率，分别为基座的滚动角、偏航角及俯仰角。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201711162977.3A CN107967241B (zh) | 2017-11-21 | 2017-11-21 | 一种空间自由漂浮机器人的基座扰动计算方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201711162977.3A CN107967241B (zh) | 2017-11-21 | 2017-11-21 | 一种空间自由漂浮机器人的基座扰动计算方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107967241A true CN107967241A (zh) | 2018-04-27 |
| CN107967241B CN107967241B (zh) | 2021-04-13 |
Family
ID=62001452
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201711162977.3A Active CN107967241B (zh) | 2017-11-21 | 2017-11-21 | 一种空间自由漂浮机器人的基座扰动计算方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107967241B (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111098299A (zh) * | 2019-12-06 | 2020-05-05 | 上海航天控制技术研究所 | 一种空间机器人扰动补偿的方法 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105242537A (zh) * | 2015-09-25 | 2016-01-13 | 哈尔滨工业大学深圳研究生院 | 一种辨识空间机器人动力学参数的方法 |
| CN107263466A (zh) * | 2017-05-11 | 2017-10-20 | 西北工业大学 | 空间机器人基于二次规划问题的基座无扰控制方法 |
-
2017
- 2017-11-21 CN CN201711162977.3A patent/CN107967241B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105242537A (zh) * | 2015-09-25 | 2016-01-13 | 哈尔滨工业大学深圳研究生院 | 一种辨识空间机器人动力学参数的方法 |
| CN107263466A (zh) * | 2017-05-11 | 2017-10-20 | 西北工业大学 | 空间机器人基于二次规划问题的基座无扰控制方法 |
Non-Patent Citations (5)
| Title |
|---|
| CHU ZHONGYI等: ""Disturbance Observer-Based Robust Control of Free-Floating Space Manipulators"", 《IEEE SYSTEMS JOURNAL》 * |
| LINGLING SHI等: ""Attitude regulation of a free-flying space robot during contact operations"", 《2016 IEEE AEROSPACE CONFERENCE》 * |
| S. DUBOWSKY等: ""Path planning for space manipulators to minimize spacecraft attitude disturbances"", 《PROCEEDINGS. 1991 IEEE INTERNATIONAL CONFERENCE ON ROBOTICS AND AUTOMATION》 * |
| 徐文福等: ""保持基座稳定的双臂空间机器人轨迹规划研究"", 《自动化学报》 * |
| 洪炳镕等: ""自由飞行空间机器人运动控制及仿真"", 《自由飞行空间机器人运动控制及仿真》 * |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111098299A (zh) * | 2019-12-06 | 2020-05-05 | 上海航天控制技术研究所 | 一种空间机器人扰动补偿的方法 |
| CN111098299B (zh) * | 2019-12-06 | 2021-09-07 | 上海航天控制技术研究所 | 一种空间机器人扰动补偿的方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107967241B (zh) | 2021-04-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Wang et al. | Coordinated trajectory planning of dual-arm space robot using constrained particle swarm optimization | |
| CN106985139A (zh) | 基于扩展状态观测与补偿的空间机器人自抗扰协调控制方法 | |
| CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
| Gao et al. | Multi-objective robust $ H_ {\infty} $ control of spacecraft rendezvous | |
| Rodic et al. | Control of a Quadrotor Flight | |
| CN109164824B (zh) | 一种考虑飞轮不确定性的航天器姿态控制方法 | |
| Zhou et al. | Robust prescribed performance tracking control for free-floating space manipulators with kinematic and dynamic uncertainty | |
| CN106945020A (zh) | 一种空间双机械臂系统运动协调控制方法 | |
| Zhang et al. | Effective motion planning strategy for space robot capturing targets under consideration of the berth position | |
| Nguyen-Huynh et al. | Adaptive reactionless motion for space manipulator when capturing an unknown tumbling target | |
| CN111880410B (zh) | 一种针对电机故障的四旋翼无人机容错控制方法 | |
| CN105116914B (zh) | 一种平流层飞艇解析模型预测路径跟踪控制方法 | |
| Xu et al. | Autonomous path planning and experiment study of free-floating space robot for target capturing | |
| CN108445768A (zh) | 空间机器人操作空间轨迹跟踪的增广自适应模糊控制方法 | |
| Qin et al. | Fuzzy adaptive robust control for space robot considering the effect of the gravity | |
| Xu et al. | Modeling and planning of a space robot for capturing tumbling target by approaching the dynamic closest point | |
| Zhang et al. | Integrated translational and rotational control for the terminal landing phase of a lunar module | |
| CN107696033A (zh) | 一种基于视觉测量的空间机械臂轨迹滚动规划方法 | |
| Hu et al. | Recursive decentralized control for robotic manipulators | |
| Zhang et al. | Manipulator-actuated adaptive integrated translational and rotational stabilization for spacecraft in proximity operations with control constraint | |
| Huang et al. | Ground-based experiment of capturing space debris based on artificial potential field | |
| CN108427429B (zh) | 一种考虑动态指向约束的航天器视轴机动控制方法 | |
| She et al. | Quasi-model free control for the post-capture operation of a non-cooperative target | |
| Rigatos et al. | Nonlinear optimal control for a spherical rolling robot | |
| CN107967241A (zh) | 一种空间自由漂浮机器人的基座扰动计算方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |