CN110986997A - 一种提高室内惯性导航精度的方法及*** - Google Patents

一种提高室内惯性导航精度的方法及*** Download PDF

Info

Publication number
CN110986997A
CN110986997A CN201911021468.8A CN201911021468A CN110986997A CN 110986997 A CN110986997 A CN 110986997A CN 201911021468 A CN201911021468 A CN 201911021468A CN 110986997 A CN110986997 A CN 110986997A
Authority
CN
China
Prior art keywords
inertial navigation
navigation
indoor
inertial
current position
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.)
Pending
Application number
CN201911021468.8A
Other languages
English (en)
Inventor
徐强
韩业强
白少伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hangzhou Shiyu Technology Co ltd
Original Assignee
Hangzhou Shiyu Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hangzhou Shiyu Technology Co ltd filed Critical Hangzhou Shiyu Technology Co ltd
Priority to CN201911021468.8A priority Critical patent/CN110986997A/zh
Publication of CN110986997A publication Critical patent/CN110986997A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, 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)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种提高室内惯性导航精度的方法及***,本发明涉及的一种提高室内惯性导航精度的方法,包括步骤:S11.采集室内位置的导航数据信息;S12.根据采集到的导航数据信息建立与所述信息相对应的误差模型;S13.通过惯性导航的算法计算当前所处的位置信息;所述惯性导航包括惯性导航的参数;S14.将所述计算得到的当前所处的位置信息与建立的误差模型中的导航数据信息进行比较,得到比较结果;S15.根据所述得到的比较结果,对惯性导航的参数进行修正。本发明基于航位推测法,结合电子罗盘、惯性导航、地图滤波作为定位技术,进而大幅度提高了室内导航的精度。

Description

一种提高室内惯性导航精度的方法及***
技术领域
本发明涉及导航领域,尤其涉及一种提高室内惯性导航精度的方法及***。
背景技术
室内定位是指在室内环境中实现位置定位,主要采用无线通讯、基站定位、惯性导航定位等多种技术集成形成一套室内位置定位体系,从而实现人员、物体等在室内空间中的位置监控。
现有的室内定位方案多数是指纹融合惯性导航,比如地磁融合惯性导航,wifi融合惯性导航,蓝牙融合惯性导航。
而惯性导航是利用陀螺仪和加速度计这两种惯性敏感器,通过测量船舶加速度和角速度而实现的自主式导航方法。惯性导航主要依赖IMU传感器(磁力计,加速计,陀螺仪)。
现有技术中对传感器的采集频率要求都非常高:穿戴设备一般都要1000hz以上,手机的传感器一般也在50hz以上。对于微信小程序、支付宝小程序等H5框架的平台,只能提供5hz左右的传感器数据,这些***中的传感器采集频率低,因为采用现有技术的定位方法其定位精确度也很低。
现有技术中存在的技术问题是:
(1)室内的磁场会被室内的钢混结构为主的金属结构切割并扭曲,虽然无法获取每个点的磁场三分量数据,但是可以获取电子罗盘的数据,而电子罗盘会受磁场影响也会形成一定的指纹性,电子罗盘的指纹性不够强。
(2)室内环境布局复杂多变,障碍物很多,包括家具、房间和行人等。同时室内环境干扰源多,灯光、温度、声音等干扰源都会对导航过程中的定位效果造成一定影响。
(3)目前的高精度室内定位技术均需要比较昂贵的额外辅助设备或前期大量的人工处理,这些都大大制约了技术的推广普及。低成本的定位技术则在定位精度上需要提高。
因此,如何基于惯性导航在手机(小程序)中传感器***数据采集频率低的情况下提高室内导航的精确度有待研究。
发明内容
本发明的目的是针对现有技术的缺陷,提供了一种提高室内惯性导航精度的方法及***,基于航位推测法,结合电子罗盘、惯性导航、地图滤波作为定位技术,进而大幅度提高了室内导航的精度。
为了实现以上目的,本发明采用以下技术方案:
一种提高室内惯性导航精度的方法,包括步骤:
S1.采集室内位置的导航数据信息;
S2.根据采集到的导航数据信息建立与所述信息相对应的误差模型;
S3.通过惯性导航的算法计算当前所处的位置信息;所述惯性导航包括惯性导航的参数;
S4.将所述计算得到的当前所处的位置信息与建立的误差模型中的导航数据信息进行比较,得到比较结果;
S5.根据所述得到的比较结果,对惯性导航的参数进行修正。
进一步的,所述步骤S1中采集的是通过电子罗盘及地图确定的室内导航数据信息。
进一步的,所述步骤S5中对惯性导航的参数进行修正是通过电子罗盘及地图进行修正的。
进一步的,所述步骤S3中包括通过惯性传感器及航位推测法得到当前所处的位置信息。
进一步的,所述步骤S5具体为采用地图来约束通过惯性导航得到的当前所处的位置信息的偏离;和/或通过电子罗盘中的偏差角度缩小通过惯性导航得到的当前所处的位置信息的定位范围。
相应的,还提供一种提高室内惯性导航精度的***,包括步骤:
采集模块,用于采集室内位置的导航数据信息;
建立模块,用于根据采集到的导航数据信息建立与所述信息相对应的误差模型;
计算模块,用于通过惯性导航的算法计算当前所处的位置信息;所述惯性导航包括惯性导航的参数;
比较模块,用于将所述计算得到的当前所处的位置信息与建立的误差模型中的导航数据信息进行比较,得到比较结果;
修正模块,用于根据所述得到的比较结果,对惯性导航的参数进行修正。
进一步的,所述采集模块中采集的是通过电子罗盘及地图确定的室内导航数据信息。
进一步的,所述修正模块中对惯性导航的参数进行修正是通过电子罗盘及地图进行修正的。
进一步的,所述计算模块包括通过惯性传感器及航位推测法得到当前所处的位置信息。
进一步的,所述修正模块具体为采用地图来约束通过惯性导航得到的当前所处的位置信息的偏离;和/或通过电子罗盘中的偏差角度缩小通过惯性导航得到的当前所处的位置信息的定位范围。
与现有技术相比,本发明解决了单一惯性导航用于手机上时,由于手机本身硬件受限,传感器采集频率低,导致误差不断积累以至于最后的导航效果很差,因此本发明结合了地图及电子罗盘不断修正累积误差,并加入惯性导航算法中,提高导航的精确程度。
附图说明
图1是实施例一提供的一种提高室内惯性导航精度的方法流程图;
图2是实施例二提供的一种提高室内惯性导航精度的***结构图。
具体实施方式
以下通过特定的具体实例说明本发明的实施方式,本领域技术人员可由本说明书所揭露的内容轻易地了解本发明的其他优点与功效。本发明还可以通过另外不同的具体实施方式加以实施或应用,本说明书中的各项细节也可以基于不同观点与应用,在没有背离本发明的精神下进行各种修饰或改变。需说明的是,在不冲突的情况下,以下实施例及实施例中的特征可以相互组合。
本发明的目的是针对现有技术的缺陷,提供了一种提高室内惯性导航精度的方法及***。本发明适用于室内、室外、地下隧道等多种场景。
实施例一
本实施例提供一种提高室内惯性导航精度的方法,如图1所示,包括步骤:
S11.采集室内位置的导航数据信息;
S12.根据采集到的导航数据信息建立与所述信息相对应的误差模型;
S13.通过惯性导航的算法计算当前所处的位置信息;所述惯性导航包括惯性导航的参数;
S14.将所述计算得到的当前所处的位置信息与建立的误差模型中的导航数据信息进行比较,得到比较结果;
S15.根据所述得到的比较结果,对惯性导航的参数进行修正。
本实施例以移动终端中的微信小程序来详细说明。需要注意的是,本实施例不仅限于应用于微信小程序,本实施例主要应用于传感器***数据采集频率低的产品中。
在步骤S11中,采集室内位置的导航数据信息。
在本实施例中,采集通过电子罗盘及地图确定的室内导航数据信息。其中,采集的信息包括每个位置坐标的磁场等信息,进而得到电子罗盘的数据。
预先采集室内的电子罗盘数据图和地图的数据图,这样室内不同位置所对应的电子罗盘和室内结构都能提前保存并确定其位置的具体坐标,比如坐标(x0,y0)对应的电子罗盘偏角是50度,坐标(x1,y1)对应的是一面墙体等。
电子罗盘包含如三维磁阻传感器的地磁传感器、双轴倾角传感器和MCU等。其中,三维磁阻传感器用来测量地球磁场,倾角传感器是在磁力仪非水平状态时进行补偿;MCU处理磁力仪和倾角传感器的信号以及数据输出和软铁、硬铁补偿。该电子罗盘可采用三个互相垂直的磁阻传感器,每个轴向上的传感器检测在该方向上的地磁场强度。向前的方向称为X方向的传感器检测地磁场在X方向的矢量值;向左或Y方向的传感器检测地磁场在Y方向的矢量值;向下或Z方向的传感器检测地磁场在Z方向的矢量值。每个方向的传感器的灵敏度都已根据在该方向上地磁场的分矢量调整到最佳点,并具有非常低的横轴灵敏度。传感器产生的模拟输出信号进行放大、滤波、模数转换等处理后送入MCU进行处理。
本实施例通过预先存储某一场景的坐标位置,可以与后续采集到的位置坐标进行比较,提高导航的精确度。
在步骤S12中,根据采集到的导航数据信息建立与所述信息相对应的误差模型。
将步骤S11中预先采集到的室内的电子罗盘数据图和地图的数据图,并建立与所述采集到的数据相对应的误差模型。
美国国家地理空间情报局(NGA)每五年更新一次世界地磁模型。理论上,在无干扰情况下,只要预先确定经纬度,那么地球任意一点的本地地磁矢量都可以由世界地磁模型计算得出。
然而,由于室内环境地磁场受到扭曲和干扰,因此采集得到的每点的地磁矢量测量值与世界地磁模型计算得到的参考值有一定的偏差。因此,通过磁力矢量解算得到的磁偏角会有一个偏差值。由于室内环境下,不同地方对地磁场的干扰和扭曲不同过,因此这个偏差值在室内不同地方大小不同,具有一定的空间特异性。
本步骤通过采集建立了包含室内坐标与该磁偏角偏差值的一一对应关系的数据库:(xi,yi,ΔMagneticDeclination)。
由于室内环境地磁场受到扭曲和干扰,因此电子罗盘的方向读数会与真实朝向有一个偏差,在室内不同的位置上,该偏差角不同。通过采集,获得室内所有位置的偏差角信息。
需要说明的是,该误差模型即为预先采集到的信息的统称,也就是说高误差模型为采集到的信息。
在步骤S13中,通过惯性导航的算法计算当前所处的位置信息;所述惯性导航包括惯性导航的参数。
xi+1=xi+l×cosθ
yi+1=yi+l×sinθ
其中,θ为电子罗盘接口给出的航向角,l为步长,其估算公式为:
Figure BDA0002247360060000051
其中,K为经验系数,accmax及accmin分别为在一个步行周期内加速度计的最大读数和最小读数。
在本实施例中,包括通过惯性传感器及航位推测法得到当前所处的位置信息。
其中,惯性导航,是利用陀螺仪和加速度计这两种惯性敏感器,通过测量船舶加速度和角速度而实现的自主式导航方法。
惯性传感器,是一种传感器,主要是检测和测量加速度、倾斜、冲击、振动、旋转和多自由度(DoF)运动,是解决导航、定向和运动载体控制的重要部件。
航位推测法,是一种利用现在物***置及速度推定未来位置方向的航海技术,现已应用至许多交通技术层面,但容易受到误差累积的影响。
在本实施例中,移动终端包括惯性传感器,通过惯性传感器实时采集运动数据,如加速度传感器、陀螺仪等测量物体的速度、方向、加速度等信息,基于航位推测法,经过计算得到物体的位置信息。
移动终端获取通过惯性传感器实时采集的速度值、加速度值、方向值等数据,并根据惯性传感器持续采集的数据,并根据航位推测法推算运动的位置方向来确定实时所处的位置信息。
在步骤S14中,将所述计算得到的当前所处的位置信息与建立的误差模型中的导航数据信息进行比较,得到比较结果。
在本实施例中,通过步骤S13中计算得到的实时所处的位置信息后,将其与误差模型中的导航信息进行比较。具体为,将基于惯性导航的方法计算出来的位置与预存的电子罗盘数据图及地图的数据图进行比较。例如,在基于惯性导航的方法计算出来的位置在对应的电子罗盘数据图中的罗盘数据和在地图的数据中的地图数据的位置坐标为(x1,y1),若观测到的电子罗盘数据和对应罗盘数据图的坐标为(x0,y0),此时可得出通过惯性导航的方法计算出得位置信息的数据偏差很大,或者观测到地图数据和对应地图数据图的坐标为(x0,y0),此时可得出通过惯性导航的方法计算的位置信息的数据偏差很大,可得到通过惯性导航的累计的误差过大。
在定位时,计算得到的当前位置信息是一个以某个点为中心的范围。根据地图信息,可以判断出当前范围中的哪些位置处为可行走区域,哪些位置在不可行走区域、墙或中空。根据采集得到的电子罗盘数据库,可以获取范围内所有点的电子罗盘信息,并与观测得到的电子罗盘数据进行比较,最接近的点就是最有可能的定位点。此时,也可以做加权平均,或者部分点加权平均。
在步骤S15中,根据所述得到的比较结果,对惯性导航的参数进行修正。
在本实施例中,若得到的比较结果无误差,则不作处理;若得到的比较结果存在误差,则对惯性导航的参数进行修正。
对惯性导航的参数进行修正是通过电子罗盘及地图进行修正的。具体为采用地图来约束通过惯性导航得到的当前所处的位置信息的偏离;和/或通过电子罗盘中的偏差角度缩小通过惯性导航得到的当前所处的位置信息的定位范围。
根据比较结果确定通过惯性导航的方法计算的位置信息与预存的导航数据信息之间的误差,本实施例可以通过地图信息来约束在运动状态中的位置偏离,或者通过对比罗盘偏差角度来缩小运动状态中的定位范围,通过不断修正惯性导航的累积误差,并加入到惯性导航算法中,提高导航的精确程度。
在步骤S13中,惯性导航中的步长参数决定了步骤S13中的步长,进而计算出下一个位置点。而在步骤S14中会得到一个最有可能的定位点,此时可以反向计算出步长及其相应的步长参数。在下一次位置估算中,可以利用本次得到的优化过的步长参数,从而使得定位更加准确。
Figure BDA0002247360060000071
Figure BDA0002247360060000072
Figure BDA0002247360060000073
其中,lcur-real是根据步骤S15中的位置坐标和步骤S14中的位置坐标推算出来的步长,Kcur-real是反向计算出来的符合实际的更为精确的步长参数,lnext-pred是下一个步行周期预测阶段即步骤S13阶段内会用到的步长。
本实施例采用地图约束包括采用地图滤波,如通过卡尔曼滤波。
在本实施例中,通过步骤S13,惯性导航中的步长参数决定了步骤S13中的步长,进而计算出下一个位置点。而在步骤S14中会得到一个最有可能的定位点,此时可以反向计算出步长及其相应的步长参数。在下一次位置估算中,可以利用本次得到的优化过的步长参数,从而使得定位更加准确。
现有技术中,单一的惯性导航是利用载体上的加速度计、陀螺仪这两种惯性元件,去分别测出飞机相对于惯性空间的角运动信息和线运动信息,并在给定初始条件下,由计算机推算出飞机的姿态、航向、速度、位置等导航参数的自主式导航方法。组成惯性导航***的设备都安装在运载体内,工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰,是一种自主式导航***。但是会有累计误差,一次惯性导航的时长越久,累计的误差越大。
而在移动终端中,有与移动终端本身硬件受限,传感器采集频率低,会导致累计误差进一步放大以至于最后的导航效果很差(长路径偏差10m以上),因此需要结合第三方信息不断修正累积误差,如用已知的地图信息来约束行进过称中的偏离,还可以通过对比罗盘偏差角度来缩小定位范围,并加入惯性导航算法中,提高导航的精确程度,达到长路径误差也小于5m的精度,在今后的不断努力调优或可达到更高的导航精度。
本实施例解决了单一惯性导航用于手机上时,由于手机本身硬件受限,传感器采集频率低,导致误差不断积累以至于最后的导航效果很差,因此本发明结合了地图及电子罗盘不断修正累积误差,并加入惯性导航算法中,提高导航的精确程度;本实施例降低了惯性导航对高传感器频率的依赖,使其可以在小程序这样的低传感器频率的载体中使用。
实施例二
本实施例提供一种提高室内惯性导航精度的***,如图2所示,包括:
采集模块11,用于采集室内位置的导航数据信息;
建立模块12,用于根据采集到的导航数据信息建立与所述信息相对应的误差模型;
计算模块13,用于通过惯性导航的算法计算当前所处的位置信息;所述惯性导航包括惯性导航的参数;
比较模块14,用于将所述计算得到的当前所处的位置信息与建立的误差模型中的导航数据信息进行比较,得到比较结果;
修正模块15,用于根据所述得到的比较结果,对惯性导航的参数进行修正。
本实施例以移动终端中的微信小程序来详细说明。需要注意的是,本实施例不仅限于应用于微信小程序,本实施例主要应用于传感器***数据采集频率低的产品中。
在采集模块11中,采集室内位置的导航数据信息。
在本实施例中,采集通过电子罗盘及地图确定的室内导航数据信息。其中,采集的信息包括每个位置坐标的磁场等信息,进而得到电子罗盘的数据。
预先采集室内的电子罗盘数据图和地图的数据图,这样室内不同位置所对应的电子罗盘和室内结构都能提前保存并确定其位置的具体坐标,比如坐标(x0,y0)对应的电子罗盘偏角是50度,坐标(x1,y1)对应的是一面墙体等。
电子罗盘包含如三维磁阻传感器的地磁传感器、双轴倾角传感器和MCU等。其中,三维磁阻传感器用来测量地球磁场,倾角传感器是在磁力仪非水平状态时进行补偿;MCU处理磁力仪和倾角传感器的信号以及数据输出和软铁、硬铁补偿。该电子罗盘可采用三个互相垂直的磁阻传感器,每个轴向上的传感器检测在该方向上的地磁场强度。向前的方向称为X方向的传感器检测地磁场在X方向的矢量值;向左或Y方向的传感器检测地磁场在Y方向的矢量值;向下或Z方向的传感器检测地磁场在Z方向的矢量值。每个方向的传感器的灵敏度都已根据在该方向上地磁场的分矢量调整到最佳点,并具有非常低的横轴灵敏度。传感器产生的模拟输出信号进行放大、滤波、模数转换等处理后送入MCU进行处理。
本实施例通过预先存储某一场景的坐标位置,可以与后续采集到的位置坐标进行比较,提高导航的精确度。
在建立模块12中,根据采集到的导航数据信息建立与所述信息相对应的误差模型。
将采集模块11中预先采集到的室内的电子罗盘数据图和地图的数据图,并建立与所述采集到的数据相对应的误差模型。
在计算模块13中,通过惯性导航的算法计算当前所处的位置信息;所述惯性导航包括惯性导航的参数。
在本实施例中,包括通过惯性传感器及航位推测法得到当前所处的位置信息。
其中,惯性导航,是利用陀螺仪和加速度计这两种惯性敏感器,通过测量船舶加速度和角速度而实现的自主式导航方法。
惯性传感器,是一种传感器,主要是检测和测量加速度、倾斜、冲击、振动、旋转和多自由度(DoF)运动,是解决导航、定向和运动载体控制的重要部件。
航位推测法,是一种利用现在物***置及速度推定未来位置方向的航海技术,现已应用至许多交通技术层面,但容易受到误差累积的影响。
在本实施例中,移动终端包括惯性传感器,通过惯性传感器实时采集运动数据,如加速度传感器、陀螺仪等测量物体的速度、方向、加速度等信息,基于航位推测法,经过计算得到物体的位置信息。
移动终端获取通过惯性传感器实时采集的速度值、加速度值、方向值等数据,并根据惯性传感器持续采集的数据,并根据航位推测法推算运动的位置方向来确定实时所处的位置信息。
在比较模块14中,将所述计算得到的当前所处的位置信息与建立的误差模型中的导航数据信息进行比较,得到比较结果。
在本实施例中,通过计算模块13中计算得到的实时所处的位置信息后,将其与误差模型中的导航信息进行比较。具体为,将基于惯性导航的方法计算出来的位置与预存的电子罗盘数据图及地图的数据图进行比较。例如,在基于惯性导航的方法计算出来的位置在对应的电子罗盘数据图中的罗盘数据和在地图的数据中的地图数据的位置坐标为(x1,y1),若观测到的电子罗盘数据和对应罗盘数据图的坐标为(x0,y0),此时可得出通过惯性导航的方法计算出得位置信息的数据偏差很大,或者观测到地图数据和对应地图数据图的坐标为(x0,y0),此时可得出通过惯性导航的方法计算的位置信息的数据偏差很大,可得到通过惯性导航的累计的误差过大。
在修正模块15中,根据所述得到的比较结果,对惯性导航的参数进行修正。
在本实施例中,若得到的比较结果无误差,则不作处理;若得到的比较结果存在误差,则对惯性导航的参数进行修正。
对惯性导航的参数进行修正是通过电子罗盘及地图进行修正的。具体为采用地图来约束通过惯性导航得到的当前所处的位置信息的偏离;和/或通过电子罗盘中的偏差角度缩小通过惯性导航得到的当前所处的位置信息的定位范围。
根据比较结果确定通过惯性导航的方法计算的位置信息与预存的导航数据信息之间的误差,本实施例可以通过地图信息来约束在运动状态中的位置偏离,或者通过对比罗盘偏差角度来缩小运动状态中的定位范围,通过不断修正惯性导航的累积误差,并加入到惯性导航算法中,提高导航的精确程度。
本实施例采用地图约束包括采用地图滤波,如通过卡尔曼滤波。
现有技术中,单一的惯性导航是利用载体上的加速度计、陀螺仪这两种惯性元件,去分别测出飞机相对于惯性空间的角运动信息和线运动信息,并在给定初始条件下,由计算机推算出飞机的姿态、航向、速度、位置等导航参数的自主式导航方法。组成惯性导航***的设备都安装在运载体内,工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰,是一种自主式导航***。但是会有累计误差,一次惯性导航的时长越久,累计的误差越大。
而在移动终端中,有与移动终端本身硬件受限,传感器采集频率低,会导致累计误差进一步放大以至于最后的导航效果很差(长路径偏差10m以上),因此需要结合第三方信息不断修正累积误差,如用已知的地图信息来约束行进过称中的偏离,还可以通过对比罗盘偏差角度来缩小定位范围,并加入惯性导航算法中,提高导航的精确程度,达到长路径误差也小于5m的精度,在今后的不断努力调优或可达到更高的导航精度。
需要说明的是,本实施例提供的一种提高室内惯性导航精度的***与实施例一类似。
本实施例解决了单一惯性导航用于手机上时,由于手机本身硬件受限,传感器采集频率低,导致误差不断积累以至于最后的导航效果很差,因此本发明结合了地图及电子罗盘不断修正累积误差,并加入惯性导航算法中,提高导航的精确程度;本实施例降低了惯性导航对高传感器频率的依赖,使其可以在小程序这样的低传感器频率的载体中使用。
注意,上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解,本发明不限于这里所述的特定实施例,对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此,虽然通过以上实施例对本发明进行了较为详细的说明,但是本发明不仅仅限于以上实施例,在不脱离本发明构思的情况下,还可以包括更多其他等效实施例,而本发明的范围由所附的权利要求范围决定。

Claims (10)

1.一种提高室内惯性导航精度的方法,其特征在于,包括步骤:
S1.采集室内位置的导航数据信息;
S2.根据采集到的导航数据信息建立与所述信息相对应的误差模型;
S3.通过惯性导航的算法计算当前所处的位置信息;所述惯性导航包括惯性导航的参数;
S4.将所述计算得到的当前所处的位置信息与建立的误差模型中的导航数据信息进行比较,得到比较结果;
S5.根据所述得到的比较结果,对惯性导航的参数进行修正。
2.根据权利要求1所述的一种提高室内惯性导航精度的方法,其特征在于,所述步骤S1中采集的是通过电子罗盘及地图确定的室内导航数据信息。
3.根据权利要求2所述的一种提高室内惯性导航精度的方法,其特征在于,所述步骤S5中对惯性导航的参数进行修正是通过电子罗盘及地图进行修正的。
4.根据权利要求1所述的一种提高室内惯性导航精度的方法,其特征在于,所述步骤S3中包括通过惯性传感器及航位推测法得到当前所处的位置信息。
5.根据权利要求3所述的一种提高室内惯性导航精度的方法,其特征在于,所述步骤S5具体为采用地图来约束通过惯性导航得到的当前所处的位置信息的偏离;和/或通过电子罗盘中的偏差角度缩小通过惯性导航得到的当前所处的位置信息的定位范围。
6.一种提高室内惯性导航精度的***,其特征在于,包括:
采集模块,用于采集室内位置的导航数据信息;
建立模块,用于根据采集到的导航数据信息建立与所述信息相对应的误差模型;
计算模块,用于通过惯性导航的算法计算当前所处的位置信息;所述惯性导航包括惯性导航的参数;
比较模块,用于将所述计算得到的当前所处的位置信息与建立的误差模型中的导航数据信息进行比较,得到比较结果;
修正模块,用于根据所述得到的比较结果,对惯性导航的参数进行修正。
7.根据权利要求6所述的一种提高室内惯性导航精度的方法,其特征在于,所述采集模块中采集的是通过电子罗盘及地图确定的室内导航数据信息。
8.根据权利要求7所述的一种提高室内惯性导航精度的方法,其特征在于,所述修正模块中对惯性导航的参数进行修正是通过电子罗盘及地图进行修正的。
9.根据权利要求6所述的一种提高室内惯性导航精度的方法,其特征在于,所述计算模块包括通过惯性传感器及航位推测法得到当前所处的位置信息。
10.根据权利要求8所述的一种提高室内惯性导航精度的方法,其特征在于,所述修正模块具体为采用地图来约束通过惯性导航得到的当前所处的位置信息的偏离;和/或通过电子罗盘中的偏差角度缩小通过惯性导航得到的当前所处的位置信息的定位范围。
CN201911021468.8A 2019-10-25 2019-10-25 一种提高室内惯性导航精度的方法及*** Pending CN110986997A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911021468.8A CN110986997A (zh) 2019-10-25 2019-10-25 一种提高室内惯性导航精度的方法及***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911021468.8A CN110986997A (zh) 2019-10-25 2019-10-25 一种提高室内惯性导航精度的方法及***

Publications (1)

Publication Number Publication Date
CN110986997A true CN110986997A (zh) 2020-04-10

Family

ID=70082391

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911021468.8A Pending CN110986997A (zh) 2019-10-25 2019-10-25 一种提高室内惯性导航精度的方法及***

Country Status (1)

Country Link
CN (1) CN110986997A (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113048977A (zh) * 2021-03-09 2021-06-29 杭州十域科技有限公司 一种融合无线电波及惯性传感器的室内地磁定位方法
CN113137976A (zh) * 2021-02-25 2021-07-20 中国人民解放军海军潜艇学院 惯导***定位性能评估方法、装置、设备和存储介质
CN113218389A (zh) * 2021-05-24 2021-08-06 北京航迹科技有限公司 一种车辆定位方法、装置、存储介质及计算机程序产品
CN113280835A (zh) * 2021-05-20 2021-08-20 北京智慧图科技有限责任公司 一种基于路径规划的室内定位校正方法
CN116153135A (zh) * 2023-04-04 2023-05-23 湖南桅灯机器人有限公司 一种应用于地下停车场的地图导航方法及***

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104457789A (zh) * 2014-11-26 2015-03-25 深圳市华颖泰科电子技术有限公司 基于惯性导航的参数修正方法和装置
CN105865450A (zh) * 2016-04-19 2016-08-17 武汉理工大学 一种基于步态的零速更新方法及***
CN107036597A (zh) * 2017-05-02 2017-08-11 华南理工大学 一种基于智能手机内置惯性传感器的室内定位导航方法
CN109029455A (zh) * 2018-07-17 2018-12-18 济南浪潮高新科技投资发展有限公司 一种室内导航方法
CN109141470A (zh) * 2017-06-16 2019-01-04 卡西欧计算机株式会社 电子设备、误差校正方法及记录介质

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104457789A (zh) * 2014-11-26 2015-03-25 深圳市华颖泰科电子技术有限公司 基于惯性导航的参数修正方法和装置
CN105865450A (zh) * 2016-04-19 2016-08-17 武汉理工大学 一种基于步态的零速更新方法及***
CN107036597A (zh) * 2017-05-02 2017-08-11 华南理工大学 一种基于智能手机内置惯性传感器的室内定位导航方法
CN109141470A (zh) * 2017-06-16 2019-01-04 卡西欧计算机株式会社 电子设备、误差校正方法及记录介质
CN109029455A (zh) * 2018-07-17 2018-12-18 济南浪潮高新科技投资发展有限公司 一种室内导航方法

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113137976A (zh) * 2021-02-25 2021-07-20 中国人民解放军海军潜艇学院 惯导***定位性能评估方法、装置、设备和存储介质
CN113137976B (zh) * 2021-02-25 2024-01-09 中国人民解放军海军潜艇学院 惯导***定位性能评估方法、装置、设备和存储介质
CN113048977A (zh) * 2021-03-09 2021-06-29 杭州十域科技有限公司 一种融合无线电波及惯性传感器的室内地磁定位方法
CN113048977B (zh) * 2021-03-09 2023-04-18 杭州十域科技有限公司 一种融合无线电波及惯性传感器的室内地磁定位方法
CN113280835A (zh) * 2021-05-20 2021-08-20 北京智慧图科技有限责任公司 一种基于路径规划的室内定位校正方法
CN113218389A (zh) * 2021-05-24 2021-08-06 北京航迹科技有限公司 一种车辆定位方法、装置、存储介质及计算机程序产品
CN113218389B (zh) * 2021-05-24 2024-05-17 北京航迹科技有限公司 一种车辆定位方法、装置、存储介质及计算机程序产品
CN116153135A (zh) * 2023-04-04 2023-05-23 湖南桅灯机器人有限公司 一种应用于地下停车场的地图导航方法及***
CN116153135B (zh) * 2023-04-04 2023-10-20 湖南朗赫科技有限公司 一种应用于地下停车场的地图导航方法及***

Similar Documents

Publication Publication Date Title
CN110986997A (zh) 一种提高室内惯性导航精度的方法及***
CN107655476B (zh) 基于多信息融合补偿的行人高精度足部导航方法
CN105674984B (zh) 一种无约束使用移动终端获取行人前进方向的方法
CN106225784B (zh) 基于低成本多传感器融合行人航位推算方法
CN109931926B (zh) 一种基于站心坐标系的小型无人机无缝自主式导航方法
CN107270893B (zh) 面向不动产测量的杆臂、时间不同步误差估计与补偿方法
US10337884B2 (en) Method and apparatus for fast magnetometer calibration
US7119533B2 (en) Method, system and device for calibrating a magnetic field sensor
CN108225324B (zh) 一种基于智能终端的地磁匹配与pdr融合的室内定位方法
US10352959B2 (en) Method and system for estimating a path of a mobile element or body
US8437970B2 (en) Restoring and storing magnetometer calibration data
CN107490378B (zh) 一种基于mpu6050与智能手机的室内定位与导航的方法
US11035915B2 (en) Method and system for magnetic fingerprinting
CN105652306A (zh) 基于航迹推算的低成本北斗与mems紧耦合定位***及方法
CN107255474B (zh) 一种融合电子罗盘和陀螺仪的pdr航向角确定方法
Wahdan et al. Three-dimensional magnetometer calibration with small space coverage for pedestrians
CN105910606A (zh) 一种基于角速度差值的方向修正方法
CN110617795B (zh) 一种利用智能终端的传感器实现室外高程测量的方法
JP2006226810A (ja) 方位計測装置
KR101576424B1 (ko) 실내 측위를 위한 지자기 센서 자동 보정 방법
CN111854762A (zh) 一种基于卡尔曼滤波算法的三维定位方法及其定位***
JP2019120587A (ja) 測位システム及び測位方法
JP2017166895A (ja) 電子機器及びセンサ較正方法、センサ較正プログラム
CN111025366A (zh) 基于ins及gnss的网格slam的导航***及方法
JP3860580B2 (ja) チルト補償型電子コンパスの伏角探索方法

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