CN107421546A - 一种基于空间环境磁场特征的无源组合定位方法 - Google Patents
一种基于空间环境磁场特征的无源组合定位方法 Download PDFInfo
- Publication number
- CN107421546A CN107421546A CN201710744801.2A CN201710744801A CN107421546A CN 107421546 A CN107421546 A CN 107421546A CN 201710744801 A CN201710744801 A CN 201710744801A CN 107421546 A CN107421546 A CN 107421546A
- Authority
- CN
- China
- Prior art keywords
- positioning
- matching
- data
- imu
- zero
- 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.)
- Granted
Links
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
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于空间环境磁场特征的无源组合定位方法,将惯导+地磁+地图进行技术组合进行无源组合定位,不需要任何硬件部署、不向外发射和接收电磁信号、不需要维护、可以分辨楼层、不易受遮挡和干扰的优点;特别是针对磁场信号容易受到环境中不断变化的低频电、磁信号干扰,本发明提出事先对磁传感器进行标校,定位时实时对磁干扰进行识别和消除的处理方法,提高磁场测量精度;同时通过匹配算法的改进,提高地磁定位的稳定性,从而确保了该室内定位系统的鲁棒性和对绝大多数应用场景的适应性。
Description
技术领域
本发明涉及定位技术领域,尤其是一种基于空间环境磁场特征的无源组合定位方法。
背景技术
室内定位技术是指一种利用无线移动通信网络,通过对接收到的无线电波的一些参数或其他信息进行测量,根据特定的算法对人、车辆或设备在某一时间所处的地理位置进行精确测定,以便为定位终端用户提供相关的位置信息服务,或进行实时检测和追踪的定位与导航技术。
应用比较多的室内定位技术包括蓝牙、WIFI、射频识别(RFID)、超宽带(UWB)、红外和超声波、Zigbee等。蓝牙定位技术数据传输不受视距的影响,但对于复杂的空间环境,蓝牙系统的稳定性稍差,受噪声信号干扰大;WIFI传输距离较短,功耗较高,受噪声信号干扰大;RFID不具有通信能力,抗干扰能力较差,不便于整合到其他系统之中,且用户的安全隐私保障和国际标准化都不够完善;UWB定位技术功耗较高,同时该系统成本高;红外线只能视线传播,穿透性能极差,布局复杂,成本较高,也极易受灯光、烟雾等环境因素影响;超声波在空气中的衰减较大,不适用于大型场合,反射测距时受多径效应和非视距传播影响很大,造成需要精确分析计算的底层硬件设施投资,成本太高;Zigbee传输速率低,定位精度对算法要求较高。
目前,90%以上的室内定位技术是基于WiFi和蓝牙等无线基站的方式,这种定位方法,要么覆盖范围小,要么需要复杂的部署、硬件和安装,维护成本非常高。
发明内容
鉴于上述的分析,本发明旨在提供一种基于空间环境磁场特征的无源组合定位方法,用以解决传统的无线定位技术覆盖范围小,需要在室内部署无线基站,导致安装和维护成本较高的问题。
本发明的目的主要是通过以下技术方案实现的:
一种基于空间环境磁场特征的无源组合定位方法,包括如下步骤:
步骤S1、数据的采集和存储,包括地磁图数据的存储、地图数据的存储、传感器原始参数的存储、惯性数据的采集、磁场数据的采集;
步骤S2、数据的预处理,包括惯性数据校正、磁场数据校正和干扰磁场的识别分离;
步骤S3、根据校正后的惯性数据进行IMU定位,结合IMU定位的定位结果,根据校正和去除干扰后的磁场数据进行地磁匹配定位,结合数字地图数据,对地磁匹配定位结果进行滤波,并修正IMU参数,得到组合定位结果。
进一步地,所述步骤S2中干扰磁场的识别分离过程包括:
对采集到的磁场数据进行中值滤波;
对滤波后的数据进行一阶差分,放大台阶信号;
去除台阶信号;
对去除台阶信号的地磁数据用测量数据一阶差分的均值代替,并进行积分还原,得到干扰分离后的地磁数据。
进一步地,所述步骤S3包括如下子步骤:
S301、利用校正后惯性数据进行IMU定位;
S302、结合IMU定位的定位结果,通过地磁匹配进行地磁定位;
S302、结合数字地图数据,对地磁匹配定位结果进行滤波,并修正IMU参数,得到组合定位结果。
进一步地,利用校正后惯性数据进行IMU定位方法包括:
1)对俯仰角、横滚角和航向角赋初值;
2)进行航位推算;
3)进行零速检测;当三轴陀螺仪连续在五个周期内数据的极差小于某个接近0的阈值时,判定定位终端处于零速状态,启动零速更新;
4)进行零速更新;如果当前定位终端处于零速,基于卡尔曼滤波器计算当前位置、速度、姿态误差,对位置和姿态进行纠正;
5)输出位置、速度和姿态信息;经过航位推算得出的载体的位置、速度和姿态信息输出用于地磁定位和定位结果的滤波处理;
6)对陀螺仪和加速度计参数修正条件进行判断;当累计超过特定数量的零速检测数据时,可启动陀螺仪和加速度计参数校正模块,所述特定数量范围为5~10;
7)对陀螺仪和加速度计的参数校正;在零速条件下,陀螺仪测量值的均值为陀螺仪的零偏;对一段时间积累的零速条件下的陀螺仪的测量值求取均值,作为陀螺仪新的零偏数据,对原来的陀螺仪零偏数据进行更新替换,重新计算当前陀螺仪的零偏;对加速度计的各轴零偏进行更新替换与陀螺仪的各轴零偏更新替换方法相同。
进一步地,所述航位推算是利用四元数,基于前一次的四元数值,以及当前测量得到的加速度、角速度信息计算当前四元数,得到欧拉转换矩阵,最后基于上组加速度、速度、位置以及当前的欧拉转换矩阵,计算当前加速度、速度以及位置,其具体过程包括:
1)依据初始的姿态角计算初始四元数;
2)计算角速度在一个周期内的积分:
3)获得当前的四元数,并把当前时刻的四元数赋给初始四元数;
4)依据当前四元数计算从载体坐标系到导航坐标系的新的旋转矩阵:
5)更新导航坐标系下加速度值、速度值和位置值;
6)更新导航坐标系下更新载体坐标系相对于导航坐标系的姿态角;
7)重复2)~6)步骤,持续进行航位推算。
进一步地,结合IMU定位结果的地磁匹配定位方法包括以下步骤:
1)系统重新启动后,进行首匹配;
所述首匹配启动全局搜索模式,对连续三次的匹配结果进行一致性判决,在搜索定位过程中,首先顺序测量三段长度均为3~10米的磁场序列,在区域内进行全局搜索,通过匹配相关算法,找到和地磁实时图最相似的地磁基准图所在的位置为PM1,PM2,PM3,此时IMU标记的位置是PA1,PA2,PA3;根据所述匹配定位的位置和IMU标记的位置进行首匹配判决,如果满足判决条件,则根据匹配相关算法的定位结果进行输出,如果不满足判决门限,则继续测量,直到满足判决条件为止;
2)首匹配完成后,进行连续匹配定位,所述连续匹配定位每隔设定时间,进行一次匹配定位,所述匹配定位的范围以首匹配位置结合IMU的指示位置为中心,半径为R的范围内进行搜索和匹配定位,所述R的范围为事先根据IMU的定位误差范围确定,以大于所述定位误差范围为基准。
进一步地,所述首匹配的一致性判决公式为判决条件为|Dis1-Dis2|≤m&|Dis2-Dis3|≤m&|Dis3-Dis1|≤m所述m是距离的判决门限,取1~3m。
进一步地,所述匹配相关算法包括绝对平均差匹配方法或积相关匹配方法两种,在采用绝对平均差匹配方法进行匹配时,选择相似度值的最小值所对应的位置为最终的匹配位置,采用积相关匹配方法进行匹配时,选择相似度值的最大值所对应的位置为最终的匹配位置。
进一步地,所述S302中,通过卡尔曼滤波算法,对地磁匹配定位结果进行滤波,结合数字地图数据对定位终端载体的运动区域的限定对定位结果进行滤波,所述限定为定位终端载体只能在数字地图的道路上移动,而不能在道路以外的位置上移动;并修正IMU参数,得到组合定位结果。
本发明有益效果如下:
本发明不需要任何硬件部署、不向外发射和接收电磁信号、不需要维护(除了建筑物结构改变以外)、可以分辨楼层、不易受遮挡和干扰的优点;特别是针对磁场信号容易受到环境中不断变化的低频电、磁信号干扰,本发明提出事先对磁传感器进行标校,定位时实时对磁干扰进行识别和消除的处理方法,提高磁场测量精度;同时通过匹配算法的改进,提高地磁定位的稳定性,从而确保了该室内定位系统的鲁棒性和对绝大多数应用场景的适应性。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1为基于空间环境磁场特征的无源组合定位流程图;
图2为干扰磁场识别分离过程图;
图3为IMU定位模块工作过程图;
图4为地磁定位过程图。
具体实施方式
下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理。
本发明的一个具体实施例,公开了一种基于空间环境磁场特征的无源组合定位方法。所述定位方法是一种将惯导+地磁+地图进行技术组合的无源组合定位方法;如图1所示,具体包括如下步骤:
步骤S1、数据采集和存储,包括地磁图数据的存储、地图数据的存储、传感器原始参数的存储、惯性数据的采集、磁场数据的采集。
1.应用场景内的地磁图数据的存储
所述应用场景内的地磁图数据内容包括平面X坐标、平面Y坐标、右向磁场、前向磁场、向下磁场和总场强度;所述数据为包含磁传感器测量模块和定位模块的地磁图采集装置事先测量所得。
2.应用场景内的地图数据的存储
所述应用场景内的地图数据包括建筑物的结构、构造和楼层房间的布置,建筑物内的区域划分、陈设物品布局和道路规划等,所述地图数据为由应用场景的建筑CAD图和场景布设图的数字化制作生成。
3.传感器原始参数存储
所述原始参数包括磁传感器和Mems IMU的原始参数。所述Mems IMU的原始参数包括:陀螺仪三轴的零偏ωx0,ωy0,ωz0,加速度计三轴的零偏ax0,ay0,az0,加速度计三轴的刻度因数误差Sx0,Sy0,Sz0,加速度计三轴的交叉耦合因子Mxy,Myz,Mzx;所述磁传感器原始参数包括:当地磁定位采用矢量特征进行匹配定位时,存储的磁传感器三轴的零偏bx,by,bz和灵敏度sx,sy,sz;当地磁定位采用标量特征进行定位时,存储的磁传感器三轴的零偏bx,by,bz、灵敏度sx,sy,sz和不正交度误差ux,uy,uz,所述磁传感器三轴的零偏和灵敏度是在零磁实验室进行测试标定后给出。
4.惯性数据的采集
所述惯性数据为包括陀螺仪和加速度计的惯性传感器测量所得,包括ωx1,ωy1,ωz1,ax1,ay1,az1;所述ωx1,ωy1,ωz1为载体坐标系下定位终端三个方向的陀螺仪的角速度测量值;所述ax1,ay1,az1为载体坐标系下定位终端三个方向的加速度计的加速度测量值。
5.磁场数据的采集和量化
所述地磁场数据为磁场传感器测量所得,包括magRMx、magRMy、magRMz;所述magRMx、magRMy、magRMz为载体坐标系下的三轴的模拟量磁场数据;所述地磁场数据经过24位的AD采样后,实现磁场测量数据的数字化,输出数字化后的三轴磁场magRx0、magRy0、magRz0。
步骤S2、数据预处理,包括陀螺仪和加速度计数据校正、磁场数据校正、干扰磁场识别和分离。
1.陀螺仪和加速度计数据校正
用存储的陀螺仪的原始参数对所述采集的角速度测量值进行校正,将所述陀螺仪三轴的零偏和角速度测量值代入式对陀螺的零偏进行校正,得到校正后的陀螺仪三轴的角速度值为ωx2,ωy2,ωz2;
用存储的加速度计的原始参数对所述采集的加速度测量值进行校正,将所述加速度计的原始参数和加速度测量值代入式对加速度计的零偏进行校正,得到校正后的加速度计三轴的加速度值为ax2,ay2,az2,其中,Myx=Mxy;Mzy=Myz;Mxz=Mzx。
通过对陀螺仪和加速度计数据校正,提高后续的IMU定位精度。
2.磁场数据校正
用存储的磁传感器原始参数对量化后的磁场数据进行校正;
当采用矢量匹配时,采用公式对磁场传感器的灵敏度和零点误差进行校正,所述magRx1、magRy1、magRz1为校正后的三轴磁场;
当采用标量匹配时,总场强度magRf=sqrt(magRx1 2+magRy1 2+magRz1 2);采用公式对磁场传感器的灵敏度和零点等误差进行校正,所述
所述
3干扰磁场的识别分离
通过对环境内的随机干扰磁场进行识别和去除,确保磁场特征的稳定性。利用磁场进行定位之前,需要对测量得到的磁场数据进行干扰识别与分离,一般的应用环境中,干扰主要来源于各种电气设备,主要体现为一些高频信号以及设备开关产生的台阶信号,针对这两类信号的识别以及分离的流程如图2所示,包括以下步骤:
1)首先对采集到的磁场数据进行中值滤波,中值滤波窗口一般设置为1~2s的采样点数,经过中值滤波,能够有效消除电气设备产生的高频干扰,保留电气设备开关产生的台阶信号以及环境特征信号;
2)对滤波后的数据进行一阶差分,通过差分处理使台阶信号能够凸显出来;
3)通过设置相关的阈值进行检测,当高于该阈值时,可认为是台阶信号,依据经验,阈值设置为最近1s内测量数据一阶差分的均值+3倍标准差;
4)对检测得到的值用1s内测量数据一阶差分的均值代替,并进行积分还原,得到干扰分离后的地磁数据。
步骤S3、进行IMU加地磁加地图的组合定位,组合定位过程包括以下子步骤:
S301、利用校正后的陀螺仪和加速度计数据进行IMU定位
IMU定位利用校正后的陀螺仪和加速度数据,进行移动终端的位置测量,如图3所示,包括以下步骤:
1.对IMU的俯仰角、横滚角和航向角赋初值:所述ax2,ay2,az2为校正后的加速度计三轴的加速度初值,g为重力加速度。
2.给IMU进行俯仰角、横滚角和航向角赋初值后,进行航位推算。
利用四元数,基于前一次的四元数值,以及当前测量得到的加速度、角速度信息计算当前四元数,得到欧拉转换矩阵,最后基于上组加速度、速度、位置以及当前的欧拉转换矩阵,计算当前加速度、速度以及位置。具体步骤包括:
1)依据初始的姿态角计算初始四元数,
将俯仰角、横滚角和航向角的初值代入式 计算从载体坐标系到地理坐标系的旋转矩阵;
根据得到旋转矩阵计算初始四元数:
2)计算角速度在一个周期内的积分:ΔT是积分时间;计算斜对称矩阵:
3)获得当前的四元数Q=(Icos(φ/2)+sin(φ/2)[Θ]/φ)Q0,并把当前时刻的四元数赋给Q0,所述I为4×4的单位矩阵;
4)依据当前四元数计算从载体坐标系到导航坐标系的新的旋转矩阵:
5)更新导航坐标系下加速度值:g为重力加速度;更新导航坐标系下速度值:速度初值一般设为0,ΔT为时间间隔;
在实际计算过程中,如果长时间进行航位推算,速度可能会发散到一个非常大的数值,不符合实际情况,这里对速度设置了一个门限,当推算得到的速度超出该门限后,采用该门限速度作为实际的速度进行更新;
更新导航坐标系下位置值:位置初值一般设为0;
更新载体坐标系相对于导航坐标系的姿态角:
7)重复2)~6)步骤,持续进行航位推算。
3.进行零速检测;
当三轴陀螺仪连续在五个周期内数据的极差小于某个接近0的阈值时,判定定位终端处于零速状态,启动零速更新。
4.进行零速更新;
如果当前定位终端处于零速,基于卡尔曼滤波器计算当前位置、速度、姿态误差,对位置和姿态进行纠正。
5.输出位置、速度和姿态信息;
经过航位推算得出的载体的位置、速度和姿态信息输出用于地磁定位和定位结果的滤波处理。
6.对陀螺仪和加速度计参数修正条件进行判断;
当累计超过特定数量的零速检测数据时,可启动陀螺仪和加速度计参数校正模块,这里的特定数量范围为[5,10]。
7.对陀螺仪和加速度计的参数进行校正;
零速条件下,陀螺仪测量值的均值为陀螺仪的零偏;对一段时间积累的零速条件下的陀螺仪的测量值求取均值,作为陀螺仪新的零偏数据,对原来的陀螺仪零偏数据进行更新替换,重新计算当前陀螺仪的零偏;对加速度计的各轴零偏进行更新替换与陀螺仪的各轴零偏更新替换方法相同。
S302、结合IMU定位的定位结果,通过地磁匹配进行地磁定位
所述地磁定位的过程如图4所示,包括:
1.系统重新启动后,进行首匹配
系统重新启动后,第一次进行地磁匹配,即为首匹配。因为需要根据首匹配的结果修正IMU定位的初值,所以对首匹配定位结果的可靠性要求比较高,这里采用了对连续三次的匹配结果进行一致性判决的方法提高首匹配的可靠性;同时由于此时定位终端可能在区域内的任何位置,所以首匹配需要启动全局搜索模式,即在全局范围内搜索定位终端可能在的位置。搜索定位过程如下,在首匹配时,首先顺序测量三段长度均为L米的(L的经验值,3≤L≤10)磁场序列,在区域内进行全局搜索,通过绝对平均差匹配方法或积相关匹配方法,找到和实时磁场测量序列最相似的基准磁场序列所在的位置,记为PM1,PM2,PM3。在匹配相关计算时,如果是标量匹配模式则只对比总场强度的相似性;如果是矢量匹配模式,则对比三个分量的相似性,总的相关值为三个分量相关值的和。此时惯导IMU标记的位置是PA1,PA2,PA3。
对PM1,PM2,PM3三个位置进行一致性判决,如果三次地磁匹配位置连续,则证明地磁匹配可靠,系统进入连续匹配定位模式。
判决公式为判决条件为|Dis1-Dis2|≤m&|Dis2-Dis3|≤m&|Dis3-Dis1|≤m,式中m是距离的判决门限,一般取1~3m。
如果满足判决门限,则根据采用的是绝对平均差匹配方法或积相关匹配方法,选择最小相关值或最大相关值的定位结果进行输出,然后进入连续匹配定位模式。如果不满足判决门限,则继续测量,直到满足判决条件为止。
2.连续匹配定位模式,每隔1s,进行一次匹配定位,和首匹配不同,这次不再采用全局搜索方法,以首匹配位置结合IMU的指示位置为中心,半径为R的范围内进行搜索定位,所述半径R为事先根据惯导的定位误差范围确定,以大于所述定位误差范围为基准;匹配方法可以选择绝对平均差匹配方法或积相关匹配方法等匹配相关算法,与首匹配选择的匹配定位方法相同。
步骤S303、对地磁匹配定位结果进行滤波,通过卡尔曼滤波算法,结合数字地图数据对定位终端载体的运动区域的限定对定位结果进行滤波,所述限定为定位终端载体只能在数字地图的道路上移动,而不可能在道路以外的墙壁、家具、设备等定位终端载体不可能出现的位置上移动;并修正IMU参数,得到组合定位结果。
综上所述,本发明实施例提供的基于空间环境磁场特征的无源组合定位方法,不需要任何硬件部署、不向外发射和接收电磁信号、不需要维护(除了建筑物结构改变以外)、可以分辨楼层、不易受遮挡和干扰的优点;特别是针对磁场信号容易受到环境中不断变化的低频电、磁信号干扰,本发明提出事先对磁传感器进行标校,实时对磁干扰进行识别和消除的处理方法,提高磁场测量精度;同时通过匹配算法的改进,提高地磁定位的稳定性,从而确保了该室内定位系统的鲁棒性和对绝大多数应用场景的适应性。
本领域技术人员可以理解,实现上述实施例方法的全部或部分流程,可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于计算机可读存储介质中。其中,所述计算机可读存储介质为磁盘、光盘、只读存储记忆体或随机存储记忆体等。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
Claims (9)
1.一种基于空间环境磁场特征的无源组合定位方法,其特征在于,包括如下步骤:
步骤S1、数据的采集和存储,包括地磁图数据的存储、地图数据的存储、传感器原始参数的存储、惯性数据的采集、磁场数据的采集;
步骤S2、数据的预处理,包括惯性数据校正、磁场数据校正和干扰磁场的识别分离;
步骤S3、根据校正后的惯性数据进行IMU定位,结合IMU定位的定位结果,根据校正和去除干扰后的磁场数据进行地磁匹配定位,结合数字地图数据,对地磁匹配定位结果进行滤波,并修正IMU参数,得到组合定位结果。
2.根据权利要求1所述无源组合定位方法,其特征在于,所述步骤S2中干扰磁场的识别分离过程包括:
对采集到的磁场数据进行中值滤波;
对滤波后的数据进行一阶差分,放大台阶信号;
去除台阶信号;
对去除台阶信号的地磁数据用测量数据一阶差分的均值代替,并进行积分还原,得到干扰分离后的地磁数据。
3.根据权利要求1所述无源组合定位方法,其特征在于,所述步骤S3包括如下子步骤:
S301、利用校正后惯性数据进行IMU定位;
S302、结合IMU定位的定位结果,通过地磁匹配进行地磁定位;
S302、结合数字地图数据,对地磁匹配定位结果进行滤波,并修正IMU参数,得到组合定位结果。
4.根据权利要求3所述无源组合定位方法,其特征在于,利用校正后惯性数据进行IMU定位方法包括:
1)对俯仰角、横滚角和航向角赋初值;
2)进行航位推算;
3)进行零速检测;当三轴陀螺仪连续在五个周期内数据的极差小于某个接近0的阈值时,判定定位终端处于零速状态,启动零速更新;
4)进行零速更新;如果当前定位终端处于零速,基于卡尔曼滤波器计算当前位置、速度、姿态误差,对位置和姿态进行纠正;
5)输出位置、速度和姿态信息;经过航位推算得出的载体的位置、速度和姿态信息输出用于地磁定位和定位结果的滤波处理;
6)对陀螺仪和加速度计参数修正条件进行判断;当累计超过特定数量的零速检测数据时,可启动陀螺仪和加速度计参数校正模块,所述特定数量范围为5~10;
7)对陀螺仪和加速度计的参数校正;在零速条件下,陀螺仪测量值的均值为陀螺仪的零偏;对一段时间积累的零速条件下的陀螺仪的测量值求取均值,作为陀螺仪新的零偏数据,对原来的陀螺仪零偏数据进行更新替换,重新计算当前陀螺仪的零偏;对加速度计的各轴零偏进行更新替换与陀螺仪的各轴零偏更新替换方法相同。
5.根据权利要求4所述无源组合定位方法,其特征在于,所述航位推算是利用四元数,基于前一次的四元数值,以及当前测量得到的加速度、角速度信息计算当前四元数,得到欧拉转换矩阵,最后基于上组加速度、速度、位置以及当前的欧拉转换矩阵,计算当前加速度、速度以及位置,其具体过程包括:
1)依据初始的姿态角计算初始四元数;
2)计算角速度在一个周期内的积分:
3)获得当前的四元数,并把当前时刻的四元数赋给初始四元数;
4)依据当前四元数计算从载体坐标系到导航坐标系的新的旋转矩阵:
5)更新导航坐标系下加速度值、速度值和位置值;
6)更新导航坐标系下更新载体坐标系相对于导航坐标系的姿态角;
7)重复2)~6)步骤,持续进行航位推算。
6.根据权利要求1所述无源组合定位方法,其特征在于,结合IMU定位结果的地磁匹配定位方法包括以下步骤:
1)系统重新启动后,进行首匹配;
所述首匹配启动全局搜索模式,对连续三次的匹配结果进行一致性判决,在搜索定位过程中,首先顺序测量三段长度均为3~10米的磁场序列,在区域内进行全局搜索,通过匹配相关算法,找到和地磁实时图最相似的地磁基准图所在的位置为PM1,PM2,PM3,此时IMU标记的位置是PA1,PA2,PA3;根据所述匹配定位的位置和IMU标记的位置进行首匹配判决,如果满足判决条件,则根据匹配相关算法的定位结果进行输出,如果不满足判决门限,则继续测量,直到满足判决条件为止;
2)首匹配完成后,进行连续匹配定位,所述连续匹配定位每隔设定时间,进行一次匹配定位,所述匹配定位的范围以首匹配位置结合IMU的指示位置为中心,半径为R的范围内进行搜索和匹配定位,所述R的范围为事先根据IMU的定位误差范围确定,以大于所述定位误差范围为基准。
7.根据权利要求6所述无源组合定位方法,其特征在于,所述首匹配的一致性判决公式为判决条件为|Dis1-Dis2|≤m&|Dis2-Dis3|≤m&|Dis3-Dis1|≤m所述m是距离的判决门限,取1~3m。
8.根据权利要求6所述无源组合定位方法,其特征在于,
所述匹配相关算法包括绝对平均差匹配方法或积相关匹配方法两种,在采用绝对平均差匹配方法进行匹配时,选择相似度值的最小值所对应的位置为最终的匹配位置,采用积相关匹配方法进行匹配时,选择相似度值的最大值所对应的位置为最终的匹配位置。
9.根据权利要求3所述无源组合定位方法,其特征在于,所述S302中,通过卡尔曼滤波算法,对地磁匹配定位结果进行滤波,结合数字地图数据对定位终端载体的运动区域的限定对定位结果进行滤波,所述限定为定位终端载体只能在数字地图的道路上移动,而不能在道路以外的位置上移动;并修正IMU参数,得到组合定位结果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710744801.2A CN107421546B (zh) | 2017-08-25 | 2017-08-25 | 一种基于空间环境磁场特征的无源组合定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710744801.2A CN107421546B (zh) | 2017-08-25 | 2017-08-25 | 一种基于空间环境磁场特征的无源组合定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107421546A true CN107421546A (zh) | 2017-12-01 |
CN107421546B CN107421546B (zh) | 2019-10-11 |
Family
ID=60434343
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710744801.2A Active CN107421546B (zh) | 2017-08-25 | 2017-08-25 | 一种基于空间环境磁场特征的无源组合定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107421546B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108151739A (zh) * | 2017-12-25 | 2018-06-12 | 北京理工大学 | 基于矢量匹配算法的重力匹配定位误差抑制方法 |
CN109029430A (zh) * | 2018-09-27 | 2018-12-18 | 北京华航无线电测量研究所 | 一种基于车载地磁定位导航的一致性判决方法及装置 |
CN109443337A (zh) * | 2018-11-15 | 2019-03-08 | 西安空间无线电技术研究所 | 一种基于金刚石内nv色心的定位导航系统与方法 |
CN110057356A (zh) * | 2019-04-29 | 2019-07-26 | 桂林电子科技大学 | 一种隧道内车辆定位方法及装置 |
CN110285809A (zh) * | 2019-07-15 | 2019-09-27 | 李素敏 | 一种室内外一体化的组合定位装置 |
CN110307849A (zh) * | 2019-07-15 | 2019-10-08 | 李素敏 | 一种人员室内定位以及室内外一体化定位方法 |
CN111698774A (zh) * | 2020-06-23 | 2020-09-22 | 北京麦钉艾特科技有限公司 | 基于多源信息融合的室内定位方法及装置 |
CN111879312A (zh) * | 2020-07-31 | 2020-11-03 | 北京麦钉艾特科技有限公司 | 一种地磁图在线更新方法 |
CN112362044A (zh) * | 2020-11-03 | 2021-02-12 | 北京无限向溯科技有限公司 | 室内定位方法、装置、设备和系统 |
CN112494027A (zh) * | 2020-11-25 | 2021-03-16 | 深圳市资福医疗技术有限公司 | 胃肠动力检查系统 |
CN114222240A (zh) * | 2021-10-29 | 2022-03-22 | 中国石油大学(华东) | 一种基于粒子滤波的多源融合定位方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103175529A (zh) * | 2013-03-01 | 2013-06-26 | 上海美迪索科电子科技有限公司 | 基于室内磁场特征辅助的行人惯性定位系统 |
CN104977006A (zh) * | 2015-08-11 | 2015-10-14 | 北京纳尔信通科技有限公司 | 一种基于模糊理论和多传感器融合的室内定位方法 |
CN105043387A (zh) * | 2015-06-26 | 2015-11-11 | 武汉科技大学 | 基于惯导辅助地磁的个人室内定位系统 |
CN106092095A (zh) * | 2016-05-31 | 2016-11-09 | 天津大学 | 一种地磁修正惯导的智能手机用户室内定位方法 |
CN106153049A (zh) * | 2016-08-19 | 2016-11-23 | 北京羲和科技有限公司 | 一种室内定位方法及装置 |
CN106248107A (zh) * | 2016-09-22 | 2016-12-21 | 中国电子科技集团公司第二十二研究所 | 一种基于室内地磁轨迹匹配的航迹推断校准方法和装置 |
US20170089706A1 (en) * | 2015-09-24 | 2017-03-30 | Microsoft Technology Licensing, Llc | Magnetometer arrays for inertial navigation, mapping, and drift compensation |
CN106610294A (zh) * | 2015-10-27 | 2017-05-03 | 高德信息技术有限公司 | 定位方法及装置 |
JP2017120261A (ja) * | 2015-12-29 | 2017-07-06 | 富士通株式会社 | 磁場に基づく位置決定 |
CN107084718A (zh) * | 2017-04-14 | 2017-08-22 | 桂林电子科技大学 | 基于行人航迹推算的室内定位方法 |
-
2017
- 2017-08-25 CN CN201710744801.2A patent/CN107421546B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103175529A (zh) * | 2013-03-01 | 2013-06-26 | 上海美迪索科电子科技有限公司 | 基于室内磁场特征辅助的行人惯性定位系统 |
CN105043387A (zh) * | 2015-06-26 | 2015-11-11 | 武汉科技大学 | 基于惯导辅助地磁的个人室内定位系统 |
CN104977006A (zh) * | 2015-08-11 | 2015-10-14 | 北京纳尔信通科技有限公司 | 一种基于模糊理论和多传感器融合的室内定位方法 |
US20170089706A1 (en) * | 2015-09-24 | 2017-03-30 | Microsoft Technology Licensing, Llc | Magnetometer arrays for inertial navigation, mapping, and drift compensation |
CN106610294A (zh) * | 2015-10-27 | 2017-05-03 | 高德信息技术有限公司 | 定位方法及装置 |
JP2017120261A (ja) * | 2015-12-29 | 2017-07-06 | 富士通株式会社 | 磁場に基づく位置決定 |
CN106092095A (zh) * | 2016-05-31 | 2016-11-09 | 天津大学 | 一种地磁修正惯导的智能手机用户室内定位方法 |
CN106153049A (zh) * | 2016-08-19 | 2016-11-23 | 北京羲和科技有限公司 | 一种室内定位方法及装置 |
CN106248107A (zh) * | 2016-09-22 | 2016-12-21 | 中国电子科技集团公司第二十二研究所 | 一种基于室内地磁轨迹匹配的航迹推断校准方法和装置 |
CN107084718A (zh) * | 2017-04-14 | 2017-08-22 | 桂林电子科技大学 | 基于行人航迹推算的室内定位方法 |
Non-Patent Citations (1)
Title |
---|
宋镖,等: "基于惯导辅助地磁的手机室内定位系统设计", 《传感技术学报》 * |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108151739B (zh) * | 2017-12-25 | 2021-02-12 | 北京理工大学 | 基于矢量匹配算法的重力匹配定位误差抑制方法 |
CN108151739A (zh) * | 2017-12-25 | 2018-06-12 | 北京理工大学 | 基于矢量匹配算法的重力匹配定位误差抑制方法 |
CN109029430A (zh) * | 2018-09-27 | 2018-12-18 | 北京华航无线电测量研究所 | 一种基于车载地磁定位导航的一致性判决方法及装置 |
CN109029430B (zh) * | 2018-09-27 | 2020-10-09 | 北京华航无线电测量研究所 | 一种基于车载地磁定位导航的一致性判决方法及装置 |
CN109443337A (zh) * | 2018-11-15 | 2019-03-08 | 西安空间无线电技术研究所 | 一种基于金刚石内nv色心的定位导航系统与方法 |
CN110057356A (zh) * | 2019-04-29 | 2019-07-26 | 桂林电子科技大学 | 一种隧道内车辆定位方法及装置 |
CN110057356B (zh) * | 2019-04-29 | 2021-07-20 | 桂林电子科技大学 | 一种隧道内车辆定位方法及装置 |
CN110285809A (zh) * | 2019-07-15 | 2019-09-27 | 李素敏 | 一种室内外一体化的组合定位装置 |
CN110307849A (zh) * | 2019-07-15 | 2019-10-08 | 李素敏 | 一种人员室内定位以及室内外一体化定位方法 |
CN111698774A (zh) * | 2020-06-23 | 2020-09-22 | 北京麦钉艾特科技有限公司 | 基于多源信息融合的室内定位方法及装置 |
CN111879312A (zh) * | 2020-07-31 | 2020-11-03 | 北京麦钉艾特科技有限公司 | 一种地磁图在线更新方法 |
CN112362044A (zh) * | 2020-11-03 | 2021-02-12 | 北京无限向溯科技有限公司 | 室内定位方法、装置、设备和系统 |
CN112494027A (zh) * | 2020-11-25 | 2021-03-16 | 深圳市资福医疗技术有限公司 | 胃肠动力检查系统 |
CN114222240A (zh) * | 2021-10-29 | 2022-03-22 | 中国石油大学(华东) | 一种基于粒子滤波的多源融合定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107421546B (zh) | 2019-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107421546B (zh) | 一种基于空间环境磁场特征的无源组合定位方法 | |
Kim et al. | Indoor positioning system using geomagnetic anomalies for smartphones | |
Pei et al. | Optimal heading estimation based multidimensional particle filter for pedestrian indoor positioning | |
KR101728123B1 (ko) | 지구 자기장을 이용한 동시 로컬리제이션 및 매핑 | |
CN102741653B (zh) | 安装磁信号源以便定位 | |
CN104969030B (zh) | 惯性装置、方法和程序 | |
CN101476860B (zh) | 一种高背景磁场下的磁定位方法及装置 | |
CN105043380A (zh) | 基于微机电传感器、WiFi定位、磁场匹配的室内导航方法 | |
US20150260524A1 (en) | Utilizing magnetic field based navigation | |
WO2014134710A1 (en) | Method and apparatus for fast magnetometer calibration | |
CN103561462A (zh) | 一种完全基于智能移动终端平台的室内定位系统和方法 | |
CN107179079A (zh) | 基于pdr与地磁融合的室内定位方法 | |
CN107014375A (zh) | 超低部署的室内定位系统及方法 | |
CN113295174B (zh) | 一种车道级定位的方法、相关装置、设备以及存储介质 | |
Long et al. | Single UWB anchor aided PDR heading and step length correcting indoor localization system | |
CN111698774A (zh) | 基于多源信息融合的室内定位方法及装置 | |
CN104913789A (zh) | 后台校准的装置和方法 | |
Bolat et al. | A hybrid indoor positioning solution based on Wi-Fi, magnetic field, and inertial navigation | |
Chen et al. | MeshMap: A magnetic field-based indoor navigation system with crowdsourcing support | |
KR102095135B1 (ko) | 실내 측위 방법 및 이를 수행하는 장치들 | |
Zwirello et al. | Study on UWB/INS integration techniques | |
Zheng et al. | Magnetic-based positioning system for moving target with feature vector | |
CN206281978U (zh) | 一种gnss接收机航向角的测试系统 | |
CN204115737U (zh) | 一种基于惯性制导和射频识别的室内定位装置 | |
Liu et al. | Wi-Fi-aided magnetic field positioning with floor estimation in indoor multi-floor navigation services |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |