JP2017083223A - Distance measurement device and traveling device - Google Patents

Distance measurement device and traveling device Download PDF

Info

Publication number
JP2017083223A
JP2017083223A JP2015209679A JP2015209679A JP2017083223A JP 2017083223 A JP2017083223 A JP 2017083223A JP 2015209679 A JP2015209679 A JP 2015209679A JP 2015209679 A JP2015209679 A JP 2015209679A JP 2017083223 A JP2017083223 A JP 2017083223A
Authority
JP
Japan
Prior art keywords
area
distance
sub
measurement data
subarea
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
Application number
JP2015209679A
Other languages
Japanese (ja)
Other versions
JP6875790B2 (en
Inventor
達朗 黒田
Tatsuro Kuroda
達朗 黒田
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.)
Sharp Corp
Original Assignee
Sharp Corp
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 Sharp Corp filed Critical Sharp Corp
Priority to JP2015209679A priority Critical patent/JP6875790B2/en
Publication of JP2017083223A publication Critical patent/JP2017083223A/en
Application granted granted Critical
Publication of JP6875790B2 publication Critical patent/JP6875790B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

PROBLEM TO BE SOLVED: To provide data for determining an obstacle by a simple calculation that only involves dividing distance measurement data acquired at all scan angles of a detection area into subareas of a plurality of scan angles, and comparing the value of distance measurement data in each subarea with a prescribed threshold.SOLUTION: A distance measurement device 1 scans a detection area of a first prescribed angle and thereby acquires information for up to an object M to be measured, for each of second prescribed angles. The distance measurement device 1 comprises: a by-subarea distance measurement data acquisition unit 17 for dividing a detection area of a first prescribed angle into a plurality of subareas of a third prescribed angle each, and acquiring distance measurement data per second prescribed angle for each subarea; a by-subarea threshold information storage unit 18 in which at least one threshold of distance measurement data is stored for each subarea; and a by-subarea measurement point calculation unit 19 for calculating, for each subarea, the number of measurement points per distance area based on the threshold on the basis of the value and threshold of distance measurement data.SELECTED DRAWING: Figure 1

Description

本発明は、測距装置および走行装置に関し、より詳しくは、簡単な演算で検知エリアにおける障害物の判定が可能な測距装置およびこの測距装置を備えた走行装置に関する。   The present invention relates to a distance measuring device and a traveling device, and more particularly to a distance measuring device capable of determining an obstacle in a detection area by a simple calculation and a traveling device including the distance measuring device.

センサ情報を利用して自己の動作を決定し、自律的に行動する自律走行装置(自動走行装置とも呼ばれる)が開発されている。例えば光学式の測距装置(測距センサ)は、測定範囲内に存在する物体との距離を計測することができ、1次元または2次元の距離データマップを取得することができるため、自律走行装置が障害物を検知して回避するための安全装置として用いられている。   An autonomous traveling device (also referred to as an automatic traveling device) has been developed that determines its own operation using sensor information and acts autonomously. For example, an optical distance measuring device (ranging sensor) can measure a distance to an object existing in the measurement range and can acquire a one-dimensional or two-dimensional distance data map, so that it can travel autonomously. The device is used as a safety device for detecting and avoiding obstacles.

例えば、特許文献1には、車両用測距装置のレーザレーダ装置が、レーザ光を2次元スキャンするスキャナと制御回路とを備えており、制御回路は、スキャナの検出エリア左右端において、その左右端にかけて受光レベルが上昇し、ピークに達しない分布が有るか否かを判断し、さらに各検出領域における距離値が略等しいか否かを判断して、検出エリアの近傍に物体が有るか否かを判断している。   For example, in Patent Document 1, a laser radar device of a vehicle range finder includes a scanner for two-dimensionally scanning laser light and a control circuit. The control circuit is arranged at the left and right ends of the detection area of the scanner. It is judged whether there is a distribution where the light receiving level rises toward the end and does not reach the peak, and further, it is judged whether the distance values in each detection area are substantially equal, and whether there is an object in the vicinity of the detection area Judgment.

特開2007−240384号公報JP 2007-240384 A

2次元レーザレーダ装置で自走ロボットが障害物検知をする際に、障害物が規定したエリア内に検知された場合、減速または停止するようなプログラムが用いられる。センサ内でハードウェア的にそれらのエリア検知機能を組み込んでいる場合には、応答時間は大きな問題にならないが、ロボットに搭載されたプロセッサで処理する場合は、プロセッサの処理能力に制限があることが多い。2次元レーザレーダ装置は放射状にレーザを出射し、各角度で測距データを出力するためデータとして、測距データ(径方向の距離)と角度(レーザーの発射された方向)の極座標系のデータが得られる。このため、例えば、検知エリアとして矩形のエリアを想定した場合、2次元X−Y座標系に変換すると、計算の負荷が重たいものになる。高速で移動するロボットの場合は検知判定結果を移動速度に見合ったレートで出力する必要があるため、判定計算がネックとなり応答速度が遅れると障害物への衝突を招く。特許文献1に開示されたレーザレーダ装置においては、スキャン位置に応じた測距データを取得しているが、測距データの分布を判断する必要があるため、その処理をより軽くすることが望ましい。   When the self-propelled robot detects an obstacle with the two-dimensional laser radar device, a program is used that decelerates or stops when the obstacle is detected within the defined area. When these area detection functions are incorporated in the sensor in hardware, the response time is not a big problem, but when processing with the processor installed in the robot, the processing capacity of the processor is limited. There are many. The two-dimensional laser radar device emits a laser beam radially and outputs distance measurement data at each angle. As data, distance measurement data (radial distance) and angle (laser emission direction) polar coordinate system data Is obtained. For this reason, for example, when a rectangular area is assumed as the detection area, the calculation load becomes heavy when converted into a two-dimensional XY coordinate system. In the case of a robot that moves at high speed, it is necessary to output the detection determination result at a rate corresponding to the moving speed. Therefore, if the response speed is delayed due to determination calculation, a collision with an obstacle is caused. In the laser radar device disclosed in Patent Document 1, distance measurement data corresponding to the scan position is acquired. However, since it is necessary to determine the distribution of the distance measurement data, it is desirable to make the processing lighter. .

本発明は、これらの実情に鑑みてなされたものであり、測距対象となる検知エリアに対する全スキャン角度で取得された測距データを、複数のスキャン角度のサブエリアに分割し、各サブエリア内における測距データの値と所定の閾値とを比較するだけの簡単な計算で、障害物判定のためのデータを提供できる測距装置、および、この測距装置を搭載した走行装置を提供することを、その目的とする。   The present invention has been made in view of these circumstances, and distance measurement data acquired at all scan angles with respect to a detection area to be distance-measured is divided into a plurality of scan angle sub-areas. A distance measuring device that can provide data for determining an obstacle by simple calculation by simply comparing the value of distance measuring data with a predetermined threshold, and a traveling device equipped with the distance measuring device are provided. That is the purpose.

上記課題を解決するために、本発明の第1の技術手段は、第1の所定角度のエリアをスキャンすることによって第2の所定角度毎に被測定物までの情報を取得する測距装置であって、前記第1の所定角度のエリアを複数のそれぞれ第3の所定角度のサブエリアに分割し、該サブエリア毎に前記第2の所定角度毎の測距データを取得するサブエリア別測距データ取得部と、前記サブエリア別に少なくとも1つの測距データの閾値を格納したサブエリア別閾値情報記憶部と、前記サブエリア毎に、前記サブエリア別測距データ取得部からの前記測距データの値と前記サブエリア別測距データ取得部からの前記閾値とに基づいて、前記閾値に基づく距離エリア毎の側点数を算出するサブエリア別測点数算出部、を備えたことを特徴とするものである。   In order to solve the above problems, a first technical means of the present invention is a distance measuring device that acquires information up to the object to be measured at every second predetermined angle by scanning an area of a first predetermined angle. The first predetermined angle area is divided into a plurality of third predetermined angle sub-areas, and distance measurement data for each second predetermined angle is obtained for each sub-area. A distance data acquisition unit; a threshold information storage unit for each sub-area storing a threshold value of at least one distance measurement data for each sub-area; and the distance measurement from the distance data acquisition unit for each sub-area for each sub-area A sub-area-specific measurement point number calculation unit that calculates the number of side points for each distance area based on the threshold value, based on the data value and the threshold value from the sub-area-specific distance measurement data acquisition unit, To do

第2の技術手段は、第1の技術手段において、前記閾値は、前記サブエリア毎に異なる値であることを特徴とするものである。   According to a second technical means, in the first technical means, the threshold value is different for each sub-area.

第3の技術手段は、第1または第2の技術手段において、前記サブエリアが、前記第1の所定角度を2等分する中央の軸に対して対称となるように設けられていることを特徴とするものである。   According to a third technical means, in the first or second technical means, the subarea is provided so as to be symmetric with respect to a central axis that bisects the first predetermined angle. It is a feature.

第4の技術手段は、第1から第3のいずれか1の技術手段において、前記第3の所定角度が前記サブエリア毎に異なることを特徴とするものである。   According to a fourth technical means, in any one of the first to third technical means, the third predetermined angle is different for each sub-area.

第5の技術手段は、第1から第4のいずれか1の技術手段において、前記測距装置は、2次元レーザレーザであることを特徴とするものである。   According to a fifth technical means, in any one of the first to fourth technical means, the distance measuring device is a two-dimensional laser laser.

第6の技術手段は、第1から第5のいずれか1に記載の測距装置を備えた走行装置である。   A sixth technical means is a traveling device including the distance measuring device according to any one of the first to fifth aspects.

第7の技術手段は、第6の技術手段であって、該走行装置を駆動する駆動部と、該駆動部を制御する制御部を有し、該制御部は、前記サブエリア別測点数算出部からの前記閾値に基づく距離エリア毎の側点数に基づいて、通常走行、徐行、または、停止を決定する障害物判定部を備えることを特徴とするものである。   A seventh technical means is a sixth technical means, and includes a drive unit that drives the traveling device and a control unit that controls the drive unit, and the control unit calculates the number of measurement points for each sub-area. An obstacle determination unit is provided that determines normal running, slowing down, or stopping based on the number of side points for each distance area based on the threshold value from the unit.

第8の技術手段は、第7の技術手段において、走行状態に応じて、前記障害物判定部は、特定の前記サブエリアの前記閾値に基づく距離エリア毎の側点数に基づいて、通常走行、徐行、または、停止を決定することを特徴とするものである。   According to an eighth technical means, in the seventh technical means, according to the traveling state, the obstacle determination unit performs normal traveling based on the number of side points for each distance area based on the threshold value of the specific sub-area. It is characterized by determining slow speed or stopping.

第9の技術手段は、第6または第7の技術手段において、前記障害物判定部は、所定の距離以内の測距データによる側点数を用いることなく、通常走行、徐行、または、停止を決定することを特徴とするものである。   According to a ninth technical means, in the sixth or seventh technical means, the obstacle determining unit determines normal running, slowing down or stopping without using a side score based on distance measurement data within a predetermined distance. It is characterized by doing.

本発明によれば、測距対象となる検知エリアをスキャンして取得した測距データを、複数のスキャン角度毎のサブエリアに分割し、各サブエリア内における測距データの値と所定の閾値とを比較するだけで、障害物判定のためのデータを得ることができる。このため、座標変換を伴うことなく簡単な計算で検知エリアにおける障害物判定が可能となり、低速、小規模なマイコンでも障害物検知が実現できる。   According to the present invention, the distance measurement data acquired by scanning the detection area to be distance measurement is divided into a plurality of sub-areas for each scan angle, and the value of the distance measurement data in each sub-area and a predetermined threshold value It is possible to obtain data for determining an obstacle simply by comparing. For this reason, it is possible to determine an obstacle in the detection area with simple calculation without coordinate conversion, and obstacle detection can be realized even with a low-speed and small-scale microcomputer.

本発明の第1の実施形態に係る走行装置の一構成例を示すブロック図である。It is a block diagram which shows one structural example of the traveling apparatus which concerns on the 1st Embodiment of this invention. 図1に示す走行装置の外観図である。It is an external view of the traveling apparatus shown in FIG. 図1に示す測距装置の検知エリアを説明するための図である。It is a figure for demonstrating the detection area of the ranging apparatus shown in FIG. 図1に示す測距装置における各サブエリアの測距データと閾値との関係を説明するための図である。It is a figure for demonstrating the relationship between the ranging data of each subarea in the ranging apparatus shown in FIG. 1, and a threshold value. 図1に示す測距装置の測点ピッチと測点間距離の関係を示す図である。It is a figure which shows the relationship between the measurement pitch of the ranging apparatus shown in FIG. 1, and the distance between measurement points. 本発明の第2の実施形態に係る測距装置における検知エリアを説明するための図である。It is a figure for demonstrating the detection area in the distance measuring device which concerns on the 2nd Embodiment of this invention. 本発明の第3の実施形態にかかる測距装置を搭載した走行装置を説明するための図である。It is a figure for demonstrating the traveling apparatus carrying the ranging device concerning the 3rd Embodiment of this invention.

以下、図面を参照しながら、本発明の測距装置および走行装置に係る好適な実施形態について説明する。以下の説明において、異なる図面においても同じ符号を付した構成は同様のものであるとして、その説明を省略する場合がある。   DESCRIPTION OF EXEMPLARY EMBODIMENTS Hereinafter, preferred embodiments according to a distance measuring device and a traveling device of the invention will be described with reference to the drawings. In the following description, the configurations denoted by the same reference numerals in different drawings are the same, and the description thereof may be omitted.

本発明に係る走行装置は、測距装置を用いて障害物を判定する障害物判定装置を備えており、障害物の検知を確実に行うとともに誤検知を防ぐようにしている。この走行装置は、工場や公共施設の施設内、或いはそれらの施設や駐車場等の敷地内で移動させる移動体や、公道を走行する自動車や自動二輪車等の移動体などである。特に敷地内や施設内で自動的に移動させる移動体には、自律走行型の制御機構を有する、所謂、自律走行装置がある。自動車等の運転者による運転を基本とする移動体も自律走行型の制御を搭載することで、自律走行、或いは運転者の運転補助としての自律走行が可能になる。また、上記障害物判定装置が搭載される移動体は、人や物を運搬する運搬目的だけでなく、移動しながら周囲を監視するためにも用いることができ、その場合の移動体は監視ロボットとも呼べる。   The traveling device according to the present invention includes an obstacle determination device that determines an obstacle using a distance measuring device, and reliably detects the obstacle and prevents erroneous detection. This traveling device is a moving body that moves in a facility such as a factory or a public facility, or a site such as those facilities or a parking lot, or a moving body such as an automobile or a motorcycle traveling on a public road. In particular, a mobile body that automatically moves within a site or facility includes a so-called autonomous traveling device having an autonomous traveling type control mechanism. A moving body based on driving by a driver such as an automobile also has autonomous driving control so that autonomous driving or autonomous driving as driving assistance for the driver becomes possible. In addition, the moving body on which the obstacle determination device is mounted can be used not only for the purpose of transporting people and objects, but also for monitoring the surroundings while moving. It can also be called.

(第1の実施形態)
図1は、本発明の第1の実施形態に係る走行装置の一構成例を示すブロック図であり、図2は、図1に示す走行装置の外観図である。走行装置1は、測距装置10および障害物判定部20を備えている。また、走行装置1は、走行装置を駆動するための図示しない駆動部と、この駆動部を制御する図示しない制御部を有している。図1に示す走行装置の障害物判定部20は、通常、走行装置1の制御部に組み込むことができる。
(First embodiment)
FIG. 1 is a block diagram showing a configuration example of a traveling device according to the first embodiment of the present invention, and FIG. 2 is an external view of the traveling device shown in FIG. The traveling device 1 includes a distance measuring device 10 and an obstacle determination unit 20. Moreover, the traveling device 1 includes a drive unit (not shown) for driving the travel device and a control unit (not shown) for controlling the drive unit. The obstacle determination unit 20 of the traveling device shown in FIG. 1 can be normally incorporated in the control unit of the traveling device 1.

測距装置10は、測定光を縦方向および横方向に2次元的に走査して、反射光を受光することで一定の計測空間領域(計測範囲)内における被測定物Mまでの距離を計測する。つまり、測距装置10はこの計測範囲におけるエリアセンサであるとも言える。このような測距装置10として代表的なものは3D−LIDAR(Light Detection and RangingまたはLaser Imaging Detection and Ranging)やレーザレンジファインダなど挙げられるが、計測方向を限ってもよければ、鉛直方向(/水平方向)に走査するように設置された2D−LIDARを採用することもできる。この場合、水平方向(/垂直方向)に所定間隔でこのような2D−LIDARを配置することで、上述のような計測空間領域をカバーすることができる。なお、レーザレンジファインダはTOF方式を採用した測距センサであり、走査軸を1軸、2軸もたせることで、それぞれ2次元平面の計測、3次元的な計測が可能となる。また、LIDARはレーザレンジファインダの一種であるとも言える。   The distance measuring device 10 measures the distance to the object M within a certain measurement space region (measurement range) by scanning the measurement light two-dimensionally in the vertical and horizontal directions and receiving the reflected light. To do. That is, it can be said that the distance measuring device 10 is an area sensor in this measurement range. Typical examples of such a distance measuring device 10 include 3D-LIDAR (Light Detection and Ranging or Laser Imaging Detection and Ranging) and a laser range finder. However, if the measurement direction is limited, the vertical direction (/ A 2D-LIDAR installed so as to scan in the horizontal direction can also be adopted. In this case, the measurement space area as described above can be covered by arranging such 2D-LIDARs at predetermined intervals in the horizontal direction (/ vertical direction). The laser range finder is a distance measuring sensor that employs the TOF method. By providing one or two scanning axes, two-dimensional plane measurement and three-dimensional measurement are possible. LIDAR can also be said to be a kind of laser range finder.

また、この他、光を走査することなく発光部から赤外光などの光を照射し、受光素子に2次元受光センサを使用して、2次元受光センサの受光結果により一定の計測空間領域内における対象物までの距離を計測するようにしてもよい。2次元受光センサとしては、例えばCCD(Charge Coupled Device)やCMOS(Complementary Metal Oxide Semiconductor Image Sensor)が挙げられる。このような測距装置としては、例えば、近赤外線LED(Light Emitting Diode)をパルス発光させ、CCDで反射光の到着時間を読み取って3次元測点画像を得るTOFカメラが挙げられる。なお、本発明の測距装置は、3次元の測点装置として構成可能であるが、説目を簡単にするため、2次元測点装置を例に説明する。   In addition to this, light such as infrared light is emitted from the light emitting unit without scanning light, and a two-dimensional light receiving sensor is used as a light receiving element. You may make it measure the distance to the target object. Examples of the two-dimensional light receiving sensor include a CCD (Charge Coupled Device) and a CMOS (Complementary Metal Oxide Semiconductor Image Sensor). An example of such a distance measuring device is a TOF camera that emits pulses of near-infrared LEDs (Light Emitting Diodes) and reads the arrival time of reflected light with a CCD to obtain a three-dimensional point image. Although the distance measuring device of the present invention can be configured as a three-dimensional measuring device, a two-dimensional measuring device will be described as an example in order to simplify the explanation.

本実施形態の測距装置10は、走査制御部11、発光部12、光学機構部13、光学窓14、受光部15、サブエリア判定部16、サブエリア別測距データ取得部17、サブエリア別閾値情報記憶部18、および、サブエリア別測点数算出部19を有する。   The distance measuring device 10 according to the present embodiment includes a scanning control unit 11, a light emitting unit 12, an optical mechanism unit 13, an optical window 14, a light receiving unit 15, a subarea determination unit 16, a subarea-specific ranging data acquisition unit 17, and a subarea. It has a separate threshold information storage unit 18 and a subarea-specific measurement point calculation unit 19.

走査制御部11は、発光部12からの測定光の出力を制御するとともに、光学機構部13を駆動制御している。光学機構部13は、ミラー等の光路調整部を備えており、発光部12から発光された測定光の光路をスキャン(走査駆動)するとともに、反射光を受光部15に導いている。光学窓14は発光部12から発光された測定光およびその反射光を通過させるためのものである。受光部15は被測定物Mからの反射光を受光し、光電変換した出力信号を出力する。サブエリア判定部16は、光学機構部13のスキャン角度から後述するサブエリアを判定する。なお、サブエリアの判定には、光学機構部13のスキャン角度を用いずに、走査制御部11からの光学機構部13への駆動信号から判定してもよい。   The scanning control unit 11 controls the output of the measurement light from the light emitting unit 12 and drives and controls the optical mechanism unit 13. The optical mechanism unit 13 includes an optical path adjustment unit such as a mirror, and scans (scans and drives) the optical path of measurement light emitted from the light emitting unit 12 and guides reflected light to the light receiving unit 15. The optical window 14 is for passing the measurement light emitted from the light emitting unit 12 and the reflected light thereof. The light receiving unit 15 receives the reflected light from the object to be measured M and outputs an output signal obtained by photoelectric conversion. The sub area determination unit 16 determines a sub area described later from the scan angle of the optical mechanism unit 13. Note that the sub-area may be determined from the drive signal from the scanning control unit 11 to the optical mechanism unit 13 without using the scan angle of the optical mechanism unit 13.

サブエリア別測距データ取得部17は、受光部15で光電変換された出力信号およびサブエリア判定部16からのエリア情報に基づいて、被測定物Mまでの距離をサブエリア別に算出し、距離情報の計測結果として出力する。サブエリア別閾値情報記憶部18はサブエリア別に測距データの閾値を記憶している。そして、サブエリア別測点数算出部19は、サブエリア別測距データ取得部17からのサブエリア別の測距データの値と、サブエリア別閾値情報記憶部18からのサブエリア別の測距データの閾値とを比較し、サブエリア別に閾値に基づく距離エリア毎の測点数を算出している。なお、障害物判定部20は、後述するようにサブエリア別測点数算出部19からのサブエリア別の距離エリアの測点数から、障害物の有無を判定している。   The sub-area distance measurement data acquisition unit 17 calculates the distance to the object to be measured M for each sub-area based on the output signal photoelectrically converted by the light receiving unit 15 and the area information from the sub-area determination unit 16. Output as information measurement results. The sub-area threshold information storage unit 18 stores a distance measurement data threshold for each sub-area. Then, the sub-area-specific number-of-points calculation unit 19 calculates the sub-area-specific distance data from the sub-area-specific distance data acquisition unit 17 and the sub-area-specific distance information from the sub-area-specific threshold information storage unit 18. The data threshold is compared, and the number of measurement points for each distance area based on the threshold is calculated for each sub-area. The obstacle determination unit 20 determines the presence / absence of an obstacle from the number of points measured in the distance area for each subarea from the number-of-subareas measurement point calculation unit 19 as described later.

このような測距装置10および障害物判定部20を備えた走行装置1は、図2で例示するように、障害物を検知しながら障害物との衝突を回避して自動走行する自律走行装置などの移動体として構成される。例示した走行装置1は、本体部30に4輪の車輪31が取り付けられてなり、図示しないが、走行装置1を走行させる駆動部やその制御を行う制御部が設けられている。また、この例では、測距装置10が本体部30に取り付けられており、本体部30の内部に設けた制御部に障害物判定部20を構成するユニットが搭載されている。また、走行装置1の駆動部は、例えば複数の車輪31を回転駆動するためのモータ及び/又はエンジン等により構成される。さらに、走行装置1は、例示するような車輪31に限らず、例えばクローラーなどによって駆動させてもよい。   As illustrated in FIG. 2, the traveling device 1 including the distance measuring device 10 and the obstacle determination unit 20 detects the obstacle and avoids a collision with the obstacle to automatically travel. Configured as a moving body. The illustrated traveling device 1 includes four wheels 31 attached to a main body 30 and is provided with a drive unit that causes the traveling device 1 to travel and a control unit that controls the traveling device 1. In this example, the distance measuring device 10 is attached to the main body unit 30, and a unit constituting the obstacle determination unit 20 is mounted on a control unit provided inside the main body unit 30. Moreover, the drive part of the traveling apparatus 1 is comprised by the motor and / or engine etc. for rotationally driving the several wheel 31, for example. Furthermore, the traveling device 1 is not limited to the illustrated wheels 31 and may be driven by, for example, a crawler.

走行装置1の図示しない制御部は、障害物判定部20による判定結果に基づいて障害物との衝突を回避する動作を行わせるように駆動部を制御する。後で詳述するが、障害物判定部20により物体が計測空間領域のいずれかのサブエリアにあると判定されると、その情報が制御部に出力され、そこで、その物体(障害物)との衝突を回避するように、例えば走行している走行装置1の走行方向を変更させたり、減速させたり、障害物の手前で停止させるような制御を行う。この制御に基づいて駆動部に、走行方向の変更、減速、停止などの動作を行わせることができ、これにより障害物との衝突を回避している。   A control unit (not shown) of the traveling device 1 controls the drive unit so as to perform an operation of avoiding a collision with an obstacle based on the determination result by the obstacle determination unit 20. As will be described in detail later, when the obstacle determination unit 20 determines that the object is in any sub-area of the measurement space region, the information is output to the control unit, where the object (obstacle) For example, control is performed such that the traveling direction of the traveling device 1 that is traveling is changed, the vehicle is decelerated, or stopped before an obstacle. Based on this control, the drive unit can be operated to change the traveling direction, decelerate, stop, and the like, thereby avoiding collision with an obstacle.

その他、移動体には、地図情報を記憶する記憶部や位置情報取得部などを設けることで、予定ルートに沿った移動が可能になる。この位置情報取得部としては、GPS(Global Positioning System)、ロシアのGLONASS(Global Navigation Satellite System)、EUのガリレオ、中国の北斗等のGNSS(Global Navigation Satellite System)をはじめ、日本の準天頂衛星システム(Quasi-Zenith Satellite System:QZSS)、インドのIRNSS(Indian Regional Navigational Satellite System)などの衛星測位システムを用いて移動体の位置を取得するユニットが挙げられる。   In addition, the mobile body can be moved along the planned route by providing a storage unit for storing map information, a position information acquisition unit, and the like. This position information acquisition unit includes GPS (Global Positioning System), Russia's GLONASS (Global Navigation Satellite System), EU's Galileo, China's Hokuto etc. GNSS (Global Navigation Satellite System), and Japan's Quasi-Zenith Satellite System (Quasi-Zenith Satellite System: QZSS), India's IRNSS (Indian Regional Navigational Satellite System), and other units that acquire the position of a moving body.

図3は、図1に示す測距装置の検知エリアを説明するための図であり、図4は、図1に示す測距装置における各サブエリアの測距データと閾値との関係を説明するための図である。測距装置10は、走行装置1に設置されており、本実施形態では、走行装置1の進行方向に対して例えば左右それぞれ135°の角度となるように、全体で270°の検知エリアをスキャンするように構成されている。具体的には、走査制御部11は光学機構部13のミラーを回転させることによって、発光部12からの測定光をスキャンニングする。ミラーへの測定光の入射角が大きくなって、測定光のスポットが大きくならないように、複数のミラーを組み合わせてもよい。スキャンニングの周期は例えば67ms(15Hz)である。測定光は、光学窓14から約4°の前傾角度で出射される。これにより、測定光は、走行装置1から5mの地点で地面から約20cmの高さとなる。   FIG. 3 is a diagram for explaining the detection area of the distance measuring device shown in FIG. 1, and FIG. 4 explains the relationship between the distance measurement data of each sub-area and the threshold value in the distance measuring device shown in FIG. FIG. The distance measuring device 10 is installed in the traveling device 1. In this embodiment, the entire detection area of 270 ° is scanned so that the left and right angles are, for example, 135 ° with respect to the traveling direction of the traveling device 1. Is configured to do. Specifically, the scanning control unit 11 scans the measurement light from the light emitting unit 12 by rotating the mirror of the optical mechanism unit 13. You may combine a some mirror so that the incident angle of the measurement light to a mirror may become large and the spot of measurement light may not become large. The scanning period is 67 ms (15 Hz), for example. The measurement light is emitted from the optical window 14 at a forward tilt angle of about 4 °. Thereby, the measurement light is about 20 cm above the ground at a point 5 m from the traveling device 1.

そして、走査制御部11は、少なくとも検知エリアである270°の範囲のスキャンニング期間中は発光部12に対して、連続あるいは間欠的に測定光を発光させるように制御する。また、受光部15は、同様に、測定光が検知エリアである270°の範囲に照射されているスキャンニング期間中は、被測定物Mからの反射光を受光する。受光のタイミングは、例えば、光学機構部13のスキャン角度1°あたりに1回とすることができる。   The scanning control unit 11 controls the light emitting unit 12 to emit measurement light continuously or intermittently at least during a scanning period in the range of 270 ° which is a detection area. Similarly, the light receiving unit 15 receives the reflected light from the measurement object M during the scanning period in which the measurement light is irradiated in the range of 270 ° which is the detection area. The timing of light reception can be, for example, once per 1 ° scan angle of the optical mechanism unit 13.

なお、測定光を間欠的に照射する場合は、スキャン角度1°毎に測定光を照射し、受光部15はその反射光を受光する。また、測定光を連続的に照射する場合は、受光部15はスキャン角度1°毎に反射光を受光するように構成される。これらのスキャン速度と受光のタイミングが測距装置の分解能となる。本実施形態では、270°の検知エリアに対して、1°毎に測距データを得ており、1回のスキャンにつき測距データは271個得ることになる。ここで、本実施形態のスキャン角度270°が本発明の第1の所定角度に相当し、被測定物までの距離情報の取得角度(測点ピッチ)である1°が第2の所定角度に相当する。   In addition, when irradiating measurement light intermittently, measurement light is irradiated every 1 degree of scanning angles, and the light-receiving part 15 receives the reflected light. When the measurement light is continuously irradiated, the light receiving unit 15 is configured to receive the reflected light at every scan angle of 1 °. These scanning speed and light reception timing are the resolution of the distance measuring device. In the present embodiment, distance measurement data is obtained every 1 ° with respect to a detection area of 270 °, and 271 distance measurement data are obtained per scan. Here, the scan angle 270 ° of the present embodiment corresponds to the first predetermined angle of the present invention, and 1 °, which is the angle information acquisition point (measurement pitch) to the object to be measured, is the second predetermined angle. Equivalent to.

そして、270°の検知エリアをスキャンする測距装置であれば、例えば30°毎のサブエリア101〜109の9つのサブエリアに分割し、各サブエリア内で、距離の閾値を設定し、例えば、所定の閾値よりも短い測距データの測点数を基に、障害物の検知を判定している。ここで、本実施形態では、サブエリア毎の分割角度30°が本発明の第3の所定角度に相当する。各サブエリア101〜109の1スキャン当たりの測距データの個数(側点数)は30個または31個となる。   If the distance measuring device scans a detection area of 270 °, for example, it is divided into nine sub-areas of sub-areas 101 to 109 every 30 °, and a distance threshold is set in each sub-area. The detection of an obstacle is determined based on the number of measurement points of distance measurement data shorter than a predetermined threshold. Here, in this embodiment, the division angle of 30 ° for each sub-area corresponds to the third predetermined angle of the present invention. The number of distance measurement data (number of side points) per scan in each of the sub-areas 101 to 109 is 30 or 31.

サブエリア101から109の各々には所定の閾値が定められている。以下に、この閾値について図4に示すサブエリア105を例に説明する。サブエリア105は走行装置1の進行方向の前方に位置するサブエリアであり、進行方向に対して左右15°で全体として30°のスキャン角度を有している。また、サブエリア105にのみ31個の側点数を有するものとする。サブエリア105については、測距データについて第1の閾値L1と第2の閾値L2とが設けられており、これらの閾値については、サブエリア別閾値情報記憶部18に記憶されている。そして、光学窓14から第1の閾値L1までがサブエリア105の最近接エリア105A(図4で濃いハッチングで示す部分)として、また、第1の閾値L1から第2の閾値L2までが近接エリア105B(図4で薄いハッチングで示す部分)として、さらに、第2の閾値L2を超えるエリアを遠隔エリア105Cとして、それぞれの距離エリアが設定され、サブエリア別測点数算出部19は、距離エリア毎の側点数を算出している。   A predetermined threshold value is set for each of the sub-areas 101 to 109. Hereinafter, this threshold value will be described taking the subarea 105 shown in FIG. 4 as an example. The sub-area 105 is a sub-area located in front of the traveling direction of the traveling device 1, and has a scanning angle of 30 ° as a whole at 15 ° left and right with respect to the traveling direction. Further, it is assumed that only the sub-area 105 has 31 side scores. For the sub-area 105, a first threshold value L1 and a second threshold value L2 are provided for the distance measurement data, and these threshold values are stored in the sub-area-specific threshold information storage unit 18. The optical window 14 to the first threshold L1 are the closest area 105A of the sub-area 105 (the portion indicated by dark hatching in FIG. 4), and the first threshold L1 to the second threshold L2 are the proximity area. As 105B (part shown by thin hatching in FIG. 4), each distance area is set as an area exceeding the second threshold L2 as a remote area 105C. The number of side points is calculated.

すなわち、サブエリア別測点数算出部19は、1スキャン当たり得られた31個の測距データについて、それぞれの測距データの値が最近接エリア105A内あるいは近接エリア105B内にあるかどうかを判別し、最近接エリア105Aと近接エリア105Bにある測距データの数である側点数を、1回のスキャンごとに算出し、障害物判定部20に出力している。図4では、最近接エリアを濃いハッチングで示すとともに近接エリアを薄いハッチングで示している。また、図4で示すように最近接エリアは同心円状に示されているように、各サブエリア101〜109では第1の閾値L1として同じ値を有している。しかし、近接エリアについては、中央のサブエリア105では第2の閾値L2として大きな値を持つようにし、中央から離れるにしたがって第2の閾値を小さく設定している。これにより、近接エリアは、走行装置1の進行方向に対するサブエリアの位置によって、その大きさを変えており、進行方向に近いサブエリアほど、遠くの距離までの被測定物の情報を利用することを可能にしている。   That is, the sub-area-specific number-of-points calculation unit 19 determines whether the value of each distance measurement data is within the closest area 105A or the proximity area 105B for the 31 distance measurement data obtained per scan. Then, the number of side points, which is the number of distance measurement data in the closest area 105A and the proximity area 105B, is calculated for each scan and output to the obstacle determination unit 20. In FIG. 4, the closest area is indicated by dark hatching, and the adjacent area is indicated by thin hatching. Further, as shown in FIG. 4, the nearest area has the same value as the first threshold value L <b> 1 in each of the sub-areas 101 to 109 as shown concentrically. However, in the proximity area, the central sub-area 105 has a large value as the second threshold value L2, and the second threshold value is set smaller as the distance from the center increases. Thereby, the size of the proximity area is changed depending on the position of the sub area with respect to the traveling direction of the traveling device 1, and the information of the object to be measured up to a farther distance is used as the sub area is closer to the traveling direction. Is possible.

図5は、図1に示す測距装置の測点ピッチと測点間距離の関係を示す図である。測定光は、図5で示すように放射状に出射されるため、距離が近いほど、小さい物体でも多数の測点で検知される。反対に、距離が遠い場合は大きな物体でも測点は少ししか検知されない。例えば、スキャン角度1°毎に測距データを得る場合、すなわち、測点ピッチが1°の場合、走行装置1の光学窓14からの距離が0.7m離れた地点では、測点間距離は2.4cmであるが、5.5m離れた地点では、測点間距離は19cm、また、10m離れた地点では測点間距離は35cmとなる。このため、各サブエリアに設けた閾値に基づく距離エリア毎の測距データの数(測点数)に応じて、走行装置1の減速、停止の判定を出す基準を変える必要がある。   FIG. 5 is a diagram showing the relationship between the station pitch and the distance between stations in the distance measuring apparatus shown in FIG. Since the measurement light is emitted radially as shown in FIG. 5, the closer the distance is, the smaller the object is detected at many measurement points. On the other hand, if the distance is long, even a large object can detect a few points. For example, when distance measurement data is obtained at every scan angle of 1 °, that is, when the measurement pitch is 1 °, the distance between the measurement points at the point where the distance from the optical window 14 of the traveling device 1 is 0.7 m away is Although it is 2.4 cm, the distance between the measuring points is 19 cm at a point 5.5 m away, and the distance between the measuring points is 35 cm at a point 10 m away. For this reason, it is necessary to change a reference for determining whether the traveling device 1 is decelerated or stopped according to the number of distance measurement data (number of measurement points) for each distance area based on the threshold value provided in each sub-area.

そして、障害物判定部20では、所定のサブエリアにおける近接エリアでの測点数から走行装置1を減速させるかどうかを判定し、最近接エリアの測点数から停止させるかどうかの判定を行っている。このため、本実施形態では、距離エリアのうち最近接エリアが停止エリアとして、近接エリアは減速エリアとして用いられている。また、遠隔エリアの測点数は、走行装置1の減速、停止の判定に用いていない。図4に戻り、例えば、サブエリア104の第1の閾値L1を0.7m、第2の閾値L2を5.5mとした場合、0.7m未満の最近接エリア105Aでの測点数が5以上の場合に、障害物判定部20は走行装置1を停止させる信号を出力する。また、0.7m以上で5.5m未満の近接エリア105Bでの測点数が3以上の場合に、障害物判定部20は走行装置1を減速させる信号を出力する。   Then, the obstacle determination unit 20 determines whether or not the traveling device 1 is decelerated based on the number of measurement points in the adjacent area in the predetermined sub-area, and determines whether or not to stop from the number of measurement points in the closest area. . For this reason, in this embodiment, the closest area of the distance areas is used as a stop area, and the proximity area is used as a deceleration area. Further, the number of measurement points in the remote area is not used to determine whether the traveling device 1 is decelerated or stopped. Returning to FIG. 4, for example, when the first threshold value L1 of the sub-area 104 is 0.7 m and the second threshold value L2 is 5.5 m, the number of measurement points in the closest area 105A of less than 0.7 m is 5 or more. In this case, the obstacle determination unit 20 outputs a signal for stopping the traveling device 1. When the number of measurement points in the proximity area 105B of 0.7 m or more and less than 5.5 m is 3 or more, the obstacle determination unit 20 outputs a signal for decelerating the traveling device 1.

同様に、サブエリア104以外の他のサブエリアについても、停止あるいは減速判定を行うための測点数をそれぞれ設定している。そして、1つのサブエリアにおいて停止判定が出された際は、他のサブエリアで異なる判定が出されたとしても走行装置1は停止されるため、障害物判定部20は走行装置1の停止判定を即座に出力するようにしている。なお、停止の判定は減速の判定よりも優先される。   Similarly, for the other sub-areas other than the sub-area 104, the number of measurement points for performing stop or deceleration determination is set. When the stop determination is issued in one subarea, the traveling device 1 is stopped even if a different determination is made in the other subarea, so the obstacle determination unit 20 determines the stop of the travel device 1. Is output immediately. Note that the stop determination has priority over the deceleration determination.

このように、本実施形態では、測距対象となる検知エリアをスキャンして取得した測距データを、複数のスキャン角度毎のサブエリアに分割し、各サブエリア内における測距データの値と所定の閾値とを比較するだけで、障害物判定のためのデータを得ている。このため、座標変換を伴うことなく簡単な計算で検知エリアにおける障害物判定が可能となり、低速、小規模なマイコンでも障害物検知が実現できる。   As described above, in the present embodiment, the distance measurement data acquired by scanning the detection area to be the distance measurement target is divided into a plurality of sub-areas for each scan angle, and the value of the distance measurement data in each sub-area Data for obstacle determination is obtained simply by comparing with a predetermined threshold. For this reason, it is possible to determine an obstacle in the detection area with simple calculation without coordinate conversion, and obstacle detection can be realized even with a low-speed and small-scale microcomputer.

(第2の実施形態)
図6は、本発明の第2の実施形態に係る測距装置における検知エリアを説明するための図である。図6において、検知エリアのスキャン角度が270°である点は、第1の実施形態と同様であるが、サブエリアをスキャン角度270°を2等分する中央の軸Xに対して対称となるように設けている。図6に示す例では、4つのサブエリアに分割されており、サブエリア201とサブエリア204とがそれぞれ90°のスキャン角度を有し、中央の軸Xに対して線対称に設けられている。また、サブエリア202とサブエリア203とがそれぞれ45°のスキャン角度を有し、中央の軸Xに対して線対称に設けられている。
(Second Embodiment)
FIG. 6 is a diagram for explaining a detection area in the distance measuring apparatus according to the second embodiment of the present invention. In FIG. 6, the point that the scan angle of the detection area is 270 ° is the same as in the first embodiment, but the sub-area is symmetric with respect to the central axis X that bisects the scan angle 270 °. It is provided as follows. In the example shown in FIG. 6, it is divided into four subareas, and each of the subarea 201 and the subarea 204 has a scan angle of 90 ° and is provided symmetrically with respect to the central axis X. . Further, each of the sub area 202 and the sub area 203 has a scanning angle of 45 ° and is provided symmetrically with respect to the central axis X.

このような、サブエリアの設定方法は、走行装置1の進行方向に対して左右のどちら側に障害物があるかといった情報が不要な場合に用いられる。したがって、第2の実施形態では、各サブエリアは前方中央からからどれだけ離れているかといったインデックス情報のみを記憶しておき、サブエリアの分割数が増えた場合でも、サブエリアの位置情報を保持するためのメモリ容量の増大を防ぐことができる。なお、隣接するサブエリアの大きさ(スキャン角度)は同じ大きさである必要はなく、中央の軸Xに対して対称の位置関係にあるサブエリアが同じ大きさを有していればよい。   Such a sub-area setting method is used when there is no need for information such as whether there is an obstacle on the left or right side of the traveling direction of the traveling device 1. Therefore, in the second embodiment, only the index information such as how far each sub-area is from the front center is stored, and the position information of the sub-area is retained even when the number of sub-area divisions increases. Increase of the memory capacity for this can be prevented. Note that adjacent subareas need not have the same size (scan angle), and the subareas having a symmetrical positional relationship with respect to the central axis X need only have the same size.

(第3の実施形態)
図7は、本発明の第3の実施形態にかかる測距装置を搭載した走行装置を説明するための図である。第1の実施形態では、サブエリア101〜109のそれぞれについて、距離エリアとして停止エリアと減速エリアの閾値を定め、障害物判定部20が全てのサブエリアの各距離エリアの側点数によって、減速あるいは停止の判定を行うようにしていたが、本実施形態では、走行装置1の走行状態に応じて、特定のサブエリアのみを用いることによって、減速あるいは停止の判定を行うようにしている。
(Third embodiment)
FIG. 7 is a diagram for explaining a traveling device equipped with a distance measuring device according to the third embodiment of the present invention. In the first embodiment, for each of the sub-areas 101 to 109, thresholds for the stop area and the deceleration area are set as distance areas, and the obstacle determination unit 20 decelerates or decreases according to the number of side points of each distance area of all the sub-areas. In the present embodiment, the determination of the stop or the stop is made by using only a specific subarea according to the traveling state of the traveling device 1.

例えば、図6に示すように、走行装置1が直進中の場合、障害物40のために、サブエリア106、107で停止判定がなされたとしても、サブエリア106、107における第1の閾値L1の大きさによっては、走行装置1を直進させたとしても障害物40に衝突する虞がない。このため、本実施形態では、例えば、直進中の場合は、前方中央に位置するサブエリア105の情報のみを利用して、走行装置1の減速、停止の判断を行っている。   For example, as shown in FIG. 6, when the traveling device 1 is traveling straight, even if the stop determination is made in the subareas 106 and 107 due to the obstacle 40, the first threshold L1 in the subareas 106 and 107 is obtained. Depending on the size, there is no possibility of colliding with the obstacle 40 even if the traveling device 1 is moved straight. For this reason, in this embodiment, for example, when traveling straight, only the information of the sub-area 105 located at the front center is used to determine whether the traveling device 1 is decelerated or stopped.

また、走行装置が例えば右折しようとする場合は、進行方向前方中央のサブエリア105以外に、進行方向に向かって右側前方に位置するサブエリア104、103の情報を利用することによって、走行装置1の減速、停止の判断を行うことが望ましい。このように、本実施形態では、走行状態に応じて、特定のサブエリアの閾値に基づく距離エリア毎の側点数に基づいて、通常走行、徐行、または、停止を決定しており、これにより、演算の負荷を軽減することが可能となる。   In addition, when the traveling device is going to turn right, for example, the traveling device 1 uses the information of the sub-areas 104 and 103 located in front of the right side in the traveling direction in addition to the sub-area 105 at the front center in the traveling direction. It is desirable to determine whether to slow down or stop. Thus, in the present embodiment, according to the running state, the normal running, slowing down, or stopping is determined based on the number of side points for each distance area based on the threshold value of the specific sub-area. It is possible to reduce the calculation load.

(第4の実施形態)
走行装置1は雨天や降雪時にも自走ロボットとして利用される。その際、光学窓14に付着した水滴や雪粒によって、光学窓14から非常に近い位置での測距データが観測されることになる。この測距データが側点数として扱われた場合、例えば、雪粒の付着のために、図4に示すサブエリア105の最近接エリア105Aで5つ以上の側点数となった場合は、走行装置1は光学窓14に付着した雪粒のために停止させられることになる。これを回避するために、本実施形態では、所定の距離以内で測距データが得られた場合は、付着物として扱い、この測距データを障害物判定に用いないようにする(無視する)ともに、無視した側点数の個数を障害物判定のための側点数の個数(例えば、停止の場合は5つ)から減算するようにしている。
(Fourth embodiment)
The traveling device 1 is used as a self-propelled robot even in the rain or snow. At that time, distance measurement data at a position very close to the optical window 14 is observed due to water droplets and snow particles adhering to the optical window 14. When this distance measurement data is handled as the number of side points, for example, when the number of side points is five or more in the closest area 105A of the sub-area 105 shown in FIG. 1 is stopped due to snow particles adhering to the optical window 14. In order to avoid this, in the present embodiment, when distance measurement data is obtained within a predetermined distance, it is treated as an adhering object, and this distance measurement data is not used for obstacle determination (ignored). In both cases, the number of neglected side points is subtracted from the number of side points for obstacle determination (for example, 5 in the case of a stop).

光学窓から。例えば0.12m以内で検知された測距データが2個存在する場合、障害物判定部20は、この2個の測距データを利用することなく、これ以外の測距データの個数をカウントし、停止判断のための側点数の個数を3(=5−2)として、0.12m以内で検知された測距データ以外に、3つの側点数がそのサブエリアの最近接エリアでカウントされた場合に、停止判定を出すようにしている。また、0.12m以内で検知された測距データが5個以上ある場合は、そのサブエリアについては判定不能である旨の判定を行う。この判定のために、測距装置10のサブエリア別測点数算出部19は、所定の距離以内の測距データを付着物として取り扱えるようにするために、付着物として判定するための閾値以内にある側点数を別途カウントするようにし、障害物判定部20に出力している。   From the optical window. For example, when there are two distance measurement data detected within 0.12 m, the obstacle determination unit 20 counts the number of other distance measurement data without using the two distance measurement data. When the number of side points for stop determination is 3 (= 5-2), in addition to the distance measurement data detected within 0.12 m, three side points are counted in the closest area of the sub-area. In this case, a stop determination is issued. If there are five or more distance measurement data detected within 0.12 m, it is determined that the sub-area cannot be determined. For this determination, the sub-area-specific number-of-points calculation unit 19 of the distance measuring device 10 falls within a threshold value for determining as an adhering substance so that ranging data within a predetermined distance can be handled as an adhering substance. A certain number of side points is separately counted and output to the obstacle determination unit 20.

1…走行装置、10…測距装置、11…走査制御部、12…発光部、13…光学機構部、14…光学窓、15…受光部、16…サブエリア判定部、17…サブエリア別測距データ取得部、18…サブエリア別閾値情報記憶部、19…サブエリア別測点数算出部、20…障害物判定部、30…本体部、31…車輪、40…障害物、101〜109,201〜204…サブエリア。
DESCRIPTION OF SYMBOLS 1 ... Traveling apparatus, 10 ... Distance measuring device, 11 ... Scan control part, 12 ... Light emission part, 13 ... Optical mechanism part, 14 ... Optical window, 15 ... Light-receiving part, 16 ... Subarea determination part, 17 ... By subarea Distance data acquisition unit, 18 ... Sub-area-specific threshold information storage unit, 19 ... Sub-area-specific measurement point calculation unit, 20 ... Obstacle determination unit, 30 ... Body part, 31 ... Wheel, 40 ... Obstacle, 101-109 , 201 to 204... Sub-area.

Claims (9)

第1の所定角度の検知エリアをスキャンすることによって第2の所定角度毎に被測定物までの情報を取得する測距装置であって、
前記第1の所定角度の検知エリアを複数のそれぞれ第3の所定角度を有するサブエリアに分割し、該サブエリア毎に前記第2の所定角度毎の測距データを取得するサブエリア別測距データ取得部と、
前記サブエリア別に前記測距データの少なくとも1つの閾値を格納したサブエリア別閾値情報記憶部と、
前記サブエリア毎に、前記サブエリア別測距データ取得部からの前記測距データの値と前記サブエリア別測距データ取得部からの前記閾値とに基づいて、前記閾値に基づく距離エリア毎の側点数を算出するサブエリア別測点数算出部、
を備えたことを特徴とする測距装置。
A distance measuring device that acquires information up to an object to be measured at every second predetermined angle by scanning a detection area of a first predetermined angle,
The first predetermined angle detection area is divided into a plurality of sub-areas each having a third predetermined angle, and distance measurement data for each sub-area is acquired for each sub-area. A data acquisition unit;
A sub-area threshold information storage unit storing at least one threshold of the distance measurement data for each sub-area;
For each subarea, based on the distance measurement data value from the subarea-specific distance measurement data acquisition unit and the threshold value from the subarea-specific distance measurement data acquisition unit, for each distance area based on the threshold value Number of measurement points by sub-area that calculates the number of side points,
A distance measuring device comprising:
前記閾値は、前記サブエリア毎に異なる値であることを特徴とする請求項1に記載の測距装置。   The distance measuring apparatus according to claim 1, wherein the threshold value is different for each subarea. 前記サブエリアが、前記第1の所定角度を2等分する中央の軸に対して対称となるように設けられていることを特徴とする請求項1または2に記載の測距装置。   3. The distance measuring apparatus according to claim 1, wherein the sub-area is provided so as to be symmetric with respect to a central axis that bisects the first predetermined angle. 4. 前記第3の所定角度が前記サブエリア毎に異なることを特徴とする請求項1から3のいずれか1に記載の測距装置。   The distance measuring apparatus according to claim 1, wherein the third predetermined angle is different for each subarea. 前記測距装置は、2次元レーザレーザであることを特徴とする請求項1から4のいずれか1に記載の測距装置。   The distance measuring device according to any one of claims 1 to 4, wherein the distance measuring device is a two-dimensional laser laser. 請求項1から5のいずれか1に記載の測距装置を備えた走行装置。   A traveling device comprising the distance measuring device according to claim 1. 請求項6に記載の走行装置であって、該走行装置を駆動する駆動部と、該駆動部を制御する制御部を有し、
該制御部は、前記サブエリア別測点数算出部からの前記閾値に基づく距離エリア毎の側点数に基づいて、通常走行、徐行、または、停止を決定する障害物判定部を備えることを特徴とする走行装置。
The travel device according to claim 6, further comprising: a drive unit that drives the travel device; and a control unit that controls the drive unit;
The control unit includes an obstacle determination unit that determines normal driving, slowing down, or stopping based on the number of side points for each distance area based on the threshold value from the sub-area-specific measurement point calculation unit. Traveling device.
前記障害物判定部は、走行状態に応じて、特定の前記サブエリアの前記閾値に基づく距離エリア毎の側点数に基づいて、通常走行、徐行、または、停止を決定することを特徴とする請求項7に記載の走行装置。   The obstacle determination unit determines normal running, slowing down, or stopping based on the number of side points for each distance area based on the threshold value of the specific sub-area according to a running state. Item 8. The traveling device according to Item 7. 前記障害物判定部は、所定の距離以内の測距データによる側点数を用いることなく、通常走行、徐行、または、停止を決定することを特徴とする請求項7または8に記載の走行装置。
The traveling device according to claim 7 or 8, wherein the obstacle determination unit determines normal traveling, slowing down, or stopping without using a side score based on distance measurement data within a predetermined distance.
JP2015209679A 2015-10-26 2015-10-26 Distance measuring device and traveling device Active JP6875790B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2015209679A JP6875790B2 (en) 2015-10-26 2015-10-26 Distance measuring device and traveling device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2015209679A JP6875790B2 (en) 2015-10-26 2015-10-26 Distance measuring device and traveling device

Publications (2)

Publication Number Publication Date
JP2017083223A true JP2017083223A (en) 2017-05-18
JP6875790B2 JP6875790B2 (en) 2021-05-26

Family

ID=58710690

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2015209679A Active JP6875790B2 (en) 2015-10-26 2015-10-26 Distance measuring device and traveling device

Country Status (1)

Country Link
JP (1) JP6875790B2 (en)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107703971A (en) * 2017-11-20 2018-02-16 唐菲菲 Unmanned aerial vehicle maneuvering method and system for inspection area
CN107744371A (en) * 2017-11-01 2018-03-02 深圳悉罗机器人有限公司 Clean robot and the detection method based on clean robot
JP2018105822A (en) * 2016-12-28 2018-07-05 株式会社三井E&Sホールディングス Obstacle detection system and obstacle detection method
CN108415018A (en) * 2018-03-27 2018-08-17 哈尔滨理工大学 A kind of target Analysis of Existence method based on millimetre-wave radar detection
WO2019124342A1 (en) * 2017-12-19 2019-06-27 株式会社ダイヘン Moving body
WO2019176116A1 (en) * 2018-03-16 2019-09-19 株式会社三井E&Sマシナリー Obstacle sensing system and obstacle sensing method
JP2019192206A (en) * 2018-04-27 2019-10-31 深セン市優必選科技股▲ふん▼有限公司Ubtech Poboticscorp Ltd Charging stand recognition method, apparatus therefor, and robot
EP3597375A1 (en) 2018-06-11 2020-01-22 Kabushiki Kaisha Toyota Jidoshokki Autonomous cart
JP2020046735A (en) * 2018-09-14 2020-03-26 トヨタ車体株式会社 Follow-up truck
WO2020262189A1 (en) * 2019-06-27 2020-12-30 ソニー株式会社 Mobile body, control method, and program

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05203739A (en) * 1992-01-29 1993-08-10 Mazda Motor Corp Obstacle detector for vehicle
JPH07140247A (en) * 1993-11-18 1995-06-02 Omron Corp On-vehicle distance measuring system using laser beam
US20060023917A1 (en) * 2004-07-01 2006-02-02 Daimlerchrysler Ag Object detection method for vehicles
US20060089799A1 (en) * 2004-10-21 2006-04-27 Kenjiro Endoh Vehicle detector and vehicle detecting method
JP2007139594A (en) * 2005-11-18 2007-06-07 Omron Corp Object detection device

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05203739A (en) * 1992-01-29 1993-08-10 Mazda Motor Corp Obstacle detector for vehicle
JPH07140247A (en) * 1993-11-18 1995-06-02 Omron Corp On-vehicle distance measuring system using laser beam
US20060023917A1 (en) * 2004-07-01 2006-02-02 Daimlerchrysler Ag Object detection method for vehicles
US20060089799A1 (en) * 2004-10-21 2006-04-27 Kenjiro Endoh Vehicle detector and vehicle detecting method
JP2006118958A (en) * 2004-10-21 2006-05-11 Alpine Electronics Inc Another vehicle detection machine and another vehicle detection method
JP2007139594A (en) * 2005-11-18 2007-06-07 Omron Corp Object detection device

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018105822A (en) * 2016-12-28 2018-07-05 株式会社三井E&Sホールディングス Obstacle detection system and obstacle detection method
CN107744371B (en) * 2017-11-01 2023-03-07 深圳飞鼠动力科技有限公司 Cleaning robot and detection method based on cleaning robot
CN107744371A (en) * 2017-11-01 2018-03-02 深圳悉罗机器人有限公司 Clean robot and the detection method based on clean robot
CN107703971A (en) * 2017-11-20 2018-02-16 唐菲菲 Unmanned aerial vehicle maneuvering method and system for inspection area
CN107703971B (en) * 2017-11-20 2023-08-25 唐菲菲 Unmanned aerial vehicle mobilization method and unmanned aerial vehicle mobilization system for patrol area
WO2019124342A1 (en) * 2017-12-19 2019-06-27 株式会社ダイヘン Moving body
WO2019176116A1 (en) * 2018-03-16 2019-09-19 株式会社三井E&Sマシナリー Obstacle sensing system and obstacle sensing method
CN108415018A (en) * 2018-03-27 2018-08-17 哈尔滨理工大学 A kind of target Analysis of Existence method based on millimetre-wave radar detection
JP2019192206A (en) * 2018-04-27 2019-10-31 深セン市優必選科技股▲ふん▼有限公司Ubtech Poboticscorp Ltd Charging stand recognition method, apparatus therefor, and robot
US11269335B2 (en) 2018-06-11 2022-03-08 Kabushiki Kaisha Toyota Jidoshokki Autonomous cart
EP3597375A1 (en) 2018-06-11 2020-01-22 Kabushiki Kaisha Toyota Jidoshokki Autonomous cart
JP7070265B2 (en) 2018-09-14 2022-05-18 トヨタ車体株式会社 Follow-up trolley
JP2020046735A (en) * 2018-09-14 2020-03-26 トヨタ車体株式会社 Follow-up truck
WO2020262189A1 (en) * 2019-06-27 2020-12-30 ソニー株式会社 Mobile body, control method, and program

Also Published As

Publication number Publication date
JP6875790B2 (en) 2021-05-26

Similar Documents

Publication Publication Date Title
JP6875790B2 (en) Distance measuring device and traveling device
US11609329B2 (en) Camera-gated lidar system
CN110389586B (en) System and method for ground and free space exploration
EP2808700B1 (en) Drive assist device, and vehicle using drive assist device
US10093312B2 (en) Obstacle determining apparatus, moving body, and obstacle determining method
WO2016059905A1 (en) Moving body
WO2016151939A1 (en) Laser radar device and traveling body
JP2016219258A (en) Luminaire and movable body
JP2017130098A (en) Autonomous travelling device
US11780436B2 (en) On-board sensor system
US11372090B2 (en) Light detection and range (LIDAR) device with SPAD and APD sensors for autonomous driving vehicles
JP2017123065A (en) Autonomous travelling device
JP6781535B2 (en) Obstacle determination device and obstacle determination method
JP2008009929A (en) Mobile robot
JP2017032329A (en) Obstacle determination device, mobile body, and obstacle determination method
JP2017059150A (en) Obstacle determination device, movable body and obstacle determination method
US20190152598A1 (en) Circular light source for obstacle detection
JP2019049811A (en) Vehicle control device, vehicle control method, and program
JP6725982B2 (en) Obstacle determination device
JP6967846B2 (en) Object detection method and object detection device
JP2015056123A (en) Environmental map generation control device of moving body, moving body, and environmental map generation method of moving body
US20240036175A1 (en) Single photon detection based light detection and range (lidar) for autonomous driving vehicles
JP2019211442A (en) Laser radar mounted on service vehicle
JP6886531B2 (en) Obstacle determination device, moving object, and obstacle determination method
US20230358893A1 (en) Optical illumination for road obstacle detection

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180920

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190905

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20191023

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191202

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20191212

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20191219

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200602

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200622

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200923

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201015

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20210330

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210423

R150 Certificate of patent or registration of utility model

Ref document number: 6875790

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150