CN105159315A - 面向空间绳系机器人的目标逼近过程鲁棒规划控制方法 - Google Patents
面向空间绳系机器人的目标逼近过程鲁棒规划控制方法 Download PDFInfo
- Publication number
- CN105159315A CN105159315A CN201510551771.4A CN201510551771A CN105159315A CN 105159315 A CN105159315 A CN 105159315A CN 201510551771 A CN201510551771 A CN 201510551771A CN 105159315 A CN105159315 A CN 105159315A
- Authority
- CN
- China
- Prior art keywords
- delta
- phi
- tether
- overbar
- sigma
- 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
Abstract
本发明公开了一种面向空间绳系机器人的目标逼近过程鲁棒规划控制方法,首先设计空间绳系机械人可移动系绳点控制方法,计算出期望系绳点空间位置,然后通过系绳控制机构对系绳进行回收或释放使得系绳点达到期望位置,从而实现在系绳参与绳系机器人轨道控制情况下,消除系绳对姿态的干扰,保证姿态的稳定,避免需要额外控制姿态带来的能量消耗。其次考虑了绳系机器人轨道控制阶段自身敏感器,系绳机构以及推力器等具有的不确定性因素,建立了绳系机器人对目标逼近的鲁棒规划模型,使得规划出的逼近方案对这些不确定因素的敏感性大大降低,并且大大提高了逼近方案的可靠性。
Description
【技术领域】
本发明隶属于航天器控制技术研究领域,涉及到一种空间绳系机械臂抓捕目标逼近控制方法,该控制方法可以广泛应用于空间绳系机械臂目标抓捕控制中。
【背景技术】
空间绳系机器人在失控卫星捕获,太空垃圾清理,辅助变轨,在轨维修,在轨组装,等方面可以发挥独特的优势。对目标的逼近过程的控制作为其关键技术是对目标实现成功抓捕的关键。
空间绳系机械人对目标逼近控制需考虑逼近过程中的轨道控制以及姿态稳定,对于空间绳系机械人,系绳可以为控制任务提供控制力和控制力矩,因而系绳的参与可以在一定程度上减轻推力器的任务压力,有助于节省空间机械人的能源消耗。而采用系绳和推力器协调对空间机械人轨道进行控制时,主要存在如下几个问题:首先是系绳张力容易对空间机械人带来力矩,进而对姿态的稳定带来干扰。而若采用姿态控制装置对该干扰进行补偿,无疑会带来新的能源消耗。因而对于以能源消耗最小为重要指标的逼近任务,故仅考虑逼近过程轨道控制中推力器的能源消耗,而不将其带来的额外姿态稳定控制能源消耗考虑在内是不合理的。其次,由于需要达到一定范围的接触条件才能保证捕获成功,因此在对目标的逼近过程中的任何轨道偏差都有可能使最后的条件不能满足该接触条件,进而导致抓捕失败甚至碰撞。而导致轨道偏差的因素主要有:模型偏差,轨道摄动,导航偏差,系绳张力矢量偏差,推进器矢量偏差,和推进器故障。由于抓捕任务持续时间较短,且只考虑抓捕机器人与目标航天器的相对运动,因而轨道摄动对该任务的影响十分有限可以忽略不计。推进器故障属于硬件故障,将对该任务产生很大影响,但任务期间硬件故障的发生是偶然性事件,不带有必然性,因而不在本文考虑范围。导航偏差主要包括位置,线速度,姿态,角速度等的测量偏差,主要原因是敏感器的安装误差以及测量性能的局限性。系绳张力矢量偏差主要包括张力大小以及方向的偏差,张力持续时间偏差,主要原因是系绳释放机构的不敏感性以及系绳矢量方向测量或计算偏差。推进器矢量偏差主要包括推力大小以及方向的偏差,推力持续时间偏差,空间机械臂质量偏差。以上这些不确定因素和偏差对任务的影响是巨大的,充分考虑这些因素进行对于抓捕任务的成功执行具有很大意义。因而有必要对绳系机器人逼近轨迹规划提出一种考虑不确定性的规划方法来降低任务对这些不确定性的敏感性,并提高方案的可靠性。
【发明内容】
提出一种绳系机器人可移动系绳点的控制方法,通过对系绳点的空间位置进行控制大幅度降低甚至消除系绳张力对空间绳系机器人的力矩,进而降低甚至消除了系绳张力对绳系机器人产生的姿态干扰。此时仅需考虑逼近过程轨道控制中推力器的能源消耗最小就可以得到能源消耗最小的逼近任务执行方案。提出一种考虑不确定性的绳系机器人逼近目标规划方法,采用推力器和系绳对绳系机器人进行控制,考虑导航偏差,系绳张力矢量偏差,推进器矢量偏差等不确定因素,建立绳系机器人逼近目标不确定规划模型,并采用粒子群优化算法进行求解,得到带有鲁棒性的空间绳系机器人控制方案。
为达到上述目的,本发明所采用的技术方案包括以下步骤:
1)空间绳系机械人可移动系绳点控制
在空间绳系机器人的后端面设置有a、b、c、d为四个系绳收放口,通过内部系绳控制电机对系绳长度进行控制,四条系绳la、lb、lc、ld连接于空间中点t,并且该点与平台连接的系绳相连,绳系机器人质心Ob在后端面的投影为O'b;在逼近过程中,通过对la、lb、lc、ld四条系绳的长度调整,控制t点在空间中的位置;平台位于点P;
使Ob,t,P三点共线,即:建立优化目标函数:
s.t.
采用优化算法进行求解得到λ=λ*,则则四个系绳收放口a、b、c、d据此对系绳长度进行调整,其中收放口a释放/收回系绳(其中当时为释放,当为收回),其他三个系绳收放口与收放口a相同;
2)建立空间绳系机械人相对目标运动不确定动力学模型
当目标和绳系机器人运行在近圆轨道时,通过C-W方程描述二者的相对运动,其状态空间模型为:
其中, U=U1+U2, 为推力器提供的速度脉冲,为与系绳拉力等效的速度脉冲,T为控制周期;
则
设任务要求在NT时间内完成,则将其离散为N个时间区间,则该离散系统的离散形式为:
X(k)=AX(k-1)+BUk-1
根据末端约束条件:
Hτ=[-I6I6]T,Kτ=[Γ+XfΓ-Xf]T;
推力器推力在大小和方向上存在偏差:
系绳张力矢量在大小和方向上存在偏差:
则进一步得到末端约束条件:
其中Y=|HτΦBMjΔVi|,
则空间绳系机械人相对目标运动不确定动力学模型为:
min(J)=||ΔV||1
s.t.
X0=X(1)
vmI3≤ΔVk≤vmI3,
3)模型求解
采用优化算法对步骤2)得到的空间绳系机械人相对目标运动不确定动力学模型进行求解,得到满足条件的控制向量ΔV以及
与现有技术相比,本发明具有以下有益效果:
本发明首先设计空间绳系机械人可移动系绳点控制方法,计算出期望系绳点空间位置,然后通过系绳控制机构对系绳进行回收或释放使得系绳点达到期望位置,从而实现在系绳参与绳系机器人轨道控制情况下,消除系绳对姿态的干扰,保证姿态的稳定,避免需要额外控制姿态带来的能量消耗。其次考虑了绳系机器人轨道控制阶段自身敏感器,系绳机构以及推力器等具有的不确定性因素,建立了绳系机器人对目标逼近的鲁棒规划模型,使得规划出的逼近方案对这些不确定因素的敏感性大大降低,并且大大提高了逼近方案的可靠性。
【附图说明】
图1系绳控制机构的示意图
其中,Ob为绳系机器人质心,O'b为Ob在后端面的投影,P为平台,t为可移动系绳点,a、b、c、d为四个系绳收放口。
【具体实施方式】
下面结合附图对本发明做进一步详细描述:
参见图1,本发明包括以下步骤:
首先,空间绳系机械人可移动系绳点控制:
确定平台在空间绳系机器人本体坐标系下的位置P,则代表系绳矢量。确定绳系机器人质心Ob在后端面的投影为O'b,当前系绳控制机构绳长为la、lb、lc、ld。并且分别确定矢量
则问题转化为优化问题:
s.t.
采用优化算法可以轻易求解得到λ=λ*,则则四个系绳收放口a、b、c、d可以据此对系绳长度进行调整,其中收放口a释放/收回系绳(其中当时为释放,当为收回)。其他三个系绳收放口同理故不再赘述。
然后,建立空间绳系机械人相对目标运动不确定动力学模型
根据执行机构的特性确定参数β1,β2,λk,μk,Flmax,vm。
确定相对运动离散化线性方程:
X(k)=AX(k-1)+BUk-1
K时刻系统的状态为:
则可以确定末端约束为:
Hτ=[-I6I6]T,Kτ=[Γ+XfΓ-Xf]T。
将系统各项不确定性考虑在内则该末端约束可以转化为:
则问题转化为:
min(J)=||ΔV||1
s.t.
X0=X(1)
vmI3≤ΔVk≤vmI3,
利用粒子群算法对上述目标函数进行优化,步骤为:
(1)初始化,产生M个粒子,每个粒子6*N维,分别对应推力器控制量和系绳控制量。
(2)计算目标函数以当前粒子中目标函数最小者为全局最优粒子,以当前粒子为个体最优粒子。
(3)按照粒子更新公式对种群中粒子进行更新,产生新一代粒子;
(4)对新一代的种群按照目标函数进行评价。更新全局最优粒子和个体最优粒子。
(5)达到最大迭代次数,输出全局最优粒子,算法结束。
以上内容仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明权利要求书的保护范围之内。
Claims (1)
1.面向空间绳系机器人的目标逼近过程鲁棒规划控制方法,其特征在于,包括以下步骤:
1)空间绳系机械人可移动系绳点控制
在空间绳系机器人的后端面设置有a、b、c、d为四个系绳收放口,通过内部系绳控制电机对系绳长度进行控制,四条系绳la、lb、lc、ld连接于空间中点t,并且该点与平台连接的系绳相连,绳系机器人质心Ob在后端面的投影为O'b;在逼近过程中,通过对la、lb、lc、ld四条系绳的长度调整,控制t点在空间中的位置;平台位于点P;
使Ob,t,P三点共线,即:建立优化目标函数:
s.t.
采用优化算法进行求解得到λ=λ*,则则四个系绳收放口a、b、c、d据此对系绳长度进行调整,其中收放口a释放/收回系绳(其中当时为释放,当为收回),其他三个系绳收放口与收放口a相同;
2)建立空间绳系机械人相对目标运动不确定动力学模型
当目标和绳系机器人运行在近圆轨道时,通过C-W方程描述二者的相对运动,其状态空间模型为:
其中, U=U1+U2, 为推力器提供的速度脉冲, 为与系绳拉力等效的速度脉冲,T为控制周期;
则
设任务要求在NT时间内完成,则将其离散为N个时间区间,则该离散系统的离散形式为:
X(k)=AX(k-1)+BUk-1
根据末端约束条件:
Hτ=[-I6I6]T,Kτ=[Γ+XfΓ-Xf]T;
推力器推力在大小和方向上存在偏差:
ΔVk=(1+λk)MckΔVk 0
系绳张力矢量在大小和方向上存在偏差:
则进一步得到末端约束条件:
其中
则空间绳系机械人相对目标运动不确定动力学模型为:
min(J)=||ΔV||1
s.t.
X0=X(1)
vmI3≤ΔVk≤vmI3,
3)模型求解
采用优化算法对步骤2)得到的空间绳系机械人相对目标运动不确定动力学模型进行求解,得到满足条件的控制向量ΔV以及
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510551771.4A CN105159315B (zh) | 2015-09-01 | 2015-09-01 | 面向空间绳系机器人的目标逼近过程鲁棒规划控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510551771.4A CN105159315B (zh) | 2015-09-01 | 2015-09-01 | 面向空间绳系机器人的目标逼近过程鲁棒规划控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105159315A true CN105159315A (zh) | 2015-12-16 |
CN105159315B CN105159315B (zh) | 2017-10-31 |
Family
ID=54800200
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510551771.4A Active CN105159315B (zh) | 2015-09-01 | 2015-09-01 | 面向空间绳系机器人的目标逼近过程鲁棒规划控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105159315B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108333924A (zh) * | 2018-01-18 | 2018-07-27 | 西北工业大学 | 一种操作交互过程中的虚拟夹具优化生成方法 |
CN114019800A (zh) * | 2021-11-08 | 2022-02-08 | 北京理工大学 | 一种用于绳网拖曳带帆板失效航天器的稳定控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02306900A (ja) * | 1989-04-24 | 1990-12-20 | Alcatel Thomson Espace | 静止通信衛生を軌道に乗せる方法 |
JPH05324072A (ja) * | 1992-05-18 | 1993-12-07 | Nippon Telegr & Teleph Corp <Ntt> | トンネルロボットの方向・位置制御コントローラ |
JPH10203479A (ja) * | 1997-01-23 | 1998-08-04 | Mitsubishi Heavy Ind Ltd | 水中ビークル位置・姿勢制御装置 |
GB2426601B (en) * | 1996-11-30 | 2007-05-02 | Daimler Benz Aerospace Ag | Target tracking missile guidance method |
CN102799187A (zh) * | 2012-06-26 | 2012-11-28 | 中国航空工业第六一八研究所 | 一种无人直升机喷施断点接续方法 |
CN102968124A (zh) * | 2012-11-29 | 2013-03-13 | 北京理工大学 | 基于模型不确定界的行星着陆轨迹跟踪鲁棒控制方法 |
CN103412485A (zh) * | 2013-07-22 | 2013-11-27 | 西北工业大学 | 基于滚动优化策略的刚体航天器姿态机动路径规划方法 |
CN104656666A (zh) * | 2015-03-11 | 2015-05-27 | 哈尔滨工业大学 | 针对空间非合作目标的相对轨道设计及高精度姿态指向控制方法 |
-
2015
- 2015-09-01 CN CN201510551771.4A patent/CN105159315B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02306900A (ja) * | 1989-04-24 | 1990-12-20 | Alcatel Thomson Espace | 静止通信衛生を軌道に乗せる方法 |
JPH05324072A (ja) * | 1992-05-18 | 1993-12-07 | Nippon Telegr & Teleph Corp <Ntt> | トンネルロボットの方向・位置制御コントローラ |
GB2426601B (en) * | 1996-11-30 | 2007-05-02 | Daimler Benz Aerospace Ag | Target tracking missile guidance method |
JPH10203479A (ja) * | 1997-01-23 | 1998-08-04 | Mitsubishi Heavy Ind Ltd | 水中ビークル位置・姿勢制御装置 |
CN102799187A (zh) * | 2012-06-26 | 2012-11-28 | 中国航空工业第六一八研究所 | 一种无人直升机喷施断点接续方法 |
CN102968124A (zh) * | 2012-11-29 | 2013-03-13 | 北京理工大学 | 基于模型不确定界的行星着陆轨迹跟踪鲁棒控制方法 |
CN103412485A (zh) * | 2013-07-22 | 2013-11-27 | 西北工业大学 | 基于滚动优化策略的刚体航天器姿态机动路径规划方法 |
CN104656666A (zh) * | 2015-03-11 | 2015-05-27 | 哈尔滨工业大学 | 针对空间非合作目标的相对轨道设计及高精度姿态指向控制方法 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108333924A (zh) * | 2018-01-18 | 2018-07-27 | 西北工业大学 | 一种操作交互过程中的虚拟夹具优化生成方法 |
CN108333924B (zh) * | 2018-01-18 | 2020-05-12 | 西北工业大学 | 一种操作交互过程中的虚拟夹具优化生成方法 |
CN114019800A (zh) * | 2021-11-08 | 2022-02-08 | 北京理工大学 | 一种用于绳网拖曳带帆板失效航天器的稳定控制方法 |
CN114019800B (zh) * | 2021-11-08 | 2023-09-15 | 北京理工大学 | 一种用于绳网拖曳带帆板失效航天器的稳定控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105159315B (zh) | 2017-10-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106707751B (zh) | 航天器终端接近的有限时间饱和避碰控制方法 | |
CN104142687B (zh) | 一种空间绳系机械臂目标抓捕后复合体姿态稳定控制方法 | |
CN104142686B (zh) | 一种卫星自主编队飞行控制方法 | |
CN102163057B (zh) | 一种自治飞艇平面路径跟踪控制方法 | |
CN105773617B (zh) | 空间机器人的三指式抓持器碰撞预测方法 | |
Sutherland et al. | Attitude control of a 2U cubesat by magnetic and air drag torques | |
CN103064423B (zh) | 多约束多航天器飞行间距预示及碰撞规避方法 | |
CN105739537A (zh) | 一种小天体表面附着运动主动控制方法 | |
Fan et al. | Robust attitude control for a rigid-flexible-rigid microsatellite with multiple uncertainties and input saturations | |
CN104108433A (zh) | 一种轮足式机器人的柔顺控制方法 | |
CN106114910A (zh) | 一种航天器飞行轨道滚动时域控制方法 | |
CN105353790A (zh) | 一种空间绳系机器人目标抓捕后复合体稳定控制方法 | |
Dafarra et al. | Torque-controlled stepping-strategy push recovery: Design and implementation on the iCub humanoid robot | |
CN103955225A (zh) | 一种适合空间绳系机器人逼近目标过程中的燃料最优位姿协调方法 | |
CN104076818A (zh) | 考虑线性化误差的空间交会系统的增益调度控制方法 | |
CN107696033A (zh) | 一种基于视觉测量的空间机械臂轨迹滚动规划方法 | |
CN105159315A (zh) | 面向空间绳系机器人的目标逼近过程鲁棒规划控制方法 | |
CN104058104A (zh) | 无加速度计情况下一种基于关调制的高精度轨控方法 | |
Virgili-Llop et al. | Laboratory experiments on the capture of a tumbling object by a spacecraft-manipulator system using a convex-programming-based guidance | |
Vadali et al. | Suboptimal command generation for control moment gyroscopes and feedback control of spacecraft | |
Morgan et al. | Decentralized model predictive control of swarms of spacecraft using sequential convex programming | |
CN103853047B (zh) | 一种基于状态量反馈的小推力跟踪制导方法 | |
CN113569391A (zh) | 地月转移轨道的参数确定方法、装置、设备及介质 | |
Lee et al. | Reactive bipedal walking method for torque controlled robot | |
CN112580188B (zh) | 一种运载火箭圆轨道在线规划方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |