CN105159315B - 面向空间绳系机器人的目标逼近过程鲁棒规划控制方法 - Google Patents
面向空间绳系机器人的目标逼近过程鲁棒规划控制方法 Download PDFInfo
- Publication number
- CN105159315B CN105159315B CN201510551771.4A CN201510551771A CN105159315B CN 105159315 B CN105159315 B CN 105159315B CN 201510551771 A CN201510551771 A CN 201510551771A CN 105159315 B CN105159315 B CN 105159315B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- msup
- mover
- 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
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τ=[-I6 I6]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τ=[-I6 I6]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三点共线,即:建立优化目标函数:
采用优化算法进行求解得到λ=λ*,则则四个系绳收放口a、b、c、d据此对系绳长度进行调整,其中收放口a释放/收回系绳其中当时为释放,当为收回;其他三个系绳收放口与收放口a相同;
2)建立空间绳系机械人相对目标运动不确定动力学模型
当目标和绳系机器人运行在近圆轨道时,通过C-W方程描述二者的相对运动,其状态空间模型为:
<mrow>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>A</mi>
<mi>X</mi>
<mo>+</mo>
<mi>B</mi>
<mi>U</mi>
</mrow>
其中,U=U1+U2,为推力器提供的速度脉冲,为与系绳拉力等效的速度脉冲,T为控制周期;
则
设任务要求在NT时间内完成,则将其离散为N个时间区间,则该离散系统的离散形式为:
X(k)=AX(k-1)+BUk-1
<mrow>
<mi>X</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mi>&Phi;</mi>
<mi>k</mi>
</msup>
<msub>
<mi>X</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msup>
<mi>&Phi;</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mi>i</mi>
</mrow>
</msup>
<mi>B</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&Delta;V</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>V</mi>
<mo>&OverBar;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
1
根据末端约束条件:
<mrow>
<msub>
<mi>H</mi>
<mi>&tau;</mi>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mi>&Phi;</mi>
<mi>N</mi>
</msup>
<msub>
<mi>X</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msup>
<mi>&Phi;</mi>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mi>i</mi>
</mrow>
</msup>
<mi>B</mi>
<mo>(</mo>
<mrow>
<msub>
<mi>&Delta;V</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>V</mi>
<mo>&OverBar;</mo>
</mover>
<mi>i</mi>
</msub>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<msub>
<mi>K</mi>
<mi>&tau;</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>f</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
Hτ=[-I6 I6]T,Kτ=[Γ+Xf Γ-Xf]T;
推力器推力在大小和方向上存在偏差:
<mrow>
<msub>
<mi>&Delta;V</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<msub>
<mi>&lambda;</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>M</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
<msup>
<msub>
<mi>&Delta;V</mi>
<mi>k</mi>
</msub>
<mn>0</mn>
</msup>
</mrow>
<mrow>
<msub>
<mi>M</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mo>|</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>&beta;</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<mo>|</mo>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>&beta;</mi>
<mn>1</mn>
</msub>
<mo>,</mo>
<mo>|</mo>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>&beta;</mi>
<mn>1</mn>
</msub>
</mrow>
系绳张力矢量在大小和方向上存在偏差:
<mrow>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>V</mi>
<mo>&OverBar;</mo>
</mover>
<mi>k</mi>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<msub>
<mi>&mu;</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>M</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
<mi>&Delta;</mi>
<msup>
<msub>
<mover>
<mi>V</mi>
<mo>&OverBar;</mo>
</mover>
<mi>k</mi>
</msub>
<mn>0</mn>
</msup>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<msub>
<mi>&mu;</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>M</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
<mfrac>
<mrow>
<msup>
<mover>
<mi>F</mi>
<mo>&RightArrow;</mo>
</mover>
<mi>k</mi>
</msup>
<mi>T</mi>
</mrow>
<mi>M</mi>
</mfrac>
</mrow>
<mrow>
<msub>
<mi>M</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mo>|</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>&beta;</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<mo>|</mo>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>&beta;</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<mo>|</mo>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>&beta;</mi>
<mn>2</mn>
</msub>
</mrow>
则进一步得到末端约束条件:
<mrow>
<msub>
<mi>H</mi>
<mi>&tau;</mi>
</msub>
<msup>
<mi>&Phi;</mi>
<mi>N</mi>
</msup>
<msub>
<mi>X</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<msub>
<mi>H</mi>
<mi>&tau;</mi>
</msub>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msup>
<mi>&Phi;</mi>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mi>i</mi>
</mrow>
</msup>
<mi>B</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&Delta;V</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>V</mi>
<mo>&OverBar;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>N</mi>
</munderover>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mn>4</mn>
</munderover>
<msub>
<mi>Y</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>N</mi>
</munderover>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mn>4</mn>
</munderover>
<msub>
<mover>
<mi>Y</mi>
<mo>&OverBar;</mo>
</mover>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>&le;</mo>
<msub>
<mi>K</mi>
<mi>&tau;</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>f</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
其中Y=|HτΦBMjΔVi|,
则空间绳系机械人相对目标运动不确定动力学模型为:
min(J)=||ΔV||1
s.t.
<mrow>
<mn>0</mn>
<mo>&le;</mo>
<msubsup>
<mi>F</mi>
<mi>l</mi>
<mi>k</mi>
</msubsup>
<mo>&le;</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>l</mi>
<mi> </mi>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mrow>
X0=X(1)
<mrow>
<msub>
<mi>H</mi>
<mi>&tau;</mi>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mi>&Phi;</mi>
<mi>N</mi>
</msup>
<msub>
<mi>X</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msup>
<mi>&Phi;</mi>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mi>i</mi>
</mrow>
</msup>
<mi>B</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&Delta;V</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>V</mi>
<mo>&OverBar;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<msub>
<mi>K</mi>
<mi>&tau;</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>f</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&Delta;V</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<msub>
<mi>&lambda;</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>M</mi>
<mrow>
<mi>c</mi>
<mi>k</mi>
</mrow>
</msub>
<msup>
<msub>
<mi>&Delta;V</mi>
<mi>k</mi>
</msub>
<mn>0</mn>
</msup>
</mrow>
<mrow>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>V</mi>
<mo>&OverBar;</mo>
</mover>
<mi>k</mi>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<msub>
<mi>&mu;</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>M</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
<mi>&Delta;</mi>
<msup>
<msub>
<mover>
<mi>V</mi>
<mo>&OverBar;</mo>
</mover>
<mi>k</mi>
</msub>
<mn>0</mn>
</msup>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<msub>
<mi>&mu;</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>M</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
<mfrac>
<mrow>
<msup>
<mover>
<mi>F</mi>
<mo>&RightArrow;</mo>
</mover>
<mi>k</mi>
</msup>
<mi>T</mi>
</mrow>
<mi>M</mi>
</mfrac>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<msub>
<mi>&mu;</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>M</mi>
<mrow>
<mi>l</mi>
<mi>k</mi>
</mrow>
</msub>
<mfrac>
<mrow>
<msub>
<mi>&eta;</mi>
<mi>k</mi>
</msub>
<msub>
<mover>
<mi>F</mi>
<mo>&RightArrow;</mo>
</mover>
<mrow>
<mi>l</mi>
<mi> </mi>
<mi>max</mi>
</mrow>
</msub>
<mi>T</mi>
</mrow>
<mi>M</mi>
</mfrac>
</mrow>
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 CN105159315A (zh) | 2015-12-16 |
CN105159315B true 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) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108333924B (zh) * | 2018-01-18 | 2020-05-12 | 西北工业大学 | 一种操作交互过程中的虚拟夹具优化生成方法 |
CN114019800B (zh) * | 2021-11-08 | 2023-09-15 | 北京理工大学 | 一种用于绳网拖曳带帆板失效航天器的稳定控制方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2647565B1 (fr) * | 1989-04-24 | 1991-07-26 | Alcatel Espace | Procede de mise a poste d'un satellite de telecommunications geostationnaire |
JPH05324072A (ja) * | 1992-05-18 | 1993-12-07 | Nippon Telegr & Teleph Corp <Ntt> | トンネルロボットの方向・位置制御コントローラ |
DE19649735A1 (de) * | 1996-11-30 | 2007-06-06 | LFK Lenkflugkörpersysteme GmbH | Lenkung für Flugkörper-Systeme mit Ziel-Tracker und zusätzlicher manueller Korrektur des Trackpunktes |
JPH10203479A (ja) * | 1997-01-23 | 1998-08-04 | Mitsubishi Heavy Ind Ltd | 水中ビークル位置・姿勢制御装置 |
CN102799187B (zh) * | 2012-06-26 | 2014-09-17 | 中国航空工业第六一八研究所 | 一种无人直升机喷施断点接续方法 |
CN102968124B (zh) * | 2012-11-29 | 2015-04-15 | 北京理工大学 | 基于模型不确定界的行星着陆轨迹跟踪鲁棒控制方法 |
CN103412485A (zh) * | 2013-07-22 | 2013-11-27 | 西北工业大学 | 基于滚动优化策略的刚体航天器姿态机动路径规划方法 |
CN104656666B (zh) * | 2015-03-11 | 2017-04-26 | 哈尔滨工业大学 | 针对空间非合作目标的相对轨道设计及高精度姿态指向控制方法 |
-
2015
- 2015-09-01 CN CN201510551771.4A patent/CN105159315B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105159315A (zh) | 2015-12-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Yang et al. | Energy-based nonlinear adaptive control design for the quadrotor UAV system with a suspended payload | |
Klemm et al. | Ascento: A two-wheeled jumping robot | |
CN106707751B (zh) | 航天器终端接近的有限时间饱和避碰控制方法 | |
CN104142687B (zh) | 一种空间绳系机械臂目标抓捕后复合体姿态稳定控制方法 | |
Hu | Robust adaptive sliding mode attitude maneuvering and vibration damping of three-axis-stabilized flexible spacecraft with actuator saturation limits | |
CN104345738B (zh) | 一种绳系释放稳定控制方法及电动力绳系末级离轨稳定控制方法 | |
Harl et al. | Reentry terminal guidance through sliding mode control | |
CN108303879B (zh) | 一种空间柔性系统的欠驱动控制方法 | |
CN105159304A (zh) | 接近并跟踪空间非合作目标的有限时间容错控制方法 | |
CN103955225B (zh) | 一种适合空间绳系机器人逼近目标过程中的燃料最优位姿协调方法 | |
Chak et al. | Disturbance observer-based fuzzy control for flexible spacecraft combined attitude & sun tracking system | |
JPH06135396A (ja) | 宇宙船の姿勢制御のための補償転換 | |
CN104460679A (zh) | 一种基于切换控制方法的挠性航天器欠驱动控制系统及其姿态控制方法 | |
Fan et al. | Robust attitude control for a rigid-flexible-rigid microsatellite with multiple uncertainties and input saturations | |
CN104656447A (zh) | 一种航天器抗干扰姿态跟踪的微分几何非线性控制方法 | |
CN105159315B (zh) | 面向空间绳系机器人的目标逼近过程鲁棒规划控制方法 | |
Guo et al. | Intelligent vehicle trajectory tracking based on neural networks sliding mode control | |
CN107933966B (zh) | 一种升降轨双模式的电动力绳系轨道转移方法及系统 | |
Mathavaraj et al. | Robust control of a reusable launch vehicle in reentry phase using model following neuro-adaptive design | |
CN104076818A (zh) | 考虑线性化误差的空间交会系统的增益调度控制方法 | |
CN103863578A (zh) | 火星着陆器喷气推力器和控制力矩陀螺复合控制系统 | |
CN112817233B (zh) | 一种基于迭代学习控制的小天体探测器绕飞段轨道跟踪控制方法 | |
Ding et al. | Trajectory linearization tracking control for dynamics of a multi-propeller and multifunction aerial robot-MMAR | |
Gonzalez-Hernandez et al. | Altitude control improvement for a Quadrotor UAV using integral action in a sliding-mode controller | |
Tanaka et al. | Development of a cyclogyro-based flying robot with variable attack angle mechanisms |
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 |