CN108827308B - 一种高精度行人室外定位***及方法 - Google Patents
一种高精度行人室外定位***及方法 Download PDFInfo
- Publication number
- CN108827308B CN108827308B CN201810603795.3A CN201810603795A CN108827308B CN 108827308 B CN108827308 B CN 108827308B CN 201810603795 A CN201810603795 A CN 201810603795A CN 108827308 B CN108827308 B CN 108827308B
- Authority
- CN
- China
- Prior art keywords
- data
- acceleration
- acc
- gps
- pedestrian
- 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
Images
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/20—Instruments for performing navigational calculations
-
- 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- 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/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
-
- 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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种基于惯性传感器和GPS数据融合的高精度行人室外定位***。该***基于智能手机或其他移动电子设备,使用设备内置的惯性传感器获取加速度、角速度,使用设备内置磁场传感器获取磁场数据,使用设备内置GPS信号接收器获取GPS数据,利用加速度数据的变化周期判断行人行走的步数,利用加速度数据、磁场数据和角速度数据计算当前行人的朝向,将步数和朝向结合计算行人移动轨迹,利用粒子滤波将惯性传感器数据计算的移动轨迹和GPS数据融合,最终得到高精度的定位结果。
Description
技术领域
本发明属于信号与数据处理技术,室外定位技术,传感器融合技术领域,涉及一种基于惯性传感器和GPS数据融合的高精度行人室外定位***及方法。
背景技术
根据世界卫生组织统计,全世界有2.85亿视觉障碍人士。视障人士损失了正常的视觉,对颜色、形状、距离、运动的理解都很困难,他们的生活在衣食住行等方面都受到了巨大的影响。在出行方面,视障人士的主要痛点在于无法精确确定自己的位置,这直接导致了他们在路口拐角处等出行关键点无法准确转向正确的方向,严重降低了他们的出行意愿。
传统的室外定位方法主要依靠GPS信号和地图路网数据。通过GPS接收器获取原始的带有一定误差经纬度信息,再结合路网的约束提高精度。这种方法可以满足汽车导航的需求,但是相比于汽车,行人运动的自由度更大,路网约束带来的定位精度提高有限,而且路网信息也不可能覆盖全部行人区域,无法给视障人士提供精准的定位服务。
导盲犬可以为视障人士提供更加完善的导航和避障帮助,同时兼有陪伴的作用,但导盲犬只适合在固定路线导航,无法带领盲人到达陌生的目的地。此外,导盲犬的养护、训练费用高昂,数量稀少,普通家庭也难以承担,不能惠及所有视障人士。
本方法基于广泛应用的惯性传感器,磁力计和GPS信号接收器,可以很方便的在智能手机、平板电脑等移动平台运行,也可以在智能眼镜、虚拟/增强现实等专用设备上运行,而且定位精度不受路网的条件的限制,非常适合视障人士日常定位、导航使用。
发明内容
本发明的目的在于针对现有技术的不足,提供一种基于惯性传感器和GPS 数据融合的高精度行人室外定位***及方法。
本发明的目的是通过以下技术方案实现的:一种基于惯性传感器和GPS数据融合的高精度行人室外定位***,所述***包含一个具有惯性传感器、磁力传感器和GPS接收器的移动电子设备。***首先从惯性传感器获取加速度和角速度数据,从磁力传感器获取磁场数据,从GPS信号接收器获取GPS定位数据。利用加速度数据的变化周期判断行人是否正在步行以及行走的步数,利用加速度数据、磁场数据和角速度数据计算当前行人运动的朝向,将步数和朝向结合计算行人短时间内的移动轨迹,利用粒子滤波将惯性传感器数据计算的移动轨迹和GPS数据融合,最终得到高精度的定位结果。
上述高精度定位***的定位方法如下:
(1)对惯性传感器,磁力计进行校准。
(2)连续采集三轴加速度数据Accx,Accy,Accz,三轴角速度数据 Gyrox,Gyroy,Gyroz,三轴磁场数据Magx,Magy,Magz,并将数据保存。
(3)计算最近一秒钟时间内的加速度向量的模长及其方差σAcc,如果方差小于0.01m2/s4,则判断行人当前处于静止状态;否则进一步计算最近一秒钟内加速度模长变化的周期τAcc以及这段时间的周期数N,N同时也是一秒钟内步行的步数。
(4)加速度计的测量结果可以看作对地球重力场方向和大小的测量,磁力计的测量结果可以看作对地球磁场方向和大小的测量。以重力场方向作为垂直于地面方向,以磁场方向作为正北方向,可以根据加速度计和磁力计的测量结果求得设备的绝对静态朝向θstatic。再利用三轴角速度积分求解设备动态朝向θdynamic,将两者计算的朝向利用互补滤波融合得到比较稳定的设备朝向θ。
(8)利用粒子滤波将GPS数据和实时更新的运动轨迹进行融合。计步器得到的运动轨迹作为***预测模型,GPS数据作为观测信息,最终得到高精度的定位结果。
本方法相比以往的定位方法优势主要在于:
1.定位精度更高。相比于用于传统的定位***,本方法定位精度更高,当视障人士达到路径的关键点,比如拐弯点、公交站点和斑马线和人行道交点时,配合使用的语音提示***可以发出更明确的指令让视障人士转向正确方向或躲避障碍。
2.定位速率更快。移动设备对传感器功耗有严格限制,因此GPS信号接收器的采样率大约在0.5Hz~1Hz。这样低的采样率无法实时反映视障人士的朝向。本方法输出的定位速率和惯性采样率相同,通常在30Hz以上,可以实时输出用户的位置和朝向,满足视障人士日常出行的定位需求。
3.在GPS信号弱的条件下也能正常工作。惯性传感器定位不需要接受外部信号,在GPS信号弱的情况下,本方法依然可以主要依靠惯性传感器实现定位。
4.无需专用设备。本方法只需要使用通用的惯性传感器,磁力计和GPS信号接收器即可工作,现代的智能手机、盲人辅助眼镜等设备均内置此类传感器,无需专门配置额外的硬件设备。
5.算法效率高。本方法基于粒子滤波进行数据融合,算法复杂度和粒子数目相关。在运算能力受限平台上运行时,只需要降低一些粒子的数目即可降低算法运行时间。
附图说明
图1为本发明室外定位方法流程图。
图2定位方法测试真实轨迹。
图3定位方法测试效果图。
具体实施方式
本发明包含一种基于惯性传感器和GPS数据融合的高精度行人室外定位***,涉及一种利用惯性传感器、磁力计和GPS信号接收器获取加速度、角速度、磁场强度和经纬度,利用朝向和姿态估计算法计算当前传感器的朝向,利用计步算法计算当前一段时间的运动步数,利用步长估计算法计算当前步行的平均步长,将步数、步长和朝向组合形成步伐向量并不断累加得到最近一段时间的计步轨迹,最终利用粒子滤波算法将GPS采集的经纬度和计步轨迹融合得到高精度定位结果的***。如图1所示,该***包含一个具有惯性传感器、磁力传感器和GPS接收器的智能手机或其他移动电子设备。***首先从惯性传感器获取加速度和角速度数据,从磁力传感器获取磁场数据,从GPS信号接收器获取 GPS定位数据。利用加速度数据的变化周期判断行人是否正在步行以及行走的步数,利用加速度数据、磁场数据和角速度数据计算当前行人运动的朝向,将步数和朝向结合计算行人短时间内的移动轨迹,利用粒子滤波将惯性传感器数据计算的移动轨迹和GPS数据融合,最终得到高精度的定位结果。
上述***的高精度室外定位方法如下:
(1)对惯性传感器,磁力传感器进行校准。
(2)连续采集三轴加速度数据Accx,Accy,Accz,三轴角速度数据 Gyrox,Gyroy,Gyroz,三轴磁场数据Magx,Magy,Magz,并将数据保存。
(3)计算最近一秒钟时间内的加速度向量的模长及其方差σAcc,如果方差小于0.01m2/s4,则判断行人当前处于静止状态;否则进一步计算最近一秒钟内加速度模长变化的周期τAcc以及这段时间的周期数N,N同时也是一秒钟内步行的步数。
(4)由于人在正常行走的过程中,惯性传感器中内嵌的MEMS加速度计采集得到的竖直方向的加速度远大于水平方向的加速度,因此,加速度计的测量结果可以看作对地球重力场方向和大小的测量,磁力计的测量结果可以看作对地球磁场方向和大小的测量。以重力场方向作为垂直于地面方向,以磁场方向作为正北方向,可以根据加速度计和磁力计的测量结果,采用最小化角度误差的方法,求得设备的绝对静态朝向θstatic。再利用三轴角速度积分求解设备动态朝向θdynamic,将两者计算的朝向利用互补滤波融合得到比较稳定的设备朝向θ。
(8)采集GPS经纬度。
(9)利用粒子滤波将GPS数据和实时更新的运动轨迹进行融合。计步器得到的运动轨迹作为***预测模型,GPS数据作为观测信息,最终得到高精度的定位结果。
佩戴有本发明所述定位***的测试人员,按照如图2所述的路径从起点走到终点,行走过程中,实时采用现有的GPS定位技术和本发明的定位技术进行定位,如图3所示,从图中可以看出,本发明的定位精度相比于现有技术有大大提高,几乎与实际路径吻合。
Claims (4)
1.一种行人室外定位***的高精度定位方法,其特征在于,所述***包含一个具有惯性传感器、磁力传感器和GPS接收器的移动电子设备;通过以下方法实现高精度定位:
(1)对惯性传感器,磁力计进行校准;
(2)惯性传感器连续采集三轴加速度数据Accx,Accy,Accz,三轴角速度数据Gyrox,Gyroy,Gyroz,磁力传感器连续采集三轴磁场数据Magx,Magy,Magz,并将数据保存;
(3)计算最近一秒钟时间内各个采样点的加速度向量的模长 及其方差σAcc,如果方差小于0.01m2/s4,则判断行人当前处于静止状态;否则进一步计算最近一秒钟内加速度模长变化的周期τAcc以及这段时间的周期数N,N同时也是一秒钟内步行的步数;
(4)将惯性传感器获得的加速度数据近似为重力场方向,磁力传感器获得的磁场数据近似为正北方向,根据加速度计和磁力计的测量结果求得设备的绝对静态朝向θstatic;再利用三轴角速度积分求解设备动态朝向θdynamic,将两者计算的朝向利用互补滤波融合得到比较稳定的设备朝向θ;
(5)将三轴加速度带入加速度-步长理论模型 粗略估计最近一秒钟运动的步长S,其中K1和K2为加速度-步长理论模型参数,Accavg,Accmax,Accmin分别为加速度模长|Acc|的平均值、最大值和最小值;
(8)利用粒子滤波将GPS信号接收器获取的GPS定位数据和实时更新的运动轨迹进行融合;计步器得到的运动轨迹作为***预测模型,GPS数据作为观测信息,最终得到高精度的定位结果。
2.根据权利要求1所述的方法,其特征在于,惯性传感器和磁力计的采样频率在30Hz以上。
3.根据权利要求1所述的方法,其特征在于,所述绝对静态朝向θstatic采用最小化角度误差的方法获得。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810603795.3A CN108827308B (zh) | 2018-06-12 | 2018-06-12 | 一种高精度行人室外定位***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810603795.3A CN108827308B (zh) | 2018-06-12 | 2018-06-12 | 一种高精度行人室外定位***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108827308A CN108827308A (zh) | 2018-11-16 |
CN108827308B true CN108827308B (zh) | 2020-09-01 |
Family
ID=64144830
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810603795.3A Active CN108827308B (zh) | 2018-06-12 | 2018-06-12 | 一种高精度行人室外定位***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108827308B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110068338A (zh) * | 2019-04-30 | 2019-07-30 | 杭州视氪科技有限公司 | 一种路线记忆***及方法 |
CN110657802B (zh) * | 2019-10-11 | 2021-12-21 | 北京航空航天大学 | 一种gps失效情况下的智能手环导航方法 |
CN113271537A (zh) * | 2021-05-20 | 2021-08-17 | 北京智慧图科技有限责任公司 | 一种混合室内定位*** |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103968827A (zh) * | 2014-04-09 | 2014-08-06 | 北京信息科技大学 | 一种可穿戴式人体步态检测的自主定位方法 |
CN104181500A (zh) * | 2014-08-19 | 2014-12-03 | 北京邮电大学 | 一种基于惯性信息和机会无线信号特征的实时定位方法 |
CN104819716A (zh) * | 2015-04-21 | 2015-08-05 | 北京工业大学 | 一种基于mems的ins/gps组合的室内外个人导航算法 |
CN105424041A (zh) * | 2016-01-18 | 2016-03-23 | 重庆邮电大学 | 一种基于bd/ins紧耦合的行人定位算法 |
CN105953794A (zh) * | 2016-04-26 | 2016-09-21 | 杭州欣晟达信息技术有限公司 | 一种基于mems传感器的计步导航方法 |
CN106949889A (zh) * | 2017-03-17 | 2017-07-14 | 南京航空航天大学 | 针对行人导航的低成本mems/gps组合导航***及方法 |
CN107613125A (zh) * | 2017-09-22 | 2018-01-19 | 常州大学 | 一种基于智能手机的盲人识别及引导式导盲的方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8380433B2 (en) * | 2008-09-24 | 2013-02-19 | Texas Instruments Incorporated | Low-complexity tightly-coupled integration filter for sensor-assisted GNSS receiver |
-
2018
- 2018-06-12 CN CN201810603795.3A patent/CN108827308B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103968827A (zh) * | 2014-04-09 | 2014-08-06 | 北京信息科技大学 | 一种可穿戴式人体步态检测的自主定位方法 |
CN104181500A (zh) * | 2014-08-19 | 2014-12-03 | 北京邮电大学 | 一种基于惯性信息和机会无线信号特征的实时定位方法 |
CN104819716A (zh) * | 2015-04-21 | 2015-08-05 | 北京工业大学 | 一种基于mems的ins/gps组合的室内外个人导航算法 |
CN105424041A (zh) * | 2016-01-18 | 2016-03-23 | 重庆邮电大学 | 一种基于bd/ins紧耦合的行人定位算法 |
CN105953794A (zh) * | 2016-04-26 | 2016-09-21 | 杭州欣晟达信息技术有限公司 | 一种基于mems传感器的计步导航方法 |
CN106949889A (zh) * | 2017-03-17 | 2017-07-14 | 南京航空航天大学 | 针对行人导航的低成本mems/gps组合导航***及方法 |
CN107613125A (zh) * | 2017-09-22 | 2018-01-19 | 常州大学 | 一种基于智能手机的盲人识别及引导式导盲的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108827308A (zh) | 2018-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105607104B (zh) | 一种基于gnss与ins的自适应导航定位***及方法 | |
Zeng et al. | Seamless pedestrian navigation methodology optimized for indoor/outdoor detection | |
Ban et al. | Indoor positioning method integrating pedestrian Dead Reckoning with magnetic field and WiFi fingerprints | |
Perttula et al. | Distributed indoor positioning system with inertial measurements and map matching | |
CN111174781B (zh) | 一种基于可穿戴设备联合目标检测的惯导定位方法 | |
CN107490378B (zh) | 一种基于mpu6050与智能手机的室内定位与导航的方法 | |
CN105241454A (zh) | 一种基于多传感器的行人导航***及导航方法 | |
CN109855621B (zh) | 一种基于uwb与sins的组合室内行人导航***及方法 | |
CN108827308B (zh) | 一种高精度行人室外定位***及方法 | |
CN107255474B (zh) | 一种融合电子罗盘和陀螺仪的pdr航向角确定方法 | |
Ladetto et al. | In step with INS navigation for the blind, tracking emergency crews | |
US20160238395A1 (en) | Method for indoor and outdoor positioning and portable device implementing such a method | |
CN111024075B (zh) | 一种结合蓝牙信标和地图的行人导航误差修正滤波方法 | |
CN108844533A (zh) | 一种基于多传感器融合和姿态解算的自由姿态pdr定位方法 | |
CN105865450A (zh) | 一种基于步态的零速更新方法及*** | |
KR20130059344A (ko) | 물체의 제로 속도 상태를 검출하는 방법 및 시스템 | |
US10670735B2 (en) | Determining vehicle orientation for enhanced navigation experience | |
CN110940344B (zh) | 一种用于自动驾驶的低成本传感器组合定位方法 | |
CN109459028A (zh) | 一种基于梯度下降的自适应步长估计方法 | |
US10999709B2 (en) | Method and system for determining a direction of movement of an object | |
CN104101341A (zh) | 移动终端间的定位方法及采用该方法的移动终端 | |
CN111174780B (zh) | 盲人道路惯导定位*** | |
CN103471586A (zh) | 一种传感器辅助的终端组合定位方法及装置 | |
Wu et al. | Indoor positioning system based on inertial MEMS sensors: Design and realization | |
CN113140132A (zh) | 一种基于5g v2x移动智能终端行人防碰撞预警***与方法 |
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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20200520 Address after: 9, 181, 310000, Wuchang Road, Wuchang Street, Yuhang District, Zhejiang, Hangzhou, 202-7 Applicant after: Hangzhou Huihui Technology Co., Ltd Address before: 9, 181, 310000, Wuchang Road, Wuchang Street, Yuhang District, Zhejiang, Hangzhou, 202-7 Applicant before: HANGZHOU KR-VISION TECHNOLOGY Co.,Ltd. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |