CN115201836A - 输出控制装置以及测距装置、输出控制方法、输出控制程序 - Google Patents
输出控制装置以及测距装置、输出控制方法、输出控制程序 Download PDFInfo
- Publication number
- CN115201836A CN115201836A CN202210348328.7A CN202210348328A CN115201836A CN 115201836 A CN115201836 A CN 115201836A CN 202210348328 A CN202210348328 A CN 202210348328A CN 115201836 A CN115201836 A CN 115201836A
- Authority
- CN
- China
- Prior art keywords
- distance
- distance information
- output
- output control
- unit
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/50—Depth or shape recovery
- G06T7/521—Depth or shape recovery from laser ranging, e.g. using interferometry; from the projection of structured light
-
- 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/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
- G01S17/894—3D imaging with simultaneous measurement of time-of-flight at a 2D array of receiver pixels, e.g. time-of-flight cameras or flash lidar
-
- 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/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
-
- 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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/06—Systems determining position data of a target
- G01S13/08—Systems for measuring distance only
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4802—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/481—Constructional features, e.g. arrangements of optical elements
- G01S7/4811—Constructional features, e.g. arrangements of optical elements common to transmitter and receiver
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/60—Analysis of geometric attributes
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/60—Type of objects
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10028—Range image; Depth image; 3D point clouds
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V2201/00—Indexing scheme relating to image or video recognition or understanding
- G06V2201/07—Target detection
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Theoretical Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Geometry (AREA)
- Multimedia (AREA)
- Optics & Photonics (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Measurement Of Optical Distance (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明提供一种输出控制装置、以及具有该输出控制装置的测距装置、输出控制方法、输出控制程序,可减少包含输出的距离信息的信息的数据量。控制部(10)为控制在包含与对象物(30)的距离信息的距离图像中包含的信息的输出的输出控制装置,具有距离运算部(11)、以及输出信息选择部(19)。距离运算部(11)根据从照明装置(21)向对象物(30)照射的光(L1)的反射量,获取与对象物(30)的距离信息。输出信息选择部(19)选择与包括基于由距离运算部(11)获取到的距离信息而被检测的对象物(30)在内的距离图像的像素对应的距离信息作为输出对象。
Description
技术领域
本发明涉及对在包含与对象物的距离信息的距离图像中包含的信息的输出进行控制的输出控制装置以及具有该控制装置的测距装置、输出控制方法、输出控制程序。
背景技术
近年来,例如已在使用测距装置,该测距装置接受作为光源而从LED(LightEmitting Diode:发光二极管)向测量对象物照射的光的反射光,利用对与测量对象物的距离进行测量的TOF(Time-of-Flight:飞行时间)传感器,对各像素生成包含与测量对象物的距离信息的距离图像。
例如,在专利文献1中已经针对人体计量系统的坐标校准方法进行了公开,该坐标校准方法基于在距离图像中包含的室内平面部的数据,将由深度相机获得的距离图像的坐标系构成为实验室坐标系。
现有技术文献
专利文献
专利文献1:(日本)特开2017-122690号公报
发明内容
发明所要解决的技术问题
然而,在上述现有的人体计量系统中,存在如下所示的问题点。
即,在上述公报中,虽然针对将由深度相机获得的距离图像的坐标系校准为实验室坐标系的方法进行了公开,但因为要输出包括与距离图像的所有像素对应的距离信息的信息,所以,输出的数据量可能巨大。
因此,由于输出的数据量较大,例如可能使接收来自系统的输出的主机之间的通信时间增加。另外,即使在对由主机侧接收到的数据例如进行检测指定的对象物等的后处理的情况下,也因为作为处理对象的数据量较大,所以,可能使在主机侧的后处理的负载增大。
本发明的问题在于提供一种输出控制装置以及具有该输出控制装置的测距装置、输出控制方法、输出控制程序,能够减少包含输出的距离信息的信息的数据量。
用于解决技术问题的技术方案
第一发明的输出控制装置为控制在包含与对象物的距离信息的距离图像中包含的信息的输出的输出控制装置,具有:距离信息获取部、以及输出信息选择部。距离信息获取部根据从照明装置向对象物照射的电磁波的反射量,获取与对象物的距离信息。输出信息选择部选择与包括基于由距离信息获取部中获取到的距离信息而被检测的对象物在内的距离图像的像素对应的距离信息,作为输出对象。
在此,例如,接受作为光源而从LED(Light Emitting Diode)向对象物照射的光的反射光,选择与包括利用从测量与测量对象物的距离的TOF(Time-of-Flight)传感器获取到的与对象物的距离信息而被检测的对象物在内的距离图像的像素对应的距离信息,作为输出对象。
在此,本输出控制装置例如可以设置在TOF传感器等测距装置内,也可以设置在测距装置的外部。
从照明装置照射的电磁波例如包括广义上的光(紫外光/可视光/红外光)、波长比光短的γ(伽马)射线、X射线、波长比光长的微波、广播用电波(短波、中波、长波)、超声波、弹性波、量子波等。
需要说明的是,距离信息获取部也可以为检测电磁波的反射来计算距离信息的结构,例如也可以为从作为外部装置而设置的距离传感器等获取距离信息的结构。
由此,例如可以选择性地只输出与包括在地面放置的对象物在内的像素对应的距离信息,进行输出控制,以不输出只在地面上没有对象物的像素部分。
其结果是,能够大幅减少包含从测距装置输出的距离信息的信息的数据量。
第二发明的输出控制装置基于第一发明的输出控制装置,还具有对象物检测部,该对象物检测部当基于由距离信息获取部获取到的距离信息检测与地面具有高度的物体时,将物体检测为对象物。
由此,通过将与作为地面而识别出的面具有高度的物体检测为对象物,能够容易地指定包含作为输出对象的距离信息的像素。
第三发明的输出控制装置基于第一或第二发明的输出控制装置,还具有角度信息获取部,该角度信息获取部获取与在距离图像中包括的各像素对应的角度信息。
由此,例如,测距装置在作为受光部而包括受光透镜与检测经由受光透镜而接受的电磁波的反射的拍摄元件的结构中,因为对于生成距离图像的拍摄元件的各像素,经由受光透镜而射入的电磁波的反射角度确定,所以能够获取与各像素对应的角度信息。
第四发明的输出控制装置基于第三发明的输出控制装置,还具有三维坐标转换部,该三维坐标转换部基于由角度信息获取部获取到的角度信息,将由距离信息获取部获取到的距离信息向三维坐标进行转换。
由此,能够利用与各像素对应的角度信息,将距离信息向三维坐标(X,Y,Z)进行转换。
第五发明的输出控制装置基于第四发明的输出控制装置,还具有平面检测部,该平面检测部对放置有对象物的地面进行检测。
由此,作为实际进行与对象物的距离测量的前阶段,通过对地面进行检测,能够在检测有无对象物时,利用测距装置与地面的距离(高度)作为基准值。
第六发明的输出控制装置基于第五发明的输出控制装置,还具有高度计算部,该高度计算部基于将由平面检测部检测出的地面的距离信息由三维坐标转换部转换后的三维坐标,计算测距装置的设置高度。
由此,能够计算测距装置与地面的位置的设置高度,在检测有无对象物时,利用测距装置与地面的距离(高度)作为基准值。
第七发明的输出控制装置基于第六发明的输出控制装置,高度计算部计算使测距装置的正交坐标系围绕轴旋转由平面检测部检测出的地面的垂线与测距装置的光轴形成的角度而再次获取到的坐标值的光轴方向的坐标值,作为设置高度。
由此,针对由测距装置测量出的与地面的距离,能够计算通过使测距装置的正交坐标系围绕轴旋转地面的垂线与测距装置的光轴形成的角度而再次获取到的坐标值的光轴方向的坐标值,作为测距装置的设置高度。
即,例如通过围绕轴旋转地面的垂线与测距装置的光轴形成的角度,以使相当于测距装置的光轴的Z轴朝向铅垂方向,能够计算设置高度,以获取与测距装置向正下方照射光并接受到其反射光的情况相同的距离信息。
第八发明的输出控制装置基于第七发明的输出控制装置,高度计算部计算使测距装置的正交坐标系围绕轴旋转而再次获取到的多个坐标值的铅垂方向的坐标值的平均值,作为设置高度。
由此,针对与作为地面而被识别的平面的坐标值(距离),求出平均值,计算该平均值作为设置高度,由此,例如在地面具有微小凹凸等的情况下,也能够准确地计算测距装置与地面的设置高度。
第九发明的输出控制装置基于第八发明的输出控制装置,还具有坐标旋转运算部,该坐标旋转运算部对使在三维坐标转换部中由距离信息及角度信息转换后的三维坐标围绕轴旋转的旋转坐标进行运算。
由此,在实际对与对象物的距离信息进行测量时,通过对使在三维坐标转换部中由距离信息及角度信息转换后的三维坐标围绕轴旋转的旋转坐标进行运算,能够对与对象物的距离进行检测。
即,通过利用运算后的旋转坐标,能够实际上对在从对象物的正上方观察的状态下测量的高度方向的距离进行测量。
第十发明的输出控制装置基于第九发明的输出控制装置,还具有对象物检测部,该对象物检测部将在坐标旋转运算部中运算出的旋转坐标的高度方向的坐标与在高度计算部中计算的设置高度进行比较,当检测到具有高度方向的尺寸的物体时,将物体检测为对象物。
由此,将与地面的设置高度与对象物的高度(高度方向的坐标)进行比较,根据对象物是否具有高度方向的尺寸,能够容易地检测物体是否为对象物。
第十一发明的输出控制装置基于第十发明的输出控制装置,还具有阈值设定部,该阈值设定部对在对象物检测部的对象物检测时利用的规定的阈值进行设定。
由此,在对象物的检测中将与地面的设置高度和对象物的高度(高度方向的坐标)进行比较时,在该高度之差比规定的阈值大或小的情况下,将该物体检测为对象物,由此而能够抑制对象物的误检测。
第十二发明的输出控制装置基于第十或第十一发明的输出控制装置,输出信息选择部选择包括由对象物检测部检测出的对象物在内的各像素的距离信息,并进行输出。
由此,通过选择性地输出拍摄元件的所有像素中、只与包括对象物在内的像素对应的距离信息,能够大幅减少输出的数据量,降低输出负载。
第十三发明的测距装置具有:第一至第十二发明中任一发明的输出控制装置、向对象物照射电磁波的照射装置、以及对从照明装置照射的电磁波的反射量进行检测的受光部。
由此,通过将上述输出控制装置设置在具有照明装置与受光部的测距装置的内部,能够输出只与包括对象物在内的像素对应的距离信息、而非受光部的拍摄元件的所有像素,能够得到可大幅减少输出的数据量的测距装置。
第十四发明的测距装置基于第十三发明的测距装置,还具有存储部,该存储部保存距离信息、与距离图像中包括的各像素对应的角度信息、测距装置的正交坐标系、设置高度、使由距离信息及角度信息转换后的三维坐标围绕轴旋转的旋转坐标、对象物检测时利用的阈值、以及作为输出对象的像素的坐标值中的至少一种。
由此,通过将距离信息、角度信息、正交坐标系、设置高度、旋转坐标、阈值、以及作为输出对象的像素的坐标值等保存在测距装置内,能够利用被保存的各种数据,实施用于大幅减少输出的数据量的处理。
第十五发明的测距装置基于第十三或第十四发明的测距装置,还具有输出部,该输出部将由输出信息选择部选择出的与像素对应的距离信息向外部设备输出。
由此,通过只将判定为包括对象物且被选择的与像素对应的距离信息从输出部向外部设备输出,能够大幅减少包含从测距装置输出的距离信息的信息的数据量。
第十六发明的输出控制方法为控制在包含与对象物的距离信息的距离图像中包含的信息的输出的输出控制方法,具有:距离信息获取步骤、以及输出信息选择步骤。距离信息获取步骤根据从照明装置向对象物照射的电磁波的反射量,获取与对象物的距离信息。输出信息选择步骤选择与包括基于在距离信息获取步骤中获取到的距离信息而被检测的对象物在内的距离图像的像素对应的距离信息,作为输出对象。
在此,例如接受作为光源而从LED(Light Emitting Diode)向对象物照射的光的反射光,选择与包括对象物在内的距离图像的像素对应的距离信息,作为输出对象,该对象物利用从测量与测量对象物的距离的TOF(Time-of-Flight)传感器获取到的、与对象物的距离信息而被检测。
在此,本输出控制方法例如可以在TOF传感器等测距装置内实施,也可以在测距装置的外部实施。
从照明装置照射的电磁波例如包括广义上的光(紫外光/可视光/红外光)、波长比光短的γ(伽马)射线、X射线、波长比光长的微波、广播用电波(短波、中波、长波)、超声波、弹性波、量子波等。
需要说明的是,在距离信息获取步骤中,可以为对电磁波的反射进行检测来计算距离信息的结构,例如也可以为从作为外部装置而设置的距离传感器等获取距离信息的结构。
由此,例如能够选择性地只输出与包括在地面放置的对象物在内的像素对应的距离信息,进行输出控制,以不输出只在地面没有对象物的像素部分。
其结果是,能够大幅减少包含从测距装置输出的距离信息的信息的数据量。
第十七发明的输出控制程序为控制在包含与对象物的距离信息的距离图像中包含的信息的输出的输出控制程序,使具有距离信息获取步骤、以及输出信息选择步骤的输出控制方法在计算机中执行。距离信息获取步骤根据从照明装置向对象物照射的电磁波的反射量,获取与对象物的距离信息。输出信息选择步骤选择与包括基于在距离信息获取步骤中获取到的距离信息而被检测的对象物在内的距离图像的像素对应的距离信息,作为输出对象。
在此,例如接受作为光源而从LED(Light Emitting Diode)向对象物照射的光的反射光,选择与包括对象物在内的距离图像的像素对应的距离信息作为输出对象,该对象物利用从对与测量对象物的距离进行测量的TOF(Time-of-Flight)传感器获取到的与对象物的距离信息进行检测。
在此,本输出控制程序例如可以在TOF传感器等测距装置内在CPU中读取并执行,也可以在测距装置的外部装置等的CPU中读取并执行。
从照明装置照射的电磁波例如包括广义上的光(紫外光/可视光/红外光)、波长比光短的γ(伽马)射线、X射线、波长比光长的微波、广播用电波(短波、中波、长波)、超声波、弹性波、量子波等。
需要说明的是,在距离信息获取步骤中,也可以为对电磁波的反射进行检测来计算距离信息的结构,例如也可以为从作为外部装置而设置的距离传感器等获取距离信息的结构。
由此,例如能够选择性地只输出与包括在地面放置的对象物在内的像素对应的距离信息,进行输出控制,以不输出只在地面没有对象物的像素部分。
其结果是,能够大幅减少包含从测距装置输出的距离信息的信息的数据量。
发明的效果
根据本发明的测距装置,能够减少包含输出的距离信息的信息的数据量。
附图说明
图1是表示本发明的一个实施方式的测距装置的外观结构的立体图。
图2是图1的测距装置的控制方块。
图3是在图2的测距装置的控制部内形成的控制方块。
图4是对计算以在图2的测距装置中具有的TOF方式计算的与对象物的距离的原理进行说明的图。
图5是表示图1的测距装置与在地面上放置的对象物的位置关系的图。
图6是表示使图5的测距装置的正交坐标形式(三维坐标)围绕X轴旋转角度θ后的正交坐标旋转形式的图。
图7是针对向图6的正交坐标形式的转换进行说明的图。
图8是针对向图6的正交坐标旋转形式的转换进行说明的图。
图9是利用正交坐标旋转形式表示图1的测距装置与在地面上放置的对象物的位置关系的图。
图10是利用正交坐标旋转形式表示图1的测距装置与在地面上开设的孔洞的位置关系的图。
图11是利用正交坐标旋转形式表示图1的测距装置与地面上的斜坡的位置关系的图。
图12是表示由图1的测距装置实施的输出控制方法的处理之中、在实际的测量前实施的校准处理的流程的流程图。
图13是表示由图1的测距装置实施的输出控制方法的处理之中、在实际的距离测量时的处理的流程的流程图。
图14是详细说明在图13的步骤S25的处理中在地面上放置的对象物(物体)的检测流程的流程图。
图15是在图13的步骤S25的处理中检测图10的地面的孔洞时的流程图。
图16是在图13的步骤S25的处理中检测图11的斜坡时的流程图。
具体实施方式
(第一实施方式)
针对具有本发明的一个实施方式的控制部(输出控制装置)10的测距装置20,利用图1~图16说明如下。
(1)测距装置20的结构
如图1所示,本实施方式的测距装置20经由受光透镜22,由拍摄元件23接受从在主体部20a的表面设置的照明装置21向对象物30照射的光L1(电磁波的一个例子)的反射光,获取根据光L1从照射至接受的光的飞行时间(Time of Flight)而计算的距离信息。
而且,如图2所示,测距装置20具有:照明装置21、受光透镜22、拍摄元件23、控制部(输出控制装置)10、存储部25、以及输出部26。
照明装置21例如具有LED,向对象物30照射具有期望波长的光。需要说明的是,在照明装置21设有将从LED照射的光聚集并向对象物30的方向引导的投光透镜(未图示)。
受光透镜22为了从照明装置21向对象物30照射、接受由对象物30反射的反射光、并向拍摄元件23引导而设置。
拍摄元件23具有多个像素,由多个像素的各像素接受由受光透镜22接受的反射光,并将进行了光电转换的电信号向控制部10发送。另外,与由拍摄元件23检测的反射光的受光量对应的电信号用于由控制部10计算各像素的距离信息。
如图2所示,控制部10与照明装置21、拍摄元件23及存储部25连接。而且,控制部10读取在存储部25中保存的照明控制程序,对向对象物30照射光的照明装置21进行控制。更详细地说,控制部10控制照明装置21,以根据与照射光的对象物30的距离、形状、颜色等对象物的性质等照射最佳的光。另外,控制部10基于从拍摄元件23接收到的与各像素对应的电信号,针对各像素计算与对象物30的距离信息。
需要说明的是,针对由测距装置20进行的与对象物30的距离测量原理,将在后面详细地说明。
如图2所示,存储部25与控制部10连接,保存用于控制照明装置21及拍摄元件23的控制程序、以及基于由拍摄元件23检测出的反射光的光量、受光时刻以及反射光的光量而计算的距离信息等数据。此外,存储部25保存后面叙述的距离信息、角度信息、正交坐标系、设置高度、旋转坐标、阈值、以及作为输出对象的像素的坐标值等信息。
输出部26将由后面叙述的输出信息选择部19(参照图3)选择出的与像素对应的距离信息向外部设备输出。
从输出部26输出的与各像素对应的距离信息并非所有像素的信息,而是限定为被选择的与一部分像素对应的信息。因此,能够降低输出负载,并且也能够降低输出目的地即外部设备的后处理的负载。
(2)控制部10的结构
如图3所示,控制部10具有:距离运算部(距离信息获取部)11、角度信息获取部12、三维坐标转换部13、平面检测部14、高度计算部15、坐标旋转运算部16、阈值设定部17、对象物检测部18、以及输出信息选择部19。
距离运算部11基于后面叙述的TOF(Time of Flight)方式的距离测量原理,对与由拍摄元件23拍摄到的灰度图像的各像素对应的、与对象物30的距离信息进行运算。
因为对于构成在经由受光透镜22而接受反射光的拍摄元件23中生成的距离图像的多个像素,反射光与被摄体的入射角度确定,所以,角度信息获取部12获取与各像素分别对应的角度信息。
三维坐标转换部13基于由角度信息获取部12获取到的角度信息,将由距离运算部11获取到的距离信息转换为正交坐标形式的三维坐标(X,Y,Z)(参照图7)。
平面检测部14作为测量与对象物30的距离时的基准,指定检测对象物30所放置的地面FL的像素的范围来检测地面FL(校准处理)。
高度计算部15基于将由平面检测部14检测出的地面FL的距离信息(高度)在三维坐标转换部13转换后的三维坐标(X,Y,Z),计算测距装置20与地面FL的设置高度h。更详细地说,高度计算部15计算使测距装置20的正交坐标系(X,Y,Z)围绕轴旋转地面FL的垂线与测距装置20的光轴形成的角度θ而再次获取到的坐标值(X,Yr,Zr)之中、光轴方向的坐标值Zr,作为设置高度h(参照图6)。
在本实施方式中,高度计算部15计算使测距装置20的正交坐标系(X,Y,Z)围绕轴旋转而再次获取到的多个坐标值(Xr,Yr,Zr)的Z方向的坐标值的平均值,作为设置高度h。
坐标旋转运算部16对使在三维坐标转换部13中由距离信息及角度信息转换后的三维坐标(正交坐标形式)围绕轴旋转后的旋转坐标(正交坐标旋转形式)进行运算(参照图6)。
阈值设定部17设定在由对象物检测部18检测对象物30时利用的规定的阈值。需要说明的是,由阈值设定部17设定的阈值可以根据被检测的对象物30的形态、形状、大小等,适当设定不同的值。
对象物检测部18将由坐标旋转运算部16进行运算后的旋转坐标的高度方向的坐标z与由高度计算部15计算的设置高度h进行比较,当检测到具有高度方向的尺寸的物体时,将该物体检测为在地面FL上放置的对象物30。
输出信息选择部19在构成包括基于由距离运算部11进行运算后的距离信息而被检测的对象物30在内的距离图像的多个像素之中、只选择与包括对象物30在内的像素对应的距离信息作为输出对象并进行输出。
<基于测距装置20的距离测量原理>
针对由本实施方式的测距装置20进行的与对象物的距离测量的原理,利用图4说明如下。
即,在本实施方式中,测距装置20的控制部10(距离运算部11)基于从照明装置21照射的光的投光波与由拍摄元件23接受的光的受光波的相位差Φ(参照图4),计算与对象物30的距离。
在此,相位差Φ由如下的关系式(1)表示。
Φ=atan(y/x)…(1)
(x=a2-a0、y=a3-a1、a0~a3为以90度间隔对受光波进行了四次采样的点的振幅)
而且,从相位差Φ向距离D的转换式由如下的关系式(2)表示。
D=(c/(2×fLED))×(Φ/2π)+DOFFSET…(2)
(c为光速(≒3×108m/s),fLED为LED的投光波的频率,DOFFSET为偏离距离)
由此,接受从照明装置21照射的光的反射光,比较其相位差,由此,距离运算部11利用光速c,能够容易地计算与对象物30的距离。
<选择输出对象的处理>
针对由本实施方式的测距装置20的控制部10选择输出对象的方法,利用附图说明如下。
即,如图5所示,在本实施方式中,测距装置20在地面FL设置的高度h的支柱P1的上端、以向斜下方的安装角度进行安装,假设放置在地面FL上的对象物30存在。
在该情况下,在测距装置20中,对与映射为拍摄元件23的所有像素的物体(对象物30、地面FL等)的距离进行运算,作为与各像素对应的距离信息,保存有以测距装置20为原点的三维坐标(X,Y,Z)。
本实施方式的测距装置20为了从上述与各像素对应的距离信息之中、只选择性地输出与具有对象物30的位置对应的像素的距离信息,实施如下的输出控制处理。
首先,作为事前准备,测距装置20实施计算与地面FL的设置高度h的校准。
具体而言,如图5所示,测距装置20在地面FL上以正交坐标系(X,Y,Z)进行距离的测量,获取各像素的测量结果(X,Y,Z)坐标值。
接着,测距装置20对获取到的结果,在指定的像素范围内进行平面检测,求出平面α的式aX+bY+cZ+d=0的系数a、b、c、d。
需要说明的是,平面检测及a、b、c、d的导出可以灵活运用现有的技术。例如,可以利用Point Cloud Library(点云库)提供的平面检测(Plane model segmentation:平面模型的点云分割)的示例代码来求出(参照http://pointclouds.org/documentation/tutorials/planar_segmentation.html等)。
接着,测距装置20求出地面FL的垂线与测距装置20的正交坐标系的Z轴形成的角度θ。
在此,图6所示的平面α与测距装置20的正交坐标系的Z轴(z+t=0)形成的角度θ由如下的关系式(1)求出。
θ=cos-1(|a×0+b×0+c×1|÷((a2+b2+c2)1/2×(02+02+12)))…(1)
通过利用使正交坐标系围绕X轴旋转θ度后的正交坐标旋转系再次测量距离,能够得到各像素的正交坐标旋转系的测量结果(Xr,Yr,Zr)的坐标值。
接着,测距装置20计算对平面α进行了检测的平面范围内的Zr的平均值,计算该平均值作为与地面FL的高度h。
需要说明的是,针对基于角度信息将拍摄元件23的各像素的距离的测量值转换为三维坐标的处理,利用图7说明如下。
即,如图7所示,测距装置20利用角度θ、φ,将与各像素对应的距离的测量值r向三维坐标X、Y、Z转换。
需要说明的是,图7所示的r、θ、φ及X、Y、Z定义如下。
X=r×sinθcosφ
Y=r×sinθsinφ
Z=r×cosθ
(测量值r为距离矢量r的大小,角度θ为距离矢量r的方向与Z轴形成的角度,角度信息φ为距离矢量r向X-Y平面的投影矢量与X轴形成的角度。)
接着,针对使对与各像素对应的距离的测量值进行了转换后的三维坐标(X,Y,Z)分别围绕X轴、Y轴、Z轴旋转、并向正交坐标旋转系转换的处理,利用图8进行说明。
在此,测距装置20指定围绕X轴、Y轴、Z轴的旋转角度,利用如下的关系式(2),针对所有像素的X、Y、Z坐标,计算旋转后的坐标值Xr、Yr、Zr。
[算式1]
例如,如图8所示,在某像素的三维坐标值为(X,Y,Z)=(0,1,0)的情况下,在围绕X轴旋转90度、围绕Y轴、Z轴无旋转的情况下,旋转后的坐标(Xr,Yr,Zr)=(0,0,1)。
然后,利用如上所述的校准处理,在求出测距装置20的设置高度h后,如图9所示,实际进行与对象物30的距离的测量。
即,以围绕X轴旋转θ度后的正交坐标旋转形式进行距离的测量,获取拍摄元件23的各像素的距离的测量结果(Xr,Yr,Zr)。
此时,在测距装置20中,由阈值设定部17设定用于检测对象物30的规定的阈值S1。
然后,测距装置20将作为测量结果而获取到的坐标(Xr,Yr,Zr)之中的Zr的值与在校准处理中计算的设置高度h的值进行比较,在其差的大小超过规定的阈值S1的情况下,判断该像素中包括对象物30,选择与该像素对应的测量结果的坐标(Xr,Yr,Zr)作为输出对象。
如图9所示,在本实施方式的测距装置20中,例如对在地面FL上放置的对象物30进行检测,选择与该对象物30的距离信息进行输出。
此时,作为用于对在地面FL上放置的对象物30进行检测的阈值,设定阈值S1。
然后,着眼于由正交坐标旋转形式得到的测距结果(Xr,Yr,Zr)的Zr,针对拍摄元件23的各像素的每个像素,进行其差(h-Zr)的运算。
在此,当差(h-Zr)>S1时,判定在该像素位置具有对象物30,选择与该像素对应的距离信息并进行输出。
在本实施方式的测距装置20中,如上所述,利用由TOF方式获取到的与对象物30的距离信息及角度信息,将测量出的距离信息转换为正交坐标旋转形式。然后,测距装置20将设置高度h与Zr值进行比较,由此,将与地面FL的高度差为规定的阈值S1以上的物体所处的位置与只是没有物体的地面的位置进行区分,能够将物体所处的位置检测为对象物30存在的像素。
由此,通过只选择与检测出对象物30的像素对应的距离信息进行输出,避免输出与没有对象物30的地面位置的距离信息等不需要的信息,能够大幅减少输出的数据量。
接着,针对如上所述利用距离信息而被检测的对象物是在地面FL形成的孔洞130a的情况下的处理,利用图10进行说明。
在此,如图10所示,对在地面FL形成的孔洞130a进行检测,只选择其测距结果进行输出。
具体而言,如图10所示,在通过上述的校准处理求出测距装置20的设置高度h后,实际进行与对象物(孔洞130a)的距离的测量。
即,以围绕X轴旋转θ度后的正交坐标旋转形式进行距离的测量,获取拍摄元件23的各像素的距离的测量结果(Xr,Yr,Zr)。
此时,在测距装置20中,由阈值设定部17设定用于检测孔洞130a的规定的阈值S2。
然后,测距装置20将作为测量结果而获取到的所有的像素的坐标(Xr,Yr,Zr)之中Zr的值与在校准处理中计算的设置高度h的值进行比较,在其差(h-Zr)不足规定的阈值S2的情况下,判断在该像素中包括孔洞130a,选择与该像素对应的测量结果的坐标(Xr,Yr,Zr)作为输出对象。
由此,作为地面FL的状态,能够容易地检测在何处具有孔洞130a,并只选择与检测出孔洞130a的像素对应的距离信息进行输出,由此,避免输出与没有孔洞130a的地面FL位置的距离信息等不需要的信息,能够大幅减少输出的数据量。
接着,针对如上所述利用距离信息而被检测的对象物是在地面FL形成的高度发生变化的斜坡130b的情况下的处理,利用图11进行说明。
在此,如图11所示,对在地面FL高度发生变化的斜坡130b进行检测,只选择该测距结果进行输出。
具体而言,如图11所示,在通过上述的校准处理求出测距装置20的设置高度h后,实际进行与对象物(斜坡130b)的距离的测量。
即,以围绕X轴旋转θ度后的正交坐标旋转形式进行距离的测量,获取拍摄元件23的各像素的距离的测量结果(Xr,Yr,Zr)。
此时,在测距装置20中,由阈值设定部17设定用于检测斜坡130b的规定的阈值S3。
然后,测距装置20着眼于作为测量结果而获取到的所有像素的坐标(Xr,Yr,Zr)之中Zr的值,求出邻接的上、下、左、右的像素间的变化量(ΔZr/ΔXr)+(ΔZr/ΔYr)。
并且,在(ΔZr/ΔXr)+(ΔZr/ΔYr)比规定的阈值S3大的情况下,作为与检测出斜坡130b的该像素对应的测距结果,选择并输出。
由此,作为地面FL的状态,只选择与检测出斜坡130b的像素对应的距离信息并进行输出,由此,避免输出与没有斜坡130b的地面FL位置的距离信息等不需要的信息,能够大幅减少输出的数据量。
<输出控制方法的处理流程>
本实施方式的测距装置20利用如上的结构,依照图12至图16所示的流程图,实施输出控制方法。
即,在图12中,如上所述,作为实施与实际的对象物30的距离的测量之前的阶段,实施校准处理。
在步骤S11中,测距装置20的距离运算部11根据拍摄元件23的所有像素的相位差信息,计算距离信息。
接着,在步骤S12中,基于在步骤S11中计算的各像素的距离信息、以及由角度信息获取部12获取到的与各像素对应的角度信息,三维坐标转换部13由距离信息转换为正交坐标形式的三维坐标(X,Y,Z)。
接着,在步骤S13中,平面检测部14对设置有测距装置20的地面FL上的规定的平面范围,实施平面检测处理。
接着,在步骤S14中,高度计算部15计算测距装置20的三维坐标的Z轴与地面FL的垂线形成的角度θ(参照图6)。
接着,在步骤S15中,坐标旋转运算部16对在所有的像素中使三维坐标围绕三个轴旋转指定的角度θ的正交坐标旋转形式的坐标(Xr,Yr,Zr)进行运算。
接着,在步骤S16中,高度计算部15在地面FL的规定的平面范围内求出Zr的平均值,将该值设定为设置高度h。
在本实施方式的测距装置20中,作为通过如上的处理来测量与实际的对象物30的距离的前阶段,实施校准处理,设定为了检测对象物30的位置而使用的作为基准的测距装置20的设置高度h。
然后,在图13中,在实施了图12所示的校准处理后,实施进行与实际的对象物30的距离测量的工序。
即,在步骤S21中,距离运算部11利用在拍摄元件23的所有像素中获取到的相位差信息,计算与对应于多个像素的各像素的对象物的距离信息。
接着,在步骤S22中,三维坐标转换部13基于由角度信息获取部12获取到的每个像素的角度信息,将在拍摄元件23的所有像素中计算的距离信息转换为正交坐标形式的三维坐标(X,Y,Z)。
接着,在步骤S23中,坐标旋转运算部16使与所有的像素对应的三维坐标围绕X/Y/Z三个轴旋转规定的角度θ,对旋转坐标(Xr,Yr,Zr)进行运算。
接着,在步骤S24中,为了针对拍摄元件23的所有像素逐一确认是否为具有作为输出对象的距离信息的像素,例如为了从拍摄元件23的所有像素之中左下端开始确认,设定为i=0、j=0。
接着,在步骤S25中,将像素(i,j)旋转后的Z轴坐标值Zr与设置高度h进行比较,将判定为具有根据作为检测对象的对象物30而设定的规定的阈值S1、S2、S3以上的差的像素作为选择对象,保存坐标(Xr,Yr,Zr)。
需要说明的是,针对步骤S25的处理内容,因为对象物30的种类不同,所以处理的详细情况将在后面进行详细的叙述。
接着,在步骤S26中,作为i=i+1,针对邻接的像素确认是否为具有作为输出对象的距离信息的像素。
接着,在步骤S27中,判定是否满足i<Max_i的条件。即,在步骤S27中,确认拍摄元件23的像素在横向上是否从端至端进行了验证。
在此,当判定尚未验证至横向的端(MAX)时,返回步骤S25,进行是否是具有作为输出对象的距离信息的像素的验证。另一方面,当判定已验证至横向的端(MAX)时,移动向步骤S28。
接着,在步骤S28中,因为已经在步骤S27中判定已验证至横向最大的位置(端)的像素,所以,为了移动到下一列的像素,则为i=0、j=j+1。
接着,在步骤S29中,判定是否满足j<Max_j的条件。即,在步骤S29中,确认拍摄元件23的像素是否在纵向上从端至端进行了验证。
在此,在判定尚未验证至纵向的端(MAX)时,返回步骤S25,进行是否是具有作为输出对象的距离信息的像素的验证。另一方面,当判定已验证至纵向的端(MAX)时,移动向步骤S30。
接着,在步骤S30中,因为针对拍摄元件23的所有像素已完成验证,所以,依据步骤S25中的验证结果,输出与被选择的像素对应的坐标(Xr,Yr,Zr)。
由此,通过只选择与检测出对象物30的像素对应的距离信息并进行输出,避免输出与没有对象物30的地面FL位置对应的所有的像素的距离信息,能够大幅减少输出的数据量。
<检测对象为对象物30的情况>
在此,针对上述的图13的步骤S25中验证拍摄元件23的各像素是否具有作为输出对象的距离信息的处理、特别是对象物30为在地面FL放置的物体的情况下的处理,利用图14进行详细的说明。
即,在步骤S31中,从通过图12所示的校准处理而求出的与地面FL的高度h减去与对象像素(i,j)的正交坐标旋转系的铅垂方向对应的坐标Zr值,计算(h-Zr)。
接着,在步骤S32中,为了判定有无在地面FL放置的对象物30,判定步骤S31中减法处理的结果(h-Zr)是否比由阈值设定部17设定的规定的阈值S1大。
在此,当判定减法处理的结果(h-Zr)比阈值S1大时,可识别对象像素中包括的对象物30是与地面FL的高度尺寸为阈值以上的物体,进入步骤S33。
另一方面,当判定减法处理的结果(h-Zr)比阈值S1小时,可识别对象像素中包括的对象物30是几乎与地面FL没有高度尺寸的物体或是地面FL,进入步骤S35。
接着,在步骤S33中,因为在步骤S32中已经识别在对象像素中包括的对象物30是与地面FL的高度尺寸为阈值以上的物体,所以对象物检测部18判定在地面FL上具有对象物30。
接着,在步骤S34中,输出信息选择部19选择判定具有对象物30的对象像素(i,j)的坐标(Xr,Yr,Zr)及其对象物ID(01)作为输出对象。
接着,在步骤S35中,因为在步骤S32中已经识别在对象像素中包括的对象物30是与地面FL几乎没有高度尺寸的物体或者是地面FL,所以,判定在与该像素对应的地面FL上的位置没有对象物,进入步骤S26。
由此,利用为了判定有无在地面FL放置的物体(对象物30)而设定的阈值S1,能够容易地判定对象像素是否包括在地面FL上放置的对象物30。
<检测对象为孔洞130a的情况>
在此,针对上述的图13的步骤S25中验证拍摄元件23的各像素是否具有作为输出对象的距离信息的处理、特别是对象物30为在地面FL形成的孔洞130a(参照图10)的情况下的处理,利用图15进行详细的说明。
即,在步骤S41中,从通过图12所示的校准处理而求出的与地面FL的高度h减去与对象像素(i,j)的正交坐标旋转系的铅垂方向对应的坐标Zr值,计算(h-Zr)。
接着,在步骤S42中,为了判定有无在地面FL形成的孔洞130a,判定步骤S41的减法处理的结果(h-Zr)是否比由阈值设定部17设定的规定的阈值S2小。
即,在对象物为孔洞130a的情况下,由测距装置20获取的对应像素的距离信息比与地面FL的设置高度h大。因此,在此,依据(h-Zr)的值在与孔洞130a对应的像素中为负值,判定是否比为了判定而设定的阈值S2小。
在此,当判定减法处理的结果(h-Zr)比阈值S2小时,可识别对象像素中包括的对象物30是处于地面FL下的孔洞130a,进入步骤S43。
另一方面,当判定减法处理的结果(h-Zr)比阈值S2大时,可识别对象像素中包括的对象物30是与地面FL几乎没有深度尺寸的物体或者是地面FL,进入步骤S45。
接着,在步骤S43中,因为在步骤S42中已经判定对象像素中包括的对象物30与地面FL的高度尺寸比阈值S2小,所以对象物检测部18判定在地面FL具有孔洞130a。
接着,在步骤S44中,输出信息选择部19选择已判定具有孔洞130a的对象像素(i,j)的坐标(Xr,Yr,Zr)及其对象物ID(02)作为输出对象。
接着,在步骤S45中,因为在步骤S42已经识别出对象像素中包括的对象物是与地面FL几乎没有深度尺寸的物体或者是地面FL,所以判定在该像素对应的地面FL上的位置没有孔洞130a,进入步骤S26。
由此,利用为了判定有无在地面FL形成的孔洞130a而设定的阈值S2,能够容易地判定对象像素是否包括在地面FL形成的孔洞130a。
<检测对象为斜坡130b的情况>
在此,针对上述的图13的步骤S25中验证拍摄元件23的各像素是否具有作为输出对象的距离信息的处理、特别是对象物30为地面FL上的斜坡130b(参照图11)的情况下的处理,利用图16,详细地进行说明。
即,在步骤S51中,为了判定有无高度方向上的尺寸发生变化的斜坡130b,计算某像素位置(i,j)和与之在横向负值侧邻接的像素位置(i-1,j)的Zr的变化量ΔZr/ΔXr。此外,计算某像素位置(i,j)和与之在纵向负值侧邻接的像素位置(i,j-1)的Zr的变化量ΔZr/ΔYr。
接着,在步骤S52中,为了判定地面FL上有无斜坡130b,判定在步骤S51中计算的ΔZr/ΔXr与ΔZr/ΔYr之和是否比由阈值设定部17设定的规定的阈值S3大,即,是否满足{(ΔZr/ΔXr)+(ΔZr/ΔYr)}>阈值S3这样的条件式。
即,在对象物为斜坡130b的情况下,依据与在横向及纵向上邻接的像素的高度方向的变化量为规定值以上,判定该变化量的纵、横之和是否比为了判定而设定的阈值S3大。
在此,当判定判定结果比阈值S3大时,可以识别存在对象像素中包括的对象物30为斜坡130b的可能性,进入步骤S53。
另一方面,当判定判定结果比阈值S3小时,可以识别对象像素中不包括斜坡130b,进入步骤S57。
接着,在步骤S53中,计算某像素位置(i,j)和与之在横向正值侧邻接的像素位置(i+1,j)的Zr的变化量ΔZr/ΔX。此外,计算某像素位置(i,j)和与之在纵向正值侧邻接的像素位置(i,j+1)的Zr的变化量ΔZr/ΔYr。
接着,在步骤S54中,判定在步骤S53中计算的ΔZr/ΔXr与ΔZr/ΔYr之和是否比阈值S3大,即,是否满足{(ΔZr/ΔXr)+(ΔZr/ΔYr)}>S3这样的条件式。
在此,当判定判定结果比阈值S3大时,可以识别对象像素中包括的对象物30为斜坡130b,进入步骤S55。
另一方面,当判定判定结果比阈值S3小时,可以识别对象像素不包括斜坡130b,进入步骤S57。
接着,在步骤S55中,因为在步骤S54中已判定ΔZr/ΔXr与ΔZr/ΔYr之和比阈值S3大,所以对象物检测部18判定在地面FL具有斜坡130b。
接着,在步骤S56中,输出信息选择部19选择已判定为具有斜坡130b的对象像素(i,j)的坐标(Xr,Yr,Zr)及其对象物ID(03)作为输出对象。
接着,在步骤S57中,因为在步骤S54已判定ΔZr/ΔXr与ΔZr/ΔYr之和比阈值S3小,所以可以识别对象物的高度方向上的尺寸在邻接的像素间几乎没有变化,因而判定在地面上没有斜坡,进入步骤S26。
由此,利用为了判定地面FL上有无斜坡130b而设定的阈值S3,能够容易地判定在对象像素中是否包括在地面FL上设置的斜坡130b。
<地面FL的状态的检测处理>
本实施方式的测距装置20如上所述,通过针对拍摄元件23所包括的所有像素,利用距离信息判定是否包括对象物(物体、孔洞、斜坡等),能够只选择包括对象物的对象像素所具有的距离信息进行输出。
另外,本实施方式的测距装置20此外通过连续实施图14至图16的流程图,也能够检测地面FL的状态。
具体而言,针对图13的步骤S25的处理,连续实施图14至图16所示的流程图,由此,利用三个阈值S1、S2、S3,作为地面FL的状态,可以检测有无物体、有无孔洞、有无斜坡等。
因此,首先,依照图14所示的流程图,利用阈值S1实施判定处理,只要检测出在地面FL上具有高度尺寸的物体,就可判定具有在地面FL上放置的对象物30,在未检测出物体的情况下,依照图15所示的流程图,进行判定处理。
然后,依照图15所示的流程图,利用阈值S2实施判定处理,只要检测出在地面FL具有深度尺寸的孔洞130a,就可判定具有在地面FL形成的孔洞130a,在未检测出孔洞130a的情况下,依照图16所示的流程图,进行判定处理。
最后,依照图16所示的流程图,利用阈值S3实施判定处理,只要在地面FL上检测出斜坡130b,则可判定在地面FL上具有斜坡130b,在未检测出斜坡130b的情况下,结束地面FL的状态检测处理,进入步骤S26。
由此,通过利用不同的阈值S1、S2、S3来实施判定处理,例如在将测距装置20搭载在可在地面FL上行驶的输送装置的情况下,也能够准确地判定地面FL有无孔洞130a等凹凸、有无障碍物等,顺利地实施输送作业。
[其它实施方式]
上面,针对本发明的一个实施方式进行了说明,但本发明不限于上述实施方式,在不脱离发明主旨的范围内可以进行各种变更。
(A)
在上述实施方式中,作为输出控制装置及输出控制方法,例举了实现本发明的例子进行了说明。但是,本发明不限于此。
例如,也可以将上述输出控制装置的输出控制方法作为在计算机执行的输出控制程序来实现本发明。
该程序在输出控制装置上搭载的存储器(存储部)中进行保存,CPU读取在存储器中保存的输出控制程序,在硬件中执行各步骤。更具体而言,CPU读取输出控制程序,执行上述的距离信息获取步骤、以及输出信息选择步骤,由此能够得到与上述相同的效果。
另外,本发明也可以作为保存输出控制装置的输出控制程序的存储介质来实现。
(B)
在上述实施方式中,作为距离信息获取部,将以TOF方式对与距离图像的各像素对应的距离信息进行运算的距离运算部11作为例子例举进行了说明。但是,本发明不限于此。
例如,也可以为从外部的测距装置获取以TOF方式求出的与距离图像的各像素对应的距离信息的结构。
即,也可以为本发明的输出控制装置与测距装置分开设置,从测距装置获取距离信息,选择与作为输出对象的像素对应的距离信息进行输出的结构。
(C)
在上述实施方式中,例举通过运算计算测距装置20的安装角度θ的例子进行了说明。但是,本发明不限于此。
例如,在预先知道测距装置的安装角度的情况下,也可以为利用该安装角度θ求出设置高度等的结构。
(D)
在上述实施方式中,例举对从照明装置21向对象物照射的光的反射光进行检测、对与对象物的距离进行测量的例子进行了说明。但是,本发明不限于此。
例如,也可以为如下的结构,即,从照明装置向对象物除了照射广义上的光(紫外光/可视光/红外光)以外,还照射波长比光短的γ(伽马)射线、X射线、波长比光长的微波、广播用电波(短波、中波、长波)等电磁波,检测其反射,由此来测量与对象物的距离。
即,向对象物照射的光也可以为具有该反射量与距离的平方成反比例进行衰减的性质的其它电磁波。
(E)
在上述实施方式中,作为利用距离信息进行检测的对象物,以在地面FL上放置的物体、孔洞130a、斜坡130b为例进行了说明。但是,本发明不限于此。
例如,作为可检测的对象物,也可以为上述以外的物体。
在该情况下,通过利用根据各物体的形态、大小、形状等而设定的阈值,能够检测有无各物体。
工业实用性
本发明的测距装置具有能够减少包含输出的距离信息的信息的数据量这样的效果,所以,例如可以广泛应用在TOF传感器等测距装置中。
附图标记说明
10控制部(输出控制装置);11距离运算部(距离信息获取部);12角度信息获取部;13三维坐标转换部;14平面检测部;15高度计算部;16坐标旋转运算部;17阈值设定部;18对象物检测部;19输出信息选择部;20测距装置;20a主体部;21照明装置;22受光透镜;23拍摄元件;25存储部;26输出部;30对象物;130a孔洞;130b斜坡;D距离;FL地面;L1光;P1支柱。
Claims (17)
1.一种输出控制装置,控制在包含与对象物的距离信息的距离图像中包含的信息的输出,该输出控制装置的特征在于,具有:
距离信息获取部,其根据从照明装置向所述对象物照射的电磁波的反射量,获取与所述对象物的距离信息;
输出信息选择部,其选择与所述距离图像的像素对应的距离信息作为输出对象,所述距离图像包括基于由所述距离信息获取部获取到的所述距离信息而被检测的所述对象物。
2.如权利要求1所述的输出控制装置,其特征在于,
还具有对象物检测部,所述对象物检测部当基于由所述距离信息获取部获取到的所述距离信息检测与地面具有高度的物体时,将所述物体检测为所述对象物。
3.如权利要求1所述的输出控制装置,其特征在于,
还具有角度信息获取部,所述角度信息获取部获取与在所述距离图像中包括的各像素对应的角度信息。
4.如权利要求3所述的输出控制装置,其特征在于,
还具有三维坐标转换部,所述三维坐标转换部基于由所述角度信息获取部获取到的所述角度信息,将由所述距离信息获取部获取到的所述距离信息向三维坐标进行转换。
5.如权利要求4所述的输出控制装置,其特征在于,
还具有对所述对象物放置的地面进行检测的平面检测部。
6.如权利要求5所述的输出控制装置,其特征在于,
还具有高度计算部,所述高度计算部基于在所述三维坐标转换部将由所述平面检测部检测出的所述地面的所述距离信息转换后的三维坐标,计算测距装置的设置高度。
7.如权利要求6所述的输出控制装置,其特征在于,
所述高度计算部计算使所述测距装置的正交坐标系围绕轴旋转由所述平面检测部检测出的所述地面的垂线与所述测距装置的光轴形成的角度而再次获取到的坐标值的所述光轴方向的坐标值,作为所述设置高度。
8.如权利要求7所述的输出控制装置,其特征在于,
所述高度计算部计算使所述测距装置的正交坐标系围绕轴旋转而再次获取到的多个坐标值之中、铅垂方向的坐标值的平均值,作为所述设置高度。
9.如权利要求8所述的输出控制装置,其特征在于,
还具有坐标旋转运算部,所述坐标旋转运算部对使在所述三维坐标转换部根据所述距离信息及所述角度信息转换后的三维坐标围绕轴旋转后的旋转坐标进行运算。
10.如权利要求9所述的输出控制装置,其特征在于,
还具有对象物检测部,所述对象物检测部将由所述坐标旋转运算部运算出的所述旋转坐标的高度方向的坐标与由所述高度计算部计算的所述设置高度进行比较,当检测到具有高度方向的尺寸的物体时,将所述物体检测为所述对象物。
11.如权利要求10所述的输出控制装置,其特征在于,
还具有阈值设定部,所述阈值设定部设定在所述对象物检测部进行所述对象物的检测时所利用的规定的阈值。
12.如权利要求10所述的输出控制装置,其特征在于,
所述输出信息选择部选择包括由所述对象物检测部检测出的所述对象物在内的各像素的距离信息进行输出。
13.一种测距装置,其特征在于,具有:
权利要求1至12中任一项所述的输出控制装置;
照射装置,其向所述对象物照射电磁波;
受光部,其对从所述照明装置照射的所述电磁波的反射量进行检测。
14.如权利要求13所述的测距装置,其特征在于,
还具有存储部,所述存储部保存所述距离信息、与所述距离图像中包括的各像素对应的角度信息、所述测距装置的正交坐标系、设置高度、使根据所述距离信息及所述角度信息转换后的三维坐标围绕轴旋转后的旋转坐标、所述对象物的检测时利用的阈值、以及作为所述输出对象的像素的坐标值中的至少一种。
15.如权利要求13所述的测距装置,其特征在于,
还具有输出部,所述输出部将与由所述输出信息选择部选择的所述像素对应的所述距离信息向外部设备输出。
16.一种输出控制方法,控制在包含与对象物的距离信息的距离图像中包含的信息的输出,该输出控制方法的特征在于,具有:
距离信息获取步骤,其根据从照明装置向所述对象物照射的电磁波的反射量,获取与所述对象物的距离信息;
输出信息选择步骤,其选择与所述距离图像的像素对应的距离信息作为输出对象,所述距离图像包括基于在所述距离信息获取步骤中获取到的所述距离信息而被检测的所述对象物。
17.一种输出控制程序,控制在包含与对象物的距离信息的距离图像中包含的信息的输出,该输出控制程序的特征在于,
使具有如下步骤的输出控制方法在计算机中执行,即,
距离信息获取步骤,其根据从照明装置向所述对象物照射的电磁波的反射量,获取与所述对象物的距离信息;
输出信息选择步骤,其选择与所述距离图像的像素对应的距离信息作为输出对象,所述距离图像包括基于在所述距离信息获取步骤中获取到的所述距离信息而被检测的所述对象物。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021064639A JP2022160108A (ja) | 2021-04-06 | 2021-04-06 | 出力制御装置およびこれを備えた測距装置、出力制御方法、出力制御プログラム |
JP2021-064639 | 2021-04-06 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115201836A true CN115201836A (zh) | 2022-10-18 |
Family
ID=83282721
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210348328.7A Pending CN115201836A (zh) | 2021-04-06 | 2022-04-01 | 输出控制装置以及测距装置、输出控制方法、输出控制程序 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20220319025A1 (zh) |
JP (1) | JP2022160108A (zh) |
CN (1) | CN115201836A (zh) |
DE (1) | DE102022107215A1 (zh) |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017122690A (ja) | 2016-01-08 | 2017-07-13 | 花王株式会社 | ヒト計測システムの座標校正方法 |
JP7292171B2 (ja) | 2019-10-10 | 2023-06-16 | ルネサスエレクトロニクス株式会社 | 半導体装置およびその製造方法 |
-
2021
- 2021-04-06 JP JP2021064639A patent/JP2022160108A/ja active Pending
-
2022
- 2022-03-16 US US17/695,877 patent/US20220319025A1/en active Pending
- 2022-03-28 DE DE102022107215.0A patent/DE102022107215A1/de active Pending
- 2022-04-01 CN CN202210348328.7A patent/CN115201836A/zh active Pending
Also Published As
Publication number | Publication date |
---|---|
JP2022160108A (ja) | 2022-10-19 |
DE102022107215A1 (de) | 2022-10-06 |
US20220319025A1 (en) | 2022-10-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11693115B2 (en) | Determining positional information of an object in space | |
US11320536B2 (en) | Imaging device and monitoring device | |
US9470548B2 (en) | Device, system and method for calibration of camera and laser sensor | |
WO2019163673A1 (ja) | 光測距装置 | |
US20170300061A1 (en) | Methods and systems for obstacle detection using structured light | |
US20070058838A1 (en) | Object position detecting apparatus, map creating apparatus, autonomous mobile apparatus, object position detecting method, and computer program product for object position detection | |
US10346995B1 (en) | Remote distance estimation system and method | |
CN115201841A (zh) | 地面状态检测装置以及测距装置、地面状态检测方法、地面状态检测程序 | |
CN102401901B (zh) | 测距系统及测距方法 | |
CN113099120A (zh) | 深度信息获取方法、装置、可读存储介质及深度相机 | |
CN115201836A (zh) | 输出控制装置以及测距装置、输出控制方法、输出控制程序 | |
JP6895074B2 (ja) | 物体検出システム及び物体検出プログラム | |
JP5802917B2 (ja) | 距離画像カメラおよびこれを用いた距離測定方法 | |
CN105929819B (zh) | 一种控制电子设备的方法及电子设备 | |
JP2010190793A (ja) | 距離計測装置及び距離計測方法 | |
JP7259660B2 (ja) | イメージレジストレーション装置、画像生成システム及びイメージレジストレーションプログラム | |
JP5439948B2 (ja) | 誘導装置及び目標判定装置 | |
KR101907875B1 (ko) | 퓨전 탐지 시스템, 탐지 프로세서, 레이더 장치 및 물체 탐지 방법 | |
JP5743635B2 (ja) | 異物検知装置 | |
US11131543B2 (en) | Three-dimensional measuring apparatus and robot system | |
JP6812997B2 (ja) | 検出装置及び検出方法 | |
CN113508309A (zh) | 距离图像传感器以及角度信息获取方法 |
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 |