蔣鴻翔,丁祝順,王媛媛,盧小東
(北京航天控制儀器研究所,北京100039)
大型平臺(tái)的慣性穩(wěn)定與地理坐標(biāo)系姿態(tài)跟蹤
蔣鴻翔,丁祝順,王媛媛,盧小東
(北京航天控制儀器研究所,北京100039)
介紹了一種大型兩軸穩(wěn)定平臺(tái)的慣性穩(wěn)定和地理系姿態(tài)跟蹤原理,建立了穩(wěn)定平臺(tái)俯仰框架和橫滾框架的運(yùn)動(dòng)學(xué)模型和動(dòng)力學(xué)模型,進(jìn)行了穩(wěn)定平臺(tái)橫滾通道的角速度回路和角位置回路設(shè)計(jì),仿真分析了姿態(tài)角測(cè)量誤差作用下的穩(wěn)定平臺(tái)姿態(tài)跟蹤性能,與利用加速度計(jì)反饋實(shí)現(xiàn)調(diào)平的兩軸阻尼穩(wěn)定平臺(tái)進(jìn)行對(duì)比,比對(duì)結(jié)果驗(yàn)證了本文設(shè)計(jì)的控制系統(tǒng)在水平姿態(tài)跟蹤速度和抗干擾能力上的優(yōu)勢(shì)。平臺(tái)樣機(jī)進(jìn)行了姿態(tài)跟蹤測(cè)試,結(jié)果驗(yàn)證了結(jié)合定位定向系統(tǒng)(POS)的穩(wěn)定平臺(tái)慣性穩(wěn)定和姿態(tài)跟蹤控制方法可行。
大型穩(wěn)定平臺(tái);運(yùn)動(dòng)學(xué)模型;動(dòng)力學(xué)模型;慣性穩(wěn)定;水平姿態(tài)跟蹤
隨著大型測(cè)量?jī)x器在航空物探、航空遙感等領(lǐng)域的廣泛使用,大型慣性穩(wěn)定平臺(tái)的應(yīng)用也越來(lái)越廣泛。在這些系統(tǒng)中,慣性穩(wěn)定平臺(tái)的主要作用是:1)由于飛機(jī)在飛行過(guò)程中易受氣流或者發(fā)動(dòng)機(jī)振動(dòng)等因素影響,產(chǎn)生機(jī)體低頻角運(yùn)動(dòng)與高頻線(xiàn)振動(dòng),穩(wěn)定平臺(tái)可以有效隔離機(jī)體運(yùn)動(dòng)對(duì)載荷測(cè)量軸的干擾。2)由于飛機(jī)在飛行過(guò)程中載荷的水平姿態(tài)不為0以及航向始終變化,穩(wěn)定平臺(tái)可以實(shí)現(xiàn)在一段航線(xiàn)內(nèi)載荷測(cè)量軸對(duì)水平及特定航向的自動(dòng)保持。
目前在國(guó)內(nèi)外航空遙感系統(tǒng)中,基于陀螺穩(wěn)定的中小型成像相機(jī)坐架已實(shí)現(xiàn)了商業(yè)化[1-2],而在國(guó)外海空重力測(cè)量系統(tǒng)中,穩(wěn)定平臺(tái)的形式正由傳統(tǒng)的基于加速度計(jì)的阻尼式水平穩(wěn)定平臺(tái),向利用基于組合導(dǎo)航原理的定位定向系統(tǒng)(POS)實(shí)現(xiàn)快速姿態(tài)跟蹤的新型穩(wěn)定平臺(tái)發(fā)展[3-5]。本文研究的大型慣性穩(wěn)定平臺(tái)應(yīng)用于航空重力測(cè)量,為兩軸慣性穩(wěn)定平臺(tái)。穩(wěn)定平臺(tái)自重大,所承載的重力傳感器質(zhì)量也大。驅(qū)動(dòng)裝置采用可輸出100Nm以上峰值力矩的力矩電機(jī)。敏感元件采用POS,基于慣性/衛(wèi)星組合導(dǎo)航原理,由高性能導(dǎo)航計(jì)算機(jī)采集陀螺、加速度計(jì)和GPS信號(hào),解算得到與其固連的重力傳感器在當(dāng)?shù)氐乩碜鴺?biāo)系下的俯仰、橫滾和偏航姿態(tài)角數(shù)據(jù),并與陀螺測(cè)量的慣性空間角速度數(shù)據(jù)一起,通過(guò)高速串行通信傳輸給穩(wěn)定平臺(tái)控制計(jì)算機(jī),實(shí)現(xiàn)陀螺穩(wěn)定和水平姿態(tài)跟蹤控制。
本文將在慣性穩(wěn)定平臺(tái)控制建模、陀螺穩(wěn)定回路和姿態(tài)跟蹤回路的設(shè)計(jì)等方面,對(duì)大型慣性穩(wěn)定平臺(tái)動(dòng)態(tài)環(huán)境下慣性穩(wěn)定及水平姿態(tài)跟蹤控制進(jìn)行探討。
穩(wěn)定平臺(tái)的框架由內(nèi)至外分別為俯仰(與重力傳感器和POS固連)、橫滾、基座、底座框架結(jié)構(gòu)。穩(wěn)定平臺(tái)控制回路包括橫滾、俯仰2個(gè)通道。橫滾和俯仰框架運(yùn)動(dòng)范圍均小于±10°。基座與底座通過(guò)阻尼減振器相連。穩(wěn)定平臺(tái)框架結(jié)構(gòu)與框架坐標(biāo)系示意如圖1所示。

圖1 穩(wěn)定平臺(tái)框架坐標(biāo)系圖Fig.1 Gimbals and coordinate diagram of the stabilization platform
其中,OXBYBZB為與基座框架固連的坐標(biāo)系,OXRYRZR為與橫滾框架固連的坐標(biāo)系,OXPYPZP為與俯仰框架固連的坐標(biāo)系。
俯仰框架的角速度[ωPXωPYωPZ]與受控角運(yùn)動(dòng)[ωPXωRY]及基座角運(yùn)動(dòng)[ωBXωBYωBZ]的運(yùn)動(dòng)學(xué)關(guān)系如下:

其中,cP=cosP,sP=sinP,cR=cosR,sR=sinR。P為框架俯仰角,R為框架橫滾角。
由式(1)可知,這一兩軸穩(wěn)定平臺(tái)實(shí)現(xiàn)框架慣性穩(wěn)定的條件是:

由ωPY=0可得:

結(jié)構(gòu)設(shè)計(jì)保證了穩(wěn)定平臺(tái)在俯仰框架角變化范圍內(nèi)不會(huì)出現(xiàn)cP為0的框架鎖定現(xiàn)象,因此式(3)可以滿(mǎn)足。俯仰框架的Z軸由于沒(méi)有運(yùn)動(dòng)自由度,其角速度直接與基座角速度相關(guān)。
忽略角速度的乘積項(xiàng),則俯仰框架的動(dòng)力學(xué)方程如下:

其中,JPX為俯仰框架繞XP軸的主慣性矩,TP為俯仰電機(jī)輸出轉(zhuǎn)矩,fP為俯仰軸上的摩擦力矩、質(zhì)量不平衡力矩等。
忽略角速度的乘積項(xiàng)和載體的角加速度,則橫滾框架的動(dòng)力學(xué)方程如下:

其中,JRY為橫滾框架繞YR軸的主慣性矩,JPY和JPZ為俯仰框架繞YP、ZP軸的主慣性矩,TR為橫滾電機(jī)輸出轉(zhuǎn)矩,fR為橫滾軸上的摩擦力矩、質(zhì)量不平衡力矩等。
POS內(nèi)部包括捷聯(lián)慣性導(dǎo)航部分和GPS導(dǎo)航部分,捷聯(lián)慣導(dǎo)選擇本地水平指北坐標(biāo)系(簡(jiǎn)稱(chēng)N系)為導(dǎo)航解算的數(shù)學(xué)平臺(tái)坐標(biāo)系。OXNYNZN為本地地理坐標(biāo)系,YN軸指向正北,XN軸指向正東,ZN軸由右手法則確定。俯仰框架坐標(biāo)系(P系)也是POS基座坐標(biāo)系,N系到P系的坐標(biāo)轉(zhuǎn)換關(guān)系如圖2所示。

圖2 地理坐標(biāo)系與POS基座坐標(biāo)系關(guān)系圖Fig.2 Relationship diagram of POS base coordinate and local geographic coordinate
其中,航向角ψ為YP軸與YN軸的夾角,在水平面XNYNO上測(cè)量。俯仰角θ為YP軸與水平面的夾角,在垂直面Y1ZNO上測(cè)量。橫滾角γ為XP軸與水平面的夾角,在橫截面X2Z2O上測(cè)量。
由圖2可知,當(dāng)穩(wěn)定平臺(tái)控制框架轉(zhuǎn)動(dòng)實(shí)現(xiàn)地理姿態(tài)跟蹤時(shí),會(huì)使俯仰角θ和橫滾角γ趨近于0,此時(shí)俯仰框架用于安裝重力傳感器的安裝面XPYPO與水平面X1Y1O重合,重力傳感器的垂直測(cè)量軸平行于ZN軸即當(dāng)?shù)氐卮咕€(xiàn)。
與航空攝影測(cè)量中將差分GPS數(shù)據(jù)存儲(chǔ)和進(jìn)行事后計(jì)算得到高精度位姿數(shù)據(jù)的POS處理方法不同的是,本文采用的是POS實(shí)時(shí)輸出的姿態(tài)數(shù)據(jù)。POS先進(jìn)行捷聯(lián)導(dǎo)航計(jì)算,得到捷聯(lián)姿態(tài)矩陣、速度和位置信息。一旦得到更新的GPS信息,執(zhí)行Kalman狀態(tài)反饋計(jì)算,對(duì)捷聯(lián)解算的位置、速度和姿態(tài)角進(jìn)行反饋修正。這一方法的姿態(tài)測(cè)量精度較低,但可實(shí)時(shí)輸出修正的姿態(tài)信息,適合于平臺(tái)姿態(tài)跟蹤控制。
已知從N系到P系之間的姿態(tài)矩陣為[6]:

由姿態(tài)矩陣可以計(jì)算出全部姿態(tài)角為:

其中,Cij代表其姿態(tài)矩陣內(nèi)部元素,i為行號(hào),j為列號(hào)。
為簡(jiǎn)化控制模型,將POS輸出姿態(tài)環(huán)節(jié)用陀螺角速度的直接積分進(jìn)行模擬,最終穩(wěn)定平臺(tái)的兩通道總控制模型如圖3所示。

圖3 穩(wěn)定平臺(tái)控制模型Fig.3 Total control model of the stabilization platform
其中,T1和T2為3×3矩陣。GPS(s)和GRS(s)為俯仰和橫滾穩(wěn)定回路控制器,GPA(s)和GRA(s)為俯仰和橫滾姿態(tài)跟蹤回路控制器。rP和rR為俯仰和橫滾跟蹤回路的輸入姿態(tài)角指令,為實(shí)現(xiàn)水平姿態(tài)保持,令其為0。Kg和KP分別為角速度和姿態(tài)角環(huán)節(jié)的比例因子。
穩(wěn)定平臺(tái)的控制回路采用內(nèi)環(huán)為速度環(huán)、外環(huán)為位置環(huán)的雙回路控制方案。在典型雙回路控制系統(tǒng)中,角速度回路的主要作用是提供角速度阻尼以抑制干擾力矩,同時(shí)快速響應(yīng)角位置回路的輸出。而角位置回路的主要作用是改變系統(tǒng)的角位置,使其精確地隨動(dòng)輸入的角位置指令。穩(wěn)定平臺(tái)由于采用POS陀螺的角速度作為慣性空間角速度反饋信息,采用POS導(dǎo)航解算姿態(tài)作為角位置反饋信息,因此可以實(shí)現(xiàn)穩(wěn)定平臺(tái)在慣性空間內(nèi)的速率穩(wěn)定和水平姿態(tài)跟蹤。
由于穩(wěn)定平臺(tái)2個(gè)通道的控制相互獨(dú)立,以橫滾通道控制回路設(shè)計(jì)為例,其原理框圖如圖4所示。

圖4 橫滾通道控制回路原理框圖Fig.4 Principle control loop diagram of roll channel
其中,K1為PWM驅(qū)動(dòng)及電機(jī)環(huán)節(jié)的比例因子,τ1為驅(qū)動(dòng)環(huán)節(jié)時(shí)間常數(shù),τ2為POS速率采樣和姿態(tài)解算環(huán)節(jié)時(shí)間常數(shù)。J為繞橫滾軸的轉(zhuǎn)動(dòng)慣量。ns為陀螺速率信號(hào)干擾,nA為POS姿態(tài)信號(hào)干擾。由于穩(wěn)定平臺(tái)自身結(jié)構(gòu)特點(diǎn),cP基本等于1,可以不需要在回路中補(bǔ)償由于俯仰角變化造成的角速度回路增益變化。
角速度回路控制器GS(s)和角位置回路控制器GA(s)均采用比例-積分式。角速度回路的控制帶寬主要受慣性穩(wěn)定平臺(tái)的結(jié)構(gòu)諧振頻率的限制,將開(kāi)環(huán)剪切頻率設(shè)計(jì)為6Hz~8Hz,能夠克服典型的頻帶在1Hz以下的載體干擾角運(yùn)動(dòng)。角位置回路的開(kāi)環(huán)剪切頻率需設(shè)計(jì)為角速度回路的開(kāi)環(huán)剪切頻率的1/10甚至更小,本文設(shè)置為0.3Hz~0.4Hz。由于POS更新角速度和姿態(tài)角信息的頻率為100Hz,對(duì)2條控制回路相位裕度減小的影響均可忽略。
由圖4可知控制回路中的干擾項(xiàng)包括:
1)平臺(tái)軸端干擾力矩fR;
2)載體角運(yùn)動(dòng)ωBX和ωBZ;
3)角速度誤差ns;
4)姿態(tài)角誤差nA。
在fR作用下的橫滾角γ為:

其中,分母的第2項(xiàng)為角速度回路的開(kāi)環(huán)傳遞函數(shù),第3項(xiàng)為角速度的開(kāi)環(huán)傳遞函數(shù)乘以角位置回路的開(kāi)環(huán)傳遞函數(shù)。一般來(lái)說(shuō),干擾力矩的頻率會(huì)高于角位置回路的剪切頻率,此頻率處的角位置回路開(kāi)環(huán)傳遞函數(shù)幅值小于0dB,造成第3項(xiàng)的值小于第2項(xiàng)。由此可知,干擾力矩主要由角速度回路進(jìn)行抑制,角位置回路也起了一定的抑制效果。分子表明穩(wěn)定平臺(tái)的轉(zhuǎn)動(dòng)慣量也會(huì)起到抑制干擾力矩的作用。
令ωB=sP·cP·ωBZ+sP·sR·ωBX,則在ωB作用下的橫滾角γ為:

由式(9)可知,2條回路對(duì)載體干擾角運(yùn)動(dòng)的隔離與對(duì)干擾力矩的隔離相似,角速度回路在抑制載體擾動(dòng)角運(yùn)動(dòng)時(shí)起主要作用。角速度誤差ns與橫滾角γ的關(guān)系也如式(9)所示。
姿態(tài)角誤差nA與橫滾角γ的關(guān)系為:

其中,HS(s)為角速度回路從角速度輸入到角速度輸出的閉環(huán)傳遞函數(shù),對(duì)于角位置回路這一環(huán)節(jié)可以被簡(jiǎn)化成HS(s)=1/Kg。
根據(jù)角位置回路從姿態(tài)角指令輸入(姿態(tài)角誤差輸入)到橫滾角輸出的閉環(huán)傳遞函數(shù),知這一姿態(tài)跟蹤回路的帶寬約為0.4Hz,只要姿態(tài)角誤差為低頻周期信號(hào),且頻率低于0.4Hz,就會(huì)引起相應(yīng)的橫滾角波動(dòng)。但是如果姿態(tài)角誤差僅為瞬時(shí)或短時(shí)誤差(比如載體大機(jī)動(dòng)造成POS在1s~2s內(nèi)的姿態(tài)解算誤差),當(dāng)這一誤差消失后,穩(wěn)定平臺(tái)會(huì)控制橫滾角快速趨于0。
傳統(tǒng)上采用加速度計(jì)進(jìn)行調(diào)平控制的兩軸穩(wěn)定平臺(tái)[7],為了使加速度計(jì)測(cè)得的比力只反映臺(tái)體的傾斜,不受載體運(yùn)動(dòng)加速度的影響,必須將加速度計(jì)調(diào)平回路的帶寬盡量降低。由于帶寬低,因此一旦回路中有力矩或角速度的瞬時(shí)擾動(dòng)造成的姿態(tài)變化,或者是載體瞬時(shí)加速度引起的穩(wěn)定平臺(tái)水平姿態(tài)變化,穩(wěn)定平臺(tái)水平姿態(tài)的回調(diào)時(shí)間將會(huì)很長(zhǎng)。
在仿真中模擬了本文姿態(tài)跟蹤穩(wěn)定平臺(tái)和采用加速度計(jì)調(diào)平控制的兩軸穩(wěn)定平臺(tái)(帶寬為0.01Hz)。令水平姿態(tài)跟蹤過(guò)程中都因載體加速度而造成了姿態(tài)測(cè)量誤差(脈沖幅值為0.05°,脈沖寬度為20s),姿態(tài)誤差以及由此造成的平臺(tái)橫滾角控制波形如圖5所示。

圖5 姿態(tài)測(cè)量誤差引起橫滾角控制誤差圖Fig.5 Roll attitude control error caused by attitude measurement error
由仿真結(jié)果可以看出,由于本文研究的姿態(tài)跟蹤穩(wěn)定平臺(tái)采用了POS,姿態(tài)跟蹤回路的帶寬較高,這使得姿態(tài)跟蹤回路能快速且高精度地響應(yīng)POS輸出的地理系水平姿態(tài),實(shí)現(xiàn)水平姿態(tài)保持。
穩(wěn)定平臺(tái)樣機(jī)由俯仰框架、橫滾框架、基座框架、底座、POS、軸端的測(cè)角元件和電機(jī)以及控制電路組成如圖6所示。模擬重力傳感器工裝與俯仰框架固連,作為被穩(wěn)定的臺(tái)體。基座框架通過(guò)減振器與底座框架連接,底座框架再固定于載體上。
為實(shí)測(cè)平臺(tái)的姿態(tài)跟蹤精度,將一臺(tái)高精度慣組安裝在臺(tái)體上表面中心位置,以測(cè)量出平臺(tái)臺(tái)體在姿態(tài)跟蹤回路控制下的實(shí)時(shí)橫滾、俯仰角,其姿態(tài)測(cè)量精度為0.001°。

圖6 穩(wěn)定平臺(tái)實(shí)物圖Fig.6 Physical object picture of the stabilization platform
平臺(tái)靜態(tài)條件下,用突然加載配重的方法給橫滾控制回路施以約1Nm的常值不平衡力矩,穩(wěn)定平臺(tái)橫滾姿態(tài)控制結(jié)果和高精度慣組輸出的橫滾姿態(tài)準(zhǔn)確值如圖7所示。
由實(shí)測(cè)數(shù)據(jù)可知,由于POS陀螺儀自身零偏不穩(wěn)定、初始對(duì)準(zhǔn)誤差、載體振動(dòng)引起的陀螺標(biāo)度因數(shù)變化等因素,加之POS根據(jù)刷新頻率為1Hz的GPS信號(hào)進(jìn)行姿態(tài)反饋修正計(jì)算的綜合結(jié)果,造成POS輸出姿態(tài)總是呈現(xiàn)出周期約1s的鋸齒波形式,但在1s其變化范圍僅為±0.0015°,相比于干擾力矩來(lái)說(shuō)對(duì)姿態(tài)跟蹤精度影響極小。
總體來(lái)說(shuō),POS輸出姿態(tài)與作為姿態(tài)基準(zhǔn)的高精度慣組輸出姿態(tài)變化趨勢(shì)吻合,說(shuō)明了本文提出的基于POS的穩(wěn)定平臺(tái)姿態(tài)跟蹤控制方法是可行的。
本文通過(guò)建立大型穩(wěn)定平臺(tái)俯仰框架和橫滾框架的運(yùn)動(dòng)學(xué)模型和動(dòng)力學(xué)模型,并以橫滾通道為例,分析了角速度回路和角位置回路的控制設(shè)計(jì),將為大型穩(wěn)定平臺(tái)工程樣機(jī)控制系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)提供理論依據(jù)。
通過(guò)仿真模擬了姿態(tài)測(cè)量誤差作用下的穩(wěn)定平臺(tái)橫滾角變化情況,與采用加速度計(jì)調(diào)平控制的兩軸穩(wěn)定平臺(tái)水平姿態(tài)跟蹤效果進(jìn)行了對(duì)比,證實(shí)了本文研究的大型穩(wěn)定平臺(tái)在姿態(tài)跟蹤方面的優(yōu)勢(shì)。
進(jìn)行了平臺(tái)樣機(jī)姿態(tài)跟蹤測(cè)試,驗(yàn)證了本文提出的結(jié)合POS的穩(wěn)定平臺(tái)慣性穩(wěn)定和姿態(tài)跟蹤控制方法的可行性。
[1]LH System Gmbh.Leica PAV80 gyro-stabilized sensor mount user manual[R].2008.
[2]LH System Gmbh.Leica PAV30 gyro-stabilized camera mount technical reference manual[R].2003.
[3]朱如意,丁祝順,夏剛.航空重力儀/梯度儀慣性穩(wěn)定平臺(tái)研制現(xiàn)狀[J].導(dǎo)航與控制,2011,10(2):69-74.ZHU Ru-yi,DING Zhu-shun,XIA Gang.Present state of airbornegravityandgradiometerinertialstabilized platforms[J].Navigation and Control,2011,10(2):69-74.
[4]張昌達(dá).幾種新型的航空重力測(cè)量系統(tǒng)和航空重力梯度測(cè)量系統(tǒng)[J].物探與化探,2005,29(6):471-476.ZHANG Chang-da.Several new types of airborne gravimetric systems and airborne gravity gradiometric systems[J].Geophysical and Geochemical Exploration,2005,29(6):471-476.[5]張永明,盛君,張貴賓.航空重力測(cè)量技術(shù)的現(xiàn)狀及應(yīng)用[J].勘探地球物理進(jìn)展,2006,29(2):94-97.ZHANG Yong-ming,SHENG Jun,ZHANG Gui-bin.Status and applications of airborne gravimetry[J].Progress in Exploration Geophysics,2006,29(2):94-97.
[6]高鐘毓.慣性導(dǎo)航系統(tǒng)技術(shù)[M].北京:清華大學(xué)出版社,2012. GAO Zhong-yu.Inertial navigation system technology[M].Beijing:Tsinghua University Press,2012.
[7]Bruton A M,Hammada Y,F(xiàn)erguson S,et al.A comparison of inertial platform,damped 2-axis platform and strap-down airborne gravimetry[C].International Symposium on Kinematic System in Geodesy,Geomatics and Navigation,Banff,Alberta,2001:542-550.
Inertial Stabilization and Attitude Tracking in the Geographic Coordinate System of the Large Platform
JIANG Hong-xiang,DING Zhu-shun,WANG Yuan-yuan,LU Xiao-dong
(Beijing Institute of Aerospace Control Devices,Beijing 100039)
The principles of inertial stabilizing and geographic coordinate system attitude tracking for a kind of large two-axis stabilization platform are described.The kinematics models and dynamics models of the pitch and roll gimbals of the platform are built.The angle rate control loop and angle position control loop of roll control channel are designed.The simulations of attitude tracking under the condition of the attitude measurement error are done,compared with that of a kind of twoaxis damped stabilization platform utilized the accelerators feedback for horizontal attitude leveling.The result demonstrated that the designed control system in this paper has the advantages in quickly attitude tracking and anti-disturbance capabilities.The attitude tracking test of the stabilized platform prototype was done.Feasibility of the inertial stabilizing and attitude tracking control methods for the stabilizing platform combined with position and orientation system(POS)are demonstrated.
large stabilized platform;kinematics model;dynamics model;inertial stabilizing;horizontal attitude tracking
TP273
A
1674-5558(2017)01-01288
10.3969/j.issn.1674-5558.2017.03.003
蔣鴻翔,男,博士,高級(jí)工程師,研究方向?yàn)閼T性穩(wěn)定平臺(tái)控制技術(shù)。
2016-06-30