JP2021163268A - 農業機械 - Google Patents

農業機械 Download PDF

Info

Publication number
JP2021163268A
JP2021163268A JP2020065146A JP2020065146A JP2021163268A JP 2021163268 A JP2021163268 A JP 2021163268A JP 2020065146 A JP2020065146 A JP 2020065146A JP 2020065146 A JP2020065146 A JP 2020065146A JP 2021163268 A JP2021163268 A JP 2021163268A
Authority
JP
Japan
Prior art keywords
vehicle body
automatic
line
travel
control unit
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
Application number
JP2020065146A
Other languages
English (en)
Inventor
孝紀 森本
Takanori Morimoto
祐介 ▲高▼橋
Yusuke Takahashi
佑輔 南方
Yusuke Minakata
幹太 中口
Kanta NAKAGUCHI
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kubota Corp
Original Assignee
Kubota Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kubota Corp filed Critical Kubota Corp
Priority to JP2020065146A priority Critical patent/JP2021163268A/ja
Priority to PCT/JP2021/008345 priority patent/WO2021199879A1/ja
Priority to EP21781268.4A priority patent/EP4129035A4/en
Publication of JP2021163268A publication Critical patent/JP2021163268A/ja
Priority to US17/951,261 priority patent/US20230015153A1/en
Pending legal-status Critical Current

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/007Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
    • A01B69/008Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/001Steering by means of optical assistance, e.g. television cameras
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0011Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement
    • G05D1/0016Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement characterised by the operator's input device
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0055Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements
    • G05D1/0061Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements for transition from automatic pilot to manual pilot and vice versa
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0217Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0255Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Environmental Sciences (AREA)
  • Mechanical Engineering (AREA)
  • Soil Sciences (AREA)
  • Mathematical Physics (AREA)
  • Theoretical Computer Science (AREA)
  • Computing Systems (AREA)
  • Acoustics & Sound (AREA)
  • Optics & Photonics (AREA)
  • Electromagnetism (AREA)
  • Guiding Agricultural Machines (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

【課題】少なくとも走行予定ラインから離れた車体を走行予定ラインに近づけた後に自動走行を行う場合に、スムーズに自動走行へ移行することができるようにする。【解決手段】農業機械は、走行可能な車体と、操作された場合に車体の自動走行の開始を指令する走行スイッチと、指令が出力された場合に走行予定ラインに基づいて車体の自動走行を行う自動走行制御部と、を備え、自動走行制御部は、走行スイッチによる指令が行われた際に、選択された走行予定ラインと車体との位置偏差及び走行予定ラインと車体の方位との方位偏差のいずれかが第1閾値以上である場合、位置偏差及び方位偏差を第1閾値未満にするライン合わせを実行する。【選択図】図12D

Description

本発明は、例えば、トラクタ、コンバイン、田植機等の農業機械に関する。
従来、自動走行を行う農業機械として、特許文献1に開示された農業機械が知られている。特許文献1に開示の農業機械(農用作業車)は、自車位置を算定する自車位置算定部と、自車の走行方位を算定する自車方位算定部と、目標走行経路に対する自車の横方向の位置ずれである位置偏差を演算する位置偏差演算部と、目標走行経路の方位線と走行方位との間の方位偏差を演算する方位偏差演算部と、位置偏差と目標位置偏差とを入力パラメータとして第1操舵値を出力する第1制御演算部と、方位偏差と目標方位偏差と位置偏差とを入力パラメータとして第2操舵値を出力する第2制御演算部と、第1操舵値と前記第2操舵値とに基づいて目標走行経路に沿って走行するための目標操舵値を出力する目標操舵演算部と、目標操舵値を入力として操舵駆動信号を出力する操舵駆動制御部と、操舵駆動信号に基づいて操向輪の操舵を行う操舵駆動部とを備えている。
特開2019−38535号公報
特許文献1に開示の農業機械にあっては、位置偏差及び方位偏差によって目標走行経路に沿って農業機械を走行させることができる。しかしながら、特許文献1の農業機械では、自動走行を中断して、目標走行経路からトラクタを離脱させた後に、再び目標走行経路に農業機械を戻した後、スムーズに自動走行に移行することが困難であった。
本発明は、このような実情に鑑みて、少なくとも走行予定ラインから離れた車体を走行予定ラインに近づけた後に自動走行を行う場合に、スムーズに自動走行へ移行することができる農業機械を提供することを目的とする。
農業機械は、走行可能な車体と、操作された場合に前記車体の自動走行の開始を指令する走行スイッチと、前記指令が出力された場合に走行予定ラインに基づいて前記車体の自動走行を行う自動走行制御部と、を備え、前記自動走行制御部は、前記走行スイッチによる指令が行われた際に、選択された前記走行予定ラインと前記車体との位置偏差及び前記走行予定ラインと前記車体の方位との方位偏差のいずれかが第1閾値以上である場合、前記位置偏差及び方位偏差を前記第1閾値未満にするライン合わせを実行する。
前記走行予定ラインは、前記車体を直進させる直進部と、前記車体を旋回させる旋回部とを含み、前記自動走行制御部は、前記直進部と前記車体との位置偏差及び前記直進部と前記車体の方位との方位偏差のいずれかが第1閾値以上であるかを判断し、前記第1閾値以上である場合には、前記ライン合わせとして、前記直進部に対する前記位置偏差及び方位偏差を前記第1閾値未満にする。
前記自動走行制御部は、前記ライン合わせにおいて、前記車体を前進させた後、前記車体を後進させる切り返しを行う。
前記自動走行制御部は、前記ライン合わせにおいて、前記切り返しを複数回行い、前記切り返しの回数が予め定められた回数以上となった場合には、前記自動走行を開始する。
前記自動走行制御部は、前記走行スイッチによる指令が行われたときの前記車体の位置である車***置と、前記車体の進行方向における走行予定ラインの端部との距離が予め定められた距離よりも短い場合には前記ライン合わせを実行しない。
農業機械は、前記車体に装着された作業装置を取得する装置取得部を備え、前記自動走行制御部は、前記装置取得部が取得した作業装置が予め定められた作業装置である場合に前記ライン合わせを実行しない。
農業機械は、前記車体の位置である車***置を検出する位置検出装置を備え、前記自動走行制御部は、前記走行スイッチによる指令が行われた際に、前記位置検出装置が検出した車***置が前記走行予定ラインに定められた開始位置である場合に、前記車***置を前記開始位置に合わす位置合わせを行う。
前記自動走行制御部は、前記位置偏差及び前記方位偏差のいずれかが第1閾値よりも大きい第2閾値以上である場合に、前記車体の自動走行を行う。
本発明によれば、少なくとも走行予定ラインから離れた車体を走行予定ラインに近づけた後に自動走行を行う場合に、スムーズに自動走行へ移行することができる。
トラクタの全体平面図である。 トラクタの全体側面図である。 トラクタの前部の拡大側面図である。 障害物検出装置が検出位置である場合のトラクタの正面図である。 障害物検出装置が退避位置である場合のトラクタの正面図である。 トラクタの制御系のブロック図である。 障害物検出装置を検出位置としてカバーを仮想線で示した平面図である。 障害物検出装置が検出位置である場合のトラクタの前部の側面図である。 カバー本体から分離カバーを取り外した状態の斜視図である。 作成画面M1の一例を示す図である。 運転画面M5の一例を示す図である。 自動走行開始前の一例を示す図である。 自動走行中の一例を示す図である。 自動走行を中断後に、手動走行を行った一例を示す図である。 ライン合わせの一例を示す図である。 直進部が折れ曲がっている状態を示す図である。 走行予定ラインの途中から自動走行を開始した場合の一例を示す図である。 自動走行の動作を示すフローである。 設定画面M6の一例を示す図である。
以下、本発明の好適な実施形態について、図面に基づいて説明する。
図1、図2は本発明に係る農業機械1の一実施形態を示している。本実施形態では、農業機械1がトラクタ1であるとして説明する。但し、農業機械1は、トラクタの他、コンバイン、田植機等の他の農業機械(農業車両)であってもよい。
以下、説明の便宜上、図1、図2の矢印A1の方向を前方、矢印A2の方向を後方、矢印B1の方向を左方、矢印B2の方向を右方、矢印Dの方向を車体幅方向(又は幅方向)という。また、車体幅方向であって車体幅方向の中心から離れる方向(矢印D1方向)を車体幅方向外方(又は外方)、車体幅方向であって車体幅方向の中心に近づく方向(矢印D2方向)を車体幅方向内方(又は内方)という。
<トラクタ>
図1、図2に示すように、トラクタ1は、車体3と、原動機4と、変速装置5とを備えている。車体3には、走行装置7が設けられている。走行装置7は、車体3を走行可能に支持しており、前輪7F及び後輪7Rを有している。前輪7F及び後輪7Rは、本実施形態の場合はタイヤ型であるが、クローラ型であってもよい。原動機4は、エンジン(ディーゼルエンジン、ガソリンエンジン)、電動モータ等である。変速装置5は、変速によって走行装置7の推進力を切り換え可能であると共に、走行装置7の前進、後進の切り換えが可能である。車体3には運転席10が設けられている。運転席10は、保護装置9により保護されている。本実施形態の場合、保護装置9は、運転席10の前方、後方、上方及び側方を取り囲むことにより運転席10を保護するキャビンであるが、少なくとも運転席10の上方を覆うことにより運転席10を保護するロプス等であってもよい。保護装置9の下方には、フェンダ13が取り付けられており、フェンダ13は後輪7Rの上部を覆っている。
車体3の後部には、3点リンク機構等で構成された連結部(図示略)が設けられている。連結部には、作業装置(インプルメント等)2を着脱可能に連結することができる。作業装置2を連結部に連結することによって、車体3によって作業装置2を牽引することができる。作業装置2は、耕耘する耕耘装置、肥料を散布する肥料散布装置、農薬を散布する農薬散布装置、収穫を行う収穫装置、牧草等の刈取を行う刈取装置、牧草等の拡散を行う拡散装置、牧草等の集草を行う集草装置、牧草等の成形を行う成形装置等である。
車体3は、車体フレーム20を有している。図1に示すように、車体フレーム20は、左側に設けられた車体フレーム20Lと、右側に設けられた車体フレーム20Rとを含む。車体フレーム20L及び車体フレーム20Rは、それぞれは変速装置5側から前方に延設されていて、原動機4の下部を支持している。車体フレーム20Lと車体フレーム20Rとは車体幅方向に離間している。車体フレーム20Lの前端部と車体フレーム20Rの前端部とは、前連結板20Fにより連結されている。車体フレーム20Lの中途部と車体フレーム20Rの中途部とは、中途連結板20Mにより連結されている。車体フレーム20L及び車体フレーム20Rは、前車軸ケース29を支持している。前車軸ケース29内には、前輪7Fを回転自在に支持する前車軸15(図6参照)が収容されている。つまり、本実施形態の場合、車体フレーム20は、前車軸15を支持する前車軸フレームである。なお、車体フレーム20は、前車軸ケース29以外の構造体を支持するフレーム(前車軸フレーム以外のフレーム)であってもよい。
図1〜図3に示すように、車体フレーム20の上方にはボンネット25が設けられている。ボンネット25は、車体フレーム20に沿って前後方向に延設されている。ボンネット25は、保護装置9の幅方向の中央部の前方に配置されている。ボンネット25は、左側に設けられた左側壁25Lと、右側に設けられた右側壁25Rと、左側壁25Lと右側壁25Rとの上部を連結する上壁部25Uとを有している。左側壁25L、右側壁25R及び上壁部25Uによってエンジンルームが形成され、エンジンルームに原動機4、冷却ファン、ラジエータ、バッテリ等が収容されている。左側壁25Lの左側方と右側壁25Rの右側方には、それぞれ前輪7Fが配置されている。
ボンネット25の前側、即ち、車体フレーム20L、20Rの前側には、ウエイト26が設けられている。ウエイト26は、車体3の前部に設けられたウエイトブラケット(ウエイト取付部)27に取り付けられている。ウエイトブラケット27は、車体フレーム20Lの前連結板20Fにボルト等の締結具により取り付けられている。ウエイト26の周囲は、ウエイトカバー100により覆われている。
図6に示すように、トラクタ1は、操舵装置11を備えている。操舵装置11は、ハンドル(ステアリングホイール)11aと、ハンドル11aの回転に伴って回転する回転軸(操舵軸)11bと、ハンドル11aの操舵を補助する補助機構(パワーステアリング機構)11cと、を有している。補助機構11cは、油圧ポンプ21と、油圧ポンプ21から吐出した作動油が供給される制御弁22と、制御弁22により作動するステアリングシリンダ23とを含む。制御弁22は、制御信号に基づいて作動する電磁弁である。制御弁22は、例えば、スプール等の移動によって切り換え可能な3位置切換弁である。また、制御弁22は、操舵軸11bの操舵によっても切り換え可能である。ステアリングシリンダ23は、前輪7Fの向きを変えるアーム(ナックルアーム)24に接続されている。
したがって、ハンドル11aを操作すれば、ハンドル11aに応じて制御弁22の切換位置及び開度が切り換わり、制御弁22の切換位置及び開度に応じてステアリングシリンダ23が左又は右に伸縮することによって、前輪7Fの操舵方向を変更することができる。なお、上述した操舵装置11は一例であり、操舵装置11の構成は上述した構成に限定されない。
<位置検出装置>
図1、図2に示すように、トラクタ1は、位置検出装置30を備えている。位置検出装置30は、保護装置9の天板の前方に装着体31を介して装着されている。但し、位置検出装置30の装着位置は、図示の位置には限定されず、保護装置9の天板上に装着してもよいし、車体3の別の場所に装着してもよい。また、位置検出装置30は、上述した耕耘装置等の作業装置2に装着されていてもよい。
位置検出装置30は、衛星測位システムによって自己の位置(緯度、経度を含む測位情報)を検出する装置である。即ち、位置検出装置30は、測位衛星から送信された信号(測位衛星の位置、送信時刻、補正情報等)を受信し、受信した信号に基づいて位置(緯度、経度)を検出する。位置検出装置30は、測位衛星からの信号を受信可能な基地局(基準局)からの補正等の信号に基づいて補正した位置を、自己の位置(緯度、経度)として検出してもよい。また、位置検出装置30がジャイロセンサや加速度センサ等の慣性計測装置を有し、慣性計測装置によって補正した位置を、自己の位置として検出してもよい。位置検出装置30によって、トラクタ1の車体3の位置(走行位置)を検出することができる。
<障害物検出装置>
図1に示すように、トラクタ1は、複数の障害物検出装置45を備えている。複数の障害物検出装置45のそれぞれは、トラクタ1の周囲に存在する物体、即ち、障害物を検出可能である。複数の障害物検出装置45のうち、少なくとも1つは、保護装置9の前方で且つボンネット25の外方に設けられている。即ち、少なくとも1つの障害物検出装置45は、トラクタ1の保護装置9の前方の領域において、ボンネット25の左側壁25Lよりも左側の領域、或いは、ボンネット25の右側壁25Rよりも右側の領域に配置されている。本実施形態の場合、複数の障害物検出装置45は、車体3の左側(ボンネット25の左側)に設けられた障害物検出装置45Lと、車体3の右側(ボンネット25の右側)に設けられた障害物検出装置45Rとを含む。
また、障害物検出装置45は、前輪7Fの前方であって且つ前輪7Fよりも外方に設けられている。障害物検出装置45Lは、左側の前輪7Fの前方であって且つ左側の前輪7よりも外方(左方)に設けられている。障害物検出装置45Rは、右側の前輪7Fの前方であって且つ右側の前輪7Fよりも外方(右方)に設けられている。言い換えれば、障害物検出装置45Lは左側の前輪7Fの左前方に設けられており、障害物検出装置45Rは、右側の前輪7Fの右前方に設けられている
障害物検出装置45は、レーザスキャナ45A、ソナー45B等である。レーザスキャナ45Aは、検出波としてレーザを照射することによって物体(障害物)を検出する。レーザスキャナ45Aは、レーザの照射から受光までの時間に基づいて障害物までの距離を検出する。図9に示すように、レーザスキャナ45Aは、投受光部45A1と収容体45A2とを含んでいる。投受光部45A1は、レーザを照射し且つ、照射したレーザが障害物に当たって反射したレーザ(反射光)を受光する。つまり、投受光部45A1は、レーザ(検出波)を照射する照射部と、障害物に当たって反射したレーザ(検出波)を受信する受信部とを含んでいる。収容体45A2は、投受光部45A1を収容して支持するケースである。収容体45A2は、投受光部45A1の上方に配置された上部体45A3と、投受光部45A1の下方に配置された下部体45A4とを有している。上部体45A3と下部体45A4との間、即ち投受光部45A1の周囲は、全部又は一部が開放されており、レーザ(検出波)が通過可能である。
ソナー45Bは、検出波として音波を照射することによって物体(障害物)を検出する。図9に示すように、ソナー45Bは、投受音部45B1と収容体45B2とを含んでいる。投受音部45B1は、音波を照射し且つ、当該照射した音波が障害物に当たって反射した反射音を受ける。つまり、投受音部45B1は、音波(検出波)を照射する照射部と、障害物に当たって反射した音波(検出波)を受信する受信部とを含んでいる。収容体45B2は、投受音部45B1を収容して支持するケースである。ソナー45Bは、音波の照射から反射音の受音までの時間に基づいて、障害物までの距離を検出する。
図1に示すように、レーザスキャナ45A及びソナー45Bは、前輪7Fの前方であって、前輪7Fよりも外方に配置されている。より詳しくは、レーザスキャナ45A及びソナー45Bは、少なくとも受信部(投受光部45A1、投受音部45B1)が前輪7Fの前方且つ前輪7Fよりも外方に配置されている。
図4に示すように、レーザスキャナ45A及びソナー45Bは、ボンネット25の上壁部25Uよりも下方であって、前輪7Fの上端部よりも低い位置に設置されている。そのため、レーザスキャナ45Aの投受光部45A1及びソナー45Bの投受音部45B1も、ボンネット25の上壁部25Uよりも下方であって、前輪7Fの上端部よりも低い位置に設置されている。また、レーザスキャナ45A(投受光部45A1)及びソナー45B(投受音部45B1)は、前輪7Fの上端部よりも下方であって且つ前車軸15よりも上方に位置している。
図1,図4に示すように、レーザスキャナ45Aは、ソナー45Bよりも外方に配置されている。具体的には、図1に示すように、レーザスキャナ45A(投受光部45A1)は、前輪7Fが車体3を直進させる位置にある状態(ハンドル11aが切られていない状態)において、前輪7Fの幅方向外端から前輪7Fの幅(トレッド幅)W1の分だけ外方に位置する仮想線X1よりも更に外方に配置されている。ソナー45Bは、仮想線X1よりも内方に配置されている。
図7に示すように、障害物検出装置45は、支持部材50によって車体3に支持されている。支持部材50は、障害物検出装置45を検出位置(図4)と退避位置(図5)とに位置変更可能である。支持部材50は、障害物検出装置45を車体3の左方に支持する支持部材50Lと、障害物検出装置45を車体3の右方に支持する支持部材50Rとを含む。支持部材50Lと支持部材50Rとは、車体幅方向の中心線CL1を挟んで対称形である点以外は同じ構成である。支持部材50は、車体フレーム(前車軸フレーム)20側から外方に延びている。具体的には、支持部材50Lは、車体フレーム20Lから左方に延びている。支持部材50Rは、車体フレーム20Rから右方に延びている。これにより、障害物検出装置45は、前輪7Fの前方に位置していて、車体3の側方及び前方の障害物を検出可能である。
<制御装置、表示装置>
図6に示すように、トラクタ1は、制御装置40と表示装置80とを備えている。制御装置40は、CPU、電気回路、電子回路等で構成されていて、トラクタ1の様々な制御を行う。表示装置80は、液晶パネル、有機ELパネル等を有していて様々な情報を表示する。
制御装置40には、トラクタ1の駆動状態等を検出する状態検出装置41と、イグニッションスイッチ42とが接続されている。
状態検出装置41は、例えば、走行系の状態を検出する装置等であって、例えば、クランクセンサ、カムセンサ、エンジン回転センサ、アクセルセンサ、車速センサ、操舵角センサ、位置検出装置30)等の状態を検出する。なお、状態検出装置41は、走行系の状態以外を検出する装置、例えば、昇降レバー検出センサ、PTO回転検出センサ等であってもよい。
イグニッションスイッチ42は、運転席10の周囲に設置され、作業者が操作可能なスイッチである。イグニッションスイッチ42は、ON/OFFに切り換え可能なスイッチであって、ONにすると原動機4が駆動し、OFFにすると原動機4の駆動が停止する。なお、イグニッションスイッチ42において、電装品への電力の供給を行うためのアクセサリスイッチを含んでいてもよく、この場合には、イグニッションスイッチ42は、原動機4を駆動する第1のONの位置と、電動品に電力を供給する第2のONの位置と、OFFの位置とに切り換え可能となる。
<自動走行>
制御装置40は、トラクタ1における走行系の制御、作業系の制御を行う。制御装置40は、例えば、状態検出装置41が検出した検出状態に基づいてエンジン回転数、車速、操舵装置11の操舵角等を制御する。また、制御装置40は、状態検出装置41が検出した検出状態に基づいて、自動走行の制御を行う。具体的には、制御装置40は、自動走行制御部40Aを備えている。自動走行制御部40Aは、制御装置40に設けられた電気電子回路、制御装置40に格納されたプログラム等から構成されている。
自動走行を行うにあたっては、図10に示すように、表示装置80等を用いて、走行ルート(走行予定ライン)L1を作成する。まず、走行予定ラインL1の作成について説明する。
図10に示すように、作業者等が表示装置80に対して所定の操作を行うと、当該表示装置80は、走行予定ラインL1を作成する作成画面M1を表示する。例えば、作成画面M1の圃場入力部86に所定の圃場名を入力すると、表示装置80は、当該圃場入力部86に入力された圃場マップ(圃場マップMP2)、即ち、圃場入力部86に入力された圃場H1のマップが圃場マップMP2として作成画面M1に表示される。また、作業者等が表示装置80に対して所定の操作を行うと、圃場マップMP2上に車体3の走行ルート(走行予定ライン)L1を作成することができる。走行予定ラインL1の作成においては、例えば、圃場マップMP2内に、走行予定ラインL1として直進を示す直進部Lan(n=1,2,3・・・n)と、旋回を示す旋回部Lbn(n=1,2,3・・・n)とを作成することができる。例えば、作成画面M1において、作業幅入力部87aに作業幅W1が入力され、ラップ幅入力部87bにラップ幅W2が入力されると、表示装置80は、直進部Lanの間隔K1(K1=W1−2×W2)を演算し、圃場H1内に間隔K1毎に複数の直進部Lanを設定する。また、複数の直進部Lanが選択されると、表示装置80は、複数の直進部Lanのうち、隣接する直進部Lanの端部を結ぶ旋回部Lbnを設定する。なお、直進部Lanの本数等は、任意に設定することができる。
また、作成画面M1に表示された走行予定ラインL1上において所定の位置を、ポインタ88で選択すると、表示装置80は、選択した所定の位置を、開始位置P1又は終了位置P2に設定する。つまり、表示装置80では、圃場H1内において、自動走行を行うための、走行予定ラインL1(複数の直進部Lan、複数の旋回部Lbn、開始位置P1、終了位置P2)を設定(作成)することが可能である。なお、サーバ等の外部機器で作成した走行予定ラインL1をトラクタ1で取得して表示装置80に表示してもよい。
自動走行制御部40Aは、走行予定ラインL1の作成が完了し且つ、自動走行の開始の指令が行われると、自動走行の制御(自動走行制御)を実行する。図6に示すように、自動走行の開始の指令は、走行スイッチ85により行う。
走行スイッチ85は、操作された場合に車体3の自動走行の開始を指令するスイッチである。走行スイッチ85は、遠隔の操作によって開始の指令(開始指令)を行うことができる機能を有する端末(携帯端末、タブレット等)85a、トラクタ1の運転席等の周辺に設置されて作業者の操作によって開始指令を行う第1操作スイッチ85b、表示装置80に表示されたシンボルマークの選択によって開始指令を行う第2操作スイッチ85cなどである。走行スイッチ85は、操作された場合に車体3の自動走行の中断、終了を指令することが可能なスイッチであってもよい。
自動走行制御部40Aは、自動走行制御において、少なくとも車体3の走行位置(位置検出装置30で検出された位置)と、予め設定された走行ルート(走行経路)が一致するように、即ち、車体3と走行予定ラインL1とが一致するように、制御弁22の切換位置及び開度を設定する。言い換えれば、制御装置40は、トラクタ1の走行位置と走行予定ラインL1とが一致するように、ステアリングシリンダ23の移動方向及び移動量(前輪7Fの操舵方向及び操舵角)を設定する。
詳しくは、自動走行制御部40Aは、車体3の走行位置と、走行予定ラインL1で示された位置(走行予定位置)とを比較し、走行位置と走行予定位置とが一致している場合は、操舵装置11におけるハンドル11aの操舵角及び操舵方向(前輪7Fの操舵角及び操舵方向)を変更せずに保持する(制御弁22の開度及び切換位置を変更せずに維持する)。自動走行制御部40Aは、走行位置と走行予定位置とが一致していない場合、当該走行位置と走行予定位置との偏差(ズレ量)が零となるように、操舵装置11におけるハンドル11aの操舵角及び/又は操舵方向を変更する(制御弁22の開度及び/又は切換位置を変更する)。
なお、上述した実施形態では、自動走行制御部40Aは、自動走行制御において、走行位置と走行予定位置との偏差に基づいて操舵装置11の操舵角を変更するものであるが、走行予定ラインL1の方位とトラクタ1(車体3)の進行方向(走行方向)の方位(車体方位)とが異なる場合、自動走行制御部40Aは、車体方位が走行予定ラインL1の方位に一致するように操舵角を設定してもよい。また、自動走行制御部40Aは、自動走行制御において、偏差(位置偏差)に基づいて求めた操舵角と、方位偏差に基づいて求めた操舵角とに基づいて、自動走行制御における最終の操舵角を設定してもよい。また、上記した自動走行制御における操舵角の設定方法とは異なる方法で操舵角を設定してもよい。
また、自動走行制御部40Aは、自動走行制御において、トラクタ1(車体3)の実際の車速が、予め設定された走行予定ラインL1に対応する車速に一致するように、走行装置7、即ち、前輪7F及び/又は後輪7Rの回転数を制御してもよい。
また、自動走行制御部40Aは、障害物検出装置45による障害物の検出結果に基づいて自動走行を制御する。例えば、障害物検出装置45が障害物を検出していない場合は自動走行を継続して行い、障害物検出装置45が障害物を検出した場合に自動走行を停止する。より具体的には、障害物検出装置45が障害物を検出した場合に、自動走行制御部40Aは、障害物とトラクタ1との距離が予め定められた閾値(停止閾値)以下である場合に、トラクタ1の走行を停止することで自動走行を停止する。
また、自動走行制御部40Aは、自動走行時において着座検出装置43が着座していると検出している場合は自動走行を継続し且つ、着座検出装置43が着座していないと検出した場合は自動走行を停止する。
図11に示すように、自動走行時(自動走行中)には、表示装置80は、運転画面M5を表示する。運転画面M5では、トラクタ1(車体3)を示す図形G1と、走行予定ラインL1とを表示する。
図12Aに示すように、圃場H1において無人で自動走行を行うためには、まず、作業者がトラクタ1に乗車し、手動操作(手動走行)でトラクタ1(車体3)を開始位置P1に向けて移動させ、トラクタ1(車体3)が開始位置P1に達すると、作業者はトラクタ1から降車する(S1)。開始位置P1において、走行開始条件を満たした状態で降車した作業者等が走行スイッチ85を操作することにより、開始指令が制御装置40(自動走行制御部40A)に入力されると、自動走行制御部40Aは、自動走行を開始する(S2)。
自動開始条件とは、現在のトラクタ1(車体3)の位置等が、自動走行を開始するのに適しているかを判断するための条件である。図12Aに示すように、トラクタ1(車体3)における所定の位置(基準点)P10と、走行予定ラインL1との位置偏差ΔJ1が閾値J10以下(例えば、5m以下)で且つ、トラクタ1(車体3)の車体方位F1と走行予定ラインL1の方位F2との方位偏差ΔF3が閾値F10以下(例えば、20°(deg)以下)である場合に、制御装置40(自動走行制御部40A)は、走行開始条件が満たされていると判断し、位置偏差ΔJ1が閾値J10超(例えば、5m超)、又は、方位偏差ΔF3が閾値F10超(例えば、20°(deg)超)場合は、走行開始条件が満たされていないと判断する。
なお、図12Aに示すように、自動開始条件を判断する位置偏差ΔJ1は、トラクタ1(車体3)の進行方向(車体方位F2)において、トラクタ1(車体3)と走行予定ラインL1との距離のことであり、トラクタ1(車体3)の前端である基準点P10を中心として、円弧の範囲(中心角20°deg)A10で示される。つまり、基準点P10から半径5mの円弧を描いたときに、円弧の範囲A10内に走行予定ラインL1が入っている場合、制御装置40(自動走行制御部40A)は、位置偏差ΔJ1が5m以下であると判断する。基準点P10は、位置検出装置30で検出された走行位置にトラクタ1の前端までの距離を加減算することにより求めることができる。
図12Bに示すように、自動走行の開始後は、自動走行制御部40Aは、トラクタ1(車体3)の走行位置P20と、走行予定ラインL1との幅方向における位置偏差ΔJ5とが閾値以下となるように、操舵及び車速の調整を行う。また、自動走行制御部40Aは、トラクタ1(車体3)の車体方位F1と走行予定ラインL1との方位F2との方位偏差ΔF3が閾値以下となるように、操舵角及び車速の設定(調整)を行う。
さて、自動走行中において、走行スイッチ85を操作することにより、自動走行を中断することができる。図12Cに示すように、自動走行を中断後、作業者がトラクタ1に乗車した後、手動走行でトラクタ1を別の場所に移動させることが可能である。例えば、図12Cの軌跡KG1に示すように、3本目の直進部La3の途中の位置P30にて自動走行を中断した後、当該位置P30から別の場所に移動することができる。ここで、自動走行を再開する場合、再開する場所、即ち、走行予定ラインL1の任意の位置を選択する。具体的には、図11に示すように、作業者は、表示装置80に表示された複数の直進部Lanのうち、自動走行の再開をしたい所定の直進部Lanを選択する。選択された所定の直進部Lan(選択直進部)Lanに向けては、作業者が手動走行で運転して、選択直進部Lanの周囲にトラクタ1(車体3)を移動させ、選択直進部Lanの周囲にトラクタ1(車体3)が達すると、作業者はトラクタ1を停止して降車する。
例えば、図12Cに示すように、トラクタ1を停止して降車した位置(停止降車位置)P31に位置している状況下において、作業者が走行スイッチ85を操作して開始指令を行うと、自動走行制御部40Aは、走行開始条件を満たしているか否かを判断する。例えば、選択直進部Lanが4番目の直進部La4である場合、自動走行制御部40Aは、停止降車位置P31と直進部La4との位置偏差ΔJ1が閾値J10以下(例えば、5m以下)で且つ方位偏差ΔF3が閾値F10以下(例えば、20°(deg)以下)であるため、走行開始条件を満たしていると判断する。一方、選択直進部Lanが6番目の直進部La6である場合、自動走行制御部40Aは、停止降車位置P31と直進部La6との位置偏差ΔJ1が閾値J10超(例えば、5m超)で且つ方位偏差ΔF3が閾値F10以下(例えば、20°(deg)以下)であるため、走行開始条件を満たしていないと判断する。
以下、説明の便宜上、選択直進部Lanが4番目の直進部La4であるとして説明を進める。4番目の直進部La4のことを選択直進部La4という。
自動走行制御部40Aは、トラクタ1が停止降車位置P31であるときに、選択直進部La4に対して走行開始条件を満たしている場合、ライン合わせ条件を満たしているか否かを判断する。ライン合わせ条件とは、走行開始条件とは異なり、自動走行を行うに際してトラクタ1(車体3)をラインに合わせることを行うか否かを判断するための条件である。
図12Cに示すように、例えば、手動走行によってトラクタ1(車体3)を停止させた停止降車位置P31において、自動走行制御部40Aは、トラクタ1(車体3)の停止降車位置P31と、選択された走行予定ラインL1である選択直進部La4との位置偏差ΔJ5が閾値J11未満(例えば、0.1m未満)であり、且つ、選択直進部La4の方位と車体方位F1とが閾値F11未満(例えば、7°(deg)未満)である場合、ライン合わせ条件を満たしていないと判断する。一方、自動走行制御部40Aは、トラクタ1(車体3)の停止降車位置P31と、選択直進部La4との位置偏差ΔJ5が閾値J11以上、又は、選択直進部La4の方位と車体方位F1とが閾値F11以上(例えば、7°(deg)以上)である場合、ライン合わせ条件は満たしていると判断する。
つまり、自動走行制御部40Aは、走行開始の指令が行われた際に、選択された走行予定ラインL1と車体3との位置偏差ΔJ5及び走行予定ラインL1と車体方位F1との方位偏差ΔF3が第1閾値以上(閾値J11以上、閾値F11以上)である場合、位置偏差ΔJ5及び方位偏差ΔF3を第1閾値未満(閾値J11未満、閾値F11未満)にするライン合わせを実行する。なお、ライン合わせ条件の第1閾値(閾値J11、閾値F11)は、走行開始条件の第2閾値(閾値J10、閾値F10)よりも小さい。言い換えれば、走行開始条件の第2閾値(閾値J10、閾値F10)は、ライン合わせ条件の第1閾値(閾値J11、閾値F11)は、走行開始条件の第2閾値(閾値J10、閾値F10)よりも大きい。
図12Dに示すように、ライン合わせを行う場合、自動走行制御部40Aは、車体3を前進させた後(S10)、車体3を後進させる切り返しを行う(S11)。図12Dに示すように、例えば、車体3が選択直進部La4に対して左側にシフトしている場合は、自動走行制御部40Aは、前進時に車体3が選択直進部La4に近づくように右側へ操舵する。一方、車体3が選択直進部La4に対して右側にシフトしている場合は、自動走行制御部40Aは、前進時に車体3が選択直進部La4に近づくように左側へ操舵する。
また、ライン合わせにおいて、自動走行制御部40Aは、前進後の後進時に前輪7Fを操舵することによって、方位偏差ΔF3を第1閾値未満(閾値F11未満)になるように調整する。
なお、図12Dに示すように、自動走行制御部40Aは、停止降車位置P31にて走行スイッチ85を操作されて開始指令が行われた場合、車体3の位置である停車降車位置(車***置)と、車体3の進行方向における走行予定ラインL1の端部(選択直進部La4の端部P40)との距離L40が予め定められた距離よりも短い場合にはライン合わせを実行しない。例えば、自動走行制御部40Aは、距離L40が3.0m未満の場合、ライン合わせを実行しない。なお、図12Eに示すように、直進部Lanが途中で屈曲(変曲)している場合は、自動走行制御部40Aは、車体3の車***置と、屈曲点P41との距離L40が予め定められた距離よりも短い場合にはライン合わせを実行しないようにしてもよい。
また、自動走行制御部40Aは、ライン合わせ時には、車体3を前進させる前進動作(S10)及び車体3を後進させる後進動作(S11)を1回の切り返しとして行う。1回の切り返しによって、位置偏差ΔJ5及び方位偏差ΔF3が第1閾値未満(閾値J11未満、閾値F11未満)にならない場合、自動走行制御部40Aは、トラクタ1に対して制御信号を出力することによって、複数回の切り返しを行う。なお、自動走行制御部40Aは、ライン合わせにおいて、切り返しの回数が予め定められた回数(3回以上)となった場合には、切り返しが終了後に、自動走行を開始する。
なお、図6に示すように、制御装置40は、装置取得部40Eを備えていてもよい。装置取得部40Eは、制御装置40に設けられた電気電子回路、制御装置40に格納されたプログラム等から構成されている。装置取得部40Eは、車体3に装着された作業装置2の種類、種別を示す装置情報を取得する。例えば、制御装置40と作業装置2とは車載ネットワークN1により接続されている。作業装置2が車体3に接続されると、作業装置2から車載ネットワークN1に接続された作業装置2の装置情報(種類、種別)が出力され、装置取得部40Eは、車載ネットワークN1に出力された装置情報を取得する。なお、装置取得部40Eは、所定の操作を行った場合に、表示装置80の画面に、装置情報を入力する部分(入力部)を表示し、入力部に入力された装置情報を取得してもよい。
自動走行制御部40Aは、停止降車位置P31にて走行スイッチ85を操作されて開始指令が行われた場合であっても、装置取得部40Eが取得した作業装置2の種類、種別が予め定められた作業装置2である場合にはライン合わせを実行せず、予め定められた作業装置2でない場合にはライン合わせを行う。例えば、作業装置2がブロードキャスタ等の散布装置の場合は、自動走行制御部40Aは、ライン合わせを行わず、開始指令が行われた場合、自動走行条件を満たしていれば、自動走行を開始する。なお、上述した作業装置2の種類、種別は、一例であり限定されない。
上述した実施形態では、作業装置2の装置情報(種類、種別)に基づいて、ライン合わせを行うか否かを決定していたが、例えば、表示装置80にライン合わせを行うか否かの画面を表示して運転者(ユーザ)の選択によって決定してもよい。
また、作業装置2における作業の精度に基づいて、第1閾値を変更してもよい。図14に示すように、所定の操作を行うと、表示装置80は、設定画面M6を表示する。設定画面M6は、作業の精度(作業精度)を入力する入力部46を表示する画面であり、例えば、複数のレベルに分けられた作業精度を入力可能である。具体的には、入力部46は、「高精度」を入力(選択)する第1入力部46aと、「高効率」を入力(選択)する第2入力部46bと、「通常」を入力(選択)する第3入力部46cと、を含んでいる。高効率は、素早く作業を行うことであり、高精度は、精密に作業を行うことである。
例えば、選択画面M6において「通常」が選択されると、自動走行制御部40Aは、第1閾値(閾値J11、閾値F11)をデフォルトとして設定された値(デフォルト値)に設定する。また、選択画面M6において「高効率」が選択されると、自動走行制御部40Aは、第1閾値(閾値J11、閾値F11)を、「通常」に対応するデフォルト値よりも大きな値(第1設定値)にすることで、ライン合わせを行い難くする。
また、選択画面M6において「高精度」が選択されると、自動走行制御部40Aは、第1閾値(閾値J11、閾値F11)を、「通常」に対応するデフォルト値よりも小さな(第2設定値)にすることで、通常よりもよりライン合わせを行ないやすくする。このように、作業精度に応じて、第1閾値を変更することによって、作業精度が高くなる(高精度側))ほど、ライン合わせを実行しやすくし、作業精度が低くなる(高効率側))ほど、ライン合わせは行わないようにすることができる。
なお、上述した作業精度は一例であり、作業精度を設定するレベル、即ち、入力部の数は、複数であれば数は限定されない。
上述した実施形態では、図12C及び図12Dに示したように、自動走行を中断させた後、手動走行で走行予定ラインL1の所定の位置にトラクタ1を停止させた場合について説明したが、圃場H1において、自動走行を開始する前、即ち、トラクタ1を開始位置P1に近づけた場合も適用可能である。
自動走行制御部40Aは、走行スイッチ85による開始指令が行われた際に、位置検出装置P30が検出した車***置が走行予定ラインL1に定められた開始位置である場合に、車***置を開始位置に合わす位置合わせを行う。例えば、開始位置P1において、走行開始条件を満たした状態で降車した作業者等が走行スイッチ85を操作したとき、自動走行制御部40Aは、走行開始条件及びライン合わせ条件を満たしているか否かを判断する。ライン合わせを満たしている場合、図12Dと同じように、開始位置P1の周囲にて、車体3を前進及び後進させることによって、トラクタ1(車体3)を1番目の直進部La1に合わせるライン合わせを実行する。
上述した実施形態では、位置偏差ΔJ1が閾値J10以下且つ方位偏差ΔF3が閾値F10以下である場合に、制御装置40(自動走行制御部40A)は、走行開始条件が満たされていると判断していたが、位置偏差ΔJ1が閾値J10以下(第1条件)及び方位偏差ΔF3が閾値F10以下(第2条件)のいずれかを満たす場合、走行開始条件が満たされていると判断してもよい。つまり、制御装置40(自動走行制御部40A)は、第1条件及び第2条件のいずれか1つを満たす場合に、走行開始条件が満たされていると判断してもよい。
また、上述した実施形態では、位置偏差ΔJ5が閾値J11以上且つ方位偏差ΔF3が閾値F11以上である場合に、制御装置40(自動走行制御部40A)は、ライン合わせ条件が満たされていると判断していたが、位置偏差ΔJ5が閾値J11以上(第3条件)及び方位偏差ΔF3が閾値F11以上(第4条件)のいずれかを満たす場合、ライン合わせ条件が満たされていると判断してもよい。つまり、制御装置40(自動走行制御部40A)は、第3条件及び第4条件のいずれか1つを満たす場合に、ライン合わせ条件が満たされていると判断してもよい。
図13は、自動走行の動作のフローを示している。図13に示すように、トラクタ1が圃場H1に入り、当該圃場H1にて初めて自動走行を開始する場合において、走行スイッチ85の操作によって開始指令を制御装置40が取得すると、自動走行制御部40Aは、走行開始条件が満たされているか否かを判断する(S30)。また、走行開始条件が満たされている場合(S30、Yes)、自動走行制御部40Aは、ライン合わせ条件が満たされているか否かを判断する(S31)。自動走行制御部40Aは、ライン合わせ条件が満たされている場合(S31、Yes)、ライン合わせを実行する(S32)。自動走行制御部40Aは、ライン合わせ条件が満たされていない場合(S31、No)、自動走行を開始する(S33)。走行スイッチ85の操作によって中断の指令を制御装置40が取得すると、自動走行制御部40Aは、自動走行を中断(停止)する(S34)。自動走行の中断後、開始指令を制御装置40が取得すると、自動走行制御部40Aは、走行開始条件が満たされているか否かを判断する(S35)。また、走行開始条件が満たされている場合(S35、Yes)、自動走行制御部40Aは、ライン合わせ条件が満たされているか否かを判断する(S36)。自動走行制御部40Aは、ライン合わせ条件が満たされている場合(S36、Yes)、ライン合わせを実行する(S37)。自動走行制御部40Aは、ライン合わせ条件が満たされていない場合(S36、No)、自動走行を再開する(S38)。また、自動走行制御部40Aは、ライン合わせによる切り返しを少なくとも1回以上行った後、自動走行を再開する(S38)。
農業機械1は、走行可能な車体3と、操作された場合に車体3の自動走行の開始を指令する走行スイッチ85と、指令が出力された場合に走行予定ラインL1に基づいて車体3の自動走行を行う自動走行制御部40Aと、を備え、自動走行制御部40Aは、走行スイッチ85による指令が行われた際に、選択された走行予定ラインL1と車体3との位置偏差ΔJ10及び走行予定ラインL1と車体3の方位との方位偏差のいずれかが第1閾値(J11、F11)以上である場合、位置偏差ΔJ5及び方位偏差ΔF3を第1閾値(J11、F11)未満にするライン合わせを実行する。これによれば、自動走行を始めて行う場合又は、自動走行を途中で中断した後、任意の位置から自動走行を再開する場合などにおいて、走行スイッチ85による指令が行われた際、位置偏差ΔJ5及び方位偏差ΔF3を第1閾値(J11、F11)未満にするライン合わせを行うことができる。即ち、少なくとも走行予定ラインL1から離れた車体3を走行予定ラインL1に近づけた後に自動走行を行う場合に、スムーズに自動走行へ移行することができる。
走行予定ラインL1は、車体3を直進させる直進部Lanと、車体3を旋回させる旋回部Lbnとを含み、自動走行制御部40Aは、直進部Lanと車体3との位置偏差ΔJ5及び直進部Lanと車体3の方位との方位偏差ΔF3のいずれかが第1閾値(J11、F11)以上であるかを判断し、第1閾値(J11、F11)以上である場合には、ライン合わせとして、直進部Lanに対する位置偏差ΔJ5及び方位偏差ΔF3を第1閾値(J11、F11)未満にする。これによれば、走行予定ラインL1の任意の位置から直進の自動走行を開始する場合に、直進部Lanと車体3との位置偏差ΔJ5及び直進部Lanと車体3の方位との方位偏差ΔF3とのいずれかを小さくしたライン合わせを行うことができるため、直進の自動走行へとスムーズに移行することができる。
例えば、図12Fの任意の位置P50にて、自動走行による作業装置2の作業を一旦停止した後、位置P51から自動走行を再開させるときなどに、直進部Lanに対する農業機械1のライン合わせを簡単に行うことができる。その結果、図12Fに示すように、作業装置2の作業済みの場所W30を、任意に変更することができる。なお、図12Fの3本の直進部Lanは同じ直進部Lanである。
自動走行制御部40Aは、ライン合わせにおいて、車体3を前進させた後、車体3を後進させる切り返しを行う。これによれば、図12Dに示すように、簡単に車体3を走行予定ラインL1に合わせることができる。
自動走行制御部40Aは、ライン合わせにおいて、切り返しを複数回行い、切り返しの回数が予め定められた回数以上となった場合には、自動走行を開始する。これによれば、複数回のライン合わせによって、走行予定ラインL1に対する車体3の姿勢を整えてから、自動走行を開始することができる。
自動走行制御部40Aは、走行スイッチ85による指令が行われたときの車体3の位置である車***置と、車体3の進行方向における走行予定ラインL1の端部との距離L40が予め定められた距離よりも短い場合にはライン合わせを実行しない。これによれば、途中から自動走行を開始する場合であって、現在の農業機械1の位置(車***置)から走行予定ラインL1の端部までの距離が短く、切り返しが難しい場合には、ライン合わせを行わずに自動走行に移行することによって、無理な切り返しを抑制できる。
農業機械1は、車体3に装着された作業装置を取得する装置取得部40Eを備え、自動走行制御部40Aは、装置取得部40Eが取得した作業装置2が予め定められた作業装置2である場合にライン合わせを実行しない。これによれば、予め定められた作業装置2に対してのみライン合わせを行わずに自動走行を開始することができる。
農業機械1は、車体3の位置である車***置を検出する位置検出装置を備え、自動走行制御部40Aは、走行スイッチ85による指令が行われた際に、位置検出装置が検出した車***置が走行予定ラインL1に定められた開始位置である場合に、車***置を開始位置に合わす位置合わせを行う。これによれば、自動走行を始めて開始するとき、即ち、農業機械1を開始位置に近づけてから自動走行を開始する場合に、農業機械1の姿勢を走行予定ラインL1に合わせやすい。
自動走行制御部40Aは、位置偏差及び方位偏差のいずれかが第1閾値よりも大きい第2閾値以上である場合に、車体3の自動走行を行う。これによれば、第2閾値によって自動走行を開始できるか否かを判断した後に、第1閾値によるライン合わせを行うかを判断することができるため、ライン合わせを行わずに自動走行を開始すること、ライン合わせを行ってから自動走行を開始することの両方を行うことができ、状況に応じてスムーズに自動走行を実行することができる。
以上、本発明の実施形態について説明したが、今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。
1 :農業機械(トラクタ)
2 :作業装置
3 :車体
30 :位置検出装置
40A :自動走行制御部
40E :装置取得部
85 :走行スイッチ
F10 :閾値
F11 :閾値
F2 :方位
J10 :閾値
J11 :閾値
L1 :走行予定ライン
L40 :距離
Lan :直進部(選択直進部)
Lbn :旋回部
P1 :開始位置
P40 :端部
ΔF3 :方位偏差
ΔJ1,J5,J10:位置偏差

