一种基于GNSS与INS的自适应导航定位系统及方法技术方案

本发明专利技术公开了一种基于GNSS与INS的自适应导航定位系统及方法，包括GNSS接收机、IMU惯性测量单元、捷联惯导解算模块、PDR行人航迹推算模块、导航定位融合模块和电源模块，GNSS接收机将定位信息和卫星信息发送至导航定位融合模块，所述IMU惯性测量单元将导航定位信息依次通过捷联惯导解算模块、PDR行人航迹推算模块发送至导航定位融合模块，所述导航定位融合模块进行GNSS与INS导航定位信息进行融合后输出。与现有技术相比，本发明专利技术可实现导航定位的平滑切换，且易于实现，容易移植到低成本处理器上。实现了PDR步长估计K值自适应、自校准，增加在PDR中的导航定位精度。

【技术实现步骤摘要】
一种基于GNSS与INS的自适应导航定位系统及方法
本专利技术涉及一种导航定位系统及方法，尤其涉及一种基于GNSS与INS的自适应导航定位系统及方法。
技术介绍
GNSS(GlobalNavigationSatelliteSystem全球卫星导航系统)，如北斗(BEIDOU)、GPS、Glonass等，越来越多的被人们所熟知。在室外空旷区域，其定位精度通常优于5米，该精度已经满足普通生活、生产所需。但在室内、地下、建筑密集区域，通常造成GNSS信号微弱、丢失以及产生多径效应，这些因素都会造成GNSS定位不准确，甚至无法定位。INS(InertialNavigationSystem，惯性导航系统)主要由IMU(InertialMeasurementUnit，惯性测量单元)组成，通常包括以下模块：3轴陀螺仪、3轴加速度计、3轴地磁计。其通过对惯性测量数据进行处理后，可得出对象的加速度、角速度、本地地磁信息，进而能够计算得出速度、姿态、航向等信息。在给定初始位置的基础上，可利用IMU进行自主导航定位，可以解决GNSS系统的覆盖问题。传统IMU模块一般应用在舰船、飞机、特种装备上，其优点是测量精度高、漂移率小，能适应长时间连续工作，缺点是体积大、功耗高且价格昂贵。因此，传统IMU给行人导航定位带来了巨大的门槛。当INS应用到行人时，由于行人行动加速度很小、速度低，加之MEMSIMU器件自身测量精度与漂移的缺陷，传统INS导航处理算法会在短时间造成巨大的累积误差，无法长时间提供准确的导航定位信息。为了克服MEMSIMU器件的劣势，通常在行人导航定位领域采用PDR(PedestrianDead-Reckoning，行人航迹推算)来进行处理。行人航迹推算，是通过IMU检测判断行人跨步动作、估计步长、检测行动航向以实现行人的导航定位。传统行人航迹推算，步长估计依靠经验公式，无法进行动态调整，而且人体之间的差异性会导致每个人员在使用同一套定位算法时差异化严重，导致导航定位不准确。
技术实现思路
本专利技术针对PDR的步长估计模型不具有统一性，本专利技术提出了一种在GNSS导航定位状态下步长估计自适应方法，能够改善不同人在使用PDR导航时产生的差异性，提升PDR导航定位精度，对模糊区域的处理，能够改善INS导航定位起始信息，使室内外导航定位信息平滑过渡。为了实现上述目的，本专利技术采用的技术方案是：一种基于GNSS与INS的自适应导航定位系统，包括GNSS接收机、IMU惯性测量单元、捷联惯导解算模块、PDR行人航迹推算模块、导航定位融合模块和电源模块，所述GNSS接收机将定位信息和卫星信息发送至导航定位融合模块，所述IMU惯性测量单元将导航定位信息依次通过捷联惯导解算模块、PDR行人航迹推算模块发送至导航定位融合模块，所述PDR行人航迹推算模块通过采集GNSS的导航定位信息进行PDR步长自适应校准，所述导航定位融合模块进行GNSS与INS导航定位信息进行融合后输出。作为优选，所述惯性测量单元采用3轴MEMS陀螺仪芯片、3轴MEMS加速度计芯片、3轴MEMS电子罗盘芯片、MEMS气压高度计芯片组成。作为优选，所述捷联惯导解算模块通过AHRS航姿参考系统计算得到载体航向、横滚、侧翻角度信息，再由坐标系旋转计算得到本地重力加速度方向的加速度矢量和。一种基于GNSS与INS的自适应导航定位方法，方法步骤如下：1)GNSS定位信息、卫星信息获取获取GNSS接收机上报的定位信息、卫星信息，解析协议，缓存定位信息、卫星姿态、卫星信号信噪比、卫星数据有效性，GPS定位信息按时间1秒整合为序列[Tk,Lok,Lak]；2)INS定位信息计算利用PDR步长估计自适应算法，计算行人惯性测量信息，并做30秒内的缓存，按时间1秒整合为序列[Tk,pk,yk]，其中pk为行人单步步长信息，yk为航向信息；3)INS定位更新策略根据PDR步长估计自适应算法得到的行人惯性测量信息序列[Tk,pk,yk]，结合T1时刻的GNSS定位信息，可得到PDR行人定位坐标序列[Tk,PLok,PLak]；4)GNSS/INS切换策略判定GNSS接收机定位是否有效，不能仅使用定位有效的提示，需要联合卫星信息综合判断，当卫星数量、卫星信号信噪比低于阈值时，将定位方式切换为INS。作为优选，步骤3)中进行INS定位更新策略时，当缓存装满后，需要剔掉T1时刻的数据，并接收新缓存数据，此时，PDR定位坐标序列的起始点需要以T2时刻的GNSS定位信息为起始点刷新，即，PDR行人惯性测量信息序列为一30秒的时间滑动窗口，缓存最近30秒的惯性测量数据。使用惯性测量信息滑动窗口第一个数据时刻对应的GNSS定位信息作为惯性导航系统的初始坐标，并计算滑动窗口中所有惯性测量信息所表征的行人定位坐标，以形成行人坐标序列[Tk,PLok,PLak]。作为优选，进行PDR步长估计自适应算法的方法步骤如下：1)捷联惯导解算通过AHRS航姿参考系统计算，得到载体航向、横滚、侧翻角度信息，再由坐标系旋转计算得到本地重力加速度方向的加速度矢量和；2)PDR跨步检测对计算得到的重力加速度方向的加速度矢量和，以3Hz为截至频率设计数字低通滤波器，并进行数字低通滤波后，得到行人在重力加速度方向上的加速度变化；对行人在重力加速度方向上变化的加速度进行峰值检测，并计算邻近极小值与极大值之差的绝对值，该绝对值若超过阈值则可判定为跨步动作，记录跨步动作发生的时间、极小值、极大值，形成序列3)GNSS定位下实际步长统计GNSS接收机的通常信息输出频率为1Hz，对于每个GNSS定位信息记录时间、经度、纬度，形成序列[Tm,Lom,Lam]，Lo为经度，La为纬度；4)PDR步长估计自适应将序列[Tm,Lom,Lam]做相应计算与调整，根据经纬度与地理距离的换算可以得到新序列[Tsm,Tem,Sm]，其中Ts为起始时刻、Te为结束时刻、S为行人在Ts时刻与Te时刻间的直线距离，根据序列可以得到序列[Tsm,Tem,Sm]每个元素所包含的PDR跨步检测信息，对Tsm，Tem，Sm，在序列中，计算跨步时刻在[Tsm,Tem]范围内的所有跨步步长比例值序列[Pk]，其中按照比例关系对移动距离Sm进行分配：进而得到得到序列[sk]；根据PDR步长估计公式：即ρk＝K·Pk处理步骤可得到了[ρk]＝[sk]、与[Pk]，再利用最小二乘法，可拟合出常数K的最优的解。作为优选，步骤4)中，设序列中共N个点，则K的估计值为：利用上述步骤，可得到PDR步长估计中常数K的自适应值，进而对行人PDR导航定位步长估计进行自校准。与现有技术相比，本专利技术的优点在于：GNSS与INS导航定位融合方法可实现导航定位的平滑切换，且易于实现，容易移植到低成本处理器上。实现了PDR步长估计K值自适应、自校准，增加在PDR中的导航定位精度。附图说明图1为本专利技术结构框图；图2为本专利技术工作流程图。具体实施方式下面将对本专利技术作进一步说明。实施例：一种基于GNSS与INS的自适应导航定位系统，参见图1，包括GNSS接收机、IMU惯性测量单元、捷联惯导解算模块、PDR行人航迹推算模块、导航定位融合模块和电源模块，所述GNSS接收机将定位信息和卫星信息发送至导航定位融合模块，所本文档来自技高网...

