CN104197958B - 一种基于激光测速仪航位推算系统的里程计标定方法 - Google Patents
一种基于激光测速仪航位推算系统的里程计标定方法 Download PDFInfo
- Publication number
- CN104197958B CN104197958B CN201410428012.4A CN201410428012A CN104197958B CN 104197958 B CN104197958 B CN 104197958B CN 201410428012 A CN201410428012 A CN 201410428012A CN 104197958 B CN104197958 B CN 104197958B
- Authority
- CN
- China
- Prior art keywords
- sigma
- dead reckoning
- laser velocimeter
- speedometer
- rsqb
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
Abstract
一种基于激光测速仪航位推算系统的里程计标定方法,它有八大步骤如下:一、将惯组、激光测速仪和里程计安装到载体上,系统上电启动;二、装订初始参数至导航计算机;三、采集和处理陀螺和加速度计的输出数据;并完成系统的粗对准和精对准;四、导航系统由对准模式切换到惯导/激光测速仪航位推算模式,运动过程中保持航位推算模式;五、采集保存激光测速仪与捷联惯导构成的航位推算系统输出的姿态矩阵和导航系下的速度以及里程计的速度输出;六、利用激光测速仪航位推算系统输出的姿态矩阵,将其在导航系下的速度转换成载体系下的速度;七、用最小二乘法辨识里程计的安装角及标度因数误差;八、标定精度评价分析。
Description
技术领域:
本发明涉及一种基于激光测速仪航位推算系统的里程计标定方法,属于惯性技术领域。
背景技术:
里程计是测量车辆行驶速度和路程的一种传感器,具有完全自主、精度高、测速范围宽、动态性能好、测量误差不随时间发散的优点。单独的里程计不具备导航定位功能,但是与惯导系统组合能优势互补,能实现全自主、高精度导航定位。
组合导航系统实际使用中捷联惯导系统和里程计分别装在载体的不同位置,需要标定里程计安装角,而且由于车轮周长受轮胎温度、充气压力以及表面磨损等因素的影响,需要同时对里程计标度因数误差进行标定。目前公开文献中用于导航定位领域的里程计并没有统一的标定方法,本文提出了一种里程计安装角和标度因数误差的标定方法。
发明内容:
1、目的:本发明的目的是提供了一种基于激光测速仪航位推算系统的里程计标定方法,它克服了现有技术的不足,解决了里程计装到载体上时需要标定安装角和标度因数误差的问题。
2、技术方案:
本发明一种基于激光测速仪航位推算系统的里程计标定方法,该方法具体步骤如下:
步骤1、将惯组、激光测速仪和里程计安装到载体上,系统上电启动。
步骤2、装订初始参数(包括初始的经度、纬度、高度、激光测速仪的标度、激光测速仪的安装角、里程计标度初值)至导航计算机。
步骤3、采集陀螺和加速度计的输出数据,对采集到的陀螺和加速度计数据进行处理,根据捷联惯导系统误差传播特性和古典控制理论,采用二阶调平和方位估算法来完成系统的粗对准,初步确定载体姿态角。粗对准时间为2分钟。粗对准后利用卡尔曼滤波技术精对准3分钟。
步骤4、导航系统由对准模式切换到惯导/激光测速仪航位推算模式,切换完成后载体开始运动,运动过程中保持航位推算模式。
步骤5、采集保存激光测速仪与捷联惯导构成的航位推算系统输出的姿态矩阵和导航系下的速度以及里程计的速度输出,至少采集保存三个不同时刻的数据。
步骤6、利用激光测速仪航位推算系统输出的姿态矩阵,将其在导航系下的速度转换成载体系下的速度。
步骤7、用最小二乘法辨识里程计的安装角及标度因数误差。
步骤8、标定精度评价分析。
其中,步骤6中所述“利用激光测速仪航位推算系统输出的姿态矩阵,将其在导航系下的速度转换成载体系下的速度”,进行过程说明如下:
分别为激光测速仪航位推算系统在导航系下的速度输出,分别为激光测速仪航位推算系统在载体系x、y、z三个轴向上的速度输出,为激光测速仪航位推算系统输出的姿态矩阵,导航系下的速度转换成载体下的速度公式如下:
其中,步骤7中所述“用最小二乘法辨识里程计的安装角和标度因数误差”,进行过程说明如下:
定义VDT为里程计理想速度输出,VD为里程计实际速度输出,分别为激光测速仪航位推算系统在载体系x、y、z三个轴向上的速度输出,δK为里程计标度因数误差,α、β、γ分别为里程计与载体系x、y、z三个轴向的夹角,即安装角。测得n个点(n≥3)里程计的速度输出VD(1)、VD(2)…VD(n)及n个点(n≥3)激光测速仪航位推算系统在载体系下的速度输出
VDT=(1+δK)VD
令 (i=1...n),由最小二乘法可得:
其中,步骤8中所述“标定精度评价分析”,进行过程说明如下:
将标定结果δK、α、β、γ代入
得
通过标准差计算公式(下式)计算 与激光测速仪航位推算系统在载体系x、y、z三个轴向上的输出 之间的离散程度,由此判断标定结果的精确度。
3、优点及功效:本发明一种基于激光测速仪航位推算系统的里程计标定方法,其优点是:相对目前公开的标定方法,用激光测速仪航位推算系统标定里程计不需要外部参考信息,无需停车标定,可进行在线标定。
附图说明
图1为里程计标定方法框图;
图2为本发明里程计标定方法的流程图。
图中符号说明如下:
Vn:激光测速仪航位推算系统在导航系下的速度输出
Vb:激光测速仪航位推算系统在载体系下的速度输出的
VD:里程计输出的速度
激光测速仪航位推算系统输出的姿态矩阵
α、β、γ:里程计与载体系x、y、z三个轴向的夹角,即安装角
δK:里程计标度因数误差
具体实施方式:
见图1、图2,本发明一种基于激光测速仪航位推算系统的里程计标定方法,该方法具体步骤如下:
步骤1、将惯组、激光测速仪和里程计安装到载体上,系统上电启动。
步骤2、装订初始参数(包括初始的经度、纬度、高度、激光测速仪的标度、激光测速仪的安装角、里程计标度初值)至导航计算机。
步骤3、采集陀螺和加速度计的输出数据,对采集到的陀螺和加速度计数据进行处理,根据捷联惯导系统误差传播特性和古典控制理论,采用二阶调平和方位估算法来完成系统的粗对准,初步确定载体姿态角。粗对准时间为2分钟。粗对准后利用卡尔曼滤波技术精对准3分钟。
步骤4、导航系统由对准模式切换到惯导/激光测速仪航位推算模式,切换完成后载体开始运动,运动过程中保持航位推算模式。
步骤5、采集保存激光测速仪与捷联惯导构成的航位推算系统输出的姿态矩阵和导航系下的速度以及里程计的速度输出,至少采集保存三个不同时刻的数据。
步骤6、利用激光测速仪航位推算系统输出的姿态矩阵,将其在导航系下的速度转换成载体系下的速度。
步骤7、用最小二乘法辨识里程计的安装角及标度因数误差。
步骤8、标定精度评价分析。
其中,步骤6中所述“利用激光测速仪航位推算系统输出的姿态矩阵,将其在导航系下的速度转换成载体系下的速度”进行过程说明如下:
分别为激光测速仪航位推算系统在导航系下的速度输出,分别为激光测速仪航位推算系统在载体系x、y、z三个轴向上的速度输出,为激光测速仪航位推算系统输出的姿态矩阵,导航系下的速度转换成载体下的速度公式如下:
其中,步骤7中所述“用最小二乘法辨识里程计的安装角和标度因数误差”进行过程说明如下:
定义VDT为里程计理想速度输出,VD为里程计实际速度输出,分别为激光测速仪航位推算系统在载体系x、y、z三个轴向上的速度输出,δK为里程计标度因数误差,α、β、γ分别为里程计与载体系x、y、z三个轴向的夹角,即安装角。测得n个点(n≥3)里程计的速度输出VD(1)、VD(2)…VD(n)及n个点(n≥3)激光测速仪航位推算系统在载体系下的速度
VDT=(1+δK)VD
令 由最小二乘法可得
其中,步骤8中所述“标定精度评价分析”进行过程说明如下:
将标定结果δK、α、β、γ代入
得
通过标准差计算公式(下式)计算 与激光测速仪航位推算系统在载体系x、y、z三个轴向上的速度 之间的离散程度,由此判断标定结果的精确度。
Claims (4)
1.一种基于激光测速仪航位推算系统的里程计标定方法,其特征在于:该方法具体步骤如下:
步骤1、将惯组、激光测速仪和里程计安装到载体上,系统上电启动;
步骤2、装订初始参数,包括初始的经度、纬度、高度、激光测速仪的标度、激光测速仪的安装角、里程计标度初值至导航计算机;
步骤3、采集陀螺和加速度计的输出数据,对采集到的陀螺和加速度计数据进行处理,根据捷联惯导系统误差传播特性和古典控制理论,采用二阶调平和方位估算法来完成系统的粗对准,初步确定载体姿态角,粗对准时间为2分钟,粗对准后利用卡尔曼滤波技术精对准3分钟;
步骤4、导航系统由对准模式切换到惯导/激光测速仪航位推算模式,切换完成后载体开始运动,运动过程中保持航位推算模式;
步骤5、采集保存激光测速仪与捷联惯导构成的航位推算系统输出的姿态矩阵和导航系下的速度以及里程计的速度输出,至少采集保存三个不同时刻的数据;
步骤6、利用激光测速仪航位推算系统输出的姿态矩阵,将其在导航系下的速度转换成载体系下的速度;
步骤7、用最小二乘法辨识里程计的安装角及标度因数误差;
步骤8、标定精度评价分析。
2.根据权利要求1所述的一种基于激光测速仪航位推算系统的里程计标定方法,其特征在于:步骤6中所述“利用激光测速仪航位推算系统输出的姿态矩阵,将其在导航系下的速度转换成载体系下的速度”进行过程说明如下:
分别为激光测速仪航位推算系统在导航系下的速度输出,分别为激光测速仪航位推算系统在载体系x、y、z三个轴向上的速度输出,为激光测速仪航位推算系统输出的姿态矩阵,导航系下的速度转换成载体下的速度公式如下:
3.根据权利要求1所述的一种基于激光测速仪航位推算系统的里程计标定方法,其特征在于:步骤7中所述“用最小二乘法辨识里程计的安装角及标度因数误差”,进行过程说明如下:
定义VDT为里程计理想速度输出,VD为里程计实际速度输出,分别为激光测速仪航位推算系统在载体系x、y、z三个轴向上的速度输出,δK为里程计标度因数误差,α、β、γ分别为里程计与载体系x、y、z三个轴向的夹角,即安装角,测得n个点(n≥3)里程计的速度输出VD(1)、VD(2)…VD(n)及n个点(n≥3)激光测速仪航位推算系统在载体系下的速度输出
VDT=(1+δK)VD
令由最小二乘法得:
4.根据权利要求3所述的一种基于激光测速仪航位推算系统的里程计标定方法,其特征在于:将标定结果δK、α、β、γ代入
得
通过标准差计算公式计算 与激光测速仪航位推算系统在载体系x、y、z三个轴向上的输出 之间的离散程度,由此判断标定结果的精确度;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410428012.4A CN104197958B (zh) | 2014-08-27 | 2014-08-27 | 一种基于激光测速仪航位推算系统的里程计标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410428012.4A CN104197958B (zh) | 2014-08-27 | 2014-08-27 | 一种基于激光测速仪航位推算系统的里程计标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104197958A CN104197958A (zh) | 2014-12-10 |
CN104197958B true CN104197958B (zh) | 2017-01-25 |
Family
ID=52083286
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410428012.4A Expired - Fee Related CN104197958B (zh) | 2014-08-27 | 2014-08-27 | 一种基于激光测速仪航位推算系统的里程计标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104197958B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104864889B (zh) * | 2015-05-29 | 2018-05-29 | 山东鲁能智能技术有限公司 | 一种基于视觉的机器人里程计校正系统及方法 |
CN104977004B (zh) * | 2015-07-13 | 2017-08-18 | 湖北航天技术研究院总体设计所 | 一种激光惯组与里程计组合导航方法及系统 |
CN106767894B (zh) * | 2015-11-20 | 2019-11-15 | 北方信息控制集团有限公司 | 一种用于捷联惯导的北斗/里程计组合标定方法 |
CN110333513B (zh) * | 2019-07-10 | 2023-01-10 | 国网四川省电力公司电力科学研究院 | 一种融合最小二乘法的粒子滤波slam方法 |
CN112013843B (zh) * | 2020-09-18 | 2023-11-17 | 中国人民解放军32202部队 | 一种惯导与车辆中央充放气系统融合的里程因数修正方法 |
CN112762961B (zh) * | 2020-12-28 | 2022-06-03 | 厦门华源嘉航科技有限公司 | 一种车载惯性里程计组合导航在线标定方法 |
CN114136339B (zh) * | 2021-11-29 | 2023-06-20 | 中国船舶重工集团公司第七0七研究所 | 一种基于单位置基准点的里程计参数标定方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102435206A (zh) * | 2011-09-01 | 2012-05-02 | 中国航空工业第六一八研究所 | 捷联惯导系统机上安装偏角的自动标定及补偿方法 |
CN102519485A (zh) * | 2011-12-08 | 2012-06-27 | 南昌大学 | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 |
CN103047996A (zh) * | 2012-12-20 | 2013-04-17 | 埃泰克汽车电子(芜湖)有限公司 | 一种车辆里程计算系统及其计算方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000348423A (ja) * | 1999-06-07 | 2000-12-15 | Sony Corp | ディスク状記録媒体の特性測定装置および特性測定方法 |
US6836238B1 (en) * | 2001-10-09 | 2004-12-28 | Escort Inc. | Police radar/laser detector with integral vehicle parameter display using a vehicle interface |
-
2014
- 2014-08-27 CN CN201410428012.4A patent/CN104197958B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102435206A (zh) * | 2011-09-01 | 2012-05-02 | 中国航空工业第六一八研究所 | 捷联惯导系统机上安装偏角的自动标定及补偿方法 |
CN102519485A (zh) * | 2011-12-08 | 2012-06-27 | 南昌大学 | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 |
CN103047996A (zh) * | 2012-12-20 | 2013-04-17 | 埃泰克汽车电子(芜湖)有限公司 | 一种车辆里程计算系统及其计算方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104197958A (zh) | 2014-12-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104197958B (zh) | 一种基于激光测速仪航位推算系统的里程计标定方法 | |
CN104165641B (zh) | 一种基于捷联惯导/激光测速仪组合导航系统的里程计标定方法 | |
CN106595715B (zh) | 基于捷联惯导与卫星组合导航系统里程计标定方法及装置 | |
EP2519803B1 (en) | Technique for calibrating dead reckoning positioning data | |
CN104180821B (zh) | 一种基于同步测量与定位计算的里程计标定方法 | |
CN104061899B (zh) | 一种基于卡尔曼滤波的车辆侧倾角与俯仰角估计方法 | |
CN101907714B (zh) | 基于多传感器数据融合的gps辅助定位方法 | |
CN110631593A (zh) | 一种用于自动驾驶场景的多传感器融合定位方法 | |
CN104359492B (zh) | 惯性导航和轮速计组成的航迹推算定位系统误差估算算法 | |
CN103162689B (zh) | 辅助车载定位系统及车辆的辅助定位方法 | |
CN109249934A (zh) | 一种轮胎磨损参数计算方法、系统及装置 | |
CN106842271B (zh) | 导航定位方法及装置 | |
CN104567931A (zh) | 一种室内惯性导航定位的航向漂移误差消除方法 | |
CN102508278A (zh) | 一种基于观测噪声方差阵估计的自适应滤波方法 | |
CN109870173A (zh) | 一种基于校验点的海底管道惯性导航系统的轨迹修正方法 | |
CN104864874B (zh) | 一种低成本单陀螺航位推算导航方法及系统 | |
CN101556160B (zh) | 可车速信号自学习的车载导航系统及方法 | |
CN104075699A (zh) | 三维固态电子罗盘及其传感器的零点和比例系数核正方法 | |
CN105424040A (zh) | 一种新型mems惯性传感器阵列余度配置方法 | |
CN205940567U (zh) | 一种车载组合导航定位系统 | |
CN104215262A (zh) | 一种惯性导航系统惯性传感器误差在线动态辨识方法 | |
CN102650693A (zh) | 导航仪的导航用里程计量信号的校正方法 | |
CN109470276A (zh) | 基于零速修正的里程计标定方法与装置 | |
CN112731483A (zh) | 一种自动驾驶组合导航系统中rtk异常值的判断方法 | |
CN107462242A (zh) | 车辆测速方法及其装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170125 Termination date: 20180827 |