CN107888289A - 基于可见光通信与惯性传感器融合的室内定位方法及平台 - Google Patents
基于可见光通信与惯性传感器融合的室内定位方法及平台 Download PDFInfo
- Publication number
- CN107888289A CN107888289A CN201711120158.2A CN201711120158A CN107888289A CN 107888289 A CN107888289 A CN 107888289A CN 201711120158 A CN201711120158 A CN 201711120158A CN 107888289 A CN107888289 A CN 107888289A
- Authority
- CN
- China
- Prior art keywords
- rss
- data
- visible light
- light communication
- sensing data
- 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.)
- Granted
Links
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-距离模型:
R(ui)=p0+p1·ui+p2·ui 2+p3·ui 3+p4·ui 4 (1)
其中,参数p0=58,p1=-76,p2=-11,p3=116,p4=-84,ui为归一化校准后的RSS数值,根据模型与真实值之间的误差,建立的RSS归一化校准模型计算公式如下:
ui=U(RSSi)=G·(RSSi+br)+nr (2)
其中,G为归一化增益,br为偏差值,nr为加性高斯噪声,增益与偏差值的计算如下:
其中,U(RSSi)0=U(RSSi|br=0)。
定位过程中,采集到的数据可以对RSS归一化校准模型进行修正,更新归一化增益与偏差值,可以使该模型减小由于使用时长引起的温飘误差。
(2)在定位开始前,随机多次采集盲节点静止或运动状态下的惯性传感数据,得到惯性传感数据的校准模型:
其中,加速度a=[ax ay az]T,角速度ω=[ωα ωβ ωγ]T。其中和为测量的加速度值和角速度值,nac和nav为加性高斯噪声。为地球坐标系到载体坐标系的转换矩阵。
根据测量的加速度,可以推出速度误差因子的线性更新模型表示为:
其中,Δa为加速度改变值,ωe为地球旋转引起的向心加速度。加速度与角速度的误差因子线性更新模型可以表示为和对误差因子进行自适应卡尔曼滤波,其状态向量和测量向量为
(3)在定位过程中,利用校准模型公式(2)对可见光通信RSS数据进行归一化校准,根据RSS-距离模型公式(1)计算得到盲节点与锚节点的距离。
根据公式(5)和公式(6)对惯性传感数据进行校准,利用惯性传感数据可以计算得到单位时间位移距离与位移方向:
其中,vk为k时刻速度值,αk为k时刻位移方向,T为单位时间。 根据误差因子线性模型,进行自适应卡尔曼滤波,更新误差因子,对惯性定位数据校准模型进行修正,可以使该模型适应由于使用时长引起的累积误差。
(4)数据融合的定位计算时,根据当前定位时刻定位环境下采集到的可见光通信RSS数据的数量,在采集到多个RSS数据时,根据采集到的RSS值可以计算得到相应的距离值,由于对应的锚节点坐标已知,由惯性传感数据计算得到的位移距离lk=vk·T,可以得到以下方程组:
其中,(xk,yk)为当前盲节点位置坐标,ri,k为k时刻盲节点到锚节点i的距离值,(X(i),Y(i))为锚节点i的位置坐标。离锚节点距离越近的RSS数据误差越小,因此根据距离值设定权重WLS,从而得到加权的最小二乘法来计算盲节点位置。基于距离值的权重计算公式为:
由此可以求解得到盲节点最佳坐标位置Sk=[xk yk]T为:
采集到多个RSS数据的情况如附图3中的case A所示,则利用公式(11)-(13)可以计算得到定位坐标。若仅采集到一个RSS数据,如附图3中的case B,则利用这个RSS数据对应的距离值,结合惯性传感数据计算得到的位移距离与移动方向进行定位计算:
若当前定位时刻没有采集到RSS数据,如附图3中的case C,则利用惯性传感数据计算得到当前盲节点位置:
Claims (3)
1.一种基于可见光通信与惯性传感器融合的室内定位方法,其特征在于:基于可见光通信RSS数据和距离的传播模型以及RSS归一化校准模型,结合惯性传感数据的校准模型对数据进行校准,包括以下步骤:
S1.在定位开始前,在可见光照射区域内统计随机分布的盲节点接收到的RSS数据以及盲节点与各RSS数据对应锚节点的距离值,将RSS值归一化后得到RSS-距离模型,计算采集数据的真实距离值与模型计算距离值的均方差,建立RSS归一化校准模型;
在定位开始前,随机多次采集盲节点静止状态与运动状态下的惯性传感数据,得到惯性传感数据的校准模型,给出校准模型中的误差因子线性模型,对其进行自适应卡尔曼滤波,优化校准模型;
S2.在定位数据采集过程中,利用优化后的校准模型对可见光通信RSS数据进行归一化标准,根据RSS-距离模型计算得到盲节点与锚节点的距离,利用优化后的校准模型对惯性传感数据进行校准,计算得到单位时间位移距离与位移方向,根据误差因子线性模型,进行只适应卡尔曼滤波,更新误差因子与惯性传感数据的标准模型;
S3.在定位数据融合计算时,利用盲节点与锚节点的水平距离,结合惯性传感数据计算得到位移距离与位移方向,根据当前定位时刻定位环境下采集到的可见光通信RSS数据的数量,计算得到盲节点位置。
2.根据权利要求1所述的一种基于可见光通信与惯性传感器融合的室内定位方法,其特征在于:所述步骤S3中根据当前定位时刻定位环境下采集到的可见光通信RSS数据的数量,结合惯性传感数据计算得到位移距离与位移方向;
若采集到大于1个RSS数据,离锚节点距离越近的RSS数据误差越小,根据距离值计算权重,采用加权的最小二乘法计算;
若采集到一个RSS数据则结合移动方向计算;
若没有采集到RSS数据则利用惯性传感数据计算。
3.基于权利要求1或2所述的一种基于可见光通信与惯性传感器融合的室内定位方法的定位平台,其特征在于:包括锚节点、盲节点和定位服务器,所述盲节点包括光电转换器、无线信号接收器和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 true CN107888289A (zh) | 2018-04-06 |
CN107888289B 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) |
Cited By (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 | 西安科技大学 | 火场应急救援消防头盔、定位系统及其定位方法 |
CN111174784A (zh) * | 2020-01-03 | 2020-05-19 | 重庆邮电大学 | 一种室内停车场可见光与惯导融合定位方法 |
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定位融合的单卡尔曼滤波导航装置和方法 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108955674A (zh) * | 2018-07-10 | 2018-12-07 | 上海亚明照明有限公司 | 基于可见光通信的室内定位装置及室内定位方法 |
CN109820271A (zh) * | 2019-01-28 | 2019-05-31 | 西安科技大学 | 火场应急救援消防头盔、定位系统及其定位方法 |
CN111174784A (zh) * | 2020-01-03 | 2020-05-19 | 重庆邮电大学 | 一种室内停车场可见光与惯导融合定位方法 |
CN111174784B (zh) * | 2020-01-03 | 2022-10-14 | 重庆邮电大学 | 一种室内停车场可见光与惯导融合定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107888289B (zh) | 2020-08-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105588566B (zh) | 一种基于蓝牙与mems融合的室内定位系统及方法 | |
CN107289933B (zh) | 基于mems传感器和vlc定位融合的双卡尔曼滤波导航装置和方法 | |
CN104713554B (zh) | 一种基于mems惯性器件与安卓智能手机融合的室内定位方法 | |
CN109725338A (zh) | 基于uwb及gps的室内室外一体化定位系统 | |
CN109916407A (zh) | 基于自适应卡尔曼滤波器的室内移动机器人组合定位方法 | |
CN107289932B (zh) | 基于mems传感器和vlc定位融合的单卡尔曼滤波导航装置和方法 | |
CN106646366A (zh) | 基于粒子滤波算法和智能设备的可见光定位方法和系统 | |
CN106680765A (zh) | 基于分布式组合滤波ins/uwb行人导航系统及方法 | |
CN108645413A (zh) | 一种移动机器人的同时定位与地图创建的动态纠正方法 | |
CN106031263A (zh) | 用于位置估计的方法及系统 | |
CN107734457A (zh) | 智慧停车场导航系统及方法 | |
CN103197279A (zh) | 一种移动目标协同定位系统及定位方法 | |
CN108151747A (zh) | 一种利用声信号与惯性导航融合的室内定位系统及定位方法 | |
CN105043380A (zh) | 基于微机电传感器、WiFi定位、磁场匹配的室内导航方法 | |
CN107094319A (zh) | 一种高精度室内外融合定位系统和方法 | |
CN103968827A (zh) | 一种可穿戴式人体步态检测的自主定位方法 | |
CN107490378B (zh) | 一种基于mpu6050与智能手机的室内定位与导航的方法 | |
CN107014375A (zh) | 超低部署的室内定位系统及方法 | |
CN109883423A (zh) | 基于卡尔曼滤波的定位方法、系统、设备及存储介质 | |
CN107270898B (zh) | 基于mems传感器和vlc定位融合的双粒子滤波导航装置和方法 | |
CN110398245A (zh) | 基于脚戴式惯性测量单元的室内行人导航姿态估计方法 | |
CN104808174B (zh) | 基于卡尔曼滤波器和航位推测法的核电站无线定位系统 | |
CN107888289A (zh) | 基于可见光通信与惯性传感器融合的室内定位方法及平台 | |
CN105704652A (zh) | 一种wlan/蓝牙定位中的指纹库采集和优化方法 | |
CN109682375A (zh) | 一种基于容错决策树的uwb辅助惯性定位方法 |
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 |