发明名称 一种基于载波频率辅助相位矢量跟踪方法
摘要 本发明涉及高动态环境下GPS信号跟踪领域,具体涉及一种利用锁频环辅助锁相环的方式代替传统单一跟踪环路,通过集中式滤波器对接收机各通道中频信号进行综合处理的矢量跟踪方法。本发明包括:(1)混频;(2)相关器及鉴别器输出;(3)集中式滤波;(4)载波频率辅助相位矢量跟踪。接收机各跟踪通道内均采用FLL辅助PLL的方式,减小鉴别器的输出误差,利用集中式滤波器将各跟踪通道内的测量值信息综合处理,滤波器输出k+1时刻的速度误差经过变换,得到k+1时刻的载波频率修正值和码频率修正值,反馈至载波压控振荡器,用来调整本地复现载波信号。
申请公布号 CN104316941B 申请公布日期 2017.02.15
申请号 CN201410546126.9 申请日期 2014.10.16
申请人 哈尔滨工程大学 发明人 沈锋;李伟东;马娜娜;韩浩;李强;桑静;迟晓彤;张金丽;周阳;兰晓明
分类号 G01S19/29(2010.01)I;G01S19/26(2010.01)I 主分类号 G01S19/29(2010.01)I
代理机构 代理人
主权项 一种基于载波频率辅助相位矢量跟踪方法,其特征在于:(1)混频:接收机利用天线接收到的卫星信号送至射频前端处理,通过多级混频将射频信号转换成中频信号,与本地载波数控振荡器产生的本地正弦和余弦复现载波信号进行混频运算,接收机第i通道I支路与Q支路中频信号载波剥离后第k时刻的输出:<img file="FDA0001142372010000011.GIF" wi="543" he="54" /><img file="FDA0001142372010000012.GIF" wi="550" he="51" />式中,<img file="FDA0001142372010000013.GIF" wi="81" he="54" />为输入信号与输出信号相位差异;(2)相关器及鉴别器输出:I/Q支路输出信号分别与本地伪码发生器生成的即时码P、超前码E和滞后码L相关运算,相关器输出六路相干积分值为:<img file="FDA0001142372010000014.GIF" wi="990" he="743" />式中,δ为本地C/A码超前滞后的间隔,T<sub>coh</sub>为预检积分时间,δf和<img file="FDA0001142372010000015.GIF" wi="53" he="52" />分别为本地产生信号与输入信号之间的载波频率误差和相位误差,R(ε<sub>i</sub>)为C/A码相关函数;锁频环和锁相环分别采用叉积鉴频法和二象限反正切函数鉴相器,载波频率误差和载波相位误差分别为:<maths num="0001"><math><![CDATA[<mrow><mi>&delta;</mi><mi>f</mi><mo>=</mo><mfrac><mrow><mi>a</mi><mi>r</mi><mi>c</mi><mi>t</mi><mi>a</mi><mi>n</mi><mn>2</mn><mrow><mo>(</mo><msub><mi>P</mi><mrow><mi>c</mi><mi>r</mi><mi>o</mi><mi>s</mi><mi>s</mi></mrow></msub><mo>,</mo><msub><mi>P</mi><mrow><mi>d</mi><mi>o</mi><mi>t</mi></mrow></msub><mo>)</mo></mrow></mrow><mrow><mn>2</mn><msub><mi>&pi;T</mi><mrow><mi>c</mi><mi>o</mi><mi>h</mi></mrow></msub></mrow></mfrac></mrow>]]></math><img file="FDA0001142372010000016.GIF" wi="414" he="110" /></maths><img file="FDA0001142372010000017.GIF" wi="278" he="113" />式中,叉积P<sub>cross</sub>与点积P<sub>dot</sub>分别等于: P<sub>cross</sub>=I<sub>P</sub>(k‑1)·I<sub>P</sub>(k)+Q<sub>P</sub>(k‑1)·Q<sub>P</sub>(k) P<sub>dot</sub>=I<sub>P</sub>(k‑1)·Q<sub>P</sub>(k)‑Q<sub>P</sub>(k‑1)·I<sub>P</sub>(k)延迟锁定环路采用非相干超前减滞后功率法,码相位误差为:<maths num="0002"><math><![CDATA[<mrow><msub><mi>&delta;</mi><mrow><mi>c</mi><mi>p</mi></mrow></msub><mo>=</mo><mfrac><mrow><msqrt><mrow><mo>(</mo><msup><msub><mi>I</mi><mi>E</mi></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>Q</mi><mi>E</mi></msub><mn>2</mn></msup><mo>)</mo></mrow></msqrt><mo>-</mo><msqrt><mrow><mo>(</mo><msup><msub><mi>I</mi><mi>L</mi></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>Q</mi><mi>L</mi></msub><mn>2</mn></msup><mo>)</mo></mrow></msqrt></mrow><mrow><msqrt><mrow><mo>(</mo><msup><msub><mi>I</mi><mi>E</mi></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>Q</mi><mi>E</mi></msub><mn>2</mn></msup><mo>)</mo></mrow></msqrt><mo>+</mo><msqrt><mrow><mo>(</mo><msup><msub><mi>I</mi><mi>L</mi></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>Q</mi><mi>L</mi></msub><mn>2</mn></msup><mo>)</mo></mrow></msqrt></mrow></mfrac></mrow>]]></math><img file="FDA0001142372010000018.GIF" wi="566" he="151" /></maths>式中,I<sub>E</sub>、Q<sub>E</sub>、I<sub>L</sub>和Q<sub>L</sub>为超前支路与滞后支路相干积分值;(3)集中式滤波:利用集中式滤波器对系统模型进行建模,选取位置和速度误差作为状态变量,分别记为δX和δV,速度差在该时间段内可以视为常数,由此得到位置和速度的误差模型: δX<sub>k+1</sub>=δX<sub>k</sub>+TδV<sub>k</sub>+η<sub>k+1</sub> δV<sub>k+1</sub>=δV<sub>k</sub>+ν<sub>k+1</sub>式中,T代表了k和k+1时刻之间的时间长度,η<sub>k+1</sub>和ν<sub>k+1</sub>是接收机位置和速度噪声,为零均值白噪声序列;时钟误差模型如下所示: B<sub>k+1</sub>=B<sub>k</sub>+TΔt<sub>k</sub> D<sub>k+1</sub>=D<sub>k</sub>+Δt<sub>k</sub>式中,B<sub>k</sub>为时钟偏差,D<sub>k</sub>为时钟频差,Δt<sub>k</sub>是D<sub>k+1</sub>和D<sub>k</sub>之差,Δt<sub>k</sub>在相对短的时间内可以视为常数,也是一个高斯白噪声序列,记为:Δt<sub>k</sub>=γ<sub>k</sub>,得到系统状态方程如下:<maths num="0003"><math><![CDATA[<mrow><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mi>&delta;x</mi><mrow><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;y</mi><mrow><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;z</mi><mrow><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;v</mi><mrow><mi>x</mi><mo>,</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;v</mi><mrow><mi>y</mi><mo>,</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;v</mi><mrow><mi>z</mi><mo>,</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub></mrow></mtd></mtr><mtr><mtd><msub><mi>B</mi><mrow><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>D</mi><mrow><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub></mtd></mtr></mtable></mfenced><mo>=</mo><msub><mi>F</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mi>&delta;x</mi><mi>k</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;y</mi><mi>k</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;z</mi><mi>k</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;v</mi><mrow><mi>x</mi><mo>,</mo><mi>k</mi></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;v</mi><mrow><mi>y</mi><mo>,</mo><mi>k</mi></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&delta;v</mi><mrow><mi>z</mi><mo>,</mo><mi>k</mi></mrow></msub></mrow></mtd></mtr><mtr><mtd><msub><mi>B</mi><mi>k</mi></msub></mtd></mtr><mtr><mtd><msub><mi>D</mi><mi>k</mi></msub></mtd></mtr></mtable></mfenced><mo>+</mo><msub><mi>W</mi><mi>k</mi></msub></mrow>]]></math><img file="FDA0001142372010000021.GIF" wi="486" he="519" /></maths>式中,状态转移矩阵F<sub>k,k+1</sub>为:<maths num="0004"><math><![CDATA[<mrow><msub><mi>F</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>T</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>T</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>T</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mi>T</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001142372010000022.GIF" wi="635" he="495" /></maths>W<sub>k</sub>为过程噪声,也称为系统噪声,记为:W<sub>k</sub>=[η<sub>x,k</sub>,η<sub>y,k</sub>,η<sub>z,k</sub>,ν<sub>x,k</sub>,ν<sub>y,k</sub>,ν<sub>z,k</sub>,γ<sub>k</sub>]<sup>T</sup>,W<sub>k</sub>为零均值白噪声序列;码鉴相器和载波鉴频器输出的码相位误差、载波频率误差转换伪距差、伪距率差为: δρ=c·δ<sub>cp</sub>/f<sub>code</sub><maths num="0005"><math><![CDATA[<mrow><mi>&delta;</mi><mover><mi>&rho;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mi>c</mi><mo>&CenterDot;</mo><mi>&delta;</mi><mi>f</mi><mo>/</mo><msub><mi>f</mi><mrow><mi>c</mi><mi>a</mi><mi>r</mi><mi>r</mi><mi>y</mi></mrow></msub></mrow>]]></math><img file="FDA0001142372010000023.GIF" wi="286" he="57" /></maths>式中,c为真空中光速,近似等于3×10<sup>8</sup>m/s,f<sub>carry</sub>和f<sub>code</sub>是载波频率和码频率的标称值,其值分别为1575.42MHz和1.023MHz;系统量测方程为:<maths num="0006"><math><![CDATA[<mfenced open = "" close = ""><mtable><mtr><mtd><mrow><msub><mi>Z</mi><mi>k</mi></msub><mo>=</mo><msub><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mi>&delta;&rho;</mi><mrow><mn>1</mn><mo>,</mo><mi>k</mi></mrow></msub></mrow></mtd><mtd><mrow><mi>&delta;</mi><msub><mover><mi>&rho;</mi><mo>&CenterDot;</mo></mover><mrow><mn>1</mn><mo>,</mo><mi>k</mi></mrow></msub></mrow></mtd><mtd><mo>...</mo></mtd><mtd><mrow><msub><mi>&delta;&rho;</mi><mrow><mi>n</mi><mo>,</mo><mi>k</mi></mrow></msub></mrow></mtd><mtd><mrow><mi>&delta;</mi><msub><mover><mi>&rho;</mi><mo>&CenterDot;</mo></mover><mrow><mi>n</mi><mo>,</mo><mi>k</mi></mrow></msub></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mrow><mn>1</mn><mo>&times;</mo><mn>2</mn><mi>n</mi></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>=</mo><msub><mi>HX</mi><mi>k</mi></msub><mo>+</mo><msub><mi>V</mi><mi>k</mi></msub></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0001142372010000031.GIF" wi="710" he="143" /></maths>量测矩阵H由下述方程决定: δρ<sub>i,k</sub>=a<sub>ix,k</sub>δx<sub>k</sub>+a<sub>iy,k</sub>δy<sub>k</sub>+a<sub>iz,k</sub>δz<sub>k</sub>+B<sub>k</sub>+η<sub>i,k</sub><maths num="0007"><math><![CDATA[<mrow><mi>&delta;</mi><msub><mover><mi>&rho;</mi><mo>&CenterDot;</mo></mover><mrow><mi>i</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>=</mo><msub><mi>a</mi><mrow><mi>i</mi><mi>x</mi><mo>,</mo><mi>k</mi></mrow></msub><msub><mi>&delta;v</mi><mrow><mi>x</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>+</mo><msub><mi>a</mi><mrow><mi>i</mi><mi>y</mi><mo>,</mo><mi>k</mi></mrow></msub><msub><mi>&delta;v</mi><mrow><mi>y</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>+</mo><msub><mi>a</mi><mrow><mi>i</mi><mi>z</mi><mo>,</mo><mi>k</mi></mrow></msub><msub><mi>&delta;v</mi><mrow><mi>z</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>+</mo><msub><mi>D</mi><mi>k</mi></msub><mo>+</mo><msub><mi>w</mi><mrow><mi>i</mi><mo>,</mo><mi>k</mi></mrow></msub></mrow>]]></math><img file="FDA0001142372010000032.GIF" wi="813" he="55" /></maths>式中,a<sub>ix,k</sub>,a<sub>iy,k</sub>,a<sub>iz,k</sub>分别为第i通道x,y,z方向上接收机相对卫星第k时刻的视线矢量;(4)载波频率辅助相位矢量跟踪:GPS信号数据码与伪码异或相加而实现扩频,二者的组合码通过双相移位键控对载波进行调制,接收机射频前端输出的中频信号模型为:<img file="FDA0001142372010000033.GIF" wi="742" he="47" />式中,A为信号幅值,D(k)为导航数据,C(k)为C/A码,f<sub>IF</sub>为中频信号频率,f<sub>d</sub>为信号多普勒频率,<img file="FDA0001142372010000034.GIF" wi="46" he="47" />为载波初相位;跟踪环路鉴别器的输出值转换为伪距、伪距率,作为集中式滤波器的量测信息,滤波器输出的速度状态变量误差值经过变换后,得到第i通道上k+1时刻的载波频率修正值和码频率修正值: δf<sub>carry,i,k+1</sub>=(B<sub>k</sub>+δV<sub>k</sub>·a<sub>i,k+1</sub>)f<sub>carry</sub>/c δf<sub>code,i,k+1</sub>=(D<sub>k</sub>+δV<sub>k</sub>·a<sub>i,k+1</sub>)f<sub>code</sub>/c式中,B<sub>k</sub>和D<sub>k</sub>分别代表时钟偏差和时钟频差对应的速度,单位是m/s;二阶FLL辅助三阶PLL输出的<img file="FDA0001142372010000035.GIF" wi="50" he="47" />经过环路滤波器后得到载波相位频率δf<sub>PLL</sub>,与载波频率修正值δf<sub>carry</sub>相加得到载波中频信号真实值f<sub>IF,real</sub>: f<sub>IF,real</sub>=f<sub>IF</sub>+δf<sub>carry</sub>+δf<sub>PLL</sub>将中频信号真实值与捕获阶段得到的多普勒频率f<sub>d</sub>一起反馈到载波压控振荡器,用来调整本地复制的正弦和余弦信号,此时载波压控振荡器输出的本地复制信号为:<img file="FDA0001142372010000036.GIF" wi="518" he="54" /><img file="FDA0001142372010000037.GIF" wi="526" he="55" />载波压控振荡器产生的本地信号与输入信号进行相关运算得到相关器输出六路相干积分值,此时接收机N个通道共享已知信息从而形成闭合回路。
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室
您可能感兴趣的专利