2. 北京控制工程研究所, 北京 100190
2. Beijing Institute of Control Engineering, 100190 Beijing, China
航天器高精度姿态稳定与跟踪控制是执行在轨操作的基础,随着航天器在空间探测、通信、导航等领域的广泛应用,航天器的姿态控制问题吸引了众多国内外学者的关注[1-2].考虑航天器飞行过程的外界干扰和系统不确定,滑模控制作为一种鲁棒控制方法,在航天器姿态控制系统中受到广泛关注.线性滑模首先在航天器姿态控制系统中获得应用,包括单星级航天器姿态跟踪控制和航天器编队姿态协调控制[3-4].由于终端滑模具有更高的控制精度和更快的响应特性,在航天器姿态控制获得了更广泛的研究和应用[5-6].
同目前大多数航天器姿态控制研究相同,上述航天器姿态控制系统均采用全状态反馈.在控制器设计中既利用航天器姿态信息,同时也需要航天器角速度信息.但在实际工程应用中,由于角速率陀螺损坏或者研制成本约束,导致角速度信息无法获取,只能利用输出反馈技术进行航天器姿态控制器设计.针对这一问题,文献[7]首先提出的是滤波器算法,利用航天器姿态四元数或MRPs(修改罗德里格斯参数)作为滤波器输入,从而获得对应导数信息并进行反馈控制,此算法在航天器姿态跟踪及编队姿态协调控制中获得了较多应用[8-9].除此之外,状态观测器设计也是解决姿态输出反馈的一种重要手段,其中包括全阶状态观测器[10]、降阶状态观测器[11]、扩张状态观测器[12]等,通过状态观测器的设计,也能得到对应的姿态导数信息.但是,上述滤波器技术和观测器技术都只能实现对姿态导数的渐进估计.为进一步减小估计时间,提高估计精度,文献[13-14]基于几何齐次性理论设计了有限时间状态观测器,能够实现对MRPs导数的有限时间估计,但观测精度会受到外界扰动及系统不确定影响.文献[15-16]基于终端滑模设计了有限时间观测器,但需要系统综合不确定和未知状态导数上界已知.并且上述有限时间观测器都是基于姿态动力学模型的,只能实现对四元数或MRPs导数的估计,无法获取角速度估计值.
当前在滑模姿态控制研究中,一般采用带有符号函数的鲁棒项对系统外界扰动和不确定进行处理,从而使控制输入产生抖振.为减小控制器抖振,同时对系统综合不确定进行处理,采用自适应控制,并且在航天器姿态跟踪控制中获得较多应用[17].但在这些自适应滑模控制器设计中,由于引入了符号函数,使得控制输入是不连续的,不可避免会产生抖振.干扰观测器技术是进行航天器鲁棒姿态控制的另一种手段,能够观测出系统综合不确定信息,同时抑制抖振.文献[18]设计了扩张状态观测器来进行航天器姿态系统综合不确定的估计,但只得到了渐进稳定结果.文献[19]设计了一种终端滑模干扰观测器,能够实现对系统不确定的有限时间精确估计.高阶滑模干扰观测器[20]也可用来进行系统不确定的有限时间估计,但这些有限时间干扰观测器均需要系统综合不确定导数或Lipschitz常数已知.本文研究了角速度不可测的航天器有限时间姿态跟踪控制.首先,设计了无需模型的改进自适应超螺旋滑模状态观测器,在有限时间内实现对四元数导数的估计,进而结合扩维姿态运动学方程得到角速度信息;然后,提出了一种新的有限时间自适应干扰观测器,并进行了有限时间姿态跟踪控制器设计.设计的两种观测器无需未知状态导数和综合不确定导数上界已知,同时控制器能较好实现抖振抑制.
1 刚体航天器非线性姿态模型航天器在空间进行姿态控制过程中,有多个坐标系需要明确.定义FB为本体固连坐标系,FI为惯性坐标系,FD为期望姿态坐标系,采用单位四元数描述航天器姿态,则刚体航天器运动学与动力学方程[4]为
$ \left\{ \begin{array}{l} {{\mathit{\boldsymbol{\dot q}}}_v} = \frac{1}{2}\left( {{q_0}{\mathit{\boldsymbol{I}}_3} + \mathit{\boldsymbol{q}}_v^ \times } \right)\mathit{\boldsymbol{w}},\\ {{\dot q}_0} = - \frac{1}{2}\mathit{\boldsymbol{q}}_v^{\rm{T}}\mathit{\boldsymbol{w}}. \end{array} \right. $ | (1) |
$ \mathit{\boldsymbol{J\dot w}} = - {\mathit{\boldsymbol{w}}^ \times }\mathit{\boldsymbol{Jw}} + \mathit{\boldsymbol{u}} + \mathit{\boldsymbol{d}}. $ | (2) |
其中:q=[q0 q1 q2 q3]T=[q0 qvT]T为航天器本体FB相对于FI的单位四元数,w∈R3为FB相对于FI的角速度,u∈R3为控制输入力矩,d∈R3为外界环境干扰,J=J0+ΔJ是航天器惯性矩阵,其中J0和ΔJ分别为标称部分和不确定部分,qv×∈R3×3是斜对角矩阵并满足
$ \mathit{\boldsymbol{q}}_v^ \times = \left[ {\begin{array}{*{20}{c}} 0&{ - {q_3}}&{{q_2}}\\ {{q_3}}&0&{ - {q_1}}\\ { - {q_2}}&{{q_1}}&0 \end{array}} \right]. $ |
在姿态跟踪控制过程中,定义期望姿态四元数为qd=[qd0 qd1 qd2 qd3]T=[qd0 qdvT]T,期望角速度为wd,满足
$ \left\{ \begin{array}{l} {\mathit{\boldsymbol{q}}_{ev}} = {\mathit{\boldsymbol{q}}_{d0}}{\mathit{\boldsymbol{q}}_v} - \mathit{\boldsymbol{q}}_{dv}^ \times {\mathit{\boldsymbol{q}}_v} - {\mathit{\boldsymbol{q}}_0}{q_{dv}},\\ {q_{e0}} = \mathit{\boldsymbol{q}}_{dv}^{\rm{T}}{\mathit{\boldsymbol{q}}_v} + {q_0}{q_{d0}},\\ {\mathit{\boldsymbol{w}}_e} = \mathit{\boldsymbol{w}} - \mathit{\boldsymbol{R}}{\mathit{\boldsymbol{w}}_d}. \end{array} \right. $ | (3) |
其中R为由FD到FB的旋转矩阵,并满足
$ \mathit{\boldsymbol{R}} = \left( {q_{e0}^2 - \mathit{\boldsymbol{q}}_{ev}^{\rm{T}}{\mathit{\boldsymbol{q}}_{ev}}} \right){I_3} + 2{\mathit{\boldsymbol{q}}_{ev}}\mathit{\boldsymbol{q}}_{ev}^{\rm{T}} - 2q_{e0}^2\mathit{\boldsymbol{q}}_{ev}^ \times . $ | (4) |
从而得到姿态跟踪误差动力学[4]为
$ \left\{ \begin{array}{l} {{\mathit{\boldsymbol{\dot q}}}_{ev}} = \frac{1}{2}\left( {{q_{e0}}{\mathit{\boldsymbol{I}}_3} + \mathit{\boldsymbol{q}}_{ev}^ \times } \right){\mathit{\boldsymbol{w}}_e},\\ {{\dot q}_{e0}} = - \frac{1}{2}\mathit{\boldsymbol{q}}_{ev}^{\rm{T}}{\mathit{\boldsymbol{w}}_e}. \end{array} \right. $ | (5) |
$ \mathit{\boldsymbol{J}}{{\mathit{\boldsymbol{\dot w}}}_e} = - {\mathit{\boldsymbol{w}}^ \times }\mathit{\boldsymbol{Jw}} + \mathit{\boldsymbol{J}}\left( {\mathit{\boldsymbol{w}}_e^ \times \mathit{\boldsymbol{R}}{\mathit{\boldsymbol{w}}_d} - \mathit{\boldsymbol{R}}{{\mathit{\boldsymbol{\dot w}}}_d}} \right)\mathit{\boldsymbol{ + u}} + \mathit{\boldsymbol{d}}. $ | (6) |
为实现对不可测的角速度进行有限时间估计,首先设计改进自适应超螺旋滑模状态观测器,在有限时间内实现对四元数导数的估计,而后对姿态运动学方程进行扩维,并计算出对应的角速度值.
引理1[21] 考虑如下非线性系统
$ \left\{ \begin{array}{l} \mathit{\boldsymbol{\dot x = }} - \alpha \frac{\mathit{\boldsymbol{x}}}{{{{\left\| \mathit{\boldsymbol{x}} \right\|}^{1/2}}}} + \mathit{\boldsymbol{z}},\\ \mathit{\boldsymbol{\dot z}} = - \frac{\beta }{2}\frac{\mathit{\boldsymbol{x}}}{{\left\| \mathit{\boldsymbol{x}} \right\|}} + \mathit{\Delta} . \end{array} \right. $ | (7) |
其中‖Δ‖≤δ,存在任意正常数k1, k2,ε,满足
$ \left\{ {\begin{array}{*{20}{c}} {\dot \alpha = \left\{ \begin{array}{l} {k_1}\sqrt {{k_2}/2} ,\;\;\;\mathit{\boldsymbol{x}} \ne 0;\\ \;\;\;\;\;\;0,\;\;\;\mathit{\boldsymbol{x}} = 0; \end{array} \right.}\\ {\dot \beta = 2\varepsilon \alpha .} \end{array}} \right. $ | (8) |
则x和ẋ在有限时间收敛到零.
假设1 航天器飞行过程中,姿态四元数q二阶可微,并满足
基于上述引理和假设,设计的改进自适应超螺旋滑模状态观测器为
$ \left\{ \begin{array}{l} \mathit{\boldsymbol{\dot {\hat q} = }} - {\alpha _1}\frac{\mathit{\boldsymbol{e}}}{{{{\left\| \mathit{\boldsymbol{\theta }} \right\|}^{1/2}}}} + \mathit{\boldsymbol{v}},\\ \mathit{\boldsymbol{\dot v}} = - \frac{{{\beta _1}}}{2}\frac{\mathit{\boldsymbol{e}}}{{\left\| \mathit{\boldsymbol{\theta }} \right\|}}. \end{array} \right. $ | (9) |
其中e=
$ \left\{ {\begin{array}{*{20}{c}} {{{\dot \alpha }_1} = \left\{ {\begin{array}{*{20}{c}} {{{\bar k}_1}\sqrt {{{\bar k}_2}/2} ,\;\;\;\left\| \mathit{\boldsymbol{e}} \right\| > \varphi ;}\\ {0,\;\;\;\left\| \mathit{\boldsymbol{e}} \right\| \le \varphi ;} \end{array}} \right.}\\ {{{\dot \beta }_1} = 2\bar \varepsilon {\alpha _1}.} \end{array}} \right. $ | (10) |
k1,k2和
由(9)可得状态观测器误差方程为
$ \left\{ \begin{array}{l} \mathit{\boldsymbol{\dot e = }} - {\alpha _1}\frac{\mathit{\boldsymbol{e}}}{{{{\left\| \mathit{\boldsymbol{\theta }} \right\|}^{1/2}}}} + \mathit{\boldsymbol{\bar v}},\\ \mathit{\boldsymbol{\dot {\bar v}}} = - \frac{{{\beta _1}}}{2}\frac{\mathit{\boldsymbol{e}}}{{\left\| \mathit{\boldsymbol{\theta }} \right\|}} - \mathit{\boldsymbol{\ddot q}}. \end{array} \right. $ | (11) |
由引理1容易得到,所设计的改进自适应超螺旋滑模观测器(9)、(10)能保证
注1 超螺旋滑模观测器(9)相比于式(7),其主要改进之处为将式(7)中的奇异点采用边界层进行代替.虽然式(7)能实现对未知状态的精确估计,但会导致抖振,即使
注2 所设计的滑模观测器(9)相比于滤波器算法[7-9]和渐进状态观测器[10-12],能够实现对未知状态的有限时间估计;相比于基于几何齐次性和终端滑模的观测器[13-16],式(9)不依赖于姿态动力学模型,同时也无需系统不确定和未知状态导数上界已知.
通过式(9)可得出
$ \left[ {\begin{array}{*{20}{c}} { - 2{{\dot q}_0}}\\ {2{{\dot q}_1}}\\ {2{{\dot q}_2}}\\ {2{{\dot q}_3}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {{q_1}}&{{q_2}}&{{q_3}}\\ {{q_0}}&{ - {q_3}}&{{q_2}}\\ {{q_3}}&{{q_0}}&{ - {q_1}}\\ { - {q_2}}&{{q_1}}&{{q_0}} \end{array}} \right]\left[ {\begin{array}{*{20}{c}} {{w_1}}\\ {{w_2}}\\ {{w_3}} \end{array}} \right] = A\left[ {\begin{array}{*{20}{c}} {{w_1}}\\ {{w_2}}\\ {{w_3}} \end{array}} \right]. $ | (12) |
由于A∈R4×3不是方阵,故不能对上式进行矩阵逆操作,无法直接求出角速度信息.为了实现对角速度的求解,将上式矩阵进行扩维,得到如下矩阵
$ \left[ {\begin{array}{*{20}{c}} { - 2{{\dot q}_0}}\\ {2{{\dot q}_1}}\\ {2{{\dot q}_2}}\\ {2{{\dot q}_3}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {{q_1}}&{{q_2}}&{{q_3}}&{ - {q_0}}\\ {{q_0}}&{ - {q_3}}&{{q_2}}&{{q_1}}\\ {{q_3}}&{{q_0}}&{ - {q_1}}&{{q_2}}\\ { - {q_2}}&{{q_1}}&{{q_0}}&{{q_3}} \end{array}} \right]\left[ {\begin{array}{*{20}{c}} {{w_1}}\\ {{w_2}}\\ {{w_3}}\\ 0 \end{array}} \right] = \bar A\left[ {\begin{array}{*{20}{c}} {{w_1}}\\ {{w_2}}\\ {{w_3}}\\ 0 \end{array}} \right]. $ | (13) |
可知A∈R4×4为四维方阵,同时
$ \left[ {\begin{array}{*{20}{c}} {{w_1}}\\ {{w_2}}\\ {{w_3}}\\ 0 \end{array}} \right] = {\left[ {\begin{array}{*{20}{c}} {{q_1}}&{{q_2}}&{{q_3}}&{ - {q_0}}\\ {{q_0}}&{ - {q_3}}&{{q_2}}&{{q_1}}\\ {{q_3}}&{{q_0}}&{ - {q_1}}&{{q_2}}\\ { - {q_2}}&{{q_1}}&{{q_0}}&{{q_3}} \end{array}} \right]^{ - 1}}\left[ {\begin{array}{*{20}{c}} { - 2{{\dot q}_0}}\\ {2{{\dot q}_1}}\\ {2{{\dot q}_2}}\\ {2{{\dot q}_3}} \end{array}} \right]. $ | (14) |
从而,角速度估计值计算式为
$ \left[ {\begin{array}{*{20}{c}} {{{\hat w}_1}}\\ {{{\hat w}_2}}\\ {{{\hat w}_3}}\\ \mathit{\boldsymbol{ \boldsymbol{\varTheta} }} \end{array}} \right] = {\left[ {\begin{array}{*{20}{c}} {{{\hat q}_1}}&{{{\hat q}_2}}&{{{\hat q}_3}}&{ - {{\hat q}_0}}\\ {{{\hat q}_0}}&{ - {{\hat q}_3}}&{{{\hat q}_2}}&{{{\hat q}_1}}\\ {{{\hat q}_3}}&{{{\hat q}_0}}&{ - {{\hat q}_1}}&{{{\hat q}_2}}\\ { - {{\hat q}_2}}&{{{\hat q}_1}}&{{{\hat q}_0}}&{{{\hat q}_3}} \end{array}} \right]^{ - 1}}\left[ {\begin{array}{*{20}{c}} { - 2{{\dot {\hat q}}_0}}\\ {2{{\dot {\hat q}}_1}}\\ {2{{\dot {\hat q}}_2}}\\ {2{{\dot {\hat q}}_3}} \end{array}} \right]. $ | (15) |
利用上式即可根据
由于
$ \mathit{\boldsymbol{J\dot {\hat w}}} = - {{\mathit{\boldsymbol{\hat w}}}^ \times }\mathit{\boldsymbol{J\hat w}} + \mathit{\boldsymbol{u}} + \mathit{\boldsymbol{d}} + \lambda\left( {\mathit{\boldsymbol{o}}\left( {\mathit{\boldsymbol{\hat w}}} \right)} \right). $ | (16) |
其中λ(ο(
$ \mathit{\boldsymbol{J}}{{\mathit{\boldsymbol{\dot {\hat w}}}}_e} = - {{\mathit{\boldsymbol{\hat w}}}^ \times }\mathit{\boldsymbol{J\hat w}} + \mathit{\boldsymbol{J}}\left( {\mathit{\boldsymbol{\hat w}}_e^ \times {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d} - {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d}} \right) + \mathit{\boldsymbol{u}} + \lambda\left( \mathit{\boldsymbol{o}} \right) + \mathit{\boldsymbol{d}}. $ | (17) |
其中
假设2 假设航天器飞行控制中,角速度w与角加速度
由式(9)可知,
为实现有限时间控制,采用终端滑模进行控制器设计,设计非奇异终端滑模面为
$ \mathit{\boldsymbol{s}} = {{\mathit{\boldsymbol{\hat w}}}_e} + k \cdot \beta \left( {{\mathit{\boldsymbol{q}}_{ev}}} \right). $ | (18) |
其中s=[s1 s2 s3]T∈R3,k>0,非奇异项β(qev)=[β(qe1) β(qe2) β(qe3)]T为
$ \beta \left( {{q_{ei}}} \right) = \left\{ \begin{array}{l} {\rm{si}}{{\rm{g}}^r}\left( {{q_{ei}}} \right),若\;{{\bar s}_i} = 0\;或\;{{\bar s}_i} \ne 0,\left| {{q_{ei}}} \right| > \mathit{\Phi };\\ {a_{11}}{q_{ei}} + {a_{12}}{\rm{si}}{{\rm{g}}^2}\left( {{q_{ei}}} \right),若\;{{\bar s}_i} \ne 0,\left| {{q_{ei}}} \right| \le \mathit{\Phi }\mathit{.} \end{array} \right. $ | (19) |
其中si=
结合式(17),得到系统方程为
$ \begin{array}{l} {\mathit{\boldsymbol{J}}_0}\mathit{\boldsymbol{\dot s}} = {\mathit{\boldsymbol{J}}_0}{{\mathit{\boldsymbol{\dot {\hat w}}}}_e} + k \cdot {\mathit{\boldsymbol{J}}_0}\dot \beta \left( {{\mathit{\boldsymbol{q}}_{ev}}} \right) = - {{\mathit{\boldsymbol{\hat w}}}^ \times }{\mathit{\boldsymbol{J}}_0}\mathit{\boldsymbol{\hat w}} + \\ \;\;\;\;\;\;\;\;{\mathit{\boldsymbol{J}}_0}\left( {\mathit{\boldsymbol{\hat w}}_e^ \times {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d} - {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d}} \right) + k \cdot {\mathit{\boldsymbol{J}}_0}\dot \beta \left( {{\mathit{\boldsymbol{q}}_{ev}}} \right) + \mathit{\boldsymbol{u}} - \\ \;\;\;\;\;\;\;\;\Delta \mathit{\boldsymbol{J}}{{\mathit{\boldsymbol{\dot {\hat w}}}}_e} - {{\mathit{\boldsymbol{\hat w}}}^ \times }\Delta \mathit{\boldsymbol{J\hat w}} + \Delta \mathit{\boldsymbol{J}}\left( {\mathit{\boldsymbol{\hat w}}_e^ \times {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d} - {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{\dot w}}_d}} \right) + \\ \;\;\;\;\;\;\;\;\mathit{\boldsymbol{d}} + \lambda \left( {\mathit{\boldsymbol{o}}\left( {\mathit{\boldsymbol{\hat w}}} \right)} \right). \end{array} $ | (20) |
其中
$ \dot \beta \left( {{q_{ei}}} \right) = \left\{ \begin{array}{l} r{\left| {{q_{ei}}} \right|^{r - 1}}{{\dot q}_{ei}},若\;{{\bar s}_i} = 0\;或\;{{\bar s}_i} \ne 0,\left| {{q_{ei}}} \right| > \mathit{\Phi };\\ {a_{11}}{{\dot q}_{ei}} + 2{a_{12}}\left| {{q_{ei}}} \right|{{\dot q}_{ei}},若\;{{\bar s}_i} \ne 0,\left| {{q_{ei}}} \right| \le \mathit{\Phi }\mathit{.} \end{array} \right. $ |
系统的标称部分可表示为
$ \begin{array}{l} \mathit{\boldsymbol{h}}\left( t \right) = - {{\mathit{\boldsymbol{\hat w}}}^ \times }{\mathit{\boldsymbol{J}}_0}\mathit{\boldsymbol{\hat w}} + {\mathit{\boldsymbol{J}}_0}\left( {\mathit{\boldsymbol{\hat w}}_e^ \times {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d} - {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{\dot w}}_d}} \right) + \\ \;\;\;\;\;\;\;\;\;k \cdot {\mathit{\boldsymbol{J}}_0}\dot \beta \left( {{\mathit{\boldsymbol{q}}_{ev}}} \right). \end{array} $ | (21) |
系统的综合不确定部分可表示为
$ \mathit{\boldsymbol{\chi }}\left( t \right) = \mathit{\boldsymbol{d}} + \lambda \left( {\mathit{\boldsymbol{o}}\left( {\mathit{\boldsymbol{\hat w}}} \right)} \right) - {{\mathit{\boldsymbol{\hat w}}}^ \times }\Delta \mathit{\boldsymbol{J\hat w}} + {\mathit{\boldsymbol{\chi }}_1}\left( t \right). $ | (22) |
其中:
$ \begin{array}{l} {\mathit{\boldsymbol{\chi }}_1}\left( t \right) = - \Delta \mathit{\boldsymbol{J}}{{\mathit{\boldsymbol{\dot {\hat w}}}}_e} + \Delta \mathit{\boldsymbol{J}}\left( {\mathit{\boldsymbol{\hat w}}_e^ \times {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d} - {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{\dot w}}_d}} \right) = \\ \;\;\;\;\;\;\;\;\;\;\; - \Delta \mathit{\boldsymbol{J}}{\left( {\mathit{\boldsymbol{\hat w}} - {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d}} \right)^\prime } + \Delta \mathit{\boldsymbol{J}}\left( {\mathit{\boldsymbol{\hat w}}_e^ \times {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d} - } \right.\\ \;\;\;\;\;\;\;\;\;\;\;\left. {{{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{\dot w}}_d}} \right) = - \Delta \mathit{\boldsymbol{J}}\left( {\mathit{\boldsymbol{\dot {\hat w}}} - {{\mathit{\boldsymbol{\hat R}}}_d}{{\mathit{\boldsymbol{\dot w}}}_d} + \mathit{\boldsymbol{\hat w}}_e^ \times {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d}} \right) + \\ \;\;\;\;\;\;\;\;\;\;\;\Delta \mathit{\boldsymbol{J}}\left( {\mathit{\boldsymbol{\hat w}}_e^ \times {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d} - {{\mathit{\boldsymbol{\hat R}}}_d}{\mathit{\boldsymbol{w}}_d}} \right) = - \Delta \mathit{\boldsymbol{J\dot {\hat w}}}. \end{array} $ | (23) |
即综合不确定为
$ \mathit{\boldsymbol{\chi }}\left( t \right) = \mathit{\boldsymbol{d}} + \lambda \left( {\mathit{\boldsymbol{o}}\left( {\mathit{\boldsymbol{\hat w}}} \right)} \right) - {{\mathit{\boldsymbol{\hat w}}}^ \times }\Delta \mathit{\boldsymbol{J\hat w}} - \Delta \mathit{\boldsymbol{J\dot {\hat w}}}. $ | (24) |
故姿态跟踪系统可整理为
$ {\mathit{\boldsymbol{J}}_0}\mathit{\boldsymbol{\dot s}} = \mathit{\boldsymbol{h}}\left( t \right) + \mathit{\boldsymbol{\chi }}\left( t \right) + \mathit{\boldsymbol{u}}. $ | (25) |
在航天器飞行过程中,d,ΔJ,
$ {{\mathit{\boldsymbol{\dot z}}}_d} = \mathit{\boldsymbol{h}}\left( t \right) + \mathit{\boldsymbol{\hat \chi }}\left( t \right) + \mathit{\boldsymbol{u}}, $ | (26) |
$ \mathit{\boldsymbol{\hat \chi }}\left( t \right) = - {\sigma _1}{\mathit{\boldsymbol{e}}_d} - {\sigma _2}{\rm{si}}{{\rm{g}}^{{r_d}}}\left( {{\mathit{\boldsymbol{e}}_d}} \right) - \frac{{\hat \gamma {\mathit{\boldsymbol{e}}_d}}}{{2\varepsilon _d^2}}. $ | (27) |
其中ed=zd-J0s,自适应增益为
$ \dot {\hat \gamma} = {k_{d1}}\left( {\frac{{{{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|}^2}}}{{2\varepsilon _d^2}} - {k_{d2}}\hat \gamma } \right). $ | (28) |
参数σ1>0, σ2>0,kd1>0, kd2>0,εd>0,指数0<rd<1.
定理1 针对非线性系统(25),设计自适应干扰观测器(26)~(28),则干扰估计值
证明 选取Lyapunov候选函数为
$ {V_1} = \frac{1}{2}\mathit{\boldsymbol{e}}_d^{\rm{T}}{\mathit{\boldsymbol{e}}_d} + \frac{1}{{2{k_{d1}}}}{{\tilde \gamma }^2}. $ | (29) |
其中
$ \begin{array}{l} {{\dot V}_1} = \mathit{\boldsymbol{e}}_d^{\rm{T}}{{\mathit{\boldsymbol{\dot e}}}_d} + \frac{1}{{{k_{d1}}}}\tilde \gamma \dot {\hat \gamma} = \\ \mathit{\boldsymbol{e}}_d^{\rm{T}}\left( { - {\sigma _1}{\mathit{\boldsymbol{e}}_d} - {\sigma _2}{\rm{si}}{{\rm{g}}^{{r_d}}}\left( {{\mathit{\boldsymbol{e}}_d}} \right) - \frac{{\hat \gamma {\mathit{\boldsymbol{e}}_d}}}{{2\varepsilon _d^2}} - \mathit{\boldsymbol{\chi }}\left( t \right)} \right) + \\ \tilde \gamma \left( {\frac{{{{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|}^2}}}{{2\varepsilon _d^2}} - {k_{d2}}\hat \gamma } \right) \le - {\sigma _1}{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|^2} - \\ {\sigma _2}\sum\limits_{j = 1}^3 {{{\left| {{\mathit{\boldsymbol{e}}_{dj}}} \right|}^{{r_d} + 1}}} - \frac{{\gamma {{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|}^2}}}{{2\varepsilon _d^2}} - \mathit{\boldsymbol{e}}_d^{\rm{T}}\mathit{\boldsymbol{\chi }}\left( t \right) - {k_{d2}}\hat \gamma \tilde \gamma \le \\ - {\sigma _1}{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|^2} - \frac{{\gamma {{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|}^2}}}{{2\varepsilon _d^2}} + \left\| {{\mathit{\boldsymbol{e}}_d}} \right\|\left\| {\mathit{\boldsymbol{\chi }}\left( t \right)} \right\| - {k_{d2}}\hat \gamma \tilde \gamma . \end{array} $ |
考虑到
$ \begin{array}{l} {{\dot V}_1} \le - {\sigma _1}{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|^2} - {k_{d2}}\hat \gamma \tilde \gamma + \frac{{\varepsilon _d^2}}{2} \le \\ \;\;\;\; - {\sigma _1}{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|^2} - {k_{d2}}{{\tilde \gamma }^2} - {k_{d2}}\gamma \tilde \gamma + \frac{{\varepsilon _d^2}}{2}. \end{array} $ | (30) |
由于
$ \begin{array}{l} {{\dot V}_1} \le - {\sigma _1}{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|^2} + \frac{{{k_{d2}}}}{2}{\gamma ^2} - \frac{{{k_{d2}}}}{2}{{\tilde \gamma }^2} + \frac{{\varepsilon _d^2}}{2} \le \\ \; - \frac{{2{\sigma _1}}}{2}{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|^2} - \frac{{{k_{d1}}{k_{d2}}}}{{2{k_{d1}}}}{{\tilde \gamma }^2} + \frac{{{k_{d2}}}}{2}{\gamma ^2} + \frac{{\varepsilon _d^2}}{2} \le \\ \;\;\;\;\;\; - \tilde \alpha {V_1} + \frac{{{k_{d2}}}}{2}{\gamma ^2} + \frac{{\varepsilon _d^2}}{2}. \end{array} $ | (31) |
其中
$ {{\bar V}_1} = \frac{1}{2}\mathit{\boldsymbol{e}}_d^{\rm{T}}{\mathit{\boldsymbol{e}}_d}. $ | (32) |
其时间导数为
$ \begin{array}{l} {{\dot {\bar V}}_1} = \mathit{\boldsymbol{e}}_d^{\rm{T}}\left( { - {\sigma _1}{\mathit{\boldsymbol{e}}_d} - {\sigma _2}{\rm{si}}{{\rm{g}}^{{r_d}}}\left( {{\mathit{\boldsymbol{e}}_d}} \right) - \frac{{\hat \gamma {\mathit{\boldsymbol{e}}_d}}}{{2\varepsilon _d^2}} - \mathit{\boldsymbol{\chi }}\left( t \right)} \right) \le \\ \;\;\; - {\sigma _1}{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|^2} - {\sigma _2}\sum\limits_{j = 1}^3 {{{\left| {{\mathit{\boldsymbol{e}}_{dj}}} \right|}^{1 + {r_d}}} - \frac{{\hat \gamma {{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|}^2}}}{{2\varepsilon _d^2}} + } \\ \;\;\;\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|\left\| {\mathit{\boldsymbol{\chi }}\left( t \right)} \right\| \le {\sigma _1}{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|^2} - {\sigma _2}{\left( {{{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|}^2}} \right)^{\frac{{1 + {r_d}}}{2}}} - \\ \;\;\;\frac{{\tilde \gamma {{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|}^2}}}{{2\varepsilon _d^2}} + \frac{{\varepsilon _d^2}}{2}. \end{array} $ | (33) |
所以,可得到
$ \begin{array}{l} {{\dot {\bar V}}_1} \le - {\sigma _1}{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|^2} - {\sigma _2}{\left( {{{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|}^2}} \right)^{\frac{{1 + {r_d}}}{2}}} + \\ \;\;\;\;\;\;\frac{{|\tilde \gamma| {{\left\| {{\mathit{\boldsymbol{e}}_d}} \right\|}^2}}}{{2\varepsilon _d^2}} + \frac{{\varepsilon _d^2}}{2} \le - 2\left( {{\sigma _1} - \underline {2\varepsilon _d^2} } \right){{\bar V}_1} - \\ \;\;\;\;\;\;{\sigma _2}\left( {{2^{\frac{{1 + {r_d}}}{2}}} - \frac{{\varepsilon _d^2}}{{2\bar V_1^{\frac{{1 + {r_d}}}{2}}}}} \right)\bar V_1^{\frac{{1 + {r_d}}}{2}}. \end{array} $ | (34) |
由上式可得,若选择σ1≥
注3 相比于之前的刚体航天器自适应滑模控制器[16-18],设计的干扰观测器(27)自适应项中避免了符号函数的引入,从而使得干扰观测值
由于干扰观测器(27)只能收敛到干扰真值邻域内,为抵消干扰观测器误差,提高控制精度,设计如下有限时间姿态跟踪控制器
$ \mathit{\boldsymbol{u}} = - {\zeta _1}\mathit{\boldsymbol{s}} - {\zeta _2}{\rm{si}}{{\rm{g}}^{{r_c}}}\left( \mathit{\boldsymbol{s}} \right) - \mathit{\boldsymbol{h}}\left( t \right) - \mathit{\boldsymbol{\hat \chi }}\left( t \right) - \frac{{\hat \psi \mathit{\boldsymbol{s}}}}{{\left\| \mathit{\boldsymbol{s}} \right\|}}. $ | (35) |
其中ζ1>0,ζ2>0,0<rc<1.
推论1 考虑系统(25)和干扰观测器(27)、(28),设计的控制器(35)在有限时间内保证q和w分别收敛至qd和wd附近邻域内.
证明 选取Lyapunov函数为
$ {V_2} = \frac{1}{2}{\mathit{\boldsymbol{s}}^{\rm{T}}}{\mathit{\boldsymbol{J}}_0}s + \frac{1}{{2{\lambda _\psi }}}{{\tilde \psi }^2}. $ | (36) |
其中λmin‖s‖2≤sTJ0s≤λmax‖s‖2,λmin, λmax为正常数,
$ \begin{array}{l} {{\dot V}_2} = {\mathit{\boldsymbol{s}}^{\rm{T}}}{\mathit{\boldsymbol{J}}_0}\mathit{\boldsymbol{\dot s + }}\frac{1}{{{\lambda _\psi }}}\tilde \psi \dot {\tilde \psi} = \\ \;\;\;{\mathit{\boldsymbol{s}}^{\rm{T}}}\left[ {h\left( t \right) + \chi \left( t \right) + u} \right] - \frac{1}{{{\lambda _\psi }}}\tilde \psi \dot {\tilde \psi} = \\ \;\;\;{\mathit{\boldsymbol{s}}^{\rm{T}}}\left[ { - {\zeta _1}\mathit{\boldsymbol{s}} - {\zeta _2}{\rm{si}}{{\rm{g}}^{{r_c}}}\left( \mathit{\boldsymbol{s}} \right) + \mathit{\boldsymbol{\chi }}\left( t \right) - \mathit{\boldsymbol{\hat \chi }}\left( t \right) - \frac{{\hat \psi \mathit{\boldsymbol{s}}}}{{\left\| \mathit{\boldsymbol{s}} \right\|}}} \right] - \\ \;\;\;\frac{1}{{{\lambda _\psi }}}\tilde \psi \dot {\hat \psi} \le - {\zeta _2}\sum\limits_{i = 1}^3 {{{\left| {{s_i}} \right|}^{1 + {r_c}}} + \left\| s \right\|\psi - \left\| s \right\|\hat \psi - } \\ \;\;\;\tilde \psi \left( { - {\varepsilon _\psi }\hat \psi + \left\| \mathit{\boldsymbol{s}} \right\|} \right) \le - {\zeta _2}{\left( {\sum\limits_{i = 1}^3 {s_i^2} } \right)^{\left( {1 + {r_c}} \right)/2}} + {\varepsilon _\psi }\tilde \psi \hat \psi \le \\ \;\;\; - {\zeta _2}{\left( {\frac{2}{{{\lambda _{\max }}}}} \right)^{\left( {1 + {r_c}} \right)/2}}{\left( {\frac{1}{2}{\mathit{\boldsymbol{s}}^T}{\mathit{\boldsymbol{J}}_0}\mathit{\boldsymbol{s}}} \right)^{\left( {1 + {r_c}} \right)/2}} + {\varepsilon _\psi }\tilde \psi \hat \psi . \end{array} $ | (37) |
其中第4到第5步可由文献[17]引理3.1推出,对于任意δψ0>0.5,可推导如下
$ \begin{array}{l} {\varepsilon _\psi }\tilde \psi \hat \psi = {\varepsilon _\psi }\left( {\tilde \psi \psi - {{\tilde \psi }^2}} \right) = \\ \;\;\;\;\;\;\;\;\;\;\;\;{\varepsilon _\psi }\left( { - {{\tilde \psi }^2} + \frac{1}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2} + \frac{{{\delta _{\psi 0}}}}{2}{\psi ^2}} \right) = \\ \;\;\;\;\;\;\;\;\;\;\;\;\frac{{{\varepsilon _\psi }{\delta _{\psi 0}}}}{2}{\psi ^2} - \frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}. \end{array} $ | (38) |
则式(37)可整理为
$ \begin{array}{l} {{\dot V}_2} \le - {\zeta _2}{\left( {\frac{2}{{{\lambda _{\max }}}}} \right)^{\left( {1 + {r_c}} \right)/2}}{\left( {\frac{1}{2}{\mathit{\boldsymbol{s}}^{\rm T}}{\mathit{\boldsymbol{J}}_0}\mathit{\boldsymbol{s}}} \right)^{\left( {1 + {r_c}} \right)/2}} - \\ \;\;\;\;\;\;\;{\left( {\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}} \right)^{\left( {1 + {r_c}} \right)/2}} + \\ \;\;\;\;\;\;\;{\left( {\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}} \right)^{\left( {1 + {r_c}} \right)/2}} + {\varepsilon _\psi }\tilde \psi \hat \psi \le \\ \;\;\;\;\;\;\; - {\zeta _2}{\left( {\frac{2}{{{\lambda _{\max }}}}} \right)^{\left( {1 + {r_c}} \right)/2}}\left[ {{{\left( {\frac{1}{2}{\mathit{\boldsymbol{s}}^{\rm T}}{\mathit{\boldsymbol{J}}_0}\mathit{\boldsymbol{s}}} \right)}^{\left( {1 + {r_c}} \right)/2}} + } \right.\\ \;\;\;\;\;\;\;\left. {{{\left( {\frac{1}{{2{\lambda _\psi }}}{{\tilde \psi }^2}} \right)}^{\left( {1 + {r_c}} \right)/2}}} \right] + {\left( {\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}} \right)^{\left( {1 + {r_c}} \right)/2}} + \\ \;\;\;\;\;\;\;{\varepsilon _\psi }\tilde \psi \hat \psi . \end{array} $ | (39) |
其中
$ \begin{array}{l} {{\dot V}_2} \le - {\zeta _2}{\left( {\frac{2}{{{\lambda _{\max }}}}} \right)^{\left( {1 + {r_c}} \right)/2}}V_2^{\left( {1 + {r_c}} \right)/2} + \\ \;\;\;\;\;\;{\left( {\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}} \right)^{\left( {1 + {r_c}} \right)/2}} + {\varepsilon _\psi }\tilde \psi \hat \psi . \end{array} $ | (40) |
由于0<rc<1,若
$ \begin{array}{l} {\left( {\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}} \right)^{\left( {1 + {r_c}} \right)/2}} + {\varepsilon _\psi }\tilde \psi \hat \psi \le \\ \;\;\;\left( {\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}} \right) + {\varepsilon _\psi }\tilde \psi \hat \psi \le \frac{{{\varepsilon _\psi }{\delta _{\psi 0}}}}{2}{\psi ^2}. \end{array} $ | (41) |
若
$ \begin{array}{l} {\left( {\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}} \right)^{\left( {1 + {r_c}} \right)/2}}\left| {_{\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2} < 1}} \right. < \\ \;\;\;\;\;{\left( {\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}} \right)^{\left( {1 + {r_c}} \right)/2}}\left| {_{\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2} \ge 1}} \right.. \end{array} $ | (42) |
故总有
$ {\left( {\frac{{{\varepsilon _\psi }\left( {2{\delta _{\psi 0}} - 1} \right)}}{{2{\delta _{\psi 0}}}}{{\tilde \psi }^2}} \right)^{\left( {1 + {r_c}} \right)/2}} + {\varepsilon _\psi }\tilde \psi \hat \psi \le \frac{{{\varepsilon _\psi }{\delta_{\psi 0}}}}{2}{\psi ^2}. $ | (43) |
则可得
$ {{\dot V}_2} \le - {\zeta _2}{\left( {\frac{2}{{{\lambda _{\max }}}}} \right)^{\left( {1 + {r_c}} \right)/2}}V_2^{\left( {1 + {r_c}} \right)/2} + \tilde \omega . $ | (44) |
其中
$ {{\dot V}_2} \le - \left[ {{\zeta _2}{{\left( {\frac{2}{{{\lambda _{\max }}}}} \right)}^{\left( {1 + {r_c}} \right)/2}} - \frac{{\bar \omega }}{{V_2^{\left( {1 + {r_c}} \right)/2}}}} \right]V_2^{\left( {1 + {r_c}} \right)/2}. $ | (45) |
当
$ {V_2} \le \frac{{{\lambda _{\max }}}}{2}{\left( {\frac{{\tilde \omega }}{{{\zeta _2}}}} \right)^{2/\left( {1 + {r_c}} \right)}}. $ | (46) |
故计算得出滑模面的有限时间收敛域为
$ \left\| \mathit{\boldsymbol{s}} \right\| \le \sqrt {\frac{{{\lambda _{\max }}}}{{2{\lambda _{\min }}}}} {\left( {\frac{{\bar \omega }}{{{\zeta _2}}}} \right)^{1/\left( {1 + {r_c}} \right)}}. $ | (47) |
依据文献[17]定理3可知,q和w在有限时间内分别收敛至qd和wd邻域内.证毕.
4 仿真分析为验证所提方法的有效性,进行仿真验证与分析.仿真中,各参数选取如下
$ J = \left[ {\begin{array}{*{20}{c}} {20}&2&{0.9}\\ 2&{17}&{0.5}\\ {0.9}&{0.5}&{15} \end{array}} \right]{\rm{kg}} \cdot {{\rm{m}}^2}. $ |
其中标称部分J0=diag(20 20 20) kg·m2.给定外界干扰,所给干扰远比空间中环境干扰大. dx=0.01sin(0.4t), dy=0.005cos(0.5t), dz=0.008cos(0.7t).
航天器姿态及角速度初值为
$ \begin{array}{*{20}{c}} {\mathit{\boldsymbol{q}}\left( 0 \right) = \left[ {\begin{array}{*{20}{c}} {0.8986}&{0.4}&{ - 0.1}&{0.15} \end{array}} \right],}\\ {\mathit{\boldsymbol{w}}\left( 0 \right) = {{\left[ {\begin{array}{*{20}{c}} {0.1}&{0.05}&{ - 0.1} \end{array}} \right]}^{\rm{T}}}.} \end{array} $ |
期望姿态与角速度为
$ \begin{array}{*{20}{c}} {{\mathit{\boldsymbol{q}}_d}\left( 0 \right) = \left[ {\begin{array}{*{20}{c}} 1&0&0&0 \end{array}} \right],}\\ {\mathit{\boldsymbol{w}}\left( t \right) = 0.1{{\left[ {\cos \left( {t/40} \right) - \sin \left( {t/50} \right) - \cos \left( {t/60} \right)} \right]}^{\rm{T}}}.} \end{array} $ |
状态观测器参数设计为k1=0.1,k2=0.01,
干扰观测器参数设计为σ1=2,σ2=0.5,kd1=0.1,kd2=20,εd=0.5,指数rd=0.7,zd(0)=[0 0 0],γ(0)=1.
控制器参数设计为ζ1=ζ2=1,rc=0.7,εψ=0.2,δa0=1,λmax=20,
为更好说明角速度估计算法优越性,将其与滤波器估计算法进行比较,滤波器算法[8]为
$ \left\{ \begin{array}{l} \mathit{\boldsymbol{\dot q}} = - a\mathit{\boldsymbol{q}} + \mathit{\boldsymbol{p}},\\ \mathit{\boldsymbol{\dot p}} = - \left( {a + 1} \right)\mathit{\boldsymbol{p}} + \left( {{a^2} + 1} \right)\mathit{\boldsymbol{q}}. \end{array} \right. $ | (48) |
其中a>0为滤波器增益,p为滤波器辅助变量,满足p(0)=aq,采用试凑法仿真中取a=22.
图 1所示为基于观测器(9)的角速度估计效果以及与基于滤波器(48)的角速度估计对比,其中标注w为真实角速度,标注wa为对应观测值.可以看出设计的角速度观测算法能在数秒内实现对真实角速度的较高精度估计,并且估值中没有抖振;由于设定了观测精度阈值,状态观测器增益也不会发生过估计问题;同时设计的角速度估计算法精度相比基于滤波器的角速度估计精度有明显提高,说明了所设计的角速度估计算法的优越性.
图 2为自适应干扰观测器对设定外界干扰的估计,标注d为真实干扰,da为对应观测值.虽然式(27)只能保证干扰观测误差收敛到一定范围内,但在应用中容易看出干扰观测器能很快实现对给定干扰的较高精度估计,并且干扰观测值是连续无抖振. 图 3、4为控制过程中,四元数误差和角速度误差的变化曲线,可以看出航天器的姿态误差和角速度误差值在有限时间内收敛到平衡点附近. 图 5为对应的控制输入曲线,可以看出控制输入在设计的约束范围内,同时控制输入信号无抖振.
为进一步说明所设计观测器和控制器的有效性,将所提方法与纯自适应滑模控制进行对比,设计纯自适应滑模姿态控制器为[17]
$ \mathit{\boldsymbol{u}} = - {\zeta _1}\mathit{\boldsymbol{s}} - {\zeta _2}si{g^{{r_c}}}\left( \boldsymbol{s} \right) - \mathit{\boldsymbol{h}}\left( t \right) - {{\hat \gamma }_a}\mathit{\boldsymbol{s}}/\left\| \mathit{\boldsymbol{s}} \right\|. $ |
其中
可以看出,设计的角速度观测器能够实现对角速度的高精度估计,同时对比图 5、7,容易得出本文设计的控制器能够较好地减小控制器的抖振,说明了所设计干扰观测器和控制器的优越性.
5 结论1) 研究了角速度不可测的刚体航天器有限时间姿态跟踪控制.分别设计了基于超螺旋滑模状态观测器的角速度估计算法和有限时间自适应干扰观测器.
2) 设计的角速度估计算法比传统滤波估计算法具有更高的精度,同时干扰观测器结合了连续自适应技术,实现了干扰的连续估计,并减小了控制输入抖振.
3) 仿真结果验证了所提算法的有效性,对工程应用有一定参考意义.但只研究了刚体航天器的姿态跟踪控制,对于挠性航天器以及故障条件下的航天器姿态控制有待进一步研究.
[1] |
SANYAL A, FOSBURY A, CHATURVEDI N, et al. Inertia-free spacecraft attitude tracking with disturbance rejection and almost global stabilization[J].
Journal of Guidance, Control, and Dyna-mics, 2009, 32(4): 1167-1174.
DOI: 10.2514/1.41565 |
[2] |
MAYHEW C G, SANFEILICE R G, TEEL A R. Quaternion-based hybrid control for robust global attitude tracking[J].
IEEE Transactions on Automatic Control, 2011, 56(11): 2555-2566.
DOI: 10.1109/TAC.2011.2108490 |
[3] |
WU Baolin, WANG Danwei, POH E K. Decentralized robust adaptive control for attitude synchronization under directed communication topology[J].
Journal of Guidance, Control, and Dynamics, 2011, 34(4): 1276-1282.
DOI: 10.2514/1.50189 |
[4] |
WU Baolin, WANG Danwei, POH E K. Decentralized sliding-mode control for attitude synchronization in spacecraft formation[J].
International Journal of Robust and Nonlinear Control, 2013, 23(11): 1183-1197.
DOI: 10.1002/rnc.2812 |
[5] |
JIN Erdong, SUN Zhaowei. Robust controllers design with finite time convergence for rigid spacecraft attitude tracking control[J].
Aerospace Science and Technology, 2008, 12(4): 324-330.
DOI: 10.1016/j.ast.2007.08.001 |
[6] |
ZONG Qun, SHAO Shikai. Decentralized finite-time attitude synchronization for multiple rigid spacecraft via a novel disturbance observer[J].
ISA Transactions, 2016, 65: 150-163.
DOI: 10.1016/j.isatra.2016.08.009 |
[7] |
GELAND O, GODHAVN J M. Passivity-based adaptive attitude control of a rigid spacecraft[J].
IEEE Transactions on Automatic Control, 1994, 39(4): 842-846.
DOI: 10.1109/9.286266 |
[8] |
WONG H, DE QUEIROZ M S, KAPILA V. Adaptive tracking control using synthesized velocity from attitude measurements[J].
Automatica, 2001, 37: 947-953.
DOI: 10.1016/S0005-1098(01)00038-3 |
[9] |
XIAO Bing, HU Qinglei, SHI Peng. Attitude stabilization of spacecraft under actuator saturation and partial loss of control effectiveness[J].
IEEE Transactions on Control System Technology, 2013, 21(6): 2251-2263.
DOI: 10.1109/TCST.2012.2236327 |
[10] |
ZOU Anmin. Distributed attitude synchronization and tracking control for multiple rigid bodies[J].
IEEE Transactions on Control System Technology, 2014, 22(2): 478-490.
DOI: 10.1109/TCST.2013.2255289 |
[11] |
ZOU Anmin, KUMAR K D, HOU Zengguang. Attitude coordination control for a group of spacecraft without velocity measurements[J].
IEEE Transactions on Control System Technology, 2012, 20(5): 1160-1174.
DOI: 10.1109/TCST.2011.2163312 |
[12] |
YANG Hongjiu, YOU Xiu, XIA Yuanqing, et al. Adaptive control for attitude synchronization of spacecraft formation via extended state observer[J].
IET Control Theory and Applications, 2014, 8(18): 2171-2185.
DOI: 10.1049/iet-cta.2013.0988 |
[13] |
ZOU Anmin, ANTON H J, KUAMR K D. Distributed finite-time velocity-free attitude coordination control for spacecraft formations[J].
Automatica, 2016, 67: 46-53.
DOI: 10.1016/j.automatica.2015.12.029 |
[14] |
ZOU Anmin. Finite-time output feedback attitude tracking control for rigid spacecraft[J].
IEEE Transactions on Control System Technology, 2014, 22(1): 338-345.
DOI: 10.1109/TCST.2013.2246836 |
[15] |
XIAO Bing, HU Qinglei, WANG Danwei. Spacecraft attitude fault tolerant control with terminal sliding-mode observer[J].
Journal of Aerospace Engineering, 2013, 28(1): 04014055.
DOI: 10.1061/(ASCE)AS.1943-5525.0000331 |
[16] |
XIAO Bing, HU Qinglei, ZHANG Youmin, et al. Fault-tolerant tracking control of spacecraft with attitude-only measurement under actuator failures[J].
Journal of Guidance, Control, and Dynamics, 2014, 37(3): 838-849.
DOI: 10.2514/1.61369 |
[17] |
ZHU Zheng, XIA Yuanqing, FU Mengyin. Attitude stabilization of rigid spacecraft with finite-time convergence[J].
International Journal of Robust and Nonlinear Control, 2011, 21(6): 686-702.
DOI: 10.1002/rnc.1624 |
[18] |
XIA Yuanqing, ZHU Zheng, FU Mengyin. Attitude tracking of rigid spacecraft with bounded disturbances[J].
IEEE Transactions on Industrial Electronics, 2011, 58(2): 647-659.
DOI: 10.1109/TIE.2010.2046611 |
[19] |
XIAO Bing, HU Qinglei, SINGHOSE W, et al. Reaction wheel fault compensation and disturbance rejection for spacecraft attitude tracking[J].
Journal of Guidance, Control, and Dynamics, 2013, 36(6): 1565-1575.
DOI: 10.2514/1.59839 |
[20] |
SHTESSEL Y B, SHKOLNIKOV I A, LEVANT A. Smooth second-order sliding modes: Missile guidance application[J].
Automatica, 2007, 43(8): 1470-1476.
DOI: 10.1016/j.automatica.2007.01.008 |
[21] |
DONG Qi, ZONG Qun, TIAN Bailing, et al. Adaptive-gain multivariable super-twisting sliding mode control for reentry RLV with torque perturbation[J].
International Journal of Robust and Nonlinear Control, 2017, 27(4): 620-638.
DOI: 10.1002/rnc.3589 |