CN106855690B - 空间绳系机器人近距离抓捕后回收目标的自适应控制方法 - Google Patents
空间绳系机器人近距离抓捕后回收目标的自适应控制方法 Download PDFInfo
- Publication number
- CN106855690B CN106855690B CN201611049852.5A CN201611049852A CN106855690B CN 106855690 B CN106855690 B CN 106855690B CN 201611049852 A CN201611049852 A CN 201611049852A CN 106855690 B CN106855690 B CN 106855690B
- Authority
- CN
- China
- Prior art keywords
- complex
- recovery
- matrix
- tether
- target
- 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.)
- Active
Links
Images
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
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
技术领域
本发明属于航天器控制技术研究领域,涉及一种空间绳系机器人近距离抓捕后回收目标的自适应控制方法。
背景技术
由于空间绳系机器人在抓捕非合作目标任务时所展现出的灵活、安全、低成本等优越性,空间绳系机器人在太空垃圾清理、失效卫星救助等方面有着潜在应用价值。尤其近年来太空垃圾数量增长迅速,失效卫星(非合作卫星)的清除清理问题已被很多国家提上日程。因为绳系机器人的可机动飞行能力,其在抓捕目标卫星时,主卫星一直处于安全区域。且绳系机器人可多次重复工作。空间绳系机器人被认为是一种可靠的清理失效卫星的方法。
根据不同的动力学和控制特点分类,整个任务可以分成释放/逼近过程,抓捕/抓捕后稳定过程,目标回收过程三个阶段。目前现有的发明专利,其发明点大部分都集中在逼近和抓捕/抓捕后两个阶段:申请号为CN201310018189.2的中国专利提出了一种空间绳系机器人系统逼近目标协调控制方法,使得空间绳系机器人可以稳定逼近目标;申请号为CN201310018221.7的中国发明专利,提出了一种空间绳系机器人目标抓捕后复合体姿态协调控制方法,可以使得新系统快速稳定;目前为止,申请号为 CN201410341359.5的中国发明专利,提出一种基于空间系绳抓捕系统的非合作目标质量辨识方法,为非合作目标抓捕后的自适应稳定回收控制奠定了一定基础。
由于系绳回收本身的负阻尼天然不稳定特性,以及近距离抓捕后复合体姿态对系绳运动影响较大,所以空间绳系机器人与被抓捕目标组成的复合体的近距离回收问题,同时包含了复合体的动力学参数辨识和回收控制两个问题,控制器设计较复杂。回收问题是整个绳系机器人任务的最后一阶段,也是任务成败的关键。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种空间绳系机器人近距离抓捕后回收目标的自适应控制方法,将目标稳定快速回收的自适应方法。
技术方案
一种空间绳系机器人近距离抓捕后回收目标的自适应控制方法,其特征在于步骤如下:
步骤1、建立复合体回收过程的动力学方程:
所述系统的广义坐标系q为系统的状态,是时间的函数,q(t)和τ(t)均表示为q和τ;
步骤2、计算回收所需要的控制输入τ:
步骤4、输入执行控制量τ至控制系统,完成复合体回收。
有益效果
本发明提出的一种空间绳系机器人近距离抓捕后回收目标的自适应控制方法,首先推导了由绳系机器人和被抓捕的目标卫星所组成的复合体,在回收过程中系统的动力学方程,然后通过李雅普诺夫定理,设计了回收过程中的控制力/力矩,设计了复合体动力学参数的辨识律,从而达到复合体的稳定回收。本发明首次提出了待回收复合体的动力学参数辨识律,可以使得整个回收过程,控制量的计算更加精准,从而回收更加平稳。
本发明使得空间绳系机器人抓捕非合作目标后所组成的复合体,可以通过系绳拉力稳定快速回收,该方法可以在复合体动力学参数的基础上,克服系绳回收问题中的天然不稳定性,将复合体稳定回收。
附图说明
图1:本发明系统框图
具体实施方式
现结合实施例、附图对本发明作进一步描述:
本发明实施例所采用的技术方案包括以下步骤:
1)建立复合体回收过程的动力学方程;
2)计算回收所需要的控制输入τ;
4)输入执行控制量τ,完成复合体回收。
所述的步骤1)中,如图所示,系绳回收复合体过程中,本体卫星R1,由卫星和绳系机器人组成的待回收复合体R2,以及系绳质心的位置分别为:
其中b1为本体卫星的质心到系绳连接点的位置矢量,b2为待回收复合体的质心到系绳连接点的位置矢量,r1为系统质心到本体卫星质心的位置矢量,r2为系统质心到复合体质心的位置矢量,rt为系统质心到系绳质心的位置矢量。
系统的平移动能为:
系统的转动动能为:
其中I1和I2分别为本体卫星和待回收复合体的转动惯量。ω1,ω2和ωt分别为本体卫星和待回收复合体的刚体旋转角速度。
系统的势能为:
其中μ为地球的引力常量398603×109m3/s2。
通过拉格朗日动力学公式,
可以得到系统的动力学公式。其中q是系统的广义坐标系,具体定义为 {θ1 ψ2 θ2ψ2 α β l}T,θ1是本体卫星的俯仰角,ψ2是本体卫星的偏航角,θ2是待回收复合体的俯仰角,ψ2是待回收复合体的偏航角,α是系绳的面内角(俯仰角),β是系绳的面外角(偏航角),l是系绳的实际长度。公式(5)中的表示广义坐标系q 对时间的导数,Qi为广义坐标系对应的广义力/力矩,具体表示为
由拉格朗日动力学得到的系统动力学方程可以写成标准形式:
其中q即为系统广义坐标系,是n×1的列向量,τ是系统的控制输入力/力矩,为n×1的列向量,M(q)是一个n×n的正定且对称的惯性矩阵,是一个n×n矩阵,G(q) 是一个n×1的列向量。其中,系统的广义坐标系q即为系统的状态,是时间的函数,在本发明中为了简便,q(t)和τ(t)均表示为q和τ。
在所述的步骤2)中,回收所需要的控制输入τ的具体计算方法为:
系统的动力学公式(6)可以改写成:
建立系统的李雅普诺夫方程为:
其中Γ和K均为正定对称矩阵。
将李雅普诺夫方程(8)对时间求导,可得
所以根据李雅普诺夫定律以及公式(9)的推导结果,可以得到待回收复合体稳定回收所需要的控制τ为:
公式(7)可以改写为
根据李雅普诺夫定理,选取参数辨识律为
即为待回收复合体的动力学参数的辨识律。
在抓捕后复合体回收过程中,动力学参数的辨识律和控制律可以保证复合体的稳定回收。
具体实施方式
第一步,建立回收过程中整个系统的动力学模型:
系绳回收复合体过程中,本体卫星R1,由卫星和绳系机器人组成的待回收复合体R2,以及系绳质心的位置分别为:
其中b1为本体卫星的质心到系绳连接点的位置矢量,b2为待回收复合体的质心到系绳连接点的位置矢量,r1为系统质心到本体卫星质心的位置矢量,r2为系统质心到复合体质心的位置矢量,rt为系统质心到系绳质心的位置矢量。
系统的平移动能为:
系统的转动动能为:
其中I1和I2分别为本体卫星和待回收复合体的转动惯量。ω1,ω2和ωt分别为本体卫星和待回收复合体的刚体旋转角速度。
系统的势能为:
其中μ为地球的引力常量398603×109m3/s2。
通过拉格朗日动力学公式可以得到系统的动力学公式。其中q是系统的广义坐标系,具体定义为{θ1 ψ2 θ2 ψ2 α β l}T,θ1是本体卫星的俯仰角,ψ2是本体卫星的偏航角,θ2是待回收复合体的俯仰角,ψ2是待回收复合体的偏航角,α是系绳的面内角(俯仰角),β是系绳的面外角(偏航角),l是系绳的实际长度。公式(5)中的表示广义坐标系q对时间的导数,Qi为广义坐标系对应的广义力/ 力矩,具体表示为
由拉格朗日动力学得到的系统动力学方程可以写成标准形式:
其中q即为系统广义坐标系,是n×1的列向量,τ是系统的控制输入力/力矩,为 n×1的列向量,M(q)是一个n×n的正定且对称的惯性矩阵,是一个n×n矩阵, G(q)是一个n×1的列向量。其中,系统的广义坐标系q即为系统的状态,是时间的函数,在本发明中为了简便,q(t)和τ(t)均表示为q和τ。
第二步,计算控制输入τ:
系统的动力学公式(6)可以改写成:
建立系统的李雅普诺夫方程为:
其中Γ和K均为正定对称矩阵。
将李雅普诺夫方程(8)对时间求导,可得
公式(7)可以改写为
根据李雅普诺夫定理,选取参数辨识律为
即为待回收复合体的动力学参数的辨识律。
Claims (1)
1.一种空间绳系机器人近距离抓捕后回收目标的自适应控制方法,其特征在于步骤如下:
步骤1、建立复合体回收过程的动力学方程:
所述系统的广义坐标系q为时间的函数,q(t)和τ(t)均表示为q和τ;
步骤2、计算回收所需要的控制输入τ:
步骤4、输入执行控制量τ至控制系统,完成复合体回收。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611049852.5A CN106855690B (zh) | 2016-11-24 | 2016-11-24 | 空间绳系机器人近距离抓捕后回收目标的自适应控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611049852.5A CN106855690B (zh) | 2016-11-24 | 2016-11-24 | 空间绳系机器人近距离抓捕后回收目标的自适应控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106855690A CN106855690A (zh) | 2017-06-16 |
CN106855690B true CN106855690B (zh) | 2020-04-03 |
Family
ID=59125526
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611049852.5A Active CN106855690B (zh) | 2016-11-24 | 2016-11-24 | 空间绳系机器人近距离抓捕后回收目标的自适应控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106855690B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107727297B (zh) * | 2017-09-11 | 2020-01-07 | 上海宇航系统工程研究所 | 一种基于系绳连接对失控卫星消旋的有效张力判定方法 |
CN107908855B (zh) * | 2017-11-10 | 2021-02-05 | 南京航空航天大学 | 刚-柔耦合空间带状绳系系统的建模方法 |
CN111230870B (zh) * | 2020-01-21 | 2021-08-03 | 上海电气集团股份有限公司 | 机器人控制方法、计算装置和存储介质 |
CN112607067B (zh) * | 2020-12-11 | 2022-07-29 | 北京空间机电研究所 | 一种可用于空间绳系控制捕获的多目标捕获切换系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6452598A (en) * | 1987-08-20 | 1989-02-28 | Nissan Motor | Tetherd satellite system |
US4824051A (en) * | 1986-01-16 | 1989-04-25 | Agence Spatiale Europeenne | Orbital system including a tethered satellite |
JP2006321374A (ja) * | 2005-05-19 | 2006-11-30 | Japan Aerospace Exploration Agency | テザー伸展装置 |
CN103955225A (zh) * | 2014-04-28 | 2014-07-30 | 西北工业大学 | 一种适合空间绳系机器人逼近目标过程中的燃料最优位姿协调方法 |
CN104252574A (zh) * | 2014-07-17 | 2014-12-31 | 西北工业大学 | 一种基于空间系绳抓捕系统的非合作目标质量辨识方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8052092B2 (en) * | 2009-01-30 | 2011-11-08 | The Boeing Company | Method and apparatus for satellite orbital change using space debris |
WO2013049588A1 (en) * | 2011-09-29 | 2013-04-04 | The Government Of The United States Of America, As Represented By The Secretary Of The Navy | Tethered spacecraft and separation system for tethered spacecraft |
CN104142687B (zh) * | 2014-07-17 | 2017-01-11 | 西北工业大学 | 一种空间绳系机械臂目标抓捕后复合体姿态稳定控制方法 |
CN105159309B (zh) * | 2015-09-01 | 2018-01-23 | 西北工业大学 | 一种利用偏置系绳的空间飞行器姿态稳定控制方法 |
CN105182748B (zh) * | 2015-09-01 | 2018-04-03 | 西北工业大学 | 一种空间绳系机器人目标抓捕稳定控制方法 |
CN105353790B (zh) * | 2015-11-17 | 2017-11-28 | 西北工业大学 | 一种空间绳系机器人目标抓捕后复合体稳定控制方法 |
CN105912005B (zh) * | 2016-05-16 | 2018-10-19 | 西北工业大学 | 利用系绳推力器的空间非合作目标姿态联合接管控制方法 |
-
2016
- 2016-11-24 CN CN201611049852.5A patent/CN106855690B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4824051A (en) * | 1986-01-16 | 1989-04-25 | Agence Spatiale Europeenne | Orbital system including a tethered satellite |
JPS6452598A (en) * | 1987-08-20 | 1989-02-28 | Nissan Motor | Tetherd satellite system |
JP2006321374A (ja) * | 2005-05-19 | 2006-11-30 | Japan Aerospace Exploration Agency | テザー伸展装置 |
CN103955225A (zh) * | 2014-04-28 | 2014-07-30 | 西北工业大学 | 一种适合空间绳系机器人逼近目标过程中的燃料最优位姿协调方法 |
CN104252574A (zh) * | 2014-07-17 | 2014-12-31 | 西北工业大学 | 一种基于空间系绳抓捕系统的非合作目标质量辨识方法 |
Non-Patent Citations (1)
Title |
---|
"空间绳系机器人捕获目标后的面内自适应回收方法";孟中杰等;《航空学报》;20151225;第36卷(第12期);正文第4035-4042页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106855690A (zh) | 2017-06-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106855690B (zh) | 空间绳系机器人近距离抓捕后回收目标的自适应控制方法 | |
Ryll et al. | 6D physical interaction with a fully actuated aerial robot | |
Mokhtari et al. | Extended state observer based control for coaxial-rotor UAV | |
Goodarzi et al. | Geometric control of a quadrotor UAV transporting a payload connected via flexible cable | |
Klausen et al. | Nonlinear control of a multirotor UAV with suspended load | |
Caccavale et al. | Adaptive control for UAVs equipped with a robotic arm | |
US10642285B2 (en) | Systems and methods for dynamics, modeling, simulation and control of mid-flight coupling of quadrotors | |
Nguyen et al. | Aerial tool operation system using quadrotors as rotating thrust generators | |
CN104252574A (zh) | 一种基于空间系绳抓捕系统的非合作目标质量辨识方法 | |
Lai et al. | Adaptive position/attitude tracking control of aerial robot with unknown inertial matrix based on a new robust neural identifier | |
CN105159304A (zh) | 接近并跟踪空间非合作目标的有限时间容错控制方法 | |
CN109240343B (zh) | 一种绳系机器人逼近目标位姿一体化控制方法 | |
Antonelli et al. | Adaptive trajectory tracking for quadrotor MAVs in presence of parameter uncertainties and external disturbances | |
Hua et al. | Homography-based visual servoing for autonomous underwater vehicles | |
CN107797449B (zh) | 一种信息不完备情形下的空间非合作目标接管控制方法 | |
CN107651224B (zh) | 基于单系绳连接点对空间失稳目标的分步消旋控制方法 | |
Cheng et al. | A neural adaptive controller in flapping flight | |
Mokhtari et al. | Sliding mode control for a small coaxial rotorcraft UAV | |
Pérez et al. | Attitude control of a quadcopter using adaptive control technique | |
Diao et al. | An output feedback attitude tracking controller design for quadrotor unmanned aerial vehicles using quaternion | |
Astudillo et al. | Optimal and robust controllers design for a smartphone-based quadrotor | |
Wang et al. | An anti-swing trajectory approach for an unmanned aerial vehicle with a slung payload | |
Qiao et al. | Fast trajectory tracking control of underactuated autonomous underwater vehicles | |
CN111975770B (zh) | 一种采用空间双臂机器人的自旋目标抓捕方法 | |
Jeong et al. | Bilateral teleoperation control of a quadrotor system with a haptic device: Experimental studies |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
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 |