CN105759244B - 基于双摄像头的高精度室内定位***及定位方法 - Google Patents
基于双摄像头的高精度室内定位***及定位方法 Download PDFInfo
- Publication number
- CN105759244B CN105759244B CN201610071624.1A CN201610071624A CN105759244B CN 105759244 B CN105759244 B CN 105759244B CN 201610071624 A CN201610071624 A CN 201610071624A CN 105759244 B CN105759244 B CN 105759244B
- Authority
- CN
- China
- Prior art keywords
- led light
- camera
- terminal
- cameras
- coordinate system
- 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 18
- 230000009977 dual effect Effects 0.000 title claims abstract description 17
- 230000004807 localization Effects 0.000 title claims abstract description 9
- 238000004891 communication Methods 0.000 claims abstract description 22
- 238000005516 engineering process Methods 0.000 claims description 11
- 238000003384 imaging method Methods 0.000 claims description 7
- 238000000205 computational method Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 230000000750 progressive effect Effects 0.000 claims description 3
- 238000004335 scaling law Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 241001416181 Axis axis Species 0.000 claims 1
- 230000007547 defect Effects 0.000 abstract description 2
- 230000003287 optical effect Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005672 electromagnetic field Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000000465 moulding Methods 0.000 description 1
- 230000005622 photoelectricity Effects 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
Classifications
-
- 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
- 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
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
基于双摄像头的高精度室内定位***及定位方法,该***包括可见光通信模块和精确定位模块;所述可见光通信模块包括LED灯和两个摄像头;所述精确定位模块包括终端及其上的两个摄像头和电子罗盘;通过双摄像头的拍摄可以来确定终端相对于LED灯的相对远近位置,弥补单摄像头情况下无法确定LED与终端距离的缺陷,然后再通过电子罗盘,以及摄像头的LED光信号获取解码,实现更加精确地定位。
Description
技术领域
本发明涉及室内定位技术领域,具体涉及一种基于双摄像头的高精度室内定位***及定位方法。
背景技术
可见光通信技术是利用可见光波段作为光载波来进行通信的一种无线通信技术,能够实现高速数据传输。相比于传统的无线通信技术,可见光通信技术具有效率高,无电磁干扰,绿色环保等特点,越来越受到国内外的广泛关注。可见光通信技术是将信息通过驱动电路,高速调制到LED光信号上进行传输,接收端可以通过摄像头,光电二极管(PD)等光电转换器将光信号转换成电信号,并解调出有效信息,实现通信功能。随着LED作为新一代绿色照明设备的大力推广以及LED器件和接收器件工艺的不断改进,可见光通信技术在近年来得到了快速的发展。
而目前室内定位的需求越来越大,但以GPS为代表的室外定位技术不能够满足室内的精度和控制需求。同时如基于WIFI以及电磁场的许多室内定位技术在室内,地下,以及电磁敏感的区域中使用相当受限,往往会受到比较大的干扰而导致无法正确定位。而随着可见光通信的快速发展,基于可见光的室内定位技术得到了大家的广泛重视。室内可见光定位***不仅继承了VLC的优点,可以在楼内,地下,矿井等封闭或电磁敏感的区域内得到广泛的应用,而且其有着稳定,不易受干扰,或者说受干扰可辨别等优点,而且基于VLC的定位方法精度基本可以保持在厘米,在异常情况下分米量级, 可以满足用户的使用需求。
而以往基于摄像头的可见光通信技术,基本只使用一个摄像头,大多也没有结合姿态传感器,或使用摄像头进行LED信息的接收。
发明内容
为了克服上述现有技术存在的问题,本发明的目的在于提供一种基于双摄像头的高精度室内定位***及定位方法,通过双摄像头的拍摄可以来确定终端相对于LED灯的相对远近位置,弥补单摄像头情况下无法确定LED与终端距离的缺陷,然后再通过电子罗盘,以及摄像头的LED光信号获取解码,实现更加精确地定位。
为达到上述目的,本发明采用如下技术方案:
基于双摄像头的高精度室内定位***,包括可见光通信模块和精确定位模块;所述可见光通信模块包括LED灯和两个摄像头;所述精确定位模块包括终端及其上的两个摄像头和电子罗盘,所述两个摄像头之间的距离不超过10cm。
所述电子罗盘与两个摄像头两两之间相对位置固定、相对姿态固定。
所述电子罗盘与两个摄像头所成角度一致,并保持与双摄像头的同步姿态变化,电子罗盘与两个摄像头的距离为15-30cm。
所述两个摄像头固定在同一平面或两个摄像头底面所成的角度不小于120度。
上述所述基于双摄像头的高精度室内定位***的定位方法,将LED灯的ID信息调制到LED灯的闪烁上,LED灯为发送端,两个摄像头为接收端,通过可见光通信技术将LED灯的ID信息传送到接收端;接收端通过两个摄 像头逐行扫描拍摄得到LED灯上的调制信息,表现为拍摄得到的LED图像上的黑白条纹,据此获取LED灯发射的ID信息,并根据查询数据库确定此LED灯的绝对位置;进一步为了实现精确定位,终端利用两个摄像头拍摄到的两组LED图像,通过对比图像中LED成像位置的差别,确定LED灯相对于两个摄像头的方向和距离,得到终端相对于所拍摄的LED灯的相对位置关系,同时结合电子罗盘得到的终端的姿态信息以及前面得到的LED灯的绝对位置信息,从而得到终端目前的精确位置。
所述终端目前的精确位置的计算方法如下:
为了进行位置计算,预设了三个坐标系,其中两个分别为以两个摄像头为原点,以各自朝向为轴的相对坐标系,随终端上的摄像头移动或转动而变化,其轴表示为v1,w1,u1以及v2,w2,u2;另一个为以LED灯位置为0点,以自然方位为坐标轴的世界坐标系,其坐标轴为n,e,d;
dc,nc,ec为LED灯在世界坐标系中的坐标,ni1,ei1,di1,ni2,ei2,di2分别为两个摄像头在世界坐标系中的坐标;f为两个摄像头的镜头焦距,s为两个摄像头之间距离,dd为LED灯距离终端的距离;而vi1,wi1,ui1,vi2,wi2,ui2分别为LED灯在两个摄像头坐标系中中成像点的坐标;vc1,wc1,uc1,vc2,wc2,uc2为LED灯在两个相对坐标系中的位置;设此时摄像头和电子罗盘在同一平面,由相似比例关系可得:
(ni2-ni1)2+(ei2-ei1)2=s2
对两个摄像头成立,R矩阵为从世界坐标系到摄像头坐标系的转换矩阵,由电子罗盘测得的角度所得;联立以上方程能够解出最终的终端i1,i2的绝对坐标;由此得到终端的精确位置。
和现有技术相比,本发明具有如下优点:
1、LED灯作为新一代的照明方式,具有无污染,易普及,安全性高等优点,通过LED进行定位一旦成型将能够很快推进到生活中。
2、通过LED灯以及摄像头的可见光室内定位,具有在电磁干扰环境中也能工作的特点,适应性强,而且相比一般利用光电二极管(PD)定位的方法精确度高。
3、使用双摄像头的室内定位方案,可以对LED的位置与距离进行推算,精确地辨别物体的距离,相比单摄像头只能预估距离有了很大的提高与进步。其次双摄像头还可以互相弥补,扩大捕捉灯的范围,增大定位的区域。
4、使用摄像头与电子罗盘构成的室内定位***,较常规室内定位***具有更高的精确度。
5、可见光通信使用LED的闪烁发送数据,而在方案中,我们利用逐行扫描的摄像头,对一段时间内LED灯传出的数据进行捕获,解码,得到其码长,可以使可见光通信与定位一体化,使PD不再必要,也使信息传输和定位更加紧密。
附图说明
图1为本发明***示意图。
图2为本发明***坐标系。
具体实施方式
下面结合具体实施方式对本发明做进一步详细说明。
如图1所示,本发明基于双摄像头的高精度室内定位***,包括可见光通信模块和精确定位模块;所述可见光通信模块包括LED灯和两个摄像头;所述精确定位模块包括终端及其上的两个摄像头和电子罗盘,所述两个摄像头之间的距离不超过10cm。
作为本发明的优选实施方式,所述电子罗盘与两个摄像头两两之间相对位置固定、相对姿态固定。所述电子罗盘与两个摄像头所成角度一致,并保持与双摄像头的同步姿态变化,电子罗盘与两个摄像头的距离为15-30cm。
作为本发明的优选实施方式,所述两个摄像头固定在同一平面或底面所成的角度不小于120度。
本发明所述基于双摄像头的高精度室内定位***的定位方法,将LED灯的ID信息调制到LED灯的闪烁上,LED灯为发送端,两个摄像头为接收端,通过可见光通信技术将LED灯的ID信息传送到接收端;接收端通过两个摄像头逐行扫描拍摄得到LED灯上的调制信息,表现为拍摄得到的LED图像上的黑白条纹,据此获取LED灯发射的ID信息,并根据查询数据库确定此LED灯的绝对位置;进一步为了实现精确定位,终端利用两个摄像头拍摄到的两组LED图像,通过对比图像中LED成像位置的差别,确定LED灯相对于两个摄像头的方向和距离,得到终端相对于所拍摄的LED灯的相对位置关系,同时结合电子罗盘得到的终端的姿态信息以及前面得到的LED灯的绝对位置信 息,从而得到终端目前的精确位置。
所述终端目前的精确位置的计算方法如下:
为了进行位置计算,预设了三个坐标系,其中两个分别为以两个摄像头为原点,以各自朝向为轴的相对坐标系,随终端上的摄像头移动或转动而变化,其轴表示为v1,w1,u1以及v2,w2,u2;另一个为以LED灯位置为0点,以自然方位为坐标轴的世界坐标系,其坐标轴为n,e,d;
dc,nc,ec为LED灯在世界坐标系中的坐标,ni1,ei1,di1,ni2,ei2,di2分别为两个摄像头在世界坐标系中的坐标;f为两个摄像头的镜头焦距,s为两个摄像头之间距离,dd为LED灯距离终端的距离;而vi1,wi1,ui1,vi2,wi2,ui2分别为LED灯在两个摄像头坐标系中中成像点的坐标;vc1,wc1,uc1,vc2,wc2,uc2为LED灯在两个相对坐标系中的位置;设此时摄像头和电子罗盘在同一平面,由相似比例关系可得:
(ni2-ni1)2+(ei2-ei1)2=s2
对两个摄像头成立,R矩阵为从世界坐标系到摄像头坐标系的转换矩阵,由电子罗盘测得的角度所得;联立以上方程能够解出最终的终端i1,i2的绝对坐标;由此得到终端的精确位置。
作为本发明的优选实施方式,在精确定位模块中,将两个摄像头,与电子罗盘固定在同一平面上,这样电子罗盘所测得的实际值就会代表摄像头目前的姿态。两个摄像头相距离开已知距离,分别对LED灯进行拍摄,这样通过拍摄的两个灯之间距离差别,以及两个摄像头之间的距离,可以判定LED灯在终端上方高度位置,如同双眼对物体进行三维位置的确定。电子罗盘可以判断终端平面的方位角度位置,结合之前的相对位置,得到终端相对于LED灯的精确位置。
本发明首先使用摄像头逐行扫描的原理,直接捕捉LED灯的闪烁传输的信息,使我们在定位过程中省去了PD的使用,其次使用双摄像头的方法,定出终端与LED灯的3D距离,从而大幅度地提高定位的精度。同时还利用LED灯在摄像头中的图像位置以及电子罗盘的角度信息,最终按上述原理进行运算,得到终端相对于LED的位置信息。
Claims (1)
1.基于双摄像头的高精度室内定位***的定位方法,所述定位***包括可见光通信模块和精确定位模块;所述可见光通信模块包括LED灯;所述精确定位模块包括终端及其上的两个摄像头和电子罗盘,其中两个摄像头分别为1号摄像头和2号摄像头;所述电子罗盘与两个摄像头两两之间相对位置固定、相对姿态固定;所述两个摄像头固定在同一平面或两个摄像头底面所成的角度不小于120度;
其特征在于:所述定位方法为:将LED灯的ID信息调制到LED灯的闪烁上,LED灯为发送端,两个摄像头为接收端,通过可见光通信技术将LED灯的ID信息传送到接收端;接收端通过两个摄像头逐行扫描拍摄得到LED灯上的调制信息,表现为拍摄得到的LED图像上的黑白条纹,据此获取LED灯发射的ID信息,并根据查询数据库确定此LED灯的绝对位置;进一步为了实现精确定位,终端利用两个摄像头拍摄到的两组LED图像,通过对比图像中LED成像位置的差别,确定LED灯相对于两个摄像头的方向和距离,得到终端相对于所拍摄的LED灯的相对位置关系,结合电子罗盘得到的终端的姿态信息以及前面得到的LED灯的绝对位置信息,从而得到终端目前的精确位置;
所述终端目前的精确位置的计算方法如下:
为了进行位置计算,预设了三个直角坐标系,其中两个直角坐标系分别为以两个摄像头为原点,以各自朝向为轴的相对坐标系,随终端上的摄像头移动或转动而变化,其轴表示为v1,w1,u1以及v2,w2,u2,其中u1轴为垂直于1号摄像头成像面且指向1号摄像头前方的轴,v1和w1分别为平行于1号摄像头成像面矩形相邻边的轴;u2轴为垂直于2号摄像头成像面且指向2号摄像头前方的轴,v2和w2分别为平行于2号摄像头成像面矩形相邻边的轴;另一个直角坐标系为以自然方位为坐标轴的世界坐标系,其坐标轴为n,e,d;
设LED灯所在位置为c点,nc,ec,dc为LED灯在世界坐标系中的坐标,ni1,ei1,di1,ni2,ei2,di2分别为两个摄像头在世界坐标系中的坐标;f为两个摄像头的镜头焦距,s为两个摄像头之间距离,dd为LED灯距离终端的距离;而vi1,wi1,ui1,vi2,wi2,ui2分别为LED灯在两个相对坐标系中成像点的坐标;vc1,wc1,uc1,vc2,wc2,uc2为LED灯在两个相对坐标系中的位置;设此时摄像头和电子罗盘在同一平面,由相似比例关系可得:
(ni2-ni1)2+(ei2-ei1)2=s2
对两个摄像头成立,R矩阵为从世界坐标系到摄像头坐标系的转换矩阵,由电子罗盘测得的角度所得;联立以上方程能够解出最终的终端i1,i2的绝对坐标;由此得到终端的精确位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610071624.1A CN105759244B (zh) | 2016-02-02 | 2016-02-02 | 基于双摄像头的高精度室内定位***及定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610071624.1A CN105759244B (zh) | 2016-02-02 | 2016-02-02 | 基于双摄像头的高精度室内定位***及定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105759244A CN105759244A (zh) | 2016-07-13 |
CN105759244B true CN105759244B (zh) | 2018-10-23 |
Family
ID=56343040
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610071624.1A Active CN105759244B (zh) | 2016-02-02 | 2016-02-02 | 基于双摄像头的高精度室内定位***及定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105759244B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105846898B (zh) * | 2016-05-20 | 2018-10-19 | 中国人民解放军信息工程大学 | 一种可见光通信方法、发送装置及*** |
CN106767775B (zh) * | 2016-11-11 | 2019-07-19 | 武汉邮电科学研究院 | 一种基于图像传感器和惯导传感器的定位方法 |
CN106772635B (zh) * | 2017-03-06 | 2019-03-19 | 盐城工学院 | 一种基于扫描交汇的地下电缆三维定位装置及定位方法 |
CN107421506B (zh) * | 2017-08-11 | 2023-03-28 | 华南理工大学 | 一种基于室内可见光通信的视觉追踪定位***和方法 |
CN107588777B (zh) * | 2017-09-27 | 2020-01-17 | 京东方科技集团股份有限公司 | 室内定位*** |
CN108170781A (zh) * | 2017-12-26 | 2018-06-15 | 中山大学 | 一种家居仓储物品的精确定位方法及*** |
CN108279400A (zh) * | 2018-01-04 | 2018-07-13 | 北京科技大学 | 一种基于单led光源的多探测器定位方法 |
CN108303676A (zh) * | 2018-01-31 | 2018-07-20 | 张斌 | 光信号定位装置、方法及*** |
CN109341687B (zh) * | 2018-06-01 | 2022-07-12 | 上海大学 | 一种基于手机任意水平朝向角度的单led可见光通信室内定位方法 |
CN109029458B (zh) * | 2018-07-19 | 2020-06-30 | 东莞信大融合创新研究院 | 一种双目视觉定位的方法 |
CN109188358B (zh) * | 2018-08-31 | 2023-03-17 | 中山大学 | 一种基于成像传感器的高精度可见光定位方法 |
CN109725286A (zh) * | 2018-12-19 | 2019-05-07 | 上海大学 | 一种基于手机任意方向角度的单led可见光通信室内定位方法 |
-
2016
- 2016-02-02 CN CN201610071624.1A patent/CN105759244B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105759244A (zh) | 2016-07-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105759244B (zh) | 基于双摄像头的高精度室内定位***及定位方法 | |
CN110261823B (zh) | 基于单个led灯的可见光室内通信定位方法及*** | |
Zhang et al. | A single LED positioning system based on circle projection | |
CN107421506B (zh) | 一种基于室内可见光通信的视觉追踪定位***和方法 | |
EP3248374B1 (en) | Method and apparatus for multiple technology depth map acquisition and fusion | |
US10194135B2 (en) | Three-dimensional depth perception apparatus and method | |
Swirski et al. | 3Deflicker from motion | |
US7957007B2 (en) | Apparatus and method for illuminating a scene with multiplexed illumination for motion capture | |
CN102749072B (zh) | 室内定位方法、装置及*** | |
Raskar et al. | Prakash: lighting aware motion capture using photosensing markers and multiplexed illuminators | |
US20070268481A1 (en) | System and method for measuring scene reflectance using optical sensors | |
CN106681510B (zh) | 位姿识别装置、虚拟现实显示装置以及虚拟现实*** | |
US20070268366A1 (en) | System and method for sensing geometric and photometric attributes of a scene with multiplexed illumination and solid state optical devices | |
US8009192B2 (en) | System and method for sensing geometric and photometric attributes of a scene with multiplexed illumination and solid states optical devices | |
CN101901087B (zh) | 基于线性图像传感器的表面定位装置及方法 | |
CN205448962U (zh) | 一种具有三维扫描功能的移动终端 | |
CN110662162B (zh) | 用于飞行时间感测和信息传送的双模式光学设备、以及利用其的装置、***和方法 | |
Piccirilli et al. | A mobile structured light system for 3D face acquisition | |
CN110689572A (zh) | 一种三维空间中移动机器人定位***及方法 | |
CN109636850B (zh) | 面向室内智能灯下的可见光定位方法 | |
US10989800B2 (en) | Tracking using encoded beacons | |
CN107462248A (zh) | 一种室内光学定位***及其使用方法 | |
CN109341687A (zh) | 一种基于手机任意水平朝向角度的单led可见光通信室内定位方法 | |
Bera et al. | A Truly 3D Visible Light Positioning System using Low Resolution High Speed Camera, LIDAR, and IMU Sensors | |
CN204944451U (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |