自动化学报  2019, Vol. 45 Issue (9): 1691-1700   PDF    
空间充气展开绳网系统捕获目标自抗扰控制研究
刘昊1, 魏承1, 谭春林2, 刘永健2, 赵阳1     
1. 哈尔滨工业大学航天学院 哈尔滨 150001;
2. 北京空间飞行器设计总体部 北京 100094
摘要: 空间充气展开绳网系统是依靠充气梁展开绳网进行目标捕获的航天器系统,具有更好的稳定性和可操控性.然而由于充气梁和绳网的大柔性变形以及捕获失稳自旋目标后的未知碰撞,使得捕获后的航天器姿态稳定控制困难.本文主要基于自抗扰控制解决了空间充气展开绳网系统捕获目标后的姿态稳定和消旋难题.首先,基于理想薄膜充压失效理论和绝对节点坐标方法建立充气展开绳网系统动力学模型,而后设计了航天器姿态稳定自抗扰控制器,用于实时估计并补偿系统捕获过程中未知惯量目标与捕获机构的碰撞干扰.仿真结果表明,动力学模型能够模拟捕获过程中充气梁的屈曲失效及碰撞特性,自抗扰控制器能够有效抑制碰撞带来的干扰,实现空间充气展开绳网系统捕获后的高精度姿态稳定控制,同时能够在有限时间内对自旋目标实现消旋.
关键词: 充气展开梁     空间绳网     绝对节点坐标法     屈曲失效     捕获仿真     自抗扰控制     姿态稳定    
Research on Capturing Target of Space Inflatable Net Capture System Based on Active Disturbance Rejection Control
LIU Hao1, WEI Cheng1, TAN Chun-Lin2, LIU Yong-Jian2, ZHAO Yang1     
1. School of Astronautics, Harbin Institute of Technology, Harbin 150001;
2. Beijing Institute of Spacecraft System Engineering, Beijing 100094
Manuscript received : December 17, 2018, accepted: April 23, 2019.
Foundation Item: Supported by Open Fund of National Defense Key Discipline Laboratory of Micro-Spacecraft Technology (HIT.KLOF.MST.201703) and Open Fund of Science and Technology on Space Intelligent Control Laboratory (ZDSYS-2017-07)
Author brief: LIU Hao  Ph. D. candidate at the School of Astronautics, Harbin Institute of Technology. His research interest covers dynamics control and simulation of space mechanism;
TAN Chun-Lin  Professor at Beijing Institute of Spacecraft System Engineering. His main research interest is spacecraft overall design;
LIU Yong-Jian  Ph. D., professor at Beijing Institute of Spacecraft System Engineering. His main research interest is spacecraft system development;
ZHAO Yang  Ph. D., professor at the School of Astronautics, Harbin Institute of Technology. His research interest covers spacecraft multi-body dynamics and control, spacecraft system simulation technology.
Corresponding author. WEI Cheng  Ph. D., associate professor at the School of Astronautics, Harbin Institute of Technology. His research interest covers dynamics, control and system simulation technology of space flexible multibody system. Corresponding author of this paper.
Recommended by Associate Editor XU Bin
Abstract: Space inflatable net capture system (SINCS) relying on an inflatable beam to deploy nets for target acquisition is proposed for space-object capture, which has more stability and controllability. However, target capture process and attitude stabilization control of SINCS are not completely understood due to large flexible deformation of inflatable nets and unknown collisions after capturing unstable spinning targets. This paper mainly solves the problem of attitude stabilization and racemization of SINCS after capturing target based on active disturbance rejection control (ADRC). Firstly, the flexible multibody dynamic model of SINCS is established based on the failure theory of ideal thin film under pressure and absolute nodal coordinate formulation. Then, an active disturbance rejection control is designed to estimate and compensate the collision between the unknown inertia target and the acquisition mechanism in real time. Simulation results show that the capturing process for non-cooperative targets could reflect the buckling failure of the inflatable boom and collision characteristics. The ADRC controller could estimate and compensate the disturbances effectively. The excellent performance of the ADRC control law meets the requirement of spacecraft attitude stabilization control after capturing unstable spinning targets. Furthermore, it is found that the target can achieve racemization in a limited time.
Key words: Inflatable boom     space net     absolute nodal coordinate formulation     buckling failure     capture simulation     active disturbance rejection control     attitude stabilization    

随着太空垃圾日益增多, 对人类的航天活动造成极大隐患.由于太空垃圾多为非合作目标, 刚性捕获系统[1]已经难以胜任, 因此空间飞网柔性捕获系统获得了极大发展, 如空间绳系飞网[2], 空间机动飞网[3]等.空间绳系飞网通过抛射牵引质量块带动飞网展开, 并由系绳拖拽被捕获目标离轨, 增大了捕获面积, 降低了对捕获精度的要求, 但是空间绳网无法长久维持构型.空间机动飞网由绳网末端机动卫星维持绳网构型以提高捕获成功率, 但是末端机动成本过高, 且控制复杂.因此空间充气展开绳网系统(Space inflatable net capture system, SINCS)被提出, 其由充气梁和绳网组成, 如图 1所示, 通过充气梁将绳网整体展开, 支撑起一个具有一定容积的伞状结构, 将捕获目标包裹进内部后, 利用安装在充气梁顶端微型收口装置收紧网口系绳实现收口, 从而完成捕获.该方案结构稳固, 控制简单可靠, 具有更好的应用潜力.

图 1 空间充气展开绳网系统任务流程 Fig. 1 The workflow of SINCS

国内外研究人员经过多年的研究, 对飞网的研究从其绳网动力学建模与仿真到实验[4-6], 已经取得了较为完善的成果, 英国萨里大学萨里航天中心RemoveDebris[7]则是飞网捕获系统的典型代表.充气展开绳网系统涉及充气展开梁, 其是一种薄膜充气结构, 因轻质, 压缩比高, 充气展开后具有承载性能, 在空间展开领域得到重视, 如EchoBalloons充气卫星, IAE充气天线[8].薄膜充气结构的承弯分析是研究的热点, 主要分为基于理想薄膜充压, 基于壳体充压和兼顾两方面影响折中的分析方法[9].但是充气捕获机构捕获过程中受到绳网拉扯以及与目标发生碰撞, 受力复杂, 单纯的理论研究已经不能完全适用.目前, 对空间充气展开绳网系统的研究尚处于概念和机构设计阶段, 如RETICULAR[10]被设计用于捕获陨石, REDCROC[11]设计捕获空间碎片.国内外还未有对空间充气展开绳网系统动力学方面的研究.

空间充气展开绳网系统工作流程包括充气展开, 接近包裹以及捕获消旋三个阶段.其中捕获消旋是决定任务成败的关键.捕获后的充气绳网系统变成一个由柔性捕获机构和含碰撞的未知惯量目标组成的大柔性, 多干扰, 强耦合的非线性系统, 给航天器姿态稳定控制带来了很大的困难.传统的PID方法并不能很好地解决这类问题.滑模变结构控制虽然对模型不确定性与干扰具有一定的鲁棒性, 但是受其不确定上界所限制难以工程化.自抗扰控制[12]将系统所有不确定因素作为未知扰动进行估计并补偿, 能够极大地提升控制系统的性能, 并已经成功应用于工业领域[13-16].因此, 自抗扰控制十分适合无法精确建模且含有大扰动的空间充气展开绳网系统姿态控制.

本文基于绝对节点坐标方法(Absolute nodal coordinate formulation, ANCF)[17]和理想薄膜充压失效方法建立绳网和充气梁的动力学模型, 应用赫兹理论建立柔性体碰撞模型, 从而建立空间充气展开绳网系统捕获动力学模型.首先, 对收口捕获过程进行仿真分析, 以验证捕获方案和动力学模型的准确性.其次, 针对未知惯量目标与捕获机构碰撞对系统的不确定干扰, 设计了航天器姿态稳定自抗扰控制器.控制器能够实时估计和补偿干扰, 满足捕获后航天器姿态稳定控制需求.最后, 仿真验证了自旋目标能够在与充气梁和绳网的相互作用下实现有限时间内的消旋.研究结果对新型空间充气展开绳网系统设计具有指导意义和参考价值.

1 动力学建模与分析

空间充气展开绳网系统包括服务航天器和充气捕获机构.充气捕获机构由四根充气梁支撑绳网组成捕获网袋, 绳网按照18×10横纵排列编织.为了简化分析, 作如下假设.

假设1. 不考虑轨道和空间干扰力矩的影响.

假设2. 不考虑充气捕获机构之外的其他柔性部件, 服务航天器简化成单刚体长方体.

假设3. 捕获目标简化为单刚体长方体.

参考坐标系如图 2所示, $ \Sigma_{o} $为惯性系, $ \Sigma_{{b}} $为服务航天器基体坐标系, 位于航天器中心. $ \Sigma_{{c}} $为捕获机构坐标系, $ \Sigma_{{t}} $为目标坐标系. $ {\pmb {R}_{ct}} $为目标坐标矢量, $ {\pmb {R}_{b}} $为服务航天器坐标矢量.下面对空间充气展开绳网系统进行动力学建模与分析.

图 2 参考坐标系 Fig. 2 Reference frames
1.1 基于ANCF的绳索动力学

为了提高计算效率, 在Euler-Bernoulli梁理论假设的基础上, 忽略扭转变形, 仅考虑轴向变形和弯曲变形, 从而得到更为简单的ANCF柔索单元.

设单元的长度为$ L $, 柔索单元中轴线上一点的位置矢量用广义坐标可表示为:

$^j\mathit{\boldsymbol{r}}(x,t) = S{(x)^j}\mathit{\boldsymbol{q}}(t)$ (1)

式中, $ S(x) $为三维ANCF柔索单元的形函数, q($ t) $为第$ j $个柔索单元的广义坐标.

由于柔索单元的形函数为常数, 柔索上任意一点的速度矢量可写为:

$ \begin{equation} {}^j\dot {\pmb r} = {{{S}} {}^j}\dot {\pmb q} \end{equation} $ (2)

柔索单元的动能可写为:

$ \begin{equation} {}^jT = \dfrac{1}{2}\int_0^L{\rho\int_A{{}^j{\dot{\pmb r}}^{\rm{T}}{}^j{\dot{\pmb r}}{\rm d}A}{\rm d}x} = \dfrac{1}{2}{}^j{\dot{\pmb q}}^{\rm{T}} {}^j{ M}{}^j\dot{\pmb q} \end{equation} $ (3)

式中, $ \rho $$ A $分别为柔索单元的密度和横截面积, $ {}^j{{M}} = \int_0^L {\rho (A{{{ S}}^{\rm{T}}}{{ S}}){\rm d}x} $为柔索单元的常值质量矩阵.

柔索单元的弹性能为:

$ \begin{equation} ^jU = \dfrac{1}{2}\int_0^L {\left( {EA{ }^j\varepsilon _0 ^2+EJ_\kappa { }^j\kappa ^2} \right)}{\rm d}x \end{equation} $ (4)

式中, $ E $为弹性模量, $ J_{\kappa } $为柔索截面的惯性矩, $ { }^j\varepsilon _0 $为轴向应变, $ { }^j\kappa $为曲率.

系统总的动能和应变能可写为:

$ \begin{equation} \begin{array}{l} T = \sum\limits_{j = 1}^k {^jT} = \dfrac{1}{2} {\dot{\pmb q}}^{\rm{T}}{M}\dot{\pmb q}\\ U = \sum\limits_{j = 1}^k {^jU} = \dfrac{1}{2} \sum\limits_{j = 1}^k {\int_0^L {\left( {E{A^j}\varepsilon _0^2 + EJ_\kappa ^j{\kappa ^2}} \right)} }{\rm d}x \end{array} \end{equation} $ (5)

考虑用受约束离散多体系统的微分代数方程描述动力学方程:

$ \begin{align} &\frac{{\rm d}}{{{\rm d}t}}{{\left( {\frac{{\partial T}}{{\partial {\dot{\pmb q}}}}} \right)}^{\rm{T}}} - {{\left( {\frac{{\partial T}} {{\partial {\pmb{q}}}}} \right)}^{\rm{T}}} + {{\left( {\frac{{\partial U}}{{\partial {\pmb{q}}}}} \right)}^{\rm{T}}} + \\ &\qquad{{\left( {\frac{{\partial {{C}}}} {{\partial {\pmb{q}}}}} \right)}^{\rm{T}}}{\lambda } = {{\pmb{Q}}_e}\\& {{{C}}({\pmb{q}}, t) = 0} \end{align} $ (6)

式中, $ C $为约束方程, $ \lambda $为约束方程对应的拉氏乘子, Qe为广义力矢量.

由式(6)可得:

$ \begin{align} & \frac{{\rm d}}{{\rm d}t}\left( {\frac{\partial T}{\partial \pmb {\dot q}}} \right)^{\rm{T}}-\left( {\frac{\partial T}{\partial {\pmb q}}} \right)^{\rm{T}} = \frac{{\rm d}}{{\rm d}t}\left( { M \pmb {\dot q}} \right)-0 = M \ddot{\pmb q} \end{align} $ (7)
$ \begin{align} &\left( {\frac{\partial U}{\partial {\pmb q}}} \right)^{\rm{T}} = \sum\limits_{j = 1}^k \int_0^L \Bigg( EA\varepsilon _0 \left( {\frac{\partial { }^j\varepsilon _0 }{\partial {\pmb q}}} \right)^{\rm{T}}+ \\ &\qquad\qquad\quad EJ_\kappa \kappa \left( {\frac{\partial { }^j\kappa }{\partial {\pmb q}}} \right)^{\rm{T}} \Bigg) {\rm d}x = -{\pmb Q}_\kappa \end{align} $ (8)

因此柔索系统的动力学方程写为:

$ \begin{equation} \begin{cases} M \ddot{\pmb q}+{ C}_q^{\rm{T}} \lambda = {\pmb Q}_\kappa +{\pmb Q}_e \\ C = 0 \end{cases} \end{equation} $ (9)
1.2 充气梁弯曲等效分析

根据理想薄膜充压的失效理论[18], 充气梁在弯曲载荷作用下, 弯曲失效过程分为两部分:线性承载阶段和屈曲失效阶段.

线性承载阶段充气梁变形较小, 充气梁的抗弯刚度在允许气压下始终保持恒定.此时充气梁可以简化为梁单元进行数值计算.考虑充气梁和等效梁的弯曲刚度相等$ E_1 I_1 = E_0 I_0 $, 等效梁的弹性模量$ E_{1} $

$ \begin{equation} E_1 = E_0 \left(1-\left(\dfrac{d}{D}\right)^4\right) \end{equation} $ (10)

式中, $ D $$ d $分别表示充气梁的外径和内径, $ E_{0} $为充气梁材料弹性模量.

屈曲失效阶段充气梁发生大挠度的变形, 充气梁在外载荷的作用下产生局部屈曲的弯矩称为临界弯矩$ M_{1} $, 当达到其极限弯矩$ M_{2} $后, 充气梁不可承受载荷.

$ \begin{equation} M_1 = 0.5p\pi r^3, M_2 = p\pi r^3 \end{equation} $ (11)

式中, $ p $是充气梁内压, $ r $是充气梁截面半径.

系统捕获阶段, 充气梁在收口绳索的牵引下发生大挠度变形, 将经历弯曲失效过程.然而由于捕获是充气梁、绳网和目标共同作用的复杂过程, 而且面对不同的目标, 捕获碰撞是不可预测的, 碰撞处可能会发生新的屈曲, 因此屈曲刚度计算和屈曲点预测理论已经不适用.本文做如下简化, 将充气梁均分为多段梁单元, 通过每段梁单元的等效弯曲刚度变化模拟充气梁的屈曲失效过程(如图 3所示).屈曲失效等效的方法如下:判断每段梁单元的弯矩, 当弯矩小于临界弯矩$ M_{1} $时, 梁单元的弯曲刚度为线性承载阶段的等效刚度.当弯矩大于临界弯矩$ M_{1} $时, 等效刚度降低, 直至弯矩大于极限弯矩$ M_{2} $时, 梁单元失效.

图 3 简化充气梁 Fig. 3 Equivalent inflatable boom

考虑充气梁的结构尺寸已经确定, 定义梁单元的弹性模量为其等效弯曲刚度.规划充气梁捕获过程等效刚度与弯矩曲线如图 4所示.

图 4 等效刚度-弯矩 Fig. 4 Equivalent stiffness-moment

其中, 文献[19]通过实验证明局部屈曲至失效段的变化是非线性的, 采用三次样条曲线拟合规划该非线性段, 其公式如下:

$ \begin{equation} E = \begin{cases} E_1, & \mid M \mid\le M_1 \\ aM^3+bM^2+cM+d, &M_1 <\mid M \mid\le M_2 \\ E_2, &M_2 <\mid M \mid \end{cases} \end{equation} $ (12)
1.3 碰撞动力学

捕获碰撞过程中利用虚功原理, 将作用在单元面上的碰撞摩擦力转化为单元广义节点力$ {\pmb Q}_c^f $:

$ \begin{equation} {\pmb Q}_c^f = N^{\rm{T}}({\pmb p}){\pmb F} \end{equation} $ (13)

式中, p是单元碰撞点对应的单元坐标参数, 由碰撞点位置决定. F为作用在碰撞点上的碰撞摩擦力, 由赫兹接触模型计算得到:

$ \begin{equation} {\pmb F} = F_n {\pmb n}+F_t {\pmb t} \end{equation} $ (14)

式中, n为碰撞法向单位矢量, t是切向单位向量.

法向碰撞力$ F_n $为:

$ \begin{equation} F_n = \left( {K\delta ^n+C\dot {\delta }} \right)B(\delta ) \end{equation} $ (15)

式中, $ K $为碰撞接触刚度系数, $ C $为接触阻尼系数, $ \delta $为法向穿透深度, $ \dot {\delta } $为穿透速度, $ n $为非线性接触力指数, $ B $($ \delta $)为判定是否接触的逻辑函数.

$ \begin{equation} K = \dfrac{4}{3}\left( {\dfrac{1}{2R}} \right)^{-0.5}\left( {\dfrac{1-\upsilon _1^2 }{E_{01} }+\dfrac{1-\upsilon _2^2 }{E_{02} }} \right)^{-1} \end{equation} $ (16)

式中, $ R $为绳单元的廓面在碰撞点处点曲率半径, $ v_{1} $$ v_{2} $为柔性绳和捕获目标的泊松比, $ E_{01} $, $ E_{02} $为柔性绳和捕获目标的弹性模量.

$ \begin{equation} C = \left(\dfrac{3K\left( {1-e^2} \right)}{4v_0 }\right)\delta ^n \end{equation} $ (17)

式中, $ e $为恢复系数, $ v $为初始碰撞速度.

切向摩擦力$ F_t $定义为库仑摩擦模型:

$ \begin{equation} F_t = \mu \left( {\left| {v_t } \right|} \right)F_n \end{equation} $ (18)

式中, $ \mu $为摩擦系数, 其由切向相对速度$ v_t $决定.

2 捕获仿真与分析 2.1 捕获目标包络分析

考虑捕获过程中往往不能完全确定捕获机构与目标的相对姿态, 所以假设目标具有任意相对姿态, 即其可能位姿空间的包络体为球形体, 分析充气展开绳网系统能够捕获目标的最大包络参数.捕获机构参数可以由下边长$ l_{d} $, 上边长$ l_{u} $, 深度$ h $描述, 其尺寸和包络图如图 5所示.

图 5 尺寸与包络 Fig. 5 Size and envelope

收口时通过安装在充气梁顶端的收口装置收紧网口系绳从而实现网袋的锁紧, 即$ \overline{AB} $$ \overline{AC} $应该向中心弯曲并相交于一点.假设被捕获目标与捕获机构无相对运动, 当$ \overline{DB} $大于弧长$ \widehat{DE} $时, 可以保证将目标完全包裹捕获在内, 从而完成收口捕获.定义$ r_{c} $为包络球的最大半径, 用于衡量捕获机构最大捕获能力.然而考虑观测误差, 碰撞等因素, 实际中被捕获目标的包络应该小于该尺寸, 以防止目标发生逃逸.由几何关系, 得:

$ \begin{align} &\alpha = \mbox{arctan}\left(\frac{l_u } {2h\left(1+\frac{l_d }{(l_u -l_d )}\right)}\right), \\ &l_{AB} = \left(1+\frac{l_d }{(l_u -l_d )}\right) \sqrt {0.25(l_u -l_d )^2+h^2} \end{align} $ (19)

$ \overline{DB} = \widehat{DE} $时, 即$ \overline{DB} = (90+\alpha )\pi r_c /180 $, 得:

$ \begin{equation} r_c = \dfrac{180\tan \alpha\cdot l_{AB} }{(180+(90+\alpha )\pi \tan \alpha )} \end{equation} $ (20)

因而可以得出目标的最适包裹深度$ h_{c} $为:

$ \begin{equation} h_c = \dfrac{r}{\sin \alpha }-\dfrac{hl_d }{l_u -l_d } \end{equation} $ (21)

$ r_{c} $$ h_{c} $可以作为捕获传感器判断是否进行下一步的收口操作的依据.

2.2 动力学仿真

利用实验室自主开发的多体动力系统仿真平台MBDyn[20]进行捕获仿真.假设充气梁已经全部充气展开, 充气展开梁与绳网施加柔性体约束, 绳网和绳网之间施加柔性体约束, 充气展开梁根部与服务航天器施加固定端约束.设置服务航天器和捕获目标的参数如表 1所示, 其中捕获机构的惯量是未知的.

表 1 服务航天器和捕获目标参数 Table 1 Parameters of spacecraft and target

由于任务需求的复杂性和太空环境的恶劣性, 要求捕获机构材料具有质量轻, 高模量和高强度的特性, 因此采用芳纶纤维编织绳网, 采用聚酰亚胺纤维作为充气薄膜材料.考虑充气薄膜管的材料弹性模量2 GPa, 厚度1 mm, 充气内压25 kPa, 由式(10)$ \sim $(12)可计算充气梁等效参数.仿真所需绳网和等效充气梁的力学参数如表 2所示.

表 2 绳网和充气梁参数 Table 2 Parameters of net and inflatable boom

由式(20)和(21)得目标最大包络半径$ r_{c} $ = 1.15 m, 最适包裹深度$ h_{c} = $ 2.38 m.碰撞的接触刚度系数和接触阻尼系数可由式(16)和(17)计算得到, 恢复系数取0.5.收口操作由充气梁末端收口系绳的驱动下完成, 设置收口系绳的拉力为30 N.服务航天器初始坐标$ R_{b}(0, 0, 0) $ m, 初始姿态角$ \theta _{b}(0, 0, 0)^\circ $, 目标初始坐标矢量$ R_{ct}~(0, 0, 2.3) $ m, 初始姿态角$ \theta _{ct}(0, 0, 45)^\circ $, 仿真步长0.001 s, 机构于2.3 s完成收口, 动力学过程如图 6所示.

图 6 捕获过程 Fig. 6 Capture process

根据第1.2节的分析, 本文将每根充气梁简化为9段, 由充气梁端头到其根部编号依次为1$ \sim $9, 等效刚度变化如图 7所示.等效梁从端部向根部依次产生屈曲, 这是因为有轴向分力导致的. 1.7 s由于碰撞的发生, 导致充气梁等效刚度发生振荡.

图 7 等效刚度变化 Fig. 7 Change of equivalent stiffness

图 8为目标与捕获机构的碰撞力曲线, 0.6 s首先发生网袋与目标的碰撞, 碰撞力较小.随着包裹的加深, 1.7 s充气梁与目标发生碰撞, 碰撞力增大, 且由于充气梁向内收口, 因此$ Z $方向的碰撞力要大于$ X $$ Y $方向.

图 8 目标碰撞力 Fig. 8 Collision of target

捕获过程中服务航天器的位移曲线如图 9所示.可知航天器$ X $$ Y $方向基本没有偏移, $ Z $方向由于捕获碰撞的影响先增大后减小, 产生0.03 m的偏移, 捕获过程对服务航天器影响很小.因此充气展开绳网系统成功实现对未知目标的捕获.

图 9 服务航天器位移 Fig. 9 Displacement of spacecraft
2.3 姿态稳定自抗扰控制

由第2.2节可知, 当目标与服务航天器无相对运动时, 捕获过程对服务航天器几乎没有影响.但是对于自旋的目标, 捕获目标的惯量以及捕获后目标与捕获机构的碰撞都是未知的, 会对服务航天器姿态稳定造成影响, 为了维持捕获后服务航天器姿态稳定和使目标快速消旋, 设计卫星姿态稳定自抗扰控制器.

2.4 航天器姿态动力学

服务航天器姿态动力学模型可以表示为:

$ \begin{equation} \left\{ {\begin{array}{l} (J_0 +\Delta J)\dot{\pmb {\omega }} = -{ {\it\Omega}} (J_0 +\Delta J)\pmb {\omega} +{\pmb u}+{\pmb d }\\ \dot{\pmb {\theta }} = R(\pmb {\theta} )\pmb {\omega} \\ \pmb {y} = \pmb {\theta} \\ \end{array}} \right. \end{equation} $ (22)

式中, ${J_0} \in {{\bf{R}}^{3 \times 3}}$为服务航天器转动惯量, $\Delta J \in {{\bf{R}}^{3 \times 3}}$为由于燃料消耗和柔性捕获机构引起的不确定项, $ \pmb {\omega} = [{\omega}_{x}\quad{\omega}_{y} \quad{\omega}_{z}]^{\rm T} $为服务航天器角速度矢量, $\mathit{\boldsymbol{d}} = {\left[ {\begin{array}{*{20}{l}} {{d_x}}&{{d_y}}&{{d_z}} \end{array}} \right]^{\rm{T}}}$为外部干扰力矩, $\mathit{\boldsymbol{u}} = {\left[ {\begin{array}{*{20}{l}} {{u_x}}&{{u_y}}&{{u_z}} \end{array}} \right]^{\rm{T}}}$为服务航天器控制力矩, 考虑捕获目标惯量较大, 控制力矩由力矩陀螺执行机构提供, $ {\Omega} $为斜称矩阵, $ \pmb {\theta} = [\gamma \quad\psi \quad \phi ]^{\rm T} $为服务航天器姿态欧拉角, $ {R} $表达式如下

$ \begin{equation} R(\pmb {\theta} ) = \begin{bmatrix} {\dfrac{\cos \varphi }{\cos \psi }}&{- \dfrac{\sin \varphi }{\cos \psi} }&0\\ {\sin \varphi }&{\cos \varphi }&0\\ { - \tan \psi \cos \varphi }&{\tan \psi \sin \varphi }&1 \end{bmatrix} \end{equation} $ (23)
2.5 ADRC控制律设计

由式(22)可得:

$ \begin{align} \pmb {\omega } = &{R}^{-1}(\pmb {\theta} ) \dot{\pmb {\theta }} \end{align} $ (24)
$ \begin{align} \dot{\pmb \omega } = &-{J}_0 ^{\rm{-}1} {\it\Omega} {J}_0 \pmb {\omega} +{J}_0 ^{\rm{-}1}\pmb {u} -\\&{J}_0 ^{\rm{-}1} {\it\Omega} \Delta {J}{\pmb {\omega}} +{{J}}_0 ^{\rm{-}1}\pmb {d}-{J}_0 ^{\rm{-}1}\Delta { {J}}\dot{\pmb {\omega }} \end{align} $ (25)
$ \begin{align} \ddot{\pmb {\theta }} = &{\dot{R}}(\pmb{\theta})\pmb {\omega} +{R}(\pmb{\theta})\dot{\pmb {\omega}} \end{align} $ (26)

因此

$ \begin{equation} \ddot{\pmb {\theta }} = - {R}(\pmb{\theta} ){J}_0^{\rm{-}1} {\it\Omega} {J}_0\pmb {\omega} + {R}(\pmb{\theta} ) {J}_0^{\rm{-}1}\pmb {u}+{{\pmb {d}}'} \end{equation} $ (27)

式中, $ {{\pmb {d}}'} = {R}(\pmb{\theta} ) { {J}_0}^{\rm{-}1}(- {\it\Omega} \Delta {J}\pmb {\it\omega} + \pmb d-\Delta {J} \pmb {\it{\dot \omega} })+{\dot R}(\pmb {\theta} )\pmb {\omega} $为未知干扰项.

这是一个二阶系统, 考虑服务航天器姿态角度和角速度可测, 设计自抗扰控制器, 如图 10所示.利用线性扩张观测器估计扰动, 通过PD角度反馈跟踪期望欧拉角并对力矩进行实时补偿, 使得系统对惯量不确定和干扰具有抑制的能力.

图 10 控制器框图 Fig. 10 Controller structure
2.5.1 扩张观测器设计

设计线性离散三阶扩张观测器如下:

$ \begin{equation} \left\{ {\begin{array}{l} \pmb {e} = \pmb {z}_1 -\pmb {\theta} \\ \pmb {z}_1 = \pmb {z}_1 +h(\pmb {z}_2 -\beta_1 \pmb {e}) \\ \pmb {z}_2 = \pmb {z}_2 +h(\pmb {z}_3 -\beta _2 \pmb {e} \\ \qquad- {R}(\pmb {\theta} ) {J}_0 ^{-1} {\it\Omega} {J}_0 \pmb {\omega} + R(\pmb {\theta} ) {J}_0 ^{-1}\pmb {u}) \\ \pmb {z}_3 = \pmb {z}_3 + h(-\beta _3 \pmb {e}) \\ \end{array}} \right. \end{equation} $ (28)

注1. 线性扩张观测器参数整定方便, 且扰动跟踪性能几乎不随扰动幅度发生变化, 非常适合对未知惯量目标, 未知碰撞的干扰估计

注2. $ \pmb{z}_{1} $$ \pmb{z}_{2} $$ \pmb{z}_{3} $分别为对$ \pmb{\theta} $$ \dot{\pmb {\theta}} $和扰动$ \pmb{d}' $的估计值. $ h $为采样步长, $ \beta_{1} $$ \beta_{2} $$ \beta_{3} $为决定观测器性能的参数. $ -{R}(\pmb{\theta} ) {J}_0 ^{-1} {\it\Omega} {J}_0\pmb{\omega} $为模型已知部分, 能够减小观测器的负担, 提高估计能力.

注3. 根据文献[21], 按3$ \omega $法选取参数时, 系统稳态时有$ \pmb{z}_1\to\pmb{\theta} $, $ \pmb{z}_2\to\dot{\pmb {\theta}} $, $ \pmb{z}_3\to\pmb{d}' $, 参数选取如下:

$ \begin{equation} \beta_1 = \frac{1}{h}, \omega_o = \frac{\beta _1 }{3}, \beta _2 = 3\omega _o^2 , \beta _3 = \omega _o^3 \end{equation} $ (29)
2.5.2 反馈律及力矩补偿

控制反馈采用PD角度线性误差反馈律, 设计如下:

$ \begin{equation} \pmb {u}_0 = k_p (\pmb{\theta} -\pmb {z}_1 )-k_d \pmb {z}_2 \end{equation} $ (30)

对干扰和耦合项的补偿设计如下:

$ \begin{equation} \pmb {u} = {J}_0 {R}^{-1}(\pmb {\theta })(\pmb {u}_0 -\pmb {z}_3 )+ {\it\Omega} {J}_0 \pmb {\omega} \end{equation} $ (31)

角度线性误差反馈律参数选取如下:

$ \begin{equation} k_p = \omega _c^2 , k_d = 2\xi \omega _c \end{equation} $ (32)

注4. 将式(31)代入式(27), 得到$ \ddot {\pmb{\theta}} = \pmb {u}_0 -\pmb {z}_3+\pmb {d}' $, 当估计误差足够小时, 系统能够跟踪期望角度.

根据式(28)、(30)和(31), 得到ADRC控制律为:

$ \begin{equation} \left\{ {\begin{array}{l} \pmb {e} = \pmb {z}_1 -\pmb {\theta} \\ \pmb {z}_1 = \pmb {z}_1 +h(\pmb {z}_2 -\beta_1 \pmb {e}) \\ \pmb {z}_2 = \pmb {z}_2 +h(\pmb {z}_3 -\beta _2 \pmb {e} \\ \qquad- {R}(\pmb {\theta} ) {J}_0 ^{-1} {\it\Omega} {J}_0 \pmb {\omega} + {R}(\pmb {\theta} ) {J}_0 ^{-1}\pmb {u}) \\ \pmb {z}_3 = \pmb {z}_3+h(-\beta _3 \pmb {e}) \\ \pmb {u}_0 = k_p (\pmb{\theta} -\pmb {z}_1 )-k_d \pmb {z}_2\\ \pmb {u} = {J}_0 {R}^{-1}(\pmb {\theta })(\pmb {u}_0 -\pmb {z}_3 )+ {\it\Omega} {J}_0 \pmb {\omega}\\ \end{array}} \right. \end{equation} $ (33)
2.6 动力学仿真

取第2.2节充气展开绳网系统捕获目标成功后的状态构型, 即收口系绳完全收紧, 充气梁末端互相约束.设置服务航天器初始姿态为(0, 0, 0) ($ ^\circ $), 目标自旋角速度为$ (1, -1, 30) $ $ (^\circ $/s).期望服务航天器姿态角(0, 0, 0) ($ ^\circ $), 期望目标角速度小于0.5 ($ ^\circ $/s).

自抗扰控制器参数: $ k_{p} = 2.56 $, $ k_{d} = 3.2 $, 仿真步长$ h = 0.001 $ s, 观测器系数可由式(29)计算得到.设置对比PD控制器, 取其控制率参数: $ {K_P} = {\rm{diag}}\{{1 152, 1 024, 1 260}\} $, $ {K_D} = {\rm{diag}}\{{1 440, 1 280, 1 600}\} $.仿真时间100 s, 动力学过程如图 11所示.

图 11 姿态稳定和消旋过程 Fig. 11 Attitude stabilization and despinning

对比两种控制方案, 仿真结果如图 12所示.可以看到自抗扰控制姿态角稳定误差均在$ \pm 10^{-4} $ rad的范围内, 比PD控制提高两个数量级以上, 能够满足航天器的稳定控制需求.

图 12 服务航天器姿态对比曲线 Fig. 12 Attitude curve of spacecraft

扩张观测器对干扰估计如图 13所示, 扰动$ z_{33} $明显大于$ z_{31} $$ z_{32} $.对于PD控制器, 其$ \phi $的跟踪精度相比$ \gamma $$ \psi $的跟踪精度减少了一个数量级, 而对于自抗扰控制器, 其较好地估计了干扰并在控制力矩上进行实时补偿(图 14), 因此获得远高于PD的控制精度.自抗扰控制器相比于PD控制器, 干扰越大, 其控制效果越明显.同时, 虽然目标绕$ X $$ Y $轴自转角速度很小, 但是对航天器造成较大的干扰, 因为其通过充气梁对航天器的作用力臂较大导致的.

图 13 干扰估计 Fig. 13 Estimation of disturbance
图 14 控制力矩 Fig. 14 Torque of controller

分析目标的碰撞力和状态如图 1516所示.由于目标受到捕获机构包裹, 不断与充气梁和绳网发生碰撞, 其动能与捕获机构的弹性势能互相转换, 并逐渐耗散, 最终实现消旋.图 16可以看出目标的自旋角速度不断减小, 并于80 s左右达到期望消旋结果.

图 15 目标碰撞力 Fig. 15 Collision of target
图 16 目标角速度 Fig. 16 Angular velocity of target

综上所述, 卫星姿态稳定自抗扰控制器能够满足对惯量未知的失稳自旋目标捕获后的系统姿态稳定控制需求, 同时通过充气梁和绳网对目标的柔性缠绕, 能够在有限时间内实现自旋目标的消旋.

3 结论

1) 建立了充气展开绳网系统动力学模型, 能够较好地描述系统绳网大变形, 充气梁屈曲失效和碰撞的特性, 模拟了系统捕获收口过程, 实现对非合作目标的捕获.

2) 设计了充气展开绳网系统姿态稳定自抗扰控制器, 适用于捕获失稳自旋目标后的系统姿态稳定控制, 能够很好地估计和补偿未知惯量目标与捕获机构相互碰撞对系统的干扰, 满足捕获后服务航天器姿态稳定控制需求, 性能指标明显优于PD控制, 且容易工程实现.

3) 通过仿真验证了在柔性充气梁和绳网与目标的相互作用下, 充气展开绳网系统能够在有限时间内对失稳自旋目标实现消旋.

参考文献
1
Shan M H, Guo J, Gill E. Review and comparison of active space debris capturing and removal methods. Progress in Aerospace Sciences, 2016, 80: 18-32. DOI:10.1016/j.paerosci.2015.11.001
2
Botta E M, Sharf I, Misra A K. Contact dynamics modeling and simulation of tether nets for space-debris capture. Journal of Guidance, Control, and Dynamics, 2017, 40(1): 110-123. DOI:10.2514/1.G000677
3
Zhao Y K, Huang P F, Zhang F, Meng Z J. Contact dynamics and control for tethered space net robot. IEEE Transactions on Aerospace and Electronic Systems, 2018, 1-1.
4
Shan M H, Guo J, Gill E. Deployment dynamics of tethered-net for space debris removal. Acta Astronautica, 2017, 132: 293-302. DOI:10.1016/j.actaastro.2017.01.001
5
Medina A, Cercos L, Stefanescu R M, Benvenuto R, Pesce V, Marcon M. Validation results of satellite mock-up capturing experiment using nets. Acta Astronautica, 2017, 134: 314-332. DOI:10.1016/j.actaastro.2017.02.019
6
Zhang F, Huang P F, Meng Z J. Dynamics analysis and controller design for maneuverable tethered space net robot. Journal of Guidance, Control, and Dynamics, 2017, 40(11): 2828-2843. DOI:10.2514/1.G002656
7
Forshaw J L, Aglietti G S, Salmon T, Retat I, Roe M, Roe M. Final payload test results for the RemoveDebris active debris removal mission. Acta Astronautica, 2017, 138: 326-342. DOI:10.1016/j.actaastro.2017.06.003
8
Schenk M, Viquerat A D, Seffen K A, Guest S D, Roe M, Burges C. Review of inflatable booms for deployable space structures:packing and rigidization. Journal of Spacecraft and Rockets, 2014, 51(3): 762-778. DOI:10.2514/1.A32598
9
Chen Shuai, Li Bin, Yang Zhi-Chun. Theoretical methods of bending characteristics analysis of membarne inflatable structures. Journal of Mechanical Strength, 2011, 33(3): 403-410.
( 陈帅, 李斌, 杨智春. 薄膜充气结构承弯性能的理论分析方法. 机械强度, 2011, 33(3): 403-410.)
10
Ceruti A, Pettenuzzo S, Tuveri M. Conceptual design and preliminarily structural analysis of inflatable basket for an asteroid capturing satellite. Strojniki Vestnik——Journal of Mechanical Engineering, 2015, 61(5): 341-351. DOI:10.5545/sv-jme
11
Roychoudhury R, Bandyopadhyay S, Paul K. Junk hunter: autonomous rendezvous, capture, and de-orbit of orbital debris. In: Proceedings of the AIAA SPACE 2011 Conference and Exposition. Long Beach, USA: 2011. 7292
12
Jin Hui-Yu, Liu Li-Li, Lan Wei-Yao. On stability condition of linear active disturbance rejection control for second-order systems. Acta Automatica Sinica, 2018, 44(9): 1725-1728.
( 金辉宇, 刘丽丽, 兰维瑶. 二阶系统线性自抗扰控制的稳定性条件. 自动化学报, 2018, 44(9): 1725-1728.)
13
Gao C, Yuan Jian P, Zhao Y K. ADRC for spacecraft attitude and position synchronization in libration point orbits. Acta Astronautica, 2018, 145: 238-249. DOI:10.1016/j.actaastro.2018.01.039
14
Tian Jia-Yi, Zhang Shi-Feng, Liu Long-Bin. Study on active disturbance reject attitude control technology of multi-satellite upper stage. Acta Automatica Sinica, 2018, 44(2): 228-239.
( 田嘉懿, 张士峰, 刘龙斌. 多星发射上面级主动抗扰姿态控制技术研究. 自动化学报, 2018, 44(2): 228-239.)
15
Zhang D Y, Wu Q H, Yao X L, Jiao L L. Active disturb-ance rejection control for looper tension of stain-less steel strip processing line. Control Engi-neering and Applied Informatics, 2018, 20(4): 60-68.
16
Cheng Yun, Chen Zeng-Qiang, Chen Ming-Wei, Sun Qing-Lin. Multivariable inverted decoupling active disturbance rejection control and its application to a distillation column process. Acta Automatica Sinica, 2017, 43(6): 1080-1088.
( 程赟, 陈增强, 孙明玮, 孙青林. 多变量逆解耦自抗扰控制及其在精馏塔过程中的应用. 自动化学报, 2017, 43(6): 1080-1088.)
17
Gerstmayr J, A. Shabana A. Analysis of thin beams and cables using the absolute nodal coordinate formulation. Nonlinear Dynamics, 2006, 45: 109-130. DOI:10.1007/s11071-006-1856-1
18
Comer R L, Levy S. Deflections of an inflated circular-cylindrical cantilever beam. AIAA journal, 1963, 1(7): 1652-1655. DOI:10.2514/3.1873
19
Wang Chang-Guo, Du Xing-Wen, He Xiao-Dong. Bending-wrinkling benavior analysis. Engineering Mechanics, 2009, 26(2): 210-215.
( 王长国, 杜星文, 赫晓东. 充气薄膜管的弯皱行为分析. 工程力学, 2009, 26(2): 210-215.)
20
Mbdyn Software and Documentation[Online], available: http://www.rapidyn.cn, December 30, 2018
21
Gao Z Q. Scaling and bandwidth-parameterization based controller tuning. In: Proceedings of the 2003 American Control Conference. Denver, USA: IEEE, 2003. 4989-4996