JPH01117702A - Controller for position of ground working machine - Google Patents

Controller for position of ground working machine

Info

Publication number
JPH01117702A
JPH01117702A JP62274393A JP27439387A JPH01117702A JP H01117702 A JPH01117702 A JP H01117702A JP 62274393 A JP62274393 A JP 62274393A JP 27439387 A JP27439387 A JP 27439387A JP H01117702 A JPH01117702 A JP H01117702A
Authority
JP
Japan
Prior art keywords
value
parallel
lift
ground
valve
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP62274393A
Other languages
Japanese (ja)
Inventor
Hironobu Kato
弘宣 加藤
Ryuichi Kimata
隆一 木全
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.)
Honda Motor Co Ltd
Original Assignee
Honda Motor 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 Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to JP62274393A priority Critical patent/JPH01117702A/en
Publication of JPH01117702A publication Critical patent/JPH01117702A/en
Pending legal-status Critical Current

Links

Landscapes

  • Lifting Devices For Agricultural Implements (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

PURPOSE:To enable start of return control of a working machine at a constant position regardless of high or low hydraulic pressure, by setting the optimum lag time to start the parallel return control judging from lifting speed, height and position of a working machine. CONSTITUTION:The first parallel counter 23 counts parallel delay count values by turning on operation of a valve 25 for lifting to output a count end signal to an arithmetic part 22 and read the present lift value in completing counting. Furthermore, after completing count values, a counting start command for parallel change count values is outputted from the arithmetic part 22 to the first parallel counter 23 to read the present lift value in completing the counting. The optimum lag time calculated on the basis of the present lift value read for each time of completing counting of count values and lift set value is set in the second parallel counter 24. After counting the count values, control by a horizontal control part 20 is changed over to control by the parallel return control part 21.

Description

【発明の詳細な説明】 (産業上の利用分野) 本発明は、トラクタなどの走行車両(以下、単に車両と
よぶ)の後部に取付けられた、ロータリ耕うん装置など
の対地作業機(以下、単に作業機とよぶ)の位置制御装
置に関するものであり、特に、作業機を、非作業位置に
おいて、車両に対して平行にするように姿勢制御を行う
対地作業機位置制御装置に関するものである。
[Detailed Description of the Invention] (Industrial Application Field) The present invention relates to a ground working machine (hereinafter simply referred to as a vehicle) such as a rotary tiller that is attached to the rear of a traveling vehicle such as a tractor (hereinafter simply referred to as a vehicle). The present invention relates to a position control device for a ground work machine (referred to as a work machine), and particularly relates to a ground work machine position control system that controls the attitude of the work machine so that it is parallel to a vehicle in a non-work position.

(従来の技術) 一般に、トラクタなどの車両に作業機が取付けられた走
行作業車においては、作業機が、作業位置と非作業位置
との間で昇降可能であり、また左右に傾斜可能であるよ
うに、連結機構を介してトラクタ側に連結されている。
(Prior Art) Generally, in a traveling work vehicle in which a work equipment is attached to a vehicle such as a tractor, the work equipment can be raised and lowered between a work position and a non-work position, and can also be tilted left and right. It is connected to the tractor side via a connecting mechanism.

そして、作業機が作業位置にあるとき、後述するように
、車両がローリングしても作業機が常に水平に保持され
るような、水平制御装置が設けられていることが多い。
When the working machine is in the working position, a horizontal control device is often provided so that the working machine is always held horizontally even if the vehicle rolls, as will be described later.

しかし、このような走行作業車による耕うん作業中の旋
回、あるいは非作業走行時に作業機を、非作業位置まで
上昇させる場合、車両が水平に対して傾斜していても、
作業機は水平に制御されているので、比較的重量のある
作業機が車両に対して傾斜したままの状態で引上げられ
ることになり、そのため、車両にかかる重量バランスが
好ましい状態でなくなり、また連結部におけるアームの
一部に無理な力が加わることがある。
However, when such a traveling work vehicle turns during tilling work, or when the work equipment is raised to a non-working position during non-working driving, even if the vehicle is tilted with respect to the horizontal,
Since the work equipment is controlled horizontally, the relatively heavy work equipment will be pulled up while tilted relative to the vehicle, resulting in an unfavorable weight balance on the vehicle and Unreasonable force may be applied to a part of the arm at the section.

そのため従来では、作業機の水平制御が行われている際
に作業機を上昇させる場合、作業機が作業位置から一定
の高さにまで上昇されたことを検出したうえで、水平制
御を解除し、その作業機が車両に対して平行状態となる
ような、平行復帰制御を行わせようにすることが考えら
れている。
Therefore, conventionally, when raising the work equipment while the work equipment is under horizontal control, the horizontal control is canceled after detecting that the work equipment has been raised to a certain height from the working position. It has been considered to perform parallel return control so that the working machine becomes parallel to the vehicle.

その−例として、作業機の位置を操作レバーの位置によ
って決定する制御方式がある。該制御方式では、前記レ
バーの上昇側に、作業機の水平制御と、平行復帰制御を
切換えるスイッチが配設され、操作レバーがこの位置以
上に上昇側に操作された時に、水平制御が平行復帰制御
に切換えられ、作業機が車両に対して平行状態となるよ
うにしである(特開昭62−27653号公報)。
An example of this is a control system in which the position of a working machine is determined by the position of an operating lever. In this control system, a switch for switching between horizontal control and parallel return control of the work equipment is provided on the upward side of the lever, and when the operating lever is operated beyond this position to the upward side, the horizontal control switches to parallel return. The control is switched so that the working machine is parallel to the vehicle (Japanese Unexamined Patent Publication No. 62-27653).

しかし、上記した従来の技術は、操作レバーによって、
作業機が所定の最大高さまで上昇された後に、初めて平
行復帰制御が開始されるようになっているため、任意の
時点で平行復帰制御を開始させるような強制的、緊急避
難的動作には対応できないという問題点があった。
However, the above-mentioned conventional technology uses the operating lever to
Parallel return control is started only after the work equipment has been raised to a predetermined maximum height, so it is compatible with forced and emergency evacuation operations that require parallel return control to be started at any point. The problem was that it couldn't be done.

上記問題点に鑑み、本発明者は、作業機が、上昇駆動し
始めてから、予定時間後に、作業機が車両に対して平行
になるように制御し、該予定時間は、上昇駆動開始時に
おける作業機の高さ位置の関数として設定するようにし
た制御手段を具備した走行作業車を提案した(特願昭6
2−186571号)。
In view of the above-mentioned problems, the present inventors controlled the work machine so that it became parallel to the vehicle after a scheduled time after the work machine started upward drive, and the scheduled time was set at the time when the upward drive started. We proposed a traveling work vehicle equipped with a control means that was set as a function of the height position of the work equipment (patent application filed in 1983).
2-186571).

(発明が解決しようとする問題点) 上記した従来の技術は、次のような問題点を内在してい
た。
(Problems to be Solved by the Invention) The conventional techniques described above have the following problems.

上記、本発明者が先に提案した走行作業車においては、
昇降駆動用油圧シリンダの油圧ポンプが作業機駆動用あ
るいは走行用のエンジンで駆動されている場合には、ア
イドル運転中は、油圧が低いため、上昇速度が比較的遅
く、作業中は油圧が十分に高いため、上昇速度が比較的
速いという現象が生じ易い。
In the above-mentioned traveling work vehicle previously proposed by the present inventor,
If the hydraulic pump of the hydraulic cylinder for lifting and lowering is driven by the engine for driving the work equipment or for traveling, the hydraulic pressure is low during idle operation, so the lifting speed is relatively slow, and the hydraulic pressure is sufficient during work. Since the temperature is high, the phenomenon that the rate of rise is relatively fast tends to occur.

このような状態で、上昇開始位置から予定時間経過後に
、平行復帰を行わせるようにしていると、油圧が低い場
合は、予定位置より下の方で平行復帰が開始され、油圧
が高い場合には、予定位置より上の方で平行復帰制御が
開始されるようになる場合があり、このため油圧の高低
のばらつきの影響を小さくするための対策が必要になる
ことがある。
In such a situation, if the parallel return is performed after the scheduled time has elapsed from the ascent start position, if the oil pressure is low, the parallel return will start below the planned position, and if the oil pressure is high, it will start parallel return. In this case, the parallel return control may be started above the planned position, and therefore it may be necessary to take measures to reduce the influence of variations in oil pressure level.

本発明は、前述の問題点を解決するためになされたもの
である。
The present invention has been made to solve the above-mentioned problems.

(問題点を解決するための手段および作用)前記の問題
点を解決するために本発明は、作業機の昇降を制御する
昇降制御部と、作業機を車両に対して、左右に傾斜させ
る制御を行う水平制御部および平行復帰制御部と、作業
機の高さ現在値を検出する検出手段と、作業機が上昇を
開始し始めた直後の上昇速度を検出する手段と、該上昇
速度および作業機の高さ位置に基づいて計算された、遅
延時間後に前記水平制御部を平行復帰制御部に切換えて
作業機を車両に対して平行にする手段とを具備した点に
特徴がある。
(Means and effects for solving the problems) In order to solve the above-mentioned problems, the present invention provides an elevation control unit that controls the elevation of a working machine, and a control unit that tilts the working machine from side to side with respect to a vehicle. a horizontal control section and a parallel return control section, a detection means for detecting the current height value of the working machine, a means for detecting the rising speed immediately after the working machine starts to rise, and a detecting means for detecting the current height value of the working machine; The present invention is characterized in that it includes means for switching the horizontal control section to a parallel return control section to make the working machine parallel to the vehicle after a delay time calculated based on the height position of the machine.

上記構成を有する本発明においては、作業機の上昇開始
直後の上昇速度を検出して、該上昇速度および作業機の
高さ位置から判断して、平行復帰制御を開始するまでの
最適遅延時間が設定されるようになっているので、前記
油圧の高低にかかわらず、はぼ一定位置で作業機の平行
復帰制御をを開始することができる。
In the present invention having the above configuration, the rising speed of the working machine immediately after the start of rising is detected, and the optimal delay time until starting the parallel return control is determined from the rising speed and the height position of the working machine. Since this setting is made, it is possible to start the parallel return control of the working machine at a substantially constant position regardless of the level of the oil pressure.

′(実施例) 以下に図面を参照して、本発明の詳細な説明する。'(Example) The present invention will be described in detail below with reference to the drawings.

第10図は本発明の制御装置を適用する走行作業車の側
面図、第11図は該走行作業車後部に連結された作業機
と連結機構部の要部を示す斜視図である。
FIG. 10 is a side view of a traveling working vehicle to which the control device of the present invention is applied, and FIG. 11 is a perspective view showing main parts of a working machine and a coupling mechanism section connected to the rear of the traveling working vehicle.

図において、車両1には、連結機構部2を介して、耕う
ん用ロータなどからなる作業機3が連結されている。
In the figure, a working machine 3 such as a tillage rotor is connected to a vehicle 1 via a connecting mechanism 2.

作業機3は、トップリンク4および、左右一対のロアー
リンク5,6からなる三点昇降リンク機構を介して、車
両1に連結されている。また、車両1側には油圧シリン
ダ7と、該シリンダ7によって駆動されるリフトアーム
8.9が取付けられている。
The work machine 3 is connected to the vehicle 1 via a three-point lifting link mechanism consisting of a top link 4 and a pair of left and right lower links 5 and 6. Further, a hydraulic cylinder 7 and a lift arm 8.9 driven by the cylinder 7 are attached to the vehicle 1 side.

ロアーリンク5,6は、それぞれリフトロッド10.1
1を介してリフトアーム8.9に接続されているので、
作業機3は油圧シリンダ7の伸縮動作によって、昇降さ
れる。
The lower links 5 and 6 each have a lift rod 10.1
Since it is connected to the lift arm 8.9 through 1,
The work machine 3 is raised and lowered by the expansion and contraction operations of the hydraulic cylinder 7.

車両1には水平センサ12が設けられ、リフトロッド1
1には該ロッドを伸縮させる油圧シリンダ13とリフト
ロッド11の伸縮量を検出するストロークセンサ14が
設けられている。
A horizontal sensor 12 is provided on the vehicle 1, and a lift rod 1
1 is provided with a hydraulic cylinder 13 that extends and contracts the rod, and a stroke sensor 14 that detects the amount of extension and contraction of the lift rod 11.

そして、車両1がローリングしても作業機3は地面に対
して水平に保持されるように、水平センサ12によって
検出された車両1の傾きの程度に応じて、伸縮量をスト
ロークセンサ14により゛監視しながら、該ストロごク
センサ14の値をストローク目標値に維持するように、
油圧シリンダ13を駆動制御している。リフトアーム8
,9には、そのリフト角度を検出する回転型ポテンショ
メータで構成されるリフトセンサ15が設けられており
、そのセンサ出力に応じて作業機3の非作業位置への上
昇、および作業位置への下降の制御を行わせることがで
きる。
Then, the stroke sensor 14 adjusts the amount of expansion and contraction according to the degree of inclination of the vehicle 1 detected by the horizontal sensor 12 so that the work implement 3 is held horizontally with respect to the ground even if the vehicle 1 rolls. While monitoring, the value of the stroke sensor 14 is maintained at the stroke target value.
The hydraulic cylinder 13 is driven and controlled. lift arm 8
, 9 is provided with a lift sensor 15 composed of a rotary potentiometer that detects the lift angle, and the work equipment 3 is raised to the non-working position and lowered to the working position according to the sensor output. can be controlled.

一方、作業機3側には、該作業機3が作業位置にあると
き、地面をならって、耕うんの深さに応じて開度θが変
化するピラー16が設けられている。ピラー16の開度
θは、ロッド17Aを介して回転型ポテンショメータで
構成されるピラーセンサ(角度センサ)18Aによって
検出される。
On the other hand, on the working machine 3 side, a pillar 16 is provided which traces the ground and whose opening degree θ changes depending on the depth of tillage when the working machine 3 is in the working position. The opening degree θ of the pillar 16 is detected via a rod 17A by a pillar sensor (angle sensor) 18A composed of a rotary potentiometer.

そして、ピラーセンサ18Aの出力に応じて前記油圧シ
リンダ7を駆動し、耕うんの深さを設定値に保持させる
、耕深制御をするこ、とができる。
Further, the hydraulic cylinder 7 is driven in accordance with the output of the pillar sensor 18A, and the tilling depth can be controlled to be maintained at a set value.

車両1には操縦者の座席17が設けられ、該座席の横位
置には作業機3の昇降を手動によって制御する昇降スイ
ッチ18が設けられている。
The vehicle 1 is provided with an operator's seat 17, and a lift switch 18 for manually controlling the lifting and lowering of the working machine 3 is provided next to the seat.

第1図に、このような走行作業車における電気制御系統
のブロック図を示す。
FIG. 1 shows a block diagram of an electrical control system in such a traveling work vehicle.

ここでは、各扛センサの検出出力、および各種スイッチ
による制御動作の指示信号に応じて、後で述べるように
、作業機3の昇降および左右傾斜の各動作指令を、前記
各油圧シリンダ7、および13にそれぞれ与えるバルブ
のオン・オフ動作を適宜行わせるようにしている。
Here, in accordance with the detection output of each sensor and control operation instruction signals from various switches, each operation command for raising/lowering and left/right tilting of the working machine 3 is sent to each of the hydraulic cylinders 7 and 7, as described later. The on/off operations of the valves provided to each of the valves 13 are performed as appropriate.

同図において、昇降制御部19には、昇降スイッチ18
によって設定される作業機3の目標高さ信号、およびリ
フトセンサ15の検出信号が入力される。そして、昇降
制御部19から、前記信号に基づいて、上昇用バルブ2
5と、下降用バルブ26にオン・オフ信号が与えられる
。該上昇用バルブ25と下降用バルブ26は、作業機3
を昇降させる油圧シリンダ7を駆動させる制御バルブで
あり、前記昇降制御部19からのオン・オフ信号によっ
て、オン・オフの動作を行う。
In the figure, the lift control unit 19 includes a lift switch 18.
A target height signal of the working machine 3 set by the above and a detection signal of the lift sensor 15 are inputted. Then, based on the signal from the lift control unit 19, the lift valve 2
5, an on/off signal is given to the lowering valve 26. The ascending valve 25 and descending valve 26 are connected to the working machine 3.
This is a control valve that drives the hydraulic cylinder 7 that raises and lowers the hydraulic cylinder 7, and performs on/off operations based on the on/off signal from the elevation control section 19.

ストローク目標値設定器29には、水平センサ12の検
出値と、ストロークセンサ14の検出値に基づいて決定
される値と比較されるストローク目標値が任意に設定さ
れる。
The stroke target value setter 29 is arbitrarily set with a stroke target value to be compared with a value determined based on the detection value of the horizontal sensor 12 and the detection value of the stroke sensor 14 .

水平制御部20には、ストロークセンサ14の検出信号
と、ストローク目標値の信号と、水平センサ12の検出
信号とが入力される。そして、前記信号に基づいて、ス
トロークセンサ14の検出値がストローク目標値と一致
するように、水平制御部20から右傾斜用バルブ27と
、左傾斜用バルブ28に、オン・オフ信号が与えられる
A detection signal from the stroke sensor 14 , a stroke target value signal, and a detection signal from the horizontal sensor 12 are input to the horizontal control unit 20 . Then, based on the signal, an on/off signal is given from the horizontal control section 20 to the right tilt valve 27 and the left tilt valve 28 so that the detected value of the stroke sensor 14 matches the stroke target value. .

右傾斜用バルブ27と、左傾斜用バルブ28は、前記オ
ン・オフ信号に応じて、作業機3を左右に傾斜させる油
圧シリンダ13を駆動させる。
The right tilting valve 27 and the left tilting valve 28 drive the hydraulic cylinder 13 that tilts the working machine 3 left and right in response to the on/off signal.

平行復帰制御部21は、作業機3を車両1に対し、平行
に位置制御するもので、ストロークセンサ14の値をス
トローク目標値に一致させるように、前記右傾斜用バル
ブ27と、左傾斜用バルブ28のオン・オフ動作の制御
を行う。なお、この平行復帰制御ではストローク目標値
として、ストロークセンサ14の中心値が設定されて用
いられる。
The parallel return control unit 21 controls the position of the work equipment 3 in parallel to the vehicle 1, and controls the right tilting valve 27 and the left tilting valve 27 so that the value of the stroke sensor 14 matches the stroke target value. Controls the on/off operation of the valve 28. Note that in this parallel return control, the center value of the stroke sensor 14 is set and used as the stroke target value.

通常の耕うん作業中、作業機3の左右傾斜動作は、水平
制御部20により制御されているが、非作業時および車
両1の旋回時には、次に述べる制御により、平行復帰制
御部21による制御に切換えられる。
During normal tillage work, the left and right tilting motion of the work implement 3 is controlled by the horizontal control unit 20, but when not working and when the vehicle 1 is turning, the horizontal movement is controlled by the parallel return control unit 21 according to the control described below. Can be switched.

演算部22には、リフトセンサ15からの、作業機3の
高さ現在値(以下、リフト現在値という)と、作業機最
上昇位置である上昇設定値が入力される。該上昇設定値
は、作業機3が平行復帰を開始しても、該作業機3が地
面に当たらないだけの高さ以上であって、あらかじめ上
昇設定値設定器30に設定された値である。
The calculation unit 22 receives input from the lift sensor 15 of the current height value of the work implement 3 (hereinafter referred to as the current lift value) and the elevation setting value which is the highest position of the work implement. The rising setting value is a value set in advance in the rising setting value setting device 30, and is at least a height at which the working equipment 3 does not hit the ground even if the working equipment 3 starts parallel return. .

¥12図のタイムチャートに、上昇用バルブ25、下降
用バルブ26、およびリフトセンサ15の信号の関係を
示す。
The time chart in Figure 12 shows the relationship among the signals of the ascending valve 25, descending valve 26, and lift sensor 15.

同図において、上昇用バルブ25がオンとなって平行遅
延カウント値の計数時間T1の経過後、すなわちa点と
、さらにa点から平行変化カウント値の計数時間T2の
経過後、すなわちb点とにおける、リフトセンサ15の
値の差、およびb点におけるリフトセンサ15の値と、
上昇設定値との差Aから平行復帰変数を計算し、後述す
る第3図の計算テーブルから最適遅延時間T3が読取ら
れ、該遅延時間T3の経過後、平行復帰制御が開始され
る。
In the figure, after the rising valve 25 is turned on and the counting time T1 of the parallel delay count value has elapsed, that is, point a, and after the elapse of the counting time T2 of the parallel change count value from point a, that is, point b. The difference between the values of the lift sensor 15 at point b and the value of the lift sensor 15 at point b,
A parallel return variable is calculated from the difference A from the rising set value, an optimum delay time T3 is read from a calculation table shown in FIG. 3, which will be described later, and after the delay time T3 has elapsed, parallel return control is started.

平行復帰変数は、(A/リフトスピード)で求められる
。該リフトスピードは、フローチャートの説明のなかで
後述する、(b点でのリフトセンサの値−a点でのリフ
トセンサの値)または“θ″があてはめられる。
The parallel return variable is determined by (A/lift speed). The lift speed is determined by (the value of the lift sensor at point b - the value of the lift sensor at point a) or "θ", which will be described later in the explanation of the flowchart.

下降用バルブ2Gがオンとなって、平行下降カウント値
T4の計数後、平行復帰制御が解除される。前記カウン
ト値T4は、前記下降用バルブ26のオン動作した後、
実際にリフトアームが動作するまでの機械的なあそびを
見越して設定された遅延時間である。
The descending valve 2G is turned on, and after counting the parallel descending count value T4, the parallel return control is released. The count value T4 is calculated after the lowering valve 26 is turned on.
This is a delay time set in anticipation of mechanical play until the lift arm actually operates.

なお、平行遅延カウント値T1は、上昇用バルブ25の
動作に対して、実際にリフトアームが動作するまでの、
機械的なあそびを見越して設定された遅延時間である。
Note that the parallel delay count value T1 is the time until the lift arm actually operates with respect to the operation of the lift valve 25.
This is a delay time set in anticipation of mechanical play.

第1平行カウンタ23は、上昇用バルブ25のオン動作
により、平行遅延カウント値T1を計数し、該カウント
値をカウントした後、演算部22にカウント終了信号が
出力され、該カウント終了時のリフト現在値が読取られ
る。
The first parallel counter 23 counts the parallel delay count value T1 by turning on the rising valve 25, and after counting the count value, a count end signal is output to the calculation unit 22, and the lift at the end of the count is The current value is read.

さらに、前記カウント値終了後、演算部22から、平行
変化カウント値T2の計数開始指令が、前記第1平行カ
ウンタ23に出力され、該カウント終了時のリフト現在
値が読取られる。
Furthermore, after the count value ends, a count start command for the parallel change count value T2 is output from the calculation section 22 to the first parallel counter 23, and the current lift value at the end of the count is read.

前記2度のカウント値の計数終了時点毎に読取られた、
前記リフト現在値と、前記上昇設定値をもとに、後述す
る計算テーブルから計算された最適遅延時間T3が、第
2平行カウンタ24にカウント値として設定され、該カ
ウント値の計数後、前記水平制御部20による制御から
平行復帰制御部21による制御に切換えられる。
The count value is read every time the count value is completed twice,
An optimum delay time T3 calculated from a calculation table described later based on the lift current value and the rise setting value is set as a count value in the second parallel counter 24, and after counting the count value, the horizontal The control by the control section 20 is switched to the control by the parallel return control section 21.

耕うん作業を開始するために昇降スイッチ18が操作さ
れ下降用バルブ26がオン動作すると、第2平行カウン
タ24により、平行下降カウント値が計数され、該カウ
ント値計数後、再び、平行復帰制御から水平制御部20
による水平制御に切換えられる。
When the lift switch 18 is operated to start tilling work and the lowering valve 26 is turned on, the second parallel counter 24 counts the parallel lowering count value, and after counting the count value, the parallel lowering control is started again. Control unit 20
Switched to horizontal control.

なお、前記平行遅延カウント値、平行変化カウント値、
平行下降カウント値は、予め、ROMデータとして記憶
されている値である。
In addition, the parallel delay count value, the parallel change count value,
The parallel descent count value is a value stored in advance as ROM data.

以上を要約すれば、本実施例では、作業機3の水平制御
中に、作業機3に対する上昇指令信号が発せられ、上昇
用バルブ25がオン動作を行っているときに、該上昇用
バルブ25のオン動作開始後から予め設定された時間経
過後の2つの時点における、作業機3の高さが読取られ
、該読取り結果から作業機3の上昇速度が算出される。
To summarize the above, in this embodiment, during horizontal control of the work machine 3, a lift command signal is issued to the work machine 3, and when the lift valve 25 is turned on, the lift valve 25 The height of the work implement 3 at two points in time after a preset time has elapsed since the start of the on-operation is read, and the rising speed of the work implement 3 is calculated from the reading results.

そして、該上昇速度のもとに、作業機3が前記上昇設定
値に到達する時間を計算し、該計算値が最適遅延時間と
して、第2平行カウンタ24にセットされ、該最適遅延
時間の経過後、作業機3を車両に対して、平行に復帰さ
せる制御を行わせるようにしている。
Then, based on the rising speed, the time required for the work equipment 3 to reach the rising set value is calculated, and the calculated value is set in the second parallel counter 24 as the optimum delay time, and the elapse of the optimum delay time. After that, the work machine 3 is controlled to return parallel to the vehicle.

第3図に、最適遅延時間と、前記平行復帰変数の関係図
を示す。同図において、横軸に、平行復帰変数、縦軸に
遅延時間T3設定のためのカウンタ値である。平行復帰
変数とカウンタ値の関係は、曲線Fのようである。
FIG. 3 shows a relationship diagram between the optimum delay time and the parallel return variable. In the figure, the horizontal axis represents the parallel return variable, and the vertical axis represents the counter value for setting the delay time T3. The relationship between the parallel return variable and the counter value is as shown by curve F.

次に、第4図、第5図を参照して、本実施例の制御フロ
ーを詳細に説明する。第4図は、水平制御と平行復帰制
御を含めた、作業機3の左右傾斜動作のための、全体の
フローチャートを示し、第5図は、第4図の平行復帰制
御の部分を抽出して詳細に示したフロチャートを示す。
Next, the control flow of this embodiment will be explained in detail with reference to FIGS. 4 and 5. FIG. 4 shows the entire flowchart for the horizontal tilting operation of the working machine 3, including horizontal control and parallel return control, and FIG. 5 shows an extracted part of the parallel return control in FIG. 4. A detailed flowchart is shown.

全体の制御フローは、以下の通りである。The overall control flow is as follows.

まず、水平センサ12と、ストロークセンサ14の値、
すなわち車両1の傾きと、該車両1に対する作業機3の
傾きが入力される(ステップSl)。該ステップS1で
の人力値をもとに、車両1の傾きとは関係なく、作業機
3を水平に制御するためのストローク目標値が計算され
る(ステップS2)。この計算結果は、ストローク目標
値として前記ストローク目標値設定器29に設定される
(ステップS3)。
First, the values of the horizontal sensor 12 and the stroke sensor 14,
That is, the inclination of the vehicle 1 and the inclination of the work implement 3 with respect to the vehicle 1 are input (step Sl). Based on the human power value in step S1, a stroke target value for controlling the work implement 3 horizontally is calculated regardless of the inclination of the vehicle 1 (step S2). This calculation result is set as a stroke target value in the stroke target value setter 29 (step S3).

以上のステップ81〜ステツプS3は、水平制御の準備
段階である。
The above steps 81 to S3 are the preparation stages for horizontal control.

ステップS3の後に、第3図を参照して後述する平行復
帰制御が行われる(ステップS4)。その後、ステップ
S5では、前記ストローク目標値とストローク現在値が
比較される。ここで、水平制御の場合は、ストローク目
標値としてステップS3での計算結果が用いられ、平行
復帰制御の場合は、リフトロッド11のストローク中心
値がストローク目標値として用いられる。
After step S3, parallel return control, which will be described later with reference to FIG. 3, is performed (step S4). Thereafter, in step S5, the stroke target value and the current stroke value are compared. Here, in the case of horizontal control, the calculation result in step S3 is used as the stroke target value, and in the case of parallel return control, the stroke center value of the lift rod 11 is used as the stroke target value.

ステップS5において、ストローク現在値がストローク
目標値より小のときは、右傾斜用バルブ27がオンとな
り(ステップS6)、油圧シリンダ13が作動してリフ
トロッド11が伸びる。
In step S5, when the current stroke value is smaller than the stroke target value, the right tilting valve 27 is turned on (step S6), the hydraulic cylinder 13 is operated, and the lift rod 11 is extended.

一方、ストローク現在値がストローク目標値より大のと
きは、左傾斜用バルブ28がオンとなり(ステップS7
)、油圧シリンダ13が作動してリフトロッド11が縮
む。
On the other hand, when the current stroke value is greater than the target stroke value, the left tilting valve 28 is turned on (step S7
), the hydraulic cylinder 13 operates and the lift rod 11 retracts.

また、両者が等しいときは、右傾斜用バルブ27と、左
傾斜用バルブ28はともにオフの状態(ステップS8)
で、油圧シリンダ13は、作動しない。
Further, when the two are equal, both the right tilt valve 27 and the left tilt valve 28 are in an OFF state (step S8).
Therefore, the hydraulic cylinder 13 does not operate.

次に、平行復帰制御について、第5図のフローチャート
を参照して説明する。
Next, the parallel return control will be explained with reference to the flowchart in FIG.

平行フラグ、セットフラグ、平行モードはいずれも、制
御起動時は、リセット状態にしである。
The parallel flag, set flag, and parallel mode are all in the reset state at the time of control activation.

まず、ステップ5401では、平行フラグがリセットさ
れているので、次の判断ステップに進む(ステップS 
402)。
First, in step 5401, since the parallel flag has been reset, the process proceeds to the next judgment step (step S
402).

ステップ5402では、上昇用バルブ25がオン動作し
ているか否かが判断され、上昇用バルブ25がオン動作
している場合は、肯定の判断となり、ステップ5403
で平行モードが′0”か否かが判断される。平行モード
も制御起動時はリセットされているので、ステップ54
04に進む。
In step 5402, it is determined whether or not the rising valve 25 is turned on. If the rising valve 25 is turned on, an affirmative judgment is made, and step 5403
It is determined whether the parallel mode is '0' or not. Since the parallel mode is also reset at the time of control activation, step 54
Proceed to 04.

次の判断ステップ5404では、セットフラグの判別が
され、該セットフラグもリセットされていて、判別結果
は0”であるから、ステップ5405に進む。
In the next determination step 5404, the set flag is determined, and since the set flag has also been reset and the determination result is 0'', the process advances to step 5405.

ステップ5405において、第1平行カウンタ23に平
行遅延カウンタ値T1がセットされ、減算が開始される
In step 5405, the parallel delay counter value T1 is set in the first parallel counter 23, and subtraction is started.

カウンタ値T1の減算が開始されると、セットフラグが
セットされる(ステップ5406)。該ステップ540
6でセットフラグがセットされるので、ステップ540
4における、次回の判断は“1′″となり、ステップ5
405およびステップ8406の処理は、スキップされ
る。
When the subtraction of the counter value T1 is started, a set flag is set (step 5406). The step 540
Since the set flag is set at step 6, step 540
The next judgment in step 4 is “1′”, and step 5
Processes 405 and 8406 are skipped.

平行遅延カウンタ値T1の減算が開始され、セットフラ
グがセットされると、ステップ8407で前記カウンタ
値が“O”になったか否かの判別が繰返され、カウンタ
値が0”になると、ステップ8408に進み、平行モー
ドの値に“1”が加算される。
When the subtraction of the parallel delay counter value T1 is started and the set flag is set, the determination as to whether the counter value has become "O" is repeated in step 8407, and when the counter value has become "0", step 8408 Then, "1" is added to the parallel mode value.

ステップ5409では、セットフラグがリセットされ、
ステップS5に移る。
In step 5409, the set flag is reset;
The process moves to step S5.

平行遅延カウンタ値T1の減算終了後は、ステップ54
08で平行モードの値に“1”が加算されているので、
次回のステップ5403の判断は、否定となり、ステッ
プ5410に移行する。
After completing the subtraction of the parallel delay counter value T1, step 54
Since "1" is added to the parallel mode value in 08,
The next determination in step 5403 is negative, and the process moves to step 5410.

平行モードの値は、制御起動時の“0゛の値に、ステッ
プ8408で“1″が加算されているので、“1″であ
るため、ステップ5410の判断は、肯定となり、ステ
ップ5411に進む。
Since the value of the parallel mode is "1" since "1" is added in step 8408 to the "0" value at the time of control activation, the judgment in step 5410 is affirmative and the process proceeds to step 5411. .

セットフラグは、ステップ5409で“O”になってい
るので、ステップ5412に進む。
Since the set flag is “O” in step 5409, the process advances to step 5412.

ステップ5412においては、第1平行カウンタ23に
平行変化カウンタ値T2がセットされ、該カウンタ値T
2の減算が開始される。
In step 5412, a parallel change counter value T2 is set in the first parallel counter 23, and the counter value T2 is set to the first parallel counter 23.
Subtraction of 2 is started.

平行変化カウンタ値T2の減算が開始されると、セット
フラグがセットされ(ステップ5413)、ステップ5
414に進む。
When the subtraction of the parallel change counter value T2 is started, a set flag is set (step 5413), and step 5
Proceed to 414.

ステップ5414では、リフト初回値として、リフトセ
ンサ15の現在値、すなわち、作業機3の高さ現在値が
セットされる。
In step 5414, the current value of the lift sensor 15, that is, the current height value of the work implement 3 is set as the initial lift value.

ステップ5413において、セットフラグがセットされ
たので、次回の処理においては、ステップ5411の判
別は“1″となり、ステップ8412〜5414の処理
は、スキップされる。
Since the set flag is set in step 5413, in the next process, the determination in step 5411 is "1", and the processes in steps 8412 to 5414 are skipped.

ステップ5415において、平行変化カウンタ値T2が
セットされた第1平行カウンタ23の値が“0”になる
まで、監視が継続され、該カウンタ値が“0“になると
、平行モードに“1”が加算される(ステップ8416
)。
In step 5415, monitoring is continued until the value of the first parallel counter 23 to which the parallel change counter value T2 is set becomes "0", and when the counter value becomes "0", "1" is set to the parallel mode. is added (step 8416
).

ステップ5417では、セットフラグがリセットされる
In step 5417, the set flag is reset.

ステップ8418では、平行変化カウンタ値T2の計数
終了後のリフト現在値、すなわち作業機3の高さが、リ
フトセンサ15から読取られ、該リフト現在値と、前記
リフト初回値との大小が比較される。
In step 8418, the current lift value after the parallel change counter value T2 has finished counting, that is, the height of the work implement 3, is read from the lift sensor 15, and the current lift value is compared with the initial lift value. Ru.

ステップ8418の判断で、リフト現在値が、リフト初
回値より大の場合は、ステップ5419に進み、リフト
スピードとして、前記リフト現在値からリフト初回値が
減算された値がセットされ、プログラムの始めに戻る。
If it is determined in step 8418 that the current lift value is greater than the initial lift value, the process proceeds to step 5419, where a value obtained by subtracting the initial lift value from the current lift value is set as the lift speed, and at the beginning of the program. return.

一方、ステップ8418の判断で、リフト初回値がリフ
ト現在値より大の場合、すなわち油圧シリンダ7に供給
される油圧が極端に低く、カウンタ値T2の計数時間に
作業機3がほとんど上昇しないで、むしろ、リフトセン
サ16が振動などの要因によって、前記初回値を下回っ
たような場合は、リフトスピードとして、“0”がセッ
トされる(ステップS 420)。
On the other hand, if it is determined in step 8418 that the initial lift value is greater than the current lift value, that is, the hydraulic pressure supplied to the hydraulic cylinder 7 is extremely low, and the work implement 3 hardly rises during the counting time of the counter value T2. Rather, if the lift sensor 16 falls below the initial value due to factors such as vibration, "0" is set as the lift speed (step S420).

ステップ5419または5420の処理が終わって、プ
ログラムの始めに戻り、上昇用バルブ25のオン動作が
継続されていると、今度は、平行モードの値がステップ
8416で“1”加算されて、′2”になっているので
、ステップ5421に移行する。
When the processing in step 5419 or 5420 is completed and the program returns to the beginning, and the upward operation of the rising valve 25 continues, the value of the parallel mode is incremented by "1" in step 8416, and '2' is added. ”, the process moves to step 5421.

ステップ5417でセットフラグはリセットされている
ので、ステップ5421の判断は、“0”であり、ステ
ップ5422に移行する。
Since the set flag has been reset in step 5417, the determination in step 5421 is "0" and the process moves to step 5422.

ステップ5422において、平行復帰開始までの遅延時
間T3が計算される。該平行復帰開始までの遅延時間T
3計算のプログラムのフローは、後述する。
In step 5422, a delay time T3 until the start of parallel return is calculated. Delay time T until the start of parallel return
The program flow for the three calculations will be described later.

ステップ8423において、前記ステップ5422で計
算された計算値(遅延時間)T3が第2平行カウンタ2
4にセットされ、直ちに減算が開始される。
In step 8423, the calculated value (delay time) T3 calculated in step 5422 is calculated by the second parallel counter 2.
is set to 4 and subtraction begins immediately.

前記カウンタ値の減算が開始されると、ステップ542
4において、セットフラグがセットされ、これ以降は、
ステップ5421の判別結果が“1“のため、ステップ
8422〜5424はスキップされる。
Once the subtraction of the counter value is started, step 542
4, the set flag is set, and from this point on,
Since the determination result in step 5421 is "1", steps 8422 to 5424 are skipped.

ステップ5425では、第2平行カウンタ24のカウン
タ値が“O”になるまでカウンタ値の監視がおこなわれ
る。
In step 5425, the counter value of the second parallel counter 24 is monitored until it reaches "O".

第2平行カウンタ24の値が“0”になると、ステップ
8426で平行フラグがセットされる。
When the value of the second parallel counter 24 becomes "0", a parallel flag is set in step 8426.

ステップ5427において、セットフラグがリセットさ
れ、ステップ8428では、平行モードの値に“0”が
セットされ、さらにステップ5429において、ストロ
ーク目標値にストローク中心値がセットされる。
In step 5427, the set flag is reset, in step 8428, the parallel mode value is set to "0", and further in step 5429, the stroke target value is set to the stroke center value.

ストローク目標値にストローク中心値がセットされると
、前記ステップS5の処理がストローク中心値とストロ
ーク現在値との比較になり、換言すれば、作業機3の水
平制御が平行復帰制御に切換えられることになる。
When the stroke center value is set to the stroke target value, the process in step S5 becomes a comparison between the stroke center value and the current stroke value, in other words, the horizontal control of the work implement 3 is switched to parallel return control. become.

ステップ8426で平行フラグがセットされた後は、プ
ログラムのフローは、ステップ5401から5430に
移行する。下降用バルブ26がオン動作をしない限り、
該ステップ5430の判断は、否定であり、ステップ5
437でセットフラグがリセットされ、ステップ843
8で、ストローク目標値に、ストーク中心値がセットさ
れる処理が繰返される。
After the parallel flag is set in step 8426, program flow moves from step 5401 to step 5430. Unless the descending valve 26 is turned on,
The determination at step 5430 is negative, and step 5
The set flag is reset at 437 and step 843
At step 8, the process of setting the stroke center value to the stroke target value is repeated.

換言すれば、作業機3の平行復帰制御が維持継続される
ことになる。
In other words, the parallel return control of the working machine 3 is maintained and continued.

下降用バルブ26がオン動作を開始すると、ステップ5
430の判断は肯定となり、ステップ8431に進む。
When the descending valve 26 starts to turn on, step 5
The determination at step 430 is affirmative, and the process advances to step 8431.

セットフラグは、ステップ5437でリセットされてい
るので、ステップ5431の判別は“O”で、ステップ
8432に進んで、第2平行カウンタ24に平行下降カ
ウンタ値T4がセットされ、該カウンタ値T4の減算が
開始される。
Since the set flag has been reset in step 5437, the determination in step 5431 is "O", and the process proceeds to step 8432, where the parallel descending counter value T4 is set in the second parallel counter 24, and the counter value T4 is subtracted. is started.

該カウンタ値の減算が開始されると、ステップ5433
において、セットフラグがセットされる。
When the subtraction of the counter value is started, step 5433
The set flag is set in .

ステップ5433が実行されると、ステップ5431の
判別は“1“になるので、次回の処理では、ステップ5
432.5433は、スキップされる。
When step 5433 is executed, the determination in step 5431 becomes "1", so in the next process, step 5
432.5433 is skipped.

ステップ5434においては、第2平行カウンタ24の
カウンタ値が′0”になるまで該カウンタ値の判別が継
続され、該カウンタ値が“0”になると、平行フラグが
リセットされ(ステップ5435)、セットフラグもリ
セットされる(ステップ8436)。
In step 5434, the determination of the counter value of the second parallel counter 24 is continued until the counter value reaches '0', and when the counter value reaches '0', the parallel flag is reset (step 5435) and set. The flag is also reset (step 8436).

ステップ5435で平行フラグがリセットされたので、
次回のステップ5401における判別は、“0”となり
、下降用バルブ26のオン動作が継続されていれば、反
対に上昇用バルブ25は、オフ動作になっているので、
ステップ5402の判断は否定となり、ステップ543
9に移行する。
Since the parallel flag was reset in step 5435,
The determination in the next step 5401 will be "0", and if the descending valve 26 continues to be turned on, the ascending valve 25 will be turned off.
The judgment in step 5402 is negative, and step 543
Move to 9.

ステップ5439においては、上昇設定値から、あらか
じめROMデータとして設定されている値γを差引いた
値が、リフト現在値より大か否かが判断される。
In step 5439, it is determined whether a value obtained by subtracting a value γ preset as ROM data from the lift setting value is greater than the current lift value.

該判断が肯定の場合、すなわちリフト現在値が上昇設定
値からγだけ下がった位置よりもさらに下回っている場
合は、セットフラグがリセットされ(ステップ5440
)、平行モードの値もリセットされる(ステップ544
1)。
If the determination is affirmative, that is, if the current lift value is further below the position γ lower than the rising set value, the set flag is reset (step 5440).
), the parallel mode value is also reset (step 544
1).

したがって、ストローク目標値をストローク中心値に置
換える処理(ステップ5429.ステップ5432)は
実行されないので、平行復帰制御は解除され、水平制御
に切換えられる。
Therefore, since the process of replacing the stroke target value with the stroke center value (steps 5429 and 5432) is not executed, parallel return control is canceled and switched to horizontal control.

なお、ステップ5439の判断が否定の場合、すなわち
リフト現在値が上昇設定値から値γ以内の値の場合は、
リフト現在値が上昇設定値と、略一致していると判断で
きるので、ステップ5425に移行し、該ステップ54
25以降のステップが上述のように実行され、平行復帰
制御が行われる。
Note that if the determination in step 5439 is negative, that is, if the current lift value is within the value γ from the rise setting value,
Since it can be determined that the current lift value substantially matches the rise set value, the process moves to step 5425, and step 54
Steps 25 and subsequent steps are executed as described above, and parallel return control is performed.

すなわち、上昇用バルブ25がオンとなってから第2平
行カウンタ24に平行復帰開始までの遅延時間T3がセ
ットされた後、この第2平行カウンタ24が0になる以
前に作業機が上昇設定値に達して上昇用バルブ25がオ
フとなった場合でもステップS39の判断が否定となる
ため、ステップ5425の監視を行い、第2平行カウン
タ24がOになった時点で平行復帰を行うことができる
That is, after the delay time T3 from when the lift valve 25 is turned on until the start of parallel return is set in the second parallel counter 24, the work machine reaches the set lift value before the second parallel counter 24 reaches 0. Even if the rising valve 25 is turned off by reaching 0, the determination in step S39 is negative, so step 5425 is monitored, and when the second parallel counter 24 reaches O, parallel return can be performed. .

次に、平行復帰タイマの計算プログラムのフローを第6
図を参照して説明する。
Next, the flow of the calculation program for the parallel return timer is shown in the sixth section.
This will be explained with reference to the figures.

まず、ステップS51において、上昇設定値と、リフト
現在値の大小が比較され、リフト現在値が大ならば、ス
テップS52に移行し、設定値Aに“0”がセットされ
、リフト現在値が小ならばステップS53に進み、上昇
設定値とリフト現在値の差が設定値Aにセットされる。
First, in step S51, the lift setting value and the current lift value are compared, and if the current lift value is large, the process moves to step S52, the setting value A is set to "0", and the current lift value is small. If so, the process advances to step S53, and the difference between the lift setting value and the current lift value is set to the setting value A.

ステップS54では、リフトスピードが“O#か否かが
判断され、前記ステップ5419およびステップ542
0の結果から、リフトスピードが“O”ならばステップ
S55に移行し、平行復帰変数にFFHが設定され、“
θ″でなければ、ステップS56に進み、平行復帰変数
に(A/リフトスピード)が設定される。
In step S54, it is determined whether the lift speed is "O#" and
If the lift speed is "O" from the result of 0, the process moves to step S55, FFH is set as the parallel return variable, and "
If not θ'', the process proceeds to step S56, where (A/lift speed) is set as the parallel return variable.

ステップS57においては、前記第3図の計算テーブル
により、平行復帰タイマの補間計算が行われ、平行復帰
遅延時間T3が決定される。
In step S57, interpolation calculation of the parallel return timer is performed using the calculation table shown in FIG. 3, and the parallel return delay time T3 is determined.

次に、本発明第2実施例を第7図〜第9図のフローチャ
ートを参照して説明する。
Next, a second embodiment of the present invention will be described with reference to flowcharts shown in FIGS. 7 to 9.

第7図においては、前記第5°図の、ステップ5406
の直後に、上昇変化量をストアしておくステップ550
0が挿入されたフローになっている。該ステップ550
0が挿入された他は第5図のフローチャートと同様であ
るので全体の図示および説明は省略する。
In FIG. 7, step 5406 in FIG.
Immediately after, step 550 stores the upward change amount.
This is a flow with 0 inserted. The step 550
Since the flowchart is the same as the flowchart in FIG. 5 except that 0 is inserted, illustration and explanation of the entire flowchart will be omitted.

該ステップ5500では、第2図に示したタイムチャー
トの、0点における上昇変化量を記憶させておくステッ
プであり、その具体的フローは、第8図に示す。
Step 5500 is a step for storing the amount of upward change at the 0 point in the time chart shown in FIG. 2, and its specific flow is shown in FIG. 8.

第8図において、ステップS61では、上昇設定値とリ
フト現在値が比較され、上昇設定値がリフト現在値より
大であれば、ステップS62に進み、上昇設定値からリ
フト現在値が減算された値が、上昇変化ff1Aとして
記憶される。
In FIG. 8, in step S61, the lift set value and the current lift value are compared, and if the rise set value is greater than the lift current value, the process proceeds to step S62, and the value obtained by subtracting the lift current value from the rise set value is determined. is stored as an upward change ff1A.

ステップS61において、上昇設定値がリフト現在値よ
り大でないと判断された場合は、ステップS63に移行
し、上昇変化fiAに“0”が記憶される。
If it is determined in step S61 that the lift setting value is not greater than the current lift value, the process moves to step S63, and "0" is stored in the lift change fiA.

なお、本第2実施例において、免5図のステップ542
2における平行復帰タイマ計算は、ステップS61〜S
63で上昇変化量Aが計算され、すでに記憶されている
ので、第9図に示したフローチャートの、ステップ86
4〜S67が実行されて計算される。第9図のフローは
、前記第1実施例のステップ354〜557(第6図)
と同様であるので説明は省略する。
In addition, in this second embodiment, step 542 in Fig.
The parallel return timer calculation in Step 2 is performed in steps S61 to S61.
Since the upward change amount A is calculated in step 63 and has already been stored, step 86 in the flowchart shown in FIG.
4 to S67 are executed and calculated. The flow in FIG. 9 corresponds to steps 354 to 557 (FIG. 6) of the first embodiment.
Since it is the same as that, the explanation will be omitted.

本節1および第2実施例によれば、上述の説明から明ら
かなように、上昇用バルブ25のオン動作開始が検出さ
れた直後における、設定された時間のリフトアームの上
昇量から作業機3の上昇速度を計算し、該上昇速度のも
とで、作業機3が上昇設定値に到達するまでの所要時間
を推定し、車両1に対する作業機3の平行復帰制御が開
始されるまでの遅延時間を設定するようにしである。
According to Section 1 and the second embodiment, as is clear from the above description, the amount of rise of the lift arm at the set time immediately after the start of the on-operation of the lift valve 25 is detected, the work equipment 3 is Calculate the rising speed, estimate the time required for the working machine 3 to reach the rising set value based on the rising speed, and calculate the delay time until the parallel return control of the working machine 3 with respect to the vehicle 1 is started. This is how you set it.

したがって、作業機3の上昇速度によらず、はぼ一定の
高さで平行復帰制御がおこなわれる。
Therefore, irrespective of the rising speed of the working machine 3, the parallel return control is performed at a substantially constant height.

なお、前記所要時間を推定するための、リフト現在値か
ら上昇設定値までの上昇変化量の計算において、第1実
施例では、前記リフト現在値としてb点での値が使用さ
れているのに対し、第2実施例では、前記リフト現在値
として0点での値が使用されている。
In addition, in the calculation of the amount of increase change from the current lift value to the set elevation value for estimating the required time, in the first embodiment, the value at point b is used as the current lift value. On the other hand, in the second embodiment, the value at point 0 is used as the current lift value.

上述のとおり、リフト現在値を抽出する点は異なってい
るが、0点とb点の間の時間、すなわち平行遅延カウン
タ値T1と、平行変化カウンタ値T2の合計時間は、数
100〜秒程度で、平行復帰のための遅延時間T3と比
較して微少時間であるので、b点までは0点のいずれで
リフト現在値を抽出しても、ともに同様な効果が得られ
る。
As mentioned above, although the point in which the current lift value is extracted is different, the time between point 0 and point b, that is, the total time of parallel delay counter value T1 and parallel change counter value T2, is about several hundred to seconds. Since this is a minute time compared to the delay time T3 for returning to parallelism, the same effect can be obtained even if the current lift value is extracted at any of the 0 points up to point b.

(発明の効果) 以上の説明から明らかなように、本発明によれば、次の
ような効果が達成できる。
(Effects of the Invention) As is clear from the above description, according to the present invention, the following effects can be achieved.

(1)作業機高さを検出するリフトセンサと、作業機の
上昇および下降用バルブと、タイマとを組合わせて、平
行復帰制御の開始および解除の切換え制御をしているの
で、該切換えタイミングを人為的に判断する必要がなく
、したがって操作が容易である。
(1) Switching control for starting and canceling parallel return control is performed by combining a lift sensor that detects the height of the work equipment, a valve for raising and lowering the work equipment, and a timer, so the switching timing There is no need to manually judge the information, and therefore the operation is easy.

(2)エンジン回転薮等に起因する油圧の変化があって
、作業機の上昇速度が変動しても、はぼ一定の高さで平
行復帰制御の開始および解除ができる。
(2) Even if the lifting speed of the work equipment fluctuates due to changes in oil pressure caused by engine rotation, etc., parallel return control can be started and canceled at a more or less constant height.

(3)作業機を駆動する上昇用バルブおよび下降用バル
ブの動作を条件として制御されるので、動作が確実であ
る。
(3) The operation is reliable because it is controlled based on the operation of the ascending valve and descending valve that drive the working machine.

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

第1図は本発明の一実施例を示す制御装置のブロック図
、第2図は上昇用バルブおよび下降用バルブのオン・オ
フ信号と、リフトセンサの検出信号との関係を示すタイ
ムチャート、第3図は平行復帰変数と平行復帰遅延時間
との関係図、第4図は水平および平行復帰制御のフロー
チャート、第5図は平行復帰制御の詳細なフローチャー
ト、第6図は平行復帰タイマ計算のフローチャート、第
7図は本発明の第2実施例の要部を示すフローチャート
、第8図は第2実施例の上昇変化量ストアのフローチャ
ート、第9図は第2実施例の平行タイマ計算のフローチ
ャート、第10図は走行作業車の側面図、第11図は車
両後部に連結された作業機およびその連結部の斜視図で
ある。 1・・・走行車両、2・・・連結機構部、3・・・作業
機、7.13・・・油圧シリンダ、8,9・・・リフト
アーム、10.11・・・リフトロッド、12・・・水
平センサ、14・・・ストロークセンサ、15・・・リ
フトセンサ、18・・・昇降スイッチ、19・・・昇降
制御部、20・・・水平制御部、21・・・平行復帰制
御部、22・・・演算部、23・・・第1平行カウンタ
、24・・・第2平行カウンタ、25・・・上昇用バル
ブ、26・・・下降用バルブ、27・・・右傾斜用バル
ブ、28・・・左傾斜用バルブ 。 代理人 弁理士 平木通人 外12 第   2   図 第   3   因 第   Z?   図 第  5  I2 (その1) 第  5  図 (その2) 第  5  図 (その3)
FIG. 1 is a block diagram of a control device showing an embodiment of the present invention, FIG. Figure 3 is a relationship diagram between parallel return variables and parallel return delay time, Figure 4 is a flowchart of horizontal and parallel return control, Figure 5 is a detailed flowchart of parallel return control, and Figure 6 is a flowchart of parallel return timer calculation. , FIG. 7 is a flowchart showing the main part of the second embodiment of the present invention, FIG. 8 is a flowchart of increasing change amount storage of the second embodiment, FIG. 9 is a flowchart of parallel timer calculation of the second embodiment, FIG. 10 is a side view of the traveling working vehicle, and FIG. 11 is a perspective view of the working machine connected to the rear of the vehicle and its connecting portion. DESCRIPTION OF SYMBOLS 1... Traveling vehicle, 2... Connection mechanism part, 3... Work equipment, 7.13... Hydraulic cylinder, 8, 9... Lift arm, 10.11... Lift rod, 12 ... horizontal sensor, 14 ... stroke sensor, 15 ... lift sensor, 18 ... lift switch, 19 ... lift control section, 20 ... horizontal control section, 21 ... parallel return control Part, 22... Calculation part, 23... First parallel counter, 24... Second parallel counter, 25... Valve for ascending, 26... Valve for descending, 27... For right tilting. Valve, 28...Valve for left tilt. Agent Patent Attorney Michito Hiraki Outside 12 Figure 2 Figure 3 Reason Z? Figure 5 I2 (Part 1) Figure 5 (Part 2) Figure 5 (Part 3)

Claims (3)

【特許請求の範囲】[Claims] (1)対地作業機を上昇または下降させる、流体圧アク
チュエータの上昇用バルブおよび下降用バルブの、オン
・オフ制御を行う昇降制御部と、対地作業機を右または
左に傾斜させる、流体圧アクチュエータの右傾斜用バル
ブおよび左傾斜用バルブのオン・オフ制御を行う水平制
御部および平行復帰制御部と、対地作業機の高さ現在値
を検出する検出手段と、前記上昇用バルブがオン動作を
始めてから予定時間後に、対地作業機が走行車両に対し
て平行になるように、前記水平制御部による制御を平行
復帰制御部による制御に切換える手段と、前記上昇用バ
ルブがオン動作し、対地作業機が上昇を開始した直後の
上昇速度を検出する手段と、前記予定時間を対地作業機
の高さ位置および前記上昇速度に基づいて算出する手段
とを具備したことを特徴とする対地作業機位置制御装置
(1) A lift control unit that controls on/off of the ascending valve and descending valve of the fluid pressure actuator that raises or lowers the ground-based work equipment, and a fluid-pressure actuator that tilts the ground-based work equipment to the right or left. a horizontal control section and a parallel return control section for controlling on/off of the right tilting valve and the left tilting valve; a detection means for detecting the current height value of the ground work equipment; After a scheduled time from the start, the means for switching the control by the horizontal control section to the control by the parallel return control section and the lifting valve are turned on so that the ground work machine becomes parallel to the traveling vehicle, and the ground work is started. A ground work equipment position comprising: means for detecting a climbing speed immediately after the machine starts climbing; and means for calculating the scheduled time based on the height position of the ground work equipment and the rising speed. Control device.
(2)前記予定時間を算出する基準になる対地作業機の
高さ位置が、前記上昇速度を算出した時点で検出された
、対地作業機の高さ位置であることを特徴とする前記特
許請求の範囲第1項記載の対地作業機位置制御装置。
(2) The above-mentioned patent claim characterized in that the height position of the ground-based work machine that serves as a reference for calculating the scheduled time is the height position of the ground-based work machine detected at the time when the rising speed is calculated. The ground work machine position control device according to item 1.
(3)前記予定時間を算出する基準になる対地作業機の
高さ位置が、上昇用バルブがオン動作を開始した直後の
、対地作業機の高さ位置であることを特徴とする前記特
許請求の範囲第1項記載の対地作業機位置制御装置。
(3) The above-mentioned patent claim characterized in that the height position of the ground-based work equipment that serves as a reference for calculating the scheduled time is the height position of the ground-based work equipment immediately after the lift valve starts turning on. The ground work machine position control device according to item 1.
JP62274393A 1987-10-29 1987-10-29 Controller for position of ground working machine Pending JPH01117702A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP62274393A JPH01117702A (en) 1987-10-29 1987-10-29 Controller for position of ground working machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP62274393A JPH01117702A (en) 1987-10-29 1987-10-29 Controller for position of ground working machine

Publications (1)

Publication Number Publication Date
JPH01117702A true JPH01117702A (en) 1989-05-10

Family

ID=17541041

Family Applications (1)

Application Number Title Priority Date Filing Date
JP62274393A Pending JPH01117702A (en) 1987-10-29 1987-10-29 Controller for position of ground working machine

Country Status (1)

Country Link
JP (1) JPH01117702A (en)

Similar Documents

Publication Publication Date Title
JPH01117702A (en) Controller for position of ground working machine
JPH0779606A (en) Rolling control mechanism for ground working device
JP3669931B2 (en) Work vehicle
JP2619702B2 (en) Ground work machine position control device
JP3805200B2 (en) Work vehicle
JP3434980B2 (en) Work vehicle position control device
JP3556098B2 (en) Hydraulic actuator control device
JP3321517B2 (en) Agricultural tractor
JP4939048B2 (en) Work vehicle lift control device
JP3648928B2 (en) Lift control device for tractor tiller
JPH088562Y2 (en) Raising control device for working unit in ground work vehicle
JPH01231804A (en) Left and right attitude controlling device of ground working machine
JPH01132302A (en) Hydraulic protection controller for ground working machine
JP3220336B2 (en) Lifting and lowering control device for working equipment of agricultural tractor
JP3755963B2 (en) Work machine
JP2660728B2 (en) Ground work machine attitude control device
JPH1098911A (en) Traveling work wagon
JP2514743Y2 (en) Agricultural depth control device for agricultural tractors
JPH01228404A (en) Controller for position of ground working machine
JPH0724487B2 (en) Feed back controller for ground work machine
JPH0636683B2 (en) Tilt control device for working unit in field working machine
JPH08224003A (en) Hydraulic pressure regulating device of tractor
JPS622764B2 (en)
JPH0253402A (en) Rolling-controlling apparatus for tractor working machine or such
JP2002227802A (en) Working vehicle