JPH01166108A - Automatic steering device for working vehicle - Google Patents

Automatic steering device for working vehicle

Info

Publication number
JPH01166108A
JPH01166108A JP62325979A JP32597987A JPH01166108A JP H01166108 A JPH01166108 A JP H01166108A JP 62325979 A JP62325979 A JP 62325979A JP 32597987 A JP32597987 A JP 32597987A JP H01166108 A JPH01166108 A JP H01166108A
Authority
JP
Japan
Prior art keywords
inclination
steering
automatic steering
detector
amount
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.)
Granted
Application number
JP62325979A
Other languages
Japanese (ja)
Other versions
JP2599944B2 (en
Inventor
Hideki Kamiyama
神山 英機
Taiji Mizukura
泰治 水倉
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 Agricultural Equipment 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 Agricultural Equipment Co Ltd filed Critical Yanmar Agricultural Equipment Co Ltd
Priority to JP62325979A priority Critical patent/JP2599944B2/en
Publication of JPH01166108A publication Critical patent/JPH01166108A/en
Application granted granted Critical
Publication of JP2599944B2 publication Critical patent/JP2599944B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

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

Abstract

PURPOSE:To prevent the generation of the danger of a working vehicle by executing the calculation and the storage of a maximum inclination quantity at the tie of a teaching steering, interrupting an automatic steering, moving back and after that, stopping when the inclination quantity detected at the time of the automatic steering exceeds the above-mentioned maximum inclination quantity. CONSTITUTION:First, in a first operation in which a driver operates a steering wheel (not shown in figure) and makes the vehicle travel as the works, the inclination quantity of the working vehicle is detected by inclination detectors 9a and 9b and the calculation and the storage of the maximum inclination quantity are executed by a steering control part 30. Next, at the time of the automatic steering, boundaries are detected by boundary detectors 10l and 10r and a front wheel 2 is steered by the steering control part 30 so that the working vehicle may be automatically steered following the said boundaries. At this time, when the inclination quantity detected by the detectors 9a and 9b exceeds the stored maximum inclination quantity, the automatic steering is interrupted the working vehicle is moved back for a fixed time and after that, it is stopped.

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、作業地内を走行して種々の対地作業を行うト
ラクタ、田植機、芝刈機等の作業用車両を所定の経路に
沿って走行せしめるべく自動操向する装置に関する。
[Detailed Description of the Invention] [Industrial Application Field] The present invention provides a system for driving work vehicles such as tractors, rice transplanters, and lawn mowers along a predetermined route to perform various ground work in a work area. This invention relates to a device that automatically steers the vehicle.

〔従来技術〕[Prior art]

従来作業地内を走行して種々の対地作業、例えばトラク
タによる圃場内の耕うん及び枠上作業、芝刈機による庭
園の芝刈作業等に教示再生制御による自動操向装置を装
備した作業用車両が公知である。これらの車両は作業地
の一部、外周又は全走路を予め手動又は自動操向にて走
行することにより、教示を行ない、その教示情報に基づ
き、作業地内の走行経路が設定され、その走行経路に沿
って、対地作業が自動操向装置により行われている。
Conventionally, work vehicles equipped with automatic steering devices using teaching and regeneration control have been known for traveling in a work area and performing various ground work, such as plowing and frame work in a field with a tractor, mowing work in a garden with a lawn mower, etc. be. These vehicles are taught by manually or automatically steering a part of the work area, the outer periphery, or the entire track in advance, and based on the teaching information, a driving route within the work area is set, and the driving route is set. Along the route, ground operations are carried out using automatic steering equipment.

〔発明が解決しようとする問題点〕[Problem that the invention seeks to solve]

しかし前述のような自動操向装置において、作業用車両
が対地作業中に圃場の畦又は障害物に乗り上げ、操向不
能に陥り最悪の場合には前記作業用車両が転倒する虞が
あった。
However, in the above-mentioned automatic steering system, there is a risk that the working vehicle may run onto a field ridge or an obstacle during ground work, making it impossible to steer the vehicle and, in the worst case, overturning the working vehicle.

本発明は斯かる事情に鑑みなされたものであり、教示後
の自動操向中に過度の傾斜による操向不能又は転倒等の
危険を未然に防止し得る自動操向装置を提供することを
目的とする。
The present invention has been made in view of the above circumstances, and an object of the present invention is to provide an automatic steering device that can prevent dangers such as inability to steer or falling due to excessive inclination during automatic steering after being taught. shall be.

〔問題点を解決するための手段〕[Means for solving problems]

本発明に係る作業用車両の自動操向装置は、作業地内を
予め教示された走路に沿って対地作業を行なう作業用車
両の自動操向装置において、該作業用車両の進行方向及
びそれと直交する方向での傾斜量を検出する傾斜検出器
と、前記教示中に前記傾斜検出器にて検出した前記作業
用車両の最大傾斜量を算出し、記憶する最大傾斜量記憶
手段と、自動操向にて対地作業をしつつ、前記傾斜検出
器にて傾斜量を検出し、該傾斜量と前記最大傾斜量とを
比較する比較手段と、前記比較手段により、前記傾斜量
が前記最大傾斜量より大きいと判定したとき、所定の動
作を行わせる手段とを具備することを特徴とする。
An automatic steering device for a work vehicle according to the present invention is an automatic steering device for a work vehicle that performs ground work along a travel path taught in advance in a work area, and includes a direction in which the work vehicle is traveling and a direction perpendicular thereto. a tilt detector for detecting a tilt amount in a direction; a maximum tilt amount storage means for calculating and storing a maximum tilt amount of the work vehicle detected by the tilt detector during the teaching; a comparison means for detecting an amount of inclination with the inclination detector and comparing the amount of inclination with the maximum amount of inclination while performing ground work; and means for causing a predetermined operation to be performed when it is determined that this is the case.

〔作用〕[Effect]

本発明においては、教示時に傾斜検出器にて算出され、
記憶された最大傾斜量と、自動操向時の対地作業中に検
出された傾斜量とを比較し、該傾斜量が最大傾斜量より
大きいとき、作業用車両の所定の動作により未然に危険
の発生を防止する。
In the present invention, it is calculated by the tilt detector at the time of teaching,
The memorized maximum amount of inclination is compared with the amount of inclination detected during ground work during automatic steering, and if the amount of inclination is greater than the maximum amount of inclination, a predetermined operation of the work vehicle will prevent a dangerous situation from occurring. Prevent occurrence.

〔実施例〕〔Example〕

以下本発明をその実施例を示す図面に基づいて詳述する
。第1図は本発明に係る作業用車両の自動操向装置(以
下本発明装置という)を装備したトラクタの左側面図で
ある。
The present invention will be described in detail below based on drawings showing embodiments thereof. FIG. 1 is a left side view of a tractor equipped with an automatic steering device for a working vehicle according to the present invention (hereinafter referred to as the device of the present invention).

図において1は、左右各一対の前輪2,2及び後輪3,
3に支持された機体である。前輪2.2は、機体1の後
部上側に設置された運転席12に着座した運転者による
操舵用のハンドル4の回動操作に応じてその向きを変更
され、該前輪2.2の向きに応じて機体1の操向がなさ
れるようになしであると共に、後述する如く、本発明装
置による自動操向が行われる場合、操向用の油圧シリン
ダ27(第3図参照)への圧油の送給方向を電気的に切
換え、該シリンダ27の動作方向を変更することによっ
てもその向きが変更され得るようになしである。また後
輪3.3は機体1の前部に搭載した動力部5にて発生さ
れた動力を変速機51を介して伝達されて回転し、該後
輪3,3の回転により機体1は作業地である圃場を走行
する。作業機であるロータリ7は、機体1の後部に装着
された3点リンク機構6の上下動に応じて機体1に対し
て昇降自在に取付けられていると共に、前記動力部5か
ら動力を伝達されて動作するようになしてあり、圃場に
降下された場合に、その動作により該圃場の耕うん及び
砕土を行う。
In the figure, 1 indicates a pair of left and right front wheels 2, 2 and a rear wheel 3,
The aircraft is supported by 3. The direction of the front wheel 2.2 is changed according to the turning operation of the steering handle 4 by the driver seated in the driver's seat 12 installed at the upper rear part of the aircraft body 1, and the direction of the front wheel 2.2 is changed. In addition, as will be described later, when automatic steering is performed by the device of the present invention, pressurized oil is supplied to the hydraulic cylinder 27 for steering (see FIG. 3). The direction can also be changed by electrically switching the feeding direction of the cylinder 27 and changing the operating direction of the cylinder 27. In addition, the rear wheels 3.3 are rotated by the power generated by the power unit 5 mounted on the front part of the aircraft body 1 being transmitted via the transmission 51, and the rotation of the rear wheels 3, 3 causes the aircraft 1 to perform work. Driving through a field, which is the land. The rotary 7, which is a work machine, is attached to the machine body 1 so as to be able to rise and fall freely in response to the vertical movement of a three-point link mechanism 6 attached to the rear of the machine body 1, and receives power from the power unit 5. When it is lowered into a field, it tills and crushes the soil in the field.

第2図は傾斜検出器の構成を示す模式的斜視図であり、
運転席20の左側には、機体1の進行方向(又は進行方
向と直交する方向)、即ち機体1の前後(又は左右)方
向の傾斜量を検出する傾斜検出器9a (又は9b)が
固設しである。この傾斜検出器9a (又は9b)は、
機体1の前後(又は左右)方向に揺動自在として鉛直下
方に垂下した錘体91の枢支軸92にポテンシオメータ
90を装着したものであり、傾斜検出器9a、9bのケ
ーシング93が機体lと共に傾倒した場合に、該ケーシ
ング93に対して前記錘体91が相対的に傾斜すること
を利用し、該錘体91の傾斜量の変化に対応する前記ポ
テンシオメータ90の出力電圧の変化として機体1の傾
斜量を検出するようになっている。前記傾斜検出器9a
(又は9b)の出力電位は、機体1が水平状態にある場
合に所定の基準値をとり、機体1が前部(又は左側)を
上として傾倒した場合に、前記基準値より高くなる。
FIG. 2 is a schematic perspective view showing the configuration of the tilt detector,
A tilt detector 9a (or 9b) is fixedly installed on the left side of the driver's seat 20 to detect the amount of tilt of the aircraft 1 in the direction of travel (or the direction perpendicular to the direction of travel), that is, the amount of tilt of the aircraft 1 in the longitudinal (or left-right) direction. It is. This tilt detector 9a (or 9b) is
A potentiometer 90 is attached to a pivot shaft 92 of a weight body 91 that hangs vertically downward so that it can swing freely in the front-rear (or left-right) direction of the fuselage 1, and the casings 93 of the tilt detectors 9a and 9b are attached to the By utilizing the fact that the weight body 91 is inclined relative to the casing 93 when the weight body 91 is tilted together, the change in the output voltage of the potentiometer 90 corresponding to the change in the amount of inclination of the weight body 91 is applied to The amount of inclination of 1 is detected. The tilt detector 9a
The output potential of (or 9b) takes a predetermined reference value when the aircraft 1 is in a horizontal state, and becomes higher than the reference value when the aircraft 1 is tilted with the front (or left side) up.

第3図は方位検出器の構成を示すブロック図であり、前
記ロータリ7の上部中央には機体lの進行方向の方位を
検出するための方位検出器8が固着されている。この方
位検出器8としては、トロイダルコア80を外側から囲
う態様にて互いに直交する一対の検出巻線81.82を
巻装してなる地磁気センサを用い、トロイダルコア80
を、発振器により発振される所定の周波数にて交流励磁
すると共に、検出巻線81.82に基準電圧を印加した
場合に、前記検出器vA81.82に誘起される電圧は
、地磁気の方向が夫々に直交する場合に最大となること
を利用し、センサ技術第5巻4号(1985年4月号)
に掲載されているような回路を構成したものである。検
出巻線81.82の出力電圧の周波数成分は、トロイダ
ルコア80の励磁電流の周波数の2倍であるから、夫々
の出力電圧は、前記発振器により発振される2倍の周波
数を基準として同期検波され、各別の積分回路及びアン
プを経て出力として取出されるようにしである。このよ
うに取出された検出巻線81.82の出力電圧は、後述
する操向制御部30に与えられており、操向制御部30
は、これらの再出力の比の逆正接により、地磁気の方位
を絶対的な基準として、方位検出器8の設置方向、換言
すれば機体1の進行方向を算出する。
FIG. 3 is a block diagram showing the configuration of the azimuth detector, and a azimuth detector 8 is fixed to the center of the upper part of the rotary 7 for detecting the azimuth in the traveling direction of the aircraft l. As the direction detector 8, a geomagnetic sensor is used, which is formed by winding a pair of detection windings 81 and 82 orthogonal to each other so as to surround the toroidal core 80 from the outside.
When is excited with alternating current at a predetermined frequency oscillated by an oscillator and a reference voltage is applied to the detection winding 81.82, the voltage induced in the detector vA 81.82 varies depending on the direction of the earth's magnetism. Taking advantage of the fact that it is maximum when orthogonal to
The circuit is constructed as shown in . Since the frequency component of the output voltage of the detection windings 81 and 82 is twice the frequency of the excitation current of the toroidal core 80, each output voltage is synchronously detected with reference to the twice the frequency oscillated by the oscillator. The signal is then outputted as an output through separate integration circuits and amplifiers. The output voltages of the detection windings 81 and 82 taken out in this way are given to the steering control section 30, which will be described later.
calculates the installation direction of the azimuth detector 8, in other words, the traveling direction of the aircraft 1, using the geomagnetic azimuth as an absolute reference, using the arc tangent of the ratio of these re-outputs.

前記動力部5を覆うボンネットの左右側面の上前部には
、夫々境界検出器101 、1Orが取付けられている
。境界検出器101 、1Orはともにその検知域を機
体1の前端部よりやや前方として、しかも左右の検知載
量の距離を、機体1の後部に取付けたロークリア等の作
業機の幅に応じて変更できるように取付けられている。
Boundary detectors 101 and 1Or are attached to the upper front portions of the left and right sides of the bonnet that covers the power unit 5, respectively. Both the boundary detectors 101 and 1Or have their detection areas slightly forward of the front end of the machine body 1, and the distance between the left and right detection loads is changed according to the width of the work equipment such as a low clear installed at the rear of the machine body 1. It is installed so that it can be used.

前記境界検出器101 、1Orは発光素子及び受光素
子を内蔵しており、前者から発せられた光を被検物に投
射し、該被検物からの反射光を後者にて捉え、その受光
量に応じた電圧信号を出力するものである。
The boundary detector 101, 1Or has a built-in light-emitting element and a light-receiving element, and projects light emitted from the former onto a test object, captures reflected light from the test object with the latter, and calculates the amount of received light. It outputs a voltage signal according to the voltage.

第4図は、前輪2.2の操舵機構の平面図と共に示す本
発明装置の制御系のブロック図である。
FIG. 4 is a block diagram of the control system of the device of the present invention, shown together with a plan view of the steering mechanism for the front wheels 2.2.

図において20は、その長手方向を左右方向として機体
1の下部に固着されたフロントアクスルであり、該フロ
ントアクスル20の左右両端部には、左右の前輪2.2
を夫々軸支するナックルアーム22.22が、各別のキ
ングピン2121回りに水平面内での回動自在に枢支し
である。ナックルアーム22.22は、夫々の前端部を
、フロントアクスル20の上部に立設した枢軸23回り
に水平面内で回動する回動板24の前部に各別のリンク
部材25.25を介して連結されており、操向用の油圧
シリンダ27はそのピストンロンドの先端部を、前記回
動板24の中途部に左方に突設されたアーム26の先端
部に係止させて取付けられている。従って、前記油圧シ
リンダ27が進出動作(又は退入動作)した場合、これ
に応じて回動板24が第4図における時計回り(又は反
時計回り)に回動し、この回動がリンク部材25.25
を介して左右のナックルアーム22.22に伝達され、
前輪2.2は、夫々のす・ノクルアーム22.22と共
に右(又は左)に舵取りされる。
In the figure, reference numeral 20 denotes a front axle fixed to the lower part of the aircraft body 1 with its longitudinal direction being the left-right direction.
The knuckle arms 22 and 22 are pivotably supported around respective king pins 2121 so as to be rotatable in a horizontal plane. The knuckle arms 22.22 have their respective front ends attached to the front part of a pivot plate 24 which pivots in a horizontal plane about a pivot 23 provided upright on the top of the front axle 20, via separate link members 25.25. The steering hydraulic cylinder 27 is attached by locking the tip of its piston rond to the tip of an arm 26 protruding leftward from the middle of the rotating plate 24. ing. Therefore, when the hydraulic cylinder 27 moves forward (or retreats), the rotating plate 24 rotates clockwise (or counterclockwise) in FIG. 25.25
is transmitted to the left and right knuckle arms 22.22 via
The front wheels 2.2 are steered to the right (or left) with their respective nockle arms 22.22.

また前記キングピン21の位置には、ポテンシオメータ
を用いた操向角検出器15が設けてあり、該操向角検出
器15は、キングピン21の回動量、即ち前輪2の操向
角に応じて、直進に対して右に操向されているときには
正の電圧を、左に操向されているときは負の電圧を出力
する。
Further, a steering angle detector 15 using a potentiometer is provided at the position of the king pin 21, and the steering angle detector 15 detects the amount of rotation of the king pin 21, that is, the steering angle of the front wheels 2. , a positive voltage is output when the vehicle is being steered to the right when traveling straight, and a negative voltage is output when the vehicle is being steered to the left.

さらに左右の前記ナックルアーム22.22の位置には
、リードスイッチを用いた走行距離検出器16N。
Further, at the positions of the left and right knuckle arms 22.22, there are mileage detectors 16N using reed switches.

16rが設けてあり、前輪2.2に取付けた磁性体を感
知することにより、前輪2,2の回転数を検出し、検出
された左右の回転数を平均し、それにより走行距離を算
出する。
16r is installed, which detects the rotation speed of the front wheels 2.2 by sensing the magnetic material attached to the front wheels 2.2, averages the detected left and right rotation speeds, and calculates the distance traveled. .

油圧シリンダ27へは、油圧ポンプ29が発生する圧油
が、4ポ一ト3位置切換式の電磁方向切換弁■を介して
供給されており、電磁方向切換弁VのソレノイドSlが
励磁されている場合、油圧ポンプ27からの圧油は、油
圧シリンダ27の退入側油室に送給され、前述の如き舵
取機構の動作によって前輪2.2は左に操向され、逆に
電磁方向切換弁VのソレノイドSrが励磁されている場
合、前輪2゜2は右に操向される。更に、ソレノイドS
1及びソレノイドSrが共に消磁されており、電磁方向
切換弁■がその中立位置にある場合、前輪2.2は現状
の舵取角度に保たれる。
Pressure oil generated by a hydraulic pump 29 is supplied to the hydraulic cylinder 27 via a 4-point/3-position switching type electromagnetic directional switching valve ■, and the solenoid Sl of the electromagnetic directional switching valve V is energized. In this case, the pressure oil from the hydraulic pump 27 is fed to the oil chamber on the retracting side of the hydraulic cylinder 27, and the front wheels 2.2 are steered to the left by the operation of the steering mechanism as described above, and conversely, the front wheels 2.2 are steered in the electromagnetic direction. When the solenoid Sr of the switching valve V is energized, the front wheel 2°2 is steered to the right. Furthermore, solenoid S
1 and solenoid Sr are both demagnetized and the electromagnetic directional control valve (2) is in its neutral position, the front wheels 2.2 are kept at the current steering angle.

一方機体1の前後進は前記変速機51により行なわれ、
該変速機51は運転席の前方右側に配設された変速レバ
52により変速される。また変速レバ52の基端枢支部
には、該レバ52を回動させるためのレバ駆動手段たる
シフトモータ50が変速レバ52の枢支軸と同軸的に装
着されており、前記シフトモータ50又は手動による変
速レバ52の回動により変速機51による前後進がなさ
れるようになっている。
On the other hand, the forward and backward movement of the aircraft 1 is performed by the transmission 51,
The speed of the transmission 51 is changed by a speed change lever 52 disposed on the front right side of the driver's seat. Further, a shift motor 50 serving as a lever driving means for rotating the lever 52 is mounted on the base end pivot portion of the shift lever 52 coaxially with the pivot shaft of the shift lever 52, and the shift motor 50 or By manually rotating the speed change lever 52, the transmission 51 moves forward or backward.

また、30は前記方位検出器8、前記傾斜検出器9a、
9b、前記走行距離検出器16 j! 、 16r及び
境界検出器101 、1Orの検出結果に基づいて後述
の如く動作し、電磁方向制御弁VのソレノイドSR又は
ソレノイドSrの励磁を行うことにより機体1を操向せ
しめる操向制御部である。
Further, 30 is the direction detector 8, the tilt detector 9a,
9b, the mileage detector 16 j! , 16r and the boundary detector 101, which operates as described below based on the detection results of the boundary detector 101 and 1Or, and is a steering control unit that steers the aircraft 1 by energizing the solenoid SR or solenoid Sr of the electromagnetic directional control valve V. .

該操向制御部30は、エンジンを始動せしめるためのキ
ースイッチ31を介して電源に接続されており、エンジ
ンが駆動状態にある場合にのみ動作可能となっている。
The steering control section 30 is connected to a power source via a key switch 31 for starting the engine, and is operable only when the engine is in a driving state.

操向制御部30の入力ポートa1には、運転席12に着
座した運転者が操向制御部30にその動作開始を指令す
る場合にオン操作する自動スイッチ32が接続されてお
、す、該スイッチ320オンに応じて人力ボートa1が
ハイレベルに転じるようになっている。
An automatic switch 32 that is turned on when the driver seated in the driver's seat 12 instructs the steering control section 30 to start its operation is connected to the input port a1 of the steering control section 30. When the switch 320 is turned on, the human-powered boat a1 is set to a high level.

また操向制御部30の人力ボートaz及び入カポ−トa
 :lには、運転席12に着座した運転者により操向可
能な位置に配された走行状態選択レバ9の基端部に、該
レバ9の係止位置に応じてオンするように配設されたマ
イクロスイッチを用いてなる教示走行スイッチ33及び
自動操向スイッチ34が夫々接続されており、前記自動
スイッチ32及び教示走行スイッチ33が共にオンされ
ている場合に入力ポートa2がハイレベルに転じ、また
自動スイッチ32及び自動操向スイッチ34がオンされ
ている場合に入カポ−)asがハイレベルに転じるよう
になっている。前記走行状態選択レバ9は、前記教示走
行スイッチ33がオンされる係止位置、前記自動操向ス
イッチ34がオンされる係止位置、及び両スイッチが共
にオフ状態となる回向動作の係止位置の3通りの係止位
置を有しており、運転席12に着座した運転者は、該レ
バ9を回動操作し、その係止位置を変更せしめることに
より、操向制御部30の後述する3通りの動作内容の選
択が可能である。
In addition, the human-powered boat az and the input port a of the steering control unit 30
:L is provided at the base end of the driving state selection lever 9, which is arranged at a position where it can be steered by the driver seated in the driver's seat 12, so as to be turned on according to the locking position of the lever 9. A taught running switch 33 and an automatic steering switch 34 are connected to each other, and when both the automatic switch 32 and taught running switch 33 are turned on, the input port a2 changes to a high level. Further, when the automatic switch 32 and the automatic steering switch 34 are turned on, the input port ()as is set to a high level. The running state selection lever 9 has a locking position where the teaching driving switch 33 is turned on, a locking position where the automatic steering switch 34 is turned on, and a locking position where both switches are turned off. The driver seated in the driver's seat 12 rotates the lever 9 to change the locking position, thereby controlling the steering control unit 30 (described later). It is possible to select three types of operation contents.

また境界検出器10J、10rの出力は、連動操作され
る切換スイッチ111 、 llrに接続されており、
該切換スイッチ111 、 llrは、境界検出器10
1 、1Orの出力を夫々バッファアンプ44の入力と
ポテンシオメータ46の入力とに振り分ける。
In addition, the outputs of the boundary detectors 10J and 10r are connected to changeover switches 111 and llr that are operated in conjunction with each other.
The changeover switch 111 and llr are the boundary detector 10
1 and 1Or outputs are distributed to the input of the buffer amplifier 44 and the input of the potentiometer 46, respectively.

ポテンシオメータ46は入力される電圧の172を出力
するよう調整されており、その出力は前記バッファアン
プ44と同一のゲインが得られ他のバッファアンプ45
に与えられている。
The potentiometer 46 is adjusted to output 172 of the input voltage, and its output has the same gain as the buffer amplifier 44, and the other buffer amplifier 45 has the same gain as the buffer amplifier 44.
is given to.

バッファアンプ44.45の出力は差動アンプ43の入
力としてあり、該差動アンプ43の出力は差動アンプ4
2の1人力としである。該差動アンプ42の他の入力端
子には前記操向角検出器15の出力が極性反転器40を
介して与えられており、差動アンプ42の出力は極性反
転器60を介して前記操向制御部3゜の入力ポートa4
に入力される。
The outputs of the buffer amplifiers 44 and 45 are input to the differential amplifier 43, and the output of the differential amplifier 43 is input to the differential amplifier 4.
Part 2 is a one-man operation. The output of the steering angle detector 15 is applied to the other input terminal of the differential amplifier 42 via a polarity inverter 40. Input port a4 of direction control unit 3°
is input.

前記制御部30に入力された差動アンプ42の出力信号
Eを比較基準値El(正)、El(負)と夫々比較し、
E>E、のとき電磁方向切換弁■のソレノイドSrを励
磁すべく出カポ−)b+がハイレベルに転じ、またE<
ElのときソレノイドSt!を励磁すべく出カポ−)b
zをハイレベルに転じ、さらにEz <E<Elのとき
は出力ボートb、、b2共にローレベルである。
Compare the output signal E of the differential amplifier 42 input to the control unit 30 with comparison reference values El (positive) and El (negative), respectively,
When E>E, the output capo-)b+ changes to high level to excite the solenoid Sr of the electromagnetic directional valve ■, and when E<
When El, solenoid St! output capo to excite)b
When Ez is changed to high level and Ez<E<El, output ports b, , b2 are both at low level.

而してE>Elのとき前輪2,2は右に操向され、E 
< E tのときは左に操向され、E、<E<E、のと
きは操向されない。
Therefore, when E>El, the front wheels 2, 2 are steered to the right, and E
When <E t, the vehicle is steered to the left, and when E and <E<E, the vehicle is not steered.

また前記極性反転器40.41は切換スイッチ111゜
11rが境界検出器101からの出力をポテンシオメー
タ46に与える側に切換えている場合に作動して、入力
信号の極性を反転し、逆に境界検出器101からの出力
をバッファアンプ44に与える側に切換えられている場
合には作動せず、入力信号をそのまま通過させる構成と
しである。
The polarity inverter 40.41 is activated when the changeover switch 111°11r is switching the output from the boundary detector 101 to the potentiometer 46, inverts the polarity of the input signal, When the output from the detector 101 is switched to the side that supplies the buffer amplifier 44, the configuration is such that it does not operate and allows the input signal to pass through as is.

そして入カポ−)asには前記走行距離検出器161 
、16rからのパルス信号が入力され、前記操向制御部
30にて一定時間内の左右夫々の回転数を検出し、その
平均回転数Paを求め、それにより走行距離が算出され
る。
And the mileage detector 161 is installed in the input capo (as).
, 16r are input, the steering control section 30 detects the left and right rotational speeds within a certain period of time, calculates the average rotational speed Pa, and calculates the travel distance.

また入力ポートa6+  a?には方位検出器8の夫々
2つの検出巻線8L82からの出力電圧が与えられてお
り、操向制御部30は予め記憶させである演算式に基づ
いてこれらの出力電圧間の比の逆正接から機体1の進行
方向を算出する。
Also input port a6+ a? are given the output voltages from the two detection windings 8L82 of the azimuth detector 8, and the steering control unit 30 calculates the arctangent of the ratio between these output voltages based on an arithmetic formula stored in advance. The traveling direction of the aircraft 1 is calculated from.

更に入カポ−)a8+  a9にはポテンシオメータを
用いてなる傾斜検出器9a 、 9bの各々の出力電圧
が与えられている。
Furthermore, the input capacitors (a8+a9) are supplied with the output voltages of each of tilt detectors 9a and 9b using potentiometers.

そして入力ポートaa+ae及びa、に入力された信号
により後述するところの既作業域と未作業域との境界に
倣う自動操向制御が行われ、入力ポートas +  a
h l  a7 +  am及びa、の入力信号により
教示及びその記憶に基づく自動繰向制御が行われる。
Then, automatic steering control that follows the boundary between the worked area and the unworked area, which will be described later, is performed by the signals input to the input ports aa+ae and a, and the input ports as+a
Input signals h l a7 + am and a perform teaching and automatic redirection control based on the memory.

一方操向制御部30の出力ポートbI及び同b2は、図
示しない各別の励磁回路を介して、前記電磁方向切換弁
■のソレノイドSr及びソレノイドSNに夫々接続され
ており、出力ポートbt  (又は出力ポートbz)の
ハイレベル出力に応じてソレノイドSr (又はソ”レ
ノイドSl)が励磁され、油圧シリンダ27が進出(又
は進入)動作するようになしてあり、舵取機構の前述の
動作により前輪2゜2が右方向(又は左方向)に舵取り
される。
On the other hand, the output ports bI and b2 of the steering control section 30 are connected to the solenoid Sr and the solenoid SN of the electromagnetic directional control valve (2), respectively, via separate excitation circuits (not shown), and the output port bt (or The solenoid Sr (or solenoid Sl) is energized in response to the high-level output of the output port bz), and the hydraulic cylinder 27 moves forward (or approaches). 2°2 is steered to the right (or left).

また出力ポートb3及び同b4は、変速レバ52をシフ
トするシフトモータ50に接続され、出カポ)b3  
(又はb4)のハイレベル出力に応じて正転(又は逆転
)し、変速レバ10を前進(又は後進)位置から後退(
又は中立)位置にシフトする。
Further, the output ports b3 and b4 are connected to a shift motor 50 that shifts the speed change lever 52, and the output ports b3 and b4 are
(or b4) rotates forward (or reverse) in accordance with the high level output of
or neutral) position.

さて以上の如く構成された本発明装置の動作について説
明する。
Now, the operation of the apparatus of the present invention constructed as above will be explained.

第5図はトラクタの走行状態を示す圃場の一部平面図で
あり、第6図は操向制御の開始時のフローチャートであ
る。
FIG. 5 is a partial plan view of a farm field showing the running state of the tractor, and FIG. 6 is a flowchart at the start of steering control.

本発明装置による自動操向は、まず第5図に示す如く、
運転者がハンドル4を操作することにより、圃場内の1
側に沿って機体1をロータリ7にて作業をしつつ走行せ
しめる第1行程にて、この作業時の機体1の進行方向及
び走行距離を教示走行経路として操向制御部30に記憶
させる教示走行を行う。次に回向を行い既作業域CTD
と未作業域UCTの境界INTに倣ってトラクタは自動
操向される。この倣いによる自動操向を行っている場合
に、前記境界INTが検出不能となったとき、機体1は
前記教示走行により記憶された方位データと方位検出器
8の方位データとを比較し、前記境界が検出可能となる
まで、この教示走行により記憶された方位データに基づ
き自動操向されるものであり、運転者は、この自動操向
を行われる場合まず自動スイッチ32をオン操作して操
作制御部30に動作開始を指令し、次に前記走行状態選
択レバ9を回動操作してこれを前記教示走行を選択する
係止位置に係止せしめ、前記教示走行スイッチ33をオ
ンさせた状態で前記教示走行を行う。この教示走行終了
後、運転者は走行状態選択レバ9を回動操作し、これを
自動操向スイッチ34をオンさせる係止位置に係止せし
めることにより、操向制御部30の動作による自動操向
を開始させる。
The automatic steering by the device of the present invention is as shown in FIG.
1 in the field by the driver operating the handle 4.
In the first step of making the aircraft 1 run along the side while working with the rotary 7, a teaching run is performed in which the direction of movement and traveling distance of the aircraft 1 during this work are stored in the steering control unit 30 as a teaching running route. I do. Next, turn around and complete work area CTD
The tractor is automatically steered in accordance with the boundary INT of the unworked area UCT. When the boundary INT becomes undetectable during automatic steering based on this tracing, the aircraft 1 compares the azimuth data stored from the taught travel with the azimuth data of the azimuth detector 8, and Until the boundary can be detected, automatic steering is performed based on the azimuth data stored through this taught driving, and when performing this automatic steering, the driver first turns on the automatic switch 32 to operate the vehicle. A state in which the control unit 30 is commanded to start operation, and then the driving state selection lever 9 is rotated to lock it in the locking position where the teaching driving is selected, and the teaching driving switch 33 is turned on. Then, the teaching run is performed. After the taught driving is completed, the driver rotates the driving state selection lever 9 and locks it in the locking position where the automatic steering switch 34 is turned on. start the direction.

操向制御部30は、キースイッチ31がオンされ電源に
接続された場合、第6図のフローチャートに示すように
、まずその入力ボートa、のレベルにより前記自動スイ
ッチ32のオンオフ状態を調べる。
When the key switch 31 is turned on and connected to the power source, the steering control section 30 first checks the on/off state of the automatic switch 32 based on the level of the input port a, as shown in the flow chart of FIG.

そして自動スイッチ32がオフされており、入カポ)a
+がローレベルである場合、操向制御部30は、そのメ
モリ、レジスタ及び全てのフラグ等をリセットし、自動
スイッチ32がオンされるまで待機し、また自動スイッ
チ32がオンされており、入カポ−)a+がハイレベル
である場合、次に入力ポートa2及び入力ボートa、の
レベルにより前記教示走行スイッチ33及び自動操向ス
イッチ34のオンオフ状態を調べ、教示走行スイッチ3
3がオンされており、入力ポートa2がハイレベルであ
るときには、後述の教示走行サブルーチンに従って、ま
た自動操向スイッチ34がオンされており、入力ボート
a、がハイレベルであるときには、後述の自動操向サブ
ルーチンに従って、更に教示走行スイッチ33及び自動
操向スイッチ34が共にオフ状態にある場合には、後述
する回向サブルーチンに従って夫々動作する。前述した
如(、自動操向スイッチ34と教示走行スイッチ33と
は、−本の走行状態選択レバ9の異なる係止位置におい
て夫々オンされるように配設されているから、これらが
共にオンされることはなく、運転者は、前記自動スイッ
チ32のオンオフ操作及び走行状態選択レバ9の回動操
作により、操向制御部30に、回向サブルーチン、教示
走行サブルーチン及び自動操向サブルーチンに夫々従う
動作を指令することができる。
Then, the automatic switch 32 is turned off, and the input capo)a
+ is at a low level, the steering control unit 30 resets its memory, registers, all flags, etc., waits until the automatic switch 32 is turned on, and if the automatic switch 32 is turned on and turned on. When capo) a+ is at a high level, the on/off states of the teaching running switch 33 and the automatic steering switch 34 are checked based on the levels of the input port a2 and the input boat a, and the teaching running switch 3
3 is turned on and the input port a2 is at a high level, the automatic steering switch 34 is turned on and the input port a2 is at a high level, according to the teaching running subroutine described later. Further, in accordance with the steering subroutine, when both the taught travel switch 33 and the automatic steering switch 34 are in the OFF state, each operates according to a turning subroutine to be described later. As described above, since the automatic steering switch 34 and the taught travel switch 33 are arranged to be turned on at different locking positions of the - driving state selection lever 9, both of them are turned on. By turning the automatic switch 32 on and off and rotating the driving state selection lever 9, the driver can cause the steering control unit 30 to follow the turning subroutine, teaching driving subroutine, and automatic steering subroutine, respectively. Actions can be commanded.

