一种利用车体非完整性约束的惯性自主导航方法
【专利摘要】本发明公开了一种利用车体非完整性约束的惯性自主导航方法。本方法利用在运动过程中车体非完整性约束，通过平滑惯性自主导航系统输出的侧向和垂向速度累积，构建卡尔曼滤波观测方程，并利用卡尔曼滤波方程周期性计算出载车的导航参数误差并修正导航参数，从而实现了利用车体非完整性约束惯性导航系统的自主导航。本发明有效的解决了惯性导航系统自主导航精度发散的问题，有效的保证了惯性定位定向设备的精度。该方法使用方便，无需增加额外辅助设备。
【专利说明】一种利用车体非完整性约束的惯性自主导航方法
【技术领域】
[0001]本发明涉及一种惯性自主导航方法，特别是一种利用车体非完整性约束的惯性自主导航方法。
【背景技术】
[0002]惯性导航系统是一种直接利用惯性器件(陀螺仪和加速度计)的测量信息建立方向基准，并通过加速度信息自动完成解算，从而获得载车瞬时速度和位置的导航系统。惯性导航系统具有完全自主的特点，被广泛应用于陆海空天领域。由于惯性器件存在随机漂移，因此惯性导航系统具有定向和定位误差随时间增长的特性。对于低精度器件(如MEMS)，其定位定向误差随时间增长的特性尤为明显，因此很难用于自主导航定位。通常，采用外围辅助设备和惯性导航系统组成组合导航系统，以抑制惯性导航系统的误差发散，实现导航定位的功能。
[0003]在载车运动条件下，采用低精度器件的惯性导航系统需要与GPS、里程计、高程计等外部设备组成组合导航系统。外部设备可以通过载车速度或位置等信息，建立惯性导航系统在运动条件下的误差模型，采用卡尔曼滤波器实现对惯性导航系统的导航信息误差的补偿。这种方法有效解决了惯性导航系统误差发散的问题，能够实现高精度的定位定向。但是这也破坏了惯性导航系统完全自主的特点，同时当外围设备故障或无法工作时，惯性导航系统还存在误差发散的问题，这些问题导致采用低精度器件的惯性导航系统在运动条件下无法实现自主导航。
【发明内容】
[0004]本发明目的在于提供一种利用车体非完整性约束的惯性自主导航方法，解决由于采用低精度器件的惯性导航系统在运动条件下无法自主导航的问题。
[0005]一种利用车体非完整性约束的惯性自主导航方法，其具体步骤为:
第一步构建利用车体非完整性约束的惯性自主导航系统
利用车体非完整性约束的惯性自主导航系统，包括:三轴硅微陀螺仪、三轴硅微加速度计、导航计算机、惯性导航解算模块、导航修正模块和通讯模块。三轴硅微陀螺仪和三轴硅微加速度计分别与导航计算机实现SPI总线连接。惯性导航解算模块、导航修正模块和通讯模块分别置于导航计算机中。
[0006]惯性导航解算模块用于利用采集的角速率和加速度通过数学运算得到载体在地理坐标系内的姿态、速度和位置。
[0007]导航修正模块用于利用车体非完整性约束构建观测方程，采用卡尔曼滤波方程周期性修正利用车体非完整性约束的惯性自主导航系统的导航参数，即载车的姿态、速度和位置。
[0008]通讯模块用于利用车体非完整性约束的惯性自主导航系统内外的数据采集和通τΗ ο[0009]第二步惯性导航解算模块对导航参数初始化
载车静止条件下，惯性导航解算模块接收来自三轴硅微陀螺仪和三轴硅微加速度计的数据，对三轴硅微陀螺仪和三轴硅微加速度计的零偏进行补偿，同时接收预存信息完成对惯性自主导航系统姿态、速度和位置信息的初始化。
[0010]第三步惯性导航解算模块进行导航解算
载车启动后，惯性导航解算模块接收三轴硅微陀螺仪和三轴硅微加速度计的数据，计算出载车在地理坐标系内的姿态、速度和位置。
[0011]第四步导航修正模块进行修正准备
导航修正模块接收导航解算模块输出的速度，并利用姿态转换矩阵将接收到的速度转换为车体的侧向速度和垂向速度。
[0012]转换公式为
【权利要求】
1.一种利用车体非完整性约束的惯性自主导航方法，其特征在于具体步骤为: 第一步构建利用车体非完整性约束的惯性自主导航系统 利用车体非完整性约束的惯性自主导航系统，包括:三轴硅微陀螺仪、三轴硅微加速度计、导航计算机、惯性导航解算模块、导航修正模块和通讯模块；三轴硅微陀螺仪和三轴硅微加速度计分别与导航计算机实现SPI总线连接；惯性导航解算模块、导航修正模块和通讯模块分别置于导航计算机中； 惯性导航解算模块用于利用采集的角速率和加速度通过数学运算得到载体在地理坐标系内的姿态、速度和位置； 导航修正模块用于利用车体非完整性约束构建观测方程，采用卡尔曼滤波方程周期性修正利用车体非完整性约束的惯性自主导航系统的导航参数，即载车的姿态、速度和位置； 通讯模块用于利用车体非完整性约束的惯性自主导航系统内外的数据采集和通讯； 第二步惯性导航解算模块对导航参数初始化 载车静止条件下，惯性导航解算模块接收来自三轴硅微陀螺仪和三轴硅微加速度计的数据，对三轴硅微陀螺仪和三轴硅微加速度计的零偏进行补偿，同时接收预存信息完成对惯性自主导航系统姿态、速度和位置信息的初始化； 第三步惯性导航解算模块进行导航解算 载车启动后，惯性导航解算模块接收三轴硅微陀螺仪和三轴硅微加速度计的数据，计算出载车在地理坐标系内的姿态、速度和位置； 第四步导航修正模块进行修正准备 导航修正模块接收导航解算模块输出的速度，并利用姿态转换矩阵将接收到的速度转换为车体的侧向速度和垂向速度； 转换公式为:
【文档编号】G01C21/20GK103712620SQ201310609301
【公开日】2014年4月9日 申请日期:2013年11月27日 优先权日:2013年11月27日
【发明者】高文劭 申请人:北京机械设备研究所