航天器終端接近的有限時間輸入飽和避碰控制

李學輝，宋申民，陳海濤，郭 永

（1. 哈爾濱工業(yè)大學 控制理論與制導技術研究中心，哈爾濱 150001；2. 西北工業(yè)大學 自動化學院，西安 710000）

航天器終端接近的有限時間輸入飽和避碰控制

李學輝1，宋申民1，陳海濤1，郭 永2

（1. 哈爾濱工業(yè)大學 控制理論與制導技術研究中心，哈爾濱 150001；2. 西北工業(yè)大學 自動化學院，西安 710000）

針對航天器終端接近問題，解決了追蹤航天器在跟蹤到達期望目標點的過程中不與目標航天器發(fā)生碰撞的難題。首先，在目標航天器軌道系下建立了航天器的相對運動和避碰模型。其次，考慮外界擾動上界已知和未知兩種情形，均給出了有限時間避碰控制器，且所設計的控制器都具有輸入飽和特性。最后，應用 Lyapunov穩(wěn)定性理論證明了在所提出的控制器作用下系統(tǒng)是有限時間收斂的，并且，利用避碰勢函數證明了所設計的控制器能夠實現(xiàn)避碰。仿真結果表明，所提出的控制器是有效的。

終端接近；避碰控制；有限時間控制；輸入飽和

航天器終端接近技術在航天在軌任務中有重要應用[1-3]。為使追蹤航天器完成各種在軌服務任務，要求追蹤航天器跟蹤到達指定期望位置，當到達期望位置后，由追蹤航天器的捕獲機構捕獲目標航天器。

在追蹤航天器接近期望位置過程中，為了航天任務的順利完成，要求追蹤航天器避免與目標航天器發(fā)生碰撞。為了解決避障問題，文獻[4]基于視線相對運動模型，利用模糊控制，研究了非合作自主交會對接的終端接近問題。文獻[5]基于橢圓蔓葉線，應用人工勢函數制導方法解決了非合作目標航天器自主交會對接與靜態(tài)障礙物躲避問題。文獻[6]利用線性二次模型預測控制研究了具有避障功能的航天器相對運動制導與控制問題。

在實際航天器控制中，執(zhí)行機構的輸出是受限的，忽略了輸入飽和問題可能引起控制性能的下降，甚至可以引起系統(tǒng)不穩(wěn)定。為了解決輸入飽和問題，文獻[7]針對追蹤星徑向方向上推進器出現(xiàn)故障的情況，在常值推力下設計了切換控制，使得追蹤星沿著指定的軌跡運動，實現(xiàn)了主動避碰。文獻[8]利用高斯偽譜法研究了航天器交會對接問題，針對在推進系統(tǒng)輸出有界且功率受限以及避免碰撞的約束下，設計了燃料最優(yōu)的控制器。文獻[9]利用安全正不變集(safe positively invariant sets)研究了航天器相對運動的避障問題，通過應用圖形搜索算法找到一條安全無碰撞路徑并能夠滿足推力限制。

為了能夠快速完成航天任務，有限時間控制在航天控制中得到了重要應用[10-12]。針對有限時間避碰問題，目前大多數文獻還沒有有效方法。文獻[13]針對多水下機器人系統(tǒng)分別研究了有限時間位置一致性和碰撞避免問題，但所提出的考慮避免碰撞問題的協(xié)同控制器不能保證系統(tǒng)有限時間收斂。文獻[14][15]針對多體 Euler-Lagrange系統(tǒng)，通過基于零空間(null-space-based)行為控制方法，研究了有限時間編隊控制策略，但是當處理有障礙物的情況時，系統(tǒng)仍無法實現(xiàn)有限時間收斂。

上述文獻雖然對避免碰撞、輸入受限、有限時間收斂等問題進行了研究，但是在一些實際航天任務中，需要將多種約束進行同時考慮。為進一步解決考慮碰撞的航天器終端接近問題，本文設計了具有避碰功能的有限時間飽和控制器。相比于上述文獻，本文的創(chuàng)新之處在于：①利用雙曲正切函數，使所設計的控制器具有輸入飽和特性。②通過引入輔助系統(tǒng)，借助有限時間控制，設計的避碰控制器使系統(tǒng)有限時間收斂。③所設計的控制器能夠解決系統(tǒng)外部擾動上界已知和未知兩種情況。

1 軌道相對運動和避碰模型

由于追蹤航天器在到達期望位置的過程中可能與目標航天器發(fā)生碰撞，下面分別建立航天器軌道相對運動和避碰模型，并給出本文的控制目標。

1.1 航天器軌道相對運動模型

圖1 航天器終端接近系統(tǒng)Fig.1 System of spacecraft terminal approach

假設空間存在一顆運行在橢圓軌道上的目標航天器，追蹤航天器從初始位置到達期望位置，其示意圖見圖1。其中，F(xiàn)I為赤道慣性坐標系其原點oI為地心；xI軸位于赤道平面內，指向春分點；zI軸沿地球自轉軸方向，向上為正；yI軸與xI軸和zI軸構成右手直角坐標系。Fo為目標航天器軌道坐標系作為航天器相對運動的參考坐標系，基本平面為目標航天器瞬時軌道平面，坐標原點ot在目標航天器的質心，xo軸沿地心到目標航天器的矢徑方向；yo軸在目標航天器軌道平面上，與xo軸垂直，且沿目標航天器運動方向；zo軸與xo軸和yo軸構成右手直角坐標系。tr和rc分別為地心到目標航天器和追蹤航天器質心的位置矢量在赤道慣性坐標系FI下的表示。

假定目標航天器不受主動控制力作用，其動力學模型為

追蹤航天器的動力學模型為

式(1)(2)中：mt和mc分別為目標航天器和追蹤航天器的質量；dt和dc分別為目標航天器和追蹤航天器所受到的外部攝動力；uc為作用于追蹤航天器的主動控制力；tr和rc分別為地心到目標航天器和追蹤航天器的距離，即為地球引力常數。

將公式(4)展開，則可得追蹤航天器相對于目標航天器的軌道運動方程為[16]

其中，

假設追蹤航天器的期望位置和速度分別為rd、定義誤差向量為重寫式(5)，可以得到軌道相對運動學方程為

1.2 避碰模型與控制目標

假設追蹤航天器與目標航天器的最小安全距離為a，則以目標航天器質心為原點，半徑為a所形成的球為避碰區(qū)域。設避碰勢函數為

由h(r)的定義可知，當追蹤航天器在避碰區(qū)域外時h(r)＞0，反之，當追蹤航天器在避碰區(qū)域內或避碰區(qū)域曲面上時

為了控制器的設計和定理的證明，我們給出如下假設。

假設1在初始時刻和期望位置，追蹤航天器在避碰區(qū)域外，即其中，

注1. 由假設1可知，為了避免追蹤航天器進入避碰區(qū)域，只需要保證追蹤航天器在到達期望位置的過程中h(r)≠0。

假設2系統(tǒng)式(11)外部擾動有界，滿足表示向量的2范數，

本文的控制目標：設計有效的具有飽和特性的控制器，使追蹤航天器能有限時間到達期望位置，且在接近過程中不會與目標航天器發(fā)生碰撞，即誤差向量e有限時間收斂到0，并且在收斂過程中h(r)＞0始終成立。

2 有限時間飽和避碰控制器設計

本文利用有限時間控制的思想設計具有飽和特性的航天器終端接近控制器?？紤]到航天器在太空環(huán)境的復雜性，下面分別對航天器外部擾動上界已知和未知兩種情況進行討論，設計有限時間飽和避碰控制器，以實現(xiàn)控制目標。

2.1 外部擾動上界已知下的避碰控制器設計

追蹤航天器在太空中會受到太陽光壓、地球重力梯度等擾動的影響。為了處理外部擾動上界已知的情況，下面設計魯棒的有限時間飽和避碰控制器。

設計控制器(13)和輔助系統(tǒng)(14)(15)：

定理1針對系統(tǒng)(11)，在假設1和2條件下，且系統(tǒng)外部擾動上界dm已知，控制參數滿足則在控制器(13)和輔助系統(tǒng)(14)(15)的作用下，可以得到如下結論（若控制參數不滿足則所設計的控制器將不能抵消外界擾動對系統(tǒng)的影響，從而可能導致系統(tǒng)是不穩(wěn)定的）：

1）追蹤航天器能夠有限時間運動到期望位置rd。

2）追蹤航天器在運動過程中不與目標航天器發(fā)生碰撞。

3）所設計的控制器具有輸入飽和特性。

證明 選取如下Lyapunov函數：

對式(16)求導并將式(11)、控制器(13)和輔助系統(tǒng)(14)(15)代入，可得：

對式(19)求解可得V1滿足

2.2 外部擾動上界未知情況下的避碰控制器設計

由于外部擾動的復雜性，其上界很難精確得到，為了處理外部擾動上界未知的情況，下面設計魯棒自適應有限時間飽和避碰控制器。

定理2針對系統(tǒng)(11)，在假設1和2條件下，且系統(tǒng)外部擾動上界dm未知，則在控制器(21)和輔助系統(tǒng)(22)～(24)的作用下，定理1的結論仍然成立。

證明 選取如下Lyapunov函數：

對式(25)求導并將式(11)、控制器(21)和輔助系統(tǒng)(22)(23)代入，可得：

利用矩陣A為反對稱的性質以及假設2，并將式(24)代入，整理可得：

同定理1的證明，可以證明定理2的結論是成立的。

3 仿真分析

為驗證本文控制方法的有效性，下面對所設計的控制器進行仿真驗證。假設外界擾動主要考慮J2項引力攝動，設追蹤航天器與目標航天器的最小安全距離追蹤航天器和目標航天器的質量均為100kg，目標航天器的軌道參數為：其中分別是半長軸、離心率、升交點赤經、軌道傾角、近地點幅角和真近點角。設追蹤航天器與目標航天器相對距離和速度的初始值分別為期望相對距離為為了處理當時出現(xiàn)的抖振問題，在時 用來代替

圖2 控制器(13)～(15)下控制力曲線圖Fig.2 Curves of control force under controller (13)-(15)

針對控制器(13)～(15)的仿真結果如圖2和圖3所示。圖 2為閉環(huán)系統(tǒng)的控制力曲線圖，可以看出控制力是有界的。圖 3給出追蹤航天器的運動軌跡，圖中球形區(qū)域為避碰區(qū)域，直線為起始位置與期望位置之間的連線。從圖3可以看出，若追蹤航天器直線運動到期望位置，必然進入避碰區(qū)域，而在所設計的控制器下，追蹤航天器能有效避免進入避碰區(qū)域，從而能夠安全地到達期望位置。

針對控制器(21)～(24)的仿真結果如圖4～6所示。圖4為閉環(huán)系統(tǒng)的控制力曲線圖，圖5為外部擾動上界的估計值d?m的曲線圖。從圖4可以看出，控制力是有界的。圖6給出追蹤航天器的運動軌跡，圖中球形區(qū)域為避碰區(qū)域，直線為起始位置與期望位置之間的連線。從圖6可以看出，若追蹤航天器直線運動到期望位置，必然進入避碰區(qū)域，而在所設計的控制器下，追蹤航天器能有效避免進入避碰區(qū)域，從而能夠安全地到達期望位置。

圖3 控制器(13)～(15)下追蹤航天器運動軌跡Fig.3 Curves of chaser spacecraft’s motion trajectory under controller (13)-(15)

圖4 控制器(21)～(24)下控制力曲線圖Fig.4 Curves of control force under controller (21)-(24)

圖5 曲線圖Fig.5 Curve of

圖6 控制器(21)～(24)下追蹤航天器運動軌跡Fig.6 Curves of chaser spacecraft’s motion trajectory under controller (21)-(24)

4 結 論

本文基于有限時間控制理論和勢函數法對航天器終端接近避碰控制問題進行研究分析，主要結論如下：

1）基于避碰勢函數，將終端接近的避碰問題轉化為避碰勢函數不能等于零的問題，從而為方便其避碰控制器設計提供了模型基礎。

2）針對系統(tǒng)外部擾動上界已知的情況，設計了有限時間終端接近避碰控制器，利用雙曲正切函數的有界性，使所設計的控制器是有界的。

3）設計了魯棒自適應有限時間飽和避碰控制器，通過引入輔助系統(tǒng)，使所設計的控制器能夠處理擾動上界未知的情況。

4）利用李雅普諾夫理論對所設計的控制器給出了嚴格的理論證明，表明系統(tǒng)狀態(tài)為有限時間穩(wěn)定的，且能實現(xiàn)避碰。

對所設計的控制器進行了數值仿真，進一步驗證了所設計控制器的有效性。

（References）：

[1]Deaconu G, Louembet C, Theron A. Designing continuously constrained spacecraft relative trajectories for proximity operations[J]. Journal of Guidance, Control,and Dynamics, 2015, 38(7): 1208-1217.

[2]Guelman M, Aleshin M. Optimal bounded low-thrust rendezvous with fixed terminal-approach direction[J].Journal of Guidance, Control, and Dynamics, 2001, 24(2):378-385.

[3]任家棟, 曾慶雙, 朱虹. 地球靜止軌道遠程交會過程導航性能評估[J]. 中國慣性技術學報, 2016, 24(2): 257-262.Ren J D, Zeng Q S, Zhu H. Performance evaluation of relative navigation algorithm during geostationary orbit long-range rendezvous[J]. Journal of Chinese Inertial Technology, 2016, 24(2): 257-262.

[4]陳統(tǒng), 徐世杰. 非合作式自主交會對接的終端接近模糊控制[J]. 宇航學報, 2006, 27(3): 416-421.Chen T, Xu S J. A fuzzy controller for terminal approach of autonomous rendezvous and docking with noncooperative target[J]. Journal of Astronautics, 2006, 27(3):416-421.

[5]張大偉, 宋申民, 裴潤, 等. 非合作目標自主交會對接的橢圓蔓葉線勢函數制導[J]. 宇航學報, 2010, 31(10):2259-2268.Zhang D W, Song S M, Pei R, et al. Ellipse Cissoid-based potential function guidance for autonomous rendezvous and docking with non-cooperative target[J]. Journal of Astronautics, 2010, 31(10): 2259-2268.

[6]Weiss A, Baldwin M, Erwin R S, et al. Model predictive control for spacecraft rendezvous and docking: strategies for handling constraints and case studies[J]. IEEE Transactions on Control Systems Technology, 2015, 23(4):1638-1647.

[7]Qi Y Q, Jia Y M. Constant thrust collision avoidance maneuver under thruster failure[J]. Advances in Space Research, 2012, 49(2): 373-385.

[8]Ma L C, Meng X Y, Liu Z Z, et al. Suboptimal powerlimited rendezvous with fixed docking direction and collision avoidance[J]. Journal of Guidance, Control, and Dynamics, 2013, 36(1): 229-239.

[9]Weiss A, Petersen C, Baldwin M, et al. Safe positively invariant sets for spacecraft obstacle avoidance[J]. Journal of Guidance, Control, and Dynamics, 2014, 38(4): 720-732.

[10]Guo Y, Song S M, Li X H. Quaternion-based finite time control for attitude tracking of spacecraft without unwinding[J]. International Journal of Control, Automation, and Systems, 2015, 13(6): 1351-1359.

[11]Guo Y, Song S M, Li X H. Finite-time output feedback attitude coordination control for formation flying spacecraft without unwinding[J]. Acta Astronautica, 2016, 122:159-174.

[12]Li X H, Song S M, Guo Y. Multivariable super-twisting sliding mode approach for attitude tracking of spacecraft[C]//The 34th China Control Conference. Hangzhou,2015: 5789-5794.

[13]Li S, Wang X. Finite-time consensus and collision avoidance control algorithms for multiple AUVs[J]. Automatica, 2013, 49(11): 3359-3367.

[14]Zhou N, Xia Y. Coordination control of multiple Euler-Lagrange systems for escorting mission[J]. International Journal of Robust and Nonlinear Control, 2015, 25(18):3596-3616.

[15]Chen J, Gan M, Huang J, et al. Formation control of multiple Euler-Lagrange systems via null-space-based behavioral control[J]. Science China Information Sciences, 2016, 59(1): 1-11.

[16]Zhang B Q, Song S M. Decentralized coordinated control for multiple spacecraft formation maneuvers[J]. Acta Astronautica, 2012, 74: 79-97.

[17]Kristiansen R. Dynamic synchronization of spacecraft[D]. Trondheim: Norwegian University of Science and Technology, 2008.

Finite-time and collision avoidance control for spacecraft terminal approach with input saturation

LI Xue-hui1, SONG Shen-min1, CHEN Hai-tao1, GUO Yong2
(1. Center for Control Theory and Guidance Technology, Harbin Institute of Technology, Harbin 150001, China;2. School of Automation, Northwestern Polytechnical University, Xi’an 710072, China)

This paper solves the avoid collision problem of spacecraft terminal approach to realize that a chaser spacecraft does not collide with the target spacecraft when reaching to the expected target point. The spacecraft relative motion and the collision avoidance model are established under the orbital coordinate system of target spacecraft. Two finite-time collision avoidance controllers are presented respectively in cases with/without knowing the upper bound of external disturbances, and the designed controllers have input saturation characteristics. Finally, Lyapunov stability theory is applied to prove the finite-time convergence of the designed controllers, and the collision avoidance potential function is used to prove that the controllers can realize the collision avoidance. Simulations demonstrate the effectiveness of the proposed controllers.

terminal approach; collision avoidance control; finite-time control; input saturation

1005-6734(2017)04-0530-06

10.13695/j.cnki.12-1222/o3.2017.04.019

V448.234

A

2017-04-17；

2017-07-20

國家自然科學基金（61174037，61333003，61021002）

李學輝（1988—），男，博士研究生。E-mail: lxh_hit@126.com

聯(lián) 系 人：宋申民（1968—），男，教授，博士生導師，研究方向為非線性系統(tǒng)的穩(wěn)定性分析、魯棒控制、導彈制導與飛行器控制。E-mail: songshenmin@hit.edu.cn