CN107450317A - 一种空间机械臂自适应动力学协调控制方法 - Google Patents
一种空间机械臂自适应动力学协调控制方法 Download PDFInfo
- Publication number
- CN107450317A CN107450317A CN201710700713.2A CN201710700713A CN107450317A CN 107450317 A CN107450317 A CN 107450317A CN 201710700713 A CN201710700713 A CN 201710700713A CN 107450317 A CN107450317 A CN 107450317A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mover
- centerdot
- 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.)
- Pending
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种空间机械臂自适应动力学协调控制方法,在深入分析空间机械臂***运动学、动力学特性的基础上,首先对经典的空间机械臂运动学方程进行扩维,得到能够同时描述机械臂末端运动与航天器姿态运动的空间机械臂“扩展运动学方程”。然后,在深入挖掘空间机械臂***动力学方程和角动量守恒方程特性的基础上,分别定义航天器参考速度和关节空间参考速度,并基于此设计空间机械臂自适应动力学协调控制器。本发明公开了一种空间机械臂与基座航天器之间的自适应动力学协调控制方法,能够在***参数存在不确知性的情况下,仅仅通过控制机械臂的运动就可以同时达到机械臂末端轨迹跟踪与基座航天器姿态调节的目的。
Description
技术领域
本发明属于空间机器人在轨维修维护领域,涉及空间机械臂自适应动力学协调控制方法。
背景技术
在轨服务通常由配备有机械臂的追踪航天器(称之为空间机械臂***)来完成。区别于地面机械臂,空间机械臂***的基座不是固定的,机械臂的运动会对基座航天器的姿态造成干扰。考虑到对地通信和对日定向等要求,通常希望机械臂执行任务时对基座航天器姿态无干扰,或者干扰尽量小。反作用零空间方法是一种有效的协调控制方法,该方法能保证机械臂运动所产生的角动量为零,从而不会对基座航天器的姿态产生干扰。该方法是一种运动学控制方法,相较于动力学控制方法,运动学控制方法的能量消耗较大;而且,该方法还需要空间机械臂***的运动学和动力学参数精确已知。然而,在空间任务中,由于地面标定误差、在轨燃料消耗等因素,很难获得空间机械臂***的精确参数。因此,在***参数存在不确知性的情况下,研究机械臂与基座航天器之间的协动力学调控制方法很有意义。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供一种空间机械臂自适应动力学协调控制方法,解决了参数不确知情况下机械臂与基座航天器之间的协调控制问题。
本发明的技术方案是:一种空间机械臂自适应动力学协调控制方法,步骤如下:
1)建立空间机械臂的扩展运动学模型;
将空间机械臂的角动量守恒方程与运动学方程联立,得到显式包含航天器运动的自由漂浮空间机械臂的扩展运动学方程,即
其中,为航天器的惯量矩阵,为机械臂末端在惯性空间中的速度,为扩展雅克比矩阵,为对应于航天器的扩展雅克比矩阵,为对应于机械臂的扩展雅克比矩阵;为对应于航天器的雅克比矩阵,为对应于机械臂的雅克比矩阵;为航天器和机械臂的耦合惯量矩阵,为机械臂关节速度,n为机械臂自由度个数;为航天器相对于惯性系的角速度,并且表示在航天器本体系中;
空间机械臂***的扩展运动学方程表示为线性参数化的形式:
其中,为扩展运动学回归矩阵,Z1为回归矩阵,Z2为运动学回归矩阵,被称为扩展运动学参数,ak,1为一组物理参数,ak,2为空间机械臂***运动学参数;
2)确定航天器参考角速度和机械臂关节参考速度;
当空间机械臂***的扩展运动学参数和动力学参数未知时,设计航天器参考角速度ωbr满足如下方程:
其中,ωbr(0)=ωb(0),为ωbr对时间的导数,分别对应为Mbb、Mbm、Cbb、Cbm的估计,为的估计,将Mbb中的参数ak,1用ak,1的估计值替换得到Kb,Km,Kbs为正定对称矩阵,sb=ωb-ωbr为航天器滑模变量,为机械臂关节空间参考速度,为对时间的导数;λb为一正数,Δ∈bv为航天器的姿态误差矩阵对应的误差四元数的矢量部分,Rb,Rbd分别为航天器的当前姿态矩阵与期望姿态矩阵;Δx=x-xd为机械臂末端位置跟踪误差,为机械臂末端在惯性空间中的位姿,为机械臂末端期望轨迹, 为机械臂末端位姿的估计,为机械臂末端期望速度,α为一正数;
关节空间参考速度为
其中,为的估计,为的经典伪逆,为任务空间参考速度;
3)确定空间机械臂自适应动力学协调控制律和参数更新律;
定义变量如下
其中,为机械臂末端速度跟踪误差,为扩展运动学参数估计误差;
参数未知情况下,空间机械臂的动力学方程为如下线性参数化的形式
其中,分别对应为Mbm、Mmm、Cmb、Cmm的估计,与为动力学回归矩阵,为动力学参数ad的估计,为机械臂关节位置, 为对时间的导数;
在空间机械臂运动学参数和动力学参数未知时,采用如下的自适应控制律
其中,为正定对称矩阵,为机械臂关节空间滑模变量;
动力学参数的估计值和扩展运动学参数的估计值分别由下面给出的自适应律进行更新
其中,Γd,Γk为正定对称矩阵;
4)采用步骤3)得到的自适应控制律和参数更新律,实现航天器姿态调节和末端执行器对任务空间中期望轨迹的跟踪,即,当t→∞时,ωb→0,Rb→Rbd,Δx→0,
本发明与现有技术相比的优点在于:
(1)与已有结果相比,本发明公开的自适应动力学协调控制算法无需测量航天器角加速度,因此本发明中方法具有较强的鲁棒性;
(2)本发明公开的方法仅仅通过适当控制机械臂的运动,便可同时实现机械臂任务空间期望轨迹跟踪和基座航天器姿态调节,可以节省星上燃料;
(3)本发明公开的方法能够处理空间机械臂***参数存在不确知性的情况,而参数不确知性在工程中广泛存在,因此本发明中方法具有较强的实用性。
附图说明
图1为三自由度平面构型自由漂浮空间机械臂示意图;
图2为基座航天器角速度变化曲线;
图3为基座航天器姿态角变化曲线;
图4为机械臂末端位置跟踪误差曲线;
图5为机械臂末端实际轨迹与期望轨迹。
具体实施方式
如图1所示,基于三自由度平面构型的自由漂浮空间机械臂***,验证本发明所公开的自适应动力学协调控制算法。机械臂采用串联结构,只能在平面内运动。基座航天器在平面内平动,亦可绕垂直于平面的轴转动。基座航天器的姿轨控***处于关闭状态。在***参数未知的情况下,通过设计机械臂关节控制力矩和参数自适应律,以同时达到基座航天器姿态调节与机械臂末端轨迹跟踪的目的。
本发明公开了一种空间机械臂自适应动力学协调控制方法,步骤如下:
1)建立空间机械臂的扩展运动学模型;
将空间机械臂的角动量守恒方程与运动学方程联立,得到显式包含航天器运动的自由漂浮空间机械臂的扩展运动学方程,即
其中,为航天器的惯量矩阵,为机械臂末端在惯性空间中的速度,为扩展雅克比矩阵,为对应于航天器的扩展雅克比矩阵,为对应于机械臂的扩展雅克比矩阵;为对应于航天器的雅克比矩阵,为对应于机械臂的雅克比矩阵;为航天器和机械臂的耦合惯量矩阵,为机械臂关节速度,n为机械臂自由度个数;为航天器相对于惯性系的角速度,并且表示在航天器本体系中;
空间机械臂***的扩展运动学方程表示为线性参数化的形式:
其中,为扩展运动学回归矩阵,Z1为回归矩阵,Z2为运动学回归矩阵,被称为扩展运动学参数,ak,1为一组物理参数,ak,2为空间机械臂***运动学参数;
2)设计航天器参考角速度和机械臂关节参考速度;
当空间机械臂***的扩展运动学参数和动力学参数未知时,设计航天器参考角速度ωbr满足如下方程:
其中,ωbr(0)=ωb(0),为ωbr对时间的导数,分别对应为Mbb、Mbm、Cbb、Cbm的估计,为的估计,将Mbb中的参数ak,1用其估计值替换即可得到K=diag([Kb,Km)],Kb,Km,Kbs为正定对称矩阵,sb=ωb-ωbr为航天器滑模变量,为机械臂关节空间参考速度,为对时间的导数;λb>0为一正数,Δ∈bv为航天器的姿态误差矩阵对应的误差四元数的矢量部分,Rb,Rbd分别为航天器的当前姿态矩阵与期望姿态矩阵;Δx=x-xd为机械臂末端位置跟踪误差,为机械臂末端在惯性空间中的位姿,为机械臂末端期望轨迹, 为机械臂末端位姿的估计,为机械臂末端期望速度,α>0为一正数;
关节空间参考速度为
其中,为的估计,为的经典伪逆,为任务空间参考速度;
3)设计空间机械臂自适应动力学协调控制律和参数更新律;
定义变量如下
其中,为机械臂末端速度跟踪误差,为扩展运动学参数估计误差;
参数未知情况下,空间机械臂的动力学方程为如下线性参数化的形式
其中,分别对应为Mbm、Mmm、Cmb、Cmm的估计,与为动力学回归矩阵,为动力学参数ad的估计,为机械臂关节位置, 为对时间的导数;
在空间机械臂运动学参数和动力学参数未知时,采用如下的自适应控制律
其中,为正定对称矩阵,为机械臂关节空间滑模变量;
动力学参数的估计值和扩展运动学参数的估计值分别由下面给出的自适应律进行更新
其中,Γd,Γk为正定对称矩阵;
4)采用步骤3)得到的自适应控制律和参数更新律,实现航天器姿态调节和末端执行器对任务空间中期望轨迹的跟踪,即,当t→∞时,ωb→0,Rb→Rbd,Δx→0,
本发明方法实施例所涉及的仿真对象为在平面内运动的三自由度自由漂浮空间机械臂。在仿真中,航天器需要调节到期望姿态,机械臂末端执行器同时要跟踪任务空间中的一条期望轨迹。由于此空间机械臂在平面内运动,仅用qb就可以描述航天器的姿态。在仿真中,令qb=0。机械臂末端执行器的期望轨迹为惯性空间中的一个圆。
图2为基座航天器角速度曲线。由图2可知,在开始时航天器角速度出现超调,但很快就衰减到0.05°/s以内。
图3为基座航天器姿态角曲线。由图3可知,航天器姿态角变化较小,最后稳定在0.02°以内。图4为机械臂末端跟踪误差曲线。由图4可知,机械臂末端跟踪误差迅速衰减,最后稳定在0.01m以内。
图5为机械臂末端的实际轨迹与期望轨迹。为表明本发明所提算法的收敛性,在仿真中令机械臂末端执行器的初始位置偏离于期望轨迹。由图5可见,随时间增长,机械臂末端执行器迅速收敛于期望轨迹。
本发明未详细说明部分属本领域技术人员公知常识。
Claims (6)
1.一种空间机械臂自适应动力学协调控制方法,其特征在于步骤如下:
1)建立空间机械臂的扩展运动学模型;
2)确定航天器参考角速度和机械臂关节参考速度;
3)确定空间机械臂自适应动力学协调控制律和参数更新律;
4)采用步骤3)得到的自适应控制律和参数更新律,实现航天器姿态调节和末端执行器对任务空间中期望轨迹的跟踪。
2.根据权利要求1所述的一种空间机械臂自适应动力学协调控制方法,其特征在于:所述建立空间机械臂的扩展运动学模型的具体形式为:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>M</mi>
<mrow>
<mi>b</mi>
<mi>b</mi>
</mrow>
</msub>
<msub>
<mi>&omega;</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<msub>
<mi>M</mi>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>J</mi>
<mi>b</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>b</mi>
</msub>
<mo>+</mo>
<msub>
<mi>J</mi>
<mi>m</mi>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msub>
<mi>Za</mi>
<mi>k</mi>
</msub>
</mrow>
其中,为航天器的惯量矩阵,为对应于航天器的雅克比矩阵,为对应于机械臂的雅克比矩阵;为航天器和机械臂的耦合惯量矩阵,为机械臂关节速度;为航天器相对于惯性系的角速度,并且表示在航天器本体系中;为扩展运动学回归矩阵,Z1为回归矩阵,Z2为运动学回归矩阵,被称为扩展运动学参数,ak,1为一组物理参数,ak,2为空间机械臂***运动学参数。
3.根据权利要求2所述的一种空间机械臂自适应动力学协调控制方法,其特征在于:所述确定航天器参考角速度的具体过程为:
当空间机械臂***的扩展运动学参数和动力学参数未知时,确定航天器参考角速度ωbr满足如下方程:
<mrow>
<msub>
<mover>
<mi>M</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>b</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>&omega;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>M</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>C</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>b</mi>
</mrow>
</msub>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>b</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>C</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>=</mo>
<msubsup>
<mover>
<mi>J</mi>
<mo>^</mo>
</mover>
<mi>b</mi>
<mrow>
<mo>*</mo>
<mi>T</mi>
</mrow>
</msubsup>
<mi>K</mi>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msubsup>
<mover>
<mi>M</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>b</mi>
</mrow>
<mo>*</mo>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mi>b</mi>
</msub>
<mo>+</mo>
<msub>
<mi>&lambda;</mi>
<mi>b</mi>
</msub>
<mi>&Delta;</mi>
<msub>
<mo>&Element;</mo>
<mrow>
<mi>b</mi>
<mi>v</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mn>1</mn>
</msub>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>k</mi>
<mo>,</mo>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>&Delta;</mi>
<mover>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>^</mo>
</mover>
<mo>+</mo>
<mi>&alpha;</mi>
<mi>&Delta;</mi>
<mi>x</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<msub>
<mi>K</mi>
<mrow>
<mi>b</mi>
<mi>s</mi>
</mrow>
</msub>
<msub>
<mi>s</mi>
<mi>b</mi>
</msub>
</mrow>
其中,ωbr(0)=ωb(0),为ωbr对时间的导数,分别对应为Mbb、Mbm、Cbb、Cbm的估计,为的估计,将Mbb中的参数ak,1用ak,1的估计值替换得到K=diag([Kb,Km)],Kb,Km,Kbs为正定对称矩阵,sb=ωb-ωbr为航天器滑模变量,为机械臂关节空间参考速度,为对时间的导数;λb为一正数,Δ∈bv为航天器的姿态误差矩阵对应的误差四元数的矢量部分,Rb,Rbd分别为航天器的当前姿态矩阵与期望姿态矩阵;Δx=x-xd为机械臂末端位置跟踪误差,为机械臂末端在惯性空间中的位姿,为机械臂末端期望轨迹, 为机械臂末端位姿的估计,为机械臂末端期望速度,α为一正数。
4.根据权利要求3所述的一种空间机械臂自适应动力学协调控制方法,其特征在于:所述确定机械臂关节参考速度的公式为:
<mrow>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>=</mo>
<msubsup>
<mover>
<mi>J</mi>
<mo>^</mo>
</mover>
<mi>m</mi>
<mrow>
<mo>*</mo>
<mo>+</mo>
</mrow>
</msubsup>
<mrow>
<mo>{</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msubsup>
<mover>
<mi>M</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>b</mi>
</mrow>
<mo>*</mo>
</msubsup>
<msub>
<mi>&lambda;</mi>
<mi>b</mi>
</msub>
<mi>&Delta;</mi>
<msub>
<mo>&Element;</mo>
<mrow>
<mi>b</mi>
<mi>v</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>}</mo>
</mrow>
<mo>-</mo>
<msubsup>
<mover>
<mi>J</mi>
<mo>^</mo>
</mover>
<mi>b</mi>
<mo>*</mo>
</msubsup>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>b</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>}</mo>
<mo>;</mo>
</mrow>
其中,为的估计,为的经典伪逆,为任务空间参考速度。
5.根据权利要求4所述的一种空间机械臂自适应动力学协调控制方法,其特征在于:步骤(3)的具体过程为:
定义变量如下
其中,为机械臂末端速度跟踪误差,为扩展运动学参数估计误差;
参数未知情况下,空间机械臂的动力学方程为如下线性参数化的形式
<mrow>
<msub>
<mover>
<mi>M</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>b</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>&omega;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>M</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>C</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>b</mi>
</mrow>
</msub>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>b</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>C</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>Y</mi>
<mi>b</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mi>d</mi>
</msub>
</mrow>
<mrow>
<msubsup>
<mover>
<mi>M</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
<mi>T</mi>
</msubsup>
<msub>
<mover>
<mi>&omega;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>M</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>C</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>b</mi>
</mrow>
</msub>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>b</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>C</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>m</mi>
</mrow>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>m</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>Y</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mi>d</mi>
</msub>
</mrow>
其中,分别对应为Mbm、Mmm、Cmb、Cmm的估计,与为动力学回归矩阵,为动力学参数ad的估计,为机械臂关节位置, 为对时间的导数;
在空间机械臂运动学参数和动力学参数未知时,采用如下的自适应控制律
<mrow>
<msub>
<mi>&tau;</mi>
<mi>m</mi>
</msub>
<mo>=</mo>
<mo>-</mo>
<msubsup>
<mover>
<mi>J</mi>
<mo>^</mo>
</mover>
<mi>m</mi>
<mrow>
<mo>*</mo>
<mi>T</mi>
</mrow>
</msubsup>
<mi>K</mi>
<msubsup>
<mover>
<mi>s</mi>
<mo>^</mo>
</mover>
<mi>x</mi>
<mo>*</mo>
</msubsup>
<mo>-</mo>
<msub>
<mi>K</mi>
<mrow>
<mi>m</mi>
<mi>s</mi>
</mrow>
</msub>
<msub>
<mi>s</mi>
<mi>m</mi>
</msub>
<mo>+</mo>
<msub>
<mi>Y</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>q</mi>
<mo>,</mo>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mi>d</mi>
</msub>
<mo>;</mo>
</mrow>
其中,为正定对称矩阵,为机械臂关节空间滑模变量;
动力学参数的估计值和扩展运动学参数的估计值分别由如下自适应律进行更新
<mrow>
<msub>
<mover>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&Gamma;</mi>
<mi>d</mi>
</msub>
<msup>
<mi>Y</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mi>m</mi>
</msub>
<mo>,</mo>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>s</mi>
</mrow>
<mrow>
<msub>
<mover>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mi>k</mi>
</msub>
<mo>=</mo>
<msub>
<mi>&Gamma;</mi>
<mi>k</mi>
</msub>
<msup>
<mi>Z</mi>
<mi>T</mi>
</msup>
<msubsup>
<mi>s</mi>
<mi>x</mi>
<mo>*</mo>
</msubsup>
</mrow>
其中,Γd,Γk为正定对称矩阵。
6.根据权利要求5所述的一种空间机械臂自适应动力学协调控制方法,其特征在于:所述步骤(4)中实现航天器姿态调节和末端执行器对任务空间中期望轨迹的跟踪,即当t→∞时,ωb→0,Rb→Rbd,Δx→0,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710700713.2A CN107450317A (zh) | 2017-08-16 | 2017-08-16 | 一种空间机械臂自适应动力学协调控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710700713.2A CN107450317A (zh) | 2017-08-16 | 2017-08-16 | 一种空间机械臂自适应动力学协调控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107450317A true CN107450317A (zh) | 2017-12-08 |
Family
ID=60492443
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710700713.2A Pending CN107450317A (zh) | 2017-08-16 | 2017-08-16 | 一种空间机械臂自适应动力学协调控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107450317A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108519740A (zh) * | 2018-05-05 | 2018-09-11 | 曲阜师范大学 | 一种全状态约束机械臂轨迹跟踪的协同控制方法 |
CN108789426A (zh) * | 2017-12-29 | 2018-11-13 | 金门工程建设有限公司 | 表面处理机械人 |
CN109270955A (zh) * | 2018-10-30 | 2019-01-25 | 中国运载火箭技术研究院 | 一种基于机械臂驱动的飞行器位姿耦合快速稳定控制方法 |
CN109591017A (zh) * | 2019-01-07 | 2019-04-09 | 西北工业大学 | 空间机器人捕获翻滚目标后的轨迹规划方法 |
CN110722557A (zh) * | 2019-10-21 | 2020-01-24 | 上海航天控制技术研究所 | 一种平台-机械臂一体化控制方法 |
CN112975965A (zh) * | 2021-02-24 | 2021-06-18 | 深圳市优必选科技股份有限公司 | 仿人机器人的解耦控制方法、装置和仿人机器人 |
CN113305831A (zh) * | 2021-04-30 | 2021-08-27 | 北京控制工程研究所 | 空间机械臂自适应协调控制的位置观测器设计方法及*** |
CN114734441A (zh) * | 2022-04-15 | 2022-07-12 | 北京邮电大学 | 一种关节部分失效故障空间机械臂运动能力优化方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103869704A (zh) * | 2014-04-08 | 2014-06-18 | 哈尔滨工业大学 | 基于扩展雅克比矩阵的空间机器人星臂协调控制方法 |
CN106945020A (zh) * | 2017-05-18 | 2017-07-14 | 哈尔滨工业大学 | 一种空间双机械臂***运动协调控制方法 |
-
2017
- 2017-08-16 CN CN201710700713.2A patent/CN107450317A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103869704A (zh) * | 2014-04-08 | 2014-06-18 | 哈尔滨工业大学 | 基于扩展雅克比矩阵的空间机器人星臂协调控制方法 |
CN106945020A (zh) * | 2017-05-18 | 2017-07-14 | 哈尔滨工业大学 | 一种空间双机械臂***运动协调控制方法 |
Non-Patent Citations (5)
Title |
---|
HANLEI WANG: "On the Adaptive Zero Reaction Control of Free-Floating Space Manipulators", 《PROCEEDING OF THE 11TH WORLD CONGRESS ON INTELLIGENT CONTROL AND AUTOMATION》 * |
XU, SHUANFENG: "Adaptive Zero Reaction Motion Control for Free-Floating Space Manipulators", 《IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS》 * |
XU, SHUANFENG: "Extended Jacobian Based Adaptive Zero Reaction Motion Control for Free-Floating Space Manipulators", 《CHINESE CONTROL CONFERENCE 》 * |
徐拴锋: "柔性关节自由漂浮空间机械臂递推自适应控制", 《空间控制技术与应用》 * |
徐拴锋: "空间机械臂自适应扩展雅克比零反作用控制", 《宇航学报》 * |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108789426A (zh) * | 2017-12-29 | 2018-11-13 | 金门工程建设有限公司 | 表面处理机械人 |
CN108519740B (zh) * | 2018-05-05 | 2020-11-17 | 曲阜师范大学 | 一种全状态约束机械臂轨迹跟踪的协同控制方法 |
CN108519740A (zh) * | 2018-05-05 | 2018-09-11 | 曲阜师范大学 | 一种全状态约束机械臂轨迹跟踪的协同控制方法 |
CN109270955B (zh) * | 2018-10-30 | 2021-08-10 | 中国运载火箭技术研究院 | 一种基于机械臂驱动的飞行器位姿耦合快速稳定控制方法 |
CN109270955A (zh) * | 2018-10-30 | 2019-01-25 | 中国运载火箭技术研究院 | 一种基于机械臂驱动的飞行器位姿耦合快速稳定控制方法 |
CN109591017A (zh) * | 2019-01-07 | 2019-04-09 | 西北工业大学 | 空间机器人捕获翻滚目标后的轨迹规划方法 |
CN109591017B (zh) * | 2019-01-07 | 2021-11-09 | 西北工业大学 | 空间机器人捕获翻滚目标后的轨迹规划方法 |
CN110722557B (zh) * | 2019-10-21 | 2021-11-05 | 上海航天控制技术研究所 | 一种平台-机械臂一体化控制方法 |
CN110722557A (zh) * | 2019-10-21 | 2020-01-24 | 上海航天控制技术研究所 | 一种平台-机械臂一体化控制方法 |
CN112975965A (zh) * | 2021-02-24 | 2021-06-18 | 深圳市优必选科技股份有限公司 | 仿人机器人的解耦控制方法、装置和仿人机器人 |
WO2022179213A1 (zh) * | 2021-02-24 | 2022-09-01 | 深圳市优必选科技股份有限公司 | 仿人机器人的解耦控制方法、装置和仿人机器人 |
CN113305831A (zh) * | 2021-04-30 | 2021-08-27 | 北京控制工程研究所 | 空间机械臂自适应协调控制的位置观测器设计方法及*** |
CN113305831B (zh) * | 2021-04-30 | 2022-10-11 | 北京控制工程研究所 | 空间机械臂自适应协调控制的位置观测器设计方法及*** |
CN114734441A (zh) * | 2022-04-15 | 2022-07-12 | 北京邮电大学 | 一种关节部分失效故障空间机械臂运动能力优化方法 |
CN114734441B (zh) * | 2022-04-15 | 2023-11-24 | 北京邮电大学 | 一种关节部分失效故障空间机械臂运动能力优化方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107450317A (zh) | 一种空间机械臂自适应动力学协调控制方法 | |
CN106945020B (zh) | 一种空间双机械臂***运动协调控制方法 | |
CN107490965B (zh) | 一种空间自由漂浮机械臂的多约束轨迹规划方法 | |
Xu et al. | The coordinated motion planning of a dual-arm space robot for target capturing | |
CN102411304B (zh) | 一种航天器小角度姿态机动控制参数优化方法 | |
CN111251297B (zh) | 一种基于随机采样的双臂空间机器人协调路径规划方法 | |
Han et al. | Robust coordinated motion control of an underwater vehicle-manipulator system with minimizing restoring moments | |
CN109176525A (zh) | 一种基于rbf的移动机械手自适应控制方法 | |
Srisuk et al. | Inverse kinematics solution using neural networks from forward kinematics equations | |
CN106055522A (zh) | 冗余空间机械臂最小基座姿态扰动的轨迹规划方法 | |
Imanberdiyev et al. | A fast learning control strategy for unmanned aerial manipulators | |
CN104076685B (zh) | 一种减少基座姿态扰动的空间机械臂路径规划方法 | |
CN110244714A (zh) | 基于滑模控制的机器人单腿摆动相双闭环控制方法 | |
Cao et al. | ESO-based robust and high-precision tracking control for aerial manipulation | |
CN108445768A (zh) | 空间机器人操作空间轨迹跟踪的增广自适应模糊控制方法 | |
Ge et al. | Sliding mode variable structure control of mobile manipulators | |
Du et al. | Learning to control a free-floating space robot using deep reinforcement learning | |
Cao et al. | Adaptive NN motion control and predictive coordinate planning for aerial manipulators | |
CN109062039B (zh) | 一种三自由度Delta并联机器人的自适应鲁棒控制方法 | |
Abiko et al. | Adaptive control for a torque controlled free-floating space robot with kinematic and dynamic model uncertainty | |
Guayasamín et al. | Trajectory tracking control for aerial manipulator based on lyapunov and sliding mode control | |
CN111546344A (zh) | 一种用于对准的机械臂控制方法 | |
Guo et al. | Adaptive neural network control for coordinated motion of a dual-arm space robot system with uncertain parameters | |
Mohan et al. | A null space control of an underactuated underwater vehicle-manipulator system under ocean currents | |
JP2004230530A (ja) | 宇宙ロボットの姿勢制御方法及び装置 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20171208 |
|
RJ01 | Rejection of invention patent application after publication |