JPH0191702A - Positioning controller to the ground for working machine - Google Patents
Positioning controller to the ground for working machineInfo
- Publication number
- JPH0191702A JPH0191702A JP62250498A JP25049887A JPH0191702A JP H0191702 A JPH0191702 A JP H0191702A JP 62250498 A JP62250498 A JP 62250498A JP 25049887 A JP25049887 A JP 25049887A JP H0191702 A JPH0191702 A JP H0191702A
- Authority
- JP
- Japan
- Prior art keywords
- stroke
- value
- current
- tilting
- tilt
- 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.)
- Withdrawn
Links
Landscapes
- Lifting Devices For Agricultural Implements (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
【発明の詳細な説明】
(産業上の利用分野)
本発明は、トラクタなどの走行車両(以下、単に車両と
よぶ)後部に取付けられた、ロータリ耕うん装置などの
対地作業機(以下、単に作業機とよぶ)の位置制御装置
に関するものであり、特に、前記作業機の位置制御が、
自動制御状態のままエンジンが始動された時、不測の昇
降・傾斜動作が行われないような制御を行わせる対地作
業機位置制御装置に関する。DETAILED DESCRIPTION OF THE INVENTION (Industrial Application Field) The present invention relates to a ground-based work machine (hereinafter simply referred to as a "vehicle") such as a rotary tiller that is attached to the rear of a traveling vehicle (hereinafter simply referred to as a "vehicle") such as a tractor. The invention relates to a position control device for a work machine (referred to as a work machine), and in particular, the position control of the work machine
The present invention relates to a ground work equipment position control device that performs control to prevent unexpected lifting and tilting operations when an engine is started in an automatic control state.
(従来の技術)
一般に、トラクタなどの車両に作業機が取付けられた走
行作業車においては、作業機が、作業位置と非作業位置
との間で昇降可能であり、また前記車両に対して左右に
傾斜可能であるように、連結機構を介してトラクタ側に
連結されている。そして、作業機の昇降および傾斜動作
の始動・停止と、位置の制御は自動制御されることが多
い。(Prior Art) Generally, in a traveling work vehicle in which a work implement is attached to a vehicle such as a tractor, the work implement can be moved up and down between a work position and a non-work position, and can be moved left and right with respect to the vehicle. It is connected to the tractor side via a connecting mechanism so that it can be tilted. The starting/stopping of the lifting/lowering and tilting operations of the work equipment and the control of the position are often automatically controlled.
このような走行作業車の作業開始時のエンジン始動、あ
るいは作業時にエンストを生じ、その後、エンジンの再
始動を行った場合、前記作業機の昇降・傾斜の制御が自
動制御状態のままであると、エンジンの始動と同時に自
動制御が働いて、持上げておいた作業機が不測の下降動
作を開始したり、左右に傾動を開始したりするようなこ
とがあり得る。If the engine of such a mobile work vehicle is started at the start of work, or if the engine stalls during work and then the engine is restarted, if the control of the lifting and tilting of the work equipment remains in the automatic control state. There is a possibility that the automatic control is activated at the same time as the engine starts, causing the lifted work equipment to unexpectedly start lowering or tilting from side to side.
この問題に対し、特公昭5 8−2 6 9 2 6号
公報では、次のような装置が提案されている。To address this problem, Japanese Patent Publication No. 58-26926 proposes the following device.
該装置は、前記作業機の昇降制御が自動制御状態のまま
エンジンが始動された場合には、安全ロック回路が作動
セットされ、該安全ロック回路は、切換え機構を昇降の
中立状態へ切換えることにより、リセットされるように
構成されている。In this device, when the engine is started while the lifting control of the work equipment is in the automatic control state, the safety lock circuit is set to operate, and the safety lock circuit is activated by switching the switching mechanism to the neutral state of lifting. , is configured to be reset.
したがって、該切換え機構をリセットして、−旦、前記
自動制御状態が解除されるまでは、作業機の昇降自動制
御が行われない。Therefore, until the switching mechanism is reset and the automatic control state is canceled, the automatic control for raising and lowering the working machine is not performed.
(発明が解決しようとする問題点)
上記した従来の技術は、次のような問題点を有していた
。(Problems to be Solved by the Invention) The above-described conventional techniques had the following problems.
上記従来技術のような自動制御のインタロック機構を使
用する場合は、作業者による操作が、複雑になる傾向が
あり、上記従来技術に、作業機の左右傾動制御のインク
ロック機構が付加されたような制御装置では、操作はよ
り複雑になる。従って、必要な機能を満足しつつ、でき
るだけ操作は省力化されることが望まれる。When using an automatically controlled interlock mechanism such as the above conventional technology, the operation by the operator tends to be complicated. With such a control device, operation becomes more complex. Therefore, it is desired that the necessary functions be satisfied while the operation is as labor-saving as possible.
車両が大きな窪みに入って、傾斜状態のままエンジンが
停止し、該車両の傾きの度合いと、作業機の傾きの度合
いとが大きくずれているような場合に、エンジンが再始
動されて作業機の左右傾動制御が自動的に開始されると
、作業機は、前記傾きの度合いに応じて急激にその傾き
が補正されるため、作業機の傾動による車両の動揺は大
きく、特に、操縦者が前記左右傾動制御を予測していな
かった場合には違和感が大きい。If the vehicle enters a large pothole and the engine stops while the vehicle is tilted, and the degree of inclination of the vehicle and the degree of inclination of the work equipment are significantly different, the engine is restarted and the work equipment is When the left/right tilt control of the machine is automatically started, the tilt of the work equipment is rapidly corrected according to the degree of the tilt, so the tilting of the work equipment causes a large shake of the vehicle. If the left/right tilt control is not predicted, it will feel very strange.
本発明は、前述の問題点を解決するためになされたもの
である。The present invention has been made to solve the above-mentioned problems.
(問題点を解決するための手段および作用)前記の問題
点を解決するために本発明は、センサで検出した値をも
とに、左右傾動ストローク現在値を演算する現在値演算
器と、水平センサで検出した値をもとに、左右傾動制御
のストローク目標値を設定する目標値設定器と、前記ス
トローク現在値から前記ストローク目標値を演算する減
算器と、該減算器で算出された最新の値を、少なくとも
2回分記憶する記憶手段と、該記憶手段に記憶された2
回分の値の正負の符号を判別する符号判別手段と、作業
機の左右傾動制御を禁止する左右傾動制御禁止手段とを
具備し、前記符号判別手段で判別された2回分の記憶値
の正負の符号が異符号になった時点で、前記左右傾動制
御禁止手段を解除し、左右傾動制御を開始させるように
した点に特徴がある。(Means and operations for solving the problem) In order to solve the above problem, the present invention provides a current value calculator that calculates the current value of the left and right tilting stroke based on the value detected by the sensor, and a horizontal a target value setter that sets a stroke target value for left/right tilt control based on the value detected by the sensor; a subtracter that calculates the stroke target value from the current stroke value; storage means for storing the value of at least twice; and 2 values stored in the storage means.
It is equipped with a sign discriminating means for discriminating the positive or negative sign of the value for two times, and a left-right tilting control inhibiting means for prohibiting the left-right tilting control of the working machine, and the sign discriminating means for discriminating the positive or negative sign of the stored value for the two times determined by the sign discriminating means. The present invention is characterized in that, when the signs become different signs, the left/right tilting control inhibiting means is canceled and the left/right tilting control is started.
上記構成を有する本発明においては、作業機の左右傾動
制御中にエンジンが停止し、その後再び、エンジンを始
動させた場合、前記左右傾動制御のストローク目標値と
、ストローク現在値が略一致した後に、左右傾動制御禁
止手段を解除し、自動左右傾動制御を開始させるように
している。In the present invention having the above configuration, when the engine is stopped during left-right tilting control of the working machine and then started again, after the stroke target value of the left-right tilting control and the current stroke value substantially match, , the lateral tilting control inhibiting means is canceled and automatic lateral tilting control is started.
従って、前記窪みにはまって車両が大きく傾斜し、エン
ジンが停止したような場合には、エンジンの再始動後、
車両を少し走行させて車両の傾斜を立直し、ストローク
目標値を現在値に一致させるか、あるいはストローク目
標値を設定するつまみを操作して、ストローク目標値を
変更して現在値と一致させるかした後に、はじめて自動
左右傾動制御が再開される。Therefore, if the vehicle gets stuck in the pothole and tilts significantly and the engine stops, after restarting the engine,
Either run the vehicle for a short time to correct the vehicle's inclination and make the stroke target value match the current value, or operate the knob for setting the stroke target value to change the stroke target value to match the current value. Automatic left/right tilt control is restarted only after this.
(実施例) 以下に図面を参照して、本発明の詳細な説明する。(Example) The present invention will be described in detail below with reference to the drawings.
第7図は本発明を適用する走行作業車の側面図、第8図
は該走行作業車後部に連結された作業機と連結機構部の
要部を示す斜視図である。FIG. 7 is a side view of a traveling working vehicle to which the present invention is applied, and FIG. 8 is a perspective view showing the 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 lift arms 8 and 9 driven by the cylinder 7 are attached to the vehicle 1 side.
ロアーリンク5.6は、それぞれリフトロッド10.1
1を介してリフトアーム8,9に接続されているので、
作業機3は油圧シリンダ7の伸縮動作によって、昇降さ
れる。Lower links 5.6 and lift rods 10.1 respectively
Since it is connected to lift arms 8 and 9 via 1,
The work machine 3 is raised and lowered by the expansion and contraction operations of the hydraulic cylinder 7.
車両1には、回転型ポテンショメータで構成される水平
センサ12が設けられ、リフトロッド1iには該ロッド
を伸縮させる油圧シリンダ13とリフトロッド11の伸
縮量を検出する直線動作型ポテンショメータで構成され
るストロークセンサ14が設けられている。The vehicle 1 is provided with a horizontal sensor 12 that is made up of a rotary potentiometer, and the lift rod 1i is made up of a hydraulic cylinder 13 that expands and contracts the rod and a linear potentiometer that detects the amount of expansion and contraction of the lift rod 11. A stroke sensor 14 is provided.
そして、車両1がローリングしても、作業機3は地面に
対して水平、または水平から所定の角度を有した対地姿
勢に保持されるように、水平センサ12によって検出さ
れた車両1の傾きの程度に応じて、伸縮量をストローク
センサ14により監視しながら、油圧シリンダ13を駆
動制御できるようにしている。The tilt of the vehicle 1 detected by the horizontal sensor 12 is adjusted so that even if the vehicle 1 rolls, the work equipment 3 is maintained horizontally with respect to the ground or at a predetermined angle from the horizontal. Depending on the extent, the hydraulic cylinder 13 can be driven and controlled while the amount of expansion and contraction is monitored by the stroke sensor 14.
作業機3が地面に対して、水平から所定の角度を有して
保持されるように制御する場合は、設定つまみ(図示し
ない)により所定値を設定し、前記水平センサ12の検
出値を該所定値により補正して傾動目標値とすることで
達成できる。When controlling the work equipment 3 to be held at a predetermined angle from the horizontal with respect to the ground, a predetermined value is set using a setting knob (not shown), and the detection value of the horizontal sensor 12 is set to the corresponding value. This can be achieved by correcting the tilting target value using a predetermined value.
リフトアーム8,9には、そのリフト角度を検出する回
転型ポテンショメータで構成されるリフトセンサ15が
設けられており、そのセンサ出力に応じて作業機3の非
作業位置への上昇および作業位置への下降の制御を行わ
せることができる。The lift arms 8 and 9 are provided with a lift sensor 15 composed of a rotary potentiometer that detects the lift angle, and the work equipment 3 is raised to a non-working position and returned to a working position according to the sensor output. It is possible to control the lowering of the
一方、作業機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を駆動し、耕うんの深さを設定値に保持させ
る、耕深制御をすることができる。According to the output of the pillar sensor 18A, the hydraulic cylinder 7 is driven to maintain the tilling depth at a set value, thereby controlling the tilling depth.
車両1には操縦者の座席17が設けられ、該座席の近傍
には作業機3の昇降を手動によって制御する操作スイッ
チ18が設けられている。The vehicle 1 is provided with an operator's seat 17, and an operation switch 18 for manually controlling the elevation and descent of the working machine 3 is provided near the seat.
前記操作スイッチ18の位置による作業機3の動作を第
6図を参照して説明する。The operation of the working machine 3 depending on the position of the operation switch 18 will be explained with reference to FIG.
操作スイッチ18は、下降側位置Aと上昇側位置りの範
囲内で操作される。操作スイッチ18が、N位置では作
業機3の昇降は停止される中立状態であり、AおよびB
位置では作業機3は下降し、CおよびD位置では作業機
3は上昇する。The operation switch 18 is operated within a range between a lower position A and an upper position. When the operation switch 18 is in the N position, the work equipment 3 is in a neutral state where the lifting and lowering is stopped, and
In the position C and D the working implement 3 is lowered, and in the C and D positions the working implement 3 is raised.
操作スイッチ18はどの位置に動かしても、操縦者が手
を離すと中立位置Nに戻る。しかし、AおよびD位置で
は、該スイッチ18がN位置に戻っても作業機3の昇降
は停止しない。No matter which position the operating switch 18 is moved to, it returns to the neutral position N when the operator releases his/her hand. However, in the A and D positions, the lifting and lowering of the work implement 3 does not stop even if the switch 18 returns to the N position.
すなわち、操作スイッチ18が−HA位置に操作される
と、作業機3は最下降位置に下降するまで停止しないし
、またD位置に操作されると、作業機3は最上昇位置に
上昇するまで停止しない。That is, when the operation switch 18 is operated to the -HA position, the work equipment 3 does not stop until it descends to the lowest position, and when it is operated to the D position, the work equipment 3 does not stop until it rises to the highest position. Do not stop.
第1図に、このような走行作業車における電気制御系統
のブロック図を示す。FIG. 1 shows a block diagram of an electrical control system in such a traveling work vehicle.
ここでは、車両1に対する作業機3の高さを制御する、
昇降制御駆動部の制御機能を停止させる手段と、作業機
3を車両1に対して左右に傾動させ左右傾動制御する、
左右傾動制御駆動部の制御機能を停止させる手段とを、
左右傾動ストローク目標値に対するストローク現在値の
偏差の程度、または操作スイッチの位置を条件に解除す
るようにしている。Here, the height of the working machine 3 with respect to the vehicle 1 is controlled.
means for stopping the control function of the elevation control drive unit; and controlling the horizontal tilting by tilting the work implement 3 to the left and right with respect to the vehicle 1;
means for stopping the control function of the left-right tilt control drive unit;
The release is conditioned on the degree of deviation of the current stroke value from the left/right tilting stroke target value or the position of the operation switch.
第1図において、左右傾動ストロークの現在値が、スト
ロークセンサ14で検出された検出結果をもとに、現在
値演算器19によって演算され、左右傾動制御の左右傾
動目標値は、水平センサ12で検出された検出結果をも
とに、目標値設定器20に設定される。In FIG. 1, the current value of the left-right tilt stroke is calculated by the current value calculator 19 based on the detection result detected by the stroke sensor 14, and the left-right tilt target value of the left-right tilt control is calculated by the horizontal sensor 12. The target value is set in the target value setting device 20 based on the detected detection result.
左右傾動制御の左右傾動目標値は、水平センサ12の検
出値から、例えば次のように設定される。The left-right tilt target value for the left-right tilt control is set, for example, as follows from the detected value of the horizontal sensor 12.
車両1が、鉛直から角度α傾斜した場合、該車両1に連
結されている作業機3も、同様に角度αだけ傾斜する。When the vehicle 1 is tilted by an angle α from the vertical, the work implement 3 connected to the vehicle 1 is also tilted by the angle α.
この場合、作業機3を左右に傾動させて水平姿勢に保持
するには、車両1の傾斜方向と反対に、作業機3を角度
αだけ傾動させればよい。In this case, in order to tilt the work implement 3 left and right and hold it in a horizontal position, the work implement 3 may be tilted by an angle α in the opposite direction to the tilt direction of the vehicle 1.
水平センサ12は車両1に搭載されているので、該水平
センサ12により、車両1自体の傾斜角度が検出できる
。従って、作業機3を左右に傾動させて水平姿勢に保持
するときの左右傾動目標値としては、水平センサ12の
検出値の正負符号を反転させた値が設定される。Since the horizontal sensor 12 is mounted on the vehicle 1, the tilt angle of the vehicle 1 itself can be detected by the horizontal sensor 12. Therefore, a value obtained by inverting the sign of the detected value of the horizontal sensor 12 is set as the horizontal tilting target value when the working machine 3 is tilted left and right and held in a horizontal posture.
左右傾動制御は、上記水平姿勢制御に限らず、作業機3
を、水平から任意の角度βの姿勢に保持させる場合もあ
る。この場合には、前記角度βを、設定つまみにより設
定しておき、前記水平センサ12による検出値αに、該
角度βを加算した値を左右傾動目標値として設定すれば
よい。The horizontal tilt control is not limited to the above-mentioned horizontal posture control, but the work equipment 3
may be held at an arbitrary angle β from the horizontal. In this case, the angle β may be set using a setting knob, and the value obtained by adding the angle β to the value α detected by the horizontal sensor 12 may be set as the left/right tilting target value.
なお、直線動作型のポテンショメータで構成されるスト
ロークセンサ14の検出値は、回転型ポテンショメータ
で構成された設定つまみ、および回転型ポテンショメー
タに連動された、振子の揺動量から左右の傾斜量を検出
するよう構成された水平センサ12の検出値をもとに設
定された、前記傾動目標値と比較できるように、前記現
在値演算器19で換算されて、作業機3の左右傾動現在
値として扱われる。Note that the detection value of the stroke sensor 14, which is made up of a linear action type potentiometer, detects the amount of left and right inclination based on the setting knob made up of a rotary type potentiometer, and the amount of swing of a pendulum, which is linked to the rotary type potentiometer. The current value is converted by the current value calculator 19 so that it can be compared with the tilt target value, which is set based on the detected value of the horizontal sensor 12 configured as shown in FIG. .
減算器21では、前記現在値から前記目標値が減算され
、その結果がA記憶部22に格納される。In the subtracter 21, the target value is subtracted from the current value, and the result is stored in the A storage section 22.
前記A記憶部22に最新の減算結果が入力されると、前
記A記憶部22の記憶内容はB記憶部23に転送される
。そして、前記記憶部A、Bの値は、その正負符号の異
同が判別手段24で判別される。When the latest subtraction result is input to the A storage section 22, the stored contents of the A storage section 22 are transferred to the B storage section 23. Then, the values in the storage units A and B are determined by the determining means 24 as to whether the positive or negative signs thereof are different.
さらに、減算器21の減算結果は傾斜保護不感帯(RO
M値)と、傾斜保護不感帯比較手段40で比較される。Furthermore, the subtraction result of the subtractor 21 is the slope protection dead zone (RO
M value) is compared with the slope protection dead zone comparison means 40.
なお、前記減算結果は、A記憶部とB記憶部に交互に格
納するようにしても良い。Note that the subtraction results may be stored alternately in the A storage section and the B storage section.
左傾斜用バルブ25と、右傾斜用バルブ26を、後述す
るタイムテーブルに従ってオン・オフ動作させ、油圧シ
リンダ13を伸縮させて、作業機3の左右傾動制御を行
う左右傾動制御駆動部27は、左右傾動制御禁止手段2
8によって、インクロックされている。The left-right tilt control drive section 27 controls the left-right tilt of the working machine 3 by turning on and off the left-tilting valve 25 and the right-tilting valve 26 according to a timetable described later, and expanding and contracting the hydraulic cylinder 13. Left/right tilt control prohibition means 2
8, the ink is locked.
そして、該左右傾動制御禁止手段28によるインタロツ
タは、前記符号判別手段24の判別結果により、解除さ
れる。前記左右傾動制御禁止手段28は、後述するよう
に操作スイッチ18の位置を操作することによってもイ
ンタロック解除される。Then, the interlock caused by the left/right tilting control inhibiting means 28 is canceled according to the determination result of the code determining means 24. The interlock of the left/right tilting control inhibiting means 28 is also released by operating the position of the operation switch 18, as will be described later.
上昇用バルブ29と、下降用バルブ30を、後述するタ
イムテーブルに従ってオン・オフ動作させ、油圧シリン
ダ7を伸縮させて、作業機3の高さ位置制御を行う昇降
制御駆動部31は、昇降制御禁止手段32によってイン
クロックされている。The elevation control drive section 31 controls the height position of the working machine 3 by turning on and off the ascending valve 29 and the descending valve 30 according to a timetable described later, and expands and contracts the hydraulic cylinder 7. The ink is locked by the inhibiting means 32.
該昇降制御禁止手段32によるインタロックは、操作ス
イッチ18がNの位置に動かされることによって解除さ
れる。The interlock by the elevation control inhibiting means 32 is released by moving the operation switch 18 to the N position.
なお、上限比較手段36において、前記左右傾動現在値
と、ストローク上限設定器33に設定された油圧シリン
ダ13のストローク上限値が比較され、一方、下限比較
手段37において、前記左右傾動現在値と、ストローク
下限設定器34に設定されたストローク下限値が比較さ
れる。Note that the upper limit comparing means 36 compares the current horizontal tilt value with the stroke upper limit value of the hydraulic cylinder 13 set in the stroke upper limit setting device 33, while the lower limit comparing means 37 compares the current horizontal tilt value with the current horizontal tilt value. The stroke lower limit value set in the stroke lower limit setter 34 is compared.
前記比較手段38.37の比較の結果により、前記スト
ローク現在値が、ストローク上限値を超過している場合
には、ゲート38が開かれて、前記ストローク現在値が
、ストローク上限値に入れ換えられ、前記ストローク現
在値が、ストローク下限値を下回っている場合には、ゲ
ート38が開かれて、前記ストローク現在値がストロー
ク下限値に入れ換えられる。If the comparison result of the comparison means 38.37 indicates that the current stroke value exceeds the upper limit stroke value, the gate 38 is opened and the current stroke value is replaced with the upper limit stroke value; If the current stroke value is below the lower stroke limit, the gate 38 is opened and the current stroke value is replaced by the lower stroke limit.
以上を要約すれば、本実施例では、作業機3の左右傾動
制御駆動部27のインタロックは、目標値設定器20で
設定された左右傾動ストローク目標値に対する、現在値
演算器19で演算されたストローク現在値の偏差の正負
符号判別結果、または前記偏差と前記傾斜保護不感帯と
の比較結果、または操作スイッチの位置操作により解除
される。To summarize the above, in this embodiment, the interlock of the lateral tilting control drive section 27 of the work equipment 3 is calculated by the current value calculator 19 with respect to the lateral tilting stroke target value set by the target value setting device 20. It is canceled by the result of determining the sign of the deviation of the current stroke value, the result of comparing the deviation with the slope protection dead zone, or by operating the position of the operation switch.
昇降制御駆動部31のインタロックは、操作スイッチの
N位置により解除される。The interlock of the elevation control drive unit 31 is released by setting the operation switch to the N position.
従って、本発明においては、エンジンが始動された時に
不測の左右傾動制御、または昇降制御が開始されること
はない。Therefore, in the present invention, when the engine is started, unexpected left/right tilt control or elevation control is not started.
前記左傾斜用バルブ25.右傾斜用バルブ26゜上昇用
バルブ29.下降用バルブ30は、予め設定された周期
毎に、後述する計算テーブルで計算されたオン時間だけ
オン動作され、前記油圧シリンダ7.13を駆動する。Said left tilt valve 25. Valve for right tilt 26° Valve for elevation 29. The lowering valve 30 is turned on every preset cycle for an on-time period calculated using a calculation table to be described later, and drives the hydraulic cylinder 7.13.
第5図に、前記オン時間のタイムチャートを示す。前記
バルブ25,26,29.30は、同図に示すように、
オン・オフが繰返されて間欠動作が行われている。FIG. 5 shows a time chart of the on-time. As shown in the figure, the valves 25, 26, 29.30 are
Intermittent operation is performed by repeatedly turning on and off.
従って、各周期fにおけるオン時間ONの比率が大きい
ほど、連続動作に近くなるので、油圧シリンダ7.13
の平均的な駆動速度は速くなり、オン時間ONの比率が
小さくなると、間欠動作は顕著となり、油圧シリンダ7
.13の平均的な尽区動速度は遅くなる。Therefore, the larger the ratio of on-time ON in each period f, the closer to continuous operation, so the hydraulic cylinder 7.13
As the average driving speed of the hydraulic cylinder 7 becomes faster and the ratio of ON time becomes smaller, the intermittent operation becomes more noticeable, and the hydraulic cylinder 7
.. 13, the average exhaustion speed becomes slower.
第4図に、前記オン時間と偏差の関係図を示す。FIG. 4 shows a diagram of the relationship between the on-time and the deviation.
同図において、横軸は、ストローク上限値、またはスト
ローク下限値に対するストローク現在値の偏差、縦軸は
前記オン時間である。In the figure, the horizontal axis represents the deviation of the current stroke value from the stroke upper limit value or the stroke lower limit value, and the vertical axis represents the on-time.
オン時間と偏差の関係は曲線S1またはS2のように定
めることができる。不感帯P以上に偏差が大きくなると
、該偏差と対応する曲線S1またはS2の関係にあるオ
ン時間だけ前記バルブ25゜26.29.30がすン動
作される。The relationship between on-time and deviation can be defined as curve S1 or S2. When the deviation becomes larger than the dead zone P, the valve 25.degree.
曲線S1の関係では、オン時間は偏差が〜Iになるまで
大きくなり、偏差がM以下の範囲では、前記バルブはオ
ン時間に従って間欠的にオン動作され、偏差がM以上で
は昇降バルブのオン動作は連続される。In the relationship of curve S1, the on-time increases until the deviation reaches ~I, and in the range where the deviation is less than or equal to M, the valve is intermittently turned on according to the on-time, and when the deviation is greater than or equal to M, the lift valve is turned on. are continuous.
曲線S2の関係では、偏差の大きさによって2段階のオ
ン時間が設定できるようになっている。In the relationship of curve S2, two stages of on-time can be set depending on the magnitude of the deviation.
曲線S1または曲線S2のいずれを選択するかは任意で
ある。It is arbitrary to select either the curve S1 or the curve S2.
第4図に示したテーブルは、昇降用と左右傾動用が準備
され、昇降用としては、上昇用と下降用がそれぞれ別々
に準備されて計算テーブル39に記憶されているが、上
昇用と下降用とも同一タイムテーブルを使用することも
できる。The table shown in FIG. 4 is prepared for lifting and lowering. You can also use the same timetable for both.
上述のように、ストローク目標値に対してストローク現
在値が大きくずれているときは、油圧シリンダの駆動速
度が速く、ストローク目標値に対するストローク現在値
のずれが少なくなってきたら前記駆動速度が遅くなるよ
うにしているので、作業機3の昇降および左右傾動後の
油圧シリンダ駆動停止時に生じる衝撃と、オーバランが
低減てきる。As described above, when the current stroke value deviates significantly from the stroke target value, the driving speed of the hydraulic cylinder is fast, and when the deviation of the current stroke value from the stroke target value decreases, the driving speed slows down. This reduces the impact and overrun that occur when the hydraulic cylinder drive is stopped after the working machine 3 is raised and lowered and tilted left and right.
次に、第2図および第3図のフローチャートを参照して
、本実施例の制御フローを詳細に説明する。Next, the control flow of this embodiment will be explained in detail with reference to the flowcharts of FIGS. 2 and 3.
同図において、イニシャルフラグは、作業機3の昇降を
行うための油圧シリンダ7を駆動する上昇用バルブ29
と下降用バルブ30のオン時間を計算するか、オン時間
を計算しないでオン時間に“0”をセットするかの判別
を行うフラグである。In the figure, the initial flag indicates the lifting valve 29 that drives the hydraulic cylinder 7 for lifting and lowering the working machine 3.
This is a flag for determining whether to calculate the on time of the descending valve 30 or to set "0" to the on time without calculating the on time.
また、水平禁止フラグは、作業機3の左右傾動を行うた
めの油圧シリンダ13を駆動する左傾斜用バルブ25と
右傾斜用バルブ26のオン時間を計算するか、オン時間
を計算しないでオン時間に“0”をセットするかの判別
を行うフラグである。In addition, the horizontal prohibition flag can be set by calculating the ON time of the left tilting valve 25 and the right tilting valve 26 that drive the hydraulic cylinder 13 for horizontally tilting the work equipment 3, or by calculating the ON time without calculating the ON time. This flag is used to determine whether to set "0" to "0".
そして、前記2つのフラグは、制御電源の起動時にはセ
ット状態にある。The two flags are set when the control power source is activated.
まず、エンジンが停止状態かどうかの判断(ステップS
l)で、エンジンが停止していると、該ステップS1の
判断は肯定で、イニシャルフラグと水平禁止フラグがセ
ットされ(ステップS2)、ATT制御処理(ステップ
519)が実行され、プログラムの最初に戻る。First, it is determined whether the engine is stopped (step S
In l), if the engine is stopped, the judgment in step S1 is affirmative, the initial flag and the horizontal prohibition flag are set (step S2), the ATT control process (step 519) is executed, and the program is started at the beginning of the program. return.
この場合、ATT制御処理(ステップ519)は第3図
のように処理される。In this case, the ATT control process (step 519) is performed as shown in FIG.
第3図において、イニシャルフラグはステップS2にお
いてセットされたので、イニシャルフラグが“0”か“
1”かの判断(ステップ3191)は“1”となり、作
業機3の1周期あたりの昇降オン時間に“O”がセット
される(ステップ5192)。In FIG. 3, the initial flag was set in step S2, so whether the initial flag is "0" or "
1" (step 3191) becomes "1", and "O" is set as the elevating/lowering on time per cycle of the working machine 3 (step 5192).
水平禁止フラグもステップS2でセットされたので、水
平禁止フラグが“1”か“0”かの判断(ステップ51
94))は“1”となり、作業機3の左右傾動オン時間
に“02がセットされる(ステップ5195)。Since the horizontal prohibition flag was also set in step S2, it is determined whether the horizontal prohibition flag is "1" or "0" (step S51).
94)) becomes "1", and "02" is set as the left/right tilt ON time of the working machine 3 (step 5195).
従って、第2図のステップS1において、エンジンが停
止されている場合は、上昇用バルブ29゜下降用バルブ
30.左傾斜用バルブ25.右傾斜用バルブ26のオン
時間はいずれも“0”であり、作業機3は昇降制御も左
右傾動制御も行われない。Therefore, in step S1 of FIG. 2, if the engine is stopped, the ascending valve 29 and the descending valve 30. Valve for left tilt 25. The ON time of the right tilting valve 26 is "0" in both cases, and the working machine 3 is not controlled to move up and down nor to control its left and right tilting.
エンジンが始動されると、ステップS1の判断は否定と
なって、ステップS3に進み、イニシャルフラグの状態
が判別される。When the engine is started, the determination in step S1 is negative, and the process proceeds to step S3, where the state of the initial flag is determined.
エンジン停止時にイニシャルフラグはステップS’2で
セットされた状態のままなので、“1”の判別がなされ
、操作スイッチ18が中立位置N(第6図参照)にある
か否かが判断される(ステップS4)。Since the initial flag remains in the state set in step S'2 when the engine is stopped, it is determined to be "1", and it is determined whether or not the operation switch 18 is in the neutral position N (see Fig. 6). Step S4).
操作スイッチ18がN位置にある場合は、イニシャルフ
ラグはクリアされる(ステップS5)。When the operation switch 18 is in the N position, the initial flag is cleared (step S5).
イニシャルフラグ力(クリアされると、ATT制御処理
における、ステップ5191の判別は“0”となって、
作業機3の昇降オン時間計算が行われる(ステップ31
93)。Initial flag force (when cleared, the determination in step 5191 in the ATT control process becomes "0",
The elevating and lowering on time of the work equipment 3 is calculated (step 31
93).
オン時間計算は前記第4図の計算テーブルに基づいて行
われる。The on-time calculation is performed based on the calculation table shown in FIG. 4 above.
一旦イニシャルフラグがクリアされると、エンジンが停
止しない限りイニシャルフラグはセットされないので、
前記昇降オン時間の計算は繰返し行われる。Once the initial flag is cleared, it will not be set unless the engine is stopped.
The calculation of the lift-on time is performed repeatedly.
その後、改めて操作スイッチ18を、中立位置N以外の
位置に動かすと、該スイッチ18の位置に応じ、前記昇
降オン時間計算の結果に従い、上昇用バルブ29と下降
用バルブ30のオン・オフ動作が行われ、作業機3は昇
降される。Thereafter, when the operation switch 18 is moved to a position other than the neutral position N, the on/off operations of the ascending valve 29 and descending valve 30 are performed according to the position of the switch 18 and the result of the above-mentioned elevation ON time calculation. The working machine 3 is raised and lowered.
ステップS8の判別では、水平禁止フラグの状態が#1
#であるので、次に左右傾動ストローク現在値がストロ
ーク上限STMAXを越えているか否かが判断される(
ステップS9)。前記ストローク現在値が、ストローク
上限を越えていると、前記ストローク現在値がストロー
ク上限と入れ換えられ(ステップ510)、ステップ5
13に進む。In the determination in step S8, the state of the horizontal prohibition flag is #1.
#, so next it is determined whether the current value of the left/right tilting stroke exceeds the stroke upper limit STMAX (
Step S9). If the current stroke value exceeds the upper stroke limit, the current stroke value is replaced with the upper stroke limit (step 510), and step 5
Proceed to step 13.
ストローク現在値がストローク上限を越えていないと、
前記ステップS9の判断は否定となり、前記ストローク
現在値がストローク下限STMINを下回っているか否
かが判断される(ステップ511)。If the current stroke value does not exceed the stroke upper limit,
The determination in step S9 is negative, and it is determined whether the current stroke value is below the stroke lower limit STMIN (step 511).
前記ストローク現在値がストローク下限を下回っている
と、前記ストローク現在値が、ストローク下限と入れ換
えられ(ステップ512)、ステップS13に進む。If the current stroke value is below the lower stroke limit, the current stroke value is replaced with the lower stroke limit (step 512), and the process proceeds to step S13.
ここで、ストローク目標値がストローク上限値とストロ
ーク下限値の範囲内でしか設定できないようにされてい
る場合に、作業機3がオーバラン状態で停止していて、
ストローク現在値がストローク上限値と、ストローク下
限値との範囲外にあって、該上限値あるいは下限値から
傾斜保護不感帯以上にオーバーしていると、ストローク
目標値とストローク現在値を略一致させることができな
゛いことがある。Here, if the stroke target value can only be set within the range of the stroke upper limit value and the stroke lower limit value, and the work equipment 3 is stopped in an overrun state,
If the current stroke value is outside the range of the stroke upper limit value and the stroke lower limit value and exceeds the upper limit value or the lower limit value by more than the slope protection dead zone, the stroke target value and the current stroke value should be made to substantially match. There are some things that I can't do.
したがって、ストローク上限値またはストローク下限値
を、前述のようにストローク現在値に置換えることで、
ストローク目標値をストローク現在値に略一致できない
問題点を排除している。Therefore, by replacing the stroke upper limit value or stroke lower limit value with the current stroke value as described above,
This eliminates the problem that the stroke target value cannot substantially match the current stroke value.
前記ストローク現在値が、前記ストローク上限と、スト
ローク下限の範囲内にある場合は、ステップSIOとス
テップS12はスキップされてステップS13に進む。If the current stroke value is within the range between the stroke upper limit and the stroke lower limit, step SIO and step S12 are skipped and the process proceeds to step S13.
該ステップS13では、ストローク現在値からストロー
ク目標値が減算され、A記憶部に格納される。In step S13, the stroke target value is subtracted from the current stroke value and stored in the A storage section.
前記A記憶部に格納された値は、その絶対値と、予めR
OMデータとして設定されている、傾斜保護不感帯とが
比較される(ステップ514)。A記憶部の値が、前記
傾斜保護不感帯の範囲内であると、ステップS14の判
断は肯定となって、水平禁止フラグはクリアされる(ス
テップ818)。The value stored in the A storage section is the absolute value and R
A slope protection dead zone set as OM data is compared (step 514). If the value in the A storage section is within the tilt protection dead zone, the determination in step S14 is affirmative, and the horizontal prohibition flag is cleared (step 818).
その結果、前記ATT制御処理(ステ・ンプ519)に
おいて、左右傾斜用バルブのオン時間が計算され(ステ
ップS 196) 、左右傾動制御が開始される。As a result, in the ATT control process (Step 519), the ON time of the left/right tilting valve is calculated (Step S196), and the left/right tilting control is started.
一方、A記憶部の値が、前記傾斜保護不感帯の範囲外で
あると、ステップS14の判断は否定となって、ステッ
プS15に進み、該ステップS15が初めて処理される
か否かが判断される。On the other hand, if the value in the A storage section is outside the range of the slope protection dead zone, the determination in step S14 is negative, and the process proceeds to step S15, where it is determined whether or not step S15 is to be processed for the first time. .
第1回口の処理であれば、まだ水平禁止フラグはクリア
されていないので、前記ATT処理(ステップ519)
における左右オン時間は“0”であり、左右傾動制御は
行われない。If it is the first processing, the horizontal prohibition flag has not been cleared yet, so the ATT processing (step 519) is performed.
The left and right ON time in is "0", and left and right tilting control is not performed.
第2回目以降のプログラムの実行で、ステップS15の
判断は否定となり、前回A記憶部に格納されていた値が
、B記憶部に転送され(ステップ516)、今回のA記
憶部の値と、B記憶部の値の正負の符号が同符号か否か
が判断される(ステップ517)。A、B記憶部は、例
えばシフトレジスタで構成できる。In the second and subsequent executions of the program, the determination at step S15 becomes negative, and the value previously stored in the A storage section is transferred to the B storage section (step 516), and the current value in the A storage section is transferred to the B storage section (step 516). It is determined whether the positive and negative signs of the values in the B storage section are the same (step 517). The A and B storage units can be configured with shift registers, for example.
A記憶部22の値と、B記憶部23の値が同符号の場合
、すなわち、A記憶部22に格納されている最新のデー
タと、B記憶部23に格納されている1サイクル前のデ
ータにおける、ストローク現在値とストローク目標値の
大小関係が変化しなかった場合は、水平禁止フラグはク
リアされないで、ATT制御処理(ステップ519)が
行われる。When the value in the A storage section 22 and the value in the B storage section 23 have the same sign, that is, the latest data stored in the A storage section 22 and the data stored in the B storage section 23 one cycle before. If the magnitude relationship between the current stroke value and the target stroke value does not change in , the horizontal prohibition flag is not cleared and the ATT control process (step 519) is performed.
このとき、水平禁止フラグはクリアされていないので、
ステップ8196の左右オン時間計算は、実行されず、
したがって、左右傾動制御は行われない。At this time, the horizontal prohibition flag is not cleared, so
The left and right on time calculations in step 8196 are not performed;
Therefore, left-right tilt control is not performed.
A記憶部22に格納されている最新のデータと、B記憶
部23格納されている1サイクル前のデータにおける、
ストローク現在値とストローク目標値の大小関係が反転
し、A記憶部22のデータとB記憶部23のデータが異
符号になった場合、すなわち、1サイクル前のデータを
読込んだ後、最新のデータが読込まれる間にストローク
目標値とストローク現在値が一致する瞬間があったと判
断された場合は、ステップ818で水平禁止フラグがク
リアされる。In the latest data stored in the A storage section 22 and the data stored in the B storage section 23 one cycle ago,
If the magnitude relationship between the current stroke value and the target stroke value is reversed and the data in the A storage section 22 and the data in the B storage section 23 have different signs, that is, after reading the data one cycle ago, the latest If it is determined that there was a moment when the stroke target value and the current stroke value matched while the data was being read, the horizontal prohibition flag is cleared in step 818.
その結果、前述と同様に、ATT制御処理(ステップ5
19)において、左右傾動制御か開始される。As a result, the ATT control process (step 5
In step 19), the left/right tilting control is started.
更に、左右傾動制御は、操作スイッチ18の位置を動か
すことによっても開始される。即ち、イニシャルフラグ
がクリアされると、前記ステップS3の判別は“0″に
なるので、再び操作スイッチ18が中立位置Nにあるか
否かが判断される(ステップS6)。Furthermore, the left-right tilt control is also started by moving the position of the operation switch 18. That is, when the initial flag is cleared, the determination in step S3 becomes "0", so it is determined again whether or not the operation switch 18 is in the neutral position N (step S6).
操作スイッチ18がN位置から他に動かされていると、
水平禁止フラグはクリアされ(ステップS7)、第3図
のATT制御処理における、水平禁止フラグの状態判別
(ステップS 194)は、“0#となって、作業機3
の左右傾動オン時間が計算される(ステップ8196)
。If the operation switch 18 is moved from the N position,
The horizontal prohibition flag is cleared (step S7), and the state determination of the horizontal prohibition flag (step S194) in the ATT control process in FIG.
The left/right tilt on time of is calculated (step 8196).
.
作業機3は、水平センサ12の検出結果に基づいて設定
されている目標値に、ストロークセンサで検出される現
在値を近付けるように左右傾動制御される。The working machine 3 is controlled to tilt laterally so that the current value detected by the stroke sensor approaches the target value set based on the detection result of the horizontal sensor 12.
そして、該左右傾動制御の際の左右傾動速度は、ステッ
プ5196の左右傾動オン時間計算結果に従い、前記目
標値に対する偏差が大きい場合は速く、該偏差が小さく
なると遅くなるように制御される。Then, the left-right tilt speed during the left-right tilt control is controlled so that it is fast when the deviation from the target value is large, and slow when the deviation is small, according to the calculation result of the left-right tilt on time in step 5196.
本実施例によれば、上述の説明から明らかなように、作
業機の昇降制御は、エンジン始動後、操作スイッチが、
中立位置に動かされた後でないと開始されない。まル、
作業機の左右傾動制御は、操作スイッチが、中立位置か
ら昇降動作位置に動かされた後でないと、開始されない
。According to the present embodiment, as is clear from the above description, the lifting and lowering control of the work equipment is performed by pressing the operation switch after starting the engine.
It will not start until after it has been moved to a neutral position. Maru,
The left/right tilt control of the working machine is not started until after the operation switch is moved from the neutral position to the lifting operation position.
ただし、左右傾動制御に関しては、ストローク目標値に
対するストローク現在値の偏差が、傾斜保護不感帯の範
囲内であれば、エンジンが始動すると、左右傾動制御が
自動的に開始されるようにしである。However, regarding the left-right tilt control, if the deviation of the current stroke value from the stroke target value is within the tilt protection dead zone, the left-right tilt control is automatically started when the engine is started.
一方、左右傾動ストロークの現在値が、ストローク目標
値に対して、傾斜保護不感帯以上に大きくずれているよ
うな場合には、エンジンが始動されて、いきなり作業機
の左右傾動篩が開始されることはなく、前記左右傾動ス
トローク現在値が前記゛傾斜保護不感帯の範囲に入るよ
うにとストローク目標値を変更した後に左右傾動制御が
開始されるようにしている。On the other hand, if the current value of the horizontal tilting stroke deviates from the stroke target value by more than the tilt protection dead zone, the engine will be started and the horizontal tilting stroke of the work equipment will suddenly start. Rather, the left-right tilt control is started after the stroke target value is changed so that the current value of the left-right tilt stroke falls within the range of the tilt protection dead zone.
すなわち、本実施例では、昇降制御の始動のインクロッ
クは、操作スイッチの中立位置への切り換えによって解
除され、左右傾動制御の始動のインクロックは、その孝
の操作スイッチの中立以外の位置への切り換え、または
ストローク目標値の変更で解除されるようにしである。That is, in this embodiment, the ink lock for starting the lift control is released by switching the operating switch to the neutral position, and the ink lock for starting the left/right tilting control is released by switching the operating switch to a position other than neutral. It is designed to be canceled by switching or changing the stroke target value.
更に、ストローク目標値の変更による左右傾動制御のイ
ンタロック解除は、作業機の傾斜度合により、自動的に
行われる場合と、人為的に操作して行う場合に分け、な
るべく、不必要な手動操作を排除できるようにしている
。Furthermore, the release of the interlock of the left/right tilting control due to a change in the stroke target value is divided into cases where it is performed automatically and cases where it is performed manually depending on the degree of inclination of the work equipment, and where possible unnecessary manual operations are avoided. This makes it possible to eliminate
そして、前記左右傾動ストローク現在値が、記傾斜保護
不感帯の範囲内に入るようにストローク目標値を変更す
るには、走行車両を走行させて、該車両の傾きを立直し
て、水平センサ12の出力信号によりストローク目標値
を変更させるか、ストローク目標値の設定つまみを操作
してストローク目標値を変更させる手段が取られる。Then, in order to change the stroke target value so that the current horizontal tilting stroke value falls within the range of the tilt protection dead zone, the vehicle is driven, the tilt of the vehicle is corrected, and the horizontal sensor 12 is adjusted. Means is taken to change the stroke target value using the output signal or by operating a stroke target value setting knob.
(発明の効果)
以上の説明から明らかなように、本発明によれば、次の
ような効果が達成できる。(Effects of the Invention) As is clear from the above description, according to the present invention, the following effects can be achieved.
(1)エンジン始動時に、操縦者が意識的に操作スイッ
チを動かさない限り、作業機が不測の左右傾斜動作を開
始することがない。(1) When starting the engine, unless the operator consciously moves the operation switch, the work equipment will not start unexpectedly tilting left or right.
(2)エンジン始動前の作業機の傾斜度合いが小さい場
合は、左右傾動制御のインタロックが自動的に解除でき
るので、無駄な手動操作が排除され操作性が向上する。(2) If the degree of inclination of the work equipment is small before starting the engine, the interlock of left and right tilting control can be automatically released, eliminating unnecessary manual operations and improving operability.
(3)エンジン始動前の作業機の傾斜度合いが大きい場
合は、走行車両を走らせて走行車両の姿勢を立直し、自
動的に左右傾動制御のインタロックを解除させることも
できるし、設定つまみを操作して手動で解除することも
できるので、操縦者は作業中の状況に応じて、より容易
な手段を選択して作業を行なえる。(3) If the degree of inclination of the work equipment is large before starting the engine, you can run the vehicle to correct its position and automatically release the left/right tilt control interlock. Since it can also be operated and manually released, the operator can select an easier method to perform the work depending on the situation during work.
第1図は本発明の一実施例を示す制御装置のブロック図
、第2図は第1図の制御装置の動作フローチャート、第
3図はオン時間計算のフローチャート、第4図はオン時
間計算の関係図、第5図はオン時間タイムチャート、第
6図は作業機の操作スイッチの概要図、第7図は走行作
業車の側面図、第8図は走行作業車後部に連結された作
業機およ゛び連結部の斜視図である。
1・・・走行車両、2・・・連結機構部、3・・・対地
作業機、7.13・・・油圧シリンダ、14・・・スト
ロークセンサ、15・・・水平センサ、18・・・操作
スイッチ、19・・・現在値演算器、20・・・目標値
設定器、21・・・減算器、22・・・A記憶部、23
・・・B記憶部、24・・・符号判別手段、28・・・
左右傾動制御禁止手段
代理人 弁理士 平木通人 外18
第 2 m(そ の 1)
第 3 図
第 4 図
第 5 図
第 6 図
第・7 図
第8図
手続補正書(自発)
昭和62年11月27日Fig. 1 is a block diagram of a control device showing an embodiment of the present invention, Fig. 2 is an operation flowchart of the control device shown in Fig. 1, Fig. 3 is a flowchart of on-time calculation, and Fig. 4 is a flowchart of on-time calculation. Relationship diagram, Figure 5 is an on-time time chart, Figure 6 is a schematic diagram of the operation switch of the working machine, Figure 7 is a side view of the traveling working vehicle, and Figure 8 is the working machine connected to the rear of the traveling working vehicle. FIG. 3 is a perspective view of the connecting portion. DESCRIPTION OF SYMBOLS 1... Traveling vehicle, 2... Connection mechanism part, 3... Ground work machine, 7.13... Hydraulic cylinder, 14... Stroke sensor, 15... Horizontal sensor, 18... Operation switch, 19...Current value calculator, 20...Target value setter, 21...Subtractor, 22...A storage unit, 23
. . . B storage unit, 24 . . . code determination means, 28 . . .
Agent for means prohibiting lateral tilting control Patent attorney Michihito Hiraki 18th 2nd m (Part 1) Figure 3 Figure 4 Figure 5 Figure 6 Figure 7 Figure 8 Procedural amendment (voluntary) 1988 November 27th
Claims (4)
連結された対地作業機を、油圧シリンダの伸縮動作にて
左右に傾動させて、設定対地姿勢に制御する対地作業機
位置制御装置において、 前記設定対地姿勢に制御するための油圧シリンダのスト
ローク目標値を、前記走行車両に設けられた水平センサ
の検出値に基づいて設定する目標値設定器と、 油圧シリンダの伸縮量を検出するセンサと、該センサの
検出値に基づいて、対地作業機の左右傾動ストローク現
在値を演算する現在値演算器と、 前記ストローク現在値の前記ストローク目標値に対する
偏差を演算する減算器と、 該減算器で得られた最新の偏差、およびその直前の偏差
の符号の異同を判別する符号判別手段と、前記油圧シリ
ンダを伸縮駆動させる右傾斜用バルブ、および左傾斜用
バルブのオン動作を制御する左右傾動制御駆動部と、 該左右傾動制御駆動部による、前記バルブのオン動作を
禁止する左右傾動制御禁止手段とを具備し、 前記符号判別手段で異符号の判別結果が出たときに、前
記左右傾動制御禁止手段を解除し、設定対地姿勢に対す
る左右傾動制御を開始させるように構成したことを特徴
とする対地作業機位置制御装置。(1) In a ground-based work equipment position control device that controls a ground-based work equipment connected to a traveling vehicle so that it can move up and down and tilt left and right to a set ground attitude by tilting it left and right through the expansion and contraction of a hydraulic cylinder. , a target value setting device that sets a stroke target value of the hydraulic cylinder for controlling the set ground attitude based on a detected value of a horizontal sensor provided on the traveling vehicle; and a sensor that detects the amount of expansion and contraction of the hydraulic cylinder. a current value calculator that calculates a current horizontal tilting stroke value of the ground work equipment based on a detected value of the sensor; a subtracter that calculates a deviation of the current stroke value from the target stroke value; a sign determining means for determining whether the signs of the latest deviation obtained in and the immediately preceding deviation are different from each other; a right tilting valve that drives the hydraulic cylinder to extend and retract; and a left/right tilting device that controls the ON operation of the left tilting valve. a control drive unit; and a left-right tilt control inhibiting unit for prohibiting the left-right tilt control drive unit from turning on the valve; A ground work machine position control device characterized in that it is configured to release a control inhibiting means and start left and right tilting control for a set ground attitude.
ーク上限値を超過したときには、該ストローク上限値を
前記ストローク現在値に入れ換え、前記ストローク現在
値が、予め設定されたストローク下限値を下回ったとき
は、該ストローク下限値を前記ストローク現在値に入れ
換えることを特徴とする前記特許請求の範囲第1項記載
の対地作業機位置制御装置。(2) When the current stroke value exceeds a preset stroke upper limit value, replace the stroke upper limit value with the stroke current value, and when the stroke current value falls below a preset stroke lower limit value. The ground work machine position control device according to claim 1, wherein the lower stroke limit value is replaced with the current stroke value.
結された対地作業機を、油圧シリンダの伸縮動作にて左
右に傾動させて、設定対地姿勢に制御する対地作業機位
置制御装置において、 前記設定対地姿勢に制御するための油圧シリンダのスト
ローク目標値を、前記走行車両に設けられた水平センサ
の検出値に基づいて設定する目標値設定器と、 油圧シリンダの伸縮量を検出するセンサと、該センサの
検出値に基づいて、対地作業機の左右傾動ストローク現
在値を演算する現在値演算器と、 前記ストローク現在値の前記ストローク目標値に対する
偏差を演算する減算器と、 前記偏差を傾斜保護不感帯と比較する傾斜保護不感帯比
較手段と、 前記油圧シリンダを伸縮駆動させる右傾斜用バルブ、お
よび左傾斜用バルブのオン動作を制御する左右傾動制御
駆動部と、 該左右傾動制御駆動部による、前記バルブのオン動作を
禁止する左右傾動制御禁止手段とを具備し、 前記傾斜保護不感帯比較手段での比較の結果、前記偏差
が前記傾斜保護不感帯の範囲内にあると判断された場合
に、前記左右傾動制御禁止手段を解除し、設定対地姿勢
に対する左右傾動制御を開始させるように構成したこと
を特徴とする対地作業機位置制御装置。(3) In a ground work machine position control device that controls a ground work machine connected to a traveling vehicle so as to be able to move up and down and tilt left and right to a set ground attitude by tilting it left and right by the expansion and contraction operation of a hydraulic cylinder, a target value setting device that sets a stroke target value of the hydraulic cylinder for controlling the set ground attitude based on a detected value of a horizontal sensor provided on the traveling vehicle; and a sensor that detects the amount of expansion and contraction of the hydraulic cylinder. , a current value calculator that calculates a current horizontal tilting stroke value of the ground work equipment based on the detected value of the sensor; a subtractor that calculates a deviation of the current stroke value from the stroke target value; an inclination protection dead zone comparison means for comparing with the protection dead zone; a left-right tilt control drive section that controls the on-operation of the right-tilt valve and the left-tilt valve that drive the hydraulic cylinder to extend and retract; and the left-right tilt control drive section; lateral tilt control prohibition means for prohibiting on-operation of the valve, and when it is determined that the deviation is within the range of the tilt protection dead zone as a result of comparison by the tilt protection dead zone comparison means, What is claimed is: 1. A ground work machine position control device, characterized in that the device is configured to release the horizontal tilting control prohibition means and start the horizontal tilting control for the set ground attitude.
ーク上限値を超過したときには、該ストローク上限値を
前記ストローク現在値に入れ換え、前記ストローク現在
値が、予め設定されたストローク下限値を下回ったとき
は、該ストローク下限値を前記ストローク現在値に入れ
換えることを特徴とする前記特許請求の範囲第3項記載
の対地作業機位置制御装置。(4) When the current stroke value exceeds a preset stroke upper limit value, replace the stroke upper limit value with the stroke current value, and when the stroke current value falls below a preset stroke lower limit value. The ground work machine position control device according to claim 3, wherein the lower stroke limit value is replaced with the current stroke value.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP62250498A JPH0191702A (en) | 1987-10-02 | 1987-10-02 | Positioning controller to the ground for working machine |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP62250498A JPH0191702A (en) | 1987-10-02 | 1987-10-02 | Positioning controller to the ground for working machine |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPH0191702A true JPH0191702A (en) | 1989-04-11 |
Family
ID=17208770
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP62250498A Withdrawn JPH0191702A (en) | 1987-10-02 | 1987-10-02 | Positioning controller to the ground for working machine |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPH0191702A (en) |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS59232008A (en) * | 1983-06-15 | 1984-12-26 | 株式会社クボタ | Rolling control mechanism of work vehicle |
| JPS62190007A (en) * | 1986-02-15 | 1987-08-20 | 三菱農機株式会社 | Method for controlling rising and falling of working machineof tractor |
| JPS62198306A (en) * | 1986-02-25 | 1987-09-02 | 三菱農機株式会社 | Working height control system in field working machine |
-
1987
- 1987-10-02 JP JP62250498A patent/JPH0191702A/en not_active Withdrawn
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS59232008A (en) * | 1983-06-15 | 1984-12-26 | 株式会社クボタ | Rolling control mechanism of work vehicle |
| JPS62190007A (en) * | 1986-02-15 | 1987-08-20 | 三菱農機株式会社 | Method for controlling rising and falling of working machineof tractor |
| JPS62198306A (en) * | 1986-02-25 | 1987-09-02 | 三菱農機株式会社 | Working height control system in field working machine |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3155119B2 (en) | Bulldozer Dosing Equipment | |
| JP3297147B2 (en) | Bulldozer dosing equipment | |
| JPH0191702A (en) | Positioning controller to the ground for working machine | |
| JP2660728B2 (en) | Ground work machine attitude control device | |
| JPH0779606A (en) | Rolling control mechanism for ground work equipment | |
| JP3019361B2 (en) | Hydraulic control device | |
| JPH0723610A (en) | Agricultural tractor | |
| JP7083238B2 (en) | Work vehicle | |
| JPH08154418A (en) | Tractor work implement lift control device | |
| JPS6359803A (en) | Working machine rising and falling control system of tractor | |
| JP2619702B2 (en) | Ground work machine position control device | |
| JPH0775482B2 (en) | Control device for ground work machine | |
| JP3556098B2 (en) | Hydraulic actuator control device | |
| JPH01231804A (en) | Left and right attitude controlling device of ground working machine | |
| JP3434980B2 (en) | Work vehicle position control device | |
| JPH10178808A (en) | Tractor | |
| JPH1098911A (en) | Traveling work wagon | |
| JPH01117702A (en) | Controller for position of ground working machine | |
| JP2510032B2 (en) | Lifting control device for work equipment | |
| JPH01132302A (en) | Hydraulic protection control device for ground-based work equipment | |
| JP2848753B2 (en) | Work machine lifting control | |
| JPH06141604A (en) | Rolling control mechanism of ground work machine | |
| JP2556837Y2 (en) | Drive control circuit for cargo handling equipment | |
| JPH11275909A (en) | Work machine attitude control device for powered vehicles | |
| JPH0889019A (en) | Turning control device for tractor |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| LAPS | Cancellation because of no payment of annual fees |