JP5083543B2 - Traveling area discrimination device and traveling area discrimination method for mobile robot - Google Patents

Traveling area discrimination device and traveling area discrimination method for mobile robot Download PDF

Info

Publication number
JP5083543B2
JP5083543B2 JP2008012551A JP2008012551A JP5083543B2 JP 5083543 B2 JP5083543 B2 JP 5083543B2 JP 2008012551 A JP2008012551 A JP 2008012551A JP 2008012551 A JP2008012551 A JP 2008012551A JP 5083543 B2 JP5083543 B2 JP 5083543B2
Authority
JP
Japan
Prior art keywords
area
mobile robot
data
laser range
region
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2008012551A
Other languages
Japanese (ja)
Other versions
JP2009175932A (en
Inventor
宗彦 前田
浩明 齋藤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
IHI Corp
IHI Aerospace Co Ltd
Original Assignee
IHI Corp
IHI Aerospace Co Ltd
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 IHI Corp, IHI Aerospace Co Ltd filed Critical IHI Corp
Priority to JP2008012551A priority Critical patent/JP5083543B2/en
Publication of JP2009175932A publication Critical patent/JP2009175932A/en
Application granted granted Critical
Publication of JP5083543B2 publication Critical patent/JP5083543B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Description

本発明は、自律して走行する移動ロボットの走行経路を決める段階において、移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分けするのに用いられる走行領域判別装置及び走行領域判別方法に関するものである。   The present invention relates to a travel region discriminating device and a travel region used for classifying a region on the front side of a mobile robot into a travelable region and a travel impossible region due to a failure in a step of determining a travel route of the mobile robot traveling autonomously. This is related to the discrimination method.

従来、上記したような走行領域判別方法としては、例えば、1軸スキャンタイプのレーザレンジファインダを用いて外界データを取得し、このレーザレンジファインダで得たデータを統計処理することで平滑な領域を検出して走行可能領域とすると共に、平滑な領域に対して高さのある領域を検出して障害による走行不能領域とするようにした手法がある(特許文献1参照)。   Conventionally, as the traveling region discrimination method as described above, for example, a single-axis scan type laser range finder is used to acquire external data, and the data obtained by the laser range finder is statistically processed to obtain a smooth region. There is a method of detecting and making a travelable region, and detecting a region with a height higher than a smooth region to make the region unable to travel due to a failure (see Patent Document 1).

また、レーザレンジファインダやCCDカメラや接触センサや超音波センサなどのセンサを複数用いて外界データを取得し、これらのデータに基づいて平坦で走行に差し支えない領域及び凹凸のある走行不能領域を判別するようにした手法がある(特許文献2参照)ほか、屋内において各種センサで3次元データを取得し、これらの3次元データの形状の特徴量(特に形状の高さ方向の特徴量)と、あらかじめ設定された障害物モデルとを比較して障害物を検出する、いわゆる特徴量のパターンマッチングを用いて障害物を検出するようにした手法がある(特許文献3参照)。
特開2000-075032号公報 特許第02769972号公報 特開2004-326264号公報
In addition, external data is acquired using multiple sensors such as a laser range finder, CCD camera, contact sensor, and ultrasonic sensor. Based on these data, areas that are flat and can be used for traveling and areas that are uneven and cannot be used are discriminated. In addition to the technique (see Patent Document 2), three-dimensional data is acquired indoors with various sensors, and the feature amount of the shape of these three-dimensional data (particularly the feature amount in the height direction of the shape) There is a technique in which an obstacle is detected by using a so-called pattern matching of a feature amount to detect an obstacle by comparing with a preset obstacle model (see Patent Document 3).
JP 2000-075032 JP Japanese Patent No. 02769972 JP 2004-326264 A

ところが、上記した従来の走行領域判別方法において、レーザレンジファインダなどのセンサで取得した形状情報から得られるさまざまな特徴について、閾値を用いて高さや勾配などの判別を行う場合には、その閾値の決定が煩雑であるのに加えて、それぞれの特徴量同士の相関関係を判別に反映させることが非常に困難である。
とくに、屋外の不整地環境では、既知障害物モデルとのパターンマッチングによる障害物検出は困難であるという問題を有しており、これらの問題を解決することが従来の課題となっていた。
However, in the conventional traveling region discrimination method described above, when various features obtained from shape information obtained by a sensor such as a laser range finder are used to discriminate height, gradient, etc., using the threshold value, In addition to the complicated determination, it is very difficult to reflect the correlation between the feature quantities in the determination.
In particular, in an outdoor rough terrain environment, there is a problem that it is difficult to detect an obstacle by pattern matching with a known obstacle model, and it has been a conventional problem to solve these problems.

本発明は、上述した従来の課題に着目してなされたもので、屋外で移動ロボットを自律走行させる場合において、簡単な条件設定のみで走行可能領域であるか否かの判別が可能であり、例えば、河原などの道路地図がない未整備の環境で自律走行させる場合においても、轍などの微かな車両通過跡に沿った道なり走行を行わせることが可能であり、加えて、判別を行う際のデータ処理において、収束演算を行わない分だけ計算コストを低減することができると共に、リアルタイムな処理を行うことが可能である走行領域判別装置及び走行領域判別方法を提供することを目的としている。   The present invention has been made paying attention to the above-described conventional problems, and in the case of autonomously traveling a mobile robot outdoors, it is possible to determine whether or not it is a travelable region only by simple condition setting, For example, even when driving autonomously in an undeveloped environment where there is no road map such as a riverbank, it is possible to drive along a road along a slight vehicle passing trace such as a kite, and in addition, a determination is made. It is an object of the present invention to provide a travel region discriminating apparatus and a travel region discriminating method capable of reducing the calculation cost by the amount not performing the convergence calculation and performing real-time processing. .

本発明者らは、水平ラインスキャンタイプの1軸レーザレンジファインダにより取得される計測対象の断面プロファイル形状データから複数の幾何的な特徴量を抽出し、これらの特徴量に対して、機械学習(教師付き学習を用いた分類器)を適用することによって、複雑な地形においても、容易に走行可能な領域、例えば、轍などの微かな車両通過跡と、それ以外の領域とに分類して、移動ロボットに車両通過跡に沿った道なり走行を行わせ得ることを見出した。   The present inventors extract a plurality of geometric feature amounts from cross-sectional profile shape data to be measured acquired by a horizontal line scan type single-axis laser range finder, and perform machine learning on these feature amounts ( By applying a supervised learning classifier), even in complicated terrain, it can be classified into areas that can be easily driven, for example, a minute vehicle passing trace such as a kite, and other areas, It has been found that a mobile robot can be run along a road along a vehicle passing track.

すなわち、本発明の請求項1に係る発明は、自律して走行する移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分けする走行領域判別装置であって、レーザ光を走査して前記移動ロボットの前方側の形状データを取得するレーザレンジファインダと、このレーザレンジファインダで得たセンサ座標系データを直交座標系データへ変換する座標変換手段を具備した外界計測部と、事前データメモリを具備して、この事前データメモリに格納した事前データと前記外界計測部で得た形状データの幾何的な特徴量とから、前記移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分け処理する処理部を備え、前記処理部の事前データメモリに格納した事前データは、前記外界計測部を具備した車両を実際に走行させてそのレーザレンジファインダにより取得した形状データの複数の幾何的な特徴量と、このレーザレンジファインダにより取得した形状データをマッピングした2次元地図上において分類された走行可能領域及び走行不能領域の分類結果とから成り、前記処理部では、自律して走行する前記移動ロボット上において前記外界計測部で得た形状データの複数の幾何的な特徴量に対して、前記事前データメモリに格納した前記事前データを教師データとする収束演算を用いない分類器を適用して、前記移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分け処理すると共に、特に走行領域が屋外不整地である場合に、轍などの微かな車両通過跡に沿った経路を走行可能領域として処理する構成としたことを特徴としており、この移動ロボットの走行領域判別装置の構成を前述の従来の課題を解決するための手段としている。 That is, the invention according to claim 1 of the present invention is a travel region discriminating device that divides a region on the front side of a mobile robot that travels autonomously into a travelable region and a travel impossible region due to an obstacle, and scans the laser beam. A laser range finder that acquires shape data of the front side of the mobile robot, an external field measurement unit that includes a coordinate conversion unit that converts sensor coordinate system data obtained by the laser range finder into orthogonal coordinate system data, It is provided with a data memory, and the area on the front side of the mobile robot is determined from the advance data stored in the advance data memory and the geometric feature amount of the shape data obtained by the external measurement unit depending on the travelable area and the obstacle. A vehicle that includes a processing unit that performs processing to divide the vehicle into an inoperable region, and the preliminary data stored in the preliminary data memory of the processing unit is a vehicle that includes the external measurement unit. A plurality of geometric feature amounts of shape data acquired by the laser range finder and the shape range acquired by the laser range finder and the travelable region and the travel classified on the two-dimensional map in which the shape data acquired by the laser range finder are mapped The prior data memory for a plurality of geometric feature quantities of shape data obtained by the external measurement unit on the mobile robot that autonomously travels. Applying a classifier that does not use a convergence calculation using the prior data stored in the training data as a teacher data, the front area of the mobile robot is divided into a runnable area and a runnable area due to an obstacle , region in the case of outdoor irregular areas, and configured to process the path along the faint vehicle passing marks, such as ruts as the travel area DOO is characterized by, that the structure of the travel area determination apparatus of the mobile robot as a means for solving the conventional problems described above.

また、本発明の請求項2に係る移動ロボットの走行領域判別装置において、前記処理部は、前記外界計測部で得た形状データの複数の幾何的な特徴量の値に対して、対数をとった値を用いて前記区分け処理を行う構成としている。 Further, in the running region determination device of the mobile robot according to claim 2 of the present invention, the processing unit, for a plurality of geometric features of the values of the shape data obtained in the previous Kigaikai measuring unit, the logarithm The segmentation process is performed using the obtained value.

一方、本発明の請求項に係る発明は、自律して走行する移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分けする走行領域判別方法であって、車両を実際に走行させてこの車両に搭載したレーザレンジファインダにより取得した形状データから抽出した複数の幾何的な特徴量と、前記レーザレンジファインダにより取得した形状データをマッピングした2次元地図上において分類された走行可能領域及び走行不能領域の分類結果とから成る事前データをあらかじめ作成し、前記移動ロボットを走行させる時点において、この移動ロボットに搭載したレーザレンジファインダからレーザ光を走査して該移動ロボットの前方側の形状データを取得すると共に、このレーザレンジファインダで得たセンサ座標系データを直交座標系データへ変換した後、前記移動ロボットのレーザレンジファインダで得た形状データから抽出した複数の幾何的な特徴量に対して、あらかじめ作成した前記事前データを教師データとする収束演算を用いない分類器を適用して前記移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分けし、特に走行領域が屋外不整地である場合において、轍などの微かな車両通過跡に沿った経路を走行可能領域として処理する構成としたことを特徴としており、この移動ロボットの走行領域判別方法の構成を前述の従来の課題を解決するための手段としている。 On the other hand, the invention according to claim 3 of the present invention is a traveling region determination method for dividing a region on the front side of a mobile robot that travels autonomously into a traveling possible region and a region incapable of traveling due to a failure. Able to travel classified on a two-dimensional map in which a plurality of geometric feature values extracted from the shape data acquired by the laser range finder that is driven and mounted on the vehicle and the shape data acquired by the laser range finder are mapped. Preliminary data consisting of the classification results of the area and the non-travelable area is created in advance, and at the time when the mobile robot travels, a laser beam is scanned from the laser range finder mounted on the mobile robot and the front side of the mobile robot is scanned. Sensor coordinate system data obtained with this laser range finder while acquiring shape data After conversion to Cartesian coordinate system data, a convergence operation using the pre-created pre-created data as teacher data for a plurality of geometric feature values extracted from the shape data obtained by the laser range finder of the mobile robot is performed. in the case by applying the classifier is not used is divided into traveling impossible region by travelable area and impairs the front side area of the mobile robot, in particular the travel area is an outdoor irregular areas, faint vehicles passing marks, such as rut The route of the mobile robot is processed as a travelable region, and the configuration of the travel region discrimination method of the mobile robot is used as a means for solving the above-described conventional problems.

また、本発明の請求項に係る移動ロボットの走行領域判別方法は、前記外界計測部で得た形状データの複数の幾何的な特徴量の値に対して、対数をとった値を用いて前記区分け処理を行う構成としている。 The running region determination method for a mobile robot according to claim 4 of the present invention, used for a plurality of geometric features of the values of the shape data obtained in the previous Kigaikai measuring section, the value of the logarithm Thus, the sorting process is performed.

この場合、外界計測部としては、移動ロボットの前方側の形状データを取得する水平ラインスキャンタイプの1軸レーザレンジファインダに加えて、3Dスキャンタイプの2軸レーザレンジファインダを用いることができるほか、例えば、ステレオカメラを用いることができる。
また、移動ロボットの自己位置を求めて上記外界計測部による計測地点を明確化する自己位置計測手段として、例えば、デッドレコニングやGPS(グローバル・ポジショニング・システム)を用いることができる。
In this case, in addition to the horizontal line scan type single-axis laser range finder that acquires the shape data of the front side of the mobile robot, a 3D scan type two-axis laser range finder can be used as the external measurement unit. For example, a stereo camera can be used.
Further, dead reckoning or GPS (Global Positioning System) can be used as self-position measuring means for obtaining the self-position of the mobile robot and clarifying the measurement point by the external measurement unit.

本発明に係る移動ロボットの走行領域判別装置及び移動ロボットの走行領域判別方法では、それぞれ上記した構成としたから、屋外で移動ロボットを自律走行させる場合において、簡単な条件設定のみで移動ロボットの前方側の領域が走行可能領域であるか否かを判別することができ、例えば、河原などの道路地図のない未整備の環境で自律走行させる場合においても、轍などの微かな車両通過跡に沿った道なり走行を行わせることが可能であるという非常に優れた効果がもたらされる。   Since the mobile robot travel area discriminating apparatus and the mobile robot travel area discriminating method according to the present invention are configured as described above, when the mobile robot is autonomously traveling outdoors, the front of the mobile robot can be simply set by simple conditions. It is possible to determine whether or not the side area is a travelable area.For example, even when autonomously traveling in an undeveloped environment without a road map such as a riverbank, it follows the traces of passing vehicles such as dredges. A very good effect that it is possible to drive on a smooth road is brought about.

また、判別を行う際のデータ処理において、収束演算を行わない分だけ計算コストを低減することができると共に、リアルタイムな処理を行うことが可能であり、加えて、外界計測部で得た形状データの複数の幾何的な特徴量の値に対して、対数をとった値を用いて区分け処理を行うようになせば、走行可能領域及び走行不能領域における特徴量の値の分布について、分散が同じ規模の正規分布として現わすことができるという非常に優れた効果がもたらされる。 In the data processing when performing the determination, it is possible to reduce the amount corresponding computational cost does not perform convergence calculation state, and are capable of performing real-time processing, in addition, it was obtained at ambient measurement section shape If segmentation processing is performed using logarithmic values for a plurality of geometric feature value values of data, the distribution of feature value values in the runnable region and the non-runnable region is distributed. very excellent effect that Ru can reveal is produced as a normal distribution of the same scale.

以下、本発明に係る移動ロボットの走行領域判別装置及び走行領域判別方法を図面に基づいて説明する。
図1〜図6は、本発明に係る移動ロボットの走行領域判別装置の一実施形態を示しており、この実施形態では、移動ロボットが車両タイプである場合を例に挙げて説明する。
図1及び図2に示すように、この走行領域判別装置1は、レーザ光を走査して移動ロボットRの前方側の形状データを取得する水平ラインスキャンタイプの1軸レーザレンジファインダ11,3Dスキャンタイプの2軸レーザレンジファインダ12及び1軸レーザレンジファインダ11で得たセンサ座標系データを鉛直上向きを1軸とする直交座標系データへ変換するデータを供するバーチカルジャイロ(座標変換手段)13を具備した外界計測部10と、デッドレコニング用のホイルオドメータ21,ヨーレートセンサ22及びGPS23を具備して、移動ロボットRの自己位置を求める自己位置計測部20と、外界計測部10で得た外界データ及び自己位置計測部20で得た自己位置データが入出力回路2を介して入力される処理部30と、この処理部30とLAN3を介して接続する地図作成部40を備えている。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS A mobile robot travel area determination device and a travel area determination method according to the present invention will be described below with reference to the drawings.
FIGS. 1-6 has shown one Embodiment of the traveling area discrimination | determination apparatus of the mobile robot based on this invention, In this embodiment, the case where a mobile robot is a vehicle type is mentioned as an example and demonstrated.
As shown in FIGS. 1 and 2, the traveling region discriminating apparatus 1 is a horizontal line scan type single-axis laser range finder 11 and 3D scan that scans a laser beam and acquires shape data on the front side of the mobile robot R. A vertical gyroscope (coordinate conversion means) 13 is provided which provides data for converting the sensor coordinate system data obtained by the two-axis laser range finder 12 and the one-axis laser range finder 11 into orthogonal coordinate system data with the vertical upward as one axis. A dead-reckoning wheel odometer 21, a yaw rate sensor 22, and a GPS 23, a self-position measuring unit 20 that determines the self-position of the mobile robot R, and external data obtained by the external-measuring unit 10 A processing unit 30 to which self-position data obtained by the self-position measuring unit 20 is input via the input / output circuit And a mapping section 40 which connects the processing unit 30 and via the LAN 3.

この場合、外界計測部10は移動ロボットRの前端部(図2(a)左端部)に搭載され、一方、自己位置計測部20はデータ解析部30,地図作成部40及び後述する車体制御部60とともに移動ロボットRの後端部(図2(a)右端部)に搭載されており、この移動ロボットRの後端部にはGPS23用のアンテナ24が配置してある。
そして、移動ロボットRにおける車体駆動部50の操舵手段51は、ドライバ52及び入出力回路4を介して車体制御部60と接続していると共に、車体駆動部50の車速制御手段53は、コンバータ54及び入出力回路4を介して車体制御部60と接続しており、この車体制御部60には、地図作成部40からの制御信号がLAN3を介して入力されるようになっている。
In this case, the external environment measurement unit 10 is mounted on the front end portion (left end portion of FIG. 2A) of the mobile robot R, while the self-position measurement unit 20 includes a data analysis unit 30, a map creation unit 40, and a vehicle body control unit described later. 60 is mounted at the rear end (right end in FIG. 2A) of the mobile robot R, and the GPS 24 antenna 24 is disposed at the rear end of the mobile robot R.
The steering means 51 of the vehicle body drive unit 50 in the mobile robot R is connected to the vehicle body control unit 60 via the driver 52 and the input / output circuit 4, and the vehicle speed control means 53 of the vehicle body drive unit 50 is a converter 54. In addition, the vehicle body control unit 60 is connected to the vehicle body control unit 60 via the input / output circuit 4, and a control signal from the map creation unit 40 is input to the vehicle body control unit 60 via the LAN 3.

上記処理部30は、図3にも示すように、事前データメモリ30aに格納した事前データと外界計測部10で得た形状データの幾何的な特徴量とから、移動ロボットRの前方側の領域を走行可能領域及び障害による走行不能領域に区分け処理する障害物検出モジュール30Aを有していると共に、自己位置計測部20で得た車速やヨーレート等による自己位置データに基づいて自己位置推定結果を生成する自己位置情報生成モジュール30Bを有している。   As shown in FIG. 3, the processing unit 30 is a region on the front side of the mobile robot R from the preliminary data stored in the preliminary data memory 30 a and the geometric feature amount of the shape data obtained by the external measurement unit 10. The obstacle detection module 30A for classifying the vehicle into a travelable area and an inability to travel due to an obstacle, and the self-position estimation result based on the self-position data obtained by the self-position measurement unit 20 such as vehicle speed and yaw rate A self-location information generation module 30B is generated.

ここで、処理部30の事前データメモリ30aに格納してあるあらかじめ作成された事前データは、外界計測部10を具備した車両を実際に走行させてそのレーザレンジファインダ11,12により取得した形状データの複数の幾何的な特徴量と、このレーザレンジファインダ11,12により取得した形状データをマッピングした2次元地図上において人為的に分類された走行可能領域及び走行不能領域の分類結果とから成っており、処理部30では、移動ロボットRの外界計測部10で得た形状データの複数の幾何的な特徴量に対して、事前データを教師データとする分類器を適用して、移動ロボットRの前方側の領域を走行可能領域及び障害による走行不能領域に区分け処理するようにしている。   Here, the pre-created pre-stored data stored in the pre-data memory 30a of the processing unit 30 is the shape data obtained by actually running the vehicle equipped with the external measurement unit 10 and using the laser range finders 11 and 12. And a classification result of the runnable area and the non-runnable area artificially classified on the two-dimensional map in which the shape data acquired by the laser range finders 11 and 12 is mapped. The processing unit 30 applies a classifier using prior data as teacher data to a plurality of geometric feature amounts of the shape data obtained by the external measurement unit 10 of the mobile robot R, so that the mobile robot R The front area is divided into a travelable area and a travel impossible area due to an obstacle.

また、上記地図作成部40は、処理部30から得た走行可能領域及び障害による走行不能領域の判別情報に基づいてベース地図を作成する地図作成モジュール40Aを有していると共に、この地図作成モジュール40Aで作成されたベース地図に基づいて移動ロボットRの走行経路を決める走行経路決定モジュール40Bを有している。
上記した走行領域判別装置1では、外界計測部10において、1軸レーザレンジファインダ11で得たセンサ座標系データをバーチカルジャイロ13からの姿勢情報を用いて鉛直上向きを1軸とする直交座標系データへ変換しているが、1軸レーザレンジファインダ11及びバーチカルジャイロ13はいずれも雲台6に固定されているので、変換に用いる座標変換行列は、1軸レーザレンジファインダ11及びバーチカルジャイロ13の相対的な姿勢よりあらかじめ決定しておく。
In addition, the map creation unit 40 includes a map creation module 40A that creates a base map based on the discrimination information of the travelable region and the travel impossible region due to a failure obtained from the processing unit 30, and the map creation module A travel route determination module 40B that determines the travel route of the mobile robot R based on the base map created in 40A is provided.
In the travel region discriminating apparatus 1 described above, in the external measurement unit 10, the sensor coordinate system data obtained by the single-axis laser range finder 11 is used as orthogonal coordinate system data with the vertical upward direction as one axis using the posture information from the vertical gyroscope 13. However, since the uniaxial laser range finder 11 and the vertical gyro 13 are both fixed to the pan head 6, the coordinate transformation matrix used for the conversion is relative to the uniaxial laser range finder 11 and the vertical gyro 13. Decide in advance from the specific attitude.

これにより、移動ロボットRの揺動によるセンサ光軸の揺れが発生した場合における鉛直方向を基準とした座標系での処理が可能であり、1軸レーザレンジファインダ11の一走査データ内では、鉛直方向を基準とした相対的な高さ成分の比較が可能である。なお、移動ロボットRの上下方向の並進動作は、現実的に計測不可能であることから、異なるタイミングで取得したデータ(高さ方向の値)相互の比較は行わない。   This enables processing in a coordinate system based on the vertical direction when the sensor optical axis fluctuates due to the swing of the mobile robot R. In one scanning data of the one-axis laser range finder 11, Comparison of relative height components based on direction is possible. Note that the translational motion in the vertical direction of the mobile robot R is not practically measurable, so the data (values in the height direction) acquired at different timings are not compared with each other.

また、処理部30の事前データメモリ30aに格納した事前データにおいて、これを構成する形状データの幾何的な特徴量には、以下に示すような四つの特徴量を用いた。
ア.近傍領域の凹凸
1軸レーザレンジファインダ11の一走査ライン内において、隣接するデータ間における高さ方向の差の絶対値
イ.曲率
1レーザレンジファインダ11の一走査ライン内において、互いに隣接する三点のデータ間における高さ方向の2階差分値の絶対値
ウ.乱雑さ(凹凸の分散値)
1軸レーザレンジファインダ11の一走査ライン内において、互いに隣接する六点程度のデータの2次関数フィッティング後における曲線からの分散
エ.移動ロボットの前方側を平面と仮定した場合の距離値と実測値との差
図4(a)に示す移動ロボットの前方側が平面であると仮定した場合の距離値L1と、図4(b)に示す路肩に高さのある障害物Sが存在する場合の実測値L2との差の絶対値。
Further, in the pre-data stored in the pre-data memory 30a of the processing unit 30, the following four feature amounts are used as geometric feature amounts of the shape data constituting the pre-data.
A. The absolute value of the difference in the height direction between adjacent data in one scanning line of the concavo-convex uniaxial laser range finder 11 in the adjacent region a. The absolute value of the second-order difference value in the height direction between three adjacent data points in one scanning line of the curvature 1 laser range finder 11 c. Randomness (unevenness dispersion value)
Dispersion from the curve after quadratic function fitting of data of about six points adjacent to each other in one scanning line of the single-axis laser range finder d. A distance value L1 when the front side of the mobile robot R shown in Saz 4 (a) between the distance values and the measured values in the case where the front side is assumed that the plane is assumed to be the plane of the mobile robot R, Fig. 4 ( The absolute value of the difference from the actual measurement value L2 when there is an obstacle S having a height on the shoulder shown in b).

上記四つの特徴量(ア)〜(エ)のうちの特徴量(ア)〜(ウ)は、路面の勾配に大きな影響を受けない。特徴量(エ)については、路面の勾配の変化、例えば、上り坂の入り口における勾配の変化では誤差要因となるが、それ以外においては走行可能領域を特徴付けるよい指針となる。
さらに、処理部30の事前データメモリ30aに格納した事前データは、その作成に際して、まず、走行が想定される環境において前記外界計測部10を具備した車両を実際に走行させて、そのレーザレンジファインダ11,12により形状データを取得し、図5に示すように、この形状データ(高さ情報)をGPSなどによる自己位置情報に基づいて2次元の地図データにマッピングする。図5において、黒色部分が低位置Lo、白色部分が高位置Hi、灰色部分が未計測位置Mである。
Of the four feature quantities (a) to (d), the feature quantities (a) to (c ) are not significantly affected by the road surface gradient. Regarding the feature amount (d), a change in the slope of the road surface, for example, a change in the slope at the entrance of the uphill is an error factor, but otherwise it is a good guideline for characterizing the travelable area.
In addition, prior data stored in the prior data memory 30a of the processing unit 30 is first created by first running a vehicle including the external measurement unit 10 in an environment where traveling is assumed, and then performing a laser range finder thereof. The shape data is acquired by 11, 12 and, as shown in FIG. 5, this shape data (height information) is mapped to two-dimensional map data based on the self-position information by GPS or the like. In FIG. 5, the black portion is the low position Lo, the white portion is the high position Hi, and the gray portion is the unmeasured position M.

次いで、上記車両を実際に走行させた際の静止画又は動画に基づいて、図6に示すように、2次元の地図データ上で人の判断により走行可能領域及び走行不能領域にそれぞれ着色して色分けする。図6において、白色部分が走行可能領域G、黒色部分が走行不能領域NGである。
そして、区分した部分において、上記レーザレンジファインダ11,12による形状データの計測がなされた部位では、この形状データから上述した四つの幾何的な特徴量(ア)〜(エ)を抽出しており、これらの幾何的な特徴量(ア)〜(エ)と、2次元地図上における走行可能領域及び走行不能領域の分類結果とを組み合わせることで、走行可能領域及び走行不能領域に分類した事前データが作成される。
Next, based on the still image or the moving image when the vehicle is actually traveled, as shown in FIG. 6, the travelable area and the travel impossible area are colored on the two-dimensional map data by human judgment, respectively. Color code. In FIG. 6, the white portion is a travelable region G, and the black portion is a travel impossible region NG.
In the section where the shape data is measured by the laser range finders 11 and 12, the above-described four geometric feature quantities (a) to (d) are extracted from the shape data. The prior data classified into the runnable area and the non-runnable area by combining these geometric feature quantities (a) to (d) and the classification results of the runnable area and the non-runnable area on the two-dimensional map. Is created.

なお、人の判断により、2次元の地図データ上において走行可能領域及び走行不能領域を区分けするに際して、例えば、轍と草との境界部分などについては、走行可能領域及び走行不能領域の各データが混在しているため、敢えて区分けを見送ることで、取得されるデータの分離性の向上を図っている。
この実施形態では、上述したように、処理部30において、事前データを教師データとする分類器を用いるようにしているが、ここで、教師データ(事前データ)の構成要素として取得した特徴量(ア)について、図7に示すように、その統計をヒストグラムとして表した。この特徴量(ア)は、過去に車両が複数回通過することにより生じた轍及びその周囲の草むらにおいて取得した値である。
It should be noted that when the travelable area and the travel impossible area are classified on the two-dimensional map data by the judgment of the person, for example, for the boundary portion between the fence and the grass, the data of the travelable area and the travel impossible area are stored. Because they are mixed, the separation of the acquired data is improved by deliberately leaving off the division.
In this embodiment, as described above, the processing unit 30 uses a classifier that uses prior data as teacher data. However, here, a feature amount (as a constituent element of teacher data (preliminary data)) ( As for (a), as shown in FIG. 7, the statistics are represented as a histogram. This feature amount (a) is a value acquired in the hail produced by the vehicle passing a plurality of times in the past and the grass around it.

このヒストグラムから、走行可能領域及び走行不能領域における特徴量(ア)の値の分布について、走行可能領域では段差などが小さな値として集中しており、一方、走行不能領域では段差などが小さい値から大きな値までの広い分布をとっていることが判るが、単純な閾値による区別は困難である。
次に、図8に示すように、特徴量(ア)の値に対数をとって、改めてヒストグラムを作成した。
From this histogram, regarding the distribution of the feature value (a) in the runnable region and the non-runnable region, the level difference is concentrated as a small value in the runnable region, while the level difference is small in the non-runnable region. Although it can be seen that the distribution is wide up to a large value, it is difficult to distinguish by a simple threshold.
Next, as shown in FIG. 8, a histogram was newly created by taking the logarithm of the feature value (a).

このヒストグラムから、走行可能領域及び走行不能領域において、それぞれ平均値が独立していて、分散が同じ規模の正規分布として現れていることが判る。この理由として、未整備の自然界に生じた走行可能領域及び走行不能領域に含まれる凹凸の高低差のオーダーが異なることが挙げられ、具体的には、轍の領域における凹凸が高低差数十mm程度のランダムな構造であるのに対して、それ以外の草むら等の領域における凹凸が高低差数百mm程度のランダムな構造をとっていることが挙げられる。   From this histogram, it can be seen that the average values are independent in the runnable region and the non-runnable region, and the variance appears as a normal distribution of the same scale. The reason for this is that the order of the height difference of the unevenness included in the unmovable natural travelable area and the non-travelable area is different. Specifically, the unevenness in the reed area has a height difference of several tens of millimeters. In contrast to the random structure of the degree, the unevenness in the other areas such as grassy spots has a random structure with a height difference of about several hundred mm.

分類すべきデータの統計量をあわせることは、特に数値計算を行う際に、丸め誤差を防ぐうえで重要である。また、学習モデルとしてもっとも平易な正規分布を仮定したモデルを適用するうえで分類性能が向上する。つまり、このような分布を持つ特徴量が複数種類取得可能であれば、機械学習により正解率の高い分類が可能である。
そこで、この実施形態では、走行可能領域及び走行不能領域の各クラスが、上記のようにして前処理を行うことで各特徴量(ア)〜(エ)の混合正規分布で表されると仮定し、処理部30の分類器 (機械学習手法)として以下に示すベイズの公式(式(1))を用いた。
Matching the statistics of the data to be classified is important to prevent rounding errors, especially when performing numerical calculations. In addition, the classification performance is improved when a model assuming the simplest normal distribution is applied as a learning model. In other words, if a plurality of types of feature quantities having such a distribution can be acquired, classification with a high accuracy rate can be performed by machine learning.
Therefore, in this embodiment, it is assumed that each class of the runnable area and the non-runnable area is represented by a mixed normal distribution of the feature amounts (a) to (d) by performing the preprocessing as described above. Then, the following Bayes formula (Formula (1)) was used as a classifier (machine learning method) of the processing unit 30.

(式1) (Formula 1)

このベイズの公式において、事後確率を計算することができ、ここで、Cは走行可能領域及び走行不能領域の2クラスであり、Dは4次元の特徴量ベクトルである。
各クラスにおける事前データの計測において、特徴量の確率分布密度が混合正規分布であると仮定した場合の確率は、以下の式(2)で求められる。
In this Bayesian formula, posterior probabilities can be calculated, where C is two classes of a runnable region and a non-runnable region, and D is a four-dimensional feature vector.
In the measurement of the prior data in each class, the probability when the probability distribution density of the feature quantity is assumed to be a mixed normal distribution is obtained by the following equation (2).

(式2) (Formula 2)

この式2を計算することにより、事後確率を計算することができ、ここで、μkはクラスkにおける特徴量の平均値であり、Σkはクラスkにおける共分散行列である。
したがって、事前の学習として、教師データに基づいて、それぞれのクラス毎に各特徴量の平均値μと共分散行列Σを求める。分類の際には、走行可能領域及び走行不能領域の各クラスにおいて、計測データから取得した特徴量を上記式2の特徴量ベクトルDに代入し、確率P(D|C)が大きい方のクラスが推定されるクラスとなる。
By calculating Equation 2, the posterior probability can be calculated, where μk is the average value of the feature quantities in class k and Σk is the covariance matrix in class k.
Therefore, as the prior learning, the average value μ and the covariance matrix Σ of each feature amount are obtained for each class based on the teacher data. At the time of classification, in each class of the runnable area and the non-runnable area, the feature quantity acquired from the measurement data is substituted into the feature quantity vector D of the above equation 2, and the class having the larger probability P (D | C). Is the estimated class.

外界計測部10で得た形状データに対して、事前の学習により構成した分類器を用いて、移動ロボットRの前方側の領域を走行可能領域及び障害による走行不能領域に区分け処理した結果を図9に示す。図9において、白色部分が走行可能領域G、黒色部分が走行不能領域NGである。
上記ベイズの公式を用いるような分類手法を行う際のデータ処理は、収束演算を行わない分だけ計算コストを低減することができると共に、リアルタイムな処理を行うことが可能である。
The result of dividing the area on the front side of the mobile robot R into the runnable area and the non-runnable area due to the obstacle using the classifier configured by the prior learning with respect to the shape data obtained by the external measurement unit 10 is shown in FIG. 9 shows. In FIG. 9, the white portion is a travelable region G, and the black portion is a travel impossible region NG.
Data processing when performing the classification method using the Bayes formula can reduce the calculation cost by the amount of not performing the convergence calculation, and can perform real-time processing.

上記した走行領域判別装置1では、1軸レーザレンジファインダ11により計測された局所的な形状データのみから走行可能領域及び障害による走行不能領域を分類しているので、走行可能領域である走行路の中央に生えた草などのように、走行可能領域の範囲内に細かな走行不能領域が存在することがある。
このような場合には、走行可能領域が連続的に広がっていると仮定して、走行可能領域に囲まれた小さな走行不能領域を、例えば、メジアンフィルタを用いて、ノイズとして除去処理してもよく、これにより、事前の地図(経路情報)の存在しない自然発生的な轍についても、それらを検出して走行すべきルートであると判断することができ、轍に沿った道なり走行が可能になる。
In the travel region discriminating apparatus 1 described above, the travelable region and the travel impossible region due to the obstacle are classified based only on the local shape data measured by the single-axis laser range finder 11. There may be a small non-travelable area within the range of the travelable area, such as grass that grows in the center.
In such a case, assuming that the travelable area continuously spreads, the small travel impossible area surrounded by the travelable area may be removed as noise using, for example, a median filter. Well, this makes it possible to detect naturally occurring dredging that does not have a prior map (route information) and determine that it should be a route that should be traveled. become.

また、このようなノイズ処理によって、実際の障害物まで除去してしまう可能性も残されているが、その際には、走行可能領域と判定した1軸レーザレンジファインダ11の形状データから、改めて凹凸や勾配などの走行に関係する情報を抽出することにより、詳細なパスプランや速度制御が可能となる。
そして、この走行領域判別装置1では、学習データを取得した環境(例えば、河原)と、移動ロボットが走行する環境(例えば、林道)が異なる場合であったとしても、同程度の分類性能が得られる。
In addition, although there is a possibility that an actual obstacle is removed by such noise processing, in that case, from the shape data of the single-axis laser range finder 11 determined to be a travelable region, it is anew. By extracting information related to running such as unevenness and gradient, detailed path plans and speed control are possible.
In this travel area discriminating apparatus 1, even if the environment (for example, Kawahara) from which the learning data is acquired and the environment (for example, forest road) in which the mobile robot R travels are different, the same classification performance is obtained. can get.

次に、上記した移動ロボットRの走行経路決定用地図の作成要領を説明する。
まず、走行領域判別装置1の処理部30における障害物検出モジュール30Aは、外界計測部10から得た形状データ及び自己位置計測部20から得た車速やヨーレート等による自己位置データに基づいて、走行可能領域及び障害による走行不能領域の判別処理を行う。
Next, a procedure for creating the travel route determination map of the mobile robot R will be described.
First, the obstacle detection module 30A in the processing unit 30 of the travel area determination device 1 travels based on the shape data obtained from the external measurement unit 10 and the self-position data obtained from the self-position measurement unit 20 such as vehicle speed and yaw rate. A determination process of a possible area and an inoperable area due to a failure is performed.

具体的には、レーザレンジファインダ11により得られた形状データの複数の幾何的な特徴量に対して、事前データメモリ30aに格納した事前データを教師データとする分類器を適用して、移動ロボットRの前方側の領域において、自然発生的な轍を走行可能領域と判定し、それ以外の領域を障害による走行不能領域と判定する。
一方、処理部30における自己位置推定のための自己位置計測部20で得た車速やヨーレート等による自己位置データを受け取る自己位置情報生成モジュール30Bは、これらの自己位置データを受け取った時点で、自己位置推定結果を生成する。具体的には、車速度とヨーレートとの積分によるデッドレコ情報を生成する。
Specifically, a mobile robot is applied to a plurality of geometric feature quantities of shape data obtained by the laser range finder 11 by using a classifier that uses pre-data stored in the pre-data memory 30a as teacher data. In the area on the front side of R, it is determined that the naturally-occurring kite is a travelable area, and the other areas are determined to be travel impossible areas due to obstacles.
On the other hand, the self-position information generation module 30B that receives the self-position data based on the vehicle speed, the yaw rate, and the like obtained by the self-position measurement section 20 for self-position estimation in the processing section 30 A position estimation result is generated. Specifically, dead record information is generated by integrating the vehicle speed and the yaw rate.

次いで、地図作成部40の地図作成モジュール40Aでは、処理部30から得た走行可能領域及び障害による走行不能領域の判別情報に基づいて、整合性のあるベース地図を連続的に作成する。
続いて、走行経路決定モジュール40Bでは、地図作成モジュール40Aで作成したベース地図に基づいて走行経路を決定して指令信号を車体制御部60に出力し、車体制御部60において操舵角度及び速度を決定して車体駆動部50の操舵手段51及び車速制御手段53に制御信号を出力すると、移動ロボットRの轍に沿った道なり走行が成されることとなる。
Next, the map creation module 40A of the map creation unit 40 continuously creates a consistent base map based on the determination information of the travelable region and the travel impossible region due to a failure obtained from the processing unit 30.
Subsequently, the travel route determination module 40B determines a travel route based on the base map created by the map creation module 40A, outputs a command signal to the vehicle body control unit 60, and the vehicle body control unit 60 determines the steering angle and speed. Then, when control signals are output to the steering means 51 and the vehicle speed control means 53 of the vehicle body drive unit 50, traveling along the road along the heel of the mobile robot R is performed.

したがって、上記した走行領域判別装置1では、簡単な条件設定のみで移動ロボットの前方側の領域が走行可能領域であるか否かを判別することができ、未整備の環境で自律走行させる場合には、轍などの微かな車両通過跡に沿った道なり走行を行わせることが可能である。
上記した走行領域判別装置1では、外界計測部10が、1軸レーザレンジファインダ11,3軸レーザレンジファインダ12及びバーチカルジャイロ13を具備している場合を示したが、外界計測部10の1軸レーザレンジファインダ11以外の構成や配置はこれに限定されるものではない。
Therefore, in the travel region discriminating apparatus 1 described above, it is possible to determine whether or not the region on the front side of the mobile robot R is a travelable region only by simple condition setting. It is possible to drive along a road along a slight vehicle passing trace such as a kite.
In the travel region discriminating apparatus 1 described above, the external measurement unit 10 includes the one-axis laser range finder 11, the three-axis laser range finder 12, and the vertical gyro 13. The configuration and arrangement other than the laser range finder 11 are not limited to this.

また、上記した走行領域判別装置及び走行領域判別方法では、処理部30の事前データメモリ30aに格納した事前データにおいて、これを構成する形状データの幾何的な特徴量として、四つの特徴量(ア)〜(エ)を用いたが、これらに限定されるものではなく、走行可能領域及び走行不能領域において互いに統計の差異が見られるものであれば、それを用いることが可能である。   Further, in the above-described travel region discriminating apparatus and travel region discriminating method, four feature amounts (a) are used as geometric feature amounts of the shape data constituting the pre-data stored in the pre-data memory 30a of the processing unit 30. ) To (d) are used, but the present invention is not limited to these, and any difference can be used if there is a statistical difference between the runnable area and the runnable area.

さらに、上記した走行領域判別装置及び走行領域判別方法では、事前データを構成する形状データの幾何的な特徴量として、1軸レーザレンジファインダ11の測距データを用いたが、これに限定されるものではなく、測距データ以外にも、1軸レーザレンジファインダ11の反射強度データを併用することができるほか、画像やその他の外界センサによるデータを併用することが可能である。   Furthermore, in the above-described travel area determination device and travel area determination method, the distance measurement data of the single-axis laser range finder 11 is used as the geometric feature amount of the shape data constituting the advance data, but the present invention is not limited to this. In addition to the distance measurement data, the reflection intensity data of the uniaxial laser range finder 11 can be used together, and images and data from other external sensors can be used together.

さらにまた、上記した走行領域判別装置及び走行領域判別方法では、走行可能領域及び走行不能領域の各クラスが、各特徴量(ア)〜(エ)の混合正規分布で表されると仮定して、処理部30の分類器 (機械学習手法)にベイズの公式を用いたが、これに限定されるものではなく、多層パーセプトロンやサポートベクターマシン等の分類器を用いることが可能であり、分類器として、サポートベクターマシンなどのより一層分類性能の高いものを用いた場合には、1軸レーザレンジファインダ11の近傍数点の生データを特徴量としてそのまま用い得ると考えられる。   Furthermore, in the above-described travel region determination device and travel region determination method, it is assumed that each class of the travelable region and the travelless region is represented by a mixed normal distribution of the respective feature amounts (a) to (d). The Bayes formula is used for the classifier (machine learning method) of the processing unit 30. However, the classifier is not limited to this, and a classifier such as a multilayer perceptron or a support vector machine can be used. In the case of using a machine having a higher classification performance such as a support vector machine, it is considered that raw data of several points in the vicinity of the uniaxial laser range finder 11 can be used as they are as feature quantities.

さらにまた、上記した走行領域判別装置及び走行領域判別方法の発展形として、自動的に教師データを取得する(オンライン学習)などが考えられる。
さらにまた、上記した一実施形態では、移動ロボットが車両タイプである場合を示したが、これに限定されるものではない。
Furthermore, as an extension of the above-described travel area discrimination device and travel area discrimination method, it is conceivable to automatically acquire teacher data (online learning).
Furthermore, in the above-described embodiment, the case where the mobile robot is a vehicle type is shown, but the present invention is not limited to this.

本発明に係る移動ロボットの走行領域判別装置の一実施形態を示すブロック図である。It is a block diagram which shows one Embodiment of the traveling area discrimination | determination apparatus of the mobile robot which concerns on this invention. 図1における走行領域判別装置を搭載した移動ロボットの側面説明図(a)及び外界計測部のレイアウト説明図(b)である。It is side surface explanatory drawing (a) of the mobile robot carrying the travel area discrimination device in FIG. 1, and layout explanatory drawing (b) of an external field measurement part. 図1における走行領域判別装置の制御フローを示すブロック図である。It is a block diagram which shows the control flow of the travel area discrimination device in FIG. 図1における走行領域判別装置において移動ロボットの前方側が平面であると仮定した場合の距離値を示す平面説明図(a)及び移動ロボットの前方側路肩に高さのある障害物が存在する場合の実測値を示す平面説明図(b)である。In the travel region discriminating apparatus in FIG. 1, an explanatory plan view (a) showing a distance value when the front side of the mobile robot is assumed to be a plane, and a case where an obstacle with a height exists on the front shoulder of the mobile robot exists. It is plane explanatory drawing (b) which shows a measured value. 事前データ作成時において実際に走行させる車両に搭載したレーザレンジファインダにより取得した形状データを自己位置情報に基づいてマッピングした状態の2次元地図のデータ説明図である。It is data explanatory drawing of the two-dimensional map of the state which mapped the shape data acquired with the laser range finder mounted in the vehicle actually drive | worked at the time of prior data preparation based on self-position information. 事前データ作成時において2次元地図データ上で走行可能領域及び走行不能領域に色分けした状態の2次元地図のデータ説明図である。It is data explanatory drawing of the 2D map of the state color-coded into the driving | running | working possible area | region and the driving impossible area | region on 2D map data at the time of prior data creation. 走行可能領域及び走行不能領域における特徴量である近傍領域の凹凸の分布を示すヒストグラムである。It is a histogram which shows distribution of the unevenness | corrugation of the vicinity area | region which is the feature-value in a driving | running | working area | region and a driving impossible area | region. 走行可能領域及び走行不能領域における特徴量である近傍領域の凹凸の値に対数をとって示すヒストグラムである。It is a histogram which shows logarithm in the value of the unevenness | corrugation of the vicinity area | region which is the feature-value in a driving | running | working possible area | region and a driving impossible area | region. 図1における走行領域判別装置を用いて移動ロボットの前方側の領域を走行可能領域及び走行不能領域に区分け処理した際の結果説明図である。FIG. 7 is a result explanatory diagram when a region on the front side of the mobile robot is divided into a travelable region and a travel impossible region using the travel region determination device in FIG. 1.

符号の説明Explanation of symbols

1 移動ロボットの走行領域判別装置
10 外界計測部
11 1軸レーザレンジファインダ
13 バーチカルジャイロ(座標変換手段)
30 処理部
30a 事前データメモリ
G 走行可能領域
NG 走行不能領域
R 移動ロボット
DESCRIPTION OF SYMBOLS 1 Mobile robot travel area discriminating apparatus 10 External measurement unit 11 1-axis laser range finder 13 Vertical gyro (coordinate conversion means)
30 processing unit 30a advance data memory G travelable area NG travel impossible area R mobile robot

Claims (4)

自律して走行する移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分けする走行領域判別装置であって、
レーザ光を走査して前記移動ロボットの前方側の形状データを取得するレーザレンジファインダと、このレーザレンジファインダで得たセンサ座標系データを直交座標系データへ変換する座標変換手段を具備した外界計測部と、
事前データメモリを具備して、この事前データメモリに格納した事前データと前記外界計測部で得た形状データの幾何的な特徴量とから、前記移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分け処理する処理部を備え、
前記処理部の事前データメモリに格納した事前データは、前記外界計測部を具備した車両を実際に走行させてそのレーザレンジファインダにより取得した形状データの複数の幾何的な特徴量と、このレーザレンジファインダにより取得した形状データをマッピングした2次元地図上において分類された走行可能領域及び走行不能領域の分類結果とから成り、
前記処理部では、自律して走行する前記移動ロボット上において前記外界計測部で得た形状データの複数の幾何的な特徴量に対して、前記事前データメモリに格納した前記事前データを教師データとする分類器を適用して、前記移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分け処理すると共に、特に走行領域が屋外不整地である場合に、轍などの微かな車両通過跡に沿った経路を走行可能領域として処理する
ことを特徴とする移動ロボットの走行領域判別装置。
A traveling region discriminating device that divides an area on the front side of a mobile robot that travels autonomously into a travelable region and a travel impossible region due to a failure,
A laser range finder that scans a laser beam to acquire shape data on the front side of the mobile robot, and an external field measurement that includes coordinate conversion means for converting sensor coordinate system data obtained by the laser range finder into orthogonal coordinate system data And
An advance data memory is provided, and an area on the front side of the mobile robot and an obstacle are obtained from the advance data stored in the advance data memory and the geometric feature amount of the shape data obtained by the external measurement unit. It has a processing unit that performs processing to divide into areas that cannot be driven by
The pre-data stored in the pre-data memory of the processing unit includes a plurality of geometric feature amounts of shape data obtained by actually driving a vehicle including the external measurement unit and acquired by the laser range finder, and the laser range. It consists of the classification result of the runnable area and the runnable area classified on the two-dimensional map to which the shape data acquired by the finder is mapped,
In the processing unit, the pre-data stored in the pre-data memory is instructed for a plurality of geometric feature amounts of the shape data obtained by the external measurement unit on the mobile robot traveling autonomously. By applying a classifier as data, the area on the front side of the mobile robot is divided into a travelable area and a travel impossible area due to an obstacle , and in particular when the travel area is an outdoor rough terrain. A traveling region discrimination device for a mobile robot, wherein a route along a kana vehicle passing trace is processed as a travelable region.
前記処理部は、前記外界計測部で得た形状データの複数の幾何的な特徴量の値に対して、対数をとった値を用いて前記区分け処理を行う請求項1に記載の移動ロボットの走行領域判別装置。 2. The mobile robot according to claim 1, wherein the processing unit performs the classification process using a logarithm value with respect to a plurality of geometric feature values of the shape data obtained by the external measurement unit. Traveling area discrimination device. 自律して走行する移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分けする走行領域判別方法であって、
車両を実際に走行させてこの車両に搭載したレーザレンジファインダにより取得した形状データから抽出した複数の幾何的な特徴量と、前記レーザレンジファインダにより取得した形状データをマッピングした2次元地図上において分類された走行可能領域及び走行不能領域の分類結果とから成る事前データをあらかじめ作成し、
前記移動ロボットを走行させる時点において、この移動ロボットに搭載したレーザレンジファインダからレーザ光を走査して該移動ロボットの前方側の形状データを取得すると共に、このレーザレンジファインダで得たセンサ座標系データを直交座標系データへ変換した後、
前記移動ロボットのレーザレンジファインダで得た形状データから抽出した複数の幾何的な特徴量に対して、あらかじめ作成した前記事前データを教師データとする分類器を適用して前記移動ロボットの前方側の領域を走行可能領域及び障害による走行不能領域に区分けし、特に走行領域が屋外不整地である場合において、轍などの微かな車両通過跡に沿った経路を走行可能領域として処理する
ことを特徴とする移動ロボットの走行領域判別方法。
A traveling area determination method that divides an area on the front side of a mobile robot that travels autonomously into a travelable area and a travel impossible area due to an obstacle,
Classification on a two-dimensional map in which a plurality of geometric feature values extracted from shape data acquired by a laser range finder mounted on the vehicle by actually running the vehicle and shape data acquired by the laser range finder are mapped Create in advance pre-composed data consisting of the classification results of the runnable area and non-runnable area,
At the time of traveling the mobile robot, the laser range finder mounted on the mobile robot is scanned with laser light to obtain shape data on the front side of the mobile robot, and the sensor coordinate system data obtained by the laser range finder Is converted to Cartesian coordinate system data,
A front side of the mobile robot is applied to a plurality of geometric features extracted from the shape data obtained by the laser range finder of the mobile robot by applying a classifier using the pre-created pre-prepared data as teacher data. Is divided into a runnable area and a non-runnable area due to obstacles , and in particular when the travel area is an outdoor rough terrain, a route along a slight vehicle passing trace such as a saddle is processed as the runnable area. A mobile robot travel area determination method.
前記レーザレンジファインダで得た形状データの複数の幾何的な特徴量の値に対して、対数をとった値を用いて前記区分け処理を行う請求項に記載の移動ロボットの走行領域判別方法。 4. The traveling region discrimination method for a mobile robot according to claim 3 , wherein the segmenting process is performed using logarithm values for a plurality of geometric feature values of the shape data obtained by the laser range finder.
JP2008012551A 2008-01-23 2008-01-23 Traveling area discrimination device and traveling area discrimination method for mobile robot Active JP5083543B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008012551A JP5083543B2 (en) 2008-01-23 2008-01-23 Traveling area discrimination device and traveling area discrimination method for mobile robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2008012551A JP5083543B2 (en) 2008-01-23 2008-01-23 Traveling area discrimination device and traveling area discrimination method for mobile robot

Publications (2)

Publication Number Publication Date
JP2009175932A JP2009175932A (en) 2009-08-06
JP5083543B2 true JP5083543B2 (en) 2012-11-28

Family

ID=41030969

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008012551A Active JP5083543B2 (en) 2008-01-23 2008-01-23 Traveling area discrimination device and traveling area discrimination method for mobile robot

Country Status (1)

Country Link
JP (1) JP5083543B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017036945A (en) * 2015-08-07 2017-02-16 株式会社Ihiエアロスペース Moving body and obstacle detection method of the same
US9851211B2 (en) 2015-06-12 2017-12-26 Ricoh Company, Ltd. Information processing apparatus, computer-readable recording medium, and information processing system

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011013803A (en) * 2009-06-30 2011-01-20 Ihi Corp Peripheral shape detection device, autonomous mobile device, operation auxiliary device for mobile body, peripheral shape detection method, control method for the autonomous mobile device and operation auxiliary method for the mobile body
JP5304534B2 (en) * 2009-08-21 2013-10-02 トヨタ自動車株式会社 Self-position estimation apparatus, self-position estimation method and program
JP5407897B2 (en) * 2010-01-25 2014-02-05 株式会社Ihi Image classification method, apparatus, and program
JP5531643B2 (en) * 2010-01-25 2014-06-25 株式会社Ihi Passage detection method, apparatus, and program
JP5605289B2 (en) * 2011-04-05 2014-10-15 トヨタ自動車株式会社 Fault recognition method and fault recognition system for moving body
JP6386794B2 (en) 2014-06-04 2018-09-05 日立建機株式会社 Transport vehicle
JP2016191735A (en) * 2015-03-30 2016-11-10 シャープ株式会社 Map creation device, autonomous traveling body, autonomous traveling body system, portable terminal, map creation method, map creation program and computer readable recording medium
JP6438354B2 (en) * 2015-05-29 2018-12-12 株式会社豊田中央研究所 Self-position estimation apparatus and mobile body equipped with self-position estimation apparatus
US11630209B2 (en) * 2019-07-09 2023-04-18 Waymo Llc Laser waveform embedding
WO2021171500A1 (en) * 2020-02-27 2021-09-02 三菱電機株式会社 Robot control device, robot control method, and learning model generation device
CN113739850B (en) * 2021-09-03 2024-01-19 浙江国净净化科技有限公司 Inspection sampling robot based on automatic data processing

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3150018B2 (en) * 1993-08-27 2001-03-26 株式会社アイ・エイチ・アイ・エアロスペース Route determination method for unmanned mobile spacecraft
JP2006018681A (en) * 2004-07-02 2006-01-19 Matsushita Electric Ind Co Ltd Process control method
JP4464893B2 (en) * 2004-09-13 2010-05-19 パナソニック株式会社 Mobile robot

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9851211B2 (en) 2015-06-12 2017-12-26 Ricoh Company, Ltd. Information processing apparatus, computer-readable recording medium, and information processing system
JP2017036945A (en) * 2015-08-07 2017-02-16 株式会社Ihiエアロスペース Moving body and obstacle detection method of the same

Also Published As

Publication number Publication date
JP2009175932A (en) 2009-08-06

Similar Documents

Publication Publication Date Title
JP5083543B2 (en) Traveling area discrimination device and traveling area discrimination method for mobile robot
CN111291676B (en) Lane line detection method and device based on laser radar point cloud and camera image fusion and chip
EP1780675B1 (en) Object detector
EP2574958B1 (en) Road-terrain detection method and system for driver assistance systems
JP4297501B2 (en) Moving object periphery monitoring device
JP3937414B2 (en) Planar detection apparatus and detection method
Bar Hillel et al. Recent progress in road and lane detection: a survey
US8564657B2 (en) Object motion detection system based on combining 3D warping techniques and a proper object motion detection
CN107646114A (en) Method for estimating track
JP5023186B2 (en) Object motion detection system based on combination of 3D warping technique and proper object motion (POM) detection
Levinson Automatic laser calibration, mapping, and localization for autonomous vehicles
JP2022022287A (en) Map making device, method for control, program, and storage medium
KR20200039548A (en) Learning method and testing method for monitoring blind spot of vehicle, and learning device and testing device using the same
CN116710961A (en) Method and system for ground segmentation using graphic cutting
Beycimen et al. A comprehensive survey of unmanned ground vehicle terrain traversability for unstructured environments and sensor technology insights
JP2006053754A (en) Plane detection apparatus and detection method
JP4270386B2 (en) Moving body moving amount calculation device
Azevedo et al. Real-time road surface mapping using stereo matching, v-disparity and machine learning
Gu et al. Correction of vehicle positioning error using 3D-map-GNSS and vision-based road marking detection
US20220309776A1 (en) Method and system for determining ground level using an artificial neural network
CN215495425U (en) Compound eye imaging system and vehicle using same
WO2023017624A1 (en) Drive device, vehicle, and method for automated driving and/or assisted driving
Jiang Semi-automated Generation of Road Transition Lines Using Mobile Laser Scanning Data
Chang et al. Real-Time Visual-Servo Navigation for Map-Free Self-Driving in Unstructured Outdoor Environments
CN117795566A (en) Perception of three-dimensional objects in sensor data

Legal Events

Date Code Title Description
A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A711

Effective date: 20090702

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20100823

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20120120

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20120125

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120313

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: 20120815

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20120821

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

Ref document number: 5083543

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20150914

Year of fee payment: 3

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250