【技术保护点】
一种基于GNSS与INS的自适应导航定位系统，其特征在于：包括GNSS接收机、IMU惯性测量单元、捷联惯导解算模块、PDR行人航迹推算模块、导航定位融合模块和电源模块，所述GNSS接收机将定位信息和卫星信息发送至导航定位融合模块，所述IMU惯性测量单元将导航定位信息依次通过捷联惯导解算模块、PDR行人航迹推算模块发送至导航定位融合模块，所述PDR行人航迹推算模块通过采集GNSS的导航定位信息进行PDR步长自适应校准，所述导航定位融合模块进行GNSS与INS导航定位信息进行融合后输出；方法步骤如下：1)GNSS定位信息、卫星信息获取获取GNSS接收机上报的定位信息、卫星信息，解析协议，缓存定位信息、卫星姿态、卫星信号信噪比、卫星数据有效性，GPS定位信息按时间1秒整合为序列[Tk,Lok,Lak]；2)INS定位信息计算利用PDR步长估计自适应算法，计算行人惯性测量信息，并做30秒内的缓存，按时间1秒整合为序列[Tk,pk,yk]，其中pk为行人单步步长信息，yk为航向信息；其中进行PDR步长估计自适应算法的方法步骤如下：a)捷联惯导解算通过AHRS航姿参考系统计算，得到载体航向、横滚、侧翻角度信息，再由坐标系旋转计算得到本地重力加速度方向的加速度矢量和；b)PDR跨步检测对计算得到的重力加速度方向的加速度矢量和，以3Hz为截至频率设计数字低通滤波器，并进行数字低通滤波后，得到行人在重力加速度方向上的加速度变化；对行人在重力加速度方向上变化的加速度进行峰值检测，并计算邻近极小值与极大值之差的绝对值，该绝对值若超过阈值则可判定为跨步动作，记录跨步动作发生的时间、极小值、极大值，形成序列...

【技术特征摘要】
1.一种基于GNSS与INS的自适应导航定位系统，其特征在于：包括GNSS接收机、IMU惯性测量单元、捷联惯导解算模块、PDR行人航迹推算模块、导航定位融合模块和电源模块，所述GNSS接收机将定位信息和卫星信息发送至导航定位融合模块，所述IMU惯性测量单元将导航定位信息依次通过捷联惯导解算模块、PDR行人航迹推算模块发送至导航定位融合模块，所述PDR行人航迹推算模块通过采集GNSS的导航定位信息进行PDR步长自适应校准，所述导航定位融合模块进行GNSS与INS导航定位信息进行融合后输出；方法步骤如下：1)GNSS定位信息、卫星信息获取获取GNSS接收机上报的定位信息、卫星信息，解析协议，缓存定位信息、卫星姿态、卫星信号信噪比、卫星数据有效性，GPS定位信息按时间1秒整合为序列[Tk,Lok,Lak]；2)INS定位信息计算利用PDR步长估计自适应算法，计算行人惯性测量信息，并做30秒内的缓存，按时间1秒整合为序列[Tk,pk,yk]，其中pk为行人单步步长信息，yk为航向信息；其中进行PDR步长估计自适应算法的方法步骤如下：a)捷联惯导解算通过AHRS航姿参考系统计算，得到载体航向、横滚、侧翻角度信息，再由坐标系旋转计算得到本地重力加速度方向的加速度矢量和；b)PDR跨步检测对计算得到的重力加速度方向的加速度矢量和，以3Hz为截至频率设计数字低通滤波器，并进行数字低通滤波后，得到行人在重力加速度方向上的加速度变化；对行人在重力加速度方向上变化的加速度进行峰值检测，并计算邻近极小值与极大值之差的绝对值，该绝对值若超过阈值则可判定为跨步动作，记录跨步动作发生的时间、极小值、极大值，形成序列c)GNSS定位下实际步长统计GNSS接收机的通常信息输出频率为1Hz，对于每个GNSS定位信息记录时间、经度、纬度，形成序列[Tm,Lom,Lam]，Lo为经度，La为纬度；d)PDR步长估计自适应将序列[Tm,Lom,Lam]做相应计算与调整，根据经纬度与地理距离的换算可以得到新序列[Tsm,Tem,Sm]，其中Ts为起始时刻、Te为结束时刻、S为行人在Ts时刻与Te...

【专利技术属性】
技术研发人员：刘淼，王学东，
申请(专利权)人：成都佰纳瑞信息技术有限公司，
类型：发明
国别省市：四川,51