基于地图信息辅助惯导阵列的室内定位方法技术

本发明专利技术公开了一种基于地图信息辅助惯导阵列的室内定位方法，本方法首先对惯性传感器阵列进行初始矫正，修正惯导阵列初始条件下的惯性传感器灵敏轴的非正交；建立惯性传感器加速度计模型，并且融合加速度计值；然后通过最小均方误差算法来融合惯导阵列中的加速度计数据并去除异常数据；对加速度计数据进行二重积分并采用梯形法得到采样数据的一阶近似，得到室内目标的位置信息；最后再引入地图信息对运动轨迹进行约束修正，得到室内目标的最终位置信息。本方法克服传统室内定位的缺陷，通过低成本的惯导装置以及地图信息，实现室内目标的定位及定位轨迹的修正，提高定位精度及可靠性，降低定位成本。

Indoor positioning method of inertial navigation array based on map information

The invention discloses an indoor positioning method based on the map information aided inertial navigation array. In this method, firstly, the inertial sensor array is initially corrected to correct the non orthogonal of the sensitive axis of the inertial sensor under the initial condition of the inertial navigation array; the accelerometer model of the inertial sensor is established and the accelerometer value is fused; then the inertial navigation array is fused by the least mean square error algorithm In this paper, the data of accelerometers are integrated twice and the first-order approximation of the sampling data is obtained by trapezoid method to get the location information of indoor targets. Finally, the map information is introduced to modify the motion path and get the final location information of indoor targets. This method overcomes the defect of traditional indoor positioning, realizes the indoor target positioning and the correction of positioning track through the low-cost inertial navigation device and map information, improves the positioning accuracy and reliability, and reduces the positioning cost.

【技术实现步骤摘要】
基于地图信息辅助惯导阵列的室内定位方法
本专利技术涉及一种基于地图信息辅助惯导阵列的室内定位方法。
技术介绍
室内定位是指在室内环境中实现位置定位，其主要采用无线通讯、基站定位、惯导定位等多种技术集成形成的室内位置定位系统，从而实现人员、物体等在室内空间中的位置监控。由于室内环境复杂多变，且无法接收卫星定位信号，使得目前室内定位有一定的困难。在室内环境无法使用卫星定位时，使用室内定位技术作为卫星定位的辅助定位，解决卫星信号到达地面时较弱、不能穿透建筑物的问题，最终定位物体当前所处的位置。目前研发较多的室内定位技术有：基于Wifi-Fingerprint的室内定位方法，这种方法不仅需要定位环境中有充足的无线接入点，同时，还需要人工采集大量的训练数据，建立指纹数据库，这种方法人力及设备成本较高。此外，还有些室内定位方法是基于红外线、超声波、蓝牙、UWB定位技术、ZigBee技术；上述定位方法主要是借助于相关的基础设施，优点是定位精度较高，缺点是成本较高，并且可移植性也非常低。如果定位环境缺乏相关基础设施，则无法实现定位。中国专利文献CN106295512A公开了一种基于标识的多纠正线室内视觉数据库构建方法以及室内定位方法，该方法基于相机，通过检索带有特定标识的图像来实现定位与导航，这在现实的室内环境中难以实现，需要在室内布置一系列带有同一标识的图像集，需改动室内环境。中国专利文献CN106228538A公开了一种基于logo的双目视觉室内定位方法，其定位过程需要双摄像机来获取图像，利用摄像机对目标点进行定位，涉及到摄像机内外参数的标定以及摄像机坐标系、图像坐标系与世界坐标系三者之间的转换，一般应用于移动机器人的三维定位领域，而向普通大众普及推广应用较困难。总之，现有单一的视觉定位方法技术不适用于室内定位。目前使用惯导定位已成为室内任务中获取人员等待检测物位置的重要方法，同时，惯导定位也存在一定的不足之处，惯性器件受加工工艺与安装因素影响存在测量误差，测量误差会随着定位时间的增长而积累，从而导致对所检测物的定位精度下降和定位可靠性降低。因此，现有的惯导定位方法及装置无法满足室内定位的要求。
技术实现思路
本专利技术所要解决的技术问题是提供一种基于地图信息辅助惯导阵列的室内定位方法，本方法克服传统室内定位的缺陷，通过低成本的惯导装置以及地图信息，实现室内目标的定位及定位轨迹的修正，提高定位精度及可靠性，降低定位成本。为解决上述技术问题，本专利技术基于地图信息辅助惯导阵列的室内定位方法包括如下步骤：步骤一、对惯性传感器阵列进行初始矫正，修正惯导阵列初始条件下惯性传感器灵敏轴的非正交性；步骤二、建立惯性传感器加速度计模型，并且融合加速度计值，加速度计模型定义为：y＝a+bd+bv+v(1)其中，y为测量加速度值，a为真正的加速度值，bd为确定性的偏置误差，bv为随机漂移偏差，v为导致速率随机游走误差的测量白噪声，速率随机游走误差是由惯性传感器测得的速率信号经积分后，在短时间内检测到的高频噪声，忽略短时间内的偏置误差和漂移偏差，式(1)简化为：y＝a+v(2)考虑惯性传感器的动态行为，随机游走过程的惯性传感器加速度计模型为：ak+1＝ak+wk(3)其中，ak为随机游走k时刻真正的加速度值，ak+1为随机游走k+1时刻真正的加速度值，wk为过程噪声；步骤三、根据式(2)和式(3)，得到单个加速度计状态空间模型表达式为：其中，xk和xk+1为加速度计k和k+1时刻的状态，Zk为k时刻的测量值，F为状态转移矩阵，H为单位矩阵，wk为过程噪声，vk为测量噪声，过程噪声和测量噪声的协方差矩阵具有以下特征：步骤四、惯导阵列中多个惯性传感器性能相同，忽略惯性传感器数据传送过程中时间戳的影响，采用最小均方误差算法融合，利用最小均方误差准则将惯导阵列中多个惯性传感器的测量向量、测量矩阵和测量噪声的协方差矩阵结合起来，所有惯性传感器得到的测量向量和测量矩阵组合如下：其中，Rt、Zt、Ht分别为t时刻的等效测量噪声协方差矩阵、测量向量和测量矩阵,Ns为惯性传感器的个数，yi为第i个惯性传感器的输出值，Ri为第i个惯性传感器的测量噪声协方差矩阵,则惯性传感器三轴加速度估计值变化如下：x＝[axayaz]T,F＝I3×3Z＝[ztaxztaxztax]T,H＝I3×3(7)其中，ax、ay、az分别为加速度计三轴的状态，ztax，ztay，ztaz分别为t时刻加速度计三轴的测量值，F为状态转移矩阵，H为3×3的单位矩阵；步骤五、采集惯导阵列加速度计数据，惯导阵列中各惯性传感器的采样时间相同并为一个单位，对加速度计数据进行二重积分并采用梯形法得到采样数据的一阶近似，得到室内目标的位置信息；步骤六、将室内目标的位置信息坐标点垂直投影至室内地图，获取室内地图投影点的位置信息，并作为室内目标的最终位置信息。进一步，所述步骤六中，在室内目标的位置信息坐标点垂直投影至室内地图后，判断室内地图坐标点与室内目标移动路径中线的距离D，设定室内目标移动路径宽度为d，若D≥d/2，采用室内地图对室内目标的位置信息坐标点进行修正，若D＜d/2，以室内目标的位置信息坐标点作为最终位置信息。由于本专利技术基于地图信息辅助惯导阵列的室内定位方法采用了上述技术方案，即本方法首先对惯性传感器阵列进行初始矫正，修正惯导阵列初始条件下的惯性传感器灵敏轴的非正交；建立惯性传感器加速度计模型，并且融合加速度计值；然后通过最小均方误差算法来融合惯导阵列中的加速度计数据并去除异常数据；对加速度计数据进行二重积分并采用梯形法得到采样数据的一阶近似，得到室内目标的位置信息；最后再引入地图信息对运动轨迹进行约束修正，得到室内目标的最终位置信息。本方法克服传统室内定位的缺陷，通过低成本的惯导装置以及地图信息，实现室内目标的定位及定位轨迹的修正，提高定位精度及可靠性，降低定位成本。附图说明下面结合附图和实施方式对本专利技术作进一步的详细说明：图1为本专利技术基于地图信息辅助惯导阵列的室内定位方法流程框图；图2为本方法中采用地图信息对运动轨迹进行约束修正示意图；图3为仿真实验效果图。具体实施方式实施例如图1所示，本专利技术基于地图信息辅助惯导阵列的室内定位方法包括如下步骤：步骤一、对惯性传感器阵列进行初始矫正，修正惯导阵列初始条件下惯性传感器灵敏轴的非正交性；步骤二、建立惯性传感器加速度计模型，并且融合加速度计值，加速度计模型定义为：y＝a+bd+bv+v(1)其中，y为测量加速度值，a为真正的加速度值，bd为确定性的偏置误差，bv为随机漂移偏差，v为导致速率随机游走误差的测量白噪声，速率随机游走误差是由惯性传感器测得的速率信号经积分后，在短时间内检测到的高频噪声，忽略短时间内的偏置误差和漂移偏差，式(1)简化为：y＝a+v(2)考虑惯性传感器的动态行为，随机游走过程的惯性传感器加速度计模型为：ak+1＝ak+wk(3)其中，ak为随机游走k时刻真正的加速度值，ak+1为随机游走k+1时刻真正的加速度值，wk为过程噪声；步骤三、根据式(2)和式(3)，得到单个加速度计状态空间模型表达式为：其中，xk和xk+1为加速度计k和k+1时刻的状态，Zk为k时刻的测量值，F为状态转移矩阵，H为单位矩阵，wk为过程噪声，vk本文档来自技高网...

【技术保护点】
1.一种基于地图信息辅助惯导阵列的室内定位方法，其特征在于本方法包括如下步骤：步骤一、对惯性传感器阵列进行初始矫正，修正惯导阵列初始条件下惯性传感器灵敏轴的非正交性；步骤二、建立惯性传感器加速度计模型，并且融合加速度计值，加速度计模型定义为：y＝a+bd+bv+v  (1)其中，y为测量加速度值，a为真正的加速度值，bd为确定性的偏置误差，bv为随机漂移偏差，v为导致速率随机游走误差的测量白噪声，速率随机游走误差是由惯性传感器测得的速率信号经积分后，在短时间内检测到的高频噪声，忽略短时间内的偏置误差和漂移偏差，式(1)简化为：y＝a+v  (2)考虑惯性传感器的动态行为，随机游走过程的惯性传感器加速度计模型为：ak+1＝ak+wk  (3)其中，ak为随机游走k时刻真正的加速度值，ak+1为随机游走k+1时刻真正的加速度值，wk为过程噪声；步骤三、根据式(2)和式(3)，得到单个加速度计状态空间模型表达式为：

【技术特征摘要】
1.一种基于地图信息辅助惯导阵列的室内定位方法，其特征在于本方法包括如下步骤：步骤一、对惯性传感器阵列进行初始矫正，修正惯导阵列初始条件下惯性传感器灵敏轴的非正交性；步骤二、建立惯性传感器加速度计模型，并且融合加速度计值，加速度计模型定义为：y＝a+bd+bv+v(1)其中，y为测量加速度值，a为真正的加速度值，bd为确定性的偏置误差，bv为随机漂移偏差，v为导致速率随机游走误差的测量白噪声，速率随机游走误差是由惯性传感器测得的速率信号经积分后，在短时间内检测到的高频噪声，忽略短时间内的偏置误差和漂移偏差，式(1)简化为：y＝a+v(2)考虑惯性传感器的动态行为，随机游走过程的惯性传感器加速度计模型为：ak+1＝ak+wk(3)其中，ak为随机游走k时刻真正的加速度值，ak+1为随机游走k+1时刻真正的加速度值，wk为过程噪声；步骤三、根据式(2)和式(3)，得到单个加速度计状态空间模型表达式为：其中，xk和xk+1为加速度计k和k+1时刻的状态，Zk为k时刻的测量值，F为状态转移矩阵，H为单位矩阵，wk为过程噪声，vk为测量噪声，过程噪声和测量噪声的协方差矩阵具有以下特征：步骤四、惯导阵列中多个惯性传感器性能相同，忽略惯性传感器数据传送过程中时间戳的影响，采用最小均方误差算法融合，利用最小均方误差准则将惯导阵列中多个惯性传感器的测量向量、测量...

【专利技术属性】
技术研发人员：范亚州，王创，王远，
申请(专利权)人：上海理工大学，
类型：发明
国别省市：上海,31