李 冬,龔 磊
(中國人民解放軍92124部隊, 遼寧 大連 116023)
制導(dǎo)工具誤差是引起飛行器落點偏差的重要因素之一,飛行器精度評定通常將特殊軌跡分離出的制導(dǎo)工具誤差折算到最大射程軌跡上,進(jìn)而獲得全程軌跡的落點精度[1-2]。與固定發(fā)射飛行器相比,動基座發(fā)射飛行器落點精度還會受到慣導(dǎo)系統(tǒng)初始定位誤差、調(diào)平對準(zhǔn)誤差和初速測量誤差的影響,這些初始誤差與制導(dǎo)工具誤差耦合在一起,共同引起落點偏差。有研究表明,初始誤差帶來的落點偏差在量級上與制導(dǎo)工具誤差相當(dāng)[3]。如何準(zhǔn)確分離初始誤差和制導(dǎo)工具誤差是動基座發(fā)射飛行器精度評定亟需解決的重要問題。
許多學(xué)者開展了動基座發(fā)射飛行器誤差分離方法的研究。文獻(xiàn)[4]通過分析初始誤差對遙外差數(shù)據(jù)的影響,建立了估計初始誤差的線性模型,但沒有估計制導(dǎo)工具誤差。鄭小兵等[5]利用地面測試數(shù)據(jù)減小制導(dǎo)工具誤差對遙外差的影響,在此基礎(chǔ)上給出了一種利用飛行起始段的遙外差數(shù)據(jù)估算初始定位誤差的方法。張仲毅等[6]在分離初始誤差的線性模型中將定向誤差歸算為射擊方位角誤差和平臺初始失準(zhǔn)角。胡正東等[7]建立了同時估計初始誤差和制導(dǎo)工具誤差的線性模型,楊華波等[8]通過仿真實驗對該模型的正確性進(jìn)行了驗證,但實驗中考慮的制導(dǎo)工具誤差項數(shù)較少,當(dāng)制導(dǎo)工具誤差中包含加速度計安裝誤差角時,該模型存在復(fù)共線性,無法給出誤差的準(zhǔn)確估計值。
本文針對動基座發(fā)射飛行器的初始誤差和制導(dǎo)工具誤差的估計問題,分析了定向誤差與平臺初始失準(zhǔn)角的轉(zhuǎn)換關(guān)系,采用線性化近似方法建立了同時估計初始誤差和制導(dǎo)工具誤差的線性模型,在此基礎(chǔ)上給出了誤差估計的Bayes方法,解決了線性模型的復(fù)共線性,通過仿真實驗檢驗了誤差估計的精度。
動基座發(fā)射飛行器的制導(dǎo)控制需要慣導(dǎo)系統(tǒng)提供發(fā)射時刻的導(dǎo)航參數(shù),這些參數(shù)包括定位參數(shù)(發(fā)射點的大地緯度B0、大地經(jīng)度L0、大地高程H0)、定向參數(shù)(發(fā)射點的天文緯度BT、天文經(jīng)度LT、天文射擊方位角AT)和初始速度參數(shù)V0=(vx0,vy0,vz0)T。把慣導(dǎo)系統(tǒng)的測量誤差以及調(diào)平對準(zhǔn)誤差帶來的導(dǎo)航參數(shù)誤差稱為初始誤差,包括定位誤差(ΔB、ΔL、ΔH)、定向誤差(ΔBT、ΔLT、ΔAT)和初速誤差ΔV=(Δvx,Δvy,Δvz)T。本文需定義理論發(fā)射系、理論發(fā)射慣性系、真發(fā)射系、真發(fā)射慣性系、平臺坐標(biāo)系等坐標(biāo)系統(tǒng)。理論發(fā)射系是以導(dǎo)航定位參數(shù)(B0,L0,H0)確定原點并以導(dǎo)航定向參數(shù)(BT,LT,AT)確定3個坐標(biāo)軸指向的發(fā)射系,真發(fā)射系是以真實定位參數(shù)(B0+ΔB,L0+ΔL,H0+ΔH)確定原點以真實定向參數(shù)(BT+ΔBT,LT+ΔLT,AT+ΔAT)確定坐標(biāo)軸指向的發(fā)射系。在發(fā)射零時刻,與理論發(fā)射系重合的發(fā)射慣性系稱為理論發(fā)射慣性系,與真發(fā)射系重合的發(fā)射慣性系稱為真發(fā)射慣性系。平臺坐標(biāo)系的原點取為真發(fā)射慣性系的原點,坐標(biāo)軸與3個陀螺儀的敏感軸平行。
上式左右兩邊分別作關(guān)于(ΔBT,ΔLT,ΔAT)和(εpx,εpy,εpz)的泰勒展開,只保留一階項,可得平臺初始失準(zhǔn)角與初始誤差的轉(zhuǎn)換關(guān)系式為
εp≈Γξ
(1)
其中
(2)
(3)
式(3)中:Φ(t)為理論發(fā)射系到理論發(fā)射慣性系的旋轉(zhuǎn)矩陣,Φ(t)=C-1Ω(t)C,Ω(t)=Rz(-ωt),ω為地球自轉(zhuǎn)角速度,R0=C-1X0,X0為理論發(fā)射系原點的地心直角坐標(biāo)
(4)
飛行器慣導(dǎo)平臺輸出的遙測數(shù)據(jù)為平臺坐標(biāo)系下的視速度測量Wp(t)=(wpx(t),wpy(t),wpz(t))T,對其積分后可得平臺坐標(biāo)系下的視位置數(shù)據(jù)Pp(t)=(ppx(t),ppy(t),ppz(t))T。Wp(t)、Pp(t)與Wr(t)、Pr(t)的偏差由制導(dǎo)工具誤差引起的,滿足如下關(guān)系[10]:
(5)
綜合式(4)和式(5)可得:
設(shè)采樣時刻為t1,t2,…,tn,令
Y=Aθ+δ
(6)
在此稱A為環(huán)境函數(shù)矩陣。
將W(t)=(wx(t),wy(t),wz(t))T簡記為W=(wx,wy,wz)T,制導(dǎo)工具誤差中的平臺初始失準(zhǔn)角εp=(εpx,εpy,εpz)T對應(yīng)的視速度環(huán)境函數(shù)[10]為
(7)
定向誤差ξ=(ΔBT,ΔLT,ΔAT)T對應(yīng)的視速度環(huán)境函數(shù)矩陣記為Sξ(t),εp和ξ引起的視速度偏差是相同的,于是有
Sξ(t)ξ=Sε(t)εp
(8)
由式(1)和式(8)可得
Sξ(t)≈Sε(t)Γ
(9)
加速度計安裝誤差角α=(αxz,αxy,αyx,αyz,αzx,αzy)T[11]對應(yīng)的視速度環(huán)境函數(shù)記為Sα(t),有
(10)
由式(2)、式(7)、式(9)和式(10)可得
Sξ(t)≈Sα(t)H
其中
于是Sξ(t)和Sα(t)的列近似線性相關(guān)。同理可推導(dǎo),ξ和α的視位置環(huán)境函數(shù)具有相同的線性關(guān)系。這樣,環(huán)境函數(shù)矩陣A關(guān)于ξ和α的列近似線性相關(guān),具有很強(qiáng)的復(fù)共線性。而ξ和α對飛行器落點偏差的影響較大,不可忽略。
對于模型式(6),由于環(huán)境函數(shù)矩陣A關(guān)于ξ和α的列存在線性相關(guān)性,在沒有θ任何先驗信息的條件下無法唯一確定θ的估計值。在飛行器試驗前,通過地面測試得到制導(dǎo)工具誤差的先驗信息,這樣利用能夠融入先驗信息的Bayes極大后驗估計[12]可以獲得θ的最優(yōu)估計,從而克服環(huán)境函數(shù)矩陣的復(fù)共線性。
假設(shè)模型(6)中誤差δ服從均值為零協(xié)方差矩陣為Pδ的高斯分布,且θ的先驗分布服從均值為θ0協(xié)方差矩陣為Pθ的高斯分布,則θ的Bayes極大后驗估計為
Pp(t)≈Φ(t)Px(t)Φ(t)T
δw(t)的協(xié)方差矩陣Pw(t)為
其中,
18ω2||Px(t)||2
Pw(t)≈Φ(t)Pv(t)Φ(t)T
Pδ≈diag((Pw(t1),…,Pw(tn),Pp(t1),…,Pp(tn))
誤差比定義為:|估計值-真值|/真值,以誤差比小于等于0.4作為判斷估計好項的標(biāo)準(zhǔn)。表1給出了1 000次MC實驗制導(dǎo)工具誤差估計的平均誤差比,可以看出,Bayes估計方法有18個估計好的項,而主成分方法只有7個估計好的項。1 000次MC實驗初始誤差估計的均方根誤差如表2所示,可以看出,PCE方法對定向誤差的估計精度遠(yuǎn)低于Bayes估計方法,PCE方法和Bayes估計方法對定位誤差和初速誤差的估計精度都很高,將初始定位誤差換算成距離度量單位,它們對定位誤差的估計精度分別為0.162 m和0.115 m。環(huán)境函數(shù)矩陣的復(fù)共線性導(dǎo)致PCE方法難以估準(zhǔn)定向誤差,同時降低了制導(dǎo)工具誤差的估計精度,而Bayes方法利用了先驗信息,克服了環(huán)境函數(shù)矩陣的復(fù)共線性,估計結(jié)果的精度較高。
表1 1 000次MC實驗制導(dǎo)工具誤差估計的平均誤差比
表2 1 000次MC實驗初始誤差估計的均方根誤差
本文研究動基座發(fā)射飛行器的初始誤差和制導(dǎo)工具誤差的估計問題,采用線性化近似方法建立了同時估計初始誤差和制導(dǎo)工具誤差的線性模型,利用Bayes估計方法解決了環(huán)境函數(shù)矩陣的復(fù)共線性。仿真結(jié)果表明:該方法的估計精度優(yōu)于PCE方法。本方法能夠為動基座發(fā)射飛行器的精度鑒定提供有力支撐。