(57)【要約】【課題】不整地・未舗装路においても高速移動可能な経路を作成し、また、舗装路においても道路形状及び自律走行体の運動特性を考慮した走行経路を作成して高速走行ができるようにする。【解決手段】本発明は、測距部３１により走行領域内の測距データを取得する測距データ取得手段３０ａと、その測距データに基づいて、局所地図を作成する局所地図作成手段３０ｂと、その局所地図に基づいて、自己位置から続く走行可能エリアを抽出し、走行可能エリア地図を生成する走行可能エリア地図作成手段３０ｃと、走行可能エリア地図に基づいて、道なり方向を設定する道なり方向設定手段３０ｆと、設定された道なり方向に基づいて、走行経路を生成する走行経路生成手段３０ｇと、自己位置、及び方位データを取得する自己位置データ取得手段３０ｈと、生成した走行経路及び自己位置データに従って、走行機構を介して走行させる自律走行手段１０ａとを有する。【選択図】図２
2012145998.tif 000002
【特許請求の範囲】
【請求項１】
走行領域内の測距データを取得するための測距部と、走行するための走行機構を有する自律走行体において、
測距部により走行領域内の測距データを取得する測距データ取得手段と、
取得した測距データに基づいて、走行可能エリア、障害物エリア、及び未計測エリアを含む局所地図を作成する局所地図作成手段と、
局所地図に基づいて、自己位置から続く走行可能エリアを抽出し、走行可能エリア地図を生成する走行可能エリア地図作成手段と、
走行可能エリア地図に基づいて、道なり方向を設定する道なり方向設定手段と、
設定された道なり方向に基づいて、走行経路を生成する走行経路生成手段と、
自己位置、及び方位データを取得する自己位置データ取得手段と、
生成した走行経路及び自己位置データに従って、走行機構を介して走行させる自律走行手段とを有することを特徴とする自律走行体。
【請求項２】
走行可能エリア地図作成手段は、自律走行体の形状及び旋回特性を考慮することで、連続するエリアを抽出することを特徴とする請求項１に記載の自律走行体。
【請求項３】
走行可能エリア地図作成手段は、自律走行体の形状に対して小さいエリア、及び自己位置から継続していない飛び地にあるエリアを除くことにより走行可能エリア地図を生成することを特徴とする請求項１又は２に記載の自律走行体。
【請求項４】
道なり方向設定手段は、走行可能エリアが未計測エリアに接する領域が連続する範囲を道の分岐として認識し、道の分岐毎に初期地点から最遠方地点までの走行可能エリアにフィッティングさせた内接円の中心地点を結ぶ近似曲線の接線方向を道なり方向として設定していることを特徴とする請求項１〜３のいずれか１項に記載の自律走行体。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、自律して走行する無人車両やロボット等の自律走行体に関する。
【背景技術】
【０００２】
この種の自律走行体として、特許文献１に記載された構成のものがある。
特許文献１に記載されている自律走行体は、搭載されている撮像装置によって撮像された画像を、複数の領域に分割して、各分割領域毎に求めた分割領域内の特徴量と所定の閾値とを比較して追従対象領域を抽出し、この追従対象領域上に注視点を設定し、この注視点に向かうための走行体の操舵角を算出し、この操舵角によって操舵制御することを内容としたものである。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２００２‐１３２３４３号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
しかしながら、特許文献１に記載の自律走行体は、不整地・未舗装路では局所的な凹凸や傾斜等の路面特性及び道路境界の不明確さのために、注視点を分割領域毎に閾値のみで抽出するとジグザグ走行となり、また、分割領域毎に注視点を設定し、それらを曲線近似した経路に向かう制御となっており、自律走行体の運動特性を考慮していないため、走行速度を上げることができない。
さらに、画像を用いているため、不整地・未舗装路に顕著な路面の凹凸、斜面、森林内の日射、夜間に対応できないという未解決の課題がある。
【０００５】
そこで本発明は、不整地・未舗装路ばかりでなく、舗装路においても道路形状及び自律走行体の運動特性を考慮した高速走行を行なえる走行経路を作成できる自律走行体の提供を目的としている。
【課題を解決するための手段】
【０００６】
上記課題を解決するための本発明は、走行領域内の測距データを取得するための測距部と、走行するための走行機構を有する自律走行体において、測距部により走行領域内の測距データを取得する測距データ取得手段と、取得した測距データに基づいて、走行可能エリア、障害物エリア、及び未計測エリアを含む局所地図を作成する局所地図作成手段と、局所地図に基づいて、自己位置から続く走行可能エリアを抽出し、走行可能エリア地図を生成する走行可能エリア地図作成手段と、走行可能エリア地図に基づいて、道なり方向を設定する道なり方向設定手段と、設定された道なり方向に基づいて、走行経路を生成する走行経路生成手段と、自己位置、及び方位データを取得する自己位置データ取得手段と、生成した走行経路及び自己位置データに従って、走行機構を介して走行させる自律走行手段とを有することを特徴としている。
【発明の効果】
【０００７】
本発明によれば、不整地・未舗装路ばかりでなく、舗装路においても道路形状及び自律走行体の運動特性を考慮した高速走行を行なえる走行経路を作成することができる。
【図面の簡単な説明】
【０００８】
【図１】本発明の一実施形態に係る自律走行体システムの一部をなす自律走行体の概略構成を示す説明図である。
【図２】同上の自律走行体に設けた制御回路のブロック図である。
【図３】同上の自律走行体の動作状態を示すフローチャートである。
【図４】（Ａ）〜（Ｃ）は、道なり方向を設定する過程を示す説明図である。
【図５】（Ａ），（Ｂ）は、道なり方向を設定する過程を示す説明図である。
【図６】（Ａ），（Ｂ）は、道なり方向を設定する過程を示す説明図である。
【発明を実施するための形態】
【０００９】
以下に、本発明を実施するための形態について、図面を参照して説明する。図１は、本発明の一実施形態に係る自律走行体システムの一部をなす自律走行体の概略構成を示す説明図、図２は、その自律走行体に設けた制御回路のブロック図である。
【００１０】
本発明の一例に係る自律走行体システムＡは、図１に示すように、自律走行体の一例である無人車両Ｂと、遠隔操縦装置（図示しない）とを無線通信回線を介して接続可能に構成したものである。
【００１１】
無人車両Ｂは、一般の乗用車両のハンドル，アクセル及びブレーキを操作するための各種のアクチュエータを付加した構成のものであり、それらのアクチュエータを下記の車両制御用コンピュータ１０、自律制御用コンピュータ３０によって駆動制御するようにしている。
【００１２】
車両制御用コンピュータ１０と自律制御用コンピュータ３０は、それぞれＣＰＵ（Central Processing Unit）やインターフェース回路（いずれも図示しない）等からなるものであり、それら車両制御用コンピュータ１０と自律制御用コンピュータ３０は、イーサネット（登録商標）１１を介して互いに接続されている。
【００１３】
自律制御用コンピュータ３０の入力ポートには、走行領域内の測距データを取得するための測距部３１が接続されている。
測距部３１は、ステレオカメラ３２と、レーザセンサ（以下、「ＬＲＦ」という。）３３を有して構成されている（図２参照）。
【００１４】
ＬＲＦ３３は、レーザ光の投光から受光までの時間を計測するタイムオブフライト方式による測距を行うものであり、本実施形態において示すものは、１つのレーザ光源を用い、光軸を光学的又は機械的に掃引することにより、物体の３次元的な形状を取得するスキャンタイプのものである。
【００１５】
ステレオカメラ３２は、自律走行を行うときに必要な奥行き方向の情報を含む画像データを取得するためのものである。
【００１６】
車両制御用コンピュータ１０の入力ポートには、イーサネット（登録商標）１１を介して無線ＬＡＮ１２と操縦用カメラ１４が、また、ＧＰＳ（Global Positioning System）１５、バーチカルジャイロ１６、モータドライバ１７及び車速パルス２０がそれぞれシリアル回線を介して接続されている。なお、符号１３は、無線ＬＡＮ１２に接続されているアンテナを示している。
【００１７】
また、出力ポートには、モータドライバ１７を介して、操舵用アクチュエータ１８、ブレーキ／アクセル用アクチュエータ１９がそれぞれ接続されている。
なお、図１に示す９…は走行輪であり、これらの走行輪９…とともに、モータドライバ１７、操舵用アクチュエータ１８、ブレーキ／アクセル用アクチュエータ１９により走行機構Ｃを構成している。
【００１８】
バーチカルジャイロ１６は、無人車両Ｂの鉛直面内における傾斜姿勢、従ってまた、操縦用カメラ１４、及びＬＲＦ３３の光軸姿勢（向き）情報を取得するものである。
ＧＰＳ１５は、無人車両Ｂの測位情報を取得するためのものである。
車速パルス２０は、無人車両Ｂの走行速度を測定するためのものであり、その無人車両Ｂの走行速度をパルス情報として出力するものである。
【００１９】
また、車両制御用コンピュータ１０は、イーサネット（登録商標）１１，無線ＬＡＮ１２及びアンテナ１３を通じて、ＧＰＳ１５、バーチカルジャイロ１６で取得した各種の情報を、図示しない遠隔操縦装置に向けて送信する機能の他、その遠隔操縦装置から送信される操縦情報に基づき、操舵用アクチュエータ１８、ブレーキ／アクセル用アクチュエータ１９をモータドライバ１７を介して駆動制御する機能を併有している。
【００２０】
上述した自律制御用コンピュータ３０は、図示しない記憶部に記憶されている所要のプログラムの実行により、次の各機能を発揮する。
（１）測距部３１により走行領域内の測距データを取得する機能。これを「測距データ取得手段３０ａ」という。
【００２１】
（２）取得した測距データに基づいて、走行可能エリア、障害物エリア、及び未計測エリアを含む局所地図を作成する機能。これを「局所地図作成手段３０ｂ」という。
本実施形態においては、ＬＲＦ３３により取得したレーザ光データと、ステレオカメラ３２により撮像した画像データの双方に基づき、走行領域内における障害物エリア、及び未計測エリアを抽出し、無人車両Ｂが到達する位置を起点とした必要な方向を臨む局所地図を作成している。
【００２２】
「局所地図」は、地形の凹凸や傾斜に応じた走行可能度の指標（以下、「コスト」という。）を有するものである。コストが低い地点は低速走行、また、コストが高い地点では高速走行が可能である。
本発明においては、道路形状に応じた無人車両Ｂの走行方向を求める際、走行速度を考慮することなく、走行可能なコスト値の領域を全て走行可能領域として、走行方向を決定している。
【００２３】
（３）局所地図に基づいて、自己位置から続く走行可能エリアを抽出し、走行可能エリア地図を生成する機能。この機能を「走行可能エリア地図作成手段３０ｃ」という。
本実施形態においては、自律走行体の形状及び旋回特性を考慮することで、自己位置から続く走行可能エリアを抽出している。
また、無人車両Ｂの形状に対して小さいエリア、及び自己位置から継続していない飛び地にあるエリアを除くことにより走行可能エリア地図を生成する。
【００２４】
（４）走行可能エリア内の通過軌跡を探索する機能。この機能を「通過軌跡探索手段３０ｄ」という。
（５）探索した通過軌跡に基づいて、通過軌跡地図を作成する機能。この機能を「通過軌跡地図作成手段３０ｅ」という。
（６）走行可能エリア地図に基づいて、道なり方向を設定する機能。この機能を「道なり方向設定手段３０ｆ」という。
本実施形態においては、走行可能エリアが未計測エリアに接する領域が連続する範囲を道の分岐として認識し、道の分岐毎に初期地点から最遠方地点までの走行可能エリアにフィッティングさせた内接円の中心地点を結ぶ近似曲線の接線方向を道なり方向として設定している。
具体的には、初期地点から最遠方地点までの通過軌跡にフィッティングさせた内接円の中心地点を結ぶ近似曲線の接線方向を道なり方向として設定している。
本実施形態においては、「無人車両Ｂが走行可能な走行可能エリア」を「道」という。
「道なり方向」とは、無人車両Ｂが走行可能な領域（道）が続く方向のことである。
すなわち、道なり方向は、局所地図内の特定の地点における方向を意味しているのではなく、道全体にわたり定義される道の方向である。
【００２５】
（７）設定された道なり方向に基づいて、走行経路を生成する機能。この機能を「走行経路生成手段３０ｇ」という。
具体的には、設定された道なり方向、自己の運動特性及び路面特性に基づいて、走行経路を生成する。
走行途中おいて、現在位置に基づいて、複数の経由位置のうち次に通過する経由位置に向かうための走行経路を所定の経路探索条件下で探索し生成する。また、経路探索条件下で前記移動経路を見出せなかったときには、上記経路探索条件を変更し、その変更した経路探索条件の下で前記走行経路を再び探索するようにしている。
これにより、走行経路をより確実に見出し、無人車両Ｂの走行を継続させられる可能性を効果的に高めることができる。
（８）自己位置、及び方位データを取得する機能。この機能を「自己位置データ取得手段３０ｈ」という。
具体的には、バーチカルジャイロ１６から相対的な方位を取得し、車速パルス２０から得られる距離情報から、デットレコニング法により相対的な自己位置を生成している。
【００２６】
上述した車両制御用コンピュータ１０は、図示しない記憶部に記憶されている所要のプログラムの実行により、次の各機能を発揮する。
（９）生成された走行経路に従って、走行機構Ｃを介して走行させる機能。これを「自律走行手段１０ａ」という。
【００２７】
本発明に係る無人車両Ｂの動作について、図３〜６を参照して説明する。図３は、動作状態を示すフローチャート、図４（Ａ）〜（Ｃ）、図５（Ａ），（Ｂ）及び図６（Ａ），（Ｂ）は、道なり方向を設定する過程を示す説明図である。なお、図４〜６において示す「×」は、無人車両Ｂが存在する地点を示している。
まず、無人車両Ｂに搭載している測距部３１により地形の計測を行なうとともに、その認識を行ない、認識した地形に基づき上記した局所地図を作成する。
【００２８】
ステップ１（図中、「Ｓ１」と略記する。以下、同様。）：得られた局所地図により、図４（Ａ）に示すような、走行可能領域ａ，障害物領域ｂ，未計測領域ｃを３値化する。
【００２９】
ステップ２：無人車両Ｂの通過軌跡を、局所地図作成手段３０ｂにより作成した局所地図上において、下記のステップ２ａ〜２ｊに示すようにして探索する（図４（Ｂ）参照）。
ステップ２ａ：無人車両Ｂの初期位置と方位を取得する。
（ｘ＊，ｙ＊，θ＊）＝（０，０，０）
ステップ２ｂ：通過軌跡を算出するために、操舵角度δを設定する。
操舵角度δは、操舵可能範囲内でランダムに設定している。
【００３０】
ステップ２ｃ：無人車両Ｂの通過地点を算出する。
Ｒ＝Ｌ／ｔａｎ（δ）
θ＝θ＊＋１／Ｒ∫ｓ０ｄｓ
ｘ＝ｘ＊＋∫ｓ０ｃｏｓ（θ）ｄｓ
ｙ＝ｙ＊＋∫ｓ０ｓｉｎ（θ）ｄｓ
Ｒ：旋回半径
Ｌ：ホイールベース
Ｓ：通過軌跡の長さ（設定値）
θ：無人車両Ｂの方位
ｘ，ｙ：無人車両Ｂの地点
【００３１】
ステップ２ｄ：障害物領域ｂに接触するか否かを判定し、障害物領域ｂに接触すると判定したときにはステップ２ｈに進み、そうでなければステップ２ｅに進む。
すなわち、障害物領域ｂに接触するか否かを判定する障害物接触判定手段を有している。
【００３２】
ステップ２ｅ：未計測領域ｃに到達するか否かを判定し、未計測領域ｃに到達すると判定したときにはステップ２ｉに進み、そうでなければステップ２ｆに進む。
【００３３】
ステップ２ｆ：∫ｄｓ＜Ｓを満たすか否かを判定し、∫ｄｓ＜Ｓを満たすと判定されればステップ２ｃに戻り、そうでなければステップ２ｇに進む。
ステップ２ｇ：無人車両Ｂの通過地点と方位を算出する。
（ｘ＊，ｙ＊，θ＊）
ステップ２ｈ：ステップ２ｃでの計算を障害物領域ｂに接触する軌跡の探索開始地点まで戻し、ステップ２ｂに戻る。
【００３４】
ステップ２ｉ：通過軌跡の探索初期地点から車幅の通過軌跡を記憶部に登録して、ステップ２ｊに進む。
ステップ２ｊ：繰り返し計算回数になったか否かを判定し、繰り返し計算回数になったと判定したときにはステップ３に進み、そうでなければステップ２ｂに戻る。
【００３５】
ステップ３：ステップ２ｉにおいて登録した車幅の通過軌跡を合成し、通過軌跡の地図を作成する（図４（Ｃ）参照）。
ステップ４：過去の通過軌跡の地図を重ね合わせた通過軌跡の地図において、初期地点からの通過軌跡の地図の最遠方地点まで通過軌跡に内接円をフィッティングさせる（図５（Ａ）参照）。
【００３６】
ステップ５：内接円の中心地点を、これまでに求めた中心地点も含め、最小二乗法で多項式近似曲線ｅを求める（図５（Ｂ）参照）。
ステップ６：通過軌跡域内の任意地点から最も近い多項式近似曲線ｅの方向を道なり方向として設定する（図６（Ａ）参照）。
ステップ７：通過軌跡地図内において、無人車両Ｂの初期位置から道なり方向、自己の運動特性及び路面特性に基づいて、経路目標点に到る走行経路を探索する（図６（Ｂ）参照）。
そして、探索した走行経路に沿い、走行機構Ｃを介して無人車両Ｂを走行させる。
【００３７】
以上の構成からなる無人車両によれば、次の効果を得ることができる。
・不整地，未舗装路においても高速走行可能な走行経路を作成することができるとともに、舗装路においても道路形状及び自律走行体の運動特性を考慮した走行経路を作成して高速走行ができる。
【００３８】
・事前地図を用いる必要がないために、事前地図に表されない河川敷や荒地等に自然発生的に形成されるわだち路であっても、道を辿るように自律走行を継続することができるとともに、無人車両Ｂの自己位置と事前地図を用いて計画される事前経路に示される座標値との誤差を考慮しなくともよいために、ＧＰＳ等の真位置を測定するための装置を設ける必要がない。
【００３９】
・無人車両Ｂに搭載する検出装置が検出できる最遠方までの道なり方向が判明していることから、最遠方地点で無人車両Ｂが道なり方向に向かう走行経路を計画すれば、道から逸脱することがない。
【００４０】
上述した実施形態においては、自律走行体の一例である無人車両Ｂと、遠隔操縦装置（図示しない）とを無線通信回線を介して接続可能に構成した例について説明したが、この構成に限るものではない。
【符号の説明】
【００４１】
１０ａ      自律走行手段
３０ａ      測距データ取得手段
３０ｂ      局所地図作成手段
３０ｃ      走行可能エリア地図作成手段
３０ｆ      道なり方向設定手段
３０ｇ      走行経路生成手段
３０ｈ      自己位置データ取得手段
３１        測距部
Ｂ          自律走行体（無人車両）
Ｃ          走行機構
【図１】
2012145998.tif 000003
【図２】
2012145998.tif 000004
【図３】
2012145998.tif 000005
【図４】
2012145998.tif 000006
【図５】
2012145998.tif 000007
【図６】
2012145998.tif 000008