CN103399298B - 一种基于光强度的多传感器室内定位装置与方法 - Google Patents
一种基于光强度的多传感器室内定位装置与方法 Download PDFInfo
- Publication number
- CN103399298B CN103399298B CN201310325495.0A CN201310325495A CN103399298B CN 103399298 B CN103399298 B CN 103399298B CN 201310325495 A CN201310325495 A CN 201310325495A CN 103399298 B CN103399298 B CN 103399298B
- Authority
- CN
- China
- Prior art keywords
- light intensity
- optical sensor
- pointolite
- light
- value
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B7/00—Measuring arrangements characterised by the use of electric or magnetic techniques
-
- 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/16—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V8/00—Prospecting or detecting by optical means
- G01V8/10—Detecting, e.g. by using light barriers
- G01V8/20—Detecting, e.g. by using light barriers using multiple transmitters or receivers
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geophysics (AREA)
- Electromagnetism (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明涉及一种基于光强度的多传感器室内定位装置与方法,装置包括光传感器组、磁传感器组、点光源、数据处理模块以及存储模块。其中,光传感器组包括N个光传感器,N≥6;光传感器获取光信号数据;存储模块存储点光源的坐标值以及N个光传感器传感平面的初始单位法向量值;磁传感器组获取当前航向角;数据处理模块获取光强值以及当前光传感器传感平面的单位法向量值,然后根据当前单位法向量值、光强值、点光源的坐标值以及光强模型建立包含至少三个方程的方程组,求解获得光传感器组的坐标值,方程由光强模型s=fd(d)fμ(μ)fω(ω)建立。本发明能在复杂的室内环境中较精确地定位该接收端的位置,且无需布置其他高精度辅助设备、无需采集室内指纹,定位精度高。
Description
【技术领域】
本发明涉及定位技术,尤其涉及一种基于光强度的多传感器室内定位装置与方法。
【背景技术】
随着信息和通信技术的普及,人们对室内定位信息的需求与日俱增,在诸如商场、机场、展厅、写字楼、仓库、地下停车场等公共场所都需要使用准确的定位信息,例如在商场导购、大型仓库管理、公共场所寻人等应用场景。精确的室内定位信息能够对可用空间和库存物资实现高效管理,能够导航警察、消防员、士兵、医务工作人员在特定场所完成特定的室内任务,因此室内定位技术具有广阔的应用前景。然而,传统的定位系统已经不能满足室内定位需求。GPS虽然在室外定位方面能满足很多应用的需求,但是由于混凝土等障碍物对信号存在遮挡,限制了其在室内环境中的应用。
目前室内定位技术主要包括邻近检测法、指纹匹配法和多边/角度法等。邻近检测法将检测到的信号源位置作为定位位置,其缺点是精度较低;指纹匹配方法利用室内环境中的信号特征匹配可获取较高的定位精度,但定位结果易受室内多径效应和环境变化等影响,且建立指纹数据库工作繁琐;多边/角度法需要预先通过其他算法精确测量定位点到参考点的距离/角度等信息,再利用三边测量法等对目标进行定位,如果测距/角设备精度较高,参考节点位置信息准确、测量距离准确,就可以精确地测得目标节点的位置,但精度高的测距/角设备较为昂贵、成本较高,若在在实际测量中采用精度一般的测距/角设备又会存在误差,结果不够准确。
【发明内容】
本发明旨在解决上述现有技术中存在的问题,提出一种基于光强度的多传感器室内定位装置与方法。
本发明一方面提出一种基于光强度的多传感器室内定位装置,该装置包括:光传感器组、磁传感器组、点光源、数据处理模块以及存储模块。其中,所述光传感器组包括N个光传感器,N≥6,所述光传感器组呈棱台形,所述N个光传感器设于所述棱台的外表面,在室内任何位置至少三个所述光传感器能采集到所述点光源的光信号数据;所述存储模块存储所述点光源的坐标值以及所述N个光传感器传感平面的初始单位法向量值;所述磁传感器组获取当前航向角;所述数据处理模块根据所述光信号数据获取光强值,并根据所述航向角以及初始单位法向量值获取当前单位法向量值,再根据当前单位法向量值、光强值、点光源的坐标值以及光强模型建立包含至少三个方程的方程组,并求解所述方程组,获得所述光传感器组的坐标值,其中,所述方程由光强模型s=fd(d)fμ(μ)fω(ω)建立,s为光信号的光强值,距离 (x0、y0、z0)为点光源的坐标值,(x,y,z)为所述光传感器的位置坐标,fd(d)为光强值与距离d的关系函数,fμ(μ)、fω(ω)分别为光强值与角度μ、ω的关系函数,μ=arcsin(|A(x0-x)+B(y0-y)+C(z0-z)|/d),其中,(A,B,C)为所述光传感器传感平面的当前单位法向量值,ω=arccosz0-z)/d)。
本发明另一方面提出一种基于光强度的多传感器室内定位方法,该方法包括如下步骤:S100、使用包括N个光传感器的光传感器组采集点光源的光信号数据,并根据所述光信号数据获取光强值,其中,N≥6;S200、使用磁传感器组获取当前航向角;S300、根据所述航向角以及光传感器传感平面初始单位法向量值获取当前单位法向量值;S400、根据所述当前单位法向量值、光强值、点光源的坐标值以及光强模型建立包含至少三个方程的方程组,并求解所述方程组,获得所述光传感器组的坐标值,其中,所述方程由光强模型s=fd(d)fμ(μ)fω(ω)建立,s为光信号的光强值,距离 (x0、y0、z0)为点光源的坐标值,(x,y,z)为所述光传感器的位置坐标,fd(d)为光强值与距离d的关系函数,fμ(μ)、fω(ω)分别为光强值与角度μ、ω的关系函数,μ=arcsin(|A(x0-x)+B(y0-y)+C(z0-z)|/d),其中,(A,B,C)为所述光传感器传感平面的当前单位法向量值,ω=arccos((z0-z)/d)。
本发明提出的基于光强度的多传感器室内定位装置与方法依据光强模型、使用集成有光传感器的接收端装置接收光信号并获取光强值,采取若干个光传感器与单一光源的实验方法,能够在复杂的室内环境中较为精确地定位该接收端的位置,且无需布置其他高精度辅助设备、无需采集室内指纹,定位精度高,稳定性好,成本低廉。
【附图说明】
图1为本发明一实施例的基于光强度的多传感器室内定位装置结构图。
图2为本发明一实施例的光传感器外观图。
图3为本发明一实施例的光传感器与点光源的光场关系示意图。
图4为本发明一实施例的基于光强度的多传感器室内定位方法流程图。
【具体实施方式】
为了使本发明的目的、技术方案及优点更加清晰,以下结合具体实施例及附图,对本发明作进一步详细说明。应当理解,文中所描述的具体实施例仅仅用以解释本发明的技术方案,而不应当理解为对本发明的限制。
本发明提供一种基于光强度的多传感器室内定位装置与方法。
本发明一方面提供一种基于光强度的多传感器室内定位装置。如图1所示,在一实施例中,所述基于光强度的多传感器室内定位装置包括光传感器组100、磁传感器组200、点光源300、数据处理模块400以及存储模块500。所述光传感器组100包括N个光传感器(第一传感器101、第二传感器102、第三传感器103、……),其中,N≥6,所述光传感器组100设计呈棱台形,所述N个光传感器设于所述棱台的外表面,且棱台形设计的所述光传感器组100能满足以下条件:即所述光传感器组100处于室内时,至少三个所述光传感器能采集到所述点光源300的光信号数据。
所述光传感器组100可设置于电路板上,通过数据接口将各个所述光传感器与所述数据处理模块400相连接,所述数据处理模块400包括但不限于CPU处理器、嵌入式处理芯片等具有数据处理功能的器件。所述光传感器组100、数据处理模块400、存储模块500可一体设置于待定位的载体上,跟随所述载体运动。
所述点光源300包括但不限于可见光LED灯、红外线LED灯等。
以N=6为例,如图2所示,所述光传感器组100呈五棱台形,其包括六个光传感器,该六个光传感器分别设于所述五棱台的六个外表面。上述设计可以使所述光传感器组100中至少三个所述光传感器(以第一传感器101、第二传感器102、第三传感器103为例)能够采集到所述点光源的光信号数据。
所述第一传感器101、第二传感器102、第三传感器103采集所述点光源300的光信号数据,所述数据处理模块400根据所述光信号数据获取光强值。
所述存储模块500预先存储了所述点光源300的坐标值以及所述N个光传感器传感平面的初始单位法向量值。
所述数据处理模块400根据航向角Φ以及所述初始单位法向量值获取第一传感器101、第二传感器102、第三传感器103传感平面的当前单位法向量值,并根据当前单位法向量值、光强值、点光源300的坐标值以及光强模型建立包含至少三个方程的方程组,并求解所述方程组,获得所述光传感器组100的坐标值,该坐标值即代表了所述载体的位置。
其中,所述方程的建立如下所述:所述方程组的建立可参照光强模型s=fd(d)fμ(μ)fω(ω),如图3所示,对于第一传感器101、第二传感器102、第三传感器103中的任意一个,所述点光源300相对于该光传感的距离 (x0、y0、z0)为点光源的坐标值,(x,y,z)为所述光传感器的位置坐标,s为所述光信号的光强值,fd(d)为光强值与距离d的关系函数,fμ(μ)、fω(ω)分别为光强值与角度μ、ω的关系函数,μ=arcsin(|A(x0-x)+B(y0-y)+C(z0-z)|/d),其中,(A,B,C)为所述光传感器传感平面的当前单位法向量值,ω=arccos((z0-z)/d)。
具体地,分别使用函数fd(d)、fμ(μ)、fω(ω)来表示光强与d、μ、ω的关系。由于光强衰减与距离的平方成反比,用参数k表示光传感器垂直面对点光源中心光距离点光源1m处测得的光强值,因此有fd(d)=k/d2;将光传感器置于中心光线上距离点光源dm处,入射角μ初值设为90°,等角度(如每隔10°)偏转光传感器的传感平面,使中心光进入传感器的入射角μ从垂直时的90°等角度(如10°)减小到0°,此时中心光线与光传感器的传感平面平行,每次偏转后测试光强值,得到光强与入射角μ的关系函数fμ(μ),同时,在上述过程中,角度ω从0°增大到90°,每次偏转后测试光强值,得到光强与角度ω的关系函数fω(ω)。综合以上影响光强的各个参数,得到光传感器与点光源之间的光强模型s=fd(d)fμ(μ)fω(ω)。综上所述,所述第一传感器101、第二传感器102、第三传感器103与所述点光源300之间的光强模型即构成所述包含至少三个方程的方程组。
所述磁传感器组200用于获取运动中待定位载体的当前航向角Φ,所述数据处理模块400根据所述航向角Φ以及初始单位法向量值获取传感器的当前单位法向量值(A,B,C)。优选地,所述磁传感器组200包括N个磁传感器,所述N个磁传感器围成一圈。在本实施例中,NN6,所述磁传感器组200获取磁力数据,所述数据处理模块400对所述磁力数据进行校正并获取所述航向角Φ。
具体地,若磁传感器没有受到任何干扰,则磁传感器旋转一周采集到的磁力数据在以(0,0)为圆心的圆上,但在实际应用中,磁传感器会受到环境的各种磁干扰,其旋转一周采集到的数据会形成一个偏离圆心的倾斜椭圆,这就需要对其进行校正,得到校正参数,从而对磁力数据进行校正,使校正后的数据恢复在以(0,0)为圆心的圆上。在本实施例中,首先需要对所述磁传感器组200中每个磁传感器进行校正,在一个无外界磁场干扰的环境中,将所述磁传感器组200在水平面上绕其中心旋转一周,同时采集磁力数据。受到干扰的磁力数据形成的椭圆表达式为(x-x0)2/a2+(y-y0)2/b2=R2,其中x,y为磁力数据,R为地磁场强度常量,x0,y0,a,b为校正参数,将上式改写成矩阵形式,根据最小二乘法求得x0,y0,a,b的值。在对每一个磁传感器进行校正、得到六组校正参数之后再结合六组校正参数对所述磁传感器组200进行校正,得到x0’,y0’,a’,b’参数,最后使用这些参数进行计算,将磁力数据恢复到以(0,0)为圆心的圆上,所述数据处理模块400根据校正后的磁力数据获取所述航向角Φ。
所述数据处理模块400根据所述航向角Φ以及初始单位法向量值获取当前单位法向量值,并根据当前单位法向量值、光强值、所述点光源300的坐标值以及光强模型建立包含至少三个方程的方程组,并求解所述方程组得到(x,y,z)值。获知所述点光源300相对于该光传感器的位置坐标后,即可获知所述光传感器组100的位置坐标,也即所述待定位载体的位置。
优选地,所述点光源300包括但不限于可见光LED灯、红外线LED灯等。所述点光源300发出的光信号应不影响室内人们的正常工作、休息,其频率不宜太低,且应使所述光传感器组100能完整采集到光信号,同时其频率也不宜太高,其频率需避开环境中已有的干扰频率,如日光灯的100Hz频率等。优选地,将所述点光源300频率设置在30Hz‐400Hz范围内。
优选地,所述数据处理模块400在建立上述方程组之前,还先将干扰光信号去除。具体地,所述数据处理模块400对所述光强值进行采样、傅里叶变换,在频域上去除干扰光信号(例如普通日光灯100Hz频率等其它频率的室内杂质光)。
本发明另一方面提出一种基于光强度的多传感器室内定位方法,如图4所示,该方法包括以下步骤:S100、使用包括N个光传感器的光传感器组采集点光源的光信号数据,并根据所述光信号数据获取光强值,其中,N≥6;S200、使用磁传感器组获取当前航向角;S300、根据所述航向角以及光传感器传感平面初始单位法向量值获取当前单位法向量值;S400、根据所述当前单位法向量值、光强值、点光源的坐标值以及光强模型建立包含至少三个方程的方程组,并求解所述方程组,获得所述光传感器组的坐标值,其中,所述方程由光强模型s=fd(d)fμ(μ)fω(ω)建立,s为光信号的光强值,距离 (x0、y0、z0)为点光源的坐标值,(x,y,z)为所述光传感器的位置坐标,fd(d)为光强值与距离d的关系函数,fμ(μ)、fω(ω)分别为光强值与角度μ、ω的关系函数,μ=arcsin(|A(x0-x)+B(y0-y)+C(z0-z)|/d),其中,(A,B,C)为所述光传感器传感平面的当前单位法向量值,ω=arccos((z0-z)/d)。
下面将对所述基于光强度的多传感器室内定位方法作进一步详细描述。
在步骤S100中所使用的所述光传感器组包括N个光传感器(如第一传感器、第二传感器、第三传感器、……),其中,N≥6。优选地,所述光传感器组设计呈棱台形,所述N个光传感器设于所述棱台的外表面,且棱台形设计的所述光传感器组能满足以下条件:即所述光传感器组处于室内时,至少三个所述光传感器能采集到所述点光源的光信号数据。所述光传感器组可设置于电路板上,通过数据接口将各个所述光传感器与数据处理器相连接。所述光传感器组、数据处理器等装置可一体设置于待定位的载体上,跟随所述载体运动。
所述点光源包括但不限于可见光LED灯、红外线LED灯等。
以N=6为例,如图2所示,所述光传感器组呈五棱台形,其包括六个光传感器,该六个光传感器分别设于所述五棱台的六个外表面。上述设计可以使所述光传感器组中至少三个所述光传感器(如第一传感器、第二传感器、第三传感器)能够采集到所述点光源的光信号数据,进而根据所述光信号数据获取光强值。
在步骤S200中使用磁传感器组获取当前航向角Φ。
优选地,所述磁传感器组包括N个磁传感器,所述N个磁传感器围成一圈。在本实施例中,N=6,使用所述磁传感器组获取磁力数据,再对所述磁力数据进行校正从而获取所述航向角Φ。
具体地,若磁传感器没有受到任何干扰,则磁传感器旋转一周采集到的磁力数据在以(0,0)为圆心的圆上,但在实际应用中,磁传感器会受到环境的各种磁干扰,其旋转一周采集到的数据会形成一个偏离圆心的倾斜椭圆,这就需要对其进行校正,得到校正参数,从而对磁力数据进行校正,使校正后的数据恢复在以(0,0)为圆心的圆上。在本实施例中,首先需要对所述磁传感器组中每个磁传感器进行校正,在一个无外界磁场干扰的环境中,将所述磁传感器组在水平面上绕其中心旋转一周,同时采集磁力数据。受到干扰的磁力数据形成的椭圆表达式为(x-x0)2/a2+(y-y0)2/b2=R2,其中x,y为磁力数据,R为地磁场强度常量,x0,y0,a,b为校正参数,将上式改写成矩阵形式,根据最小二乘法求得x0,y0,a,b的值。在对每一个磁传感器进行校正、得到六组校正参数之后再结合六组校正参数对所述磁传感器组进行校正,得到x0’,y0’,a’,b’参数,最后使用这些参数进行计算,将磁力数据恢复到以(0,0)为圆心的圆上,所最终根据校正后的磁力数据获取所述航向角Φ。获取航向角Φ之后,即可实施步骤S300,根据所述航向角Φ以及光传感器传感平面初始单位法向量值获取当前单位法向量值。
在步骤S400中,根据当前单位法向量值、光强值、预先存储的所述点光源坐标值以及光强模型建立包含至少三个方程的方程组,并求解所述方程组,获得所述光传感器组的坐标值,该坐标值即代表了所述载体的位置。
其中,所述方程的建立如下所述:所述方程组的建立可参照光强模型s=fd(d)fμ(μ)fω(ω),如图3所示,对于第一传感器、第二传感器、第三传感器中的任意一个,所述点光源相对于该光传感的距离 (x0、y0、z0)为点光源的坐标值,(x,y,z)为所述光传感器的位置坐标,s为所述光信号的光强值,fd(d)为光强值与距离d的关系函数,fμ(μ)、fω(ω)分别为光强值与角度μ、ω的关系函数,μ=arcsin(|A(x0-x)+B(y0-y)+C(z0-z)|/d),其中,(A,B,C)为所述光传感器传感平面的当前单位法向量值,ω=arccos((z0-z)/d)。具体地,分别使用函数fd(d)、fμ(μ)、fω(ω)来表示光强与d、μ、ω的关系。由于光强衰减与距离的平方成反比,用参数k表示光传感器垂直面对点光源中心光距离点光源1m处测得的光强值,因此有fd(d)=k/d2;将光传感器置于中心光线上距离点光源dm处,入射角μ初值设为90°,等角度(如每隔10°)偏转光传感器的传感平面,使中心光进入传感器的入射角μ从垂直时的90°等角度(如10°)减小到0°,此时中心光线与光传感器的传感平面平行,每次偏转后测试光强值,得到光强与入射角μ的关系函数fμ(μ),同时,在上述过程中,角度ω从0°增大到90°,每次偏转后测试光强值,得到光强与角度ω的关系函数fω(ω)。综合以上影响光强的各个参数,得到光传感器与点光源之间的光强模型s=fd(d)fμ(μ)fω(ω)。综上所述,所述第一传感器、第二传感器、第三传感器与所述点光源之间的光强模型即构成所述包含至少三个方程的方程组。
基于求解上述方程组可得(x,y,z)值,获知所述点光源相对于该光传感器的位置坐标后,即可获知所述光传感器组的位置坐标,也即所述待定位载体的位置。
优选地,所述点光源包括但不限于可见光LED灯、红外线LED灯等。所述点光源发出的光信号应不影响室内人们的正常工作、休息,其频率不宜太低,且应使所述光传感器组能完整采集到光信号,同时其频率也不宜太高,其频率需避开环境中已有的干扰频率,如日光灯的100Hz频率等。优选地,将所述点光源频率设置在30Hz‐400Hz范围内。
优选地,在步骤S400中建立上述方程组之前,还先将干扰光信号去除。具体地,对所述光强值进行采样、傅里叶变换,在频域上去除干扰光信号(例如普通日光灯100Hz频率等其它频率的室内杂质光)。
本发明提出的基于光强度的多传感器室内定位装置与方法依据光强模型、使用集成有光传感器的接收端装置接收光信号并获取光强值,采取若干个光传感器与单一光源的实验方法,能够在复杂的室内环境中较为精确地定位该接收端的位置,且无需布置其他高精度辅助设备、无需采集室内指纹,定位精度高,稳定性好,成本低廉。
虽然本发明参照当前的较佳实施方式进行了描述,但本领域的技术人员应能理解,上述较佳实施方式仅用来解释和说明本发明的技术方案,而并非用来限定本发明的保护范围,任何在本发明的精神和原则范围之内,所做的任何修饰、等效替换、变形、改进等,均应包含在本发明的权利要求保护范围之内。
Claims (10)
1.一种基于光强度的多传感器室内定位装置,包括:光传感器组、磁传感器组、点光源、数据处理模块以及存储模块,其中,
所述光传感器组包括N个光传感器,N≥6,所述光传感器组呈棱台形,所述N个光传感器设于所述棱台的外表面,在室内任何位置至少三个所述光传感器能采集到所述点光源的光信号数据;
所述存储模块存储所述点光源的坐标值以及所述N个光传感器传感平面的初始单位法向量值;
所述磁传感器组获取当前航向角;
所述数据处理模块根据所述光信号数据获取光强值,并根据所述航向角以及初始单位法向量值获取当前单位法向量值,再根据当前单位法向量值、光强值、点光源的坐标值以及光强模型建立包含至少三个方程的方程组,并求解所述方程组,获得所述光传感器组的坐标值,其中,所述方程由光强模型s=fd(d)fμ(μ)fω(ω)建立,s为光信号的光强值,距离 (x0、y0、z0)为点光源的坐标值,(x,y,z)为所述光传感器的位置坐标,fd(d)为光强值与距离d的关系函数,fμ(μ)、fω(ω)分别为光强值与角度μ、ω的关系函数,μ=arcsin(|A(x0-x)+B(y0-y)+C(z0-z)|/d),其中,(A,B,C)为所述光传感器传感平面的当前单位法向量值,ω=arccos((z0-z)/d);
用参数k表示所述光传感器垂直面对点光源中心距离点光源1m处测得的光强值,则所述fd(d)=k/d2;
将所述光传感器置于中心光线上距离点光源dm处,所述角度μ初值设为90°,等角度偏转所述光传感器的传感平面,使中心光线进入所述光传感器的角度μ从垂直时的90°等角度减小到0°,此时中心光线与所述光传感器的传感平面平行,每次偏转后测试光强值,得到所述光强与角度μ的关系函数fμ(μ);
将所述光传感器置于中心光线上距离点光源dm处,所述角度ω初值设为0°,等角度偏转所述点光源,使所述点光源发出的进入所述光传感器的光线与中心光线的角度ω从0°增大到90°,每次偏转后测试光强值,得到所述光强与角度ω的关系函数fω(ω)。
2.根据权利要求1所述的基于光强度的多传感器室内定位装置,其特征在于,N=6,所述光传感器组呈五棱台形,所述六个光传感器分别设于所述五棱台的六个外表面。
3.根据权利要求1所述的基于光强度的多传感器室内定位装置,其特征在于,所述磁传感器组包括N个磁传感器,所述N个磁传感器围成一圈,所述磁传感器组获取磁力数据,所述数据处理模块对所述磁力数据进行校正并获取所述航向角。
4.根据权利要求1至3任意一项所述的基于光强度的多传感器室内定位装置,其特征在于,所述点光源为可见光LED灯或红外线LED灯。
5.根据权利要求1至3任意一项所述的基于光强度的多传感器室内定位装置,其特征在于,所述数据处理模块去除干扰光信号,并根据当前单位法向量值、光强值、点光源的坐标值以及光强模型建立所述方程组。
6.一种基于光强度的多传感器室内定位方法,包括以下步骤:
S100、使用包括N个光传感器的光传感器组采集点光源的光信号数据,并根据所述光信号数据获取光强值,其中,N≥6;
S200、使用磁传感器组获取当前航向角;
S300、根据所述航向角以及光传感器传感平面初始单位法向量值获取当前单位法向量值;
S400、根据所述当前单位法向量值、光强值、点光源的坐标值以及光强模型建立包含至少三个方程的方程组,并求解所述方程组,获得所述光传感器组的坐标值,其中,所述方程由光强模型s=fd(d)fμ(μ)fω(ω)建立,s为光信号的光强值,距离 (x0、y0、z0)为点光源的坐标值,(x,y,z)为所述光传感器的位置坐标,fd(d)为光强值与距离d的关系函数,fμ(μ)、fω(ω)分别为光强值与角度μ、ω的关系函数,μ=arcsin(|A(x0-x)+B(y0-y)+C(z0-z)|/d),其中,(A,B,C)为所述光传感器传感平面的当前单位法向量值,ω=arccos((z0-z)/d);
用参数k表示所述光传感器垂直面对点光源中心距离点光源1m处测得的光强值,则所述fd(d)=k/d2;
将所述光传感器置于中心光线上距离点光源dm处,所述角度μ初值设为90°,等角度偏转所述光传感器的传感平面,使中心光线进入所述光传感器的角度μ从垂直时的90°等角度减小到0°,此时中心光线与所述光传感器的传感平面平行,每次偏转后测试光强值,得到所述光强与角度μ的关系函数fμ(μ);
将所述光传感器置于中心光线上距离点光源dm处,所述角度ω初值设为0°,等角度偏转所述点光源,使所述点光源发出的进入所述光传感器的光线与中心光线的角度ω从0°增大到90°,每次偏转后测试光强值,得到所述光强与角度ω的关系函数fω(ω)。
7.根据权利要求6所述的基于光强度的多传感器室内定位方法,其特征在于,N=6,所述光传感器组呈五棱台形,所述六个光传感器分别设于所述五棱台的六个外表面。
8.根据权利要求6所述的基于光强度的多传感器室内定位方法,其特征在于,所述磁传感器组包括N个磁传感器,所述N个磁传感器围成一圈,对所述磁传感器采集的磁力数据进行校正并获取所述航向角。
9.根据权利要求6至8任意一项所述的基于光强度的多传感器室内定位方法,其特征在于,所述点光源为可见光LED灯或红外线LED灯。
10.根据权利要求6至8任意一项所述的基于光强度的多传感器室内定位方法,其特征在于,在步骤S400中,首先去除干扰光信号,再根据当前单位法向量值、光强值、点光源的坐标值以及光强模型建立所述方程组。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310325495.0A CN103399298B (zh) | 2013-07-30 | 2013-07-30 | 一种基于光强度的多传感器室内定位装置与方法 |
US14/087,162 US9360310B2 (en) | 2013-07-30 | 2013-11-22 | Multi-sensor indoor localization method and device based on light intensity |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310325495.0A CN103399298B (zh) | 2013-07-30 | 2013-07-30 | 一种基于光强度的多传感器室内定位装置与方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103399298A CN103399298A (zh) | 2013-11-20 |
CN103399298B true CN103399298B (zh) | 2015-12-02 |
Family
ID=49562954
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310325495.0A Active CN103399298B (zh) | 2013-07-30 | 2013-07-30 | 一种基于光强度的多传感器室内定位装置与方法 |
Country Status (2)
Country | Link |
---|---|
US (1) | US9360310B2 (zh) |
CN (1) | CN103399298B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110333483A (zh) * | 2019-06-25 | 2019-10-15 | 北京科技大学 | 一种多pd结构的可见光定位接收装置 |
Families Citing this family (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104297726B (zh) * | 2014-10-23 | 2017-02-22 | 东南大学 | 一种面向可见光通信的多接收点几何中心定位方法 |
TWI548891B (zh) | 2015-01-12 | 2016-09-11 | 金寶電子工業股份有限公司 | 掃地機定位系統及其定位方法 |
CN104991228B (zh) * | 2015-02-06 | 2016-11-02 | 北京理工大学 | 基于可见光信号强度的三维空间室内定位方法 |
CN104735780B (zh) * | 2015-03-25 | 2018-03-30 | 中国科学院深圳先进技术研究院 | 一种室内定位装置和定位方法 |
US9883351B2 (en) * | 2015-03-25 | 2018-01-30 | Shenzhen Institutes Of Advanced Technology Chinese Academy Of Sciences | Indoor positioning device and indoor positioning method |
CN104865553B (zh) * | 2015-06-10 | 2017-07-14 | 珠海横琴华策光通信科技有限公司 | 定位系统、光信号处理器及定位部件 |
CN105425207B (zh) * | 2015-10-29 | 2018-02-02 | 中国计量学院 | 一种基于ZigBee传感网络及LED的煤矿井定位系统设计 |
CN105424032B (zh) * | 2015-12-08 | 2018-05-08 | 小米科技有限责任公司 | 终端室内定位方法及装置 |
CN106907993B (zh) * | 2017-03-05 | 2020-12-11 | 湖南奥通智能科技有限公司 | 一种基于机器视觉的位置检测模组及实时防护系统 |
US10877156B2 (en) | 2018-03-23 | 2020-12-29 | Veoneer Us Inc. | Localization by light sensors |
US11022511B2 (en) | 2018-04-18 | 2021-06-01 | Aron Kain | Sensor commonality platform using multi-discipline adaptable sensors for customizable applications |
CN109632088B (zh) * | 2019-01-17 | 2024-02-02 | 南京易纹兴智能科技有限公司 | 一种多光源照度检测和矫正的自动控制系统 |
US20220163323A1 (en) * | 2019-03-22 | 2022-05-26 | Chengdu University Of Information Technology | Irradiance-Based Radiation Source Orientation Method |
US11238028B2 (en) * | 2019-04-12 | 2022-02-01 | Aclima Inc. | Signal processing for multi-sensor groups |
US11307186B2 (en) | 2019-05-10 | 2022-04-19 | Aclima Inc. | Integration and active flow control for environmental sensors |
CN110261823B (zh) * | 2019-05-24 | 2022-08-05 | 南京航空航天大学 | 基于单个led灯的可见光室内通信定位方法及系统 |
CN110518951B (zh) * | 2019-07-26 | 2021-06-15 | 联想(北京)有限公司 | 一种信息处理方法及装置 |
CN110823094B (zh) * | 2019-11-08 | 2021-03-30 | 北京理工大学 | 一种点光源三维坐标测量方法及装置 |
CN113012199B (zh) * | 2021-03-23 | 2024-01-12 | 北京灵汐科技有限公司 | 运动目标追踪的系统和方法 |
CN114088095B (zh) * | 2021-10-29 | 2023-07-25 | 鹏城实验室 | 一种基于光电二极管的三维室内定位方法 |
TWI804255B (zh) * | 2022-03-28 | 2023-06-01 | 國立陽明交通大學 | 多面體的光線感測裝置 |
CN117934454A (zh) * | 2024-03-18 | 2024-04-26 | 季华实验室 | 发光单元检测方法、装置、电子设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5393970A (en) * | 1993-09-13 | 1995-02-28 | Jeng-Jye Shau | Optical location tracking devices |
CN101825697A (zh) * | 2009-03-06 | 2010-09-08 | 财团法人工业技术研究院 | 基于光线强度的定位方法及系统 |
CN102236096A (zh) * | 2010-04-02 | 2011-11-09 | 精工爱普生株式会社 | 光学式位置检测装置、机械手及机械臂 |
CN102279380A (zh) * | 2010-04-26 | 2011-12-14 | 三星电子株式会社 | 用于估计位置和方向的系统和方法 |
CN102980574A (zh) * | 2012-11-20 | 2013-03-20 | 清华大学 | 基于led的室内可见光精确定位接收模型及定位方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005098476A1 (en) * | 2004-03-29 | 2005-10-20 | Evolution Robotics, Inc. | Method and apparatus for position estimation using reflected light sources |
WO2005098475A1 (en) * | 2004-03-29 | 2005-10-20 | Evolution Robotics, Inc. | Sensing device and method for measuring position and orientation relative to multiple light sources |
TWI411803B (zh) * | 2009-05-19 | 2013-10-11 | Univ Nat Taiwan | 室內目標定位裝置及方法 |
-
2013
- 2013-07-30 CN CN201310325495.0A patent/CN103399298B/zh active Active
- 2013-11-22 US US14/087,162 patent/US9360310B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5393970A (en) * | 1993-09-13 | 1995-02-28 | Jeng-Jye Shau | Optical location tracking devices |
CN101825697A (zh) * | 2009-03-06 | 2010-09-08 | 财团法人工业技术研究院 | 基于光线强度的定位方法及系统 |
CN102236096A (zh) * | 2010-04-02 | 2011-11-09 | 精工爱普生株式会社 | 光学式位置检测装置、机械手及机械臂 |
CN102279380A (zh) * | 2010-04-26 | 2011-12-14 | 三星电子株式会社 | 用于估计位置和方向的系统和方法 |
CN102980574A (zh) * | 2012-11-20 | 2013-03-20 | 清华大学 | 基于led的室内可见光精确定位接收模型及定位方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110333483A (zh) * | 2019-06-25 | 2019-10-15 | 北京科技大学 | 一种多pd结构的可见光定位接收装置 |
Also Published As
Publication number | Publication date |
---|---|
US9360310B2 (en) | 2016-06-07 |
US20150039262A1 (en) | 2015-02-05 |
CN103399298A (zh) | 2013-11-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103399298B (zh) | 一种基于光强度的多传感器室内定位装置与方法 | |
CN103389488B (zh) | 一种基于光强度的多光源室内定位装置与方法 | |
CN111919476B (zh) | 一种室内定位的方法、服务器及定位系统 | |
US7605756B2 (en) | System a method and an apparatus for performing wireless measurements, positioning and surface mapping by means of a portable coordinate system | |
CN104483658B (zh) | 基于Wi-Fi和地磁场的室内定位方法 | |
US11640486B2 (en) | Architectural drawing based exchange of geospatial related digital content | |
CN104507163B (zh) | 一种采用类蜂窝式布局的rfid室内定位系统及方法 | |
KR20180063263A (ko) | 3차원 공간 검출 시스템, 측위 방법 및 시스템 | |
US9883351B2 (en) | Indoor positioning device and indoor positioning method | |
CN103543434B (zh) | 室内定位系统、手机及定位方法 | |
KR101946734B1 (ko) | 번개 검출 시스템, 방법 및 장치 | |
CN104270194A (zh) | 一种可见光室内定位方法 | |
CN103813448A (zh) | 一种基于rssi的室内定位方法 | |
CN102695272B (zh) | 一种匹配定位的方法和移动终端 | |
CN107071899A (zh) | 一种快速高精度室内实时定位系统 | |
CN110430534A (zh) | 一种定位选择方法、装置、电子设备及存储介质 | |
CN110220452B (zh) | 一种定位方法及系统 | |
CN104914407A (zh) | 一种室内定位装置和定位方法 | |
JP2010197049A (ja) | 位置推定システム及び基準データ測定装置 | |
CN105509716A (zh) | 一种基于增强现实技术的地理信息采集方法及装置 | |
CN110764052A (zh) | 基于超宽带的定位方法及装置、系统 | |
CN104090263A (zh) | 基于rfid技术的定位方法、系统 | |
CN106255198B (zh) | 采集施工定位系统和方法 | |
CN104113912A (zh) | 一种移动设备的室内定位方法 | |
CN108828515A (zh) | 一种无人机控制器的定位方法、服务器、监测站和系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |