JP2022183958A - 自動走行方法、自動走行システム、及び自動走行プログラム - Google Patents
自動走行方法、自動走行システム、及び自動走行プログラム Download PDFInfo
- Publication number
- JP2022183958A JP2022183958A JP2021091524A JP2021091524A JP2022183958A JP 2022183958 A JP2022183958 A JP 2022183958A JP 2021091524 A JP2021091524 A JP 2021091524A JP 2021091524 A JP2021091524 A JP 2021091524A JP 2022183958 A JP2022183958 A JP 2022183958A
- Authority
- JP
- Japan
- Prior art keywords
- work vehicle
- work
- travel
- vehicle
- route
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 71
- 238000012545 processing Methods 0.000 claims description 83
- 239000000463 material Substances 0.000 claims description 3
- 238000005507 spraying Methods 0.000 description 73
- 239000007921 spray Substances 0.000 description 58
- 230000008569 process Effects 0.000 description 35
- 238000003860 storage Methods 0.000 description 29
- 238000004891 communication Methods 0.000 description 28
- 239000000126 substance Substances 0.000 description 25
- 238000005259 measurement Methods 0.000 description 16
- 238000001514 detection method Methods 0.000 description 12
- 238000010586 diagram Methods 0.000 description 8
- 230000006870 function Effects 0.000 description 7
- 238000011084 recovery Methods 0.000 description 7
- 230000005540 biological transmission Effects 0.000 description 3
- 230000002706 hydrostatic effect Effects 0.000 description 3
- 239000007788 liquid Substances 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 239000002420 orchard Substances 0.000 description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 2
- 240000000560 Citrus x paradisi Species 0.000 description 1
- 230000005856 abnormality Effects 0.000 description 1
- 230000003213 activating effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000003306 harvesting Methods 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000002366 time-of-flight method Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000009333 weeding Methods 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
- A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
- A01B69/007—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
- A01B69/008—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01M—CATCHING, TRAPPING OR SCARING OF ANIMALS; APPARATUS FOR THE DESTRUCTION OF NOXIOUS ANIMALS OR NOXIOUS PLANTS
- A01M7/00—Special adaptations or arrangements of liquid-spraying apparatus for purposes covered by this subclass
- A01M7/0089—Regulating or controlling systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Abstract
【課題】走行領域を自動走行する作業車両が作業中に自動走行を停止した場合に、作業車両を停止場所から移動させることが可能な自動走行方法、自動走行システム、及び自動走行プログラムを提供すること。【解決手段】自動走行方法は、圃場Fにおいて、作業車両10が作業車両10の測位情報に基づいて、予め設定された目標経路Rに従って自動走行を行う目標経路用走行モードM1で作業車両10を走行させることと、作業車両10の測位精度が所定精度未満の場合に、目標経路用走行モードM1から、作業車両10が圃場F内に配置された作物Vの位置に応じて走行を行う作物列経路用走行モードM2に切り替えて作業車両10を走行させることと、作物列経路用走行モードM2において、作物Vの位置に応じて設定される作物列経路R0の端点まで作業車両10を走行させることと、を実行する。【選択図】図10
Description
本発明は、走行領域において目標経路に従って作業車両を自動走行させる自動走行方法、自動走行システム、及び自動走行プログラムに関する。
圃場、農園などの作業領域において、衛星から受信する信号(例えばGNSS信号)を利用して作業車両を測位しながら、予め設定された目標経路に従って作業車両を自動走行させるシステムが知られている。また、前記システムにおいて、衛星からの信号が途絶えた場合に、作業車両の自動走行を停止させる技術が提案されている(例えば特許文献1参照)。
従来の前記システムでは、作業車両が自動走行しながら所定の作業を行っているときに衛星からの信号が途絶えると、その時点で作業車両が停止される。このため、例えば作業車両が周囲に十分なスペースを確保できない場所で停止した場合に、オペレータが停止場所で作業車両の復帰作業を行ったり、作業車両を広いスペースに移動させたりすることが困難になる問題が生じる。
本発明の目的は、走行領域を自動走行する作業車両が作業中に自動走行を停止した場合に、作業車両を停止場所から移動させることが可能な自動走行方法、自動走行システム、及び自動走行プログラムに関する。
本発明に係る自動走行方法は、走行領域において、作業車両が当該作業車両の測位情報に基づいて、予め設定された目標経路に従って自動走行を行う第1走行モードで前記作業車両を走行させることと、前記作業車両の測位精度が所定精度未満の場合に、前記第1走行モードから、前記作業車両が前記走行領域内に配置された作業対象物の位置に応じて走行を行う第2走行モードに切り替えて前記作業車両を走行させることと、前記第2走行モードにおいて、前記作業対象物の位置に応じて設定される作業対象物経路の端点まで前記作業車両を走行させることと、を実行する方法である。
本発明に係る自動走行システムは、走行処理部と切替処理部とを備える。前記走行処理部は、走行領域において、作業車両が当該作業車両の測位情報に基づいて、予め設定された目標経路に従って自動走行を行う第1走行モードで前記作業車両を走行させる。前記切替処理部は、前記作業車両の測位精度が所定精度未満の場合に、前記第1走行モードから、前記作業車両が前記走行領域内に配置された作業対象物の位置に応じて走行を行う第2走行モードに切り替える。さらに、前記走行処理部は、前記第2走行モードにおいて、前記作業対象物の位置に応じて設定される作業対象物経路の端点まで前記作業車両を走行させる。
本発明に係る自動走行プログラムは、走行領域において、作業車両が当該作業車両の測位情報に基づいて、予め設定された目標経路に従って自動走行を行う第1走行モードで前記作業車両を走行させることと、前記作業車両の測位精度が所定精度未満の場合に、前記第1走行モードから、前記作業車両が前記走行領域内に配置された作業対象物の位置に応じて走行を行う第2走行モードに切り替えて前記作業車両を走行させることと、前記第2走行モードにおいて、前記作業対象物の位置に応じて設定される作業対象物経路の端点まで前記作業車両を走行させることと、を一又は複数のプロセッサーに実行させるためのプログラムである。
本発明によれば、走行領域を自動走行する作業車両が作業中に自動走行を停止した場合に、作業車両を停止場所から移動させることが可能な自動走行方法、自動走行システム、及び自動走行プログラムを提供することができる。
以下の実施形態は、本発明を具体化した一例であって、本発明の技術的範囲を限定するものではない。
[自動走行システム1]
図1及び図2に示すように、本発明の実施形態に係る自動走行システム1は、作業車両10と、操作端末20と、基地局40と、衛星50とを含んでいる。作業車両10及び操作端末20は、通信網N1を介して通信可能である。例えば、作業車両10及び操作端末20は、携帯電話回線網、パケット回線網、又は無線LANを介して通信可能である。
図1及び図2に示すように、本発明の実施形態に係る自動走行システム1は、作業車両10と、操作端末20と、基地局40と、衛星50とを含んでいる。作業車両10及び操作端末20は、通信網N1を介して通信可能である。例えば、作業車両10及び操作端末20は、携帯電話回線網、パケット回線網、又は無線LANを介して通信可能である。
本実施形態では、作業車両10が、圃場Fに植えられた作物V(図5参照)に薬液、水などを散布する散布作業を行う車両である場合を例に挙げて説明する。圃場Fは本発明の走行領域の一例であり、圃場Fは例えば葡萄園、林檎園などの果樹園である。作物Vは例えば葡萄の果樹である。前記散布作業は、例えば作物Vに薬液、水などの散布物を散布する作業である。他の実施形態として、作業車両10は、除草作業を行う車両、葉刈作業を行う車両、収穫作業を行う車両であってもよい。
作物Vは、圃場Fにおいて所定の間隔で複数列に配置されている。具体的には、図5に示すように、複数の作物Vは、所定の方向(D1方向)に直線状に植えられており、直線状に並ぶ複数の作物Vを含む作物列Vrを構成する。図5には、3つの作物列Vrを例示している。各作物列Vrは列方向(D2方向)に所定の間隔W1で配置されている。隣り合う作物列Vrの間隔W2の領域(空間)は、作業車両10がD1方向に走行しながら作物Vに対して散布作業を行う作業通路となる。
また、作業車両10は、予め設定された目標経路Rに沿って自動走行(自律走行)することが可能である。例えば図6に示すように、作業車両10は、作業開始位置Sから作業終了位置Gまで、作業経路R1(作業経路R1a~R1f)及び移動経路R2を含む目標経路Rに沿って自動走行する。作業経路R1は、作業車両10が作物Vに対して散布作業を行う直線状の経路であり、移動経路R2は、作業車両10が散布作業を行わないで作物列Vr間を移動する経路である。移動経路R2には、例えば旋回経路及び直進経路が含まれる。図6に示す例では、圃場Fにおいて、作物列Vr1~Vr11から成る作物Vが配置されている。図6では、作物Vが植えられている位置(作物位置)を「Vp」で表している。また、図6の圃場Fを走行する作業車両10は、車体100が門型の形状を有しており(図4C参照)、1つの作物列Vrを跨いで走行しながら、当該作物列Vrの作物V及び当該作物列Vrに隣接する作物列Vrに対して薬液を散布する。例えば図6に示すように、作業車両10が作物列Vr5を跨いで走行する場合、作業車両10の左側車体(左側部100L)が作物列Vr4,Vr5の間の作業通路を走行し、作業車両10の右側車体(右側部100R)が作物列Vr5,Vr6の間の作業通路を走行し、かつ作物列Vr4,Vr5,Vr6の作物Vに対して薬液を散布する。
また、作業車両10は、所定の列順序で自動走行を行う。例えば、作業車両10は、作物列Vr1を跨いで走行し、次に作物列Vr3を跨いで走行し、次に作物列Vr5を跨いで走行する。このように、作業車両10は、予め設定された作物列Vrの順番に応じて自動走行を行う。なお、作業車両10は、作物列Vrの配列順に1列ごとに走行してもよいし、複数列おきに走行してもよい。
衛星50は、GNSS(Global Navigation Satellite System)等の衛星測位システムを構成する測位衛星であり、GNSS信号(衛星信号)を送信する。基地局40は、衛星測位システムを構成する基準点(基準局)である。基地局40は、作業車両10の現在位置を算出するための補正情報を作業車両10に送信する。
作業車両10に搭載される測位装置16は、衛星50から送信されるGNSS信号を利用して作業車両10の現在位置(緯度、経度、高度)及び現在方位などを算出する測位処理を実行する。具体的には、測位装置16は、2台の受信機(アンテナ164及び基地局40)が受信する測位情報(GNSS信号など)と基地局40で生成される補正情報とに基づいて作業車両10を測位するRTK(Real Time Kinematic)方式などを利用して作業車両10を測位する。前記測位方式は周知の技術であるため詳細な説明は省略する。作業車両10は、作業車両10の測位の位置精度(測位精度)が所定の精度(閾値)以上の場合に自動走行を行うことが可能に構成されている。
以下、自動走行システム1を構成する各構成要素の詳細について説明する。
[作業車両10]
図3は、作業車両10を左前方側から見た外観図である。図4Aは、作業車両10を左側から見た左側面の外観図であり、図4Bは、作業車両10を右側から見た右側面の外観図であり、図4Cは、作業車両10を背面側から見た背面の外観図である。
図3は、作業車両10を左前方側から見た外観図である。図4Aは、作業車両10を左側から見た左側面の外観図であり、図4Bは、作業車両10を右側から見た右側面の外観図であり、図4Cは、作業車両10を背面側から見た背面の外観図である。
図1~図4に示すように、作業車両10は、車両制御装置11、記憶部12、走行装置13、散布装置14、通信部15、測位装置16、障害物検出装置17、手動走行用操作部18などを備える。車両制御装置11は、記憶部12、走行装置13、散布装置14、測位装置16、障害物検出装置17、手動走行用操作部18などに電気的に接続されている。なお、車両制御装置11及び測位装置16は、無線通信可能であってもよい。
通信部15は、作業車両10を有線又は無線で通信網N1に接続し、通信網N1を介して操作端末20などの外部機器との間で所定の通信プロトコルに従ったデータ通信を実行するための通信インターフェースである。
記憶部12は、各種の情報を記憶するHDD(Hard Disk Drive)又はSSD(Solid State Drive)などの不揮発性の記憶部である。記憶部12には、車両制御装置11に後述の自動走行処理(図10参照)を実行させるための自動走行プログラムなどの制御プログラムが記憶されている。例えば、前記自動走行プログラムは、CD又はDVDなどのコンピュータ読取可能な記録媒体に非一時的に記録されており、所定の読取装置(不図示)で読み取られて記憶部12に記憶される。なお、前記自動走行プログラムは、サーバー(不図示)から通信網N1を介して作業車両10にダウンロードされて記憶部12に記憶されてもよい。また、記憶部12には、操作端末20において生成される目標経路Rの情報を含む経路データが記憶される。例えば、前記経路データは、操作端末20から作業車両10に転送されて記憶部12に記憶される。
ここで、作業車両10は、圃場Fにおいて複数列に並べて植えられた作物V(果樹)を跨いで走行する門型の車体100を備える。図4Cに示すように、車体100は、左側部100Lと、右側部100Rと、左側部100L及び右側部100Rを接続する接続部100Cとにより門型に形成されており、左側部100L、右側部100R、及び接続部100Cの内側に作物Vの通過を許容する空間100Sが確保される。
車体100の左側部100L及び右側部100Rそれぞれの下端部には、クローラ101が設けられている。左側部100Lには、エンジン(不図示)、バッテリー(不図示)などが設けられている。右側部100Rには、散布装置14の貯留タンク14A(図4B参照)などが設けられている。このように、車体100の左側部100L及び右側部100Rに構成部品を振り分けて配置することにより、作業車両10は、左右のバランスの均衡化及び低重心化が図られている。その結果、作業車両10は、圃場Fの斜面などを安定して走行することができる。
走行装置13は、作業車両10を走行させる駆動部である。走行装置13は、エンジン、クローラ101などを備える。
左右のクローラ101は、静油圧式無段変速装置による独立変速が可能な状態でエンジンからの動力により駆動される。これにより、車体100は、左右のクローラ101が前進方向に等速駆動されることにより前進方向に直進する前進状態になり、左右のクローラ101が後進方向に等速駆動されることにより後進方向に直進する後進状態になる。また、車体100は、左右のクローラ101が前進方向に不等速駆動されることにより前進しながら旋回する前進旋回状態になり、左右のクローラ101が後進方向に不等速駆動されることで後進しながら旋回する後進旋回状態になる。また、車体100は、左右いずれか一方のクローラ101が駆動停止された状態で他方のクローラ101が駆動されることによりピボット旋回(信地旋回)状態になり、左右のクローラ101が前進方向と後進方向とに等速駆動されることでスピン旋回(超信地旋回)状態になる。また、車体100は、左右のクローラ101が駆動停止されることで走行停止状態になる。尚、左右のクローラ101は、電動モータにより駆動される電動式に構成されていてもよい。
図4Cに示すように、散布装置14は、薬液などを貯留する貯留タンク14A、薬液などを圧送する散布用ポンプ(不図示)、散布用ポンプを駆動する電動式の散布モータ(不図示)、車体100の背部において縦向き姿勢で左右に2本ずつ並列に備えられた散布管14B、各散布管14Bに3個ずつ備えられた合計12個の散布ノズル14C、薬液などの散布量及び散布パターンを変更する電子制御式のバルブユニット(不図示)、及び、これらを接続する複数の散布用配管(図示せず)などを備えている。
各散布ノズル14Cは、対応する散布管14Bに、上下方向に位置変更可能に取り付けられている。これにより、各散布ノズル14Cは、隣り合う散布ノズル14Cとの間隔及び散布管14Bに対する高さ位置を散布対象物(作物V)に応じて変更することができる。また、各散布ノズル14Cは、車体100に対する高さ位置及び左右位置を散布対象物に応じて変更可能に取り付けられている。
なお、散布装置14において、各散布管14Bに設けられる散布ノズル14Cの数量は、作物Vの種類、各散布管14Bの長さなどに応じて種々の変更が可能である。
図4Cに示すように、複数の散布ノズル14Cのうち、最左端の散布管14Bに設けられた3個の散布ノズル14Cは、車体100の左外方に位置する作物Vaに向けて薬液を左向きに散布する。複数の散布ノズル14Cのうち、最左端の散布管14Bに隣接する左内側の散布管14Bに設けられた3個の散布ノズル14Cは、車体100における左右中央の空間100Sに位置する作物Vbに向けて薬液を右向きに散布する。複数の散布ノズル14Cのうち、最右端の散布管14Bに設けられた3個の散布ノズル14Cは、車体100の右外方に位置する作物Vcに向けて薬液を右向きに散布する。複数の散布ノズル14Cのうち、最右端の散布管14Bに隣接する右内側の散布管14Bに設けられた3個の散布ノズル14Cは、空間100Sに位置する作物Vbに向けて薬液を左向きに散布する。
上記の構成により、散布装置14においては、車体100の左側部100Lに設けられた2本の散布管14Bと6個の散布ノズル14Cとが左側の散布部14Lとして機能する。また、車体100の右側部100Rに設けられた2本の散布管14Bと6個の散布ノズル14Cとが右側の散布部14Rとして機能する。そして、左右の散布部14L,14Rは、車体100の背部において、左右方向への散布が可能な状態で、左右の散布部14L,14Rの間に作物Vbの通過(空間100S)を許容する左右間隔を置いて配置されている。
散布装置14において、散布部14L,14Rによる散布パターンには、散布部14L,14Rのそれぞれが左右の両方向に薬液を散布する4方向散布パターンと、散布部14L,14Rによる散布方向が限定された方向限定散布パターンとが含まれる。前記方向限定散布パターンには、散布部14Lが左右の両方向に薬液を散布し、かつ、散布部14Rが左方向のみに薬液を散布する左側3方向散布パターンと、散布部14Lが右方向のみに薬液を散布し、かつ、散布部14Rが左右の両方向に薬液を散布する右側3方向散布パターンと、散布部14Lが右方向のみに薬液を散布し、かつ、散布部14Rが左方向のみに薬液を散布する2方向散布パターンと、散布部14Lが左方向のみに散布し、かつ、散布部14Rが薬液を散布しない左側1方向散布パターンと、散布部14Rが右方向のみに散布し、かつ、散布部14Lが薬液を散布しない右側1方向散布パターンとが含まれる。
車体100には、測位装置16から取得する測位情報などに基づいて車体100を圃場Fの目標経路Rに従って自動走行させる自動走行制御部、エンジンに関する制御を行うエンジン制御部、静油圧式無段変速装置に関する制御を行うHST(Hydro-Static Transmission)制御部、及び、散布装置14などの作業装置に関する制御を行う作業装置制御部などが搭載されている。各制御部は、マイクロコントローラなどが搭載された電子制御ユニット、マイクロコントローラの不揮発性メモリ(例えばフラッシュメモリなどのEEPROM)に記憶された各種の情報及び制御プログラムなどによって構築されている。不揮発性メモリに記憶された各種の情報には、事前に生成された目標経路Rなどが含まれてもよい。本実施形態では、各制御部を総称して「車両制御装置11」という(図2参照)。
測位装置16は、測位制御部161、記憶部162、通信部163、及びアンテナ164などを備える通信機器である。アンテナ164は、車体100の天井部(接続部100C)の前方及び後方に設けられている(図3参照)。また車体100の天井部には、作業車両10の走行状態を表示する表示灯102などが設けられている(図3参照)。なお、測位装置16には前記バッテリーが接続されており、測位装置16は、前記エンジンの停止中も稼働可能である。
通信部163は、測位装置16を有線又は無線で通信網N1に接続し、通信網N1を介して基地局40などの外部機器との間で所定の通信プロトコルに従ったデータ通信を実行するための通信インターフェースである。
アンテナ164は、衛星から発信される電波(GNSS信号)を受信するアンテナである。アンテナ164が作業車両10の前方及び後方に設けられているため、作業車両10の現在位置及び現在方位を高精度に測位することができる。
測位制御部161は、一又は複数のプロセッサーと、不揮発性メモリ及びRAMなどの記憶メモリとを備えるコンピュータシステムである。記憶部162は、測位制御部161に測位処理を実行させるための制御プログラム、及び、測位情報、移動情報などのデータを記憶する不揮発性メモリなどである。測位制御部161は、アンテナ164が衛星50から受信するGNSS信号に基づいて所定の測位方式(RTK方式など)により作業車両10の現在位置及び現在方位を測位する。
障害物検出装置17は、車体100の前方左側に設けられたライダーセンサー171Lと、車体100の前方右側に設けられたライダーセンサー171Rとを備える(図3参照)。各ライダーセンサーは、例えばライダーセンサーが照射したレーザー光が測距点に到達して戻るまでの往復時間に基づいて測距点までの距離を測定するTOF(Time Of Flight)方式により、ライダーセンサーから測定範囲の各測距点(測定対象物)までの距離を測定する。
ライダーセンサー171Lは、車体100の前方左側の所定範囲が測定範囲に設定されており、ライダーセンサー171Rは、車体100の前方右側の所定範囲が測定範囲に設定されている。各ライダーセンサーは、測定した各測距点までの距離、各測距点に対する走査角(座標)などの測定情報を車両制御装置11に送信する。
また、障害物検出装置17は、車体100の前方側に設けられた左右の超音波センサー172F(図3参照)と、車体100の後方側に設けられた左右の超音波センサー172R(図4A~図4C参照)とを備える。各超音波センサーは、超音波センサーが発信した超音波が測距点に到達して戻るまでの往復時間に基づいて測距点までの距離を測定するTOF方式により、超音波センサーから測定対象物までの距離を測定する。
前方左側の超音波センサー172Fは、車体100の前方左側の所定範囲が測定範囲に設定されており、前方右側の超音波センサー172Fは、車体100の前方右側の所定範囲が測定範囲に設定されており、後方左側の超音波センサー172Rは、車体100の後方左側の所定範囲が測定範囲に設定されており、後方右側の超音波センサー172Rは、車体100の後方右側の所定範囲が測定範囲に設定されている。各超音波センサーは、測定した測定対象物までの距離と測定対象物の方向とを含む測定情報を車両制御装置11に送信する。
また、障害物検出装置17は、車体100の前方側に設けられた左右の接触センサー173F(図3参照)と、車体100の後方側に設けられた左右の接触センサー173R(図4A及び図4B参照)とを備える。車体100の前方側の接触センサー173Fは、接触センサー173Fに障害物が接触した場合に障害物を検出する。車体100の後方側の接触センサー173Rの前方(作業車両10の後方側)には散布装置14が設けられており、接触センサー173Rは、散布装置14に対して障害物が接触した場合に散布装置14が後方(作業車両10の前方側)に移動することにより障害物を検出する。各接触センサーは、障害物を検出した場合に検出信号を車両制御装置11に送信する。
車両制御装置11は、CPU、ROM、及びRAMなどの制御機器を有する。前記CPUは、各種の演算処理を実行するプロセッサーである。前記ROMは、前記CPUに各種の演算処理を実行させるためのBIOS及びOSなどの制御プログラムが予め記憶される不揮発性の記憶部である。前記RAMは、各種の情報を記憶する揮発性又は不揮発性の記憶部であり、前記CPUが実行する各種の処理の一時記憶メモリー(作業領域)として使用される。そして、車両制御装置11は、前記ROM又は記憶部12に予め記憶された各種の制御プログラムを前記CPUで実行することにより作業車両10を制御する。
車両制御装置11は、作業車両10の走行を制御する。具体的には、図2に示すように、車両制御装置11は、判定処理部111、走行処理部112、切替処理部113などの各種の処理部を含む。なお、車両制御装置11は、前記CPUで前記制御プログラムに従った各種の処理を実行することによって前記各種の処理部として機能する。また、一部又は全部の前記処理部が電子回路で構成されていてもよい。なお、前記制御プログラムは、複数のプロセッサーを前記処理部として機能させるためのプログラムであってもよい。
判定処理部111は、作業車両10の測位状態を判定する。具体的には、判定処理部111は、作業車両の測位精度が所定精度以上であるか又は所定精度未満であるかを判定する。より具体的には、測位制御部161は、GNSS信号を受信可能な衛星50の数が所定数以上でありGNSS信号のクオリティの評価値が所定値である場合に前記測位状態が高精度状態であると判定する。前記高精度状態とは、例えば前記測位状態がRTK測位可能な状態をいう。一方、測位制御部161は、GNSS信号を受信可能な衛星50の数が所定数未満でありGNSS信号のクオリティの評価値が所定値でない場合に前記測位状態が低下した(低精度状態)と判定する。前記低精度状態とは、例えば前記測位状態がRTK測位不可能な状態をいう。前記測位状態は、作業車両10の周囲の障害物(防風林、建物など)、受信機(アンテナ164及び基地局40)の異常などの影響により変動する。
判定処理部111は、測位制御部161が判定した測位状態に基づいて前記判定処理を行う。例えば、判定処理部111は、前記測位状態が高精度状態である場合に、作業車両10の測位精度が所定精度以上であると判定する。一方、判定処理部111は、前記測位状態が高精度状態から低下した場合に、作業車両10の測位精度が所定精度未満であると判定する。
走行処理部112は、作業車両10の測位状態に基づいて、作業車両10を走行させる走行処理を実行する。例えば、判定処理部111が作業車両10の測位精度が所定精度以上であると判定した場合に、走行処理部112は、測位装置16により測位される作業車両10の位置及び方位を含む測位情報に基づいて、目標経路Rに沿って作業車両10を自動走行させる目標経路用走行モードM1(本発明の第1走行モードに相当)で走行させる。例えば、測位状態がRTK測位可能な状態である場合に、走行処理部112は、測位装置16により測位される作業車両10の測位情報に基づいて作業車両10を目標経路用走行モードM1で自動走行を開始させる。これにより、作業車両10は、目標経路Rに沿って自動走行を開始する。なお、前記測位状態がRTK測位可能な状態(高精度状態)であることは、作業車両10が自動走行を開始する条件(自動走行開始条件)に含まれる。
ここで、作業車両10が目標経路Rに従って自動走行中に前記測位精度が低下して、RTK測位不可能な状態(所定精度未満)になると、走行処理部112は、作業車両10の位置精度を担保できなくなるため自動走行を中断して作業車両10を停止させる。例えば図7に示すように、作業車両10が作物列Vr5(本発明の第1作業経路の一例)を自動走行しながら散布作業を行っているときに前記測位精度が所定精度未満になった場合に、作業車両10はその時点(位置Pe)で停止する。また、作業車両10は、位置Peで散布作業も停止する。この場合、作業車両10の周囲には作物Vが配置されているため、例えばオペレータは、作業車両10の停止場所(位置Pe)に行って作業車両10の復帰作業を行うことが困難である。
そこで、本実施形態では、作業車両10の前記測位精度が所定精度未満になった場合に、切替処理部113は、作業車両10の走行モードを目標経路用走行モードM1から、作業車両10が圃場F内に配置された作物Vの位置に応じて走行を行う作物列経路用走行モードM2(本発明の第2走行モードに相当)に切り替える。作物列経路用走行モードM2は、例えばライダーセンサー171L,171Rの測定結果に基づいて推定した作物列経路R0に沿って作業車両10を走行させる走行モードである。
走行処理部112は、作業車両10が複数の作業経路R1のうち所定の作業経路R1を走行中に前記測位精度が前記所定精度未満になった場合に、当該作業経路R1の端点まで作業車両10を走行させる。例えば、走行処理部112は、作業経路R1を自動走行中に走行モードが作物列経路用走行モードM2に切り替えられた場合に、作業車両10を作物列経路用走行モードM2で当該作業経路R1の端点まで走行させる。具体的には、障害物検出装置17は、作業経路R1上の障害物の検出結果とライダーセンサー171L,171Rの測定結果とを統合して、作業車両10が跨いでいる作業経路R1、具体的には作物列(図7では作物列Vr5)の作物列経路R0(本発明の作業対象物経路の一例)を推定する。また障害物検出装置17は、推定した作物列経路R0の始点及び終点の位置(座標)を車両制御装置11に送信する。走行処理部112は、作物列経路用走行モードM2において、GNSS信号を用いることなく、推定された作物列経路R0に沿って作業車両10を自動走行させる。
図8には、作物列経路用走行モードM2の走行方法の概要を示している。図8のR0は推定された作物列Vraの経路を表し、Ev1は作物列Vraの始点を表し、Ev2は作物列Vraの終点を表し、Vpは作物列Vraに含まれる作物を表し、Peは前記測位精度が前記所定精度未満になって作業車両10が停止した位置を表している。なお、終点Ev2は、図7に示す終点E2と同一であってもよい。また、始点Ev1は、例えば作物列Vraに含まれる作物Vのうち位置Peに最も近い作物Vの位置である。
走行処理部112は、作物列Vraに対する作業車両10の横方向の位置偏差L1及び方位偏差θ1を算出し、位置偏差L1及び方位偏差θ1が小さくなるように作業車両10の姿勢を制御しながら位置Peから終点Ev2まで走行させる。
ここで、作物列Vraの推定結果には誤差が含まれるため、算出した位置偏差L1及び方位偏差θ1に移動平均フィルターやローパスフィルター等を用いたフィルタリング処理を行うことが好ましい。そして、走行処理部112は、前記フィルタリング処理の結果を用いて作業車両10の走行を制御することが好ましい。
また、作物列Vraの推定精度を高めるために、過去の作物列Vraの推定結果を用いてもよい。この場合、作物列Vraの端点の数を増やす必要があり、過去のデータを使用するために作業車両10の相対移動量を算出し、過去の作物列Vraの検出位置の座標変換が必要になる。前記相対移動量の算出は、クローラ101に取り付けられた回転数センサー及び慣性計測ユニット(IMU)のデータをカルマンフィルタ等の既知の手法で統合し、作物列Vraの移動量を推定する。作業車両10が自動走行中は毎制御周期、測位情報(GNSS位置情報)から終点までの距離を算出しているため、走行処理部112は、測位精度が所定精度未満になる前の終点までの距離の情報と推定した作業車両10の移動量とから、作物列Vraの端点(終点Ev2)への到達判定処理を実行し、端点到達時まで自動走行させる。なお、作物Vの配置状態によってはライダーセンサー171L,171Rセンサーが作物Vを検出できない事態も起こり得る。この場合には、走行処理部112は、作物列Vraの推定エラーが規定回数連続で発生した場合に作物列経路用走行モードM2の自動走行を終了させる。
また、散布作業を中断させるため予め設定された走行速度を維持する必要がないこと、また作業車両10の移動量推定精度及び作物列Vraの検出精度を向上させること、などの理由から、走行処理部112は、作物列経路用走行モードM2の自動走行中の移動速度を、目標経路用走行モードM1における走行速度よりも遅い速度に設定してもよい。また、走行処理部112は、作業車両10を作物列経路用走行モードM2で自動走行させている間、散布作業を停止させる。
走行処理部112は、例えば図7に示す圃場Fにおいて、作業車両10を作物列経路用走行モードM2で自動走行させて作業車両10が作物列Vr5の終点E2に到達すると、終点E2で停止させる。終点E2は作物列経路R0の端点であり、作物Vが配置されていない領域(例えば枕地領域)に含まれる。このため、オペレータは、終点E2で停止した作業車両10の場所まで行って容易に復帰作業などを行うことが可能になる。オペレータが復帰作業を行った結果、前記測位精度が所定精度以上になると、走行処理部112は、走行モードを目標経路用走行モードM1に切り替える。そして、走行処理部112は、作業車両10が停止した終点E2から、測位装置16により測位される前記測位情報に基づいて、目標経路Rに沿って作業車両10を自動走行させる。終点E2は、本発明の端点の一例である。
また、走行処理部112は、作物列経路R0における目標経路用走行モードM1から作物列経路用走行モードM2に切り替えた時点の作業車両10の位置(位置Pe)を記録してもよい。この場合、オペレータが復帰作業を行った結果、前記測位精度が所定精度以上になると、走行処理部112は、走行モードを目標経路用走行モードM1に切り替えて、位置Peから、測位装置16により測位される前記測位情報に基づいて、目標経路Rに沿って作業車両10を自動走行させる。なお、例えば図7において、走行処理部112は、終点E2から目標経路用走行モードM1で作業車両10を自動走行させ、作物列Vr11の作業を終了した後に、作業車両10を位置Peに移動させて位置Peから作物列Vr5の未作業領域を自動走行及び散布作業を実行させてもよい。
以上のように、走行処理部112は、作業車両10の測位精度が所定精度以上である場合に、GNSS信号を利用した測位情報に基づいて目標経路Rに従って作業車両10を自動走行(目標経路用走行モードM1)させ、作業車両10の測位精度が所定精度未満になった場合に、目標経路用走行モードM1から作物列経路用走行モードM2に切り替えて、推定した作物列経路R0に沿って作業車両10を自動走行させる。走行処理部112は、本発明の走行処理部の一例である。
なお、走行処理部112は、操作端末20から走行停止指示を取得すると作業車両10の自動走行を停止させる。例えば、操作端末20の操作画面においてオペレータがストップボタンを押下すると、操作端末20は前記走行停止指示を作業車両10に出力する。走行処理部112は、操作端末20から前記走行停止指示を取得すると、作業車両10の自動走行を停止させる。これにより、作業車両10は、自動走行を停止し、散布装置14による散布作業を停止する。
上述した作業車両10の構成は、本発明の作業車両の一構成例であって、本発明は上述の構成に限定されない。上述の作業車両10は、第1作物列Vrを跨いで走行しながら、前記第1作物列Vrと、前記第1作物列Vrの左右方向それぞれの第2作物列Vrとに散布物を散布する散布作業を行うことが可能な車両である。他の実施形態として、作業車両10は、車体100が門型の形状ではなく、車体100全体が作物列Vrの間(作業通路)を走行する通常の形状であってもよい。この場合、作業車両10は、作物列Vrを跨がずに各作業通路を順に自動走行する。また、散布装置14は、一つの散布部を備え、左右の両方向に薬液を散布する散布パターンと、左方向のみに薬液を散布する散布パターンと、右方向のみに薬液を散布する散布パターンとを切り替えて散布作業を行う。
[操作端末20]
図2に示すように、操作端末20は、制御部21、記憶部22、操作表示部23、及び通信部24などを備える情報処理装置である。操作端末20は、タブレット端末、スマートフォンなどの携帯端末で構成されてもよい。
図2に示すように、操作端末20は、制御部21、記憶部22、操作表示部23、及び通信部24などを備える情報処理装置である。操作端末20は、タブレット端末、スマートフォンなどの携帯端末で構成されてもよい。
通信部24は、操作端末20を有線又は無線で通信網N1に接続し、通信網N1を介して一又は複数の作業車両10などの外部機器との間で所定の通信プロトコルに従ったデータ通信を実行するための通信インターフェースである。
操作表示部23は、各種の情報を表示する液晶ディスプレイ又は有機ELディスプレイのような表示部と、操作を受け付けるタッチパネル、マウス、又はキーボードのような操作部とを備えるユーザーインターフェースである。オペレータは、前記表示部に表示される操作画面において、前記操作部を操作して各種情報(後述の作業車両情報、圃場情報、作業情報など)を登録する操作を行うことが可能である。また、オペレータは、前記操作部を操作して作業車両10に対する作業開始指示、走行停止指示などを行うことが可能である。さらに、オペレータは、作業車両10から離れた場所において、操作端末20に表示される走行軌跡、車体100の周囲画像により、圃場F内を目標経路Rに従って自動走行する作業車両10の走行状態、作業状況、及び周囲の状況を把握することが可能である。
記憶部22は、各種の情報を記憶するHDD又はSSDなどの不揮発性の記憶部である。記憶部22には、制御部21に後述の自動走行処理(図10参照)を実行させるための自動走行プログラムなどの制御プログラムが記憶されている。例えば、前記自動走行プログラムは、CD又はDVDなどのコンピュータ読取可能な記録媒体に非一時的に記録されており、所定の読取装置(不図示)で読み取られて記憶部22に記憶される。なお、前記自動走行プログラムは、サーバー(不図示)から通信網N1を介して操作端末20にダウンロードされて記憶部22に記憶されてもよい。
制御部21は、CPU、ROM、及びRAMなどの制御機器を有する。前記CPUは、各種の演算処理を実行するプロセッサーである。前記ROMは、前記CPUに各種の演算処理を実行させるためのBIOS及びOSなどの制御プログラムが予め記憶される不揮発性の記憶部である。前記RAMは、各種の情報を記憶する揮発性又は不揮発性の記憶部であり、前記CPUが実行する各種の処理の一時記憶メモリー(作業領域)として使用される。そして、制御部21は、前記ROM又は記憶部22に予め記憶された各種の制御プログラムを前記CPUで実行することにより操作端末20を制御する。
図2に示すように、制御部21は、設定処理部211、経路生成処理部212、出力処理部213などの各種の処理部を含む。なお、制御部21は、前記CPUで前記制御プログラムに従った各種の処理を実行することによって前記各種の処理部として機能する。また、一部又は全部の前記処理部が電子回路で構成されていてもよい。なお、前記制御プログラムは、複数のプロセッサーを前記処理部として機能させるためのプログラムであってもよい。
設定処理部211は、作業車両10に関する情報(以下、作業車両情報という。)と、圃場Fに関する情報(以下、圃場情報という。)と、作業(ここでは散布作業)に関する情報(以下、作業情報という。)とを設定して登録する。
前記作業車両情報の設定処理において、設定処理部211は、作業車両10の機種、作業車両10においてアンテナ164が取り付けられている位置、作業機(ここでは散布装置14)の種類、作業機のサイズ及び形状、作業機の作業車両10に対する位置、作業車両10の作業中の車速及びエンジン回転数、作業車両10の旋回中の車速及びエンジン回転数等の情報について、オペレータが操作端末20において登録する操作を行うことにより当該情報を設定する。本実施形態では、作業機の情報として、散布装置14に関する情報が設定される。
前記圃場情報の設定処理において、設定処理部211は、圃場Fの位置及び形状、作業を開始する作業開始位置S及び作業を終了する作業終了位置G(図6参照)、作業方向等の情報について、オペレータが操作端末20において登録する操作を行うことにより当該情報を設定する。なお、作業方向とは、圃場Fから枕地等の非作業領域を除いた領域である作業領域において、散布装置14で散布作業を行いながら作業車両10を走行させる方向を意味する。
圃場Fの位置及び形状の情報は、例えばオペレータが作業車両10を手動により圃場Fの外周に沿って一回り周回走行させ、そのときのアンテナ164の位置情報の推移を記録することで、自動的に取得することができる。また、圃場Fの位置及び形状は、操作端末20に地図を表示させた状態でオペレータが操作端末20を操作して当該地図上の複数の点を指定することで得られた多角形に基づいて取得することもできる。取得された圃場Fの位置及び形状により特定される領域は、作業車両10を走行させることが可能な領域(走行領域)である。
前記作業情報の設定処理において、設定処理部211は、作業情報として、作業車両10が枕地において旋回する場合にスキップする作業経路の数であるスキップ数、枕地の幅等を設定可能に構成されている。
経路生成処理部212は、前記各設定情報に基づいて、作業車両10を自動走行させる経路である目標経路Rを生成する。目標経路Rは、例えば作業開始位置Sから作業終了位置Gまでの経路である(図6参照)。図6に示す目標経路Rは、作物Vが植えられた領域において作物Vに対して薬液を散布する直線状の作業経路R1と、散布作業を行わないで作物列Vr間を移動する移動経路R2とを含む。
目標経路Rの生成方法の一例について図9A及び図9Bを用いて説明する。図9Aには、作物列Vrを模式的に示している。先ず、オペレータは作業車両10を手動により作物列Vrの外周に沿って走行させる(図9A参照)。作業車両10は、走行中に各作物列Vrの一方側(図9Aの下側)の端点E1と他方側(図9Aの上側)の端点E2とを検出し、各端点E1,E2の位置情報(座標)を取得する。なお、端点E1,E2は、既に植えられた作物Vの位置であってもよいし、これから植える予定の作物Vの位置を示す目標物の位置であってもよい。経路生成処理部212は、作業車両10から各端点E1,E2の位置情報(座標)を取得すると、対応する端点E1,E2同士を結ぶ線L1(図9B参照)を作物列Vrの作業経路に設定し、複数の作業経路と移動経路(旋回経路)とを含む目標経路Rを生成する。目標経路Rの生成方法は、上述の方法に限定されない。経路生成処理部212は、生成した目標経路Rを記憶部22に記憶してもよい。
出力処理部213は、経路生成処理部212が生成した目標経路Rの情報を含む経路データを作業車両10に出力する。なお、出力処理部213は、前記経路データをサーバー(不図示)に出力してもよい。前記サーバーは、複数の操作端末20のそれぞれから取得する複数の前記経路データを操作端末20及び作業車両10に関連付けて記憶し管理する。
制御部21は、上述の処理に加えて、各種情報を操作表示部23に表示させる処理を実行する。例えば、制御部21は、作業車両情報、圃場情報、作業情報などを登録する登録画面、目標経路Rを生成する操作画面、作業車両10に自動走行を開始させる操作画面、作業車両10の走行状態などを表示する表示画面などを操作表示部23に表示させる。
また制御部21は、オペレータから各種操作を受け付ける。具体的には、制御部21は、オペレータから作業車両10に作業を開始させる作業開始指示、自動走行中の作業車両10の走行を停止させる走行停止指示などを受け付ける。制御部21は、前記各指示を受け付けると、前記各指示を作業車両10に出力する。
作業車両10の車両制御装置11は、操作端末20から作業開始指示を取得すると、作業車両10の自動走行及び散布作業を開始させる。また、車両制御装置11は、操作端末20から走行停止指示を取得すると、作業車両10の自動走行及び散布作業を停止させる。
なお、操作端末20は、サーバーが提供する農業支援サービスのウェブサイト(農業支援サイト)に通信網N1を介してアクセス可能であってもよい。この場合、操作端末20は、制御部21によってブラウザプログラムが実行されることにより、サーバーの操作用端末として機能することが可能である。
[自動走行処理]
以下、図10を参照しつつ、作業車両10の車両制御装置11によって実行される前記自動走行処理の一例について説明する。
以下、図10を参照しつつ、作業車両10の車両制御装置11によって実行される前記自動走行処理の一例について説明する。
なお、本発明は、前記自動走行処理に含まれる一又は複数のステップを実行する自動走行方法の発明として捉えることができる。また、ここで説明する前記自動走行処理に含まれる一又は複数のステップは適宜省略されてもよい。なお、前記自動走行処理における各ステップは同様の作用効果を生じる範囲で実行順序が異なってもよい。さらに、ここでは車両制御装置11が前記自動走行処理における各ステップを実行する場合を例に挙げて説明するが、一又は複数のプロセッサーが当該自動走行処理における各ステップを分散して実行する自動走行方法も他の実施形態として考えられる。
ステップS1において、車両制御装置11は、自動走行開始条件を満たすか否かを判定する。例えば、車両制御装置11は、作業車両10の現在位置が作業開始位置Sに一致し、かつ作業車両10の測位精度が所定精度以上(測位状態がRTK測位可能な状態)である場合に、前記自動走行開始条件を満たすと判定する(S1:Yes)。この場合、処理はステップS2に移行する。一方、車両制御装置11は、上記両条件のいずれかを満たさない場合には上記両条件を満たすまで待機する(S1:No)。
ステップS2において、車両制御装置11は、操作端末20から作業開始指示を取得したか否かを判定する。例えば、オペレータが操作端末20においてスタートボタンを押下すると、操作端末20は作業開始指示を作業車両10に出力する。車両制御装置11が操作端末20から作業開始指示を取得すると(S2:Yes)、処理はステップS3に移行する。車両制御装置11は、操作端末20から作業開始指示を取得するまで待機する(S2:No)。
ステップS3において、車両制御装置11は、目標経路用走行モードM1による自動走行を開始する。例えば、車両制御装置11は、操作端末20から作業開始指示を取得すると、作業車両10の測位情報(RTK測位情報)に基づいて、前記経路データに含まれる目標経路Rに従って自動走行を開始する。また車両制御装置11は、作物列Vrに対して薬液を散布する散布作業を散布装置14に開始させる。
次にステップS4において、車両制御装置11は、前記測位精度が所定精度未満であるか否かを判定する。前記測位精度が所定精度未満である場合(S4:Yes)、処理はステップS5に移行する。一方、前記測位精度が所定精度以上である場合(S4:No)、処理はステップS11に移行する。このように、車両制御装置11は、作業車両10が目標経路用走行モードM1で自動走行しながら散布作業を行っている間、前記測位精度が所定精度未満であるか否かの判定処理を継続して実行する。
次にステップS5において、車両制御装置11は、作業車両10の現在位置が作業領域内か又は非作業領域(枕地領域)内かを判定する。作業車両10の現在位置が作業領域内である場合(S5:Yes)、処理はステップS6に移行する。作業車両10の現在位置が非作業領域内である場合(S5:No)、処理はステップS51に移行する。
ステップS6において、車両制御装置11は、走行モードを目標経路用走行モードM1から、作業車両10が作物列経路R0に沿って走行を行う作物列経路用走行モードM2に切り替える。車両制御装置11は、走行モードを作物列経路用走行モードM2に切り替えると、作業車両10を作物列経路用走行モードM2で走行させる。例えば、車両制御装置11は、ライダーセンサー171L,171Rの測定結果に基づいて推定した作物列経路R0に沿って、作物列経路R0の終点に向かって自動走行させる。
また、車両制御装置11は、作物列経路用走行モードM2における作業車両10の走行速度を、目標経路用走行モードM1における作業車両10の走行速度よりも遅い速度に設定する。これにより、作業車両10の位置精度が低い状態でも作業車両10を前記終点まで安全に走行させることができる。また、車両制御装置11は、作物列経路用走行モードM2で自動走行させている間、散布作業を停止させる。これにより、作業車両10が終点まで移動する間、散布作業の精度が低い状態で散布作業が行なわれることを防ぐことができる。さらに、車両制御装置11は、目標経路用走行モードM1から作物列経路用走行モードM2に切り替えた時点の作物列経路R0上の作業車両10の位置Peを記録する。これにより、作業車両10の測位精度が所定精度以上に復帰した後に、作業車両10は、位置Peから終点までの未散布領域を確実に散布作業することができる。
次にステップS7において、車両制御装置11は、作業車両10が作物列経路R0の端点に到達したか否かを判定する。具体的には、車両制御装置11は、作業車両10が、推定した作物列経路R0の終点E2(図7参照)に到達したか否かを判定する。作業車両10が作物列経路R0の端点に到達した場合(S7:Yes)、処理はステップS8に移行する。作業車両10が作物列経路R0の端点に到達していない場合(S7:No)、処理はステップS71に移行する。ステップS71では、車両制御装置11は、前記測位精度が所定精度以上であるか否かを判定する。前記測位精度が所定精度以上である場合(S71:Yes)、処理はステップS10に移行する。一方、前記測位精度が所定精度未満である場合(S71:No)、処理はステップS7に戻る。このように、作業車両10が作物列経路用走行モードM2で作物列経路R0を走行しているときに前記測位精度が所定精度以上に復帰すると(S71:Yes)、処理はステップS10に移行する。
ステップS8では、車両制御装置11は、復帰動作を行う。具体的には、車両制御装置11は、作業車両10を終点Ev2で停止させて、終点Ev2においてオペレータによる復帰作業を受け付ける。ステップS8の後、処理はステップS9に移行する。
ステップS9において、車両制御装置11は、前記測位精度が所定精度以上であるか否かを判定する。前記測位精度が所定精度以上である場合(S9:Yes)、処理はステップS10に移行する。一方、前記測位精度が所定精度未満である場合(S9:No)、処理は終了する。例えば、オペレータが終点Ev2で停止した作業車両10の場所まで行って復帰作業などを行うことにより、前記測位精度が所定精度以上に復帰すると、車両制御装置11は、前記測位精度が所定精度以上であると判定する。一方、オペレータが終点Ev2で停止した作業車両10の場所まで行って復帰作業などを行っても前記測位精度が所定精度以上に復帰しない場合には、車両制御装置11は、前記自動走行処理を終了する。この場合、オペレータは、手動操作により作業車両10を圃場F外に移動させて修理などを行う。
ステップS9において、車両制御装置11は、前記測位精度が所定精度以上であるか否かを判定する。前記測位精度が所定精度以上である場合(S9:Yes)、処理はステップS10に移行する。一方、前記測位精度が所定精度未満である場合(S9:No)、処理は終了する。例えば、オペレータが終点Ev2で停止した作業車両10の場所まで行って復帰作業などを行うことにより、前記測位精度が所定精度以上に復帰すると、車両制御装置11は、前記測位精度が所定精度以上であると判定する。一方、オペレータが終点Ev2で停止した作業車両10の場所まで行って復帰作業などを行っても前記測位精度が所定精度以上に復帰しない場合には、車両制御装置11は、前記自動走行処理を終了する。この場合、オペレータは、手動操作により作業車両10を圃場F外に移動させて修理などを行う。
ステップS10では、車両制御装置11は、走行モードを作物列経路用走行モードM2から目標経路用走行モードM1に切り替える。車両制御装置11は、走行モードを目標経路用走行モードM1に切り替えると、作業車両10を再度目標経路用走行モードM1で走行させる。例えば、車両制御装置11は、作業車両10が停止した位置Peから、測位装置16により測位される前記測位情報(RTK測位情報)に基づいて、目標経路Rに沿って作業車両10を自動走行させる。
ステップS11において、車両制御装置11は、作業車両10が作業を終了したか否かを判定する。車両制御装置11は、作業車両10の位置が作業終了位置G(図7参照)に一致する場合に作業を終了したと判定する。作業車両10が作業を終了した場合(S11:Yes)、前記自動走行処理は終了する。車両制御装置11は、作業車両10が作業を終了するまでステップS4~S10の処理を繰り返す(S11:No)。
非作業領域(枕地領域)内で前記測位精度が所定精度未満になった場合(S5:No)、ステップS51において、車両制御装置11は、復帰動作を行う。具体的には、車両制御装置11は、作業車両10を非作業領域(枕地領域)で停止させて、停止場所においてオペレータによる復帰作業を受け付ける。なお、車両制御装置11は、作業車両10の走行モードをリセットする。ステップS51の後、ステップS52において、車両制御装置11は、前記測位精度が所定精度以上であるか否かを判定する。前記測位精度が所定精度以上である場合(S52:Yes)、ステップS10において、車両制御装置11は走行モードを目標経路用走行モードM1に切り替える。一方、前記測位精度が所定精度未満である場合(S52:No)、処理は終了する。
以上説明したように、本実施形態に係る自動走行システム1は、走行領域(例えば圃場F)において、作業車両10が作業車両10の測位情報に基づいて、予め設定された目標経路Rに従って自動走行を行う目標経路用走行モードM1で作業車両10を走行させる。また、自動走行システム1は、作業車両10の測位精度が所定精度未満の場合に、目標経路用走行モードM1から、作業車両10が前記走行領域内に配置された作業対象物(作物V)の位置に応じて走行を行う作物列経路用走行モードM2に切り替えて作業車両10を走行させる。また、自動走行システム1は、作物列経路用走行モードM2において、作業対象物(作物V)の位置に応じて設定される作業対象物経路(作物列経路R0)の端点まで作業車両10を走行させる。
また、本実施形態に係る自動走行方法は、一又は複数のプロセッサーが、走行領域において、作業車両10が作業車両10の測位情報に基づいて、予め設定された目標経路Rに従って自動走行を行う目標経路用走行モードM1で作業車両10を走行させることと、作業車両10の測位精度が所定精度未満の場合に、目標経路用走行モードM1から、作業車両10が前記走行領域内に配置された作業対象物(作物V)の位置に応じて走行を行う作物列経路用走行モードM2に切り替えて作業車両10を走行させることと、作物列経路用走行モードM2において、作業対象物(作物V)の位置に応じて設定される作業対象物経路(作物列経路R0)の端点まで作業車両10を走行させることと、を実行する。
上記の構成によれば、例えば作業車両10が作物列Vr(作業経路R1)を自動走行中に周囲に十分なスペースを確保できない場所で停止した場合に、作業車両10を停止場所から作物列Vrの端点まで移動させることができる。前記端点は例えば、作業対象物(作物V)が配置されていない枕地領域に含まれる。このため、オペレータは、前記端点で停止した作業車両10の場所まで行って容易に復帰作業などを行うことが可能になる。そして、オペレータは、作業車両10を目標経路用走行モードM1による自動走行に迅速に復帰させることができる。
本発明は上述した実施形態に限定されない。本発明の他の実施形態について以下に説明する。
上述の実施形態では、車両制御装置11は、作業車両10の測位精度が所定精度未満の場合に、目標経路用走行モードM1から作物列経路用走行モードM2に切り替えて、作業車両10をライダーセンサー171L,171Rの検出結果を利用して作物列経路R0に沿って自動走行させている。この構成では、例えば圃場Fの路面状態が悪い場合、圃場Fの傾斜が大きい場合などにおいて、作物列経路R0の推定精度が低下し、端点に正確に到達することが困難になることが考えられる。そこで、他の実施形態として、作物列経路用走行モードM2において、オペレータの操作を介在させてもよい。
具体的には、他の実施形態として、車両制御装置11は、作業車両10の測位精度が所定精度未満の場合に、目標経路用走行モードM1から作物列経路用走行モードM2に切り替えると、オペレータの所定の操作に基づいて、作業車両10を作物列経路R0(作業経路R1)の端点まで走行させる。
ここで、前記オペレータの操作(本発明の所定の操作)は、作業車両10を停止場所(位置Pe)から前記端点まで自動走行させる許可を与える指示操作であってもよいし、作業車両10を停止場所(位置Pe)から前記端点まで手動走行させる走行操作であってもよい。
例えば、作物列Vrの作業経路R1を自動走行しながら散布作業を行っているときに作業車両10の測位精度が所定精度未満になった場合に、車両制御装置11は、目標経路用走行モードM1から作物列経路用走行モードM2に切り替える。そして、オペレータは、操作端末20、スマートフォンなどの操作機器において、自動走行を許可する許可ボタンを選択して自動走行指示を行う。車両制御装置11は、操作端末20から前記自動走行指示を取得すると、作物列経路用走行モードM2で作業車両10を位置Peから前記端点まで自動走行させる。例えばオペレータは、作業車両10が停止した位置Peの周囲を目視により確認して操作端末20において前記指示操作を行うことができる。また、例えばオペレータは、作業車両10から離れた遠隔地で操作端末20において前記指示操作を行うことができる。
また、例えば作物列Vrの作業経路R1を自動走行しながら散布作業を行っているときに作業車両10の測位精度が所定精度未満になった場合に、車両制御装置11は、目標経路用走行モードM1から作物列経路用走行モードM2に切り替える。そして、オペレータは、作業車両10に設けられた手動走行用操作部18(図4B参照)を操作して作業車両10を手動走行させる。図11には、手動走行用操作部18の外観を示している。手動走行用操作部18は、手動走行モードを有効化する電源スイッチ181と、作業車両10を前進及び後進させる操作スイッチ182と、作業車両10を右旋回及び左旋回させる操作スイッチ183と、手動走行モードが有効な場合に点灯するLED184とを備えている。なお、手動走行用操作部18は、通信ケーブル(不図示)を介して作業車両10の車両制御装置11に接続されている。車両制御装置11は、手動走行用操作部18の操作に応じて作業車両10を走行させる。例えばオペレータは、手動走行用操作部18の電源スイッチ181をON状態にして、操作スイッチ182により前進の指示操作を行う。車両制御装置11は、前進の指示操作を受け付けている間だけ、作業車両10を前記端点向かって前進走行させる。
また、他の実施形態として、例えば、車両制御装置11が作物列経路用走行モードM2で作業車両10を作物列経路R0の端点に向かって自動走行させている間に前記測位精度が所定精度以上に復帰した場合には、車両制御装置11は、走行モードを目標経路用走行モードM1に切り替えて作業車両10を自動走行させてもよい。これにより、作業車両10が作物列経路用走行モードM2で走行する距離を最短距離に抑えることができる。
また、他の実施形態として、車両制御装置11は、前記測位精度が所定精度未満になった場所(位置Pe)に応じて作業車両10の進行方向を制御してもよい。例えば、位置Peが作物列経路R0(作業経路R1)の終点E2よりも始点E1に近い場合(図7参照)、車両制御装置11は、作業車両10を位置Peから始点E1に向かって後進させる。このように、車両制御装置11は、作業車両10を作物列経路用走行モードM2で走行させる場合には、作業車両10を位置Peに近い方の端点に向けて走行させてもよい。これにより、作業車両10が作物列経路用走行モードM2で走行する距離を最短距離に抑えることができる。始点E1は、本発明の端点の一例である。また、始点E1は作業経路R1の端点であり、作物Vが配置されていない領域(例えば枕地領域)に含まれる。
1 :自動走行システム
10 :作業車両
11 :車両制御装置
111 :判定処理部
112 :走行処理部
113 :切替処理部
14 :散布装置
16 :測位装置
17 :障害物検出装置
18 :手動走行用操作部
20 :操作端末
211 :設定処理部
212 :経路生成処理部
213 :出力処理部
40 :基地局
50 :衛星
F :圃場(走行領域)
E1 :始点(端点)
E2 :終点(端点)
R :目標経路
R0 :作物列経路
V :作物(作業対象物)
Vr :作物列
M1 :目標経路用走行モード(第1走行モード)
M2 :作物列経路用走行モード(第2走行モード)
10 :作業車両
11 :車両制御装置
111 :判定処理部
112 :走行処理部
113 :切替処理部
14 :散布装置
16 :測位装置
17 :障害物検出装置
18 :手動走行用操作部
20 :操作端末
211 :設定処理部
212 :経路生成処理部
213 :出力処理部
40 :基地局
50 :衛星
F :圃場(走行領域)
E1 :始点(端点)
E2 :終点(端点)
R :目標経路
R0 :作物列経路
V :作物(作業対象物)
Vr :作物列
M1 :目標経路用走行モード(第1走行モード)
M2 :作物列経路用走行モード(第2走行モード)
Claims (11)
- 走行領域において、作業車両が当該作業車両の測位情報に基づいて、予め設定された目標経路に従って自動走行を行う第1走行モードで前記作業車両を走行させることと、
前記作業車両の測位精度が所定精度未満の場合に、前記第1走行モードから、前記作業車両が前記走行領域内に配置された作業対象物の位置に応じて走行を行う第2走行モードに切り替えて前記作業車両を走行させることと、
前記第2走行モードにおいて、前記作業対象物の位置に応じて設定される作業対象物経路の端点まで前記作業車両を走行させることと、
を実行する自動走行方法。 - 前記第2走行モードにおいて、前記作業対象物経路の端点まで前記作業車両を前記作業対象物の位置に応じて自動走行させる、
請求項1に記載の自動走行方法。 - 前記第2走行モードにおいて、ユーザーの操作に基づいて、前記作業対象物経路の端点まで前記作業車両を走行させる、
請求項1に記載の自動走行方法。 - 前記第2走行モードにおいて、ユーザーの所定の操作を受け付けた場合に、前記作業対象物経路の端点まで前記作業車両を前記作業対象物の位置に応じて自動走行させる、
請求項3に記載の自動走行方法。 - 前記第2走行モードにおける前記作業車両の走行速度を、前記第1走行モードにおける前記作業車両の走行速度よりも遅い速度に設定する、
請求項1~4のいずれかに記載の自動走行方法。 - 前記第2走行モードにおいて、前記作業車両による前記作業対象物に対する作業を停止させる、
請求項1~5のいずれかに記載の自動走行方法。 - 前記作業対象物経路における前記第1走行モードから前記第2走行モードに切り替えた時点の前記作業車両の位置を記録する、
請求項1~6のいずれかに記載の自動走行方法。 - 前記作業対象物経路の端点は、前記作業対象物が配置されていない領域又は枕地領域に含まれる、
請求項1~7のいずれかに記載の自動走行方法。 - 前記作業車両は、第1作業対象物を跨いで走行しながら、前記第1作業対象物と、前記第1作業対象物の左右方向それぞれの第2作業対象物とに散布物を散布する散布作業を行うことが可能な車両である、
請求項1~8のいずれかに記載の自動走行方法。 - 走行領域において、作業車両が当該作業車両の測位情報に基づいて、予め設定された目標経路に従って自動走行を行う第1走行モードで前記作業車両を走行させる走行処理部と、
前記作業車両の測位精度が所定精度未満の場合に、前記第1走行モードから、前記作業車両が前記走行領域内に配置された作業対象物の位置に応じて走行を行う第2走行モードに切り替える切替処理部と、
を備え、
前記走行処理部は、前記第2走行モードにおいて、前記作業対象物の位置に応じて設定される作業対象物経路の端点まで前記作業車両を走行させる、
自動走行システム。 - 走行領域において、作業車両が当該作業車両の測位情報に基づいて、予め設定された目標経路に従って自動走行を行う第1走行モードで前記作業車両を走行させることと、
前記作業車両の測位精度が所定精度未満の場合に、前記第1走行モードから、前記作業車両が前記走行領域内に配置された作業対象物の位置に応じて走行を行う第2走行モードに切り替えて前記作業車両を走行させることと、
前記第2走行モードにおいて、前記作業対象物の位置に応じて設定される作業対象物経路の端点まで前記作業車両を走行させることと、
を一又は複数のプロセッサーに実行させるための自動走行プログラム。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021091524A JP2022183958A (ja) | 2021-05-31 | 2021-05-31 | 自動走行方法、自動走行システム、及び自動走行プログラム |
EP22174750.4A EP4098094A3 (en) | 2021-05-31 | 2022-05-23 | Automatic traveling method, automatic traveling system, and automatic traveling program |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021091524A JP2022183958A (ja) | 2021-05-31 | 2021-05-31 | 自動走行方法、自動走行システム、及び自動走行プログラム |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2022183958A true JP2022183958A (ja) | 2022-12-13 |
Family
ID=81841871
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021091524A Pending JP2022183958A (ja) | 2021-05-31 | 2021-05-31 | 自動走行方法、自動走行システム、及び自動走行プログラム |
Country Status (2)
Country | Link |
---|---|
EP (1) | EP4098094A3 (ja) |
JP (1) | JP2022183958A (ja) |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8649930B2 (en) * | 2009-09-17 | 2014-02-11 | Agjunction Llc | GNSS integrated multi-sensor control system and method |
EP3104244B1 (en) | 2014-02-06 | 2019-03-27 | Yanmar Co., Ltd. | Parallel travel work system |
JP7019310B2 (ja) * | 2017-05-29 | 2022-02-15 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
CN112752500A (zh) * | 2018-08-01 | 2021-05-04 | 株式会社久保田 | 收获机、行驶系统、行驶方法、行驶程序以及存储介质 |
JP7348731B2 (ja) * | 2019-02-26 | 2023-09-21 | ヤンマーパワーテクノロジー株式会社 | 作業車両 |
WO2020205781A1 (en) * | 2019-03-29 | 2020-10-08 | Birger Iftach | Methods and systems for detection of false positives in detection of agricultural spraying errors |
JP7227070B2 (ja) * | 2019-05-17 | 2023-02-21 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
-
2021
- 2021-05-31 JP JP2021091524A patent/JP2022183958A/ja active Pending
-
2022
- 2022-05-23 EP EP22174750.4A patent/EP4098094A3/en active Pending
Also Published As
Publication number | Publication date |
---|---|
EP4098094A3 (en) | 2022-12-21 |
EP4098094A2 (en) | 2022-12-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11960295B2 (en) | 3-D image system for vehicle control | |
EP3351077B1 (en) | Travel route generation device and travel route generation program | |
JP6688747B2 (ja) | 自動的なビーコン位置判定 | |
KR102121646B1 (ko) | 포장 상태 검지 시스템 | |
WO2015139050A1 (en) | Implement and boom height control | |
US11852484B2 (en) | Method for determining the orientation of a robot, orientation determination apparatus of a robot, and robot | |
KR102168104B1 (ko) | 농업용기계의 자율 주행 방법 | |
JP2016189172A (ja) | 自動走行情報管理システム | |
US20220382291A1 (en) | Route Generation Method, Route Generation Device, and Route Generation Program | |
EP4099125B1 (en) | Automatic traveling method, automatic traveling system, and automatic traveling program | |
EP4098094A2 (en) | Automatic traveling method, automatic traveling system, and automatic traveling program | |
JP2022183957A (ja) | 自動走行方法、自動走行システム、及び自動走行プログラム | |
US20220382288A1 (en) | Route Generation Method, Route Generation Device, And Route Generation Program | |
JP2022183963A (ja) | 散布作業方法、散布作業システム、及び散布作業プログラム | |
EP4099120A1 (en) | Route determination method, route determination system, and route determination program | |
JP2022183956A (ja) | 自動走行方法、自動走行システム、及び自動走行プログラム | |
EP4099124A1 (en) | Automatic traveling method, automatic traveling system, and automatic traveling program | |
EP4104651A1 (en) | Automatic traveling method, automatic traveling system, and automatic traveling program | |
JP6982105B2 (ja) | 作業機 | |
JP2023072849A (ja) | 作業管理方法、作業管理システム、及び作業管理プログラム | |
JP2023072848A (ja) | 作業管理方法、作業管理システム、及び作業管理プログラム | |
JP2023127875A (ja) | 自動走行方法、自動走行システム、及び自動走行プログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20240222 |