[发明专利]基于室内磁场特征辅助的行人惯性定位系统

说明书

技术领域

本发明涉及惯性导航和室内定位领域，具体地，涉及一种基于室内磁场特征辅助的行人惯性定位系统。

背景技术

空间中分布着由地磁南指向地磁北的地磁场。地磁场在室内环境下受到建筑物钢筋混凝土结构和室内电机、电器的共同影响，形成大小和方向偏离原始地磁场的异常。这种磁场异常即使经过数月也很稳定，可以用来作为定位的依据。目前的研究和专利将磁场信息用于定位大多基于机器人的应用，定位时逐点匹配磁场数据库。现有的室内定位方案具有以下缺陷：

1、现有的室内定位系统需要信标的支持。如基于RFID或者Wifi的接收的信号强度指示(RSSI)、基于超声波或者基于超宽带的定位方式都需要额外信标的支持，很多情况下要事先知道信标的位置才能进行定位。

2、现有的室内定位系统获取定位信号所需的能耗较高。现有技术使用视频系统来获取定位信息意味着能耗较高，在便携设备中不能进行长时间的定位工作。

3、现有定位设备成本较高。一些融合系统采用了距离传感器，气压传感器等器件摄像头等设备成本较高。

发明内容

针对现有技术中的缺陷，本发明的目的是提供一种基于室内磁场特征辅助的行人惯性定位系统。

根据本发明的一个方面，提供一种基于室内磁场特征辅助的行人惯性定位系统，包括：磁场及惯性数据获取模块100、行人航位推算模块101、磁场定位模块102、定位融合模块103和输出模块104，其中，

磁场及惯性数据获取模块100用以采集磁场信息数据、以及行人的加速度和角速度信息数据；

行人航位推算模块101与磁场及惯性数据获取模块100连接，用以根据加速度和角速度数据判断行人行走的步数，每一步的步长以及每一步的方向，并推算出行人从起点开始的行走路径，得到惯性位置、速度和姿态信息；

磁场定位模块102分别与磁场及惯性数据获取模块100和行人航位推算模块101连接，用以根据磁场信息、以及惯性位置、速度和姿态信息建立磁场特征库并定位实时磁场特征；

定位融合模块103分别与行人航位推算模块101和磁场定位模块102连接，用以对惯性定位信息和磁场特征定位信息进行融合，得到最终的定位结果，并将定位结果发送至输出模块104；

输出模块104与定位融合模块103连接，用以接收定位结果，并将定位结果发送至显示设备上进行显示。

优选地，磁场及惯性数据获取模块100安装在行人脚部，其包括：三轴磁力计1001、三轴加速度计1002、三轴陀螺仪1003和标定模块1004，三轴加速度计1002和三轴陀螺仪1003用以测量行人脚部在运动中的加速度和各种转动的角速度，三轴磁力计1001测量传感器坐标系中的三轴磁场大小，标定模块1004用以对加速度、角速度和磁场信息进行标定并输出。

优选地，三轴磁力计1001的采样频率不低于100Hz。

优选地，行人航位推算模块101包括零速检测模块1011、扩展卡尔曼滤波模块1012、以及位置和姿态惯性解算模块1013，零速检测模块1011利用磁场及惯性数据获取模输出的角速度信息来判断脚部是否处于静止的状态，并输出当时是否为零速的标识，同时零速检测模块接收位置和姿态惯性解算模块1013输出的速度信息，并在检测到零速时将速度的误差量传递给扩展卡尔曼滤波模块1012；扩展卡尔曼滤波模块1012以零速时加速度和角速度的零偏为误差状态量，并输出误差状态量至位置和姿态惯性解算模块1013，位置和姿态惯性解算模块1013根据接收到的误差状态量和磁场及惯性数据获取模块100输出的加速度和角速度测量值输出惯性解算位置、速度、以及姿态信息。

优选地，磁场定位模块102包括：地磁检测模块1021、磁场特征库1022和地磁特征提取模块1023，地磁检测模块1021根据磁场及惯性数据获取模块100输出的磁场信息以及位置和姿态惯性解算模块1013输出的惯性解算姿态，将磁场矢量旋转到东北天坐标系中；地磁特征提取模块1023在零速检测模块1011检测到行人脚部运动时对地磁检测模块输出的磁场数据进行采样，提取出磁场特征，并将磁场特征与磁场特征库1022中的特征进行匹配，继而得出磁场特征定位结果，即行人所在位置的概率。

优选地，地磁特征提取模块1023采集满128点或者256点数据后，将数据段中的东北天向磁场分量或磁场幅值做离散傅立叶变化和离散小波变化来获取频域特性；同时，将数据段经过动态时间扭曲Dynamic Time Warping和隐性马尔可夫模型来提取其时域特征。