JP2599944B2 - Automatic steering system for work vehicles - Google Patents

Automatic steering system for work vehicles

Info

Publication number
JP2599944B2
JP2599944B2 JP62325979A JP32597987A JP2599944B2 JP 2599944 B2 JP2599944 B2 JP 2599944B2 JP 62325979 A JP62325979 A JP 62325979A JP 32597987 A JP32597987 A JP 32597987A JP 2599944 B2 JP2599944 B2 JP 2599944B2
Authority
JP
Japan
Prior art keywords
inclination
amount
automatic steering
detector
steering
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.)
Expired - Fee Related
Application number
JP62325979A
Other languages
Japanese (ja)
Other versions
JPH01166108A (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.)
Yanma Agricultural Equipment Co Ltd
Original Assignee
Yanma 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 Yanma Agricultural Equipment Co Ltd filed Critical Yanma 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)

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、作業地内を走行して種々の対地作業を行う
トラクタ、田植機、芝刈機等の作業用車両を所定の経路
に沿って走行せしめるべく自動操向する装置に関する。
DETAILED DESCRIPTION OF THE INVENTION [Industrial Application Field] The present invention travels a work vehicle such as a tractor, a rice transplanter, a lawn mower, or the like that performs various ground work by traveling in a work place along a predetermined route. The present invention relates to a device that automatically steers to make it work.

〔従来技術〕(Prior art)

従来作業地内を走行して種々の対地作業、例えばトラ
クタによる圃場内の耕うん及び砕土作業、芝刈機による
庭園の芝刈作業等に教示再生制御による自動操向装置を
装備した作業用車両が公知である。これらの車両は作業
地の一部、外周又は全走路を予め手動又は自動操向にて
走行することにより、教示を行ない、その教示情報に基
づき、作業地内の走行経路が設定され、その走行経路に
沿って、対地作業が自動操向装置により行われている。
BACKGROUND ART Conventionally, there is known a working vehicle equipped with an automatic steering device by teaching regeneration control in various ground work such as plowing and crushing work in a field by a tractor, lawn mowing work in a garden by a lawnmower, and the like, traveling in a work place. . These vehicles teach in advance by manually or automatically steering a part of the work place, the outer periphery, or the entire runway, and a travel route in the work place is set based on the teaching information. Along the route, ground work is performed by the automatic steering device.

〔発明が解決しようとする問題点〕 しかし前述のような自動操向装置において、作業用車
両が対地作業中に圃場の畦又は障害物に乗り上げ、操向
不能に陥り最悪の場合には前記作業用車両が転倒する虞
があった。
[Problems to be Solved by the Invention] However, in the automatic steering device as described above, in the worst case, when the work vehicle climbs on a ridge or an obstacle in a field during ground work and becomes unable to steer, and the worst case, There was a risk that the utility vehicle would fall.

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

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

本発明に係る作業用車両の自動操向装置は、作業地内
を予め教示された走路に沿って対地作業を行なう作業用
車両の自動操向装置において、該作業用車両の進行方向
及びそれと直交する方向での傾斜量を検出する傾斜検出
器と、前記教示中に前記傾斜検出器にて検出した前記作
業用車両の最大傾斜量を算出し、記憶する最大傾斜量記
憶手段と、自動操向にて対地作業をしつつ、前記傾斜検
出器にて傾斜量を検出し、該傾斜量と前記最大傾斜量と
を比較する比較手段と、前記比較手段により、前記傾斜
量が前記最大傾斜量より大きいと判定したとき、所定の
動作を行わせる手段とを具備することを特徴とする。
An automatic steering device for a working vehicle according to the present invention is an automatic steering device for a working vehicle that performs ground work along a runway taught in advance in a work place. 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 working vehicle detected by the tilt detector during the teaching, and for automatic steering. While performing ground work, the inclination amount is detected by the inclination detector, and the comparison unit compares the inclination amount with the maximum inclination amount. The comparison unit determines that the inclination amount is larger than the maximum inclination amount. Means for performing a predetermined operation when it is determined that

〔作用〕[Action]

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

〔実施例〕〔Example〕

以下本発明をその実施例を示す図面に基づいて詳述す
る。第1図は本発明に係る作業用車両の自動操向装置
(以下本発明装置という)を装備したトラクタの左側面
図である。
Hereinafter, the present invention will be described in detail with reference to the drawings showing the embodiments. 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 present device).

図において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 FIG. 1, reference numeral 1 denotes an airframe supported by a pair of left and right front wheels 2, 2 and rear wheels 3, 3. The direction of the front wheels 2, 2 is changed in accordance with the turning operation of the steering handle 4 by the driver sitting on the driver's seat 12 installed on the rear upper side of the body 1, and the direction of the front wheels 2, 2 is changed. The body 1 is steered accordingly, and when automatic steering is performed by the apparatus of the present invention, as will be described later, the steering hydraulic cylinder 27 (third cylinder) is used.
(See the figure.) The direction in which the pressure oil is supplied to the cylinder 27 is electrically switched to change the operation direction of the cylinder 27, so that the direction can also be changed. The rear wheels 3,3 are the fuselage 1
The power generated by the power unit 5 mounted on the front of the
The airframe 1 is rotated by being transmitted via the rear wheel 51, and the body 1 travels in a field, which is a work place, by the rotation of the rear wheels 3,3. Roller 7 as a working machine is attached to the body 1 so as to be able to move up and down in accordance with the vertical movement of a three-point link mechanism 6 attached to the rear part of the body 1, and power is transmitted from the power unit 5. When the vehicle is dropped into a field, the operation cultivates and crushes the field.

第2図は傾斜検出器の構成を示す模式的斜視図であ
り、運転席20の左側には、機体1の進行方向(又は進行
方向と直交する方向)、即ち機体1の前後(又は左右)
方向の傾斜量を検出する傾斜検出器9a(又は9b)が固設
してある。この傾斜検出器9a(又は9b)は、機体1の前
後(又は左右)方向に揺動自在として鉛直下方に垂下し
た錘体91の枢支軸92にポテンシオメータ90を装着したも
のであり、傾斜検出器9a,9bのケーシング93が機体1と
共に転倒した場合に、該ケーシング93に対して前記錘体
91が相対的に傾斜することを利用し、該錘体91の傾斜量
の変化に対応する前記ポテンシオメータ90の出力電圧の
変化として機体1の傾斜量を検出するようになってい
る。前記傾斜検出器9a(又は9b)の出力電位は、機体1
が水平状態にある場合に所定の基準地をとり、機体1が
前部(又は左側)を上として傾倒した場合に、前記基準
値より高くなる。
FIG. 2 is a schematic perspective view showing the configuration of the tilt detector. The left side of the driver's seat 20 is in the traveling direction of the body 1 (or a direction orthogonal to the traveling direction), that is, before and after (or left and right) of the body 1.
An inclination detector 9a (or 9b) for detecting the amount of inclination in the direction is fixed. The tilt detector 9a (or 9b) has a potentiometer 90 mounted on a pivot shaft 92 of a weight 91 vertically suspended so as to be swingable in the front-rear (or left-right) direction of the body 1. When the casing 93 of the detectors 9a and 9b falls with the body 1, the weight
The tilt amount of the body 1 is detected as a change in the output voltage of the potentiometer 90 corresponding to a change in the tilt amount of the weight body 91 by utilizing the relative tilt of the weight 91. The output potential of the tilt detector 9a (or 9b)
Is higher than the reference value when the aircraft 1 is tilted with the front part (or left side) facing upward when the vehicle is in a horizontal state.

第3図は方位検出器の構成を示すブロック図であり、
前記ロータリ7の上部中央には機体1の進行方向の方位
を検出するための方位検出器8が固着されている。この
方位検出器8としては、トロイダルコア80を外側から囲
う態様にて互いに直交する一対の検出巻線81,82を巻装
してなる地磁気センサを用い、トロイダルコア80を、発
振器により発振される所定の周波数にて交流励磁すると
共に、検出巻線81,82に基準電圧を印加した場合に、前
記検出巻線81,82に誘起される電圧は、地磁気の方向が
夫々に直交する場合に最大となることを利用し、センサ
技術第5巻4号(1985年4月号)に掲載されているよう
な回路を構成したものである。検出巻線81,82の出力電
圧の周波数成分は、トロイダルコア80の励磁電流の周波
数の2倍であるから、夫々の出力電圧は、前記発振器に
より発振される2倍の周波数を基準として同期検波さ
れ、各別の積分回路及びアンプを経て出力として取出さ
れるようにしてある。このように取出された検出巻線8
1,82の出力電圧は、後述する操向制御部30に与えられて
おり、操向制御部30は、これらの両出力の比の逆正接に
より、地磁気の方位を絶対的な基準として、方位検出器
8の設置方向、換言すれば機体1の進行方向を算出す
る。
FIG. 3 is a block diagram showing a configuration of the direction detector.
An azimuth detector 8 for detecting the azimuth of the body 1 in the traveling direction is fixed to the upper center of the rotary 7. As the azimuth detector 8, a geomagnetic sensor 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 is used, and the toroidal core 80 is oscillated by an oscillator. When AC excitation is performed at a predetermined frequency and a reference voltage is applied to the detection windings 81 and 82, the voltage induced in the detection windings 81 and 82 is maximum when the directions of the geomagnetism are orthogonal to each other. The circuit described in Sensor Technology, Vol. 5, No. 4 (April, 1985) is constructed by utilizing the following. Since the frequency components of the output voltages of the detection windings 81 and 82 are twice the frequency of the exciting current of the toroidal core 80, each output voltage is synchronously detected with reference to twice the frequency oscillated by the oscillator. And output as an output through a separate integrating circuit and amplifier. The detection winding 8 thus taken out
The output voltage of 1,82 is given to a steering control unit 30 described later, and the steering control unit 30 uses the arc tangent of the ratio of these two outputs to set the azimuth of the geomagnetism as an absolute reference. The installation direction of the detector 8, in other words, the traveling direction of the aircraft 1 is calculated.

前記動力部5を覆うボンネットの左右側面の上前部に
は、夫々境界検出器10l,10rが取付けられている。境界
検出器10l,10rはともにその検知域を機体1の前端部よ
りやや前方として、しかも左右の検知域間の距離を、機
体1の後部に取付けたロータリ7等の作業機の幅に応じ
て変更できるように取付けられている。
Boundary detectors 10l and 10r are attached to the upper front portions of the left and right side surfaces of the hood covering the power unit 5, respectively. Both of the boundary detectors 10l and 10r have their detection areas slightly ahead of the front end of the body 1 and the distance between the left and right detection areas according to the width of a working machine such as a rotary 7 attached to the rear of the body 1. Installed so that it can be changed.

前記境界検出器10l,10rは発光素子及び受光素子を内
蔵しており、前者から発せられた光を被検物に投射し、
該被検物からの反射光を後者にて捉え、その受光量に応
じた電圧信号を出力するものである。
The boundary detectors 10l and 10r incorporate a light-emitting element and a light-receiving element, and project light emitted from the former onto a test object,
The reflected light from the test object is captured by the latter, and a voltage signal corresponding to the amount of received light is output.

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

図において20は、その長手方向を左右方向として機体
1の下部に固着されたフロントアクスルであり、該フロ
ントアクスル20の左右両端部には、左右の前輪2,2を夫
々軸支するナックルアーム22,22が、各別のキングピン2
1,21回りに水平面内での回動自在に枢支してある。ナッ
クルアーム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 a lower portion of the body 1 with its longitudinal direction being the left-right direction. Knuckle arms 22 respectively supporting left and right front wheels 2, 2 are provided at both left and right ends of the front axle 20. , 22 each with a separate kingpin 2
It is pivotally supported around 1,21 so that it can rotate freely in the horizontal plane. The knuckle arms 22 and 22 have respective front ends at the front of a rotating plate 24 that rotates in a horizontal plane around a pivot 23 erected on the upper part of the front axle 20 via separate link members 25 and 25. The steering hydraulic cylinder 27 is attached by locking the distal end of the piston rod to the distal end of an arm 26 projecting leftward in the middle of the rotary plate 24. ing.
Accordingly, when the hydraulic cylinder 27 performs the advance operation (or the retreat operation), the rotation plate 24 rotates clockwise (or counterclockwise) in FIG. The front wheels 2, 2 are transmitted to the left and right knuckle arms 22, 22 via 25, 25, and are steered right (or left) together with the respective knuckle arms 22, 22.

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

さらに左右の前記ナックルアーム22,22の位置には、
リードスイッチを用いた走行距離検出器16l,16rが設け
てあり、前輪2,2に取付けた磁性体を感知することによ
り、前輪2,2の回転数を検出し、検出された左右の回転
数を平均し、それにより走行距離を算出する。
Furthermore, at the positions of the knuckle arms 22, 22 on the left and right,
Travel distance detectors 16l and 16r using reed switches are provided, and by detecting the magnetic material attached to the front wheels 2, 2, the rotation speed of the front wheels 2, 2 is detected, and the detected left and right rotation speeds are detected. Are averaged, thereby calculating the mileage.

油圧シリンダ27へは、油圧ポンプ29が発生する圧油
が、4ポート3位置切換式の電磁方向切換弁Vを介して
供給されており、電磁方向切換弁VのソレノイドSlが励
磁されている場合、油圧ポンプ27からの圧油は、油圧シ
リンダ27の退入側油室に送給され、前述の如き舵取機構
の動作によって前輪2,2は左に操向され、逆に電磁方向
切換弁VのソレノイドSrが励磁されている場合、前輪2,
2は右に操向される。更に、ソレノイドSl及びソレノイ
ドSrが共に消磁されており、電磁方向切換弁Vがその中
立位置にある場合、前輪2,2は現状の舵取角度に保たれ
る。
When the hydraulic oil generated by the hydraulic pump 29 is supplied to the hydraulic cylinder 27 via a four-port, three-position switching type electromagnetic directional control valve V, and the solenoid Sl of the electromagnetic directional switching valve V is excited The hydraulic oil from the hydraulic pump 27 is supplied to the retreat-side oil chamber 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. When the V solenoid Sr is excited, the front wheels 2,
2 is steered to the right. Further, when the solenoid Sl and the solenoid Sr are both demagnetized and the electromagnetic directional control valve V is at its neutral position, the front wheels 2, 2 are maintained 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 body 1 is performed by the transmission 51,
The transmission 51 is provided with a transmission lever 52 disposed on the front right side of the driver's seat.
The speed is changed by Also, at the proximal pivot of the transmission lever 52,
A shift motor 50, which is lever driving means for rotating the lever 52, is mounted coaxially with a pivot shaft of the shift lever 52, and the transmission 51 is rotated by the shift motor 50 or manual rotation of the shift lever 52. The forward and backward movement is made.

また、30は前記方位検出器8、前記傾斜検出器9a,9
b、前記走行距離検出器16l,16r及び境界検出器10l,10r
の検出結果に基づいて後述の如く動作し、電磁方向制御
弁VのソレノイドSl又はソレノイドSrの励磁を行うこと
により機体1を操向せしめる操向制御部である。
Reference numeral 30 denotes the azimuth detector 8, the inclination detectors 9a, 9
b, the traveling distance detectors 16l, 16r and the boundary detectors 10l, 10r
This is a steering control unit that operates as described later based on the detection result of, and steers the aircraft 1 by exciting the solenoid Sl or the solenoid Sr of the electromagnetic direction control valve V.

該操向制御部30は、エンジンを始動せしめるためのキ
ースイッチ31を介して電源に接続されており、エンジン
が駆動状態にある場合にのみ動作可能となっている。
The steering control unit 30 is connected to a power supply 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が接続されており、該ス
イッチ32のオンに応じて入力ポートa1がハイレベルに転
じるようになっている。
The input port a 1 of the steering control unit 30, and an automatic switch 32 for turning on is connected when the driver seated in the driver's seat 12 for commanding the operation start to the steering control unit 30, the switch input ports a 1 in accordance with the 32-on is adapted to turn on a high level.

