CN113484542B - 一种用于三维测速仪的单点快速标定方法 - Google Patents
一种用于三维测速仪的单点快速标定方法 Download PDFInfo
- Publication number
- CN113484542B CN113484542B CN202110763968.XA CN202110763968A CN113484542B CN 113484542 B CN113484542 B CN 113484542B CN 202110763968 A CN202110763968 A CN 202110763968A CN 113484542 B CN113484542 B CN 113484542B
- Authority
- CN
- China
- Prior art keywords
- velocimeter
- dimensional
- navigation
- calibration
- uncalibrated
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000004364 calculation method Methods 0.000 claims abstract description 12
- 238000009434 installation Methods 0.000 claims description 15
- 239000011159 matrix material Substances 0.000 claims description 15
- 238000005070 sampling Methods 0.000 claims description 6
- 239000013598 vector Substances 0.000 claims description 3
- 238000009825 accumulation Methods 0.000 abstract 1
- 238000001914 filtration Methods 0.000 description 2
- 238000005299 abrasion Methods 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000004164 analytical calibration Methods 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
- G01P21/02—Testing or calibrating of apparatus or devices covered by the preceding groups of speedometers
Abstract
本发明涉及一种用于三维测速仪的单点快速标定方法,属于组合导航领域。本发明包括:建立参考坐标系;求未标定测速仪与已标定测速仪在导航系下的定位误差;求标定时段内,未标定测速仪与惯导组合导航所产生的定位误差;对组合导航定位误差表达式进行离散化处理;在标定时段的组合导航算法中进行累加计算,求解欠定方程组的最小范数解,得到测速仪标定参数。本发明利用测线上的单个高精度三维参考坐标点实现测速仪全部标定参数的快速计算,使惯导/测速仪自主组合导航系统摆脱了对GNSS的持续依赖,无需单独规划标定测线、执行特定机动和离线处理,不停车即可直接开展与高精度惯导/测速仪车载组合导航相关的任务,对一维、二维、三维测速仪均适用。
Description
技术领域:
本发明属于组合导航领域,特别是涉及一种用于三维测速仪的单点快速标定方法。
背景技术:
惯导与测速仪组成的车载组合导航系统具有自主性和隐蔽性强的特点,有较高的军事应用价值。但测速仪输出的是自身坐标系下的速度,在与惯导进行组合导航解算之前,须利用坐标转换关系投影到导航坐标系中。由于安装时无法保证测速仪坐标系与惯导体坐标系完全重合,并且路面情况、车辆载重、车胎充气和磨损等因素会造成测速仪刻度因子误差,为保证惯导/测速仪车载组合导航的定位精度,需要在实际使用之前标定测速仪与惯导之间的姿态安装误差角和测速仪的刻度因子误差。
目前比较经典的测速仪标定方法有解析标定法、滤波标定法、速度标定法等。解析标定法需要单独规划一段具有一定长度的直线标定测线,经离线处理后再代入后续的组合导航中,并且标定时的车辆状态和路况环境与实际应用时的车况和路况均存在差别,预先标定与实际使用时参数的差异导致该方法精度受限,较为不便;滤波标定法以惯导系统速度与测速仪速度之差作为观测量,虽可实现测速仪的在线标定,但受状态量可观测度的影响需要车辆进行特定的机动,其标定精度有限;速度标定法需要连续的高精度外部参考速度信息,一般由差分GNSS(Global Navigation Satellite System,全球导航卫星系统)提供,因此对卫星导航具有一定的依赖性。三种经典的标定方法还存在一个共同的问题:三种方法针对的均是一维测速仪,无法对输出三向速度的三维测速仪进行标定,也无法标定测速仪与惯导之间的横滚安装误差角。
发明内容:
针对上述问题,本发明提供了一种用于三维测速仪的单点快速标定方法。在对测速仪进行标定时,不用单独规划直线标定测线,不用进行特定机动,也不需要连续的GNSS信号,仅利用测线上的一个外部高精度三维参考坐标点,便可实现测速仪横滚安装误差角、俯仰安装误差角、航向安装误差角和刻度因子等全部标定参数的快速计算,不用停车即可直接开展高精度惯导/测速仪车载组合导航任务。此外,本方法能够对输出三向速度的三维测速仪进行标定,同样适用于一维测速仪和二维测速仪,只要将无速度输出的通道置零即可。
本发明的目的通过以下步骤实现:
步骤一、建立参考坐标系:导航系n系取北-东-地坐标系,相应的,惯导体坐标系b系取前-右-下坐标系,测速仪坐标系m系取前-右-下坐标系;
步骤二、求未标定测速仪与已标定测速仪在n系下的速度误差δvn的表达式,其中,未标定的测速仪速度在n系下的投影是存在误差的,用表示,其中,/>为惯导姿态矩阵,vm为m系下测速仪的输出速度;已标定的测速仪速度在n系下的投影是准确的,用表示,其中,K为刻度因子,/>为m系与b系之间的姿态转移矩阵;未标定测速仪与已标定测速仪在n系下的速度误差/>整理并将标定参数作为列向量单独提出,以得到未标定测速仪的速度误差表达式:
其中,为惯导姿态矩阵,K为刻度因子,/>为m系与b系之间的姿态转移矩阵,α,β,γ分别对应着横滚安装误差角、俯仰安装误差角和航向安装误差角,η×为[α β γ]T构成的斜对称矩阵,vm为m系下测速仪的输出速度,/>为m系下测速仪输出的前-右-下三向速度;本发明同样适用于一维测速仪和二维测速仪,使用时只需将无速度输出的通道置零即可;
步骤三、以外部高精度三维参考坐标点为基准,求标定时段内,未标定测速仪与惯导组合导航所产生的定位误差;记车辆开始运动时刻为t0,获得外部高精度三维参考坐标点的时刻为t1,标定时段为[t0,t1];在标定时段,以未标定测速仪输出的速度与惯导直接进行组合导航将产生定位误差,将其表示为:
其中,△pn为t1时刻未标定的测速仪组合导航定位结果与外部高精度三维参考坐标点的位置误差,δbn为[t0,t1]标定时段中每个时刻产生的位置偏移量,由每个时刻未标定测速仪所产生的速度误差δvn与测速仪采样周期T相乘得到;外部高精度三维参考坐标点可以由GNSS提供,也可以由事先测定的高精度路标点提供;
步骤四、对组合导航定位误差表达式进行离散化处理,将公式(1)代入公式(2),并进行离散化,得到如下表达式:
其中,T为测速仪的采样周期;
令
步骤五、在标定时段的组合导航算法中进行公式(4)的累加计算,在t1时刻计算△pn,公式(3)是欠定方程组,求解其最小范数解,求得测速仪的标定参数:
本发明的有益效果是:
本发明仅利用测线上的一个高精度三维参考坐标点,便可实现测速仪全部标定参数的快速计算。计算所需的各项参数可实时通过惯导和测速仪的输出获得,不需要进行整段数据的存储。本发明使车载惯导/测速仪自主组合导航系统摆脱了对GNSS的持续依赖,无需单独规划标定测线、执行特定机动和离线处理,不停车即可直接开展与高精度惯导/测速仪车载组合导航相关的任务。本发明能够适用于一维测速仪、二维测速仪和三维测速仪。
附图说明:
图1为本发明的流程图。
具体实施方式:
下面将通过实施例对本发明的技术方案进行清楚、完整地描述。
如图1所示,本发明一种用于三维测速仪的单点快速标定方法包括如下步骤:
步骤一、建立参考坐标系:导航系n系取北-东-地坐标系,相应的,惯导体坐标系b系取前-右-下坐标系,测速仪坐标系m系取前-右-下坐标系;
步骤二、求未标定测速仪与已标定测速仪在n系下的速度误差δvn的表达式,其中,未标定的测速仪速度在n系下的投影是存在误差的,用表示,其中,/>为惯导姿态矩阵,vm为m系下测速仪的输出速度;已标定的测速仪速度在n系下的投影是准确的,用表示,其中,K为刻度因子,/>为m系与b系之间的姿态转移矩阵;未标定测速仪与已标定测速仪在n系下的速度误差/>整理并将标定参数作为列向量单独提出,以得到未标定测速仪的速度误差表达式:
其中,为惯导姿态矩阵,K为刻度因子,/>为m系与b系之间的姿态转移矩阵,α,β,γ分别对应着横滚安装误差角、俯仰安装误差角和航向安装误差角,η×为[α β γ]T构成的斜对称矩阵,vm为m系下测速仪的输出速度,/>为m系下测速仪输出的前-右-下三向速度;本发明同样适用于一维测速仪和二维测速仪,使用时只需将无速度输出的通道置零即可;
步骤三、以外部高精度三维参考坐标点为基准,求标定时段内,未标定测速仪与惯导组合导航所产生的定位误差;记车辆开始运动时刻为t0,获得外部高精度三维参考坐标点的时刻为t1,标定时段为[t0,t1];在标定时段,以未标定测速仪输出的速度与惯导直接进行组合导航将产生定位误差,将其表示为:
其中,△pn为t1时刻未标定的测速仪组合导航定位结果与外部高精度三维参考坐标点的位置误差,δbn为[t0,t1]标定时段中每个时刻产生的位置偏移量,由每个时刻未标定测速仪所产生的速度误差δvn与测速仪采样周期T相乘得到;外部高精度三维参考坐标点可以由GNSS提供,也可以由事先测定的高精度路标点提供;
步骤四、对组合导航定位误差表达式进行离散化处理,将公式(1)代入公式(2),并进行离散化,得到如下表达式:
其中,T为测速仪的采样周期;
令
步骤五、在标定时段的组合导航算法中进行公式(4)的累加计算,在t1时刻计算△pn,公式(3)是欠定方程组,求解其最小范数解,求得测速仪的标定参数:
本发明具有计算简便、使用外部参考信息少、适用面广、工程实用性强等优点。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (3)
1.一种用于三维测速仪的单点快速标定方法,其特征在于,包括如下步骤:
步骤一、建立参考坐标系:导航系n系取北-东-地坐标系,相应的,惯导体坐标系b系取前-右-下坐标系,测速仪坐标系m系取前-右-下坐标系;
步骤二、求未标定测速仪与已标定测速仪在n系下的速度误差δvn的表达式,其中,未标定的测速仪速度在n系下的投影是存在误差的,用表示,其中,/>为惯导姿态矩阵,vm为m系下测速仪的输出速度;已标定的测速仪速度在n系下的投影是准确的,用表示,其中,K为刻度因子,/>为m系与b系之间的姿态转移矩阵;未标定测速仪与已标定测速仪在n系下的速度误差/>整理并将标定参数作为列向量单独提出,以得到未标定测速仪的速度误差表达式:
其中,为惯导姿态矩阵,K为刻度因子,/>为m系与b系之间的姿态转移矩阵,α,β,γ分别对应着横滚安装误差角、俯仰安装误差角和航向安装误差角,η×为[αβγ]T构成的斜对称矩阵,vm为m系下测速仪的输出速度,/>为m系下测速仪输出的前-右-下三向速度;
步骤三、以外部高精度三维参考坐标点为基准,求标定时段内,未标定测速仪与惯导组合导航所产生的定位误差;记车辆开始运动时刻为t0,获得外部高精度三维参考坐标点的时刻为t1,标定时段为[t0,t1];在标定时段,以未标定测速仪输出的速度与惯导直接进行组合导航将产生定位误差,将其表示为:
其中,△pn为t1时刻未标定的测速仪组合导航定位结果与外部高精度三维参考坐标点的位置误差,δbn为[t0,t1]标定时段中每个时刻产生的位置偏移量,由每个时刻未标定测速仪所产生的速度误差δvn与测速仪采样周期T相乘得到;
步骤四、对组合导航定位误差表达式进行离散化处理,将公式(1)代入公式(2),并进行离散化,得到如下表达式:
其中,T为测速仪的采样周期;
令
步骤五、在标定时段的组合导航算法中进行公式(4)的累加计算,在t1时刻计算△pn,公式(3)是欠定方程组,求解其最小范数解,求得测速仪的标定参数:
2.如权利要求1所述的一种用于三维测速仪的单点快速标定方法,其特征在于,所述方法用于一维测速仪或二维测速仪使用时将无速度输出的通道置零。
3.如权利要求1所述的一种用于三维测速仪的单点快速标定方法,其特征在于,所述步骤三中的外部高精度三维参考坐标点由GNSS提供或由事先测定的高精度路标点提供。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110763968.XA CN113484542B (zh) | 2021-07-06 | 2021-07-06 | 一种用于三维测速仪的单点快速标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110763968.XA CN113484542B (zh) | 2021-07-06 | 2021-07-06 | 一种用于三维测速仪的单点快速标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113484542A CN113484542A (zh) | 2021-10-08 |
CN113484542B true CN113484542B (zh) | 2023-09-19 |
Family
ID=77940611
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110763968.XA Active CN113484542B (zh) | 2021-07-06 | 2021-07-06 | 一种用于三维测速仪的单点快速标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113484542B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114396965A (zh) * | 2022-01-17 | 2022-04-26 | 广州导远电子科技有限公司 | 一种组合导航单元的辅助标定方法、装置、电子设备 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1999032852A1 (de) * | 1997-12-22 | 1999-07-01 | Litef Gmbh | Selbsttätige, schnelle kalibrierung einer bordautonomen messung eines geschwindigkeitsvektors |
US6240367B1 (en) * | 1998-11-27 | 2001-05-29 | Ching-Fang Lin | Full fusion positioning method for vehicle |
CN101017098A (zh) * | 2007-02-09 | 2007-08-15 | 江苏新科数字技术有限公司 | Gps/ins组合定位导航系统的角度检测校正方法 |
KR20190003916A (ko) * | 2017-06-30 | 2019-01-10 | 현대엠엔소프트 주식회사 | 항법용 관성센서 캘리브레이션 방법 |
CN110763872A (zh) * | 2019-11-21 | 2020-02-07 | 中国船舶重工集团公司第七0七研究所 | 一种多普勒测速仪多参数在线标定方法 |
CN111323050A (zh) * | 2020-03-19 | 2020-06-23 | 哈尔滨工程大学 | 一种捷联惯导和多普勒组合系统标定方法 |
CN112378400A (zh) * | 2020-10-30 | 2021-02-19 | 湖南航天机电设备与特种材料研究所 | 一种双天线gnss辅助的捷联惯导组合导航方法 |
CN112762961A (zh) * | 2020-12-28 | 2021-05-07 | 厦门华源嘉航科技有限公司 | 一种车载惯性里程计组合导航在线标定方法 |
-
2021
- 2021-07-06 CN CN202110763968.XA patent/CN113484542B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1999032852A1 (de) * | 1997-12-22 | 1999-07-01 | Litef Gmbh | Selbsttätige, schnelle kalibrierung einer bordautonomen messung eines geschwindigkeitsvektors |
US6240367B1 (en) * | 1998-11-27 | 2001-05-29 | Ching-Fang Lin | Full fusion positioning method for vehicle |
CN101017098A (zh) * | 2007-02-09 | 2007-08-15 | 江苏新科数字技术有限公司 | Gps/ins组合定位导航系统的角度检测校正方法 |
KR20190003916A (ko) * | 2017-06-30 | 2019-01-10 | 현대엠엔소프트 주식회사 | 항법용 관성센서 캘리브레이션 방법 |
CN110763872A (zh) * | 2019-11-21 | 2020-02-07 | 中国船舶重工集团公司第七0七研究所 | 一种多普勒测速仪多参数在线标定方法 |
CN111323050A (zh) * | 2020-03-19 | 2020-06-23 | 哈尔滨工程大学 | 一种捷联惯导和多普勒组合系统标定方法 |
CN112378400A (zh) * | 2020-10-30 | 2021-02-19 | 湖南航天机电设备与特种材料研究所 | 一种双天线gnss辅助的捷联惯导组合导航方法 |
CN112762961A (zh) * | 2020-12-28 | 2021-05-07 | 厦门华源嘉航科技有限公司 | 一种车载惯性里程计组合导航在线标定方法 |
Non-Patent Citations (2)
Title |
---|
一种激光多普勒测速仪辅助捷联惯导在线标定方法;潘建业;张春熹;刘春红;;导航与控制(06);全文 * |
激光多普勒测速仪在线标定算法;崔耀星;汤建勋;聂晓明;;传感器与微系统(01);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113484542A (zh) | 2021-10-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107588769B (zh) | 一种车载捷联惯导、里程计及高程计组合导航方法 | |
CA2104716C (en) | Method for calibrating inertial navigation instruments of aircraft | |
Fu et al. | High-accuracy SINS/LDV integration for long-distance land navigation | |
CN107655493B (zh) | 一种光纤陀螺sins六位置系统级标定方法 | |
CN111551175B (zh) | 一种航姿参考系统的互补滤波姿态解算方法 | |
CN109870173A (zh) | 一种基于校验点的海底管道惯性导航系统的轨迹修正方法 | |
CN110631574B (zh) | 一种惯性/里程计/rtk多信息融合方法 | |
CN110361031B (zh) | 一种基于回溯理论的imu全参数误差快速标定方法 | |
US4347573A (en) | Land-vehicle navigation system | |
CN104197958B (zh) | 一种基于激光测速仪航位推算系统的里程计标定方法 | |
CN106595715A (zh) | 基于捷联惯导/卫星组合导航系统里程计标定方法及装置 | |
CN103968844B (zh) | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 | |
CN109708663B (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 | |
CN113484542B (zh) | 一种用于三维测速仪的单点快速标定方法 | |
JP2021518529A (ja) | 車両に装備されたジャイロメータの較正方法 | |
JP3783257B2 (ja) | ナビゲーション装置 | |
CN104297525A (zh) | 基于火箭橇试验的惯性测量系统加速度计标定方法 | |
JPH04231813A (ja) | 角度および角度特性曲線の測定方法 | |
CN115371706A (zh) | 一种基于罗德里格斯参数的李群捷联惯导误差模型统一式 | |
JPH0949737A (ja) | 航法信号出力方法 | |
CN114111767A (zh) | 基于多信息融合对线路设计线型进行优化的方法 | |
CN113048987A (zh) | 一种车载导航系统定位方法 | |
CN111750846A (zh) | 一种船用罗经及其动态校准方法 | |
CN112985426B (zh) | 一种用于二轮车的定位方法 | |
CN113503882B (zh) | 一种车载惯性/地磁组合导航方法及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |