CN106840156B - 一种提高手机惯性导航性能的方法 - Google Patents
一种提高手机惯性导航性能的方法 Download PDFInfo
- Publication number
- CN106840156B CN106840156B CN201710194760.4A CN201710194760A CN106840156B CN 106840156 B CN106840156 B CN 106840156B CN 201710194760 A CN201710194760 A CN 201710194760A CN 106840156 B CN106840156 B CN 106840156B
- Authority
- CN
- China
- Prior art keywords
- mobile phone
- inertial navigation
- speed
- error
- tunnel
- 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 14
- 238000003908 quality control method Methods 0.000 claims abstract description 10
- 238000004364 calculation method Methods 0.000 claims description 7
- 230000009191 jumping Effects 0.000 claims 1
- 238000005516 engineering process Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000010801 machine learning Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- 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
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种提高手机惯性导航性能的方法,包括以下步骤:云端服务器计算出目标车辆本次的近似速度,播发给用户手机端;进行质量控制;判断推算的距离是否达到了隧道长度,如果是进行位置锁定;如果不是用户手机端利用卡尔曼滤波器计算得到误差,并对手机惯性导航进行修正,用户手机端输出目标车辆位置。本发明实现在线速度修正,并与地图匹配一起使用来提升手机惯性导航在隧道内的定位精度;实现手机非导航模式下的隧道定位,有效降低位置误差。
Description
技术领域
本发明涉及一种车载定位***定位方法,尤其涉及一种提高手机惯性导航性能的方法。
背景技术
手机惯性导航技术可以帮助手机在卫星信号丢失的环境中(比如隧道、地下车库)继续定位,提升手机定位的有效率,该技术主要利用手机内置MEMS传感器(三轴陀螺仪、三轴加速度计),通过捷联惯性导航的方式与GPS(Global Positioning System,全球定位***)定位进行松耦合,可以实现手机定位的无缝连接。由于传感器的器件本身存在误差,该误差会在卫星信号丢失的时间内不断的积累,使手机惯性导航的精度随着时间的增加而不断发散,目前提升手机惯性导航定位精度的方法主要有:里程计辅助、磁强计辅助、图像辅助等。但没有利用云端服务器计算出的车辆速度来提升手机惯性导航定位精度。
也有根据利用在线地图手机导航模式下隧道内进行定位,导航模式下隧道定位的技术原理主要是通过地图匹配和已经规划好的路线,还有进口隧道的速度,根据最简单的航位推算技术即用地图的航向信息和车辆进口隧道的速度信息进行二维的位置递推,从而实现隧道定位。但需要手机处于导航模式下,且事先要在手机上规划好路线。
发明内容
针对上述问题,本发明提出一种提高手机惯性导航性能的方法,包括以下步骤:
S1:云端服务器根据以往数据得到目标车辆经过隧道的速度模型以及隧道的长度,并计算出目标车辆本次经过同一个隧道的近似速度,云端服务器将近似速度和隧道长度通过互联网播发给用户手机端;
S2:用户手机端收到云端服务器播发的近似速度和隧道长度,进行质量控制,如果近似速度不满足质量控制,则返回步骤S1;
S3:判断用户手机端惯性导航推算的距离是否达到了隧道长度,如果是则执行步骤S5,如果不是则执行步骤S4;
S4:用户手机端利用卡尔曼滤波器计算得到误差,并对手机惯性导航进行修正,并跳转至步骤S6;
S5:进行位置锁定,并将定位点锁定在隧道口,直到目标车辆再次接收到GPS信号;
S6:用户手机端输出目标车辆位置。
按如下判断规则进行质量控制:
Vb/x<Va<Vb·X<k;
其中Va表示云端服务器播发的近似速度,vb表示目标车辆进隧道口的速度,x表示经验值系数,取值为3~5,k表示最大的限速,范围为180km/h~200km/h。
步骤S4包括以下步骤:
S41:进行卡尔曼滤波器计算,根据手机惯性导航推算的位置和地图匹配的位置之间的位置差,估计出手机惯性导航的位置误差,并按位置误差对手机惯性导航进行反馈修正;
S42:进行卡尔曼滤波器计算,利用云端服务器播发的近似速度与手机惯性导航推算的速度之间的差值估计出惯性导航的速度误差,并按速度误差对手机惯性导航进行反馈修正;
S43:进行卡尔曼滤波器计算,利用GPS给出的位置和速度与手机惯性导航推算的位置和速度之间的差值,估计手机出惯性导航的位置误差、速度误差、姿态误差、陀螺零偏误差、加速度计零偏误差,对手机惯性导航进行反馈修正。
本发明技术方案实现的有益效果:
本发明利用云端服务器经过机器学习得到车辆近似速度,以及云端服务器提前算好的隧道长度,通过互联网下发到手机端,实现在线速度修正,并与地图匹配一起使用来提升手机惯性导航在隧道内的定位精度。实现手机非导航模式下的隧道定位,有效降低位置误差,可以大幅度提升手机惯性导航在隧道、高架下、高楼旁、地下车库的定位精度。
附图说明
图1是本发明一种提高手机惯性导航性能的方法的流程图。
图2是本发明一种提高手机惯性导航性能的方法的原理图。
具体实施方式
下面结合附图和具体实施例,进一步阐述本发明,本发明实施例仅用以说明本发明的技术方案而非限制本发明的保护范围。
如图1所示,本发明提出一种提高手机惯性导航性能的方法,包括以下步骤:
包括以下步骤:
S1:云端服务器根据以往数据得到目标车辆经过隧道的速度模型以及隧道的长度,并计算出目标车辆本次经过同一个隧道的近似速度,云端服务器将近似速度和隧道长度通过互联网播发给用户手机端;
S2:用户手机端收到云端服务器播发的近似速度和隧道长度,进行质量控制,如果近似速度不满足质量控制,则返回步骤S1;
S3:判断用户手机端惯性导航推算的距离是否达到了隧道长度,如果是则执行步骤S5,如果不是则执行步骤S4;
S4:用户手机端利用卡尔曼滤波器计算得到误差,并对手机惯性导航进行修正,并跳转至步骤S6;
S5:进行位置锁定,并将定位点锁定在隧道口,直到目标车辆再次接收到GPS信号;
S6:用户手机端输出目标车辆位置。
按如下判断规则进行质量控制:
Vb/x<Va<Vb·x<k;
其中va表示云端服务器播发的近似速度,vb表示目标车辆进隧道口的速度,x表示经验值系数,取值为3~5,k表示最大的限速,范围为180km/h~200km/h。
如图2所示,步骤S4包括以下步骤:
S41:进行卡尔曼滤波器1计算,根据手机惯性导航推算的位置和地图匹配的位置之间的位置差,估计出手机惯性导航的位置误差,并按位置误差对手机惯性导航进行反馈修正,提高手机惯性导航的位置精度;
S42:进行卡尔曼滤波器2计算,利用云端服务器播发的近似速度与手机惯性导航推算的速度之间的差值估计出手机惯性导航的速度误差,并按速度误差对手机惯性导航进行反馈修正,提高手机惯性导航的速度精度;
S43:进行主卡尔曼滤波器计算,利用GPS给出的位置和速度与手机惯性导航推算的位置和速度之间的差值,估计出惯性导航的位置误差、速度误差、姿态误差、陀螺零偏误差、加速度计零偏误差,对手机惯性导航进行反馈修正,提高手机惯性导航的位置和速度精度。
卡尔曼滤波器1的输入是惯性导航和地图匹配的位置差,输出是惯性导航***的参数误差(参数包括位置、速度误差、姿态误差、陀螺零偏误差、加速度计零偏误差);
卡尔曼滤波器2的输入是云端服务器播发的速度和惯性导航速度的速度差,输出是惯性导航***的参数误差(参数包括位置、速度、姿态、陀螺零偏、加速度计零偏);
主卡尔曼滤波器的输入是GPS和惯性导航的位置误差和速度误差,输出是惯性导航***的参数误差(参数包括位置、速度、姿态、陀螺零偏、加速度计零偏)。
以下近似速度修正方程实现利用卡尔曼滤波器计算误差:
Zk=HkXk+ek
其中,ek表示随机测量噪声,Xk=(δrnδvnεnδbgyroδbacc)3×15,下标k表示k时刻,上标b表示载体坐标系,n表示导航坐标系,下标x、y、z表示载体坐标系x、y、z三个轴向,表示载体坐标系X轴速度误差,表示载体坐标系Y轴速度误差,表示载体坐标系Z轴速度误差,表示导航坐标系到载体坐标系的方向余弦矩阵,vn×表示导航坐标系速度的叉乘反对称矩阵,δrn表示导航坐标系位置误差,δvn表示导航坐标系速度误差,εn表示导航系姿态误差,δbgyro表示陀螺仪零偏误差,δbacc表示加速度计零偏误差。
如果只有在线速度修正和隧道长度的限制,手机惯性导航的性能只能减少纵向位置误差,而法向位置误差仍然存在,因此在线速度修正需要与地图匹配一起使用才能真正提高手机惯性导航的定位能力。
采用云端服务器下发的速度和隧道长度与惯性导航推算的速度进行卡尔曼滤波融合可以估计得到速度误差,对惯性导航速度进行反馈修正,提高前向速度精度,进而提高纵向位置精度,同时,采用在线地图匹配的结果对惯性导航的位置进行修正,可以提高法向位置精度,因此两者结合可以大幅度提升手机惯性导航在隧道内的性能。
Claims (2)
1.一种提高手机惯性导航性能的方法,其特征在于包括以下步骤:
S1:云端服务器根据以往数据得到目标车辆经过隧道的速度模型以及隧道长度,并计算出目标车辆本次经过同一个隧道的近似速度,所述云端服务器将所述近似速度和所述隧道长度通过互联网播发给用户手机端;
S2:所述用户手机端收到所述云端服务器播发的所述近似速度和所述隧道长度,进行质量控制,如果所述近似速度不满足所述质量控制,则返回步骤S1;
S3:判断所述用户手机端惯性导航推算的距离是否达到了所述隧道长度,如果是则执行步骤S5,如果不是则执行步骤S4;
S4:所述用户手机端利用卡尔曼滤波器计算得到误差,对手机惯性导航进行修正,并跳转至步骤S6;
S5:进行位置锁定,并将定位点锁定在所述隧道口,直到所述目标车辆再次接收到GPS信号;
S6:所述用户手机端输出所述目标车辆位置;
按如下判断规则进行所述质量控制:
vb/X<va<vb·X<k;
其中va表示所述云端服务器播发的所述近似速度,vb表示所述目标车辆进隧道口的速度,x表示经验值系数,取值为3~5,k表示最大的限速,范围为180km/h~200km/h。
2.根据权利要求1所述的提高手机惯性导航性能的方法,其特征在于所述步骤S4包括以下步骤:
S41:进行卡尔曼滤波器计算,根据所述用户手机惯性导航推算的位置和地图匹配的位置之间的位置差,估计出所述手机惯性导航的位置误差,并按所述位置误差对所述手机惯性导航进行反馈修正;
S42:进行卡尔曼滤波器计算,利用所述云端服务器播发的所述近似速度与所述手机惯性导航推算的速度之间的差值估计出所述手机惯性导航的速度误差,并按所述速度误差对所述手机惯性导航进行反馈修正;
S43:进行卡尔曼滤波器计算,利用GPS给出的位置和速度与所述手机惯性导航推算的位置和速度之间的差值,估计出所述手机惯性导航的位置误差、速度误差、姿态误差、陀螺零偏误差、加速度计零偏误差,对所述手机惯性导航进行反馈修正。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710194760.4A CN106840156B (zh) | 2017-03-28 | 2017-03-28 | 一种提高手机惯性导航性能的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710194760.4A CN106840156B (zh) | 2017-03-28 | 2017-03-28 | 一种提高手机惯性导航性能的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106840156A CN106840156A (zh) | 2017-06-13 |
CN106840156B true CN106840156B (zh) | 2019-03-12 |
Family
ID=59142838
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710194760.4A Active CN106840156B (zh) | 2017-03-28 | 2017-03-28 | 一种提高手机惯性导航性能的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106840156B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107943859B (zh) * | 2017-11-07 | 2021-07-30 | 千寻位置网络有限公司 | 海量传感器数据收集处理及反馈的***和方法 |
CN108121003A (zh) * | 2017-12-26 | 2018-06-05 | 湖南迈克森伟电子科技有限公司 | 组合导航精准定位*** |
CN113554890A (zh) * | 2021-06-30 | 2021-10-26 | 东风汽车集团股份有限公司 | 一种在隧道工况下基于5g通信的导航增强***及方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102928816A (zh) * | 2012-11-07 | 2013-02-13 | 东南大学 | 一种面向隧道环境的车辆高可靠组合定位方法 |
CN104020441A (zh) * | 2014-06-17 | 2014-09-03 | 东南大学 | 一种基于无线射频的隧道环境下车辆二维定位方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5372802B2 (ja) * | 2010-02-24 | 2013-12-18 | クラリオン株式会社 | トンネル内位置推定機能付きナビゲーション装置 |
CN103033184B (zh) * | 2011-09-30 | 2014-10-15 | 迈实电子(上海)有限公司 | 用于惯性导航***的纠错方法、装置和*** |
CN103499350B (zh) * | 2013-09-28 | 2016-01-27 | 长安大学 | Gps盲区下融合多源信息的车辆高精度定位方法及装置 |
CN106143367A (zh) * | 2015-04-27 | 2016-11-23 | 戴姆勒大中华区投资有限公司 | 一种隧道通过辅助*** |
US10304331B2 (en) * | 2015-06-25 | 2019-05-28 | Here Global B.V. | Method and apparatus for determining an estimated traffic congestion status of a tunnel based on probe data |
CN105628024B (zh) * | 2015-12-29 | 2018-09-04 | 中国电子科技集团公司第二十六研究所 | 基于多传感器融合的单人定位导航器和定位导航方法 |
-
2017
- 2017-03-28 CN CN201710194760.4A patent/CN106840156B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102928816A (zh) * | 2012-11-07 | 2013-02-13 | 东南大学 | 一种面向隧道环境的车辆高可靠组合定位方法 |
CN104020441A (zh) * | 2014-06-17 | 2014-09-03 | 东南大学 | 一种基于无线射频的隧道环境下车辆二维定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106840156A (zh) | 2017-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101628427B1 (ko) | 카메라를 이용한 추측항법 기반 네비게이션 시스템 및 그 제어방법 | |
Chang et al. | In-motion initial alignment for odometer-aided strapdown inertial navigation system based on attitude estimation | |
US8744644B2 (en) | Apparatus and method for detecting location of vehicle | |
CN109186597B (zh) | 一种基于双mems-imu的室内轮式机器人的定位方法 | |
CN110285804B (zh) | 基于相对运动模型约束的车辆协同导航方法 | |
CN113670334B (zh) | 一种飞行汽车的初始对准方法和装置 | |
CN106840156B (zh) | 一种提高手机惯性导航性能的方法 | |
JP6060642B2 (ja) | 自己位置推定装置 | |
CN111536972B (zh) | 一种基于里程计刻度系数修正的车载dr导航方法 | |
CN105318876A (zh) | 一种惯性里程计组合高精度姿态测量方法 | |
KR102441073B1 (ko) | 자이로 센싱값 보상 장치, 그를 포함한 시스템 및 그 방법 | |
US20170074678A1 (en) | Positioning and orientation data analysis system and method thereof | |
KR102331312B1 (ko) | 차량 내부 센서, 카메라, 및 gnss 단말기를 이용한 3차원 차량 항법 시스템 | |
CN109470276B (zh) | 基于零速修正的里程计标定方法与装置 | |
CN104864874A (zh) | 一种低成本单陀螺航位推算导航方法及*** | |
Liu et al. | Interacting multiple model UAV navigation algorithm based on a robust cubature Kalman filter | |
CN106646569B (zh) | 一种导航定位方法及设备 | |
Wang et al. | Land vehicle navigation using odometry/INS/vision integrated system | |
KR102622587B1 (ko) | 정밀측위 시스템의 종방향 위치 오차를 보정하기 위한 장치 및 방법 | |
Hu et al. | Kilometer sign positioning-aided INS/odometer integration for land vehicle autonomous navigation | |
WO2016098703A1 (ja) | 角速度センサ補正装置、角速度センサ補正方法、方位推定装置、方位推定方法 | |
KR20120084244A (ko) | 차량 위치 인식 장치 및 그 방법 | |
Kim et al. | High accurate affordable car navigation using built-in sensory data and images acquired from a front view camera | |
CN111566443A (zh) | 用道路几何和方向参数估计陆地交通工具导航数据的方法 | |
CN113048987A (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 | ||
CP02 | Change in the address of a patent holder |
Address after: 200438 9 / F, 10 / F, 11 / F, 12 / F, 38 Lane 1688, Guoquan North Road, Yangpu District, Shanghai Patentee after: QIANXUN SPATIAL INTELLIGENCE Inc. Address before: Room j165, 1st floor, building 64, 1436 Jungong Road, Yangpu District, Shanghai, 200433 Patentee before: QIANXUN SPATIAL INTELLIGENCE Inc. |
|
CP02 | Change in the address of a patent holder |