CN104635495B - 一种含模型参数不确定性平流层卫星的经向偏移分级控制方法 - Google Patents
一种含模型参数不确定性平流层卫星的经向偏移分级控制方法 Download PDFInfo
- Publication number
- CN104635495B CN104635495B CN201510066636.0A CN201510066636A CN104635495B CN 104635495 B CN104635495 B CN 104635495B CN 201510066636 A CN201510066636 A CN 201510066636A CN 104635495 B CN104635495 B CN 104635495B
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mover
- mfrac
- msup
- 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.)
- Expired - Fee Related
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- External Artificial Organs (AREA)
Abstract
一种含模型参数不确定性平流层卫星的经向偏移分级控制方法,有七大步骤;首先对六自由度动力学模型进行参数不确定性分析,克服无法用整体反馈线性化方法直接设计平流层卫星经向偏移控制律的难点,根据平流层卫星飞行机理,从上述六自由度模型中提取出“球‑绳子***”、“绳‑帆子***”和“帆‑舵子***”中含不确定参数的级联子***模型,再将控制问题分解为三个子问题,并基于子***模型分别设计这三个子问题的控制律。分别选取三个级联子***控制器参数,使“帆‑舵子***”的响应速度快于“绳‑帆子***”,且“绳‑帆子***”的响应速度快于“球‑绳子***”,最终在含模型参数不确定性的情况下可靠地实现平流层卫星经向偏移的高精度控制。
Description
技术领域
本发明涉及一种含模型参数不确定性平流层卫星的经向偏移分级控制方法,通过把***分解为含参数不确定性的三个级联子***,并根据相应子***分别设计自适应控制律、反馈线性化控制律和滑模变结构控制律来实现平流层卫星的经向偏移控制,为平流层卫星的环地球纬度自主飞行提供了更可靠的技术方案,属于自动控制技术领域。
背景技术
临近空间为海拔20~100km的空间范围,其底部(海拔10~50km)为平流层范围。平流层大气上下对流小,以稳定的大气环流为主。临近空间飞行器主要工作在海拔20km以上平流层。作为一种新型临近空间飞行器,平流层卫星在传统高空气球的基础上加装了动力装置来控制其经向偏移,以实现在稳定的大气环流作用下环地球纬度方向飞行。如图1所示,本发明针对的平流层卫星由高空气球、吊舱、系绳和带方向舵的气动帆构成。其中气球工作在海拔35km的高度,而气动帆通过长达15km的系绳悬挂于气球之下,工作在海拔20km的高度。气球和气动帆所在高度的风速差可达20m/s,调整气动帆方向舵可利用这一风速差改变气动帆的偏航角,从而改变气动帆所受的气动力,该气动力通过系绳作用于气球进而控制平流层卫星的经向偏移。与其它同类型的平流层飞行器相比,平流层卫星在能耗、制造、发射、回收和维护等方面有诸多优势。
为实现平流层卫星经向偏移的控制,现有的控制设计多基于参数已知的确定模型。实际上,受工作环境和测量精度的影响,一些模型参数(主要是惯性参数和气动参数)不可避免地具有不确定性,故无法得到参数已知的确定模型,也就难以实现平流层卫星经向偏移的有效控制。本发明的控制律设计基于一种六自由度动力学模型,模型中的惯性参数(气球附加惯性质量和气动帆转动惯量)与气动参数(气球阻力系数、气球等效面积、气动帆气动中心和方向舵气动中心)均存在不确定性。理论分析表明,对此模型无法用整体反馈线性化方法设计控制律进行经向偏移控制,故依据平流层卫星的飞行机理,从六自由度动力学模型中提取出含参数不确定性的三个级联子系,并针对这三个子***依次设计自适应控制律、反馈线性化控制律和滑模控制律,更可靠地实现平流层卫星经向偏移的高精度控制。
发明内容
(1)目的:本发明旨在提供一种含模型参数不确定性的平流层卫星经向偏移分级控制方法,它涉及三个含参数不确定性级联子***的自适应控制律、反馈线性化控制律和滑模变结构控制律设计。
(2)技术方案:本发明的主要内容是:首先确定实现平流层卫星经向偏移控制所用的六自由度动力学模型,然后对其进行参数不确定性分析,接着为克服无法用整体反馈线性化方法直接设计平流层卫星经向偏移控制律的难点,根据平流层卫星的飞行机理,从上述六自由度模型中提取出“球-绳子***”、“绳-帆子***”和“帆-舵子***”这三个含不确定参数的级联子***模型,再将“舵控制球”的控制问题分解为“舵控制帆”、“帆控制绳”和“绳控制球”这三个子控制问题,并分别设计这三个子问题的控制律。先基于“球-绳子***”模型用自适应控制方法设计出实现平流层卫星经向偏移控制所需的系绳侧偏角,再基于“绳-帆子***”模型用反馈线性化方法设计出跟踪系绳侧偏角所需的气动帆偏航角,最后基于“帆-舵子***”模型用滑模控制方法设计出跟踪气动帆偏航角所需的方向舵偏角。分别选取三个级联子***的控制器参数,使“帆-舵子***”的响应速度快于“绳-帆子***”,且“绳-帆子***”的响应速度快于“球-绳子***”,最终可在含模型参数不确定性的情况下更可靠地实现平流层卫星经向偏移的高精度控制。
为实现上述方案,本发明“一种含模型参数不确定性的平流层卫星经向偏移分级控制方法”的具体设计步骤如下:
步骤一选取控制模型,这里采用一种平流层卫星六自由度动力学模型;
步骤二分析模型参数不确定性,其中主要考虑惯性参数和气动参数的不确定性;
步骤三从六自由度动力学模型中分别提取出“球-绳子***”、“绳-帆子***”和“帆-舵子***”模型,并定义组合参数;
步骤四基于“球-绳子***”模型用自适应控制方法设计跟踪平流层卫星经向期望轨迹所需的系绳侧偏角;
步骤五基于“绳-帆子***”模型用反馈线性化方法设计跟踪系绳侧偏角所需的气动帆偏航角;
步骤六基于“帆-舵子***”模型用滑模控制方法设计跟踪气动帆偏航角所需的方向舵偏角;
步骤七选取相应子***的控制器参数使得“绳-帆子***”的响应速度快于“球-绳子***”,而“帆-舵子***”的响应速度快于“绳-帆子***”。
其中,在步骤一中所述的“选取控制模型,这里采用一种平流层卫星六自由度动力学模型”,其中六个自由度包括气球系绳点的经度、纬度和高度,系绳的倾角和侧偏角以及气动帆的偏航角。
其中,在步骤二中所述的“分析模型参数不确定性,其中主要考虑惯性参数和气动参数的不确定性”,所涉及的惯性参数有气球附加惯性质量和气动帆的转动惯量,气动参数有气球阻力系数、气球等效面积、气动帆气动中心和方向舵气动中心。
其中,在步骤三中所述的“从六自由度动力学模型中分别提取出‘球-绳子***’、‘绳-帆子***’和‘帆-舵子***’模型”,其提取方法是:“球-绳子***”模型根据气球和系绳的受力分析得到;“绳-帆子***”模型由六自由度动力学模型的第五行简化而来,“帆-舵子***”模型则为六自由度动力学模型的第六行。
其中,在步骤四中所述的“基于‘球-绳子***’模型用自适应控制方法设计跟踪平流层卫星经向期望轨迹所需的系绳侧偏角”,控制律中所涉平流层卫星经向期望轨迹为基于反正切函数设计的一条由经度偏移位置缓慢变化到预定纬度轨道位置的曲线。
其中,在步骤五中所述的“基于‘绳-帆子***’模型用反馈线性化方法设计跟踪系绳侧偏角所需的气动帆偏航角”,反馈控制律中所涉期望系绳侧偏角的一阶和二阶导数通过构造二阶滤波器获得。
其中,在步骤六中所述的“基于‘帆-舵子***’模型用滑模控制方法设计跟踪气动帆偏航角所需的方向舵偏角”,控制律中所涉期望气动帆偏航角的一阶和二阶导数通过构造另一二阶滤波器获得。
(3)优点及效果:
与现有技术相比,本发明的优点和效果是:
考虑了平流层卫星六自由度动力学模型中含参数不确定性的经向偏移控制方法,克服了依赖精确模型设计平流层卫星经向偏移控制律的困难,更接近于实用,具体表现在:
①在“球-绳子***”的闭环控制***设计中采用了自适应控制方法,可在气球惯性参数和气动参数不确定时实现有效的高精度控制;
②在“帆-舵子***”的闭环控制***设计中采用了滑模控制方法,可在气动帆及方向舵的惯性参数和气动参数不确定时实现有效的高精度控制。
附图说明
图1平流层卫星示意图;
图2含模型参数不确定性的平流层卫星经向偏移控制算法流程图。
图中符号说明如下:
Oexeyeze—地面坐标系;OSxSySzS—帆坐标系;OBxBayBazBa—球气流坐标系;OSxSaySazSa—帆气流坐标系;V35—海拔35km风速;V20—海拔20km风速;OBOS—系绳;OBOS′—系绳在面Oexeze上的投影;α—OBOS′与轴Oeze的夹角(系绳倾角);β—OBOS与OBOS′的夹角(系绳侧偏角);βB—OBxBa与轴Oexe的夹角;ψ—OSxS与轴Oexe的夹角(气动帆偏航角);βS—OSxS与轴OSxSa的夹角。
具体实施方式
下面结合图2,对本发明中的设计方法作进一步的说明:
步骤一提出控制模型。
图1中各坐标系的建立基于以下假设:
i)视地面坐标系为惯性坐标系;
ii)气球始终处于浮重平衡状态且不考虑其转动;
iii)系绳为直线状并忽略其扭转及气动力影响;
iv)气动帆始终于铅垂面内运动;
v)忽略垂直方向气流影响。
如图1所示,各坐标系定义如下:
i)地面坐标系Oexeyeze:Oe为地面一固定点;Oexe朝正东方向;Oeze竖直向下;Oeye与Oexe、Oeze构成右手坐标系。
ii)气动帆坐标系OSxSySzS:与气动帆固连。OS为帆系绳点,OSxS沿平衡杆向前;OSzS在帆对称平面内垂直OSxS向下;OSyS与OSxS、OSzS构成右手系。
iii)球气流坐标系OBxBayBazBa:OB为球系绳点,OBxBa沿球空速方向;OBzBa在含OBxBa的铅垂平面内垂直OBxBa向下;OByBa垂直于面OBxBazBa向右。
iv)帆气流坐标系OSxSaySazSa:OS为帆系绳点,OSxSa指向气动帆空速方向;OSzSa在包含OSxSa的铅垂平面内垂直OSxSa向下;OSySa垂直面OSxSazSa向右。
选取广义坐标q=[x,y,z,α,β,ψ]T,其中x,y,z为球系绳点在惯性坐标系下的位移,α为系绳倾角,β为系绳侧偏角,ψ为气动帆偏航角,具体参见图1。平流层卫星的六自由度动力学模型可表示为
其中H(q)=[hij]为6×6对称矩阵为正定对称矩阵,其非零元为
h11=h22=h33=mB+mT+mS+m′,
其中
n6=(AS1sinψ-AS2cosψ)xA+(AR1sinψ-AR2cosψ)βSxR;
Q=bδ,其中b=[b1,...,b6]T,
b1=AR1,b2=AR2,b2=0,b4=-AR1lcosαcosβ,b5=(AR1sinαsinβ+AR2cosβ)l,
b6=-(AR1sinψ-AR2cosψ)xR。
式(1)中所涉及参数说明如下:
mB—气球质量;mT—系绳质量;mS—气动帆质量;m′—气球附加惯性系数;l—系绳长度;Jz—气动帆绕OSzS轴的转动惯量;AB1—气球前向气动分力,有AB1=-QBSBCBcosβB,这里QB为气球动压,SB为气球等效面积,CB为气球阻力系数;AB2—气球侧向气动分力,有AB2=-QBSBCBsinβB;AS1—气动帆前向阻力,有AS1=QSSSCS sin(ψ+βS),这里QS为气动帆动压,SS为气动帆等效面积,CS为气动帆升力系数;AS2—气动帆侧向阻力,有AS2=-QSSSCScos(ψ+βS);AR1—方向舵前向阻力,有AR1=QSSRCRsin(ψ+βS),这里SR为方向舵等效面积,CR为方向舵升系数;AR2—方向舵侧向阻力,有AR2=-QSSRCRcos(ψ+βS);xA—气动帆气动中心到气动帆系绳点距离;xR—方向舵气动中心到气动帆系绳点距离;δ—方向舵偏角。
步骤二分析模型参数不确定性。
经分析,动力学模型(1)中含有不确定性参数主要有两类,其中惯性参数有气球附加惯性系数m′和气动帆转动惯量JZ;气动参数有气球等效面积SB,气球阻力系数CB,气动帆气动中心到气动帆系绳点距离xA和方向舵气动中心到气动帆系绳点距离xR。
步骤三从六自由度动力学模型中提取出“球-绳子***”、“绳-帆子***”和“帆-舵子***”模型,并定义组合参数。
“球-绳子***”的动力学方程为
“绳-帆子***”的动力学方程为
其中a和b分别为气动帆空速沿地面系Oexe和Oeye的分量,
“帆-舵子***”的动力学方程为
根据上述方程,可进一步定义含不确定性的组合参数a1=mB+m′,a2=SBCB,a3=-xA/Jz>0,a4=-xR/Jz>0。
步骤四基于“球-绳子***”模型用自适应控制方法设计跟踪平流层卫星经向期望轨迹所需的系绳侧偏角。
设A点为平流层卫星的当前位置,B点为位于预定轨道上的一点,PA和PB分别为点A和B沿地面Oeye轴坐标,则基于双曲正切函数设计的耗时ts从A点机动到B点的轨迹为
yd(t)=[(PB-PA)tanh(10t/ts-5)]/2+(PB+PA)/2 (5)
根据定义的组合参数,“球-绳子***”的动力学方程可写为
定义经向轨迹跟踪误差e1=y-yd,组合误差以及可设计出保证e1收敛到零所需的系绳侧偏角为
其中k1>0,和分别为组合参数a1和a2的估计值且其变化遵循自适应律
其中γ>0。
步骤五基于“绳-帆子***”模型用反馈线性化方法设计跟踪系绳侧偏角所需的气动帆偏航角。
定义系绳侧偏角跟踪误差e2=β-βd,设计出可保证e2收敛到零所需的气动帆偏航角为
其中kd2>0,kp2>0。为克服上式中和计算的复杂性,构造二阶滤波器
使得其中ε2为正常数。用ζ2替换替换则有
步骤六基于“帆-舵子***”模型用滑模控制方法设计跟踪气动帆偏航角所需的方向舵偏角。
根据定义的组合参数,“帆-舵子***”的动力学方程可写为
定义气动帆偏航角误差e3=ψ-ψd,组合误差其中λ3>0,f1=AS1sinψ-AS2cosψ,f2=AR1sinψ-AR2cosψ。取和为组合参数a3和a4的估计值,为组合参数a3和a4的估计误差,和为Δ3和Δ4的边界。同样地,构造二阶滤波器
其中ε3为正常数。于是可用η2替换替换得到使e3有界所需的方向舵偏角为
其中σ0>0,ε>0,为饱和函数,定义如下
步骤七选取控制律参数
选取控制器参数k1,λ1,kp2,kd2,λ3和ε,使“帆-舵子***”的闭环***响应频率比“绳-帆子***”的闭环***响应频率高一个数量级,“球-绳子***”的闭环***响应频率比“帆-舵子***”的闭环***响应频率高一个数量级。一般地,可取k1=40,λ1=0.01,kp2=0.04,kd2=0.4,λ3=4和ε=0.02。
Claims (1)
1.一种含模型参数不确定性的平流层卫星经向偏移分级控制方法,其特征在于:包括如下步骤:
步骤一提出控制模型;采用一种平流层卫星六自由度动力学模型;
平流层卫星的六自由度动力学模型表示为:
<mrow>
<mi>H</mi>
<mrow>
<mo>(</mo>
<mi>q</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>N</mi>
<mrow>
<mo>(</mo>
<mi>q</mi>
<mo>,</mo>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>Q</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中H(q)=[hij]为6×6对称矩阵为正定对称矩阵,其非零元为
h11=h22=h33=mB+mT+mS+m′,
<mrow>
<msub>
<mi>h</mi>
<mn>15</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mi> </mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mo>,</mo>
<msub>
<mi>h</mi>
<mn>25</mn>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
<mo>,</mo>
<msub>
<mi>h</mi>
<mn>34</mn>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mi> </mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>h</mi>
<mn>35</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mi>sin</mi>
<mi>&beta;</mi>
<mo>,</mo>
<msub>
<mi>h</mi>
<mn>44</mn>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mn>3</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<msup>
<mi>cos</mi>
<mn>2</mn>
</msup>
<mi>&beta;</mi>
<mo>,</mo>
<msub>
<mi>h</mi>
<mn>45</mn>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mn>24</mn>
</mfrac>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<mi>sin</mi>
<mn>2</mn>
<mi>&alpha;</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mn>2</mn>
<mi>&beta;</mi>
<mo>,</mo>
</mrow>
h66=Jz;
其中
<mrow>
<msub>
<mi>n</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
<mo>+</mo>
<mn>2</mn>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mo>+</mo>
<msup>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>B</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>S</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>R</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>&beta;</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>n</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>l</mi>
<msup>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mi>sin</mi>
<mi>&beta;</mi>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>B</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>S</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>R</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>&beta;</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>n</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
<mo>-</mo>
<mn>2</mn>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mo>+</mo>
<msup>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mo>,</mo>
</mrow>
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>n</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mrow>
<mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mn>3</mn>
</mfrac>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>sin</mi>
<mn>2</mn>
<mi>&beta;</mi>
<mo>-</mo>
<mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mn>12</mn>
</mfrac>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<msup>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mrow>
<mo>(</mo>
<mrow>
<mn>4</mn>
<msup>
<mi>cos</mi>
<mn>2</mn>
</msup>
<msup>
<mi>&alpha;cos</mi>
<mn>2</mn>
</msup>
<mi>&beta;</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
<mi>sin</mi>
<mn>2</mn>
<mi>&alpha;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mrow>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<msub>
<mi>g</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<msub>
<mi>g</mi>
<mi>S</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&alpha;</mi>
<mi>cos</mi>
<mi>&beta;</mi>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>A</mi>
<mrow>
<mi>S</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>R</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>&beta;</mi>
<mi>S</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&alpha;</mi>
<mi>cos</mi>
<mi>&beta;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>,</mo>
</mrow>
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>n</mi>
<mn>5</mn>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mrow>
<mfrac>
<mn>1</mn>
<mn>12</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>6</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<msup>
<mi>cos</mi>
<mn>2</mn>
</msup>
<mi>&alpha;</mi>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<msup>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mi>sin</mi>
<mn>2</mn>
<mi>&beta;</mi>
<mo>+</mo>
<mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mn>6</mn>
</mfrac>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mn>4</mn>
<msup>
<mi>&alpha;cos</mi>
<mn>2</mn>
</msup>
<mi>&beta;</mi>
<mo>+</mo>
<mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mn>24</mn>
</mfrac>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<msup>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<msup>
<mi>sin</mi>
<mn>2</mn>
</msup>
<mn>2</mn>
<mi>&alpha;</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mn>2</mn>
<mi>&beta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>+</mo>
<mo>(</mo>
<mrow>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<msub>
<mi>g</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<msub>
<mi>g</mi>
<mi>S</mi>
</msub>
</mrow>
<mo>)</mo>
<mi>l</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mi>sin</mi>
<mi>&beta;</mi>
<mo>-</mo>
<mo>(</mo>
<mrow>
<msub>
<mi>A</mi>
<mrow>
<mi>S</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>R</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>&beta;</mi>
<mi>S</mi>
</msub>
</mrow>
<mo>)</mo>
<mi>l</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&alpha;</mi>
<mi>sin</mi>
<mi>&beta;</mi>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>S</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>R</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>&beta;</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mi> </mi>
<mi>cos</mi>
<mi>&beta;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>,</mo>
</mrow>
n6=(AS1sinψ-AS2cosψ)xA+(AR1sinψ-AR2cosψ)βSxR;
Q=bδ,其中b=[b1,...,b6]T,
b1=AR1,b2=AR2,b2=0,b4=-AR1lcosαcosβ,b5=(AR1sinαsinβ+AR2cosβ)l,
b6=-(AR1sinψ-AR2cosψ)xR;
式(1)中所涉及参数说明如下:
mB—气球质量;mT—系绳质量;mS—气动帆质量;m′—气球附加惯性系数;l—系绳长度;Jz—气动帆绕OSzS轴的转动惯量;AB1—气球前向气动分力,有AB1=-QBSBCBcosβB,这里QB为气球动压,SB为气球等效面积,CB为气球阻力系数;AB2—气球侧向气动分力,有AB2=-QBSBCBsinβB;AS1—气动帆前向阻力,有AS1=QSSSCSsin(ψ+βS),这里QS为气动帆动压,SS为气动帆等效面积,CS为气动帆升力系数;AS2—气动帆侧向阻力,有AS2=-QSSSCScos(ψ+βS);AR1—方向舵前向阻力,有AR1=QSSRCRsin(ψ+βS),这里SR为方向舵等效面积,CR为方向舵升系数;AR2—方向舵侧向阻力,有AR2=-QSSRCRcos(ψ+βS);xA—气动帆气动中心到气动帆系绳点距离;xR—方向舵气动中心到气动帆系绳点距离;δ—方向舵偏角;
步骤二分析模型参数不确定性;
动力学模型(1)中含有不确定性参数有两类,其中惯性参数有气球附加惯性系数m′和气动帆转动惯量JZ;气动参数有气球等效面积SB,气球阻力系数CB,气动帆气动中心到气动帆系绳点距离xA和方向舵气动中心到气动帆系绳点距离xR;
步骤三从六自由度动力学模型中提取出“球-绳子***”、“绳-帆子***”和“帆-舵子***”模型,并定义组合参数;
“球-绳子***”的动力学方程为
<mrow>
<mo>(</mo>
<msub>
<mi>m</mi>
<mi>B</mi>
</msub>
<mo>+</mo>
<msup>
<mi>m</mi>
<mo>&prime;</mo>
</msup>
<mo>)</mo>
<mover>
<mi>y</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mi>Q</mi>
<mi>B</mi>
</msub>
<msub>
<mi>S</mi>
<mi>B</mi>
</msub>
<msub>
<mi>C</mi>
<mi>B</mi>
</msub>
<msub>
<mi>sin&beta;</mi>
<mi>B</mi>
</msub>
<mo>=</mo>
<mo>(</mo>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<msub>
<mi>g</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<msub>
<mi>g</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
<mi>sec</mi>
<mi>&alpha;</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
“绳-帆子***”的动力学方程为
<mrow>
<msub>
<mi>h</mi>
<mn>55</mn>
</msub>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>P</mi>
<mrow>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>,</mo>
<mi>&beta;</mi>
<mo>,</mo>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mn>2</mn>
<msub>
<mi>&pi;Q</mi>
<mi>S</mi>
</msub>
<msub>
<mi>S</mi>
<mi>S</mi>
</msub>
<mi>l</mi>
<mo>&lsqb;</mo>
<mi>&psi;</mi>
<mo>-</mo>
<mi>arctan</mi>
<mrow>
<mo>(</mo>
<mi>b</mi>
<mo>/</mo>
<mi>a</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
其中a和b分别为气动帆空速沿地面系Oexe和Oeye的分量,
<mfenced open = "" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>P</mi>
<mrow>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>,</mo>
<mi>&beta;</mi>
<mo>,</mo>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mn>12</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>6</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<msup>
<mi>cos</mi>
<mn>2</mn>
</msup>
<mi>&alpha;</mi>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<msup>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<mi>sin</mi>
<mn>2</mn>
<mi>&beta;</mi>
<mo>+</mo>
<mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mn>6</mn>
</mfrac>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>sin</mi>
<mn>4</mn>
<msup>
<mi>&alpha;cos</mi>
<mn>2</mn>
</msup>
<mi>&beta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>+</mo>
<mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<mn>24</mn>
</mfrac>
<msup>
<mi>l</mi>
<mn>2</mn>
</msup>
<msup>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msup>
<msup>
<mi>sin</mi>
<mn>2</mn>
</msup>
<mn>2</mn>
<mi>&alpha;</mi>
<mi>sin</mi>
<mn>2</mn>
<mi>&beta;</mi>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<msub>
<mi>g</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<msub>
<mi>g</mi>
<mi>S</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mi>l</mi>
<mi> </mi>
<mi>cos</mi>
<mi>&alpha;</mi>
<mi>sin</mi>
<mi>&beta;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
“帆-舵子***”的动力学方程为
<mrow>
<msub>
<mi>J</mi>
<mi>z</mi>
</msub>
<mover>
<mi>&psi;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>x</mi>
<mi>A</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>S</mi>
<mn>1</mn>
</mrow>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&psi;</mi>
<mo>-</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>S</mi>
<mn>2</mn>
</mrow>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&psi;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>R</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>R</mi>
<mn>1</mn>
</mrow>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&psi;</mi>
<mo>-</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>R</mi>
<mn>2</mn>
</mrow>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&psi;</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>&delta;</mi>
<mo>+</mo>
<msub>
<mi>&beta;</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
根据上述方程,进一步定义含不确定性的组合参数a1=mB+m′,a2=SBCB,a3=-xA/Jz>0,a4=-xR/Jz>0;
步骤四基于“球-绳子***”模型用自适应控制方法设计跟踪平流层卫星经向期望轨迹所需的系绳侧偏角;
设A点为平流层卫星的当前位置,B点为位于预定轨道上的一点,PA和PB分别为点A和B沿地面Oeye轴坐标,则基于双曲正切函数设计的耗时ts从A点机动到B点的轨迹为
yd(t)=[(PB-PA)tanh(10t/ts-5)]/2+(PB+PA)/2 (5)
根据定义的组合参数,“球-绳子***”的动力学方程写为
<mrow>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<msub>
<mi>Q</mi>
<mi>B</mi>
</msub>
<msub>
<mi>sin&beta;</mi>
<mi>B</mi>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<msub>
<mi>g</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<msub>
<mi>g</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>sec</mi>
<mi>&alpha;</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
定义经向轨迹跟踪误差e1=y-yd,组合误差以及设计出保证e1收敛到零所需的系绳侧偏角为
<mrow>
<msup>
<mi>&beta;</mi>
<mi>d</mi>
</msup>
<mo>=</mo>
<mi>arctan</mi>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
</msub>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<mi>r</mi>
<mo>-</mo>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mn>2</mn>
</msub>
<msub>
<mi>Q</mi>
<mi>B</mi>
</msub>
<msub>
<mi>sin&beta;</mi>
<mi>B</mi>
</msub>
<mo>)</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
</mrow>
<mrow>
<msub>
<mi>m</mi>
<mi>T</mi>
</msub>
<msub>
<mi>g</mi>
<mi>T</mi>
</msub>
<mo>+</mo>
<msub>
<mi>m</mi>
<mi>S</mi>
</msub>
<msub>
<mi>g</mi>
<mi>S</mi>
</msub>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
其中k1>0,和分别为组合参数a1和a2的估计值且其变化遵循自适应律
<mrow>
<msub>
<mover>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mi>&gamma;</mi>
<mi>r</mi>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>r</mi>
</msub>
<mo>,</mo>
<msub>
<mover>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&gamma;rQ</mi>
<mi>B</mi>
</msub>
<msub>
<mi>sin&beta;</mi>
<mi>B</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
其中γ>0;
步骤五基于“绳-帆子***”模型用反馈线性化方法设计跟踪系绳侧偏角所需的气动帆偏航角;
定义系绳侧偏角跟踪误差e2=β-βd,设计出可保证e2收敛到零所需的气动帆偏航角为
<mrow>
<msup>
<mi>&psi;</mi>
<mi>d</mi>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mi>P</mi>
<mrow>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>,</mo>
<mi>&beta;</mi>
<mo>,</mo>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>h</mi>
<mn>55</mn>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>d</mi>
</msup>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>p</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>e</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>&pi;Q</mi>
<mi>S</mi>
</msub>
<msub>
<mi>S</mi>
<mi>S</mi>
</msub>
<mi>l</mi>
<mi> </mi>
<mi>cos</mi>
<mi>&beta;</mi>
</mrow>
</mfrac>
<mo>+</mo>
<mi>arctan</mi>
<mfrac>
<mi>b</mi>
<mi>a</mi>
</mfrac>
</mrow>
其中kd2>0,kp2>0;为克服上式中和计算的复杂性,构造二阶滤波器
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>&zeta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>&zeta;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>&zeta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>&epsiv;</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
</mfrac>
<mrow>
<mo>(</mo>
<mo>-</mo>
<msub>
<mi>&epsiv;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>&zeta;</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&zeta;</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msup>
<mi>&beta;</mi>
<mi>d</mi>
</msup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
使得其中ε2为正常数;用ζ2替换替换则有
<mrow>
<msup>
<mi>&psi;</mi>
<mi>d</mi>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mi>P</mi>
<mrow>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>,</mo>
<mi>&beta;</mi>
<mo>,</mo>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>,</mo>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>h</mi>
<mn>55</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&zeta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
</msub>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>d</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>&zeta;</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>p</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>e</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>&pi;Q</mi>
<mi>S</mi>
</msub>
<msub>
<mi>S</mi>
<mi>S</mi>
</msub>
<mi>l</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
</mrow>
</mfrac>
<mo>+</mo>
<mi>arctan</mi>
<mfrac>
<mi>b</mi>
<mi>a</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
步骤六基于“帆-舵子***”模型用滑模控制方法设计跟踪气动帆偏航角所需的方向舵偏角;
根据定义的组合参数,“帆-舵子***”的动力学方程写为
<mrow>
<mover>
<mi>&psi;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mi>a</mi>
<mn>3</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>S</mi>
<mn>1</mn>
</mrow>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&psi;</mi>
<mo>-</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>S</mi>
<mn>2</mn>
</mrow>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&psi;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>a</mi>
<mn>4</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>R</mi>
<mn>1</mn>
</mrow>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&psi;</mi>
<mo>-</mo>
<msub>
<mi>A</mi>
<mrow>
<mi>R</mi>
<mn>2</mn>
</mrow>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&psi;</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>&delta;</mi>
<mo>+</mo>
<msub>
<mi>&beta;</mi>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
定义气动帆偏航角误差e3=ψ-ψd,组合误差其中λ3>0,f1=AS1sinψ-AS2cosψ,f2=AR1sinψ-AR2cosψ;取和为组合参数a3和a4的估计值,为组合参数a3和a4的估计误差,和为Δ3和Δ4的边界;同样地,构造二阶滤波器
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>&eta;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>&epsiv;</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
</mfrac>
<mrow>
<mo>(</mo>
<mo>-</mo>
<msub>
<mi>&epsiv;</mi>
<mn>3</mn>
</msub>
<msub>
<mi>&eta;</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&eta;</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msup>
<mi>&psi;</mi>
<mi>d</mi>
</msup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
其中ε3为正常数;于是用η2替换 替换得到使e3有界所需的方向舵偏角为
<mrow>
<mi>&delta;</mi>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mn>3</mn>
</msub>
<msub>
<mi>f</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>f</mi>
<mn>3</mn>
</msub>
</mrow>
<mrow>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mn>4</mn>
</msub>
<msub>
<mi>f</mi>
<mn>2</mn>
</msub>
</mrow>
</mfrac>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mi>S</mi>
</msub>
<mo>+</mo>
<mo>&lsqb;</mo>
<mfrac>
<msub>
<mover>
<mi>&Delta;</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mrow>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&Delta;</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
</mrow>
</mfrac>
<mo>|</mo>
<mfrac>
<msub>
<mi>f</mi>
<mn>1</mn>
</msub>
<msub>
<mi>f</mi>
<mn>2</mn>
</msub>
</mfrac>
<mo>|</mo>
<mo>+</mo>
<mfrac>
<msub>
<mover>
<mi>&Delta;</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mrow>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mn>4</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&Delta;</mi>
<mo>&OverBar;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>|</mo>
<mfrac>
<mrow>
<msub>
<mover>
<mi>a</mi>
<mo>^</mo>
</mover>
<mn>3</mn>
</msub>
<msub>
<mi>f</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>f</mi>
<mn>3</mn>
</msub>
</mrow>
<msub>
<mi>f</mi>
<mn>2</mn>
</msub>
</mfrac>
<mo>|</mo>
<mo>+</mo>
<msub>
<mi>&sigma;</mi>
<mn>0</mn>
</msub>
<mo>&rsqb;</mo>
<mi>s</mi>
<mi>a</mi>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mfrac>
<msub>
<mi>s</mi>
<mn>3</mn>
</msub>
<mi>&epsiv;</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
其中σ0>0,ε>0,为饱和函数,定义如下
<mrow>
<mi>s</mi>
<mi>a</mi>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mfrac>
<msub>
<mi>s</mi>
<mn>3</mn>
</msub>
<mi>&epsiv;</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>sgn</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>s</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>s</mi>
<mn>3</mn>
</msub>
<mo>|</mo>
<mo>></mo>
<mi>&epsiv;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mfrac>
<msub>
<mi>s</mi>
<mn>3</mn>
</msub>
<mi>&epsiv;</mi>
</mfrac>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>s</mi>
<mn>3</mn>
</msub>
<mo>|</mo>
<mo>&le;</mo>
<mi>&epsiv;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
步骤七选取控制律参数
选取控制器参数k1,λ1,kp2,kd2,λ3和ε,使“帆-舵子***”的闭环***响应频率比“绳-帆子***”的闭环***响应频率高一个数量级,“球-绳子***”的闭环***响应频率比“帆-舵子***”的闭环***响应频率高一个数量级;取k1=40,λ1=0.01,kp2=0.04,kd2=0.4,λ3=4和ε=0.02。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510066636.0A CN104635495B (zh) | 2015-02-09 | 2015-02-09 | 一种含模型参数不确定性平流层卫星的经向偏移分级控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510066636.0A CN104635495B (zh) | 2015-02-09 | 2015-02-09 | 一种含模型参数不确定性平流层卫星的经向偏移分级控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104635495A CN104635495A (zh) | 2015-05-20 |
CN104635495B true CN104635495B (zh) | 2017-09-12 |
Family
ID=53214376
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510066636.0A Expired - Fee Related CN104635495B (zh) | 2015-02-09 | 2015-02-09 | 一种含模型参数不确定性平流层卫星的经向偏移分级控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104635495B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106094854B (zh) * | 2016-07-15 | 2019-03-01 | 中国人民解放军战略支援部队航天工程大学 | 电磁编队卫星姿态和轨道相对控制方法 |
CN107272410B (zh) * | 2017-07-06 | 2019-05-31 | 南京航空航天大学 | 一种基于滑模控制和神经网络的卫星机动自主定轨方法 |
CN107544262B (zh) * | 2017-10-27 | 2019-10-11 | 南京工业大学 | 一种运载火箭自适应精确回收控制方法 |
FR3079631B1 (fr) * | 2018-03-27 | 2020-03-20 | Airbus Operations | Systeme et procede de controle de la trajectoire d'un aeronef. |
CN111395405B (zh) * | 2020-04-29 | 2023-08-15 | 宋彦震 | 自适应井盖口定位标注提示装置及其方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101959202B (zh) * | 2010-10-07 | 2013-02-27 | 西安电子科技大学 | 基于遗传算法的平流层飞艇布局优化方法 |
CN103984812A (zh) * | 2014-05-09 | 2014-08-13 | 西北工业大学 | 一种适用于平流层卫星***的空间绳系的仿真方法 |
CN104199303B (zh) * | 2014-09-18 | 2017-02-01 | 北京航空航天大学 | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 |
-
2015
- 2015-02-09 CN CN201510066636.0A patent/CN104635495B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN104635495A (zh) | 2015-05-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104635495B (zh) | 一种含模型参数不确定性平流层卫星的经向偏移分级控制方法 | |
CN103838914B (zh) | 一种高超声速飞行器滑翔段弹道解析求解方法 | |
CN109144084B (zh) | 一种基于固定时间收敛观测器的垂直起降重复使用运载器姿态跟踪控制方法 | |
CN103488814B (zh) | 一种适用于再入飞行器姿态控制的闭环仿真*** | |
CN104527994B (zh) | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 | |
CN110377045A (zh) | 一种基于抗干扰技术的飞行器全剖面控制方法 | |
CN107544262B (zh) | 一种运载火箭自适应精确回收控制方法 | |
CN104199303B (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
CN102880052B (zh) | 基于时标功能分解的高超声速飞行器执行器饱和控制方法 | |
CN101381004A (zh) | 基于大气阻力的微小卫星编队飞行控制方法及控制装置 | |
CN104035335A (zh) | 基于高精度纵、横程解析预测方法的平稳滑翔再入制导律 | |
CN104615144A (zh) | 基于目标规划的高超声速飞行器再入轨迹在线优化方法 | |
CN105182985A (zh) | 高超声速飞行器俯冲段全量一体化制导控制方法 | |
CN107121929B (zh) | 基于线性协方差模型预测控制的鲁棒再入制导方法 | |
CN104360686B (zh) | 一种飞艇非奇异终端滑模航迹控制方法 | |
CN106527491A (zh) | 一种固定翼无人机控制***及横侧向飞行轨迹控制方法 | |
CN103941742A (zh) | 一种无人机滑跑纠偏控制装置及方法 | |
CN107861517A (zh) | 基于线性伪谱的跳跃式再入飞行器在线弹道规划制导方法 | |
CN105388763B (zh) | 一种对流层间歇滑翔飞行控制方法 | |
CN105116914B (zh) | 一种平流层飞艇解析模型预测路径跟踪控制方法 | |
CN106383994A (zh) | 一种基于脉冲和气动辅助结合的低轨轨道面转移方法 | |
CN104215242A (zh) | 一种基于横向游移坐标系的极区惯性导航方法 | |
CN106371312A (zh) | 基于模糊控制器的升力式再入预测‑校正制导方法 | |
CN106484969B (zh) | 一种大包线强机动飞行器动力学高精度仿真方法 | |
CN105022403B (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170912 Termination date: 20190209 |