CN105737833B - 室内导航方法及装置 - Google Patents
室内导航方法及装置 Download PDFInfo
- Publication number
- CN105737833B CN105737833B CN201610321161.XA CN201610321161A CN105737833B CN 105737833 B CN105737833 B CN 105737833B CN 201610321161 A CN201610321161 A CN 201610321161A CN 105737833 B CN105737833 B CN 105737833B
- Authority
- CN
- China
- Prior art keywords
- information
- ibeacon
- navigation
- sensor
- navigation system
- 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.)
- Expired - Fee Related
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/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
- G01C21/343—Calculating itineraries, i.e. routes leading from a starting point to a series of categorical destinations using a global route restraint, round trips, touristic trips
-
- 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/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
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
本发明提供了一种室内导航方法及装置,该方法包括:路径规划步骤,根据起止点及环境信息规划移动路径提供给用户;航向融合步骤,对陀螺仪和方向传感器进行实时卡尔曼滤波,获取融合航向信息并输出;抗干扰步骤,基于传感器定位信息筛选出可用的iBeacon列表,获取初始点和特征点的iBeacon定位信息,再根据位移信息和融合航向信息获取传感器导航信息;多源数据融合导航步骤,对传感器导航系统和iBeacon导航系统进行实时卡尔曼滤波,获取融合导航信息并输出;导航信息显示步骤,调用地图引擎模块,将融合导航信息在地图上实时动态显示。本发明结合了多种室内导航的方法,通过数据融合的方式实现低成本、高精度的导航和定位。
Description
技术领域
本发明涉及室内导航领域,尤其涉及一种室内导航方法及装置。
背景技术
随着科技的发展,人们对于室内导航的需求越来越大,比如在大型商场、展会、停车场、医院、飞机场等需要导航定位的复杂室内场景,人们的位置信息非常重要。
目前,已存在的室内定位技术有Bluetooth(蓝牙)定位技术、UW(Ultra Wideband,超宽带技术)、红外定位技术、RFID(射频识别定位技术)、WiFi定位技术、磁场定位技术以及计算机视觉定位技术等,它们主要采用射频、红外测距、指纹匹配和图像识别等方式来实现室内定位。然而,这些技术由于部署成本较高、精度有限、易受干扰、商业应用困难等原因,未被广泛应用于公共场所。
发明内容
本发明的目的是提供一种室内导航方法及装置,旨在解决室内导航应用中高定位精度和低成本二者不能兼得的技术问题,以较低的成本建设一套性能稳定、定位精度相对较高并能够大规模应用的室内定位系统。
本发明解决其技术问题所采用的技术方案是:
一种室内导航方法,其特征在于,包括:
数据接收步骤:用户设备接收室内iBeacon基站发送的广播消息,iBeacon基站发送的广播消息中包括自身所在的位置信息以及基站类型信息;
比较定位步骤:根据接收到的广播消息的信号强度、所述位置信息、所述基站类型信息,确定用户设备所在位置。
一种室内导航方法,其特征在于,包括:
路径规划步骤:
根据起点、终点及地图数据规划出移动路径,并向用户提供;所述地图数据存储于服务器;
航向融合步骤:
接收传感器导航系统提供的定位信息、角速度信息和航向信息,所述传感器导航系统包括陀螺仪和方向传感器,所述角速度信息由陀螺仪提供,所述航向信息由方向传感器提供;
构造角速度信息的卡尔曼滤波离散状态方程:其中,k是自然数,为状态向量,包括陀螺仪输出的角速度信息和惯性解算得到的惯性航向信息,Fh为状态转移矩阵,为状态噪声矩阵;
构造航向信息的卡尔曼滤波离散量测方程:其中,为量测向量,是方向传感器输出的航向信息,为的非线性量测函数,为量测噪声矩阵;
根据所述角速度信息的卡尔曼滤波离散状态方程和所述航向信息的卡尔曼滤波离散量测方程,对陀螺仪和方向传感器进行实时卡尔曼滤波,获取融合航向信息并输出;
抗干扰步骤:
获取传感器导航系统提供的当前位置的传感器定位信息Ps;
根据iBeacon导航系统提供的iBeacon信标列表,获取这些iBeacon信标的位置信息:Pb(1),Pb(2),…,Pb(i),…Pb(n),i、n是自然数,1≤i≤n,Pb(i)是第i个iBeacon信标的位置信息;
计算Pb(i)与Ps间的相对距离r(i);根据空间无线信号传播模型,得到与相对距离r(i)相应的预测iBeacon信号强度指示RSSIp(i);
调用蓝牙模块,获取该iBeacon信标在当前位置的真实iBeacon信号强度指示RSSIr(i);
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除;
将筛选后的iBeacon信标列表中iBeacon信标的信号强度与从服务器下载的iBeacon指纹数据库相匹配,获取初始点的iBeacon定位信息和用于校正的特征点的iBeacon定位信息;所述iBeacon指纹数据库中包含iBeacon信标的信号强度信息及其位置信息;
接收传感器导航系统提供的位移信息,所述传感器导航系统还包括加速度计,所述位移信息由加速度计提供;
以初始点的iBeacon定位信息为初始值,根据位移信息和融合航向信息,获取传感器导航信息;
多源数据融合导航步骤:
在iBeacon定位的特征点,构造传感器导航系统的卡尔曼滤波离散状态方程:Xk=FXk-1+Wk-1;其中,Xk为状态向量,包括传感器导航位置信息、速度信息和加速度信息;F为状态转移矩阵;Wk-1为状态噪声矩阵;所述位置信息、速度信息和加速度信息由加速度计提供;
在iBeacon定位的特征点,构造iBeacon导航系统的卡尔曼滤波离散量测方程:yk=h(Xk)+vk;其中,yk为量测向量,是用于校正的特征点的iBeacon定位信息,h(Xk)为Xk的非线性量测函数,vk为量测噪声矩阵;
根据所述传感器导航系统的卡尔曼滤波离散状态方程和所述iBeacon导航系统的卡尔曼滤波离散量测方程,对传感器导航系统和iBeacon导航系统进行实时卡尔曼滤波,获取融合导航信息并输出;
导航信息显示步骤:
调用地图引擎模块,将所述融合导航信息在地图上实时动态显示;所述地图存储于服务器。
在此基础上,进一步地,所述抗干扰步骤前,还包括:
预先下载步骤:
根据融合导航信息,预先下载在预定范围内的iBeacon指纹数据库。
在上述任意实施例的基础上,进一步地,所述抗干扰步骤后,还包括:
异常记录步骤:
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除,并记录在iBeacon信标异常数据库中;所述iBeacon信标异常数据库存储于服务器。
在上述任意实施例的基础上,进一步地,所述导航信息显示步骤后,还包括:
移动路径显示步骤:
记录融合导航信息,存储于导航信息数据库,所述导航信息数据库存储于服务器;
绘制移动路径,在地图上显示该移动路径。
一种室内导航装置,其特征在于,包括:
数据接收模块,其用于用户设备接收室内iBeacon基站发送的广播消息,iBeacon基站发送的广播消息中包括自身所在的位置信息以及基站类型信息;
比较定位模块,其用于根据接收到的广播消息的信号强度、所述位置信息、所述基站类型信息,确定用户设备所在位置。
一种室内导航装置,其特征在于,包括:
路径规划模块,其用于:
根据起点、终点及地图数据规划出移动路径,并向用户提供;所述地图数据存储于服务器;
航向融合模块,其用于:
接收传感器导航系统提供的定位信息、角速度信息和航向信息,所述传感器导航系统包括陀螺仪和方向传感器,所述角速度信息由陀螺仪提供,所述航向信息由方向传感器提供;
构造角速度信息的卡尔曼滤波离散状态方程:其中,k是自然数,为状态向量,包括陀螺仪输出的角速度信息和惯性解算得到的惯性航向信息,Fh为状态转移矩阵,为状态噪声矩阵;
构造航向信息的卡尔曼滤波离散量测方程:其中,为量测向量,是方向传感器输出的航向信息,为的非线性量测函数,为量测噪声矩阵;
根据所述角速度信息的卡尔曼滤波离散状态方程和所述航向信息的卡尔曼滤波离散量测方程,对陀螺仪和方向传感器进行实时卡尔曼滤波,获取融合航向信息并输出;
抗干扰模块,其用于:
获取传感器导航系统提供的当前位置的传感器定位信息Ps;
根据iBeacon导航系统提供的iBeacon信标列表,获取这些iBeacon信标的位置信息:Pb(1),Pb(2),…,Pb(i),…Pb(n),i、n是自然数,1≤i≤n,Pb(i)是第i个iBeacon信标的位置信息;
计算Pb(i)与Ps间的相对距离r(i);根据空间无线信号传播模型,得到与相对距离r(i)相应的预测iBeacon信号强度指示RSSIp(i);
调用蓝牙模块,获取该iBeacon信标在当前位置的真实iBeacon信号强度指示RSSIr(i);
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除;
将筛选后的iBeacon信标列表中iBeacon信标的信号强度与从服务器下载的iBeacon指纹数据库相匹配,获取初始点的iBeacon定位信息和用于校正的特征点的iBeacon定位信息;所述iBeacon指纹数据库中包含iBeacon信标的信号强度信息及其位置信息;
接收传感器导航系统提供的位移信息,所述传感器导航系统还包括加速度计,所述位移信息由加速度计提供;
以初始点的iBeacon定位信息为初始值,根据位移信息和融合航向信息,获取传感器导航信息;
多源数据融合导航模块,其用于:
在iBeacon定位的特征点,构造传感器导航系统的卡尔曼滤波离散状态方程:Xk=FXk-1+Wk-1;其中,Xk为状态向量,包括传感器导航位置信息、速度信息和加速度信息;F为状态转移矩阵;Wk-1为状态噪声矩阵;所述位置信息、速度信息和加速度信息由加速度计提供;
在iBeacon定位的特征点,构造iBeacon导航系统的卡尔曼滤波离散量测方程:yk=h(Xk)+vk;其中,yk为量测向量,是用于校正的特征点的iBeacon定位信息,h(Xk)为Xk的非线性量测函数,vk为量测噪声矩阵;
根据所述传感器导航系统的卡尔曼滤波离散状态方程和所述iBeacon导航系统的卡尔曼滤波离散量测方程,对传感器导航系统和iBeacon导航系统进行实时卡尔曼滤波,获取融合导航信息并输出;
导航信息显示模块,其用于:
调用地图引擎模块,将所述融合导航信息在地图上实时动态显示;所述地图存储于服务器。
在此基础上,进一步地,所述抗干扰模块前,还包括:
预先下载模块,其用于:
根据融合导航信息,预先下载在预定范围内的iBeacon指纹数据库。
在上述任意实施例的基础上,进一步地,所述抗干扰模块后,还包括:
异常记录模块,其用于:
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除,并记录在iBeacon信标异常数据库中;所述iBeacon信标异常数据库存储于服务器。
在上述任意实施例的基础上,进一步地,所述导航信息显示模块后,还包括:
移动路径显示模块,其用于:
记录融合导航信息,存储于导航信息数据库;所述导航信息数据库存储于服务器;
绘制移动路径,在地图上显示该移动路径。
本发明的有益效果是:
本发明提供了一种室内导航方法及装置,该方法包括:路径规划步骤,根据起止点及环境信息规划移动路径提供给用户;航向融合步骤,对陀螺仪和方向传感器进行实时卡尔曼滤波,获取融合航向信息并输出;抗干扰步骤,基于传感器定位信息筛选出可用的iBeacon列表,获取初始点和特征点的iBeacon定位信息,再根据位移信息和融合航向信息获取传感器导航信息;多源数据融合导航步骤,根据传感器导航系统的卡尔曼滤波离散状态方程和iBeacon导航系统的卡尔曼滤波离散量测方程,对传感器导航系统和iBeacon导航系统进行实时卡尔曼滤波,获取融合导航信息并输出;导航信息显示步骤,调用地图引擎模块,将融合导航信息在地图上实时动态显示。本发明结合了多种室内导航的方法,通过数据融合的方式实现低成本、高精度的导航和定位。相比现有的室内定位方法,本发明采用抗干扰算法,在某个iBeacon信标受到干扰时可将其从用于定位的iBeacon信标列表中剔除,防止受干扰iBeacon信标影响定位结果,保证了复杂室内环境下导航的可靠性和稳定性;采用陀螺仪和方向传感器融合解算姿态的方法,获得的用户姿态更加准确;采用传感器与iBeacon的组合导航,结合了手机传感器定位频率高、短时定位精度高和iBeacon长时定位精度高的优势,使定位和导航结果更加平滑和精确;设计的系统和方法可同时应用于iOS和Android两种平台,通用性强,适用于楼宇、商场、停车场、医院和机场等公共场所的室内导航和定位,为智慧商城乃至智慧城市提供技术支撑和保障。
附图说明
下面结合附图和实施例对本发明进一步说明。
图1示出了本发明实施例提供的一种室内导航方法的简要流程图;
图2示出了本发明实施例提供的一种室内导航装置的结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不限定本发明。
具体实施例一
本发明实施例提供了一种室内导航方法,包括:
数据接收步骤:用户设备接收室内iBeacon基站发送的广播消息,iBeacon基站发送的广播消息中包括自身所在的位置信息以及基站类型信息;
比较定位步骤:根据接收到的广播消息的信号强度、位置信息、基站类型信息,确定用户设备所在位置。
具体实施例二
如图1所示,本发明实施例提供了一种室内导航方法,包括:
路径规划步骤S101:
根据起点、终点及地图数据规划出移动路径,并向用户提供;地图数据存储于服务器;
航向融合步骤S102:
接收传感器导航系统提供的定位信息、角速度信息和航向信息;传感器导航系统包括陀螺仪和方向传感器;角速度信息由陀螺仪提供;航向信息由方向传感器提供;
构造角速度信息的卡尔曼滤波离散状态方程:其中,k是自然数,为状态向量,包括陀螺仪输出的角速度信息和惯性解算得到的惯性航向信息,Fh为状态转移矩阵,为状态噪声矩阵;
构造航向信息的卡尔曼滤波离散量测方程:其中,为量测向量,是方向传感器输出的航向信息,为的非线性量测函数,为量测噪声矩阵;
根据角速度信息的卡尔曼滤波离散状态方程和航向信息的卡尔曼滤波离散量测方程,对陀螺仪和方向传感器进行实时卡尔曼滤波,获取融合航向信息并输出;
抗干扰步骤S103:
获取传感器导航系统提供的当前位置的传感器定位信息Ps;
根据iBeacon导航系统提供的iBeacon信标列表,获取这些iBeacon信标的位置信息:Pb(1),Pb(2),…,Pb(i),…Pb(n),i、n是自然数,1≤i≤n,Pb(i)是第i个iBeacon信标的位置信息;
计算Pb(i)与Ps间的相对距离r(i);根据空间无线信号传播模型,得到与相对距离r(i)相应的预测iBeacon信号强度指示RSSIp(i);
调用蓝牙模块,获取该iBeacon信标在当前位置的真实iBeacon信号强度指示RSSIr(i);
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除;
将筛选后的iBeacon信标列表中iBeacon信标的信号强度与从服务器下载的iBeacon指纹数据库相匹配,获取初始点的iBeacon定位信息和用于校正的特征点的iBeacon定位信息;iBeacon指纹数据库中包含iBeacon信标的信号强度信息及其位置信息;
接收传感器导航系统提供的位移信息,传感器导航系统还包括加速度计,位移信息由加速度计提供;
以初始点的iBeacon定位信息为初始值,根据位移信息和融合航向信息,获取传感器导航信息;
多源数据融合导航步骤S104:
在iBeacon定位的特征点,构造传感器导航系统的卡尔曼滤波离散状态方程:Xk=FXk-1+Wk-1;其中,Xk为状态向量,包括传感器导航位置信息、速度信息和加速度信息;F为状态转移矩阵;Wk-1为状态噪声矩阵;位置信息、速度信息和加速度信息由加速度计提供;
在iBeacon定位的特征点,构造iBeacon导航系统的卡尔曼滤波离散量测方程:yk=h(Xk)+vk;其中,yk为量测向量,是用于校正的特征点的iBeacon定位信息,h(Xk)为Xk的非线性量测函数,vk为量测噪声矩阵;
根据传感器导航系统的卡尔曼滤波离散状态方程和iBeacon导航系统的卡尔曼滤波离散量测方程,对传感器导航系统和iBeacon导航系统进行实时卡尔曼滤波,获取融合导航信息并输出;
导航信息显示步骤S105:
调用地图引擎模块,将融合导航信息在地图上实时动态显示;地图存储于服务器。
航向融合步骤S102的方程中,上角标h无实际意义,目的是与多源数据融合导航步骤S104的方程区别开来。
本发明实施例中,路径规划步骤根据起点、终点及场地情况规划出移动路径,供用户选择;航向融合步骤融合陀螺仪和方向传感器数据得到融合航向信息;抗干扰步骤比较传感器导航系统和iBeacon导航系统的导航结果,抑制受干扰iBeacon信标对数据融合后导航结果的影响;多源数据融合导航步骤融合传感器导航系统和iBeacon导航系统两者输出的导航信息,得到融合导航信息,之后再进一步调用地图引擎模块将导航信息在地图中实时显示,绘制用户的移动路径。
本发明结合了多种室内导航的方法,通过数据融合的方式实现低成本、高精度的导航和定位。相比现有的室内定位方法,本发明采用抗干扰算法,在某个iBeacon信标受到干扰时可将其从用于定位的iBeacon信标列表中剔除,防止受干扰iBeacon信标影响定位结果,保证了复杂室内环境下导航的可靠性和稳定性;采用陀螺仪和方向传感器融合解算姿态的方法,获得的用户姿态更加准确;采用传感器与iBeacon的组合导航,结合了手机传感器定位频率高、短时定位精度高和iBeacon长时定位精度高的优势,使定位和导航结果更加平滑和精确;设计的系统和方法可同时应用于iOS和Android两种平台,通用性强,适用于楼宇、商场、停车场、医院和机场等公共场所的室内导航和定位,为智慧商城乃至智慧城市提供技术支撑和保障。
在此基础上,进一步地,抗干扰步骤前,还可以包括:
预先下载步骤:
根据融合导航信息,预先在预定范围内的iBeacon指纹数据库。
这样做的好处是,在探测到用户当前位置后,提前下载预定距离范围内的iBeacon指纹数据库,提高定位效率。
在上述任意实施例的基础上,进一步地,抗干扰步骤后,还可以包括:
异常记录步骤:
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除,并记录在iBeacon信标异常数据库中;iBeacon信标异常数据库存储于服务器。
这样做的好处是,便于对定位异常的iBeacon信标进行后续处理,了解其产生定位异常的原因并进行定位信息的修复。
在上述任意实施例的基础上,进一步地,导航信息显示步骤后,还可以包括:
移动路径显示步骤:
记录融合导航信息,存储于导航信息数据库,导航信息数据库存储于服务器;
绘制移动路径,在地图上显示该移动路径。
这样做的好处是,方便用户查看自己的历史移动路径,提高用户体验。
具体实施例三
一种室内导航装置,其特征在于,包括:
数据接收模块,其用于用户设备接收室内iBeacon基站发送的广播消息,iBeacon基站发送的广播消息中包括自身所在的位置信息以及基站类型信息;
比较定位模块,其用于根据接收到的广播消息的信号强度、位置信息、基站类型信息,确定用户设备所在位置。
具体实施例四
如图2所示,本发明实施例提供了一种室内导航装置,其特征在于,包括:
路径规划模块201,其用于:
根据起点、终点及地图数据规划出移动路径,并向用户提供;地图数据存储于服务器;
航向融合模块202,其用于:
接收传感器导航系统提供的定位信息、角速度信息和航向信息;传感器导航系统包括陀螺仪和方向传感器;角速度信息由陀螺仪提供;航向信息由方向传感器提供;
构造角速度信息的卡尔曼滤波离散状态方程:其中,k是自然数,为状态向量,包括陀螺仪输出的角速度信息和惯性解算得到的惯性航向信息,Fh为状态转移矩阵,为状态噪声矩阵;
构造航向信息的卡尔曼滤波离散量测方程:其中,为量测向量,是方向传感器输出的航向信息,为的非线性量测函数,为量测噪声矩阵;
根据角速度信息的卡尔曼滤波离散状态方程和航向信息的卡尔曼滤波离散量测方程,对陀螺仪和方向传感器进行实时卡尔曼滤波,获取融合航向信息并输出;
抗干扰模块203,其用于:
获取传感器导航系统提供的当前位置的传感器定位信息Ps;
根据iBeacon导航系统提供的iBeacon信标列表,获取这些iBeacon信标的位置信息:Pb(1),Pb(2),…,Pb(i),…Pb(n),i、n是自然数,1≤i≤n,Pb(i)是第i个iBeacon信标的位置信息;
计算Pb(i)与Ps间的相对距离r(i);根据空间无线信号传播模型,得到与相对距离r(i)相应的预测iBeacon信号强度指示RSSIp(i);
调用蓝牙模块,获取该iBeacon信标在当前位置的真实iBeacon信号强度指示RSSIr(i);
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除;
将筛选后的iBeacon信标列表中iBeacon信标的信号强度与从服务器下载的iBeacon指纹数据库相匹配,获取初始点的iBeacon定位信息和用于校正的特征点的iBeacon定位信息;iBeacon指纹数据库中包含iBeacon信标的信号强度信息及其位置信息;
接收传感器导航系统提供的位移信息,传感器导航系统还包括加速度计,位移信息由加速度计提供;
以初始点的iBeacon定位信息为初始值,根据位移信息和融合航向信息,获取传感器导航信息;
多源数据融合导航模块204,其用于:
在iBeacon定位的特征点,构造传感器导航系统的卡尔曼滤波离散状态方程:Xk=FXk-1+Wk-1;其中,Xk为状态向量,包括传感器导航位置信息、速度信息和加速度信息;F为状态转移矩阵;Wk-1为状态噪声矩阵;位置信息、速度信息和加速度信息由加速度计提供;
在iBeacon定位的特征点,构造iBeacon导航系统的卡尔曼滤波离散量测方程:yk=h(Xk)+vk;其中,yk为量测向量,是用于校正的特征点的iBeacon定位信息,h(Xk)为Xk的非线性量测函数,vk为量测噪声矩阵;
根据传感器导航系统的卡尔曼滤波离散状态方程和iBeacon导航系统的卡尔曼滤波离散量测方程,对传感器导航系统和iBeacon导航系统进行实时卡尔曼滤波,获取融合导航信息并输出;
导航信息显示模块205,其用于:
调用地图引擎模块,将融合导航信息在地图上实时动态显示;地图存储于服务器。
本发明该装置结合了多种室内导航的方法,通过数据融合的方式实现低成本、高精度的导航和定位。本发明该装置可以在某个iBeacon信标受到干扰时可将其从用于定位的iBeacon信标列表中剔除,防止受干扰iBeacon信标影响定位结果,保证了复杂室内环境下导航的可靠性和稳定性;采用陀螺仪和方向传感器融合解算姿态的方法,获得的用户姿态更加准确;采用传感器与iBeacon的组合导航,结合了手机传感器定位频率高、短时定位精度高和iBeacon长时定位精度高的优势,使定位和导航结果更加平滑和精确;设计的系统可同时应用于iOS和Android两种平台,通用性强,适用于楼宇、商场、停车场、医院和机场等公共场所的室内导航和定位,为智慧商城乃至智慧城市提供技术支撑和保障。
在此基础上,进一步地,抗干扰模块前,还可以包括:
预先下载模块,其用于:
根据融合导航信息,预先在预定范围内的iBeacon指纹数据库。
这样做的好处是,在探测到用户当前位置后,提前下载预定距离范围内的iBeacon指纹数据库,提高定位效率。
在上述任意实施例的基础上,进一步地,抗干扰模块后,还可以包括:
异常记录模块,其用于:
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该异常iBeacon信标从iBeacon信标列表中删除,并记录在iBeacon信标异常数据库中;iBeacon信标异常数据库存储于服务器。
这样做的好处是,便于对定位异常的iBeacon信标进行后续处理,了解其产生定位异常的原因并进行定位信息的修复。
在上述任意实施例的基础上,进一步地,导航信息显示模块后,还可以包括:
移动路径显示模块,其用于:
记录融合导航信息,存储于导航信息数据库;导航信息数据库存储于服务器;
绘制移动路径,在地图上显示该移动路径。
这样做的好处是,方便用户查看自己的历史移动路径,提高用户体验。
尽管本发明已进行了一定程度的描述,明显地,在不脱离本发明的精神和范围的条件下,可进行各个条件的适当变化。可以理解,本发明不限于所述实施方案,而归于权利要求的范围,其包括所述每个因素的等同替换。
Claims (8)
1.一种室内导航方法,其特征在于,包括:
数据接收步骤:用户设备接收室内iBeacon基站发送的广播消息,iBeacon基站发送的广播消息中包括自身所在的位置信息以及基站类型信息;
比较定位步骤:根据接收到的广播消息的信号强度、所述位置信息、所述基站类型信息,确定用户设备所在位置;
具体包括:
路径规划步骤:
根据起点、终点及地图数据规划出移动路径,并向用户提供;所述地图数据存储于服务器;
航向融合步骤:
接收传感器导航系统提供的定位信息、角速度信息和航向信息,所述传感器导航系统包括陀螺仪和方向传感器,所述角速度信息由陀螺仪提供,所述航向信息由方向传感器提供;
构造角速度信息的卡尔曼滤波离散状态方程:其中,k是自然数,为状态向量,包括陀螺仪输出的角速度信息和惯性解算得到的惯性航向信息,Fh为状态转移矩阵,为状态噪声矩阵;
构造航向信息的卡尔曼滤波离散量测方程:其中,为量测向量,是方向传感器输出的航向信息,为的非线性量测函数,为量测噪声矩阵;
根据所述角速度信息的卡尔曼滤波离散状态方程和所述航向信息的卡尔曼滤波离散量测方程,对陀螺仪和方向传感器进行实时卡尔曼滤波,获取融合航向信息并输出;
抗干扰步骤:
获取传感器导航系统提供的当前位置的传感器定位信息Ps;
根据iBeacon导航系统提供的iBeacon信标列表,获取这些iBeacon信标的位置信息:Pb(1),Pb(2),...,Pb(i),...Pb(n),i.n是自然数,1≤i≤n,Pb(i)是第i个iBeacon 信标的位置信息;
计算Pb(i)与Ps间的相对距离r(i);根据空间无线信号传播模型,得到与相对距离r(i)相应的预测iBeacon信号强度指示RSSIp(i);
调用蓝牙模块,获取该iBeacon信标在当前位置的真实iBeacon信号强度指示RSSIr(i);
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除;
将筛选后的iBeacon信标列表中iBeacon信标的信号强度与从服务器下载的iBeacon指纹数据库相匹配,获取初始点的iBeacon定位信息和用于校正的特征点的iBeacon定位信息;所述iBeacon指纹数据库中包含iBeacon信标的信号强度信息及其位置信息;
接收传感器导航系统提供的位移信息,所述传感器导航系统还包括加速度计,所述位移信息由加速度计提供;
以初始点的iBeacon定位信息为初始值,根据位移信息和融合航向信息,获取传感器导航信息;
多源数据融合导航步骤:
在iBeacon定位的特征点,构造传感器导航系统的卡尔曼滤波离散状态方程:Xk-FXk-1+Wk-1;其中,Xk为状态向量,包括传感器导航位置信息、速度信息和加速度信息;F为状态转移矩阵;Wk-1为状态噪声矩阵;所述位置信息、速度信息和加速度信息由加速度计提供;
在iBeacon定位的特征点,构造iBeacon导航系统的卡尔曼滤波离散量测方程:yk=h(Xk)+vk;其中,yk为量测向量,是用于校正的特征点的iBeacon定位信息,h(Xk)为Xk的非线性量测函数,vk为量测噪声矩阵;
根据所述传感器导航系统的卡尔曼滤波离散状态方程和所述iBeacon导航系统的卡尔曼滤波离散量测方程,对传感器导航系统和iBeacon导航系统进行实时卡尔曼滤波,获取融合导航信息并输出;
导航信息显示步骤:
调用地图引擎模块,将所述融合导航信息在地图上实时动态显示;所述地图存储于服务器。
2.根据权利要求1所述的室内导航方法,其特征在于,所述抗干扰步骤前,还包括:
预先下载步骤:
根据融合导航信息,预先下载在预定范围内的iBeacon指纹数据库。
3.根据权利要求1或2所述的室内导航方法,其特征在于,所述抗干扰步骤后,还包括:
异常记录步骤:
当||RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除,并记录在iBeacon信标异常数据库中;所述iBeacon信标异常数据库存储于服务器。
4.根据权利要求1或2所述的室内导航方法,其特征在于,所述导航信息显示步骤后,还包括:
移动路径显示步骤:
记录融合导航信息,存储于导航信息数据库,所述导航信息数据库存储于服务器;
绘制移动路径,在地图上显示该移动路径。
5.一种室内导航装置,其特征在于,包括:
数据接收模块,其用于用户设备接收室内iBeacon基站发送的广播消息,iBeacon基站发送的广播消息中包括自身所在的位置信息以及基站类型信息;
比较定位模块,其用于根据接收到的广播消息的信号强度、所述位置信息、所述基站类型信息,确定用户设备所在位置;
具体包括:
路径规划模块,其用于:
根据起点、终点及地图数据规划出移动路径,并向用户提供;所述地图数据存储于服务器;
航向融合模块,其用于:
接收传感器导航系统提供的定位信息、角速度信息和航向信息,所述传感器导航系统包括陀螺仪和方向传感器,所述角速度信息由陀螺仪提供,所述航向信息由方向传感器提供;
构造角速度信息的卡尔曼滤波离散状态方程:其中,k是自然数,为状态向量,包括陀螺仪输出的角速度信息和惯性解算得到的惯性航向信息,Fh为状态转移矩阵,为状态噪声矩阵;
构造航向信息的卡尔曼滤波离散量测方程:其中,为量测向量,是方向传感器输出的航向信息,为的非线性量测函数,为量测噪声矩阵;
根据所述角速度信息的卡尔曼滤波离散状态方程和所述航向信息的卡尔曼滤波离散量测方程,对陀螺仪和方向传感器进行实时卡尔曼滤波,获取融合航向信息并输出;
抗干扰模块,其用于:
获取传感器导航系统提供的当前位置的传感器定位信息Ps;
根据iBeacon导航系统提供的iBeacon信标列表,获取这些iBeacon信标的位置信息:pb(1),Pb(2),...,Pb(i),...Pb(n),i,n是自然数,1≤i≤n,Pb(i)是第i个iBeacon信标的位置信息;
计算Pb(i)与Ps间的相对距离r(i);根据空间无线信号传播模型,得到与相对距离r(i)相应的预测iBeacon信号强度指示RSSIp(i);
调用蓝牙模块,获取该iBeacon信标在当前位置的真实iBeacon信号强度指示RSSIr(i);
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除;
将筛选后的iBeacon信标列表中iBeacon信标的信号强度与从服务器下载的iBeacon指纹数据库相匹配,获取初始点的iBeacon定位信息和用于校正的特征点的iBeacon定位信息;所述iBeacon指纹数据库中包含iBeacon信标的信号强度信息及其位置信息;
接收传感器导航系统提供的位移信息,所述传感器导航系统还包括加速度计,所述位移信息由加速度计提供;
以初始点的iBeacon定位信息为初始值,根据位移信息和融合航向信息,获取传感器导航信息;
多源数据融合导航模块,其用于:
在iBeacon定位的特征点,构造传感器导航系统的卡尔曼滤波离散状态方程:Xk=FXk-1+Wk-1;其中,Xk为状态向量,包括传感器导航位置信息、速度信息和加速度信息;F为状态转移矩阵;Wk-1为状态噪声矩阵;所述位置信息、速度信息和加速度信息由加速度计提供;
在iBeacon定位的特征点,构造iBeacon导航系统的卡尔曼滤波离散量测方程:yk=h(Xk)+vk;其中,yk为量测向量,是用于校正的特征点的iBeacon定位信息,h(Xk)为Xk的非线性量测函数,vk为量测噪声矩阵;
根据所述传感器导航系统的卡尔曼滤波离散状态方程和所述iBeacon导航系统的卡尔曼滤波离散量测方程,对传感器导航系统和iBeacon导航系统进行实时卡尔曼滤波,获取融合导航信息并输出;
导航信息显示模块,其用于:
调用地图引擎模块,将所述融合导航信息在地图上实时动态显示;所述地图存储于服务器。
6.根据权利要求5所述的室内导航装置,其特征在于,所述抗干扰模块前,还包括:
预先下载模块,其用于:
根据融合导航信息,预先下载在预定范围内的iBeacon指纹数据库。
7.根据权利要求5或6所述的室内导航装置,其特征在于,所述抗干扰模块后,还包括:
异常记录模块,其用于:
当|RSSIr(i)-RSSIp(i)|>T时,T为预定的比较阈值,将该iBeacon信标从iBeacon信标列表中删除,并记录在iBeacon信标异常数据库中;所述iBeacon信标异常数据库存储于服务器。
8.根据权利要求5或6所述的室内导航装置,其特征在于,所述导航信息显示模块后,还包括:
移动路径显示模块,其用于:
记录融合导航信息,存储于导航信息数据库;所述导航信息数据库存储于服务器;
绘制移动路径,在地图上显示该移动路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610321161.XA CN105737833B (zh) | 2016-05-13 | 2016-05-13 | 室内导航方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610321161.XA CN105737833B (zh) | 2016-05-13 | 2016-05-13 | 室内导航方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105737833A CN105737833A (zh) | 2016-07-06 |
CN105737833B true CN105737833B (zh) | 2018-06-22 |
Family
ID=56256138
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610321161.XA Expired - Fee Related CN105737833B (zh) | 2016-05-13 | 2016-05-13 | 室内导航方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105737833B (zh) |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106403941B (zh) * | 2016-08-29 | 2019-04-19 | 上海智臻智能网络科技股份有限公司 | 一种定位方法及装置 |
CN106525043A (zh) * | 2016-10-09 | 2017-03-22 | 李信 | 一种智能路线规划方法 |
CN106851539B (zh) * | 2017-02-03 | 2020-05-22 | 上海雅丰信息科技有限公司 | 基于蓝牙和惯导的融合室内定位方法 |
CN107063301A (zh) * | 2017-03-02 | 2017-08-18 | 合肥极友软件开发有限公司 | 一种车载卫星定位的自动位置纠正系统 |
CN106989747B (zh) * | 2017-03-29 | 2020-09-04 | 无锡市中安捷联科技有限公司 | 一种基于室内平面图的自主导航系统 |
CN107179080B (zh) * | 2017-06-07 | 2020-07-24 | 纳恩博(北京)科技有限公司 | 电子设备的定位方法和装置、电子设备、电子定位系统 |
CN107389968B (zh) * | 2017-07-04 | 2020-01-24 | 武汉视览科技有限公司 | 一种基于光流传感器和加速度传感器的无人机定点实现方法和装置 |
CN107490372A (zh) * | 2017-07-31 | 2017-12-19 | 程昊 | 一种基于iBeacon的定位、导航的方法及系统 |
CN107605219B (zh) * | 2017-09-05 | 2019-05-10 | 武汉大学 | 一种基于ble的自适应室内停车导航与自动泊车系统及方法 |
CN107764266A (zh) * | 2017-09-18 | 2018-03-06 | 千寻位置网络有限公司 | 室内组合导航仿真方法及系统、导航装置、终端、存储器 |
CN107517448A (zh) * | 2017-09-19 | 2017-12-26 | 深圳市深层互联科技有限公司 | 一种beacon基站的触发方法及装置 |
CN107734457B (zh) * | 2017-09-29 | 2020-07-28 | 桂林电子科技大学 | 智慧停车场导航系统及方法 |
CN108534780A (zh) * | 2018-03-28 | 2018-09-14 | 联动优势电子商务有限公司 | 一种室内导航方法、服务器和终端 |
CN108801264A (zh) * | 2018-06-05 | 2018-11-13 | 安徽邵氏华艾生物医疗电子科技有限公司 | 一种三维校正模型下的室内导航方法 |
CN109000654B (zh) * | 2018-06-07 | 2022-04-01 | 全图通位置网络有限公司 | 定位方法、装置、设备及存储介质 |
CN109270490A (zh) * | 2018-09-30 | 2019-01-25 | 成都精位科技有限公司 | 定位信号处理方法及装置 |
CN109540124A (zh) * | 2018-11-23 | 2019-03-29 | 东北大学 | 一种基于nb-iot的高精度定位方法 |
CN112461238B (zh) * | 2020-12-14 | 2023-03-10 | 北京航天控制仪器研究所 | 一种动态随机布设信标的室内人员定位导航系统及方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000213952A (ja) * | 1999-01-27 | 2000-08-04 | Nec Mobile Commun Ltd | 移動通信におけるナビゲ―ション方法およびシステム |
CN102359787B (zh) * | 2011-07-15 | 2013-07-03 | 东南大学 | 一种wsn/mins高精度实时组合导航信息融合方法 |
CN104182250A (zh) * | 2014-08-06 | 2014-12-03 | 胡继强 | 一种通用APP软件方便支持其他iBeacon方法 |
CN104270710A (zh) * | 2014-09-25 | 2015-01-07 | 郭利敏 | 一种基于iBeacon的蓝牙室内定位系统 |
CN104284419B (zh) * | 2014-10-20 | 2018-01-12 | 北京邮电大学 | 一种基于iBeacon的室内定位及辅助导航方法、装置和系统 |
CN105045876A (zh) * | 2015-07-17 | 2015-11-11 | 北京奇虎科技有限公司 | 获取周边信息的方法、装置及系统 |
CN105208652B (zh) * | 2015-09-21 | 2018-11-30 | 徐乔治 | 一种基于无线技术的室内定位系统 |
-
2016
- 2016-05-13 CN CN201610321161.XA patent/CN105737833B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN105737833A (zh) | 2016-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105737833B (zh) | 室内导航方法及装置 | |
US9476717B2 (en) | Simultaneous localization and mapping by using Earth's magnetic fields | |
US8174447B2 (en) | Concept for localizing a position on a path | |
CN104390643B (zh) | 基于多信息融合实现室内定位的方法 | |
KR102399591B1 (ko) | 관심 지역 및 입구의 위치를 결정하는 시스템 | |
CN105783917B (zh) | 基于地磁的移动终端定位方法及其装置 | |
US10415978B2 (en) | Landmark location determination | |
TWI391632B (zh) | 利用識別標籤之定位導航系統與應用於其上之定位導航方法 | |
CN106461786B (zh) | 室内全球定位系统 | |
CN104717744B (zh) | 一种基于无线局域网及分层聚类的室内定位方法 | |
CN104931051A (zh) | 基于大数据的室内电子地图绘制和导航方法及其系统 | |
CN102829775A (zh) | 一种室内导航方法、系统及设备 | |
US20170055118A1 (en) | Location and activity aware content delivery system | |
CN103162683A (zh) | 用于执行地图匹配的装置和方法 | |
CN108496057A (zh) | 基于照明源定位 | |
CN106949892A (zh) | 一种定位方法及装置 | |
CN107421546A (zh) | 一种基于空间环境磁场特征的无源组合定位方法 | |
CN111698774B (zh) | 基于多源信息融合的室内定位方法及装置 | |
CN105025439A (zh) | 室内定位系统及所应用的数据库、方法和装置 | |
CN104181500A (zh) | 一种基于惯性信息和机会无线信号特征的实时定位方法 | |
CN105592420B (zh) | 环境特征库生成及基于环境特征库的室内定位方法和装置 | |
CN104618869A (zh) | 室内定位方法和设备 | |
KR20160105628A (ko) | 비콘과 가속도 센서를 활용한 이동거리와 위치 측정 방법 및 이를 이용한 실내 측위 시스템 | |
CN103557834B (zh) | 一种基于双摄像头的实体定位方法 | |
CN108512888A (zh) | 一种信息标注方法、云端服务器、系统、电子设备及计算机程序产品 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180622 |
|
CF01 | Termination of patent right due to non-payment of annual fee |