JP6982999B2 - 経路決定装置と経路決定方法 - Google Patents

Description

本発明は、移動装置の移動経路を決定するための支援情報を人が入力した場合に、この情報に基づいて移動装置の移動経路を決定する経路決定装置と経路決定方法に関する。

火山の噴火や原子力発電所の事故などにより被災した地域において又は他の危険地域において、物資輸送、土木作業、偵察などを行うために、無人の移動装置を用いることがある。
また、空港や航空基地などの広大な場所をパトロールするために、カメラなどの監視用センサを搭載した無人の移動装置を用いることがある。

無人移動装置を制御しながら走行させる方法として、遠隔操作方法、自律制御方法、および半自律制御方法がある。遠隔操作方法では、移動装置から離れた位置で、移動装置から送信されてくる環境データ（例えば移動装置の周囲の状況を示す画像データ）を見ながら、人が操作装置を操作することにより、移動装置の移動（進行方向や速度など）を制御する。自律制御方法では、移動装置に設けた移動制御装置により、予め設定された位置へ移動するように移動装置の移動を制御する。半自律制御方法は、遠隔操作方法と自律制御方法の中間に相当する方法である。すなわち、半自律制御方法では、移動装置が自動で移動している時に、移動装置から離れた位置で、人が操作装置を操作することにより、移動装置の移動（例えば進行方向）を制御できる。

遠隔操作方法、自律制御方法、および半自律制御方法のいずれの場合も、移動装置の周囲の環境データ（例えばカメラが撮像した画像データや、レーザレーダが取得した周囲の計測点群の位置データ）を取得して、どこに障害物が存在するのかを認識する。この障害物の認識に基づいて、移動装置の進行方向側における障害物の手前で移動装置を停止させ、または、障害物を回避するよう移動装置の移動を制御する。

上述したような無人移動装置の走行方法は、例えば下記の特許文献１〜３に記載されている。

特許第５６４７９０５号 特許第５９６９９０３号 特許第５４９８１７８号

ところで、移動装置の円滑な走行が困難となりそうな場合があり得る。これは、一例では、移動装置の進行方向側における分岐路の状況によって生じる。
例えば、狭い走行路において、右折または左折により分岐路へ進入する時に移動装置の向きを９０度より大きく変えなければならない場合に、分岐路への進入に失敗する可能性がある。あるいは、移動装置を、狭い分岐路へ右折または左折により進入させる場合に、分岐路への進入に失敗する可能性がある。なお、このような問題は、遠隔操作方法、自律制御方法、および半自律制御方法のいずれにおいても生じ得る。

そこで、本発明の目的は、移動装置の円滑な走行が困難となりそうな場合に、状況に適した移動経路を探索して決定できる新たな技術を提供することにある。

本発明に係る経路決定装置は、移動装置の移動経路を決定する装置である。経路決定装置は、移動経路に関して、環境地図データにおける目標点と経由点を人が入力装置を用いて指定した場合に、目標点と経由点とを受ける指定受信部と、目標点と経由点に基づいて、環境地図データにおいて障害物に干渉しない移動装置の移動経路を探索して決定する探索装置を備える。探索装置は、環境地図データにおいて、経由点を含む局所領域内に複数の候補点を生成し、目標点を含む別の局所領域内に複数の候補点を生成する候補点生成部と、複数の局所領域からそれぞれ１つずつ選択した候補点の組み合わせを１つの組み合わせとして、複数の組み合わせを特定する組生成部と、特定した複数の組み合わせの各々について、各候補点を通る候補経路を生成し、各候補経路が障害物に干渉するか否かを判断する候補経路生成部と、障害物に干渉しないと判断された各候補経路について、予め定めた評価関数に従って評価値を求め、複数の候補経路から、最良の評価値を持つ候補経路を選択し、選択した候補経路を、移動装置の移動経路として決定する評価部と、を備える。

本発明に係る経路決定方法は、移動装置の移動経路を経路決定装置により探索して決定する方法である。経路決定方法では、次の（Ａ）（Ｂ）を行う。
（Ａ）移動装置の移動経路に関して、環境地図データにおける目標点と経由点を人が入力装置を用いて指定した場合に、目標点と経由点とを受ける。
（Ｂ）目標点と経由点に基づいて、環境地図データにおいて障害物に干渉しない移動装置の移動経路を探索して決定する。
（Ｂ）では、次の（Ｂ１）〜（Ｂ４）を行う。
（Ｂ１）環境地図データにおいて、経由点を含む局所領域内に複数の候補点を生成し、目標点を含む別の局所領域内に複数の候補点を生成し、
（Ｂ２）複数の局所領域からそれぞれ１つずつ選択した候補点の組み合わせを１つの組み合わせとして、複数の組み合わせを特定し、
（Ｂ３）特定した複数の組み合わせの各々について、各候補点を通る候補経路を生成し、各候補経路が障害物に干渉するか否かを判断し、
（Ｂ４）障害物に干渉しないと判断された各候補経路について、予め定めた評価関数に従って評価値を求め、複数の候補経路から、最良の評価値を持つ候補経路を選択し、選択した候補経路を、移動装置の移動経路として決定する。

本発明によると、移動経路に関して、環境地図データにおける目標点と経由点が人により指定され、目標点と経由点を支援情報として受け、この支援情報に基づいて移動経路を探索する。このように、移動装置が移動可能な経路を、人の支援を受けて経路決定装置が探索して決定できる。したがって、経路決定装置だけの探索では、円滑に移動できる経路を探索するのが困難となりそうな場合でも、経路決定装置は、人の支援を受けることにより、状況に適した移動経路を探索して決定できるようになる。

移動装置と支援装置を含む遠隔操作システムを示す。 移動装置と支援装置の構成を示すブロック図である。 （Ａ）は環境地図データを示し、（Ｂ）は経路決定の支援情報が指定された環境地図データを示す。 本発明の実施形態による経路決定装置の構成を示すブロック図である。 （Ａ）は候補点が生成された環境地図データを示し、（Ｂ）は１つの候補経路を表わした環境地図データを示す。 移動制御装置のモードの切り替えを示す説明図である。 自律モードと半自律モードの時における移動装置側の処理を示す。 経路決定の支援方法を示す。 本発明の実施形態による経路決定方法を示すフローチャートである。

本発明の実施形態を図面に基づいて説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。

図１は、移動装置１０と支援装置２０を含む遠隔操作システムを示す。

移動装置１０の車体１は、車両として基本的な走行の機能を有し、地表面２（例えば舗装路または未舗装路）を移動するものであればよい。車体１は、図１のように地表面２と接する車輪が回転駆動されることにより移動する装輪タイプのものであってもよいし、地表面２と接する無端状ベルトが回転駆動されることにより移動する装軌（無限軌道）タイプのものであってもよい。あるいは、車体１は、装輪タイプと装軌タイプを組み合わせたハイブリッドタイプのものであってもよい。

図２は、移動装置１０と支援装置２０の構成を示すブロック図である。

（移動装置の構成）
移動装置１０は、環境計測装置３、位置検出装置５、地図データ生成装置７、経路決定装置３０、移動制御装置９、および通信装置１１を含む。例えば、移動装置１０は無人で移動するものである。

環境計測装置３は、移動装置１０の進行方向側の領域を含む範囲における状況を示す環境データ（障害物と走行可能領域を示すデータ）を取得する。環境計測装置３は、カメラまたはレーザレーダであってよい。レーザレーダは、例えばレーザレンジファインダ（ＬＲＦ）やＬＩＤＡＲ（Ｌａｓｅｒ Ｉｍａｇｉｎｇ Ｄｅｔｅｃｔｉｏｎ Ａｎｄ Ｒａｎｇｉｎｇ）と呼ばれる機器であってよい。環境計測装置３がカメラである場合には、環境データは、カメラが撮像した画像データである。環境計測装置３がレーザレーダである場合には、環境データは、３次元空間内に物体が存在する箇所を示すデータである。

位置検出装置５は移動装置１０に設けられる。位置検出装置５は、地表面２に固定された座標系（以下で固定座標系という）における移動装置１０の車体１の現在位置（以下で移動装置１０の現在位置ともいう）を検出する。位置検出装置５は、例えばＩＭＵ（ｉｎｅｒｔｉａｌ ｍｅａｓｕｒｅｍｅｎｔ ｕｎｉｔ）とＧＮＳＳ（Ｇｌｏｂａｌ Ｎａｖｉｇａｔｉｏｎ Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍ）受信機と、演算部とを有する。ＩＭＵは、車体１に固定された３軸の方向の加速度と、これら３軸まわりの角速度を検出する。ＧＮＳＳ受信機は、複数の航法衛星（例えばＧＰＳ衛星）から電波を受信し、これらの電波に基づいて移動装置１０の位置を求める。演算部は、ＩＭＵが検出した上述の加速度および角速度と、ＧＮＳＳ受信機が求めた移動装置１０の位置とに基づいて、移動装置１０の現在位置を精度よく求める。
なお、位置検出装置５は、固定座標系における移動装置１０の現在位置を検出できれば、上述の構成に限定されず他の構成を有していてもよい。

地図データ生成装置７は、環境計測装置３が取得した環境データと、位置検出装置５が検出した移動装置１０の現在位置とに基づいて、固定座標系における環境地図データを生成する。環境地図データは、移動装置１０の進行方向側の領域を含む範囲のデータであり、この範囲は、例えば移動装置１０の周囲である。環境地図データは、移動装置１０の現在位置を示すとともに、この現在位置に対して、移動装置１０が走行可能な領域と、移動装置１０が走行不能な障害物の領域とを示す。

すなわち、環境地図データが表わす領域の範囲は、移動装置１０の現在位置と、移動装置１０が走行可能な領域と、移動装置１０が走行不能な障害物の領域を含む。このような環境地図データが表わす領域の範囲（広さ）は、環境計測装置３が環境データを取得するために計測を行った範囲であってよい。環境計測装置３がカメラである場合には、環境地図データが表わす範囲は、当該カメラの撮像範囲であり、環境計測装置３がレーザレーダである場合には、環境地図データが表わす範囲は、当該レーザレーダの計測範囲であってよい。

経路決定装置３０は、支援装置２０から経路探索の支援情報として後述の指定を受けない場合には、基本経路探索処理を行う。基本経路探索処理では、経路決定装置３０は、地図データ生成装置７が生成した環境地図データにおいて障害物に干渉しない移動装置１０の基本の移動経路を探索する。この処理の一例では、経路決定装置３０は、予め設定された目標位置へ至るまでの移動装置１０の基本の移動経路を生成する。基本経路探索処理の別の例では、目標位置の他に目標位置へ至るまでに移動装置１０が通過する複数の経由位置も予め設定されており、経路決定装置３０は、移動装置１０が次に通過する経由位置へ至る基本の移動経路を生成する。

環境計測装置３による環境データの取得と、位置検出装置５による移動装置１０の現在位置の検出と、地図データ生成装置７による環境地図データの生成と、経路決定装置３０による基本の移動経路の探索および決定は、移動装置１０の移動中に繰り返し行われる。

移動制御装置９は、経路決定装置３０が決定した移動経路（基本の移動経路または後述の新たな移動経路）を移動装置１０が移動するように移動装置１０の移動を制御する。具体的には、この制御のために、移動制御装置９は、車体１のアクセル、ブレーキ、ステアリング、変速機などをそれぞれ操作する複数のアクチュエータの動作を制御する。

通信装置１１は、移動装置１０から離れた位置にある支援装置２０と無線通信する。例えば、通信装置１１は、地図データ生成装置７が生成した環境地図データを支援装置２０に送信する。また、通信装置１１は、環境計測装置３が取得した環境データも支援装置２０に送信してもよい。さらに、通信装置１１は、上述の基本の移動経路と移動装置１０の現在位置も支援装置２０に送信してもよい。

（支援装置の構成）
支援装置２０は、経路決定装置３０用に設けられ、通信装置２１と表示装置２３と入力装置２５とを備える。支援装置２０は、所定の場所へ置いた状態で使用されるもの（図１の装置２０Ａ）であってもよいし、人の手で持った状態で使用されるもの（図１の装置２０Ｂ）であってもよい。

通信装置２１は、上述の環境地図データを移動装置１０から受信する。通信装置２１は、環境地図データの他に、上述の環境データと基本の移動経路と移動装置１０の現在位置を移動装置１０から受信してもよい。

表示装置２３は、通信装置２１が受信した環境地図データ、または、環境地図データと環境データを、その画面２５ａに表示する。なお、通信装置２１が基本の移動経路と移動装置１０の現在位置も受信した場合には、表示装置２３は、環境地図データにおいて基本の移動経路と移動装置１０の現在位置も表示する。人は、表示された環境地図データなどを見て、移動装置１０の経路生成を支援したい時には、そのための支援情報を、入力装置２５を操作することにより入力できる。図３（Ａ）は、環境地図データの一例を示す。図３（Ａ）は、移動装置１０が、走行可能領域Ｒａの分岐路で左側の分岐路へ曲がって進入するはずが、曲がりきれずに障害物の直前で停止した状態を示す。

入力装置２５は、人に操作されることにより、環境地図データにおける各種の指定を支援情報として入力可能に構成されている。人が、表示装置２３に表示された環境地図データを見ながら入力装置２５を操作できるように、表示装置２３と入力装置２５が配置される。

例えば、入力装置２５により次の（１）〜（４）の指定を入力可能である。
（１）目標点：表示された環境地図データ（すなわち、環境地図データが表わす領域の範囲。以下同様）において、移動装置１０を到達させる目標点の指定。目標点は、例えば環境地図データにおける分岐路内の点であってよいが、これに限定されない。
（２）目標点向き：目標点における移動装置１０の向きを示す目標点向きの指定。
（３）経由点と経由点順序：移動装置１０が目標点へ至る前に通過する経由点の指定。複数の（例えば２つ以上または３つ以上の）経由点を指定する場合には、これらの経由点が移動装置１０により通過される順序（以下で単に経由点順序という）も入力装置２５により指定する。
（４）進行向き：探索対象の移動経路の開始点Ｐ０（例えば移動装置１０の現在位置）と各経由点について、この開始点Ｐ０または経由点からの移動装置１０の移動が前進または後進であることを示す進行向きの指定。ここで、前進とは、移動装置１０が移動装置１０の前方側へ進むことを意味し、後進とは、移動装置１０が移動装置１０の後方側へ進むことを意味する。

図３（Ｂ）は、図３（Ａ）の環境地図データにおいて上記（１）〜（４）の指定をした状態を示す。図３（Ｂ）の例では次のように指定されている。環境地図データにおいて、目標点Ｐｔと経由点Ｐ１〜Ｐ３が指定され、経由点Ｐ１〜Ｐ３の経由点順序（ここでは、Ｐ１、Ｐ２、Ｐ３の順序）が指定されている。目標点向きが矢印Ｘにより指定されている。移動装置１０の現在位置Ｐ０から経由点Ｐ１までの進行向きは後進であり、経由点Ｐ１から経由点Ｐ２までの進行向きは前進であり、経由点Ｐ２から経由点Ｐ３までの進行向きは後進であり、経由点Ｐ３から目標点Ｐｔまでの進行向きは前進である。

入力装置２５は、タッチパネル画面２５ａとマウス２５ｂの一方または両方を有していてよい。

タッチパネル画面２５ａにより目標点または経由点の指定をする場合には、例えば次の操作を行ってよい。人は、タッチパネル画面２５ａに表示されている環境地図データにおける目標点または経由点としたい箇所でタッチパネル画面２５ａを指またはタッチ用器具（例えばタッチペン）によりタッチ操作する。これにより、目標点または経由点の指定を行える。

マウス２５ｂにより上記目標点または経由点の指定をする場合には、例えば次の操作を行ってよい。人は、マウス２５ｂの移動操作をすることにより、表示装置２３の画面２５ａに表示されている環境地図データにおいて目標点または経由点としたい箇所にカーソルを位置させ、この状態でマウス２５ｂのクリック操作をする。これにより、目標点または経由点の指定を行える。

目標点向きの指定は、例えば次のように行われる。画面２５ａにおいて、（例えば環境地図データに含まれる目標点）に初期の矢印が自動的に表示され、この矢印の向きを、上述のタッチパネル画面２５ａに対する上述のタッチ操作、または、上述のマウス２５ｂのクリック操作や移動操作などにより、変更して目標点向きを指定できる。

進行向きの指定は、例えば次のように行われる。タッチパネル画面２５ａには、移動経路の開始点Ｐ０（図３では移動装置１０の現在位置Ｐ０）が表示される。また、タッチパネル画面２５ａには、指定した経由点も表示される。初期状態では、開始点Ｐ０からの進行向きと各経由点からの進行向きの指定は、前進になっている。タッチパネル画面２５ａにおいて、表示された開始点Ｐ０の箇所または経由点の箇所で上述のタッチ操作をし、または、マウス２５ｂの移動操作で、この箇所にカーソルを位置させてマウス２５ｂのクリック操作をする。このようなタッチ操作またはマウス２５ｂの操作により、開始点Ｐまたは経由点からの進行向きの指定が、前進と後進との間で切り替わる。開始点Ｐまたは経由点からの進行向きの指定が、前進か後進であるかがタッチパネル画面２５ａに表示される。例えば、タッチパネル画面２５ａに、図３（Ｂ）の環境地図データが表示され、図３（Ｂ）のように、開始点Ｐまたは経由点から延びている矢印の色により、当該点からの進行向きの指定が前進か後進であるかが表示されている。図３（Ｂ）では、黒塗り三角の矢印は前進を示し、白抜き三角の矢印は後進を示している。

入力装置２５は、上記（１）〜（４）の指定を行えるものであればよく、上述したタッチパネル画面２５ａやマウス２５ｂの例に限定されず、キーボードや他の入力デバイスを有していてもよい。

通信装置２１は、入力装置２５により入力された各指定を、これらの指令を行った環境地図データに対応づけた状態で移動装置１０（すなわち通信装置１１）へ送信する。

（経路決定装置の構成）
図４は、経路決定装置３０の構成を示すブロック図である。経路決定装置３０は、基本探索部２７を備える。経路決定装置３０が支援装置２０から経路探索の支援情報を受けない場合には、基本探索部２７は、上述した基本経路探索処理を行うことにより基本の移動経路を生成して移動制御装置９へ出力する。基本探索部２７は、上述した基本経路探索処理を行う限りにおいて、どのような構成を有していてもよく、例えば、環境地図データに基づいて移動経路を探索する公知の構成を有していてよい。

経路決定装置３０は、通信装置２１，１１を介して支援装置２０から各指定を受けると、各指定に基づいて移動装置１０の新たな移動経路を探索して決定する。そのために、経路決定装置３０は、指定受信部３１と探索装置３２とを有する。

指定受信部３１は、通信装置２１，１１を介して支援装置２０から、上記（１）〜（４）の指定を受ける。
探索装置３２は、上記（１）〜（４）の指定に基づいて、環境地図データにおいて障害物に干渉しない新たな移動経路を探索して決定する。この時、探索する移動経路の開始点Ｐ０は、図３（Ａ）の例では移動装置１０の現在位置である。

探索装置３２は、候補点生成部３３と、組生成部３４と、候補経路生成部３５と、評価部３６とを有する。

候補点生成部３３は、環境地図データにおいて経由点を含む局所領域内に複数の候補点Ｑ（以下で経由点の候補点Ｑともいう）を生成し、環境地図データにおいて目標点を含む局所領域内に複数の候補点Ｑ（以下で目標点の候補点Ｑともいう）を生成する。指定受信部３１が複数の経由点を受けた場合には、候補点生成部３３は、経由点毎に、該経由点を含む局所領域内に複数の候補点Ｑを生成する。

図５（Ａ）は、図３（Ｂ）の各指定に対して候補点生成部３３により候補点Ｑが生成された環境地図データを示す。図５（Ａ）において、Ｒ１〜Ｒ３はそれぞれ経由点Ｐ１〜Ｐ３の局所領域を示し、Ｒｔは目標点の局所領域を示し、各局所領域Ｒ１〜Ｒ３、Ｒｔ内の白い各四角は候補点Ｑを示す。各局所領域は、例えば、経由点または目標点がこの局所領域の中心部に位置する領域である。

組生成部３４は、複数の局所領域からそれぞれ１つずつ選択した候補点Ｑの組み合わせを１つの組み合わせとして、複数の組み合わせを特定する。

候補経路生成部３５は、特定した複数の組み合わせの各々について、該組み合わせの各候補点Ｑを通る候補経路を生成する。候補経路生成部３５は、各組み合わせについて、次の処理（ａ）と処理（ｂ）を繰り返す。
（ａ）局所経路を生成する。
（ｂ）上記（ａ）で生成した局所経路が環境地図データにおいて障害物に干渉するかを判断する。
最初に行う（ａ）では、目標点の候補点又は開始点Ｐ０を生成起点とし、生成起点の次の候補点を端点として、該生成起点から該端点まで延びる局所経路を生成する。２回目以降に行う（ａ）では、前回の（ａ）で生成した局所経路の端点を新たな生成起点とし、該生成起点の次の前記候補点を端点として、該生成起点から該端点まで延びる次の局所経路を生成する。最後に行う（ａ）では、前回の（ａ）で生成した局所経路の端点を新たな生成起点とし目標点の候補点又は開始点Ｐ０を端点として、該生成起点から該端点まで延びる局所経路を生成する。

次に、候補経路生成部３５は、次の条件（ｃ）を満たす複数の組み合わせを特定する。（ｃ）開始点Ｐ０と目標点の候補点Ｑの一方から他方まで至る経路を構成する各局所経路（全ての局所経路）が障害物に干渉しないと上記（ｂ）で判断された。

また、候補経路生成部３５は、条件（ｃ）を満たす各組み合わせについて、この組み合わせの各候補点Ｑを通る経路（すなわち、各局所経路により構成される経路）を上述の候補経路とする。図５（Ｂ）は、図５（Ａ）の場合において生成された候補経路の１つを太い破線で示している。

評価部３６は、生成された各候補経路について、予め定めた評価関数（評価関数の具体例は後述する）に従って評価値を求め、複数の候補経路から、最良の評価値を持つ候補経路を選択し、選択した該候補経路を、移動装置１０の新たな移動経路として決定する。なお、条件（ｃ）を満たす組み合わせが１つである場合には、探索装置３２は、この組み合わせの各局所経路により構成される経路を移動装置１０の新たな移動経路として決定する。

（各装置における処理）
経路決定装置３０のモードには、本実施形態では、通常モードと待機モードと支援モードがある。
図６は、経路決定装置３０のモードの切り替えを示す説明図である。

＜待機モード＞
移動装置１０を起動させた初期時点では、経路決定装置３０は待機モードにあり、移動装置１０は停止している。この状態で、人が入力装置２５を操作することにより、通常モード指令を入力すると、この通常モード指令が通信装置２１から移動装置１０へ送信される。これにより、経路決定装置３０のモードが通常モードに切り替えられる。

＜通常モード＞
通常モードには、自律モードと遠隔操作モードと半自律モードとがある。これらのモード間の切り替えは、入力装置２５に設けたモード切替用の操作部により行われてよい。この操作部が人に操作されると、この操作に応じたモード切替指令が入力されて通信装置２１から移動装置１０へ送信され、これにより、経路決定装置３０のモードが、初期のモード（例えば自律モード）からモード切替指令に示されるモード（自律モード、遠隔操作モードまたは半自律モード）に切り替えられる。
図７は、自律モードと半自律モードの時における移動装置１０側の処理を示す。
＜自律モード＞

自律モードまたは半自律モードの時に、移動装置１０において基本の移動経路を生成するための処理が行われる。この処理は、次のステップＳ１〜Ｓ３の繰り返しである。
ステップＳ１において、環境計測装置３は、環境データを取得し、位置検出装置５は、移動装置１０の現在位置を検出する。
ステップＳ２において、地図データ生成装置７は、ステップＳ１で取得された環境データと、ステップＳ１で検出された移動装置１０の現在位置とに基づいて、環境地図データを生成する。
ステップＳ３において、経路決定装置３０の基本探索部２７は、ステップＳ２で生成された環境地図データと、予め与えられた目標位置または次の経由位置とに基づいて、移動装置１０の現在位置から目標位置または次の経由位置へ向かうための基本の移動経路を生成する。

ステップＳ１〜Ｓ３の繰り返しにおいて、ステップＳ３で基本の移動経路が生成される度に、この移動経路は、経路決定装置３０から移動制御装置９へ出力される。

ステップＳ４において、移動制御装置９は、ステップＳ３で生成された基本の移動経路を受ける度に、この移動経路を移動装置１０が移動するように移動装置１０の移動を制御する。

また、ステップＳ１で環境データが取得される度に、または、環境データが取得される頻度よりも低い頻度で、最新の当該環境データは通信装置１１から支援装置２０（すなわち通信装置２１）へ送信される。ステップＳ２で環境地図データが生成される度に、または、環境地図データが生成される頻度よりも低い頻度で、最新の当該環境地図データは通信装置１１から支援装置２０へ送信される。このように通信装置１１から送信された環境データと環境地図データは、支援装置２０における表示装置２３に表示される。この時、環境データと環境地図データは、それぞれ、図１のように同じ画面２５ａの異なる領域に表示されてよい。

＜半自律モード＞
通常モードが半自律モードである場合には、上述のステップＳ１〜Ｓ４が繰り返し行われている時に、ステップＳ５において、人は、表示装置２３に表示された環境データまたは環境地図データを見ながら、適宜の遠隔操作装置を操作できる。遠隔操作装置は、入力装置２５に組み込まれていてもよいし、入力装置２５とは別個に設けられていてもよい。

ステップＳ５において、遠隔操作装置が人に操作されると、この操作に応じた操作指令が、通信装置２１から移動装置１０へ送信される。
この場合、経路決定装置３０の基本探索部２７は、ステップＳ３において、ステップＳ５で送信された操作指令と、ステップＳ２で生成された環境地図データとに基づいて、障害物に干渉しない移動装置１０の基本の移動経路を表わす経路データを生成する。操作指令は、例えば、移動装置１０のアクセル操作量、ブレーキ操作量、進行方向などを示す。経路データは、移動経路と、移動経路上の各点での指令速度を含む。この指令速度は、移動装置１０の現在の速度とアクセル操作量またはブレーキ操作量とに基づいて経路決定装置３０により決定される。なお、半自律モードの他の点は、自律モードと同じであってよい。ステップＳ４において、移動制御装置９は、ステップＳ３で生成された経路データに従って移動装置１０の移動を制御する。

＜遠隔操作モード＞
通常モードが遠隔操作モードである場合、ステップＳ５で送信された操作指令に基づいて、移動装置１０の移動経路を表わす上述の経路データを生成する。この時、ステップＳ２で生成された環境地図データは考慮されない。この点で、遠隔操作モードは半自律モードと異なる。遠隔操作モードの他の点は、半自律モードと同じであってよい。

＜支援モード＞
通常モードで移動装置１０が移動している時に、人は、表示装置２３に表示された環境データと環境地図データを見て、移動装置１０が分岐路へ進入することが困難でありそうな場合において、経路決定装置３０のモードを支援モードに切り替えることができる。すなわち、人は、入力装置２５を操作する（例えばボタンを押す）ことにより、経路決定装置３０のモードを支援モードに切り替えることを示すモード切替指令を入力できる。これにより、このモード切替指令は、通信装置２１から移動装置１０へ送信され、その結果、経路決定装置３０のモードが支援モードに切り替わる。

例えば、次のｉ）〜ｉｖ）の場合に、経路決定装置３０のモードを支援モードに切り替えることができる。
ｉ）移動装置１０が、走行可能領域Ｒａの分岐路で、右側または左側の分岐路へ曲がって進入する時に、曲がりきれずに障害物の直前で停止した場合（例えば図３（Ａ）の状態の場合）。
ｉｉ）上述のステップＳ３で生成された基本の移動経路とは異なる特定の分岐路へ移動装置１０を進入させたい場合。
ｉｉｉ）基本の移動経路に沿って移動装置１０が分岐路へ進入（例えば右折または左折により進入）するために、移動装置１０の向きを９０度より大きく変えなければならないことにより、分岐路への移動装置１０の進入が失敗する可能性がありそうな場合。
ｉｖ）基本の移動経路に沿って、移動装置１０が狭い分岐路へ移動装置１０が進入（例えば右折または左折により進入）することになる場合に、より適切な経路でこの分岐路に進入させたい場合。

経路決定の支援方法を図３と図５の例に基づいて説明する。この例では、走行可能領域Ｒａの分岐路において左側の分岐路へ移動装置１０を進入させる場合を説明するが、以下の説明は、他の場合にも適用可能である。
また、経路決定の支援方法を図８に基づいて説明する。図８は、支援装置２０を用いた経路決定の支援方法を示すフローチャートである。経路決定の支援方法は、ステップＳ１１〜Ｓ１４を有する。

＜入力装置の処理＞
ステップＳ１１において、入力装置２５により、支援モードを示すモード切替指令が入力される。
ステップＳ１２において、ステップＳ１１で入力されたモード切替指令が、通信装置２１から移動装置１０に送信される。これにより経路決定装置３０のモードが支援モードに切り替わる。
ステップＳ１３において、人が入力装置２５を操作することにより、上述のように環境地図データにおいて上述した（１）〜（４）の指定を支援情報として入力する。図３（Ｂ）は、図３（Ａ）に対してステップＳ１３による各指定を行った場合を示す。
ステップＳ１４において、ステップＳ１３で入力された各指定が、支援情報として通信装置２１から移動装置１０に送信される。これらの指定は、その対象となった環境地図データと対応づけられた状態で送信される。例えば、各指定とこの環境地図データとが送信されてよい。

＜経路決定装置の処理＞
経路決定装置３０は、ステップＳ１４で送信された支援情報を通信装置１１を介して指定受信部３１により受けると、支援情報に基づいて、本発明の実施形態による経路決定方法としての支援経路探索処理を実行する。
図９は、支援経路探索処理を示すフローチャートである。支援経路探索処理は、ステップＳ２１〜Ｓ２４を有する。

ステップＳ２１では、候補点生成部３３により、上述の各指定がなされた環境地図データにおいて、指定された経由点毎に、経由点を含む局所領域内に複数の候補点Ｑを生成し、指定された目標点を含む局所領域内に複数の候補点Ｑを生成する。図５（Ａ）は、図３（Ｂ）に対してステップＳ２１が行われた状態を示す。

目標点を含む局所領域は、局所領域の大きさ又は形状が、経由点を含む局所領域と異なっていてもよい。また、目標点を含む局所領域と経由点を含む局所領域とでは、互いに隣接する候補点Ｑ同士の間隔（すなわち候補点Ｑの密度）が異なっていてもよい。

ステップＳ２１において、候補点Ｑが生成された環境地図データを次のように変更してもよい。ステップＳ２１のように各経由点と目標点について複数の候補点Ｑが生成された環境地図データが、通信装置１１から支援装置２０へ送信され表示装置２３に表示されてもよい。人は、表示されたこの環境地図データを見て、入力装置２５を操作することにより、目標点または経由点を含む局所領域の大きさ又は形状を変更し、または、目標点または経由点を含む局所領域において候補点Ｑの密度を変更することができる。この変更がなされた環境地図データは、通信装置２１から移動装置１０へ送信されて、次のステップＳ２２で用いられる。

ステップＳ２２では、ステップＳ２１で生成または変更された複数の局所領域からそれぞれ１つずつ選択した候補点Ｑの組み合わせを１つの組み合わせとして、組生成部３４により複数の組み合わせを特定する。例えば、全ての組み合わせを特定する。なお、目標点と経由点の合計数がＭ（図３（Ｂ）ではＭ＝４）であり、各局所領域においてＮ個（図５（Ａ）ではＮ＝２５）の候補点Ｑが生成されている場合には、全ての組み合わせの数はＮ^Ｍ個である。

ステップＳ２３では、ステップＳ２２で特定した複数の組み合わせの各々について、候補経路生成部３５により、該組み合わせの各候補点Ｑを通る候補経路を生成する。この時、候補経路生成部３５は、目標点の候補点と開始点Ｐ０の一方から、候補経路の一部となる局所経路を、目標点の候補点と開始点Ｐ０の他方に至るまで順に生成していく。また、この時、目標点の候補点Ｑにおける当該候補経路の接線方向が上述のように指定された目標点向きになり、かつ、位置検出装置５から受けた現在位置Ｐ０に基づいて開始点Ｐ０における当該候補経路の接線方向が当該現在位置Ｐ０における移動装置１０（車体１）の向きになるように、候補経路生成部３５は、当該候補経路を生成する。図５（Ｂ）において、図５（Ａ）の場合に対して生成された候補経路の１つを破線で示す。

ステップＳ２３は、ステップＳ２３１〜Ｓ２３６を有する。ステップＳ２３１〜Ｓ２３５は繰り返される。

ステップＳ２３１では、ステップＳ２２で特定された複数の組み合わせから１つの組み合わせを選択する。

最初のステップＳ２３２では、ステップＳ２３１で選択した組み合わせについて、目標点の候補点又は開始点Ｐ０を生成起点とし、生成起点の次の候補点Ｑを端点として、生成起点から端点まで延びる局所経路を生成する。２回目以降のステップＳ２３２では、ステップＳ２３１で選択した組み合わせについて、前回のステップＳ２３２で生成した局所経路の端点を新たな生成起点とし、この生成起点の次の候補点Ｑを端点として、この生成起点から端点まで延びる次の局所経路を生成する。

最初のステップＳ２３２での生成起点が目標点の候補点である場合には、生成起点の次の候補点Ｑとは、支援情報に含まれる経由点順序と逆の順序に従った候補点である。詳しくは次の通りである。目標点の候補点が生成起点のとき、この生成起点の次の候補点Ｑは、経由点順序における最後の経由点から生成された候補点である。経由点の候補点Ｑ１が生成起点のとき、この生成起点の次の候補点Ｑ２は、候補点Ｑ１の生成元となった経由点よりも経由点順序において１つ手前（すなわち、１つだけ開始点Ｐ０側）の経由点から生成された候補点Ｑ２である。経由点順序において最初の経由点から生成された候補点が生成起点のとき、この生成起点の次の候補点は、開始点Ｐ０である。

最初のステップＳ２３２での生成起点が開始点Ｐ０である場合には、次の候補点とは、支援情報に含まれる経由点順序に従った候補点である。詳しくは次の通りである。開始点Ｐ０が生成起点のとき、この生成起点の次の候補点Ｑは、経由点順序における最初の経由点から生成された候補点である。経由点の候補点Ｑ１が生成起点のとき、この生成起点の次の候補点Ｑ２は、候補点Ｑ１の生成元となった経由点の次の経由点（すなわち、経由点順序で次になる経由点）から生成された候補点Ｑ２である。経由点順序において最後の経由点の候補点が生成起点のとき、この生成起点の次の候補点は、目標点の候補点である。

局所経路は、曲線状（例えばクロソイド曲線）の経路であってよい。また、局所経路では、この経路における各点において、この経路に接する直線の方向が、この点での移動装置１０（すなわち車体１）の向きを示す。

ステップＳ２３３では、ステップＳ２３２で生成された局所経路が、ステップＳ１３で入力された各指定と対応づけられた環境地図データにおいて障害物に干渉するかを判断する。ここで、干渉するとは、局所経路が障害物に衝突すること、および、局所経路が障害物から設定距離以内の位置を通ることにより移動装置１０がこの局所経路を通ると障害物に接触することの少なくとも一方に該当することを意味する。

ステップＳ２３３で局所経路が障害物に干渉すると判断された場合、ステップＳ２３１で選択した組み合わせについての処理を中断し、ステップＳ２３５へ進む。一方、ステップＳ２３３で局所経路が障害物に干渉しないと判断された場合、ステップＳ２３４へ進む。

ステップＳ２３４では、ステップＳ２３１で選択した組み合わせについて、未生成の次の局所経路があるかを判断する。ここで、未生成の次の局所経路がある場合には、ステップＳ２３２へ戻り別の局所経路を生成して上述の処理を再び行い、未生成の次の局所経路が無い場合には、ステップＳ２３５へ進む。

候補経路生成部３５は、最初または最後のステップＳ２３２において、目標点の候補点を局所経路の生成起点又は端点とする場合、該生成起点または該端点における接線方向が指定された上述の目標点向きになる局所経路を生成する。また、候補経路生成部３５は、最初または最後のステップＳ２３２において、開始点Ｐ０を局所経路の生成起点又は端点とする場合、該生成起点または該端点における接線方向が、現在位置Ｐ０の移動装置１０の向きになる局所経路を生成する。候補経路生成部３５は、２回目以降に行うステップＳ２３２では、前回のステップＳ２３２で生成した局所経路の端点での接線方向を基準方向として、生成起点での接線方向が基準方向となる局所経路を生成する。

言い換えると次の通りである。
最初のステップＳ２３２で目標点の候補点を生成起点とする場合には、目標点の候補点Ｑにおける当該局所経路の接線方向が上述のように指定された目標点向きになるという条件を満たすように、当該局所経路を基準経路として生成する。次に、基準経路に結合される次の局所経路を生成する。この時、基準経路と次の局所経路との結合点（候補点）における基準経路の接線方向が、接線条件となる。すなわち、基準経路と次の局所経路との結合点において、この接線条件を、次の局所経路の接線方向が満たすように、次の局所経路が生成される。その後、当該次の局所経路を新たな基準経路として、当該基準経路に結合される次の局所経路を上述と同様に生成する。このような処理を繰り返して候補経路を生成する。この場合、最後に生成する局所経路は、開始点Ｐ０における接線方向が、現在位置Ｐ０の移動装置１０（車体１）の向きになるように生成される。
最初のステップＳ２３２で開始点Ｐ０を生成起点とする場合には、上述と逆の手順で各局所経路が生成される。

上述の支援情報に含まれる各経由点の進行向きは、ステップＳ２３２において、各局所経路の進行向きとして反映される。すなわち、上記各組み合わせにおける各経由点について、該経由点の進行向きが、該経由点の候補点から経由点順序における次の候補点までの局所経路の進行向き（言い換えると該経由点の候補点からの進行向き）であるとして、候補経路生成部３５は、ステップＳ２３２を繰り返す。詳しくは、候補経路生成部３５は、繰り返されるステップＳ２３２において、各局所経路の進行向きに従って、次の生成方法１と生成方法２により各局所経路を生成する。

（生成方法１）
互いに結合される１対の局所経路の進行向きがそれぞれ前進と後進である場合に、候補経路生成部３５は、図５（Ｂ）のように、当該１対の局所経路同士の結合点が移動経路における局所的な折り返し点となるように、当該１対の局所経路を生成する。すなわち、当該１対の局所経路の一方が該１対の局所経路の他方の延長線上には存在しないように、当該１対の局所経路は生成される。この生成方法１は、互いに進行向きが逆であって互いに結合される各対の局所経路の生成に適用される。
（生成方法２）
互いに結合される１対の局所経路の進行向きが同じである場合には、候補経路生成部３５は、当該１対の局所経路の一方が局所的に該１対の局所経路の他方の延長線上に存在するように当該１対の局所経路を生成する。この生成方法２は、互いに進行向きが同じであって互いに結合される各対の局所経路の生成に適用される。

ステップＳ２３５では、ステップＳ２２で特定された複数の組み合わせの中に未だ選択していない組み合わせがあるかを判断する。ここで、未だ選択していない組み合わせがある場合には、ステップＳ２３１へ戻り別の組み合わせを選択して上述の処理を再び行い、未だ選択していない組み合わせが無い場合には、ステップＳ２３６へ進む。

ステップＳ２３６では、開始点Ｐ０と目標点の候補点Ｑの一方から他方まで至る経路を構成する全ての局所経路が障害物に干渉しないと判断された（ステップＳ２３３でＮＯとなった）複数の組み合わせを特定し、これらの組み合わせの各々について、ステップＳ２３２で繰り返し生成された局所経路により構成される経路であって開始点Ｐ０から目標点の候補点Ｑに至る経路を候補経路とする。このようにして、ステップＳ２３において、複数の候補経路が生成される。

ステップＳ２４において、評価部３６により、ステップＳ２３６で生成された複数の候補経路の各々について、予め定めた評価関数に従って評価値を求め、複数の候補経路から、最良の評価値を持つ候補経路を選択し、選択した該候補経路を、移動装置１０の新たな移動経路として決定する。なお、ステップＳ２３６で生成された候補経路が１つである場合には、探索装置３２は、この候補経路を移動装置１０の新たな移動経路として決定する。ステップＳ２３６で生成される候補経路が１つもない場合には、探索装置３２は、「経路生成不可」を示す信号を出力する。この信号は、移動装置１０の通信装置１１から支援装置２０へ送信される。その結果、支援装置２０に設けた表示装置（例えば上述の表示装置２３）に、「経路生成不可」を示す旨が表示される。

評価関数は、例えばＥ＝αＴ＋βＳであってよい。ここで、Ｅは評価値であり、αとβは重み定数であり、ＴとＳは次のように定義される。Ｔは、候補経路の開始点Ｐ０から目標点の候補点Ｑまで候補経路上を移動装置１０が（例えば、一定の速度で、あるいは候補経路の曲率に応じて変化する速度で）移動するのに要する時間であり、評価部３６により求められる。Ｓは、候補経路の開始点Ｐ０から目標点の候補点Ｑまで候補経路上を移動装置１０が移動する期間にわたる、移動装置１０のステアリングの操舵角の積算値である。この操舵角は、車体１が直進する時のステアリングの基準操舵角（すなわちゼロ度）からの操舵角度の絶対値である。Ｅ＝αＴ＋βＳの代わりに、Ｅ＝Ｔ^α×Ｓ^βを用いてもよい。この評価関数における各記号の定義は上述と同じである。Ｅ＝αＴ＋βＳまたはＥ＝Ｔ^α×Ｓ^βにおいて、α＞０、β＞０である場合に、評価値の絶対値が小さいほど、評価値は良い値となる。
なお、評価関数は上述の例に限定されず、様々な関数を評価関数として設定することができる。

ステップＳ２５において、経路決定装置３０（評価部３６）は、ステップＳ２４で決定された移動経路を表わし且つ各局所経路の上記進行向きを含む経路データを移動装置１０の移動制御装置９へ出力する。

＜移動制御装置の処理＞
経路決定装置３０は、ステップＳ１２で送信された、支援モードを示すモード切替指令を通信装置１１を介して受けると、停止指令を移動制御装置９に出力し、これにより移動制御装置９は移動装置１０の移動を停止させる。その後、移動制御装置９は、上述の支援経路探索処理により生成されステップＳ２５で出力された経路データを受けると、この経路データに従って、移動制御装置９は移動装置１０の移動を制御する。これにより、移動装置１０は、次の（Ａ）と（Ｂ）を満たすように制御される。
（Ａ）移動装置１０は、経路データが表わす移動経路上を移動する。
（Ｂ）移動装置１０は、経路データが表わす移動経路の各局所経路上を、該局所経路の進行向きに従って前進または後進する。すなわち、移動装置１０は、該局所経路の進行向きが前進であれば該局所経路上を前進で移動し、該局所経路の進行向きが後進であれば該局所経路上を後進で移動する。

移動制御装置９は、移動経路の終点（すなわち、ステップＳ２４で決定された移動経路における目標点の候補点）まで移動装置１０を移動させたら、（例えば移動装置１０は移動制御装置９により停止させられ）、モード切替信号を経路決定装置３０へ出力する。これにより、経路決定装置３０のモードは上述の通常モードへ自動で切り替えられる。

（実施形態による効果）
上述した実施形態によると、人が指定した目標点と経由点を支援情報として受け、この支援情報に基づいて移動経路を探索するので、基本探索部２７だけの探索では、移動可能な経路を探索するのが困難となりそうな場合でも、経路決定装置３０は、人の支援を受けることにより、状況に適した移動経路を探索して決定できるようになる。上述の例では、移動装置１０を分岐路へ進入させる際に、この進入が困難そうである場合に、人は、入力装置２５を用いて、表示装置２３に表示された環境地図データにおいて、分岐路内の目標点を指定することにより、分岐路内のどの位置へ移動装置１０を到達させるかを指定できる。さらに、人は、入力装置２５を用いて、環境地図データにおいて経由点を指定することにより、目標点へ至るためにどの位置を経由すればよいかを指定できる。このように指定された目標点と経由点に基づいて、移動経路が決定されるので、移動装置１０が失敗せずに分岐路へ進入する新たな移動経路を決定できるようになる。

また、入力装置２５により、目標点における移動装置１０の向きを示す目標点向きを指定可能であり、この目標点向きに基づいて新たな移動経路が決定される。このように、分岐路内へ進入した時に移動装置１０がどのような向きになっていればよいかを示す目標点向きを指定して新たな移動経路に反映させることができるので、移動装置１０が円滑に分岐路を通過できる可能性が高まる。

入力装置２５により、経由点からの移動装置１０の移動が前進または後進であることを示す経由点の進行向きを指定可能であるので、前進と後進を組み合わせた移動（自動車の切り返しと同様の移動）をさせるための移動経路の決定が可能となる。

また、探索装置３２は、開始点を含む局所領域内の点または開始点から、経由点を含む局所領域内の点または経由点を通り、目標点を含む局所領域内の点もしくは目標点へ至る移動経路を探索して決定する。これにより、入力装置２５により大まかな目標点と経由点を指定することにより、探索装置３２により、目標点と経由点の指定を反映させた移動経路が決定される。

探索装置３２は、複数の候補経路を生成し、生成された各候補経路について、予め定めた評価関数に従って評価値を求め、複数の候補経路から、最良の評価値を持つ候補経路を選択し、選択した候補経路を新たな移動経路として決定する。したがって、より適切な（例えば最良の）移動経路を決定できる。

探索装置３２は、経由点毎に、該経由点を含む局所領域内に複数の候補点を生成し、複数の局所領域からそれぞれ１つずつ選択した候補点の組み合わせを１つの組み合わせとして、複数の組み合わせを特定する。また、探索装置３２は、各組み合わせについて、開始点と次の候補点までの局所経路、または、いずれかの候補点から次の候補点までの局所経路を生成し、この局所経路が障害物に干渉するかを判断する。したがって、局所経路が障害物に干渉すると判断された段階で、その組み合わせについての処理を中断できるので、効率的な処理が可能となる。

本発明は上述した実施の形態に限定されず、本発明の技術的思想の範囲内で種々変更を加え得ることは勿論である。例えば、以下の変更例１、２の一方または両方を採用してもよい。この場合、以下で述べない点は上述と同じであってよい。

（変更例１）
上述では、環境地図データが２次元空間を表わすデータであり、上述の開始点と目標点と各経由点は２次元座標であったが、環境地図データが３次元空間を表わすデータであり、上述の開始点と目標点と各経由点は３次元座標であってもよい。

（変更例２）
表示装置２３に表示される環境地図データは、上述では、環境計測装置３が取得した環境データに基づいて生成されたものであるが、本発明はこれに限定されない。すなわち、移動装置１０が、自身以外の移動する障害物（人や他の車両など）が存在せず環境状態が変化しない場所を移動する場合には、環境地図データは、静止障害物の箇所を示す既知の地図データに基づくデータであってもよい。この場合、上述の各「環境地図データ」は、「既知の地図データにおいて移動装置１０の現在位置を示した環境地図データ」に読み替えられる。

１ 車体、２ 地表面、３ 環境計測装置、５ 位置検出装置、７ 地図データ生成装置、９ 移動制御装置、１０ 移動装置、１１ 通信装置、２０ 支援装置、２１ 通信装置、２３ 表示装置、２５ 入力装置、２５ａ 画面（タッチパネル画面）、２５ｂ マウス、２７ 基本探索部、３０ 経路決定装置、３１ 指定受信部、３２ 探索装置、３３ 候補点生成部、３４ 組生成部、３５ 候補経路生成部、３６ 評価部、Ｐ０ 開始点、Ｐ１，Ｐ２，Ｐ３ 経由点、Ｑ 候補点

Claims (7)

1. 移動装置の移動経路を決定する経路決定装置であって、
   前記移動経路に関して、環境地図データにおける目標点と経由点を人が入力装置を用いて指定した場合に、前記目標点と前記経由点とを受ける指定受信部と、
   前記目標点と前記経由点に基づいて、前記環境地図データにおいて障害物に干渉しない前記移動経路を探索して決定する探索装置を備え、
   前記探索装置は、
   前記環境地図データにおいて、前記経由点を含む局所領域内に複数の候補点を生成し、前記目標点を含む別の局所領域内に複数の候補点を生成する候補点生成部と、
   複数の前記局所領域からそれぞれ１つずつ選択した前記候補点の組み合わせを１つの組み合わせとして、複数の組み合わせを特定する組生成部と、
   特定した複数の前記組み合わせの各々について、各前記候補点を通る候補経路を生成し、各前記候補経路が障害物に干渉するか否かを判断する候補経路生成部と、
   障害物に干渉しないと判断された各前記候補経路について、予め定めた評価関数に従って評価値を求め、最良の評価値を持つ複数の前記候補経路から前記候補経路を選択し、選択した該候補経路を前記移動装置の前記移動経路として決定する評価部と、を備える、経路決定装置。
2. 前記移動経路に関して、前記目標点と前記経由点に加えて、前記目標点における前記移動装置の向きを示す目標点向きを、人が入力装置を用いて指定した場合に、
   前記指定受信部は、前記目標点と前記経由点と前記目標点向きを受け、
   前記候補経路生成部は、前記組生成部が特定した複数の前記組み合わせの各々について、前記目標点の前記候補点における向きが前記目標点向きとなり且つ各前記候補点を通る前記候補経路を生成する、請求項１に記載の経路決定装置。
3. 前記移動経路に関して、前記目標点と前記経由点に加えて、前記経由点からの前記移動装置の移動が前進または後進であることを示す経由点の進行向きを、人が入力装置を用いて指定した場合に、
   前記指定受信部は、前記目標点と前記経由点と前記経由点の前記進行向きを受け、
   該進行向きが前記経由点の前記候補点からの進行向きであるとして、前記探索装置は、決定した前記移動経路を表わし且つ当該移動経路における前記候補点からの前記進行向きを含む経路データを前記移動装置の移動制御装置へ出力する、請求項１または２に記載の経路決定装置。
4. 前記指定受信部が複数の前記経由点を受けた場合には、前記候補点生成部は、前記経由点毎に、該経由点を含む前記局所領域内に複数の候補点を生成し、
   探索する前記移動経路の開始点が、前記移動装置の現在位置であり、
   前記候補経路生成部は、各前記組み合わせについて、
   （ａ）局所経路を生成する処理と、
   （ｂ）前記（ａ）で生成した前記局所経路が前記環境地図データにおいて障害物に干渉するかの判断を行う処理と、を繰り返し、
   最初に行う前記（ａ）では、前記目標点の前記候補点又は前記開始点を生成起点とし、生成起点の次の前記候補点を端点として、該生成起点から該端点まで延びる局所経路を生成し、２回目以降に行う前記（ａ）では、前回の前記（ａ）で生成した前記局所経路の端点を新たな生成起点とし、該生成起点の次の前記候補点を端点として、該生成起点から該端点まで延びる次の局所経路を生成し、最後に行う前記（ａ）では、前回の前記（ａ）で生成した前記局所経路の端点を新たな生成起点とし前記目標点の前記候補点又は前記開始点を端点として、該生成起点から該端点まで延びる局所経路を生成し、
   前記開始点と前記目標点の前記候補点の一方から他方まで至る経路を構成する各前記局所経路が障害物に干渉しないと前記（ｂ）で判断された前記組み合わせを特定し、該組み合わせの各前記局所経路により構成される経路を、障害物に干渉しない前記候補経路とする、請求項１、２または３に記載の経路決定装置。
5. 前記候補経路生成部は、前記（ａ）において、
   前記目標点の前記候補点を前記局所経路の前記生成起点又は前記端点とする場合、該生成起点または該端点における接線方向が指定された目標点向きになる該局所経路を生成し、
   前記開始点を前記局所経路の前記生成起点又は前記端点とする場合、該生成起点または該端点における接線方向が、前記現在位置の前記移動装置の向きになる該局所経路を生成する、請求項４に記載の経路決定装置。
6. 前記候補経路生成部は、２回目以降に行う前記（ａ）において、
   前回の前記（ａ）で生成した前記局所経路の前記端点での接線方向を基準方向として、前記生成起点での接線方向が基準方向となる前記局所経路を生成する、請求項４または５に記載の経路決定装置。
7. 移動装置の移動経路を経路決定装置により探索して決定する経路決定方法であって、
   （Ａ）前記移動経路に関して、環境地図データにおける目標点と経由点を人が入力装置を用いて指定した場合に、前記目標点と前記経由点とを受け、
   （Ｂ）前記目標点と前記経由点に基づいて、前記環境地図データにおいて障害物に干渉しない前記移動経路を探索して決定し、
   前記（Ｂ）では、
   前記環境地図データにおいて、前記経由点を含む局所領域内に複数の候補点を生成し、前記目標点を含む別の局所領域内に複数の候補点を生成し、
   複数の前記局所領域からそれぞれ１つずつ選択した前記候補点の組み合わせを１つの組み合わせとして、複数の組み合わせを特定し、
   特定した複数の前記組み合わせの各々について、各前記候補点を通る候補経路を生成し、各前記候補経路が障害物に干渉するか否かを判断し、
   障害物に干渉しないと判断された各前記候補経路について、予め定めた評価関数に従って評価値を求め、複数の前記候補経路から、最良の評価値を持つ前記候補経路を選択し、選択した該候補経路を前記移動装置の前記移動経路として決定する、経路決定方法。

Images