主权项 |
一种基于卫星导航和Kalman滤波的高精度授时方法,采用以下步骤:步骤1:卫星接收模块接受卫星位置信息与伪距信息,根据卫星位置信息与伪距信息,采用最小二乘法解算卫星接收模块的钟差信息δt<sub>g</sub>;步骤2:对卫星接收模块的钟差信息进行Kalman滤波,对于第k次滤波具体步骤如下:步骤2.1:Kalman滤波的时间更新过程:对状态向量X<sub>k‑1</sub>=[δt<sub>k‑1</sub> δf<sub>k‑1</sub>]进行估计,得到状态估计值<img file="FDA0000541362580000011.GIF" wi="93" he="97" />其中δt<sub>k‑1</sub>为秒信号发生器的钟差信息、δf<sub>k‑1</sub>为秒信号发生器频差信息,估计式为<img file="FDA0000541362580000012.GIF" wi="291" he="97" /><maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>A</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000541362580000013.GIF" wi="258" he="166" /></maths>当k=1时,X<sub>k‑1</sub>取值为[0 0];根据式<img file="FDA0000541362580000014.GIF" wi="350" he="84" />得到协方差阵P<sub>k‑1</sub>的预测矩阵<img file="FDA0000541362580000015.GIF" wi="80" he="97" />其中Q为过程噪声协方差阵;步骤2.2:Kalman滤波的量测更新过程:根据式<img file="FDA0000541362580000016.GIF" wi="497" he="83" />得到增益矩阵K<sub>k</sub>,其中C=[1 0],R为量测噪声协方差阵;根据式<img file="FDA0000541362580000017.GIF" wi="576" he="89" />得到滤波后的状态向量矩阵X<sub>k</sub>,根据式<img file="FDA0000541362580000018.GIF" wi="397" he="83" />得到更新后的协方差矩阵P<sub>k</sub>,其中I为二维单位矩阵;步骤3:利用每一次滤波得到的秒信号发生器的钟差信息乘以晶振的频率f<sub>0</sub>得到秒信号发生器的相位控制字N<sub>p</sub>的调整量ΔN<sub>p</sub>,用N<sub>p</sub>减去调整量ΔN<sub>p</sub>得到精确的秒信号发生器的相位控制字;利用每一次滤波得到的秒信号发生器的频差信息乘以晶振的频率f<sub>0</sub>得到秒信号发生器的频率控制字N<sub>f</sub>的调整量ΔN<sub>f</sub>,用N<sub>f</sub>减去调整量ΔN<sub>f</sub>得到精确的秒信号发生器的频率控制字;根据得到的精确的秒信号发生器的相位控制字和频率控制字,实现高精度授时。 |