CN106093954A - 一种二维码激光测距车辆定位方法及其设备 - Google Patents

一种二维码激光测距车辆定位方法及其设备 Download PDF

Info

Publication number
CN106093954A
CN106093954A CN201610385003.0A CN201610385003A CN106093954A CN 106093954 A CN106093954 A CN 106093954A CN 201610385003 A CN201610385003 A CN 201610385003A CN 106093954 A CN106093954 A CN 106093954A
Authority
CN
China
Prior art keywords
quick response
response code
laser
equipment
generating
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.)
Pending
Application number
CN201610385003.0A
Other languages
English (en)
Inventor
邓湘
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Individual
Original Assignee
Individual
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Individual filed Critical Individual
Priority to CN201610385003.0A priority Critical patent/CN106093954A/zh
Publication of CN106093954A publication Critical patent/CN106093954A/zh
Pending legal-status Critical Current

Links

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
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
    • 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
    • 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
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Automation & Control Theory (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

本发明涉及一种扫描二维码获取信息并通过激光测距来为车辆精确定位的方法及其设备。包括有位于平整反光表面上的二维码图形、可安装于车辆上的旋转调节底座、激光测距设备、二维码扫描识别定位设备，其特征是：二维码扫描识别定位设备首先识别并锁定位于路边各种便于观察到的平整反光表面上的二维码；然后激光测距设备的三个激光发射器的先后各发射一段激光束打在二维码所在平面上，激光测距设备的激光接收器结合其他设备测量出三个激光落点与三个激光发射器各自测量基准点之间的距离；在激光发射器发射激光束的同时二维码扫描识别定位设备识别并定位出三个激光落点的坐标，最终采用类似GPS卫星定位的方法计算出各测量基准点的坐标。

Description

一种二维码激光测距车辆定位方法及其设备
技术领域
本发明涉及移动车辆的导航定位方法，特别是涉及一种扫描二维码获取信息并通过激光测距来为车辆精确定位的方法及其设备。
背景技术
现今常见的汽车定位技术大多是卫星导航定位，虽然普通的卫星导航定位成本很低只需一枚小小的定位芯片，但定位精度较差误差一般在10米左右，如遇天气状况不佳或者周围有过多的高层建筑遮挡误差能扩大到30米。使用伪距差分定位技术会将定位精度提高到车道级甚至米级水平，但这样就需要在道路旁每隔一定距离设置一个定位基准站，并要时刻保持基准站和用户车辆之间的无线通讯，成本较高且定位精度依然只有米级。如果使用载波相位差分定位技术精度能够达到厘米级，可这又需比较昂贵的用户端车载定位设备，而且载波相位观测值初始化时间通常会在几十秒到十几分钟之间一般是五六分钟，车辆一旦在行驶的过程中卫星定位信号受高层建筑、树木、隧道、桥梁的影响而中断，重新初始化过程时间过长。还有一些拥有专业天线的无基准站车道级精度的卫星定位设备，但价格同样过高。综上，卫星定位技术虽然非常普及，但是成本低时精度不高，精度高时成本又过高，建有基准站的还要时刻保持与移动车辆的无线通讯，而且在立交桥下或隧道中会丢失卫星信号，恶劣的天气和电磁环境也会对卫星信号造成干扰。
车载导航技术除了卫星导航外还有的就是惯性导航，但是惯性导航只能在短时间内保证定位精度，时间一长其定位精度将大大降低误差可达几百米，这种误差已不能为车辆提供有效导航定位。
另外还有一种广泛应用于室内自动机器人导航的技术，这种技术主要是在地面布置标识物如条形码或二维码，然后通过条形码或二维码扫描设备来确定自动机器人的位置。这种方法在室内小范围使用尚可，但如果用于室外特别是在车辆经常行驶碾压的道路上使用，二维码标识图块可能很快因磨损、缺失、被遮挡而无法使用，而且如遇到大雨或大雪天气二维码标识块被雨水或积雪覆盖，所有被覆盖二维码标识图块都将无法提供定位。所以位于地面的二维码定位技术虽然定位精度很高可以达到毫米级，但只能应用于室内地面，并不能将之简单拿来应用在室外道路路面上。
发明内容
本发明的目的在于克服现有车辆定位技术的不足，提供一种定位精度高、成本较低、几乎全天候全地段、二维码图形寿命足够长的室外二维码激光测距车辆定位技术。
本发明解决其技术问题是采取以下技术方案实现的。
一种二维码激光测距车辆定位方法及其设备，包括有位于平整反光表面上的二维码图形、可安装于车辆上的旋转调节底座、激光测距设备以及二维码扫描识别定位设备，其特征如下。
二维码主要位于路灯杆广告牌上的平整反光表面、路牌背面的平整反光表面、路口信号灯杆上的平整反光表面、平整反光墙面等便于观察到的平整反光表面上。
激光测距设备应至少由微处理器、计时器、三个激光发射器、一个激光接收器、激光夹角调节器等部分组成，激光夹角调节器可调节三个激光发射器朝向间的夹角，在夹角调节过程中，三个激光发射器基准点相互之间的距离应始终相等，三个激光发射器的激光束发射方向的反向延长线应始终交于一点，此交点与三个激光发射器基准点也应始终保持等距，其中以三个激光发射器基准点为顶点的等边三角形的重心与反向延长线交点之间的连线可称为激光发射器中轴线。
二维码扫描识别定位设备应至少由三个二维码扫描定位摄像头、一个二维码搜索摄像头、存储二维码编号信息数据库的硬盘，与激光测距设备共用的微处理器等部分组成，其中每一个二维码扫描定位摄像头都应单独与一个激光发射器固定连接并可在调节激光发射器朝向夹角时随固连的激光发射器一起转动，固定相连的二维码扫描定位摄像头和激光发射器两者的朝向应相互平行，二维码搜索摄像头的朝向应与激光发射器中轴线平行。
旋转调节底座应至少包括基座、旋转底座、俯仰块，其中基座固定安装于车辆上，旋转底座铰接于基座上可水平360度旋转，俯仰块铰接于旋转底座上可俯仰旋转，激光测距设备和二维码扫描识别定位设备都固定连接在俯仰块上。
二维码上应有三个位置探测图形，二维码所含信息应至少包含此二维码的编号，编号对应的是二维码上三个位置探测图形中心点的精确坐标，二维码编号对应的坐标信息应可在二维码编号信息数据库内查到或者是上网查到。
通过扫描二维码获取车辆精确位置信息的步骤如下：
首先可通过车载GPS***或以前的二维码定位数据加惯导***获取车辆大概位置，然后再检索二维码编号信息数据库内是否有位于附近的二维码，如有则使二维码搜索摄像头指向二维码所处位置大概方向，并持续从摄像头读取图像信息，在对获取的图像信息处理过后检测图像中是否有二维码，如没有则应不断微调摄像头的朝向和焦距直到找到二维码为止，找到后二维码搜索摄像头应持续跟踪锁定此二维码。
二维码搜索摄像头锁定二维码后，激光夹角调节器应先将三个激光发射器朝向间的夹角调至最小，以保证三激光发射器发射的激光束都能射到二维码所在平面上，再由一个激光发射器结合激光接收器持续用粗尺粗测基准点与二维码所在平面的距离，然后逐步扩大三个激光发射器朝向间的夹角尽量使三个激光束在平面上落点相互远离。
根据三个激光发射器朝向间的夹角以及基准点与二维码所在平面的距离可得出三激光束落点在二维码搜索摄像头所摄图像内的大致位置，通过分析图像可判断出三激光束是否都能射到二维码所在平面上，当判断三激光束都能射到二维码所在平面上且落点间距足够远时，择机令三个激光发射器先后各发射一段激光束打在二维码所在平面上，三次发射的过程应控制在0.1毫秒以内，激光接收器接收三束反射激光，经处理后最终得到三个激光落点与三个激光发射器各自测量基准点之间的距离，此三连测应使用精尺测距。
在某一激光发射器发射激光束进行精测的同时，与之固定连接的二维码扫描定位摄像头应拍摄一张高分辨率照片，此照片应将二维码图像完整摄入并使之尽量多地占据照片画面，照片分辨率不应低于二百万像素，二维码扫描定位摄像头拍摄时的快门速度不应慢于1/2000秒。
采用类似GPS卫星定位的方法，其具体的定位算法是：设二维码上三个位置探测图形的中心点分别为A、B、C，其中直线AB垂直于直线AC，以A点为原点，AB为u轴，AC为v轴可建立平面坐标系（u，v）。
设定某一激光发射器发射的激光束在二维码所在平面上的落点为D，因激光发射器的朝向与其旁边固连的二维码扫描摄像头的朝向平行，且摄像头镜头中心点与激光束中心线的间距是确定的，当测得测量基准点与激光落点D的距离Ld后可按比例计算求得落点D在二维码扫描摄像头拍摄的高清照片上的像素位置。
微处理器使用二维码图像识别软件分析处理高清二维码照片可获得三个二维码位置探测图形的中心点A、B、C在照片上的像素位置，因A、B、C三点在平面坐标系（u，v）中的坐标已知，线段AB、线段AC的长度已知，在照片上经过几何图形作图计算可求得落点D在平面坐标系（u，v）中的坐标，又由于A、B、C三点在世界坐标系(x,y,z)中的坐标可在二维码编号信息数据库中查询获得，通过坐标系变换即可得到D点在世界坐标系(x,y,z)中的坐标D（xd，yd，zd）。
设定另两个激光发射器发射激光束在二维码所在平面上的落点为E和F，可测得另两个激光发射器的测量基准点与落点E和F的距离分别为Le和 Lf，同理可求得落点E和F在世界坐标系中的坐标E（xe，ye，ze）和F（xf，yf，zf）。
设三个激光发射器激光束发射方向的反向延长线交点为O（xo，yo，zo），设三个激光发射器的测量基准点与点O的距离都为r，可根据三激光发射器朝向间夹角依预设对应表查得r的长度，那么点O在世界坐标系中的坐标可通过以下方程组求解获得：
(xd - xo)²+(yd - yo)²+(zd - zo)²=(Ld+ r)²
(xe - xo)²+(ye - yo)²+(ze - zo)²=(Le+ r)²
(xf - xo)²+(yf - yo)²+(zf - zo)²=(Lf+ r)²。
有了点O的坐标，在D、E、F点坐标以及Ld、Le、Lf和r的长度都已知的情况下，可计算求得三激光发射器测量基准点的坐标。
所述的二维码位置探测图形的中心点处可设置小型穿雾灯，小型穿雾灯可在大雾天气人为控制开启。
所述的二维码搜索摄像头旁边应设有与其朝向平行的闪光灯或照明射灯。
所述的二维码扫描定位摄像头拍摄高分辨率二维码照片的分辨率不应低于三百万像素，拍摄时的快门速度不应慢于1/10000秒。
所述的二维码最好选用QR Code二维码，二维码图形的各边边长应不小于50cm。
所述的三个激光发射器先后各发射一段激光束的过程应控制在0.01毫秒以内。
所述的二维码编号对应的信息还可包括此二维码的最佳探测位置区域，在此区域内的车辆应首选探测扫描此区域对应的二维码。
所述的设备中还可增加一显示屏用以显示二维码搜索摄像头拍摄的内容，用户可根据显示屏显示图像采用手动方式控制二维码搜索摄像头对准二维码。
所述的激光测距设备可包含四个或四个以上的激光发射器，相应的所述的二维码扫描识别定位设备可包含四个或四个以上的二维码扫描定位摄像头。
所述的二维码还可位于安装于汽车尾部的反光板上，车尾安装有二维码反光板的车辆在获取本车精确坐标后，经计算可得到车尾二维码反光板上各位置探测图形中心点的精确坐标，并可通过短距无线通讯向后方车辆发送这些精确坐标信息。反光板上二维码的编号对应信息还可包含车辆车型以及二维码反光板在车辆上精确安装位置等信息，使得后方扫描二维码的车辆不光可以获得自己的位置信息，还能获得前车的相对位置信息。车尾反光板主要应用于大型车辆，因为大型车辆体型较大有时候会遮挡住后方车辆的视线，使之无法扫描到附近的二维码。
本发明与现有技术相比，具有如下几方面的优点和有益效果：
1、搭配车载惯性导航***，可以为车辆提供不间断的高精度导航定位。惯性导航的特点是在短时间内误差小长时间误差极大，我们可以利用这一特点配合二维码定位一起使用。在一个二维码图形脱离摄像头视野范围后一般还要等待几秒钟的时间摄像头才能识别并锁定下一个二维码图形，那么在这几秒钟的时间里就可使用惯性导航来辅助定位，由于此间隔时间只有几秒所以惯性导航可保持很高精度，从而能够为车辆提供持续的高精度导航定位。
2、成本相对低廉，车载设备主要由普通的摄像头和相位激光测距仪组成，路边设备则是位于各种平整反光表面上的二维码图形，只要每隔一百米能有一个二维码图形为车辆提供定位，配合惯性导航***车辆即可全程获得高精度导航定位。而且路边广告牌上的二维码在提供定位服务的同时也能提供广告相关链接，任何人或车辆扫描此二维码都能获得与广告内容相关的信息、优惠或服务，占用广告幅面的二维码不但不会降低广告价值，反而能为广告带来附加价值，架设二维码路灯杆广告牌的费用可通过收取广告费逐步收回。
3、定位精度很高，可以达到厘米级，主要的误差来源是激光测距的距离误差和激光落点坐标的误差，常见的相位激光测距仪的误差是±1.5mm，三百万像素分辨率的照片中如果二维码图形能基本占据主要画面内容，那在二维码图形的一个边的长度里大概能有一千个像素，如果这个边的真实长度是1米的话那么一个像素就是1mm，如照片画面不模糊且无畸变，二维码三个位置探测图形中心点坐标误差应在1mm左右，经二维码图像识别软件分析计算得到的激光落点坐标的精度即可达到毫米级。但由于激光束夹角过小，即激光落点间距相对激光测得距离过小后者往往是前者的数十倍，在求解激光发射器朝向反向延长线交点坐标时，在垂直于激光发射器中轴线方向误差会被放大数十倍至厘米级甚至分米级，解决这一问题的办法是使用两台车载设备同时测量两个二维码，两个车载设备的激光发射器中轴线经平移使其相交后相互间夹角越接近垂直越好，如此可使定位精度在激光发射器中轴线经平移相交后所决定的面上达到毫米级。
4、可提供几乎全天候定位，位于二维码位置探测图形中心点处的小型穿雾灯可在大雾天气开启，雾灯光与周围雾气背景区别大容易识别，这样二维码图像识别软件无需识别二维码只需识别出照片中的小型穿雾灯亮光中心即可。二维码的编号及其位置可在二维码编号信息数据库中通过查询车辆附近二维码获得，如果车辆附近一定范围内有多个二维码，可分别根据这些二维码的坐标来计算车辆当前位置，与由惯性导航获得的车辆当前位置数据比较，偏差过大者排除即可。
5、二维码图形寿命足够长，位于路牌、路灯杆、墙壁上的二维码图形不会像位于路面上的二维码图形那样容易磨损、缺失或被遮盖，正常情况下能有超过十年的使用寿命。
附图说明
图1是车辆在行驶中使用二维码激光测距定位设备扫描路边二维码的演示图。
图2是二维码位置探测图形中心点与激光落点在二维码平面上的位置关系图。
具体实施方式
下面结合附图对本发明做进一步阐释，但本发明要求保护的范围并不局限于实施方式中表述的范围。
一种二维码激光测距车辆定位方法及其设备，包括有位于平整反光表面上的二维码图形、可安装于车辆上的旋转调节底座、激光测距设备以及二维码扫描识别定位设备，其特征如下。
二维码主要位于路灯杆广告牌上的平整反光表面、路牌背面的平整反光表面、路口信号灯杆上的平整反光表面、平整反光墙面等便于观察到的平整反光表面上。
激光测距设备应至少由微处理器、计时器、三个激光发射器、一个激光接收器、激光夹角调节器等部分组成，激光夹角调节器可调节三个激光发射器朝向间的夹角，在夹角调节过程中，三个激光发射器基准点相互之间的距离应始终相等，三个激光发射器的激光束发射方向的反向延长线应始终交于一点，此交点与三个激光发射器基准点也应始终保持等距，其中以三个激光发射器基准点为顶点的等边三角形的重心与反向延长线交点之间的连线可称为激光发射器中轴线。
二维码扫描识别定位设备应至少由三个二维码扫描定位摄像头、一个二维码搜索摄像头、存储二维码编号信息数据库的硬盘，与激光测距设备共用的微处理器等部分组成，其中每一个二维码扫描定位摄像头都应单独与一个激光发射器固定连接并可在调节激光发射器朝向夹角时随固连的激光发射器一起转动，固定相连的二维码扫描定位摄像头和激光发射器两者的朝向应相互平行，二维码搜索摄像头的朝向应与激光发射器中轴线平行。
旋转调节底座应至少包括基座、旋转底座、俯仰块，其中基座固定安装于车辆上，旋转底座铰接于基座上可水平360度旋转，俯仰块铰接于旋转底座上可俯仰旋转，激光测距设备和二维码扫描识别定位设备都固定连接在俯仰块上。
二维码上应有三个位置探测图形，二维码所含信息应至少包含此二维码的编号，编号对应的是二维码上三个位置探测图形中心点的精确坐标，二维码编号对应的坐标信息应可在二维码编号信息数据库内查到或者是上网查到。
通过扫描二维码获取车辆精确位置信息的步骤如下：
首先可通过车载GPS***或以前的二维码定位数据加惯导***获取车辆大概位置，然后再检索二维码编号信息数据库内是否有位于附近的二维码，如有则使二维码搜索摄像头指向二维码所处位置大概方向，并持续从摄像头读取图像信息，在对获取的图像信息处理过后检测图像中是否有二维码，如没有则应不断微调摄像头的朝向和焦距直到找到二维码为止，找到后二维码搜索摄像头应持续跟踪锁定此二维码。
二维码搜索摄像头锁定二维码后，激光夹角调节器应先将三个激光发射器朝向间的夹角调至最小，以保证三激光发射器发射的激光束都能射到二维码所在平面上，再由一个激光发射器结合激光接收器持续用粗尺粗测基准点与二维码所在平面的距离，然后逐步扩大三个激光发射器朝向间的夹角尽量使三个激光束在平面上落点相互远离。
根据三个激光发射器朝向间的夹角以及基准点与二维码所在平面的距离可得出三激光束落点在二维码搜索摄像头所摄图像内的大致位置，通过分析图像可判断出三激光束是否都能射到二维码所在平面上，当判断三激光束都能射到二维码所在平面上且落点间距足够远时，择机令三个激光发射器先后各发射一段激光束打在二维码所在平面上，三次发射的过程应控制在0.1毫秒以内，激光接收器接收三束反射激光，经处理后最终得到三个激光落点与三个激光发射器各自测量基准点之间的距离，此三连测应使用精尺测距。
在某一激光发射器发射激光束进行精测的同时，与之固定连接的二维码扫描定位摄像头应拍摄一张高分辨率照片，此照片应将二维码图像完整摄入并使之尽量多地占据照片画面，照片分辨率不应低于二百万像素，二维码扫描定位摄像头拍摄时的快门速度不应慢于1/2000秒。
采用类似GPS卫星定位的方法，其具体的定位算法是：设二维码上三个位置探测图形的中心点分别为A、B、C，其中直线AB垂直于直线AC，以A点为原点，AB为u轴，AC为v轴可建立平面坐标系（u，v）。
设定某一激光发射器发射的激光束在二维码所在平面上的落点为D，因激光发射器的朝向与其旁边固连的二维码扫描摄像头的朝向平行，且摄像头镜头中心点与激光束中心线的间距是确定的，当测得测量基准点与激光落点D的距离Ld后可按比例计算求得落点D在二维码扫描摄像头拍摄的高清照片上的像素位置。
如图2所示，图2中的二维码是微处理器使用二维码图像识别软件对高清二维码照片处理后的结果，处理的操作包括图形畸变校正、噪声去除、二值化和图形旋转等，最终可识别获得三个二维码位置探测图形的中心点A、B、C在照片上的像素位置，因A、B、C三点在平面坐标系（u，v）中的坐标已知，线段AB、线段AC的长度已知，在照片上经过几何图形作图计算可求得激光落点D在平面坐标系（u，v）中的坐标，又由于A、B、C三点在世界坐标系(x,y,z)中的坐标可在二维码编号信息数据库中查询获得，通过坐标系变换即可得到D点在世界坐标系(x,y,z)中的坐标D（xd，yd，zd）。
设定另两个激光发射器发射激光束在二维码所在平面上的落点为E和F，可测得另两个激光发射器的测量基准点与落点E和F的距离分别为Le和 Lf，同理可求得落点E和F在世界坐标系中的坐标E（xe，ye，ze）和F（xf，yf，zf）。
设三个激光发射器激光束发射方向的反向延长线交点为O（xo，yo，zo），设三个激光发射器的测量基准点与点O的距离都为r，可根据三激光发射器朝向间夹角依预设对应表查得r的长度，那么点O在世界坐标系中的坐标可通过以下方程组求解获得：
(xd - xo)²+(yd - yo)²+(zd - zo)²=(Ld+ r)²
(xe - xo)²+(ye - yo)²+(ze - zo)²=(Le+ r)²
(xf - xo)²+(yf - yo)²+(zf - zo)²=(Lf+ r)²。
有了点O的坐标，在D、E、F点坐标以及Ld、Le、Lf和r的长度都已知的情况下，可计算求得三激光发射器测量基准点的坐标。

Claims (10)

1.一种二维码激光测距车辆定位方法及其设备，包括有位于平整反光表面上的二维码图形、可安装于车辆上的旋转调节底座、激光测距设备以及二维码扫描识别定位设备，其特征在于：
二维码主要位于路灯杆广告牌上的平整反光表面、路牌背面的平整反光表面、路口信号灯杆上的平整反光表面、平整反光墙面等便于观察到的平整反光表面上；
激光测距设备应至少由微处理器、计时器、三个激光发射器、一个激光接收器、激光夹角调节器等部分组成，激光夹角调节器可调节三个激光发射器朝向间的夹角，在夹角调节过程中，三个激光发射器基准点相互之间的距离应始终相等，三个激光发射器的激光束发射方向的反向延长线应始终交于一点，此交点与三个激光发射器基准点也应始终保持等距，其中以三个激光发射器基准点为顶点的等边三角形的重心与反向延长线交点之间的连线可称为激光发射器中轴线；
二维码扫描识别定位设备应至少由三个二维码扫描定位摄像头、一个二维码搜索摄像头、存储二维码编号信息数据库的硬盘，与激光测距设备共用的微处理器等部分组成，其中每一个二维码扫描定位摄像头都应单独与一个激光发射器固定连接并可在调节激光发射器朝向夹角时随固连的激光发射器一起转动，固定相连的二维码扫描定位摄像头和激光发射器两者的朝向应相互平行，二维码搜索摄像头的朝向应与激光发射器中轴线平行；
旋转调节底座应至少包括基座、旋转底座、俯仰块，其中基座固定安装于车辆上，旋转底座铰接于基座上可水平360度旋转，俯仰块铰接于旋转底座上可俯仰旋转，激光测距设备和二维码扫描识别定位设备都固定连接在俯仰块上；
二维码上应有三个位置探测图形，二维码所含信息应至少包含此二维码的编号，编号对应的是二维码上三个位置探测图形中心点的精确坐标，二维码编号对应的坐标信息应可在二维码编号信息数据库内查到或者是上网查到；
通过扫描二维码获取车辆精确位置信息的步骤如下：
①首先可通过车载GPS***或以前的二维码定位数据加惯导***获取车辆大概位置，然后再检索二维码编号信息数据库内是否有位于附近的二维码，如有则使二维码搜索摄像头指向二维码所处位置大概方向，并持续从摄像头读取图像信息，在对获取的图像信息处理过后检测图像中是否有二维码，如没有则应不断微调摄像头的朝向和焦距直到找到二维码为止，找到后二维码搜索摄像头应持续跟踪锁定此二维码；
②二维码搜索摄像头锁定二维码后，激光夹角调节器应先将三个激光发射器朝向间的夹角调至最小，以保证三激光发射器发射的激光束都能射到二维码所在平面上，再由一个激光发射器结合激光接收器持续用粗尺粗测基准点与二维码所在平面的距离，然后逐步扩大三个激光发射器朝向间的夹角尽量使三个激光束在平面上落点相互远离；
③根据三个激光发射器朝向间的夹角以及基准点与二维码所在平面的距离可得出三激光束落点在二维码搜索摄像头所摄图像内的大致位置，通过分析图像可判断出三激光束是否都能射到二维码所在平面上，当判断三激光束都能射到二维码所在平面上且落点间距足够远时，择机令三个激光发射器先后各发射一段激光束打在二维码所在平面上，三次发射的过程应控制在0.1毫秒以内，激光接收器接收三束反射激光，经处理后最终得到三个激光落点与三个激光发射器各自测量基准点之间的距离，此三连测应使用精尺测距；
④在某一激光发射器发射激光束进行精测的同时，与之固定连接的二维码扫描定位摄像头应拍摄一张高分辨率照片，此照片应将二维码图像完整摄入并使之尽量多地占据照片画面，照片分辨率不应低于二百万像素，二维码扫描定位摄像头拍摄时的快门速度不应慢于1/2000秒；
⑤采用类似GPS卫星定位的方法，其具体的定位算法是：设二维码上三个位置探测图形的中心点分别为A、B、C，其中直线AB垂直于直线AC，以A点为原点，AB为u轴，AC为v轴可建立平面坐标系（u，v）；
设定某一激光发射器发射的激光束在二维码所在平面上的落点为D，因激光发射器的朝向与其旁边固连的二维码扫描摄像头的朝向平行，且摄像头镜头中心点与激光束中心线的间距是确定的，当测得测量基准点与激光落点D的距离Ld后可按比例计算求得落点D在二维码扫描摄像头拍摄的高清照片上的像素位置；
微处理器使用二维码图像识别软件分析处理高清二维码照片可获得三个二维码位置探测图形的中心点A、B、C在照片上的像素位置，因A、B、C三点在平面坐标系（u，v）中的坐标已知，线段AB、线段AC的长度已知，在照片上经过几何图形作图计算可求得落点D在平面坐标系（u，v）中的坐标，又由于A、B、C三点在世界坐标系(x,y,z)中的坐标可在二维码编号信息数据库中查询获得，通过坐标系变换即可得到D点在世界坐标系(x,y,z)中的坐标D（xd，yd，zd）；
设定另两个激光发射器发射激光束在二维码所在平面上的落点为E和F，可测得另两个激光发射器的测量基准点与落点E和F的距离分别为Le和 Lf，同理可求得落点E和F在世界坐标系中的坐标E（xe，ye，ze）和F（xf，yf，zf）；
设三个激光发射器激光束发射方向的反向延长线交点为O（xo，yo，zo），设三个激光发射器的测量基准点与点O的距离都为r，可根据三激光发射器朝向间夹角依预设对应表查得r的长度，那么点O在世界坐标系中的坐标可通过以下方程组求解获得：
(xd - xo)²+(yd - yo)²+(zd - zo)²=(Ld+ r)²
(xe - xo)²+(ye - yo)²+(ze - zo)²=(Le+ r)²
(xf - xo)²+(yf - yo)²+(zf - zo)²=(Lf+ r)²；
有了点O的坐标，在D、E、F点坐标以及Ld、Le、Lf和r的长度都已知的情况下，可计算求得三激光发射器测量基准点的坐标。
2.根据权利要求1所述的定位方法及其设备，其特征在于，所述的二维码位置探测图形的中心点处可设置小型穿雾灯，小型穿雾灯可在大雾天气人为控制开启。
3.根据权利要求1所述的定位方法及其设备，其特征在于，所述的二维码搜索摄像头旁边应设有与其朝向平行的闪光灯或照明射灯。
4.根据权利要求1所述的定位方法及其设备，其特征在于，所述的二维码扫描定位摄像头拍摄高分辨率二维码照片的分辨率不应低于三百万像素，拍摄时的快门速度不应慢于1/10000秒。
5.根据权利要求1所述的定位方法及其设备，其特征在于，所述的二维码最好选用QRCode二维码，二维码图形的各边边长应不小于50cm。
6.根据权利要求1所述的定位方法及其设备，其特征在于，所述的三个激光发射器先后各发射一段激光束的过程应控制在0.01毫秒以内。
7.根据权利要求1所述的定位方法及其设备，其特征在于，所述的二维码编号对应的信息还可包括此二维码的最佳探测位置区域，在此区域内的车辆应首选探测扫描此区域对应的二维码。
8.根据权利要求1所述的定位方法及其设备，其特征在于，所述的设备中还可增加一显示屏用以显示二维码搜索摄像头拍摄的内容，用户可根据显示屏显示图像采用手动方式控制二维码搜索摄像头对准二维码。
9.根据权利要求1所述的定位方法及其设备，其特征在于，所述的激光测距设备可包含四个或四个以上的激光发射器，相应的所述的二维码扫描识别定位设备可包含四个或四个以上的二维码扫描定位摄像头。
10.根据权利要求1所述的定位方法及其设备，其特征在于，所述的二维码还可位于安装于汽车尾部的反光板上，车尾安装有二维码反光板的车辆在获取本车精确坐标后，经计算可得到车尾二维码反光板上各位置探测图形中心点的精确坐标，并可通过短距无线通讯向后方车辆发送这些精确坐标信息。
CN201610385003.0A 2016-06-02 2016-06-02 一种二维码激光测距车辆定位方法及其设备 Pending CN106093954A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610385003.0A CN106093954A (zh) 2016-06-02 2016-06-02 一种二维码激光测距车辆定位方法及其设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610385003.0A CN106093954A (zh) 2016-06-02 2016-06-02 一种二维码激光测距车辆定位方法及其设备

Publications (1)

Publication Number Publication Date
CN106093954A true CN106093954A (zh) 2016-11-09

Family

ID=57448156

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610385003.0A Pending CN106093954A (zh) 2016-06-02 2016-06-02 一种二维码激光测距车辆定位方法及其设备

Country Status (1)

Country Link
CN (1) CN106093954A (zh)

Cited By (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106989746A (zh) * 2017-03-27 2017-07-28 远形时空科技（北京）有限公司 导航方法及导航装置
CN107179091A (zh) * 2017-06-27 2017-09-19 广东嘉腾机器人自动化有限公司 一种agv行走视觉定位误差修正方法
CN107300391A (zh) * 2017-06-26 2017-10-27 国家电网公司 一种变电站智能巡检机器人定位坐标的自动校正装置及校正方法
CN107380002A (zh) * 2017-08-17 2017-11-24 陕西隆翔停车设备集团有限公司 一种agv小车无线充电***及其充电方法
CN107490379A (zh) * 2017-08-28 2017-12-19 山东非凡智能科技有限公司 利用二维码地标定位agv工作点位置的方法及***
CN108037503A (zh) * 2017-12-22 2018-05-15 杭州视熵科技有限公司 一种面向家居板材上下料的基于激光雷达的平面多板材定位方法
CN108469262A (zh) * 2018-03-13 2018-08-31 上海三利数字技术有限公司 轨道交通列车的定位***及方法
CN108805930A (zh) * 2018-05-31 2018-11-13 上海燧方智能科技有限公司 自动驾驶车辆的定位方法和***
CN109754034A (zh) * 2019-01-08 2019-05-14 北京邮电大学 一种基于二维码的终端设备定位方法及装置
CN109800828A (zh) * 2017-11-17 2019-05-24 比亚迪股份有限公司 基于二维码的车辆定位***和定位方法
CN109798872A (zh) * 2017-11-16 2019-05-24 北京凌云智能科技有限公司 车辆定位方法、装置和***
CN109990746A (zh) * 2017-12-29 2019-07-09 沈阳新松机器人自动化股份有限公司 一种获取平面位置的方法
CN110164166A (zh) * 2018-02-11 2019-08-23 北京图森未来科技有限公司 一种车辆定位***、方法和装置
CN110547004A (zh) * 2017-02-14 2019-12-06 弗劳恩霍夫应用研究促进协会 用于定位信号的发送的装置、***和方法
CN110641522A (zh) * 2019-09-30 2020-01-03 中铁第四勘察设计院集团有限公司 高速磁浮轨道交通的列车定位***
CN110986003A (zh) * 2019-10-23 2020-04-10 湖南省辰波建设有限公司 一种多功能智能路灯杆
CN111256676A (zh) * 2018-11-30 2020-06-09 杭州海康机器人技术有限公司 移动机器人定位方法、装置和计算机可读存储介质
CN111680647A (zh) * 2020-06-12 2020-09-18 中华人民共和国杭州海关 一种用于危化品检验的护目镜及其检验方法
CN112149441A (zh) * 2020-09-04 2020-12-29 北京布科思科技有限公司 一种基于反光板的二维码定位控制方法
CN113179292A (zh) * 2021-03-02 2021-07-27 武汉理工大学 基于边缘计算的船舶定位方法、***、装置及存储介质
CN113739785A (zh) * 2020-05-29 2021-12-03 杭州海康机器人技术有限公司 一种机器人定位方法、装置及存储介质
US11532230B2 (en) 2018-02-11 2022-12-20 Beijing Tusen Zhitu Technology Co., Ltd. System, method and apparatus for position-based parking of vehicle
TWI808543B (zh) * 2021-11-22 2023-07-11 創奕能源科技股份有限公司 移動載具用精密定位/標誌參考裝置、辨識系統及方法
CN116592876A (zh) * 2023-07-17 2023-08-15 北京元客方舟科技有限公司 定位装置及定位装置的定位方法

Cited By (34)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110547004B (zh) * 2017-02-14 2022-03-18 弗劳恩霍夫应用研究促进协会 用于定位信号的发送的装置、***和方法
CN110547004A (zh) * 2017-02-14 2019-12-06 弗劳恩霍夫应用研究促进协会 用于定位信号的发送的装置、***和方法
US11006246B2 (en) 2017-02-14 2021-05-11 Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. Base station, wireless communications network and methods for operating the same
CN106989746A (zh) * 2017-03-27 2017-07-28 远形时空科技（北京）有限公司 导航方法及导航装置
CN107300391A (zh) * 2017-06-26 2017-10-27 国家电网公司 一种变电站智能巡检机器人定位坐标的自动校正装置及校正方法
CN107179091A (zh) * 2017-06-27 2017-09-19 广东嘉腾机器人自动化有限公司 一种agv行走视觉定位误差修正方法
CN107179091B (zh) * 2017-06-27 2019-09-20 广东嘉腾机器人自动化有限公司 一种agv行走视觉定位误差修正方法
CN107380002A (zh) * 2017-08-17 2017-11-24 陕西隆翔停车设备集团有限公司 一种agv小车无线充电***及其充电方法
CN107490379A (zh) * 2017-08-28 2017-12-19 山东非凡智能科技有限公司 利用二维码地标定位agv工作点位置的方法及***
CN107490379B (zh) * 2017-08-28 2020-11-27 山东非凡智能科技有限公司 利用二维码地标定位agv工作点位置的方法及***
CN109798872A (zh) * 2017-11-16 2019-05-24 北京凌云智能科技有限公司 车辆定位方法、装置和***
CN109798872B (zh) * 2017-11-16 2021-06-22 北京凌云智能科技有限公司 车辆定位方法、装置和***
CN109800828A (zh) * 2017-11-17 2019-05-24 比亚迪股份有限公司 基于二维码的车辆定位***和定位方法
CN109800828B (zh) * 2017-11-17 2020-10-20 比亚迪股份有限公司 基于二维码的车辆定位***和定位方法
CN108037503A (zh) * 2017-12-22 2018-05-15 杭州视熵科技有限公司 一种面向家居板材上下料的基于激光雷达的平面多板材定位方法
CN109990746A (zh) * 2017-12-29 2019-07-09 沈阳新松机器人自动化股份有限公司 一种获取平面位置的方法
US11532230B2 (en) 2018-02-11 2022-12-20 Beijing Tusen Zhitu Technology Co., Ltd. System, method and apparatus for position-based parking of vehicle
US11094201B2 (en) 2018-02-11 2021-08-17 Tusimple, Inc. Method, device and system for vehicle positioning
CN110164166A (zh) * 2018-02-11 2019-08-23 北京图森未来科技有限公司 一种车辆定位***、方法和装置
CN108469262A (zh) * 2018-03-13 2018-08-31 上海三利数字技术有限公司 轨道交通列车的定位***及方法
CN108805930A (zh) * 2018-05-31 2018-11-13 上海燧方智能科技有限公司 自动驾驶车辆的定位方法和***
CN111256676A (zh) * 2018-11-30 2020-06-09 杭州海康机器人技术有限公司 移动机器人定位方法、装置和计算机可读存储介质
CN111256676B (zh) * 2018-11-30 2022-02-11 杭州海康机器人技术有限公司 移动机器人定位方法、装置和计算机可读存储介质
CN109754034A (zh) * 2019-01-08 2019-05-14 北京邮电大学 一种基于二维码的终端设备定位方法及装置
CN110641522A (zh) * 2019-09-30 2020-01-03 中铁第四勘察设计院集团有限公司 高速磁浮轨道交通的列车定位***
CN110986003A (zh) * 2019-10-23 2020-04-10 湖南省辰波建设有限公司 一种多功能智能路灯杆
CN113739785A (zh) * 2020-05-29 2021-12-03 杭州海康机器人技术有限公司 一种机器人定位方法、装置及存储介质
CN111680647A (zh) * 2020-06-12 2020-09-18 中华人民共和国杭州海关 一种用于危化品检验的护目镜及其检验方法
CN112149441A (zh) * 2020-09-04 2020-12-29 北京布科思科技有限公司 一种基于反光板的二维码定位控制方法
CN112149441B (zh) * 2020-09-04 2024-01-16 北京布科思科技有限公司 一种基于反光板的二维码定位控制方法
CN113179292A (zh) * 2021-03-02 2021-07-27 武汉理工大学 基于边缘计算的船舶定位方法、***、装置及存储介质
TWI808543B (zh) * 2021-11-22 2023-07-11 創奕能源科技股份有限公司 移動載具用精密定位/標誌參考裝置、辨識系統及方法
CN116592876A (zh) * 2023-07-17 2023-08-15 北京元客方舟科技有限公司 定位装置及定位装置的定位方法
CN116592876B (zh) * 2023-07-17 2023-10-03 北京元客方舟科技有限公司 定位装置及定位装置的定位方法

Similar Documents

Publication Publication Date Title
CN106093954A (zh) 一种二维码激光测距车辆定位方法及其设备
Brenner Extraction of features from mobile laser scanning data for future driver assistance systems
US5247356A (en) Method and apparatus for mapping and measuring land
Tao Mobile mapping technology for road network data acquisition
Li Mobile mapping: An emerging technology for spatial data acquisition
CN109641538A (zh) 使用车辆创建，更新地图的***和方法
US7650013B2 (en) System and method for map and position-determination enhancement
CN110057373A (zh) 用于生成高精细语义地图的方法、装置和计算机存储介质
US10264239B2 (en) Method for producing a digital photo wherein at least some of the pixels comprise position information, and such a digital photo
CN108885106A (zh) 使用地图的车辆部件控制
US20050057745A1 (en) Measurement methods and apparatus
CN105512646A (zh) 一种数据处理方法、装置及终端
US9367962B2 (en) Augmented image display using a camera and a position and orientation sensor
CN106468552A (zh) 一种基于机载光电平台的双机交会定位方法
CN101666642B (zh) 自动测量的数字水准仪
ES2854944T3 (es) Procedimiento y dispositivo para georreferenciar datos de imágenes aéreas utilizando datos de imágenes SAR
CN109446973A (zh) 一种基于深度神经网络图像识别的车辆定位方法
US20130293716A1 (en) Mobile mapping system for road inventory
CN109146958A (zh) 一种基于二维图像的交通标志空间位置测量方法
CN111426304B (zh) 基于视觉、卫星定位和gis算法的精确姿态定位方法
CN114115545A (zh) 一种ar井盖标注方法、***、设备和存储介质
CN201503267U (zh) 一种自动测量的数字水准仪
CN106203335A (zh) 基于三维点云的标志牌可视度评价方法
JPH07139942A (ja) 測量装置
WO2022030033A1 (ja) 地物データの生成システム、地物データベース更新システム及び地物データの生成方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
WD01 Invention patent application deemed withdrawn after publication
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20161109