CN103499335A - 一种三维测距方法及其装置 - Google Patents
一种三维测距方法及其装置 Download PDFInfo
- Publication number
- CN103499335A CN103499335A CN201310410512.0A CN201310410512A CN103499335A CN 103499335 A CN103499335 A CN 103499335A CN 201310410512 A CN201310410512 A CN 201310410512A CN 103499335 A CN103499335 A CN 103499335A
- Authority
- CN
- China
- Prior art keywords
- spot
- distance measuring
- light source
- lantern slide
- projection objective
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C3/00—Measuring distances in line of sight; Optical rangefinders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/04—Interpretation of pictures
- G01C11/06—Interpretation of pictures by comparison of two or more pictures of the same area
- G01C11/12—Interpretation of pictures by comparison of two or more pictures of the same area the pictures being supported in the same relative position as when they were taken
- G01C11/14—Interpretation of pictures by comparison of two or more pictures of the same area the pictures being supported in the same relative position as when they were taken with optical projection
- G01C11/20—Interpretation of pictures by comparison of two or more pictures of the same area the pictures being supported in the same relative position as when they were taken with optical projection in separate planes
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- Multimedia (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Measurement Of Optical Distance (AREA)
Abstract
本发明涉及一种三维测距方法及其装置,特别涉及一种用于移动机器人的三维测距方法及其装置,属于移动机器人环境感知技术领域。包括光源、反光镜、聚光镜、幻灯片、投影物镜、摄像头和图像处理器。光源、反光镜、聚光镜、幻灯片和投影物镜组成投影系统,将幻灯片上的等间距圆斑图形投射到移动机器人前方空间,摄像头和图像处理器组成的图像测量系统测量视场中各个投影光斑的直径,就可计算出该投影光斑处的物体距离。本发明技术方案无需使用三维扫描机构,就能进行三维测距,系统结构简单,测量速度快,成本低廉,不存在激光测距装置的安全性问题,可用于环境感知精度和测量速度要求较高的场合。
Description
技术领域
本发明涉及一种三维测距方法及其装置,特别涉及一种用于移动机器人的三维测距方法及其装置,属于移动机器人环境感知技术领域。
背景技术
距离测量是移动机器人感知环境和完成其它高级任务(如自主导航、避开障碍、地图生成和环境建模等)的必要基础。目前用于移动机器人的测距技术有:
(1)双目视觉测距。利用两台位置相互固定的摄像机组成双目视觉测量系统,根据同一景物在两台摄像机上成像的视差恢复出景物深度,从而获得距离信息。双目视觉测量方法在原理上非常简单,可用于三维测距,但由于光照、噪声和畸变等因素的影响,导致目标点投影到两台摄像机上的像点特性不同,很难从两台摄像机拍摄的图像中找到对应的像点,因此目前双目视觉测距技术还不成熟,同时视觉图像的处理过程复杂,需要较长的计算时间,无法适应实时性要求较高的场合。
(2)超声波测距。超声波测距的原理是利用超声波发射器发射高频超声波脉冲,超声波在空气介质中行进一段距离,遇到障碍物后反射,由接收器接收返回的超声波。测量超声波从发射器发射到碰到障碍物反射回接收器的时间,根据超声波在空气介质中的传播速度与超声波频率,就可计算出机器人距障碍物的距离。超声传感器体积小、价格低,目前已在移动机器人获得广泛应用,但超声波测距在实际应用中仍然存在明显的不足:超声波在空气中传播有较大的能量衰减,最大测量距离有限;超声波的波束角较大,使得反射目标点的准确方位难以确定,因此超声波测距技术仅能用在对环境感知精度要求不高的场合,如只是大致知道一下前方是否有较大的障碍物。
(3)红外测距。红外测距通过红外信号发射管发射特定频率的红外信号,当红外信号遇到障碍物被反射,由红外信号接收管接收返回的红外信号。测量红外信号从发射管发射到碰到障碍物反射回接收管的时间,就可获得障碍物的距离。红外发射管发射的红外信号具有有一定的发散角度,无法确定反射目标点的准确方位。另外,由于自然界的所有物体只要温度高于0K都会辐射红外线,室内墙壁也会将红外信号反射到红外接收管,使得红外测距精度受环境影响很大,红外测距技术也只能用于对环境感知精度要求不高的场合。
(4)激光测距。激光测距原理与超声波和红外测距原理类似,利用激光脉冲发射和接收之间的飞行时间来计算测量距离。激光的准直性能好,可以对目标点进行精确测距,为了获得前方扇形平面区域内任意一点的距离,必需要增加二维扫描装置,使激光束进行扇形扫描(图1)。激光测距的优点是准确度高,适于对环境感知精度要求较高的场合,缺点是系统复杂、成本较高,难以在移动机器人领域推广应用。若要对三维空间的物体测距,还需使用三维扫描装置,大幅度增加了系统的体积、复杂性和成本。另外,脉冲激光束是能量非常集中的单色光源,扫描测距时若直接照射到人眼,会对人眼造成严重损伤。
发明内容
本发明的目的是提出一种三维测距方法及其装置,利用光学成像技术和图像测量技术,直接测量三维空间的物体距离,无需三维扫描机构,对目标点进行精确快速定位,并使测距系统结构简单、降低测距成本。
本发明提出的三维测距方法,包括以下步骤:
(1)将幻灯片上的圆斑图形投影到测距装置的前方,在前方多个物体的表面分别形成圆斑图像,该圆斑图像的直径与物体表面和测距装置之间的距离成正比;
(2)拍摄前方景物,得到前方景物的数字图像,该数字图像中包含有前方多个物体的圆斑图像;
(3)测量数字图像中每个圆斑图像的直径,根据每个圆斑图像的直径D,计算出该圆斑物体表面距测距装置投影物镜焦点f的距离L:
L=D/α
其中距离系数α由光学投影系统中投影物镜的孔径与焦距之比决定:
α=d/F
其中d为投影物镜的孔径,F为投影物镜的焦距。
本发明提出的三维测距装置,包括:
光源,用于发出稳定的光能量,对幻灯片进行照明,光源置于反光镜与聚光镜之间;
反光镜,用于将光源向后发射的光线反射回来加以利用,提高光源的利用率,反光镜置于光源的后方;
聚光镜,用于将光源发出的光线会聚并均匀地照射在幻灯片上,聚光镜置于光源的前方;
幻灯片,用于通过曝光成像形成圆斑图形,幻灯片置于聚光镜与投影物镜之间;
投影物镜,用于将幻灯片上的圆斑图形投影到测距装置前方物体表面上,投影物镜置于幻灯片与前方物体之间;
摄像头,用于拍摄前方视场内物体表面上的圆斑图像,得到数字图像,并将数字图像输出给图像处理器;
图像处理器,接收摄像头输出的数字图像,测量数字图像中每个圆斑的直径,根据每个圆斑的直径,计算出该圆斑物体表面距摄像头的距离。
本发明提供的三维测距方法及其装置,利用投影光斑直径与被测物体表面到投影物镜焦点距离成正比的特性,通过测量光斑直径的大小来获得该圆斑物体表面的距离,可对摄像头视场内所有面积大于投影光斑面积的目标物体进行快速测距,系统结构简单,测距深度快,成本低廉,无需三维扫描机构,不存在激光测距装置的安全性问题,使用普通光源照明,不会对人眼造成伤害,可用于环境感知精度和测量速度要求较高的场合。
附图说明
图1是本发明提出的三维测距装置的测距示意图。
图2是本发明方法中测得的前方景物的数字图像。
图3是本发明提出的三维测距装置的结构示意图。
图4是本发明提出的三维测距方法的原理图。
图1—图4中,1是测距装置、2是远距离物体、3是三维测距装置中投影到远距离物体2上的测量圆斑图形,4是中距离物体,5是三维测距装置投影到中距离物体上的测量圆斑图形,6是近距离物体,7是三维测距装置投影到近距离物体6上的测量圆斑图形,8是图像处理器,9是摄像头,10是投影物镜,11是幻灯片,12是聚光镜,13是光源,14是反光镜,f是投影物镜的焦点,D是投影光斑的直径,L是投影光斑处物体表面到投影物镜焦点f的距离。
具体实施方式
本发明提出的三维测距方法,包括以下步骤:
(1)将幻灯片上的圆斑图形投影到测距装置的前方,在前方多个物体的表面分别形成圆斑图像,该圆斑图像的直径与物体表面和测距装置之间的距离成正比;如图1中所示,图1中,1是测距装置、2是远距离物体、3是三维测距装置中投影到远距离物体2上的测量圆斑图形,4是中距离物体,5是三维测距装置投影到中距离物体上的测量圆斑图形,6是近距离物体,7是三维测距装置投影到近距离物体6上的测量圆斑图形,8是图像处理器。
(2)拍摄前方景物,得到前方景物的数字图像,该数字图像中包含有前方多个物体的圆斑图像,如图2所示,图2中,3是三维测距装置中投影到远距离物体2上的测量圆斑图形,5是三维测距装置投影到中距离物体上的测量圆斑图形,7是三维测距装置投影到近距离物体。
(3)测量数字图像中每个圆斑图像的直径,根据每个圆斑图像的直径D,计算出该圆斑物体表面距测距装置投影物镜焦点f的距离L,其原理如图4所示:
L=D/α
其中距离系数α由光学投影系统中投影物镜的孔径与焦距之比决定:
α=d/F
其中d为投影物镜的孔径,F为投影物镜的焦距。
本发明提出的三维测距装置,其结构如图3所示,该装置包括:
光源13,用于发出稳定的光能量,对幻灯片进行照明,光源置于反光镜与聚光镜之间;
反光镜,用于将光源向后发射的光线反射回来加以利用,提高光源的利用率,反光镜置于光源的后方;
聚光镜12,用于将光源发出的光线会聚并均匀地照射在幻灯片上,聚光镜置于光源的前方;
幻灯片11,用于通过曝光成像形成圆斑图形,幻灯片置于聚光镜与投影物镜之间;
投影物镜10,用于将幻灯片上的圆斑图形投影到测距装置前方物体表面上,投影物镜置于幻灯片与前方物体之间;
摄像头9,用于拍摄前方视场内物体表面上的圆斑图像,得到数字图像,并将数字图像输出给图像处理器;
图像处理器8,接收摄像头输出的数字图像,测量数字图像中每个圆斑的直径,根据每个圆斑的直径,计算出该圆斑物体表面距摄像头的距离。
本发明的三维测距装置的一个实施例中,图像处理器8采用TI公司的TMS320C64xTM数字信号处理器,摄像头9采用OmniVision公司像素为4224×3000的OV12830图像传感器模组,图像输出格式为10bit RAW RGB,投影物镜10采用焦距为100mm的双凸透镜,幻灯片11采用黑白正片胶片,聚光镜12采用焦距为10mm的双凸透镜,光源13采用200W金属卤素灯泡,反光镜14采用金属抛光凹面镜。本发明的一个实施例中,距离系数α的取值为1/1000。
本发明三维测距装置的工作原理是:
由光源13、反光镜14、聚光镜12、幻灯片11和投影物镜10组成的投影系统,将幻灯片11上的圆斑图形投射到移动机器人前方空间(如图1所示),投影光斑的直径D与被测物体表面到投影物镜焦点的距离L成正比(如图4所示),通过图像处理器8和摄像头9组成的图像测量系统测量视场中各个投影光斑的直径D,就可计算出该投影光斑处的物体距离L。
本发明提供的三维测距装置,利用投影光斑直径与被测物体表面到投影物镜焦点距离成正比的特性,通过测量光斑直径的大小来获得该圆斑处物体表面的距离,可对摄像头视场内所有投影光斑处的物体进行快速测距,系统结构简单,成本低廉,无需三维扫描机构,不存在激光测距装置的安全性问题,可用于环境感知精度和测量速度要求较高的场合。
Claims (2)
1.一种三维测距方法,其特征在于该方法包括以下步骤:
(1)将幻灯片上的圆斑图形投影到测距装置的前方,在前方多个物体的表面分别形成圆斑图像,该圆斑图像的直径与物体表面和测距装置之间的距离成正比;
(2)拍摄前方景物,得到前方景物的数字图像,该数字图像中包含有前方多个物体的圆斑图像;
(3)测量数字图像中每个圆斑图像的直径,根据每个圆斑图像的直径D,计算出该圆斑物体表面距测距装置投影物镜焦点f的距离L:
L=D/α
其中距离系数α由光学投影系统中投影物镜的孔径与焦距之比决定:
α=d/F
其中d为投影物镜的孔径,F为投影物镜的焦距。
2.一种三维测距装置,其特征在于该装置包括:
光源,用于发出稳定的光能量,对幻灯片进行照明,光源置于反光镜与聚光镜之间;
反光镜,用于将光源向后发射的光线反射回来加以利用,提高光源的利用率,反光镜置于光源的后方;
聚光镜,用于将光源发出的光线会聚并均匀地照射在幻灯片上,聚光镜置于光源的前方;
幻灯片,用于通过曝光成像形成圆斑图形,幻灯片置于聚光镜与投影物镜之间;
投影物镜,用于将幻灯片上的圆斑图形投影到测距装置前方物体表面上,投影物镜置于幻灯片与前方物体之间;
摄像头,用于拍摄前方视场内物体表面上的圆斑图像,得到数字图像,并将数字图像输出给图像处理器;
图像处理器,接收摄像头输出的数字图像,测量数字图像中每个圆斑的直径,根据每个圆斑的直径,计算出该圆斑物体表面距摄像头的距离。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310410512.0A CN103499335B (zh) | 2013-09-10 | 2013-09-10 | 一种三维测距方法及其装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310410512.0A CN103499335B (zh) | 2013-09-10 | 2013-09-10 | 一种三维测距方法及其装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103499335A true CN103499335A (zh) | 2014-01-08 |
CN103499335B CN103499335B (zh) | 2015-06-10 |
Family
ID=49864566
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310410512.0A Active CN103499335B (zh) | 2013-09-10 | 2013-09-10 | 一种三维测距方法及其装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103499335B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106526609A (zh) * | 2016-12-15 | 2017-03-22 | 深圳市迈测科技股份有限公司 | 激光测距系统、装置、组合装置及方法 |
CN108008403A (zh) * | 2017-12-11 | 2018-05-08 | 深圳市富微科创电子有限公司 | 红外激光测距装置及方法、无人机及避障方法 |
CN108731596A (zh) * | 2018-03-29 | 2018-11-02 | 海安智鹏自动化科技有限公司 | 一种基于视觉识别的简易水下测距方法 |
CN110132144A (zh) * | 2019-07-10 | 2019-08-16 | 常州伊博艾利斯自动化有限公司 | 一种物体尺寸测量方法及系统 |
CN113610054A (zh) * | 2021-08-27 | 2021-11-05 | 广州慧瞳科技有限公司 | 一种水下结构病害深度检测方法、系统、装置及存储介质 |
CN114450587A (zh) * | 2019-10-16 | 2022-05-06 | 株式会社岛津制作所 | 成像质量分析装置 |
CN117989990A (zh) * | 2024-02-04 | 2024-05-07 | 东北电力大学 | 一种新型测量输电铁塔螺栓松动高度的装置及方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102192727A (zh) * | 2010-03-19 | 2011-09-21 | 阿尔卡特朗讯 | 移动手持设备和方法 |
CN102445180B (zh) * | 2010-10-13 | 2013-09-18 | 原相科技股份有限公司 | 测距系统、测距与处理方法 |
CN102445179B (zh) * | 2010-10-13 | 2013-07-31 | 原相科技股份有限公司 | 测距方法、测距系统与其处理方法 |
CN202362458U (zh) * | 2011-12-08 | 2012-08-01 | 长沙华鹏电力科技有限责任公司 | 一种动力伞激光雷达三维测距系统 |
CN203454994U (zh) * | 2013-09-10 | 2014-02-26 | 紫光股份有限公司 | 一种三维测距装置 |
-
2013
- 2013-09-10 CN CN201310410512.0A patent/CN103499335B/zh active Active
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106526609A (zh) * | 2016-12-15 | 2017-03-22 | 深圳市迈测科技股份有限公司 | 激光测距系统、装置、组合装置及方法 |
CN108008403A (zh) * | 2017-12-11 | 2018-05-08 | 深圳市富微科创电子有限公司 | 红外激光测距装置及方法、无人机及避障方法 |
CN108731596A (zh) * | 2018-03-29 | 2018-11-02 | 海安智鹏自动化科技有限公司 | 一种基于视觉识别的简易水下测距方法 |
CN110132144A (zh) * | 2019-07-10 | 2019-08-16 | 常州伊博艾利斯自动化有限公司 | 一种物体尺寸测量方法及系统 |
CN114450587A (zh) * | 2019-10-16 | 2022-05-06 | 株式会社岛津制作所 | 成像质量分析装置 |
CN113610054A (zh) * | 2021-08-27 | 2021-11-05 | 广州慧瞳科技有限公司 | 一种水下结构病害深度检测方法、系统、装置及存储介质 |
CN117989990A (zh) * | 2024-02-04 | 2024-05-07 | 东北电力大学 | 一种新型测量输电铁塔螺栓松动高度的装置及方法 |
CN117989990B (zh) * | 2024-02-04 | 2024-07-19 | 东北电力大学 | 一种新型测量输电铁塔螺栓松动高度的装置及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103499335B (zh) | 2015-06-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103499335B (zh) | 一种三维测距方法及其装置 | |
CN107219533B (zh) | 激光雷达点云与图像融合式探测系统 | |
US9967545B2 (en) | System and method of acquiring three-dimensional coordinates using multiple coordinate measurment devices | |
US20180135969A1 (en) | System for measuring the position and movement of an object | |
CN111880194B (zh) | 非视域成像装置及方法 | |
CN103206926B (zh) | 一种全景三维激光扫描装置 | |
CA2955858C (en) | Night vision device | |
CN104698467B (zh) | 一种不同瞄准线上多目标脉冲激光测距装置及方法 | |
CN107515403A (zh) | 一种tof三维测距传感器 | |
CN105004324A (zh) | 一种具有三角测距功能的单目视觉传感器 | |
CN109223303A (zh) | 全自动伤口拍摄评估防护眼罩及测量方法 | |
CN205305018U (zh) | 获取三维场景的深度图的设备 | |
JP2002152779A (ja) | 3次元画像検出装置 | |
CN203454994U (zh) | 一种三维测距装置 | |
CN106154282B (zh) | 激光阵列高速空间跟踪系统 | |
CN206362929U (zh) | 激光雷达以及激光雷达测量装置 | |
CN116184425A (zh) | 一种基于飞行时间传感器的非视域测距成像方法及系统 | |
CN103697825A (zh) | 一种超分辨3d激光测量系统及方法 | |
CN111277811B (zh) | 一种三维空间相机及其拍照方法 | |
CN110345863A (zh) | 一种固态式环形三维成像装置 | |
CN101930071A (zh) | 侦测物体运动的装置及方法 | |
CN203687882U (zh) | 一种超分辨3d激光测量系统 | |
CN218213452U (zh) | 一种深度相机及移动机器人 | |
CN109470146B (zh) | 高分辨力立体视觉系统与测量方法 | |
CN204788348U (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 |