JP6920970B2 - 走行経路決定装置 - Google Patents

走行経路決定装置 Download PDF

Info

Publication number
JP6920970B2
JP6920970B2 JP2017221345A JP2017221345A JP6920970B2 JP 6920970 B2 JP6920970 B2 JP 6920970B2 JP 2017221345 A JP2017221345 A JP 2017221345A JP 2017221345 A JP2017221345 A JP 2017221345A JP 6920970 B2 JP6920970 B2 JP 6920970B2
Authority
JP
Japan
Prior art keywords
route
work
travel
traveling
harvester
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
JP2017221345A
Other languages
English (en)
Other versions
JP2018099113A (ja
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.)
Kubota Corp
Original Assignee
Kubota Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kubota Corp filed Critical Kubota Corp
Priority to CN201780071309.1A priority Critical patent/CN109964191B/zh
Priority to PCT/JP2017/042874 priority patent/WO2018116771A1/ja
Priority to KR1020197013043A priority patent/KR102452908B1/ko
Publication of JP2018099113A publication Critical patent/JP2018099113A/ja
Application granted granted Critical
Publication of JP6920970B2 publication Critical patent/JP6920970B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface

Description

本発明は、作業地を協調的に走行しながら作業する、複数の作業車のための走行経路を決定する走行経路決定装置に関する。
特許文献1による圃場作業機は、自動走行を用いて圃場作業を行うため、経路算出部と運転支援ユニットとを備えている。経路算出部は、地形データから圃場の外形を求め、この外形と圃場作業機の作業幅とに基づいて、設定された走行開始地点から始まって走行終了地点で終わる走行経路を算出する。運転支援ユニットは、GPSモジュールから得られる測位データに基づいて求められた自車位置と、経路算出部によって算出された走行経路とを比較し、走行機体が走行経路に沿って走行するように操舵機構を制御する。
圃場作業機を自動走行させることにより、圃場作業に必要な人手が軽減される。さらに人手を軽減するためには、同時に投入する圃場作業機を複数台とし、それぞれの圃場作業機の走行経路を算出し、算出された走行経路に沿って自動走行させるとよい。例えば、特許文献2では、2台の作業車を併走走行させながら作業を行うシステムが開示されている。このシステムで用いられている走行経路設定装置では、第1の作業車と第2の作業車の走行位置関係を設定することで、それに対応する走行経路が設定される。第1の作業車と第2の作業車の走行位置関係を設定するために、作業車の作業幅(作業機の幅)がタッチパネルを通じて設定される。しかしながら、このシステムでは、作業幅が第1の作業車と第2の作業車とで異なる場合には、各作業車専用の走行経路を算定し、各作業車は専用の走行経路に沿って走行しなければならない。したがって、複数の作業車での融通性のある協調走行作業は困難である。複数の作業車が協調して、広大な作業地を作業している間に、燃料補給や収穫物などの排出といった機械的要因や天候の変動や作業地状態などの環境的要因などにより、特定の作業車が予め設定された走行経路から一時的にあるいは長期的に離脱することが少なくない。このような場合には、残った作業車だけで未作業領域をカバーするための走行経路を再算出して、設定し直す必要がある。しかし、特許文献2によるシステムには、一方の作業車が作業を中断した場合、他方の作業車に設定された走行経路を修正して、他方の作業車が作業を中断した作業車に代わって作業走行するといった融通性はない。
特開2015−112071号公報 特開2016−093125号公報
作業幅が異なる複数の作業車が作業地を協調的に作業する際に必要となる走行経路が高い融通性をもって運用される技術が要望されている。
上記課題を解決するための1つの手段として、標準作業幅を有する少なくとも1台の標準作業車と前記標準作業幅とは異なる特定作業幅を有する少なくとも1台の特定作業車とからなる複数の作業車が、作業対象領域を協調的に作業しながら自動走行するための走行経路を決定する走行経路決定装置は、前記作業対象領域を網羅する走行経路として、前記標準作業幅を間隔とする互いに平行な多数の線状の走行経路要素の集合体である走行経路要素群を算出して、読み出し可能に格納する経路管理部と、前記標準作業車が次に走行すべき次走行経路要素を順次前記走行経路要素群から選択して前記標準作業車の走行制御部に与える第1経路要素選択部と、前記特定作業車が次に走行すべき次走行経路要素を順次前記走行経路要素群から選択して前記特定作業車の走行制御部に与える第2経路要素選択部とを備えている。さらに、この走行経路決定装置は、前記特定作業車によって走行済となった走行経路要素に平行な走行経路要素が、前記標準作業車または前記特定作業車の走行すべき走行経路要素として選択された場合、及び前記標準作業車によって走行済となった走行経路要素に平行な走行経路要素が、前記特定作業車の走行すべき走行経路要素として選択された場合、選択された前記走行経路要素の位置座標を前記標準作業幅と前記特定作業幅との差に基づいて修正する走行経路要素修正部とを備えている。
この構成では、予め、標準作業車の作業幅である標準作業幅で走行経路を構成する走行経路要素が算出され、読み出し可能に格納される。作業走行時には、標準作業車のための走行経路要素は第1経路要素選択部によって選択される。これに対して、標準作業車とは異なる作業幅を有する特定作業車のための走行経路要素は、第2経路要素選択部によって選択されるが、選択される走行経路要素は、標準作業車の作業走行に適合するものであるので、特定作業車に適するように修正される。また、一旦特定作業車が作業走行することで生じる既作業領域は、その作業幅に着目して考えると、標準作業車が作業走行することで生じる既作業領域とは異なる。したがって、その後に、標準作業車のために第1経路要素選択部によって選択された走行経路要素が当該既作業領域に隣接する場合、当該走行要素も修正される。このような修正は走行経路要素修正部によって行われる。したがって、これから走行すべき走行経路要素が修正する必要がある場合に、もう一度走行経路要素を算出し直すのではなく、走行経路要素が当初の位置から修正されるだけである。
特定作業車が作業走行した際の既作業領域と未作業領域との間の境界線は、標準作業車が作業走行した際の境界線に比べて、標準作業幅と特定作業幅との差(作業幅差)だけ、ずれが生じる。このずれをカバーするように、この境界線に沿って作業走行するための走行経路要素は、予め算出されている走行経路要素の位置から、作業幅差に対応する距離だけ修正変位させる必要がある。したがって、走行経路要素修正部は、特定作業車によって走行済となった走行経路要素に平行で、これから走行される走行経路要素の位置座標を、作業幅差に基づいて修正する。また、標準作業車によって走行済となった走行経路要素に平行な走行経路要素であっても、当該走行経路要素が特定作業車で走行される場合には、当該走行経路要素の位置座標は作業幅差に基づいて修正される。これにより、標準作業車が走行する予定の走行経路を標準作業車に代わって特定作業車が走行すること、及び特定作業車が走行する予定の走行経路を特定作業車に代わって標準作業車が走行することが、作業残しや無駄な作業重複(オーバーラップ)を生じることなく実現される。
上述したように、標準作業車と特定作業車とが協調して効率よく作業走行するためには、作業対象領域に設定される走行経路を作り出す走行経路要素群のレイアウトが重要である。本発明の好適な実施形態の1つでは、前記走行経路要素群は、前記作業対象領域をメッシュ分割するメッシュ線からなるメッシュ線群であり、前記メッシュ線同士の交点が、前記標準作業車及び前記特定作業車の経路変更を許す経路変更可能点として設定される。このようなメッシュ線群は、平行な線のグループで構成されるので、その電子的な取扱い、つまりプログラミングでの取り扱いが容易である。作業走行途中であってもメッシュ線群から適切な走行経路要素を選択して、作業車の走行目標に設定していくことで、走行経路を柔軟に変更しながらも作業対象領域を網羅する作業走行が可能となる。
走行経路要素群がメッシュ線からなるメッシュ線群において、そのようなメッシュ線の既作業地に接する端点を経路変更の始点とし、他のメッシュ線の既作業地に接する端点を経路変更の終点とするような利用を採用すると、作業対象領域を横断するような長い走行経路を作り出すことができる。したがって、本発明の好適な実施形態の1つでは、前記走行経路要素群は、前記作業対象領域をメッシュ分割するメッシュ線からなるメッシュ線群であり、前記メッシュ線の両端点が、前記標準作業車及び前記特定作業車の経路変更を許す経路変更可能点として設定される。このメッシュ線の両端点、つまりは走行経路要素の端点を、作業対象領域外の領域における走行経路要素と接続することで、作業対象領域内での走行から作業対象領域外の領域の走行、及び、作業対象領域外の領域の走行から作業対象領域内での走行を、スムーズに行うことができる。このような走行は、長い走行経路を取ることができるので、収穫作業走行や耕耘作業走行などの農作業走行に適している。
上記課題を解決するための他の1つの手段として、標準作業幅を有する少なくとも1台の標準作業車と前記標準作業幅とは異なる特定作業幅を有する少なくとも1台の特定作業車とからなる複数の作業車が作業対象領域を協調的に作業しながら自動走行するための走行経路を決定する走行経路決定装置は、前記標準作業幅と前記特定作業幅との最大公約数を基準幅とし、前記作業対象領域を前記基準幅で短冊状に分割する互いに平行な多数の線状の走行経路要素の集合体である走行経路要素群を算出して、読み出し可能に格納する経路管理部と、前記標準作業車の自動走行制御部に与える第1経路要素選択部と、前記特定作業車の自動走行制御部に与える第2経路要素選択部とを備えている。標準作業車のための第1経路要素選択部は、前記標準作業幅の整数倍、または、前記特定作業幅の整数倍、または、前記標準作業幅の整数倍と前記特定作業幅の整数倍との和、になる未作業領域を残すように、次に走行すべき次走行経路要素を順次前記走行経路要素群から選択する。特定作業車のための第2経路要素選択部は、前記標準作業幅の整数倍、または、前記特定作業幅の整数倍、または、前記標準作業幅の整数倍と前記特定作業幅の整数倍との和、になる未作業領域を残すように、次に走行すべき次走行経路要素を順次前記走行経路要素群から選択する。
この構成では、予め、標準作業幅と特定作業幅との最大公約数を基準幅とし、作業対象領域をその基準幅で短冊状に分割する互いに平行な多数の線状の走行経路要素の集合体である走行経路要素群が算出され、読み出し可能に格納される。このため、標準作業車と特定作業車とが作業走行すべき走行経路要素を選択する際に、作業走行によって作り出されていく未作業領域が、標準作業車と走行作業車との作業走行の繰り返し(どちらか一方の単独作業走行を含む)で、無駄なく作業されることになる。最初に算出される走行経路要素の幅である基準幅は、標準作業幅または特定作業幅と同じか、それより短いものとなるので、作業走行のために使用されない走行経路要素が発生するが、走行経路要素の修正は不要であるので、演算負荷は小さい。
このような互いに平行な多数の線状の走行経路要素を走行経路とする作業走行は、長い線状走行経路の終点でUターン等を行って別の長い線状走行経路始点に進入する走行を繰り返す往復走行によく適合する。このような往復走行は、収穫作業走行や耕耘作業走行などの農作業走行によく用いられている。このため、本発明の好適な実施形態の1つでは、前記走行経路要素の端点が、1つの前記走行経路要素から他の前記走行経路要素への前記標準作業車及び前記特定作業車の経路変更を許す経路変更可能点として設定されている。
なお、この出願で用いられている「作業走行」という語句は、実際に作業を行いながら走行していることだけでなく、作業時における方向転換のための作業を行わない走行なども含めた広義の意味で用いられている。
さらに、本明細書では、作業車の作業環境という語句には、作業車の状態、作業地の状態、人(監視者、運転者、管理者など)による指令なども含めることができ、この作業環境を評価することで状態情報が求められる。この状態情報として、燃料補給や収穫物の排出などの機械的要因や天候の変動や作業地状態などの環境的要因、さらには、不測の作業中断指令などの人的要求を挙げることができる。また、複数台の作業車が協調しながら作業走行する場合には、作業車同士の位置関係なども、作業環境または状態情報の1つとなる。なお、監視者や管理者は、作業車に乗り込んでいてもよいし、作業車の近くに、あるいは作業車から遠く離れていてもよい。
作業対象領域での作業車の作業走行を模式的に示す説明図である。 走行経路決定装置を用いた自動走行制御の基本的な流れを示す説明図である。 Uターンと直進とを繰り返す走行パターンを示す説明図である。 メッシュ状経路に沿う走行パターンを示す説明図である。 作業車の実施形態の1つである収穫機の側面図である。 作業車自動走行システムにおける制御機能ブロック図である。 走行経路要素群の一例であるメッシュ直線の算出方法を説明する説明図である。 短冊部分要素算出部によって算出された走行経路要素群の一例を示す説明図である。 ノーマルUターンとスイッチバックターンとを示す説明図である。 図8による走行経路要素群における走行経路要素の選択例を示す説明図である。 メッシュ経路要素算出部によって算出された走行経路要素群における渦巻き走行パターンを示す説明図である。 メッシュ経路要素算出部によって算出された走行経路要素群における直線往復走行パターンを示す説明図である。 Uターン走行経路の基本的な生成原理を説明する説明図である。 図13の生成原理に基づいて生成されたUターン走行経路の一例を示す説明図である。 図13の生成原理に基づいて生成されたUターン走行経路の一例を示す説明図である。 図13の生成原理に基づいて生成されたUターン走行経路の一例を示す説明図である。 メッシュ状の走行経路要素群におけるαターン走行経路の説明図である。 作業対象領域から離脱後に再開される作業走行が離脱前の作業走行の続きから行われないケースを示す説明図である。 協調制御された複数台の収穫機による作業走行を示す説明図である。 メッシュ経路要素算出部によって算出された走行経路要素群を用いた協調制御走行の基本的な走行パターンを示す説明図である。 協調制御走行における離脱走行及び復帰走行を示す説明図である。 短冊部分要素算出部によって算出された走行経路要素群を用いた協調制御走行の例を示す説明図である。 短冊部分要素算出部によって算出された走行経路要素群を用いた協調制御走行の例を示す説明図である。 中割り過程を示す説明図である。 中割りされた圃場における協調制御走行の例を示す説明図である。 格子状に区分けされた圃場における協調制御走行の例を示す説明図である。 マスタ収穫機からスレーブ収穫機のパラメータを調整できる構成を示す説明図である。 駐車位置周辺にUターン走行スペースを作り出すための自動走行を説明する説明図である。 作業幅が異なる2台の収穫機による経路選択の具体例を示す説明図である。 作業幅が異なる2台の収穫機による経路選択の具体例を示す説明図である。 湾曲した平行線からなる走行経路要素群の一例を示す図である。 湾曲したメッシュ線を含む走行経路要素群の一例を示す図である。 湾曲したメッシュ線からなる走行経路要素群の一例を示す図である。
〔自動走行の概要〕
図1には、作業車自動走行システムによる作業走行が模式的に示されている。この実施形態では、作業車は、作業走行として、走行しながら農作物を収穫する収穫作業(刈取作業)を行う収穫機1であり、一般に普通型コンバインと呼ばれている機種である。収穫機1によって作業走行される作業地は圃場と呼ばれる。圃場における収穫作業では、収穫機1が畦と呼ばれる圃場の境界線に沿って作業を行いながら周回走行した領域が外周領域SAとして設定される。外周領域SAの内側は作業対象領域CAとして設定される。外周領域SAは、収穫機1が収穫物の排出や燃料補給のための移動用スペース及び方向転換用スペース等として利用される。外周領域SAの確保のため、収穫機1は、最初の作業走行として、圃場の境界線に沿って3〜4周の周回走行を行う。周回走行では、一周毎に収穫機1の作業幅分だけ、圃場が作業されることになるので、外周領域SAは収穫機1の作業幅の3〜4倍程度の幅を有する。このことから、特別に注記しない限り、外周領域SAは既刈地(既作業地)として扱われ、作業対象領域CAは未刈地(未作業地)として扱われる。なお、この実施形態では、作業幅は、刈取り幅にオーバーラップ量を減算した値として取り扱われる。しかしながら、作業幅の概念は、作業車の種類によって異なる。本発明での作業幅は、作業車の種類や作業種類によって規定されるものである。
収穫機1は、GPS(グローバル・ポジショニング・システム)で用いられる人工衛星GSからのGPS信号に基づいて測位データを出力する衛星測位モジュール80を備えており、収穫機1は、測位データから、収穫機1の特定箇所の位置座標である自車位置を算出する機能を有する。収穫機1は、算出された自車位置を目標となる走行経路に合わせるように操縦することで走行収穫作業を自動化する自動走行機能を有している。収穫機1は、走行しながら収穫した収穫物を排出するために、畦際に駐車している運搬車CVの周辺に接近して、駐車する必要がある。運搬車CVの駐車位置が予め決められている場合には、このような接近走行、つまり作業対象領域CAにおける作業走行からの一時的な離脱、及び作業走行への復帰も自動走行で行うことも可能である。この作業対象領域CAからの離脱及び作業対象領域CAへの復帰のための走行経路は、外周領域SAが設定された時点で生成される。なお、運搬車CVの代わりに燃料補給車やその他の作業支援車も駐車可能である。
〔作業車自動走行システムの基本的な流れ〕
本発明の作業車自動走行システムに組み込まれた収穫機1が、収穫作業を自動走行で行うためには、走行の目標となる走行経路を生成し、その走行経路を管理する走行経路管理装置が必要となる。この走行経路管理装置の基本的な構成と、この走行経路管理装置を用いた自動走行制御の基本的な流れとを、図2を用いて説明する。
圃場に到着した収穫機1は、圃場の境界線の内側に沿って周回しながら収穫を行う。この作業は周囲刈りと呼ばれ、収穫作業ではよく知られた作業である。その際、コーナ領域では、未刈穀稈が残らないように前進と後進とを繰り返す走行が行われる。本形態では、少なくとも最外周一周は、刈り残しがないように、かつ、畦にぶつからないように、手動走行によって行われる。内周側の残りの数周は、周囲刈り専用の自動走行プログラムによって自動走行しても良く、また、最外周の周囲刈りに引き続いて手動走行によって行っても良い。このような周回走行の走行軌跡内側に残される作業対象領域CAの形状としては、自動走行による作業走行にとって都合が良いように、できるだけ簡単な多角形、好ましくは四角形が採用される。
さらに、この周回走行の走行軌跡は、自車位置算出部53が衛星測位モジュール80の測位データから算出した自車位置に基づいて得ることができる。さらに、この走行軌跡から圃場の外形データ、特に周回走行の走行軌跡内側に位置する未刈地である作業対象領域CAの外形データが、外形データ生成部43によって生成される。圃場は、領域設定部44により外周領域SAと作業対象領域CAとに分けて管理される。
作業対象領域CAに対する作業走行は、自動走行によって実施される。このため、作業対象領域CAを網羅する走行(作業幅で埋め尽くす走行)のための走行経路である走行経路要素群が経路管理部60によって管理される。この走行経路要素群は、多数の走行経路要素の集合体である。経路管理部60は、作業対象領域CAの外形データに基づいて走行経路要素群を算出し、読み出し可能にメモリに格納しておく。
この作業車自動走行システムでは、作業対象領域CAでの作業走行の前に、予め全走行経路が決定されているのではなく、走行途中で、作業車の作業環境等の事情に応じて走行経路の変更が可能である。なお、走行経路の変更が可能な点(ノード)と点(ノード)の間の最小単位(リンク)が走行経路要素である。指定された場所から自動走行が開始されると、次に走行すべき次走行経路要素が、順次、経路要素選択部63によって、走行経路要素群から選択される。自動走行制御部511は、選択された走行経路要素と自車位置とに基づいて、車体が当該走行経路要素に沿うように自動走行データを生成して、自動走行を実行する。
図2では、外形データ生成部43と、領域設定部44と、経路管理部60とによって、収穫機1のための走行経路を生成する走行経路生成装置が構築されている。また、自車位置算出部53、領域設定部44と、経路管理部60と、経路要素選択部63とによって、収穫機1のための走行経路を決定する走行経路決定装置が構築されている。このような走行経路生成装置や走行経路決定装置は、従来の自動走行可能な収穫機1の制御系に組み込むことが可能である。あるいは、走行経路生成装置や走行経路決定装置をコンピュータ端末に構築し、当該コンピュータ端末と収穫機1の制御系とをデータ交換可能に接続して、自動走行を実現することも可能である。
〔走行経路要素群の概要〕
走行経路要素群の一例として、図3には、作業対象領域CAを短冊状に分割する多数の平行分割直線を走行経路要素とする走行経路要素群が示されている。この走行経路要素群は2つのノード(両端点であって、ここで経路変更可能である経路変更可能点と称する)を1本のリンクで連結した直線状の走行経路要素を平行に並べたものである。走行経路要素は、作業幅のオーバーラップ量を調整することにより、等間隔を開けて並ぶように設定される。1つの直線で示される走行経路要素の端点から他の直線で示される走行経路要素の端点への移行には、Uターン走行(例えば180°の方向転換走行)が行われる。このような平行な走行経路要素をUターン走行によって繋ぎながら自動走行することを、以降は、『直線往復走行』と称する。このUターン走行には、ノーマルUターン走行と、スイッチバックターン走行とが含まれる。ノーマルUターン走行は、収穫機1の前進だけで行われ、その走行軌跡はU字状となる。スイッチバックターン走行は、収穫機1の前進と後進とを用いて行われ、その走行軌跡はU字状とはならないが、結果的には、収穫機1はノーマルUターン走行と同じ方向転換走行が得られる。ノーマルUターン走行を行うためには、方向転換走行前の経路変更可能点と方向転換走行後の経路変更可能点との間に2本以上の走行経路要素を挟む距離が必要となる。それより短い距離では、スイッチバックターン走行が用いられる。つまり、スイッチバックターン走行は、ノーマルUターン走行と異なって後進を行うため、収穫機1の旋回半径の影響がなく、移行する走行経路要素の選択肢が多い。しかし、スイッチバックターン走行では前後進の切替えが行われるため、スイッチバックターン走行は、基本的には、ノーマルUターン走行と比べて時間がかかる。
走行経路要素群の他の例として、図4には、作業対象領域CAをメッシュ分割する、縦横方向に延びた多数のメッシュ直線(本発明に係る「メッシュ線」に相当)からなる走行経路要素群が示されている。メッシュ直線同士の交点(経路変更可能点)及びメッシュ直線の両端点(経路変更可能点)において、経路変更が可能である。つまり、この走行経路要素群は、メッシュ直線の交点及び端点をノードとし、メッシュ直線によって区画された各メッシュの辺がリンクとして機能する経路網を構築し、自由度の高い走行を可能にする。上述した直線往復走行だけでなく、例えば、図4に示すような外から内に向かう『渦巻き走行』や、『ジグザグ走行』も可能であり、さらに、作業途中において、渦巻き走行から直線往復走行に変更することも可能である。
〔走行経路要素を選択する際の考え方〕
経路要素選択部63が、順次、次に走行すべき走行経路要素である次走行経路要素を選択する際の選択ルールは、作業走行の前に予め設定される静的ルールと、作業走行中にリアルタイムで利用される動的ルールとに分けることができる。静的ルールには、予め決められた基本的な走行パターンに基づいて走行経路要素を選択すること、例えば、図3に示すようなUターン走行を行いながら直線往復走行を実現するように走行経路要素を選択するルールや、図4に示すような外から内に向かう反時計回りの渦巻き走行を実現するように走行経路要素を選択するルールなどが含まれる。動的ルールには、リアルタイムでの収穫機1の状態、作業地の状態、監視者(運転者や管理者も含む)の指令などが含まれる。原則として、動的ルールは、静的ルールに優先して用いられる。このために、収穫機1の状態、作業地の状態、監視者の指令などを評価して求められる状態情報を出力する作業状態評価部55が備えられる。そのような評価のために必要となる入力パラメータとして種々の一次情報(作業環境)が作業状態評価部55入力される。この一次情報には、収穫機1に設けられている各種センサやスイッチからの信号だけでなく、天候情報や時刻情報や乾燥施設などの外部施設情報なども含まれている。さらに、複数台の収穫機1で協調作業を行う場合には、この一次情報に、他の収穫機1の状態情報も含まれる。
〔収穫機の概要〕
図5は、この実施の形態での説明に採用されている作業車としての収穫機1の側面図である。この収穫機1は、クローラ式の走行機体11を備えている。走行機体11の前部には、運転部12が設けられている。運転部12の後方には、脱穀装置13及び収穫物を貯留する収穫物タンク14が、左右方向に並設されている。また、走行機体11の前方には、収穫部15が高さ調整可能に設けられている。収穫部15の上方には、穀稈を起こすリール17が高さ調節可能に設けられている。収穫部15と脱穀装置13との間には刈取穀稈を搬送する搬送装置16、収穫物タンク14から収穫物を排出する排出装置18が設けられている。収穫物タンク14の下部に収穫物の重量(収穫物の貯留状態)を検出するロードセンサが装備され、収穫物タンク14の内部や周辺に、収量計や食味計が装備されている。食味計からは、品質データとして収穫物の水分値とタンパク値の測定データが出力される。収穫機1には、GNSSモジュールやGPSモジュールなどとして構成される衛星測位モジュール80が設けられている。衛星測位モジュール80の構成要素として、GPS信号やGNSS信号を受信するための衛星用アンテナが走行機体11の上部に取り付けられている。なお、衛星測位モジュール80には、衛星航法を補完するために、ジャイロ加速度センサや磁気方位センサを組み込んだ慣性航法モジュールを含めることができる。
図5では、収穫機1の動きを監視する監視者(運転者や管理者も含む)が当該収穫機1に搭乗し、かつ、監視者が操作する通信端末4が収穫機1に持ち込まれている。ただし、通信端末4は収穫機1に取り付けられている構成であってもよい。さらに、監視者及び通信端末4は、収穫機1の機外に存在していてもよい。
収穫機1は、自動操舵による自動走行と、手動操舵による手動走行とが可能である。また、自動走行としては、従来のように予め全走行経路を決めて走行する自動走行と、状態情報に基づいてリアルタイムに次の走行経路を決めていく自動走行と、が可能である。本発明においては、予め全走行経路を決めて走行する前者を慣行走行と称するとともに、リアルタイムに次の走行経路を決めていく後者を自動走行と称して、両者を別物として取り扱う。慣行走行の経路は、例えば、予めいくつかのパターンを登録するか、あるいは、通信端末4等において監視者が任意に設定できるように構成する。
〔自動走行の機能制御ブロックについて〕
図6には、この収穫機1に構築されている制御系と、通信端末4の制御系が示されている。この実施形態では、収穫機1のための走行経路を管理する走行経路管理装置は、通信端末4に構築された第1走行経路管理モジュールCM1と、収穫機1の制御ユニット5に構築された第2走行経路管理モジュールCM2とから構成されている。
通信端末4は、通信制御部40やタッチパネル41等を備えており、コンピュータシステムの機能や、制御ユニット5によって実現される自動走行に必要な条件を入力するユーザー・インターフェイスとしての機能を有する。通信端末4は、通信制御部40を用いることで、無線回線やインターネットを介して管理コンピュータ100とデータ交換可能であるとともに、無線LANや有線LANあるいはその他の通信方式によって収穫機1の制御ユニット5とデータ交換可能である。管理コンピュータ100は、遠隔地の管理センタKSに設置されたコンピュータシステムであり、クラウドコンピュータとして機能している。管理コンピュータ100は、各農家や農業組合や農業企業体から送られてくる情報を格納して、要求に応じて送り出すことができる。図6では、そのようなサーバ機能を実現するものとして、作業地情報格納部101と作業計画管理部102とが示されている。通信端末4では、通信制御部40を通じて管理コンピュータ100や収穫機1の制御ユニット5から取得した外部データ、及び、タッチパネル41を通じて入力されたユーザ指示(自動走行に必要な条件)等の入力データに基づいて、データ処理が行われ、その処理結果は、タッチパネル41の表示パネルに表示されるとともに、通信制御部40を通じて管理コンピュータ100や収穫機1の制御ユニット5に送信可能である。
作業地情報格納部101には、圃場周辺の地形図や圃場の属性情報(圃場の出入口、条方向等)などを含む圃場情報が格納されている。管理コンピュータ100の作業計画管理部102では、指定された圃場での作業内容を記述した作業計画書が管理されている。監視者の操作を通じて、あるいは自動的に実行されるプログラムを通じて、圃場情報及び作業計画書は、通信端末4や収穫機1の制御ユニット5にダウンロード可能である。作業計画書には、作業対象となる圃場における作業に関して、各種の情報(作業条件)が含まれている。この情報(作業条件)としては、例えば、以下のものが挙げられる。
(a)走行パターン(直線往復走行、渦巻き走行、ジグザグ走行等)
(b)運搬車CVの支援車の駐車位置や収穫物排出等のための収穫機の駐車位置
(c)作業形態(一台の収穫機1による作業、複数台の収穫機1による作業)
(d)いわゆる中割ライン
(e)収穫対象となる作物種(稲(ジャポニカ米、インディカ米)、麦、大豆、菜種、そば等)に応じた車速や脱穀装置13の回転速度の値等。
特に(e)の情報から、作物種に応じた走行機器パラメータの設定や収穫機器パラメータの設定が自動的に実行されるので、設定ミスが回避される。
なお、収穫物を運搬車CVに排出するために収穫機1が駐車する位置が収穫物排出用駐車位置であり、燃料補給車から燃料を補給するために収穫機1が駐車する位置が燃料補給用駐車位置であり、この実施形態では、実質的に同じ位置に設定される。
上記の情報(a)−(e)は、ユーザー・インターフェイスとしての通信端末4を通じて監視者が入力する形態であっても良い。通信端末4には、自動走行の開始や停止を指示する入力機能や、上述したように、自動走行と慣行走行とのいずれで作業走行するかの入力機能や、走行変速装置等の車両走行機器群71や収穫部15等の作業装置機器群72(図6参照)に対するパラメータの値を微調整する入力機能等も構築されている。作業装置機器群72のパラメータのうち、値が微調整できるものとしては、リール17の高さや、収穫部15の高さ等が挙げられる。
通信端末4は、人為的な切り替え操作により、自動走行経路や慣行走行経路のアニメーション表示状態、上記パラメータ表示/微調整状態等に切り替え可能である。なお、このアニメーション表示とは、予め全走行経路が決められている慣行走行における走行経路である自動走行経路や慣行走行経路に沿って走行する収穫機1の走行軌跡をアニメーション化して、タッチパネル41の表示パネル部に表示することである。このようなアニメーション表示により、運転者は、走行前に、これから走行する走行経路を直感的に確認することができる。
作業地データ入力部42は、管理コンピュータ100からダウンロードされた圃場情報や作業計画書や通信端末4から取得した情報を入力する。圃場情報に含まれている圃場概略図や圃場出入口の位置がタッチパネル41に表示され、外周領域SAの形成のために周回走行を行う運転者が支援される。圃場出入口などのデータが圃場情報に含まれていない場合は、ユーザがタッチパネル41を通じて入力することができる。外形データ生成部43は、制御ユニット5から受け取った収穫機1の周回走行時の走行軌跡データ(自車位置の時系列データ)から、精度のよい圃場の外形状及び外形寸法と作業対象領域CAの外形状及び外形寸法とを算出する。領域設定部44は、収穫機1の周回走行の走行軌跡データから外周領域SAと作業対象領域CAを設定する。設定された外周領域SA及び作業対象領域CAの位置座標、つまり外周領域SA及び作業対象領域CAの外形データは、自動走行のための走行経路の生成に用いられる。この実施形態では、走行経路の生成は、収穫機1の制御ユニット5に構築された第2走行経路管理モジュールCM2で行われるので、設定された外周領域SA及び作業対象領域CAの位置座標は、第2走行経路管理モジュールCM2に送られる。
圃場が大きい場合には、中割りと呼ばれる、中央突破の走行経路で圃場を複数の区画に区分けする中割り領域を作り出す作業が行われる。この中割り位置指定も、タッチパネル41の画面に表示された作業地の外形図に対するタッチ操作で行うことができる。もちろん、中割りの位置設定は、自動走行のための走行経路要素群の生成にも影響するので、走行経路要素群の生成時に自動的に行ってもよい。その際、中割り領域の延長線上に運搬車CVなどの作業支援車の支援を受けるための収穫機1の駐車位置が配置されると、全区画からの収穫物排出の走行が効率的に行われる。
第2走行経路管理モジュールCM2には、経路管理部60と、経路要素選択部63と、経路設定部64とが備えられている。経路管理部60は、作業対象領域CAを網羅する走行経路を構成する多数の走行経路要素の集合体である走行経路要素群を算出して、読み出し可能に格納する。走行経路要素群を算出する機能部として、この経路管理部60には、メッシュ経路要素算出部601と短冊経路要素算出部602とUターン経路算出部603とが含まれている。経路要素選択部63は、後で詳しく説明する種々の選択ルールに基づいて、次に走行すべき次走行経路要素を順次前記走行経路要素群から選択する。経路設定部64は、選択された次走行経路要素を、自動走行のための目標走行経路として設定する。
メッシュ経路要素算出部601は、走行経路要素として、作業対象領域CAをメッシュ分割するメッシュ直線からなるメッシュ直線群(本発明に係る「メッシュ線群」に相当)である走行経路要素群を算出し、そのメッシュ直線同士の交点及び端点の位置座標も算出することができる。この走行経路要素が収穫機1の自動走行時の目標走行経路となるので、収穫機1はメッシュ直線同士の交点及び端点で、一方の走行経路要素から他方の走行経路要素へ経路変更することが可能である。つまり、メッシュ直線同士の交点及び端点が収穫機1の経路変更を許す経路変更可能点として機能する。
図7に、走行経路要素群の一例であるメッシュ直線群の作業対象領域CAへの配置の概略が示されている。メッシュ経路要素算出部601によって、収穫機1の作業幅をメッシュ間隔として、作業対象領域CAをメッシュ直線で埋め尽くするように走行経路要素群が算出される。作業対象領域CAは、上述したように、圃場の境界から内側に向かって作業幅で3〜4周の周回走行によって形成された外周領域SAの内側の領域であるため、基本的には、作業対象領域CAの外形は、圃場の外形と相似することになる。しかし、メッシュ直線の算出を容易にするため、作業対象領域CAがほぼ多角形、好ましくはほぼ四角形になるように、外周領域SAを作り出す場合もある。図7では、作業対象領域CAの形状は、第1辺S1と第2辺S2と第3辺S3と第4辺S4とからなる変形四角形である。
メッシュ経路要素算出部601は、図7に示されているように、作業対象領域CAの第1辺S1から収穫機1の作業幅の半分の距離をあけた位置から、第1辺S1に平行であるとともに、収穫機1の作業幅分の間隔をあけて作業対象領域CAの上に並ぶ第1直線群を算出する。同様に、第2辺S2から収穫機1の作業幅の半分の距離をあけた位置から、第2辺S2に平行であるとともに、収穫機1の作業幅分の間隔をあけて作業対象領域CAの上に並ぶ第2直線群、第3辺S3から収穫機1の作業幅の半分の距離をあけた位置から、第3辺S3に平行であるとともに、収穫機1の作業幅分の間隔をあけて作業対象領域CAの上に並ぶ第3直線群、第4辺S4から収穫機1の作業幅の半分の距離をあけた位置から、第4辺S4に平行であるとともに、収穫機1の作業幅分の間隔をあけて作業対象領域CAの上に並ぶ第4直線群を算出する。このように第1辺S1から第4辺S4が、走行経路要素群としての直線群を生成する基準線となっている。直線上の2点の位置座標があればその直線を定義することができるので、走行経路要素である各直線は、各直線の2点の位置座標で規定される直線としてデータ化され、予め定められたデータフォーマットでメモリに格納される。このデータフォーマットには、各走行経路要素を識別するための経路識別子としての経路番号のほか、各走行経路要素の属性値として、経路種、基準となった外形四角形の辺、未走行/既走行などが含まれている。
もちろん、四角形以外の多角形の作業対象領域CAにおいても、上述した直線群の算出を適用することができる。すなわち、作業対象領域CAがNを3以上の整数とした際のN角形状とすると、走行経路要素群は、第1直線群から第N直線群までのN個の直線群からなる。各直線群は、このN角形のいずれかの辺に平行に所定間隔(作業幅)で並んだ直線を含むことになる。
なお、外周領域SAにも、経路管理部60によって走行経路要素群が設定されており、外周領域SAに設定された走行経路要素は、収穫機1が外周領域SAを走行する際に用いられる。外周領域SAに設定された走行経路要素には、離脱経路、復帰経路、Uターン走行用中間直進経路などの属性値が与えられる。離脱経路は、収穫機1が作業対象領域CAを離脱して外周領域SAに入るために用いられる走行経路要素群を意味する。復帰経路は、収穫機1が外周領域SAから作業対象領域CAでの作業走行に復帰するために用いられる走行経路要素群を意味する。Uターン走行用中間直進経路(以下単に中間直進経路と略称する)は、外周領域SAでのUターン走行に用いられるUターン走行経路の一部を構成する直線状の経路である。即ち、中間直進経路は、Uターン走行の開始側の旋回経路とUターン走行の終了側の旋回経路とを接続する直線部分を構成する直線状の走行経路要素群であって、外周領域SAにおいて作業対象領域CAの各辺に平行に設けられた経路である。また、当所は渦巻き走行を行い、途中で直線往復走行に切り換えて作業走行を行う場合、渦巻き走行によって、未刈地は、全辺において作業対象領域CAよりも小さくなるため、効率良く作業走行を行うには、作業対象領域CA内でUターン走行をする方が、わざわざ外周領域SAにまで移動しなくても良いため、無駄な走行がなく、効率的である。そこで、作業対象領域CAでUターン走行が実行される場合には、中間直進経路は、未刈地の外周ラインの位置に応じて、内周側へ平行移動される。
図7では、作業対象領域CAの形状を変形四角形としたので、メッシュ経路要素群の生成の基準となる辺が、4つあったが、作業対象領域CAの形状が長方形または正方形であれば、メッシュ経路要素群の生成の基準となる辺が、2つとなり、メッシュ経路要素群の構造はより簡単となる。
経路管理部60の短冊経路要素算出部602によって算出される走行経路要素群は、図3に示されているように、作業対象領域CAの外形を構成する辺から選ばれた基準辺、例えば最長辺に平行に延びるとともに、作業幅で作業対象領域CAを網羅する(作業幅で埋め尽くす)平行直線群である。短冊経路要素算出部602で算出された走行経路要素群は、作業対象領域CAを短冊状に分割する。さらに、走行経路要素群は、収穫機1がUターン走行するためのUターン走行経路によって順次接続されていく平行直線の集合体である。つまり、平行直線である1つの走行経路要素の走行が終了すれば、次に選択された走行経路要素への移行ためのUターン走行経路がUターン経路算出部603によって決定される。
経路管理部60のUターン経路算出部603は、短冊経路要素算出部602によって算出される走行経路要素群から選択された2つの走行経路要素をUターン走行で接続するためのUターン走行経路を算出する。Uターン経路算出部603は、外周領域SA等が設定されたら、外周領域SAの外形状及び外形寸法と作業対象領域CAの外形状及び外径寸法と収穫機1の旋回半径等に基づいて、外周領域SAのうち、作業対象領域CAの外周の各辺(外辺)に対応する領域毎に、作業対象領域CAの外辺に平行な一つの中間直進経路を算出し、かつ、ノーマルUターン走行及びスイッチバックターン走行が行われるに際して、現在走行している走行経路要素と対応する中間直進経路とを結ぶ開始側の旋回経路と、対応する中間直進経路と移行する走行経路要素とを結ぶ終了側の旋回経路と、を算出する。なお、Uターン走行経路の生成原理については後述する。
図6に示すように、第2走行経路管理モジュールCM2を構築している収穫機1の制御ユニット5には、作業走行を行うために、種々の機能が構築されている。制御ユニット5はコンピュータシステムとして構成されており、入出力インタフェースとして、出力処理部7、入力処理部8、通信処理部70が備えられている。出力処理部7は、収穫機1に装備されている車両走行機器群71、作業装置機器群72、報知デバイス73などと接続している。車両走行機器群71には、走行機体11の左右のクローラの速度を調整して操舵を行う操舵機器をはじめ、図示されていないが変速機構やエンジンユニットなど車両走行のために制御される機器が含まれている。作業装置機器群72には、収穫部15、脱穀装置13、排出装置18などを構成する機器が含まれている。報知デバイス73には、ディスプレイやランプやスピーカが含まれている。特に、ディスプレイには、圃場の外形とともに、走行済の走行経路(走行軌跡)やこれから走行すべき走行経路など、種々の報知情報が表示される。ランプやスピーカは、走行注意事項や自動操舵走行での目標走行経路からの外れなど、注意情報や警告情報を搭乗者(運転者や監視者)に報知するために用いられる。
通信処理部70は、通信端末4で処理されたデータを受け取るとともに、制御ユニット5で処理されたデータの送信を行う機能を有する。これにより、通信端末4は、制御ユニット5のユーザー・インターフェイスとして機能することができる。通信処理部70は、さらに、管理コンピュータ100との間でのデータ交換を行うためにも用いられるので、種々の通信フォーマットを取り扱う機能を有する。
入力処理部8は、衛星測位モジュール80、走行系検出センサ群81、作業系検出センサ群82、自動/手動切替操作具83などと接続している。走行系検出センサ群81には、エンジン回転数や変速状態などの走行状態を検出するセンサが含まれている。作業系検出センサ群82には、収穫部15の高さ位置を検出するセンサや収穫物タンク14の貯留量を検出するセンサなどが含まれている。自動/手動切替操作具83は、自動操舵で走行する自動走行モードと手動操舵で走行する手動走行モードとのいずれかを選択するスイッチである。また、自動走行と慣行走行とを切替えるスイッチが、運転部12に備えられているか、あるいは、通信端末4に構築されている。
さらに、制御ユニット5には、走行制御部51、作業制御部52、自車位置算出部53、報知部54が備えられている。自車位置算出部53は、衛星測位モジュール80から出力される測位データに基づいて、自車位置を算出する。この収穫機1が自動走行(自動操舵)と手動走行(手動操舵)の両方で走行可能に構成されているため、車両走行機器群71を制御する走行制御部51には、自動走行制御部511と手動走行制御部512とが含まれている。手動走行制御部512は、運転者による操作に基づいて車両走行機器群71を制御する。自動走行制御部511は、経路設定部64で設定された走行経路と自車位置との間の方位ずれ及び位置ずれを算出し、自動操舵指令を生成し、出力処理部7を介して操舵機器に出力する。作業制御部52は、収穫機1を構成する収穫部15、脱穀装置13、排出装置18などに設けられている動作機器の動きを制御するために、作業装置機器群72に制御信号を与える。報知部54は、ディスプレイなどの報知デバイス73を通じて運転者や監視者に必要な情報を報知するための報知信号(表示データや音声データ)を生成する。
自動走行制御部511は、操舵制御だけではなく、車速制御も可能である。車速については、上述したように、例えば、搭乗者が、作業開始前に通信端末4を通じて設定する。設定可能な車速には、収穫走行時の車速、非作業旋回(Uターン走行など)時の車速、収穫物排出時や燃料補給時の作業対象領域CAから離脱して外周領域SAを走行する際の車速などが含まれる。自動走行制御部511は、衛星測位モジュール80によって得られた測位データに基づいて実車速を算出する。出力処理部7は、実車速が設定された車速に合うように、走行への変速操作指令等を車両走行機器群71に送る。
〔自動走行の経路について〕
作業車自動走行システムにおける自動走行の例を、直線往復走行を行う例と、渦巻き走行を行う例とに分けて説明する。
まず、短冊経路要素算出部602によって算出された走行経路要素群を用いて直線往復走行する例について説明する。図8には、模式化によって、直線長さを短くした短冊で表された21本の走行経路要素からなる走行経路要素群が示されており、各走行経路要素の上側に経路番号が付与されている。作業走行開始時の収穫機1は、14番の走行経路要素に位置している。収穫機1が位置している走行経路要素と、他の走行経路要素との離間度が符号付き整数で、各経路の下側に付与されている。14番の走行経路要素に位置している収穫機1が、次の走行経路要素に移行するための優先度が、図8において、走行経路要素の下部に整数値で示されている。値が小さいほど優先度が高く、優先的に選択される。この収穫機1は、走行完了した走行経路要素から次の走行経路要素移行する際に、図9で示すように、少なくとも2つの走行経路要素を挟んで次の走行経路要素に移行するノーマルUターン走行と、2つ以下の走行経路要素を挟んで、つまり隣接する走行経路要素へ移行することができるスイッチバックターン走行とが可能である。ノーマルUターン走行は、移行元の走行経路要素の端点から外周領域SAに入ると、約180°の方向転換を行い、移行先の走行経路要素の端点に入る。なお、移行元の走行経路要素と移行先の走行経路要素との間隔が大きい場合は、約90°の旋回の間に相応な直進が入ることになる。つまり、ノーマルUターン走行は、前進走行のみで実行される。これに対して、スイッチバックターン走行は、移行元の走行経路要素の端点から外周領域SAに入ると、一旦約90°旋回した後、約90°旋回でスムーズに移行先の走行経路要素に入れる位置まで後進してから、移行先の走行経路要素の端点に向かう。これにより、操舵制御は複雑になるが、互いの間隔が短い走行経路要素への移行も可能である。
次に走行すべき走行経路要素の選択は、経路要素選択部63によって行われるが、この実施形態では、基本的な選択の優先度として、順番元になる走行経路要素から所定距離だけ離れている適正離間走行経路要素を最高優先度とし、この適正離間走行経路要素に比べて順番元になる走行経路要素から離れるほど、優先度は低くなるように設定される。例えば、次の走行経路要素への移行に関しては、走行距離の短いノーマルUターン走行が走行時間も短く、効率が良い。したがって、2本あけた左右両隣りの走行経路要素の優先度が最も高く設定される(優先度=「1」)。それより収穫機1から離れるほど、ノーマルUターン走行の走行時間が長くなるので、優先度が低くなる(優先度=「2」,「3」,・・・)。つまり、優先度の数値は優先順位を示している。ただし、ノーマルUターン走行の走行時間が長くなり、スイッチバックターン走行より効率が悪くなる8本あけた隣りの走行経路要素への移行の優先度は、スイッチバックターン走行より低くなる。スイッチバックターン走行では、隣の走行経路要素へ移行する優先度より、1本あけた走行経路要素へ移行する優先度の方が高くなっている。これは隣の走行経路要素へのスイッチバックターン走行は、急旋回が必要となり、圃場を荒らす可能性が高いからである。なお、次の走行経路要素への移行は、左右いずれの方向も可能であるが、従来の作業の慣習にしたがって、左側の走行経路要素への移行が右側の走行経路要素への移行に優先するというルールが採用される。したがって、図8の例では、経路番号:14に位置する収穫機1は、次に走行する走行経路要素として、経路番号:17の走行経路要素を選択する。このような優先度の設定が、収穫機1が新しい走行経路要素に入るごとに行われる。
既に選択された走行経路要素、即ち、作業が完了している走行経路要素は、原則的に選択禁止とされる。したがって、図10で示すように、例えば、優先度が「1」である経路番号:11や経路番号:17が既作業地(既刈地)であれば、経路番号:14に位置する収穫機1は、次に走行する走行経路要素として、優先度が「2」である経路番号:18の走行経路要素を選択する。
図11には、メッシュ経路要素算出部601によって算出された走行経路要素を用いて渦巻き走行する例が示されている。図11で示された圃場の外周領域SAと作業対象領域CAは図7のものと同一であり、作業対象領域CAに設定された走行経路要素群も同じである。ここでは説明のために、第1辺S1を基準線とする走行経路要素をL11、L12・・・で示し、第2辺S2を基準線とする走行経路要素をL21、L22・・・で示し、第3辺S3を基準線とする走行経路要素をL31、L32・・・で示し、第4辺S4を基準線とする走行経路要素をL41、L42・・・で示している。
図11の太線は、収穫機1の外側から内側に向かって渦巻き状に走行する走行経路を示している。作業対象領域CAの外側の走行経路要素L11が最初の走行経路として選択される。走行経路要素L11と走行経路要素L21との交点でほぼ90°の経路変更が行われ、収穫機1は走行経路要素L21を走行する。さらに、走行経路要素L21と走行経路要素L31との交点でほぼ110°の経路変更が行われ、収穫機1は走行経路要素L31を走行する。走行経路要素L31と走行経路要素L41との交点でほぼ70°の経路変更が行われ、収穫機1は走行経路要素L41を走行する。次に、収穫機1は、走行経路要素L11の内側の走行経路要素L12と走行経路要素L41との交点で走行経路要素L12に移行する。このような走行経路要素の選択を繰り返すことで、収穫機1は、圃場の作業対象領域CAを外から内への渦巻き状に作業走行する。このように。渦巻き走行パターンが設定されている場合、未走行の属性を有するとともに作業対象領域CAの最外周に位置する走行経路要素同士の交点で経路変更が行われ、収穫機1は方向転換する。
図12には、図11で示された同じ走行経路要素群を利用したUターン走行の走行例が示されている。まず、作業対象領域CAの外側の走行経路要素L11が最初の走行経路として選択される。収穫機1は、走行経路要素L11の終端(端点)を超えて、外周領域SAに入り、第2辺S2に沿うように90°ターンを行い、さらに、走行経路要素L11と平行に延びる走行経路要素L14の始端(端点)に進入するように再び90°ターンを行う。結果的には、180°のノーマルUターン走行を経て、走行経路要素L11から、2本分の走行経路要素をあけて走行経路要素L14に移行する。さらに、走行経路要素L14を走行して、外周領域SAに入ると、180°のノーマルUターン走行を経て、走行経路要素L14と平行に延びる走行経路要素L17に移行する。このようにして、収穫機1は、走行経路要素L17から走行経路要素L110に、さらに走行経路要素L110から走行経路要素L16に移行して、最終的に、圃場の作業対象領域CA全体の作業走行を完了する。以上の説明から明らかなように、図8と図9と図10とを用いて説明された、短冊経路要素算出部602による走行経路要素群を用いた直線往復走行の例は、このメッシュ経路要素算出部601によって算出された走行経路要素を用いた直線往復走行にも適用可能である。
このように、直線往復走行は、作業対象領域CAを短冊状に分割する走行経路要素群であっても、作業対象領域CAをメッシュ状に分割する走行経路要素群であっても実現可能である。言い換えると、作業対象領域CAをメッシュ状に分割する走行経路要素群であれば、直線往復走行にも渦巻き走行にもジグザグ走行にも用いることができ、また、作業途中で走行パターンを渦巻き走行から直線往復走行に変更することも可能である。
〔Uターン走行経路の生成原理〕
図13を用いて、Uターン経路算出部603がUターン走行経路を生成する基本原理を説明する。図13では、LS0で示された旋回元の走行経路要素からLS1で示された旋回先の走行経路要素に移行するUターン走行経路が示されている。通常の走行では、LS0が作業対象領域CAにおける走行経路要素であれば、LS1が外周領域SAでの走行経路要素(=中間直進経路)となり、逆に、LS1が作業対象領域CAにおける走行経路要素であれば、LS0が外周領域SAでの走行経路要素(=中間直進経路)となるのが一般的である。走行経路要素LS0とLS1の直線式(または直線上の2点)がメモリに記録されており、これらの直線式からその交点(図13ではPXで示されている)及び交差角(図13ではθで示されている)が算出される。次に、走行経路要素LS0及び走行経路要素LS1に接するとともに、収穫機1の最小旋回半径と等しい半径(図13ではrで示されている)の接円が算出される。この接円と走行経路要素LS0及びLS1との接点(図13ではPS0,PS1で示されている)を結ぶ円弧(接円の一部)が、旋回経路となる。そこで、走行経路要素LS0とLS1との交点PXと、円との接点までの距離Yを、Y=r/(tan(θ/2))
で求める。最小旋回半径が収穫機1の仕様により実質的に決まっているため、rは規定値である。なお、rは、最小旋回半径と同一の値でなくても良く、無理のない旋回半径を予め通信端末4等によって設定し、その旋回半径となるような旋回操作をプログラミングしてあれば良い。走行制御的には、収穫機1は、旋回元の走行経路要素LS0を走行中に、交点までの距離がYである位置座標(PS0)に到達すると、旋回走行を開始し、次いで、旋回走行中に収穫機1の方位と旋回先の走行経路要素LS1の方位との差が許容値に収まれば旋回走行を終了する。その際、収穫機1の旋回半径は正確に半径rに一致しなくてもよい。旋回先の走行経路要素LS1との距離及び方位差に基づいて操舵制御されることで、収穫機1は旋回先の走行経路要素LS1に移行することができる。
図14、図15、図16に、具体的な3つのUターン走行が示されている。図14では、旋回元の走行経路要素LS0及び旋回先の走行経路要素LS1が作業対象領域CAの外辺から傾斜状態に延びているが、鉛直に延びていても同様である。ここでは、外周領域SAにおけるUターン走行経路は、走行経路要素LS0及び走行経路要素LS1の外周領域SAへの延長線、外周領域SAの走行経路要素の一部(線分)である中間直進経路と、2つの円弧状の旋回経路とからなる。このUターン走行経路も、図13を用いて説明された基本原理に準じて、生成することができる。中間直進経路と旋回元の走行経路要素LS0との交差角θ1及び交点PX1、この中間直進経路と旋回先の走行経路要素LS1との交差角θ2及び交点PX2が算出される。さらには、旋回元の走行経路要素LS0と中間直進経路とに接する半径r(=収穫機1の旋回半径)の接円の接点PS10,PS11の位置座標、及び、中間直進経路と旋回先の走行経路要素LS1とに接する半径rの接円の接点PS20,PS21の位置座標が算出される。これらの接点PS10,PS20にて、収穫機1は旋回を開始することなる。同様に、図15で示された、三角形状の突起を形成した作業対象領域CAに対して、その三角形状の突起を迂回するようなUターン走行経路も同様に生成することができる。走行経路要素LS0及びLS1と、外周領域SAの走行経路要素の一部(線分)である2つの中間直進経路との交点が求められる。それぞれの交点の算出には、図13を用いて説明された基本原理が適用される。
図16には、スイッチバックターン走行による旋回走行が示されており、旋回元の走行経路要素LS0から旋回先の走行経路要素LS1に移行する。このスイッチバックターン走行においては、外周領域SAの走行経路要素の一部(線分)である作業対象領域CAの外辺に平行な中間直進経路と走行経路要素LS0とに接する半径rの接円と、当該中間直進経路と走行経路要素LS1とに接する半径rの接円とが算出される。図13を用いて説明された基本原理に準じて、この2つの接円と中間直進経路との接点の位置座標、旋回元の走行経路要素LS0と接円との接点の位置座標、旋回先の走行経路要素LS1と接円との接点の位置座標が算定される。これにより、スイッチバックターン走行におけるUターン走行経路が生成される。なお、スイッチバックターン走行では、中間直進経路は収穫機1によって後進走行される。
〔渦巻き走行における方向転換走行について〕
図17には、上述した渦巻き走行において、走行経路要素の経路変更可能点である交点での経路変更に用いられる方向転換走行の一例が示されている。以降、この方向転換走行をαターン走行と称する。このαターン走行における走行経路(αターン走行経路)は、いわゆる切り返し走行経路の一種であり、走行元の走行経路要素(図17ではLS0で示されている)と旋回先の走行経路要素(図17ではLS1で示されている)の交点から、前進での旋回経路を経て、後進での旋回経路で旋回先の走行経路要素に接する経路である。αターン走行経路は基準化されているので、走行元の走行経路要素と旋回先の走行経路要素との交差角に応じて生成されたαターン走行経路が予め登録されている。したがって、経路管理部60は、算出された交差角に基づいて適正なαターン走行経路を読み出し、経路設定部64に与える。この構成に代えて、交差角毎の自動制御プログラムを自動走行制御部511に登録しておき、経路管理部60によって算出された交差角に基づいて、自動走行制御部511が適正な自動制御プログラム読み出すような構成を採用してもよい。
〔経路選択のルール〕
経路要素選択部63は、管理センタKSから受け取った作業計画書や通信端末4から人為的に入力された走行パターン(例えば、直線往復走行パターンや渦巻き走行パターン)と、自車位置と、作業状態評価部55から出力される状態情報とに基づいて、走行経路要素を順次選択する。即ち、設定された走行パターンのみを基準にして全走行経路を形成してしまう場合とは異なって、作業前には予測し得ない事態に対応した好適な走行経路が形成されたことになる。また、経路要素選択部63には、上述した基本的なルール以外に、以下のような経路選択ルールA1からA11が予め登録可能であり、走行パターンと状態情報とに応じて、好適な経路選択ルールが適応される。
(A1)監視者(搭乗者)による操作により、自動走行から手動走行への移行が要求された場合、手動走行の準備が完了後、経路要素選択部63による走行経路要素の選択が停止される。そのような操作には、自動/手動切替操作具83の操作、制動操作具の操作(特に急停車操作)、操舵操作具(ステアリングレバーなど)による所定操舵角以上の操作、などが含まれる。さらに、走行系検出センサ群81に、自動走行時に搭乗することが要求される監視者の不在を検出するセンサ、例えば、座席に設けられた着座検出センサやシートベルトの着装検出センサ、が含まれている場合、このセンサからの信号に基づいて、自動走行制御を停止させることができる。つまり、監視者の不在が検知されると、自動走行制御の停止、あるいは収穫機1の走行自体が、停止される。また、操舵操作具による所定操舵角より小さな微小な操舵角の操作は、自動走行制御を停止させることなしに、走行方向の微調整だけを行うような構成を採用してもよい。
(A2)自動走行制御部511は、圃場の外形ライン位置と測位データに基づく自車位置との関係(距離)を監視しており、外周領域SAにおける旋回時に、畦と機体との接触を回避するように自動走行を制御する。具体的には、自動走行を停止して収穫機1を停車させたり、ターン走行の形態を変更(ノーマルUターン走行からスイッチバックターン走行やαターン走行に変更)したり、その領域を通過しない走行経路設定を行ったりする。また、『旋回エリアが狭くなっています。御注意下さい。』等といった報知を行うように構成してあっても良い。
(A3)収穫物タンク14の収穫物の貯留量が満杯または満杯近くになって、収穫物排出が必要な場合、作業状態評価部55から経路要素選択部63へ、状態情報の1つとして、排出要求(作業対象領域CAでの作業走行からの離脱要求の一種)が出される。この場合、畦際の運搬車CVへの排出作業を行うための駐車位置と自車位置とに基づいて、作業対象領域CAでの作業走行から離脱し、外周領域SAを走行して該駐車位置に向かう、適正な走行経路要素(例えば、最短経路となる走行経路要素)が、外周領域SAに設定された走行経路要素群のうち離脱経路の属性値が与えられたものと、作業対象領域CAに設定された走行経路要素群とから選択される。
(A4)燃料残量センサからの信号等によって算出される燃料タンクの残量値に基づいて、燃料切れの切迫が評価された場合、燃料補給要求(離脱要求の一種)が出される。この場合も、(A3)と同様に、予め設定されている燃料補給位置である駐車位置と自車位置とに基づいて、燃料補給位置への適正な走行経路要素(例えば、最短経路となる走行経路要素)が選択される。
(A5)作業対象領域CAでの作業走行から離脱して、外周領域SAに入った場合、再び作業対象領域CAに復帰する必要がある。この作業対象領域CAへの復帰の始点となる走行経路要素として、離脱点に最も近い走行経路要素、あるいは、外周領域SAでの現在位置から最も近い走行経路要素が、外周領域SAに設定された走行経路要素群のうち復帰経路の属性値が与えられたものと、作業対象領域CAに設定された走行経路要素群とから選択される。
(A6)収穫物排出や燃料補給のため、作業対象領域CAでの作業走行から離脱して、再び作業対象領域CAに戻る走行経路を決定する際、作業対象領域CAにおける既作業(既走行)となって走行禁止の属性が付与された走行経路要素を、走行可能な走行経路要素として復活させる。既作業の走行経路要素を選択することで所定以上の時間短縮が可能な場合には、当該走行経路要素が選択される。さらに、作業対象領域CAから離脱する際の作業対象領域CAにおける走行には後進を用いることも可能である。
(A7)収穫物排出や燃料補給のため、作業対象領域CAでの作業走行から離脱するタイミングは、それぞれの余裕度と駐車位置までの走行時間または走行距離とから決定される。余裕度は、ここでは、収穫物排出であれば、収穫物タンク14における現状の貯留量から満杯になるまでに予測される走行時間または走行距離である。燃料補給であれば、燃料タンクにおける現状の残量から完全に燃料切れになるまでに予測される走行時間または走行距離である。例えば、自動走行中に排出用の駐車位置の近くを通過する際に、余裕度や排出作業に要する時間等に基づいて、駐車位置を通り過ぎて、満杯になってから離脱して駐車位置に戻ってくる場合と、駐車位置の近くを通るついでに排出も行う場合とで、いずれが、最終的に効率的な走行であるか(総作業時間が短いとか総走行距離が短いとか)を判定する。あまりにも少ない量のときに排出作業を行うと、全体として排出回数が増えてしまい、効率的ではないし、ほぼ満杯なのであれば、ついでに排出してしまう方が効率的である。
(A8)図18には、作業対象領域CAから離脱後に再開される作業走行で選択される走行経路要素が、離脱前の作業走行の続きではないケースが示されている。このケースでは、図3、図12で示されたような直線往復走行パターンが予め設定されている。図18では、駐車位置は符号PPで示されており、かつ、比較例として、作業対象領域CAを180°のUターン走行を伴う直線往復走行で順調に作業走行しきった場合の走行経路が点線で示されている。実際の走行軌跡は太実線で示されている。作業走行の進行に伴って、順次、直線状の走行経路要素とUターン走行経路とが選択される(ステップ#01)。
作業走行の途中で(ステップ#02)、離脱要求が発生すると、作業対象領域CAから外周領域SAに進む走行経路が算出される。この地点では、現在走行中の走行経路要素に沿ってそのまま直進して外周領域SAに出る経路と、現在走行中の走行経路要素から90°旋回し、既刈地(=既走行の属性を持つ走行経路要素の集合部分)を通過して駐車位置が存在する外周領域SAに出る経路とが考えられる。ここでは、より走行距離が短い後者の経路が選択される(ステップ#03)。この後者の離脱走行では、90°旋回後の作業対象領域CAでの離脱走行経路要素として、外周領域SAに設定されている走行経路要素を離脱点まで平行移動させたものが用いられる。但し、時間的な余裕を持って離脱要求がなされるのであれば、前者の経路が選択される。この前者の離脱走行では、作業対象領域CAでの離脱走行中において、収穫作業が続行されるので、作業効率の点で利点がある。
収穫機1は、作業対象領域CAでの作業走行を離脱して、作業対象領域CA及び外周領域SAを離脱走行して駐車位置に到着すると、作業支援車から支援を受ける。この例では、運搬車CVに収穫物タンク14に貯留された収穫物が排出される。
収穫物の排出が完了すると、作業走行に復帰するため、離脱要求が発生した地点に戻る必要がある。図18の例では、離脱要求が発生した時に走行していた走行経路要素に未作業部分が残されているので、当該走行経路要素に戻る。このため、収穫機1は、駐車位置から外周領域SAの走行経路要素を選択して、左回りに走行し、目的とする走行経路要素の端点に達すると、そこで90°旋回して当該走行経路要素に入り、作業走行を行う。離脱要求が発生した地点を過ぎれば、収穫機1は非作業で走行し、Uターン走行経路を経て、次の走行経路要素を作業走行する(ステップ#04)。以後は、収穫機1は直線往復走行を続行し、この作業対象領域CAでの作業走行を完了する(ステップ#05)。
(A9)入力されている作業地データに圃場内の走行障害物の位置が含まれている場合、あるいは収穫機1に障害物位置検出装置が装備されている場合、障害物の位置と自車位置とに基づいて、障害物回避走行のための走行経路要素が選択される。この障害物回避目的の選択ルールとして、障害物にできるだけ近接した迂回経路をとる走行経路要素を選択するルールや、一旦外周領域SAに出てから作業対象領域CAに入る際に障害物の存在しない直線経路を取ることができる走行経路要素を選択するルールがある。
(A10)図4、図11で示されるような渦巻き走行パターンが設定されている場合に、選択対象となる走行経路要素の長さが短くなると、渦巻き走行パターンから直線往復走行パターンに自動的に切り替えられる。面積が狭くなった場合は、前後進を行うαターン走行を含む渦巻き走行は非効率的になりがちだからである。
(A11)慣行走行で走行している場合において、未作業地、つまり作業対象領域CAにおける走行経路要素群における未作業(未走行)の走行経路要素の数が所定値以下になった場合、慣行走行から自動走行に自動的に切り替えられる。また、収穫機1が、メッシュ直線群で網羅された作業対象領域CAを外から内への渦巻き走行で作業している場合、残された未作業地の面積が少なくなって、未作業走行経路要素の数が所定値以下になった場合、渦巻き走行から直線往復走行に切り替えられる。この場合では、上述したように、無駄な走行を避けるために、中間直進経路の属性を持つ走行経路要素が、外周領域SAから作業対象領域CAの未作業地付近まで平行移動される。
(A12)稲作や麦作などの圃場では、苗の作付け列である条(畝)に平行に収穫機1を走行させることが、収穫作業の効率が向上させる。このため、経路要素選択部63による走行経路要素の選択において、条に平行な走行経路要素ほど選択されやすくする。ただし、作業走行開始時に、機体の姿勢が条方向に平行な姿勢や位置でない場合には、条方向と交差する方向に沿った走行であっても、条に平行な姿勢とするための走行によって作業を行うように構成する。これにより、少しでも無駄な走行(非作業走行)を減らし、早く作業を終えられる。
〔協調走行制御〕
次に、複数の作業車が投入される作業車自動走行システムによる作業走行について説明する。ここでは、理解のしやすさのために、2台の収穫機1による作業走行(自動走行)を説明する。図19には、マスタ収穫機1mとして機能する第1作業車と、スレーブ収穫機1sとして機能する第2作業車とが協調して、1つの圃場を作業走行する様子が示されている。2台の収穫機1を区別するために、それぞれに対してマスタ収穫機1mとスレーブ収穫機1sいう名称が与えられているが、区別して説明する必要がない場合には、単に収穫機1と称する。なお、マスタ収穫機1mには、監視者が乗り込んでおり、監視者は、マスタ収穫機1mに持ち込まれた通信端末4を操作する。便宜的に、マスタ及びスレーブという用語を使用したが、厳密な主従関係を示すものではない。マスタ収穫機1mとスレーブ収穫機1sとの間はそれぞれの通信処理部70を介してデータ通信可能であり、状態情報の交換を行う。通信端末4は、マスタ収穫機1mに監視者の指令や走行経路に関するデータなどを与えるだけでなく、通信端末4とマスタ収穫機1mとを介して、スレーブ収穫機1sにも監視者の指令や走行経路に関するデータを与えることができる。例えば、スレーブ収穫機1sの作業状態評価部55から出力された状態情報はマスタ収穫機1mにも転送され、マスタ収穫機1mの作業状態評価部55から出力された状態情報はスレーブ収穫機1sにも転送される。したがって、双方の経路要素選択部63は、双方の状態情報と双方の自車位置とを考慮して次走行経路要素を選択する機能を有する。また、通信端末4に、経路管理部60と経路要素選択部63が構築されている場合には、双方の収穫機1が、状態情報を通信端末4に与え、そこで選択された次走行経路要素を受け取ることになる。
図20には、図7と同様に、作業幅でメッシュ分割するメッシュ直線からなるメッシュ直線群で網羅された作業対象領域CAを2台の収穫機1によって、つまりマスタ収穫機1mとスレーブ収穫機1sとによって作業する様子が示されている。ここでは、マスタ収穫機1mは、作業対象領域CAを示す変形四角形の右下の頂点付近から走行経路要素L11に入り、走行経路要素L11と走行経路要素L21との交点で左旋回して走行経路要素L21に入る。さらに、走行経路要素L21と走行経路要素L32との交点で左旋回して走行経路要素L32に入る。このようにして、マスタ収穫機1mは、左旋回の渦巻き走行を行う。これに対して、スレーブ収穫機1sは、作業対象領域CAの左上の頂点付近から走行経路要素L31に入り、走行経路要素L31と走行経路要素L41との交点で左旋回して走行経路要素L41に入る。さらに、走行経路要素L41と走行経路要素L12との交点で左旋回して走行経路要素L12に入る。このようにして、スレーブ収穫機1sは、左旋回の渦巻き走行を行う。図20から明らかなように、マスタ収穫機1mの走行軌跡の間にスレーブ収穫機1sの走行軌跡が入り込むような協調制御が行われるので、マスタ収穫機1mは、自己の作業幅とスレーブ収穫機1sの作業幅とを合わせた幅だけ間隔をあけた渦巻き走行となり、スレーブ収穫機1sは、自己の作業幅とマスタ収穫機1mの作業幅とを合わせた幅だけ間隔をあけた渦巻き走行となる。マスタ収穫機1mの走行軌跡とスレーブ収穫機1sの走行軌跡とは、2重渦巻きを作り出している。
なお、作業対象領域CAは、外側の周回走行によって形成される外周領域SAによって規定されるので、最初に外周領域SAを形成するための周回走行を、マスタ収穫機1mとスレーブ収穫機1sとのいずれかによって行う必要がある。この周回走行も、マスタ収穫機1mとスレーブ収穫機1sとの協調制御で行うことも可能である。
図20で示された走行軌跡は理論的なものである。実際には、作業状態評価部55から出力される状態情報に対応して、マスタ収穫機1mの走行軌跡とスレーブ収穫機1sの走行経路は修正され、その走行軌跡も、完全な2重渦巻きにはならない。そのような修正走行の一例が、図21を用いて以下に説明される。図21では、圃場の外側(畦)において、第1辺S1の中央外側に対応する位置に、収穫機1によって収穫された収穫物を搬送する運搬車CVが駐車している。そして、外周領域SAにおける運搬車CVに隣り合う位置に、運搬車CVへの収穫物排出作業のために収穫機1が駐車される駐車位置が設定されている。図21は、スレーブ収穫機1sが、作業走行の途中で、作業対象領域CAでの走行経路要素から離脱して、外周領域SAを周回走行し、収穫物を運搬車CVに排出し、再び外周領域SAを周回走行し、作業対象領域CAでの走行経路要素に復帰する様子を示している。
まず、スレーブ収穫機1sの経路要素選択部63は、離脱要求(収穫物排出)が発生すると、貯留量の余裕と、駐車位置までの走行距離等に基づいて、外周領域SAにおける離脱経路の属性地を持つ走行経路要素と、その離脱経路属性の走行経路要素への離脱元となる走行経路要素と、を選択する。本形態では、外周領域SAのうち駐車位置が設定された領域に設定されている走行経路要素と、現在走行している走行経路要素L41とが選択されており、走行経路要素L41と走行経路要素L12との交点が離脱点となっている。外周領域SAに進んだスレーブ収穫機1sは、外周領域SAの走行経路要素(離脱経路)に沿って駐車位置まで走行し、駐車位置にて運搬車CVに収穫物を排出する。
マスタ収穫機1mは、スレーブ収穫機1sが作業対象領域CAでの作業走行を離脱して収穫物の排出を行っている間も、作業対象領域CAでの作業走行を継続する。但し、スレーブ収穫機1sは、走行経路要素L42の走行中において、本来なら走行経路要素L42と走行経路要素L13との交点で走行経路要素L13を選択する予定であった。しかし、スレーブ収穫機1sの離脱により走行経路要素L12の走行がキャンセルされたので、走行経路要素L12は未刈地(未走行)となっている。このため、マスタ収穫機1mの経路要素選択部63は、走行経路要素L13に代えて走行経路要素L12を選択する。つまり、マスタ収穫機1mは、走行経路要素L42と走行経路要素L12との交点まで走行して、そこで左折して、走行経路要素L12を走行する。
スレーブ収穫機1sが収穫物排出を終えると、スレーブ収穫機1sの経路要素選択部63は、スレーブ収穫機1sの現在位置及び自動走行速度と、作業対象領域CAにおける走行経路要素の属性(未走行/既走行)と、マスタ収穫機1mの現在位置及び自動走行速度と等に基づいて、復帰するべき走行経路要素を選択する。本形態では、最も外側に位置する未作業走行経路要素である走行経路要素L43が選択されている。スレーブ収穫機1sは、駐車位置から、外周領域SAを、復帰経路の属性を有する走行経路要素に沿って左回りに走行して、走行経路要素L43の左端から走行経路要素L43に入る。スレーブ収穫機1sの経路要素選択部63が走行経路要素L43を選択すると、その情報が、状態情報としてマスタ収穫機1mに送信される。マスタ収穫機1mの経路要素選択部63は、走行経路要素L33まで走行経路を選択していたとすると、次の走行経路要素として、走行経路要素L43の内側隣の走行経路要素L44を選択する。このことは、マスタ収穫機1mとスレーブ収穫機1sとが、走行経路要素L33と走行経路要素L44との交点付近で近接する可能性があることを意味する。そこで、両収穫機1m,1sの走行制御部51またはいずれか一方の走行制御部51は、当該交点のマスタ収穫機1mとスレーブ収穫機1sとの当該交点付近の通過時間差を算出し、その通過時間差が所定値以下なら、通過時間が遅い方の収穫機1(ここではマスタ収穫機1m)が衝突回避のため一時停車するように制御する。スレーブ収穫機1sが当該交点を通過した後に、マスタ収穫機1mが再び自動走行を開始する。このようにマスタ収穫機1mとスレーブ収穫機1sとが、互いに自車位置や選択した走行経路要素などの情報を交換しているので、衝突回避行動や遅延回避行動を実行することができる。
このような衝突回避行動や遅延回避行動は、図22及び図23で示すように、直線往復走行においても実行される。なお、図22及び図23では、互いに平行な直線からなる平行直線群は、L01、L02、・・・L10で示されており、L01−L04が既作業の走行経路要素であり、L05−L10が未作業の走行経路要素である。図22では、マスタ収穫機1mが駐車位置に向かうために外周領域SAを走行し、スレーブ収穫機1sが作業対象領域CAの下端で、詳しくは走行経路要素L04の下端で一時停止している。スレーブ収穫機1sが走行経路要素L04からUターン走行で走行経路要素L07に移行するために外周領域SAに進入すると、マスタ収穫機1mと衝突するので、スレーブ収穫機1sが、衝突回避行動として一時停車しているのである。そして、駐車位置にマスタ収穫機1mが駐車した場合、走行経路要素L05、L06、L07を用いた作業対象領域CAへの進入や作業対象領域CAからの離脱は不可能となるので、走行経路要素L05、L06、L07は一時的に走行禁止(選択禁止)となる。マスタ収穫機1mが排出作業を終え、駐車位置から移動すると、スレーブ収穫機1sの経路要素選択部63が、マスタ収穫機1mの走行経路を加味して、走行経路要素L05−L10から、次に移行すべき走行経路要素を選択し、スレーブ収穫機1sは自動走行を再開する。
また、駐車位置にてマスタ収穫機1mが排出作業を行っている間にも、スレーブ収穫機1sが作業を続けることも可能である。その例を図23に示してある。このケースでは、スレーブ収穫機1sの経路要素選択部63は、通常であれば、走行経路要素優先度が「1」である3レーン先の走行経路要素L07を、移行先の走行経路要素として選択するが、走行経路要素L07は、図22の例と同様に走行禁止となっている。そこで、次に優先度が高い走行経路要素L08が選択される。走行経路要素L04から走行経路要素L08への移動経路としては、既走行となった現在の走行経路要素L04を後進する経路(図23で実線で示されている)や、走行経路要素L04の下端から右回りで前進して外周領域SAに出る経路(図23で点線で示されている)等の複数の経路が算出され、最も効率の良い経路、例えば最短となる経路(この形態では実線の経路)が選択される。
これまでの説明では、マスタ収穫機1mとスレーブ収穫機1sとの作業幅が同じであると見なして説明したが、実際には、それぞれの作業幅が異なることがある。この場合、マスタ収穫機1mとスレーブ収穫機1sとが作業走行のために用いるそれぞれの走行経路が予め算出され、それぞれの収穫機1が自分のために算出された走行経路だけを走行する場合には、さして問題はない。しかしながら、作業途中で、マスタ収穫機1mがスレーブ収穫機1sのための設定された走行経路を、あるいはスレーブ収穫機1sがマスタ収穫機1mのための設定された走行経路を作業走行する場合には、作業幅の違いを考慮して、作業走行に用いられる走行経路の変更または修正が必要になる。次に、作業幅の違いを考慮して、走行経路の決定するアルゴリズムを、図29と図30とを用いて説明する。なお、この説明においては、マスタ収穫機1mが標準作業幅を有する標準作業車であり、スレーブ収穫機1sが標準作業幅と異なる特定作業幅を有する特定作業車である。さらに、説明を分かりやすくするため、標準作業幅を「6」とし、特定作業幅を「4」としている。
図29には、図22などで用いられている直線往復走行パターンが設定されている第1のケースが示されている。この第1のケースでは、経路管理部60は、標準作業幅と特定作業幅の最大公約数または近似最大公約数である基準幅で、作業対象領域CAを網羅する多数の走行経路要素の集合体である走行経路要素群を算出する。標準作業幅が「6」、特定作業幅が「4」であるから、基準幅は「2」となる。図29では、走行経路要素を識別するため、01から20までの数を、経路番号として各走行経路要素に付してある。
経路番号17の走行経路要素からマスタ収穫機1mが出発し、経路番号12の走行経路要素からスレーブ収穫機1sが出発するものとする。経路要素選択部63は、第1のケースでは、マスタ収穫機1mの走行経路要素を選択する機能を有する第1経路要素選択部631と、スレーブ収穫機1sの走行経路要素を選択する機能を有する第2経路要素選択部632と動作させる。経路要素選択部63がマスタ収穫機1mの制御ユニット5に構築されている場合、第2経路要素選択部632によって選択された次走行経路要素は、マスタ収穫機1mの通信処理部70とスレーブ収穫機1sの通信処理部70とを介してスレーブ収穫機1sの経路設定部64に与えられる。なお、作業幅の中心または収穫機1の中心と走行経路要素とは必ずしも一致しなくてもよく、偏差があれば、その偏差を考慮した自動走行制御が行われる。
図29に示されているように、第1経路要素選択部631は、標準作業幅または特定作業幅の整数倍の領域(未走行でも既走行でも可)、あるいは、標準作業幅の整数倍と特定作業幅の整数倍との合計の領域(未走行でも既走行でも可)を残すように、未走行となっている走行経路要素群から、次の走行経路要素を選択する。選択された次走行経路要素は、マスタ収穫機1mの経路設定部64に与えられる。同様に、第2経路要素選択部632は、標準作業幅または特定作業幅の整数倍の領域(未走行でも既走行でも可)、あるいは、標準作業幅の整数倍と特定作業幅の整数倍との合計の領域(未走行でも既走行でも可)を残すように、未走行となっている走行経路要素群から、次の走行経路要素を選択する。
つまり、第1経路要素選択部631または第2経路要素選択部632によって与えられた次走行経路要素に沿ってマスタ収穫機1mまたはスレーブ収穫機1sが自動走行した後には、作業対象領域CAには、標準作業幅または特定作業幅の整数倍の幅を有する未走行の領域が残され続けることとなる。しかし、最終的には、特定作業幅未満の狭い幅を有する未作業領域が残る可能性があるが、そのような最後に残った未作業領域は、マスタ収穫機1mまたはスレーブ収穫機1sのいずれかで作業走行される。
図30には、図21などで用いられている、渦巻き走行パターンが設定されている第2のケースが示されている。この第2のケースでは、作業対象領域CAに、縦横の間隔が標準作業幅である縦直線群と横直線群とで走行経路要素群が設定される。横直線群に属する走行経路要素には、その経路番号として、X1からX9の記号が与えられており、縦直線群に属する走行経路要素には、その経路番号として、Y1からY9の記号が与えられている。尚、図30で示している例では、走行経路要素群は、直線状の走行経路要素のみから構成されている。しかしながら、本発明はこれに限定されず、走行経路要素群には、湾曲した線状の走行経路要素が含まれていても良い。また、走行経路要素群は、湾曲した線状の走行経路要素のみから構成されていても良い。
図30は、マスタ収穫機1mとスレーブ収穫機1sとが外から内にかけて左回りの二重渦巻き線を描くような渦巻き走行パターンが設定されている。経路番号Y1の走行経路要素からマスタ収穫機1mが出発し、経路番号X1の走行経路要素からスレーブ収穫機1sが出発するものとする。経路要素選択部63は、第2のケースでは、第1経路要素選択部631と第2経路要素選択部632と走行経路要素修正部633とを動作させる。
図30に示すように、マスタ収穫機1mは、まず、第1経路要素選択部631によって最初に選択された経路番号Y1の走行経路要素を走行する。しかしながら、図30で示された走行経路要素群は、当初標準作業幅を間隔として算出されているので、標準作業幅より狭い特定作業幅を有するスレーブ収穫機1sのために、第2経路要素選択部632によって最初に選択された経路番号X1の走行経路要素は、標準作業幅と特定作業幅の違いを埋めるために、その位置座標が修正される。つまり、標準作業幅と特定作業幅との差(以降、この差を幅差と称する)の0.5倍分だけ、経路番号X1の走行経路要素は外側寄りに修正される(図30、#01)。同様に、スレーブ収穫機1sの走行にともなって選択された次走行経路要素である経路番号Y2、X8、Y8も修正される(図30、#02と#03と#04)。マスタ収穫機1mは、当初通りの経路番号Y1から経路番号X9、Y9の走行経路要素を走行する(図30、#03と#04)が、その次に選択される経路番号X2の走行経路要素は、その外側をスレーブ収穫機1sが走行しているので幅差だけ位置修正が行われる(図30、#04)。スレーブ収穫機1sのために、経路番号X3の走行経路要素を選択された際には、経路番号X3の外側に位置する経路番号X1の走行経路要素をスレーブ収穫機1sが既に走行しているので、幅差の1.5倍分だけ、位置修正が行われる(図30、#05)。このようにして、あとは、順次、選択された走行経路要素の外側にスレーブ収穫機1sが走行した走行経路要素が存在する数に応じて標準作業幅と特定作業幅との差を相殺すべく、選択された走行経路要素の位置修正が行われる(図30、#06)。このような走行経路要素の位置修正は、ここでは、経路要素選択部63に構築された走行経路要素修正部633によって行われる。
図29と図30とを用いた走行例では、第1経路要素選択部631と第2経路要素選択部632とが、マスタ収穫機1mの制御ユニット5に構築されていると仮定している。しかしながら、第2経路要素選択部632がスレーブ収穫機1sに構築されることも可能である。その際は、スレーブ収穫機1sが走行経路要素群を示すデータを受け取り、第1経路要素選択部631と第2経路要素選択部632とが、それぞれが選択した走行経路要素を交換しながら、自己の次走行経路要素を選択し、必要な位置座標修正を行うとよい。また、経路管理部60、第1経路要素選択部631、第2経路要素選択部632を全て、通信端末4に構築し、通信端末4から、選択された走行経路要素を経路設定部64に送る構成も可能である。
上述したように、複数台の収穫機1が協調して、1つの圃場の作業走行する場合では、それぞれの経路要素選択部63は、管理センタKSから受け取った作業計画書や通信端末4から人為的に入力された走行パターン(例えば、直線往復走行パターンや渦巻き走行パターン)を基本ルールとして用いる。この基本ルールには、個々の収穫機1に設定されている上述した(A1)から(A12)の経路選択ルールが含まれる。さらに基本ルールには、複数台の収穫機1が協調して作業走行する場合に特有な経路選択ルールも含まれる。以下に、そのような協調作業走行に特有な経路選択ルールである(B1)から(B11)を列挙する。
(B1)協調して作業走行する複数の収穫機1は、同じ走行パターンで自動走行する。例えば、一方の収穫機1に直線往復走行パターンが設定されている場合は、他方の収穫機1にも直線往復走行パターンが設定される。
(B2)渦巻き走行パターンが設定されている場合に、一方の収穫機1が作業対象領域CAでの作業走行から離脱して外周領域SAに入ると、他方の収穫機1は、より外側の走行経路要素を選択する。その結果、離脱した収穫機1の走行予定経路を残しておくのではなく、離脱した収穫機1が走行する予定の走行経路要素を先取りする。
(B3)渦巻き走行パターンが設定されている場合に、離脱した収穫機1が再び作業対象領域CAでの作業走行に復帰するに際しては、作業走行中の収穫機1から遠く、かつ、未作業の属性を持つ走行経路要素を選択する。
(B4)渦巻き走行パターンが設定されている場合に、選択対象となる走行経路要素の長さが短くなると、1台のみの収穫機1で作業走行を実行し、残りの収穫機1は作業走行から離脱する。
(B5)渦巻き走行パターンが設定されている場合、衝突危険性を回避するため、複数の収穫機1が、作業対象領域CAの外形を示す多角形の辺に平行な走行経路要素群から走行経路要素を同時に選択することを禁止する。
(B6)直線往復走行パターンが設定されている場合、いずれかの収穫機1がUターン走行しているときは、他の収穫機1は、外周領域SAのうちUターン走行が実行されている領域に進入しないように自動走行制御される。
(B7)直線往復走行パターンが設定されている場合、次の走行経路要素としては、他の収穫機1が次に走行予定の走行経路要素または現在走行している走行経路要素から少なくとも2つ以上の走行経路要素が飛ばされた位置にある走行経路要素が選択される。
(B8)収穫物排出や燃料補給のため、作業対象領域CAでの作業走行から離脱するタイミングの決定、及び、走行経路要素の選択は、余裕度と駐車位置までの走行時間とだけでなく、複数の収穫機1が同時に離脱しないことを条件に加えて行われる。
(B9)マスタ収穫機1mにて慣行走行が設定されている場合、スレーブ収穫機1sは、マスタ収穫機1mに追従する自動走行を行う。
(B10)マスタ収穫機1mの収穫物タンク14の容量とスレーブ収穫機1sの収穫物タンク14の容量とが異なる場合に、同時またはほぼ同時に排出要求が出されると、容量が少ない収穫機1が先に排出作業を行う。排出できない収穫機1の排出待機時間(非作業時間)が短くなり、圃場の収穫作業を少しでも早く終了できる。
(B11)1つの圃場が相当広い場合は、1つの圃場を中割りによって複数の区画に区分けし、各区画に1台の収穫機1を投入する。図24は、作業対象領域CAの中央に帯状の中割り領域CCを形成して、作業対象領域CAを2つの区画CA1とCA2とに区分けする中割り過程の途中を示す説明図であり、図25は、中割り過程の終了後を示す説明図である。この実施形態では、マスタ収穫機1mが中割り領域CCを形成する。マスタ収穫機1mが中割りを行っている間、スレーブ収穫機1sは、区画CA2で、例えば直線往復走行パターンで作業走行を行う。この作業走行に先立って、区画CA2のための走行経路要素群が生成される。その際、区画CA2の中割り領域CC側の作業幅一本分に対応する走行経路要素は、中割り過程が終了するまで、選択禁止とし、マスタ収穫機1mとスレーブ収穫機1sとの接触を回避する。
中割り過程が終了すると、マスタ収穫機1mは区画CA1のために算出された走行経路要素群を用いて、単独作業走行のように走行制御され、スレーブ収穫機1sは区画CA2のために算出された走行経路要素群を用いて、単独作業走行のように走行制御される。どちらかの収穫機1が先に作業を完了した場合、作業が残っている区画に入って、当該収穫機1と他の収穫機1との協調制御が開始される。担当する区画での作業が終了した収穫機1は、他の収穫機1の作業のサポートをするために、他の収穫機1の担当区画に向かうように自動走行する。
圃場の規模がさらに大きい場合には、図26に示すように、圃場が格子状に中割りされる。この中割りは、マスタ収穫機1mとスレーブ収穫機1sとで行うことができる。格子状の中割りで形成された区画にマスタ収穫機1mによる作業とスレーブ収穫機1sによる作業とが振り分けられ、それぞれの区画において、単独の収穫機1による作業走行が実施される。但し、マスタ収穫機1mとスレーブ収穫機1sとの距離が所定値以上に離れないという条件で、走行経路要素が選択される。これは、スレーブ収穫機1sがマスタ収穫機1mから離れ過ぎると、マスタ収穫機1mに搭乗している監視者によるスレーブ収穫機1sの作業走行の監視や、互いの状態情報の交信が困難になるためである。図26のような形態の場合は、担当する区画での作業が終了した収穫機1は、他の収穫機1の作業のサポートをするために、他の収穫機1の担当区画に向かうように自動走行しても良いし、自車の担当である次の区画に向かうように自動走行しても良い。
運搬車CVの駐車位置や、燃料補給車の駐車位置は、外周領域SAの外側となるので、作業走行している区画によっては、収穫物排出や燃料補給のための走行経路が長くなり、その走行時間が無駄となる。このため、駐車位置への往き走行及び駐車位置からの戻り走行の際に、通り道となる区画の作業走行を実施するような走行経路要素と周回走行経路要素が選択される。
〔協調自動走行時における作業装置機器群等のパラメータの微調整について〕
マスタ収穫機1mとスレーブ収穫機1sとが協調して作業走行する場合、通常マスタ収穫機1mには、監視者が搭乗しているので、マスタ収穫機1mについては、必要に応じて、通信端末4を通じて、自動走行制御における車両走行機器群71や作業装置機器群72に対するパラメータの値を微調整できる。マスタ収穫機1mの車両走行機器群71や作業装置機器群72に対するパラメータの値を、スレーブ収穫機1sにおいても実現するため、図27に示すように、マスタ収穫機1mからスレーブ収穫機1sのパラメータを調整できる構成を採用することができる。ただし、通信端末4は、スレーブ収穫機1sにも備えられていても何ら問題はない。なぜならば、スレーブ収穫機1sも、単独自動走行をする場合も、マスタ収穫機1mとして使用される場合もあるからである。
図27に示された通信端末4には、パラメータ取得部45と、パラメータ調整指令生成部46とが構築されている。パラメータ取得部45は、マスタ収穫機1mとスレーブ収穫機1sとで設定されている機器パラメータを取得する。これにより、通信端末4のタッチパネル41の表示パネル部にマスタ収穫機1m及びスレーブ収穫機1sの機器パラメータの設定値を表示させることができる。マスタ収穫機1mに搭乗している監視者は、タッチパネル41を通じて、マスタ収穫機1m及びスレーブ収穫機1sの機器パラメータを調整するための機器パラメータ調整量を入力する。パラメータ調整指令生成部46は、入力された機器パラメータ調整量に基づいて、対応する機器パラメータを調整するパラメータ調整指令を生成して、マスタ収穫機1m及びスレーブ収穫機1sに送信する。このような通信のための通信インタフェースとして、マスタ収穫機1m及びスレーブ収穫機1sの制御ユニット5には通信処理部70が備えられており、通信端末4には通信制御部40が備えられている。マスタ収穫機1mの機器パラメータの調整に関しては、監視者がマスタ収穫機1mに装備されている各種操作具を用いて、直接行ってもよい。機器パラメータは、走行機器パラメータと作業機器パラメータとに分けられ、走行機器パラメータには、車速とエンジン回転数とが含まれ、作業機器パラメータには収穫部15の高さやリール17の高さが含まれている。
上述したように、自動走行制御部511は、衛星測位モジュール80によって得られた測位データに基づいて実車速を算出する機能を有する。協調自動走行において、この機能を利用し、同一方向で先行する収穫機1の測位データに基づく実車速と、後続の収穫機1の測位データに基づく実車速とを比較し、車速差があれば、後続の収穫機1の車速が先行する収穫機1の車速となるように、車速調整が行われる。これにより、先行する収穫機1と後続の収穫機1との車速の違いに起因する異常接近や接触が回避される。
収穫機1の通信処理部70や通信端末4の通信制御部40に、登録されている携帯電話などの携帯通信端末と通話やメールを送る通信通話機能を備えることができる。そのような通信通話機能が備えられている場合、収穫物の貯留量が所定量を超えると、収穫物の排出先となる運搬車CVの運転者に、収穫物排出を行う旨の通話(人工音声)またはメールが送出される。同様に、燃料残量が所定量以下になると、燃料補給車の運転者に、燃料補給を依頼する旨の通話(人工音声)またはメールが送出される。
〔別の実施形態〕
(1)上述の実施形態では、事前の周回走行によって、直線往復走行におけるUターン走行にとっても、渦巻き走行におけるαターン走行にとっても十分な広さのスペースが確保されることを前提に自動走行の説明をした。しかし、一般的には、Uターン走行に要するスペースは、αターン走行に要するスペースよりも広い。そのため、事前の周回走行により形成されるスペースは、Uターン走行にとって十分でないことが有り得る。例えば、図28に示すように、1台の収穫機1によって作業を行っている際に、Uターン走行をするときに、畦にデバイダ等が接触して、畦を崩してしまう虞がある。そこで、走行パターンとして直線往復走行パターンが設定された場合には、前述のように畦を崩してしまう事態を回避するべく、作業走行が開始されたら、先ずは、作業対象領域CAの最外周部分において、少なくとも一周を自動で作業走行することにより、外周領域SAを内周側に拡張する。事前の周回走行によって形成された外周領域SAの幅がUターン走行にとって不十分であったとしても、このように、外周領域SAを内周側に拡張することによって、問題なくUターン走行を行うことが可能となる。また、圃場の周囲に停車された作業支援車への収穫物排出等のために収穫機1を規定の駐車位置に停車させる際は、効率良い作業のために、収穫機1を駐車位置に、ある程度正確に、かつ、支援作業に好適な姿勢(向き)で停車させる必要がある。これは、自動走行であろうが手動走行であろうが同じである。作業対象領域CAの外周ラインうちUターン走行が行われる側の外周ラインは直線往復走行によっては変動しないため、外周領域SAが狭いと、収穫機1が未作業地である作業対象領域CAに突入して農作物などに損傷を与えたり、畦に接触して畦を崩してしまったりする可能性がある。このため、直線往復走行による作業対象領域CAの走行作業を開始する前に、追加的な周回走行(追加周回走行)を行うことが好適である。このような追加周回走行は、監視者の指示によって行われてもよいし、自動的に行われてもよい。なお、上述したように、外周領域SAを作り出す事前の周回走行は、通常複数周、渦巻き状に行われる。一番外側の周回走行経路は、走行経路が複雑で、圃場毎に異なるので、人為操舵が採用される。それ以降の周回走行は、自動操舵または人為操舵で行われる。また、図28に示すように、駐車位置PPとUターン経路群ULとが重複している場合、収穫機1が駐車位置PPに駐車している間は、その収穫機1により、別の収穫機1のUターン走行が阻害されてしまう事態が想定される。そのため、事前の周回走行が完了した時点で、駐車位置PPとUターン経路群ULとが重複している場合は、上述の追加周回走行を行うことが望ましい。
追加周回走行のための走行経路は、事前の周回走行における収穫機1の走行軌跡や、作業対象領域CAの外形データ等に基づいて算出することができる。従って、追加周回走行は、自動操舵によって行うことが可能である。以下に、図28を用いて、自動走行での追加周回走行の流れの一例を説明する。
<ステップ#01>
事前の周回走行によって、圃場は、収穫作業が終わった外周領域SAと、これから収穫作業が行われる作業対象領域CAとに区分けされる。事前の周回走行後においては、図28のステップ#01に示すように、駐車位置PPとUターン経路群ULとが外周領域SAにおいて重複している。そして、外周領域SAにおけるUターン経路群ULが設定されている部分の幅は、直線往復走行だけでは拡張されることはない。したがって、この部分の幅を拡張するために、自動的に、あるいは監視者の指示に基づいて、図28のステップ#02で示す追加周回走行が実行される。
<ステップ#02>
この追加周回走行では、矩形状の周回走行経路を構成する複数の周回走行経路要素(図28で太線)が算出される。この周回走行経路要素には、直線往復走行のために算出された走行経路要素における左端の走行経路要素Lsと右端の走行経路要素Leとが含まれる。なお、走行経路要素Ls及び走行経路要素Leは、いずれも直線状である。また、矩形状の周回走行経路において、走行経路要素Lsと走行経路要素Leとは対辺となる。また、ここでは、周回走行経路要素は、走行経路要素Lsと、走行経路要素Leと、走行経路要素Ls及び走行経路要素Leの上端同士を接続する走行経路要素と、走行経路要素Ls及び走行経路要素Leの下端同士を接続する走行経路要素と、である。自動走行が開始されると、この追加的な周回走行経路に適合する周回走行経路要素が経路要素選択部63によって選択され、自動走行(周回走行での作業走行)が実行される。
<ステップ#03>
図28のステップ#03で示すように、この追加周回走行により、外周領域SAが拡大される。これにより、駐車位置PPと未作業地との間に、少なくとも収穫機1の作業幅に相当する幅を有するスペースが新たに形成される。次いで、作業対象領域CAが、この追加周回走行での周回数の作業幅分だけ縮小されたことにより、左端の走行経路要素Lsと右端の走行経路要素Leとは、作業対象領域CAが縮小された分だけ内側に移動する。そして、移動された走行経路要素Ls及び走行経路要素Leを対辺とする矩形である新たな作業対象領域CAに対して、直線往復走行パターンによる作業走行経路が決定され、新たな作業対象領域CAの自動作業走行が開始される。
なお、図28のステップ#01において、駐車位置PPがUターン経路群ULに重複しておらず、かつ、駐車位置PPがUターン経路群ULに向かい合っていない場合がある。例えば、駐車位置PPが、左端の走行経路要素Lsに向き合って位置する場合がある。この場合は、走行経路要素Lsが最初に選択される直線往復走行が行われることで、駐車位置の周辺領域が拡大されていくので、上述の追加周回走行は、もはや実行されない。あるいは、1周程度の追加周回走行だけが行われても良い。
また、複数台の収穫機1によって協調的に作業走行するような場合にも、上述の追加周回走行が自動的に行われるように構成されていても良い。協調作業の場合、走行パターンとして直線往復走行パターンが設定されると共に、駐車位置PPがUターン経路群ULに向かい合う位置に設定されると、作業走行開始後すぐに、複数周(3〜4周程度)分の追加周回走行が自動的に行われる。これにより、作業対象領域CAが縮小され、駐車位置PPの内周側に広いスペースが確保される。したがって、一台の収穫機1が駐車位置PPに停車していても、他の収穫機1は、余裕を持って、駐車位置PPの内周側でUターンすることや、駐車位置PPの内周側を通過することができる。
(2)上述の実施形態では、直線往復走行パターンが設定されている場合に、外周領域SAにおいてUターン走行が行われる領域に、運搬車CV等の支援車への作業のための駐車位置が設定されていると、排出作業等のために停車している収穫機1とは別の収穫機1は、排出作業等の終了まで停止して待機したり、駐車位置を迂回する走行経路要素が選択されたりするように構成されていた。しかし、このような場合に、駐車位置よりも内周側にUターン走行を行うのに十分なスペースを確保するために、自動走行(作業走行)が開始されると、1台または複数台の収穫機1が自動で作業対象領域CAの外周部を何周か周回走行するように構成してあっても良い。
(3)上述の実施形態において図6に基づいて説明した制御機能ブロックはあくまでも一例に過ぎず、各機能部をさらに分割することや複数の機能部を統合することも可能である。また、機能部は、上部制御装置としての制御ユニット5と通信端末4と管理コンピュータ100とに振り分けられたが、この機能部の振り分けも一例であり、各機能部は、任意の上部制御装置に振り分けることも可能である。上部制御装置同士でデータ交換可能につながっていれば、別な上部制御装置に振り分けること可能である。例えば、図6で示された制御機能ブロック図では、作業地データ入力部42、外形データ生成部43、領域設定部44が、第1走行経路管理モジュールCM1として、通信端末4に構築されている。さらに、経路管理部60、経路要素選択部63、経路設定部64が、第2走行経路管理モジュールCM2として、収穫機1の制御ユニット5に構築されている。これに代えて、経路管理部60が第1走行経路管理モジュールCM1に含まれてもよい。また、外形データ生成部43や領域設定部44が、第2走行経路管理モジュールCM2に含まれてもよい。第1走行経路管理モジュールCM1の全てを制御ユニット5に構築してもよいし、第2走行経路管理モジュールCM2の全てを通信端末4に構築してもよい。走行経路管理に関するできるだけ多くの制御機能部を持ち出し可能な通信端末4に構築した方が、メンテナンス等の自由度が高くなり、好都合である。この機能部の振り分けは、通信端末4及び制御ユニット5のデータ処理能力や、通信端末4と制御ユニット5との間の通信速度によって制限される。
(4)本発明で算定され、設定される走行経路は、自動走行の目標走行経路として用いられるが、手動走行の目標走行経路として用いることも可能である。つまり、本発明は、自動走行のみならず手動走行にも適用可能であり、もちろん、自動走行と手動走行とを混在させた運用も可能である。
(5)上述の実施形態では、管理センタKSから送られてくる圃場情報に、そもそも圃場周辺の地形図が含まれており、圃場の境界に沿った周回走行によって、圃場の外形状及び外形寸法の精度を向上させる例を示した。しかし、圃場情報には圃場周辺の地形図、少なくとも圃場の地形図が含まれておらず、周回走行によって初めて、圃場の外形状及び外形寸法が算定されるように構成してあっても良い。また、管理センタKSから送られてくる圃場情報や作業計画書の内容や、通信端末4を通じて入力される項目は、上述した形態のものに限られず、本発明の趣旨を逸脱しない範囲で変更可能である。
(6)上述の実施形態では、図6に示されているように、メッシュ経路要素算出部601とは別に、短冊経路要素算出部602が備えられ、短冊経路要素算出部602によって、作業対象領域CAを網羅する平行直線群である走行経路要素群が算出される例を示した。しかし、短冊経路要素算出部602を備えずに、メッシュ経路要素算出部601によって算出されたメッシュ状の直線群である走行経路要素を用いて、直線往復走行を実現しても良い。
(7)上述の実施形態では、協調走行制御が行われている際に、監視者の目視結果に基づいて、スレーブ収穫機1sの車両走行機器群71や作業装置機器群72のパラメータを変更する例を示した。しかし、マスタ収穫機1mやスレーブ収穫機1sに搭載されたカメラによって撮影された映像(動画や一定間隔で撮影される静止画)がマスタ収穫機1mに搭載されたモニタ等に映し出されるように構成し、監視者がこの映像を見て、スレーブ収穫機1sの作業状況を判断し、車両走行機器群71や作業装置機器群72のパラメータを変更しても良い。あるいは、マスタ収穫機1mのパラメータが変更されるのに連動して、スレーブ収穫機1sのパラメータが変更されるように構成しても良い。
(8)上述の実施形態では、協調して作業走行する複数の収穫機1は、同じ走行パターンで自動走行するように構成した例を示したが、異なる走行パターンで自動走行するように構成することも可能である。
(9)上述の実施形態では、2台の収穫機1によって協調自動走行を行う例を示したが、3台以上の収穫機1による協調自動走行も同様の作業車自動走行システム及び走行経路管理装置によって実現可能である。
(10)図3では、走行経路要素群の一例として、作業対象領域CAを短冊状に分割する多数の平行分割直線を走行経路要素とする走行経路要素群が示されている。しかしながら、本発明はこれに限定されない。例えば、図31に示す走行経路要素群は、湾曲した平行線を走行経路要素としている。このように、平行線は湾曲していても良い。また、平行線群には、湾曲した平行線が含まれていても良い。
(11)図4では、走行経路要素群の一例として、作業対象領域CAをメッシュ分割する、縦横方向に延びた多数のメッシュ直線からなる走行経路要素群が示されている。しかしながら、本発明はこれに限定されない。即ち、本発明に係る「メッシュ線」は、直線でなくても良い。例えば、図32に示す走行経路要素群では、紙面における横方向のメッシュ線は直線であり、紙面における縦方向のメッシュ線は湾曲している。また、図33に示す走行経路要素群では、紙面における横方向のメッシュ線及び縦方向のメッシュ線は、いずれも湾曲している。このように、メッシュ線は湾曲していても良い。また、メッシュ線群には、湾曲したメッシュ線が含まれていても良い。
(12)上述の実施形態では、直線状の走行経路要素に沿った走行と、Uターン走行と、を繰り返すことにより、直線往復走行が行われる。しかしながら、本発明はこれに限定されず、図31から図33に示すような湾曲した走行経路要素に沿った走行と、Uターン走行と、を繰り返すことにより、往復走行が行われるように構成されていても良い。
本発明は、作業車として普通型コンバインである収穫機1以外にも、作業地を自動作業しながら走行することができる作業車であれば、自脱型コンバインやトウモロコシ収穫機など他の収穫機1や、耕耘装置などの作業装置を取り付けたトラクタ、水田作業機等にも適用可能である。
1 :収穫機(作業車)
1m :マスタ収穫機(標準作業車)
1s :スレーブ収穫機(特定作業車)
4 :通信端末
60 :経路管理部
601 :メッシュ経路要素算出部
602 :短冊経路要素算出部
603 :Uターン経路算出部
63 :経路要素選択部
631 :第1経路要素選択部
632 :第2経路要素選択部
633 :走行経路要素修正部
64 :経路設定部
CA :作業対象領域
X1〜X9 :経路番号
Y1〜Y9 :経路番号

Claims (5)

  1. 標準作業幅を有する少なくとも1台の標準作業車と前記標準作業幅とは異なる特定作業幅を有する少なくとも1台の特定作業車とからなる複数の作業車が、作業対象領域を協調的に作業しながら自動走行するための走行経路を決定する走行経路決定装置であって、
    前記作業対象領域を網羅する走行経路として、前記標準作業幅を間隔とする互いに平行な多数の線状の走行経路要素の集合体である走行経路要素群を算出して、読み出し可能に格納する経路管理部と
    前記標準作業車が次に走行すべき次走行経路要素を順次前記走行経路要素群から選択して前記標準作業車の走行制御部に与える第1経路要素選択部と、
    前記特定作業車が次に走行すべき次走行経路要素を順次前記走行経路要素群から選択して前記特定作業車の走行制御部に与える第2経路要素選択部と、
    前記特定作業車によって走行済となった走行経路要素に平行な走行経路要素が、前記標準作業車または前記特定作業車の走行すべき走行経路要素として選択された場合、及び前記標準作業車によって走行済となった走行経路要素に平行な走行経路要素が、前記特定作業車の走行すべき走行経路要素として選択された場合、選択された前記走行経路要素の位置座標を前記標準作業幅と前記特定作業幅との差に基づいて修正する走行経路要素修正部と、を備えた走行経路決定装置。
  2. 前記走行経路要素群は、前記作業対象領域をメッシュ分割するメッシュ線からなるメッシュ線群であり、前記メッシュ線同士の交点が、前記標準作業車及び前記特定作業車の経路変更を許す経路変更可能点として設定される請求項1に記載の走行経路決定装置。
  3. 前記走行経路要素群は、前記作業対象領域をメッシュ分割するメッシュ線からなるメッシュ線群であり、前記メッシュ線の両端点が、前記標準作業車及び前記特定作業車の経路変更を許す経路変更可能点として設定される請求項1に記載の走行経路決定装置。
  4. 標準作業幅を有する少なくとも1台の標準作業車と前記標準作業幅とは異なる特定作業幅を有する少なくとも1台の特定作業車とからなる複数の作業車が作業対象領域を協調的に作業しながら自動走行するための走行経路を決定する走行経路決定装置であって、
    前記標準作業幅と前記特定作業幅との最大公約数を基準幅とし、前記作業対象領域を前記基準幅で短冊状に分割する互いに平行な多数の線状の走行経路要素の集合体である走行経路要素群を算出して、読み出し可能に格納する経路管理部と、
    前記標準作業幅の整数倍、または、前記特定作業幅の整数倍、または、前記標準作業幅の整数倍と前記特定作業幅の整数倍との和、になる未作業領域を残すように、次に走行すべき次走行経路要素を順次前記走行経路要素群から選択して、前記標準作業車の自動走行制御部に与える第1経路要素選択部と、
    前記標準作業幅の整数倍、または、前記特定作業幅の整数倍、または、前記標準作業幅の整数倍と前記特定作業幅の整数倍との和、になる未作業領域を残すように、次に走行すべき次走行経路要素を順次前記走行経路要素群から選択して、前記特定作業車の自動走行制御部に与える第2経路要素選択部と、を備えた走行経路決定装置。
  5. 前記走行経路要素の端点が、1つの前記走行経路要素から他の前記走行経路要素への前記標準作業車及び前記特定作業車の経路変更を許す経路変更可能点として設定される請求項4に記載の走行経路決定装置。
JP2017221345A 2016-12-19 2017-11-16 走行経路決定装置 Active JP6920970B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201780071309.1A CN109964191B (zh) 2016-12-19 2017-11-29 行驶路径决定装置
PCT/JP2017/042874 WO2018116771A1 (ja) 2016-12-19 2017-11-29 走行経路決定装置
KR1020197013043A KR102452908B1 (ko) 2016-12-19 2017-11-29 주행 경로 결정 장치

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2016245797 2016-12-19
JP2016245797 2016-12-19

Publications (2)

Publication Number Publication Date
JP2018099113A JP2018099113A (ja) 2018-06-28
JP6920970B2 true JP6920970B2 (ja) 2021-08-18

Family

ID=62714681

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017221345A Active JP6920970B2 (ja) 2016-12-19 2017-11-16 走行経路決定装置

Country Status (3)

Country Link
JP (1) JP6920970B2 (ja)
KR (1) KR102452908B1 (ja)
CN (1) CN109964191B (ja)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7130535B2 (ja) * 2018-08-01 2022-09-05 株式会社クボタ 自動走行制御システム
WO2020026650A1 (ja) * 2018-08-01 2020-02-06 株式会社クボタ 自動走行制御システム、自動走行制御方法、自動走行制御プログラム、及び、記憶媒体
JP7246918B2 (ja) * 2018-12-21 2023-03-28 ヤンマーパワーテクノロジー株式会社 走行状態表示装置、及び、自動走行システム
JP2020099268A (ja) * 2018-12-21 2020-07-02 株式会社クボタ 圃場作業車及び走行経路生成システム
JP7203654B2 (ja) * 2019-03-25 2023-01-13 ヤンマーパワーテクノロジー株式会社 自動走行システム
JP2022074349A (ja) 2020-11-04 2022-05-18 村田機械株式会社 自律走行経路計画方法
JP7451481B2 (ja) * 2021-11-30 2024-03-18 ヤマハ発動機株式会社 農作業支援システム、自動走行車両の制御システム及び制御方法、並びにプログラム
CN114532017B (zh) * 2022-03-18 2022-10-28 江苏玖顺农业机械有限公司 一种水稻种植用自动导航小型高速插秧机
CN114894092B (zh) * 2022-05-19 2024-02-27 西北农林科技大学 一种农机具作业幅宽视觉检测系统与方法

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19629618A1 (de) * 1996-07-23 1998-01-29 Claas Ohg Routenplanungssystem für landwirtschaftliche Arbeitsfahrzeuge
US8498788B2 (en) * 2010-10-26 2013-07-30 Deere & Company Method and system for determining a planned path of a vehicle
JP5724110B2 (ja) * 2011-07-07 2015-05-27 株式会社日立製作所 経路作成システム、経路作成方法及びプログラム
JP2014178759A (ja) * 2013-03-13 2014-09-25 Kubota Corp 作業車協調システム
JP6278682B2 (ja) 2013-12-12 2018-02-14 株式会社クボタ 圃場作業機
JP5676039B1 (ja) * 2014-05-28 2015-02-25 シャープ株式会社 自走式装置、自走式装置の制御方法、および、自走式装置の制御プログラム
JP6219790B2 (ja) * 2014-07-29 2017-10-25 株式会社クボタ 作業車協調システム
JP6267626B2 (ja) 2014-11-13 2018-01-24 ヤンマー株式会社 走行経路設定装置

Also Published As

Publication number Publication date
CN109964191B (zh) 2022-08-16
KR20190096955A (ko) 2019-08-20
JP2018099113A (ja) 2018-06-28
CN109964191A (zh) 2019-07-02
KR102452908B1 (ko) 2022-10-11

Similar Documents

Publication Publication Date Title
JP6936356B2 (ja) 作業車自動走行システム
JP6832828B2 (ja) 走行経路決定装置
JP2020127405A5 (ja)
JP6920958B2 (ja) 走行経路生成装置
KR102532963B1 (ko) 작업차 자동 주행 시스템
JP6920970B2 (ja) 走行経路決定装置
JP6793625B2 (ja) 走行経路管理システム
JP6673786B2 (ja) 作業車自動走行システム及び走行経路管理装置
WO2018042853A1 (ja) 作業車自動走行システム、走行経路管理装置、走行経路生成装置、走行経路決定装置
WO2018101351A1 (ja) 走行経路管理システム及び走行経路決定装置
WO2018116770A1 (ja) 作業車自動走行システム
JP6920969B2 (ja) 走行経路管理システム
JP6842907B2 (ja) 作業車自動走行システム
JP6891097B2 (ja) 走行経路決定装置
KR102452919B1 (ko) 작업차 자동 주행 시스템
JP6689738B2 (ja) 作業車自動走行システム
JP6982116B2 (ja) 作業車自動走行システム及び走行経路管理装置
JP6789800B2 (ja) 作業車自動走行システム
JP2018099112A5 (ja)
JP7118119B2 (ja) 作業車自動走行システム
JP2022028836A5 (ja)
JP2020110158A5 (ja)
JP6673813B2 (ja) 走行経路管理システム
WO2018116771A1 (ja) 走行経路決定装置
JP7076195B2 (ja) 作業車自動走行システム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20191225

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210126

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210727

R150 Certificate of patent or registration of utility model

Ref document number: 6920970

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150