また操向制御部30の入力ポートa2及び入力ポートa3
は、運転席12に着座した運転者により操向可能な位置に
配された走行状態選択レバ9の基端部に、該レバ9の係
止位置に応じてオンするように配設されたマイクロスイ
ッチを用いてなる教示走行スイッチ33及び自動操向スイ
ッチ34が夫々接続されており、前記自動スイッチ32及び
教示走行スイッチ33が共にオンされている場合に入力ポ
ートa2がハイレベルに転じ、また自動スイッチ32及び自
動操向スイッチ34がオンされている場合に入力ポートa3
がハイレベルに転じるようになっている。前記走行状態
選択レバ9は、前記教示走行スイッチ33がオンされる係
止位置、前記自動操向スイッチ34がオンされる係止位
置、及び両スイッチが共にオフ状態となる回向動作の係
止位置の3通りの係止位置を有しており、運転席12に着
座した運転者は、該レバ9を回動操作し、その係止位置
を変更せしめることにより、操向制御部30の後述する3
通りの動作内容の選択が可能である。
Also the input port a 2 and input port a 3 of the steering control unit 30, the base end portion of the traveling state selection lever 9 arranged on the steerable position by the driver sitting in the driver's seat 12, the lever A teaching travel switch 33 and an automatic steering switch 34 using micro switches arranged to be turned on in accordance with the locking position of No. 9 are connected respectively, and both the automatic switch 32 and the teaching travel switch 33 are connected. When the input port a 2 is turned on, the input port a 2 turns to a high level, and when the automatic switch 32 and the automatic steering switch 34 are turned on, the input port a 3
Turns to a high level. The traveling state selection lever 9 includes a locking position where the teaching travel switch 33 is turned on, a locking position where the automatic steering switch 34 is turned on, and locking of a reversing operation in which both switches are turned off. The driver has three locking positions, and the driver seated on the driver's seat 12 rotates the lever 9 to change the locking position, so that the steering control unit 30 will be described later. Do 3
The following operation contents can be selected.

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

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

バッファアンプ44,45の出力は差動アンプ43の入力と
してあり、該差動アンプ43の出力は差動アンプ42の1入
力としてある。誤差動アンプ42の他の入力端子には前記
操向角検出器15の出力が極性反転器40を介して与えられ
ており、差動アンプ42の出力は極性反転器60を介して前
記操向制御部30の入力ポート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 one input of the differential amplifier 42. The output of the steering angle detector 15 is provided to another input terminal of the error amplifier 42 via a polarity inverter 40, and the output of the differential amplifier 42 is supplied to the input terminal of the error amplifier 42 via a polarity inverter 60. is input to the input port a 4 of the control unit 30.

前記制御部30に入力された差動アンプ42の出力信号E
を比較基準値E1(正),E2(負)と夫々比較し、E>E1
のとき電磁方向切換弁VのソレノイドSrを励磁すべく出
力ポートb1がハイレベルに転じ、またE<E2のときソレ
ノイドSlを励磁すべく出力ポートb2をハイレベルに転
じ、さらにE2<E<E1のときは出力ポートb1,b2共にロ
ーレベルである。
The output signal E of the differential amplifier 42 input to the control unit 30
Is compared with the comparison reference values E 1 (positive) and E 2 (negative), respectively, and E> E 1
Turning output ports b 1 so as to energize the solenoid Sr electromagnetic directional switching valve V is in the high level, and turns to the high level the output port b 2 so as to energize the solenoid Sl when E <E 2, further E 2 when <when E <of E 1 is an output port b 1, b 2 are both low level.

而してE>E1のとき前輪2,2は右に操向され、E<E2
のときは左に操向され、E2<E<E1のときは操向されな
い。
Front wheels 2,2 when Thus to E> E 1 is steered to the right, E <E 2
When the is steered to the left, it is not steered in E 2 <E <When E 1.

また前記極性反転器40,41は切換スイッチ11l,11rが境
界検出器10lからの出力をポテンシオメータ46に与える
側に切換えている場合に作動して、入力信号の極性を反
転し、逆に境界検出器10lからの出力をバッファアンプ4
4に与える側に切換えられている場合には作動せず、入
力信号をそのまま通過させる構成としてある。
The polarity inverters 40 and 41 operate when the changeover switches 11l and 11r are switched to the side that supplies the output from the boundary detector 10l to the potentiometer 46, and invert the polarity of the input signal, and conversely, Buffer amplifier 4
In the case where the input signal is switched to the input side, the input signal does not operate and the input signal is passed as it is.

そして入力ポートa5には前記走行距離検出器16l,16r
からのパルス信号が入力され、前記操向制御部30にて一
定時間内の左右夫々の回転数を検出し、その平均回転数
Paを求め、それにより走行距離が算出される。
Then, the input port a 5 the running distance detector 16l, 16r
The steering control unit 30 detects the left and right rotation speeds within a predetermined time, and calculates the average rotation speed.
Pa is obtained, and the mileage is calculated based on Pa.

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

更に入力ポートa8,a9にはポテンシオメータを用いて
なる傾斜検出器9a,9bの各々の出力電圧が与えられてい
る。
Further comprising using a potentiometer to the input port a 8, a 9 tilt detector 9a, are given respective output voltages of 9b.

そして入力ポートa4,a8及びa9に入力された信号によ
り後述するところの既作業域と未作業域との境界に倣う
自動操向制御が行われ、入力ポートa5,a6,a7,a8及びa9
の入力信号により教示及びその記憶に基づく自動操向制
御が行われる。
Then, according to signals input to the input ports a 4 , a 8 and a 9 , automatic steering control is performed according to a boundary between an already-worked area and an un-worked area, which will be described later, and the input ports a 5 , a 6 , a 7, a 8 and a 9
, An automatic steering control based on the teaching and the storage thereof is performed.

一方操向制御部30の出力ポートb1及び同b2は、図示し
ない各別の励磁回路を介して、前記電磁方向切換弁Vの
ソレノイドSr及びソレノイドSlに夫々接続されており、
出力ポートb1(又は出力ポートb2)のハイレベル出力に
応じてソレノイドSr(又はソレノイドSl)が励磁され、
油圧シリンダ27が進出(又は退入)動作するようになし
てあり、舵取機構の前述の動作により前輪2,2が右方向
(又は左方向)に舵取りされる。
On the other hand, the output ports b 1 and b 2 of the steering control unit 30 are respectively connected to the solenoid Sr and the solenoid Sl of the electromagnetic directional control valve V via separate excitation circuits (not shown),
Solenoid Sr (or solenoid Sl) is excited according to the high level output of output port b 1 (or output port b2),
The hydraulic cylinder 27 is configured to advance (or retreat), and the front wheels 2, 2 are steered rightward (or leftward) by the above-described operation of the steering mechanism.

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

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

第5図はトラクタの走行状態を示す圃場の一部平面図
であり、第6図は操向制御の開始時のフローチャートで
ある。
FIG. 5 is a partial plan view of the 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の動作による自動操向を開始させる。
In the automatic steering according to the present invention, first, as shown in FIG. 5, the driver operates the steering wheel 4 to move the aircraft 1 along the one side in the field while working with the rotary 7. In one stroke, teaching travel is performed in which the steering control unit 30 stores the traveling direction and travel distance of the machine body 1 during this work as a teaching travel route. Next, turn around and work area CTD
The tractor is automatically steered following the boundary INT of the unworked area UCT. When performing the automatic steering based on the following, when the boundary INT cannot be detected, the body 1 compares the azimuth data stored by the teaching traveling with the azimuth data of the azimuth detector 8, and Until the boundary can be detected, the vehicle is automatically steered based on the azimuth data stored by the teaching travel. When performing this automatic steering, the driver first turns on the automatic switch 32 and operates the automatic switch 32. Control unit 30
Command to start the operation, and then rotate the traveling state selection lever 9 to lock it at a locking position for selecting the teaching traveling. When the teaching traveling switch 33 is turned on, the teaching Make a run. After the completion of the teaching traveling, the driver rotates the traveling state selection lever 9 and locks the driving state selection lever 9 at a locking position where the automatic steering switch 34 is turned on.
Automatic steering by the operation of the steering control unit 30 is started.

操向制御部30は、キースイッチ31がオンされ電源に接
続された場合、第6図のフローチャートに示すように、
まずその入力ポートa1のレベルにより前記自動スイッチ
32のオンオフ状態を調べる。そして自動スイッチ32がオ
フされており、入力ポートa1がローレベルである場合、
操向制御部30は、そのメモリ,レジスタ及び全てのフラ
グ等をリセットし、自動スイッチ32がオンされるまで待
機し、また自動スイッチ32がオンされており、入力ポー
トa1がハイレベルである場合、次に入力ポートa2及び入
力ポートa3のレベルにより前記教示走行スイッチ33及び
自動操向スイッチ34のオンオフ状態を調べ、教示走行ス
イッチ33がオンされており、入力ポートa2がハイレベル
であるときには、後述の教示走行サブルーチンに従っ
て、また自動操向スイッチ34がオンされており、入力ポ
ートa3がハイレベルであるときには、後述の自動操向サ
ブルーチンに従って、更に教示走行スイッチ33及び自動
操向スイッチ34が共にオフ状態にある場合には、後述す
る回向サブルーチンに従って夫々動作する。前述した如
く、自動操向スイッチ34と教示走行スイッチ33とは、一
本の走行状態選択レバ9の異なる係止位置において夫々
オンされるように配設されているから、これらが共にオ
ンされることはなく、運転者は、前記自動スイッチ32の
オンオフ操作及び走行状態選択レバ9の回動操作によ
り、操向制御部30に、回向サブルーチン、教示走行サブ
ルーチン及び自動操向サブルーチンに夫々従う動作を指
令することができる。
When the key switch 31 is turned on and connected to the power source, the steering control unit 30 performs, as shown in the flowchart of FIG.
First the automatic switch by its input ports a 1 level
Check the on / off status of 32. And has an automatic switch 32 is turned off, when the input port a 1 is at low level,
Steering control unit 30 resets its memory, registers and all flags, waits until the automatic switch 32 is turned on, also has an automatic switch 32 is turned on, the input port a 1 is a high level If, by then the input port a 2 and input port a 3 levels examined off states of the teaching travel switch 33 and the automatic steering switch 34, the teaching travel switch 33 is turned on, the input port a 2 is a high level when it is, according to the teachings running subroutine will be described later, also has an automatic steering switch 34 is turned on, when the input port a 3 is a high level, according to the automatic steering subroutine will be described later, further teaches the travel switch 33 and the automatic steering When both the direction switches 34 are in the OFF state, they operate in accordance with the direction subroutine described later. As described above, the automatic steering switch 34 and the teaching travel switch 33 are disposed so as to be turned on at different locking positions of the single traveling state selection lever 9, so that they are both turned on. The driver turns the automatic switch 32 on and off and turns the running state selection lever 9 to turn the steering control unit 30 to follow the turning subroutine, the teaching driving subroutine, and the automatic steering subroutine. Can be ordered.

前述の教示走行は、第5図に示す圃場の左端1行程の
み即ち○印で示す基点から上方へ向かって走行し、上辺
にて回向するまでの間行われて終了する。
The above-mentioned teaching traveling is performed only from the base point indicated by the circle in the upper left part of the field shown in FIG.

第7図はこのような教示走行のフローチャートを示
し、第8図は方位検出サブルーチンのフローチャートを
示し、第9図は距離算出サブルーチン、第10図は最大傾
斜量算出記憶サブルーチンのフローチャートを示してい
る。
FIG. 7 shows a flowchart of such teaching traveling, FIG. 8 shows a flowchart of an azimuth detecting subroutine, FIG. 9 shows a flowchart of a distance calculating subroutine, and FIG. 10 shows a flowchart of a maximum tilt amount calculating subroutine. .