前述の教示走行は、第5図に示す圃場の左端1行程のみ
即ち○印で示す基点から上方へ向かって走行し、上辺に
て回向するまでの間行われて終了する。
The above-mentioned teaching travel is performed only for one stroke at the left end of the field shown in FIG. 5, that is, the vehicle travels upward from the base point indicated by the circle mark, until it turns around at the upper side, and then ends.

第7図はこのような教示走行のフローチャートを示し、
第8図は方位検出サブルーチンのフローチャートを示し
、第9図は距離算出サブルーチン、第10図は最大傾斜
量算出記憶サブルーチンのフローチャートを示している
FIG. 7 shows a flowchart of such teaching running,
FIG. 8 shows a flowchart of the direction detection subroutine, FIG. 9 shows a flowchart of the distance calculation subroutine, and FIG. 10 shows a flowchart of the maximum inclination calculation storage subroutine.

前述の条件が満足され、教示走行サブルーチンに移行し
た場合、操向制御部30は機体1の前後及び左右方向の
最大傾斜量CaMAx l CbMAXの算出と一定距
離り、毎の方位検出とを行い、それぞれを記憶装置に書
き込む。
When the above-mentioned conditions are satisfied and the transition is made to the teaching driving subroutine, the steering control unit 30 calculates the maximum inclination amount CaMAX l CbMAX of the aircraft body 1 in the longitudinal and lateral directions, and detects the azimuth at every fixed distance. Write each to the storage device.

また方位検出サブルーチンでは方位検出器8の方位デー
タが所定回数読み込まれ、その平均により一定距離の方
位Siを決定する。距離算出サブルーチンでは左右夫々
の距離検出器16 j! 、 16rより出力された回
転数p1.Prを一定時間T2計数し、左右の回転数P
l、Prの平均回転数Paを算出し、1回転当りの距離
lと平均回転数Paと一定時間T。
Further, in the direction detection subroutine, the direction data of the direction detector 8 is read a predetermined number of times, and the direction Si of a certain distance is determined by the average of the data. In the distance calculation subroutine, the left and right distance detectors 16 j! , the rotation speed p1. outputted from 16r. Pr is counted for a certain period of time T2, and the number of left and right rotations P
Calculate the average rotational speed Pa of l and Pr, and calculate the distance l per rotation, the average rotational speed Pa, and a certain time T.

とから速度v1を求め(Vz =PaX l / Tt
 )、この速度を時間で積分して走行距離りを求める。
Find the speed v1 from (Vz = PaX l / Tt
), this speed is integrated over time to find the distance traveled.

求めたLを基点からの距離L5に加え、各地点の基点か
らの距離を求める。
The obtained L is added to the distance L5 from the base point to find the distance of each point from the base point.

次に求められた距離り、と方位S!とを記憶装置に書き
込み記憶する。これは機体1を運転者が回向位置に走行
状態選択レバ9を係止するまで一定距離り、毎に行われ
る。
Next, the distance and direction S are determined! and is written and stored in the storage device. This is performed every time the vehicle 1 moves a certain distance until the driver locks the driving state selection lever 9 in the turning position.

