更全的杂志信息网

基于惯性导航的室内定位误差修正算法

更新时间:2009-03-28

近年来,随着物联网、智能家居的迅猛发展,室内导航成为目前导航与定位研究的主要方向之一。基于射频识别(radio-frequency identification,RFID)[1]、超声波、ZigBee[2]、无线传感器[3]的室内定位技术的不断兴起,已经被广泛应用到室内定位领域,且具有较高的定位精度。但这些技术均需要依靠外界的设备装置来辅助定位,并通过这些硬件设备进行数据传输来实现定位,当外界环境无法满足要求时,就无法实现定位。所以,随着人们对室内复杂环境定位需求的不断提升,基于自身传感器进行定位的惯性导航技术得到了大力发展[4-6]。但是单独使用惯性导航解算时,位移误差会以导航时间的三次方发散,迅速超出导航范围,失去导航定位的意义[7]。要解决这一问题有两种方法:一是利用组合导航的方式进行误差修正,例如GPS与惯性导航的组合[8],但GPS信号容易受到建筑物的影响,不适合进行室内定位;二是在导航解算之前通过误差修正算法,消除速度累积误差,达到削弱位移误差的目的。2012年,瑞典皇家工学院信号处理实验室的John Olof Nilsson提出了一个开源的、实时的基于鞋绑式零速修正辅助的惯性导航系统,并对鞋绑式惯性导航系统误差模型的影响进行了研究,提出了一个基于步进式惯性导航和步进式航位推算的局部分散式系统框架。目前一些学者根据此系统,利用加速度计的输出进行零速检测[9-12]来修正误差值。文献[9]设计了一种基于零速检测的加速度量测幅值计步算法,实现了载体坐标系和行人地理坐标系的转换,利用惯性测量元件对人员行走进行检测,实现了行人运动姿态的有效识别和步数的精确统计。但这种方法易受到行走震动的影响,容易出现零速点误判和漏判等问题。针对此问题,本文提出了一种新的零速检测算法,该算法同时利用加速度计和陀螺仪的输出进行零速点检测,然后通过扩展卡尔曼滤波算法进行误差修正。

1 MEMS室内定位系统及误差模型

基于零速检测的MEMS室内定位系统主要器件为加速度计和陀螺仪。系统的主要误差包括:加速度计的零位误差和陀螺漂移。基于零速检测的MEMS室内定位系统原理框图如图1所示。定位系统的基本原理:首先由加速度计和陀螺仪进行数据采集后,输入到导航解算单元进行速度、位置的解算,最后利用误差修正算法对导航结果进行反馈修正,达到精确解算的目的。

  

图1 MEMS室内定位系统原理框图Fig.1 Schematic diagram of MEMS indoor positioning system

加速度计测量模型[13]

本次变更设计可有效增加魏乐、净化两村节水灌溉面积,在促进当地节水增收及提高水资源利用率方面迈上了一个新的台阶。

 

(1)

式中:b表示载体坐标系,fb为加速度计测量比力值;δKA为加速度计刻度因数误差系数;δA为加速度计的安装误差;为零偏误差。

而当人处于C1状态时:

 

(2)

姿态误差方程:

假设惯性导航姿态误差角φ是小角度,并且不考虑地球重力模型误差,可以得到线性近似的MEMS室内定位系统误差模型[14]

[5] HARLE R. A survey of indoor inertial positioning systems for pedestrians[J]. IEEE Communications Surveys & Tutorials, 2013, 15(3):1281-1293.

式中:为陀螺仪测量的载体角速度;δKG为陀螺仪刻度因数误差系数;δG为陀螺仪的安装误差;εb为陀螺仪随机漂移误差。

第四,制定与完善国际贸易融资相关的法律法规。国内立法机关的应加强对国际贸易融资法律法规和政策措施的研究,找出我国与国际其他国家在贸易融资方面的差距,并分析问题产生的原因,提出解决问题的具体对策。需要强调的是,相关研究人员要与国际惯例接轨,制定实施性强的法律法规,探索出国际贸易融资未来发展的光明之路。

 

(3)

式中:n表示导航坐标系;表示导航坐标系相对于惯性坐标系的转动角速度;表示的计算误差;表示导航坐标系相对于载体坐标系转动角速度的计算误差。

速度误差方程:

 
 

(4)

式中:是加速度计测量的比力值;表示导航坐标系相对于地球的转动角速度;表示导航坐标系相对于地理坐标系的转动角速度;vn表示惯性导航计算的速度;δvn表示速度误差;表示比力测量误差。

位移误差方程:

(3)与其他地区相比,汾渭平原SO2柱浓度变化幅度较小,2013—2016年有明显的上升趋势,而京津冀地区、四川盆地、长江三角洲和珠江三角洲自2011年来均表现出下降趋势。

 

(5)

2 定位数据预处理

在加速度计采集数据前,先让加速度计预先工作一段时间,保证加速度计稳定后,以100 Hz的采样频率进行采样,采样时间为15 min。得到数据后,以Matlab为数据处理平台进行数据处理,见图2。

  

图2 加速度计测量值Fig.2 Accelerometer measurements

理论上x轴,y轴上的测量值为0,而z轴的测量值应与当地的重力加速度相等,然而从图2可以看出,在静止时刻,x轴,y轴测量值不等于零,而z轴的值也不等于g。因此,通过测量得出偏移量,在实际导航过程中需要对零值偏移进行补偿。修正后的测量值如图3所示,可以看出零位误差控制在10-2范围内,相比之前有了较大的改善,为后续导航解算的准确性提供了保障。

  

图3 修正后的加速度计测量值Fig.3 Modified accelerometer measurements

3 零速检测误差修正算法

[3] 沙朝恒. 基于矩阵补全的无线传感器网络节点定位算法研究[D].南京:南京邮电大学,2016.

  

图4 人行走的状态图Fig.4 State of human walking

理论上当人处于C1时刻时,此时脚部着地,加速度计水平方向输出值应为零,加速度计竖直方向应等于重力常量。根据此特征,可以利用加速度计输出参量的模值、方差以及幅值和已设定的阈值进行比较,提取人行走时的零速点,利用零速点来消除速度误差。但这种算法容易受到脚着地时震动的干扰,导致零点检测误差大,使行人的速度误差和位移误差增加。因此,为了减小震动的干扰,提出了新的零速检测算法,将加速度计与陀螺仪的零速判定进行比较运算,提高检测的准确率。

假设人行走时,两种运动状态的输出为

 

(6)

式中:θ表示加速度计输出信号的未知参数;N表示滑动窗口的取点个数;表示k时刻加速度计输出的未知量;Sa表示零点时刻加速度计输出的未知量。

加速度计输出信号的概率密度函数为

 
 

(7)

式中:zn表示k时刻加速度计的输出量。

根据Neyman-Pearson定理,如果

由表7可知,评价体系中亩均用水量占总用水量的百分比对体系的影响程度最大,其权重为0.259,灌溉水有效利用系数次之,权重为0.123,政府支持与公众参与对体系影响较小,其权重分别为0.017、0.016,其余各指标在此之间。各指标的权重能基本反映汾河流域各地市实际节水灌溉发展水平,可以用于类似体系指标权重的分析计算。

 

(8)

则判定为C1状态,其中γ为判定阈值。

阈值可以由式(9)求出:

 

(9)

式中:PF表示虚警概率p(C1/C0);α表示显著水平,根据实际情况给定[15]

首先,不少受访者者认为指南覆盖面不够广,发布渠道单一。除了传统的发布渠道,可以考虑在新媒体上进行宣传,如建立微信公众号、开发相关专业性软件等。鼓励医院职能部门在这些新媒体上定期发送指南内容,使其可以多渠道广覆盖,让临床医师或相关人员更加简易、快速地获取。其次,针对不同级别医院面临的不同病情的患者,医师应用临床指南时,应对指南进行适用性评价,思考该指南是否能应用于当前的患者、医院或社区。本研究中,40.0%的医师“不了解”临床指南的评价原则;而医院级别与最高学历影响指南认知与应用(P<0.001)。

综上所述,基于惯性导航的室内定位误差修正算法主要分为3步:第1步将加速度计和陀螺仪传感器采集的数据进行预处理,通过测量得出偏移量,在实际导航过程中对零值偏移进行补偿;第2步为零速点检测,利用加速度计输出参量的方差以及陀螺仪输出参量的幅值和已设定的阈值进行比较,确定人行走时的零速时刻;第3步利用EKF算法,建立状态方程和量测方程进行误差修正。

根据最大似然估计法,当人处于C0状态时,因此,

 

(10)

陀螺仪测量模型为

 
 

(11)

将式(11)代入式(7)可得:

 
 

(12)

将式(10)与式(12)代入式(8)可得:

 
 

(13)

另外,可以根据陀螺仪输出的幅值来判定C1状态,判定式如下:

 

(14)

进行与运算,如果结果为1则判定该时刻为零速时刻,如果结果为0则说明该时刻为运动状态,具体的算法流程图如图5所示。

沅水上游水电站投运后对发电效益影响分析…………………………………………………肖 杨,王 也(5.45)

  

图5 算法流程图Fig.5 Flow chart of the algorithm

4 扩展卡尔曼滤波算法

传统的卡尔曼滤波算法无法应用在环境复杂的室内,而且随着滤波迭代次数的增加,舍入误差会逐渐积累,一旦卡尔曼滤波发散,就会失去其最优估计的作用。扩展卡尔曼滤波(extended Kalman filter,EKF)可以运用在非线性的系统,因此在惯性导航系统中有着广泛的应用。

EKF的状态估计值为

 

(15)

式中:表示横滚角、俯仰角以及航向角的误差值;表示角速率的误差值;表示加速度的误差值。

状态一步预测方程:

随着近几年来的计算机技术快速发展,多层螺旋CT不断的发展,明显提高球管转以及时间分辨率。除此之外,旋转1周探测器可以覆盖扫描范围约为3240 mm,因此,5 s内即可完成心脏检查,从而明显提高临床检查成功率。相关研究对130例研究对象(均无临床症状,而心电图检查阳性、ECT检查结果显示冠状动脉缺血改变)实施64层螺旋CT冠状动脉造影检查、经皮选择性冠状动脉造影检查,其检查结果显示,64层螺旋CT冠状动脉造影检查的灵敏度(54.60%)、特异度(95.10%)、阳性预测值(77.60%)、阴性预测值(87.10%)及准确度(85.50%)均更高(P<0.05)。

 

(16)

式中:表示在k时刻预测的状态值;表示在(k-1)时刻估计的状态值;ωk-1表示在(k-1)时刻系统噪声矩阵。

一晃,十七年过去了。2009年9月26日,又是一个星期六。我们俩聊起过往,感慨万千。我们共同经历了人生中的大部分时光,彼此了解,相互默契,说上句便知下句,虽无语也胜千言。世界观、人生观、价值观,那么相近,如出一辙。

状态矩阵:

综上,针对社区老年2型糖尿病患者,积极开展护理措施干预,可有效促进患者血糖水平的控制,提高满意度,效果理想,值得推广。

Φk=

 

(17)

式中:表示的是导航坐标系中的反对称矩阵。

其中:

 
 

(18)

量测方程:

 

(19)

式中:Zk表示在k时刻的量测值;H表示量测矩阵;nk表示量测噪声矩阵。

5 仿真结果及分析

㉘《首都地方法院检察处为送谷案被害人遗骸鉴定书致军事法庭公函》,载胡菊蓉编《南京大屠杀史料集 24南京审判》,江苏人民出版社、凤凰出版社2006年版,第365~366页。

为了验证室内导航误差修正算法的有效性和定位准确性,进行了矩形路线行走实验,使用型号为JY901的九轴姿态模块进行数据采集,将采集的数据利用Matlab仿真平台进行数据分析和处理。行走总距离为45 m,采样频率为100 Hz。实验采用平均定位误差(mean position error, MPE)来度量定位准确性,如式(20)所示[16]

 

(20)

式中:M是总的采样点数:和(xi,yi)分别是第i次定位估计位置坐标和真实位置坐标。

A survey of 19 women for the use of sunscreen cosmetics 11 26

图6为人行走的速度和加速度方差零速点检测结果,图7为人行走的速度和改进后的零速检测结果,改进后的算法结合了加速度计方差和陀螺仪幅值。图6和图7中零速检测值为“1”时表示此刻为零速时刻,值为“0”时表示此刻为运动状态。对比后发现图7中的零速检测更加精准,并且可以看出运动状态分布更加均匀,与实际行走过程相吻合,算法性能优于图6单独使用加速度计方差的检测方法,零速点检测准确率提高了10%左右。

  

图6 零速点检测结果Fig.6 Zero velocity point detection result

  

图7 改进后的零速点检测结果Fig.7 Improved zero velocity point detection result

图8为速度误差曲线,从图中可以看出,在行走过程中速度误差得到了有效抑制,这是因为利用行走过程中“零速点”的特性,修正了速度误差。从图9位移误差曲线中可以看出,位移误差也得到了修正,最终定位误差约为1.18 m,定位误差控制在3%以内,减小了随时间发散的速度,提高了定位精度。

  

图8 速度误差Fig.8 Velocity error

  

图9 位移误差曲线Fig.9 Displacement error curve

  

图10 行走轨迹Fig.10 Walking track

从图10行走轨迹中可以看出,算法改进前的轨迹随着行走时间的增加,偏离真实路径的误差不断增大。而改进后的行走轨迹与改进前的轨迹相比更加平滑,这是因为消除了行走过程中震动的影响。改进后的轨迹与改进前相比,虽然误差得到了抑制,但与真实路径对比发现,行走的轨迹与真实路径还有一定差距,这是由于陀螺仪漂移误差导致航向计算有一定偏差。

6

本文提出的误差修正算法与单一使用加速度计的零速检测算法相比,提高了零速点的检测准确率,有效修正了速度误差,抑制了位移误差的发散速度,通过Matlab仿真平台验证了算法的有效性和性能,修正后的定位误差在3%左右。从轨迹图可以看出,虽然位移误差得到了修正,但是受到陀螺仪漂移的影响,导致方位上存在一定的偏差。如何有效地抑制方位的偏差,是接下来研究的重点,可以考虑使用磁力计、地图匹配等方法进行航向修正。

参考文献/References

[1] 纪敏. WiFi/RFID室内融合定位方法的研究[D].南京:南京邮电大学,2016.

JI Min.Study of WiFi/RFID Indoor Fusion Positioning Method[D].Nanjing:Nanjing University of Posts and Telecommunications,2016.

[2] 林滢.基于ZigBee技术的融合性室内定位系统研究与设计[D].南京:南京邮电大学,2016.

LIN Ying.The Research and Implementation of the Technology of Indoor Positioning Based on ZigBee[D].Nanjing:Nanjing University of Posts and Telecommunications,2016.

人在行走时,脚部运动可以分为两种运动状态:迈步时为运动状态(C0),脚落地时为静止状态(C1),如图4所示。

SHA Zhaoheng.Localization for Wireless Sensor Networks via Matrix Completion[D].Nanjing:Nanjing University of Posts and Telecommunications,2016.

[4] GROVES P D. Navigation using inertial sensors[J]. IEEE Aerospace and Electronic Systems Magazine, 2015, 30(2):42-69.

近年来,出现了很多针对具有可配置缓冲器的电路的时序分析和优化方法.文献[5]提出了针对芯片良率分析,基于蒙特卡罗算法的框架模型.文献[6]分析了不同存储器在电路流片中对延时、面积和功耗等方面的影响.文献[7]在文献[6]的基础上建立了静态时序电路的分析模型,并基于蒙特卡罗算法与实际电路比较.文献[8]提出了一种插入缓冲器以提高电路时序稳定性的方法,最高可以减少87.3%的时钟抖动.

④IT服务外包作为一种市场化活动,市场规律自然蕴涵其中,管理意识的弱化是服务方减少供给、压缩成本、风险放大的直接诱因,放任式的服务外包会引发因服务外包而带来的新风险。

[6] LARGE D R, BURNETT G, BENFORD S, et al. Crowdsourcing good landmarks for in-vehicle navigation systems[J]. Behaviour & Information Technology, 2016, 35(10):807-816.

[7] 崔潇, 秦永元, 周琪,等. 鞋式个人导航系统算法和试验研究[J]. 测控技术, 2013, 32(3):138-142.

CUI Xiao, QIN Yongyuan, ZHOU Qi, et al.Algorithm and test research on shoe-mounted personal navigation system[J]. Measurement and Control Technology, 2013, 32(3):138-142.

[8] 张恒浩, 刘藻珍, 孟秀云,等.D-S证据理论在组合导航中的决策判断[J].河北科技大学学报,2011,32(6):571-574.

ZHANG Henghao,LIU Zaozhen,MENG Xiuyun,et al.Application of D-S evidence theory in integrated navigation[J].Journal of Hebei University of Science and Technology,2011,32(6):571-574.

[9] 陈国良, 杨洲. 基于加速度量测幅值零速检测的计步算法研究[J]. 武汉大学学报(信息科学版), 2017, 42(6):726-730.

CHEN Guoliang, YANG Zhou. Step counting algorithm based on zero velocity update[J]. Geomatics and Information Science of Wuhan University, 2017, 42 (6): 726-730.

[10] 苑宝贞, 苏中, 李擎,等. 基于贝叶斯网络的强鲁棒性零速检测方法[J]. 计算机测量与控制, 2016, 24(3):200-203.

YUAN Baozhen, SU Zhong, LI Qing, et al. A robust zero velocity detection method based on bayesian networks[J]. Computer Measurement and Control, 2016, 24 (3): 200-203.

[11] 朱彩杰, 赵冬青, 杨洲. 基于 MEMS 的室内定位误差修正方法研究[J]. 测绘工程, 2017, 26(5):57-61.

ZHU Caijie, ZHAO Dongqing,YANG Zhou.A study of indoor positioning error correction method based on MEMS[J].Engineering of Surveying and Mapping, 2017, 26(5):57-61.

[12] 王普, 潘凯, 任明荣,等. 基于伪自适应阈值零速检测法的室内个人导航系统[J]. 北京工业大学学报, 2015,41(9):1308-1313.

WANG Pu, PAN Kai, REN Mingrong, et al. Indoor personal navigation system based on zero velocity detection of pseudo adaptive threshold [J].Journal of Beijing University of Technology, 2015,41 (9): 1308-1313.

[13] 秦永元. 惯性导航[M]. 北京:科学出版社, 2008:355-361.

[14] 严恭敏. 车载自主定位定向系统研究[D]. 西安:西北工业大学, 2006.

YAN Gongmin.Research on Vehicle Autonomous Positioning and Orientation System[D].Xi’an:Northwestern Polytechnical University,2006.

[15] KAY S M. Fundamentals of Statistical Signal Processing: Estimation Theory [M]. NJ: Prentice-Hall Inc Upper Saddle River, 1993.

[16] 刘玉杰. 基于扩展卡尔曼滤波算法的融合室内定位系统研究与实现[D]. 南京:南京邮电大学, 2016.

LIU Yujie.Research and Implementation of Indoor Positioning System Based on Extended Kalman Filter[D].Nanjing:Nanjing University of Posts and Telecommunications,2016.

 
陈国通,王小娜,张晓旭,许文倩,张璞
《河北工业科技》 2018年第03期
《河北工业科技》2018年第03期文献

服务严谨可靠 7×14小时在线支持 支持宝特邀商家 不满意退款

本站非杂志社官网,上千家国家级期刊、省级期刊、北大核心、南大核心、专业的职称论文发表网站。
职称论文发表、杂志论文发表、期刊征稿、期刊投稿,论文发表指导正规机构。是您首选最可靠,最快速的期刊论文发表网站。
免责声明:本网站部分资源、信息来源于网络,完全免费共享,仅供学习和研究使用,版权和著作权归原作者所有
如有不愿意被转载的情况,请通知我们删除已转载的信息 粤ICP备2023046998号