前述の条件が満足され、教示走行サブルーチンに移行
した場合、操向制御部30は機体1の前後及び左右方向の
最大傾斜量CaMAX,CbMAXの算出と一定距離La毎の方位検
出とを行い、それぞれを記憶装置に書き込む。
Above conditions are satisfied, when a transition is made to the teaching running subroutine, steering control unit 30 is the maximum slope of the front and rear of the machine body 1 and the left-right direction Ca MAX, and a predetermined distance L a per azimuth detection and calculation of the Cb MAX And write them to the storage device.

また方位検出サブルーチンでは方位検出器8の方位デ
ータが所定回数読み込まれ、その平均により一定距離の
方位Siを決定する。距離算出サブルーチンでは左右夫々
の距離検出器16l,16rより出力された回転数Pl,Prを一定
時間T2計数し、左右の回転数Pl,Prの平均回転数Paを算
出し、1回転当りの距離lと平均回転数Paと一定時間T2
とから速度Viを求め(Vi=Pa×l/T2)、この速度を時間
で積分して走行距離Lを求める。求めたLを基点からの
距離Lsに加え、各地点の基点からの距離を求める。
The azimuth data of the azimuth detector 8 is read a predetermined number of times is the azimuth detection subroutine determines the orientation S i of a certain distance by the average. Distance calculation subroutine respective right and left distance detector 16l, rotational speed Pl output from 16r, a certain time T 2 counted Pr, left and right rotational speed Pl, calculates the average rotational speed Pa of Pr, per rotation Distance l, average rotation speed Pa and fixed time T 2
Obtain a speed V i and a (V i = Pa × l / T 2), determine the traveling distance L by integrating the speed at the time. The L calculated in addition to the distance L s from the base point to determine the distance from the base point of each point.

次に求められた距離Lsと方位Siとを記憶装置に書き込
み記憶する。これは機体1を運転者が回向位置に走行状
態選択レバ9を係止するまで一定距離La毎に行われる。
Write store next distance obtained L s and the orientation S i in the storage device. This is done every predetermined distance L a to the machine body 1 by the driver to lock the running state selection lever 9 to EKO position.

第11図は自動操向制御を示すフローチャートである
が、最初の回向が終わり教示走行が終了すると、運転者
は走行状態選択レバ9の回動操作により該レバ9を自動
操向スイッチ34をオンできる係止位置にする。次いで操
向制御部30は前後方向の傾斜量Caと左右方向の傾斜量Cb
とを夫々検出し、それと教示走行にて記憶された夫々の
方向の最大傾斜量CaMAX,CbMAXとを比較し、前記傾斜量C
a,Cbのいずれかが前記最大傾斜量CaMAX,CbMAXを超える
と操向制御部30は自動操向を中断し、出力ポートb1にハ
イレベル出力がなされシフトモータ50の正転により変速
レバ52が前進から後退にシフトされ、機体1は傾斜方向
と逆方向に後退し、一定時間経過後、動力部5は停止
し、トラクタは停止する。
FIG. 11 is a flowchart showing the automatic steering control. When the first turning is completed and the teaching traveling is completed, the driver turns the automatic steering switch 34 by turning the traveling state selecting lever 9 by turning the lever. Set to a lock position that can be turned on Next, the steering control unit 30 calculates the inclination amount Ca in the front-rear direction and the inclination amount Cb in
Are compared with the maximum inclination amounts Ca MAX and Cb MAX in the respective directions stored in the teaching travel, and the inclination amount C
a shift, either Cb is the maximum inclination amount Ca MAX, steering control unit 30 exceeds Cb MAX interrupts the automatic steering, the forward rotation of the shift motor 50 the high level output is performed to the output port b 1 The lever 52 is shifted from the forward to the reverse, the body 1 retreats in the direction opposite to the tilt direction, and after a certain period of time, the power unit 5 stops and the tractor stops.

このようにして自動操向時に畦等の障害物に乗り上
げ、教示時の最大傾斜量CaMAX,CbMAXを超えると機体1
は所定の動作により転倒等の危険を未然に防止する。
In this way, when the vehicle climbs over an obstacle such as a ridge during automatic steering and exceeds the maximum inclination amount Ca MAX , Cb MAX during teaching, the aircraft 1
Prevents the danger of falling over by a predetermined operation.

また前記傾斜量Ca,Cbのいずれもが前記最大傾斜量Ca
MAX,CbMAXを超えないときは、境界検出器10l,10rにより
境界INTを検出し、それに倣って自動操向する。例えば
第5図上から下に境界INTに倣って操向される場合即ち
機体1の右側に既作業域CTDが存在する場合、第4図に
示す切換スイッチ11l,11rは第4図と逆にスイッチング
され右側の境界検出器10rの出力がバッファアンプ44の
入力となる側に切換えられる。
Further, both of the inclination amounts Ca and Cb are equal to the maximum inclination amount Ca.
MAX, when not exceeding Cb MAX, the boundary detector 10l, and detects a boundary INT by 10r, automatically steering so as to follow it. For example, when the vehicle is steered following the boundary INT from top to bottom in FIG. 5, that is, when the work area CTD exists on the right side of the body 1, the changeover switches 11l and 11r shown in FIG. Switching is performed, and the output of the right boundary detector 10r is switched to the input side of the buffer amplifier 44.

今、境界検出器10l,10rの出力をA,Bとし、バッファア
ンプ44,45のゲインをkとすると、差動アンプ43への出
力は1/2kAとkBとなり、差動アンプ43のゲインをk′と
し、k・k′=Kとすると、差動アンプ43の出力Cは下
記の如くなる。
Now, assuming that the outputs of the boundary detectors 10l and 10r are A and B and the gains of the buffer amplifiers 44 and 45 are k, the output to the differential amplifier 43 is 1/2 kA and kB, and the gain of the differential amplifier 43 is Assuming that k ′ and k · k ′ = K, the output C of the differential amplifier 43 is as follows.

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

既作業域CTDで表面の凹凸が激しく、表面に投射され
た光は散乱するので、既作業域CTDを検知域とする境界
検出器の出力はほぼ0となる。それ故、第1の場合はB
=0、第2の場合はA=Bとなり、第3の場合はBは0
〜Aの間の値となる。特に境界検出器10rが境界INTの上
部に位置しており、その検知域に未作業域UCTと既作業
域CTDとを半分ずつ含むときにはB=1/2Aとなる。即
ち、差動アンプ16の出力信号Cはこれが0である場合に
は境界INTに倣って走行していることを示しており、正
である場合には、機体1の前部が第5図における右寄
り、即ち未作業域UTD側に寄った状態であることを示し
ており、負である場合には、機体1の前部が第5図にお
ける左寄り即ち既作業域CTD側へ寄った状態であること
を示している。
Since the surface of the already-worked area CTD has severe irregularities and the light projected on the surface is scattered, the output of the boundary detector having the already-worked area CTD as a detection area is almost zero. Therefore, in the first case B
= 0, A = B in the second case, and B = 0 in the third case
AA. In particular, when the boundary detector 10r is located above the boundary INT and its detection area includes half of the unworked area UCT and half of the already-worked area CTD, B = 1 / 2A. 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, and when the output signal C is positive, the front part of the body 1 in FIG. This indicates that the front of the body 1 is shifted to the left, that is, to the already-worked area CTD side in FIG. It is shown that.

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

またこのとき境界INTが検出不能となり、境界INTに倣
う自動操向が不能になると、前述してある教示走行にて
記憶された方位データSMiが読み込まれ、その中の基点
から同じ距離の記憶方位データSMiと検出方位データSi
が比較され、その結果により操向制御部30の出力ポート
b1もしくはb2のどちらかがハイレベル出力されるか、又
はどちらも出力されず機体1を右進、左進又はそのまま
操向する。
Also, at this time, if the boundary INT becomes undetectable and automatic steering following the boundary INT becomes impossible, the azimuth data S Mi stored in the teaching travel described above is read, and the same distance from the base point in the direction data is stored. Direction data S Mi and detected direction data S i
Are compared, and the output port of the steering control unit 30 is
or either b 1 or b 2 is a high level output, or both MigiSusumu the body 1 without being output, forehand or directly steering.

なお自動操向が教示走行の走行方向と逆のとき即ち第
5図で上から下へ自動操向されるときは、記憶された方
位データSMiは反対から読み込まれるべくなしてある。
When the automatic steering is opposite to the traveling direction of the teaching travel, that is, when the vehicle is automatically steered from top to bottom in FIG. 5, the stored azimuth data S Mi is read from the opposite direction.

これらにより境界INTに倣って自動操向された作業用
車両がその途中で境界INTの検出をできなくなっても、
自動操向が中断されず教示された第1行程の方位に倣っ
て走行されることになる。
Due to these, even if the work vehicle automatically steered according to the boundary INT can not detect the boundary INT in the middle,
The automatic steering is not interrupted, and the vehicle follows the azimuth of the first travel taught.

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

なお本実施例においては、進行方向を検出する方位検
出器として、トロイダルコアを利用してなる地磁気セン
サを用いたが、地磁気に感応して回動する磁針の回動域
に例えばフォトインタラプタ、リードスイッチ等を多数
配設し、これらにより前記磁針の回動位置を検出して、
地磁気の方位に対する機体1の進行方向を特定する方位
検出器を用いてもよい。
In the present embodiment, a geomagnetic sensor using a toroidal core is used as the direction detector for detecting the traveling direction. However, for example, a photo interrupter, a lead, etc. A large number of switches and the like are arranged, and the rotational position of the magnetic needle is detected by these,
An azimuth detector for specifying the traveling direction of the airframe 1 with respect to the azimuth of geomagnetism may be used.

また傾斜検出器として本実施例においては錘体の枢支
軸にポテンシオメータを装着したものを使用している
が、本発明はこれに限るものではなく、地磁気センサを
利用し、それが傾くと出力値が変化する事を応用したも
の等傾斜量を検出できるものであれば何でもよい。
Further, in the present embodiment, a tilt detector having a potentiometer mounted on a pivot shaft of a weight body is used as the tilt detector.However, the present invention is not limited to this. Any device can be used as long as the amount of inclination can be detected, for example, by applying a change in the output value.

さらに本実施例においては、トラクタに本発明装置を
装着した場合について述べたが、本発明装置は、田植
機,収穫機,芝刈機等の他の作業用車両にも適用可能で
あることは言うまでもない。
Further, in the present embodiment, the case where the present invention device is mounted on the tractor has been described. However, it goes without saying that the present invention device can be applied to other work vehicles such as rice transplanters, harvesters, lawnmowers and the like. No.

〔効果〕〔effect〕

以上詳述した如く本発明装置においては、教示走行時
に最大傾斜量の算出及び記憶を行ない、自動操向時に検
出された傾斜量と最大傾斜量とを比較して障害物等にト
ラクタが乗り上げ、前記傾斜量が最大傾斜量を超えると
自動操向を中断し、一定時間後退した後停止するので、
転倒等の危険を未然に防ぎ安全な作業環境を提供できる
等優れた効果を奏する。
As described in detail above, in the apparatus of the present invention, the maximum inclination amount is calculated and stored during teaching traveling, and the tractor rides on an obstacle or the like by comparing the inclination amount detected during automatic steering with the maximum inclination amount, When the inclination amount exceeds the maximum inclination amount, the automatic steering is interrupted and stopped after retreating for a predetermined time,
It has excellent effects such as preventing a danger such as falling down and providing a safe working environment.

【図面の簡単な説明】 図面は本発明の一実施例を示すものであり、第1図は本
発明装置を装備したトラクタの左側面図、第2図は傾斜
検出器の構成を示す模式的斜視図、第3図は方位検出器
の構成を示すブロック図、第4図は本発明装置の構成を
示すブロック図、第5図はトラクタの走行状態を示す圃
場の一部平面図、第6〜第11図は本発明装置の動作内容
を示すフローチャートである。 1……機体、2……前輪、3……後輪、7……ロータ
リ、8a,8b……方位検出器、9a,9b……傾斜検出器、10l,
10r……境界検出器、16l,16r……走行距離検出器、27…
…油圧シリンダ、30……操向制御部、50……シフトモー
BRIEF DESCRIPTION OF THE DRAWINGS FIG. 1 shows an embodiment of the present invention. FIG. 1 is a left side view of a tractor equipped with the device of the present invention, and FIG. 2 is a schematic diagram showing a configuration of a tilt detector. FIG. 3 is a block diagram showing a configuration of the azimuth detector, FIG. 4 is a block diagram showing a configuration of the device of the present invention, FIG. 5 is a partial plan view of a field showing a running state of the tractor, FIG. FIG. 11 to FIG. 11 are flowcharts showing the operation contents of the device of the present invention. 1 ... body, 2 ... front wheel, 3 ... rear wheel, 7 ... rotary, 8a, 8b ... direction detector, 9a, 9b ... tilt detector, 10l,
10r …… Boundary detector, 16l, 16r …… Driving distance detector, 27…
... Hydraulic cylinder, 30 ... Steering control unit, 50 ... Shift motor

Claims (1)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】作業地内を予め教示された走路に沿って対
地作業を行なう作業用車両の自動操向装置において、 該作業用車両の進行方向及びそれと直交する方向での傾
斜量を検出する傾斜検出器と、 前記教示中に前記傾斜検出器にて検出した前記作業用車
両の最大傾斜量を算出し、記憶する最大傾斜量記憶手段
と、 自動操向にて対地作業をしつつ、前記傾斜検出器にて傾
斜量を検出し、該傾斜量と前記最大傾斜量とを比較する
比較手段と、 前記比較手段により、前記傾斜量が前記最大傾斜量より
大きいと判定したとき、所定の動作を行わせる手段と を具備することを特徴とする作業用車両の自動操向装
置。
1. An automatic steering apparatus for a working vehicle that performs ground work along a runway taught in advance in a working place, wherein a slope detecting a traveling direction of the working vehicle and a tilt amount in a direction orthogonal to the traveling direction. A maximum inclination amount storage means for calculating and storing a maximum inclination amount of the working vehicle detected by the inclination detector during the teaching, and A comparing unit that detects the amount of inclination with a detector and compares the amount of inclination with the maximum amount of inclination. When the comparing unit determines that the amount of inclination is greater than the maximum amount of inclination, a predetermined operation is performed. An automatic steering device for a working vehicle, comprising:
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 JPH01166108A (en) 1989-06-30
JP2599944B2 true 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)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5891686B2 (en) * 2011-09-29 2016-03-23 井関農機株式会社 Work vehicle
JP6879156B2 (en) * 2017-09-29 2021-06-02 井関農機株式会社 Work vehicle

Also Published As

Publication number Publication date
JPH01166108A (en) 1989-06-30

Similar Documents

Publication Publication Date Title
US7191865B2 (en) Off road vehicle
CA2164153C (en) Steering system for working vehicle and the method thereof
JP2599944B2 (en) Automatic steering system for work vehicles
WO2005101945A2 (en) Off road vehicle steering systems
JP2632332B2 (en) Automatic steering system for work vehicles
JPH05284804A (en) Mechanism for steering agricultural working machine
JP2956012B1 (en) Self-driving articulated vehicle
JPH0851808A (en) Agricultural working machine
JP3055184B2 (en) Powered vehicle four-wheel steering system
JP2599943B2 (en) Automatic steering system for work vehicles
JPS61253263A (en) Power steering device for work vehicle
JPH0891238A (en) Control method for rear wheel steering device
JP2525950Y2 (en) Work vehicle
JP2505356Y2 (en) Steering control device for work vehicle
JP2805676B2 (en) Self-propelled vehicle steering method and steering device
JPH0813652B2 (en) Four-wheel steering system
JP2651579B2 (en) Automatic steering device for agricultural work vehicles
JPH078653B2 (en) 4-wheel steering system for vehicles
JP2854482B2 (en) Automatic steering structure of work vehicle
JP2822578B2 (en) Four-wheel steering control device
JPH075023Y2 (en) Steering control device for mobile agricultural machinery
JPH0522015Y2 (en)
JPH0730419Y2 (en) Rotating device for mobile agricultural machinery
JP2949786B2 (en) Powered vehicle steering system
JP2667572B2 (en) Steering control device for automatic traveling work vehicle

Legal Events

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