一種箭體多級聯(lián)合全自動垂調(diào)控制算法研究及系統(tǒng)設計

劉麗媛，邢 然，王趙帥，鄭國昆，劉海波

（北京航天發(fā)射技術研究所，北京，100076）

0 引 言

火箭垂直度調(diào)整的目的是調(diào)整發(fā)動機推力線，從而減小火箭起飛段的橫向漂移量。垂直度調(diào)整是非常重要的一個環(huán)節(jié)，其可靠性及精度是系統(tǒng)重點關注指標。

運載火箭通過發(fā)射平臺支承臂機械接口豎立在發(fā)射平臺上，中國運載火箭除新一代大型運載火箭外，均為4個支承臂支承運載火箭箭體的支承方式，故稱為“四點支承”。支承臂是發(fā)射平臺的部組件之一，通過液壓動力驅(qū)動支承臂可實現(xiàn)支承臂的伸縮運動，運載火箭采用四點支承時，通過對4個支承臂的協(xié)調(diào)動作，即可實現(xiàn)運載火箭的垂直度調(diào)整操作。

現(xiàn)有的基于4點支承的垂直度調(diào)整方法，多為半自動或單級垂調(diào)控制模式。為滿足載人火箭的高可靠及高精度需求，需設計一種基于全自動多級聯(lián)合的高精度垂調(diào)控制策略的控制系統(tǒng)，將各級水平度控制在相應的允許范圍，實現(xiàn)整體箭體垂直度調(diào)整需求。這就要求控制算法需能夠解決各級間的反向作用及相互影響，以滿足系統(tǒng)在性能優(yōu)化的基礎上，減少垂直度調(diào)整時間的總體要求。

本文對多級整體垂調(diào)需求進行解析，通過理論分析，建立算法模型及系統(tǒng)，并結合試驗數(shù)據(jù)，對全自動多級聯(lián)合的影響因素及控制算法進行探討與改進，最終實現(xiàn)4點平面下的快速調(diào)平控制。

1 系統(tǒng)需求及原理模型

1.1 系統(tǒng)需求

本系統(tǒng)及算法需求就是建立在4點支承的基礎上的多級聯(lián)合全自動垂調(diào)系統(tǒng)，既適用于I級火箭與發(fā)射平臺對接后的獨立垂調(diào)，也適用于Ⅱ級火箭、星箭組合體上箭對接后的I、Ⅱ級同時垂調(diào)。

本系統(tǒng)應根據(jù)I、Ⅱ級水平儀數(shù)據(jù)，將測量垂直度與目標垂直度偏差值調(diào)整到總體要求范圍內(nèi)，并在過程中保證滿足如下條件：

a）支承臂高度升降范圍為0～120 mm，其中兩端各留10 mm的安全范圍。當支承臂升降過程中達到10 mm的上下限范圍時系統(tǒng)進行報警及校正；

b）4個支承臂在垂直度調(diào)整過程中執(zhí)行升降動作。動作時，當高差Δ絕對值不小于2 mm時進行報警、校正。

式中～分別為Ⅰ～Ⅳ支承臂高度傳感器示值，單位mm；

c）I級火箭轉場后進行單獨垂調(diào)，要求I級水平度（以下簡稱）滿足∣∣≤0.5′；

d）II級火箭、星箭組合體轉場后對II級進行垂調(diào)，要求I、II級水平度（以下簡稱）分別滿足∣∣≤3′,∣∣≤15′。

調(diào)整到位后，全自動垂調(diào)自動停止，并給出調(diào)整完畢的結論。

1.2 原理模型

四點支承調(diào)平，將由4個獨立象限中支承臂所在點位確定為1、2、3、4四點的平面，記為一級平面,如圖1所示。

圖1 一級平面模型Fig.1 Level 1 Plane Model Diagram

水平傳感器沿、方向布置，、兩個方向的水平傾角分別為和，兩傳感器間的夾角為，則平臺的傾斜角度可由和合成為

I、Ⅱ級水平數(shù)據(jù)原理均可簡化為如上模型，但I、Ⅱ級測量的水平數(shù)據(jù)，受4個支承臂動作調(diào)整的影響不同，在多級聯(lián)合的情況下，4個支承點的動作對平面的作用效果存在差異。需通過合理的算法模型進行解算，達到多級的綜合優(yōu)化調(diào)整效果。

2 多級聯(lián)合垂調(diào)控制算法研究

2.1 控制影響因素解析

通過系統(tǒng)需求分析及控制原理解析，不難發(fā)現(xiàn)多級聯(lián)合垂調(diào)控制算法應能實現(xiàn)同步運動誤差、水平度范圍多因素相互作用下的最優(yōu)動作“路線”規(guī)劃。

2.1.1 同步運動誤差控制

為使4點支承下的各級箭體水平面處于各自的同一水平面上，在支承臂上升、下降過程中每一時刻都要保證4路升降的位移變化絕對值基本相同，因此不僅要對每一路升降支承臂的位置進行精確位置跟蹤控制，還要對多路升降支承臂進行高精度同步控制，即不僅要考慮每路位移實際值與設定值之間的跟蹤誤差，還需考慮該路與相鄰一路之間位移的同步誤差。針對系統(tǒng)被控對象多的特點，基于耦合補償原理，本研究采用環(huán)形耦合控制方式對多路液壓馬達進行同步控制，對于每路液壓馬達，僅考慮與其相鄰一側液壓馬達的位移偏差，該位移偏差反饋到該路支承臂，對其控制量進行補償修正，各路支承臂之間兩兩耦合，形成耦合環(huán)，在負載擾動等情況下，仍能保證各路之間較好的同步控制精度。位置閉環(huán)跟蹤控制模型如圖2所示。

圖2 位置閉環(huán)跟蹤控制模型Fig.2 Postion Closed-loop Tracking Control Model Diagram

由個支承臂構成的多點控制系統(tǒng)，第點的跟蹤誤差可定義為

為了更好地反映各點位置誤差的變化情況，按鄰近次序定義同步誤差為ε()如式（5）：

2.1.2 水平度調(diào)整控制

不同級平面的測量角度傳感器不同，但控制模型一致。針對每一獨立級平面，系統(tǒng)需求以該級水平度為判據(jù)，可采用角度調(diào)平方法。該方法實質(zhì)是對水平儀檢測實際傾角角度和進行調(diào)整，直到檢測到的兩個角度滿足測量垂直度與目標垂直度偏差值小于10″的誤差范圍內(nèi)，則平臺實現(xiàn)調(diào)平。

常見的角度誤差控制調(diào)平法的控制邏輯如圖3所示。假設最高點不動，分析角度控制誤差調(diào)平方法。當＞0，＞0時，第1條支腿為最高點，保持第1條支腿的支撐點不動，則第2、3條支腿同時上升就會使減小，當減小至允許誤差范圍值時2、3支腿停止上升；接下來令第3、4條支腿上升，從而使減小，當減小至允許誤差范圍值時3、4支腿停止上升，則平臺實現(xiàn)調(diào)平。對于兩個傾角、的調(diào)節(jié)，一般先調(diào)節(jié)較大的角度，注意在調(diào)節(jié)過程中，務必使最高點保持不動。

圖3 水平度控制模型Fig.3 Levelness Control Model Diagram

但由于受箭體特性影響，在本系統(tǒng)角度控制調(diào)節(jié)時無法保持最高點不動原則。所以調(diào)整角度控制策略如下：

其中，項傾角為1、3支承臂連線角度，正值為1低3高，項傾角為2、4支承臂連線角度，正值為2低4高。當︱︱＞0，︱︱＞0 時，對于兩個傾角、的調(diào)節(jié)，先調(diào)節(jié)較大的角度。例如傾角較大，則先調(diào)節(jié)傾角軸線上的兩個支承臂的高度，動作方向應為傾角變小的趨勢一致，兩個支承臂作反向運動，直到角度值滿足調(diào)平要求，即可停止動作。反之亦然。

2.2 控制算法研究

通過各影響因素解析及控制模型建立，綜合多級聯(lián)合垂調(diào)的支承臂控制策略如下：

在支承臂控制過程中，系統(tǒng)實時采集各支承臂高度，計算控制誤差，并將采集和控制輸出信號傳送執(zhí)行機構及顯示器，實時監(jiān)測動作過程數(shù)據(jù)。同時接受來自I級火箭水平儀I-III象限垂直度、I級火箭水平儀II-IV象限垂直度、II級火箭水平儀I-III象限垂直度、II級火箭水平儀II-IV象限垂直度，用于支承臂垂調(diào)流程控制。

依據(jù)要求I級水平度、II級水平度，分別滿足 ∣∣≤3′和∣∣≤15′，∣－∣≤18′自動調(diào)整；∣－∣＞18′協(xié)商手動調(diào)整。分解判斷策略如表5所示，設為0′至1′之間的一個控制公差（默認0.5′）。其中，邊界范圍值及公差值均可根據(jù)要求進行設置調(diào)整。

表1 垂調(diào)控制策略分析表Tab.1 Vertical Control Strategy Analysis Table

由于算法采用水平度及位移值雙閉環(huán)處理，為避免產(chǎn)生反復調(diào)節(jié)及“過矯”情況，同時在算法控制中，設定控制原則如下：

a）設定優(yōu)先級分別為：水平度→位移值；

b）各傾角方向單獨判斷調(diào)整，確定各傾角線上支承臂動作；

c）單次動作中，單一傾角方向上的支承臂動作調(diào)節(jié)，需按首次判定方向動作，不允許進行反向調(diào)節(jié)。

3 控制系統(tǒng)設計

本文設計的控制算法，搭載支承臂垂調(diào)控制系統(tǒng)設備進行驗證。系統(tǒng)硬件設計架構見圖4，系統(tǒng)采用PLC控制器，運行周期10 ms左右，具有快速的計算性能?？刂破魍ㄟ^模擬量采集通路采集各支承臂的位移傳感器的實時數(shù)據(jù)值，通過串口接收箭上各級水平角度數(shù)值，通過控制器控制算法計算判斷，給出各個支承臂的動作控制信號，從而驅(qū)動執(zhí)行機構進行動作，達到調(diào)整箭體整體垂直度的效果。其中，執(zhí)行機構包括支承臂、液壓驅(qū)動系統(tǒng)等外圍所有動作設備。控制系統(tǒng)主要通過輸出不同的流量控制信號，給比例放大板，控制液壓系統(tǒng)比例流量閥的調(diào)節(jié)，驅(qū)動液壓馬達，從而實現(xiàn)支承臂的動作精度控制。

圖4 控制系統(tǒng)架構Fig.4 Control System Architecture Diagram

4 試驗測試數(shù)據(jù)及結果分析

4.1 試驗測試數(shù)據(jù)

基于支承臂垂調(diào)控制系統(tǒng)設備對控制算法進行了兩部分驗證測試。

4.1.1 邊界范圍控制測試

主要以水平儀的各種邊界情況進行策略判定測試驗證在極端工況下的算法自適應情況。當I、II級水平儀數(shù)據(jù)在要求范圍內(nèi)時，不進行調(diào)平動作；當不滿足要求時，共有3種工況：

a）I級水平儀滿足，II級水平儀不滿足。

此情況下的水平角度邊界測試值及動作狀態(tài)值如表2所示，其中，分別為1，3方向和2，4方向上的傾角值，下角標1，2代表所相應的級層。

表2 水平角度及動作狀態(tài)1Tab.2 Horizontal Angle and Motion State 1

b）I級水平儀不滿足，II級水平儀滿足。

此情況下的水平角度邊界測試值及動作狀態(tài)值如表3所示。

表3 水平角度及動作狀態(tài)2Tab.3 Horizontal Angle and Motion State 2

c）I、II級水平儀都不滿足。

此情況下的水平角度邊界測試值及動作狀態(tài)值如表4所示。

表4 水平角度及動作狀態(tài)3Tab.4 Horizontal Angle and Motion State 3

根據(jù)控制系統(tǒng)實物測試邊界結果可見，控制算法在各邊界工況下的自動判斷優(yōu)化選擇有效，與期望運動控制效果一致，能夠滿足系統(tǒng)自動多級聯(lián)合垂調(diào)判斷控制使用要求。

4.1.2 控制性能測試

測試控制算法在任意工況下，調(diào)節(jié)動作的控制性能及效果。以實際測試時某次動作數(shù)據(jù)為例，水平角度數(shù)值向傾角5′08″，向傾角4′09″，各支承臂初始動作高度值均為60 mm，目標值向傾角2′，向傾角2′。調(diào)整后，水平角度數(shù)值向傾角2′04″，向傾角2′04″，各支承臂高度值依次為Ⅰ：58.39 mm，Ⅱ： 59.35 mm，Ⅲ：62.06 mm，Ⅳ：61.20 mm。各支承臂位移變化趨勢如圖5所示，水平角度變化趨勢如圖6所示，傾角角度值在實際計算及記錄中統(tǒng)一轉換為單位秒。

圖5 支承臂位移變化趨勢Fig.5 Displacement Trend Diagram of Supporting Arm

圖6 水平角度變化趨勢Fig.6 Horizontal Angle Trend Chart

4.2 結果分析

結合試驗數(shù)據(jù)分析，可總結多級自動垂調(diào)控制算法下支承臂動作規(guī)律如下：

a）各支承臂動作時，對關鍵因素的影響由大到小為：水平度→位移值。

b）水平度調(diào)整時，不同向傾角間，相互影響較小，變化趨勢趨近一致。

c）垂直度調(diào)整時高度值及變化差值算法能夠閉環(huán)控制在±0.5 mm。

試驗結果表明，本文設計的控制算法能滿足多級聯(lián)合垂調(diào)控制的需求，控制精度高，提升了垂調(diào)控制性能及控制時間，具有極強的工程應用性。

5 結 論

本文依據(jù)需求，以水平傾角及支承臂位移高度作為調(diào)整控制對象，設計了一種多級聯(lián)合垂調(diào)控制算法，試驗證明該算法能高效實現(xiàn)箭體垂直度的快速判定與調(diào)整控制，調(diào)整結果與目標期望值一致，將誤差控制在要求范圍之內(nèi)，實現(xiàn)高精度雙閉環(huán)垂調(diào)控制功能?；谠O計方案的試驗結果，對垂調(diào)控制下的各關鍵因素的調(diào)整趨勢及規(guī)律做了深入探討，總結了各關鍵因素受控制策略影響的優(yōu)先程度，實現(xiàn)了全自動多級聯(lián)合的高精度垂調(diào)控制。該控制算法已應用于某型號活動發(fā)射平臺大修的電氣系統(tǒng)更新研制中，并經(jīng)過了出廠測試、靶場現(xiàn)場安裝調(diào)試及發(fā)射任務的考核。