Claims (8)

  1. 走行可能な車体と、
    操作された場合に前記車体の自動走行の開始を指令する走行スイッチと、
    前記指令が出力された場合に走行予定ラインに基づいて前記車体の自動走行を行う自動走行制御部と、
    を備え、
    前記自動走行制御部は、前記走行スイッチによる指令が行われた際に、選択された前記走行予定ラインと前記車体との位置偏差及び前記走行予定ラインと前記車体の方位との方位偏差のいずれかが第1閾値以上である場合、前記位置偏差及び方位偏差を前記第1閾値未満にするライン合わせを実行する農業機械。
  2. 前記走行予定ラインは、前記車体を直進させる直進部と、前記車体を旋回させる旋回部とを含み、
    前記自動走行制御部は、前記直進部と前記車体との位置偏差及び前記直進部と前記車体の方位との方位偏差のいずれかが第1閾値以上であるかを判断し、前記第1閾値以上である場合には、前記ライン合わせとして、前記直進部に対する前記位置偏差及び方位偏差を前記第1閾値未満にする請求項1に記載の農業機械。
  3. 前記自動走行制御部は、前記ライン合わせにおいて、前記車体を前進させた後、前記車体を後進させる切り返しを行う請求項1又は2に記載の農業機械。
  4. 前記自動走行制御部は、前記ライン合わせにおいて、前記切り返しを複数回行い、前記切り返しの回数が予め定められた回数以上となった場合には、前記自動走行を開始する請求項3に記載の農業機械。
  5. 前記自動走行制御部は、前記走行スイッチによる指令が行われたときの前記車体の位置である車***置と、前記車体の進行方向における走行予定ラインの端部との距離が予め定められた距離よりも短い場合には前記ライン合わせを実行しない請求項1〜4のいずれかに記載の農業機械。
  6. 前記車体に装着された作業装置を取得する装置取得部を備え、
    前記自動走行制御部は、前記装置取得部が取得した作業装置が予め定められた作業装置である場合に前記ライン合わせを実行しない請求項1〜5のいずれかに記載の農業機械。
  7. 前記車体の位置である車***置を検出する位置検出装置を備え、
    前記自動走行制御部は、前記走行スイッチによる指令が行われた際に、前記位置検出装置が検出した車***置が前記走行予定ラインに定められた開始位置である場合に、前記車***置を前記開始位置に合わす位置合わせを行う請求項1〜6のいずれかに記載の農業機械。
  8. 前記自動走行制御部は、前記位置偏差及び前記方位偏差のいずれかが第1閾値よりも大きい第2閾値以上である場合に、前記車体の自動走行を行う請求項1〜7のいずれかに記載の農業機械。
