GPS/SINS超紧组合导航系统中的快速重定位方法技术方案
【技术实现步骤摘要】
本专利技术涉及组合导航
，特别是一种GPS/SINS超紧组合导航系统中的快速重定位方法。
技术介绍
GPS全球定位系统通过对在轨卫星发射的无线电信号进行被动测距来得到用户的三维位置。由于在轨卫星的星座能够保证全球任意位置都有足够数量的卫星信号实现定位，使得导航定位服务能够实现全球覆盖，具有定位精度较高，覆盖范围较广且定位误差不随时间积累等优点，已经在军民领域获得了广泛的应用。GPS的缺点是动态定位误差较大，数据更新频率低，且定位精度极易受到多路径效应、遮挡等地理环境因素的影响，同时在高动态情况下容易出现信号失锁、无法定位等情况，单独使用无法满足高速、实时导航的要求。捷联惯性导航系统(Straped Inertial Navigation Systems,SINS)依靠惯性传感器实现全天候、全球性的自主三维定位、测姿和测速，是一种完全自主的导航系统，具有隐蔽性好、不受外界干扰等优点，也因此成为航空、航天和航海等领域中一种广泛使用的主要导航系统，在导航领域中占有突出的地位。但由于惯性测量器件陀螺和加速度计固有的漂移、零偏等误差具有强时间相关性，误差随时间逐步累积，所以低成本的SINS精度通常较差，且随时间发散。目前，GPS/SINS超紧组合组合导航系统结合卫星导航、惯性导航的优点，具有定位精度高，稳定性强等特点，因此在军事领域及民用领域都被广泛应用。但是，在高动态、弱信号等工作环境下，载体在飞行过程中可能面临GPS信号失锁等情况，从而使超紧组合导航系统无法正常工作。
技术实现思路
本专利技术的目的在于提供一种GPS/SINS超紧组合导航系统中的快速重定位方...
【技术保护点】
一种GPS/SINS超紧组合导航系统中的快速重定位方法，其特征在于，包括以下步骤：步骤1，根据历书信息和本地时间预测可见卫星：首先根据星历或历书信息，结合接收机时钟提供的本地时间解算出第i颗卫星在地心地固直角坐标系即ECEF坐标系下的位置SINS根据IMU输出的信息实时计算得到载体当前时刻的纬度L、经度λ和高度h；将载体的位置进行坐标变换得到载体在ECEF坐标系下的位置(xu,yu,zu)，计算第i颗卫星相对于载体的高度角；步骤2，根据卫星高度角信息为卫星分配多个通道：根据在轨卫星的高度角，判断并剔除当前不可见的卫星，对剩下的可搜捕卫星分配通道进行二维搜索；步骤3，利用外部辅助的载体位置信息，结合卫星历书或星历、本地时间信息实时解算得到辅助信息，并对载波环和码环提供辅助；步骤4，完成信号捕获并进入跟踪状态以后读取本地时间，利用星历信息和SINS输出的辅助信息计算伪距，反推卫星信号的发射时间，从而解算得到当前帧计数；步骤5，检测帧计数正确性，解调导航电文，利用导航测量值和导航电文进行定位解算，最终得到用户的卫星信息。
【技术特征摘要】
1.一种GPS/SINS超紧组合导航系统中的快速重定位方法，其特征在于，包括以下步骤：步骤1，根据历书信息和本地时间预测可见卫星：首先根据星历或历书信息，结合接收机时钟提供的本地时间解算出第i颗卫星在地心地固直角坐标系即ECEF坐标系下的位置SINS根据IMU输出的信息实时计算得到载体当前时刻的纬度L、经度λ和高度h；将载体的位置进行坐标变换得到载体在ECEF坐标系下的位置(xu,yu,zu)，计算第i颗卫星相对于载体的高度角；步骤2，根据卫星高度角信息为卫星分配多个通道：根据在轨卫星的高度角，判断并剔除当前不可见的卫星，对剩下的可搜捕卫星分配通道进行二维搜索；步骤3，利用外部辅助的载体位置信息，结合卫星历书或星历、本地时间信息实时解算得到辅助信息，并对载波环和码环提供辅助；步骤4，完成信号捕获并进入跟踪状态以后读取本地时间，利用星历信息和SINS输出的辅助信息计算伪距，反推卫星信号的发射时间，从而解算得到当前帧计数；步骤5，检测帧计数正确性，解调导航电文，利用导航测量值和导航电文进行定位解算，最终得到用户的卫星信息。2.根据权利要求1所述的GPS/SINS超紧组合导航系统中的快速重定位方法，其特征在于，步骤1中所述根据历书信息和本地时间预测可见卫星，具体如下：(1.1)首先根据星历或历书信息，结合接收机时钟提供的本地时间解算出第i颗卫星在地心地固直角坐标系即ECEF坐标系下的位置SINS根据IMU输出的信息实时计算得到载体当前时刻的纬度L、经度λ和高度h；将载体的位置进行坐标变换得到载体在ECEF坐标系下的位置(xu,yu,zu)，根据卫星与载体的位置信息，算得载体到第i颗卫星的向量如下： Δ x Δ y Δ z = x s i y s i z s i - x u y u z u ]]>(1.2)将ECEF坐标系下的卫星观测向量转换为载体坐标系下的卫星观测向量 Δ e Δ n Δ u = - s i n λ c o s λ 0 - sin L cos λ - sin L s i n λ cos L cos L c o s λ cos L sin λ sin L · Δ x Δ y Δ z ]]>上式中，[Δx,Δy,Δz]T是ECEF坐标系下载体到卫星的观测向量，[Δe,Δn,Δu]T是载体坐标系下的卫星观测向量，λ、L分别为接收机的经度和纬度；(1.3)计算第i颗卫星相对于载体的高度角θi θ i = a r c s i n ( Δ u ( Δ e ) 2 + ( Δ n ) 2 + ( Δ u ) 2 ) ]]>根据在轨卫星的高度角，判断并剔除当前不可见的卫星，对剩下的可搜捕卫星分配通道进行二维搜索。3.根据权利要求1所述的GPS/SINS超紧组合导航系统中的快速重定位方法，其特征在于，步骤2中所述根据卫星高度角信息为卫星分配多个通道，具体如下：(2.1)初始化多通道模块，将所有通道状态设为关闭并将通道压入栈中，将所有卫星的搜捕状态设为不可见；(2.2)判断能否通过高度角预测可见卫星：若不能预测，则将全部卫星的搜捕状态设置为可能可见，将所有通道从栈中弹出，将通道状态设置为常规时域捕获，为每颗卫星分配一个通道，进行二维搜捕，通道的状态设置为常规捕获；若可以预测，则将预测成功的卫星搜捕状态设置为预测可见，并申请使用多通道；将预测不可见的卫星的搜捕状态设置为预测不可见，并不再分配相应通道，等待高度角大到足够角度时再重新开启；(2.3)对于预测可见的卫星，通过查询栈顶的位置判断是否有多余通道；查询的优先级由卫星的高度角大小决定；如果申请多通道成功，根据卫星高度角的大小从栈中弹出通道并将通道的搜捕卫星号设置为该颗卫星，包括最先分配给该颗卫星的通道，以及弹出的通道状态均设置为多通道捕获；(2.4)成功捕获以后，将卫星搜捕状态改为可见，留下最先搜捕到该卫星信号的通道，将通道状态设置为信号确认；随后查找并释放该卫星之前使用的其他通道，将这些通道的状态设置为关闭并压入栈中，等待下次使用；如果超过时间仍未成功捕获卫星信号，则释放该颗卫星占用的所有通道，将卫星搜捕状态设置为弱信号，并重新分配一个通道改为采用非相干积分检测法捕获，此时的通道状态设置为非相干积分捕获。4.根据权利要求1所述的GPS/SINS超紧组合导航系统中的快速重定位方法，其特征在于，步骤3中所述利用外部辅助的载体位置信息，结合卫星历书或星历、本地时间信息实时解算得到辅助信息，并对载波环和码环提供辅助，具体如下：(3.1)卫星信号相对中频频率的偏移除了受卫星和载体之间的相对运动引起的多普勒效应影响外，还包括接收机时钟频漂和卫星时钟频漂，频率偏移表示为：Δfcarrier＝fdopp+Δfrec+Δfs上式中，Δfs为卫星时钟频率漂移造成的频率偏差，能够由时钟校正项消除；Δfrec为接收机时钟频率漂移带来的频率偏差，fdopp为卫星和载体之间的多普勒频移；(3.2)将SINS输出的当前时刻载体速度变换到ECEF坐标系下，结合历书或星历解算出的第i颗卫星在ECEF坐标系下的速度计算得到载体和第i颗卫星之间在视线矢量上的相对速度为： v u _ s i = ( v → u - v → s ) · e → u _ s i = ( x · u y · u z · u - x · s i y · s i z · s i ) · x s i - x u r y s i - y u r z s i - z u r ]]>上式中，为卫星和载体在视距方向的单位方向矢量，r为几何距离；(3.3)计算卫星和载体之间相对运动造成的多普勒频移 f d o p p i = f L 1 c · v u _ s i = 1 λ 1 · v u _ s i ]]>上式中，fL1为GPS L1波段的载波频率，取1575.42MHz，c为光在真空中的传播速度，取299792458.0m/s，比例系数(3.4)最终计算得到的第i颗卫星信号的载波频率为 f 0 i = f I F + f d o p p i + Δ f ~ r e c ]]>上式中，fIF为下变频后信号的中频频率，为接收机晶振频漂带来的频率误差估计值，为卫星相对于载体的多普勒频移；(3.5)接收机信号捕获控制部分根据实时解算得到的载波频率一方面不断调整本地复制信号的载波频率，将调整后的中频频率作为捕获中心值；另一方面，根据载波频率与码速率之间的关系维持码相位的同步。5.根据权利要求1所述的GPS/SINS超紧组合导航系统中的快速重定位方法，其特征在于，步骤4中所述完成信号捕获并进入跟踪状态以后读取本地时间，利用星历信息和SINS输出的辅助信息计算伪距，反推卫星信号的发射时间，从而解算得到当前帧计数，具体如下：(4.1)卫星星历计算出卫星的位置和速度，通过卫星星历和IMU计算得到载体与卫星之间的伪距： ρ i = ( x i - x u _ i n s ) 2 + ( y i - y u _ i n s ) 2 + ( z i - z u _ i n s ) 2 + δt u ]]>式中，(xi,yi,zi)为卫星的位置，(xu_ins,yu_ins,zu_ins)为惯导提供的接收机的位置，δtu为钟差；(4.2)由于本地时间由本地时钟得到，利用伪距计算公式反推卫星发射时间ρρ＝c×(t-t(s))式中，c为光速；t为信号的接收时刻；t(s)为信号的发射时刻(4.3)信号的发射时刻由一系列连续的测量值组成，计算公式为： t s = T O W + ( 30 w + b ) × 0.020 + ( c + C P 1023 + C D P 1023 × 2046 ) × 0.001 ( s ) ]]>式中，TOW表示上一子帧中截短的周内时计数，乘以6以后就等于当前子帧的起始时间；W表示当前已接收到的帧内导航电文字，b表示当前导航电文字字内的比特位计数，c表示在当前比特中已经接收完整伪码周期的数量，CP表示当前码相位测量值，CDP表示当前的载波周期计数；由于已知信号发射时间，由上式解算得到位计数、字计数、子帧计数及Z计数，从而实现帧同步。6.根据权利要求1所述的GPS/SINS超紧组合导航系统中的快速重定位方法，其特征在于，步骤5中所述检测帧计数正确性，解调导航电文，利用导航测量值和导航电文进行定位解算，最终得到用户的卫星信息，具体如下：(5.1)判断帧计数是否正确，若正确则进入稳定跟踪状态，若不正确则退出帧同步状态；(5.2)若设卫星i的坐标为(xi,yi,zi)，接收机到该卫星的伪距为ρi，接收机的坐标(xu,yu,zu)，卫星时钟与接收机本地时钟钟差为δtu，则列出以下等式： ρ i = ( x i - x u ) 2 + ( y i - y u ) 2 + ( z i - z u ) 2 + δt u ]]>其中，卫星的位置(xi,yi,zi)和卫星与接收机的伪距为ρi都是已知量，通过导航电文中的信息求得；接收机的坐标(x,y,z)和钟差δtu为未知量，收机获取4颗以上的卫星的导航电文，则列出四个方程，从而解算出接收机的位置；采用牛顿迭代及线性化方法对方程组进行求解，其具体步骤如下：第1步，设置方程初始解：迭代前给方程组的4个未知数设定一个初始值，初始值的设置分为两种情况：若是首次定位，则全部设为0；若已经成功定位，则将上一次的结果设置为本次迭代的初始值；第2步，线性化方程组，对上式进行泰勒展开得： ρ i - ρ i ( x , y , z , δt u ) = ∂ ρ i ∂ x · Δ x + ∂ ρ i ∂ y · Δ y + ∂ ρ i ∂ z · Δ z + 1 · δt u ]]>其中： ∂ ρ i ∂ x = - ( x i - x ) ( x i - x u ) 2 + ( y i - y u ) 2 + ( z i - z u ) 2 = - ...
【专利技术属性】
技术研发人员：陈帅，陈克振，蒋长辉，屈新芬，韩乃龙，孙昭行，卢启伟，赵琛，汪益平，韩筱，孔维一，黄思亮，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏;32
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。