发明名称 一种基于GNSS的单频高精度定位方法
摘要 一种基于GNSS的单频高精度定位方法,其步骤如下:一:准备工作;二:初始历元位置解算;三:构建载波相位历元差分观测模型,求解相对位置变化量;四:进行模糊度信息与位置信息传递;五:进行模糊度信息与方差信息调整;六:构建模糊度与位置信息虚拟观测方程;七:GRAPHIC组合观测方程与虚拟观测方程共同进行最小二乘估计,解算最终定位结果。通过上述步骤,本发明使用载波相位历元差分辅助的GRAPHIC组合运动学定位算法,提高了运动学导航定位精度;采用精密星历能对低轨卫星进行高精度定轨,采用广播星历则能实现实时导航定位;该方法,不受导航定位过程中换星影响,可靠度高,成本低廉,数据处理简单,利于普及与应用。
申请公布号 CN106569241A 申请公布日期 2017.04.19
申请号 CN201610855464.X 申请日期 2016.09.27
申请人 北京航空航天大学 发明人 陈培;张键;孙秀聪;魏华波
分类号 G01S19/44(2010.01)I 主分类号 G01S19/44(2010.01)I
代理机构 北京慧泉知识产权代理有限公司 11232 代理人 王顺荣;唐爱华
主权项 一种基于GNSS的单频高精度定位方法,其特征在于:其步骤如下:步骤一:准备工作首先给出伪距观测方程:P=ρ+c(δt<sub>r</sub>‑δt<sup>s</sup>)+δ<sub>ion</sub>+δ<sub>rel</sub>+ε<sub>p</sub>·········(1)式(1)中,P伪距观测量,以米(m)为单位;ρ为GPS卫星到接收机的真实几何距离;c为真空中的光速;δt<sub>r</sub>为接收机钟差;δt<sup>s</sup>为GPS卫星钟差;δ<sub>ion</sub>为电离层延迟;δ<sub>rel</sub>为相对论效应引起的误差;ε<sub>p</sub>为伪距观测噪声,其符合方差为<img file="FDA0001121452520000011.GIF" wi="54" he="77" />的白噪声;给出载波相位观测方程:<img file="FDA0001121452520000012.GIF" wi="1404" he="79" />式(2)中,Φ为载波相位观测量,以米为单位,<img file="FDA0001121452520000013.GIF" wi="36" he="43" />为载波相位观测量,以周为单位;λ为载波波长;ρ为GPS卫星到接收机的真实几何距离;c为真空中光速;δt<sub>r</sub>为接收机钟差;δt<sup>s</sup>为GPS卫星钟差;N为模糊度;δ<sub>ion</sub>为电离层延迟;δ<sub>rel</sub>为相对论效应引起的误差;<img file="FDA0001121452520000014.GIF" wi="51" he="54" />为载波相位观测噪声,其符合方差为<img file="FDA0001121452520000015.GIF" wi="59" he="70" />的白噪声;为了消除电离层误差,利用伪距观测方程(1)和载波相位观测方程(2)中电离层延迟一阶项,大小相等,符号相反的性质,得到以下消除电离层误差项的GRAPHIC组合观测方程为:<img file="FDA0001121452520000016.GIF" wi="1388" he="118" />上式中δt<sup>s</sup>通过外部星历得到,为已知项;δ<sub>rel</sub>通过建模得到并进行修正,合并已知项的观测方程为:G<sub>c</sub>=ρ+cδt<sub>r</sub>+λN<sub>G</sub>+ε<sub>G</sub>···········(4)其中G<sub>c</sub>为误差修正后的GRAPHIC组合观测量,N<sub>G</sub>为GRAPHIC组合模糊度,表达式如下:<img file="FDA0001121452520000017.GIF" wi="1014" he="111" />下文在不引起歧义的情况下,统一将N<sub>G</sub>简写为N,并称为模糊度;ε<sub>G</sub>为GRAPHIC组合观测噪声,表达式如下:<img file="FDA0001121452520000021.GIF" wi="1062" he="111" />其噪声方差如下:<img file="FDA0001121452520000022.GIF" wi="1262" he="318" />式(7)是GRAPHIC组合观测量的噪声方差,其中D(·)为求方差算子是由伪距噪声方差与载波噪声方差组合得到;伪距的测量噪声能达米级,而载波相位的测量噪声一般为毫米级;由上式能看到GRAPHIC组合的噪声水平处于伪距噪声和载波相位噪声之间,为分米级,使用这种组合进行传统的GRAPHIC组合运动学定轨、定位和导航,结果的误差在分米级,难以满足高精度定位要求;给出载波相位历元差分观测方程:<img file="FDA0001121452520000023.GIF" wi="2091" he="151" />上式(8)中,k表示当前历元,k‑1表示上一历元;其他符号与上文相同;其中,GPS卫星钟差项δt<sup>s</sup>通过外部星历得到;相对论引起的误差项δ<sub>rel</sub>通过建模得到;而当历元时间较短时,相邻历元电离层变化不大,残留项(δ<sub>ion,k</sub>‑δ<sub>ion,k‑1</sub>)忽略;因此得到整理后的载波相位历元差分观测方程:<img file="FDA0001121452520000024.GIF" wi="1438" he="79" />上式中ΔΦ<sub>c</sub>为GPS接收机钟差,相对论效应修正后的载波相位历元差分观测量;其观测噪声方差为:<img file="FDA0001121452520000025.GIF" wi="1294" he="255" />从(10)中看出,载波相位历元差分观测量的噪声水平与载波相位观测量的水平相当;以上,给出了载波相位历元差分测量模型,该模型用于相邻历元的相对位置求解,其结果将传递到下一历元用于构建位置信息虚拟观测量;使用最小二乘估计对当前时刻接收机的位置和钟差信息进行估计;以下给出一种基于GNSS的单频高精度定位方法具体步骤;步骤二:初始历元位置解算由于初始历元是导航定位过程的第一个历元,其没有来自上一历元的先验信息,因此对于初始历元要进行单独处理,初始化它的位置信息与模糊度信息;构建GRAPHIC组合观测量计算值Z;由公式(4),得知GRAPHIC组合观测方程是一个关于状态变量x=(x<sub>r</sub>,y<sub>r</sub>,z<sub>r</sub>,δt<sub>r</sub>,N<sub>1</sub>…N<sub>p</sub>)<sup>T</sup>的非线性方程,其中模糊度下标表示当前历元共观测到的GPS卫星数目;GRAPHIC组合观测量计算值Z,计算如下:<img file="FDA0001121452520000031.GIF" wi="1116" he="70" />其中<img file="FDA0001121452520000032.GIF" wi="38" he="59" />的关系式如下:<img file="FDA0001121452520000033.GIF" wi="1334" he="110" />其中,上式符号“~”表示估计值,<img file="FDA0001121452520000034.GIF" wi="234" he="79" />为接收机的三个位置估计分量,(x<sup>s</sup>,y<sup>s</sup>,z<sup>s</sup>)<sup>T</sup>为GPS卫星的三个位置分量;采用卡尔曼滤波器一步估计状态变量x=(x<sub>r</sub>,y<sub>r</sub>,z<sub>r</sub>,δt<sub>r</sub>,N<sub>1</sub>…N<sub>p</sub>)<sup>T</sup>;因为GRAPHIC组合观测方程是关于状态变量x=(x<sub>r</sub>,y<sub>r</sub>,z<sub>r</sub>,δt<sub>r</sub>,N<sub>1</sub>…N<sub>p</sub>)<sup>T</sup>的非线性方程,因此要对其线性化,线性化过程如下:将GRAPHIC组合观测方程(4),写成如下形式:G<sub>c</sub>=h(x)+ε<sub>G</sub>············(13)在参考点<img file="FDA0001121452520000035.GIF" wi="574" he="93" />处线性化:<img file="FDA0001121452520000036.GIF" wi="1187" he="222" />其中<img file="FDA0001121452520000037.GIF" wi="91" he="63" />便是上面所求的GRAPHIC组合观测量的计算值Z;Δx为状态变量x的实际值与估计值之差;H模型观测量对状态量x的偏导数雅克比矩阵,有:<img file="FDA0001121452520000041.GIF" wi="1071" he="134" />认为每个GRAPHIC组合观测量是相互独立的,观测噪声阵有如下形式:<img file="FDA0001121452520000042.GIF" wi="1142" he="127" />状态变量初始值<img file="FDA0001121452520000043.GIF" wi="551" he="81" />的先验协方差阵P<sup>‑</sup>如下:<img file="FDA0001121452520000044.GIF" wi="1143" he="231" />式(17),是一个分块对角阵;其中<img file="FDA0001121452520000045.GIF" wi="60" he="62" />为位置信息初始先验方差阵;P<sub>t</sub><sup>‑</sup>为接收机钟差初始先验方差阵;<img file="FDA0001121452520000046.GIF" wi="60" he="55" />为模糊度方差阵,取值如下:<img file="FDA0001121452520000047.GIF" wi="1166" he="236" />其中,取值一般为伪距单点定位误差的一半,现取30米;P<sub>t</sub><sup>‑</sup>=0··············(19)式(19),表示初始历元钟差δt<sub>r</sub>的初始带入值是准确的,在后面估计出的各个历元接收机钟差项全都是相对于第一历元时刻的相对钟差,后边不再叙述;<img file="FDA0001121452520000048.GIF" wi="1099" he="75" />式(20),模糊度方差值为一个极大值,这是因为初始历元并没有模糊度信息的先验值,所以如此处理表示方差的初始带入值是完全不可信的;给状态变量的估计值<img file="FDA0001121452520000049.GIF" wi="571" he="95" />赋初值,其中位置状态变量的估计值<img file="FDA00011214525200000410.GIF" wi="234" he="77" />赋值如下:<img file="FDA00011214525200000411.GIF" wi="1230" he="90" />其中,(x<sub>spp</sub>,y<sub>spp</sub>,z<sub>spp</sub>)<sup>T</sup>表示由伪距单点定位得出的接收机位置,单点定位在此不再叙述;钟差状态变量<img file="FDA0001121452520000051.GIF" wi="59" he="63" />的赋值如下:<img file="FDA0001121452520000052.GIF" wi="1005" he="60" />上式与式(19)联立,其意义表示初始历元钟差为0,并且是准确的;以后历元的钟差估计值皆表示相对于初始历元的相对钟差;模糊度状态变量估计值<img file="FDA0001121452520000053.GIF" wi="235" he="91" />的赋值如下:<img file="FDA0001121452520000054.GIF" wi="1182" he="95" />卡尔曼滤波,滤波系数如下:K=P<sup>‑</sup>H<sup>T</sup>(HP<sup>‑</sup>H<sup>T</sup>+R)··········(24)则状态量的估计值更新如下:<img file="FDA0001121452520000055.GIF" wi="1126" he="70" />上式中,上标“+”表示更新后的量,下文出现不再叙述;以式(25)的一步估计值,作为初始历元的最终解算结果;状态变量方差阵P更新如下:P<sup>+</sup>=(1‑KH)P<sup>‑</sup>···········(26);步骤三:构建载波相位历元差分观测模型,求解相对位置变化量由式(9)给出的载波相位历元差分方程,带入k历元与k‑1历元的坐标位置如下:<img file="FDA0001121452520000056.GIF" wi="1445" he="287" />上式中,GPS卫星位置、钟差以及k‑1历元接收机位置皆为已知量;k历元与k‑1历元接收机位置、钟差有如下关系:<img file="FDA0001121452520000057.GIF" wi="1131" he="302" />上式中,Δx,Δy,Δz,Δδt<sub>r</sub>分别表示从k‑1历元到k历元,接收机位置变换量与钟差变化量;将式(28)带入式(27),则ΔΦ<sub>c</sub>成为一个关于状态变量y=(Δx,Δy,Δz,cΔδt<sub>r</sub>)<sup>T</sup>的非线性函数,记为下式:ΔΦ<sub>c</sub>=f(Δx,Δy,Δz,Δδt<sub>r</sub>)··········(29)给出状态变量估计值<img file="FDA0001121452520000061.GIF" wi="456" he="77" />的初始值如下:<img file="FDA0001121452520000062.GIF" wi="1301" he="79" />计算载波相位历元差分观测量的计算值ΔL:<img file="FDA0001121452520000063.GIF" wi="1565" he="285" />非线性方程(29)在带入估计值<img file="FDA0001121452520000064.GIF" wi="473" he="86" />泰勒展开,取一阶项,求H阵:<img file="FDA0001121452520000065.GIF" wi="1218" he="238" />上式,各个量含义与(14)中各量含义类似,不再叙述;由式(10),给出载波相位历元差分观测量的噪声阵R,如下:<img file="FDA0001121452520000066.GIF" wi="1062" he="74" />由最小二乘估计:Δy=(H<sup>T</sup>R<sup>‑1</sup>H)<sup>‑1</sup>(H<sup>T</sup>R<sup>‑1</sup>(ΔΦ<sub>c</sub>‑ΔL))·······(34)更新状态变量的估计值:<img file="FDA0001121452520000067.GIF" wi="1051" he="62" />将<img file="FDA0001121452520000068.GIF" wi="56" he="61" />作为新的初值,带入式(30),计算式(31)~(35);重复以上过程直到满足下式:||Δy||<10<sup>‑3</sup>m············(36)或超出最大迭代次数时终止;状态变量y的方差阵P由下式给出:<img file="FDA0001121452520000071.GIF" wi="1334" he="143" />上式中P<sub>dR</sub>为位置变化量信息方差阵;P<sub>tdR</sub>,P<sub>dRt</sub>为位置变化量与钟差变化量协方差阵;P<sub>t</sub>为钟差变化量方差阵;I为单位阵;Q为电离层控制因子,用来控制不同历元间电离层残差影响;步骤四:模糊度信息与位置信息传递k‑1历元的位置信息与模糊度信息已知,由步骤三也已解算出k‑1历元到k历元的位置变化量;此步骤便是要把位置信息与模糊度信息传递到k历元;k历元的位置信息传递如下:x<sub>k0</sub>=x<sub>k‑1</sub>+Δxy<sub>k0</sub>=y<sub>k‑1</sub>+Δy············(38)z<sub>k0</sub>=z<sub>k‑1</sub>+ΔzP<sub>R0</sub>=P<sub>Rk‑1</sub>+P<sub>dR</sub>············(39)上式中下标“0”,表示初值;K历元的模糊度信息传递如下:<img file="FDA0001121452520000072.GIF" wi="1110" he="235" />方差信息传递如下:<img file="FDA0001121452520000073.GIF" wi="1208" he="255" />上式中下标“0”,表示初值;因为不对钟差进行传递,所以,对式(41)中钟差的方差<img file="FDA0001121452520000074.GIF" wi="73" he="63" />设为10<sup>6</sup>,对<img file="dest_path_BDA0001121452530000101.GIF" wi="412" he="71" />均设为0;步骤五:模糊度信息与方差信息调整若从k‑1历元到k历元若发生换星,则进行该步骤;否则跳过步骤五,执行步骤六;从k‑1历元到k历元若发生换星,位置信息不发生变化,模糊度改变;要对步骤四中的式(40)与式(41)中和模糊度有关的项进行修改;对式(40)的调整,保留k‑1历元与k历元共同观测的GPS卫星模糊度,去掉只在k‑1历元观测到的卫星模糊度,增加k历元新增的GPS卫星模糊度,将其模糊度设为0,得到模糊度信息为(N<sub>0</sub>)<sub>q×1</sub>,‘q’表示k历元所观测到的总的GPS卫星个数;对式(41)的调整,保留k‑1历元与k历元共同观测的GPS卫星模糊度方差与协方差,去掉只在k‑1历元观测到的卫星的方差与协方差,增加k历元新增的GPS卫星方差与协方差,方差值取10<sup>6</sup>,协方差取0;得到的模糊度方差阵为<img file="FDA0001121452520000081.GIF" wi="115" he="69" />步骤六:构建模糊度与位置信息虚拟观测方程使用步骤四传递,步骤五调整过的位置信息与模糊度信息作为虚拟测量的测量值,如下:<img file="FDA0001121452520000082.GIF" wi="1150" he="334" />上式中x,y,z为接收机三个位置坐标,标“v”,表示虚拟测量;q表示k历元所观测到的GPS卫星总数;虚拟观测方程如下:<img file="FDA0001121452520000083.GIF" wi="1102" he="294" />上式中,(N<sub>k</sub>)<sub>q×1</sub>为k历元代估模糊度向量;观测方程矩阵形式如下:<img file="FDA0001121452520000084.GIF" wi="1166" he="318" />上式中H<sub>v</sub>表达式如下:H<sub>v</sub>=I<sub>(3+q)×(3+q)</sub>············(45)虚拟观测量的噪声阵由下式给出:<img file="FDA0001121452520000091.GIF" wi="1102" he="160" />若发生了换星,则式(46)中<img file="FDA0001121452520000092.GIF" wi="65" he="63" />由步骤五得到;若未发生换星,则<img file="FDA0001121452520000093.GIF" wi="228" he="63" />步骤七:GRAPHIC组合观测方程与虚拟观测方程共同进行最小二乘估计,解算最终定位结果观测方程如下:<img file="FDA0001121452520000094.GIF" wi="1222" he="455" />上式中,H<sub>G</sub>的计算步骤与步骤二中GRAPHIC组合H阵计算相同;H<sub>v</sub>由步骤六中给出;υ为噪声向量;观测量的噪声阵,由下式给出:<img file="FDA0001121452520000095.GIF" wi="1078" he="149" />上式中R<sub>G</sub>由(16)给出;最小二乘估计:Δx=(H<sup>T</sup>R<sup>‑1</sup>H)<sup>‑1</sup>R<sup>‑1</sup>(z‑Z)·········(49)上式中,z为观测量的测量值,如下:<img file="FDA0001121452520000096.GIF" wi="1022" he="143" />Z为观测量的计算值,如下:<img file="FDA0001121452520000097.GIF" wi="1022" he="159" />上式中G'由式(11)计算,V'为下式:<img file="FDA0001121452520000101.GIF" wi="1052" he="454" />更新状态变量x:<img file="FDA0001121452520000102.GIF" wi="1046" he="55" />将更新后的状态量估计值<img file="FDA0001121452520000103.GIF" wi="47" he="47" />作为新的初值带入式(47)计算H阵;重复(47)~(53),直到满足下式:<img file="FDA0001121452520000104.GIF" wi="1094" he="234" />及迭代次数超过最大迭代次数时停止;得到状态量的最小二乘估计,其k历元的最终定位结果为(x<sub>k</sub> y<sub>k</sub> z<sub>k</sub>)<sup>T</sup>,计算状态变量的协方差阵:<img file="FDA0001121452520000105.GIF" wi="1308" he="255" />回到步骤三,重复以后步骤,进行下一个历元的相对定位,信息传递以及运动学定位解算;通过上述步骤,提出了一种基于GNSS的单频高精度定位方法;该方法仅采用单个接收机的单频GPS数据,使用载波相位历元差分辅助的GRAPHIC组合运动学定位算法,提高了运动学导航定位精度;采用精密星历能对低轨卫星进行高精度定轨,采用广播星历则能实现实时导航定位;该方法,不受导航定位过程中换星影响,可靠度高,并且该方法的实现只需一个单频GPS接收机,具有成本低廉的优势,数据处理简单,利于普及与应用。
地址 100191 北京市海淀区学院路37号