第11図は自動操向制御を示すフローチャートであるが
、最初の回向が終わり教示走行が終了すると、運転者は
走行状態選択レバ9の回動操作により該レバ9を自動操
向スイッチ34をオンできる係止位置にする。次いで操
向制御部30は前後方向の傾斜量Caと左右方向の傾斜
量cbとを夫々検出し、それと教示走行にて記憶された
夫々の方向の最大傾斜量CaMAX + Cb+4Ax
とを比較し、前記傾斜(jtCa。
FIG. 11 is a flowchart showing the automatic steering control. When the first turn is completed and the teaching driving is completed, the driver turns the driving state selection lever 9 to switch the automatic steering switch 34. Set it to the locking position where it can be turned on. Next, the steering control unit 30 detects the amount Ca of inclination in the longitudinal direction and the amount cb of inclination in the left-right direction, and combines them with the maximum amount of inclination CaMAX + Cb + 4Ax in each direction stored in the teaching driving.
The slope (jtCa.

cbのいずれかが前記最大傾斜量CaMAX、CbMA
Xを超えると操向制御部30は自動操向を中断し、出力
ポートb1にハイレベル出力がなされシフトモータ50
の正転により変速レバ52が前進から後退にシフトされ
、機体lは傾斜方向と逆方向に後退し、一定時間経過後
、動力部5は停止し、トラクタは停止する。
Either of cb is the maximum slope amount CaMAX, CbMA
When X is exceeded, the steering control unit 30 interrupts automatic steering, and a high level output is made to the output port b1 to
As a result of the forward rotation, the speed change lever 52 is shifted from forward to backward, and the machine body I moves backward in the opposite direction to the tilting direction. After a certain period of time, the power unit 5 stops and the tractor stops.

このようにして自動操向時に畦等の障害物に乗り上げ、
教示時の最大傾斜量caMax l CtlMAXを超
えると機体1は所定の動作により転倒等の危険を未然に
防止する。
In this way, during automatic steering, you may run onto obstacles such as ridges,
When the maximum tilt amount caMax l CtlMAX at the time of teaching is exceeded, the aircraft 1 performs a predetermined operation to prevent dangers such as falling.

また前記傾斜量Ca、 Cbのいずれもが前記最大傾斜
量CaMAX + CbMAXを超えないときは、境界
検出器10C1Orにより境界INTを検出し、それに
倣って自動操向する。例えば第5図上から下に境界IN
Tに倣って操向される場合即ち機体1の右側に既作業域
CTDが存在する場合、第4図に示す切換スイッチ11
β、11rは第4図と逆にスイッチングされ右側の境界
検出器10rの出力がバッファアンプ44の入力となる
側に切換えられる。
When neither of the tilt amounts Ca and Cb exceeds the maximum tilt amount CaMAX + CbMAX, the boundary detector 10C1Or detects the boundary INT, and automatically steers the vehicle according to the boundary INT. For example, the boundary IN from top to bottom in Figure 5
When the aircraft is steered in accordance with T, that is, when there is an existing working area CTD on the right side of the aircraft 1, the changeover switch 11 shown in FIG.
β, 11r is switched in the opposite manner to that in FIG.

今、境界検出器10J、10rの出力をA、Bとし、バ
ッファアンプ44.45のゲインをkとすると、差動ア
ンプ43への出力は%kAとkBとなり、差動アンプ4
3のゲインをに′とし、k −k ’ =にとすると、
差動アンプ43の出力Cは下記の如くなる。
Now, if the outputs of the boundary detectors 10J and 10r are A and B, and the gain of the buffer amplifier 44.45 is k, the outputs to the differential amplifier 43 are %kA and kB, and the differential amplifier 4
Let the gain of 3 be ′ and k −k ′ =
The output C of the differential amplifier 43 is as follows.

C=K(B−VzA) 左側の境界検出器は常に未作業域OCTを検知域として
いるのに対して、右側の境界検出器10rは、既作業域
CTDのみを検知している第1の場合、未作業域OCT
のみを検知している第2の場合、境界INTを含んで両
者を検知域としている第3の場合が考えられる。
C=K(B-VzA) The left boundary detector always detects the unworked area OCT as the detection area, whereas the right boundary detector 10r detects only the worked area CTD. In case, unworked area OCT
In the second case, only the boundary INT is detected, and in the third case, the detection area includes both the boundary INT and the boundary INT.

既作業域CTDでは表面の凹凸が激しく、表面に投射さ
れた光は散乱するので、既作業域CTDを検知域とする
境界検出器の出力はほぼOとなる。それ故、第1の場合
はB=0、第2の場合はA=Bとなり、第3の場合はB
は0〜Aの間の値となる。
The surface of the already worked area CTD is very uneven and the light projected onto the surface is scattered, so the output of the boundary detector whose detection area is the already worked area CTD is approximately O. Therefore, in the first case B=0, in the second case A=B, and in the third case B
is a value between 0 and A.

特に境界検出器10rが境界INTの上部に位置してお
り、その検知域に未作業域tlcTと既作業域CTDと
を半分ずつ含むときにはB = ’A Aとなる。即ち
、差動アンプ16の出力信号Cはこれが0である場合に
は境界INTに倣って走行していることを示しており、
正である場合には、機体1の前部が第5図における右寄
り、即ち未作業域UTD側に寄った状態であることを示
しており、負である場合には、機体1の前部が第5図に
おける左寄り即ち既作業域CTD側へ寄った状態である
ことを示している。
In particular, when the boundary detector 10r is located above the boundary INT and its detection area includes half of the unworked area tlcT and half of the worked area CTD, B='AA. That is, when the output signal C of the differential amplifier 16 is 0, it indicates that the vehicle is traveling along the boundary INT.
If it is positive, it means that the front part of the machine 1 is closer to the right in Fig. 5, that is, closer to the unworked area UTD side, and if it is negative, the front part of the machine 1 is This shows that the state is shifted to the left in FIG. 5, that is, closer to the completed work area CTD side.

一方操向角検出器15からの出力信号りは前輪2゜2の
直進に対する左右の操向角に応じた電圧となっており、
ゲインに、Kを出力信号りと関連づけて設定しているの
で、差動アンプ42の出力信号E=C−Dは、その時の
前輪2.2の状態からの所要操向角変化量となっている
。出力信号Eが前述の如く基準電圧値E+、Exと比較
され、操向制御されることになる。
On the other hand, the output signal from the steering angle detector 15 is a voltage corresponding to the left and right steering angles of the front wheels 2°2 with respect to straight travel.
Since K is set in the gain in relation to the output signal, the output signal E=CD of the differential amplifier 42 becomes the required amount of change in steering angle from the state of the front wheels 2.2 at that time. There is. The output signal E is compared with the reference voltage values E+ and Ex as described above, and the steering is controlled.

またこのとき境界INTが検出不能となり、境界INT
に倣う自動操向が不能になると、前述しである教示走行
にて記憶された方位データSMiが読み込まれ、その中
の基点から同じ距離の記憶方位データSMiと検出方位
データS、が比較され、その結果により操向制御部30
の出力ボートblもしくはb2のどちらかがハイレベル
出力されるか、又はどちらも出力されず機体1を右進、
左進又はそのまま操向する。
Also, at this time, the boundary INT becomes undetectable, and the boundary INT
When the automatic steering that follows becomes impossible, the azimuth data SMi stored during the teaching drive described above is read, and the detected azimuth data S is compared with the memorized azimuth data SMi at the same distance from the base point. Based on the result, the steering control unit 30
Either output boat bl or b2 is output at high level, or neither output is output and aircraft 1 moves to the right.
Turn left or continue steering.

なお自動操向が教示走行の走行方向と逆のとき即ち第5
図で上から下へ自動操向されるときは、記憶された方位
データS、4.は反対から読み込まれるべくなしである
Note that when the automatic steering is in the opposite direction to the taught driving direction, that is, the fifth
When automatic steering is performed from top to bottom in the figure, the stored orientation data S, 4. cannot be read from the opposite direction.

これらにより境界INTに倣って自動操向された作業用
車両がその途中で境界INTの検出をできなくなっても
、自動操向が中断されず教示された第1行程の方位に倣
って走行されることになる。
As a result, even if a work vehicle that has been automatically steered following the boundary INT fails to detect the boundary INT mid-way, the automatic steering will not be interrupted and the vehicle will continue to follow the taught direction of the first stroke. It turns out.

この自動操向制御も前述の教示走行と同様に、運転者が
走行状態選択レバ9を回向位置に係止するまで行われる
This automatic steering control is also performed, similarly to the above-described taught driving, until the driver locks the driving state selection lever 9 in the turning position.

なお本実施例においては、進行方向を検出する方位検出
器として、トロイダルコアを利用してなる地磁気センサ
を用いたが、地磁気に感応して回動する磁針の回動域に
例えばフォトインクラブタ、リードスイッチ等を多数配
設し、これらにより前記磁針の回動位置を検出して、地
磁気の方位に対する機体1の進行方向を特定する方位検
出器を用いてもよい。
In this example, a geomagnetic sensor using a toroidal core was used as the direction detector for detecting the direction of travel. , a large number of reed switches, etc. may be provided, and a direction detector may be used which detects the rotational position of the magnetic needle and specifies the traveling direction of the aircraft 1 with respect to the direction of earth's magnetism.

また傾斜検出器として本実施例においては錘体の枢支軸
にポテンシオメータを装着したものを使用しているが、
本発明はこれに限るものではなく、地磁気センサを利用
し、それが傾くと出力値が変化する事を応用したもの等
傾斜量を検出できるものであれば何でもよい。
Furthermore, in this embodiment, a tilt detector with a potentiometer attached to the pivot shaft of the weight body is used.
The present invention is not limited to this, but any device that can detect the amount of inclination may be used, such as a geomagnetic sensor that changes its output value when the sensor is tilted.

さらに本実施例においては、トラクタに本発明装置を装
着した場合について述べたが、本発明装置は、田植機、
収穫機、芝刈機等の他の作業用車両にも適用可能である
ことは言うまでもない。
Furthermore, in this embodiment, the case where the device of the present invention is attached to a tractor has been described, but the device of the present invention can also be used for rice transplanters, rice transplanters, rice transplanters, etc.
Needless to say, the present invention can also be applied to other work vehicles such as harvesters and lawn mowers.

〔効果〕 − 以上詳述した如く本発明装置においては、教示走行時に
最大傾斜量の算出及び記憶を行ない、自動操同時に検出
された傾斜量と最大傾斜量とを比較して障害物等にトラ
クタが乗り上げ、前記傾斜量が最大傾斜量を超えると自
動操向を中断し、−定時間後退した後停止するので、転
倒等の危険を未然に防ぎ安全な作業環境を提供できる等
優れた効果を奏する。
[Effect] - As detailed above, in the device of the present invention, the maximum amount of inclination is calculated and stored during teaching driving, and the amount of inclination detected during automatic operation is compared with the maximum amount of inclination, so that the tractor does not approach obstacles, etc. If the machine runs over the top and the amount of inclination exceeds the maximum amount of inclination, the automatic steering will be interrupted and the machine will move backwards for a certain period of time and then stop, which has excellent effects such as preventing dangers such as falling and providing a safe working environment. play.

【図面の簡単な説明】[Brief explanation of the drawing]

図面は本発明の一実施例を示すものであり、第1図は本
発明装置を装備したトラクタの左側面図、第2図は傾斜
検出器の構成を示す模式的斜視図、第3図は方位検出器
の構成を示すブロック図、第4図は本発明装置の構成を
示すブロック図、第5図はトラクタの走行状態を示す圃
場の一部平面図、第6〜第11図は本発明装置の動作内
容を示すフローチャートである。 1・・・機体 2・・・前輪 3・・・後輪 7・・・
ロータリ8a、8b・・・方位検出器 9a、9b・・
・傾斜検出器IQ l 、 tor・・・境界検出器 
161 、16r・・・走行距離検出器 27・・・油
圧シリンダ 30・・・操向制御部50・・・シフトモ
ータ 特 許 出願人  ヤンマー農機株式会社代理人 弁理
士  河  野  登  夫篤 2 図 ′l!J7  図 第9図 第 8  図 *10  図 第 11  図
The drawings show one embodiment of the present invention, and FIG. 1 is a left side view of a tractor equipped with the device of the present invention, FIG. 2 is a schematic perspective view showing the configuration of an inclination detector, and FIG. FIG. 4 is a block diagram showing the configuration of the azimuth detector, FIG. 4 is a block diagram showing the configuration of the device of the present invention, FIG. 5 is a partial plan view of a field showing the running state of the tractor, and FIGS. 3 is a flowchart showing the operation details of the device. 1... Airframe 2... Front wheel 3... Rear wheel 7...
Rotary 8a, 8b... Orientation detector 9a, 9b...
・Inclination detector IQ l, tor...boundary detector
161, 16r... Mileage detector 27... Hydraulic cylinder 30... Steering control unit 50... Shift motor patent Applicant Yanmar Agricultural Machinery Co., Ltd. Agent Patent attorney Noboru Atsushi Kono 2 Figure' l! J7 Figure 9 Figure 8 *10 Figure 11

Claims (1)

【特許請求の範囲】 1、作業地内を予め教示された走路に沿って対地作業を
行なう作業用車両の自動操向装置において、 該作業用車両の進行方向及びそれと直交す る方向での傾斜量を検出する傾斜検出器と、前記教示中
に前記傾斜検出器にて検出した 前記作業用車両の最大傾斜量を算出し、記憶する最大傾
斜量記憶手段と、 自動操向にて対地作業をしつつ、前記傾斜 検出器にて傾斜量を検出し、該傾斜量と前記最大傾斜量
とを比較する比較手段と、 前記比較手段により、前記傾斜量が前記最 大傾斜量より大きいと判定したとき、所定の動作を行わ
せる手段と を具備することを特徴とする作業用車両の 自動操向装置。
[Scope of Claims] 1. In an automatic steering system for a work vehicle that performs ground work along a pre-taught course in a work area, the amount of inclination in the direction of travel of the work vehicle and in the direction perpendicular thereto is an inclination detector for detecting; a maximum inclination storage means for calculating and storing the maximum inclination of the work vehicle detected by the inclination detector during the teaching; , a comparison means for detecting an amount of inclination with the inclination detector and comparing the amount of inclination with the maximum amount of inclination; and when the comparison means determines that the amount of inclination is larger than the maximum amount of inclination, a predetermined amount of inclination is detected. 1. An automatic steering device for a work vehicle, comprising: means for causing the operation to take place.
JP62325979A 1987-12-22 1987-12-22 Automatic steering system for work vehicles Expired - Fee Related JP2599944B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP62325979A JP2599944B2 (en) 1987-12-22 1987-12-22 Automatic steering system for work vehicles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP62325979A JP2599944B2 (en) 1987-12-22 1987-12-22 Automatic steering system for work vehicles

Publications (2)

Publication Number Publication Date
JPH01166108A true JPH01166108A (en) 1989-06-30
JP2599944B2 JP2599944B2 (en) 1997-04-16

Family

ID=18182730

Family Applications (1)

Application Number Title Priority Date Filing Date
JP62325979A Expired - Fee Related JP2599944B2 (en) 1987-12-22 1987-12-22 Automatic steering system for work vehicles

Country Status (1)

Country Link
JP (1) JP2599944B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013074815A (en) * 2011-09-29 2013-04-25 Iseki & Co Ltd Working vehicle
JP2019062811A (en) * 2017-09-29 2019-04-25 井関農機株式会社 Work vehicle

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013074815A (en) * 2011-09-29 2013-04-25 Iseki & Co Ltd Working vehicle
JP2019062811A (en) * 2017-09-29 2019-04-25 井関農機株式会社 Work vehicle

Also Published As

Publication number Publication date
JP2599944B2 (en) 1997-04-16

Similar Documents

Publication Publication Date Title
US20070240928A1 (en) Compact construction vehicle with improved mobility
JPH0147967B2 (en)
JP2910244B2 (en) Unmanned traveling work vehicle
US11180122B2 (en) Safety device of working vehicle
JPH01166108A (en) Automatic steering device for working vehicle
JPH05116643A (en) Reach type fork lift
US5291964A (en) Apparatus for automatically centering a steerable wheel
JP2632332B2 (en) Automatic steering system for work vehicles
JPH0851808A (en) Agricultural working machine
JP3032407B2 (en) Self-driving vehicles
JP2525950Y2 (en) Work vehicle
JPS61253263A (en) Power steering device for work vehicle
JP2584747Y2 (en) Work vehicle steering mechanism
JP2599943B2 (en) Automatic steering system for work vehicles
JP2651579B2 (en) Automatic steering device for agricultural work vehicles
JPH0733973Y2 (en) Steering device for mobile agricultural machinery such as tractors
JP2784065B2 (en) Steering control device for traveling work machine
JPH11291931A (en) Steering control device of crawler type construction machine and control method thereof
JP2949786B2 (en) Powered vehicle steering system
JPH0730419Y2 (en) Rotating device for mobile agricultural machinery
JP2822578B2 (en) Four-wheel steering control device
JPH04271963A (en) Four-wheel steering device for power vehicle
JP3582694B2 (en) Traveling work vehicle
JPS59154911A (en) Automatic running working machine
JP2505356Y2 (en) Steering control device for work vehicle

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees