1.一種用于GNSS信號(hào)跟蹤的多更新速率卡爾曼載波跟蹤方法,其特征在于,包括以下步驟:
步驟1,接收到的GNSS信號(hào)依次經(jīng)過(guò)接收機(jī)中的天線、射頻前端、AD轉(zhuǎn)換器后轉(zhuǎn)變?yōu)閿?shù)字中頻信號(hào)r(t);
步驟2,本地載波生成裝置NCO(NCO:Numerically Controlled Oscillator)產(chǎn)生頻率控制字為fNCO的兩路信號(hào),分別為同相信號(hào)sI(t)和正交信號(hào)sQ(t),具體為:
sI(t)=cos(2πfNCO·t)
sQ(t)=-sin(2πfNCO·t)
本地偽碼生成裝置產(chǎn)生導(dǎo)頻支路偽碼信號(hào)cp(t)和數(shù)據(jù)支路偽碼信號(hào)cd(t);
將數(shù)字中頻信號(hào)分為相同的兩路信號(hào),一路信號(hào)與同相信號(hào)相乘混合為sI(t)·r(t),再分別與導(dǎo)頻支路偽碼信號(hào)、數(shù)據(jù)支路偽碼信號(hào)相乘混合后,得到信號(hào)為sI(t)·cp(t)·r(t)、sI(t)·cd(t)·r(t);另一路信號(hào)與正交信號(hào)相乘混合為sQ(t)·r(t),再分別與導(dǎo)頻支路偽碼信號(hào)、數(shù)據(jù)支路偽碼信號(hào)相乘混合后,得到信號(hào)為sQ(t)·cp(t)·r(t)、sQ(t)·cd(t)·r(t);
步驟3,相關(guān)器進(jìn)行相關(guān)處理,設(shè)定相干積分時(shí)間為Tc,對(duì)所述步驟2中的信號(hào)sI(t)·cp(t)·r(t)、sQ(t)·cp(t)·r(t)、sI(t)·cd(t)·r(t)、sQ(t)·cd(t)·r(t)分別進(jìn)行相關(guān)處理得到輸出信號(hào)分別為Ip,k,Qp,k,Id,k,Qd,k,其中下標(biāo)k表示跟蹤環(huán)路中第k個(gè)跟蹤歷元,每個(gè)歷元對(duì)應(yīng)的時(shí)長(zhǎng)為Tc,故輸出信號(hào)的積分區(qū)間為(k-1)·Tc到k·Tc,具體結(jié)果如下:
步驟4,鑒別器處理,鑒別器包括數(shù)據(jù)支路鑒相器(記為第一鑒別器),導(dǎo)頻支路鑒相器(記為第二鑒別器),導(dǎo)頻支路鑒頻器(記為第三鑒別器),
所述步驟3中的相關(guān)器輸出信號(hào)Id,k,Qd,k輸入第一鑒別器,經(jīng)第一鑒別器處理后輸出為εd,θ,k;相關(guān)器輸出信號(hào)Ip,k分別輸入第二鑒別器和第三鑒別器,相關(guān)器輸出信號(hào)Qp,k分別輸入第二鑒別器和第三鑒別器,經(jīng)第二鑒別器和第三鑒別器處理后分別輸出為εp,θ,k和εp,f,k;具體各輸出計(jì)算過(guò)程為:
其中
其中,Nd,θ,Np,θ,Np,f分別表示三個(gè)鑒別器的相干積累次數(shù);
步驟5,多更新速率卡爾曼濾波器MUKF(MUKF:Multiple Update-rate Kalman Filter)進(jìn)行濾波處理,將濾波結(jié)果反饋至載波生成裝置中用于更新頻率控制字fNCO。
2.如權(quán)利要求1所述的一種用于GNSS信號(hào)跟蹤的多更新速率卡爾曼載波跟蹤方法,其特征在于,所述步驟5中MUKF濾波的具體過(guò)程為:
步驟51,根據(jù)鑒別器的輸出結(jié)果獲取量測(cè)信息,所述量測(cè)信息包括MUKF的新息增量Yk,量測(cè)矩陣Hk,量測(cè)噪聲矩陣Rk,當(dāng)三個(gè)鑒別器的結(jié)果均有輸出時(shí),計(jì)算表達(dá)式為:
Hd,θ,Hp,θ和Hp,f分別為三個(gè)鑒別器對(duì)應(yīng)的量測(cè)矩陣,具體為:
Rd,θ,Rp,θ和Rp,f分別為三個(gè)鑒別器輸出結(jié)果的噪聲方差,具體為:
其中C/N0為信號(hào)載噪比,當(dāng)某跟蹤歷元中僅有其中一個(gè)或兩個(gè)鑒別器的結(jié)果輸出時(shí),Yk,Hk和Rk只取對(duì)應(yīng)項(xiàng)的組合值;
步驟52,MUKF跟蹤濾波迭代過(guò)程,具體如下:
濾波器的系統(tǒng)方程為:
Xk+1=Φ·Xk+wk
其中Xk=[θk,fk,αk]T,表示第k個(gè)歷元時(shí)的系統(tǒng)狀態(tài)向量,θk、fk、αk分別表示信號(hào)的載波相位、頻率和頻率變化率,單位分別為周、Hz和Hz/s;wk=[ωrf·wb ωrf·wd (ωrf/c)·wa]T表示系統(tǒng)噪聲,wb和wd分別為由接收機(jī)中晶體振蕩器的引起的相位噪聲和頻率噪聲,其噪聲譜密度分別為qb和qd;wa是系統(tǒng)頻率變化率噪聲,其功率譜密度為qa;ωrf是載波頻率,c表示光速;Φ是系統(tǒng)狀態(tài)轉(zhuǎn)移矩陣,具體為:
Q是wk對(duì)應(yīng)的系統(tǒng)噪聲協(xié)方差矩陣,具體為:
根據(jù)步驟51中獲取的量測(cè)信息,MUKF濾波過(guò)程為:
Step 1:計(jì)算系統(tǒng)狀態(tài)向量預(yù)測(cè)值
Step 2:計(jì)算系統(tǒng)狀態(tài)向量協(xié)方差矩陣的預(yù)測(cè)值
Pk-1表示系統(tǒng)狀態(tài)向量Xk-1的協(xié)方差矩陣,表示系統(tǒng)狀態(tài)向量Xk的協(xié)方差矩陣預(yù)測(cè)值;
Step 3:若當(dāng)前歷元時(shí)刻無(wú)鑒別器結(jié)果輸出,則轉(zhuǎn)至Step6,若當(dāng)前歷元至少有一個(gè)鑒別器輸出結(jié)果,則根據(jù)對(duì)應(yīng)量測(cè)信息中的Rk,Hk計(jì)算卡爾曼濾波器增益Gk:
Step 4:根據(jù)新息Yk更新系統(tǒng)狀態(tài)向量值Xk:
Step 5:更新系統(tǒng)狀態(tài)向量協(xié)方差矩陣Pk:
Step 6:無(wú)鑒別器結(jié)果輸出時(shí),直接將預(yù)測(cè)結(jié)果作為當(dāng)前歷元的估計(jì)結(jié)果,即:
步驟53,根據(jù)系統(tǒng)狀態(tài)向量Xk的估計(jì)結(jié)果,反饋輸出至本地載波生成裝置NCO用于更新頻率控制字fNCO,即:
fNCO=fk
其中fk為向量Xk中的第二個(gè)元素,即信號(hào)載波頻率;至此,完成了一次MUKF的濾波處理過(guò)程。
3.一種用于GNSS信號(hào)跟蹤的多更新速率卡爾曼載波跟蹤環(huán)路,其特征在于,包括本地載波生成裝置NCO(1)、本地偽碼生成裝置(2)、6個(gè)乘法器(3,4,5,6,7,8)、4個(gè)相關(guān)器(9,10,11,12)、3個(gè)鑒別器(13,14,15)和1個(gè)MUKF(16);
通過(guò)本地載波生成裝置NCO產(chǎn)生同相信號(hào)和正交信號(hào),第一乘法器(3)和第二乘法器(4)將數(shù)字中頻信號(hào)與同相信號(hào)、正交信號(hào)分別進(jìn)行乘運(yùn)算得到混合信號(hào)sI(t)·r(t)和sQ(t)·r(t);第三乘法器(5)將sI(t)·r(t)與本地偽碼生成裝置產(chǎn)生導(dǎo)頻支路偽碼信號(hào)進(jìn)行乘運(yùn)算后輸出至第一相關(guān)器(9),第四乘法器(6)將sQ(t)·r(t)與本地偽碼生成裝置產(chǎn)生導(dǎo)頻支路偽碼信號(hào)進(jìn)行乘運(yùn)算后輸出至第二相關(guān)器(10),第五乘法器(7)將sQ(t)·r(t)與本地偽碼生成裝置產(chǎn)生數(shù)據(jù)支路偽碼信號(hào)進(jìn)行乘運(yùn)算后輸出至第三相關(guān)器(11),第六乘法器(8)將sI(t)·r(t)與本地偽碼生成裝置產(chǎn)生數(shù)據(jù)支路偽碼信號(hào)進(jìn)行乘運(yùn)算后輸出至第四相關(guān)器(12);第一相關(guān)器(9)和第二相關(guān)器(10)的輸出作為第一鑒別器(13)的輸入,第三相關(guān)器(11)和第四相關(guān)器(12)的輸出作為第二鑒別器(14)和第三鑒別器(15)的輸入;第一鑒別器,第二鑒別器和第三鑒別器的輸出作為MUKF的輸入;所述MUKF的輸出結(jié)果反饋至本地載波生成裝置NCO,用于更新本地載波生成裝置NCO的振蕩頻率。