[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JP5918162B2 - Traveling vehicle - Google Patents

Traveling vehicle Download PDF

Info

Publication number
JP5918162B2
JP5918162B2 JP2013055021A JP2013055021A JP5918162B2 JP 5918162 B2 JP5918162 B2 JP 5918162B2 JP 2013055021 A JP2013055021 A JP 2013055021A JP 2013055021 A JP2013055021 A JP 2013055021A JP 5918162 B2 JP5918162 B2 JP 5918162B2
Authority
JP
Japan
Prior art keywords
mode
travel
automatic
speed
manual
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2013055021A
Other languages
Japanese (ja)
Other versions
JP2014182453A (en
Inventor
康平 小倉
康平 小倉
晃史 黒田
晃史 黒田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yanmar Co Ltd
Original Assignee
Yanmar Co Ltd
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 Yanmar Co Ltd filed Critical Yanmar Co Ltd
Priority to JP2013055021A priority Critical patent/JP5918162B2/en
Publication of JP2014182453A publication Critical patent/JP2014182453A/en
Application granted granted Critical
Publication of JP5918162B2 publication Critical patent/JP5918162B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Guiding Agricultural Machines (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本発明は、自動走行を可能とする走行車両において、自動走行モードと手動走行モードとの切り換えがスムーズに行えるようにするための技術に関する。   The present invention relates to a technique for smoothly switching between an automatic travel mode and a manual travel mode in a traveling vehicle that enables automatic traveling.

従来、走行車両の一例としてトラクタに自動操舵制御手段とGPS位置情報算出手段を備えて、設定経路に沿って自動的に走行させて作業を可能としたトラクタが公知となっている(例えば、特許文献1参照)。
トラクタを自動的に走行させるために、自律走行手段を設けて、圃場内の所定領域を目標とする経路で自律走行させるようにしている。
2. Description of the Related Art Conventionally, as an example of a traveling vehicle, a tractor that includes an automatic steering control unit and a GPS position information calculation unit in a tractor and that automatically operates along a set route to enable work (for example, a patent) Reference 1).
In order to automatically run the tractor, an autonomous running means is provided so as to autonomously run on a predetermined route in the field.

特開2002−186309号公報JP 2002-186309 A

トラクタを圃場内の開始位置まで手動で移動し、自動走行切換スイッチ等を操作して自動走行を開始する場合、例えば、操舵装置が直進方向以外の角度で停止して自動走行を開始すると、急に直進方向に操舵装置が切られて急旋回することがあった。また、主変速レバー、または、前後進切換レバーが中立位置で停止されても、副変速レバーが高速位置であると、自動走行の開始操作をすると、PTOの駆動と同時に副変速が作業速度である低速に切り換えられるため、走行速度が急変し、作業者にショックを与えるだけでなく、作業開始位置の圃場が荒らされてしまうことがあった。   When the tractor is manually moved to the start position in the field and the automatic travel changeover switch or the like is operated to start automatic travel, for example, when the steering device stops at an angle other than the straight traveling direction and starts automatic travel, In some cases, the steering device was cut in a straight direction and the vehicle turned sharply. Even if the main speed change lever or the forward / reverse switching lever is stopped at the neutral position, if the sub speed change lever is at the high speed position and the automatic travel start operation is performed, the sub speed change is performed at the work speed simultaneously with the PTO drive. Since the speed is switched to a certain low speed, the traveling speed suddenly changes, which not only gives a shock to the worker, but also makes the field at the work start position rough.

本発明は以上の如き状況に鑑みてなされたものであり、手動走行モードから自動走行モードへの切り換え時に走行速度や進行方向が急変しないようにする走行車両を提供する。   The present invention has been made in view of the above situation, and provides a traveling vehicle that prevents a traveling speed and a traveling direction from changing suddenly when switching from a manual traveling mode to an automatic traveling mode.

本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段を説明する。   The problem to be solved by the present invention is as described above. Next, means for solving the problem will be described.

即ち、請求項1においては、GPS衛星から送信される電波を受信して機体の位置を算出するGPS位置算出手段と、操舵装置を回動する操舵駆動手段と、エンジン回転制御手段と、変速手段と、これらを制御する制御部を備え、前記機体の位置に基づいて設定経路に沿って走行するように前記操舵駆動手段、エンジン回転制御手段及び変速手段を制御して自動走行可能とする自動走行モードと、変速操作手段、操舵操作手段及びエンジン回転操作手段の人為的操作に応じて前記機体の走行を可能とする手動走行モードとを備える走行車両において、制御部には自動走行モードと手動走行モードを切り換えるモード切換操作手段が接続され、制御部は、モード切換操作手段が手動から自動に切り換えられると、車速が設定速度以下、かつ、操舵装置が略直進位置、かつ、前後進切換手段が中立、かつ、クラッチがオフ、かつ、ブレーキがオフ、かつ、副変速装置が低速位置、かつ、走行車両に異常がなく、かつ、エンジン回転数が設定回転数以上の場合、自動走行準備モードに切り換わり、自動走行にかかる必要なデータがそろうと、自動走行モードとなり自動走行が開始されるものである。   That is, in claim 1, a GPS position calculating means for receiving a radio wave transmitted from a GPS satellite and calculating a position of the airframe, a steering driving means for rotating a steering device, an engine rotation control means, and a speed changing means. And an automatic running that enables automatic running by controlling the steering drive means, the engine rotation control means, and the speed change means so as to run along the set route based on the position of the airframe. In a traveling vehicle having a mode and a manual travel mode that enables the vehicle to travel in response to an artificial operation of the speed change operation means, the steering operation means, and the engine rotation operation means, the control unit includes an automatic travel mode and a manual travel mode. The mode switching operation means for switching the mode is connected, and when the mode switching operation means is switched from manual to automatic, the control unit controls the vehicle speed to be equal to or lower than the set speed. The device is in a substantially straight running position, the forward / reverse switching means is neutral, the clutch is turned off, the brake is turned off, the auxiliary transmission is in a low speed position, the running vehicle is normal, and the engine speed When the rotation speed is equal to or higher than the set rotational speed, the mode is switched to the automatic travel preparation mode, and the automatic travel mode is started when the necessary data for the automatic travel are obtained.

請求項2においては、前記制御部は、前記自動走行準備モードにおいて、車速が前記設定速度よりも速い、または、操舵操作手段が略直進位置でない、または、モード切換操作手段による切換操作から設定時間経過した場合は、手動走行準備モードに移行するものである。   According to a second aspect of the present invention, in the automatic travel preparation mode, the control unit is configured such that the vehicle speed is faster than the set speed, the steering operation means is not in a substantially straight position, or a set time from the switching operation by the mode switching operation means. When the time has elapsed, the mode shifts to the manual travel preparation mode.

請求項3においては、前記自動走行準備モードになると、制御部は、エンジンをアイドル回転に変更し、走行停止制御を行うものである。   According to a third aspect of the present invention, when the automatic travel preparation mode is entered, the control unit changes the engine to idle rotation and performs travel stop control.

以上のような手段を用いることにより、手動走行モードから自動走行モードに切り換わる途中で自動走行準備モードに切り換わり、急発進や急旋回することがなく、また、手動走行準備モードで異常な状態が生じても、確認して自動走行への移行を中止したりでき、スムーズな手動走行モードから自動走行モードへの切り換えができる。   By using the means as described above, the automatic travel preparation mode is switched in the middle of switching from the manual travel mode to the automatic travel mode, and there is no sudden start or sudden turn. Even if this occurs, it is possible to confirm and cancel the transition to automatic driving, and to smoothly switch from manual driving mode to automatic driving mode.

トラクタとGPS衛星と基準局を示す概略側面図。The schematic side view which shows a tractor, a GPS satellite, and a reference station. トラクタの平面図。The top view of a tractor. 制御ブロック図。Control block diagram. モードの移行条件を示す図。The figure which shows the mode transition conditions.

まず、走行車両の一例としてトラクタ1の全体構成について説明する。但し、走行車両はトラクタに限定するものではなく、複数の走行輪を有して走行可能とし、操舵装置により操舵操作が可能な田植機や乗用管理機や運搬車等であってもよい。   First, the overall configuration of the tractor 1 will be described as an example of a traveling vehicle. However, the traveling vehicle is not limited to a tractor, and may be a rice transplanter, a riding management machine, a transport vehicle, or the like that has a plurality of traveling wheels and can be traveled and can be steered by a steering device.

図1から図3において、ボンネット2内にエンジン3が内設され、該ボンネット2の後部のキャビン11内にダッシュボード14が設けられ、ダッシュボード14上に操舵操作手段となるステアリングハンドル4が設けられている。該ステアリングハンドル4の回動により操舵装置を介して前輪9・9の向きが回動され、その回動角度は前輪9の回動基部に設けた舵角センサ7aにより検知され、舵角センサ7aにより得られた検出値は制御部30に入力される。前記ステアリングハンドル4の後方に運転席5が配設され、運転席5下方にミッションケース6が配置される。ミッションケース6の左右両側にリアアクスルケース8・8が連設され、該リアアクスルケース8・8には車軸を介して後輪10・10が支承される。エンジン3からの動力はミッションケース6内の主変速装置や副変速装置により変速されて、後輪10・10を駆動可能としている。後輪10の回転数は車速センサ27により検知され、走行速度として制御部30に入力される。但し、車速の検知方法や配置位置は限定するものではない。   1 to 3, an engine 3 is installed in the hood 2, a dashboard 14 is provided in a cabin 11 at the rear of the hood 2, and a steering handle 4 serving as a steering operation means is provided on the dashboard 14. It has been. By turning the steering handle 4, the direction of the front wheels 9, 9 is turned through the steering device, and the turning angle is detected by a rudder angle sensor 7a provided at the turning base of the front wheel 9, and the rudder angle sensor 7a. The detection value obtained by the above is input to the control unit 30. A driver seat 5 is disposed behind the steering handle 4, and a mission case 6 is disposed below the driver seat 5. Rear axle cases 8 and 8 are connected to the left and right sides of the transmission case 6, and rear wheels 10 and 10 are supported on the rear axle cases 8 and 8 via axles. The power from the engine 3 is shifted by a main transmission and an auxiliary transmission in the mission case 6 so that the rear wheels 10 and 10 can be driven. The rotational speed of the rear wheel 10 is detected by the vehicle speed sensor 27 and input to the control unit 30 as the traveling speed. However, the vehicle speed detection method and the arrangement position are not limited.

前記エンジン3を支持するフロントフレーム13にはフロントアクスルケース7が支持され、該フロントアクスルケース7の両側に前輪9・9が支承され、前記ミッションケース6からの動力が前輪9・9に伝達可能に構成している。前記前輪9・9は操舵輪となっており、ステアリングハンドル4の回動操作により回動可能とするとともに、操舵駆動手段となるパワステシリンダからなる操舵アクチュエータ40により前輪9・9が左右操舵回動可能となっている。操舵アクチュエータ40は制御部30と接続され、自動走行制御により駆動される。   A front axle case 7 is supported on a front frame 13 that supports the engine 3, front wheels 9 and 9 are supported on both sides of the front axle case 7, and power from the transmission case 6 can be transmitted to the front wheels 9 and 9. It is configured. The front wheels 9, 9 are steered wheels, and can be turned by turning the steering handle 4, and the front wheels 9, 9 can be turned left and right by a steering actuator 40 comprising a power steering cylinder as a steering drive means. It is possible. The steering actuator 40 is connected to the control unit 30 and is driven by automatic traveling control.

前記運転席5とステアリングハンドル4との間の下方にステップ12が形成される。前記ステップ12上のダッシュボード14の進行方向右下方に左右ブレーキペダル15・15やアクセルペダル28が配置され、その近傍にパーキングレバー39が配置され、ダッシュボード14の左下方にクラッチペダル16が配置される。前記ブレーキペダル15の踏込量はブレーキセンサ15aにより検知され、パーキングレバー39の操作はパーキングレバー位置センサ39aにより検知され、ブレーキセンサ15a及びパーキングレバー位置センサ39aは制御部30と接続され、ブレーキセンサ15a及びパーキングレバー位置センサ39aの検出値に応じて制動手段となるブレーキアクチュエータ41が作動され、リアアクスルケース8(またはミッションケース6)内に設けたブレーキにより制動可能としている。   A step 12 is formed below the driver seat 5 and the steering handle 4. The left and right brake pedals 15 and 15 and the accelerator pedal 28 are arranged at the lower right of the dashboard 14 in the traveling direction on the step 12, the parking lever 39 is arranged in the vicinity thereof, and the clutch pedal 16 is arranged at the lower left of the dashboard 14. Is done. The depression amount of the brake pedal 15 is detected by the brake sensor 15a, the operation of the parking lever 39 is detected by the parking lever position sensor 39a, the brake sensor 15a and the parking lever position sensor 39a are connected to the control unit 30, and the brake sensor 15a The brake actuator 41 serving as a braking means is actuated in accordance with the detection value of the parking lever position sensor 39a, and braking is possible by the brake provided in the rear axle case 8 (or the transmission case 6).

クラッチペダル16はエンジン3とデフ装置との間に設けるクラッチを入切操作するものであり、クラッチペダル16の回動基部にはクラッチセンサ16aが設けられ、クラッチはクラッチアクチュエータ46の作動により断接され、クラッチセンサ16a及びクラッチアクチュエータ46は制御部30と接続されている。クラッチペダル16を踏込操作すると、クラッチセンサ16aにより検知されて、制御部30を介してクラッチアクチュエータ46が作動されてクラッチを断(オフ)とする。なお、クラッチは作業車両に応じて、エンジン3と変速装置の間に配置しても、変速装置に配置しても、前後進切換装置に配置しても良く、クラッチの配置位置は限定するものではない。また、クラッチの構成も摩擦式、油圧式等限定するものではない。   The clutch pedal 16 is used to turn on and off a clutch provided between the engine 3 and the differential device. A clutch sensor 16a is provided at the rotation base of the clutch pedal 16, and the clutch is connected / disconnected by the operation of the clutch actuator 46. The clutch sensor 16a and the clutch actuator 46 are connected to the control unit 30. When the clutch pedal 16 is depressed, it is detected by the clutch sensor 16a, and the clutch actuator 46 is actuated via the control unit 30 to disengage (turn off) the clutch. Depending on the work vehicle, the clutch may be disposed between the engine 3 and the transmission, may be disposed on the transmission, or may be disposed on the forward / reverse switching device, and the arrangement position of the clutch is limited. is not. Further, the configuration of the clutch is not limited to a friction type or a hydraulic type.

また、ダッシュボード14の右側にはアクセルレバー21や作業機昇降スイッチが配置され、ダッシュボード14の左側には前後進切換レバー22が配置されている。アクセルレバー21及び前記アクセルペダル28の操作量はアクセルセンサ21aにより検知され、アクセルセンサ21aは制御部30と接続され、検出値を入力する。制御部30にはエンジン回転制御手段となるエンジンコントローラ60及びエンジン回転数センサ61が接続され、エンジンコントローラ60には回転数を変更するアクセルアクチュエータ42が接続されている。エンジン3の回転がアクセルレバー21またはアクセルペダル28または自動走行設定手段70により設定した回転数となるようにアクセルアクチュエータ42が作動される。アクセルアクチュエータ42はエンジンの種類に合わせて、スロットル変更モータや燃料噴射量を変更するラックアクチュエータや燃料噴射ノズルを開閉するソレノイド等で構成される。   Further, an accelerator lever 21 and a work machine up / down switch are disposed on the right side of the dashboard 14, and a forward / reverse switching lever 22 is disposed on the left side of the dashboard 14. The operation amounts of the accelerator lever 21 and the accelerator pedal 28 are detected by an accelerator sensor 21a, and the accelerator sensor 21a is connected to the control unit 30 and inputs a detection value. The controller 30 is connected to an engine controller 60 and an engine speed sensor 61 serving as engine speed control means. The engine controller 60 is connected to an accelerator actuator 42 that changes the speed. The accelerator actuator 42 is operated so that the rotation of the engine 3 becomes the rotation speed set by the accelerator lever 21 or the accelerator pedal 28 or the automatic travel setting means 70. The accelerator actuator 42 includes a throttle change motor, a rack actuator that changes the fuel injection amount, a solenoid that opens and closes the fuel injection nozzle, and the like according to the type of engine.

前後進切換レバー22の回動基部には切換位置検知センサ22aが配置されて切換位置を検知し、ミッションケース6内には前後進切換装置が配置されて前後進切換アクチュエータ43により切り換え可能としている。前記切換位置検知センサ22a及び前後進切換アクチュエータ43は制御部30と接続されて、前後進切換レバー22が操作されると前後進切換アクチュエータ43を作動させて前後進切換が行われる。なお、前後進を切り換えるための構成は、歯車摺動式や油圧クラッチ式やHST斜板変更式等により可能であり、限定するものではなく、また、前後進切換アクチュエータ43はモータやソレノイド等で構成することが可能であり、限定するものではない。   A switching position detection sensor 22 a is disposed at the rotation base of the forward / reverse switching lever 22 to detect the switching position, and a forward / reverse switching device is disposed in the mission case 6 so as to be switched by the forward / reverse switching actuator 43. . The switching position detection sensor 22a and the forward / reverse switching actuator 43 are connected to the controller 30, and when the forward / reverse switching lever 22 is operated, the forward / reverse switching actuator 43 is operated to perform forward / reverse switching. The configuration for switching between forward and backward movement is possible by a gear sliding type, a hydraulic clutch type, an HST swash plate changing type, etc., and is not limited. The forward / backward switching actuator 43 is a motor, solenoid or the like. It can be configured and is not limited.

前記ダッシュボード14上にはエンジン回転数や異常や設定値等を表示する表示手段49やキースイッチやモード切換操作手段となる自動・手動切換スイッチ71等が配置されている。自動・手動切換スイッチ71は自動走行モードと手動走行モードを人為的操作で切り換えるものであり、詳細は後述する。また、表示手段49や自動・手動切換スイッチ71の配置位置は限定するものではなく、キャビン11の柱等に設けてもよい。   On the dashboard 14, there are arranged display means 49 for displaying the engine speed, abnormality, set value and the like, an automatic / manual changeover switch 71 serving as a key switch and mode changeover operation means, and the like. The automatic / manual changeover switch 71 switches between the automatic running mode and the manual running mode by human operation, and will be described in detail later. Further, the arrangement positions of the display means 49 and the automatic / manual changeover switch 71 are not limited, and may be provided on a column of the cabin 11 or the like.

前記運転席5の右側には、主変速レバー17や作業機高さを調節する昇降レバー18やPTO入切スイッチ25等が配置され、主変速レバー17の回動基部には主変速レバー位置センサ17aが設けられて回動操作位置が検知され、主変速レバー位置センサ17aは制御部30と接続されて検出値が入力される。前記ミッションケース6には主変速装置を変速するための主変速アクチュエータ44が設けられ、主変速レバー17の操作に応じて作動されて変速される。主変速装置は本実施形態では油圧式無段変速装置により構成され、斜板をソレノイドまたはモータ等で構成した主変速アクチュエータ44により傾倒させて変速する構成としている。   On the right side of the driver's seat 5, a main transmission lever 17, an elevating lever 18 for adjusting the height of the work implement, a PTO on / off switch 25, and the like are disposed. 17a is provided to detect the rotation operation position, and the main shift lever position sensor 17a is connected to the control unit 30 to input a detection value. The transmission case 6 is provided with a main transmission actuator 44 for shifting the main transmission, and is operated in accordance with the operation of the main transmission lever 17 to change the speed. In the present embodiment, the main transmission is constituted by a hydraulic continuously variable transmission, and the swash plate is tilted by a main transmission actuator 44 constituted by a solenoid, a motor, or the like to change gears.

昇降レバー18の回動基部には昇降レバー位置センサ18aが配置されて回動操作位置が検知され、昇降レバー位置センサ18aは制御部30と接続されて検出値が入力される。昇降レバー18を操作すると、後述する昇降アクチュエータ48が切り換えられて昇降油圧シリンダ26が作動されてロータリ耕耘装置24を昇降することができる。
PTO入切スイッチ25はミッションケース6内に設けたPTOクラッチを断接操作するものであり、PTO入切スイッチ25及びPTOクラッチを切換作動するPTOクラッチアクチュエータ45は制御部30と接続され、PTO入切スイッチ25の操作によりPTOクラッチアクチュエータ45が作動されて、PTO軸への動力の断接を可能としている。
A lift lever position sensor 18a is disposed at the rotation base of the lift lever 18 to detect the rotation operation position, and the lift lever position sensor 18a is connected to the control unit 30 to receive a detection value. When the elevating lever 18 is operated, the elevating actuator 48 described later is switched, and the elevating hydraulic cylinder 26 is operated to elevate the rotary tiller 24.
The PTO on / off switch 25 is used to connect / disconnect the PTO clutch provided in the mission case 6. The PTO on / off switch 25 and the PTO clutch actuator 45 for switching the PTO clutch are connected to the control unit 30, By operating the switch 25, the PTO clutch actuator 45 is actuated, and the power can be connected to the PTO shaft.

前記運転席5の左側にはPTO変速レバー19や副変速レバー20等が配置される。副変速レバー20の回動基部には副変速レバー位置センサ20aが設けられ、副変速レバー位置センサ20aは制御部30と接続されて検出値が入力される。前記ミッションケース6には副変速装置を変速するための副変速アクチュエータ47が設けられ、副変速レバー20の操作に応じて作動されて変速される。主変速レバー17及び副変速レバー20は変速操作手段とし、主変速アクチュエータ44及び副変速アクチュエータ47は変速手段としている。
そして、運転席5やステアリングハンドル4や主変速レバー17や副変速レバー20の操作手段等はキャビン11により覆われている。なお、前記レバー類やスイッチ等の配置位置は限定するものではない。
On the left side of the driver seat 5, a PTO speed change lever 19, a sub speed change lever 20, and the like are arranged. A sub-transmission lever position sensor 20a is provided at the rotation base of the sub-transmission lever 20, and the sub-transmission lever position sensor 20a is connected to the control unit 30 and receives a detection value. The transmission case 6 is provided with a sub-transmission actuator 47 for shifting the sub-transmission device, and is actuated according to the operation of the sub-transmission lever 20 to change the speed. The main transmission lever 17 and the sub transmission lever 20 are used as transmission operation means, and the main transmission actuator 44 and the sub transmission actuator 47 are used as transmission means.
The driver's seat 5, the steering handle 4, the main transmission lever 17, the auxiliary transmission lever 20, and the like are covered with the cabin 11. In addition, the arrangement positions of the levers and the switches are not limited.

また、トラクタ機体後方に作業機装着装置23を介して作業機としてロータリ耕耘装置24が昇降自在に装設させて耕耘作業を行うように構成している。前記ミッションケース6上に昇降シリンダ26が設けられ、該昇降シリンダ26を伸縮させることにより、作業機装着装置23を構成する昇降アームを回動させてロータリ耕耘装置24を昇降できるようにしている。また、作業機装着装置23の左右一側には傾倒シリンダが設けられ、ロータリ耕耘装置24を左右傾倒可能に構成している。   Further, a rotary tiller 24 is installed as a work machine behind the tractor body via a work machine mounting device 23 so as to be able to move up and down to perform the tilling work. An elevating cylinder 26 is provided on the transmission case 6, and the elevating arm 26 constituting the work implement mounting device 23 is rotated by moving the elevating cylinder 26 to extend and lower the rotary tiller 24. In addition, a tilting cylinder is provided on one side of the work implement mounting device 23 so that the rotary tiller 24 can be tilted left and right.

前記キャビン11上にGPS衛星37からの電波を受信する移動GPSアンテナ34が設けられ、移動GPSアンテナ34は移動受信機33と接続され、移動受信機33は制御部30と接続されている。該制御部30には、トラクタ1の走行状態を検出するための手段として、GPS位置算出手段と変位・方位算出手段を備え、ジャイロセンサ31と方位センサ32と移動受信機33と接続している。   A mobile GPS antenna 34 that receives radio waves from a GPS satellite 37 is provided on the cabin 11, the mobile GPS antenna 34 is connected to a mobile receiver 33, and the mobile receiver 33 is connected to the control unit 30. The control unit 30 includes GPS position calculating means and displacement / orientation calculating means as means for detecting the traveling state of the tractor 1, and is connected to the gyro sensor 31, the direction sensor 32, and the mobile receiver 33. .

次に、トラクタ1の走行状態を取得する方法について説明する。
トラクタ1は、機体の姿勢情報を得るためにジャイロセンサ31、および方位センサ32を具備する。
ジャイロセンサ31はトラクタ1の機体前後方向の傾斜(ピッチ)の角速度、機体左右方向の傾斜(ロール)の角速度、および旋回(ヨー)の角速度、を検出するものである。該三つの角速度を積分計算することにより、トラクタ1の機体の前後方向および左右方向への傾斜角度、および旋回角度を求めることが可能である。ジャイロセンサ31の具体例としては、機械式ジャイロセンサ、光学式ジャイロセンサ、流体式ジャイロセンサ、振動式ジャイロセンサ等が挙げられる。ジャイロセンサ31は制御部30に接続され、当該三つの角速度に係る情報を制御部30に入力する。
Next, a method for acquiring the traveling state of the tractor 1 will be described.
The tractor 1 includes a gyro sensor 31 and an orientation sensor 32 in order to obtain attitude information of the aircraft.
The gyro sensor 31 detects the angular velocity of the tractor 1 in the longitudinal direction (pitch), the angular velocity in the lateral direction (roll), and the angular velocity of turning (yaw). By integrating and calculating the three angular velocities, it is possible to obtain the inclination angle and the turning angle of the airframe of the tractor 1 in the front-rear direction and the left-right direction. Specific examples of the gyro sensor 31 include a mechanical gyro sensor, an optical gyro sensor, a fluid gyro sensor, and a vibration gyro sensor. The gyro sensor 31 is connected to the control unit 30 and inputs information related to the three angular velocities to the control unit 30.

方位センサ32はトラクタ1の向き(進行方向)を検出するものである。方位センサ32の具体例としては磁気方位センサ等が挙げられる。方位センサ32は制御部30に接続され、機体の向きに係る情報を制御部30に入力する。   The direction sensor 32 detects the direction (traveling direction) of the tractor 1. A specific example of the direction sensor 32 includes a magnetic direction sensor. The direction sensor 32 is connected to the control unit 30 and inputs information related to the orientation of the aircraft to the control unit 30.

こうして制御部30は、上記ジャイロセンサ31、方位センサ32から取得した信号を変位・方位演算手段により演算し、トラクタ1の姿勢(向き、機体前後方向及び機体左右方向の傾斜、旋回方向)を求める。   In this way, the control unit 30 calculates the signals acquired from the gyro sensor 31 and the azimuth sensor 32 by the displacement / azimuth calculation means, and obtains the attitude of the tractor 1 (direction, forward / backward direction of the body, left / right inclination of the body, and turning direction). .

次に、トラクタ1の位置情報をGPS(グローバル・ポジショニング・システム)を用いて取得する方法について説明する。
GPSは、元来航空機・船舶等の航法支援用として開発されたシステムであって、上空約二万キロメートルを周回する二十四個のGPS衛星(六軌道面に四個ずつ配置)、GPS衛星の追跡と管制を行う管制局、測位を行うための利用者の受信機で構成される。
GPSを用いた測位方法としては、単独測位、相対測位、DGPS(ディファレンシャルGPS)測位、RTK−GPS(リアルタイムキネマティック−GPS)測位など種々の方法が挙げられ、これらいずれの方法を用いることも可能であるが、本実施形態では測定精度の高いRTK−GPS測位方式を採用し、この方法について図1、図3より説明する。
Next, a method for acquiring the position information of the tractor 1 using the GPS (global positioning system) will be described.
GPS was originally developed as a navigation support system for aircraft, ships, etc., and is composed of 24 GPS satellites (four on six orbital planes) orbiting about 20,000 kilometers above the sky. It consists of a control station that performs tracking and control, and a user receiver that performs positioning.
As a positioning method using GPS, there are various methods such as single positioning, relative positioning, DGPS (differential GPS) positioning, RTK-GPS (real-time kinematics-GPS) positioning, and any of these methods can be used. However, in the present embodiment, an RTK-GPS positioning method with high measurement accuracy is adopted, and this method will be described with reference to FIGS.

RTK−GPS(リアルタイムキネマティック−GPS)測位は、位置が判っている基準局と、位置を求めようとする移動局とで同時にGPS観測を行い、基準局で観測したデータを無線等の方法で移動局にリアルタイムで送信し、基準局の位置成果に基づいて移動局の位置をリアルタイムに求める方法である。   RTK-GPS (real-time kinematics-GPS) positioning is performed by simultaneously performing GPS observations on a reference station whose position is known and a mobile station whose position is to be obtained. Is transmitted in real time, and the position of the mobile station is obtained in real time based on the position result of the reference station.

本実施形態においては、トラクタ1に移動局となる移動受信機33と移動GPSアンテナ34が配置され、基準局となる固定受信機35と固定GPSアンテナ36が圃場の作業の邪魔にならない所定位置に配設される。本実施形態のRTK−GPS(リアルタイムキネマティック−GPS)測位は、基準局および移動局の両方で位相の測定(相対測位)を行い、基準局の固定受信機35で観測した位相データを移動受信機33に送信する。   In the present embodiment, the mobile receiver 33 and the mobile GPS antenna 34 that are mobile stations are arranged on the tractor 1, and the fixed receiver 35 and the fixed GPS antenna 36 that are reference stations are arranged at predetermined positions that do not interfere with the work on the field. Established. In the RTK-GPS (real-time kinematic-GPS) positioning of the present embodiment, the phase measurement (relative positioning) is performed at both the reference station and the mobile station, and the phase data observed by the fixed receiver 35 of the reference station is transferred to the mobile receiver 33. Send to.

トラクタ1に配置された移動GPSアンテナ34はGPS衛星37・37・・・からの信号を受信する。この信号は移動受信機33に送信され測位される。そして、同時に基準局となる固定GPSアンテナ36でGPS衛星37・37・・・からの信号を受信し、固定受信機35で測位し移動受信機33に送信し、観測されたデータを解析して移動局の位置を決定する。こうして得られた位置情報は制御部30に送信される。   The mobile GPS antenna 34 disposed in the tractor 1 receives signals from GPS satellites 37, 37. This signal is transmitted to the mobile receiver 33 for positioning. At the same time, signals from the GPS satellites 37, 37... Are received by the fixed GPS antenna 36 serving as a reference station, measured by the fixed receiver 35 and transmitted to the mobile receiver 33, and the observed data is analyzed and moved. Determine the station location. The position information thus obtained is transmitted to the control unit 30.

こうして、このトラクタ1における制御部30は、GPS衛星37・37・・・から送信される電波を受信して移動受信機33において設定時間間隔で機体の位置情報を求め、ジャイロセンサ31及び方位センサ32から機体の変位情報および方位情報を求め、これら位置情報と変位情報と方位情報に基づいて機体が予め設定した設定経路に沿って走行するように、操舵アクチュエータ40、主変速アクチュエータ44等を制御する。自動耕耘作業にあっては、ロータリ耕耘装置24を設定深さ(耕深)となるように昇降アクチュエータ48を制御し、設定回転数となるようにエンジンコントローラ60によってエンジン3の回転数を制御する。設定経路および作業態様はキャビン11内の任意位置に配設した自動走行設定手段70により設定する。自動走行設定手段70はタッチパネル等で構成して表示手段49と一体的に構成してもよい。   In this way, the control unit 30 in the tractor 1 receives radio waves transmitted from the GPS satellites 37, 37,..., Obtains the position information of the aircraft at set time intervals in the mobile receiver 33, and the gyro sensor 31 and the azimuth sensor. 32, the displacement information and the direction information of the airframe are obtained, and the steering actuator 40, the main transmission actuator 44 and the like are controlled so that the airframe travels along a preset route based on the position information, the displacement information, and the direction information. To do. In the automatic tillage work, the lifting actuator 48 is controlled so that the rotary tiller 24 is at the set depth (plowing depth), and the engine controller 60 controls the rotation speed of the engine 3 so as to be the set rotation speed. . The setting route and work mode are set by the automatic travel setting means 70 disposed at an arbitrary position in the cabin 11. The automatic travel setting means 70 may be constituted by a touch panel or the like and integrated with the display means 49.

次に、本発明の手動運転(手動走行モード)と自動運転(自動走行モード)の切り換え制御について、図4より説明する。   Next, switching control between manual operation (manual travel mode) and automatic operation (automatic travel mode) according to the present invention will be described with reference to FIG.

制御部30は、手動走行モード80と自動走行モード81と自動走行準備モード82と手動走行準備モード83と、これらを切り換えるモード切換手段84とを備える。   The control unit 30 includes a manual travel mode 80, an automatic travel mode 81, an automatic travel preparation mode 82, a manual travel preparation mode 83, and mode switching means 84 for switching between these modes.

モード切換手段84は、各モードにおいて、後述する移行条件が満たされると、その条件に合うモードへ移行させるための手段である。   The mode switching means 84 is a means for making a transition to a mode that meets the condition when a transition condition described later is satisfied in each mode.

手動走行モード80は、自動走行設定手段70の設定によるプログラムとは関係なく、ステアリングハンドル4、ブレーキペダル15、クラッチペダル16、主変速レバー17、昇降レバー18、PTO変速レバー19、副変速レバー20、アクセルレバー21、前後進切換レバー22、PTOスイッチ25等の人為的に操作によって、トラクタ1を走行させたり、作業させたり、停止させたりするモードである。手動走行モード80において、自動走行開始条件が満たされると(移行条件1)、モード切換手段84により自動走行準備モード82に移行される。   In the manual travel mode 80, the steering handle 4, the brake pedal 15, the clutch pedal 16, the main transmission lever 17, the lift lever 18, the PTO transmission lever 19, and the auxiliary transmission lever 20 are independent of the program set by the automatic traveling setting means 70. In this mode, the tractor 1 is caused to travel, work, or be stopped by artificially operating the accelerator lever 21, the forward / reverse switching lever 22, the PTO switch 25, and the like. In the manual travel mode 80, when the automatic travel start condition is satisfied (transition condition 1), the mode switching means 84 shifts to the automatic travel preparation mode 82.

自動走行準備モード82は、手動走行モード80から自動走行モード81への遷移モードであり、エンジン3はアイドル回転数とし、走行停止状態として走行作業開始指令が整うまで待機する。
自動走行準備モード82時において自動走行に必要なデータが揃い、そのデータが異常値ではなく、自動走行開始指示が出されていると(移行条件2)、モード切換手段84により自動走行モード81に移行される。また、自動走行準備モード82時において、自動走行中断条件が満たされていたり、遷移後設定時間以上経過したりしていると(移行条件3)、モード切換手段84により手動走行準備モード83に移行される。即ち、自動走行準備モード82がないと、直接、手動走行モード80から自動走行モード81へ移行してしまうので、遷移途中で異常が生じた場合やGPSの信号の処理中でも自動走行が開始され、作業開始時に乱れることがある。本実施例では自動走行準備モード82があるため、これらを回避して、スムーズな移行が可能となる。
The automatic travel preparation mode 82 is a transition mode from the manual travel mode 80 to the automatic travel mode 81, and the engine 3 is set to the idling speed, and waits until the travel work start command is completed as a travel stop state.
When the data necessary for automatic traveling is available in the automatic traveling preparation mode 82, and the data is not an abnormal value and an automatic traveling start instruction is issued (transition condition 2), the mode switching means 84 switches to the automatic traveling mode 81. To be migrated. Further, when the automatic driving interruption condition is satisfied in the automatic driving preparation mode 82 or when the set time has elapsed after the transition (transition condition 3), the mode switching means 84 shifts to the manual driving preparation mode 83. Is done. In other words, if there is no automatic travel preparation mode 82, the automatic travel mode directly shifts from the manual travel mode 80 to the automatic travel mode 81, so that automatic travel is started even when an abnormality occurs during the transition or during GPS signal processing, May be confused at the start of work. In this embodiment, since there is an automatic travel preparation mode 82, these can be avoided and a smooth transition can be achieved.

自動走行モード81は、自動走行設定手段70により設定した条件に従い、自動的に、予め設定した経路に沿うように、トラクタ1の位置や方向を検知しながら操舵アクチュエータ40やブレーキアクチュエータ41を制御して走行し、設定した速度となるように、エンジン回転数や変速装置を制御し、設定した作業を行うように昇降アクチュエータ48等を制御する。
自動走行モード81時において、自動走行に必要なデータが揃っていなかったり、データが異常値であったり、走行停止が指示されたり、自動走行中断条件が満たされると(移行条件4)、モード切換手段84により手動走行準備モード83に移行される。
The automatic travel mode 81 controls the steering actuator 40 and the brake actuator 41 while detecting the position and direction of the tractor 1 automatically along a preset route according to the conditions set by the automatic travel setting means 70. The engine speed and the transmission are controlled so as to achieve the set speed, and the lift actuator 48 and the like are controlled so as to perform the set work.
When the automatic driving mode is 8 o'clock, the data required for automatic driving is not available, the data is abnormal, the driving stop is instructed, or the automatic driving interruption condition is satisfied (transition condition 4), the mode is switched. The means 84 shifts to the manual travel preparation mode 83.

手動走行準備モード83は、自動走行モード81から手動走行モード80への遷移モードであり、自動走行設定手段70によるプログラムは無視し、エンジン3はアイドル回転数とし、走行を停止させる制御を行う。
手動走行準備モード83時において、手動走行開始条件が満たされると(移行条件5)、モード切換手段84により手動走行モード80に移行される。また、手動走行準備モード83時において、自動走行開始条件が満たされると(移行条件6)、モード切換手段84により手動走行準備モード83に移行される。即ち、自動走行モード81から手動走行モード80へ直接移行すると、急加速やエンジン回転数の急増の可能性があるので、自動走行モード81から手動走行モード80へ移行する際には、一旦、車速を最低速、エンジン回転数を最低回転数に落として安全を確保してから、手動走行に移行するようにしている。即ち、手動走行準備モード83がないと、直接、自動走行モード81から手動走行モード80へ移行してしまうので、変速操作手段の位置によっては急発進することがあり、アクセルレバー21の位置によってはエンストしたり、高回転となったりし、操舵装置の位置によっては急旋回したりすることがある。手動走行準備モード83を設けることでこれらを防止し、自動走行モード81への復帰も容易にできるようにしている。
The manual travel preparation mode 83 is a transition mode from the automatic travel mode 81 to the manual travel mode 80. The program by the automatic travel setting means 70 is ignored, the engine 3 is set to the idling speed, and the travel is stopped.
When the manual travel start condition is satisfied in the manual travel preparation mode 83 (transition condition 5), the mode is switched to the manual travel mode 80 by the mode switching means 84. Further, when the automatic travel start condition is satisfied in the manual travel preparation mode 83 (transition condition 6), the mode switching means 84 shifts to the manual travel preparation mode 83. That is, when the automatic travel mode 81 directly shifts to the manual travel mode 80, there is a possibility of sudden acceleration or a sudden increase in the engine speed. Therefore, when the automatic travel mode 81 transitions to the manual travel mode 80, the vehicle speed is temporarily increased. The minimum speed and the engine speed are reduced to the minimum speed to ensure safety before shifting to manual driving. That is, if the manual travel preparation mode 83 is not provided, the automatic travel mode 81 directly shifts to the manual travel mode 80. Therefore, depending on the position of the speed change operation means, the vehicle may start suddenly. Depending on the position of the steering device, the engine may turn sharply. By providing the manual travel preparation mode 83, these are prevented, and the return to the automatic travel mode 81 can be facilitated.

次に、各モードへの具体的な移行制御を説明する。
まず、手動操作でトラクタ1を圃場内の作業開始位置に移動する。エンジン3が作動され、機体の走行が停止され、手動走行モード80とした状態において自動走行を開始する場合、制御部30は、自動走行開始条件が満たされているか判断する。つまり、車速が設定速度(この設定速度は急発進しないような遅い速度で、例えば1km/h)以下で、前後進切換レバー22が中立、かつ、クラッチペダル16、ブレーキペダル15、パーキングレバー39が操作されていない、かつ、副変速レバー20が低速位置、かつ、エンジン回転数が設定回転数以上(この設定回転数はエンジン3が作動している最低回転数で、例えば250rpm以上)、かつ、ステアリングハンドル4が直進位置(以下「直進位置」は殆ど旋回しない略直進状態の位置とする)、かつ、トラクタに異常が発生していない状態で、自動・手動切換スイッチ71がオン(自動走行)に切り換えられているかを判断する。この自動走行開始条件(移行条件1)を満たしていると、自動走行準備モード82に移行される。
前記トラクタの異常とは、バッテリの電圧が設定値(最低作動電圧)以下であったり、油圧が設定値(最低作動圧)以下であったり、冷却水の温度が設定値(オーバーヒート水温)以上であったり、センサが反応していない場合等である。
Next, specific transition control to each mode will be described.
First, the tractor 1 is moved to the work start position in the field by manual operation. When the engine 3 is activated, the vehicle is stopped, and the automatic travel is started in the state where the manual travel mode 80 is set, the control unit 30 determines whether the automatic travel start condition is satisfied. That is, when the vehicle speed is equal to or less than the set speed (the set speed is a slow speed such as 1 km / h that does not start suddenly), the forward / reverse switching lever 22 is neutral, and the clutch pedal 16, the brake pedal 15, and the parking lever 39 are Not operated, the sub-shift lever 20 is in the low speed position, and the engine speed is equal to or higher than the set speed (this set speed is the minimum speed at which the engine 3 is operating, for example, 250 rpm or higher), and The automatic / manual changeover switch 71 is turned on (automatic travel) when the steering handle 4 is in the straight travel position (hereinafter referred to as “the straight travel position” is a substantially straight travel position that hardly turns) and the tractor is not abnormal. It is judged whether it is switched to. When this automatic travel start condition (transition condition 1) is satisfied, the automatic travel preparation mode 82 is entered.
The abnormality of the tractor means that the battery voltage is below the set value (minimum operating voltage), the hydraulic pressure is below the set value (minimum operating pressure), or the cooling water temperature is above the set value (overheat water temperature). Or if the sensor is not responding.

自動走行準備モード82に移行すると、自動走行に必要なデータがすべて揃っているか、自動走行中断条件を満たしているか、自動走行準備モード82に移行後設定時間(例えば1秒)以上経過したか、判断し、自動走行に必要なデータがすべて揃っていると(移行条件2)、自動走行モード81に移行し、自動走行中断条件を満たしている場合、または、自動走行準備モード82に移行後、設定時間以上経過した場合(移行条件3)、手動走行準備モード83に移行する。   When shifting to the automatic driving preparation mode 82, whether all data necessary for automatic driving are available, whether the automatic driving interruption condition is satisfied, whether the set time (for example, 1 second) or more has elapsed after shifting to the automatic driving preparation mode 82, If all the data required for automatic driving are determined (transition condition 2), the mode shifts to the automatic driving mode 81, and when the automatic driving interruption condition is satisfied, or after the mode shifts to the automatic driving preparation mode 82, When the set time has elapsed (transition condition 3), the mode shifts to the manual travel preparation mode 83.

前記自動走行に必要なデータとしては、走行経路データや作業データやGPSからの位置データやジャイロセンサ31と方位センサ32からのデータ等である。   The data necessary for the automatic traveling includes traveling route data, work data, position data from GPS, data from the gyro sensor 31 and the direction sensor 32, and the like.

また、前記自動走行中断条件とは、前後進切換レバー22が中立位置以外の位置にある、または、クラッチペダル16またはブレーキペダル15またはパーキングレバー39が操作されている、または、副変速レバー20が低速位置以外の位置、または、エンジン回転数が設定回転数未満(例えば250rpm未満)、または、トラクタに異常が発生した場合、または、自動・手動切換スイッチ71がオフに切り換えられた場合、または、PTOスイッチ25がオンまたはオフに操作された場合である。つまり、自動走行準備モード82に移行後に、作業者が手動操作を行うと、自動走行が中断されるようにして、手動操作を優先させている。   The automatic travel interruption condition is that the forward / reverse switching lever 22 is in a position other than the neutral position, the clutch pedal 16 or the brake pedal 15 or the parking lever 39 is operated, or the auxiliary transmission lever 20 is When a position other than the low speed position, the engine speed is less than a set speed (for example, less than 250 rpm), or when an abnormality occurs in the tractor, or when the automatic / manual changeover switch 71 is turned off, or This is a case where the PTO switch 25 is operated on or off. That is, when the operator performs a manual operation after shifting to the automatic travel preparation mode 82, the automatic operation is interrupted so that the manual operation is prioritized.

自動走行が開始されて自動走行モード81に移行した状態においては、制御部30は、自動走行に必要なデータが揃わないか、または、自動走行に必要なデータが異常な値となっていないか、または、自動走行中断条件を満たしているか、または、自動走行停止を指示されたか(移行条件4)、判断し、これらのいずれか一つの条件が満たされると手動走行準備モード83に移行する。
自動走行に必要なデータが揃わない場合とは、走行経路データや作業データが消去されたり、変更された場合や、GPSからの位置データが届かない場合や、ジャイロセンサ31や方位センサ32からのデータが入力されない場合等である。
自動走行停止を指示された場合とは、自動走行プログラムが終了した場合や、自動走行設定手段70を用いて停止指令(プログラム)をした場合や、設定値等を変更した場合や、遠隔操作で停止が指示された場合等である。
In a state where the automatic traveling is started and the state is shifted to the automatic traveling mode 81, the control unit 30 does not have data necessary for the automatic traveling or whether the data necessary for the automatic traveling has an abnormal value. Alternatively, it is determined whether the automatic driving interruption condition is satisfied, or whether automatic driving stop is instructed (transition condition 4), and when any one of these conditions is satisfied, the process shifts to the manual driving preparation mode 83.
The case where the data required for automatic driving is not available means that the driving route data and work data are deleted or changed, the position data from GPS does not reach, the gyro sensor 31 and the direction sensor 32 This is the case when no data is input.
When the automatic travel stop is instructed, the automatic travel program ends, the stop command (program) is issued using the automatic travel setting means 70, the set value is changed, or the remote operation is performed. For example, when a stop is instructed.

自動走行が中断されたりして手動走行準備モード83に移行すると、手動走行開始条件が満たされたか、自動走行開始条件が満たされたか判断する。手動走行開始条件が満たされると(移行条件5)手動走行モード80への移行を許可し、自動走行開始条件が満たされると(移行条件6)自動走行準備モード82への移行を許可する。
手動走行開始条件とは、前後進切換レバー22が中立で、主変速レバー17が最低速位置から設定範囲内の位置に変速され、アクセルレバー21が低回転域(例えば、最大回転数の50パーセント以下)にセットされ、自動・手動切換スイッチ71がオフ(手動)になっていることである。こうして、エンジン3が低回転で機体が停止しているときに手動走行モード80に移行できるようにして、急発進や急旋回等が生じないようにしている。
When the automatic travel is interrupted and the process shifts to the manual travel preparation mode 83, it is determined whether the manual travel start condition is satisfied or the automatic travel start condition is satisfied. When the manual travel start condition is satisfied (transition condition 5), the transition to the manual travel mode 80 is permitted, and when the automatic travel start condition is satisfied (transition condition 6), the transition to the automatic travel preparation mode 82 is permitted.
The manual travel start condition is that the forward / reverse switching lever 22 is neutral, the main transmission lever 17 is shifted from the lowest speed position to a position within the set range, and the accelerator lever 21 is in a low rotation range (for example, 50% of the maximum rotation speed). The automatic / manual changeover switch 71 is turned off (manual). In this way, when the engine 3 is running at a low speed and the airframe is stopped, it is possible to shift to the manual travel mode 80 so as not to cause a sudden start or a sudden turn.

以上のように、GPS衛星37から送信される電波を受信して機体の位置を算出するGPS位置算出手段と、操舵装置を回動する操舵駆動手段となる操舵アクチュエータ40と、エンジン回転制御手段となるエンジンコントローラ60と、変速手段となる主変速アクチュエータ44と副変速アクチュエータ47と、これらを制御する制御部30を備え、前記機体の位置に基づいて設定経路に沿って走行するように前記操舵駆動手段、エンジン回転制御手段及び変速手段を制御して自動走行可能とする自動走行モード81と、変速操作手段となる主変速レバー17と副変速レバー20、操舵操作手段となるステアリングハンドル4及びエンジン回転操作手段となるアクセルレバー21の人為的操作に応じて前記機体の走行を可能とする手動走行モード80とを備える走行車両において、制御部30には自動走行モード81と手動走行モード80を切り換えるモード切換操作手段となる自動・手動切換スイッチ71が接続され、自動・手動切換スイッチ71が手動から自動に切り換えられると、車速が設定速度以下、かつ、操舵装置が略直進位置、かつ、前後進切換手段が中立、かつ、クラッチがオフ(クラッチペダル16が非操作)、かつ、ブレーキがオフ(ブレーキペダル15及びパーキングレバー39が非操作)、かつ、副変速装置が低速位置、かつ、トラクタに異常がなく、かつ、エンジン回転数が設定回転数以上の場合、自動走行準備モード82に切り換わり、自動走行にかかる必要なデータがそろうと、自動走行モード81となり自動走行が開始されるので、手動走行モード80から自動走行モード81に切り換わる途中で、自動走行準備モード82に切り換わり、急発進や急旋回することなくスムーズに自動走行が開始される。   As described above, the GPS position calculation means for receiving the radio wave transmitted from the GPS satellite 37 and calculating the position of the airframe, the steering actuator 40 serving as the steering drive means for rotating the steering device, the engine rotation control means, An engine controller 60, a main transmission actuator 44 and a sub-transmission actuator 47 serving as transmission means, and a control unit 30 for controlling them, and the steering drive so as to travel along a set route based on the position of the machine body. An automatic travel mode 81 that enables automatic travel by controlling the engine, the engine rotation control means and the speed change means, the main speed change lever 17 and the sub speed change lever 20 as the speed change operation means, the steering handle 4 as the steering operation means and the engine speed. Manual travel that allows the aircraft to travel in response to an artificial operation of the accelerator lever 21 as an operation means In the traveling vehicle having the mode 80, the control unit 30 is connected to an automatic / manual switch 71 serving as a mode switching operation means for switching between the automatic travel mode 81 and the manual travel mode 80. When the vehicle is switched from automatic to automatic, the vehicle speed is equal to or lower than the set speed, the steering device is substantially straight, the forward / reverse switching means is neutral, the clutch is off (the clutch pedal 16 is not operated), and the brake is off. If the brake pedal 15 and the parking lever 39 are not operated, the auxiliary transmission is in the low speed position, the tractor is normal, and the engine speed is equal to or higher than the set speed, the automatic travel preparation mode 82 is switched to. In other words, when the necessary data for automatic driving are available, automatic driving mode 81 is entered and automatic driving is started. In the course of switching from the 80 to the automatic driving mode 81, switched to the automatic travel preparation mode 82, smooth automatic travel in is started without sudden acceleration or sudden turns.

また、前記制御部30は、前記自動走行準備モード82において、車速が前記手動走行モード80から自動走行準備モード82への移行にかかる遅い設定速度よりも速い、または、操舵装置が直進位置でない、または、モード切換操作手段84による切換操作から設定時間経過した場合は、手動走行準備モード83に移行するので、車速が十分設定速度まで落ちずに自動走行に移行することがなく、または、自動走行移行時に旋回することもなく、モード切換操作手段となる自動・手動切換スイッチ71による切換操作により反応がない場合にはそのまま維持することなく手動走行準備モード83に移行する。そして、異常を認識して改善されると自動走行準備モード82へ復帰することもでき、または、自動走行をやめて手動走行モード80に速やかに移行することもできるようになる。   Further, the control unit 30 is configured so that the vehicle speed is faster than a slow set speed required for shifting from the manual travel mode 80 to the automatic travel preparation mode 82 in the automatic travel preparation mode 82, or the steering device is not in a straight traveling position. Alternatively, when the set time has elapsed from the switching operation by the mode switching operation means 84, the mode shifts to the manual travel preparation mode 83, so that the vehicle speed does not sufficiently decrease to the set speed and does not shift to the automatic travel, or the automatic travel If there is no reaction by the switching operation by the automatic / manual switching switch 71 serving as a mode switching operation means without making a turn at the time of transition, the mode shifts to the manual travel preparation mode 83 without being maintained as it is. When the abnormality is recognized and improved, the automatic travel preparation mode 82 can be restored, or the automatic travel can be stopped and the manual travel mode 80 can be promptly shifted.

また、前記自動走行準備モード82になると、制御部30は、エンジン3をアイドル回転に変更し、走行停止制御を行うので、強制的に一旦停止してから自動走行モード81に移行するので、急な変動が生じることがなく、確実に自動走行モード81へ移行ができ、安全性の向上が図れる。   Further, when the automatic travel preparation mode 82 is entered, the control unit 30 changes the engine 3 to idle rotation and performs travel stop control. Therefore, the control unit 30 forcibly stops and then shifts to the automatic travel mode 81. Therefore, it is possible to surely shift to the automatic travel mode 81 and improve safety.

制御部30には自動走行モード81と手動走行モード80を切り換えるモード切換手段84が設けられ、制御部30は、自動走行モード81時に、前後進切換手段となる前後進切換レバー22が中立以外、または、クラッチペダル16が操作またはブレーキペダル15またはパーキングレバー39が操作された、または、副変速レバー20が低速以外、または、モード切換操作手段となる自動・手動切換スイッチ71が操作され、または、PTOスイッチ25の操作が行われた場合、または、エンジン回転数が設定回転数以下になった場合には、自動走行が中断され、手動走行準備モード83とするので、自動走行モード81時に、手動操作が行われたときや自動走行モード81では有り得ない回転数となると自動走行が中断され、容易に手動操作ができるようになり、意図しない走行を回避できる。また、自動走行モード81から直接手動走行モード80に移行しないため、急な車速変化やエンジン回転数変化や急旋回等が生じることがなく、スムーズな移行が図れる。また、手動操作の意思を確認することとなり、意図しないモード切換を防止できる。   The control unit 30 is provided with mode switching means 84 for switching between the automatic travel mode 81 and the manual travel mode 80. In the automatic travel mode 81, the control unit 30 is configured so that the forward / reverse switching lever 22 serving as the forward / reverse switching means is other than neutral. Alternatively, the clutch pedal 16 is operated or the brake pedal 15 or the parking lever 39 is operated, the sub-shift lever 20 is other than a low speed, or the automatic / manual changeover switch 71 serving as a mode switching operation means is operated, or When the PTO switch 25 is operated or when the engine speed is equal to or lower than the set speed, the automatic travel is interrupted and the manual travel preparation mode 83 is entered. When the operation is performed or when the rotation speed is not possible in the automatic driving mode 81, the automatic driving is interrupted and the operation is easily performed. Operation will be able to, it is possible to avoid the unintended traveling. In addition, since the automatic travel mode 81 does not directly shift to the manual travel mode 80, there is no sudden vehicle speed change, engine speed change, sudden turn, or the like, and a smooth transition can be achieved. Further, the intention of manual operation is confirmed, and unintended mode switching can be prevented.

前記手動走行準備モード83になると、制御部30は、エンジン3をアイドル回転に変更するので、一旦エンジン3の回転数を落としてから手動走行モード80に移行することになり、急な速度変化が生じることがなくスムーズに手動走行モード80に移行できる。   When the manual travel preparation mode 83 is entered, the control unit 30 changes the engine 3 to idle rotation. Therefore, the controller 30 temporarily decreases the rotational speed of the engine 3 and then shifts to the manual travel mode 80, and a sudden speed change occurs. It is possible to smoothly shift to the manual travel mode 80 without occurring.

前記手動走行準備モード83において、制御部30は、自動走行開始条件を満たすと自動走行準備モード82に移行するので、自動走行が中断した状態から容易に自動走行モード81に復帰できてスムーズに発進できるようになる。   In the manual travel preparation mode 83, the control unit 30 shifts to the automatic travel preparation mode 82 when the automatic travel start condition is satisfied. Therefore, the automatic travel mode can be easily returned to the automatic travel mode 81 from the state where the automatic travel is interrupted, and the vehicle starts smoothly. become able to.

1 トラクタ
4 ステアリングハンドル
17 主変速レバー
20 副変速レバー
21 アクセルレバー
30 制御部
37 GPS衛星
40 操舵アクチュエータ
44 主変速アクチュエータ
47 副変速アクチュエータ
60 エンジンコントローラ
71 自動・手動切換スイッチ
80 手動走行モード
81 自動走行モード
82 自動走行準備モード
DESCRIPTION OF SYMBOLS 1 Tractor 4 Steering handle 17 Main transmission lever 20 Sub transmission lever 21 Acceleration lever 30 Control part 37 GPS satellite 40 Steering actuator 44 Main transmission actuator 47 Sub transmission actuator 60 Engine controller 71 Automatic / manual changeover switch 80 Manual driving mode 81 Automatic driving mode 82 Automatic driving preparation mode

Claims (3)

GPS衛星から送信される電波を受信して機体の位置を算出するGPS位置算出手段と、操舵装置を回動する操舵駆動手段と、エンジン回転制御手段と、変速手段と、これらを制御する制御部を備え、前記機体の位置に基づいて設定経路に沿って走行するように前記操舵駆動手段、エンジン回転制御手段及び変速手段を制御して自動走行可能とする自動走行モードと、変速操作手段、操舵操作手段及びエンジン回転操作手段の人為的操作に応じて前記機体の走行を可能とする手動走行モードとを備える走行車両において、制御部には自動走行モードと手動走行モードを切り換えるモード切換操作手段が接続され、制御部は、モード切換操作手段が手動から自動に切り換えられると、車速が設定速度以下、かつ、操舵装置が略直進位置、かつ、前後進切換手段が中立、かつ、クラッチペダル16、ブレーキペダル15、パーキングレバー39が操作されていない、かつ、副変速装置が低速位置、かつ、走行車両に異常がなく、かつ、エンジン回転数が設定回転数以上の場合、自動走行準備モードに切り換わり、自動走行にかかる必要なデータがそろうと、自動走行モードとなり自動走行が開始されることを特徴とする走行車両。   GPS position calculation means for receiving radio waves transmitted from GPS satellites to calculate the position of the airframe, steering drive means for rotating the steering device, engine rotation control means, speed change means, and control unit for controlling these An automatic travel mode that enables automatic travel by controlling the steering drive means, the engine rotation control means, and the speed change means so as to travel along a set route based on the position of the airframe, speed change operation means, and steering In a traveling vehicle having a manual travel mode that enables the vehicle to travel in response to an artificial operation of the operation means and the engine rotation operation means, the control unit includes a mode switching operation means for switching between the automatic travel mode and the manual travel mode. Connected, the control unit, when the mode switching operation means is switched from manual to automatic, the vehicle speed is equal to or less than the set speed, the steering device is substantially straight, and The reverse switching means is neutral, the clutch pedal 16, the brake pedal 15, and the parking lever 39 are not operated, the auxiliary transmission is in the low speed position, the running vehicle is normal, and the engine speed is set. When the number of revolutions is higher, the vehicle switches to the automatic travel preparation mode, and when the necessary data relating to the automatic travel is obtained, the travel vehicle is started and the automatic travel is started. 前記制御部には、前記自動走行準備モードにおいて、車速が前記設定速度よりも速い、または、操舵操作手段が直進位置でない、または、モード切換操作手段による切換操作から設定時間経過した場合は、手動走行準備モードに移行することを特徴とする請求項1に記載の走行車両。   In the automatic traveling preparation mode, the control unit is configured to manually operate when the vehicle speed is faster than the set speed, or when the steering operation means is not in the straight traveling position, or when a set time has elapsed from the switching operation by the mode switching operation means. The traveling vehicle according to claim 1, wherein the traveling vehicle shifts to a traveling preparation mode. 前記自動走行準備モードになると、制御部は、エンジンをアイドル回転に変更し、走行停止制御を行うことを特徴とする請求項2に記載の走行車両。   The traveling vehicle according to claim 2, wherein when the automatic travel preparation mode is entered, the control unit changes the engine to idle rotation and performs travel stop control.
JP2013055021A 2013-03-18 2013-03-18 Traveling vehicle Active JP5918162B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2013055021A JP5918162B2 (en) 2013-03-18 2013-03-18 Traveling vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2013055021A JP5918162B2 (en) 2013-03-18 2013-03-18 Traveling vehicle

Publications (2)

Publication Number Publication Date
JP2014182453A JP2014182453A (en) 2014-09-29
JP5918162B2 true JP5918162B2 (en) 2016-05-18

Family

ID=51701139

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2013055021A Active JP5918162B2 (en) 2013-03-18 2013-03-18 Traveling vehicle

Country Status (1)

Country Link
JP (1) JP5918162B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018139038A1 (en) * 2017-01-30 2018-08-02 ヤンマー株式会社 Work vehicle control device

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101601553B1 (en) 2014-12-03 2016-03-21 현대자동차주식회사 Driving control system of vehicle and method for changing speed setting mode using thereof
JP6756273B2 (en) * 2017-01-20 2020-09-16 株式会社デンソー Automatic operation control device
JP6932655B2 (en) * 2017-02-08 2021-09-08 ヤンマーパワーテクノロジー株式会社 Work vehicle
JP6726128B2 (en) * 2017-03-31 2020-07-22 ヤンマーパワーテクノロジー株式会社 Agricultural vehicle autonomous driving system
JP7023059B2 (en) * 2017-06-28 2022-02-21 株式会社クボタ Work platform
WO2019124258A1 (en) 2017-12-18 2019-06-27 株式会社クボタ Tractor and working vehicle
JP7085103B2 (en) * 2018-01-23 2022-06-16 株式会社クボタ Work vehicle
EP3730347B1 (en) 2017-12-18 2023-06-07 Kubota Corporation Tractor and working vehicle
JP6891135B2 (en) * 2018-01-23 2021-06-18 株式会社クボタ Work vehicle
EP3759007B1 (en) * 2018-03-02 2023-10-25 ST Engineering Land Systems Ltd. Hybrid drive by wire system for track vehicle operation
JP6973225B2 (en) * 2018-03-23 2021-11-24 株式会社豊田自動織機 Remote control system for industrial vehicles, industrial vehicles, remote control devices, remote control programs for industrial vehicles, and remote control methods for industrial vehicles
JP2019176801A (en) * 2018-03-30 2019-10-17 株式会社クボタ Field work vehicle
JP6890154B2 (en) * 2019-01-28 2021-06-18 先進モビリティ株式会社 Self-driving vehicle
JP7276073B2 (en) * 2019-10-29 2023-05-18 井関農機株式会社 work vehicle
JP7160875B2 (en) 2020-09-24 2022-10-25 ヤンマーパワーテクノロジー株式会社 work vehicle controller
JP2022098847A (en) * 2020-12-22 2022-07-04 井関農機株式会社 Work vehicle
WO2022201855A1 (en) * 2021-03-22 2022-09-29 日立建機株式会社 Autonomously operating construction machinery
JP7372021B2 (en) * 2021-11-24 2023-10-31 三菱ロジスネクスト株式会社 Cargo handling system

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2923670B2 (en) * 1990-04-02 1999-07-26 本田技研工業株式会社 Automatic steering device
US6356819B1 (en) * 1998-04-20 2002-03-12 Trimble Navigation Limited Safety system for guidance control system
JP2001147717A (en) * 1999-11-19 2001-05-29 Yanmar Diesel Engine Co Ltd Automatic traveling setting device for automatic traveling vehicle

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018139038A1 (en) * 2017-01-30 2018-08-02 ヤンマー株式会社 Work vehicle control device
JP2018121537A (en) * 2017-01-30 2018-08-09 ヤンマー株式会社 Work vehicle control device
CN110248534A (en) * 2017-01-30 2019-09-17 洋马株式会社 Working truck control device
CN114600582A (en) * 2017-01-30 2022-06-10 洋马动力科技有限公司 Work vehicle control device
CN114600582B (en) * 2017-01-30 2024-04-30 洋马动力科技有限公司 Work vehicle control device

Also Published As

Publication number Publication date
JP2014182453A (en) 2014-09-29

Similar Documents

Publication Publication Date Title
JP6016680B2 (en) Traveling vehicle
JP5918162B2 (en) Traveling vehicle
JP6869808B2 (en) Work machine control device, work machine control method and work machine
KR102283927B1 (en) Task vehicle control system
KR102463645B1 (en) Work vehicle control device
JP7091189B2 (en) Automatic driving system for work vehicles
KR102696042B1 (en) work vehicle
JP7504961B2 (en) Work vehicle control method
JP7524410B2 (en) Work vehicles
JP7411018B2 (en) Automatic driving system for work vehicles
JP2020103085A (en) Work vehicle
WO2020235470A1 (en) Automatic travel system
JP2022033175A (en) Automatic traveling system
WO2021045097A1 (en) Work vehicle
JP2019053470A (en) Work vehicle-purpose autonomous travelling system
KR102696043B1 (en) work vehicle
JP7189720B2 (en) work vehicle
JP7137970B2 (en) work vehicle
JP7040705B2 (en) Automatic driving system for work vehicles
JP7125206B2 (en) work vehicle
US20230313490A1 (en) Automatically steering a mobile machine
JP7314353B2 (en) work vehicle
US20240229419A1 (en) Work machine and method for controlling work machine
JP2022060517A (en) Work vehicle automatic traveling system
CN117177899A (en) Work machine and method for controlling a work machine

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20150508

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160407

R150 Certificate of patent or registration of utility model

Ref document number: 5918162

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350