CN107888289B - 基于可见光通信与惯性传感器融合的室内定位方法及平台 - Google Patents
基于可见光通信与惯性传感器融合的室内定位方法及平台 Download PDFInfo
- Publication number
- CN107888289B CN107888289B CN201711120158.2A CN201711120158A CN107888289B CN 107888289 B CN107888289 B CN 107888289B CN 201711120158 A CN201711120158 A CN 201711120158A CN 107888289 B CN107888289 B CN 107888289B
- Authority
- CN
- China
- Prior art keywords
- rss
- data
- model
- positioning
- visible light
- 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
- 238000004891 communication Methods 0.000 title claims abstract description 41
- 238000000034 method Methods 0.000 title claims abstract description 31
- 230000004927 fusion Effects 0.000 title claims abstract description 22
- 238000006073 displacement reaction Methods 0.000 claims abstract description 20
- 238000010606 normalization Methods 0.000 claims abstract description 9
- 238000001914 filtration Methods 0.000 claims abstract description 7
- 230000003044 adaptive effect Effects 0.000 claims abstract description 5
- 230000001133 acceleration Effects 0.000 claims description 13
- 239000000654 additive Substances 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 claims description 4
- 230000000996 additive effect Effects 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 238000012821 model calculation Methods 0.000 claims description 2
- 230000005477 standard model Effects 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 abstract description 9
- 238000005516 engineering process Methods 0.000 abstract description 6
- 230000004807 localization Effects 0.000 description 4
- 230000007423 decrease Effects 0.000 description 2
- 238000005286 illumination Methods 0.000 description 2
- 230000000295 complement effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000005389 magnetism Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0252—Radio frequency fingerprinting
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04B—TRANSMISSION
- H04B10/00—Transmission systems employing electromagnetic waves other than radio-waves, e.g. infrared, visible or ultraviolet light, or employing corpuscular radiation, e.g. quantum communication
- H04B10/11—Arrangements specific to free-space transmission, i.e. transmission through air or vacuum
- H04B10/114—Indoor or close-range type systems
- H04B10/116—Visible light communication
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于可见光通信与惯性传感器融合的室内定位方法及其平台,基于可见光通信技术,结合惯性传感器,实现在室内移动盲节点的高精度定位,具体步骤包括:根据可见光传播特性,建立接收信号强度(Received Signal Strength,RSS)和距离的传播模型以及RSS归一化校准模型;建立惯性传感数据的校准模型与误差因子的线性模型,对误差因子进行自适应卡尔曼滤波以优化模型参数;定位过程中对可见光RSS数据和惯性传感数据进行校准修正;根据RSS‑距离模型得到盲节点与锚节点的距离值,根据惯性传感数据得到单位时间位移距离与位移方向;对可见光数据与惯性传感数据进行融合计算,最终得到盲节点定位结果。
Description
技术领域
本发明涉及一种基于可见光通信与惯性传感器融合的室内定位方法及其平台,属于室内无线定位技术领域。
背景技术
可见光通信是可见光波段的光作为信息载体进行通信的方式,也是近年来兴起的无线光通信技术,既具有无线通信的灵活性,又可节约日益紧张的无线电频谱资源。可见光通信基于室内LED(Light Emitting Diode,LED)照明的基础,在实际应用中,可以兼顾照明和通信两个方面的用途,即节约能源又减少了通信设施的资金投入。可见光通信速率快,无射频辐射,保密性好,抗干扰能力强,不需要架设光纤,适用于对电磁干扰敏感的特殊场合,在短距离通信中有着极大的发展潜力,己经成为了国内外无线通信领域研究的热点。
惯性定位***的理论依据是牛顿经典力学,利用加速度计和陀螺仪实时采集目标载体的加速度、角速度等位置信息,通过积分运算求解目标载体的运动速度、姿态、位移等信息。惯性定位***通常会集成磁强计,用于方位角度的计算。惯性定位***不依赖于任何外部信息(声、光、电、磁等),可以在外太空、地表以下甚至水下工作,基本不受外界或人为干扰。此外,惯性定位***具有实时性、高精度、高稳定性等特点。
单一定位技术虽然可以在特定的环境下满足人们的需求,但不可避免地都存在着缺陷,比如定位精度差、***复杂、硬件成本高以及抗干扰能力差等问题,难以适应大众化的定位需求。因此,一些研究试图通过两种或多种定位技术的融合实现优势互补,使融合定位技术的普适性更强。但是,目前已有的融合定位普遍存在定位精度低、抗干扰能力差等问题。
发明内容
为解决现有技术中可见光定位易受环境遮挡或干扰、惯性传感器存在累积误差等问题,本发明提供一种基于可见光通信与惯性传感器融合的室内定位方法及其平台,通过融合定位方法实现高精度的室内定位。
为解决上述技术问题,本发明提供了一种基于可见光通信与惯性传感器融合的室内定位方法,基于可见光通信RSS数据和距离的传播模型以及RSS归一化校准模型,结合惯性传感数据的校准模型对数据进行校准,包括以下步骤:
S1.在定位开始前,在可见光照射区域内统计随机分布的盲节点接收到的RSS数据以及盲节点与各RSS数据对应锚节点的距离值,将RSS值归一化后得到RSS-距离模型,计算采集数据的真实距离值与模型计算距离值的均方差,建立RSS归一化校准模型;
在定位开始前,随机多次采集盲节点静止状态与运动状态下的惯性传感数据,得到惯性传感数据的校准模型,给出校准模型中的误差因子线性模型,对其进行自适应卡尔曼滤波,优化校准模型;
S2.在定位数据采集过程中,利用优化后的校准模型对可见光通信RSS数据进行归一化标准,根据RSS-距离模型计算得到盲节点与锚节点的距离,利用优化后的校准模型对惯性传感数据进行校准,计算得到单位时间位移距离与位移方向,根据误差因子线性模型,进行只适应卡尔曼滤波,更新误差因子与惯性传感数据的标准模型;
S3.在定位数据融合计算时,利用盲节点与锚节点的水平距离,结合惯性传感数据计算得到位移距离与位移方向,根据当前定位时刻定位环境下采集到的可见光通信RSS数据的数量,计算得到盲节点位置。
进一步的,步骤S3中根据当前定位时刻定位环境下采集到的可见光通信RSS数据的数量,结合惯性传感数据计算得到位移距离与位移方向;
若采集到大于1个RSS数据,离锚节点距离越近的RSS数据误差越小,根据距离值计算权重,采用加权的最小二乘法计算;
若采集到一个RSS数据则结合移动方向计算;
若没有采集到RSS数据则利用惯性传感数据计算。
本发明还公开了一种基于可见光通信与惯性传感器融合的室内定位方法的定位平台,包括锚节点、盲节点和定位服务器,所述盲节点包括光电转换器、无线信号接收器和ARM处理器,将获取到的可见光通信RSS数据与惯性传感数据发送至定位服务器。
有益效果:本发明与现有技术相比,本发明充分考虑可见光通信定位的局限性问题与惯性定位的累积误差问题,通过惯性定位弥补可见光通信定位收到遮挡干扰的问题,通过校准模型解决惯性定位的累积误差问题,在可见光照射范围内采用可见光RSS数据结合惯性传感数据的融合定位方式,提高定位精度并校准惯性定位数据,在可见光照射范围外则采用惯性定位,弥补了可见光RSS数据定位的局限性,通过可见光通信定位技术与惯性传感定位技术的融合,实现室内高精度定位。
附图说明
图1是基于可见光通信与惯性传感器融合的室内定位方法流程图。
图2是可见光通信与惯性传感器的融合定位平台示意图。
图3是融合定位三种数据采集情况示意图。
具体实施方式
本发明为基于可见光通信与惯性传感器融合的室内定位方法,采集数据建立校准模型与RSS-距离模型,对定位数据进行校准计算,根据数据获取情况采用相应的计算方法计算盲节点坐标,方法的主要步骤如图1所示,下面结合附图对本发明方案设计作进一步的具体分析和描述。
如图2所示,融合定位平台主要分成三部分:锚节点(图2中的LED)、盲节点与定位服务器,盲节点为控制器包括光电转换器、无线信号接收器和ARM处理器,将获取到的可见光通信RSS数据与惯性传感数据发送至定位服务器,基于可见光通信与惯性传感器融合的室内定位方法则在定位服务器上运行得到定位结果,具体包括以下步骤:
(1)在定位开始前,多次采集随机分布的盲节点在可见光照射区域内的RSS值RSS={RSS1,…RSSi,…RSSC}以及盲节点与各RSS对应锚节点的距离值r={r1,…ri,…rC},将RSS数值归一化后得到RSS-距离模型:
其中,参数p0=58,p1=-76,p2=-11,p3=116,p4=-84,ui为归一化校准后的RSS数值,根据模型与真实值之间的误差,建立的RSS归一化校准模型计算公式如下:
ui=U(RSSi)=G·(RSSi+br)+nr (2)
其中,G为归一化增益,bτ为偏差值,nr为加性高斯噪声,增益与偏差值的计算如下:
定位过程中,采集到的数据可以对RSS归一化校准模型进行修正,更新归一化增益与偏差值,可以使该模型减小由于使用时长引起的温飘误差。
(2)在定位开始前,随机多次采集盲节点静止或运动状态下的惯性传感数据,得到惯性传感数据的校准模型:
根据测量的加速度,可以推出速度误差因子的线性更新模型表示为:
(3)在定位过程中,利用校准模型公式(2)对可见光通信RSS数据进行归一化校准,根据RSS-距离模型公式(1)计算得到盲节点与锚节点的距离。
根据公式(5)和公式(6)对惯性传感数据进行校准,利用惯性传感数据可以计算得到单位时间位移距离与位移方向:
其中,vk为k时刻速度值,ak为k时刻位移方向,T为单位时间。
(4)数据融合的定位计算时,根据当前定位时刻定位环境下采集到的可见光通信RSS数据的数量,在采集到多个RSS数据时,根据采集到的RSS值可以计算得到相应的距离值,由于对应的锚节点坐标已知,由惯性传感数据计算得到的位移距离lk=vk·T,可以得到以下方程组:
其中,(xk,yk)为当前盲节点位置坐标,ri,k为k时刻盲节点到锚节点i的距离值,(X(i),Y(i))为锚节点i的位置坐标。离锚节点距离越近的RSS数据误差越小,因此根据距离值设定权重WLS,从而得到加权的最小二乘法来计算盲节点位置。基于距离值的权重计算公式为:
由此可以求解得到盲节点最佳坐标位置Sk=[xkyk]T为:
采集到多个RSS数据的情况如附图3中的case A所示,则利用公式(11)-(13)可以计算得到定位坐标。若仅采集到一个RSS数据,如附图3中的case B,则利用这个RSS数据对应的距离值,结合惯性传感数据计算得到的位移距离与移动方向进行定位计算:
若当前定位时刻没有采集到RSS数据,如附图3中的case C,则利用惯性传感数据计算得到当前盲节点位置:
Claims (2)
1.一种基于可见光通信与惯性传感器融合的室内定位方法,其特征在于:基于可见光通信RSS数据和距离的传播模型以及RSS归一化校准模型,结合惯性传感数据的校准模型对数据进行校准,包括以下步骤:
S1.在定位开始前,在可见光照射区域内统计随机分布的盲节点接收到的RSS数据以及盲节点与各RSS数据对应锚节点的距离值,将RSS值归一化后得到RSS-距离模型:
其中,p0、p1、p2、p3、p4为参数,ui为归一化校准后的RSS数值;
计算采集数据的真实距离值与模型计算距离值的均方差,建立RSS归一化校准模型:
ui=U(RSSi)=G·(RSSi+br)+nr (2)
其中,G为归一化增益,bτ为偏差值,nτ为加性高斯噪声,增益与偏差值的计算如下:
在定位开始前,随机多次采集盲节点静止状态与运动状态下的惯性传感数据,得到惯性传感数据的校准模型:
给出校准模型中的误差因子的线性模型,其包括速度误差因子的线性模型、加速度误差因子的线性模型和角速度误差因子的线性模型;所述速度误差因子的线性模型为:
其中,Δa为加速度改变值,ωe为地球旋转引起的向心加速度;
加速度与角速度误差因子的线性模型分别表示为:
对误差因子的线性模型进行自适应卡尔曼滤波,得到误差因子线性校准模型;
S2.在定位数据采集过程中,利用RSS归一化校准模型对可见光通信RSS数据进行归一化校准,根据RSS-距离模型计算得到盲节点与锚节点的距离,利用惯性传感数据的校准模型对惯性传感数据进行校准,计算得到单位时间位移距离与位移方向:
其中,vk为k时刻速度值,ak为k时刻位移方向,T为单位时间;
根据误差因子线性校准模型,进行自适应卡尔曼滤波,更新误差因子,对惯性传感数据的标准模型进行修正;
S3.在定位数据融合计算时,根据当前定位时刻定位环境下采集到的可见光通信RSS数据的数量,利用盲节点与锚节点的水平距离,结合惯性传感数据计算得到位移距离与位移方向:
其中,(xk,yk)为当前盲节点位置坐标,ri,k为k时刻盲节点到锚节点i的距离值,(X(i),Y(i))为锚节点i的位置坐标;lk=vk·T为位移距离;
若采集到大于1个RSS数据,离锚节点距离越近的RSS数据误差越小,根据距离值计算权重,采用加权的最小二乘法计算得到盲节点位置;
其中,根据距离值计算权重的公式为:
得到盲节点位置Sk=[xkyk]T为:
其中:ALS和bLS分别表示最小二乘法矩阵形式的矩阵和列向量;
若采集到一个RSS数据则结合移动方向计算得到盲节点位置:
若没有采集到RSS数据则利用惯性传感数据计算得到盲节点位置:
2.基于权利要求1所述的一种基于可见光通信与惯性传感器融合的室内定位方法的定位平台,其特征在于:包括锚节点、盲节点和定位服务器,所述盲节点包括光电转换器、无线信号接收器和ARM处理器,将获取到的可见光通信RSS数据与惯性传感数据发送至定位服务器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711120158.2A CN107888289B (zh) | 2017-11-14 | 2017-11-14 | 基于可见光通信与惯性传感器融合的室内定位方法及平台 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711120158.2A CN107888289B (zh) | 2017-11-14 | 2017-11-14 | 基于可见光通信与惯性传感器融合的室内定位方法及平台 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107888289A CN107888289A (zh) | 2018-04-06 |
CN107888289B true CN107888289B (zh) | 2020-08-11 |
Family
ID=61777024
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711120158.2A Active CN107888289B (zh) | 2017-11-14 | 2017-11-14 | 基于可见光通信与惯性传感器融合的室内定位方法及平台 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107888289B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108955674A (zh) * | 2018-07-10 | 2018-12-07 | 上海亚明照明有限公司 | 基于可见光通信的室内定位装置及室内定位方法 |
CN109820271A (zh) * | 2019-01-28 | 2019-05-31 | 西安科技大学 | 火场应急救援消防头盔、定位***及其定位方法 |
CN111174784B (zh) * | 2020-01-03 | 2022-10-14 | 重庆邮电大学 | 一种室内停车场可见光与惯导融合定位方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104333903A (zh) * | 2014-09-17 | 2015-02-04 | 北京邮电大学 | 基于rssi和惯性测量的室内多目标的定位***和方法 |
CN105674986A (zh) * | 2016-04-05 | 2016-06-15 | 中国电子科技集团公司第二十研究所 | 一种可见光与惯性组合的室内定位方法 |
CN107289932A (zh) * | 2017-06-28 | 2017-10-24 | 东南大学 | 基于mems传感器和vlc定位融合的单卡尔曼滤波导航装置和方法 |
-
2017
- 2017-11-14 CN CN201711120158.2A patent/CN107888289B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104333903A (zh) * | 2014-09-17 | 2015-02-04 | 北京邮电大学 | 基于rssi和惯性测量的室内多目标的定位***和方法 |
CN105674986A (zh) * | 2016-04-05 | 2016-06-15 | 中国电子科技集团公司第二十研究所 | 一种可见光与惯性组合的室内定位方法 |
CN107289932A (zh) * | 2017-06-28 | 2017-10-24 | 东南大学 | 基于mems传感器和vlc定位融合的单卡尔曼滤波导航装置和方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107888289A (zh) | 2018-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104121905B (zh) | 一种基于惯性传感器的航向角获取方法 | |
Fan et al. | Data fusion for indoor mobile robot positioning based on tightly coupled INS/UWB | |
CN106556854B (zh) | 一种室内外导航***及方法 | |
CN113124856B (zh) | 基于uwb在线锚点的视觉惯性紧耦合里程计及计量方法 | |
CN109682375B (zh) | 一种基于容错决策树的uwb辅助惯性定位方法 | |
CN110398245B (zh) | 基于脚戴式惯性测量单元的室内行人导航姿态估计方法 | |
US9823068B2 (en) | Reducing elevation error with environmental pressure anomaly compensation | |
CN107289932B (zh) | 基于mems传感器和vlc定位融合的单卡尔曼滤波导航装置和方法 | |
CN107888289B (zh) | 基于可见光通信与惯性传感器融合的室内定位方法及平台 | |
CN109099913B (zh) | 一种基于mems惯性器件的穿戴式导航装置和方法 | |
CN108414972B (zh) | 一种基于相位特征的移动机器人rfid定位方法 | |
CN106017470B (zh) | 微惯性测量单元筛选方法及组合式微惯性测量装置 | |
CN107014375B (zh) | 超低部署的室内定位***及方法 | |
CN104808174B (zh) | 基于卡尔曼滤波器和航位推测法的核电站无线定位*** | |
CN110986952B (zh) | 一种针对行人的高精度抗干扰室内定位方法 | |
CN110617795B (zh) | 一种利用智能终端的传感器实现室外高程测量的方法 | |
CN113324544B (zh) | 一种基于图优化的uwb/imu的室内移动机器人协同定位方法 | |
CN110986997A (zh) | 一种提高室内惯性导航精度的方法及*** | |
CN108801250B (zh) | 基于水下机器人的实时姿态获取方法及装置 | |
CN114111802A (zh) | 一种行人航迹推算辅助uwb的定位方法 | |
CN112362057A (zh) | 基于零速修正与姿态自观测的惯性行人导航算法 | |
CN104374389B (zh) | 一种面向室内移动机器人的imu/wsn组合导航方法 | |
CN115767412A (zh) | 融合超宽带和惯性测量单元的室内定位方法 | |
CN104546391A (zh) | 一种用于盲杖的陀螺稳定装置及其互补滤波方法 | |
Zhang et al. | A dynamic window-based UWB-odometer fusion approach for indoor positioning |
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 |