CN108469737A - 一种空间非合作目标导航捕获的动力学控制方法及*** - Google Patents

一种空间非合作目标导航捕获的动力学控制方法及*** Download PDF

Info

Publication number
CN108469737A
CN108469737A CN201810401080.XA CN201810401080A CN108469737A CN 108469737 A CN108469737 A CN 108469737A CN 201810401080 A CN201810401080 A CN 201810401080A CN 108469737 A CN108469737 A CN 108469737A
Authority
CN
China
Prior art keywords
space
arm
pedestal
armed lever
mechanical arm
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
Application number
CN201810401080.XA
Other languages
English (en)
Other versions
CN108469737B (zh
Inventor
葛东明
王大轶
史纪鑫
谢宁
邹元杰
邓润然
朱卫红
柳翠翠
仲维昆
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Spacecraft System Engineering
Original Assignee
Beijing Institute of Spacecraft System Engineering
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Spacecraft System Engineering filed Critical Beijing Institute of Spacecraft System Engineering
Priority to CN201810401080.XA priority Critical patent/CN108469737B/zh
Publication of CN108469737A publication Critical patent/CN108469737A/zh
Application granted granted Critical
Publication of CN108469737B publication Critical patent/CN108469737B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

一种空间非合作目标导航捕获的动力学控制方法及***，针对空间机器人在轨抓取自旋或翻滚非合作目标的导航捕获问题，本文给出了一种空间非合作目标导航捕获的动力学控制方法。首先，建立了空间机器人***动能解析式描述。其次，建立了空间机器人的运动学方程。最后，利用第二类拉格朗日方程和伪坐标方程，建立了解析式的空间机器人***运动学和动力学模型。此方法基于矢量力学理论方法推导得到，采用矩阵和向量运算，且方程为解析式表达式，物理意义清晰。此方法便于对空间机器人***的运动学和动力学进行耦合分析、便于基于模型的动力学控制算法实现，且计算量小，便于控制算法的实时计算。

Description

一种空间非合作目标导航捕获的动力学控制方法及***
技术领域
本发明涉及一种空间非合作目标导航捕获的动力学控制方法及***，属于动力学控制技术领域。
背景技术
空间机器人在轨服务在未来空间活动中将起到越来越重要的作用，如卫星维修、大型空间结构建造、空间碎片清除等任务，以降低航天员出舱风险和提高工作效率。在轨服务特别适合于非合作卫星，由于故障卫星一般不具备专门的抓捕装置，且往往处于自旋或翻滚状态，对抓捕操作带来严峻挑战。
空间机器人与地面机械臂的主要差别在于空间机器人的基座不是固定在地面上，而是工作在微重力环境中。机械臂和基座在动力学与运动学上是耦合的，即机械臂的运动会对航天器平台产生反作用力和力矩，使得***运动学和动力学分析十分复杂。因此，一个精确，高效的空间机器人***模型对于基于模型的控制器是至关重要的，特别是对于复杂的抓捕操作，其有助于实现更好的控制性能。
采用树形拓扑结构描述开链多体***，可以采用牛顿-欧拉、拉格朗日描述和凯恩方法描述多机械臂***。这种传统的递推动力学描述主要适用于多体动力学分析，不便于基于模型的控制算法设计和开发。早期的空间机器人动力学建模方法主要关注自由漂浮工作模式。采用虚拟臂方法描述自由漂浮空间机器人***的运动学和动力学。采用广义雅克比矩阵进行逆运动学求解。但是，自由漂浮***由于***质心位置不变，其工作空间是受限的。特别是在抓捕动目标时，工作空间动力学奇异性会导致***稳定性问题。目前这些方法在应用中有如下局限性：1)大多假设基座处于自由漂浮状态，即基座不受任何控制；2)动力学模型多为迭代递归形式，不满足控制算法的推导和实现；3)模型计算量大，不满足控制算法的实时性要求。
发明内容
本发明解决的技术问题为：克服现有技术的不足，针对空间机器人在轨抓取自旋或翻滚非合作目标的相对导航问题，本文给出了一种空间非合作目标导航捕获的动力学建模方法。通过此方法，可以给出解析式的空间机器人***运动学和动力学模型，适用于***动力学分析、基于模型的控制算法推导和程序实现。
本发明解决的技术方案为：一种空间非合作目标导航捕获的动力学控制方法，步骤如下：
(1)建立多臂空间机器人***的基座和机械臂臂杆的动能表达式；
(2)建立多臂空间机器人***运动学方程；
(3)根据步骤(1)多臂空间机器人的基座和机械臂臂杆的动能表达式和步骤(2)多臂空间机器人***运动学方程，建立***动力学方程，利用***动力学方程，实现多臂空间机器人***的控制。
步骤(1)建立多臂空间机器人***的基座和机械臂臂杆的动能表达式，具体步骤如下：
(1.1)设定基座的动能表达式为
其中，v0和ω0为基座相对于惯性系的速度和角速度，m0为基座的质量，P0为基座的静矩，I0为基座的转动惯量阵。
(1.2)设定多臂空间机器人***的第m个机械臂的第k个臂杆的动能表达式为
式中，和为臂杆相对于惯性系的速度和角速度，为臂杆的质量，为臂杆的静矩，为臂杆的转动惯量阵。
(1.3)设定中间变量，令
步骤(2)建立多臂空间机器人***运动学方程，步骤如下：
(2.1)定义臂杆之间的关节的转动方向为Z轴，那么，第m个机械臂的第k个臂杆和第k-1个臂杆(当k取1的时候，第k-1个臂杆相当于基座)之间的连接关系式为
式中，
为第k个臂杆的转动关节角，为第k个臂杆参考系在第k-1个臂杆参考系的位置矢量，为其斜对称矩阵，为第k-1个臂杆参考系到第k个臂杆参考系的转换矩阵，为第k个臂杆参考系的Z轴。
(2.2)令：
其中，diag(·)代表对角矩阵。
(2.3)整理式(5)，得
令：
(2.4)进一步整理式(9)为
其中，
(2.5)对于第m个机械臂的末端，其运动学关系式为
(2.6)令：
则式(14)描述为：
式(17)为多臂空间机器人***运动学方程，即第m个机械臂末端与基座速度、机械臂关节速度的关系。其中，和分别为基座和机械臂的雅克比矩阵，具体由机械臂的几何参数组成。
步骤(3)根据步骤(1)多臂空间机器人的基座和机械臂臂杆的动能表达式和步骤(2)多臂空间机器人***运动学方程，建立***动力学方程，利用***动力学方程，实现多臂空间机器人***的控制，具体步骤如下：
(3.1)将式(14)代入公式(2)，得第m个机械臂的动能表达式：
其中：
(3.2)令
则多臂空间机器人***动能表达式为
其中q＝[q(1),q(2),...,q(n)]T，
(3.3)将式(23)的M(q)划分为
(3.4)利用广义坐标和伪坐标形式的Lagrange方程，分别对式(22)中的基座伪坐标和广义坐标求解，得到***动力学方程
其中，广义坐标和伪坐标形式的Lagrange方程如下
其中，Qk为对应全部主动力的广义力，F0为本体所受外力，T0为本体所受外力矩，是ω0的斜对称矩阵。
(3.5)***动力学方程如下：
T＝[F0 T0 τ(1) τ(2)...τ(n)]T (58)
其中， 是ω0的斜对称矩阵，是v0的斜对称矩阵，τ(m)为第m个机械臂的关节驱动力矩；
(3.6)利用***动力学方程，实现多臂空间机器人的控制。
多臂空间机器人***，包括：基座、多个多关节机械臂，将空间机器人划分为基座和各个机械臂；机械臂由若干个臂杆组成，臂杆之间通过转动关节连接，***各个体为刚体，即多刚体动力学***。
基座配置有力和力矩执行器，如推力器，实现基座的位置和姿态控制。
基座作为机械臂的安装基础，负责空间机器人整体的位置和姿态保持或机动。
机械臂可以为多机械臂形式，每个机械臂的自由度至少为6
所给出的运动学和动力学方程为独立坐标形式的解析式表达式。
非合作目标不具备与空间机器人的信息互通，其运动状态可以为姿态稳定或姿态翻滚。
本发明的一种空间非合作目标导航捕获的动力学控制***，包括：第一建立模块、第二建立模块、控制模块；
第一建立模块建立多臂空间机器人***的基座和机械臂臂杆的动能表达式；第二建立模块建立多臂空间机器人***运动学方程；控制模块根据第一建立模块中多臂空间机器人的基座和机械臂臂杆的动能表达式和第二建立模块中多臂空间机器人***运动学方程，建立***动力学方程，利用***动力学方程，实现多臂空间机器人***的控制。
本发明与现有技术相比的优点在于：
(1)本发明实现了对空间机器人***的运动学和动力学的解析式模型描述。采用矢量力学理论方法，选择基于矩阵和矢量的数学运算，采用独立坐标形式的第二类拉格朗日方程，建立解析式的空间机器人***的运动学和动力学方程。
(2)本发明便于对空间机器人***的运动学和动力学进行耦合分析。方程表现为解析式的计算方程，物理意义清晰，便于分析关键质量和几何参数对***运动学和动力学的耦合影响。
(3)本发明便于基于模型的控制算法实现，计算量小，便于控制算法的实时计算。基于此动力学方程，可以实现机械臂臂杆之间的动力学耦合补偿，和机械臂与基座之间的动力学耦合补偿，从而实现机械臂关节空间的解耦控制，和机械臂与基座之间的解耦控制，可以显著提高空间机器人***的控制性能。
(4)本发明给出的运动学和动力学方程，便于编程和软件实现，可以与控制***联合仿真，仿真验证动力学与控制***的闭环控制性能。
(5)本发明给出的计算方程为开放式的数学描述，便于实现计算代码输出，基于半模型、半硬件的控制***半物理仿真。
附图说明
图1为本发明方法的流程框图；
图2为空间机器人动力学示意图；
图3为动力学方程与商用多体软件Adams的响应对比图，其中(a)为机械臂1末端速度示意图；(b)为机械臂2末端速度示意图；(c)为机械臂1末端角速度示意图；(d)为机械臂2末端角速度示意图；
图4为双臂机器人动力学阻抗控制响应图；其中，(a)为机械臂末端的位移示意图；(b)为机械臂1的关节角示意图；(c)为机械臂2的关节角示意图。
具体实施方式
下面结合附图和具体实施例对本发明做进一步详细描述。
本发明一种空间非合作目标导航捕获的动力学控制方法，针对空间机器人在轨抓取自旋或翻滚非合作目标的导航捕获问题，本文给出了一种空间非合作目标导航捕获的动力学控制方法。首先，建立了空间机器人***动能解析式描述。其次，建立了空间机器人的运动学方程。最后，利用第二类拉格朗日方程和伪坐标方程，建立了解析式的空间机器人***运动学和动力学模型。此方法基于矢量力学理论方法推导得到，采用矩阵和向量运算，且方程为解析式表达式，物理意义清晰。此方法便于对空间机器人***的运动学和动力学进行耦合分析、便于基于模型的动力学控制算法实现，且计算量小，便于控制算法的实时计算。
本发明所研究的多臂空间机器人由基座、多个多关节机械臂组成。根据图2，本发明将空间机器人划分为基座和各个机械臂；机械臂由若干个臂杆和关节组成，臂杆之间通过关节连接，关节可以沿着一个轴转动，驱动机械臂的每个关节，即可以实现机械臂的受控运动。***各个体为刚体，即多刚体动力学***。本发明中，首先对基座、各个臂杆建立动能表达式，其次根据基座和各个臂杆之间的连接条件，建立***运动学关系式，最后，推到出***动能，利用第二类拉格朗日描述，得到解析式的***动力学方程。
整个发明的实施流程如图1所示。具体实施方式详述如下：
(1)建立各体的动能表达式，本发明给出的计算方程为开放式的数学描述，便于实现计算代码输出，基于半模型、半硬件的控制***半物理仿真。
设定基座的动能表达式为
其中，v0和ω0为基座相对于惯性系的速度和角速度，m0为基座的质量，P0为基座的静矩，由基座的质量特性给出，I0为基座的转动惯量阵，由基座的质量特性给出，1为3*3的单位阵。
同样地，设定第m个机械臂的第k个臂杆的动能表达式为
其中，和分别为第m个机械臂的第k个臂杆相对于惯性系的速度和角速度，为臂杆的质量，为臂杆的静矩，为臂杆的转动惯量阵，n为机械臂的总数，Nm表示第m个机械臂的自由度。
定义中间变量M0、令：
(2)建立***运动学方程，本发明给出的计算方程为开放式的数学描述，便于实现计算代码输出，基于半模型、半硬件的控制***半物理仿真。
定义臂杆之间的关节的转动方向为Z轴，那么，第m个机械臂的第k个臂杆和第k-1个臂杆(当k取1的时候，第k-1个臂杆相当于基座)之间的连接关系式为
其中
为第k个臂杆的转动关节角，为第k个臂杆参考系在第k-1个臂杆(或基座)参考系的位置矢量，为其斜对称矩阵，为第k-1个臂杆参考系到第k个臂杆参考系的转换矩阵，为第k个臂杆参考系的Z轴， 分别为第m个机械臂的第k-1个臂杆相对于惯性系的速度和角速度；
设定中间变量和令
其中，diag(·)代表对角矩阵；
整理式(5)，得
令
进一步整理式(9)为
其中，
那么，对于第m个机械臂的末端，其运动学关系式为
令
则式(14)描述为
式(17)为多臂空间机器人***运动学方程，即第m个机械臂末端与基座速度、机械臂关节速度的关系。其中，和分别为基座和机械臂的雅克比矩阵，具体由机械臂的几何参数组成。
(3)建立***动力学方程，本发明给出的运动学和动力学方程，便于编程和软件实现，可以与控制***联合仿真，仿真验证动力学与控制***的闭环控制性能。
将式(14)代入公式(2)，得第m个机械臂的动能表达式：
其中：
令
那么，多臂空间机器人***动能表达式为
其中q＝[q(1),q(2),...,q(n)]T，
将式(23)的M(q)划分为
广义坐标和伪坐标形式的Lagrange方程如下
其中，Qk为对应全部主动力的广义力，F0为本体所受外力，T0为本体所受外力矩，是ω0的斜对称矩阵。
利用式(25)和式(26)，分别对式(22)中的基座伪坐标和广义坐标求解，得到***动力学方程
T＝[F0 T0 τ(1) τ(2)...τ(n)]T (87)
其中， 是ω0的斜对称矩阵，是v0的斜对称矩阵，τ(m)为第m个机械臂的关节驱动力矩。
利用***动力学方程，实现多臂空间机器人的控制。
本发明便于基于模型的控制算法实现，计算量小，便于控制算法的实时计算。基于此动力学方程，可以实现机械臂臂杆之间的动力学耦合补偿，和机械臂与基座之间的动力学耦合补偿，从而实现机械臂关节空间的解耦控制，和机械臂与基座之间的解耦控制，可以显著提高空间机器人***的控制性能。
(4)模型校验和控制应用
以带两个6自由度机械臂的空间机器人为例，验证所给出的动力学建模方法的正确性。在本体和机械臂关节端分别施加力和力矩，采用商用多体动力学建模软件Adams建立同样模型和激励，对比机械臂末端的速度和角速度时间响应，如图3的(a)、(b)、(c)、(d)所示。可以看出，所给出的动力学建模方法与商用多体动力学建模软件的仿真结果一致性较好，说明了所给出的动力学建模方法的正确性和有效性。
利用所给出的动力学建模方法，建立双臂空间机器人的***动力学方程，并应用于双臂空间机器人的阻抗控制中。在双机械臂的末端沿轴向分别施加2N和1N的作用力，控制机械臂抵抗此作用力，以保证机械臂末端相对于惯性空间的位置和姿态的稳定性。控制效果如图4的(a)、(b)、(c)所示，可以看出，机械臂末端经过一个过渡过程后，稳定在了一定的数值上，保持了相对于惯性空间的稳定性，机械臂关节角经过一个调整过程，也稳定在了一定的数值上，保持了机械臂构型的稳定性。由于基于此动力学模型的控制，消除了控制通道在动力学上的耦合项，***控制性能可以较为精确的实现所期望的控制特性。
本发明的一种空间非合作目标导航捕获的动力学控制***，包括：第一建立模块、第二建立模块、控制模块；
第一建立模块建立多臂空间机器人***的基座和机械臂臂杆的动能表达式；第二建立模块建立多臂空间机器人***运动学方程；控制模块根据第一建立模块中多臂空间机器人的基座和机械臂臂杆的动能表达式和第二建立模块中多臂空间机器人***运动学方程，建立***动力学方程，利用***动力学方程，实现多臂空间机器人***的控制。
第一建立模块，建立各体的动能表达式，本发明给出的计算方程为开放式的数学描述，便于实现计算代码输出，基于半模型、半硬件的控制***半物理仿真。
设定基座的动能表达式为
其中，v0和ω0为基座相对于惯性系的速度和角速度，m0为基座的质量，P0为基座的静矩，由基座的质量特性给出，I0为基座的转动惯量阵，由基座的质量特性给出，1为3*3的单位阵。
同样地，设定第m个机械臂的第k个臂杆的动能表达式为
其中，和分别为第m个机械臂的第k个臂杆相对于惯性系的速度和角速度，为臂杆的质量，为臂杆的静矩，为臂杆的转动惯量阵，n为机械臂的总数，Nm表示第m个机械臂的自由度。
定义中间变量M0、令：
第二建立模块建立***运动学方程，本发明给出的计算方程为开放式的数学描述，便于实现计算代码输出，基于半模型、半硬件的控制***半物理仿真。
定义臂杆之间的关节的转动方向为Z轴，那么，第m个机械臂的第k个臂杆和第k-1个臂杆(当k取1的时候，第k-1个臂杆相当于基座)之间的连接关系式为
其中
为第k个臂杆的转动关节角，为第k个臂杆参考系在第k-1个臂杆(或基座)参考系的位置矢量，为其斜对称矩阵，为第k-1个臂杆参考系到第k个臂杆参考系的转换矩阵，为第k个臂杆参考系的Z轴， 分别为第m个机械臂的第k-1个臂杆相对于惯性系的速度和角速度；
设定中间变量和令
其中，diag(·)代表对角矩阵；
整理式(5)，得
令
进一步整理式(9)为
其中，
那么，对于第m个机械臂的末端，其运动学关系式为
令
则式(14)描述为
式(17)为多臂空间机器人***运动学方程，即第m个机械臂末端与基座速度、机械臂关节速度的关系。其中，和分别为基座和机械臂的雅克比矩阵，具体由机械臂的几何参数组成。
控制模块，建立***动力学方程，本发明给出的运动学和动力学方程，便于编程和软件实现，可以与控制***联合仿真，仿真验证动力学与控制***的闭环控制性能。利用***动力学方程，实现多臂空间机器人***的控制。
将式(14)代入公式(2)，得第m个机械臂的动能表达式：
其中：
令
那么，多臂空间机器人***动能表达式为
其中q＝[q(1),q(2),...,q(n)]T，
将式(23)的M(q)划分为
广义坐标和伪坐标形式的Lagrange方程如下
其中，Qk为对应全部主动力的广义力，F0为本体所受外力，T0为本体所受外力矩，是ω0的斜对称矩阵。
利用式(25)和式(26)，分别对式(22)中的基座伪坐标和广义坐标求解，得到***动力学方程
T＝[F0 T0 τ(1) τ(2)...τ(n)]T (116)
其中， 是ω0的斜对称矩阵，是v0的斜对称矩阵，τ(m)为第m个机械臂的关节驱动力矩。
利用***动力学方程，实现多臂空间机器人的控制。
本发明便于基于模型的控制算法实现，计算量小，便于控制算法的实时计算。基于此动力学方程，可以实现机械臂臂杆之间的动力学耦合补偿，和机械臂与基座之间的动力学耦合补偿，从而实现机械臂关节空间的解耦控制，和机械臂与基座之间的解耦控制，可以显著提高空间机器人***的控制性能。
本发明实现了对空间机器人***的运动学和动力学的解析式模型描述。采用矢量力学理论方法，选择基于矩阵和矢量的数学运算，采用独立坐标形式的第二类拉格朗日方程，建立解析式的空间机器人***的运动学和动力学方程，实现了对空间机器人***的控制。
本发明便于对空间机器人***的运动学和动力学进行耦合分析。方程表现为解析式的计算方程，物理意义清晰，便于分析关键质量和几何参数对***运动学和动力学的耦合影响。

Claims (10)

1.一种空间非合作目标导航捕获的动力学控制方法，其特征在于步骤如下：
(1)建立多臂空间机器人***的基座和机械臂臂杆的动能表达式；
(2)建立多臂空间机器人***运动学方程；
(3)根据步骤(1)多臂空间机器人的基座和机械臂臂杆的动能表达式和步骤(2)多臂空间机器人***运动学方程，建立***动力学方程，利用***动力学方程，实现多臂空间机器人***的控制。
2.根据权利要求1所述的一种空间非合作目标导航捕获的动力学控制方法，其特征在于：步骤(1)建立多臂空间机器人***的基座和机械臂臂杆的动能表达式，具体步骤如下：
(1.1)设定基座的动能表达式为
其中，v0和ω0为基座相对于惯性系的速度和角速度，m0为基座的质量，P0为基座的静矩，I0为基座的转动惯量阵；
(1.2)设定多臂空间机器人***的第m个机械臂的第k个臂杆的动能表达式为
式中，和为臂杆相对于惯性系的速度和角速度，为臂杆的质量，为臂杆的静矩，为臂杆的转动惯量阵；
(1.3)设定中间变量，令
3.根据权利要求1所述的一种空间非合作目标导航捕获的动力学控制方法，其特征在于：步骤(2)建立多臂空间机器人***运动学方程，步骤如下：
(2.1)定义臂杆之间的关节的转动方向为Z轴，那么，第m个机械臂的第k个臂杆和第k-1个臂杆之间的连接关系式为：
式中，
为第k个臂杆的转动关节角，为第k个臂杆参考系在第k-1个臂杆参考系的位置矢量，为其斜对称矩阵，为第k-1个臂杆参考系到第k个臂杆参考系的转换矩阵，为第k个臂杆参考系的Z轴；
(2.2)令：
其中，diag(·)代表对角矩阵；
(2.3)整理式(5)，得
令：
(2.4)进一步整理式(9)为
其中，
(2.5)对于第m个机械臂的末端，其运动学关系式为
(2.6)令：
则式(14)描述为：
式(17)为多臂空间机器人***运动学方程，即第m个机械臂末端与基座速度、机械臂关节速度的关系；其中，和分别为基座和机械臂的雅克比矩阵，由机械臂的几何参数组成。
4.根据权利要求1所述的一种空间非合作目标导航捕获的动力学控制方法，其特征在于：步骤(3)根据步骤(1)多臂空间机器人的基座和机械臂臂杆的动能表达式和步骤(2)多臂空间机器人***运动学方程，建立***动力学方程，利用***动力学方程，实现多臂空间机器人***的控制，具体步骤如下：
(3.1)将式(14)代入公式(2)，得第m个机械臂的动能表达式：
其中：
(3.2)令
则多臂空间机器人***动能表达式为
其中q＝[q(1),q(2),...,q(n)]T，
(3.3)将式(23)的M(q)划分为
(3.4)利用广义坐标和伪坐标形式的Lagrange方程，分别对式(22)中的基座伪坐标和广义坐标求解，得到***动力学方程
其中，广义坐标和伪坐标形式的Lagrange方程如下
其中，Qk为对应全部主动力的广义力，F0为本体所受外力，T0为本体所受外力矩，是ω0的斜对称矩阵；
(3.5)***动力学方程如下：
T＝[F0T0τ(1)τ(2)...τ(n)]T (29)
其中， 是ω0的斜对称矩阵，是v0的斜对称矩阵，τ(m)为第m个机械臂的关节驱动力矩；
(3.6)利用***动力学方程，实现多臂空间机器人的控制。
5.根据权利要求1所述的一种空间非合作目标导航捕获的动力学控制方法，其特征在于：多臂空间机器人***，包括：基座、多个多关节机械臂，将空间机器人划分为基座和各个机械臂；机械臂由若干个臂杆组成，臂杆之间通过转动关节连接，***各个体为刚体，即多刚体动力学***。
6.根据权利要求1所述的一种空间非合作目标导航捕获的动力学控制方法，其特征在于：基座配置有力和力矩执行器，力矩执行器选用推力器，实现基座的位置和姿态控制。
7.根据权利要求1所述的一种空间非合作目标导航捕获的动力学控制方法，其特征在于：基座作为机械臂的安装基础，负责空间机器人整体的位置和姿态保持或机动。
8.根据权利要求1所述的一种空间非合作目标导航捕获的动力学控制方法，其特征在于：机械臂能够为多机械臂形式，每个机械臂的自由度至少为6。
9.根据权利要求1所述的一种空间非合作目标导航捕获的动力学控制方法，其特征在于：运动学和动力学方程为独立坐标形式的解析式表达式。
10.一种空间非合作目标导航捕获的动力学控制***，其特征在于包括：第一建立模块、第二建立模块、控制模块；
第一建立模块建立多臂空间机器人***的基座和机械臂臂杆的动能表达式；第二建立模块建立多臂空间机器人***运动学方程；控制模块根据第一建立模块中多臂空间机器人的基座和机械臂臂杆的动能表达式和第二建立模块中多臂空间机器人***运动学方程，建立***动力学方程，利用***动力学方程，实现多臂空间机器人***的控制。
CN201810401080.XA 2018-04-28 2018-04-28 一种空间非合作目标导航捕获的动力学控制方法及*** Active CN108469737B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810401080.XA CN108469737B (zh) 2018-04-28 2018-04-28 一种空间非合作目标导航捕获的动力学控制方法及***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810401080.XA CN108469737B (zh) 2018-04-28 2018-04-28 一种空间非合作目标导航捕获的动力学控制方法及***

Publications (2)

Publication Number Publication Date
CN108469737A true CN108469737A (zh) 2018-08-31
CN108469737B CN108469737B (zh) 2021-06-11

Family

ID=63263915

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810401080.XA Active CN108469737B (zh) 2018-04-28 2018-04-28 一种空间非合作目标导航捕获的动力学控制方法及***

Country Status (1)

Country Link
CN (1) CN108469737B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109625333A (zh) * 2019-01-03 2019-04-16 西安微电子技术研究所 一种基于深度增强学习的空间非合作目标捕获方法
CN110348049A (zh) * 2019-06-03 2019-10-18 南京航空航天大学 单边约束情况下估计空间非合作目标动力学参数的方法
CN111975770A (zh) * 2020-07-29 2020-11-24 西北工业大学 一种采用空间双臂机器人的自旋目标抓捕方法
CN113821935A (zh) * 2021-09-30 2021-12-21 合肥工业大学 基于对称约束的动力学模型的建立方法及其***
CN115870972A (zh) * 2022-09-28 2023-03-31 南京航空航天大学 一种多机器人卫星的协同操控方法
CN117131704A (zh) * 2023-09-22 2023-11-28 中山大学 一种面向机器人在轨组装的耦合动力学建模方法及***

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8027741B2 (en) * 2008-05-29 2011-09-27 The United States Of America As Represented By The Secretary Of The Navy System and method of improved kalman filtering for estimating the state of a dynamic system
US20150267619A1 (en) * 2012-02-15 2015-09-24 Rolls-Royce Corporation Gas turbine engine performance seeking control
CN106502260A (zh) * 2016-12-01 2017-03-15 西北工业大学 空间绳系机器人抓捕挠性目标卫星后的姿态接管控制方法
CN106625671A (zh) * 2016-12-27 2017-05-10 西北工业大学 一种空间机器人抓捕翻滚目标的最优轨迹规划方法
CN107153354A (zh) * 2017-05-26 2017-09-12 西北工业大学 一种输入受限的空间非合作目标可控质量边界确定方法
CN107169196A (zh) * 2017-05-11 2017-09-15 西北工业大学 空间机器人由末端执行器向基座的动力学建模方法
CN107270933A (zh) * 2017-05-16 2017-10-20 北京控制工程研究所 一种基于多星协同的空间碎片运动状态联合确定方法
CN107490965A (zh) * 2017-08-21 2017-12-19 西北工业大学 一种空间自由漂浮机械臂的多约束轨迹规划方法
CN107529630A (zh) * 2017-06-23 2018-01-02 西北工业大学 一种空间机器人建立动力学模型的方法
CN107797449A (zh) * 2017-09-27 2018-03-13 西北工业大学深圳研究院 一种信息不完备情形下的空间非合作目标接管控制方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8027741B2 (en) * 2008-05-29 2011-09-27 The United States Of America As Represented By The Secretary Of The Navy System and method of improved kalman filtering for estimating the state of a dynamic system
US20150267619A1 (en) * 2012-02-15 2015-09-24 Rolls-Royce Corporation Gas turbine engine performance seeking control
CN106502260A (zh) * 2016-12-01 2017-03-15 西北工业大学 空间绳系机器人抓捕挠性目标卫星后的姿态接管控制方法
CN106625671A (zh) * 2016-12-27 2017-05-10 西北工业大学 一种空间机器人抓捕翻滚目标的最优轨迹规划方法
CN107169196A (zh) * 2017-05-11 2017-09-15 西北工业大学 空间机器人由末端执行器向基座的动力学建模方法
CN107270933A (zh) * 2017-05-16 2017-10-20 北京控制工程研究所 一种基于多星协同的空间碎片运动状态联合确定方法
CN107153354A (zh) * 2017-05-26 2017-09-12 西北工业大学 一种输入受限的空间非合作目标可控质量边界确定方法
CN107529630A (zh) * 2017-06-23 2018-01-02 西北工业大学 一种空间机器人建立动力学模型的方法
CN107490965A (zh) * 2017-08-21 2017-12-19 西北工业大学 一种空间自由漂浮机械臂的多约束轨迹规划方法
CN107797449A (zh) * 2017-09-27 2018-03-13 西北工业大学深圳研究院 一种信息不完备情形下的空间非合作目标接管控制方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
MAODENG LI: "Study on the Observability Analysis Based on the Trace of Error Covariance Matrix for Spacecraft Autonomous Navigation", 《2013 10TH IEEE INTERNATIONAL CONFERENCE ON CONTROL AND AUTOMATION (ICCA)》 *
葛东明等: "一种柔性空间机械臂的刚体运动和柔性振动复合控制方法", 《空间控制技术与应用》 *
葛东明等: "空间飞行器在轨服务过程解析式动力学建模及控制应用", 《第十届全国多体动力学与控制暨第五届全国航天动力学与控制学术会议》 *

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109625333A (zh) * 2019-01-03 2019-04-16 西安微电子技术研究所 一种基于深度增强学习的空间非合作目标捕获方法
CN109625333B (zh) * 2019-01-03 2021-08-03 西安微电子技术研究所 一种基于深度增强学习的空间非合作目标捕获方法
CN110348049A (zh) * 2019-06-03 2019-10-18 南京航空航天大学 单边约束情况下估计空间非合作目标动力学参数的方法
CN110348049B (zh) * 2019-06-03 2023-04-28 南京航空航天大学 单边约束情况下估计空间非合作目标动力学参数的方法
CN111975770A (zh) * 2020-07-29 2020-11-24 西北工业大学 一种采用空间双臂机器人的自旋目标抓捕方法
CN111975770B (zh) * 2020-07-29 2022-07-26 西北工业大学 一种采用空间双臂机器人的自旋目标抓捕方法
CN113821935A (zh) * 2021-09-30 2021-12-21 合肥工业大学 基于对称约束的动力学模型的建立方法及其***
CN113821935B (zh) * 2021-09-30 2024-02-02 合肥工业大学 基于对称约束的动力学模型的建立方法及其***
CN115870972A (zh) * 2022-09-28 2023-03-31 南京航空航天大学 一种多机器人卫星的协同操控方法
CN117131704A (zh) * 2023-09-22 2023-11-28 中山大学 一种面向机器人在轨组装的耦合动力学建模方法及***

Also Published As

Publication number Publication date
CN108469737B (zh) 2021-06-11

Similar Documents

Publication Publication Date Title
CN108469737A (zh) 一种空间非合作目标导航捕获的动力学控制方法及***
CN106945020B (zh) 一种空间双机械臂***运动协调控制方法
CN106891335B (zh) 一种空间机器人在轨抓捕过程的柔顺与协调控制方法
CN112346470A (zh) 一种基于改进自抗扰控制的四旋翼姿态控制方法
Dongming et al. Impedance control of multi-arm space robot for the capture of non-cooperative targets
CN108527372A (zh) 一种变刚度串联弹性驱动器的机器人关节自适应控制方法
Meng et al. Vibration suppression control of free-floating space robots with flexible appendages for autonomous target capturing
CN112091976B (zh) 一种水下机械臂任务空间控制方法
CN108445768B (zh) 空间机器人操作空间轨迹跟踪的增广自适应模糊控制方法
CN113467501B (zh) 作业飞行机器人动态滑翔抓取与力位混合控制方法
CN106406098A (zh) 一种机器人***在未知环境下的人机交互控制方法
CN105912007A (zh) 空间机械臂抗干扰姿态稳定的微分几何非线性控制方法
Liu et al. Improved RBF network torque control in flexible manipulator actuated by PMAs
CN114347018A (zh) 一种基于小波神经网络的机械臂扰动补偿方法
Peng et al. Modeling and analysis of the multiple dynamic coupling effects of a dual-arm space robotic system
CN110641738A (zh) 一种空间五自由度自由飞行机械臂的轨迹跟踪控制方法
Zhang et al. 3-Degree-of-freedom parallel robot control based fuzzy theory
Bai et al. Extended state observer based attitude control of a bird-like flapping-wing flying robot
Gao et al. Event-triggered tracking control scheme for quadrotors with external disturbances: theory and validations
Yang et al. Research on gravity compensation in motion control of multi-joint robot
Yang et al. Nonlinear disturbance observer based adaptive backstepping control for trajectory tracking of aerial parallel manipulator
CN107728470B (zh) 一种无速率测量的机械臂姿态控制方法
Wei et al. Robotic skills learning based on dynamical movement primitives using a wearable device
Wu et al. Fully-actuated-system-approach-based Attitude-orbit Integrated Control for Spacecraft Formation Flying
CN117195389B (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