CN114440895B - 基于因子图的气压辅助Wi-Fi/PDR室内定位方法 - Google Patents
基于因子图的气压辅助Wi-Fi/PDR室内定位方法 Download PDFInfo
- Publication number
- CN114440895B CN114440895B CN202210209003.0A CN202210209003A CN114440895B CN 114440895 B CN114440895 B CN 114440895B CN 202210209003 A CN202210209003 A CN 202210209003A CN 114440895 B CN114440895 B CN 114440895B
- Authority
- CN
- China
- Prior art keywords
- air pressure
- positioning
- pdr
- factor graph
- acceleration
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 69
- 238000005259 measurement Methods 0.000 claims abstract description 23
- 238000001914 filtration Methods 0.000 claims abstract description 22
- 238000001514 detection method Methods 0.000 claims abstract description 11
- 238000013213 extrapolation Methods 0.000 claims abstract description 10
- 238000012545 processing Methods 0.000 claims abstract description 7
- 238000004364 calculation method Methods 0.000 claims abstract description 6
- 230000008030 elimination Effects 0.000 claims abstract description 6
- 238000003379 elimination reaction Methods 0.000 claims abstract description 6
- 238000012937 correction Methods 0.000 claims abstract description 4
- 230000001133 acceleration Effects 0.000 claims description 22
- 238000005457 optimization Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 7
- 238000012549 training Methods 0.000 claims description 7
- 238000013528 artificial neural network Methods 0.000 claims description 6
- 238000012216 screening Methods 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 238000013461 design Methods 0.000 claims description 2
- 238000012360 testing method Methods 0.000 claims description 2
- 238000011426 transformation method Methods 0.000 claims description 2
- 230000005484 gravity Effects 0.000 claims 1
- 230000035772 mutation Effects 0.000 abstract description 8
- 238000005516 engineering process Methods 0.000 description 5
- 230000004927 fusion Effects 0.000 description 5
- 238000007500 overflow downdraw method Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000009825 accumulation Methods 0.000 description 2
- 238000009530 blood pressure measurement Methods 0.000 description 2
- 230000001186 cumulative effect Effects 0.000 description 2
- 238000000691 measurement method Methods 0.000 description 2
- 235000008694 Humulus lupulus Nutrition 0.000 description 1
- 244000062793 Sorghum vulgare Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000010485 coping Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 235000019713 millet Nutrition 0.000 description 1
- 238000000059 patterning Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- 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
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- 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
- G01C21/183—Compensation of inertial measurements, e.g. for temperature effects
- G01C21/188—Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
- G01C5/06—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels by using barometric means
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/18—Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/33—Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/38—Services specially adapted for particular environments, situations or purposes for collecting sensor information
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Data Mining & Analysis (AREA)
- Mathematical Optimization (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Computational Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Mathematical Analysis (AREA)
- Probability & Statistics with Applications (AREA)
- Operations Research (AREA)
- Evolutionary Biology (AREA)
- Bioinformatics & Computational Biology (AREA)
- Algebra (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Navigation (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本发明公开了基于因子图的气压辅助Wi‑Fi/PDR室内定位方法。对行人轨迹推算进行了改进:基于步伐点的假设使用峰值检测和滤除方法进行步伐检测,在步长估计中使用高斯‑牛顿迭代法计算对数模型参数,在方向估计中采用跳变消除法和IIR滤波处理航向角数据。提出基于广义延拓外推法的突变过滤法滤除并替换气压数据突变值;结合稠密连接网络的CSI矫正定位方法、PDR以及差分气压测高法结果构建因子图模型,融合不同更新速率的量测信息,灵活高效即插即用。本方法能减小行人轨迹结果误差,通过突变过滤法以较低的开销完成检测,充分利用各种量测信息,提高了定位的准确率和稳定性。
Description
技术领域
本发明属于室内导航定位技术领域,涉及基于因子图的多源信息融合方法,具体涉及基于因子图的气压辅助Wi-Fi/PDR室内定位方法。
背景技术
由于单一定位源无法满足室内定位的定位精度和稳定性的要求,因此采用多源信息融合方法,对多种定位信息进行组合是目前室内定位技术中增强定位的鲁棒性和准确度的主要手段之一。凭借着低计算量和高准确率的优势,以卡尔曼滤波器为代表的滤波方法在实时性要求高的多源融合定位领域中占有一席之地。
不同于基于马尔科夫假设的卡尔曼滤波只依靠上一时刻的状态进行估计,图优化方法能够对之前数据的整体或局部进行非线性优化,只要计算资源允许,往往能取得比滤波器技术更高的优化精度。而近年来随着云计算、物联网的兴起,大规模计算成为可能,以因子图为代表的优化方法逐渐被应用到导航定位、地图构建等领域中,在诸如无人驾驶、智能物流等方面起到了不可小视的作用。因子图是一种信息传递模型,能通过双向图刻画被因式分解为若干局部函数乘积形式的全局函数。基于因子图的室内多源融合定位方法本质上是贝叶斯网络最大后验估计,能够完成多种定位方法的动态融合,可应对传感器输出频率不同以及量测信息丢失的情况,实现即插即用,十分灵活。
目前大部分多源信息融合方法基于联邦滤波器,应对采样频率各异的量测量时,为了保证各子***时间一致通常会舍去适量的量测信息;另一方面以EKF为代表的一系列滤波器建立在马尔科夫性假设成立的基础上,虽然极大地减少了计算复杂度,但也丢弃了许多重要的信息。对此,因子图可以在解决时间同步问题的同时,充分利用量测信息提高定位精度。
发明内容
针对现有技术的不足,本发明提出了基于因子图的气压辅助Wi-Fi/PDR室内定位方法,使用信道状态信息(Channel State Information,CSI)作为指纹数据,对行人轨迹推算(Pedestrian Dead Reckoning,PDR)的各步骤进行改进,削弱惯性器件误差累积对定位的影响,并使用气压计,通过自身差分气压测高方法获得高度变化量,从而提高定位的精确度以及增强定位的鲁棒性。
基于因子图的气压辅助Wi-Fi/PDR室内定位方法,具体包括以下步骤:
步骤S1:在定位区域内布置定位装置。所述定位装置包括Wi-Fi设备、无线网卡、惯性器件模块和数字气压传感器。
所述Wi-Fi设备的信号覆盖定位区域,用于构建无线传感器网络,在离线阶段对定位区域进行网格划分,通过无线网卡传输采集的信道状态信息。根据Wi-Fi设备采集的数据与对应的位置坐标构建CSI指纹库,训练定位神经网络预测位置坐标,然后利用广义延拓插值法进行CSI指纹库扩充,得到插值指纹库。在i时刻定位神经网络根据CSI信号输出的估计位置经过插值指纹库的矫正后,得到用于输入因子图的坐标量测数据
所述惯性器件模块包含加速度计和陀螺仪,用于在定位过程中持续输出三轴加速度和航向角。所述数字气压传感器用于持续输出当前位置的气压值和气温。
步骤S2:改进PDR,构建步长模型,输出轨迹推算量测信息,具体包括以下步骤:
步骤S21:将惯性器件模块获取的载体坐标系下的三轴加速度a=[ax ay az]T,与旋转矩阵R左乘,得到载体坐标系的z轴竖直向下时的相对坐标系下的加速度a′:
a′=[a′x a′y a′z]T=Ra
将a′z-g作为步伐检测的待检测量,其中g为当地的重力加速度,ax、ay、az分别为在载体坐标系下加速度沿x轴、y轴、z轴方向的分量,a′x、a′y、a′z分别为在相对坐标系下加速度沿x轴、y轴、z轴方向的分量。α、β和γ分别是航向角、俯仰角和横滚角。
对所有时刻的待检测量a′z-g进行峰值检测,将低于设定阈值的步伐点时刻滤除,得到步伐点时刻集合ts1。由于仅凭借峰值判断会将许多抖动造成的较大波峰也被计算在内,因此需要对步伐点时刻集合ts1进行二次筛选。一般来说人在正常步行过程中步频存在上限,且行进中竖直方向上产生的最大瞬时加速度是由脚步落地造成的,据此提出两个合理假设:
①在最短步伐用时内至多只有一个步伐点;
②在最短步伐用时中如果出现多个步伐点,则取待检测量最大的为该区间的唯一步伐点。
根据上述两个假设,对步伐点集合ts1进一步筛选,记τ为最短步伐用时,为τ时间内第j个步伐点时刻,则二次筛选后的步伐点集合ts2中的元素满足如下条件:
步骤S22:建立步长与加速度的对数模型,w和b为模型系数,具体如下所示:
f(w,b)=w·log(a′z(t)-g)+b,t∈ts2
收集多次不同速度与不同路线下惯性器件模块输出的数据,构建轨迹推算训练数据集其中/>为行走步数,Sii为行走路程,M为数据量。
采用高斯-牛顿迭代法优化步长与加速度对数模型中的参数,使得路程残差平方和最小,优化公式为:
其中,为第ii条训练数据的第jj步估计步长。
步骤S23:陀螺仪的航向角取值范围一般为[0,360°),在对航向角数据进行滤波处理的过程中,容易遇到在范围边界处来回跳变的情况,仅仅是一次越过边界的跳变也会对滤波结果造成严重影响。因此需要对航向角数据进行处理,当后一时刻的航向角αk减去前一时刻航向角的绝对值大于180°,可以认为发生了跳变,具体处理方法为:
其中,表示经过处理后的航向角,/>
采用双线性变换法设计IIR滤波器,对经过处理后的航向角进行低通滤波。
步骤S24:记stepLeni为i时刻的估计步长,得到用于输入因子图的PDR量测信息
步骤S3:在实际应用中,由于数字气压传感器中空气流通不畅等原因引起的气压量测突变,会降低定位精度,针对这个现象提出一种基于广义延拓外推法的突变过滤方法,用于检测并替换气压量测中的突变点。
步骤S31:收集一组时间序列气压数据计算L个广义延拓外推模型:
式中,为拟合函数的系数,对于第l个模型采用tm-l至tn-l时段的数据计算拟合系数,每个模型数据量均为固定的n-m+1个,利用上述L个广义延拓外推模型估计tn+1时刻的气压值/>
步骤S32:数字气压传感器输出的量测数据的标准差为σ,显著性水平为a,a=0.05,通过标准正态分布表得到检验统计量za/2,通过广义延拓预测值估计气压真值/>然后通过设定的置信区间/>判断数字气压传感器输出的量测数据是否为突变点,当量测数据超出置信区间,认为该量测数据发生了突变,并用估计的气压真值替换该值。
步骤S33:依据差分气压转换高度公式,计算i时刻差分高度值作为输入因子图的差分气压高度量测信息/>
其中,为当前气温,/>与/>分为经过步骤S32过滤后相邻两个时刻的气压值。
步骤S4:将步骤S1~S3得到的量测输入因子图模型。因子图的状态量为X=[x y z α′]T,包括三轴坐标值x、y、z与航向角α′,依据输入的新的量测信息类型构建新的因子节点,并依次进行扩展结构、增量更新、变量消元,然后进行图优化,优化目标函数为:
其中,为量测误差协方差矩阵,||·||R为求取马氏距离,Δ表示求取相邻时刻变量节点的状态量差值。
最后,得到优化后的因子图状态量X,将其中的三轴坐标值作为输出的定位结果。
本发明具有以下有益效果:
1、利用在大部分室内广泛分布的Wi-Fi设备以及智能终端中易于取得的惯性器件和气压计,进行多源融合导航定位,采用因子图保证在各设备输出的量测信息更新频率不一致的情况下,依然能够充分利用量测信息提高定位的准确率和稳定性。
2、对行人轨迹推算方法进行改进,使用峰值检测和步伐点滤除方法进行步伐检测,使用高斯-牛顿迭代法计算对数模型参数实现步长估计,采用跳变消除法和IIR滤波处理航向角数据,进一步缩小轨迹推算结果的误差。
3、引入基于广义延拓外推法的突变过滤法,增强判断的鲁棒性,滤除并替换气压数据中的突变值。
附图说明
图1是基于因子图的气压辅助Wi-Fi/PDR室内定位方法框图;
图2是Wi-Fi/PDR和气压计辅助的因子图结构图;
图3是基于因子图的Wi-Fi/PDR和气压计辅助的室内定位方法实验轨迹图;
图4是不同融合方法的定位误差累积概率分布图。
具体实施方式
以下结合附图对本发明作进一步的解释说明;
如图1所示,本方法涉及Wi-Fi、PDR和气压,构建了利用结合稠密连接网络的CSI矫正定位方法、PDR以及差分气压测高法结果的因子图模型,如图2所示,因子图的结构使其具有很高的可扩展性,可以灵活地组合不同量测频率的传感器,也可以应对传感器暂时不可用或者新的传感器信息引入的情况,实现即插即用的功能。
由于在大部分室内环境中都部署有大量的Wi-Fi设备,因此基于Wi-Fi信号的定位技术能以较低的成本取得不错的定位效果,使用CSI作为指纹数据,相较于RSSI(ReceivedSignal Strength Indicator,接收信号强度),具有更好的细粒度与更强的稳定性。
PDR一般包括三个步骤,分别是步伐检测、步长估计和航向估计,通过改进各步骤方法可以削弱惯性器件误差累积对定位的影响,进一步提高PDR的定位精度。本方法首先提出两个假设,并在此基础上使用峰值检测和步伐点滤除方法进行步伐检测;在步长估计问题中使用高斯-牛顿迭代法计算对数模型参数;在方向估计中采用跳变消除法和IIR滤波处理航向角数据,得到的行人轨迹结果较改进前误差更小。
大气压强是大气状态的一项关键指标,气压能在一定程度上反应对应压强下的高度,为了避免时间尺度为天或年的周期性气压波动,以及与天气密切相关的随机气压波动削弱气压测高的准确性和稳定性,基于广义延拓外推法的突变过滤法,使用多次外推结果增强判断的鲁棒性,滤除并替换气压数据中的突变值,采用自身差分气压测高方法获得高度变化量,可以增强定位的鲁棒性。
本实施例在办公楼的四楼、五楼与楼梯间区域进行设备部属与数据采集,实现室内定位。使用的接收终端为配备IWL 5300NIC无线网卡的华硕FX50JX笔记本电脑,Wi-Fi设备为小米路由器4C,数字气压传感器的型号为BMP388,惯性器件模块的型号为LINS16460。
步骤一、在定位区域内部属定位装置,并划分网格,然后在各个训练节点处采集CSI,记录对应的坐标搭建CSI指纹库,根据CSI指纹库训练神经网络进行位置分类。然后对CSI指纹库做平均处理并使用广义延拓插值法扩充,构建用于矫正的插值指纹库。然后采集惯性器件模块在不同速度、不同路线下输出的数据,构成训练数据集,采用高斯-牛顿迭代法计算步长模型参数,得到步长估计模型。
步骤二、安排实验人员携带惯性器件模块匀速步行,行进路线为在四楼走廊按逆时针方向行走,通过楼梯到达五楼走廊后按顺时针方向行走,在走廊的行走轨迹均为矩形。
s2.1、将实时采集到的CSI输入步骤一训练好的神经网络得到估计坐标,采用插值指纹库和K近邻对估计坐标进行矫正,然后将矫正后的定位坐标输入因子图模型。
s2.2、对惯性器件模块输出的三轴加速度进行步伐点提取,并建立步长与加速度的对数模型对步长进行估计。然后对跳变的航向角数据进行处理与低通滤波,再将PDR量测信息输入因子图模型。
s2.3、采用基于广义延拓外推法的突变过滤方法处理数字气压传感器输出的数据,并将其转换为差分高度后再输入因子图模型。
步骤三、依据步骤二处理后的量测信息,在因子图模型中新建对应的因子节点,然后进行结构拓展、增量更新、变量消元后,对因子图进行非线性优化求解当前的变量状态,并输出定位坐标,最终结果如图3所示,图中黑色实线为参考轨迹,带圆虚线为因子图定位轨迹,朝向为左箭头指向开始方向,朝向为右箭头指向结束方向。
与采用卡尔曼滤波器和联邦滤波器替换因子图进行对比,不同融合方法的定位误差累积概率分布如图4所示,本方法最终取得的平均定位误差为0.291m,相比于使用卡尔曼滤波器和联邦滤波器为多源融合算法,平均定位误差分别减小了42.9%和40.3%。
最后应当说明的是:以上实施例仅用以说明本发明的技术方案而非对其限制,所属领域的普通技术人员应当理解;依然可以对本发明的方案进行修改或者是部分技术的替换,凡非用于限制本发明的专利保护范围,本发明保护范围依然以权利要求书为准;凡是采用本发明附图内容或者是说明书所做的类似结构变动,同理均应该包含在该专利的保护范围内。
Claims (4)
1.基于因子图的气压辅助Wi-Fi/PDR室内定位方法,其特征在于:该方法包括以下步骤:
步骤S1:在定位区域内布置定位装置;所述定位装置包括Wi-Fi设备、无线网卡、惯性器件模块和数字气压传感器;
所述Wi-Fi设备的信号覆盖定位区域,通过无线网卡传输采集的信道状态信息,并根据对应位置的坐标构建CSI指纹库,训练定位神经网络,然后利用广义延拓插值法进行CSI指纹库扩充,得到插值指纹库;在i时刻定位神经网络根据CSI信号输出估计位置坐标,经过插值指纹库的矫正后,作为输入因子图的坐标量测数据
所述惯性器件模块包含加速度计和陀螺仪,用于在定位过程中持续输出三轴加速度和航向角;所述数字气压传感器用于持续输出当前位置的气压值和气温;
步骤S2:对PDR进行改进,构建步长模型,输出轨迹推算量测信息,具体包括以下步骤:
步骤S21:根据惯性器件模块获取的载体坐标系下的三轴加速度a=[ax ay az]T,转换成载体坐标系的z轴竖直向下时的加速度a′=[a′x a′ y a′z]T,然后将a′z-g作为步伐检测的待检测量,对所有时刻的待检测量进行峰值检测,将低于设定阈值的步伐点时刻滤除,得到步伐点时刻集合ts1;再对步伐点集合ts1进行二次筛选,消除抖动,二次筛选后的步伐点集合ts2为:
其中,τ为最短步伐用时,为τ时间内第j个步伐点时刻,g为重力加速度;
步骤S22:建立步长与加速度的对数模型:
f(w,b)=w·log(a′z(t)-g)+b,t∈ts2
其中,w和b为模型系数,收集M次不同速度与不同路线下惯性器件模块输出的数据,构建轨迹推算训练数据集其中/>为行走步数,Sii为行走路程,以路程残差平方和最小为目标,采用高斯-牛顿迭代法优化对数模型f(w,b)中的参数,优化公式为:
其中,为第ii条训练数据的第jj步估计步长;
步骤S23:获取惯性器件模块输出的航向角,当当前时刻的航向角αk与上一时刻的航向角的差值绝对值大于180°时,进行跳变处理:
其中,表示经过处理后的航向角,/>然后对经过处理后的航向角/>进行低通滤波;
步骤S24:记stepLeni为i时刻的估计步长,得到用于输入因子图的PDR量测信息
步骤S3:对数字气压传感器输出的气压数据进行处理,具体包括以下步骤:
步骤S31:收集一组时间序列气压数据计算L个广义延拓外推模型:
其中,为拟合函数的系数,对于第l个模型采用tm-l至tn-l时段的数据计算拟合系数,每个模型数据量为n-m+1个,利用上述L个广义延拓外推模型估计tn+1时刻的气压值
步骤S32:计算数字气压传感器输出的量测数据的标准差σ、显著性水平a以及检验统计量za/2,通过广义延拓预测值估计气压真值/>然后设置信区间/>当数字气压传感器输出的量测数据超出该置信区间时,使用估计的气压真值/>替量测数据;
步骤S33:依据差分气压转换高度公式,计算i时刻差分高度值作为输入因子图的差分气压高度量测信息/>
其中,为当前气温,/>与/>分为经过步骤S32过滤后相邻两个时刻的气压值;
步骤S4:将步骤S1~S3得到的量测输入因子图模型;因子图的状态量为X=[x y z α′]T,包括三轴坐标值x、y、z与航向角α′,依据输入的新的量测信息类型构建新的因子节点,并依次进行扩展结构、增量更新、变量消元,然后进行图优化,优化目标函数为:
其中,为量测误差协方差矩阵,||·||R为求取马氏距离,Δ表示求取相邻时刻变量节点的状态量差值;
最后,得到优化后的因子图状态量X,将其中的三轴坐标值作为输出的定位结果。
2.如权利要求1所述基于因子图的气压辅助Wi-Fi/PDR室内定位方法,其特征在于:将惯性器件模块获取的载体坐标系下的三轴加速度a=[ax ay az]T,与旋转矩阵R左乘,得到载体坐标系的z轴竖直向下时的相对坐标系下的加速度a′:
a′=[a′x a′y a′z]T=Ra
ax、ay、az分别为在载体坐标系下加速度沿x轴、y轴、z轴方向的分量,a′x、a′y、a′z分别为在相对坐标系下加速度沿x轴、y轴、z轴方向的分量;α、β和γ分别是航向角、俯仰角和横滚角。
3.如权利要求1所述基于因子图的气压辅助Wi-Fi/PDR室内定位方法,其特征在于:步骤S23中,采用双线性变换法设计IIR滤波器对处理后的航向角进行低通滤波。
4.如权利要求1所述基于因子图的气压辅助Wi-Fi/PDR室内定位方法,其特征在于:设置数字气压传感器输出的量测数据的显著性水平a=0.05。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210209003.0A CN114440895B (zh) | 2022-03-04 | 2022-03-04 | 基于因子图的气压辅助Wi-Fi/PDR室内定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210209003.0A CN114440895B (zh) | 2022-03-04 | 2022-03-04 | 基于因子图的气压辅助Wi-Fi/PDR室内定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114440895A CN114440895A (zh) | 2022-05-06 |
CN114440895B true CN114440895B (zh) | 2023-11-24 |
Family
ID=81359151
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210209003.0A Active CN114440895B (zh) | 2022-03-04 | 2022-03-04 | 基于因子图的气压辅助Wi-Fi/PDR室内定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114440895B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115201873B (zh) * | 2022-09-06 | 2023-07-28 | 中冶智诚(武汉)工程技术有限公司 | 多体制协同室内外精密定位***架构及其运行方法 |
CN117560629B (zh) * | 2024-01-11 | 2024-04-02 | 北京中关村实验室 | 一种安全鲁棒的室内行人轨迹跟踪方法和*** |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019018315A1 (en) * | 2017-07-17 | 2019-01-24 | Kaarta, Inc. | ALIGNMENT OF MEASURED SIGNAL DATA WITH SLAM LOCATION DATA AND ASSOCIATED USES |
CN110933599A (zh) * | 2019-12-17 | 2020-03-27 | 北京理工大学 | 一种融合uwb与wifi指纹的自适应定位方法 |
CN112923919A (zh) * | 2021-01-21 | 2021-06-08 | 湖南格纳微信息科技有限公司 | 基于图优化的行人定位方法及*** |
-
2022
- 2022-03-04 CN CN202210209003.0A patent/CN114440895B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019018315A1 (en) * | 2017-07-17 | 2019-01-24 | Kaarta, Inc. | ALIGNMENT OF MEASURED SIGNAL DATA WITH SLAM LOCATION DATA AND ASSOCIATED USES |
CN110933599A (zh) * | 2019-12-17 | 2020-03-27 | 北京理工大学 | 一种融合uwb与wifi指纹的自适应定位方法 |
CN112923919A (zh) * | 2021-01-21 | 2021-06-08 | 湖南格纳微信息科技有限公司 | 基于图优化的行人定位方法及*** |
Non-Patent Citations (1)
Title |
---|
《智能移动平台融合定位技术综述》;裴凌 等;《导航定位与授时》;第4卷(第5期);第8-18页 * |
Also Published As
Publication number | Publication date |
---|---|
CN114440895A (zh) | 2022-05-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Shen et al. | Dual-optimization for a MEMS-INS/GPS system during GPS outages based on the cubature Kalman filter and neural networks | |
CN114440895B (zh) | 基于因子图的气压辅助Wi-Fi/PDR室内定位方法 | |
CN110243358B (zh) | 多源融合的无人车室内外定位方法及*** | |
CN111780755B (zh) | 一种基于因子图和可观测度分析的多源融合导航方法 | |
CN113074739B (zh) | 基于动态鲁棒容积卡尔曼的uwb/ins融合定位方法 | |
CN112747747B (zh) | 一种改进的uwb/imu融合室内行人定位方法 | |
CN107014375B (zh) | 超低部署的室内定位***及方法 | |
CN104613965B (zh) | 一种基于双向滤波平滑技术的步进式行人导航方法 | |
CN110388926B (zh) | 一种基于手机地磁和场景图像的室内定位方法 | |
CN114166221B (zh) | 动态复杂矿井环境中辅助运输机器人定位方法及*** | |
CN112004183B (zh) | 一种基于卷积神经网络融合IMU和WiFi信息的机器人自主定位方法 | |
CN112284376A (zh) | 一种基于多传感器融合的移动机器人室内定位建图方法 | |
CN113866810A (zh) | 一种列车定位导航的方法、***、电子设备及存储介质 | |
CN113639722B (zh) | 连续激光扫描配准辅助惯性定位定姿方法 | |
CN104613966A (zh) | 一种地籍测量事后数据处理方法 | |
CN116929335A (zh) | 基于多源信息感知的辐射场地图构建方法 | |
CN114915913A (zh) | 一种基于滑窗因子图的uwb-imu组合室内定位方法 | |
CN112539747B (zh) | 一种基于惯性传感器和雷达的行人航位推算方法和*** | |
CN114463932A (zh) | 非接触式施工安全距离主动动态识别预警***及方法 | |
CN116380038A (zh) | 一种基于在线增量尺度因子图的多源导航信息融合方法 | |
CN113029138B (zh) | 一种基于多传感器数据融合的小车实时姿态检测方法 | |
CN115435782A (zh) | 一种多源信息约束下的抗干扰位置估计方法及装置 | |
CN113237482B (zh) | 一种基于因子图的城市峡谷环境下车辆鲁棒定位方法 | |
CN115507827A (zh) | 基于超宽带与高精度mems组成的网状分布式滑坡监测*** | |
CN114705223A (zh) | 多移动智能体在目标跟踪中的惯导误差补偿方法及*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |