JP7113875B2 - 経路探索プログラムと、経路探索システムと、この経路探索システムを組み込んだ作業車 - Google Patents

Description

本発明は、作業地を走行するために設定された案内走行経路を探索する技術及び、この技術を採用した作業車に関する。

ＧＰＳ装置により計測される位置情報に基づいて、ティーチング経路生成手段により生成されたティーチング経路に対して平行な目標経路を生成し、該目標経路上を自律的に走行する田植機が、特許文献１から知られている。この田植機では、オペレータにより自動旋回操作具が操作されることにより、次の目標経路へ向けて自動的に旋回し、かつ、旋回動作の終了後に引き続き、次の目標経路上を自律的に走行する。

ＧＰＳユニットにより計測される位置情報に基づいて生成されたティーチング経路に対して平行な目標経路が生成され、次の目標経路へ向けて自動的に旋回し、かつ、次の目標経路上を自律的に走行するように構成された田植機が特許文献２から知られている。

特開２０１６－０２１８９０号公報 特開２００８－１３１８８０号公報

上述したように、設定された案内走行経路に沿って走行を行う、従来の作業車では、走行案内となっていた走行経路から次の走行経路に移行する旋回走行時や、ぬかるみ面や凹凸面での走行時に、一時的に車体の位置や向きが走行経路から逸脱し、走行経路を見失うことがある。探索すべき走行経路が複数設定されていると、その内から新たに走行目標とすべき走行経路を探索する場合、走行目標とすべき走行経路ではなく、それに隣接する走行経路やその他の探索領域内にある走行経路を見つけ出してしまう可能性がある。そのような間違った走行経路に向かうことを指示する操舵情報が報知されたり、間違った走行経路に向かって自動操舵されたりすると、意図しない走行結果をもたらす。
このような実情に鑑み、走行目標とすべき走行経路を高い信頼性で探索する技術が要望されている。

本発明による、作業車の走行目標となる案内走行経路を見つけ出す経路探索プログラムは、前記作業車における所定基準点である自車基準点の進行方向に広がる扇形領域を探索領域として設定する探索領域設定機能と、複数の走行経路を格納する走行経路格納部から読み出された作業地における複数の走行経路候補のうち、取得した自車位置に基づき、前記探索領域内において最も自車基準点に近いと判定された前記走行経路候補を前記作業車の走行目標となる案内走行経路として選択する案内経路選択機能と、をコンピュータに実現させ、前記案内経路選択機能において、前記探索領域が複数の前記走行経路候補を捉えている場合、前記探索領域に捉えられている複数の前記走行経路候補のうち、最も自車基準点に近いと判定された前記走行経路候補が、前記案内走行経路として選択されるように構成されている。

この構成によれば、作業車が作業地を走行するために設定されている複数の走行経路が走行経路格納部から読み出され、走行経路候補としてメモリ等に展開され、設定されている探索領域内において、これらの走行経路候補の中で、作業車の進行方向前方で、作業車の自車基準点（一般には測位データから算出される）にもっとも近い走行経路候補が案内走行経路として選択される。作業車の進行方向の前方に広がる扇形領域において、作業車の自車基準点に最も近い走行経路候補が走行すべき走行経路である確率が高い。したがって、走行経路候補が複数存在しても、上述の方法によって簡単かつ迅速に走行すべき案内走行経路を選択することが可能となる。なお、自車基準点の進行方向に広がる扇形領域の具体的な例としては、自車基準点を中心として、中心角１８０°（進行方向を中心線として+９０°と－９０°）以下、好ましくは中心角４５°から９０°の扇形領域であるが、任意に設定できるような構成が好適である。
さらに、本発明において、前記複数の走行経路候補は、作業地において互いに略平行に延びるものであると好適である。
さらに、本発明において、各前記走行経路に、作業済みであるか否かを示す属性が付与されており、前記走行経路格納部に格納された複数の前記走行経路から前記属性に基づいて抽出された複数の前記走行経路が、複数の前記走行経路候補として前記走行経路格納部から読み出されると好適である。

上述した経路探索プログラムを作業車に構築するためには、経路探索プログラムをシステム化して作業車の制御系に組み込むと好都合である。そのような経路探索システムを搭載した作業車も本発明に含まれ、上述した経路探索プログラムと同じ作用効果を得ることができる。

作業車の周辺に設定された探索領域と作業地に設定された走行経路とを説明する説明図である。 走行経路候補群と自車位置と探索領域との間の位置関係に基づいて案内走行経路を選択する制御ルールを説明する説明図である。 作業車の具体的な実施形態の１つである耕耘装置付きトラクタの側面図である。 トラクタの制御系を示す機能ブロック図である。 経路探索ルーチンの１つを示すフローチャート図である。 走行経路候補群と自車位置と探索領域との間の位置関係を説明する模式図である。 走行経路候補群と自車位置と探索領域との間の位置関係を説明する模式図である。 走行経路候補群と自車位置と探索領域との間の位置関係を説明する模式図である。

まず、本発明の具体的な実施形態を説明する前に、本発明で用いられている用語の定義と経路探索の原理を、図１と図２を用いて説明する。図１には、車体１と、車体１に装備された作業装置３０とからなる作業車と、この作業車が走行する作業地が模式的に示されている。作業地に設定された、作業車の走行目標となる案内走行経路ＬＮは、ここでは、互いに平行に延びている直線状の走行経路群として示されており、各走行経路ＬＮは式で表される。走行経路ＬＮは、実際の走行経路として機能する実走行経路部分Ｌａと、実走行経路部分Ｌａの延長線である経路延長部分Ｌｂとからなり、実走行経路部分Ｌａは両端の端点ＥＰによって規定されている。また、走行経路群を構成する各走行経路ＬＮは、厳密な意味での直線でなくともよく、曲線でもよい。その際、曲線は、曲線式で表されるような曲線でもよいし、折れ曲がりながらつながっている直線片の集合体でもよい。各走行経路ＬＮは、平行な配置に限定されるわけではなく、非平行な配置、例えば他の走行経路ＬＮと直交する走行経路ＬＮが混在してもよい。さらに、作業車の走行には、作業を伴いながら走行する実作業走行と、方向転回などの作業を伴わずに走行する非作業走行とが含まれているが、この明細書においては、作業車の走行という用語には、実作業走行と非作業走行とのいずれかあるいは両方の意味が含まれている。

ここでは、作業車における所定基準点としての自車基準点ＣＰは、車体１のほぼ中央の位置に設定されているが、作業装置３０の対地作業位置など種々の位置に設定可能である。自車基準点ＣＰからの径方向の距離は探索距離Ｒと称される。つまり、自車基準点ＣＰを中心とする半径：Ｒの円ＳＣの内側が探索距離Ｒ以内を満たす領域となる。さらに、図１の例では、自車基準点ＣＰの周辺領域を探索領域ＳＡとして、自車基準点ＣＰを中心として自車の進行方向に広がる中心角が約４５°の扇形状の領域（扇形領域）が探索領域ＳＡとして設定されている。この扇形の半径は、探索距離Ｒと一致しており、その辺には符号Ｓｅが付与されている。扇形の中心角：θは１８０°まで広げてもよい。探索領域ＳＡの形状は任意であるが、演算上、できるだけ簡単な形状が好ましい。ＧＰＳやＧＮＮＳなどの衛星測位モジュール（測位モジュールの一例）からの測位データに基づいて算出される自車位置と自車基準点ＣＰとの位置が異なっていても簡単な演算で補正することができるので、実質的には同一位置であると見なすことができる。説明を簡単にするため、以下の説明では、自車位置と自車基準点ＣＰは同一であるとする。したがって、自車基準点ＣＰは、以下単に自車位置とも略称される。自車基準点ＣＰ（自車位置）から走行経路ＬＮへの垂線は自車基準点ＣＰと走行経路ＬＮとの最短距離ＭＤを規定するので、この垂線と走行経路ＬＮの交点を示す座標位置は最短位置ＭＰと定義される。

作業地に設定されている走行経路群、演算上はメモリに展開されている直線群が、本経路探索プログラムによって取り扱われる複数の走行経路候補となる。自車基準点ＣＰと探索領域ＳＡとの間の位置関係が算出され、算出された位置関係に基づいて、複数の走行経路候補から作業車の走行目標となる案内走行経路が選択される。

図２には、３本の走行経路ＬＮからなる走行経路候補とこの走行経路候補に対して種々の位置（姿勢）にある作業車とが、示されている。作業車には、黒丸で示された自車基準点ＣＰと扇形の探索領域ＳＡが付記されている。各走行経路ＬＮは紙面上から下に互いに平行に直線状に延びており、実走行経路部分Ｌａと下側の経路延長部分Ｌｂとで示されている。案内走行経路として採用された走行経路ＬＮは太い線で示されている。

本発明の基本的な経路探索の１つでは、探索領域ＳＡ内において最も自車位置（自車基準点）ＣＰに近い走行経路候補を作業車の走行目標となる案内走行経路として選択する。図２においても、探索領域ＳＡ内において、実質的に、自車基準点ＣＰから最も近くに位置する走行経路ＬＮが、案内走行経路として採用されている。

図２には、本発明の基本的な経路探索の他の１つとして用いられる、走行経路候補と作業車の自車基準点ＣＰと探索領域ＳＡとの間の位置関係に基づいて３つの走行経路候補から案内走行経路を選択するためのルールの例、つまり例（ａ）から例（ｆ）が示されている

例（ａ）
作業車の進行方向は走行経路ＬＮの延び方向と一致している。探索領域ＳＡは真ん中の走行経路候補の実走行経路部分Ｌａを捉えている。自車基準点ＣＰは、真ん中の走行経路候補の経路延長部分Ｌｂ上にある。このまま進行すれば、作業車は実走行経路部分Ｌａに達するので、真ん中の走行経路候補が案内走行経路として選択される。
例（ｂ）
作業車の進行方向は走行経路ＬＮの延び方向に対してわずかに傾斜している。探索領域ＳＡは真ん中の走行経路候補の実走行経路部分Ｌａと右側の走行経路候補の実走行経路部分Ｌａを捉えている。自車基準点ＣＰは、真ん中の走行経路候補の経路延長部分Ｌｂ上にある。真ん中の走行経路候補に沿ってわずかに操舵しながら進行すれば、作業車は実走行経路部分Ｌａに達するので、真ん中の走行経路候補が案内走行経路として選択される。
例（ｃ）
作業車の進行方向は走行経路ＬＮの延び方向と一致しているが、作業車は真ん中の走行経路候補と右側の走行経路候補との間に位置している。探索領域ＳＡは真ん中の走行経路候補の実走行経路部分Ｌａと右側の走行経路候補の実走行経路部分Ｌａを捉えている。いずれの走行経路候補においても、最短位置ＭＰは実走行経路部分Ｌａ上となる。最短距離ＭＤは真ん中の走行経路候補との間の方が短いので、真ん中の走行経路候補が案内走行経路として選択される。
例（ｄ）
作業車の進行方向は走行経路ＬＮの延び方向に対して大きく傾斜している。探索領域ＳＡは真ん中の走行経路候補の実走行経路部分Ｌａと右側の走行経路候補の経路延長部分Ｌｂを捉えている。いずれの走行経路候補においても、最短位置ＭＰは経路延長部分Ｌｂ上となる。最短距離ＭＤは真ん中の走行経路候補との間の方が短い。探索領域ＳＡと走行経路候補との交点は、真ん中の走行経路候補ではその実走行経路部分Ｌａに位置し、右側の走行経路候補ではその経路延長部分Ｌｂに位置する。ここでは、真ん中の走行経路候補が案内走行経路として選択される。
例（ｅ）
作業車の進行方向は走行経路ＬＮの延び方向に対して大きく傾斜している。探索領域ＳＡは右側の走行経路候補の実走行経路部分Ｌａを捉えている。いずれの走行経路候補においても、最短位置ＭＰは実走行経路部分Ｌａとなる。最短距離ＭＤは真ん中の走行経路候補との間の方が短い。作業車の自車基準点ＣＰは、真ん中の走行経路候補を通り抜けている。探索領域ＳＡと右側の走行経路候補との交点は、その実走行経路部分Ｌａに位置する。ここでは、右側の走行経路候補が案内走行経路として選択される。
例（ｆ）
作業車の進行方向は走行経路ＬＮの延び方向に対して大きく傾斜している。探索領域ＳＡは左側の走行経路候補の実走行経路部分Ｌａと真ん中の走行経路候補の実走行経路部分Ｌａとを捉えている。いずれの走行経路候補においても、最短位置ＭＰは実走行経路部分Ｌａとなる。最短距離ＭＤは左側の走行経路候補との間の方が短い。探索領域ＳＡと左側の走行経路候補との交点及び探索領域ＳＡと真ん中の走行経路候補との交点は、それぞれの実走行経路部分Ｌａに位置する。ここでは、左側の走行経路候補が案内走行経路として選択される。

上述したようなルールを組み合わせて、走行経路候補と作業車の自車基準点ＣＰと探索領域ＳＡとの間の位置関係に基づいて複数の走行経路候補から案内走行経路を選択する選択アルゴリズムが、作業車の種類や作業地の種類などに応じて構築することができる。

案内走行経路が選択されると、案内走行経路と自車位置との間の偏差が算出され、この偏差を縮小するように操舵することで、予定通りの走行が実現する。作業車の操舵は、手動でもよいし、自動でもよい。手動の場合には、算出された偏差が視覚または音声を通じて運転者に報知されるので、その報知を参考にして運転者は操舵を行う。

次に、本発明の作業車の具体的な実施形態の１つを説明する。この実施形態では、作業車は、図３に示されているように、畦によって境界づけられた圃場（作業地）に対して走行作業を行う作業装置３０を装備可能なトラクタである。このトラクタは、前輪１１と後輪１２とによって支持された車体１の中央部に操縦部２０が設けられている。車体１の後部には油圧式の昇降機構３１を介してロータリ耕耘装置である作業装置３０が装備されている。前輪１１は操向輪として機能し、その操舵角を変更することでトラクタの走行方向が変更される。前輪１１の操舵角は操舵機構１３の動作によって変更される。操舵機構１３には自動操舵のための操舵モータ１４が含まれている。手動走行の際には、前輪１１の操舵は操縦部２０に配置されているステアリングホイール２２の操作によって可能である。トラクタのキャビン２１には、ＧＮＳＳモジュールとして構成されている衛星測位モジュール８０が設けられている。衛星測位モジュール８０の構成要素として、ＧＰＳ信号やＧＮＳＳ信号を受信するための衛星用アンテナがキャビン２１の天井領域に取り付けられている。なお、衛星測位モジュール８０には、衛星航法を補完するために、ジャイロ加速度センサや磁気方位センサを組み込んだ慣性航法モジュールを含めることができる。もちろん、慣性航法モジュールは、衛星測位モジュール８０とは別の場所に設けてもよい。

図４には、このトラクタに構築されている制御系が示されている。この制御系は、図１と図２とを用いて説明された、本発明による線路探索技術を実現するように構成されている。この制御系の中核要素である制御ユニット５には、入出力インタフェースとして機能する、出力処理部７、入力処理部８、通信処理部７０が備えられている。出力処理部７は、車両走行機器群７１、作業装置機器群７２、報知デバイス７３などと接続している。車両走行機器群７１には、操舵モータ１４をはじめ、図示されていないが変速機構やエンジンユニットなど車両走行のために制御される機器が含まれている。作業装置機器群７２には、作業装置３０の駆動機構や、作業装置３０を昇降させる昇降機構３１などが含まれている。通信処理部７０は、制御ユニット５で処理されたデータを遠隔地の管理センタＫＳに構築された管理コンピュータ１００に送信するとともに、管理コンピュータ１００から種々のデータを受信する機能を有する。報知デバイス７３には、ディスプレイやランプやスピーカが含まれている。特に、ディスプレイには、制御ユニット５で生成された各走行経路が表示される。ランプやスピーカは、走行注意事項や自動操舵走行での目標走行経路からの外れ度合など、運転者に報知したい種々の情報を運転者や操作者に報知するために用いられる。報知デバイス７３と出力処理部７との間の信号伝送は、有線または無線で行われる。

入力処理部８は、衛星測位モジュール８０、走行系検出センサ群８１、作業系検出センサ群８２、自動／手動切替操作具８３などと接続している。走行系検出センサ群８１には、エンジン回転数や変速状態などの走行状態を検出するセンサが含まれている。作業系検出センサ群８２には、作業装置３０の位置や傾きを検出するセンサ、作業負荷などを検出するセンサなどが含まれている。自動／手動切替操作具８３は、自動操舵で走行する自動走行モードと手動操舵で走行する手動操舵モードとのいずれかを選択するスイッチである。例えば、自動操舵モードでの走行を中断し、自動／手動切替操作具８３を操作することで、手動操舵での走行に切り替えることも可能であり、また、手動操舵での走行を中断し、自動／手動切替操作具８３を操作することで、自動操舵での走行に切り替えることも可能である。

制御ユニット５には、図１と図２とを用いて説明された、作業車の走行目標となる案内走行経路を見つけ出す経路探索を実行する走行経路探索モジュール６０が構築されている。そのほかに、制御ユニット５には、走行制御部５０、作業制御部５３、自車位置算出部５４、偏差算出部５５、経路生成部５６、走行経路格納部５７、報知部５８が備えられている。

車両走行機器群７１を制御する走行制御部５０は、このトラクタが自動走行（自動操舵）と手動走行（手動操舵）の両方で走行可能に構成されているため、手動走行制御部５１と自動走行制御部５２とが含まれている。手動走行制御部５１は、運転者による操作に基づいて車両走行機器群７１を制御する。自動走行制御部５２は、車体１が走行経路探索モジュール６０によって選択された案内走行経路に沿うように、自動操舵指令を生成し、出力処理部７を介して操舵モータ１４に出力する。作業制御部５３は、作業装置３０の動きを制御するために、作業装置機器群７２に制御信号を与える。

自車位置算出部５４は、衛星測位モジュール８０から送られてくる測位データに基づいて、自車位置を算出する。偏差算出部５５は、走行経路探索モジュール６０によって選択された案内走行経路と自車位置との間の偏差（座標位置ずれ及び方向ずれを含む）を算出し、自動走行制御部５２に与える。自動走行制御部５２はこの偏差が小さくなるような自動操舵指令を生成し、出力処理部７を介して操舵モータ１４を制御する。

経路生成部５６は、走行経路探索モジュール６０で走行経路候補として取り扱われる走行経路を規定する経路データを生成する。この経路データの生成は、作業地情報に含まれている作業地地図データから得られる外形データに基づいて生成される。あるいは、運転者や管理者の入力操作を通じて、経路データを生成することも可能である。作業地情報は、遠隔地の管理センタＫＳに設置されている管理コンピュータ１００の作業地情報格納部１０１から抽出され、制御ユニット５にダウンロード可能である。また、経路データそれ自体を作業地情報に含ませて、管理コンピュータ１００で管理することも可能である。つまり、図４では、経路生成部５６が制御ユニット５に構築されているが、経路生成部５６を管理コンピュータ１００内に構築し、管理コンピュータ１００で生成された経路データが制御ユニット５に通信処理部７０を介してダウンロードされる構成も可能である。さらには、図４には図示されていないが、このトラクタの走行を監視している監視者等が携帯しているタブレットコンピュータなどの通信端末に経路生成部５６を構築し、通信端末で生成された経路データが制御ユニット５に通信処理部７０を介してダウンロードされる構成も可能である。いずれにしても、制御ユニット５で取得された経路データである走行経路は、走行経路格納部５７に格納される。さらに、指定された圃場での走行作業を記述した作業計画書も管理コンピュータ１００の作業計画管理部１０２から制御ユニット５にダウンロードしてもよい。作業車は、作業前に、作業計画書に基づく作業が可能なように調整される。

報知部５８は、ディスプレイやスピーカなどの報知デバイス７３を通じて運転者や監視者に必要な情報を報知するための報知信号（表示データや音声データ）を生成する。この実施形態では、報知部５８は、走行経路格納部５７に格納されている作業経路や偏差算出部５５によって算出された偏差をグラフィカルにディスプレイに表示す表示データを生成する表示データ生成機能を有している。

走行経路探索モジュール６０は、実質的にコンピュータプログラムによって構築されており、図１と図２で説明された制御を実行することが可能である。このため、走行経路探索モジュール６０には、探索領域設定部６１、位置関係算出部６２、案内経路選択部６３が含まれている。探索領域設定部６１は、図１で示された探索領域ＳＡの形状、探索領域ＳＡの車体１に対する位置を設定する。この実施形態では、探索領域ＳＡは扇形であるので、扇形の中心角θ、扇形の辺の長さＳｅが設定される。また、この扇形の中心点は自車基準点ＣＰとされ、自車位置として取り扱われる。なお、扇形の辺の長さＳｅと探索距離Ｒは同一である。位置関係算出部６２は、走行経路格納部５７から読み出された複数の走行経路候補と自車位置算出部５４で得られた自車位置との間の位置関係を算出する。案内経路選択部６３は、位置関係算出部６２で算出された位置関係に基づいて、走行経路候補から、自車を案内する案内走行経路を選択して、偏差算出部５５に与える。

案内経路選択部６３は、図２を用いて説明された、例（ａ）から例（ｆ）などの制御ルールを組み合わせて実行することができる。このような制御ルールを組み合わせて、案内経路選択部６３によって実行される経路探索ルーチンの１つを、図５に示されたフローチャートを用いて説明する。

なお、フローチャートの理解を助けるため、自車位置と探索領域ＳＡと走行経路との位置関係が図６から図８に模式的に例示されている。この位置関係は、案内経路を選択する際の選択条件として用いられる。図６において、自車基準点（自車位置）ＣＰは、走行経路ＬＮ上に位置している。さらに、図６の（ａ）では、自車基準点ＣＰは実走行経路部分Ｌａ上に位置しており、図６の（ｂ）と（ｃ）では、経路延長部分Ｌｂ上に位置しており、図６の（ｂ）では、端点ＥＰは探索領域ＳＡ内であり、図６の（ｃ）では、端点ＥＰは探索領域ＳＡ外である。図７において、自車基準点（自車位置）ＣＰは、走行経路ＬＮから外れて位置しており、最短距離ＭＤと最短位置ＭＰが示されている。さらに、図７の（ａ）では、最短位置ＭＰに対応する端点ＥＰが探索領域ＳＡ内に位置し、図７の（ｂ）では、端点ＥＰが探索距離Ｒの外側に位置している、図７の（ｃ）では、自車基準点ＣＰと端点ＥＰを結ぶ直線と車体１の進行方向との角度：αが所定角度の９０°を超えている。図８において、探索領域ＳＡの辺Ｓｅと走行経路との交点ＩＰ（図８では星印で示されている）が示されており、図８の（ａ）では、交点ＩＰは実走行経路部分Ｌａ上に位置しており、図８の（ｂ）では、交点ＩＰは経路延長部分Ｌｂ上に位置している。

経路探索ルーチンが呼び出されると、走行経路格納部５７から走行経路データが走行経路候補群として読み出される（＃１０）。次いで、自車位置算出部５４で算出された自車位置を取得する（＃１１）。走行経路格納部５７から走行経路候補として複数の走行経路を抽出して読み出す（＃１２）。なお、走行経路候補として、作業地全体または部分領域に展開される走行経路を全て読み出してもよい。この場合、この処理ステップは初期処理として取り扱われる。あるいは、走行経路に、未作業／既作業の属性値や進行方向の属性値を付与しておき、選択対象とはならない走行経路は抽出しないように構成してもよい。

次に、自車位置を通る各走行経路候補への垂線を求め、最短位置ＭＰ（座標値）と最短距離ＭＤとが求められ（＃１３）、最短距離ＭＤが短い順に、以降の位置関係算出処理のための対象走行経路候補（以下単に対象経路と略称する）として指定される（＃１４）。経路選択の第１段階として、自車位置（自車基準点ＣＰ）が対象経路上に位置しているかどうか判定される（＃１５）。もちろん、この判定条件には所定の誤差範囲は含まれており、厳密に自車位置が対象経路上に位置していなくてもよい。その際、自車位置が対象経路の実走行経路部分Ｌａ上に位置しているだけでなく、経路延長部分Ｌｂに位置していても、この判定条件を満たしているとみなし（＃１５Ｙｅｓ分岐）、この対象経路は案内走行経路として選択される（＃５１）。選択された案内走行経路と自車位置との偏差として、位置ずれ（最短距離ＭＤと同じ）及び方向ずれが偏差算出部５５で算出され（＃５２）、走行制御部５０における走行制御に用いられる（＃５３）。新たな自車位置での経路探索のため、ステップ＃１１に戻る。

ステップ＃１５で、自車位置（自車基準点ＣＰ）が対象経路上に位置しない場合（＃１５Ｎｏ分岐）、次に、対象経路の実走行経路部分の端点ＥＰが探索距離Ｒの円領域に入っているかどうかの探索領域判定を受ける（＃２０）。この探索領域判定が不成立ならば（＃２０Ｎｏ分岐）、全走行経路候補の探索が済んだかどうか判定され（＃４０）、未処理の対象経路が残っている限りは（＃４０Ｎｏ分岐）、次の対象経路に対する選択処理のため＃１４に戻り、未処理の対象経路が残っていなければ（＃４０Ｙｅｓ分岐）、新たな自車位置での経路探索のため、ステップ＃１１に戻る。逆に、探索領域判定が成立するなら（＃２０Ｙｅｓ分岐）、次の角度判定を受ける（＃２１）。この角度判定では、端点ＥＰと自車位置とを結ぶ直線と車体１の進行方向との間の角度が所定の範囲に入っているかどうか、あるいは端点ＥＰが探索領域ＳＡにはいっているかどうかが判定される。

この角度判定が不成立ならば、（＃２１Ｎｏ分岐）、未処理の対象経路が残っている限りは（＃４０Ｎｏ分岐）、次の対象経路に対する選択処理のため＃１４に戻り、未処理の対象経路が残っていなければ（＃４０Ｙｅｓ分岐）、新たな自車位置での経路探索のため、ステップ＃１１に戻る。角度判定が成立ならば（＃２１Ｙｅｓ分岐）、さらに探索領域ＳＡの辺Ｓｅと対象経路との交点を算出し（＃３０）、当該交点が対象経路の実走行経路部分に位置するかどうかを判定する交点判定を受ける（＃３１）。この交点判定が不成立ならば（＃３１Ｎｏ分岐）、未処理の対象経路が残っている限りは（＃４０Ｎｏ分岐）、次の対象経路に対する選択処理のため＃１４に戻り、未処理の対象経路が残っていなければ（＃４０Ｙｅｓ分岐）、新たな自車位置での経路探索のため、ステップ＃１１に戻る。交点判定が成立ならば（＃３１Ｙｅｓ分岐）、この対象経路は案内走行経路として選択される（＃５１）。選択された案内走行経路と自車位置との偏差として、位置ずれ（最短距離ＭＤと同じ）及び方向ずれが偏差算出部５５で算出され（＃５２）、走行制御部５０における走行制御に用いられる（＃５３）。新たな自車位置での経路探索のため、ステップ＃１１に戻る。

〔別実施の形態〕
（１）上述した実施形態では、自車位置（自車基準点ＣＰ）と探索領域ＳＡと走行経路候補（走行経路ＬＮ）との間の位置関係に基づいて、案内走行経路が選択されていたが、最も簡単な実施形態では、自車位置（自車基準点）にもっとも近い走行経路候補を案内走行経路として選択される。
（２）上述した実施形態では、走行経路ＬＮは、直線として示されていたが、曲線であってもよい。
（３）上述した実施形態では、扇形状の探索領域ＳＡの中心角は、ほぼ４５°として示されていたが、中心角は、好ましくは１８０°以下で任意に設定できるようにしてもよい。なお、中心角０°の探索領域ＳＡは、実際的には、直線として取り扱われる。また、探索領域ＳＡの中心点は、車体１の幅方向で中央で、かつ車体進行方向で前側が好ましいが、作業車の仕様等に応じて任意に設定可能である。
（４）上述した実施形態では、作業車として、ロータリ耕耘機を作業装置３０として装備したトラクタを、作業車として取り上げたが、そのようなトラクタ以外にも、例えば、田植機、コンバインなどの農作業車も、実施形態として採用することができる。
（５）図４で示された機能ブロック図における各機能部は、主に説明目的で区分けされている。実際には、各機能部は他の機能部と統合または複数の機能部に分けることができる。また、遠隔地の管理センタＫＳに設置される管理コンピュータ１００に代えて、運転者や監視者が携帯する通信端末（携帯電話やタブレットコンピュータなど）を利用してもよいし、図４で示された機能部の１つ以上をそのような通信端末に構築してもよい。もちろん、この圃場走行経路生成システムの全ての機能部を作業車に構築してもよい。

本発明は、作業地を走行するために設定された案内走行経路を探索するコンピュータプログラムやコンピュータシステム及び、このような経路探索技術を採用する作業車に適用可能である。走行経路に沿った走行は、手動走行であってもよいし、自動走行であってもよい。

１ ：車体
５ ：制御ユニット
２２ ：ステアリングホイール
３０ ：作業装置
５０ ：走行制御部
５１ ：手動走行制御部
５２ ：自動走行制御部
５４ ：自車位置算出部
５５ ：偏差算出部
５７ ：走行経路格納部
５８ ：報知部
６０ ：走行経路探索モジュール
６１ ：探索領域設定部
６２ ：位置関係算出部
６３ ：案内経路選択部
８０ ：衛星測位モジュール
ＣＰ ：自車基準点
ＥＰ ：端点
ＬＮ ：走行経路
Ｌａ ：実走行経路部分
Ｌｂ ：経路延長部分

Claims (3)

1. 作業車の走行目標となる案内走行経路を見つけ出す経路探索プログラムであって、
   前記作業車における所定基準点である自車基準点の進行方向に広がる扇形領域を探索領域として設定する探索領域設定機能と、
   複数の走行経路を格納する走行経路格納部から読み出された作業地における複数の走行経路候補のうち、取得した自車位置に基づき、前記探索領域内において最も自車基準点に近いと判定された前記走行経路候補を前記作業車の走行目標となる案内走行経路として選択する案内経路選択機能と、をコンピュータに実現させ、
   前記案内経路選択機能において、前記探索領域が複数の前記走行経路候補を捉えている場合、前記探索領域に捉えられている複数の前記走行経路候補のうち、最も自車基準点に近いと判定された前記走行経路候補が、前記案内走行経路として選択される経路探索プログラム。
2. 作業車の走行目標となる案内走行経路を見つけ出す経路探索システムであって、
   前記作業車における所定基準点である自車基準点の周辺領域を探索領域として設定する探索領域設定部と、
   複数の走行経路を格納する走行経路格納部から読み出された作業地における複数の走行経路候補のうち、取得した自車位置に基づき、前記探索領域内において最も自車基準点に近いと判定された前記走行経路候補を前記作業車の走行目標となる案内走行経路として選択する案内経路選択部と、を備え、
   前記案内経路選択部は、前記探索領域が複数の前記走行経路候補を捉えている場合、前記探索領域に捉えられている複数の前記走行経路候補のうち、最も自車基準点に近いと判定された前記走行経路候補を、前記案内走行経路として選択する経路探索システム。
3. 複数の走行経路を格納する走行経路格納部と、
   測位モジュールからの測位データに基づいて自車位置を算出する自車位置算出部と、
   作業車における所定基準点である自車基準点の周辺領域を探索領域として設定する探索領域設定部と、
   前記走行経路格納部から読み出された作業地における複数の走行経路候補のうち、前記自車位置に基づき、前記探索領域内において最も自車基準点に近いと判定された前記走行経路候補を走行目標となる案内走行経路として選択する案内経路選択部と、
   前記案内走行経路と前記自車位置との偏差を算出する偏差算出部と、を備え、
   前記案内経路選択部は、前記探索領域が複数の前記走行経路候補を捉えている場合、前記探索領域に捉えられている複数の前記走行経路候補のうち、最も自車基準点に近いと判定された前記走行経路候補を、前記案内走行経路として選択する作業車。

Images