CN105068102A - 一种基于dsp+fpga的超紧组合导航方法 - Google Patents
一种基于dsp+fpga的超紧组合导航方法 Download PDFInfo
- Publication number
- CN105068102A CN105068102A CN201510490859.XA CN201510490859A CN105068102A CN 105068102 A CN105068102 A CN 105068102A CN 201510490859 A CN201510490859 A CN 201510490859A CN 105068102 A CN105068102 A CN 105068102A
- Authority
- CN
- China
- Prior art keywords
- carrier
- error
- satellite
- centerdot
- rho
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种基于DSP+FPGA的超紧组合导航方法。步骤如下:组合导航***初始对准;GNSS接收机初始化;SINS导航解算,将惯性辅助信息发送给GNSS接收机;导航星的伪距测量误差补偿;载体相对每颗导航星的伪距、伪距率解算;构建***状态方程和量测方程;进行全维滤波解算,并根据滤波结果对***进行校正;利用卫星的星历信息解算出的卫星位置和速度以及组合导航输出的载***置和速度,计算由于载体和卫星之间的相对运动所造成的载波多普勒频移并对跟踪环路进行反馈校正,实现惯性信息辅助GNSS跟踪环路。本发明方法可实现基于惯性/卫星的伪距、伪距率组合导航,提高了导航精度和对复杂环境的适应性,应用前景广阔。
Description
一、技术领域
本发明涉及组合导航技术领域,特别是一种基于DSP+FPGA的超紧组合导航方法。
二、背景技术
卫星/惯性组合导航***结合卫星导航、惯性导航的优点,具有定位精度高,稳定性强等特点,因此在军事领域及民用领域都被广泛应用。组合导航的模式有很多种,主要分为松组合、紧组合、深组合三类。基于位置和速度的松组合***虽然具有结构简单,计算量小等优点,但在GNSS接收机收星数少于4颗无法定位时,***无法正常组合,导航精度随之下降。基于伪距、伪距率的紧组合导航***虽然可以在收星数少于四颗的情况下进行组合,但由于GNSS接收机收星数的减少,降低了观测变量的维数,导致导航精度变差。此外,无论是松组合导航***还是紧组合导航***,在高动态环境下都面临GNSS接收机性能下降甚至失效的问题。
三、发明内容
本发明的目的是提供一种高精度的基于DSP+FPGA的超紧组合导航方法,能够有效抑制导航精度的发散。
实现本发明目的的技术解决方案为:一种基于DSP+FPGA的超紧组合导航方法,包括以下步骤:
步骤1,***上电后完成硬件初始化工作,包括串口初始化、总线初始化、定时器初始化;
步骤2,SINS***初始对准,即对SINS***的初始速度、位置、姿态进行初始对准;
步骤3,GNSS接收机初始化,为相关器各通道分配C/A码,设置搜捕卫星,开始可见卫星的捕获;
步骤4,导航计算机接收SINS数据,采用四元数法进行导航解算,确定出载体的速度、位置、姿态信息,并装订成惯性辅助信息发送给GNSS接收机;
步骤5,导航处理器根据TIC锁存数据确定卫星的伪距和伪距率,并对导航星的伪距测量误差进行补偿;同时解调出导航星发送的导航电文,并根据导航电文解算导航卫星的位置、速度信息;
步骤6,GNSS接收机将步骤3中已捕获卫星的通道转为跟踪状态,利用步骤4提供的载***置、速度信息,以及步骤5提供的卫星位置和速度,实时计算由于卫星和载体之间相对运动造成的多普勒频移及变化率,并利用所得结果对载波跟踪环路进行反馈校正;
步骤7,根据步骤5提供的导航星速度、位置信息,以及步骤4提供的载体速度、位置信息,确定载体相对每颗导航星的伪距、伪距率信息;
步骤8,构建***状态方程和量测方程:状态变量包括SINS***误差、GNSS***误差和惯性器件误差,SINS***误差包括姿态误差、速度误差和位置误差;GNSS***误差包括钟差和钟漂;惯性器件误差包括随机误差;
步骤9,根据步骤8构建的***状态方程和量测方程进行全维滤波解算,将所得滤波结果对***进行校正。
本发明与现有技术相比,其显著优点是:(1)由于采用GNSS输出的原始伪距、伪距率信息,从而消除了量测输出的时间相关性,并且在收星数少于四颗的情况下仍然可以实现组合导航;(2)采用全维滤波方式组合,利用全部观测信息,从而实现最佳精度导航;(3)采用惯性信息辅助GNSS接收机跟踪环路,实现GNSS与INS之间的双向辅助;(4)对于惯性高动态飞行过程中加加速度所造成的多普勒频移残差问题,根据载体飞行过程中的受力情况对载体运动状态构建相应数学模型,实时计算观测时刻各通道多普勒频移及其变化率,提高GNSS接收机的动态适应性。
四、附图说明
图1是本发明基于DSP+FPGA的超紧组合导航方法的流程图。
图2是本发明基于DSP+FPGA的超紧组合导航方法的***硬件结构图。
图3是本发明基于DSP+FPGA的超紧组合导航方法的惯性辅助载波环数学模型图。
图4是本发明基于DSP+FPGA的超紧组合导航方法的***维数变化示意图。
图5是本发明基于DSP+FPGA的超紧组合导航方法的***原理结构图。
五、具体实施方式
下面结合附图及具体实施例对本发明作进一步详细说明。
结合图1,本发明基于DSP+FPGA的超紧组合导航方法,步骤如下:
步骤1,***上电后完成硬件初始化工作,包括串口初始化、总线初始化、定时器初始化;
步骤2,SINS***初始对准,即对SINS***的初始速度、位置、姿态进行初始对准,具体如下:
SINS初始对准,初始化速度、位置。采用动基座传递对准技术,实现姿态、位置、速度的快速,精确初始化。
步骤3,GNSS接收机初始化,为相关器各通道分配C/A码,设置搜捕卫星,开始可见卫星的捕获,具体如下:
(3.1)GNSS接收机初始化,通过初始对准提供的载***置,结合卫星的轨道分布预测搜捕卫星,并为相关器各通道分配相关卫星C/A码,设置搜捕卫星;二维搜索中,为了提高捕获速度,由一次搜索1/2码片增加为一次搜索3个码片,即由即时相关峰一路相关增加为超前相关峰、即时相关峰、滞后相关峰、延迟超前相关峰、延迟即时相关峰、延迟滞后相关峰等六路相关峰。采用六路相关提高了二维搜索中码片搜索的速度,在扫频范围同为±10KHZ的情况下,捕获速度将提高为原来一路相关方法的6倍。
(3.2)根据Flash中保存的卫星历书信息计算各通道正在搜捕卫星的位置和速度,结合步骤2中初始对准提供的载***置、速度信息计算卫星的多普勒频移,从而缩小搜索范围,加快捕获速度。
步骤4,导航计算机接收SINS数据,采用四元数法进行导航解算,确定出载体的速度、位置、姿态信息,并装订成惯性辅助信息发送给GNSS接收机,硬件图如图2所示,具体如下:
(4.1)由FPGA接收惯导数据并将数据存入FIFO中,当接收到完整的一包数据后触发接收中断,由导航计算机读取IMU数据;
(4.2)导航计算机进行SINS导航解算,采用四元数算法计算出载体的速度、位置、姿态信息,具体如下:
(4.2.1)捷联惯导***姿态更新解算,采用传统四元数算法。
四元数微分方程表达式为:
其中,Ω为载体坐标系相对导航系下的角速率构成的反对称矩阵,Q为四元数。
通过龙格-库塔求解四元数微分方程,然后由四元数求得姿态矩阵,由姿态矩阵求解三个姿态角;
(4.2.2)捷联惯导***速度解算。
速度微分方程如下:
其中,是由四元数求得的姿态矩阵,为地球自转角速率在n系的投影,为n系相对e系的旋转角速率,Vn为n系下载体速度矢量,fb为加速度计测得的在载体坐标系下的输出值,gn为当地重力加速度矢量;
(4.2.3)捷联惯导***位置解算。
位置微分方程如下:
上式中,L,λ和h分别是载体的纬度、经度和高度;VE、VN和VU分别是载体在东、北、天方向上的速度分量;RM、RN分别是地球的子午圈半径和卯酉圈半径;
(4.3)将SINS解算得到的地理坐标系下的位置、速度、加速度等信息转换到ECEF坐标系下,装订成惯性辅助信息后写入FIFO中,由FPGA串口发送给GNSS接收机。
步骤5,导航处理器根据TIC锁存数据确定卫星的伪距和伪距率,并对导航星的伪距测量误差进行补偿;同时解调出导航星发送的导航电文,并根据导航电文解算导航卫星的位置、速度信息,具体如下:
(5.1)根据TIC锁存数据计算卫星的伪距和伪距率:具体测量时,由于接收机时间可以预知或假定,因此只要知道信号的发射时间就可以求得伪距。在GPS的导航电文中,根据Z计数确定每一帧开始时对应的GPS时间;在帧同步后,对数据位、码周期数、半个码片滑动整数及小数部分分别进行计数得到测量时刻信号的发射时间,用发射时间减去接收时间就得到传播延时,从而实现了伪距的测量。
(5.2)对导航星的伪距测量误差进行补偿,即对伪距补偿地球自转和对流层影响,地球自转和对流层影响如下:
地球自转影响:
其中,Px、Py分别为卫星ECEF坐标系下x、y轴位置,px、py分别为载体ECEF坐标系下x、y轴位置,we为地球自转角速率,light_speed为光速;
对流层效应影响:
其中,θ为卫星的高度角。
校正后,得到导航卫星伪距ρGj、伪距率信息,导航卫星的伪距ρGj公式为:
ρGj=rj-δtu-vρj
其中,rj为载体到第j颗卫星的真实无差距离,δtu为钟差引起的距离误差,vρj为伪距测量白噪声。
导航卫星的伪距率公式如下:
其中,δtru为钟漂引起的距离率误差,为伪距率测量白噪声,为载体到第j颗卫星Sj的真实无差距离变化率;
(5.3)导航电文是GPS信号中调制的数据,GPS接收机接收到卫星信号后,进行载波解调和伪码解扩,得到50bps的数据码,按照导航电文的格式,即可将数据码编译成导航电文,卫星位置和速度的计算公式参考ICD-GPS-200C。
步骤6,GNSS接收机将步骤3中已捕获卫星的通道转为跟踪状态,利用步骤4提供的载***置、速度信息,以及步骤5提供的卫星位置和速度,实时计算由于卫星和载体之间相对运动造成的多普勒频移及变化率,并利用所得结果对载波跟踪环路进行反馈校正,载波跟踪环路的数学模型如图3所示:
(6.1)计算多普勒频移,设第i通道所跟踪的卫星在ECEF中的位置为步骤(4.2.3)中递推得到的载***置P′u=(Xu,Yu,Zu),则相对位置的单位视线矢量Ri为:
式中,(Xu,Yu,Zu)为载体的真实无差位置,为由卫星星历确定的第j颗卫星在ECEF坐标系中的位置;
观测时刻GNSS接收机第i通道所跟踪的卫星信号其载波多普勒频移及变化率为:
式中,是载波多普勒频移,是载波多普勒频移变化率,c是光速,fL1是信号载波频率,VS、αS分别是观测时刻载体的三维速度、加速度;V′u、α′u分别是观测时刻接收机i通道卫星的三维速度、加速度;
(6.2)对辅助信息进行数据拟合,接收机载波环是一个由鉴相器、环路滤波器和数控振荡器构成的负反馈闭环控制***。环路滤波器若选择二阶滤波器,则传递函数F(s)可表达成:
式中,F(s)为滤波器传递函数,τ1和τ2是滤波器系数,s为拉普拉斯变换算子;
常规载波跟踪环的闭环传递函数H(s)和误差传递函数He(s)分别为:
式中,wn表示特征频率且K表示环路增益,ξ表示阻尼系数且θr(s)、θe(s)分别是滤波器输入相位、输出相位,δθ(s)为相位误差,且δθ(s)=θe(s)-θγ(s);
由此可知加入惯性辅助后的闭环传递函数和误差传递函数分别为
其中,k表示刻度系数误差,τ表示滞后时间常数;
当载体在视线矢量上作匀加加速度运动时,根据拉式变换有:
式中,θ0为鉴相器输出的相位误差,ν、A和J分别是载体与卫星之间的相对速度、加速度和加加速度在视线矢量上的投影;
根据终值定理,得到环路的稳态误差为
根据以上公式可知:二阶锁相环不能跟踪载体的加加速度。而当载体作匀加速运动时,有惯性辅助时的稳态误差为无惯性辅助时的稳态误差为若刻度误差取k=0.001,那么稳态误差将减小1000倍。由此可见,惯性辅助载波环路有效增大了环路的等效带宽,且辅助效果由惯性辅助信息的精度决定。
由于分布式组合导航***串口传输速率的限制,惯性辅助信息更新率相对跟踪环路更新率较低,所以在惯性信息更新的间隔中,载体机动引起的加加速度会造成相位误差。
当辅助间隔取40ms,加加速度取20g/s时,可以算得加速度残留达到
若跟踪环路为2阶,滤波带宽取20Hz,阻尼系数取0.7071,那么此时动态应力造成的相位误差为
从上我们可以看出:当载体作加加速度运动时,较长的辅助间隔内会累积较大的相位误差,可能导致环路失锁,因此需要对辅助信息进行插值或拟合。加加速度反映了载体的受力变化情况。其中发动机的工作由火控***控制,飞行阻力与大气稀薄程度和速度有关。通过对发动机推力和飞行阻力变化的合理建模,可以在一定范围内对加加速度进行拟合,减小其带来的不利影响。剩下的误差则由环路滤波器消除。
步骤7,根据步骤5提供的导航星速度、位置信息,以及步骤4提供的载体速度、位置信息,确定载体相对每颗导航星的伪距、伪距率信息,流程如图4所示。具体解算流程为:
根据导航星的速度、位置信息,以及SINS的速度、位置信息,计算出载体相对每颗导航星的伪距、伪距率信息,其中载体到第j颗卫星的伪距ρIj为:
ρIj=rj+ej1δx+ej2δy+ej3δz
其中,δx、δy、δz分别为载体在地球坐标系中的位置误差在x轴、y轴、z轴分量,rj为载体到第j颗卫星的真实无差距离,ej1、ej2、ej3分别为载体与第j颗卫星x轴、y轴、z轴的方向余弦;
载体到第j颗卫星的伪距率为:
其中,分别为载体在地球坐标系中的速度误差在x轴、y轴、z轴分量,为载体到第j颗卫星的真实无差距离变化率。
步骤8,构建***状态方程和量测方程:状态变量包括SINS***误差、GNSS***误差和惯性器件误差,SINS***误差包括姿态误差、速度误差和位置误差;GNSS***误差包括钟差和钟漂;惯性器件误差包括随机误差,具体为:
(8.1)组合导航***通过卡尔曼滤波器对***中的误差量进行估计,并将估计值作为校正量反馈到***中,实现组合校正。为了对误差量进行补偿,需要建立相应的数学模型,包括SINS***误差、GNSS***误差和惯性器件误差三部分。SINS***误差主要包括姿态误差、速度误差和位置误差;GNSS***误差包括钟差和钟漂;惯性器件误差为简单起见,只考虑随机误差。由此建立的超紧组合导航***状态方程如下:
上式中,φE、φN、φU分别为东、北、天方向平台失准角,δVE、δVN、δVU分别为载体东、北、天方向速度误差,δL、δλ、δh分别为载体纬度、经度、高度误差,δtu为与时钟等效的距离误差,δtru为与时钟频率等效的距离率误差,RM为椭球子午圈上各点的曲率半径,RN为卯酉圈上各点的曲率半径,wie为地球转动角速率,fE、fN、fU分别是惯导***的比力在导航系下东、北、天方向上的分量,εE、εN、εU分别为地理坐标系内陀螺的漂移在东、北、天方向上的投影,▽E、▽N、▽U分别为地理坐标系内加速计的漂移在东、北、天方向上的投影,βtru为反相关时间;L和h分别是载体的纬度和高度;VE、VN和VU分别是载体在东、北、天方向上的速度分量;
(8.2)以导航***的姿态误差、速度误差、位置误差及伪距、伪距率误差为状态变量,建立惯性/卫星组合导航***的状态方程:
其中,X为***状态矢量,表示***状态矢量的导数,F为***状态转移矩阵,G为***噪声驱动矩阵,W为***噪声矢量,具体如下:
***状态矢量:
上式中共17个状态变量,φE,φN,φU分别为东、北、天方向姿态误差角;δVE,δVN,δVU分别为东、北、天方向速度误差;δL,δλ,δh分别为纬度误差、经度误差、高度误差;εx,εy,εz分别为载体系下陀螺三个轴向的随机漂移;▽x,▽y,▽z分别为载体系下加速度计三个轴向的偏差;δtu和δtru分别为钟差引起的等效距离误差和钟漂引起的距离率误差;
状态转移矩阵:
其中Fins由步骤(8.1)中误差方程构成,为载体坐标系到导航坐标系的姿态转换矩阵,
***噪声驱动矩阵:
***噪声矢量:
假设***噪声为零均值高斯白噪声,协方差阵为E(WWT)=Q,Q为***过程噪声方差阵;wgx、wgy、wgz分别为陀螺仪x轴、y轴、z轴方向的随机白噪声,wax、way、waz分别为加速度计x轴、y轴、z轴方向的随机白噪声,wtu、wtru分别为伪距随机和伪距率随机白噪声;
(8.3)计算每个通道对应的每颗导航星的高度角,方位角信息,方法如下:首先由将ECEF坐标系中载体到相应导航星的观测向量转换到以载***置为原点的地理坐标系中,计算公式如下:
G=S*E
其中
其中,E=[ΔxΔyΔz]T为ECEF坐标系内载体到该卫星的观测向量,G=[ΔeΔnΔu]T为向量E在以载***置为原点的地理坐标系三个方向上的投影;
其中,[XYZ]T为卫星在ECEF坐标系中的位置,[xyz]T为载体在ECEF坐标系中位置,L,λ分别为载体的纬度、经度;
最终方位角和高度角由以下计算公式得出:
α=arctan(Δe/Δn)
上式中,θ,α分别为高度角、方位角,其中θ∈(0,π/2),α∈(0,2π);
(8.4)根据步骤(8.3)计算得到的高度角、方位角确定可见卫星。根据可见卫星个数,***动态调整观测方程及组合滤波器相关矩阵的维数;
(8.5)构建***量测方程
Z(t)=H(t)X(t)+V(t)
其中Z(t)为***观测矢量,H(t)为***观测矩阵,V(t)为***观测噪声阵,X为***状态矢量。量测方程的维数及组合滤波器的维数根据可见星数量变化,结合图4,若可见星数量为n,则观测向量Z的维数为2n×1;***观测矩阵H维数为2n×17;***观测噪声方差R阵维数为2n×2n;卡尔曼滤波增益阵维数为17×2n;
伪距观测方程如下:
式中,为伪距观测矢量,为伪距观测矩阵,为伪距观测噪声阵,为伪距状态矢量,分别为:
δρj=ρIj-ρGj=ej1δx+ej2δy+ej3δz+δtu+νρj
其中,为各通道伪距测量白噪声,ρIj、ρGj分别为步骤7中所求载体相对每颗卫星伪距和步骤5中GNSS接收机输出的卫星伪距,展开如下:
伪距率观测方程如下所示:
式中,为伪距率观测矢量,为伪距率观测矩阵,为伪距率观测噪声阵,为伪距率状态矢量,分别为:
其中,为各通道伪距率测量白噪声分别为步骤7中所求载体相对每颗卫星伪距率和步骤5中GNSS接收机输出的卫星伪距率,展开如下:
综合伪距、伪距率差观测方程,得到***观测方程如下:
上式中,为***观测矢量,为***观测矩阵,为***观测矩阵,为状态向量。
步骤9,结合图5,根据步骤8构建的***状态方程和量测方程进行全维滤波解算,将所得滤波结果对***进行校正,具体如下:
当可见卫星数目大于四颗时***将面临两种选择:通过选星算法选择四颗卫星作为导航星;采用全维滤波方式使用全部可见星的观测量作为滤波器输入,全维滤波方式中组合导航***工作模式的切换如图5所示。全维滤波算法与选星算法的比较如下:
选星算法可以在不增加滤波器***维数的情况下提高导航精度。缺点是其他卫星提供的有效信息会被浪费,从而降低***的可观测性。全维滤波使用所有可见卫星进行组合滤波,增强了***的观测性;但观测维数的增加导致滤波时间加长。
对于“DSP+FPGA”平台,数据的接收和发送均由FPGA完成,DSP与FPGA之间通过EMIF连接,传输耗时可忽略不计。不妨设卡尔曼滤波器全维滤波时间为tk,数据的同步时间为tc,惯导解算时间为tins,其他数据运算时间为tother。若惯导的解算周期为T,那么需满足下列公式成立:
T≥tc+tk+tins+tother
当处理器选择TI公司的TMS320C6713时,测得各项时间如下表所示:
表一:时间测试
时间项 | tc | tins | tother |
耗时 | 0.5ms | 0.38ms | 0.1ms |
表二:不同收星数下的滤波时间
收星数 | 4 | 6 | 8 | 12 |
tk | 5.03ms | 5.5ms | 6.1ms | 8.9ms |
若惯导的解算周期设为10ms,从上表可以看到,即使是进行全维滤波,总时间仍小于解算周期,说明采用全维滤波完全可行。
本发明利用惯性信息(三维位置、速度)结合本地时间、卫星星历等信息,实时计算可视卫星的相对多普勒频移及变化率辅助GNSS接收机进行信号跟踪。针对惯性辅助间隔内的多普勒频移误差积累问题,采用曲线拟合估计加加速度的方法对惯性辅助信息进行数据递推以消除加速度残差。将GNSS接收机输出的伪距、伪距率与计算得到的伪距、伪距率作差,并将差值作为观测量进行全维滤波,根据滤波结果校正当前***。本发明方法可实现基于惯性/卫星的伪距、伪距率组合导航,提高了导航精度和对复杂环境的适应性,应用前景广阔。
Claims (9)
1.一种基于DSP+FPGA的超紧组合导航方法,其特征在于,包括以下步骤:
步骤1,***上电后完成硬件初始化工作,包括串口初始化、总线初始化、定时器初始化;
步骤2,SINS***初始对准,即对SINS***的初始速度、位置、姿态进行初始对准;
步骤3,GNSS接收机初始化,为相关器各通道分配C/A码,设置搜捕卫星,开始可见卫星的捕获;
步骤4,导航计算机接收SINS数据,采用四元数法进行导航解算,确定出载体的速度、位置、姿态信息,并装订成惯性辅助信息发送给GNSS接收机;
步骤5,导航处理器根据TIC锁存数据确定卫星的伪距和伪距率,并对导航星的伪距测量误差进行补偿;同时解调出导航星发送的导航电文,并根据导航电文解算导航卫星的位置、速度信息;
步骤6,GNSS接收机将步骤3中已捕获卫星的通道转为跟踪状态,利用步骤4提供的载***置、速度信息,以及步骤5提供的卫星位置和速度,实时计算由于卫星和载体之间相对运动造成的多普勒频移及变化率,并利用所得结果对载波跟踪环路进行反馈校正;
步骤7,根据步骤5提供的导航星速度、位置信息,以及步骤4提供的载体速度、位置信息,确定载体相对每颗导航星的伪距、伪距率信息;
步骤8,构建***状态方程和量测方程:状态变量包括SINS***误差、GNSS***误差和惯性器件误差,SINS***误差包括姿态误差、速度误差和位置误差;GNSS***误差包括钟差和钟漂;惯性器件误差包括随机误差;
步骤9,根据步骤8构建的***状态方程和量测方程进行全维滤波解算,将所得滤波结果对***进行校正。
2.根据权利要求1所述的基于DSP+FPGA的超紧组合导航方法,其特征在于,步骤2中所述SINS***初始对准,即采用动基座传递对准方式,实现姿态、位置、速度的初始化。
3.根据权利要求1所述的基于DSP+FPGA的超紧组合导航方法,其特征在于,步骤3中所述GNSS接收机初始化,为相关器各通道分配C/A码,设置搜捕卫星,开始可见卫星的捕获,具体如下:
(3.1)GNSS接收机初始化,通过初始对准提供的载***置,结合卫星的轨道分布预测搜捕卫星,并为相关器各通道分配相关卫星C/A码,设置搜捕卫星;
(3.2)根据Flash中保存的卫星历书信息确定各通道正在搜捕卫星的位置和速度,结合步骤2中初始对准提供的载***置、速度信息确定卫星的多普勒频移。
4.根据权利要求1所述的基于DSP+FPGA的超紧组合导航方法,其特征在于,步骤4中所述导航计算机接收SINS数据,采用四元数法进行导航解算,确定出载体的速度、位置、姿态信息,具体如下:
(4.1)由FPGA接收惯导数据并将数据存入FIFO中,当接收到完整的一包数据后触发接收中断,由导航计算机读取IMU数据;
(4.2)导航计算机进行SINS导航解算,采用四元数算法计算出载体的速度、位置、姿态信息,具体如下:
(4.2.1)捷联惯导***姿态更新解算
四元数微分方程表达式为:
其中,Ω为载体坐标系相对导航系下的角速率构成的反对称矩阵,Q为四元数;
通过龙格-库塔求解四元数微分方程,然后由四元数求得姿态矩阵,由姿态矩阵求解三个姿态角;
(4.2.2)捷联惯导***速度解算
速度微分方程如下:
其中,是由四元数求得的姿态矩阵,为地球自转角速率在n系的投影,为n系相对e系的旋转角速率,Vn为n系下载体速度矢量,fb为加速度计测得的在载体坐标系下的输出值,gn为当地重力加速度矢量;
(4.2.3)捷联惯导***位置解算
位置微分方程如下:
上式中,L,λ和h分别是载体的纬度、经度和高度;VE、VN和VU分别是载体在东、北、天方向上的速度分量;RM、RN分别是地球的子午圈半径和卯酉圈半径;
(4.3)将SINS***解算得到的地理坐标系下的位置、速度、加速度信息转换到ECEF坐标系下,并装订成惯性辅助信息写入FIFO中,由FPGA串口发送给GNSS接收机。
5.根据权利要求1所述的基于DSP+FPGA的超紧组合导航方法,其特征在于,步骤5中所述导航处理器根据TIC锁存数据确定卫星的伪距和伪距率,并对导航星的伪距测量误差进行补偿;同时解调出导航星发送的导航电文,并根据导航电文解算导航卫星的位置、速度信息,具体为:
(5.1)导航处理器根据TIC锁存数据确定卫星的伪距和伪距率:在GPS的导航电文中,根据Z计数确定每一帧开始时对应的GPS时间;在帧同步后,对数据位、码周期数、半个码片滑动整数及小数部分分别进行计数得到测量时刻信号的发射时间,用发射时间减去接收时间得到传播延时,从而实现伪距的测量;
(5.2)对导航星的伪距测量误差进行补偿,即对伪距补偿地球自转和对流层影响,地球自转和对流层影响如下:
上式第一项为地球自转影响,第二项为对流层效应影响,其中Px、Py分别为卫星ECEF坐标系下x、y轴位置,px、py分别为载体ECEF坐标系下x、y轴位置,we为地球自转角速率,light_speed为光速,θ为卫星的高度角;
校正后,得到导航卫星伪距ρGj、伪距率信息,导航卫星的伪距ρGj公式为:
ρGj=rj-δtu-vρj
其中,rj为载体到第j颗卫星的真实无差距离,δtu为钟差引起的距离误差,vρj为伪距测量白噪声;
导航卫星的伪距率公式如下:
其中,δtru为钟漂引起的距离率误差,为伪距率测量白噪声,为载体到第j颗卫星Sj的真实无差距离变化率;
(5.3)导航电文是GPS信号中调制的数据,GPS接收机接收到卫星信号后,进行载波解调和伪码解扩,得到50bps的数据码,按照导航电文的格式,即可将数据码编译成导航电文,卫星位置和速度的计算公式参考ICD-GPS-200C。
6.根据权利要求1所述的基于DSP+FPGA的超紧组合导航方法,其特征在于,步骤6中所述GNSS接收机将步骤3中已捕获卫星的通道转为跟踪状态,利用步骤4提供的载***置、速度信息,以及步骤5提供的卫星位置和速度,实时计算由于卫星和载体之间相对运动造成的多普勒频移及变化率,并利用所得结果对载波跟踪环路进行反馈校正,具体如下:
(6.1)计算多普勒频移,设第i通道所跟踪的卫星在ECEF中的位置为步骤(4.2.3)中递推得到的载***置P′u=(Xu,Yu,Zu),则相对位置的单位视线矢量Ri为:
式中,(Xu,Yu,Zu)为载体的真实无差位置,为由卫星星历确定的第j颗卫星在ECEF坐标系中的位置;
观测时刻GNSS接收机第i通道所跟踪卫星信号的载波多普勒频移及变化率为:
式中,是载波多普勒频移,是载波多普勒频移变化率,c是光速,fL1是信号载波频率,VS、αS分别是观测时刻载体的三维速度、加速度;V′u、α'u分别是观测时刻接收机i通道卫星的三维速度、加速度;
(6.2)对辅助信息进行数据拟合,接收机载波环是由鉴相器、环路滤波器和数控振荡器构成的负反馈闭环控制***,滤波器若选择二阶滤波器,则传递函数F(s)表达成:
式中,F(s)为滤波器传递函数,τ1和τ2是滤波器系数,s为拉普拉斯变换算子;
常规载波跟踪环的闭环传递函数H(s)和误差传递函数He(s)分别为:
式中,wn表示特征频率且K表示环路增益,ξ表示阻尼系数且θr(s)、θe(s)分别是滤波器输入相位、输出相位,δθ(s)为相位误差,且δθ(s)=θe(s)-θγ(s);
由此可知加入惯性辅助后的闭环传递函数和误差传递函数分别为
其中,k表示刻度系数误差,τ表示滞后时间常数;
当载体在视线矢量上作匀加加速度运动时,根据拉式变换有:
式中,θ0为鉴相器输出的相位误差,ν、A和J分别是载体与卫星之间的相对速度、加速度和加加速度在视线矢量上的投影;
根据终值定理,得到环路的稳态误差E(∞)为
根据以上公式可知:二阶锁相环不能跟踪载体的加加速度,而当载体作匀加速运动时,有惯性辅助时的稳态误差为无惯性辅助时的稳态误差为
7.根据权利要求1所述的基于DSP+FPGA的超紧组合导航方法,其特征在于,步骤7中所述根据步骤5提供的导航星速度、位置信息,以及步骤4提供的载体速度、位置信息,确定载体相对每颗导航星的伪距、伪距率信息,具体为:
根据导航星的速度、位置信息,以及SINS的速度、位置信息,计算出载体相对每颗导航星的伪距、伪距率信息,其中载体到第j颗卫星的伪距ρIj为:
ρIj=rj+ej1δx+ej2δy+ej3δz
其中,δx、δy、δz分别为载体在地球坐标系中的位置误差在x轴、y轴、z轴分量,rj为载体到第j颗卫星的真实无差距离,ej1、ej2、ej3分别为载体与第j颗卫星x轴、y轴、z轴的方向余弦;
载体到第j颗卫星的伪距率为:
其中,分别为载体在地球坐标系中的速度误差在x轴、y轴、z轴分量,为载体到第j颗卫星的真实无差距离变化率。
8.根据权利要求1所述的基于DSP+FPGA的超紧组合导航方法,其特征在于,步骤8中所述构建***状态方程和量测方程:
(8.1)组合导航***通过卡尔曼滤波器对***中的误差量进行估计,并将估计值作为校正量反馈到***中,实现组合校正;状态变量包括SINS***误差、GNSS***误差和惯性器件误差,SINS***误差包括姿态误差、速度误差和位置误差;GNSS***误差包括钟差和钟漂;惯性器件误差包括随机误差;由此建立的超紧组合导航***状态方程如下:
上式中,φE、φN、φU分别为东、北、天方向平台失准角,δVE、δVN、δVU分别为载体东、北、天方向速度误差,δL、δλ、δh分别为载体纬度、经度、高度误差,δtu为与时钟等效的距离误差,δtru为与时钟频率等效的距离率误差,RM为椭球子午圈上各点的曲率半径,RN为卯酉圈上各点的曲率半径,wie为地球转动角速率,fE、fN、fU分别是惯导***的比力在导航系下东、北、天方向上的分量,εE、εN、εU分别为地理坐标系内陀螺的漂移在东、北、天方向上的投影,▽E、▽N、▽U分别为地理坐标系内加速计的漂移在东、北、天方向上的投影,βtru为反相关时间;L和h分别是载体的纬度和高度;VE、VN和VU分别是载体在东、北、天方向上的速度分量;
(8.2)以导航***的姿态误差、速度误差、位置误差及钟差、钟漂误差为状态变量,建立惯性/卫星组合导航***的状态方程:
其中,X为***状态矢量,表示***状态矢量的导数,F为***状态转移矩阵,G为***噪声驱动矩阵,W为***噪声矢量,具体如下:
***状态矢量:
上式中共17个状态变量,φE,φN,φU分别为东、北、天方向姿态误差角;δVE,δVN,δVU分别为东、北、天方向速度误差;δL,δλ,δh分别为纬度误差、经度误差、高度误差;εx,εy,εz分别为载体系下陀螺三个轴向的随机漂移;▽x,▽y,▽z分别为载体系下加速度计三个轴向的偏差;δtu和δtru分别为钟差引起的等效距离误差和钟漂引起的距离率误差;
状态转移矩阵:
其中Fins由步骤(8.1)中误差方程构成,为载体坐标系到导航坐标系的姿态转换矩阵,
***噪声驱动矩阵:
***噪声矢量:
假设***噪声为零均值高斯白噪声,协方差阵为E(WWT)=Q,Q为***过程噪声方差阵;wgx、wgy、wgz分别为陀螺仪x轴、y轴、z轴方向的随机白噪声,wax、way、waz分别为加速度计x轴、y轴、z轴方向的随机白噪声,wtu、wtru分别为伪距随机和伪距率随机白噪声;
(8.3)计算每个通道对应的每颗导航星的高度角,方位角信息,方法如下:首先由将ECEF坐标系中载体到相应导航星的观测向量转换到以载***置为原点的地理坐标系中,计算公式如下:
G=S*E
其中
其中,E=[ΔxΔyΔz]T为ECEF坐标系内载体到该卫星的观测向量,G=[ΔeΔnΔu]T为向量E在以载***置为原点的地理坐标系三个方向上的投影;
其中,[XYZ]T为卫星在ECEF坐标系中的位置,[xyz]T为载体在ECEF坐标系中位置,L,λ分别为载体的纬度、经度;
最终方位角和高度角由以下计算公式得出:
α=arctan(Δe/Δn)
上式中,θ,α分别为高度角、方位角,其中θ∈(0,π/2),α∈(0,2π);
(8.4)根据步骤(8.3)计算得到的高度角、方位角确定可见卫星,根据可见卫星个数,***动态调整观测方程及组合滤波器相关矩阵维数;
(8.5)构建***量测方程
Z(t)=H(t)X(t)+V(t)
其中,Z(t)为***观测矢量,H(t)为***观测矩阵,V(t)为***观测噪声阵,X为***状态矢量;量测方程的维数及组合滤波器的维数根据可见星数量变化,若可见星数量为n,则观测向量Z的维数为2n×1;***观测矩阵H维数为2n×17;***观测噪声方差R阵维数为2n×2n;卡尔曼滤波增益阵维数为17×2n;
伪距观测方程如下:
式中,为伪距观测矢量,为伪距观测矩阵,为伪距观测噪声阵,为伪距状态矢量,分别为:
δρj=ρIj-ρGj=ej1δx+ej2δy+ej3δz+δtu+νρj
其中, 为各通道伪距测量白噪声,ρIj、ρGj分别为步骤7中所求载体相对每颗卫星伪距和步骤5中GNSS接收机输出的卫星伪距,展开如下:
伪距率观测方程如下所示:
式中,为伪距率观测矢量,为伪距率观测矩阵,为伪距率观测噪声阵,为伪距率状态矢量,分别为:
其中,为各通道伪距率测量白噪声分别为步骤7中所求载体相对每颗卫星伪距率和步骤5中GNSS接收机输出的卫星伪距率,展开如下:
综合伪距、伪距率差观测方程,得到***观测方程如下:
上式中,为***观测矢量,为***观测矩阵,为***观测矩阵,为状态向量。
9.根据权利要求1所述的基于DSP+FPGA的超紧组合导航方法,其特征在于,步骤9中所述根据步骤8构建的***状态方程和量测方程进行全维滤波解算,将所得滤波结果对***进行校正,设卡尔曼滤波器全维滤波时间为tk,数据的同步时间为tc,惯导解算时间为tins,其他数据运算时间为tother,若惯导的解算周期为T,那么需满足下列公式成立:
T≥tc+tk+tins+tother
。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510490859.XA CN105068102A (zh) | 2015-08-11 | 2015-08-11 | 一种基于dsp+fpga的超紧组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510490859.XA CN105068102A (zh) | 2015-08-11 | 2015-08-11 | 一种基于dsp+fpga的超紧组合导航方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105068102A true CN105068102A (zh) | 2015-11-18 |
Family
ID=54497517
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510490859.XA Pending CN105068102A (zh) | 2015-08-11 | 2015-08-11 | 一种基于dsp+fpga的超紧组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105068102A (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105549057A (zh) * | 2015-12-07 | 2016-05-04 | 韩厚增 | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 |
CN105806339A (zh) * | 2016-05-14 | 2016-07-27 | 中卫物联成都科技有限公司 | 一种基于gnss、ins和守时***的组合导航方法和设备 |
CN106385280A (zh) * | 2016-10-14 | 2017-02-08 | 上海微小卫星工程中心 | 用于微小卫星的高速数据管理和传输的***及方法 |
CN106595649A (zh) * | 2016-11-22 | 2017-04-26 | 北京航天自动控制研究所 | 一种飞行中惯性初始基准偏差补偿方法 |
CN106980130A (zh) * | 2017-03-03 | 2017-07-25 | 哈尔滨工程大学 | 一种sins/gnss深组合自适应导航方法 |
CN107121685A (zh) * | 2017-06-08 | 2017-09-01 | 南京理工大学 | 一种微型星载高动态gnss接收机及其导航方法 |
CN107202577A (zh) * | 2017-06-08 | 2017-09-26 | 南京理工大学 | 一种基于gnss、芯片原子钟和微惯导的微pnt*** |
CN107656300A (zh) * | 2017-08-15 | 2018-02-02 | 东南大学 | 基于北斗/gps双模软件接收机的卫星/惯性超紧组合***及方法 |
CN109742543A (zh) * | 2019-01-29 | 2019-05-10 | 上海微小卫星工程中心 | 一种用于将终端的天线对准卫星的方法及相应*** |
CN110501696A (zh) * | 2019-06-28 | 2019-11-26 | 电子科技大学 | 一种基于多普勒量测自适应处理的雷达目标跟踪方法 |
CN111854746A (zh) * | 2020-07-31 | 2020-10-30 | 南京理工大学 | Mimu/csac/高度计辅助卫星接收机的定位方法 |
WO2021027621A1 (zh) * | 2019-08-14 | 2021-02-18 | Oppo广东移动通信有限公司 | 导航方法、装置设备、电子设备及存储介质 |
CN113311455A (zh) * | 2021-06-11 | 2021-08-27 | 合众思壮(河南)科技研究院有限公司 | 一种卫星信号分析方法及*** |
CN116540282A (zh) * | 2023-05-08 | 2023-08-04 | 北京交通大学 | 一种基于惯性传感器辅助的gnss的移动载体精准时间传递方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060161329A1 (en) * | 2005-01-14 | 2006-07-20 | Robert Crane | System and method for advanced tight coupling of GPS and inertial navigation sensors |
CN103995269A (zh) * | 2014-05-26 | 2014-08-20 | 南京理工大学 | 一种惯性信息辅助gnss跟踪环路方法 |
CN104181572A (zh) * | 2014-05-22 | 2014-12-03 | 南京理工大学 | 一种弹载惯性/卫星紧组合导航方法 |
CN104316947A (zh) * | 2014-08-26 | 2015-01-28 | 南京航空航天大学 | Gnss/ins超紧组合导航装置及相对导航*** |
-
2015
- 2015-08-11 CN CN201510490859.XA patent/CN105068102A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060161329A1 (en) * | 2005-01-14 | 2006-07-20 | Robert Crane | System and method for advanced tight coupling of GPS and inertial navigation sensors |
CN104181572A (zh) * | 2014-05-22 | 2014-12-03 | 南京理工大学 | 一种弹载惯性/卫星紧组合导航方法 |
CN103995269A (zh) * | 2014-05-26 | 2014-08-20 | 南京理工大学 | 一种惯性信息辅助gnss跟踪环路方法 |
CN104316947A (zh) * | 2014-08-26 | 2015-01-28 | 南京航空航天大学 | Gnss/ins超紧组合导航装置及相对导航*** |
Non-Patent Citations (1)
Title |
---|
何航平: "基于矢量跟踪环的GPS/INS深组合导航***研究与设计", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105549057A (zh) * | 2015-12-07 | 2016-05-04 | 韩厚增 | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 |
CN105549057B (zh) * | 2015-12-07 | 2018-08-17 | 韩厚增 | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 |
CN105806339A (zh) * | 2016-05-14 | 2016-07-27 | 中卫物联成都科技有限公司 | 一种基于gnss、ins和守时***的组合导航方法和设备 |
CN105806339B (zh) * | 2016-05-14 | 2018-09-25 | 中卫物联成都科技有限公司 | 一种基于gnss、ins和守时***的组合导航方法和设备 |
CN106385280B (zh) * | 2016-10-14 | 2019-04-26 | 上海微小卫星工程中心 | 用于微小卫星的高速数据管理和传输的***及方法 |
CN106385280A (zh) * | 2016-10-14 | 2017-02-08 | 上海微小卫星工程中心 | 用于微小卫星的高速数据管理和传输的***及方法 |
CN106595649A (zh) * | 2016-11-22 | 2017-04-26 | 北京航天自动控制研究所 | 一种飞行中惯性初始基准偏差补偿方法 |
CN106595649B (zh) * | 2016-11-22 | 2019-10-22 | 北京航天自动控制研究所 | 一种飞行中惯性初始基准偏差补偿方法 |
CN106980130A (zh) * | 2017-03-03 | 2017-07-25 | 哈尔滨工程大学 | 一种sins/gnss深组合自适应导航方法 |
CN106980130B (zh) * | 2017-03-03 | 2019-11-01 | 哈尔滨工程大学 | 一种sins/gnss深组合自适应导航方法 |
CN107202577A (zh) * | 2017-06-08 | 2017-09-26 | 南京理工大学 | 一种基于gnss、芯片原子钟和微惯导的微pnt*** |
CN107121685A (zh) * | 2017-06-08 | 2017-09-01 | 南京理工大学 | 一种微型星载高动态gnss接收机及其导航方法 |
CN107656300A (zh) * | 2017-08-15 | 2018-02-02 | 东南大学 | 基于北斗/gps双模软件接收机的卫星/惯性超紧组合***及方法 |
CN107656300B (zh) * | 2017-08-15 | 2020-10-02 | 东南大学 | 基于北斗/gps双模软件接收机的卫星/惯性超紧组合方法 |
CN113555688A (zh) * | 2019-01-29 | 2021-10-26 | 上海微小卫星工程中心 | 一种终端天线与高轨卫星的对准方法及*** |
CN109742543A (zh) * | 2019-01-29 | 2019-05-10 | 上海微小卫星工程中心 | 一种用于将终端的天线对准卫星的方法及相应*** |
CN113555688B (zh) * | 2019-01-29 | 2022-05-27 | 上海微小卫星工程中心 | 一种终端天线与高轨卫星的对准方法及*** |
CN110501696A (zh) * | 2019-06-28 | 2019-11-26 | 电子科技大学 | 一种基于多普勒量测自适应处理的雷达目标跟踪方法 |
CN110501696B (zh) * | 2019-06-28 | 2022-05-31 | 电子科技大学 | 一种基于多普勒量测自适应处理的雷达目标跟踪方法 |
WO2021027621A1 (zh) * | 2019-08-14 | 2021-02-18 | Oppo广东移动通信有限公司 | 导航方法、装置设备、电子设备及存储介质 |
CN111854746A (zh) * | 2020-07-31 | 2020-10-30 | 南京理工大学 | Mimu/csac/高度计辅助卫星接收机的定位方法 |
CN113311455A (zh) * | 2021-06-11 | 2021-08-27 | 合众思壮(河南)科技研究院有限公司 | 一种卫星信号分析方法及*** |
CN113311455B (zh) * | 2021-06-11 | 2024-05-24 | 河南芯港半导体有限公司 | 一种卫星信号分析方法及*** |
CN116540282A (zh) * | 2023-05-08 | 2023-08-04 | 北京交通大学 | 一种基于惯性传感器辅助的gnss的移动载体精准时间传递方法 |
CN116540282B (zh) * | 2023-05-08 | 2023-09-29 | 北京交通大学 | 一种基于惯性传感器辅助的gnss的移动载体精准时间传递方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105068102A (zh) | 一种基于dsp+fpga的超紧组合导航方法 | |
Sun et al. | A new IMU-aided multiple GNSS fault detection and exclusion algorithm for integrated navigation in urban environments | |
CN104181572B (zh) | 一种弹载惯性/卫星紧组合导航方法 | |
Han et al. | A novel initial alignment scheme for low-cost INS aided by GPS for land vehicle applications | |
CN104297773B (zh) | 一种高精度北斗三频sins深组合导航*** | |
CN106507913B (zh) | 用于管道测绘的组合定位方法 | |
CN103900611B (zh) | 一种惯导天文高精度复合两位置对准及误差标定方法 | |
CN106932804A (zh) | 天文辅助的惯性/北斗紧组合导航***及其导航方法 | |
CN101666650A (zh) | 一种sins/gps超紧致组合导航***及实现方法 | |
CN103969672A (zh) | 一种多卫星***与捷联惯性导航***紧组合导航方法 | |
CN106291639A (zh) | 一种gnss接收机实现定位的方法及装置 | |
CN101666868A (zh) | 一种基于sins/gps深组合数据融合的卫星信号矢量跟踪方法 | |
CN106501832A (zh) | 一种容错矢量跟踪gnss/sins深组合导航方法 | |
CN111580144B (zh) | 一种mins/gps超紧组合导航***设计方法 | |
CN103487820A (zh) | 一种车载捷联/卫星紧组合无缝导航方法 | |
CN106199668A (zh) | 一种级联式gnss/sins深组合导航方法 | |
CN103454665A (zh) | 一种双差gps/sins组合导航姿态测量方法 | |
Iqbal et al. | Pseudoranges error correction in partial GPS outages for a nonlinear tightly coupled integrated system | |
Wang et al. | Evaluation on loosely and tightly coupled GNSS/INS vehicle navigation system | |
Abd Rabbou et al. | Non-linear filtering for precise point positioning GPS/INS integration | |
Elisson et al. | Low cost relative GNSS positioning with IMU integration | |
Kong et al. | The composed correcting Kalman filtering method for integrated SINS/GPS navigation system | |
Campos-Vega et al. | Navigation through the Processing of Android Data with a High-Order Kalman Filter | |
Qian | Generic multisensor integration strategy and innovative error analysis for integrated navigation | |
Xiaoyu et al. | GH-LPS/INS integration for precise UAV application |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20151118 |