一种惯性卫星组合导航设备及方法与流程
本发明属于惯性卫星组合导航,具体涉及一种惯性卫星组合导航设备及方法。
背景技术:
1、惯性卫星组合导航技术是智能运动装备、测绘勘探、工程监测等领域的核心基础技术,其中纯惯性导航具备完全自主、无外部依赖、数据更新率高、抗干扰能力强的优势,可高频输出载体角速度、加速度、姿态、速度及位置信息,但长期工作会因传感器零偏、随机噪声等误差累积,导致导航精度随时间发散;纯卫星导航可提供高精度绝对位置、速度信息,无误差累积问题,但易受电磁干扰、遮挡环境影响,出现信号失锁、数据中断、定位失效等问题,无法实现连续稳定导航输出。
2、现有单一导航方式存在明显技术短板,难以满足复杂工况下高精度、高可靠、连续稳定的导航需求。为解决上述技术问题,行业普遍采用惯性/卫星组合导航方案,融合惯性导航高频稳定输出、卫星导航绝对精度高的双重优势。但目前常规组合导航设备存在诸多不足:一是部分设备惯性传感器精度不足,姿态解算误差较大;二是数据融合算法简单,无法有效抑制惯性导航误差累积与卫星导航信号异常干扰;三是设备体积大、功耗高,难以适配小型化搭载场景;四是接口协议不通用,适配性与兼容性较差。
技术实现思路
1、本发明的主要目的在于,提供一种惯性卫星组合导航设备及方法,克服现有单一导航设备精度有限、误差累积、抗干扰能力弱、体积功耗大、工况适应性差等技术缺陷。
2、为了解决以上技术问题,本发明提供以下技术方案:
3、第一方面,本发明提供一种惯性卫星组合导航设备,该设备包括高精度mems惯性测量单元、全频gnss定位定向模块、主控处理单元、电源单元和通信接口单元;
4、其中,所述高精度mems惯性测量单元用于输出三轴陀螺仪角速率数据和三轴加速度计比力数据;
5、所述全频gnss定位定向模块用于输出定位数据、定向数据和测速数据;
6、所述通信接口单元用于接收所述全频gnss定位定向模块输出数据,并输出惯性原始数据和组合导航数据;
7、所述主控处理单元分别与所述高精度mems惯性测量单元、所述全频gnss定位定向模块和所述通信接口单元连接,所述主控处理单元被配置为:
8、对所述三轴陀螺仪角速率数据和所述三轴加速度计比力数据进行误差补偿;
9、基于经误差补偿后的惯性测量数据进行初始对准和捷联惯性导航解算,获得惯性导航姿态、速度和位置结果;
10、将所述全频gnss定位定向模块输出的定位数据、定向数据和测速数据与所述惯性导航姿态、速度和位置结果进行卡尔曼滤波融合,得到组合导航数据;以及
11、通过所述通信接口单元输出所述组合导航数据。
12、进一步地,所述高精度mems惯性测量单元包括三轴mems陀螺仪和三轴加速度计,所述主控处理单元通过spi总线采集所述三轴mems陀螺仪输出的角速率数据以及所述三轴加速度计输出的比力数据。
13、进一步地,所述通信接口单元包括多路rs-422串口,所述多路rs-422串口包括用于接收所述全频gnss定位定向模块数据的接收机输入接口、用于输出惯性原始数据的第一输出接口和用于输出组合导航数据的第二输出接口;
14、所述惯性原始数据包括三轴陀螺仪角速率数据、三轴加速度计比力数据和传感器温度数据,所述组合导航数据包括姿态数据、速度数据、位置数据、导航状态数据、温度数据和时间数据;
15、所述第一输出接口以高于所述第二输出接口的输出频率输出所述惯性原始数据。
16、进一步地,所述误差补偿包括温度漂移补偿、零偏误差补偿、标度因数非线性补偿以及轴间交叉耦合误差补偿。
17、进一步地,所述主控处理单元被配置为在设备上电后进入初始对准状态,并基于地球重力矢量和地球自转角速度矢量构建导航惯性坐标系与载体惯性坐标系,以求解初始姿态和航向参数。
18、进一步地,所述通信接口单元还用于接收外部航向编码器数据;所述主控处理单元被配置为:在初始对准期间,若检测到所述外部航向编码器数据包含有效航向输入信号,则结束所述初始对准状态并切换至组合导航工作状态。
19、进一步地,所述卡尔曼滤波融合包括:
20、以姿态失准角、东向速度误差、北向速度误差、天向速度误差、经度误差、纬度误差、高度误差、陀螺仪零偏和加速度计零偏作为状态量,建立捷联惯性导航误差传播模型;
21、以所述全频gnss定位定向模块输出的三维位置数据和三维速度数据,与所述捷联惯性导航解算获得的位置数据和速度数据之间的差值作为观测量;以及
22、基于卡尔曼滤波预测和更新迭代估计系统误差状态,并对所述惯性导航姿态、速度和位置结果进行闭环修正。
23、进一步地,所述主控处理单元还被配置为监测所述高精度mems惯性测量单元的工作状态、卫星信号锁定状态、串口通信状态和供电状态;在检测到卫星信号失效时,切换至纯惯性导航模式,并持续输出导航数据。
24、第二方面,本发明提供一种惯性卫星组合导航方法,应用于第一方面所述的惯性卫星组合导航设备,该方法包括:
25、采集三轴陀螺仪角速率数据、三轴加速度计比力数据和全频gnss定位定向数据;
26、对所述三轴陀螺仪角速率数据和所述三轴加速度计比力数据进行误差补偿;
27、基于经误差补偿后的惯性测量数据进行初始对准和捷联惯性导航解算,获得惯性导航姿态、速度和位置结果;
28、将所述全频gnss定位定向数据与所述惯性导航姿态、速度和位置结果进行卡尔曼滤波融合,获得组合导航数据;以及
29、输出所述组合导航数据。
30、进一步地,所述进行初始对准包括:基于地球重力矢量、地球自转角速度矢量以及所述惯性测量数据,求解姿态变换矩阵,获得初始姿态和航向参数;
31、所述将全频gnss定位定向数据与所述惯性导航姿态、速度和位置结果进行卡尔曼滤波融合,包括:
32、建立包含姿态失准角、速度误差、位置误差、陀螺仪零偏和加速度计零偏的系统状态方程;
33、根据全频gnss定位定向数据与惯性导航解算数据之间的位置差和速度差建立观测方程;以及
34、利用卡尔曼滤波对系统状态进行预测和更新,基于更新后的系统状态修正所述惯性导航姿态、速度和位置结果。
35、总体而言,通过本发明所构思的以上技术方案与现有技术相比,能够取得以下有益效果:
36、本发明提供一种惯性卫星组合导航设备及方法,通过mems惯性测量单元与全频gnss定位定向模块协同采集惯性数据和卫星导航数据,并对惯性测量数据进行误差补偿、初始对准和捷联惯性导航解算,再利用卡尔曼滤波对惯性导航结果与gnss数据进行融合修正,从而抑制惯性导航过程中误差累积以及卫星信号异常对导航结果的影响;同时,在卫星信号失效时切换至纯惯性导航模式,以保持姿态、速度和位置导航数据的连续输出,提升设备对复杂应用工况的适应能力。
1.一种惯性卫星组合导航设备,其特征在于,该设备包括高精度mems惯性测量单元、全频gnss定位定向模块、主控处理单元、电源单元和通信接口单元;
2.根据权利要求1所述的惯性卫星组合导航设备,其特征在于,所述高精度mems惯性测量单元包括三轴mems陀螺仪和三轴加速度计,所述主控处理单元通过spi总线采集所述三轴mems陀螺仪输出的角速率数据以及所述三轴加速度计输出的比力数据。
3.根据权利要求1所述的惯性卫星组合导航设备,其特征在于,所述通信接口单元包括多路rs-422串口,所述多路rs-422串口包括用于接收所述全频gnss定位定向模块数据的接收机输入接口、用于输出惯性原始数据的第一输出接口和用于输出组合导航数据的第二输出接口;
4.根据权利要求1所述的惯性卫星组合导航设备,其特征在于,所述误差补偿包括温度漂移补偿、零偏误差补偿、标度因数非线性补偿以及轴间交叉耦合误差补偿。
5.根据权利要求1所述的惯性卫星组合导航设备,其特征在于,所述主控处理单元被配置为在设备上电后进入初始对准状态,并基于地球重力矢量和地球自转角速度矢量构建导航惯性坐标系与载体惯性坐标系,以求解初始姿态和航向参数。
6.根据权利要求1所述的惯性卫星组合导航设备,其特征在于,所述通信接口单元还用于接收外部航向编码器数据;所述主控处理单元被配置为:在初始对准期间,若检测到所述外部航向编码器数据包含有效航向输入信号,则结束所述初始对准状态并切换至组合导航工作状态。
7.根据权利要求1所述的惯性卫星组合导航设备,其特征在于,所述卡尔曼滤波融合包括:
8.根据权利要求1所述的惯性卫星组合导航设备,其特征在于,所述主控处理单元还被配置为监测所述高精度mems惯性测量单元的工作状态、卫星信号锁定状态、串口通信状态和供电状态;在检测到卫星信号失效时,切换至纯惯性导航模式,并持续输出导航数据。
9.一种惯性卫星组合导航方法,其特征在于,应用于权利要求1至8任一项所述的惯性卫星组合导航设备,该方法包括:
10.根据权利要求9所述的惯性卫星组合导航方法,其特征在于,所述进行初始对准包括:基于地球重力矢量、地球自转角速度矢量以及所述惯性测量数据,求解姿态变换矩阵,获得初始姿态和航向参数;
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com