,,
(中國衛(wèi)星海上測控部,江蘇 江陰 214431)
圖1 船載雷達伺服驅動結構框圖
船載雷達由于安裝基座固定在甲板上,捕獲目標時天線因船搖的影響無法準確的進行空間指向,通常船搖幅度遠大于雷達波束寬度,即使跟蹤上目標也有可能因此而丟失,因此隔離船搖是船載雷達系統(tǒng)設計時必須解決的關鍵問題之一[1]。目前,船載雷達系統(tǒng)主要采用自跟蹤閉環(huán)、陀螺反饋、船搖前饋等方法隔離船搖,根據海況的惡劣情況單獨使用一種方法或組合使用以期獲得理想的船搖隔離效果[2]。船搖前饋信息包括船搖速度和船搖加速度,由計算機接收慣導設備敏感的船搖信息計算獲得[3]。由于前饋量的計算誤差包括慣導精度誤差、坐標轉換誤差、船體變形誤差等,因此船搖前饋一般只能給系統(tǒng)增加約7 dB的隔離度,難以滿足12 m口徑的船載X頻段天線隔離度指標。針對這種情況,本文提出一種基于卡爾曼濾波的新型船搖補償方法,直接利用濾波以后的高精度速率陀螺信號作為前饋補償量,經過仿真和試驗表明,可以極大地提高船搖隔離度。
船載天線驅動單元分為方位、俯仰兩條驅動支路,俯仰支路采用直流電機雙鏈驅動,方位支路采用直流電機雙/四鏈驅動,對電機控制采用電消隙方式,在環(huán)路設計上采用三環(huán)控制[4]。同時,為實現電消隙,配置有偏置力矩環(huán)、差速抑制環(huán),保證多電機的受力均勻。下面以俯仰支路為例,簡單介紹伺服驅動基本結構。方位支路是雙電機驅動系統(tǒng),為保證高測量精度和高動態(tài)性能,與常規(guī)伺服系統(tǒng)設計一樣采用典型的三環(huán),電流環(huán)為最內環(huán),通過改造馬達控制器電流控制回路實現;速度環(huán)為中間環(huán)路,為自主設計環(huán)路,它為開環(huán)環(huán)路,將速度控制信息、偏置力矩信息、差速抑制信息等合成送給電流環(huán);位置環(huán)為最外層環(huán)路,它為閉環(huán)環(huán)路,采用計算機通過設計控制算法實現天線精準控制。由于船載測控設備工作環(huán)境特點,增加了抑制船搖的陀螺環(huán),在天線特定位置固定2個陀螺,用于感知天線相對基準的轉速,將感應出的電信號經過處理后饋入速度環(huán),從而實現克服船搖的目的。該系統(tǒng)的結構框圖如圖1所示。
船載雷達伺服系統(tǒng)為了提高系統(tǒng)船搖隔離度通常采用陀螺反饋穩(wěn)定方案,即在天線軸上(方位和俯仰)分別安裝速率陀螺,敏感船搖在天線軸上的角速度反饋閉環(huán)構成陀螺環(huán)穩(wěn)定回路,隔離船搖對系統(tǒng)跟蹤性能的影響,提高系統(tǒng)的跟蹤精度。陀螺環(huán)作為位置環(huán)的內環(huán),主要起以下作用:
1)速率陀螺能夠提前獲取船體搖晃對天線軸的影響,進而通過陀螺環(huán)穩(wěn)定回路降低船體搖晃造成天線指向擾動的不利影響,這種方法比單純利用位置環(huán)路閉環(huán)穩(wěn)定隔離度船搖的效果要好,而且更快。
2)陀螺環(huán)構成位置環(huán)的內環(huán),控制天線朝著角誤差減小的方向運行,實現對目標的隨動跟蹤。隔離度。
船搖前饋補償就是將船搖擾動信號引入速度環(huán)輸入端,構成前饋復合控制,達到船搖隔離的目的。在船體安裝三軸速率陀螺,用于感應橫搖、縱搖和航向三個方向的船搖速度分量,經過坐標變換轉換成方位、俯仰軸的船搖擾動信號加到系統(tǒng)中。坐標變換公式為:
圖2 船搖前饋原理框圖
由此可計算船搖前饋隔離度為:
根據船載雷達伺服系統(tǒng)的數學模型,利用MATLAB計算前饋隔離度,當船搖擾動ω=0.5 rad/s時,
可見由陀螺實測數據作為前饋量的船搖前饋隔離度遠大于計算機輔助計算的前饋補償。但是陀螺在實際使用過程中,受船體振動的影響、以及陀螺內部信號處理產生的熱噪聲以及傳輸過程都會造成輸出數據中存在著多余的噪聲干擾,在開環(huán)控制中這些噪聲都被放大,有可能降低系統(tǒng)跟蹤精度以及穩(wěn)定性等問題[5]。因此必須對陀螺的測量數據進行濾波以后才能加入到系統(tǒng)環(huán)路中。
卡爾曼濾波是一種線性最小方差估計方法,通過系統(tǒng)輸入輸出觀測數據,對系統(tǒng)狀態(tài)進行最優(yōu)估計的算法。其基本思想是首先建立噪聲與信號的狀態(tài)模型,然后分別計算前一時刻的估計值以及當前時刻的觀測值,通過估計值和觀測值來當前時刻狀態(tài)變量的值。這種濾波算法非常適用于實時處理和計算機運算,其算法如下:
設隨機線性離散系統(tǒng)的狀態(tài)方程和測量方程為:
Xk=φk|k-1Xk-1+Γk|k-1Wk
Yk=HkXk+Vk
其中:Xk表示狀態(tài)向量,φk|k-1表示系統(tǒng)狀態(tài)轉移矩陣,Hk表示測量矩陣,Wk表示過程噪聲,Vk表示測量噪聲。假設Wk和Vk是互不相關的零均值高斯白噪聲,即:
由此可得到卡爾曼濾波算法迭代過程如下:
Kk=Pk|k-1HkT(HkPk|k-1HkT+Rk)-1
Pk= (1-KkHk)Pk|k-1
由于速率陀螺輸出的是天線角度上的變化率,導致濾波器的測量方程的觀測誤差是彼此耦合的,造成濾波測量方程相互耦合。雖然假定濾波器的狀態(tài)方程相互獨立,但是為了保證濾波效果仍需將濾波器設計為六態(tài)濾波器,導致濾波計算過程非常繁雜。由于我們采用的是直角坐標系,根據相關資料和工程經驗,可近似認為測量誤差互不相關,因此可以將濾波器分別設計為兩個三態(tài)濾波器,這將極大的簡化濾波計算過程,而對濾波性能無明顯影響。因此本文采用這種線性化解耦后的濾波算法。
這里以俯仰陀螺輸出電壓為例,利用卡爾曼濾波對陀螺輸出數據進行處理。濾波結果如圖3所示。圖中實線條為濾波前的陀螺輸出值,虛線條為濾波后的陀螺輸出值,右圖為左圖的局部放大圖。從圖中可見通過卡爾曼濾波以后可以有效的降低陀螺噪聲。
圖3 俯仰陀螺濾波前后輸出曲線
利用 MATLAB/Simulink 對船搖前饋補償方案進行仿真分析。卡爾曼濾波算法在 MATLAB 中用m語言編制函數實現,并在 Simulink中用 MATLAB Function模塊調用該函數,陀螺在船搖擾動下的測量數據作為卡爾曼濾波器的輸入,卡爾曼濾波器輸出的速度量作為前饋信息加入速度回路前端,從而實現基于卡爾曼濾波器的陀螺前饋補償方案的仿真。仿真框圖如圖4所示,將仿真數據輸出到 MATLAB 的工作空間進行處理,得出此時的總船搖隔離度為56 dB。
圖4 前饋補償方案仿真框圖
同時本文給出了船搖擾動作用下加入基于前饋補償方案伺服分系統(tǒng)穩(wěn)態(tài)輸出響應曲線如圖5所示,可見前饋量的加入也沒有改變系統(tǒng)的穩(wěn)定性。
圖5 系統(tǒng)穩(wěn)態(tài)輸出響應曲線
為了檢驗新方法隔離船搖的效果,針對某船載X頻段天線進行船搖隔離度測試。按照《航天測量船船載測控通信設備船搖隔離度檢測方法》的試驗要求[6],船舶生搖滿足檢測方法的試驗條件,天線跟蹤信標球完成相關的測試。測試環(huán)路包括:自跟蹤環(huán)、自跟蹤環(huán)+陀螺環(huán)、自跟蹤環(huán)+船搖前饋、自跟蹤環(huán)+陀螺環(huán)+船搖前饋總隔離度,通過對測試數據進行處理,結果如表1所示。從表中試驗結果可見,基于卡爾曼濾波的新型船搖前饋補償方案能較大幅度的提高船搖隔離度從而提升系統(tǒng)跟蹤性能。
表1 船搖隔離度測試結果(俯仰)
本文針對計算機輔助船搖前饋技術對系統(tǒng)隔離度提升不多的問題,從原理和仿真兩方面分析了利用陀螺實測數據作為前饋量的船搖補償方案對系統(tǒng)隔離度的貢獻,并進行了試驗測試。船載雷達在實際工作過程中受船體振動等環(huán)境影響,可能會在前饋支路引入其他噪聲。對于船體環(huán)境引入的高頻噪聲,卡爾曼濾波可以起到很好的濾波作用,而且速度環(huán)有低通濾波器特性,高頻噪聲不會在輸出端體現;對于船載環(huán)境引入的低頻噪聲,卡爾曼濾波也可以起到較好的濾波作用,而且低頻噪聲可以算做船搖的一部分,通過前饋系數的調整可以達到較好的隔離效果。試驗結果表明該補償方法能較大程度的提高系統(tǒng)隔離度。
參考文獻:
[1] 瞿元新,周錦標,謝 勇. 船載測控設備船搖隔離度自動化測試方法研究[J].飛行器測控學報,2006,25(4):62-65.
[2] 劉四方,羅友明. 基于VC++的77船搖隔離度自動化測試研究[J].微計算機信息,2008,24(4):36-37,53.
[3] 王 恒,李永剛,陳 亮,等. 測量船船搖前饋數據處理方法研究及應用[J].飛行器測控學報, 2011, 30(2):64-69.
[4] 丁求啟,陶 敏,張桂平. 智能積分器在船載大口徑天線伺服系統(tǒng)中的應用[J].電子設計工程,2013, 21(9):174-176.
[5] 陶 敏,丁求啟,張桂平. 一種基于卡爾曼濾波的船載伺服系統(tǒng)隨機誤差處理方法[J]. 電子設計工程,2013, 21(10):28-31.
[6] 楊鼎新. 航天測量船雷達天線前饋技術應用分析[J]. 自動化技術與應用,2013, 32(12):51-54.