JP2020065146A 2020-03-31 2020-03-31 農業機械 Pending JP2021163268A (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2020065146A JP2021163268A (ja) 2020-03-31 2020-03-31 農業機械
PCT/JP2021/008345 WO2021199879A1 (ja) 2020-03-31 2021-03-04 農業機械
EP21781268.4A EP4129035A4 (en) 2020-03-31 2021-03-04 AGRICULTURAL MACHINE
US17/951,261 US20230015153A1 (en) 2020-03-31 2022-09-23 Agricultural machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020065146A JP2021163268A (ja) 2020-03-31 2020-03-31 農業機械

Publications (1)

Publication Number Publication Date
JP2021163268A true JP2021163268A (ja) 2021-10-11

Family

ID=77927617

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020065146A Pending JP2021163268A (ja) 2020-03-31 2020-03-31 農業機械

Country Status (4)

Country Link
US (1) US20230015153A1 (ja)
EP (1) EP4129035A4 (ja)
JP (1) JP2021163268A (ja)
WO (1) WO2021199879A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102399322B1 (ko) * 2021-12-07 2022-05-19 충남대학교산학협력단 전기 구동 크롤러 타입 농작업용 차량 플랫폼

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002067990A (ja) * 2000-09-04 2002-03-08 Mitsubishi Agricult Mach Co Ltd 移動農機の操向装置
JP2010200674A (ja) * 2009-03-03 2010-09-16 National Agriculture & Food Research Organization 走行制御装置
WO2020003561A1 (ja) * 2018-06-25 2020-01-02 株式会社クボタ 作業車両
JP2020018236A (ja) * 2018-08-01 2020-02-06 株式会社クボタ 収穫機

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05260804A (ja) * 1992-03-23 1993-10-12 Kubota Corp 芝刈作業車の走行制御装置
KR20200096500A (ko) * 2017-12-18 2020-08-12 가부시끼 가이샤 구보다 자동 조타 시스템 및 자동 조타 방법
WO2020003563A1 (ja) * 2018-06-25 2020-01-02 株式会社クボタ 作業車両
JP2019038535A (ja) 2018-10-10 2019-03-14 株式会社クボタ 自動走行圃場作業車両

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002067990A (ja) * 2000-09-04 2002-03-08 Mitsubishi Agricult Mach Co Ltd 移動農機の操向装置
JP2010200674A (ja) * 2009-03-03 2010-09-16 National Agriculture & Food Research Organization 走行制御装置
WO2020003561A1 (ja) * 2018-06-25 2020-01-02 株式会社クボタ 作業車両
JP2020018236A (ja) * 2018-08-01 2020-02-06 株式会社クボタ 収穫機

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102399322B1 (ko) * 2021-12-07 2022-05-19 충남대학교산학협력단 전기 구동 크롤러 타입 농작업용 차량 플랫폼
WO2023106596A1 (ko) * 2021-12-07 2023-06-15 충남대학교산학협력단 전기 구동 크롤러 타입 농작업용 차량 플랫폼

Also Published As

Publication number Publication date
WO2021199879A1 (ja) 2021-10-07
US20230015153A1 (en) 2023-01-19
EP4129035A1 (en) 2023-02-08
EP4129035A4 (en) 2024-04-24

Similar Documents

Publication Publication Date Title
EP3729935B1 (en) Automatic steering system and automatic steering method
KR102283927B1 (ko) 작업 차량 제어 시스템
WO2021100373A1 (ja) 作業車両用の自動走行システム
WO2021025108A1 (ja) 作業車両用の自動走行システム
EP3744161B1 (en) Work vehicle
JP7504961B2 (ja) 作業車両制御方法
WO2021125273A1 (ja) 作業車両
US11866094B2 (en) Working vehicle having a display for displaying driving information thereof
JP2023098980A (ja) 自動走行システム及び自動走行方法
WO2020166164A1 (ja) 農業機械
WO2021199879A1 (ja) 農業機械
JP2002074436A (ja) 作業車両の管理システム
WO2021010297A1 (ja) 自動走行システム
WO2017208484A1 (ja) 作業車協調システム及び作業車
JP6991058B2 (ja) 自動操舵システム
JP7046618B2 (ja) 作業車両
JP2021040498A (ja) 作業車両
KR20210022534A (ko) 작업 차량
WO2021200568A1 (ja) 農業機械
JP2020054316A (ja) 作業車両
JP7042732B2 (ja) 自動操舵システムおよび自動操舵方法
JP7075436B2 (ja) 作業車両制御システム
JP2020054320A (ja) 作業車両
JP2020054318A (ja) 作業車両
US20220322601A1 (en) Work Machine Capable of Autonomous Travel

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220622

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230725

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230925

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20231121

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20240122

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240321

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20240618