CN113305831A - 空间机械臂自适应协调控制的位置观测器设计方法及系统 - Google Patents
空间机械臂自适应协调控制的位置观测器设计方法及系统 Download PDFInfo
- Publication number
- CN113305831A CN113305831A CN202110481248.4A CN202110481248A CN113305831A CN 113305831 A CN113305831 A CN 113305831A CN 202110481248 A CN202110481248 A CN 202110481248A CN 113305831 A CN113305831 A CN 113305831A
- Authority
- CN
- China
- Prior art keywords
- space
- spacecraft
- mechanical arm
- matrix
- adaptive
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
一种空间机械臂自适应协调控制的位置观测器设计方法及系统,包括:建立空间机械臂的扩展运动学模型;确定航天器参考角速度,设计任务空间位置观测器;确定机械臂关节参考速度;确定空间机械臂自适应动力学协调控制律和参数更新律;采用得到的自适应动力学协调控制律和参数更新律,实现航天器姿态调节和末端执行器对任务空间中期望轨迹的跟踪。本发明基于任务空间位置观测器设计了空间机械臂自适应动力学协调控制器,能够在空间机械臂系统参数存在不确知性的情况下,仅仅通过控制机械臂的运动就可以同时达到机械臂末端轨迹跟踪与基座航天器姿态调节的目的。
Description
技术领域
本发明涉及一种用于空间机械臂自适应动力学协调控制的任务空间位置观测器设计方法,属于机械臂动力学控制领域。
背景技术
在轨服务通常由配备有机械臂的追踪航天器(称之为空间机械臂系统)来完成。其中,作为基座的卫星称为基座航天器。区别于地面机械臂,空间机械臂系统的基座不是固定的,机械臂的运动会对基座航天器的姿态造成干扰。考虑到对地通信和对日定向等要求,通常希望将基座航天器保持在期望姿态。为此,需要合理规划控制机械臂的运动,使得机械臂的运动对基座航天器姿态无干扰。反作用零空间方法是一种有效的协调控制方法,它能保证机械臂运动所产生的角动量为零,从而不会对基座航天器的姿态产生干扰。该方法是一种运动学控制方法,相较于动力学控制方法,运动学控制方法的能量消耗较大;而且,该方法还需要空间机械臂系统的运动学和动力学参数精确已知。然而,在空间任务中,由于地面标定误差、在轨燃料消耗等因素,很难获得空间机械臂系统的精确参数。
因此,在空间机械臂系统参数存在不确知性的情况下,研究机械臂与基座航天器之间的自适应动力学协调控制方法很有意义。但是,该控制方法需要对空间机械臂末端速度进行测量,而对机械臂任务空间速度的测量会引入噪声。
发明内容
本发明的目的在于:克服现有技术的不足,提供一种用于空间机械臂自适应动力学协调控制的任务空间位置观测器设计方法,解决了空间机械臂自适应动力学协调控制器设计中任务空间速度测量引入噪声的问题。
本发明目的通过如下技术方案予以实现:
一种空间机械臂自适应协调控制的位置观测器设计方法,步骤如下:
1)建立空间机械臂的扩展运动学模型;
空间机械臂的扩展运动学模型的具体形式为:
其中,为航天器的惯量矩阵,为对应于航天器的雅克比矩阵,为对应于机械臂的雅克比矩阵;为航天器和机械臂的耦合惯量矩阵,为机械臂关节速度;为航天器相对于惯性系的角速度,并且表示在航天器本体系中;为扩展运动学回归矩阵,Z1为回归矩阵,Z2为运动学回归矩阵,被称为扩展运动学参数,ak,1为一组物理参数,ak,2为空间机械臂系统运动学参数。
2)确定航天器参考角速度,设计任务空间位置观测器;
确定航天器参考角速度和设计任务空间位置观测器的具体过程为:
当空间机械臂系统的扩展运动学参数和动力学参数未知时,确定航天器参考角速度ωbr满足如下方程:
其中,ω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分别为航天器的当前姿态矩阵与期望姿态矩阵; 为机械臂末端位姿的估计,为机械臂末端期望速度,α为一正数,为任务空间位置观测信号。
为避免任务空间速度测量引入噪声,设计了一种简单的任务空间位置观测器。观测器方程由下式给出
3)确定机械臂关节参考速度;
机械臂关节参考速度为:
4)确定空间机械臂自适应动力学协调控制律和参数更新律;
空间机械臂自适应动力学协调控制律和参数更新律的具体过程为:
定义变量如下
参数未知情况下,空间机械臂的动力学方程为如下线性参数化的形式
在空间机械臂运动学参数和动力学参数未知时,采用如下的自适应控制律
进一步的,本发明还提出一种空间机械臂自适应协调控制的位置观测器设计系统,包括:
扩展运动学模型建立模块:建立空间机械臂的扩展运动学模型;
参考角速度计算模块:确定航天器参考角速度,设计任务空间位置观测器;
关节参考速度计算模块:确定机械臂关节参考速度;
控制律确定模块:确定空间机械臂自适应动力学协调控制律和参数更新律;
姿控和跟踪模块:采用得到的自适应动力学协调控制律和参数更新律,实现航天器姿态调节和末端执行器对任务空间中期望轨迹的跟踪。
本发明与现有技术相比具有如下优点:
(1)本发明采用任务空间位置观测器来估计任务空间速度,从而避免了任务空间速度测量所引入的噪声。
(2)本发明公开的自适应动力学协调控制算法无需测量航天器角加速度,因此本发明中方法具有较强的鲁棒性。
(3)本发明公开的方法仅仅通过适当控制机械臂的运动,便可同时实现机械臂末端轨迹跟踪和基座航天器姿态调节,可以节省星上燃料。
(4)本发明公开的方法能够处理空间机械臂系统参数存在不确知性的情况,而参数不确知性在工程中广泛存在,因此本发明中方法具有较强的实用性。
(5)本发明公开了一种用于空间机械臂自适应动力学协调控制的任务空间位置观测器设计方法,然后基于该观测器设计了空间机械臂自适应动力学协调控制器,能够在空间机械臂系统参数存在不确知性的情况下,仅仅通过控制机械臂的运动就可以同时达到机械臂末端轨迹跟踪与基座航天器姿态调节的目的。
附图说明
图1为三自由度平面构型自由漂浮空间机械臂示意图;
图2为基座航天器姿态角变化曲线;
图3为机械臂末端位置跟踪误差曲线;
图4为任务空间位置观测器位置观测误差曲线。
具体实施方式
本发明提出一种用于空间机械臂自适应动力学协调控制的任务空间位置观测器设计方法,在深入分析空间机械臂系统运动学、动力学特性的基础上,首先对经典的空间机械臂运动学方程进行扩维,得到能够同时描述机械臂末端运动与航天器姿态运动的空间机械臂“扩展运动学方程”。
然后,在深入挖掘利用空间机械臂系统动力学方程和角动量守恒方程特性的基础上,定义航天器参考速度和关节空间参考速度,并基于此设计机械臂自适应动力学协调控制器。该控制器包括三部分——转置雅克比反馈、滑模反馈和动力学补偿。为避免任务空间速度测量所引入的噪声,设计了一种简单的任务空间位置观测器。
最后,应用输入输出稳定性理论,证明了该控制算法的稳定性和航天器姿态调节误差、末端执行器轨迹跟踪误差、任务空间位置观测器位置观测误差的渐近收敛性。本发明公开的一种用于空间机械臂自适应动力学协调控制的任务空间位置观测器设计方法,为避免任务空间速度测量所引入的噪声,设计了一种简单的任务空间位置观测器。基于该观测器设计了空间机械臂自适应动力学协调控制器,能够在空间机械臂系统参数存在不确知性的情况下,仅仅通过控制机械臂的运动就可以同时达到机械臂末端轨迹跟踪与基座航天器姿态调节的目的。
如图1所示,基于三自由度平面构型的自由漂浮空间机械臂系统,验证本发明所公开的自适应动力学协调控制算法。机械臂采用串联结构,只能在平面内运动。基座航天器在平面内平动,亦可绕垂直于平面的轴转动。基座航天器的姿轨控系统处于关闭状态。在系统参数未知的情况下,通过设计机械臂关节控制力矩和参数自适应律,以同时达到基座航天器姿态调节与机械臂末端轨迹跟踪的目的。
具体的,本发明一种空间机械臂自适应协调控制的位置观测器设计方法,步骤如下:
1)建立空间机械臂的扩展运动学模型;
空间机械臂的扩展运动学模型的具体形式为:
其中,为航天器的惯量矩阵,为对应于航天器的雅克比矩阵,为对应于机械臂的雅克比矩阵;为航天器和机械臂的耦合惯量矩阵,为机械臂关节速度;为航天器相对于惯性系的角速度,并且表示在航天器本体系中;为扩展运动学回归矩阵,Z1为回归矩阵,Z2为运动学回归矩阵,被称为扩展运动学参数,ak,1为一组物理参数,ak,2为空间机械臂系统运动学参数。
2)确定航天器参考角速度,设计任务空间位置观测器;
确定航天器参考角速度和设计任务空间位置观测器的具体过程为:
当空间机械臂系统的扩展运动学参数和动力学参数未知时,确定航天器参考角速度ωbr满足如下方程:
其中,ω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分别为航天器的当前姿态矩阵与期望姿态矩阵; 为机械臂末端位姿的估计,为机械臂末端期望速度,α为一正数,为任务空间位置观测信号。
为避免任务空间速度测量引入噪声,设计了一种简单的任务空间位置观测器。观测器方程由下式给出
3)确定机械臂关节参考速度;
机械臂关节参考速度为:
4)确定空间机械臂自适应动力学协调控制律和参数更新律;
空间机械臂自适应动力学协调控制律和参数更新律的具体过程为:
定义变量如下
参数未知情况下,空间机械臂的动力学方程为如下线性参数化的形式
在空间机械臂运动学参数和动力学参数未知时,采用如下的自适应控制律
本发明还提出一种空间机械臂自适应协调控制的位置观测器设计系统,包括:
扩展运动学模型建立模块:建立空间机械臂的扩展运动学模型;
参考角速度计算模块:确定航天器参考角速度,设计任务空间位置观测器;
关节参考速度计算模块:确定机械臂关节参考速度;
控制律确定模块:确定空间机械臂自适应动力学协调控制律和参数更新律;
姿控和跟踪模块:采用得到的自适应动力学协调控制律和参数更新律,实现航天器姿态调节和末端执行器对任务空间中期望轨迹的跟踪。
本发明方法实施例所涉及的仿真对象为在平面内运动的三自由度自由漂浮空间机械臂。在仿真中,航天器需要调节到期望姿态,机械臂末端执行器同时要跟踪任务空间中的一条期望轨迹。由于此空间机械臂在平面内运动,仅用qb就可以描述航天器的姿态。在仿真中,令qb=0。机械臂末端执行器的期望轨迹为惯性空间中的一个圆。
图2为基座航天器姿态角曲线。由图2可知,航天器姿态角变化较小,最后稳定在0.02°以内。
图3为机械臂末端跟踪误差曲线。由图3可知,机械臂末端跟踪误差迅速衰减,最后稳定在0.005m以内。
图4为任务空间位置观测器位置观测误差曲线。由图4可知,机械臂任务空间位置观测误差快速趋于零。
以上所述,仅为本发明最佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
Claims (10)
1.一种空间机械臂自适应协调控制的位置观测器设计方法,其特征在于步骤如下:
建立空间机械臂的扩展运动学模型;
确定航天器参考角速度,设计任务空间位置观测器;
确定机械臂关节参考速度;
确定空间机械臂自适应动力学协调控制律和参数更新律;
采用得到的自适应动力学协调控制律和参数更新律,实现航天器姿态调节和末端执行器对任务空间中期望轨迹的跟踪。
3.根据权利要求2所述的一种空间机械臂自适应协调控制的位置观测器设计方法,其特征在于:所述确定航天器参考角速度的具体过程为:
当空间机械臂系统的扩展运动学参数和动力学参数未知时,确定航天器参考角速度ωbr满足如下方程:
6.根据权利要求5所述的一种空间机械臂自适应协调控制的位置观测器设计方法,其特征在于:确定空间机械臂自适应动力学协调控制律和参数更新律的具体过程为:
定义变量如下
参数未知情况下,空间机械臂的动力学方程为如下线性参数化的形式
在空间机械臂运动学参数和动力学参数未知时,采用如下的自适应控制律
8.一种根据权利要求1所述的空间机械臂自适应协调控制的位置观测器设计方法实现的空间机械臂自适应协调控制的位置观测器设计系统,其特征在于包括:
扩展运动学模型建立模块:建立空间机械臂的扩展运动学模型;
参考角速度计算模块:确定航天器参考角速度,设计任务空间位置观测器;
关节参考速度计算模块:确定机械臂关节参考速度;
控制律确定模块:确定空间机械臂自适应动力学协调控制律和参数更新律;
姿控和跟踪模块:采用得到的自适应动力学协调控制律和参数更新律,实现航天器姿态调节和末端执行器对任务空间中期望轨迹的跟踪。
9.根据权利要求8所述的空间机械臂自适应协调控制的位置观测器设计系统,其特征在于:所述建立空间机械臂的扩展运动学模型的具体形式为:
其中,为航天器的惯量矩阵,为对应于航天器的雅克比矩阵,为对应于机械臂的雅克比矩阵;为航天器和机械臂的耦合惯量矩阵,为机械臂关节速度;为航天器相对于惯性系的角速度,并且表示在航天器本体系中;为扩展运动学回归矩阵,Z1为回归矩阵,Z2为运动学回归矩阵,为扩展运动学参数,ak,1为一组物理参数,ak,2为空间机械臂系统运动学参数;
所述确定航天器参考角速度的具体过程为:
当空间机械臂系统的扩展运动学参数和动力学参数未知时,确定航天器参考角速度ωbr满足如下方程:
其中,ω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分别为航天器的当前姿态矩阵与期望姿态矩阵;为机械臂末端位姿的估计,为机械臂末端期望速度,α为一正数,为任务空间位置观测信号;
任务空间位置观测器由下式给出
所述确定机械臂关节参考速度的公式为:
10.根据权利要求9所述的空间机械臂自适应协调控制的位置观测器设计系统,其特征在于:确定空间机械臂自适应动力学协调控制律和参数更新律的具体过程为:
定义变量如下
参数未知情况下,空间机械臂的动力学方程为如下线性参数化的形式
在空间机械臂运动学参数和动力学参数未知时,采用如下的自适应控制律
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110481248.4A CN113305831B (zh) | 2021-04-30 | 2021-04-30 | 空间机械臂自适应协调控制的位置观测器设计方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110481248.4A CN113305831B (zh) | 2021-04-30 | 2021-04-30 | 空间机械臂自适应协调控制的位置观测器设计方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113305831A true CN113305831A (zh) | 2021-08-27 |
CN113305831B CN113305831B (zh) | 2022-10-11 |
Family
ID=77371359
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110481248.4A Active CN113305831B (zh) | 2021-04-30 | 2021-04-30 | 空间机械臂自适应协调控制的位置观测器设计方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113305831B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9663252B1 (en) * | 2016-12-07 | 2017-05-30 | Beihang University | Method for attitude controlling based on finite time friction estimation for flexible spacecraft |
US9776741B1 (en) * | 2016-06-02 | 2017-10-03 | Beihang University | Method for refined attitude control based on output feedback for flexible spacecraft |
CN107450317A (zh) * | 2017-08-16 | 2017-12-08 | 北京控制工程研究所 | 一种空间机械臂自适应动力学协调控制方法 |
CN108132601A (zh) * | 2017-12-06 | 2018-06-08 | 西北工业大学 | 一种利用机械臂抑制航天器基座姿态干扰的方法 |
CN109927032A (zh) * | 2019-03-28 | 2019-06-25 | 东南大学 | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 |
CN112180729A (zh) * | 2020-10-09 | 2021-01-05 | 电子科技大学中山学院 | 一种机械臂自适应轨迹跟踪控制方法 |
-
2021
- 2021-04-30 CN CN202110481248.4A patent/CN113305831B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9776741B1 (en) * | 2016-06-02 | 2017-10-03 | Beihang University | Method for refined attitude control based on output feedback for flexible spacecraft |
US9663252B1 (en) * | 2016-12-07 | 2017-05-30 | Beihang University | Method for attitude controlling based on finite time friction estimation for flexible spacecraft |
CN107450317A (zh) * | 2017-08-16 | 2017-12-08 | 北京控制工程研究所 | 一种空间机械臂自适应动力学协调控制方法 |
CN108132601A (zh) * | 2017-12-06 | 2018-06-08 | 西北工业大学 | 一种利用机械臂抑制航天器基座姿态干扰的方法 |
CN109927032A (zh) * | 2019-03-28 | 2019-06-25 | 东南大学 | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 |
CN112180729A (zh) * | 2020-10-09 | 2021-01-05 | 电子科技大学中山学院 | 一种机械臂自适应轨迹跟踪控制方法 |
Non-Patent Citations (1)
Title |
---|
黎凯等: "柔性空间机械臂在轨操作仿真与分析", 《空间控制技术与应用》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113305831B (zh) | 2022-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107490965B (zh) | 一种空间自由漂浮机械臂的多约束轨迹规划方法 | |
CN108614425B (zh) | 移动机器人自适应积分滑模控制方法 | |
Jin et al. | Cartesian trajectory planning of space robots using a multi-objective optimization | |
Chen et al. | Adaptive sliding-mode disturbance observer-based finite-time control for unmanned aerial manipulator with prescribed performance | |
CN107505947B (zh) | 一种空间机器人捕获目标后消旋及协调控制方法 | |
Liu et al. | Trajectory tracking for a dual-arm free-floating space robot with a class of general nonsingular predefined-time terminal sliding mode | |
Yan et al. | Trajectory planning and low-chattering fixed-time nonsingular terminal sliding mode control for a dual-arm free-floating space robot | |
CN107263466B (zh) | 空间机器人基于二次规划问题的基座无扰控制方法 | |
CN112327892B (zh) | 一种auv误差受限的抗扰控制方法 | |
CN111506095B (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
CN109656132B (zh) | 一种空间机器人有限时间协调控制方法 | |
CN115480583B (zh) | 飞行作业机器人的视觉伺服跟踪与阻抗控制方法 | |
Hu et al. | Impedance sliding mode control with adaptive fuzzy compensation for robot-environment interacting | |
Zhao et al. | Minimum base disturbance control of free-floating space robot during visual servoing pre-capturing process | |
Jun-Pei et al. | Neural network control of space manipulator based on dynamic model and disturbance observer | |
Lamraoui et al. | Path following control of fully actuated autonomous underwater vehicle based on LADRC | |
CN109623812B (zh) | 考虑航天器本体姿态运动的机械臂轨迹规划方法 | |
Lai et al. | Image dynamics-based visual servo control for unmanned aerial manipulatorl with a virtual camera | |
CN113954077B (zh) | 带有能量优化的水下游动机械臂轨迹跟踪控制方法及装置 | |
Qi et al. | Three-dimensional formation control based on filter backstepping method for multiple underactuated underwater vehicles | |
CN116382332B (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN116141329A (zh) | 一种基于自校正控制的空间闭环双臂机器人运动控制方法 | |
CN113305831B (zh) | 空间机械臂自适应协调控制的位置观测器设计方法及系统 | |
Sun et al. | Finite-time integrated target tracking for spacecraft with two-dimensional turntable under performance constraints | |
CN110480641B (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 |