JP7076195B2 - Work vehicle automatic driving system - Google Patents
Work vehicle automatic driving system Download PDFInfo
- Publication number
- JP7076195B2 JP7076195B2 JP2017221342A JP2017221342A JP7076195B2 JP 7076195 B2 JP7076195 B2 JP 7076195B2 JP 2017221342 A JP2017221342 A JP 2017221342A JP 2017221342 A JP2017221342 A JP 2017221342A JP 7076195 B2 JP7076195 B2 JP 7076195B2
- Authority
- JP
- Japan
- Prior art keywords
- work
- traveling
- route
- travel
- 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
Links
- 230000002093 peripheral effect Effects 0.000 claims description 112
- 238000004364 calculation method Methods 0.000 claims description 60
- 230000008859 change Effects 0.000 claims description 18
- 230000007704 transition Effects 0.000 claims description 16
- 238000004891 communication Methods 0.000 description 69
- 238000003306 harvesting Methods 0.000 description 60
- 241001124569 Lycaenidae Species 0.000 description 27
- 230000006870 function Effects 0.000 description 27
- 238000012545 processing Methods 0.000 description 18
- 238000011156 evaluation Methods 0.000 description 17
- 238000007599 discharging Methods 0.000 description 11
- 238000001514 detection method Methods 0.000 description 9
- 239000000463 material Substances 0.000 description 8
- 238000000034 method Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 230000009471 action Effects 0.000 description 5
- 239000000446 fuel Substances 0.000 description 4
- 230000003068 static effect Effects 0.000 description 4
- 238000003860 storage Methods 0.000 description 4
- 238000005520 cutting process Methods 0.000 description 3
- 238000012905 input function Methods 0.000 description 3
- 240000007594 Oryza sativa Species 0.000 description 2
- 235000007164 Oryza sativa Nutrition 0.000 description 2
- 241000209140 Triticum Species 0.000 description 2
- 235000021307 Triticum Nutrition 0.000 description 2
- 102100038968 WAP four-disulfide core domain protein 1 Human genes 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 238000009826 distribution Methods 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 239000002828 fuel tank Substances 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 239000000256 polyoxyethylene sorbitan monolaurate Substances 0.000 description 2
- 235000009566 rice Nutrition 0.000 description 2
- 241000894007 species Species 0.000 description 2
- 240000002791 Brassica napus Species 0.000 description 1
- 235000004977 Brassica sinapistrum Nutrition 0.000 description 1
- 240000008620 Fagopyrum esculentum Species 0.000 description 1
- 235000009419 Fagopyrum esculentum Nutrition 0.000 description 1
- 244000068988 Glycine max Species 0.000 description 1
- 235000010469 Glycine max Nutrition 0.000 description 1
- 240000002582 Oryza sativa Indica Group Species 0.000 description 1
- 240000008467 Oryza sativa Japonica Group Species 0.000 description 1
- 101001136140 Pinus strobus Putative oxygen-evolving enhancer protein 2 Proteins 0.000 description 1
- 240000008042 Zea mays Species 0.000 description 1
- 235000005824 Zea mays ssp. parviglumis Nutrition 0.000 description 1
- 235000002017 Zea mays subsp mays Nutrition 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 235000013339 cereals Nutrition 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000010485 coping Effects 0.000 description 1
- 235000005822 corn Nutrition 0.000 description 1
- 238000001035 drying Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000013508 migration Methods 0.000 description 1
- 230000005012 migration Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 102000004169 proteins and genes Human genes 0.000 description 1
- 108090000623 proteins and genes Proteins 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 230000007306 turnover Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Guiding Agricultural Machines (AREA)
Description
本発明は、データ交換しながら作業地を協調的に作業走行する複数の作業車のための作業車自動走行システムに関する。 The present invention relates to an automatic work vehicle traveling system for a plurality of work vehicles that cooperatively work and travel on a work site while exchanging data.
特許文献1による圃場作業機は、自動走行によって圃場作業を行うために、経路算出部と運転支援ユニットとを備えている。経路算出部は、地形データから圃場の外形を求め、この外形と圃場作業機の作業幅とに基づいて、設定された走行開始地点から始まって走行終了地点で終わる走行経路を算出する。運転支援ユニットは、GPSモジュールから得られる測位データ(緯度経度データ)に基づいて求められた自車位置と、経路算出部によって算出された走行経路とを比較し、走行機体が走行経路に沿って走行するように操舵機構を制御する。
The field work machine according to
特許文献1には、1台の作業車を自動走行制御するシステムが開示されているが、特許文献2には、2台の作業車を併走走行させながら作業を行うシステムが開示されている。このシステムでは、圃場を特定した後、第一作業車に対する第二作業車の作業配置位置が設定されると、第一作業車と第二作業車の作業を行うための走行経路が決定される。走行経路が決定されると、第一作業車と第二作業車とは、自車の位置を測位して、走行経路に沿って走行しながら作業を行う。
作業地を複数の作業車が作業走行すれば、作業時間が短縮される。これを実現するため、特許文献2に開示されているような自動走行システムでは、第一作業車に対する第二作業車の作業配置位置が前もって設定され、この2台の作業車が原則的に、設定された作業配置位置を維持しながら作業走行する。しかしながら、第一作業車と第二作業車との一方だけが事情によって作業走行から離脱することは考慮されていない。第一作業車と第二作業車との一方だけが離脱した場合、残った作業車も作業走行を離脱するか、あるいは、残った作業車だけが予め与えられている自己の走行経路に沿って作業走行することになる。実際の作業走行では、広大な圃場を作業走行している間に、燃料補給や収穫物の排出などの機械的要因や天候の変動や作業地状態などの環境的要因などが発生し、予め設定された作業走行からの離脱が少なからず生じる。
If multiple work vehicles run on the work site, the work time will be shortened. In order to realize this, in the automatic traveling system as disclosed in
このような実情に鑑み、複数の作業車による作業地の協調的な作業走行において、作業車の走行作業からの離脱に適切に対処できる作業車自動走行システムが要望されている。 In view of such a situation, there is a demand for a work vehicle automatic traveling system capable of appropriately coping with the departure of the work vehicle from the traveling work in the coordinated work traveling of the work area by a plurality of work vehicles.
データ交換しながら作業地を協調的に作業走行する複数の作業車のための作業車自動走行システムは、前記作業地を外周領域と前記外周領域の内側である作業対象領域とに設定する領域設定部と、前記作業車の位置を算出する作業車位置算出部と、前記作業対象領域を網羅する走行経路を構成する多数の走行経路要素の集合体である走行経路要素群と、前記外周領域を周回する周回経路を構成する周回経路要素の集合体である周回経路要素群とを読み出し可能に管理する経路管理部と、状態情報に基づいて、前記作業車が次に走行すべき次走行経路要素を前記走行経路要素群から、または次に走行すべき次周回経路要素を前記周回経路要素群から順次選択する経路要素選択部と、前記次走行経路要素と前記作業車の位置とに基づいて自動走行を実行する自動走行制御部とを備えている。さらに、前記経路要素選択部は、前記複数の作業車によって前記作業対象領域を協調的に作業走行する際に採用される協調経路要素選択ルールと、前記作業車の内の1台が単独作業車として前記作業対象領域を単独作業走行するとともに、前記複数の作業車のうち前記単独作業車ではない前記作業車が前記周回経路要素に基づく周回走行を行っているか、または停車している際に採用される単独経路要素選択ルールとを備えており、前記協調経路要素選択ルールが採用された状態での前記複数の作業車による協調的な作業走行中に、前記複数の作業車の内の1台を除いた残りの作業車が作業走行を離脱した場合、当該1台である前記単独作業車に前記単独経路要素選択ルールが適用される。 The work vehicle automatic traveling system for a plurality of work vehicles that work and travel in a coordinated manner while exchanging data has an area setting in which the work area is set as an outer peripheral area and a work target area inside the outer peripheral area. A unit, a work vehicle position calculation unit that calculates the position of the work vehicle, a travel route element group that is an aggregate of a large number of travel route elements that constitute a travel route that covers the work target area, and the outer peripheral region. A route management unit that readablely manages an orbiting route element group that is an aggregate of orbiting route elements constituting an orbiting route, and a next traveling route element that the work vehicle should travel next based on state information. Is automatically selected from the traveling route element group or the next circuit route element to be traveled next from the circuit route element group, and automatically based on the position of the next traveling route element and the work vehicle. It is equipped with an automatic driving control unit that executes driving. Further, the route element selection unit includes a cooperative route element selection rule adopted when the plurality of work vehicles cooperatively work and travel in the work target area, and one of the work vehicles is a single work vehicle. This is adopted when the work vehicle, which is not the single work vehicle among the plurality of work vehicles, is performing orbiting based on the orbital route element, or is stopped, while traveling independently in the work target area. It is provided with a single route element selection rule to be performed, and one of the plurality of work vehicles is being operated in a coordinated manner by the plurality of work vehicles in a state where the cooperative route element selection rule is adopted. When the remaining work vehicle excluding the above is withdrawn from the work run, the single route element selection rule is applied to the single work vehicle, which is the single work vehicle .
この構成によれば、まずは、作業対象領域を網羅する走行経路を作り出す多数の走行経路要素と、外周領域を周回する周回経路を作り出す周回経路要素とが算出される。協調経路要素選択ルールでは、複数の作業車によって作業対象領域が協調的に作業走行されるように、走行経路要素が選択される。単独経路要素選択ルールでは、単独作業車によって作業対象領域が単独作業走行されるように走行経路要素が選択される。協調経路要素選択ルールに基づいて、例えば2台の作業車による作業走行が行われている途中で、一方の作業車が作業走行を離脱すると、他方の作業車が単独で作業対象領域を作業走行しなければならないことになる。この場合には、協調経路要素選択ルールから単独経路要素選択ルールに切り換わり、単独作業走行している作業車の走行経路要素の選択に、単独経路要素選択ルールが適用される。これにより、単独作業走行している作業車は、作業走行を離脱した作業車の分も含めて作業対象領域を作業走行するので、未作業領域を残すことなく、作業対象領域に対する作業が完了する。 According to this configuration, first, a large number of traveling path elements that create a traveling path that covers the work target area and a circular path element that creates an orbiting path that orbits the outer peripheral region are calculated. In the cooperative route element selection rule, the travel route element is selected so that the work target area is cooperatively traveled by a plurality of work vehicles. In the single route element selection rule, the travel route element is selected so that the work target area is independently traveled by the single work vehicle. Based on the cooperative route element selection rule, for example, if one work vehicle leaves the work vehicle while the work vehicle is being driven by two work vehicles, the other work vehicle independently travels in the work target area. You will have to do it. In this case, the cooperative route element selection rule is switched to the single route element selection rule, and the single route element selection rule is applied to the selection of the travel route element of the work vehicle traveling independently. As a result, the work vehicle that is traveling independently travels in the work target area including the work vehicle that has left the work travel, so that the work on the work target area is completed without leaving an unworked area. ..
作業対象領域を網羅する走行経路を作り出す走行経路要素群には、メッシュ線群と平行線群とがある。メッシュ線群は、作業対象領域をメッシュ分割するメッシュ線からなる集合体であり、メッシュ線同士の交点が、作業車の経路変更を許す経路変更可能点として設定される。平行線群は、作業対象領域を短冊状に分割する互いに平行な平行線からなる集合体であり、外周領域におけるUターン走行により、1つの走行経路要素の一端から他の走行経路要素の一端への移行が実行される。メッシュ線群と平行線群とによって、協調経路要素選択ルールと協調経路要素選択ルールとにおける経路選択の仕方が異なる。メッシュ線群と協調経路要素選択ルールとの組み合わせでは、作業車による複数の渦巻き状走行軌跡によって作り出される多重渦巻き状走行軌跡が作業対象領域を網羅するように、次走行経路要素が選択される。また、メッシュ線群と単独経路要素選択ルールとの組み合わせでは、単独作業車による渦巻き状走行軌跡が作業対象領域を網羅するように、次走行経路要素が選択される。これにより、複数台の作業による作業走行から単独の作業車による作業走行に移行しても、未作業領域を残すことなく、スムーズに作業対象領域に対する作業が行われる。 There are a mesh line group and a parallel line group in the travel path element group that creates a travel path that covers the work target area. The mesh line group is an aggregate consisting of mesh lines that divide the work target area into meshes, and the intersections of the mesh lines are set as route changeable points that allow the route change of the work vehicle. The parallel line group is an aggregate consisting of parallel lines parallel to each other that divides the work target area into strips, and by U-turn traveling in the outer peripheral region, from one end of one traveling path element to one end of another traveling path element. Migration is performed. The method of route selection in the cooperative path element selection rule and the cooperative path element selection rule differs depending on the mesh line group and the parallel line group. In the combination of the mesh line group and the cooperative path element selection rule, the next travel path element is selected so that the multiple spiral travel loci created by the plurality of spiral travel loci by the work vehicle cover the work target area. Further, in the combination of the mesh line group and the single route element selection rule, the next travel route element is selected so that the spiral travel locus by the single work vehicle covers the work target area. As a result, even if the work running by a plurality of units is changed to the work running by a single work vehicle, the work on the work target area is smoothly performed without leaving an unworked area.
また、平行線群と協調経路要素選択ルールとの組み合わせでは、任意の作業車が外周領域に停車した場合、停車した作業車の位置によっては、他の作業車のUターン走行の障害となる。このことを考慮して、平行線群と協調経路要素選択ルールとの組み合わせでは、複数の作業車のうちの1台の作業車が位置している走行経路要素及び当該走行経路要素に隣接する走行経路要素は、その他の作業車のための次走行経路要素としての選択対象から外される。また、平行線群と単独経路要素選択ルールとの組み合わせでは、複数の作業車のうち単独作業車ではない作業車であって且つ外周領域に位置している作業車に向かう走行経路要素は、次走行経路要素としての選択対象から外される。これにより、協調作業走行している複数の作業車の内の1台が他の作業車のUターン走行の障害となる外周領域の位置に停車していても、例外処理的に走行経路要素の選択を変更することで、待ち時間の少ない作業走行が実現する。 Further, in the combination of the parallel line group and the cooperative route element selection rule, when an arbitrary work vehicle is stopped in the outer peripheral region, the U-turn running of another work vehicle may be hindered depending on the position of the stopped work vehicle. In consideration of this, in the combination of the parallel line group and the cooperative route element selection rule, the travel route element in which one work vehicle of the plurality of work vehicles is located and the travel adjacent to the travel route element. The route element is excluded from the selection as the next travel route element for other work vehicles. Further, in the combination of the parallel line group and the single route element selection rule, the traveling route element toward the work vehicle that is not the single work vehicle and is located in the outer peripheral region among the plurality of work vehicles is as follows. It is excluded from the selection target as a travel route element. As a result, even if one of the plurality of work vehicles traveling in cooperative work is stopped at a position in the outer peripheral region that hinders the U-turn running of the other work vehicle, the travel route element is exceptionally handled. By changing the selection, work running with less waiting time is realized.
〔自動走行の概要〕
図1には、作業車自動走行システムにおける作業車の作業走行が模式的に示されている。この実施形態では、作業車は、作業走行として、走行しながら農作物を収穫する収穫作業(刈取作業)を行う収穫機1であり、一般に普通型コンバインと呼ばれている機種である。収穫機1によって作業走行される作業地は圃場と呼ばれる。圃場における収穫作業では、収穫機1が畦と呼ばれる圃場の境界線に沿って作業を行いながら周回走行した領域が外周領域SAとして設定される。外周領域SAの内側は作業対象領域CAとして設定される。外周領域SAは、収穫機1が収穫物の排出や燃料補給のための移動用スペース及び方向転換用スペース等として利用される。外周領域SAの確保のため、収穫機1は、最初の作業走行として、圃場の境界線に沿って3~4周の周回走行を行う。周回走行では、一周毎に収穫機1の作業幅分だけ、圃場が作業されることになるので、外周領域SAは収穫機1の作業幅の3~4倍程度の幅を有する。このことから、特別に注記しない限り、外周領域SAは既刈地(既作業地)として扱われ、作業対象領域CAは未刈地(未作業地)として扱われる。なお、この実施形態では、作業幅は、刈取り幅にオーバーラップ量を減算した値として取り扱われる。しかしながら、作業幅の概念は、作業車の種類によって異なる。本発明での作業幅は、作業車の種類や作業種類によって規定されるものである。
[Overview of autonomous driving]
FIG. 1 schematically shows the work running of the work vehicle in the work vehicle automatic running system. In this embodiment, the work vehicle is a
なお、この出願で用いられている「作業走行」という語句は、実際に作業を行いながら走行していることだけでなく、作業時における方向転換のための作業を行わない走行なども含めた広義の意味で用いられている。
さらに、本明細書では、作業車の作業環境という語句には、作業車の状態、作業地の状態、人(監視者、運転者、管理者など)による指令なども含めることができ、この作業環境を評価することで状態情報が求められる。この状態情報には、燃料補給や収穫物の排出などの機械的要因や天候の変動や作業地状態などの環境的要因、さらには、不測の作業中断指令などの人的要求が含まれる。また、複数台の作業車が協調しながら作業走行する場合には、他車の状態情報が、他車の作業走行状態として取り扱われ、自車と他車との位置関係を示す他車位置関係等も、他車の作業走行状態に含まれる。なお、監視者や管理者は、作業車に乗り込んでいてもよいし、作業車の近くに、あるいは作業車から遠く離れていてもよい。
The term "working run" used in this application is broadly defined to include not only running while actually performing work, but also running without performing work for changing direction during work. It is used in the meaning of.
Further, in the present specification, the term work environment of the work vehicle may include the state of the work vehicle, the state of the work place, a command by a person (observer, driver, manager, etc.), and this work. Status information is required by evaluating the environment. This status information includes mechanical factors such as refueling and harvest discharge, environmental factors such as weather fluctuations and work site conditions, and human demands such as unforeseen work interruption orders. In addition, when a plurality of work vehicles work in cooperation with each other, the state information of the other vehicle is treated as the work running state of the other vehicle, and the positional relationship between the own vehicle and the other vehicle is shown. Etc. are also included in the working running state of other vehicles. The observer or the manager may be in the work vehicle, near the work vehicle, or far away from the work vehicle.
収穫機1は、GPS(グローバル・ポジショニング・システム)で用いられる人工衛星GSからのGPS信号に基づいて測位データを出力する衛星測位モジュール80を備えており、収穫機1は、測位データから、収穫機1の特定箇所の位置座標である自車位置を算出する機能を有する。収穫機1は、算出された自車位置を目標となる走行経路に合わせるように操縦することで走行収穫作業を自動化する自動走行機能を有している。収穫機1は、走行しながら収穫した収穫物を排出するために、畦際に駐車している運搬車CVの周辺に接近して、駐車する必要がある。運搬車CVの駐車位置が予め決められている場合には、このような接近走行、つまり作業対象領域CAにおける作業走行からの一時的な離脱、及び作業走行への復帰も自動走行で行うことも可能である。この作業対象領域CAからの離脱及び作業対象領域CAへの復帰のための走行経路は、外周領域SAが設定された時点で生成される。なお、運搬車CVの代わりに燃料補給車やその他の作業支援車も駐車可能である。
The
〔作業車自動走行システムの基本的な流れ〕
本発明の作業車自動走行システムに組み込まれた収穫機1が、収穫作業を自動走行で行うためには、走行の目標となる走行経路を生成し、その走行経路を管理する走行経路管理装置が必要となる。この走行経路管理装置の基本的な構成と、この走行経路管理装置を用いた自動走行制御の基本的な流れとを、図2を用いて説明する。
[Basic flow of work vehicle automatic driving system]
In order for the
圃場に到着した収穫機1は、圃場の境界線の内側に沿って周回しながら収穫を行う。この作業は周囲刈りと呼ばれ、収穫作業ではよく知られた作業である。その際、コーナ領域では、未刈穀稈が残らないように前進と後進とを繰り返す走行が行われる。本形態では、少なくとも最外周一周は、刈り残しがないように、かつ、畦にぶつからないように、手動走行によって行われる。内周側の残りの数周は、周囲刈り専用の自動走行プログラムによって自動走行しても良く、また、最外周の周囲刈りに引き続いて手動走行によって行っても良い。このような周回走行の走行軌跡内側に残される作業対象領域CAの形状としては、自動走行による作業走行にとって都合が良いように、できるだけ簡単な多角形、好ましくは四角形が採用される。この内側の周囲刈りによって得られる走行軌跡の位置データに基づいて、外周領域SAを周回するための周回経路要素が作成される。
The
さらに、この周回走行の走行軌跡は、自車位置算出部53(本発明に係る「作業車位置算出部」に相当)が衛星測位モジュール80の測位データから算出した自車位置に基づいて得ることができる。さらに、この走行軌跡から圃場の外形データ、特に周回走行の走行軌跡内側に位置する未刈地である作業対象領域CAの外形データが、外形データ生成部43によって生成される。圃場は、領域設定部44により外周領域SAと作業対象領域CAとに分けて管理される。
Further, the traveling locus of this orbiting travel is obtained based on the own vehicle position calculated from the positioning data of the
作業対象領域CAに対する作業走行は、自動走行によって実施される。このため、作業対象領域CAを網羅する走行(作業幅で埋め尽くす走行)のための走行経路である走行経路要素群が経路管理部60によって管理される。この走行経路要素群は、多数の走行経路要素の集合体である。経路管理部60は、作業対象領域CAの外形データに基づいて走行経路要素群を算出し、読み出し可能にメモリに格納しておく。
The work run for the work target area CA is carried out by automatic run. Therefore, the
この作業車自動走行システムでは、作業対象領域CAでの作業走行の前に、予め全走行経路が決定されているのではなく、走行途中で、作業車の作業環境等の事情に応じて走行経路の変更が可能である。このため、収穫機1の状態、作業地の状態、監視者の指令などを評価して求められる状態情報を出力する作業状態評価部55が備えられている。なお、走行経路の変更が可能な点(ノード)と点(ノード)の間の最小単位(リンク)が走行経路要素である。指定された場所から自動走行が開始されると、次に走行すべき次走行経路要素が、順次、経路要素選択部63によって、走行経路要素群から選択される。
自動走行制御部511は、選択された走行経路要素と自車位置とに基づいて、車体が当該走行経路要素に沿うように自動走行データを生成して、自動走行を実行する。
In this work vehicle automatic traveling system, the entire traveling route is not determined in advance before the work traveling in the work target area CA, but the traveling route is determined according to the work environment of the work vehicle during the traveling. Can be changed. Therefore, the work
Based on the selected travel path element and the position of the own vehicle, the automatic
図2では、外形データ生成部43と、領域設定部44と、経路管理部60とによって、収穫機1のための走行経路を生成する走行経路生成装置が構築されている。また、自車位置算出部53、領域設定部44と、経路管理部60と、経路要素選択部63とによって、収穫機1のための走行経路を決定する走行経路決定装置が構築されている。このような走行経路生成装置や走行経路決定装置は、従来の自動走行可能な収穫機1の制御系に組み込むことが可能である。あるいは、走行経路生成装置や走行経路決定装置をコンピュータ端末に構築し、当該コンピュータ端末と収穫機1の制御系とをデータ交換可能に接続して、自動走行を実現することも可能である。
In FIG. 2, a traveling route generation device for generating a traveling route for the
協調的に作業走行する複数台の収穫機1が、この作業車自動走行システムに組み込まれる場合、収穫機1同士の位置関係を算出する他車位置関係算出部56が備えられる。他車位置関係算出部56は、一方の収穫機1の位置(自車位置)、他方の収穫機1の位置(他車位置)、一方の収穫機1の進行方向、他方の収穫機1の進行方向などを含む他車位置関係を算出する。この他車位置関係は、収穫機1の作業走行状態を表すデータの1つである。この作業走行状態は、収穫機1の状態、作業地の状態、監視者の指令などを評価することで、作業状態評価部55から出力される状態情報のことである。図2に示すように、他車位置関係算出部56によって算出された他車位置関係は作業状態評価部55に送られる。複数台の収穫機が協調的に作業走行する際には、作業状態評価部55は、他車の作業走行状態を経路要素選択部63に送る。
When a plurality of
〔走行経路要素群の概要〕
走行経路要素群の一例として、図3には、作業対象領域CAを短冊状に分割する多数の平行分割直線を走行経路要素とする走行経路要素群が示されている。この走行経路要素群は2つのノード(両端点であって、ここで経路変更可能である経路変更可能点と称する)を1本のリンクで連結した直線状の走行経路要素を平行に並べたものである。走行経路要素は、作業幅のオーバーラップ量を調整することにより、等間隔を開けて並ぶように設定される。1つの直線で示される走行経路要素の端点から他の直線で示される走行経路要素の端点への移行には、Uターン走行(例えば180°の方向転換走行)が行われる。このような平行な走行経路要素をUターン走行によって繋ぎながら自動走行することを、以降は、『直線往復走行』と称する。このUターン走行には、ノーマルUターン走行と、スイッチバックターン走行とが含まれる。ノーマルUターン走行は、収穫機1の前進だけで行われ、その走行軌跡はU字状となる。スイッチバックターン走行は、収穫機1の前進と後進とを用いて行われ、その走行軌跡はU字状とはならないが、結果的には、収穫機1はノーマルUターン走行と同じ方向転換走行が得られる。ノーマルUターン走行を行うためには、方向転換走行前の経路変更可能点と方向転換走行後の経路変更可能点との間に2本以上の走行経路要素を挟む距離が必要となる。それより短い距離では、スイッチバックターン走行が用いられる。つまり、スイッチバックターン走行は、ノーマルUターン走行と異なって後進を行うため、収穫機1の旋回半径の影響がなく、移行する走行経路要素の選択肢が多い。しかし、スイッチバックターン走行では前後進の切替えが行われるため、スイッチバックターン走行は、基本的には、ノーマルUターン走行と比べて時間がかかる。
[Overview of travel route elements]
As an example of the travel path element group, FIG. 3 shows a travel path element group in which a large number of parallel division straight lines for dividing the work target area CA into strips are used as travel path elements. This travel route element group is a series of linear travel route elements in which two nodes (points at both ends, which are referred to here as route changeable points) connected by a single link are arranged in parallel. Is. The travel path elements are set to be lined up at equal intervals by adjusting the overlap amount of the working widths. A U-turn run (eg, 180 ° turnover run) is performed to transition from the endpoint of the travel path element represented by one straight line to the endpoint of the travel path element represented by the other straight line. The automatic traveling while connecting such parallel traveling path elements by U-turn traveling is hereinafter referred to as "straight reciprocating traveling". This U-turn running includes normal U-turn running and switchback turn running. The normal U-turn running is performed only by advancing the
走行経路要素群の他の例として、図4には、作業対象領域CAをメッシュ分割する、縦横方向に延びた多数のメッシュ直線(本発明に係る「メッシュ線」に相当)からなる走行経路要素群が示されている。メッシュ直線同士の交点(経路変更可能点)及びメッシュ直線の両端点(経路変更可能点)において、経路変更が可能である。つまり、この走行経路要素群は、メッシュ直線の交点及び端点をノードとし、メッシュ直線によって区画された各メッシュの辺がリンクとして機能する経路網を構築し、自由度の高い走行を可能にする。上述した直線往復走行だけでなく、例えば、図4に示すような外から内に向かう『渦巻き走行』や、『ジグザグ走行』も可能であり、さらに、作業途中において、渦巻き走行から直線往復走行に変更することも可能である。なお、外周領域SAを周回するための走行経路を作り出すのが、周回経路要素の集合体である周回経路要素群である。 As another example of the travel path element group, FIG. 4 shows a travel path element composed of a large number of mesh straight lines extending in the vertical and horizontal directions (corresponding to the “mesh line” according to the present invention) that divides the work target area CA into a mesh. The group is shown. The route can be changed at the intersections of the mesh straight lines (route changeable points) and at both end points of the mesh straight lines (route changeable points). That is, this travel route element group constructs a route network in which the intersections and endpoints of the mesh straight lines serve as nodes and the sides of each mesh partitioned by the mesh straight lines function as links, enabling highly flexible travel. In addition to the above-mentioned straight reciprocating travel, for example, "swirl traveling" and "zigzag traveling" from the outside to the inside as shown in FIG. 4 are possible, and further, from swirling traveling to straight reciprocating traveling during work. It is also possible to change it. It is the orbital path element group, which is an aggregate of the orbital path elements, that creates the traveling path for orbiting the outer peripheral region SA.
〔走行経路要素を選択する際の考え方〕
経路要素選択部63が、順次、次に走行すべき走行経路要素である次走行経路要素を選択する際の選択ルールは、作業走行の前に予め設定される静的ルールと、作業走行中にリアルタイムで利用される動的ルールとに分けることができる。静的ルールには、予め決められた基本的な走行パターンに基づいて走行経路要素を選択すること、例えば、図3に示すようなUターン走行を行いながら直線往復走行を実現するように走行経路要素を選択するルールや、図4に示すような外から内に向かう反時計回りの渦巻き走行を実現するように走行経路要素を選択するルールなどが含まれる。動的ルールは、原則、静的ルールに優先して用いられる。動的ルールには、時々刻々と変化するリアルタイムでの収穫機1の状態、作業地の状態、監視者(運転者や管理者も含む)の指令などの状態情報の内容が含まれる。作業状態評価部55は、入力パラメータとして種々の一次情報(作業環境)や、収穫機1の状態、作業地の状態、監視者の指令などを取り込み、状態情報を出力する。なお、この一次情報には、収穫機1に設けられている各種センサやスイッチからの信号だけでなく、天候情報や時刻情報や乾燥施設などの外部施設情報なども含まれている。さらに、複数台の収穫機1で協調作業を行う場合には、作業状態評価部55から出力される状態情報には、他車位置関係算出部56によって算出される他車位置関係も含まれる。そして、この状態情報が、他車の作業走行状態として用いられる。
[Concept when selecting travel route elements]
The selection rule when the route
さらに、経路要素選択部63は、複数の収穫機1によって作業対象領域CAを協調的に作業走行する際に採用される協調経路要素選択ルールと、単独の収穫機1が作業対象領域CAを単独作業走行する際に採用される単独経路要素選択ルールとを備えている。単独の収穫機1が作業対象領域CAを単独作業走行するともに、自車以外の収穫機1が周回経路要素に基づく周回走行を行っているか、または停車している場合には、単独の収穫機1の経路要素選択部63は、単独経路要素選択ルールに基づいて前次走行経路要素を選択する。
Further, the route
〔収穫機の概要〕
図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には、衛星航法を補完するために、ジャイロ加速度センサや磁気方位センサを組み込んだ慣性航法モジュールを含めることができる。
[Overview of harvester]
FIG. 5 is a side view of the
図5では、収穫機1の動きを監視する監視者(運転者や管理者も含む)が当該収穫機1に搭乗し、かつ、監視者が操作する通信端末4が収穫機1に持ち込まれている。ただし、通信端末4は収穫機1に取り付けられている構成であってもよい。さらに、監視者及び通信端末4は、収穫機1の機外に存在していてもよい。
In FIG. 5, a monitor (including a driver and a manager) who monitors the movement of the
収穫機1は、自動操舵による自動走行と、手動操舵による手動走行とが可能である。また、自動走行としては、従来のように予め全走行経路を決めて走行する自動走行と、状態情報に基づいてリアルタイムに次の走行経路を決めていく自動走行と、が可能である。本出願においては、予め全走行経路を決めて走行する前者を慣行走行と称するとともに、リアルタイムに次の走行経路を決めていく後者を自動走行と称して、両者を別物として取り扱う。慣行走行の経路は、例えば、予めいくつかのパターンを登録するか、あるいは、通信端末4等において監視者が任意に設定できるように構成する。
The
〔自動走行の機能制御ブロックについて〕
図6には、この収穫機1に構築されている制御系と、通信端末4の制御系とが示されている。この実施形態では、収穫機1のための走行経路を管理する走行経路管理装置は、通信端末4に構築された第1走行経路管理モジュールCM1と、収穫機1の制御ユニット5に構築された第2走行経路管理モジュールCM2とから構成されている。
[About the function control block for automatic driving]
FIG. 6 shows the control system constructed in the
通信端末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に送信可能である。
The
作業地情報格納部101には、圃場周辺の地形図や圃場の属性情報(圃場の出入口、条方向等)などを含む圃場情報が格納されている。管理コンピュータ100の作業計画管理部102では、指定された圃場での作業内容を記述した作業計画書が管理されている。監視者の操作を通じて、あるいは自動的に実行されるプログラムを通じて、圃場情報及び作業計画書は、通信端末4や収穫機1の制御ユニット5にダウンロード可能である。作業計画書には、作業対象となる圃場における作業に関して、各種の情報(作業条件)が含まれている。この情報(作業条件)としては、例えば、以下のものが挙げられる。
(a)走行パターン(直線往復走行、渦巻き走行、ジグザグ走行等)
(b)運搬車CV等の支援車の駐車位置や収穫物排出等のための収穫機の駐車位置
(c)作業形態(一台の収穫機1による作業、複数台の収穫機1による作業)
(d)いわゆる中割ライン
(e)収穫対象となる作物種(稲(ジャポニカ米、インディカ米)、麦、大豆、菜種、そば等)に応じた車速や脱穀装置13の回転速度の値等。
特に(e)の情報から、作物種に応じた走行機器パラメータの設定や収穫機器パラメータの設定が自動的に実行されるので、設定ミスが回避される。
The work site
(A) Running pattern (straight reciprocating running, swirl running, zigzag running, etc.)
(B) Parking position of support vehicle such as carrier CV and parking position of harvester for discharging harvested material (c) Work mode (work by one
(D) So-called middle split line (e) The value of the vehicle speed and the rotation speed of the threshing
In particular, from the information in (e), the setting of the traveling equipment parameter and the setting of the harvesting equipment parameter according to the crop species are automatically executed, so that the setting error is avoided.
なお、収穫物を運搬車CVに排出するために収穫機1が駐車する位置が収穫物排出用駐車位置であり、燃料補給車から燃料を補給するために収穫機1が駐車する位置が燃料補給用駐車位置であり、この実施形態では、実質的に同じ位置に設定される。
The position where the
上記の情報(a)-(e)は、ユーザー・インターフェイスとしての通信端末4を通じて監視者が入力する形態であっても良い。通信端末4には、自動走行の開始や停止を指示する入力機能や、上述したように、自動走行と慣行走行とのいずれで作業走行するかの入力機能や、走行変速装置等の車両走行機器群71や収穫部15等の作業装置機器群72(図6参照)に対するパラメータの値を微調整する入力機能等も構築されている。作業装置機器群72のパラメータのうち、値が微調整できるものとしては、リール17の高さや、収穫部15の高さ等が挙げられる。
The above information (a)-(e) may be input by the observer through the
通信端末4は、人為的な切り替え操作により、自動走行経路や慣行走行経路のアニメーション表示状態、上記パラメータ表示/微調整状態等に切り替え可能である。なお、このアニメーション表示とは、予め全走行経路が決められている慣行走行における走行経路である自動走行経路や慣行走行経路に沿って走行する収穫機1の走行軌跡をアニメーション化して、タッチパネル41の表示パネル部に表示することである。このようなアニメーション表示により、運転者は、走行前に、これから走行する走行経路を直感的に確認することができる。
The
作業地データ入力部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に送られる。
The work site
圃場が大きい場合には、中割りと呼ばれる、中央突破の走行経路で圃場を複数の区画に区分けする中割り領域を作り出す作業が行われる。この中割り位置指定も、タッチパネル41の画面に表示された作業地の外形図に対するタッチ操作で行うことができる。もちろん、中割りの位置設定は、自動走行のための走行経路要素群の生成にも影響するので、走行経路要素群の生成時に自動的に行ってもよい。その際、中割り領域の延長線上に運搬車CVなどの作業支援車の支援を受けるための収穫機1の駐車位置が配置されると、全区画からの収穫物排出の走行が効率的に行われる。
When the field is large, a work called middle division is performed to create a middle division area that divides the field into a plurality of sections by a traveling route that breaks through the center. This middle division position designation can also be performed by touching the outline drawing of the work area displayed on the screen of the
第2走行経路管理モジュールCM2には、経路管理部60と、経路要素選択部63と、経路設定部64とが備えられている。経路管理部60は、走行経路要素群及び周回経路要素群を算出して、読み出し可能に格納する。走行経路要素群は、作業対象領域CAを網羅する走行経路を構成する多数の走行経路要素の集合体である。周回経路要素群は、外周領域SAを周回する周回経路を構成する周回経路要素の集合体である。走行経路要素群を算出する機能部として、この経路管理部60には、メッシュ経路要素算出部601と短冊経路要素算出部602とUターン経路算出部603とが含まれている。経路要素選択部63は、後で詳しく説明する種々の選択ルールに基づいて、次に走行すべき次走行経路要素を順次前記走行経路要素群から選択する。経路設定部64は、選択された次走行経路要素を、自動走行のための目標走行経路として設定する。
The second travel route management module CM2 includes a
メッシュ経路要素算出部601は、走行経路要素として、作業対象領域CAをメッシュ分割するメッシュ直線からなるメッシュ直線群(本発明に係る「メッシュ線群」に相当)である走行経路要素群を算出し、そのメッシュ直線同士の交点及び端点の位置座標も算出することができる。この走行経路要素が収穫機1の自動走行時の目標走行経路となるので、収穫機1はメッシュ直線同士の交点及び端点で、一方の走行経路要素から他方の走行経路要素へ経路変更することが可能である。つまり、メッシュ直線同士の交点及び端点が収穫機1の経路変更を許す経路変更可能点として機能する。
The mesh route
図7に、走行経路要素群の一例であるメッシュ直線群の作業対象領域CAへの配置の概略が示されている。メッシュ経路要素算出部601によって、収穫機1の作業幅をメッシュ間隔として、作業対象領域CAをメッシュ直線で埋め尽くすように走行経路要素群が算出される。作業対象領域CAは、上述したように、圃場の境界から内側に向かって作業幅で3~4周の周回走行によって形成された外周領域SAの内側の領域であるため、基本的には、作業対象領域CAの外形は、圃場の外形と相似することになる。しかし、メッシュ直線の算出を容易にするため、作業対象領域CAがほぼ多角形、好ましくはほぼ四角形になるように、外周領域SAを作り出す場合もある。図7では、作業対象領域CAの形状は、第1辺S1と第2辺S2と第3辺S3と第4辺S4とからなる変形四角形である。
FIG. 7 shows an outline of the arrangement of the mesh straight line group, which is an example of the traveling path element group, in the work target area CA. The mesh path
メッシュ経路要素算出部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点の位置座標で規定される直線としてデータ化され、予め定められたデータフォーマットでメモリに格納される。このデータフォーマットには、各走行経路要素を識別するための経路識別子としての経路番号のほか、各走行経路要素の属性値として、経路種、基準となった外形四角形の辺、未走行/既走行などが含まれている。
As shown in FIG. 7, the mesh path
もちろん、四角形以外の多角形の作業対象領域CAにおいても、上述した直線群の算出を適用することができる。すなわち、作業対象領域CAがNを3以上の整数とした際のN角形状とすると、走行経路要素群は、第1直線群から第N直線群までのN個の直線群からなる。各直線群は、このN角形のいずれかの辺に平行に所定間隔(作業幅)で並んだ直線を含むことになる。 Of course, the above-mentioned calculation of the straight line group can also be applied to the work target area CA of a polygon other than the quadrangle. That is, assuming that the work target area CA has an N-angle shape when N is an integer of 3 or more, the traveling path element group consists of N straight line groups from the first straight line group to the Nth straight line group. Each straight line group includes straight lines arranged in parallel with any side of this N-sided polygon at predetermined intervals (working width).
なお、外周領域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ターン走行が実行される場合には、中間直進経路は、未刈地の外周ラインの位置に応じて、内周側へ平行移動される。
A traveling route element group is also set in the outer peripheral region SA by the
図7では、作業対象領域CAの形状を変形四角形としたので、メッシュ経路要素群の生成の基準となる辺が、4つあったが、作業対象領域CAの形状が長方形または正方形であれば、メッシュ経路要素群の生成の基準となる辺が、2つとなり、メッシュ経路要素群の構造はより簡単となる。 In FIG. 7, since the shape of the work target area CA is a deformed quadrangle, there are four sides that serve as a reference for generating the mesh path element group, but if the shape of the work target area CA is a rectangle or a square, The number of sides that serve as a reference for the generation of the mesh path element group becomes two, and the structure of the mesh path element group becomes simpler.
この実施形態では、経路管理部60に、オプションの走行経路要素算出部として短冊経路要素算出部602が備えられている。この短冊経路要素算出部602によって算出される走行経路要素群は、図3に示されているように、作業対象領域CAの外形を構成する辺から選ばれた基準辺、例えば最長辺に平行に延びるとともに、作業幅で作業対象領域CAを網羅する(作業幅で埋め尽くす)平行直線群(本発明に係る「平行線群」に相当)である。短冊経路要素算出部602で算出された走行経路要素群は、作業対象領域CAを短冊状に分割する。さらに、走行経路要素群は、収穫機1がUターン走行するためのUターン走行経路によって順次接続されていく平行直線(本発明に係る「平行線」に相当)の集合体である。つまり、平行直線である1つの走行経路要素の走行が終了すれば、次に選択された走行経路要素への移行ためのUターン走行経路がUターン経路算出部603によって決定される。
In this embodiment, the
Uターン経路算出部603は、短冊経路要素算出部602によって算出される走行経路要素群から選択された2つの走行経路要素をUターン走行で接続するためのUターン走行経路を算出する。Uターン経路算出部603は、外周領域SA等が設定されたら、外周領域SAの外形状及び外形寸法と作業対象領域CAの外形状及び外形寸法と収穫機1の旋回半径等に基づいて、外周領域SAのうち、作業対象領域CAの外周の各辺(外辺)に対応する領域毎に、作業対象領域CAの外辺に平行な一つの中間直進経路を算出し、かつ、ノーマルUターン走行及びスイッチバックターン走行が行われるに際して、現在走行している走行経路要素と対応する中間直進経路とを結ぶ開始側の旋回経路と、対応する中間直進経路と移行する走行経路要素とを結ぶ終了側の旋回経路と、を算出する。なお、Uターン走行経路の生成原理については後述する。
The U-turn
図6に示すように、第2走行経路管理モジュールCM2を構築している収穫機1の制御ユニット5には、作業走行を行うために、種々の機能が構築されている。制御ユニット5はコンピュータシステムとして構成されており、入出力インタフェースとして、出力処理部7、入力処理部8、通信処理部70が備えられている。出力処理部7は、収穫機1に装備されている車両走行機器群71、作業装置機器群72、報知デバイス73などと接続している。車両走行機器群71には、走行機体11の左右のクローラの速度を調整して操舵を行う操舵機器をはじめ、図示されていないが変速機構やエンジンユニットなど車両走行のために制御される機器が含まれている。作業装置機器群72には、収穫部15、脱穀装置13、排出装置18などを構成する機器が含まれている。報知デバイス73には、ディスプレイやランプやスピーカが含まれている。特に、ディスプレイには、圃場の外形とともに、走行済の走行経路(走行軌跡)やこれから走行すべき走行経路など、種々の報知情報が表示される。ランプやスピーカは、走行注意事項や自動操舵走行での目標走行経路からの外れなど、注意情報や警告情報を搭乗者(運転者や監視者)に報知するために用いられる。
As shown in FIG. 6, the
通信処理部70は、通信端末4で処理されたデータを受け取るとともに、制御ユニット5で処理されたデータの送信を行う機能を有する。これにより、通信端末4は、制御ユニット5のユーザー・インターフェイスとして機能することができる。通信処理部70は、さらに、管理コンピュータ100との間でのデータ交換を行うためにも用いられるので、種々の通信フォーマットを取り扱う機能を有する。
The
入力処理部8は、衛星測位モジュール80、走行系検出センサ群81、作業系検出センサ群82、自動/手動切替操作具83などと接続している。走行系検出センサ群81には、エンジン回転数や変速状態などの走行状態を検出するセンサが含まれている。作業系検出センサ群82には、収穫部15の高さ位置を検出するセンサや収穫物タンク14の貯留量を検出するセンサなどが含まれている。自動/手動切替操作具83は、自動操舵で走行する自動走行モードと手動操舵で走行する手動走行モードとのいずれかを選択するスイッチである。また、自動走行と慣行走行とを切替えるスイッチが、運転部12に備えられているか、あるいは、通信端末4に構築されている。
The
さらに、制御ユニット5には、走行制御部51、作業制御部52、自車位置算出部53、報知部54、作業状態評価部55、他車位置関係算出部56が備えられている。自車位置算出部53は、衛星測位モジュール80から出力される測位データに基づいて、自車位置を算出する。この収穫機1が自動走行(自動操舵)と手動走行(手動操舵)の両方で走行可能に構成されているため、車両走行機器群71を制御する走行制御部51には、自動走行制御部511と手動走行制御部512とが含まれている。手動走行制御部512は、運転者による操作に基づいて車両走行機器群71を制御する。自動走行制御部511は、経路設定部64で設定された走行経路と自車位置との間の方位ずれ及び位置ずれを算出し、自動操舵指令を生成し、出力処理部7を介して操舵機器に出力する。作業制御部52は、収穫機1を構成する収穫部15、脱穀装置13、排出装置18などに設けられている動作機器の動きを制御するために、作業装置機器群72に制御信号を与える。報知部54は、ディスプレイなどの報知デバイス73を通じて運転者や監視者に必要な情報を報知するための報知信号(表示データや音声データ)を生成する。作業状態評価部55は、各種センサの検出結果や各種操作具の操作結果などから、収穫機1の状態、作業地の状態、人(監視者、運転者、管理者など)による指令を含む状態情報を出力する。他車位置関係算出部56は、複数台の収穫機1で協調作業を行う場合に、自車と他車との位置関係を示す他車位置関係を算出する。この他車位置関係の算出には、自車の位置や自車が選択している走行経路要素、及び他車の位置や他車が選択している走行経路要素が用いられる。さらに、他車位置関係算出部56は、作業車同士の接触推定位置を算出する機能も有する。
Further, the
自動走行制御部511は、操舵制御だけではなく、車速制御も可能である。車速については、上述したように、例えば、搭乗者が、作業開始前に通信端末4を通じて設定する。設定可能な車速には、収穫走行時の車速、非作業旋回(Uターン走行など)時の車速、収穫物排出時や燃料補給時の作業対象領域CAから離脱して外周領域SAを走行する際の車速などが含まれる。自動走行制御部511は、衛星測位モジュール80によって得られた測位データに基づいて実車速を算出する。出力処理部7は、実車速が設定された車速に合うように、走行への変速操作指令等を車両走行機器群71に送る。
The automatic
〔自動走行の経路について〕
作業車自動走行システムにおける自動走行の例を、直線往復走行を行う例と、渦巻き走行を行う例とに分けて説明する。
[About the route of automatic driving]
An example of automatic running in the work vehicle automatic running system will be described separately for an example of performing straight reciprocating running and an example of performing swirling running.
まず、短冊経路要素算出部602によって算出された走行経路要素群を用いて直線往復走行する例について説明する。図8には、模式化によって、直線長さを短くした短冊で表された21本の走行経路要素からなる走行経路要素群が示されており、各走行経路要素の上側に経路番号が付与されている。作業走行開始時の収穫機1は、14番の走行経路要素に位置している。収穫機1が位置している走行経路要素と、他の走行経路要素との離間度が符号付き整数で、各経路の下側に付与されている。14番の走行経路要素に位置している収穫機1が、次の走行経路要素に移行するための優先度が、図8において、走行経路要素の下部に整数値で示されている。値が小さいほど優先度が高く、優先的に選択される。この収穫機1は、走行完了した走行経路要素から次の走行経路要素に移行する際に、図9で示すように、少なくとも2つの走行経路要素を挟んで次の走行経路要素に移行するノーマルUターン走行と、2つ以下の走行経路要素を挟んで、つまり隣接する走行経路要素へ移行することができるスイッチバックターン走行とが可能である。ノーマルUターン走行は、移行元の走行経路要素の端点から外周領域SAに入ると、約180°の方向転換を行い、移行先の走行経路要素の端点に入る。なお、移行元の走行経路要素と移行先の走行経路要素との間隔が大きい場合は、約90°の旋回の間に相応な直進が入ることになる。つまり、ノーマルUターン走行は、前進走行のみで実行される。これに対して、スイッチバックターン走行は、移行元の走行経路要素の端点から外周領域SAに入ると、一旦約90°旋回した後、約90°旋回でスムーズに移行先の走行経路要素に入れる位置まで後進してから、移行先の走行経路要素の端点に向かう。これにより、操舵制御は複雑になるが、互いの間隔が短い走行経路要素への移行も可能である。
First, an example of linear reciprocating travel using the travel route element group calculated by the strip route
次に走行すべき走行経路要素の選択は、経路要素選択部63によって行われるが、この実施形態では、基本的な選択の優先度として、順番元になる走行経路要素から所定距離だけ離れている適正離間走行経路要素を最高優先度とし、この適正離間走行経路要素に比べて順番元になる走行経路要素から離れるほど、優先度は低くなるように設定される。例えば、次の走行経路要素への移行に関しては、走行距離の短いノーマルUターン走行が走行時間も短く、効率が良い。したがって、2本あけた左右両隣りの走行経路要素の優先度が最も高く設定される(優先度=「1」)。それより収穫機1から離れるほど、ノーマルUターン走行の走行時間が長くなるので、優先度が低くなる(優先度=「2」,「3」,・・・)。つまり、優先度の数値は優先順位を示している。ただし、ノーマルUターン走行の走行時間が長くなり、スイッチバックターン走行より効率が悪くなる8本あけた隣りの走行経路要素への移行の優先度は、スイッチバックターン走行より低くなる。スイッチバックターン走行では、隣の走行経路要素へ移行する優先度より、1本あけた走行経路要素へ移行する優先度の方が高くなっている。これは隣の走行経路要素へのスイッチバックターン走行は、急旋回が必要となり、圃場を荒らす可能性が高いからである。なお、次の走行経路要素への移行は、左右いずれの方向も可能であるが、従来の作業の慣習にしたがって、左側の走行経路要素への移行が右側の走行経路要素への移行に優先するというルールが採用される。したがって、図8の例では、経路番号:14に位置する収穫機1は、次に走行する走行経路要素として、経路番号:17の走行経路要素を選択する。このような優先度の設定が、収穫機1が新しい走行経路要素に入るごとに行われる。
The next travel route element to be traveled is selected by the route
既に選択された走行経路要素、即ち、作業が完了している走行経路要素は、原則的に選択禁止とされる。したがって、図10で示すように、例えば、優先度が「1」である経路番号:11や経路番号:17が既作業地(既刈地)であれば、経路番号:14に位置する収穫機1は、次に走行する走行経路要素として、優先度が「2」である経路番号:18の走行経路要素を選択する。 The travel path element that has already been selected, that is, the travel route element for which the work has been completed, is basically prohibited from selection. Therefore, as shown in FIG. 10, for example, if the route number: 11 or the route number: 17 having the priority of "1" is an existing work area (already mowed area), the harvester located at the route number: 14. 1 selects a travel route element having a priority of "2" as a travel route element to be traveled next.
図11には、メッシュ経路要素算出部601によって算出された走行経路要素を用いて渦巻き走行する例が示されている。図11で示された圃場の外周領域SAと作業対象領域CAは図7のものと同一であり、作業対象領域CAに設定された走行経路要素群も同じである。ここでは説明のために、第1辺S1を基準線とする走行経路要素をL11、L12・・・で示し、第2辺S2を基準線とする走行経路要素をL21、L22・・・で示し、第3辺S3を基準線とする走行経路要素をL31、L32・・・で示し、第4辺S4を基準線とする走行経路要素をL41、L42・・・で示している。
FIG. 11 shows an example of spiral traveling using the traveling path element calculated by the mesh path
図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は方向転換する。
The thick line in FIG. 11 shows a traveling path that spirally travels from the outside to the inside of the
図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によって算出された走行経路要素を用いた直線往復走行にも適用可能である。
FIG. 12 shows a running example of U-turn running using the same running path element group shown in FIG. First, the travel path element L11 outside the work target area CA is selected as the first travel route. The
このように、直線往復走行は、作業対象領域CAを短冊状に分割する走行経路要素群であっても、作業対象領域CAをメッシュ状に分割する走行経路要素群であっても実現可能である。言い換えると、作業対象領域CAをメッシュ状に分割する走行経路要素群であれば、直線往復走行にも渦巻き走行にもジグザグ走行にも用いることができ、また、作業途中で走行パターンを渦巻き走行から直線往復走行に変更することも可能である。 As described above, the linear reciprocating travel can be realized by either a traveling path element group that divides the work target area CA into strips or a traveling path element group that divides the work target area CA into a mesh shape. .. In other words, if it is a travel path element group that divides the work target area CA into a mesh shape, it can be used for straight reciprocating travel, swirl travel, and zigzag travel, and the travel pattern can be changed from swirl travel during work. It is also possible to change to straight round trip.
〔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に移行することができる。
[Principle of U-turn travel path generation]
With reference to FIG. 13, the basic principle that the U-turn
Y = r / (tan (θ / 2))
Ask for. Since the minimum turning radius is substantially determined by the specifications of the
図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を用いて説明された基本原理が適用される。
14, 15, and 16 show three specific U-turn runs. In FIG. 14, the traveling path element LS0 of the turning source and the traveling path element LS1 of the turning destination extend from the outer side of the work target area CA in an inclined state, but the same applies even if they extend vertically. Here, the U-turn traveling path in the outer peripheral region SA is an extension line of the traveling path element LS0 and the traveling path element LS1 to the outer peripheral region SA, and an intermediate straight route which is a part (line segment) of the traveling path element of the outer peripheral region SA. And two arcuate turning paths. This U-turn travel path can also be generated according to the basic principle described with reference to FIG. The intersection angle θ1 and the intersection PX1 between the intermediate straight path and the turning path element LS0, and the intersection angle θ2 and the intersection PX2 between the intermediate straight path and the turning path element LS1 are calculated. Further, the position coordinates of the contact circles PS10 and PS11 having a radius r (= turning radius of the harvester 1) in contact with the traveling path element LS0 of the turning source and the intermediate straight path, and the traveling of the intermediate straight path and the turning destination. The position coordinates of the contacts PS20 and PS21 of the tangent circle of radius r in contact with the path element LS1 are calculated. At these contacts PS10 and PS20, the
図16には、スイッチバックターン走行による旋回走行が示されており、旋回元の走行経路要素LS0から旋回先の走行経路要素LS1に移行する。このスイッチバックターン走行においては、外周領域SAの走行経路要素の一部(線分)である作業対象領域CAの外辺に平行な中間直進経路と走行経路要素LS0とに接する半径rの接円と、当該中間直進経路と走行経路要素LS1とに接する半径rの接円とが算出される。図13を用いて説明された基本原理に準じて、この2つの接円と中間直進経路との接点の位置座標、旋回元の走行経路要素LS0と接円との接点の位置座標、旋回先の走行経路要素LS1と接円との接点の位置座標が算定される。これにより、スイッチバックターン走行におけるUターン走行経路が生成される。なお、スイッチバックターン走行では、中間直進経路は収穫機1によって後進走行される。
FIG. 16 shows turning running by switchback turn running, and shifts from the running path element LS0 of the turning source to the running path element LS1 of the turning destination. In this switchback turn run, an intermediate straight path parallel to the outer side of the work target area CA, which is a part (line segment) of the run path element of the outer peripheral region SA, and a tangent circle having a radius r in contact with the run path element LS0. And the tangent circle of the radius r in contact with the intermediate straight path and the traveling path element LS1 are calculated. According to the basic principle explained with reference to FIG. 13, the position coordinates of the contact point between the two tangent circles and the intermediate straight path, the position coordinates of the contact point between the traveling path element LS0 of the turning source and the tangent circle, and the turning destination. The position coordinates of the contact point between the travel path element LS1 and the inscribed circle are calculated. As a result, a U-turn traveling path in the switchback turn traveling is generated. In the switchback turn run, the intermediate straight path is run backward by the
〔渦巻き走行における方向転換走行について〕
図17には、上述した渦巻き走行において、走行経路要素の経路変更可能点である交点での経路変更に用いられる方向転換走行の一例が示されている。以降、この方向転換走行をαターン走行と称する。このαターン走行における走行経路(αターン走行経路)は、いわゆる切り返し走行経路の一種であり、走行元の走行経路要素(図17ではLS0で示されている)と旋回先の走行経路要素(図17ではLS1で示されている)の交点から、前進での旋回経路を経て、後進での旋回経路で旋回先の走行経路要素に接する経路である。αターン走行経路は基準化されているので、走行元の走行経路要素と旋回先の走行経路要素との交差角に応じて生成されたαターン走行経路が予め登録されている。したがって、経路管理部60は、算出された交差角に基づいて適正なαターン走行経路を読み出し、経路設定部64に与える。この構成に代えて、交差角毎の自動制御プログラムを自動走行制御部511に登録しておき、経路管理部60によって算出された交差角に基づいて、自動走行制御部511が適正な自動制御プログラムを読み出すような構成を採用してもよい。
[About turning driving in swirl running]
FIG. 17 shows an example of the direction change traveling used for the route change at the intersection which is the route changeable point of the travel route element in the above-mentioned spiral travel. Hereinafter, this direction change running is referred to as α-turn running. The travel path (α-turn travel route) in this α-turn travel is a kind of so-called turn-back travel route, and is a travel route element of the travel source (indicated by LS0 in FIG. 17) and a travel route element of the turn destination (FIG. 17). In 17, it is a path that comes into contact with the traveling path element of the turning destination in the turning path in the reverse direction from the intersection point (indicated by LS1 in 17) through the turning path in the forward direction. Since the α-turn traveling route is standardized, the α-turn traveling route generated according to the intersection angle between the traveling route element of the traveling source and the traveling route element of the turning destination is registered in advance. Therefore, the
〔経路選択のルール〕
経路要素選択部63は、管理センタKSから受け取った作業計画書や通信端末4から人為的に入力された走行パターン(例えば、直線往復走行パターンや渦巻き走行パターン)と、自車位置と、作業状態評価部55から出力される状態情報とに基づいて、走行経路要素を順次選択する。即ち、設定された走行パターンのみを基準にして全走行経路を形成してしまう場合とは異なって、作業前には予測し得ない事態に対応した好適な走行経路が形成されたことになる。また、経路要素選択部63には、上述した基本的なルール以外に、以下のような経路選択ルールA1からA11が予め登録可能であり、走行パターンと状態情報とに応じて、好適な経路選択ルールが適応される。
[Rules for route selection]
The route
(A1)監視者(搭乗者)による操作により、自動走行から手動走行への移行が要求された場合、手動走行の準備が完了後、経路要素選択部63による走行経路要素の選択が停止される。そのような操作には、自動/手動切替操作具83の操作、制動操作具の操作(特に急停車操作)、操舵操作具(ステアリングレバーなど)による所定操舵角以上の操作、などが含まれる。さらに、走行系検出センサ群81に、自動走行時に搭乗することが要求される監視者の不在を検出するセンサ、例えば、座席に設けられた着座検出センサやシートベルトの着装検出センサ、が含まれている場合、このセンサからの信号に基づいて、自動走行制御を停止させることができる。つまり、監視者の不在が検知されると、自動走行制御の停止、あるいは収穫機1の走行自体が、停止される。また、操舵操作具による所定操舵角より小さな微小な操舵角の操作は、自動走行制御を停止させることなしに、走行方向の微調整だけを行うような構成を採用してもよい。
(A1) When the transition from automatic driving to manual driving is requested by the operation by the observer (passenger), the selection of the traveling route element by the route
(A2)自動走行制御部511は、圃場の外形ライン位置と測位データに基づく自車位置との関係(距離)を監視しており、外周領域SAにおける旋回時に、畦と機体との接触を回避するように自動走行を制御する。具体的には、自動走行を停止して収穫機1を停車させたり、ターン走行の形態を変更(ノーマルUターン走行からスイッチバックターン走行やαターン走行に変更)したり、その領域を通過しない走行経路設定を行ったりする。また、『旋回エリアが狭くなっています。御注意下さい。』等といった報知を行うように構成してあっても良い。
(A2) The automatic
(A3)収穫物タンク14の収穫物の貯留量が満杯または満杯近くになって、収穫物排出が必要な場合、作業状態評価部55から経路要素選択部63へ、状態情報の1つとして、排出要求(作業対象領域CAでの作業走行からの離脱要求の一種)が出される。この場合、畦際の運搬車CVへの排出作業を行うための駐車位置と自車位置とに基づいて、作業対象領域CAでの作業走行から離脱し、外周領域SAを走行して該駐車位置に向かう、適正な走行経路要素(例えば、最短経路となる走行経路要素)が、外周領域SAに設定された走行経路要素群のうち離脱経路の属性値が与えられたものと、作業対象領域CAに設定された走行経路要素群とから選択される。
(A3) When the stored amount of the harvested product in the harvested
(A4)燃料残量センサからの信号等によって算出される燃料タンクの残量値に基づいて、燃料切れの切迫が評価された場合、燃料補給要求(離脱要求の一種)が出される。この場合も、(A3)と同様に、予め設定されている燃料補給位置である駐車位置と自車位置とに基づいて、燃料補給位置への適正な走行経路要素(例えば、最短経路となる走行経路要素)が選択される。 (A4) When the urgency of running out of fuel is evaluated based on the remaining amount value of the fuel tank calculated by a signal from the fuel remaining amount sensor or the like, a refueling request (a kind of withdrawal request) is issued. In this case as well, as in (A3), an appropriate travel route element to the refueling position (for example, travel that is the shortest route) based on the parking position and the own vehicle position, which are preset refueling positions. Route element) is selected.
(A5)作業対象領域CAでの作業走行から離脱して、外周領域SAに入った場合、再び作業対象領域CAに復帰する必要がある。この作業対象領域CAへの復帰の始点となる走行経路要素として、離脱点に最も近い走行経路要素、あるいは、外周領域SAでの現在位置から最も近い走行経路要素が、外周領域SAに設定された走行経路要素群のうち復帰経路の属性値が与えられたものと、作業対象領域CAに設定された走行経路要素群とから選択される。 (A5) When the worker escapes from the work running in the work target area CA and enters the outer peripheral area SA, it is necessary to return to the work target area CA again. As the travel path element that is the starting point of returning to the work target area CA, the travel path element closest to the departure point or the travel path element closest to the current position in the outer peripheral region SA is set in the outer peripheral region SA. It is selected from the travel route element group to which the attribute value of the return route is given and the travel route element group set in the work target area CA.
(A6)収穫物排出や燃料補給のため、作業対象領域CAでの作業走行から離脱して、再び作業対象領域CAに戻る走行経路を決定する際、作業対象領域CAにおける既作業(既走行)となって走行禁止の属性が付与された走行経路要素を、走行可能な走行経路要素として復活させる。既作業の走行経路要素を選択することで所定以上の時間短縮が可能な場合には、当該走行経路要素が選択される。さらに、作業対象領域CAから離脱する際の作業対象領域CAにおける走行には後進を用いることも可能である。 (A6) Already work (already run) in the work target area CA when deciding a travel route to leave the work run in the work target area CA and return to the work target area CA again for harvesting discharge and refueling. The travel route element to which the attribute of prohibition of travel is given is revived as a travel route element that can be traveled. When it is possible to shorten the time by a predetermined time or more by selecting the travel route element of the existing work, the travel route element is selected. Further, it is also possible to use reverse movement for traveling in the work target area CA when leaving the work target area CA.
(A7)収穫物排出や燃料補給のため、作業対象領域CAでの作業走行から離脱するタイミングは、それぞれの余裕度と駐車位置までの走行時間または走行距離とから決定される。余裕度は、ここでは、収穫物排出であれば、収穫物タンク14における現状の貯留量から満杯になるまでに予測される走行時間または走行距離である。燃料補給であれば、燃料タンクにおける現状の残量から完全に燃料切れになるまでに予測される走行時間または走行距離である。例えば、自動走行中に排出用の駐車位置の近くを通過する際に、余裕度や排出作業に要する時間等に基づいて、駐車位置を通り過ぎて、満杯になってから離脱して駐車位置に戻ってくる場合と、駐車位置の近くを通るついでに排出も行う場合とで、いずれが、最終的に効率的な走行であるか(総作業時間が短いとか総走行距離が短いとか)を判定する。あまりにも少ない量のときに排出作業を行うと、全体として排出回数が増えてしまい、効率的ではないし、ほぼ満杯なのであれば、ついでに排出してしまう方が効率的である。
(A7) The timing of withdrawal from the work running in the work target area CA for the discharge of the harvested product and the refueling is determined from the respective margins and the running time or the running distance to the parking position. Here, the margin is the travel time or mileage predicted from the current storage amount in the
(A8)図18には、作業対象領域CAから離脱後に再開される作業走行で選択される走行経路要素が、離脱前の作業走行の続きではないケースが示されている。このケースでは、図3、図12で示されたような直線往復走行パターンが予め設定されている。図18では、駐車位置は符号PPで示されており、かつ、比較例として、作業対象領域CAを180°のUターン走行を伴う直線往復走行で順調に作業走行しきった場合の走行経路が点線で示されている。実際の走行軌跡は太実線で示されている。作業走行の進行に伴って、順次、直線状の走行経路要素とUターン走行経路とが選択される(ステップ#01)。 (A8) FIG. 18 shows a case where the travel path element selected in the work travel resumed after leaving the work target area CA is not a continuation of the work travel before the departure. In this case, a linear reciprocating travel pattern as shown in FIGS. 3 and 12 is preset. In FIG. 18, the parking position is indicated by the reference numeral PP, and as a comparative example, the traveling route when the work is smoothly completed in a straight reciprocating traveling with a U-turn traveling of 180 ° is a dotted line. Indicated by. The actual running locus is shown by a thick solid line. As the work travel progresses, the linear travel path element and the U-turn travel path are sequentially selected (step # 01).
作業走行の途中で(ステップ#02)、離脱要求が発生すると、作業対象領域CAから外周領域SAに進む走行経路が算出される。この地点では、現在走行中の走行経路要素に沿ってそのまま直進して外周領域SAに出る経路と、現在走行中の走行経路要素から90°旋回し、既刈地(=既走行の属性を持つ走行経路要素の集合部分)を通過して駐車位置が存在する外周領域SAに出る経路とが考えられる。ここでは、より走行距離が短い後者の経路が選択される(ステップ#03)。この後者の離脱走行では、90°旋回後の作業対象領域CAでの離脱走行経路要素として、外周領域SAに設定されている走行経路要素を離脱点まで平行移動させたものが用いられる。但し、時間的な余裕を持って離脱要求がなされるのであれば、前者の経路が選択される。この前者の離脱走行では、作業対象領域CAでの離脱走行中において、収穫作業が続行されるので、作業効率の点で利点がある。 When a withdrawal request is generated during the work run (step # 02), a run route from the work target area CA to the outer peripheral area SA is calculated. At this point, a route that goes straight along the currently traveling travel path element and exits to the outer peripheral region SA, and a 90 ° turn from the currently traveling travel route element, and has the attribute of already cut land (= already traveled). It is considered that the route passes through (the aggregated portion of the traveling route elements) and exits to the outer peripheral region SA where the parking position exists. Here, the latter route with a shorter mileage is selected (step # 03). In this latter departure travel, as the departure travel path element in the work target area CA after turning 90 °, the travel path element set in the outer peripheral region SA is translated to the departure point. However, if the withdrawal request is made with sufficient time, the former route is selected. In the former withdrawal run, the harvesting work is continued during the withdrawal run in the work target area CA, which is advantageous in terms of work efficiency.
収穫機1は、作業対象領域CAでの作業走行を離脱して、作業対象領域CA及び外周領域SAを離脱走行して駐車位置に到着すると、作業支援車から支援を受ける。この例では、運搬車CVに収穫物タンク14に貯留された収穫物が排出される。
When the
収穫物の排出が完了すると、作業走行に復帰するため、離脱要求が発生した地点に戻る必要がある。図18の例では、離脱要求が発生した時に走行していた走行経路要素に未作業部分が残されているので、当該走行経路要素に戻る。このため、収穫機1は、駐車位置から外周領域SAの走行経路要素を選択して、左回りに走行し、目的とする走行経路要素の端点に達すると、そこで90°旋回して当該走行経路要素に入り、作業走行を行う。離脱要求が発生した地点を過ぎれば、収穫機1は非作業で走行し、Uターン走行経路を経て、次の走行経路要素を作業走行する(ステップ#04)。以後は、収穫機1は直線往復走行を続行し、この作業対象領域CAでの作業走行を完了する(ステップ#05)。
When the discharge of the harvest is completed, it is necessary to return to the point where the withdrawal request was made in order to return to the work run. In the example of FIG. 18, since an unworked portion is left in the traveling path element that was traveling when the withdrawal request was generated, the process returns to the traveling path element. Therefore, the
(A9)入力されている作業地データに圃場内の走行障害物の位置が含まれている場合、あるいは収穫機1に障害物位置検出装置が装備されている場合、障害物の位置と自車位置とに基づいて、障害物回避走行のための走行経路要素が選択される。この障害物回避目的の選択ルールとして、障害物にできるだけ近接した迂回経路をとる走行経路要素を選択するルールや、一旦外周領域SAに出てから作業対象領域CAに入る際に障害物の存在しない直線経路を取ることができる走行経路要素を選択するルールがある。
(A9) If the input work area data includes the position of a traveling obstacle in the field, or if the
(A10)図4、図11で示されるような渦巻き走行パターンが設定されている場合に、選択対象となる走行経路要素の長さが短くなると、自動的に、直線往復走行パターンに変更する。面積が狭くなった場合は、前後進を行うαターン走行を含む渦巻き走行は非効率的になりがちだからである。 (A10) When the spiral traveling pattern as shown in FIGS. 4 and 11 is set and the length of the traveling path element to be selected becomes short, the pattern is automatically changed to the straight reciprocating traveling pattern. This is because when the area becomes small, swirl running including α-turn running that moves forward and backward tends to be inefficient.
(A11)慣行走行で走行している場合において、未作業地、つまり作業対象領域CAにおける走行経路要素群における未作業(未走行)の走行経路要素の数が所定値以下になった場合、慣行走行から自動走行に自動的に切り替えられる。また、収穫機1が、メッシュ直線群で網羅された作業対象領域CAを外から内への渦巻き走行で作業している場合、残された未作業地の面積が少なくなって、未作業走行経路要素の数が所定値以下になった場合、渦巻き走行パターンから直線往復走行パターンに自動的に切り替えられる。この場合では、上述したように、無駄な走行を避けるために、中間直進経路の属性を持つ走行経路要素が、外周領域SAから作業対象領域CAの未作業地付近まで平行移動される。
(A11) In the case of traveling in conventional driving, when the number of unworked (untraveled) traveling route elements in the traveling route element group in the unworked area, that is, the work target area CA becomes a predetermined value or less, the customary driving is performed. It automatically switches from running to automatic running. Further, when the
(A12)稲作や麦作などの圃場では、苗の作付け列である条(畝)に平行に収穫機1を走行させることが、収穫作業の効率が向上させる。このため、経路要素選択部63による走行経路要素の選択において、条に平行な走行経路要素ほど選択されやすくする。ただし、作業走行開始時に、機体の姿勢が条方向に平行な姿勢や位置でない場合には、条方向と交差する方向に沿った走行であっても、条に平行な姿勢とするための走行によって作業を行うように構成する。これにより、少しでも無駄な走行(非作業走行)を減らし、早く作業を終えられる。
(A12) In fields such as rice cultivation and wheat cultivation, running the
〔協調走行制御〕
次に、複数の作業車が投入される作業車自動走行システムによる作業走行について説明する。ここでは、理解のしやすさのために、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に与え、そこで選択された次走行経路要素を受け取ることになる。
[Cooperative driving control]
Next, the work running by the work vehicle automatic running system in which a plurality of work cars are input will be described. Here, for ease of understanding, work running (automatic running) by two
図20には、図7と同様に、作業幅でメッシュ分割するメッシュ直線からなるメッシュ直線群で網羅された作業対象領域CAが示されている。ここでは、マスタ収穫機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重渦巻きを作り出している。
Similar to FIG. 7, FIG. 20 shows a work target area CA covered by a mesh straight line group consisting of mesh straight lines that are mesh-divided by the work width. Here, the
なお、作業対象領域CAは、外側の周回走行によって形成される外周領域SAによって規定されるので、最初に外周領域SAを形成するための周回走行を、マスタ収穫機1mとスレーブ収穫機1sとのいずれかによって行う必要がある。この周回走行も、マスタ収穫機1mとスレーブ収穫機1sとの協調制御で行うことも可能である。
Since the work target area CA is defined by the outer peripheral region SA formed by the outer peripheral region SA, the
このように、経路要素選択部63が協調経路要素選択ルールを採用している場合には、例えば、図20に示されているように、複数の収穫機1によって、作業対象領域CAが協調的に作業走行されるように走行経路要素が選択される。その結果、図20の例では、2台の収穫機1による2つの走行軌跡が二重渦巻き線を描きながら作業対象領域CAを網羅する渦巻き走行パターンとなる。また経路要素選択部63が単独経路要素選択ルールを採用している場合には、例えば、図11に示されているように、単独の収穫機1によって、作業対象領域CAが作業走行されるように走行経路要素が選択される。その結果、図11の例では、単独の収穫機1による1つの走行軌跡が渦巻き線を描きながら作業対象領域CAを網羅する渦巻き走行パターンとなる。
As described above, when the route
次に、協調経路要素選択ルールによる2台の収穫機1での協調作業走行から、単独経路要素選択ルールによる単独の収穫機1での単独作業走行への切り替わりが、図21を用いて説明される。このような協調作業走行から単独作業走行への切り替わりは、1台の収穫機1が停止または作業対象領域CAから離脱した際に発生する。
Next, the switching from the cooperative work run by the two
協調作業走行から単独作業走行への切り替わりは、作業状態評価部55から出力される状態情報(他車位置関係及び接触推定位置を含む)から、1台の収穫機1の停止または作業対象領域CAから離脱が確認されると実行される。図21では、圃場の外側(畦)において、第1辺S1の中央外側に対応する位置に、収穫機1によって収穫された収穫物を搬送する運搬車CVが駐車している。そして、外周領域SAにおける運搬車CVに隣り合う位置に、運搬車CVへの収穫物排出作業のために収穫機1が駐車される駐車位置が設定されている。図21は、スレーブ収穫機1sが、作業走行の途中で、作業対象領域CAでの走行経路要素から離脱して、外周領域SAを周回走行し、収穫物を運搬車CVに排出し、再び外周領域SAを周回走行し、作業対象領域CAでの走行経路要素に復帰する様子を示している。
When switching from cooperative work running to single work running, one
まず、スレーブ収穫機1sの経路要素選択部63は、離脱要求(収穫物排出)が発生すると、貯留量の余裕と、駐車位置までの走行距離等に基づいて、外周領域SAにおける離脱経路の属性値を持つ走行経路要素と、その離脱経路属性の走行経路要素への離脱元となる走行経路要素と、を選択する。本形態では、外周領域SAのうち駐車位置が設定された領域に設定されている走行経路要素と、現在走行している走行経路要素L41とが選択されており、走行経路要素L41と走行経路要素L12との交点が離脱点となっている。外周領域SAに進んだスレーブ収穫機1sは、外周領域SAの走行経路要素(離脱経路)に沿って駐車位置まで走行し、駐車位置にて運搬車CVに収穫物を排出する。このようなスレーブ収穫機1sの作業対象領域CAからの離脱を示すデータは、作業状態評価部55から出力される状態情報に含まれている、スレーブ収穫機1sの現在位置及び現在選択している走行経路要素と、マスタ収穫機1mの現在位置及び現在選択している走行経路要素とから判定される。
First, when a departure request (harvest discharge) occurs, the route
マスタ収穫機1mは、スレーブ収穫機1sが作業対象領域CAでの作業走行を離脱して収穫物の排出を行っている間も、作業対象領域CAでの作業走行を継続する。但し、スレーブ収穫機1sは、走行経路要素L42の走行中において、本来なら走行経路要素L42と走行経路要素L13との交点で走行経路要素L13を選択する予定であった。しかし、スレーブ収穫機1sの離脱により走行経路要素L12の走行がキャンセルされたので、走行経路要素L12は未刈地(未走行)となっている。このため、マスタ収穫機1mの経路要素選択部63は、協調経路要素選択ルールを取り消し、単独経路要素選択ルールを採用する。その結果、マスタ収穫機1mの経路要素選択部63は、走行経路要素L13に代えて走行経路要素L12を選択する。つまり、マスタ収穫機1mは、走行経路要素L42と走行経路要素L12との交点まで走行して、そこで左折して、走行経路要素L12を走行する。
The
スレーブ収穫機1sが収穫物排出を終えると、スレーブ収穫機1sの経路要素選択部63は、スレーブ収穫機1sの現在位置及び自動走行速度と、作業対象領域CAにおける走行経路要素の属性(未走行/既走行)と、マスタ収穫機1mの現在位置及び自動走行速度と等に基づいて、復帰するべき走行経路要素を選択する。本形態では、最も外側に位置する未作業走行経路要素である走行経路要素L43が選択されている。スレーブ収穫機1sは、駐車位置から、外周領域SAを、復帰経路の属性を有する走行経路要素に沿って左回りに走行して、走行経路要素L43の左端から走行経路要素L43に入る。スレーブ収穫機1sの経路要素選択部63が走行経路要素L43を選択すると、その情報が、状態情報としてマスタ収穫機1mに送信される。これにより、マスタ収穫機1mの経路要素選択部63は、単独経路要素選択ルールを取り消し、協調経路要素選択ルールを採用する。その結果、マスタ収穫機1mの経路要素選択部63は、走行経路要素L33まで走行経路を選択していたとすると、次の走行経路要素として、走行経路要素L43の内側隣の走行経路要素L44を選択する。その際、他車位置関係算出部56は、マスタ収穫機1m及びスレーブ収穫機1sが走行している(選択している)走行経路要素L33と走行経路要素L44との交点付近でマスタ収穫機1mとスレーブ収穫機1sとが接触することを推定する。これにより、他車位置関係算出部56は、当該交点付近を接触推定位置として算出する。そこで、他車位置関係算出部56は、当該交点のマスタ収穫機1mとスレーブ収穫機1sとの当該交点付近の通過時間差を算出し、その通過時間差が所定値以下(マスタ収穫機1mとスレーブ収穫機1sとの接触が推定される)なら、通過時間が遅い方の収穫機1(ここではマスタ収穫機1m)が衝突回避のため一時停車するように自動走行制御部511に指令する。スレーブ収穫機1sが当該交点を通過した後に、マスタ収穫機1mが再び自動走行を開始する。このようにマスタ収穫機1mとスレーブ収穫機1sとが、互いに自車位置や選択した走行経路要素などの情報を交換しているので、衝突回避行動や遅延回避行動を実行することができる。
When the
このような衝突回避行動や遅延回避行動は、図22及び図23で示すように、直線往復走行においても実行される。また、その際は、協調経路要素選択ルールから単独経路要素選択ルールへの切り替わり、及びその逆の切り替わりも実行される。なお、図22及び図23では、互いに平行な直線からなる平行直線群は、L01、L02、・・・L10で示されており、L01-L04が既作業の走行経路要素であり、L05-L10が未作業の走行経路要素である。図22では、マスタ収穫機1mが二点鎖線で示されている駐車位置に向かうために外周領域SAを走行している。スレーブ収穫機1sは、マスタ収穫機1mとの接触を回避するために、衝突回避行動として、作業対象領域CAの下端で、詳しくは走行経路要素L04の下端で一時停止している。図23では、スレーブ収穫機1sの前を横切ったマスタ収穫機1mは、駐車位置で停車している。また、図22及び図23の作業走行状態では、スレーブ収穫機1sの経路要素選択部63は、単独経路要素選択ルールを採用している。マスタ収穫機1mの経路要素選択部63は、周回経路要素を選択する離脱経路要素選択ルールを採用している。図23において、スレーブ収穫機1sが走行経路要素L04からUターン走行で走行経路要素L07に移行するために外周領域SAに進入すると、マスタ収穫機1mと衝突する。駐車位置にマスタ収穫機1mが駐車した場合、走行経路要素L05、L06、L07を用いた作業対象領域CAへの進入や作業対象領域CAからの離脱は不可能となるので、走行経路要素L05、L06、L07は一時的に走行禁止(選択禁止)となる。マスタ収穫機1mが排出作業を終え、駐車位置から移動すると、スレーブ収穫機1sの経路要素選択部63が、マスタ収穫機1mの走行経路を加味して、走行経路要素L05-L10から、次に移行すべき走行経路要素を選択し、スレーブ収穫機1sは自動走行を再開する。
As shown in FIGS. 22 and 23, such a collision avoidance action and a delay avoidance action are also executed in a straight reciprocating run. In that case, switching from the cooperative route element selection rule to the single route element selection rule and vice versa is also executed. In addition, in FIG. 22 and FIG. 23, the parallel straight line group consisting of straight lines parallel to each other is shown by L01, L02, ... L10, L01-L04 is a travel path element for work, and L05-L10. Is an unworked travel path element. In FIG. 22, the
また、駐車位置にてマスタ収穫機1mが排出作業等を行っている間にも、スレーブ収穫機1sが作業を続けることも可能である。その例を図23に示してある。このケースでは、スレーブ収穫機1sの経路要素選択部63は、通常であれば、走行経路要素優先度が「1」である3レーン先の走行経路要素L07を、移行先の走行経路要素として選択するが、走行経路要素L07は、図22の例と同様に走行禁止となっている。そこで、次に優先度が高い走行経路要素L08が選択される。走行経路要素L04から走行経路要素L08への移動経路としては、既走行となった現在の走行経路要素L04を後進する経路(図23で実線で示されている)や、走行経路要素L04の下端から右回りで前進して外周領域SAに出る経路(図23で点線で示されている)等の複数の経路が算出され、最も効率の良い経路、例えば最短となる経路(この形態では実線の経路)が選択される。
Further, it is also possible for the
図22と図23とに示された作業走行形態から、以下のことが理解される。つまり、協調経路要素選択ルールでは、自車以外の収穫機1が位置している走行経路要素及び当該走行経路要素に隣接する走行経路要素は、次走行経路要素としての選択対象から外される。また、単独経路要素選択ルールでは、外周領域に位置している自車以外の収穫機1に向かう前記走行経路要素は、次走行経路要素としての選択対象から外される。
From the working running modes shown in FIGS. 22 and 23, the following can be understood. That is, in the cooperative route element selection rule, the travel route element in which the
上述したように、複数台の収穫機1が協調して、1つの圃場の作業走行する場合でも、それぞれの経路要素選択部63は、管理センタKSから受け取った作業計画書や通信端末4から人為的に入力された走行パターン(例えば、直線往復走行パターンや渦巻き走行パターン)と、自車位置と、それぞれの作業状態評価部55から出力される状態情報と、予め登録されている選択ルールとに基づいて、走行経路要素を順次選択していく。以下に、上述した(A1)-(A12)以外のルールであって、複数台の収穫機1が協調して作業走行する場合に特有な選択ルール(B1)から(B11)を列挙する。
As described above, even when a plurality of
(B1)協調して作業走行する複数の収穫機1は、同じ走行パターンで自動走行する。例えば、一方の収穫機1に直線往復走行パターンが設定されている場合は、他方の収穫機1にも直線往復走行パターンが設定される。
(B1) The plurality of
(B2)渦巻き走行パターンが設定されている場合に、一方の収穫機1が作業対象領域CAでの作業走行から離脱して外周領域SAに入ると、他方の収穫機1は、より外側の走行経路要素を選択する。その結果、離脱した収穫機1の走行予定経路を残しておくのではなく、離脱した収穫機1が走行する予定の走行経路要素を先取りする。
(B2) When the swirl traveling pattern is set, when one
(B3)渦巻き走行パターンが設定されている場合に、離脱した収穫機1が再び作業対象領域CAでの作業走行に復帰するに際しては、作業走行中の収穫機1から遠く、かつ、未作業の属性を持つ走行経路要素を選択する。
(B3) When the swirl running pattern is set, when the
(B4)渦巻き走行パターンが設定されている場合に、選択対象となる走行経路要素の長さが短くなると、1台のみの収穫機1で作業走行を実行し、残りの収穫機1は作業走行から離脱する。
(B4) When the spiral traveling pattern is set and the length of the traveling path element to be selected becomes short, the working traveling is executed by only one harvesting
(B5)渦巻き走行パターンが設定されている場合、衝突危険性を回避するため、複数の収穫機1が、作業対象領域CAの外形を示す多角形の辺に平行な走行経路要素群から走行経路要素を同時に選択することを禁止する。
(B5) When the swirl running pattern is set, in order to avoid the risk of collision, a plurality of
(B6)直線往復走行パターンが設定されている場合、いずれかの収穫機1がUターン走行しているときは、他の収穫機1は、外周領域SAのうちUターン走行が実行されている領域に進入しないように自動走行制御される。
(B6) When the straight reciprocating travel pattern is set, when any of the
(B7)直線往復走行パターンが設定されている場合、次の走行経路要素としては、他の収穫機1が次に走行予定の走行経路要素または現在走行している走行経路要素から少なくとも2つ以上の走行経路要素が飛ばされた位置にある走行経路要素が選択される。
(B7) When the straight reciprocating travel pattern is set, as the next travel route element, at least two or more from the travel route element that the
(B8)収穫物排出や燃料補給のため、作業対象領域CAでの作業走行から離脱するタイミングの決定、及び、走行経路要素の選択は、余裕度と駐車位置までの走行時間とだけでなく、複数の収穫機1が同時に離脱しないことを条件に加えて行われる。
(B8) Determining the timing of withdrawal from work driving in the work target area CA for harvesting discharge and refueling, and selection of travel route elements are not only determined by the margin and the travel time to the parking position. This is performed on condition that the plurality of
(B9)マスタ収穫機1mにて慣行走行が設定されている場合、スレーブ収穫機1sは、マスタ収穫機1mに追従する自動走行を行う。
(B9) When the conventional traveling is set in the
(B10)マスタ収穫機1mの収穫物タンク14の容量とスレーブ収穫機1sの収穫物タンク14の容量とが異なる場合に、同時またはほぼ同時に排出要求が出されると、容量が少ない収穫機1が先に排出作業を行う。排出できない収穫機1の排出待機時間(非作業時間)が短くなり、圃場の収穫作業を少しでも早く終了できる。
(B10) When the capacity of the
(B11)1つの圃場が相当広い場合は、1つの圃場を中割りによって複数の区画に区分けし、各区画に1台の収穫機1を投入する。図24は、作業対象領域CAの中央に帯状の中割り領域CCを形成して、作業対象領域CAを2つの区画CA1とCA2とに区分けする中割り過程の途中を示す説明図であり、図25は、中割り過程の終了後を示す説明図である。この実施形態では、マスタ収穫機1mが中割り領域CCを形成する。マスタ収穫機1mが中割りを行っている間、スレーブ収穫機1sは、区画CA2で、例えば直線往復走行パターンで作業走行を行う。この作業走行に先立って、区画CA2のための走行経路要素群が生成される。その際、区画CA2の中割り領域CC側の作業幅一本分に対応する走行経路要素は、中割り過程が終了するまで、選択禁止とし、マスタ収穫機1mとスレーブ収穫機1sとの接触を回避する。
(B11) When one field is considerably large, one field is divided into a plurality of sections by middle division, and one
中割り過程が終了すると、マスタ収穫機1mは区画CA1のために算出された走行経路要素群を用いて、単独作業走行のように走行制御され、スレーブ収穫機1sは区画CA2のために算出された走行経路要素群を用いて、単独作業走行のように走行制御される。どちらかの収穫機1が先に作業を完了した場合、作業が残っている区画に入って、当該収穫機1と他の収穫機1との協調制御が開始される。担当する区画での作業が終了した収穫機1は、他の収穫機1の作業のサポートをするために、他の収穫機1の担当区画に向かうように自動走行する。
When the middle division process is completed, the
圃場の規模がさらに大きい場合には、図26に示すように、圃場が格子状に中割りされる。この中割りは、マスタ収穫機1mとスレーブ収穫機1sとで行うことができる。格子状の中割りで形成された区画にマスタ収穫機1mによる作業とスレーブ収穫機1sによる作業とが振り分けられ、それぞれの区画において、単独の収穫機1による作業走行が実施される。但し、マスタ収穫機1mとスレーブ収穫機1sとの距離が所定値以上に離れないという条件で、走行経路要素が選択される。これは、スレーブ収穫機1sがマスタ収穫機1mから離れ過ぎると、マスタ収穫機1mに搭乗している監視者によるスレーブ収穫機1sの作業走行の監視や、互いの状態情報の交信が困難になるためである。図26のような形態の場合は、担当する区画での作業が終了した収穫機1は、他の収穫機1の作業のサポートをするために、他の収穫機1の担当区画に向かうように自動走行しても良いし、自車の担当である次の区画に向かうように自動走行しても良い。
When the scale of the field is further large, the field is divided in a grid pattern as shown in FIG. 26. This middle division can be performed by the
運搬車CVの駐車位置や、燃料補給車の駐車位置は、外周領域SAの外側となるので、作業走行している区画によっては、収穫物排出や燃料補給のための走行経路が長くなり、その走行時間が無駄となる。このため、駐車位置への往き走行及び駐車位置からの戻り走行の際に、通り道となる区画の作業走行を実施するような走行経路要素と周回経路要素が選択される。 Since the parking position of the carrier CV and the parking position of the refueling vehicle are outside the outer peripheral region SA, the traveling route for harvesting discharge and refueling becomes longer depending on the section where the work is being carried out. Running time is wasted. For this reason, a travel route element and a circuit route element that carry out work travel of the section serving as a passage are selected when traveling to and from the parking position and returning from the parking position.
〔協調自動走行時における作業装置機器群等のパラメータの微調整について〕
マスタ収穫機1mとスレーブ収穫機1sとが協調して作業走行する場合、通常マスタ収穫機1mには、監視者が搭乗しているので、マスタ収穫機1mについては、必要に応じて、通信端末4を通じて、自動走行制御における車両走行機器群71や作業装置機器群72に対するパラメータの値を微調整できる。マスタ収穫機1mの車両走行機器群71や作業装置機器群72に対するパラメータの値を、スレーブ収穫機1sにおいても実現するため、図27に示すように、マスタ収穫機1mからスレーブ収穫機1sのパラメータを調整できる構成を採用することができる。ただし、通信端末4は、スレーブ収穫機1sにも備えられていても何ら問題はない。なぜならば、スレーブ収穫機1sも、単独自動走行をする場合も、マスタ収穫機1mとして使用される場合もあるからである。
[Fine adjustment of parameters such as work equipment group during cooperative automatic driving]
When the
図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の高さが含まれている。
The
上述したように、他車位置関係算出部56は、衛星測位モジュール80によって得られた測位データに基づいて収穫機1の現在位置及び実車速を算出する機能を有する。協調自動走行において、この機能を利用し、同一方向で先行する収穫機1の測位データに基づく実車速と、後続の収穫機1の測位データに基づく実車速とを比較し、車速差があれば、後続の収穫機1の車速が先行する収穫機1の車速となるように、車速調整が行われる。これにより、先行する収穫機1と後続の収穫機1との車速の違いに起因する異常接近や接触が回避される。
As described above, the other vehicle position
上述したように、2台の収穫機1で協調作業走行している途中で、一方の収穫機1が離脱しても、協調経路要素選択ルールから単独経路要素選択ルールに切り換わることで、他方の収穫機1が一方の作業機1の分まで作業走行を行うことができる。同様に、3台以上の収穫機1で協調作業走行している途中で、少なくとも1台の収穫機1が離脱しても、台数を減じた協調経路要素選択ルールまたは単独経路要素選択ルールに切り換わることで、残っている収穫機1が離脱した作業機1の分まで作業走行を行うことができる。
As described above, even if one of the
収穫機1の通信処理部70や通信端末4の通信制御部40に、登録されている携帯電話などの携帯通信端末と通話やメールを送る通信通話機能を備えることができる。そのような通信通話機能が備えられている場合、収穫物の貯留量が所定量を超えると、収穫物の排出先となる運搬車CVの運転者に、収穫物排出を行う旨の通話(人工音声)またはメールが送出される。同様に、燃料残量が所定量以下になると、燃料補給車の運転者に、燃料補給を依頼する旨の通話(人工音声)またはメールが送出される。
The
〔別の実施形態〕
(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とが重複している場合は、上述の追加周回走行を行うことが望ましい。
[Another Embodiment]
(1) In the above-described embodiment, the automatic traveling is performed on the premise that a sufficient space is secured for both the U-turn traveling in the straight reciprocating traveling and the α-turn traveling in the spiral traveling by the preliminary lap traveling. I explained. However, in general, the space required for U-turn traveling is wider than the space required for α-turn traveling. Therefore, the space formed by the preliminary lap running may not be sufficient for the U-turn running. For example, as shown in FIG. 28, when the work is performed by one
追加周回走行のための走行経路は、事前の周回走行における収穫機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の自動作業走行が開始される。
The traveling route for the additional lap traveling can be calculated based on the traveling locus of the
<
The field is divided into an outer peripheral area SA where the harvesting work has been completed and a work target area CA where the harvesting work is to be performed by the prior orbital running. After the lap run in advance, as shown in
<
In this additional orbital travel, a plurality of orbital travel route elements (thick lines in FIG. 28) constituting the rectangular orbital travel route are calculated. The orbital travel path element includes the leftmost travel path element Ls and the rightmost travel path element Le in the travel path element calculated for straight reciprocating travel. The travel path element Ls and the travel route element Le are both linear. Further, in the rectangular orbital traveling path, the traveling path element Ls and the traveling path element Le are opposite sides. Further, here, the orbiting travel path element includes a travel route element Ls, a travel route element Le, a travel route element Ls connecting the upper ends of the travel route element Ls and the travel route element Le, a travel route element Ls, and a travel route. A travel path element that connects the lower ends of the element Le. When the automatic traveling is started, the orbiting traveling route element suitable for this additional orbiting traveling route is selected by the route
<
As shown in
なお、図28のステップ#01において、駐車位置PPがUターン経路群ULに重複しておらず、かつ、駐車位置PPがUターン経路群ULに向かい合っていない場合がある。例えば、駐車位置PPが、左端の走行経路要素Lsに向き合って位置する場合がある。この場合は、走行経路要素Lsが最初に選択される直線往復走行が行われることで、駐車位置の周辺領域が拡大されていくので、上述の追加周回走行は、もはや実行されない。あるいは、1周程度の追加周回走行だけが行われても良い。
In
また、複数台の収穫機1によって協調的に作業走行するような場合にも、上述の追加周回走行が自動的に行われるように構成されていても良い。協調作業の場合、走行パターンとして直線往復走行パターンが設定されると共に、駐車位置PPがUターン経路群ULに向かい合う位置に設定されると、作業走行開始後すぐに、複数周(3~4周程度)分の追加周回走行が自動的に行われる。これにより、作業対象領域CAが縮小され、駐車位置PPの内周側に広いスペースが確保される。したがって、一台の収穫機1が駐車位置PPに停車していても、他の収穫機1は、余裕を持って、駐車位置PPの内周側でUターンすることや、駐車位置PPの内周側を通過することができる。
Further, even in the case where the work running is coordinated by a plurality of
(2)上述の実施形態では、直線往復走行パターンが設定されている場合に、外周領域SAにおいてUターン走行が行われる領域に、運搬車CV等の支援車への作業のための駐車位置が設定されていると、排出作業等のために停車している収穫機1とは別の収穫機1は、排出作業等の終了まで停止して待機したり、駐車位置を迂回する走行経路要素が選択されたりするように構成されていた。しかし、このような場合に、駐車位置よりも内周側にUターン走行を行うのに十分なスペースを確保するために、自動走行(作業走行)が開始されると、1台または複数台の収穫機1が自動で作業対象領域CAの外周部を何周か周回走行するように構成してあっても良い。
(2) In the above-described embodiment, when the straight reciprocating travel pattern is set, the parking position for work on the support vehicle such as the transport vehicle CV is located in the region where the U-turn travel is performed in the outer peripheral region SA. If it is set, the
(3)上述した実施形態では、第1作業車であるマスタ収穫機1mと第2作業車であるスレーブ収穫機1sとの作業幅が同じであると見なして、走行経路要素の設定及び選択について説明した。ここでは、マスタ収穫機1mの作業幅とスレーブ収穫機1sとの作業幅とが異なる場合に、どのように走行経路要素の設定及び選択がなされるかについて、2つの例を挙げて説明する。マスタ収穫機1mの作業幅を第1作業幅とし、スレーブ収穫機1sの作業幅を第2作業幅として説明する。理解しやすいように、具体的に、第1作業幅を「6」とし、第2作業幅を「4」としている。
(3) In the above-described embodiment, it is considered that the work width of the
(3-1)図29には、直線往復走行パターンが設定されている場合の例が示されている。このケースでは、経路管理部60は、第1作業幅と第2作業幅の最大公約数または近似最大公約数である基準幅で、作業対象領域CAを網羅する多数の走行経路要素の集合体である走行経路要素群を算出する。第1作業幅が「6」、第2作業幅が「4」であるから、基準幅は「2」となる。図29では、走行経路要素を識別するため、01から20までの数を、経路番号として各走行経路要素に付してある。
(3-1) FIG. 29 shows an example in which a linear reciprocating travel pattern is set. In this case, the
経路番号17の走行経路要素からマスタ収穫機1mが出発し、経路番号12の走行経路要素からスレーブ収穫機1sが出発するものとする。経路要素選択部63は、図6に示すように、マスタ収穫機1mの走行経路要素を選択する機能を有する第1経路要素選択部631と、スレーブ収穫機1sの走行経路要素を選択する機能を有する第2経路要素選択部632とに分けられている。経路要素選択部63がマスタ収穫機1mの制御ユニット5に構築されている場合、第2経路要素選択部632によって選択された次走行経路要素は、マスタ収穫機1mの通信処理部70とスレーブ収穫機1sの通信処理部70とを介してスレーブ収穫機1sの経路設定部64に与えられる。なお、作業幅の中心または収穫機1の中心と走行経路要素とは必ずしも一致しなくてもよく、偏差があれば、その偏差を考慮した自動走行制御が行われる。
It is assumed that the
図29に示されているように、第1経路要素選択部631は、第1作業幅または第2作業幅の整数倍の領域(未走行でも既走行でも可)、あるいは、第1作業幅の整数倍と第2作業幅の整数倍との合計の領域(未走行でも既走行でも可)を残すように、未走行となっている走行経路要素群から、次の走行経路要素を選択する。選択された次走行経路要素は、マスタ収穫機1mの経路設定部64に与えられる。同様に、第2経路要素選択部632は、第1作業幅または第2作業幅の整数倍の領域(未走行でも既走行でも可)、あるいは、第1作業幅の整数倍と第2作業幅の整数倍との合計の領域(未走行でも既走行でも可)を残すように、未走行となっている走行経路要素群から、次の走行経路要素を選択する。
As shown in FIG. 29, the first route
つまり、第1経路要素選択部631または第2経路要素選択部632によって与えられた次走行経路要素に沿ってマスタ収穫機1mまたはスレーブ収穫機1sが自動走行した後には、作業対象領域CAには、第1作業幅または第2作業幅の整数倍の幅を有する未走行の領域が残され続けることとなる。しかし、最終的には、第2作業幅未満の狭い幅を有する未作業領域が残る可能性があるが、そのような最後に残った未作業領域は、マスタ収穫機1mまたはスレーブ収穫機1sのいずれかで作業走行される。
That is, after the
(3-2)図30には、渦巻き走行パターンが設定されている場合の例が示されている。このケースでは、作業対象領域CAに、縦横の間隔が第1作業幅である縦直線群と横直線群とで走行経路要素群が設定される。横直線群に属する走行経路要素には、その経路番号として、X1からX9の記号が与えられており、縦直線群に属する走行経路要素には、その経路番号として、Y1からY9の記号が与えられている。 (3-2) FIG. 30 shows an example in which a spiral traveling pattern is set. In this case, a traveling route element group is set in the work target area CA by the vertical straight line group and the horizontal straight line group in which the vertical and horizontal intervals are the first work width. The traveling route elements belonging to the horizontal straight line group are given the symbols X1 to X9 as their route numbers, and the traveling route elements belonging to the vertical straight line group are given the symbols Y1 to Y9 as their route numbers. Has been done.
図30は、マスタ収穫機1mとスレーブ収穫機1sとが外から内にかけて左回りの二重渦巻き線を描くような渦巻き走行パターンが設定されている。経路番号Y1の走行経路要素からマスタ収穫機1mが出発し、経路番号X1の走行経路要素からスレーブ収穫機1sが出発するものとする。経路要素選択部63は、このケースでも、第1経路要素選択部631と第2経路要素選択部632とに分けられている。
In FIG. 30, a spiral traveling pattern is set such that the
図30に示すように、マスタ収穫機1mは、まず、第1経路要素選択部631によって最初に選択された経路番号Y1の走行経路要素を走行する。しかしながら、図30で示された走行経路要素群は、当初第1作業幅を間隔として算出されているので、第1作業幅より狭い第2作業幅を有するスレーブ収穫機1sのために、第2経路要素選択部632によって最初に選択された経路番号X1の走行経路要素は、第1作業幅と第2作業幅の違いを埋めるために、その位置座標が修正される。つまり、第1作業幅と第2作業幅との差(以降、この差を幅差と称する)の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が走行した走行経路要素が存在する数に応じて第1作業幅と第2作業幅との差を相殺すべく、選択された走行経路要素の位置修正が行われる(図30、#06)。走行経路要素の位置修正は、ここでは、経路管理部60によって行われるが、第1経路要素選択部631と第2経路要素選択部632とによって行われることも可能である。
As shown in FIG. 30, the
図29と図30とを用いた走行例では、第1経路要素選択部631と第2経路要素選択部632とが、マスタ収穫機1mの制御ユニット5に構築されていると仮定している。しかしながら、第2経路要素選択部632がスレーブ収穫機1sに構築されることも可能である。その際は、スレーブ収穫機1sが走行経路要素群を示すデータを受け取り、第1経路要素選択部631と第2経路要素選択部632とが、それぞれが選択した走行経路要素を交換しながら、自己の次走行経路要素を選択し、必要な位置座標修正を行うとよい。また、経路管理部60、第1経路要素選択部631、第2経路要素選択部632を全て、通信端末4に構築し、通信端末4から、選択された走行経路要素を経路設定部64に送る構成も可能である。
In the traveling example using FIGS. 29 and 30, it is assumed that the first route
(4)上述の実施形態において図6に基づいて説明した制御機能ブロックはあくまでも一例に過ぎず、各機能部をさらに分割することや複数の機能部を統合することも可能である。また、機能部は、上部制御装置としての制御ユニット5と通信端末4と管理コンピュータ100とに振り分けられたが、この機能部の振り分けも一例であり、各機能部は、任意の上部制御装置に振り分けることも可能である。上部制御装置同士でデータ交換可能につながっていれば、別な上部制御装置に振り分けること可能である。例えば、通信端末4の機能の全てをマスタ収穫機1mに構築することも可能である。また、図6で示された制御機能ブロック図では、他車位置関係算出部56は、収穫機1の制御ユニットに構築されていたが、通信端末4に構築してもよい。この場合、通信端末4には、各収穫機1の現在位置、現在走行している(選択している)走行経路要素などの情報が各収穫機1から送られる。逆に、他車位置関係算出部56によって算出された他車位置関係は各作業車1の作業状態評価部55に送られる。さらに、図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) The control function block described with reference to FIG. 6 in the above-described embodiment is merely an example, and each functional unit can be further divided or a plurality of functional units can be integrated. Further, the functional unit is distributed to the
(5)本発明で算定され、設定される走行経路は、自動走行の目標走行経路として用いられるが、手動走行の目標走行経路として用いることも可能である。つまり、本発明は、自動走行のみならず手動走行にも適用可能であり、もちろん、自動走行と手動走行とを混在させた運用も可能である。 (5) The travel route calculated and set in the present invention is used as a target travel route for automatic travel, but it can also be used as a target travel route for manual travel. That is, the present invention can be applied not only to automatic driving but also to manual driving, and of course, it is also possible to operate a mixture of automatic driving and manual driving.
(6)上述の実施形態では、管理センタKSから送られてくる圃場情報に、そもそも圃場周辺の地形図が含まれており、圃場の境界に沿った周回走行によって、圃場の外形状及び外形寸法の精度を向上させる例を示した。しかし、圃場情報には圃場周辺の地形図、少なくとも圃場の地形図が含まれておらず、周回走行によって初めて、圃場の外形状及び外形寸法が算定されるように構成してあっても良い。また、管理センタKSから送られてくる圃場情報や作業計画書の内容や、通信端末4を通じて入力される項目は、上述した形態のものに限られず、本発明の趣旨を逸脱しない範囲で変更可能である。
(6) In the above-described embodiment, the field information sent from the management center KS includes a topographic map around the field in the first place, and the outer shape and external dimensions of the field are obtained by orbiting along the boundary of the field. An example of improving the accuracy of is shown. However, the field information does not include a topographic map around the field, or at least a topographic map of the field, and may be configured so that the outer shape and external dimensions of the field can be calculated only by orbiting. Further, the field information sent from the management center KS, the contents of the work plan, and the items input through the
(7)上述の実施形態では、図6に示されているように、メッシュ経路要素算出部601とは別に、短冊経路要素算出部602が備えられ、短冊経路要素算出部602によって、作業対象領域CAを網羅する平行直線群である走行経路要素群が算出される例を示した。しかし、短冊経路要素算出部602を備えずに、メッシュ経路要素算出部601によって算出されたメッシュ状の直線群である走行経路要素を用いて、直線往復走行を実現しても良い。
(7) In the above-described embodiment, as shown in FIG. 6, a strip route
(8)上述の実施形態では、協調走行制御が行われている際に、監視者の目視結果に基づいて、スレーブ収穫機1sの車両走行機器群71や作業装置機器群72のパラメータを変更する例を示した。しかし、マスタ収穫機1mやスレーブ収穫機1sに搭載されたカメラによって撮影された映像(動画や一定間隔で撮影される静止画)がマスタ収穫機1mに搭載されたモニタ等に映し出されるように構成し、監視者がこの映像を見て、スレーブ収穫機1sの作業状況を判断し、車両走行機器群71や作業装置機器群72のパラメータを変更しても良い。あるいは、マスタ収穫機1mのパラメータが変更されるのに連動して、スレーブ収穫機1sのパラメータが変更されるように構成しても良い。
(8) In the above-described embodiment, the parameters of the vehicle traveling
(9)上述の実施形態では、協調して作業走行する複数の収穫機1は、同じ走行パターンで自動走行するように構成した例を示したが、異なる走行パターンで自動走行するように構成することも可能である。
(9) In the above-described embodiment, the plurality of
(10)上述の実施形態では、2台の収穫機1によって協調自動走行を行う例を示したが、3台以上の収穫機1による協調自動走行も同様の作業車自動走行システム及び走行経路管理装置によって実現可能である。
(10) In the above-described embodiment, an example in which cooperative automatic driving is performed by two
(11)図3では、走行経路要素群の一例として、作業対象領域CAを短冊状に分割する多数の平行分割直線を走行経路要素とする走行経路要素群が示されている。しかしながら、本発明はこれに限定されない。例えば、図31に示す走行経路要素群は、湾曲した平行線を走行経路要素としている。このように、本発明に係る「平行線」は湾曲していても良い。また、本発明に係る「平行線群」には、湾曲した平行線が含まれていても良い。 (11) FIG. 3 shows, as an example of the traveling path element group, a traveling path element group in which a large number of parallel division straight lines for dividing the work target area CA into strips are used as traveling path elements. However, the present invention is not limited to this. For example, in the traveling path element group shown in FIG. 31, curved parallel lines are used as traveling path elements. As described above, the "parallel lines" according to the present invention may be curved. Further, the "parallel line group" according to the present invention may include curved parallel lines.
(12)図4では、走行経路要素群の一例として、作業対象領域CAをメッシュ分割する、縦横方向に延びた多数のメッシュ直線からなる走行経路要素群が示されている。しかしながら、本発明はこれに限定されない。即ち、本発明に係る「メッシュ線」は、直線でなくても良い。例えば、図32に示す走行経路要素群では、紙面における横方向のメッシュ線は直線であり、紙面における縦方向のメッシュ線は湾曲している。また、図33に示す走行経路要素群では、紙面における横方向のメッシュ線及び縦方向のメッシュ線は、いずれも湾曲している。このように、メッシュ線は湾曲していても良い。また、メッシュ線群には、湾曲したメッシュ線が含まれていても良い。 (12) In FIG. 4, as an example of the traveling path element group, a traveling path element group composed of a large number of mesh straight lines extending in the vertical and horizontal directions, which divides the work target area CA into a mesh, is shown. However, the present invention is not limited to this. That is, the "mesh line" according to the present invention does not have to be a straight line. For example, in the traveling path element group shown in FIG. 32, the horizontal mesh line on the paper surface is a straight line, and the vertical mesh line on the paper surface is curved. Further, in the traveling path element group shown in FIG. 33, both the horizontal mesh line and the vertical mesh line on the paper surface are curved. In this way, the mesh wire may be curved. Further, the mesh line group may include curved mesh lines.
(13)上述の実施形態では、直線状の走行経路要素に沿った走行と、Uターン走行と、を繰り返すことにより、直線往復走行が行われる。しかしながら、本発明はこれに限定されず、図31から図33に示すような湾曲した走行経路要素に沿った走行と、Uターン走行と、を繰り返すことにより、往復走行が行われるように構成されていても良い。 (13) In the above-described embodiment, the linear reciprocating travel is performed by repeating the traveling along the linear traveling path element and the U-turn traveling. However, the present invention is not limited to this, and is configured to perform reciprocating traveling by repeating traveling along a curved traveling path element as shown in FIGS. 31 to 33 and U-turn traveling. You may be.
本発明の作業車自動走行システムは、作業車として普通型コンバインである収穫機1以外にも、作業地を自動作業しながら走行することができる作業車であれば、自脱型コンバインやトウモロコシ収穫機など他の収穫機1や、耕耘装置などの作業装置を取り付けたトラクタ、水田作業機等にも適用可能である。
In addition to the
1 :収穫機(作業車)
1m :マスタ収穫機
1s :スレーブ収穫機
4 :通信端末
5 :制御ユニット
41 :タッチパネル
42 :作業地データ入力部
43 :外形データ生成部
44 :領域設定部
51 :走行制御部
511 :自動走行制御部
512 :手動走行制御部
52 :作業制御部
53 :自車位置算出部(作業車位置算出部)
55 :作業状態評価部
56 :他車位置関係算出部
60 :経路管理部
63 :経路要素選択部
64 :経路設定部
70 :通信処理部
80 :衛星測位モジュール
SA :外周領域
CA :作業対象領域
1: Harvester (working vehicle)
1m:
55: Work state evaluation unit 56: Other vehicle position relationship calculation unit 60: Route management unit 63: Route element selection unit 64: Route setting unit 70: Communication processing unit 80: Satellite positioning module SA: Outer peripheral area CA: Work target area
Claims (3)
前記作業地を外周領域と前記外周領域の内側である作業対象領域とに設定する領域設定部と、
前記作業車の位置を算出する作業車位置算出部と、
前記作業対象領域を網羅する走行経路を構成する多数の走行経路要素の集合体である走行経路要素群と、前記外周領域を周回する周回経路を構成する周回経路要素の集合体である周回経路要素群とを読み出し可能に管理する経路管理部と、
状態情報に基づいて、前記作業車が次に走行すべき次走行経路要素を前記走行経路要素群から、または次に走行すべき次周回経路要素を前記周回経路要素群から順次選択する経路要素選択部と、
前記次走行経路要素と前記作業車の位置とに基づいて自動走行を実行する自動走行制御部と、を備え、
前記経路要素選択部は、前記複数の作業車によって前記作業対象領域を協調的に作業走行する際に採用される協調経路要素選択ルールと、前記作業車の内の1台が単独作業車として前記作業対象領域を単独作業走行するとともに、前記複数の作業車のうち前記単独作業車ではない前記作業車が前記周回経路要素に基づく周回走行を行っているか、または停車している際に採用される単独経路要素選択ルールとを備えており、
前記協調経路要素選択ルールが採用された状態での前記複数の作業車による協調的な作業走行中に、前記複数の作業車の内の1台を除いた残りの作業車が作業走行を離脱した場合、当該1台である前記単独作業車に前記単独経路要素選択ルールが適用される作業車自動走行システム。 It is a work vehicle automatic driving system for multiple work vehicles that work cooperatively on the work site while exchanging data.
An area setting unit that sets the work area to the outer peripheral area and the work target area inside the outer peripheral area, and
The work vehicle position calculation unit that calculates the position of the work vehicle, and
An orbital path element that is an aggregate of a traveling path element group that is an aggregate of a large number of traveling path elements that constitute a traveling path that covers the work target area, and an orbiting path element that constitutes an orbiting path that orbits the outer peripheral region. The route management unit that manages the group so that it can be read out,
Based on the state information, the route element selection for sequentially selecting the next travel route element to be traveled by the work vehicle from the travel route element group or the next circuit route element to be traveled from the circuit route element group. Department and
It is provided with an automatic traveling control unit that executes automatic traveling based on the next traveling route element and the position of the working vehicle.
The route element selection unit includes a cooperative route element selection rule adopted when the plurality of work vehicles cooperatively work and travel in the work target area, and one of the work vehicles is a single work vehicle. It is adopted when the work vehicle which is not the single work vehicle among the plurality of work vehicles is traveling independently based on the circuit path element or is stopped while traveling independently in the work target area. It has a single route element selection rule and
During the cooperative work run by the plurality of work vehicles in the state where the cooperative route element selection rule is adopted, the remaining work vehicles other than one of the plurality of work vehicles have left the work run. In this case, the work vehicle automatic traveling system in which the single route element selection rule is applied to the single work vehicle, which is the single unit .
前記メッシュ線同士の交点が、前記作業車の経路変更を許す経路変更可能点として設定され、
前記協調経路要素選択ルールでは、前記作業車による複数の渦巻き状走行軌跡によって作り出される多重渦巻き状走行軌跡が前記作業対象領域を網羅するように、前記次走行経路要素が選択され、
前記単独経路要素選択ルールでは、前記単独作業車による前記渦巻き状走行軌跡が前記作業対象領域を網羅するように、前記次走行経路要素が選択される請求項1に記載の作業車自動走行システム。 The travel path element group is a mesh line group composed of mesh lines that divide the work target area into a mesh.
The intersection of the mesh lines is set as a route changeable point that allows the route change of the work vehicle.
In the cooperative path element selection rule, the next travel path element is selected so that the multiple spiral travel loci created by the plurality of spiral travel loci by the work vehicle cover the work target area.
The work vehicle automatic traveling system according to claim 1, wherein in the single route element selection rule, the next traveling route element is selected so that the spiral traveling locus by the independent working vehicle covers the work target area.
前記作業車のUターン走行により、1つの走行経路要素の一端から他の走行経路要素の一端への移行が実行され、
前記協調経路要素選択ルールでは、前記複数の作業車のうちの1台の前記作業車が位置している前記走行経路要素及び当該走行経路要素に隣接する前記走行経路要素は、その他の前記作業車のための前記次走行経路要素としての選択対象から外され、
前記単独経路要素選択ルールでは、前記複数の作業車のうち前記単独作業車ではない前記作業車であって且つ前記外周領域に位置している前記作業車に向かう前記走行経路要素は、前記次走行経路要素としての選択対象から外される請求項1に記載の作業車自動走行システム。 The traveling path element group is a parallel line group consisting of parallel lines parallel to each other that divides the work target area into strips.
By the U-turn running of the work vehicle, the transition from one end of one traveling path element to one end of the other traveling path element is executed.
In the cooperative route element selection rule, the travel route element in which one of the plurality of work vehicles is located and the travel route element adjacent to the travel route element are other work vehicles. Excluded from selection as the next travel path element for
In the single route element selection rule, among the plurality of work vehicles, the travel route element toward the work vehicle, which is the work vehicle that is not the single work vehicle and is located in the outer peripheral region, is the next travel. The work vehicle automatic traveling system according to claim 1, which is excluded from the selection target as a route element.
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US16/466,056 US11300976B2 (en) | 2016-12-19 | 2017-11-29 | Work vehicle automatic traveling system |
KR1020197013041A KR102452919B1 (en) | 2016-12-19 | 2017-11-29 | work vehicle automatic driving system |
CN201780071289.8A CN109964190B (en) | 2016-12-19 | 2017-11-29 | Automatic traveling system of working vehicle |
EP17882393.6A EP3557360B1 (en) | 2016-12-19 | 2017-11-29 | Work vehicle automatic traveling system |
PCT/JP2017/042873 WO2018116770A1 (en) | 2016-12-19 | 2017-11-29 | Work vehicle automatic traveling system |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016245803 | 2016-12-19 | ||
JP2016245803 | 2016-12-19 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018099111A JP2018099111A (en) | 2018-06-28 |
JP7076195B2 true JP7076195B2 (en) | 2022-05-27 |
Family
ID=62713730
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017221342A Active JP7076195B2 (en) | 2016-12-19 | 2017-11-16 | Work vehicle automatic driving system |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7076195B2 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7364203B2 (en) * | 2019-01-22 | 2023-10-18 | 日本電気通信システム株式会社 | Inspection robot, system, information processing device, method, and program |
JP7045341B2 (en) * | 2019-01-29 | 2022-03-31 | ヤンマーパワーテクノロジー株式会社 | Collaborative work system |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015112071A (en) | 2013-12-12 | 2015-06-22 | 株式会社クボタ | Field work machine |
JP2016170580A (en) | 2015-03-12 | 2016-09-23 | 株式会社シンテックホズミ | Conveyance vehicle system |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09120313A (en) * | 1995-10-24 | 1997-05-06 | Kubota Corp | Guidance controller for working vehicle |
JP6267626B2 (en) * | 2014-11-13 | 2018-01-24 | ヤンマー株式会社 | Travel route setting device |
-
2017
- 2017-11-16 JP JP2017221342A patent/JP7076195B2/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015112071A (en) | 2013-12-12 | 2015-06-22 | 株式会社クボタ | Field work machine |
JP2016170580A (en) | 2015-03-12 | 2016-09-23 | 株式会社シンテックホズミ | Conveyance vehicle system |
Also Published As
Publication number | Publication date |
---|---|
JP2018099111A (en) | 2018-06-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6936356B2 (en) | Work vehicle automatic driving system | |
JP6832828B2 (en) | Travel route determination device | |
JP2020127405A5 (en) | ||
KR102532963B1 (en) | Work vehicle automatic driving system | |
JP6673786B2 (en) | Work vehicle automatic traveling system and traveling route management device | |
JP6793625B2 (en) | Travel route management system | |
JP6920958B2 (en) | Travel route generator | |
WO2018042853A1 (en) | Autonomous work vehicle travel system, travel route-managing device, travel route-generating device, and travel route-determining device | |
WO2018116770A1 (en) | Work vehicle automatic traveling system | |
WO2018101351A1 (en) | Travel route management system and travel route determination device | |
JP6920970B2 (en) | Travel route determination device | |
JP6842907B2 (en) | Work vehicle automatic driving system | |
JP6920969B2 (en) | Travel route management system | |
JP6789800B2 (en) | Work vehicle automatic driving system | |
JP6982116B2 (en) | Work vehicle automatic driving system and driving route management device | |
KR102452919B1 (en) | work vehicle automatic driving system | |
JP6891097B2 (en) | Travel route determination device | |
JP6689738B2 (en) | Work vehicle automatic traveling system | |
JP2018099112A5 (en) | ||
JP7118119B2 (en) | Work vehicle automatic driving system | |
JP2022028836A5 (en) | ||
JP2020110158A5 (en) | ||
JP6673813B2 (en) | Travel route management system | |
WO2018116771A1 (en) | Traveling path determination device | |
JP7076195B2 (en) | Work vehicle automatic driving system |
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: 20210302 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210430 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20211109 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220105 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220208 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220406 |
|
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: 20220419 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220517 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7076195 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |