JP7106418B2 - work vehicle - Google Patents
work vehicle Download PDFInfo
- Publication number
- JP7106418B2 JP7106418B2 JP2018189202A JP2018189202A JP7106418B2 JP 7106418 B2 JP7106418 B2 JP 7106418B2 JP 2018189202 A JP2018189202 A JP 2018189202A JP 2018189202 A JP2018189202 A JP 2018189202A JP 7106418 B2 JP7106418 B2 JP 7106418B2
- Authority
- JP
- Japan
- Prior art keywords
- travel line
- vehicle body
- target
- steering
- line
- 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
- 238000013459 approach Methods 0.000 claims description 8
- 230000007423 decrease Effects 0.000 claims description 2
- 238000012937 correction Methods 0.000 description 104
- 230000005540 biological transmission Effects 0.000 description 22
- 238000010586 diagram Methods 0.000 description 12
- 230000007246 mechanism Effects 0.000 description 12
- 238000005259 measurement Methods 0.000 description 10
- 238000006073 displacement reaction Methods 0.000 description 8
- 230000007935 neutral effect Effects 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 5
- 244000025254 Cannabis sativa Species 0.000 description 4
- 239000003921 oil Substances 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 238000005507 spraying Methods 0.000 description 4
- 230000003247 decreasing effect Effects 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 239000003905 agrochemical Substances 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 239000003337 fertilizer Substances 0.000 description 2
- 238000003306 harvesting Methods 0.000 description 2
- 239000010720 hydraulic oil Substances 0.000 description 2
- 238000003825 pressing Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000007480 spreading Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003971 tillage Methods 0.000 description 1
Images
Landscapes
- Guiding Agricultural Machines (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本発明は、例えば、トラクタ等の作業車両に関する。 The present invention relates to work vehicles such as tractors, for example.
従来、農作業機として特許文献１が知られている。特許文献１の農作業機は、手動操舵による手動走行と、基準走行ラインに平行に設定される設定走行ラインに沿って自動操舵により走行する自動走行とを切替自在な走行機体と、手動走行と自動走行とを切替自在な切替スイッチとを備えている。また、農作業機は、畝に沿って走行中に右指示ボタンを押した後、基準走行ラインの始点が設定され、走行中に左指示ボタンを押すことによって基準走行ラインの終点が設定される。
Conventionally,
特許文献１の農作業機では、切替スイッチによって手動走行から自動走行に切り換えることにより、簡単に設定走行ラインに沿って自動走行を行うことができる。農作業機と設定走行ラインとの差（位置偏差）が大きい場合、農作業機が設定走行ラインに向かう時の操舵角が大きくなり過ぎて、農作業機が現在の位置から設定走行ラインへ向かうときの走行の挙動が安定しない場合がある。
The agricultural implement disclosed in
そこで、本発明は上記問題点に鑑み、現在の位置から走行予定ラインまでの移動（走行）をスムーズに行うことができる作業車両を提供することを目的とする。 SUMMARY OF THE INVENTION Accordingly, it is an object of the present invention to provide a work vehicle that can smoothly move (travel) from its current position to a planned travel line.
この技術的課題を解決するための本発明の技術的手段は、以下に示す点を特徴とする。
作業車両は、車体を操舵する操舵装置と、前記車体の位置を検出する測位装置と、前記車体と走行予定ラインとの偏差が小さくなるように前記操舵装置における自動操舵を制御する制御装置と、を備え、前記制御装置は、前記測位装置で検出された車体の位置である車体位置と前記走行予定ラインとの間に、前記車体位置から所定の設定距離だけ離れた位置に前記走行予定ラインと平行な目標走行ラインを設定する目標ライン設定部と、前記車体が前記走行予定ラインに到達する前に、前記車体が前記目標走行ラインに向かうように前記操舵装置の自動操舵を行う自動操舵制御部と、を有している。前記目標ライン設定部は、前記偏差が所定値以上である場合に前記目標走行ラインを設定し、前記自動操舵制御部は、設定された前記目標走行ラインに近づくように前記車体の前記自動操舵を実行し、前記目標ライン設定部は、前記目標走行ラインの設定後、前記自動操舵制御部が前記自動操舵を実行中に所定の条件が満たされるごとに前記偏差が前記所定値以上か否かの判定を行い、前記偏差が所定値以上である場合に、そのときの車体位置から前記設定距離だけ離れた位置に前記目標走行ラインを再設定し、前記自動操舵制御部は再設定された前記目標走行ラインに近づくように前記車体の前記自動操舵を実行する。
The technical means of the present invention for solving this technical problem are characterized by the following points.
The work vehicle includes a steering device that steers a vehicle body, a positioning device that detects the position of the vehicle body, a control device that controls automatic steering in the steering device so that a deviation between the vehicle body and a planned travel line is reduced, and the control device is arranged between the vehicle body position, which is the position of the vehicle body detected by the positioning device, and the planned travel line, at a position separated from the vehicle body position by a predetermined set distance. A target line setting unit that sets a parallel target travel line, and an automatic steering control unit that automatically steers the steering device so that the vehicle body heads toward the target travel line before the vehicle body reaches the planned travel line. and have The target line setting unit sets the target travel line when the deviation is equal to or greater than a predetermined value, and the automatic steering control unit controls the automatic steering of the vehicle body so as to approach the set target travel line. After setting the target travel line, the target line setting unit determines whether the deviation is equal to or greater than the predetermined value each time a predetermined condition is satisfied while the automatic steering control unit is executing the automatic steering. A determination is made, and if the deviation is equal to or greater than a predetermined value, the target travel line is reset to a position separated by the set distance from the vehicle body position at that time, and the automatic steering control unit controls the reset target travel line. The automatic steering of the vehicle body is performed so as to approach the running line.
作業車両は、前記車体の走行距離を算出する距離算出部を備えており、前記目標ライン設定部は、前記自動操舵制御部が前記自動操舵を実行中に前記距離算出部が算出した前記走行距離が閾値を超えた場合に、前記所定の条件が満たされたものとし、前記目標走行ラインを再設定するか否かの判断のために前記偏差が前記所定値以上か否かの判定を行う。 The work vehicle includes a distance calculation unit that calculates a travel distance of the vehicle body, and the target line setting unit calculates the travel distance calculated by the distance calculation unit while the automatic steering control unit is performing the automatic steering. exceeds the threshold, it is determined that the predetermined condition is satisfied, and whether or not the deviation is equal to or greater than the predetermined value is determined in order to determine whether or not to reset the target travel line.
前記目標ライン設定部は、前記自動操舵制御部が前記自動操舵を実行中に前記偏差が所定量小さくなる毎に、前記所定の条件が満たされたものとし、前記目標走行ラインを再設定するか否かの判断のために前記偏差が前記所定値以上か否かの判定を行う。
作業車両は、前記目標走行ラインの設定を行ってからの経過時間を計測する計時部を備えており、前記目標ライン設定部は、前記自動操舵制御部が前記自動操舵を実行中に前記計時部が計測した経過時間が所定時間を超えた場合に、前記所定の条件が満たされたものとし、前記目標走行ラインを再設定するか否かの判断のために前記偏差が前記所定値以上か否かの判定を行う。
The target line setting unit assumes that the predetermined condition is satisfied and resets the target travel line each time the deviation decreases by a predetermined amount while the automatic steering control unit is performing the automatic steering . In order to determine whether or not, it is determined whether or not the deviation is equal to or greater than the predetermined value .
The work vehicle is provided with a timer that measures the elapsed time after the target travel line is set, and the target line setting unit is configured to operate the timer while the automatic steering control unit is executing the automatic steering. When the measured elapsed time exceeds a predetermined time, the predetermined condition is assumed to be satisfied, and whether the deviation is equal to or greater than the predetermined value for determining whether to reset the target travel line make a judgment as to whether
前記目標ライン設定部は、前記偏差が前記所定値未満である場合に前記目標走行ラインの設定を終了する。
作業車両は、手動操舵により車体の操舵を行うステアリングハンドルと、前記自動操舵の開始及び終了のいずれかを切り換える操舵切換スイッチと、を備えている。
The target line setting unit ends the setting of the target travel line when the deviation is less than the predetermined value .
The work vehicle includes a steering handle for steering the vehicle body by manual steering, and a steering selector switch for switching between starting and ending the automatic steering.
本発明によれば、現在の位置から走行予定ラインまでの移動（走行）をスムーズに行うことができる。 According to the present invention, it is possible to smoothly move (travel) from the current position to the planned travel line.
以下、本発明の実施の形態を図面に基づいて説明する。
図１２は作業車両１の一実施形態を示す側面図であり、図１２は作業車両１の一実施形態を示す平面図である。本実施形態の場合、作業車両１はトラクタである。但し、作業車両１は、トラクタに限定されず、コンバインや移植機等の農業機械（農業車両）であってもよいし、ローダ作業機等の建設機械（建設車両）等であってもよい。
BEST MODE FOR CARRYING OUT THE INVENTION Hereinafter, embodiments of the present invention will be described with reference to the drawings.
12 is a side view showing one embodiment of the
以下、トラクタ（作業車両）１の運転席１０に着座した運転者の前側（図１２の矢印Ａ１方向）を前方、運転者の後側（図１２の矢印Ａ２方向）を後方、運転者の左側を左方、運転者の右側を右方として説明する。また、作業車両１の前後方向に直交する方向である水平方向を車体幅方向として説明する。
図１２に示すように、トラクタ１は、車体３と、原動機４と、変速装置５とを備えている。車体３は走行装置７を有していて走行可能である。走行装置７は、前輪７Ｆ及び後輪７Ｒを有する装置である。前輪７Ｆは、タイヤ型であってもクローラ型であってもよい。また、後輪７Ｒも、タイヤ型であってもクローラ型であってもよい。
Hereinafter, the front side of the driver seated in the driver's
As shown in FIG. 12 , the
原動機４は、ディーゼルエンジン、電動モータ等であって、この実施形態ではディーゼルエンジンで構成されている。変速装置５は、変速によって走行装置７の推進力を切換可能であると共に、走行装置７の前進、後進の切換が可能である。車体３には運転席１０が設けられている。
また、車体３の後部には、３点リンク機構等で構成された連結部８が設けられている。連結部８には、作業装置を着脱可能である。作業装置を連結部８に連結することによって、車体３によって作業装置を牽引することができる。作業装置は、耕耘する耕耘装置、肥料を散布する肥料散布装置、農薬を散布する農薬散布装置、収穫を行う収穫装置、牧草等の刈取を行う刈取装置、牧草等の拡散を行う拡散装置、牧草等の集草を行う集草装置、牧
草等の成形を行う成形装置等である。
The
A connecting
図１に示すように、変速装置５は、主軸（推進軸）５ａと、主変速部５ｂと、副変速部５ｃと、シャトル部５ｄと、ＰＴＯ動力伝達部５ｅと、前変速部５ｆと、を備えている。推進軸５ａは、変速装置５のハウジングケース（ミッションケース）に回転自在に支持され、当該推進軸５ａには、エンジン４のクランク軸からの動力が伝達される。主変速部５ｂは、複数のギア及び当該ギアの接続を変更するシフタを有している。主変速部５ｂは、複数のギアの接続（噛合）をシフタで適宜変更することによって、推進軸５ａから入力された回転を変更して出力する（変速する）。
As shown in FIG. 1, the
副変速部５ｃは、主変速部５ｂと同様に、複数のギア及び当該ギアの接続を変更するシフタを有している。副変速部５ｃは、複数のギアの接続（噛合）をシフタで適宜変更することによって、主変速部５ｂから入力された回転を変更して出力する（変速する）。
シャトル部５ｄは、シャトル軸１２と、前後進切換部１３とを有している。シャトル軸１２には、副変速部５ｃから出力された動力がギア等を介して伝達される。前後進切換部１３は、例えば、油圧クラッチ等で構成され、油圧クラッチの入切によってシャトル軸１２の回転方向、即ち、トラクタ１の前進及び後進を切り換える。シャトル軸１２は、後輪デフ装置２０Ｒに接続されている。後輪デフ装置２０Ｒは、後輪７Ｒが取り付けられた後車軸２１Ｒを回転自在に支持している。
The
The
ＰＴＯ動力伝達部５ｅは、ＰＴＯ推進軸１４と、ＰＴＯクラッチ１５とを有している。ＰＴＯ推進軸１４は、回転自在に支持され、推進軸５ａからの動力が伝達可能である。ＰＴＯ推進軸１４は、ギア等を介してＰＴＯ軸１６に接続されている。ＰＴＯクラッチ１５は、例えば、油圧クラッチ等で構成され、油圧クラッチの入切によって、推進軸５ａの動力をＰＴＯ推進軸１４に伝達する状態と、推進軸５ａの動力をＰＴＯ推進軸１４に伝達しない状態とに切り換わる。
The PTO
前変速部５ｆは、第１クラッチ１７と、第２クラッチ１８とを有している。第１クラッチ１７及び第２クラッチ１８は、推進軸５ａからの動力が伝達可能であって、例えば、シャトル軸１２の動力が、ギア及び伝動軸を介して伝達される。第１クラッチ１７及び第２クラッチ１８からの動力は、前伝動軸２２を介して前車軸２１Ｆに伝達可能である。具体的には、前伝動軸２２は、前輪デフ装置２０Ｆに接続され、前輪デフ装置２０Ｆは、前輪７Ｆが取り付けられた前車軸２１Ｆを回転自在に支持している。
The
第１クラッチ１７及び第２クラッチ１８は、油圧クラッチ等で構成されている。第１クラッチ１７には油路が接続され、当該油路には油圧ポンプ３３から吐出した作動油が供給される第１作動弁２５に接続されている。第１クラッチ１７は、第１作動弁２５の開度によって接続状態と切断状態とに切り換わる。第２クラッチ１８には油路が接続され、当該油路には第２作動弁２６に接続されている。第２クラッチ１８は、第２作動弁２６の開度によって接続状態と切断状態とに切り換わる。第１作動弁２５及び第２作動弁２６は、例えば、電磁弁付き二位置切換弁であって、電磁弁のソレノイドを励磁又は消磁することにより、接続状態又は切断状態に切り換わる。
The first clutch 17 and the second clutch 18 are composed of hydraulic clutches or the like. An oil passage is connected to the first clutch 17 , and the oil passage is connected to a first operating valve 25 to which hydraulic oil discharged from a
第１クラッチ１７が切断状態で且つ第２クラッチ１８が接続状態である場合、第２クラッチ１８を通じてシャトル軸１２の動力が前輪７Ｆに伝達される。これにより、前輪７Ｆ及び後輪７Ｒが動力によって駆動する四輪駆動（４ＷＤ）で且つ前輪７Ｆと後輪７Ｒとの回転速度が略同じとなる（４ＷＤ等速状態）。一方、第１クラッチ１７が接続状態で且つ第２クラッチ１８が切断状態である場合、四輪駆動になり且つ前輪７Ｆの回転速度が後輪７Ｒの回転速度に比べて速くなる（４ＷＤ増速状態）。また、第１クラッチ１７及び第２クラッチ１８が接続状態である場合、シャトル軸１２の動力が前輪７Ｆに伝達されないため、後輪７Ｒが動力によって駆動する二輪駆動（２ＷＤ）となる。
When the first clutch 17 is in the disengaged state and the second clutch 18 is in the engaged state, the power of the shuttle shaft 12 is transmitted to the
トラクタ１は、測位装置４０を備えている。測位装置４０は、Ｄ－ＧＰＳ、ＧＰＳ、ＧＬＯＮＡＳＳ、北斗、ガリレオ、みちびき等の衛星測位システム（測位衛星）により、自己の位置（緯度、経度を含む測位情報）を検出可能である。即ち、測位装置４０は、測位衛星から送信された衛星信号（測位衛星の位置、送信時刻、補正情報等）を受信し、衛星信号に基づいて位置（例えば、緯度、経度）を検出する。測位装置４０は、受信装置４１
と、慣性計測装置（ＩＭＵ：Inertial Measurement Unit）４２とを有している。受信装置４１は、アンテナ等を有していて測位衛星から送信された衛星信号を受信する装置であり、慣性計測装置４２とは別に車体３に取付けられている。この実施形態では、受信装置４１は、車体３に設けられたロプスに取付けられている。なお、受信装置４１の取付箇所は、実施形態に限定されない。
The
and an inertial measurement unit (IMU: Inertial Measurement Unit) 42 . The receiving
慣性計測装置４２は、加速度を検出する加速度センサ、角速度を検出するジャイロセンサ等を有している。車体３、例えば、運転席１０の下方に設けられ、慣性計測装置４２によって、車体３のロール角、ピッチ角、ヨー角等を検出することができる。
図１に示すように、トラクタ１は、操舵装置１１を備えている。操舵装置１１は、運転者の操作によって車体３の操舵を行う手動操舵と、運転者の操作によらずに自動的に車体３の操舵を行う自動操舵とを行うことが可能な装置である。
The
As shown in FIG. 1 , the
操舵装置１１は、ステアリングハンドル（ステアリングホイール）３０と、ステアリングハンドル３０を回転可能に支持するステアリングシャフト(回転軸)３１とを有している。また、操舵装置１１は、補助機構（パワーステアリング装置）３２を有している。補助機構３２は、油圧等によってステアリングシャフト３１（ステアリングハンドル３０）の回転を補助する。補助機構３２は、油圧ポンプ３３と、油圧ポンプ３３から吐出した作動油が供給される制御弁３４と、制御弁３４により作動するステアリングシリンダ３５とを含んでいる。制御弁３４は、例えば、スプール等の移動によって切り換え可能な３位置切換弁であり、ステアリングシャフト３１の操舵方向（回転方向）に対応して切り換わる。ステアリングシリンダ３５は、前輪７Ｆの向きを変えるアーム（ナックルアーム）３６に接続されている。
The
したがって、運転者がステアリングハンドル３０を把持して一方向又は他方向に操作すれば、当該ステアリングハンドル３０の回転方向に対応して制御弁３４の切換位置及び開度が切り換わり、当該制御弁３４の切換位置及び開度に応じてステアリングシリンダ３５が左又は右に伸縮することによって、前輪７Ｆの操舵方向を変更することができる。つまり、車体３は、ステアリングハンドル３０の手動操舵によって、進行方向を左又は右に変更することができる。
Therefore, when the driver grips the steering handle 30 and operates it in one direction or the other, the switching position and the degree of opening of the
次に、自動操舵について説明する。
図２に示すように、自動操舵を行うに際しては、まず、自動操舵を行う前に走行基準ラインＬ１を設定する。走行基準ラインＬ１の設定後に、当該走行基準ラインＬ１に平行な走行予定ラインＬ２の設定を行うことによって自動操舵を行うことができる。自動操舵では、測位装置４０によって測定された車体位置と走行予定ラインをＬ２とが一致するように、トラクタ１（車体３）の進行方向の操舵を自動的に行う。
Next, automatic steering will be described.
As shown in FIG. 2, when performing automatic steering, first, a driving reference line L1 is set before performing automatic steering. After setting the driving reference line L1, automatic steering can be performed by setting a planned driving line L2 parallel to the driving reference line L1. In the automatic steering, the tractor 1 (body 3) is automatically steered in the direction of travel so that the vehicle body position measured by the
具体的には、自動操舵を行う前にトラクタ１（車体３）を圃場内の所定位置に移動させ（Ｓ１）、所定位置にて運転者がトラクタ１に設けられた操舵切換スイッチ５２の操作を行うと（Ｓ２）、測位装置４０によって測定された車体位置が走行基準ラインＬ１の始点Ｐ１０に設定される（Ｓ３）。また、トラクタ１（車体３）を走行基準ラインＬ１の始点Ｐ１０から移動させ（Ｓ４）、所定の位置で運転者が操舵切換スイッチ５２の操作を行うと（Ｓ５）、測位装置４０によって測定された車体位置が走行基準ラインＬ１の終点Ｐ１１に設定される（Ｓ６）。したがって、始点Ｐ１０と終点Ｐ１１とを結ぶ直線が走行基準ラインＬ１として設定される。
Specifically, before automatic steering is performed, the tractor 1 (body 3) is moved to a predetermined position in the field (S1), and the driver operates the
走行基準ラインＬ１の設定後（Ｓ６後）、例えば、トラクタ１（車体３）を、走行基準ラインＬ１を設定した場所とは異なる場所に移動させ（Ｓ７）、運転者が操舵切換スイッチ５２の操作を行うと（Ｓ８）、走行基準ラインＬ１に平行な直線である走行予定ラインＬ２が設定される（Ｓ９）。走行予定ラインＬ２の設定後、自動操舵が開始され、トラクタ１（車体３）の進行方向が走行予定ラインＬ２に沿うように変更される。例えば、現在の車体位置が走行予定ラインＬ２に対して左側にある場合には、前輪７Ｆが右に操舵され、現在の車体位置が走行予定ラインＬ２に対して右側にある場合には、前輪７Ｆが左に操舵される。なお、自動操舵中において、トラクタ１（車体３）の走行速度（車速）は、運転者が手動で当該トラクタ１に設けられたアクセル部材（アクセルペダル、アクセルレバ
ー）の操作量を変更したり、変速装置５の変速段を変更することにより変更することができる。
After setting the traveling reference line L1 (after S6), for example, the tractor 1 (vehicle body 3) is moved to a location different from the location where the traveling reference line L1 is set (S7), and the driver operates the
また、自動操舵の開始後、運転者が任意の箇所で操舵切換スイッチ５２の操作を行うと、自動操舵を終了することができる。即ち、走行予定ラインＬ２の終点は、操舵切換スイッチ５２の操作による自動操舵の終了によって設定することができる。つまり、走行予定ラインＬ２の始点から終点までの長さは、走行基準ラインＬ１よりも長く設定したり、短く設定することができる。言い換えれば、走行予定ラインＬ２は、走行基準ラインＬ１の長さとは関連付けされておらず、走行予定ラインＬ２によって、走行基準ラインＬ１の長さよりも長い距離を自動操舵しながら走行させることができる。
Further, after the automatic steering is started, the automatic steering can be terminated when the driver operates the
図１に示すように、操舵装置１１は、自動操舵機構３７を有している。自動操舵機構３７は、車体３の自動操舵を行う機構であって、測位装置４０で検出された車体３の位置（車体位置）に基づいて車体３を自動操舵する。自動操舵機構３７は、ステアリングモータ３８とギア機構３９とを備えている。ステアリングモータ３８は、車体位置に基づいて、回転方向、回転速度、回転角度等が制御可能なモータである。ギア機構３９は、ステアリングシャフト３１に設けられ且つ当該ステアリングシャフト３１と供回りするギアと、ステアリングモータ３８の回転軸に設けられ且つ当該回転軸と供回りするギアとを含んでいる。ステアリングモータ３８の回転軸が回転すると、ギア機構３９を介して、ステアリングシャフト３１が自動的に回転（回動）し、車体位置が走行予定ラインＬ２に一致するように、前輪７Ｆの操舵方向を変更することができる。
As shown in FIG. 1 , the
図１に示すように、トラクタ１は、表示装置４５を備えている。表示装置４５は、トラクタ１に関する様々な情報を表示可能な装置であって、少なくともトラクタ１の運転情報を表示可能である。表示装置４５は、運転席１０の前方に設けられている。
図１に示すように、トラクタ１は、設定スイッチ５１を備えている。設定スイッチ５１は、少なくとも自動操舵の開始前の設定を行う設定モードに切り換えるスイッチである。設定モードは、自動操舵を開始する前に当該自動操舵に関する様々な設定を行うモードであり、例えば、走行基準ラインＬ１の始点、終点の設定等を行うモードである。
As shown in FIG. 1, the
As shown in FIG. 1 , the
設定スイッチ５１は、ＯＮ又はＯＦＦに切換可能であり、ＯＮである場合には設定モードが有効である信号を出力し、ＯＦＦである場合には設定モードが無効である信号を出力する。また、設定スイッチ５１は、ＯＮである場合には設定モードが有効である信号を表示装置４５に出力し、ＯＦＦである場合には設定モードが無効である信号を表示装置４５に出力する。
The setting
トラクタ１は、操舵切換スイッチ５２を備えている。操舵切換スイッチ５２は、自動操舵の開始又は終了を切り換えるスイッチである。具体的には、操舵切換スイッチ５２は、中立位置から上、下、前、後に切換可能であり、設定モードが有効である状態で中立位置から下方に切り換えられた場合には自動操舵の開始を出力し、設定モードが有効である状態で中立位置から上方に切り換えられた場合には自動操舵の終了を出力する。また、操舵切換スイッチ５２は、設定モードが有効である状態で中立位置から後に切り換えられた場合には、現在の車体位置を走行基準ラインＬ１の始点Ｐ１０に設定することを出力し、操舵切換スイッチ５２は、設定モードが有効である状態で中立位置から前に切り換えられた場合には、現在の車体位置を走行基準ラインＬ１の終点Ｐ１１に設定することを出力する。
The
トラクタ１は、補正スイッチ５３を備えている。補正スイッチ５３は、測位装置４０によって測定された車体位置（緯度、経度）を補正するスイッチである。即ち、補正スイッチ５３は、衛星信号（測位衛星の位置、送信時刻、補正情報等）と、慣性計測装置４２で計測した測定情報（加速度、角速度）とで演算された車体位置（演算車体位置という）を補正するスイッチである。
The
補正スイッチ５３は、押圧可能なプッシュスイッチ又はスライド可能なスライドスイッチで構成されている。以下、補正スイッチ５３がプッシュスイッチ、スライドスイッチのそれぞれである場合について説明する。
補正スイッチ５３がプッシュスイッチである場合、当該プッシュスイッチの操作回数に
基づいて、補正量が設定される。補正量は、補正量＝操作回数×１回の操作回数当たりの補正量により決定される。例えば、図３Ａに示すように、プッシュスイッチを操作する毎に、補正量が数センチ或いは数十センチずつ増加する。プッシュスイッチの操作回数は、第１制御装置６０Ａに入力され、当該第１制御装置６０Ａが操作回数に基づいて補正量を設定（演算）する。
The
When the
また、補正スイッチ５３がスライドスイッチである場合、当該スライドスイッチの操作量（変位量）に基づいて、補正量が設定される。例えば、補正量は、補正量＝所定位置からの変位量により決定される。例えば、図３Ｂに示すように、スライドスイッチの変位量が５ｍｍ増加する毎に、補正量が数センチ或いは数十センチずつ増加する。スライドスイッチの操作量（変位量）は、第１制御装置６０Ａに入力され、当該第１制御装置６０Ａが変位量に基づいて補正量を設定（演算）する。なお、上述した補正量の増加方法及び増加の割合は、上述した数値に限定されない。
Further, when the
詳しくは、図４Ａ及び図４Ｂに示すように、補正スイッチ５３は、第１補正部５３Ａと、第２補正部５３Ｂとを有している。第１補正部５３Ａは、車体３の幅方向における一方側、即ち、左側に対応する車体位置の補正を指令する部分である。第２補正部５３Ｂは、車体３の幅方向における他方側、即ち、右側に対応する車体位置の補正を指令する部分である。
Specifically, as shown in FIGS. 4A and 4B, the
図４Ａに示すように、補正スイッチ５３がプッシュスイッチである場合、第１補正部５３Ａ及び第２補正部５３Ｂは、操作を行う毎に自動的に復帰するＯＮ又はＯＦＦのスイッチである。第１補正部５３Ａを構成するスイッチと第２補正部５３Ｂを構成するスイッチとは一体化されている。なお、第１補正部５３Ａを構成するスイッチと第２補正部５３Ｂを構成するスイッチとは互いに離間して配置されていてもよい。図３Ａに示すように、第１補正部５３Ａを押圧する毎に、車体３の左側に対応する補正量（左補正量）が増加する。また、第２補正部５３Ｂを押圧する毎に、車体３の右側に対応する補正量（右補正量）が増加する。
As shown in FIG. 4A, when the
図４Ｂに示すように、補正スイッチ５３がスライドスイッチである場合、第１補正部５３Ａ及び第２補正部５３Ｂは、長孔の長手方向に沿って左又は右に移動する摘み部５５を含んでいる。補正スイッチ５３がスライドスイッチである場合、第１補正部５３Ａと第２補正部５３Ｂとは互いに幅方向に離間して配置されている。図３Ｂに示すように、摘み部５５を予め定められた基準位置から徐々に左側へ変位させると、変位量に応じて左補正量が増加する。また、摘み部５５を予め定められた基準位置から徐々に右側へ変位させると、変位量に応じて右補正量が増加する。なお、図４Ｂに示すように、スライドスイッチである場合、第１補正部５３Ａと第２補正部５３Ｂとを一体化に形成し、摘み部５５の基準位置を中央部に設定し、基準位置から左側に移動した場合に左補正量が設定され、摘み部５５を中間位置から右側に移動した場合に右補正量が設定される構成としてもよい。
As shown in FIG. 4B, when the
次に、補正スイッチ５３による補正量（左補正量、右補正量）と、走行予定ラインＬ２と、トラクタ１（車体３）の挙動（走行軌跡）との関係について説明する。
図５Ａは、自動操舵中で直進中に演算車体位置Ｗ１が右にずれた場合の状態を示している。図５Ａに示すように、自動操舵が開始された状態において、実際のトラクタ１（車体３）の位置（実際位置Ｗ２）と演算車体位置Ｗ１とが一致し、且つ、実際位置Ｗ２と走行予定ラインＬ２とが一致している場合、トラクタ１は走行予定ラインＬ２に沿って走行する。即ち、測位装置４０の測位に誤差がなく、測位装置４０で検出した車体位置（演算車体位置Ｗ１）が実際位置Ｗ２と同じである区間Ｐ１では、トラクタ１は走行予定ラインＬ２に沿って走行する。なお、測位装置４０の測位に誤差がなく補正も行われていない場合は、演算車体位置Ｗ１と、補正量で補正した補正後の車体位置（補正車体位置）Ｗ３とは同じ値である。補正車体位置Ｗ３は、補正車体位置Ｗ３＝演算車体位置Ｗ１－補正量である。
Next, the relationship between the correction amount (left correction amount, right correction amount) by the
FIG. 5A shows a state in which the calculated vehicle body position W1 deviates to the right while the vehicle is traveling straight under automatic steering. As shown in FIG. 5A, when the automatic steering is started, the actual position (actual position W2) of the tractor 1 (vehicle body 3) and the calculated vehicle body position W1 match, and the actual position W2 and the planned travel line If L2 matches, the
ここで、位置Ｐ２０の付近において、実際位置Ｗ２が走行予定ラインＬ２に対してズレていないのにも関わらず、様々な影響により、測位装置４０の測位に誤差が生じ、測位装置４０で検出した車体位置Ｗ１が走行予定ラインＬ２（実際位置Ｗ２）に対して右側にズ
レてしまい、ズレ量Ｗ４が維持されているとすると、トラクタ１は、演算車体位置Ｗ１と走行予定ラインＬ２とにズレが生じたと判断し、演算車体位置Ｗ１と走行予定ラインＬ２とのズレ量Ｗ４を解消するように、当該トラクタ１を左に操舵する。そうすると、トラクタ１の実際位置Ｗ２は左の操舵によって走行予定ラインＬ２にシフトする。その後、運転者がトラクタ１が走行予定ラインＬ２からズレていることに気づき、位置Ｐ２１にて第２補正部５３Ｂを操舵して右補正量を零から増加させたとする。演算車体位置Ｗ１に対して右補正量が加えられ、補正後の車体位置（補正車体位置）Ｗ３は、実際位置Ｗ２と略同じにすることができる。つまり、第２補正部５３Ｂによって右補正量を設定することにより、位置Ｐ２０の付近において発生したズレ量Ｗ４を解消する方向に、測位装置４０の車体位置を補正することができる。なお、図５Ａの位置Ｐ２１に示すように、車体位置の補正後、トラクタ１の実際位置Ｗ２が走行予定ラインＬ２から左側に離れている場合は、トラクタ１は右に操舵され、当該トラクタ１の実際位置Ｗ２を、走行予定ラインＬ２に一致させることができる。
Here, in the vicinity of the position P20, although the actual position W2 is not deviated from the planned travel line L2, due to various influences, an error occurs in the positioning of the
図５Ｂは、自動操舵中で直進中に演算車体位置Ｗ１が左にずれた場合の状態を示している。図５Ｂに示すように、自動操舵が開始された状態において、実際位置Ｗ２と演算車体位置Ｗ１とが一致し、且つ、実際位置Ｗ２と走行予定ラインＬ２とが一致している場合、図５Ａと同様に、トラクタ１は走行予定ラインＬ２に沿って走行する。即ち、図５Ａと同様に、測位装置４０の測位に誤差がない区間Ｐ２では、トラクタ１は走行予定ラインＬ２に沿って走行する。また、図５Ａと同様に、演算車体位置Ｗ１と補正車体位置Ｗ３とは同じ値である。
FIG. 5B shows a state in which the calculated vehicle body position W1 deviates to the left while the vehicle is traveling straight under automatic steering. As shown in FIG. 5B, when the actual position W2 and the calculated vehicle body position W1 match and the actual position W2 and the planned travel line L2 match in a state in which the automatic steering is started, as shown in FIG. Similarly, the
ここで、位置Ｐ２２において、様々な影響により、測位装置４０の測位に誤差が生じ、測位装置４０で検出した車体位置Ｗ１が実際位置Ｗ２に対して左側にズレてしまい、ズレ量Ｗ５が維持されているとすると、トラクタ１は、演算車体位置Ｗ１と走行予定ラインＬ２とのズレ量Ｗ５を解消するように、当該トラクタ１を右に操舵する。その後、運転者がトラクタ１が走行予定ラインＬ２からズレていることに気づき、運転者が位置Ｐ２３にて第１補正部５３Ａを操舵して左補正量を零から増加させたとする。そうすると、演算車体位置Ｗ１に対して左補正量が加えられ、補正後の車体位置（補正車体位置）Ｗ３は、実際位置Ｗ２と略同じにすることができる。つまり、第１補正部５３Ａによって左補正量を設定することにより、位置Ｐ２２の付近において発生したズレ量Ｗ５を解消する方向に、測位装置４０の車体位置を補正することができる。なお、図５Ｂの位置Ｐ２３に示すように、車体位置の補正後、トラクタ１の実際位置Ｗ２が走行予定ラインＬ２から右側に離れている場合は、トラクタ１は左に操舵され、当該トラクタ１の実際位置Ｗ２を、走行予定ラインＬ２に一致させることができる。
Here, at the position P22, various influences cause an error in the positioning of the
次に、設定スイッチ５１、補正スイッチ５３について説明する。
図６に示すように、ステアリングシャフト３１の外周は、ステアリングポスト１８０により覆われている。ステアリングポスト１８０の外周は、カバー１７７により覆われている。カバー１７７は、運転席１０の前方に設けられている。カバー１７７は、パネルカバー１７８とコラムカバー１７９とを含んでいる。
Next, the setting
As shown in FIG. 6, the outer circumference of the steering
パネルカバー１７８は、表示装置４５を支持している。パネルカバー１７８の上板部１７８ａには、表示装置４５を支持する支持部１７８ｅが設けられている。支持部１７８ｅは、ステアリングシャフト３１の前方且つステアリングハンドル３０の下方において表示装置４５を支持している。また、上板部１７８ａは、設定スイッチ５１及び補正スイッチ５３が取り付けられた取付面１７８ｆを有している。取付面１７８ｆは、支持部１７８ｅの後方であって且つステアリングハンドル３０の下方に設けられている。支持部１７８ｅと取付面１７８ｆとは連続しており、支持部１７８ｅは上板部１７８ａの前部に位置し、取付面１７８ｆは上板部１７８ａの後部に位置している。設定スイッチ５１、補正スイッチ５３は、取付面１７８ｆに取り付けられている。これにより、設定スイッチ５１、補正スイッチ５３は、ステアリングシャフト３１の周囲に配置されている。
A
パネルカバー１７８の左板部１７８ｂからはシャトルレバー１８１が突出している。シャトルレバー１８１は、車体３の走行方向を切り換える操作を行う部材である。より詳し
く説明すると、シャトルレバー１８１を前方に操作（揺動）することにより、前後進切換部１３が走行装置７へ前進動力を出力する状態となり、車体３の走行方向が前進方向に切り換えられる。また、シャトルレバー１８１を後方に操作（揺動）することにより、前後進切換部１３が走行装置７へ後進動力を出力する状態となり、車体３の走行方向が後進方向に切り換えられる。シャトルレバー１８１が中立位置にあるときには、走行装置７へ動力が出力されない。
A
コラムカバー１７９は、ステアリングハンドル３０の下方に配置されており、ステアリングシャフト３１の上部の周囲を覆っている。コラムカバー１７９は、略四角筒状に形成されており、パネルカバー１７８の取付面１７８ｆから上方に突出している。つまり、取付面１７８ｆは、コラムカバー１７９の周囲に設けられている。そのため、取付面１７８ｆに取り付けられた設定スイッチ５１、補正スイッチ５３は、コラムカバー１７９の周囲に配置されている。
The
次に、設定スイッチ５１、操舵切換スイッチ５２、補正スイッチ５３のそれぞれの配置について詳しく説明する。図６に示すように、設定スイッチ５１、操舵切換スイッチ５２、補正スイッチ５３は、ステアリングシャフト３１の周囲に配置されている。
設定スイッチ５１は、ステアリングシャフト３１の一側方（左方）に配置されている。操舵切換スイッチ５２は、ステアリングシャフト３１の一側方（左方）に配置されている。本実施形態の場合、操舵切換スイッチ５２は、揺動可能なレバーから構成されている。操舵切換スイッチ５２は、ステアリングシャフト３１側に設けられた基端部を支点として揺動可能である。操舵切換スイッチ５２の基端部は、コラムカバー１７９の内部に設けられている。操舵切換スイッチ５２は、コラムカバー１７９の一側方（左方）に突出している。
Next, the arrangement of the setting
The setting
補正スイッチ５３は、ステアリングシャフト３１の他側方（右方）に配置されている。より詳しくは、補正スイッチ５３は、ステアリングシャフト３１の右方且つ後方（斜め右後方）に配置されている。補正スイッチ５３は、コラムカバー１７９との位置関係では、コラムカバー１７９の右方且つ後方（斜め右後方）に配置されている。補正スイッチ５３は、パネルカバー１７８の取付面１７８ｆとの位置関係では、取付面１７８ｆの右後部に配置されている。補正スイッチ５３が傾斜した取付面１７８ｆの後部に配置されていることによって、補正スイッチ５３とステアリングハンドル３０との距離を長く確保することができる。これにより、意図しない補正スイッチ５３の操作やステアリングハンドル３０の操舵をより確実に防止できる。
The
上述の通り、設定スイッチ５１、操舵切換スイッチ５２、補正スイッチ５３は、ステアリングシャフト３１の周囲に配置されている。言い換えれば、設定スイッチ５１、操舵切換スイッチ５２、補正スイッチ５３は、ステアリングシャフト３１の周囲に集約して存在している。そのため、運転者は、各スイッチの位置を一目瞭然で把握することができる。加えて、運転者は、運転席１０に着座したままの状態で姿勢を変えずに各スイッチを操作することができる。そのため、操作性が良好となり、且つ誤操作を防止することができる。また、各スイッチから配策されるハーネス（配線）を短くすることができる。
As described above, the setting
尚、上述したスイッチの配置について、左と右とを入れ替えて配置してもよい。つまり、一側方が左方であって他側方が右方であってもよいし、一側方が右方であって他側方が左方であってもよい。具体的には、例えば、設定スイッチ５１及び操舵切換スイッチ５２をステアリングシャフト３１の右方に配置し、補正スイッチ５３をステアリングシャフト３１の左方に配置してもよい。
Incidentally, regarding the arrangement of the switches described above, the left and right sides may be interchanged. That is, one side may be the left side and the other side may be the right side, or one side may be the right side and the other side may be the left side. Specifically, for example, the setting
図１に示すように、トラクタ１は、複数の制御装置６０を備えている。複数の制御装置６０は、トラクタ１における走行系の制御、作業系の制御、車体位置の演算等を行う装置である。複数の制御装置６０は、第１制御装置６０Ａ、第２制御装置６０Ｂ及び第３制御装置６０Ｃである。
第１制御装置６０Ａは、受信装置４１が受信した衛星信号（受信情報）と、慣性計測装置４２が測定した測定情報（加速度、角速度等）を受信し、受信情報及び測定情報に基づいて車体位置を求める。例えば、第１制御装置６０Ａは、補正スイッチ５３による補正量
が零である場合、即ち、補正スイッチ５３による車体位置の補正が指令されていない場合、受信情報と測定情報とで演算された演算車体位置Ｗ１に対して補正を行わず、演算車体位置Ｗ１を自動操舵時に用いる車体位置に決定する。一方、第１制御装置６０Ａは、補正スイッチ５３による車体位置の補正が指令されている場合、補正スイッチ５３の操作回数及び補正スイッチ５３の操作量（変位量）のいずれかに基づいて車体位置の補正量を設定し、演算車体位置Ｗ１を補正量で補正した補正車体位置Ｗ３を自動操舵時に用いる車体位置に決定する。
As shown in FIG. 1 , the
The
第１制御装置６０Ａは、車体位置（演算車体位置Ｗ１、補正車体位置Ｗ３）及び走行予定ラインＬ２に基づいて制御信号を設定し、制御信号を第２制御装置６０Ｂに出力する。第２制御装置６０Ｂは、自動操舵制御部２００を有している。自動操舵制御部２００は、第２制御装置６０Ｂに設けられた電気・電子回路、ＣＰＵ等に格納されたプログラム等から構成されている。自動操舵制御部２００は、第１制御装置６０Ａから出力された制御信号に基づいて車体３が走行予定ラインＬ２に沿って走行するように自動操舵機構３７のステアリングモータ３８を制御する。
The
図７に示すように、車体位置と走行予定ラインＬ２との偏差が閾値未満である場合、自動操舵制御部２００は、ステアリングモータ３８の回転軸の回転角を維持する。車体位置と走行予定ラインＬ２との偏差が閾値以上であって、トラクタ１が走行予定ラインＬ２に対して左側に位置している場合は、自動操舵制御部２００は、トラクタ１の操舵方向が右方向となるようにステアリングモータ３８の回転軸を回転する。車体位置と走行予定ラインＬ２との偏差が閾値以上であって、トラクタ１が走行予定ラインＬ２に対して右側に位置している場合は、自動操舵制御部２００は、トラクタ１の操舵方向が左方向となるようにステアリングモータ３８の回転軸を回転する。なお、上述した実施形態では、車体位置と走行予定ラインＬ２との偏差に基づいて操舵装置１１の操舵角を変更していたが、走行予定ラインＬ２の方位とトラクタ１（車体３）の進行方向（走行方向）の方位（車体方位）Ｆ１とが異なる場合、即ち、走行予定ラインＬ２に対する車体方位Ｆ１の角度θｇが閾値以上である場合、自動操舵制御部２００は、角度θｇが零（車体方位Ｆ１が走行予定ラインＬ２の方位に一致）するように操舵角を設定してもよい。また、自動操舵制御部２００は、偏差（位置偏差）に基づいて求めた操舵角と、方位（方位偏差）に基づいて求めた操舵角とに基づいて、自動操舵における最終の操舵角を設定してもよい。上述した実施形態における自動操舵における操舵角の設定は一例であり、限定されない。
As shown in FIG. 7, the automatic
第３制御装置６０Ｃは、運転席１０の周囲に設けられた操作部材の操作に応じて、連結部８を昇降させる。なお、第１制御装置６０Ａ、第２制御装置６０Ｂ及び第３制御装置６０Ｃは一体化されていてもよい。また、上述した走行系の制御、作業系の制御、車体位置の演算は限定されない。
以上のように、制御装置６０によって、トラクタ１（車体３）を自動操舵することができる。
The
As described above, the
上述したように自動操舵中のトラクタ１（車体３）は、車体３と走行予定ラインＬ２との位置偏差及び方位偏差のいずれかを零にする（小さくする）ように自動操舵を行う。図８に示すように、制御装置６０（第１制御装置６０Ａ）は、自動操舵を行う際に走行予定ラインＬ２よりも車体３に近い位置、即ち、車体位置（演算車体位置Ｗ１、補正車体位置Ｗ３）と走行予定ラインＬ２との間に目標走行ラインＡＬｎ（ｎ＝１，２，３・・・・）を設定する。目標走行ラインＡＬｎは、走行予定ラインＬ２と略平行な直線である。
As described above, the tractor 1 (body 3) during automatic steering performs automatic steering so as to zero (reduce) either the position deviation or the azimuth deviation between the
第１制御装置６０Ａは、目標ライン設定部２１３を備えている。目標ライン設定部２１３は、制御装置６０に設けられた電気・電子部品、当該制御装置６０に組み込まれたプログラム等から構成されている。目標ライン設定部２１３は、位置偏差が所定以上である場合に目標走行ラインＡＬｎの設定を行う。
図８は、目標ライン設定部２１３を備えていないトラクタ１（以降、通常トラクタと呼ぶ）の走行軌跡Ｋ１と、目標ライン設定部２１３を備えているトラクタ１（以降、本トラクタと呼ぶ）の走行軌跡Ｋ２とを示している。トラクタ１（通常トラクタ、本トラクタ）は、走行予定ラインＬ２に対して位置偏差Δｘだけ離れ且つ方位偏差がゼロ、即ち、走行
予定ラインＬ２より左側に位置偏差Δｘだけ位置ズレした状態で地点Ｐ２０上に存在しているとする。
The
FIG. 8 shows a travel locus K1 of a
通常トラクタが自動操舵を行った場合、操舵装置１１によって車体３が走行予定ラインＬ２に近づくように操舵角が設定されながら進むため、通常トラクタの走行軌跡は走行軌跡Ｋ１のようになる。
一方、本トラクタが自動操舵を行う場合、目標ライン設定部２１３は、地点Ｐ２０における位置偏差Δｘが予め定められた第１設定判定値よりも大きい（所定以上）であれば、現在の車体位置（地点Ｐ２０）と走行予定ラインＬ２との間に目標走行ラインＡＬ１（ｎ＝１）を設定する。目標ライン設定部２１３は、地点Ｐ２０から設定距離Ｘ１だけ離れた位置に走行予定ラインＬ２と平行な目標走行ラインＡＬ１を設定する。
When the tractor normally performs automatic steering, the
On the other hand, when the tractor performs automatic steering, the target
目標ライン設定部２１３が目標走行ラインＡＬ１を設定後は、第２制御装置６０Ｂの自動操舵制御部２００によって、車体３が目標走行ラインＡＬ１に近づくように操舵装置１１の操舵角及び操舵方向が設定される自動操舵を実行する。目標走行ラインＡＬ１に基づく自動操舵後、目標ライン設定部２１３は、任意の地点における位置偏差Δｘが第１設定判定値よりも大きいか否かを判定し、位置偏差Δｘが第１設定判定値よりも大きい場合は、目標ライン設定部２１３は、例えば、地点Ｐ２１と走行予定ラインＬ２との間に新しい目標走行ラインＡＬ２（ｎ＝２）を再設定する。新しい目標走行ラインＡＬ２を再設定後は、第２制御装置６０Ｂの自動操舵制御部２００によって、車体３が目標走行ラインＡＬ２に近づくように操舵装置１１の操舵角及び操舵方向が設定される自動操舵を実行する。目標走行ラインＡＬ２の設定後、目標ライン設定部２１３は、任意の地点における位置偏差Δｘが第１設定判定値よりも小さい場合は、目標走行ラインＡＬｎの再設定は停止する。目標走行ラインＡＬｎの再設定の停止は、本トラクタは、走行予定ラインＬ２に従って自動操舵を行う。
After the target
つまり、目標ライン設定部２１３は、現在の車体位置と走行予定ラインＬ２との位置偏差Δｘが第１設定判定値よりも小さくなるまで、目標走行ラインＡＬｎの再設定を繰り返し、自動操舵制御部２００は、再設定された目標走行ラインＡＬｎに車体３が近づくように自動操舵を行う。
上述したように、目標走行ラインＡＬｎの再設定を行いながら自動操舵を行った場合は、自動操舵における本トラクタの走行軌跡Ｋ２は、通常トラクタの走行軌跡Ｋ１よりも比較的なだらかな軌跡を描くようになる。つまり、通常トラクタ及び本トラクタが走行予定ラインＬ２に向けて自動操舵を行う場合において、目標走行ラインＡＬｎへ向けて走行する本トラクタの操舵角は、通常トラクタの操舵角よりも小さくすることができるため、本トラクタを徐々に走行予定ラインＬ２に近づけることができる。
That is, the target
As described above, when automatic steering is performed while resetting the target travel line ALn, the travel locus K2 of the tractor in the automatic steering draws a relatively smoother locus than the travel locus K1 of the normal tractor. become. That is, when the normal tractor and the main tractor automatically steer toward the planned travel line L2, the steering angle of the main tractor traveling toward the target travel line ALn can be made smaller than the steering angle of the normal tractor. Therefore, the tractor can be gradually brought closer to the scheduled travel line L2.
次に、目標ライン設定部２１３が、トラクタ１（車体３）の走行距離に基づいて、目標走行ラインの再設定を行う場合の説明をする。
制御装置６０は、車体３の走行距離を算出する距離算出部２１４を備えている。距離算出部２１４は、制御装置６０に設けられた電気・電子部品、当該制御装置６０に組み込まれたプログラム等から構成されている。距離算出部２１４は、例えば、目標ライン設定部２１３が目標走行ラインＡＬｎを設定した地点から現在の車体３までの走行距離を求める。距離算出部２１４は、トラクタ１に設けられた走行距離計に基づいて、目標ライン設定部２１３が目標走行ラインＡＬｎを設定した地点から現在の車体３までの走行距離を求める。距離算出部２１４は、目標ライン設定部２１３が目標走行ラインＡＬｎを設定した地点における走行距離計の数値と、所定時間後の走行距離計の数値との差から走行距離を求める。
Next, a case where the target
The
なお、距離算出部２１４は、目標ライン設定部２１３が目標走行ラインＡＬｎを設定した時点での測位装置４０が検出した車体位置と、所定時間後の測位装置４０が検出した車体位置との差分を演算することで、走行距離を算出してもよい。
目標ライン設定部２１３は、自動操舵制御部２００が目標走行ラインＡＬｎに基づく自動操舵を実行中に距離算出部２１４が算出した走行距離が閾値を超えた場合に、目標走行ラインＡＬｎの再設定を行う。
Note that the
The target
図９Ａは、走行距離Ｌｘに基づいて目標走行ラインＡＬｎを行いながら自動操舵を行った場合のトラクタ１の走行軌跡Ｋ２を示した図である。図９Ａに示すように、トラクタ１（車体３）は自動操舵による走行中であり、走行予定ラインＬ２から左側に位置偏差Δｘの地点ＬＰ０に存在している。このとき、地点ＬＰ０における位置偏差Δｘは、予め定められた第１設定判定値（判定距離Ｊｘ）以上であるため、目標ライン設定部２１３は、車体３（地点ＬＰ０）から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬ１を設定する。自動操舵制御部２００は、目標走行ラインＡＬ１が設定されると、目標走行ラインＡＬ１に従って自動操舵を行う。
FIG. 9A is a diagram showing the travel locus K2 of the
自動操舵制御部２００による目標走行ラインＡＬ１に基づく自動操舵の開始後、目標ライン設定部２１３は、距離算出部２１４が算出した走行距離Ｌｘ（目標走行ラインＡＬ１を設定した地点ＬＰ０から現在の車体３までの走行距離Ｌｘ）を監視する。例えば、地点ＬＰ１において走行距離Ｌｘが閾値以上で且つ車体３と走行予定ラインＬ２との位置偏差Δｘ２が第１設定判定値（判定距離Ｊｘ）以上である場合、目標ライン設定部２１３は目標走行ラインＡＬｎの再設定を行う。目標ライン設定部２１３は、車体３（地点ＬＰ１）から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬ２を設定する。自動操舵制御部２００は、目標走行ラインＡＬ２が設定されると、目標走行ラインＡＬ２に従って自動操舵を行う。
After automatic steering based on the target travel line AL1 is started by the automatic
自動操舵制御部２００による目標走行ラインＡＬ２に基づく自動操舵の開始後、目標ライン設定部２１３は、地点ＬＰ１から現在の車体３までの走行距離Ｌｘを監視する。例えば、地点ＬＰ２において走行距離Ｌｘが閾値以上になった場合、目標ライン設定部２１３は、車体３と走行予定ラインＬ２との位置偏差Δｘ３が第１設定判定値（判定距離Ｊｘ）以上であるか否かを判断する。ここで、目標ライン設定部２１３は位置偏差Δｘ３が第１設定判定値（判定距離Ｊｘ）以上でない場合、目標走行ラインＡＬｎの再設定の停止をする。自動操舵制御部２００は、目標走行ラインＡＬｎの再設定の停止を行うと、走行予定ラインＬ２に従って自動操舵を行う。
After the automatic
図９Ｂは、走行距離Ｌｘに基づいて目標走行ラインＡＬｎを行いながら自動操舵を行った場合のトラクタ１のフローを示している。
トラクタ１（車体３）の自動操舵を開始する（Ｓ２１）と、目標ライン設定部２１３は、現在の車体位置と走行予定ラインＬ２との位置偏差Δｘが目標走行ライン設定の判定距離Ｊｘ以上の大きさであるか確認する（Ｓ２２）。
FIG. 9B shows the flow of the
When automatic steering of the tractor 1 (vehicle body 3) is started (S21), the target
位置偏差Δｘが判定距離Ｊｘ未満の大きさであれば（Ｓ２２、Ｎｏ）、目標ライン設定部２１３は、目標走行ラインＡＬｎの設定を行わない、或いは、目標走行ラインＡＬｎの再設定を停止する（Ｓ２６）。自動操舵制御部２００は、走行予定ラインＬ２に従って自動操舵を行う（Ｓ２７）。一方、位置偏差Δｘが判定距離Ｊｘ以上の大きさであれば（Ｓ２２、Ｙｅｓ）、目標ライン設定部２１３は、車体３から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬｎを設定する（Ｓ２３）。
If the positional deviation Δx is less than the judgment distance Jx (S22, No), the target
トラクタ１（制御装置６０）は目標走行ラインＡＬｎが設定されると、目標走行ラインに従って自動操舵を行う（Ｓ２４）。自動操舵中に、目標ライン設定部２１３は、走行距離Ｌｘが閾値以上であるか否かを判定する（Ｓ２５）。走行距離Ｌｘが閾値未満である場合（Ｓ２５、Ｎｏ）、目標ライン設定部２１３は、目標走行ラインＡＬｎの再設定の処理に移行せず、自動操舵制御部２００は、目標走行ラインＡＬｎに基づく自動操舵を継続する（Ｓ２４）。
When the target travel line ALn is set, the tractor 1 (control device 60) performs automatic steering according to the target travel line (S24). During automatic steering, the target
走行距離Ｌｘが閾値以上である場合（Ｓ２５、Ｙｅｓ）において、車体３と走行予定ラインＬ２との位置偏差Δｘが判定距離Ｊｘ以上の大きさであれば（Ｓ２２、Ｙｅｓ）、目標ライン設定部２１３は、車体３から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬｎを再設定する（Ｓ２３）。位置偏差Δｘが判定距離Jｘ未満の大きさであれば（Ｓ２２、Ｎｏ）、目標走行ラインの設定を停止する（Ｓ２６）。
If the travel distance Lx is equal to or greater than the threshold (S25, Yes), and if the positional deviation Δx between the
次に、目標ライン設定部２１３が、トラクタ１（車体３）と目標走行ラインＡＬｎとの位置偏差に基づいて、目標走行ラインＡＬｎの再設定または停止を行うことについて説明する。なお、説明の便宜上、トラクタ１（車体３）と目標走行ラインＡＬｎとの位置偏差
ＡＸのことを「第１位置偏差」、トラクタ１（車体３）と走行予定ラインＬ２の位置偏差のことを「第２位置偏差」という。
Next, it will be described how the target
目標ライン設定部２１３は、自動操舵制御部２００が自動操舵を実行中に第１位置偏差が所定量小さくなる毎に、目標走行ラインＡＬｎを設定する。
図１０Ａは、第１位置偏差に基づいて目標走行ラインＡＬｎを行いながら自動操舵を行った場合のトラクタ１の走行軌跡を示した図である。
トラクタ１（車体３）は自動操舵による走行中であり、走行予定ラインＬ２から左側に第２位置偏差Δｘの地点ＡＰ０に存在している。このとき、地点ＬＰ０における第２位置偏差Δｘは、予め定められた第１設定判定値（判定距離Ｊｘ）以上であるため、目標ライン設定部２１３は、車体３（地点ＡＰ０）から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬ１を設定する。自動操舵制御部２００は、目標走行ラインＡＬ１が設定されると、目標走行ラインＡＬ１に従って自動操舵を行う。
The target
FIG. 10A is a diagram showing the travel locus of the
The tractor 1 (vehicle body 3) is traveling by automatic steering, and is located at a point AP0 with a second positional deviation Δx on the left side of the planned traveling line L2. At this time, since the second positional deviation Δx at the point LP0 is equal to or greater than the predetermined first set determination value (determination distance Jx), the target
自動操舵制御部２００による目標走行ラインＡＬ１に基づく自動操舵の開始後、目標ライン設定部２１３は、第１位置偏差ＡＸを監視する。地点ＡＰ１において第１位置偏差ＡＸが所定量小さくなり且つ車体３と走行予定ラインＬ２との第２位置偏差Δｘ４が第１設定判定値（判定距離Ｊｘ）以上である場合、目標ライン設定部２１３は目標走行ラインＡＬｎの再設定を行う。目標ライン設定部２１３は、車体３（地点ＡＰ１）から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬ２を設定する。自動操舵制御部２００は、目標走行ラインＡＬ２が設定されると、目標走行ラインＡＬ２に従って自動操舵を行う。
After the automatic
自動操舵制御部２００による目標走行ラインＡＬ２に基づく自動操舵の開始後、目標ライン設定部２１３は、現在の車体３と目標走行ラインＡＬ２との第２位置偏差ＡＸを監視する。例えば、地点ＡＰ２において第２位置偏差ＡＸが所定量小さくなった場合、目標ライン設定部２１３は、車体３と走行予定ラインＬ２との第２位置偏差Δｘ５が第１設定判定値（判定距離Ｊｘ）以上であるか否かを判断する。ここで、目標ライン設定部２１３は第２位置偏差Δｘ５が第１設定判定値（判定距離Ｊｘ）以上でない場合、目標走行ラインＡＬｎの再設定の停止をする。自動操舵制御部２００は、目標走行ラインＡＬｎの再設定の停止を行うと、走行予定ラインＬ２に従って自動操舵を行う。
After the automatic
図１０Ｂは、第２位置偏差ＡＸに基づいて目標走行ラインＡＬｎを行いながら自動操舵を行った場合のトラクタ１のフローを示している。
トラクタ１（車体３）の自動操舵を開始する（Ｓ２１）と、目標ライン設定部２１３は、現在の車体位置と走行予定ラインＬ２との第２位置偏差Δｘが目標走行ライン設定の判定距離Ｊｘ以上の大きさであるか確認する（Ｓ２２）。
FIG. 10B shows the flow of the
When automatic steering of the tractor 1 (vehicle body 3) is started (S21), the target
第２位置偏差Δｘが判定距離Ｊｘ未満の大きさであれば（Ｓ２２、Ｎｏ）、目標ライン設定部２１３は、目標走行ラインＡＬｎの設定を行わない、或いは、目標走行ラインＡＬｎの再設定を停止する（Ｓ２６）。自動操舵制御部２００は、走行予定ラインＬ２に従って自動操舵を行う（Ｓ２７）。一方、第２位置偏差Δｘが判定距離Ｊｘ以上の大きさであれば（Ｓ２２、Ｙｅｓ）、目標ライン設定部２１３は、車体３から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬｎを設定する（Ｓ２３）。
If the second positional deviation Δx is less than the judgment distance Jx (S22, No), the target
トラクタ１（制御装置６０）は目標走行ラインＡＬｎが設定されると、目標走行ラインに従って自動操舵を行う（Ｓ２４）。自動操舵中に、目標ライン設定部２１３は、第１位置偏差ＡＸが所定量小さくなったか否かを判定する（Ｓ３０）。第１位置偏差ＡＸが所定量小さくなっていない場合（Ｓ３０、Ｎｏ）、目標ライン設定部２１３は、目標走行ラインＡＬｎの再設定の処理に移行せず、自動操舵制御部２００は、目標走行ラインＡＬｎに基づく自動操舵を継続する（Ｓ２４）。
When the target travel line ALn is set, the tractor 1 (control device 60) performs automatic steering according to the target travel line (S24). During automatic steering, the target
第１位置偏差ＡＸが所定量小さくなった場合（Ｓ３０、Ｙｅｓ）において、車体３と走行予定ラインＬ２との第２位置偏差Δｘが判定距離Ｊｘ以上の大きさであれば（Ｓ２２、Ｙｅｓ）、目標ライン設定部２１３は、車体３から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬｎを再設定する（Ｓ２３）。第２位置偏差Δｘが判定距離Jｘ未満の大きさであれば（Ｓ２２、Ｎｏ）、目標走行ラインの設定を停止
する（Ｓ２６）。
When the first positional deviation AX has decreased by a predetermined amount (S30, Yes), if the second positional deviation Δx between the
次に、目標ライン設定部２１３が、経過時間に基づいて、目標走行ラインの再設定または解除を行うときの説明をする。
制御装置６０は、目標走行ラインの設定を行ってからの経過時間を計測する計時部２１５を備えている。計時部２１５は、制御装置６０に設けられた電気・電子部品、当該制御装置６０に組み込まれたプログラム等から構成されている。計時部２１５は、任意の時点からの経過時間を計測し、当該経過時間を目標ライン設定部２１３に送信する。
Next, a description will be given of when the target
The
目標ライン設定部２１３は、自動操舵制御部２００が自動操舵を実行中に計時部２１５が計測した経過時間が所定時間を超えた場合に、目標走行ラインＡＬｎを再設定する。
図１１Ａは、経過時間に基づいて目標走行ラインＡＬｎを行いながら自動操舵を行った場合のトラクタ１の走行軌跡を示した図である。
トラクタ１（車体３）は自動操舵による走行中であり、走行予定ラインＬ２から左側に第２位置偏差Δｘの地点ＡＰ０に存在している。このとき、地点ＴＰ０における位置偏差（第２位置偏差）Δｘは、予め定められた第１設定判定値（判定距離Ｊｘ）以上であるため、目標ライン設定部２１３は、車体３（地点ＡＰ０）から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬ１を設定する。自動操舵制御部２００は、目標走行ラインＡＬ１が設定されると、目標走行ラインＡＬ１に従って自動操舵を行う。
The target
FIG. 11A is a diagram showing the travel locus of the
The tractor 1 (body 3) is traveling by automatic steering, and is located at a point AP0 on the left side of the scheduled traveling line L2 with a second positional deviation Δx. At this time, since the positional deviation (second positional deviation) Δx at the point TP0 is equal to or greater than the predetermined first set determination value (determination distance Jx), the target
自動操舵制御部２００による目標走行ラインＡＬ１に基づく自動操舵の開始後、目標ライン設定部２１３は、計時部２１５が計時した経過時間（目標走行ラインＡＬ１の設定を行ってからの第１経過時間）を監視する。地点ＴＰ１において第１経過時間が所定以上となり且つ車体３と走行予定ラインＬ２との第２位置偏差Δｘ６が第１設定判定値（判定距離Ｊｘ）以上である場合、目標ライン設定部２１３は目標走行ラインＡＬｎの再設定を行う。目標ライン設定部２１３は、車体３（地点ＡＰ１）から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬ２を設定する。自動操舵制御部２００は、目標走行ラインＡＬ２が設定されると、目標走行ラインＡＬ２に従って自動操舵を行う。
After automatic steering based on the target travel line AL1 is started by the automatic
自動操舵制御部２００による目標走行ラインＡＬ２に基づく自動操舵の開始後、目標ライン設定部２１３は、目標走行ラインＡＬ２の設定を行ってからの第２経過時間を監視する。例えば、地点ＴＰ２において第２経過時間が所定以上となった場合、目標ライン設定部２１３は、車体３と走行予定ラインＬ２との第２位置偏差Δｘ６が第１設定判定値（判定距離Ｊｘ）以上であるか否かを判断する。ここで、目標ライン設定部２１３は第２位置偏差Δｘ６が第１設定判定値（判定距離Ｊｘ）以上でない場合、目標走行ラインＡＬｎの再設定の停止をする。自動操舵制御部２００は、目標走行ラインＡＬｎの再設定の停止を行うと、走行予定ラインＬ２に従って自動操舵を行う。
After the automatic
図１１Ｂは、経過時間に基づいて目標走行ラインＡＬｎを行いながら自動操舵を行った場合のトラクタ１のフローを示している。
トラクタ１（車体３）の自動操舵を開始する（Ｓ２１）と、目標ライン設定部２１３は、現在の車体位置と走行予定ラインＬ２との第２位置偏差Δｘが目標走行ライン設定の判定距離Ｊｘ以上の大きさであるか確認する（Ｓ２２）。
FIG. 11B shows the flow of the
When automatic steering of the tractor 1 (vehicle body 3) is started (S21), the target
第２位置偏差Δｘが判定距離Ｊｘ未満の大きさであれば（Ｓ２２、Ｎｏ）、目標ライン設定部２１３は、目標走行ラインＡＬｎの設定を行わない、或いは、目標走行ラインＡＬｎの再設定を停止する（Ｓ２６）。自動操舵制御部２００は、走行予定ラインＬ２に従って自動操舵を行う（Ｓ２７）。一方、第２位置偏差Δｘが判定距離Ｊｘ以上の大きさであれば（Ｓ２２、Ｙｅｓ）、目標ライン設定部２１３は、車体３から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬｎを設定する（Ｓ２３）。
If the second positional deviation Δx is less than the judgment distance Jx (S22, No), the target
トラクタ１（制御装置６０）は目標走行ラインＡＬｎが設定されると、目標走行ラインに従って自動操舵を行う（Ｓ２４）。自動操舵中に、目標ライン設定部２１３は、目標走行ラインＡＬｎを設定してからの経過時間が所定以上であるか否かを判定する（Ｓ４０）
。経過時間が所定未満である場合（Ｓ２０、Ｎｏ）、目標ライン設定部２１３は、目標走行ラインＡＬｎの再設定の処理に移行せず、自動操舵制御部２００は、目標走行ラインＡＬｎに基づく自動操舵を継続する（Ｓ２４）。
When the target travel line ALn is set, the tractor 1 (control device 60) performs automatic steering according to the target travel line (S24). During automatic steering, the target
. If the elapsed time is less than the predetermined time (S20, No), the target
経過時間が所定以上である場合（Ｓ２０、Ｙｅｓ）において、車体３と走行予定ラインＬ２との第２位置偏差Δｘが判定距離Ｊｘ以上の大きさであれば（Ｓ２２、Ｙｅｓ）、目標ライン設定部２１３は、車体３から走行予定ラインＬ２に向かって設定距離Ｘ１だけ離れた位置に目標走行ラインＡＬｎを再設定する（Ｓ２３）。第２位置偏差Δｘが判定距離Jｘ未満の大きさであれば（Ｓ２２、Ｎｏ）、目標走行ラインの設定を停止する（Ｓ２６）。
If the elapsed time is equal to or greater than a predetermined time (S20, Yes), and if the second positional deviation Δx between the
上述した実施形態では、目標走行ラインＡＬｎを再設定するにあたっての３つの条件（走行距離、位置偏差、経過時間）を提示したが、これらを組み合わせて用いてもよい。トラクタ１（車体３）の走行距離もしくは位置偏差の変化量のどちらかが所定量となったときに目標走行ラインの再設定を行ってもよいし、トラクタ１の走行距離もしくは経過時間のどちらかが所定量となったときに目標走行ラインの再設定を行ってもよい。また、トラクタ１の位置偏差の変化量もしくは経過時間のどちらかが所定量となったときに目標走行ラインの再設定を行ってもよい。
In the above-described embodiment, three conditions (travel distance, positional deviation, elapsed time) for resetting the target travel line ALn are presented, but these may be used in combination. The target travel line may be reset when either the travel distance of the tractor 1 (body 3) or the amount of change in the positional deviation reaches a predetermined amount, or the travel distance of the
作業車両１は、車体３を操舵する操舵装置１１と、車体３の位置を検出する測位装置４０と、車体３と走行予定ラインとの偏差が小さくなるように操舵装置１１における自動操舵を制御する制御装置６０と、を備え、制御装置６０は、測位装置４０で検出された車体３の位置である車体位置と走行予定ラインＬ２との間に目標走行ラインＡＬｎを設定する目標ライン設定部２１３と、車体３が走行予定ラインＬ２に到達する前に車体３が目標走行ラインＡＬｎに向かうように操舵装置１１の自動操舵を行う自動操舵制御部２００と、を有している。これによれば、車体３が走行予定ラインＬ２に到達する前に、車体位置と走行予定ラインＬ２との間に目標走行ラインＡＬｎが設定することができる。例えば、車体３と走行予定ラインＬ２とが離れている場合に、車体３は目標走行ラインＡＬｎに対して自動操舵を行うことができるため、車体３の走行の挙動を安定化させることができる。言い換えれば、目標走行ラインＡＬｎを設定しない場合と比べ、目標走行ラインＡＬｎへの操舵装置１１における操舵角を緩やかにすることができるため、現在の位置から走行予定ラインＬ２までの移動（走行）をスムーズに行うことができる。
The
目標ライン設定部２１３は、偏差が所定以上である場合に目標走行ラインＡＬｎを設定する。これによれば、目標走行ラインＡＬｎの設定が行い易い。即ち、偏差として位置偏差が大きい場合に目標走行ラインＡＬｎの設定を行うことができる。
作業車両１は、車体３の走行距離を算出する距離算出部２１４を備えており、目標ライン設定部２１３は、自動操舵制御部２００が自動操舵を実行中に距離算出部２１４が算出した走行距離が閾値を超えた場合に、目標走行ラインＡＬｎを再設定する。これによれば、自動操舵の走行距離に基づいて目標走行ラインＡＬｎを設定している。即ち、車体３が所定の走行距離だけ進む毎に目標走行ラインＡＬｎの設定をし直すことができ、車体３を走行距離進む毎に徐々に走行予定ラインＬ２に近づけることができる。
The target
The
目標ライン設定部２１３は、自動操舵制御部２００が自動操舵を実行中に偏差が所定量小さくなる毎に、目標走行ラインＡＬｎを再設定する。これによれば、自動操舵を行った場合において、車体３とライン（走行予定ラインＬ２、目標走行ライン）との偏差が小さくなる毎に目標走行ラインＡＬｎの設定をし直すことができ、車体３を徐々に走行予定ラインＬ２に近づけることができる。
The target
作業車両１は、目標走行ラインＡＬｎの設定を行ってからの経過時間を計測する計時部２１５を備えており、目標ライン設定部２１３は、自動操舵制御部２００が自動操舵を実行中に計時部２１５が計測した経過時間が所定時間を超えた場合に、目標走行ラインＡＬｎを再設定する。これによれば、自動操舵を行った場合において、所定時間毎に目標走行ラインＡＬｎの設定をし直すことができ、車体３を徐々に走行予定ラインＬ２に近づけることができる。
The
目標ライン設定部２１３は、偏差が所定未満である場合に目標走行ラインＡＬｎの設定
を終了する。これによれば、繰り返し目標走行ラインＡＬｎを設定しているような状況下において、簡単に目標走行ラインＡＬｎに基づく自動操舵から走行予定ラインＬ２に基づく自動操舵に切り換えることができる。
作業車両１は、手動操舵により車体３の操舵を行うステアリングハンドル３０と、自動操舵の開始及び終了のいずれかを切り換える操舵切換スイッチ５２と、を備えている。これによれば、操舵切換スイッチ５２の切換によって簡単に自動操舵と、手動操舵とを切り換えることができる。
The target
The
今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。 It should be considered that the embodiments disclosed this time are illustrative in all respects and not restrictive. The scope of the present invention is indicated by the scope of the claims rather than the above description, and is intended to include all modifications within the scope and meaning equivalent to the scope of the claims.
１ 作業車両
３ 車体
１１ 操舵装置
３０ ステアリングハンドル
４０ 測位装置
５２ 操舵切換スイッチ（基準ライン設定スイッチ）
６０、６０Ａ 制御装置（第１制御装置）
２１３ 目標ライン設定部
２１４ 距離算出部
２１５ 計時部
ＡＬｎ 目標走行ライン
Ｌ１ 走行基準ライン
Ｌ２ 走行予定ライン
REFERENCE SIGNS
60, 60A control device (first control device)
213 target
Claims (6)
前記車体の位置を検出する測位装置と、
前記車体と走行予定ラインとの偏差が小さくなるように前記操舵装置における自動操舵を制御する制御装置と、
を備え、
前記制御装置は、
前記測位装置で検出された車体の位置である車体位置と前記走行予定ラインとの間に、前記車体位置から所定の設定距離だけ離れた位置に前記走行予定ラインと平行な目標走行ラインを設定する目標ライン設定部と、
前記車体が前記走行予定ラインに到達する前に、前記車体が前記目標走行ラインに向かうように前記操舵装置の自動操舵を行う自動操舵制御部と、
を有し、
前記目標ライン設定部は、前記偏差が所定値以上である場合に前記目標走行ラインを設定し、
前記自動操舵制御部は、設定された前記目標走行ラインに近づくように前記車体の前記自動操舵を実行し、
前記目標ライン設定部は、前記目標走行ラインの設定後、前記自動操舵制御部が前記自動操舵を実行中に所定の条件が満たされるごとに前記偏差が前記所定値以上か否かの判定を行い、前記偏差が所定値以上である場合に、そのときの車体位置から前記設定距離だけ離れた位置に前記目標走行ラインを再設定し、前記自動操舵制御部は再設定された前記目標走行ラインに近づくように前記車体の前記自動操舵を実行する作業車両。 a steering device for steering a vehicle body;
a positioning device that detects the position of the vehicle body;
a control device for controlling automatic steering in the steering device so as to reduce the deviation between the vehicle body and the planned travel line;
with
The control device is
Between the vehicle body position, which is the position of the vehicle body detected by the positioning device, and the planned travel line, a target travel line parallel to the planned travel line is set at a position separated from the vehicle body position by a predetermined set distance . a target line setting unit;
an automatic steering control unit that automatically steers the steering device so that the vehicle body moves toward the target travel line before the vehicle body reaches the planned travel line;
has
The target line setting unit sets the target travel line when the deviation is equal to or greater than a predetermined value,
The automatic steering control unit executes the automatic steering of the vehicle body so as to approach the set target travel line,
After setting the target travel line, the target line setting unit determines whether the deviation is equal to or greater than the predetermined value each time a predetermined condition is satisfied while the automatic steering control unit is executing the automatic steering. and if the deviation is equal to or greater than a predetermined value, the target travel line is reset to a position separated by the set distance from the vehicle body position at that time, and the automatic steering control unit moves the target travel line to the reset target travel line. A work vehicle that performs said automatic steering of said vehicle body to approach .
前記目標ライン設定部は、前記自動操舵制御部が前記自動操舵を実行中に前記距離算出部が算出した前記走行距離が閾値を超えた場合に、前記所定の条件が満たされたものとし、前記目標走行ラインを再設定するか否かの判断のために前記偏差が前記所定値以上か否かの判定を行う請求項１に記載の作業車両。 A distance calculation unit that calculates the travel distance of the vehicle body,
The target line setting unit determines that the predetermined condition is satisfied when the traveled distance calculated by the distance calculation unit exceeds a threshold while the automatic steering control unit is executing the automatic steering, and 2. The work vehicle according to claim 1, wherein it is determined whether or not the deviation is equal to or greater than the predetermined value in order to determine whether or not to reset the target travel line.
定量小さくなる毎に、前記所定の条件が満たされたものとし、前記目標走行ラインを再設定するか否かの判断のために前記偏差が前記所定値以上か否かの判定を行う請求項１又は２に記載の作業車両。 The target line setting unit assumes that the predetermined condition is satisfied and resets the target travel line each time the deviation decreases by a predetermined amount while the automatic steering control unit is performing the automatic steering . The work vehicle according to claim 1 or 2, wherein it is determined whether or not the deviation is equal to or greater than the predetermined value .
前記目標ライン設定部は、前記自動操舵制御部が前記自動操舵を実行中に前記計時部が計測した経過時間が所定時間を超えた場合に、前記所定の条件が満たされたものとし、前記目標走行ラインを再設定するか否かの判断のために前記偏差が前記所定値以上か否かの判定を行う請求項１～３のいずれかに記載の作業車両。 A timing unit for measuring the elapsed time after setting the target travel line,
The target line setting unit determines that the predetermined condition is satisfied when the elapsed time measured by the timer unit exceeds a predetermined time while the automatic steering control unit is executing the automatic steering, and the target line setting unit determines that the predetermined condition is satisfied. The work vehicle according to any one of claims 1 to 3 , wherein it is determined whether or not the deviation is equal to or greater than the predetermined value in order to determine whether or not to reset the travel line.
前記自動操舵の開始及び終了のいずれかを切り換える操舵切換スイッチと、
を備えている請求項１～５のいずれかに記載の作業車両。 a steering handle for steering the vehicle body by manual steering;
a steering selector switch for switching between starting and ending the automatic steering;
The work vehicle according to any one of claims 1 to 5 , comprising:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018189202A JP7106418B2 (en) | 2018-10-04 | 2018-10-04 | work vehicle |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018189202A JP7106418B2 (en) | 2018-10-04 | 2018-10-04 | work vehicle |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2020054319A JP2020054319A (en) | 2020-04-09 |
| JP7106418B2 true JP7106418B2 (en) | 2022-07-26 |
Family
ID=70105446
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2018189202A Active JP7106418B2 (en) | 2018-10-04 | 2018-10-04 | work vehicle |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7106418B2 (en) |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2010126077A (en) | 2008-11-28 | 2010-06-10 | Jtekt Corp | Travel supporting device |
| US20130304300A1 (en) | 2012-05-11 | 2013-11-14 | Trimble Navigation Ltd. | Path planning autopilot |
| JP2017081425A (en) | 2015-10-28 | 2017-05-18 | 本田技研工業株式会社 | Vehicle control device, vehicle control method, and vehicle control program |
| JP2017123803A (en) | 2016-01-13 | 2017-07-20 | 株式会社クボタ | Agricultural implement |
| JP2018120364A (en) | 2017-01-24 | 2018-08-02 | 株式会社クボタ | Automatic steering system |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH10234202A (en) * | 1997-02-28 | 1998-09-08 | Kubota Corp | Assist device for traveling |
-
2018
- 2018-10-04 JP JP2018189202A patent/JP7106418B2/en active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2010126077A (en) | 2008-11-28 | 2010-06-10 | Jtekt Corp | Travel supporting device |
| US20130304300A1 (en) | 2012-05-11 | 2013-11-14 | Trimble Navigation Ltd. | Path planning autopilot |
| JP2017081425A (en) | 2015-10-28 | 2017-05-18 | 本田技研工業株式会社 | Vehicle control device, vehicle control method, and vehicle control program |
| JP2017123803A (en) | 2016-01-13 | 2017-07-20 | 株式会社クボタ | Agricultural implement |
| JP2018120364A (en) | 2017-01-24 | 2018-08-02 | 株式会社クボタ | Automatic steering system |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2020054319A (en) | 2020-04-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP7179607B2 (en) | work vehicle | |
| WO2020012930A1 (en) | Work vehicle | |
| JP2023107830A (en) | work vehicle | |
| JP2022164924A (en) | work vehicle | |
| JP2022161904A (en) | Working vehicle | |
| CN112312760B (en) | Work vehicle | |
| JP7106419B2 (en) | work vehicle | |
| JP7161364B2 (en) | work vehicle | |
| JP2023021229A (en) | work vehicle | |
| JP7159121B2 (en) | work vehicle | |
| JP7106418B2 (en) | work vehicle | |
| JP2022166316A (en) | work vehicle | |
| JP7059123B2 (en) | Work vehicle | |
| JP6743260B1 (en) | Work vehicle | |
| JP7125206B2 (en) | work vehicle | |
| JP7179565B2 (en) | work vehicle | |
| JP7059122B2 (en) | Work vehicle | |
| JP7013335B2 (en) | Work vehicle | |
| KR20210030256A (en) | Work vehicle | |
| JP7311661B2 (en) | work vehicle | |
| JP2020001467A (en) | Work vehicle | |
| JP7314353B2 (en) | work vehicle | |
| JP7203698B2 (en) | Work vehicle and operation display system for work vehicle | |
| JP7229868B2 (en) | work vehicle | |
| JP7125205B2 (en) | work vehicle |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20201225 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20211028 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20211109 |
|
| A601 | Written request for extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A601 Effective date: 20211224 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220228 |
|
| 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: 20220614 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220713 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7106418 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |