一种基于单位置基准点的里程计参数标定方法技术

本发明专利技术涉及一种基于单位置基准点的里程计参数标定方法，其技术特点是：步骤1、按照里程计标定参数建立模型，将里程计信号从里程计坐标系转换到惯性导航设备坐标系；步骤2、根据纯惯性导航解算结果、定位误差推算结果对纯惯性导航解算位置进行修正；步骤3、根据纯惯性导航解算位置修正结果及里程计推位计算结果，计算里程计标定参数。本发明专利技术设计合理，其通过纯惯性导航解算与位置修正方法进行高精度的定位精度，具有惯性导航系统短时间高精度定位能力，实现了里程计参数的标定功能，本发明专利技术仅需要一个位置基准点就可以完成车载里程计的参数标定，具有精度高、通用性强、便于实现等特点。点。点。

【技术实现步骤摘要】
一种基于单位置基准点的里程计参数标定方法


[0001]本专利技术属于惯性导航
，涉及惯性导航器件测试，尤其是一种基于单位置基准点的里程计参数标定方法。

技术介绍

[0002]陆用惯性导航系统与历程计组合的方式，可以实现高精度的定位定向功能。在组合过程中需要将里程计的参数转换到导航坐标系，转换过程需要提前对里程计的误差参数进行准确的标定。现有的里程计参数标定手段多采用两个位置基准点，从第一个基准点出发，到第二个基准点结束的方式进行标定，由于标定路径受限制，需要提前布设远距离基准点，停靠基准点要求高，不能实现里程计参数的快速便捷标定功能。

技术实现思路

[0003]本专利技术的目的在于克服现有技术的不足，提供一种设计合理、精度高且速度快的基于单位置基准点的里程计参数标定方法。
[0004]本专利技术解决现有的技术问题是采取以下技术方案实现的：
[0005]一种基于单位置基准点的里程计参数标定方法，包括以下步骤：
[0006]步骤1、按照里程计标定参数建立模型，将里程计信号从里程计坐标系转换到惯性导航设备坐标系；
[0007]步骤2、根据纯惯性导航解算结果、定位误差推算结果对纯惯性导航解算位置进行修正；
[0008]步骤3、根据纯惯性导航解算位置修正结果及里程计推位计算结果，计算里程计标定参数。
[0009]而且，所述步骤1的具体实现方法为：
[0010]首先，在里程计与惯性导航设备进行组合导航时，构建里程计误差模型，该里程计误差模型包括里程计标度因数δk
d
、方位安装误差δψ以及俯仰安装角误差δθ；
[0011]然后，将里程计信号ΔS从里程计坐标系d系转换到惯性导航设备坐标系b系，则从里程计坐标系转换到的惯性导航设备坐标系的方法如下：
[0012][0013]而且，所述步骤2的具体实现方法为：
[0014]首先采用对速度误差最小二乘拟合的方式进行拟合，进而积分计算纯惯性导航解算位置误差，通过在直线行驶过程中不定期的停车，记录停车时刻t
k
和对应的惯性解算速度v
k
，通过最小二乘拟合，拟合计算全程的速度误差公式：
[0015]δv
ins
＝Ab
[0016]其中：
[0017][0018]通过
[0019]b＝(A
T
A)
‑1A
T
δv
ins
[0020]得到速度误差的拟合公式：
[0021]δv
ins
＝b0+b1t+b2t2[0022]当行驶导航过程中无法进行停车操作时，上述模型可以退化为线性模型：
[0023][0024]其中v
k
和t
k
为最终结束停车时的导航时间和纯惯性导航速度误差；
[0025]通过对速度误差曲线进行积分，得到到达终点位置的定位补偿，对纯惯导解算的位置误差进行修正，实现短时间的高精度纯惯性导航定位精度；
[0026][0027]退化模型
[0028][0029]最后，得到纯惯性导航解算位置的修改结果为：
[0030][0031]而且，所述步骤3的具体实现方法为：
[0032]首先按下式计算基于里程计的系统定位：
[0033][0034][0035][0036]其中R
M
和R
N
分别为当地的地球子午圈于卯酉圈半径，另外：
[0037][0038][0039]R，P，H分别为惯导设备的横摇、纵摇和方位角；
[0040]然后按下式计算里程计标定参数中的标度因数δk
d
、方位安装误差δψ以及俯仰安装角误差δθ：
[0041][0042][0043][0044]其中S
ins
和S
d
分别对应，设备从起始点到终点的纯惯性解算修正位置误差后的位移矢量长度和里程计推位计算的位移矢量长度。
[0045]本专利技术的优点和积极效果是：
[0046]本专利技术设计合理，其通过纯惯性导航解算与位置修正方法进行高精度的定位精度，具有惯性导航系统短时间高精度定位能力，实现了里程计参数的标定功能，本专利技术仅需要一个位置基准点就可以完成车载里程计的参数标定，具有精度高、通用性强、便于实现等特点。
附图说明
[0047]图1为本专利技术的里程计参数标定方法流程图。
具体实施方式
[0048]以下结合附图对本专利技术实施例做进一步详述。
[0049]一种基于单位置基准点的里程计标定方法，如图1所示，包括以下步骤：
[0050]步骤1、将里程计信号从里程计坐标系转换到惯性导航设备坐标系，进行里程计推位计算。
[0051]在本步骤中，如果里程计与惯性导航设备进行组合导航，便需要对里程计的误差模型进行建模。常规的里程计误差模型包括三个参数，分别是里程计标度因数δk
d
、方位安装误差δψ以及俯仰安装角误差δθ。
[0052]本专利技术将里程计信号ΔS(位移增量)从里程计坐标系d系(满足右手坐标系定义，车辆前向为y轴正方向，垂直车辆水平面向上指天为z轴正方向，垂直于y轴和z轴构成平面，指向车辆右侧为x正方向)转换到惯性导航设备坐标系b系(满足右手坐标系定义，x
b
y
b
z
b
轴的指向与d系x
d
y
d
z
d
轴的指向基本一致)。
[0053]从里程计坐标系转换到的惯性导航设备坐标系的方法如下：
[0054][0055]步骤2、根据纯惯性导航解算结果、定位误差推算结果对纯惯性导航解算位置进行修正。其具体实现方法如下：
[0056]首先，固定点惯性导航系统完成初始对准，并记录初始位置P0；然后启动车辆开始进行纯惯性导航定位计算，在导航定位解算过程中需要保持车辆为直线单向行驶。
[0057]其中P0包括了当地经度、纬度和高度，表示如下：
[0058][0059]在本步骤中，位置修正方法采用对速度误差最小二乘拟合后进行积分的方式进行计算，通过在直线行驶过程中不定期的停车，记录停车时刻t
k
和对应的惯性解算速度v
k
，通过最小二乘拟合，拟合计算全程的速度误差公式：
[0060]δv
ins
＝Ab
[0061]其中：
[0062][0063]通过
[0064]b＝(A
T
A)
‑1A
T
δv
ins
[0065]得到速度误差的拟合公式：
[0066]δv
ins
＝b0+b1t+b2t2[0067]当行驶导航过程中无法进行停车操作时，上述拟合公式可以退化为线性模型：
[0068][0069]其中v
k<本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于单位置基准点的里程计参数标定方法，其特征在于：包括以下步骤：步骤1、按照里程计标定参数建立模型，将里程计信号从里程计坐标系转换到惯性导航设备坐标系；步骤2、根据纯惯性导航解算结果、定位误差推算结果对纯惯性导航解算位置进行修正；步骤3、根据纯惯性导航解算位置修正结果及里程计推位计算结果，计算里程计标定参数。2.根据权利要求1所述的一种基于单位置基准点的里程计参数标定方法，其特征在于：所述步骤1的具体实现方法为：首先，在里程计与惯性导航设备进行组合导航时，构建里程计误差模型，该里程计误差模型包括里程计标度因数δk
d
、方位安装误差δψ以及俯仰安装角误差δθ；然后，将里程计信号ΔS从里程计坐标系d系转换到惯性导航设备坐标系b系，则从里程计坐标系转换到的惯性导航设备坐标系的方法如下：3.根据权利要求1所述的一种基于单位置基准点的里程计参数标定方法，其特征在于：所述步骤2的具体实现方法为：首先采用对速度误差最小二乘拟合的方式进行拟合，进而积分计算纯惯性导航解算位置误差，通过在直线行驶过程中不定期的停车，记录停车时刻t
k
和对应的惯性解算速度v
k
，通过最小二乘拟合，拟合计算全程的速度误差公式：δv
ins
＝Ab其中：通过b＝(A
T
A)
‑1A
T
...

【专利技术属性】
技术研发人员：张君，刘赢，赵帅，
申请(专利权)人：中国船舶重工集团公司第七零七研究所，
类型：发明
国别省市：