JPS63118426A - Controller and controlling method for blade of bulldozer - Google Patents
Controller and controlling method for blade of bulldozerInfo
- Publication number
- JPS63118426A JPS63118426A JP24465586A JP24465586A JPS63118426A JP S63118426 A JPS63118426 A JP S63118426A JP 24465586 A JP24465586 A JP 24465586A JP 24465586 A JP24465586 A JP 24465586A JP S63118426 A JPS63118426 A JP S63118426A
- Authority
- JP
- Japan
- Prior art keywords
- angle
- blade
- cylinder
- cylinders
- target
- 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
Links
- 238000000034 method Methods 0.000 title claims description 31
- 230000008602 contraction Effects 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims 4
- 206010034719 Personality change Diseases 0.000 claims 1
- 239000002131 composite material Substances 0.000 abstract 2
- 230000036544 posture Effects 0.000 description 24
- 230000007935 neutral effect Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 239000003921 oil Substances 0.000 description 4
- 238000003672 processing method Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 239000000725 suspension Substances 0.000 description 2
- 238000010276 construction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 239000010720 hydraulic oil Substances 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Landscapes
- Operation Control Of Excavators (AREA)
Abstract
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明はブルドーザのブレードをシリンダによってチル
トおよびアングルさせるようにしたブルドーザのブレー
ド制m装置および方法に関する。DETAILED DESCRIPTION OF THE INVENTION [Field of Industrial Application] The present invention relates to a bulldozer blade control device and method in which the bulldozer blade is tilted and angled by a cylinder.
従来ブルドーザのブレードをシリンダによってチルトお
よびアングルさせるようにした機構は、第14図に示す
ように、ブレード1はCフレーム3に対してボールジヨ
イントにより連結され、かつ、ロッド9により連結され
アングル回転およびチルト回転が自在に取り付けられて
おり、このCフレーム3とブレード1との間に2本のア
ングルシリンダ5a、5bおよび1本のチルトシリンダ
6を取り付けて構成されている。In the conventional mechanism for tilting and angulating the blade of a bulldozer using a cylinder, as shown in Fig. 14, the blade 1 is connected to the C frame 3 by a ball joint, and is also connected by a rod 9 to rotate the blade at an angle. Two angle cylinders 5a, 5b and one tilt cylinder 6 are installed between the C frame 3 and the blade 1.
そして、ブレード1を左アングルまたは右アングルさせ
るときには、チルトシリンダ6の長さは固定した状態で
、左右のアングルシリンダ5a。When the blade 1 is angled to the left or to the right, the length of the tilt cylinder 6 is fixed and the length of the left and right angle cylinders 5a is fixed.
5bの長さを変化させ、またブレード1を左チルトまた
は右チルトさせるときには、左右のアングルシリンダ5
a、5bの長さは固定した状態で、チルトシリンダ6の
長さを変化させることによって行なう。When changing the length of the blade 5b or tilting the blade 1 to the left or right, use the left and right angle cylinders 5.
This is done by changing the length of the tilt cylinder 6 while keeping the lengths a and 5b fixed.
なお、同図において、7.8はリフトシリンダ、9はピ
ッチング抑止ロッドである。In addition, in the same figure, 7.8 is a lift cylinder, and 9 is a pitching prevention rod.
しかし、上記従来のブレードのチルトおよびアングルの
制御装置は、シリンダの数が多く、これに伴なって機構
も複雑となり、かつ作業機宙吊も増大するという問題が
ある。However, the above-mentioned conventional blade tilt and angle control device has a problem in that the number of cylinders is large, the mechanism becomes complicated, and the amount of suspension of the work machine increases.
本発明の目的は上記実情に鑑みてなされたもので、ブレ
ードをチルトおよびアングルさせるシリンダの数を2木
にし、機構の簡略化、作業機宙吊の軽減を図り、かつチ
ルト動作またはアングル動作のみ行なうように上記2本
のシリンダを複合制御することができるブルドーザのブ
レード制御l装置を提供することにある。The object of the present invention was made in view of the above-mentioned circumstances.The purpose of the present invention is to reduce the number of cylinders that tilt and angle the blade to two, simplify the mechanism, reduce the suspension of the work machine, and only perform tilt or angle operations. It is an object of the present invention to provide a blade control device for a bulldozer that can perform combined control of the two cylinders as described above.
本発明の他の目的は、上記2本のシリンダの複合制御に
よりブレードの姿勢を変更させたときに、ブレードにか
かる負荷等によってブレードが予定外の姿勢変化をした
場合に、好適な対処を行なうことができるブルドーザの
ブレード制御方法を提供することにある。Another object of the present invention is to take appropriate measures in the event that the blade changes its posture unexpectedly due to the load applied to the blade, etc. when changing the posture of the blade through combined control of the two cylinders. An object of the present invention is to provide a method for controlling a bulldozer blade.
〔問題点を解決するための手段および作用)本発明によ
れば、ブレードをCフレームに対してチルト及びアング
ル自在に連結し、このブレードとCフレームとの間に各
シリンダの長さの組み合わせによって前記ブレードのチ
ルト角及びアングル角が一義的に定まる態様で第1、第
2のシリンダを配設し、前記ブレードの目標とするチル
ト角およびアングル角をそれぞれ独立して指示する指示
手段を設け、この指示手段によって前記ブレードの目標
とするチルト角およびアングル角が指示されると、その
指示された目標チルト角および目標アングル角に基づい
て前記ブレードを当該目標チルト角および目標アングル
角にするに必要な前記第1、第2のシリンダのそれぞれ
の目標シリンダ長を換尊し、前記第1、第2のシリンダ
の実際のシリンダ長が前記換算した目標シリンダ長にな
るように第1、第2のシリンダを複合制御するようにし
ている。[Means and operations for solving the problem] According to the present invention, the blade is connected to the C frame so as to be tiltable and angular, and the blade is connected to the C frame so as to be able to tilt and angle freely, and there is a gap between the blade and the C frame depending on the combination of the lengths of each cylinder. The first and second cylinders are arranged in such a manner that the tilt angle and angle angle of the blade are uniquely determined, and an instruction means is provided for independently indicating the target tilt angle and angle angle of the blade, When the target tilt angle and angle angle of the blade are instructed by this instruction means, it is necessary to set the blade to the target tilt angle and target angle based on the instructed target tilt angle and target angle angle. The target cylinder lengths of the first and second cylinders are converted, and the first and second cylinders are adjusted so that the actual cylinder lengths of the first and second cylinders become the converted target cylinder lengths. We are trying to have multiple control over these.
また、上述のブレード制御に際し、前記ブレードが制御
される前のチルト角およびアングル角を予め初期値とし
て記憶しておき、前記ブレードのチルト角およびアング
ル角のうちいずれか一方の目標角の指示による前記第1
、第2のシリンダの複合制御後、指示されなかった他方
の角度の前記初期値との偏差を求め、前記一方の角度の
現在の角度を変えずに前記偏差が許容範囲内に入るよう
に前記第1、第2のシリンダを更に複合制御して前記ブ
レードの予定外の姿勢変化を修正するようにしている。Further, when controlling the blade as described above, the tilt angle and angle angle before the blade is controlled are stored in advance as initial values, and the target angle of either one of the tilt angle and the angle angle of the blade is specified. Said first
, after the combined control of the second cylinder, the deviation of the other angle that was not instructed from the initial value is determined, and the deviation is adjusted so that the deviation falls within the allowable range without changing the current angle of the one angle. The first and second cylinders are further controlled in a combined manner to correct an unexpected change in the attitude of the blade.
更に、上述のブレード制御に際し、前記ブレードのチル
ト角およびアングル角のうち少なくとも一方の目標角の
指示による前記第1、第2のシリンダの複合制御中に、
該第1、第2のシリンダの伸縮速度のうち少なくとも一
方が成る許容最低速度以下のとき前記第1、第2のシリ
ンダの制御を禁止し、前記ブレードの予定外の姿勢変化
を防止するようにしている。Furthermore, during the above-mentioned blade control, during the combined control of the first and second cylinders based on an instruction of a target angle of at least one of the tilt angle and the angle angle of the blade,
Control of the first and second cylinders is prohibited when at least one of the expansion and contraction speeds of the first and second cylinders is equal to or lower than an allowable minimum speed to prevent an unexpected change in attitude of the blade. ing.
更にまた、上述の制御に際し、前記ブレードが制御され
る前のチルト角およびアングル角を予め初期値として記
憶しておき、前記ブレードのチルト角およびアングル角
のうち少なくとも一方の目標角の指示による前記第1、
第2のシリンダの複合制御中に、該第1、第2のシリン
ダの伸縮速度がともに成る許容最低速度以下のとき、前
記目標角による前記第1、第2のシリンダの制御を禁止
し、その後、前記記憶した初期値を目標角として前記第
1、第2のシリンダを複合制御、し、前記ブレードを初
期のブレード姿勢に復帰させるようにしている。Furthermore, in the above-mentioned control, the tilt angle and the angle angle before the blade is controlled are stored in advance as initial values, and the tilt angle and the angle angle of the blade are adjusted according to an instruction of a target angle of at least one of the tilt angle and the angle angle of the blade. First,
During the combined control of the second cylinder, when the expansion and contraction speeds of the first and second cylinders are both below the allowable minimum speed, the control of the first and second cylinders using the target angle is prohibited, and then The first and second cylinders are jointly controlled using the stored initial value as a target angle to return the blade to its initial blade attitude.
以下、本発明を添付図面を参照して詳細に説明する。 Hereinafter, the present invention will be described in detail with reference to the accompanying drawings.
第2図は本発明に係るブルドーザのブレード機構の一実
施例を示す斜視図である。同図において、ブレード10
は、Cフレーム11に対してチルト及びアングル自在に
連結されている。すなわち、ブレード10におけるセン
タビン12が配設されるブラケット13と、Cフレーム
11におけるセンタシャフト14とが連結され、ブレー
ド10はセンタピン12の軸回り方向(アングル方向)
およびセンタシャフト14の軸回り方向(チルト方向)
に回動し得るようになっている。FIG. 2 is a perspective view showing one embodiment of a bulldozer blade mechanism according to the present invention. In the figure, blade 10
is connected to the C frame 11 so as to be tiltable and angular. That is, the bracket 13 on which the center pin 12 of the blade 10 is disposed is connected to the center shaft 14 of the C frame 11, and the blade 10 is moved around the axis of the center pin 12 (angle direction).
and the direction around the axis of the center shaft 14 (tilt direction)
It is designed so that it can be rotated.
このブレード10とフレーム11との間には、フレード
10をアングルおよびチルトさせるための2本のシリン
ダ15および16が取り付けられている。このシリンダ
15および16は、図示のようにブレード10の取付部
位に関して非対称に取り付けられており、またシリンダ
15および16は、複合動作することにより、ブレード
10をアングル動作およびチルト動作させることができ
る。Two cylinders 15 and 16 are attached between the blade 10 and the frame 11 to angle and tilt the blade 10. As shown, the cylinders 15 and 16 are attached asymmetrically with respect to the attachment portion of the blade 10, and the cylinders 15 and 16 perform a combined operation to cause the blade 10 to angle and tilt.
次に、上記シリンダ15.16の好ましい取付態様につ
いて詳説する。Next, a preferred manner of mounting the cylinders 15, 16 will be explained in detail.
まず、シリンダ15.16非対称な取付態様を説明する
前に、2本のシリンダを左右対称に取り付けた場合につ
いて説明する。First, before explaining how the cylinders 15 and 16 are asymmetrically mounted, a case where two cylinders are mounted symmetrically will be described.
この場合、左右シリンダ長さの組み合わせとブレード姿
勢(アングル角、チルト角により定義される)との関係
は第3図(a)のようになる。同図において、1つ1つ
の曲線は、アングル角を一定にした状態でチルト角を順
次変化させた場合の左右のシリンダ長の組み合せを示す
点をつないだものである。また、第3図(b)は第3図
(a)の一部拡大図である。なお、破線で示す曲線1は
、チルト角がOoのときにアングル角を変化させた場合
の左右のシリンダ長の変化を示す。In this case, the relationship between the combination of the left and right cylinder lengths and the blade posture (defined by the angle angle and tilt angle) is as shown in FIG. 3(a). In the figure, each curve connects points showing the combination of left and right cylinder lengths when the tilt angle is sequentially changed while the angle is kept constant. Moreover, FIG. 3(b) is a partially enlarged view of FIG. 3(a). Note that a curve 1 indicated by a broken line indicates a change in the left and right cylinder lengths when the angle angle is changed when the tilt angle is Oo.
第3図(b)において、2つの曲線m、nの交点Pは、
1つの左右のシリンダ長の組み合わせに対して2つのブ
レード姿勢が存在することを示している。具体的には、
曲I1mにおけるアングル角度で右チルト(矢印B方向
に移動)して交点Pに達している第1のブレード姿勢と
、このアングル角度よりも右側(矢印り方向)にアング
ルした曲線nにおけるアングル角度で左チルト(矢印六
方向)に移動して交点Pに達している第2のブレード姿
勢とが、同じシリンダ長の組み合わせで存在する。In Figure 3(b), the intersection P of the two curves m and n is
This shows that there are two blade postures for one combination of left and right cylinder lengths. in particular,
The first blade posture tilts to the right (moves in the direction of arrow B) at the angle angle in song I1m and reaches the intersection point P, and the angle angle at curve n that is angled to the right (in the direction of the arrow) from this angle angle. A second blade posture in which the blade tilts to the left (in the six directions of the arrow) and reaches the intersection point P exists in the same combination of cylinder lengths.
したがって、外力によって上記第1のブレード姿勢から
第2のブレード姿勢に、あるいはその逆にブレードが変
化する虞がある。Therefore, there is a possibility that the blade may change from the first blade attitude to the second blade attitude or vice versa due to external force.
また、ブレード姿勢を変化させるには、現在の姿勢を示
す上記曲線の点からその点における接線の傾きが示すよ
うな割合で左右のシリンダ長を変化させる必要があるが
、例えば第3図(b)における曲線12mの接触点Qの
ところでは、チルトさせる場合の接線の傾きと、アング
ルさせる場合の接線の傾きとが一致し、この接線の傾き
が示すような割合で左右のシリンダ長を変化させた場合
に、アングルするのかチルトするのかはっきりしないと
言える。In addition, in order to change the blade posture, it is necessary to change the left and right cylinder lengths at a rate indicated by the slope of the tangent at that point from the point on the curve that indicates the current posture. ), the slope of the tangent line when tilting matches the slope of the tangent line when angulating, and the left and right cylinder lengths are changed at the rate indicated by the slope of this tangent line. In this case, it is not clear whether to angle or tilt.
したがって、好ましくは上記問題点が生じないような態
様で2本のシリンダを取り付ける。Therefore, preferably the two cylinders are installed in such a manner that the above problems do not occur.
すなわち、第4図のグラフに示すような左右シリンダの
長さの組み合わせとブレード姿勢が得られるように2本
のシリンダを取り付ける。なお、同図の矢印A、B、C
,Dは第3図(b)に示したブレード動作方向と同じで
ある。That is, the two cylinders are installed so that the combination of the lengths of the left and right cylinders and the blade posture as shown in the graph of FIG. 4 are obtained. Note that arrows A, B, and C in the same figure
, D are the same as the blade movement direction shown in FIG. 3(b).
このグラフに示すブレード動作と左右シリンダの伸縮と
の関係は、第1表に示すように左アングル、右アングル
、左チルト、右チルトの4つの動作別にシリンダストロ
ーク変化が全く異なる。Regarding the relationship between the blade operation and the expansion and contraction of the left and right cylinders shown in this graph, as shown in Table 1, the cylinder stroke changes are completely different for each of the four operations: left angle, right angle, left tilt, and right tilt.
第 1 表
第5図および第6図は、それぞれ第2図の平面図および
背面図で、左右のシリンダ15.16の好ましい取付態
様を示している。すなわち、かかる取付態様によれば、
第1表に示したように左アングル時には左シリンダ15
は縮退し、右シリンダ16は伸長し、右アングル時には
左シリンダ15は伸長し、右シリンダ16はf!退し、
(第7図参照)、また、左チルト時には左右のシリンダ
がともに伸長し、右チルト時には左右のシリンダがとも
にfa退する(第8図参照)。Table 1 FIGS. 5 and 6 show the preferred mounting manner of the left and right cylinders 15, 16, respectively, in top and rear views of FIG. That is, according to this mounting mode,
As shown in Table 1, left cylinder 15 when left angle
is retracted, the right cylinder 16 is extended, and at the right angle, the left cylinder 15 is extended, and the right cylinder 16 is f! Retire,
(See FIG. 7). Also, when tilting to the left, both the left and right cylinders extend, and when tilting to the right, both left and right cylinders retract fa (see FIG. 8).
次に、上記シリンダを制御する装置について説明する。Next, a device for controlling the cylinder will be explained.
第1図は本発明によるブルドーザのブレード制御装置の
一実施例を示すブロック図である。FIG. 1 is a block diagram showing an embodiment of a bulldozer blade control device according to the present invention.
同図において、チルトレバー20およびアングルレバ−
22はそれぞれブレード10のチルト角速度およびアン
グル角速度を指令するものであり、チルト角速度信号発
生器24およびアングル角速度信号発生器26はそれぞ
れチルトレバー20およびアングルレバ−22のレバー
操作量に応じたチルト角速度α およびアングル角速度
Brを示°r
すアナログ信号をA/D変換器28に出力する。In the same figure, the tilt lever 20 and the angle lever
22 commands the tilt angular velocity and angle angular velocity of the blade 10, respectively, and the tilt angular velocity signal generator 24 and the angle angular velocity signal generator 26 command the tilt angular velocity according to the lever operation amount of the tilt lever 20 and the angle lever 22, respectively. An analog signal indicating α and angle angular velocity Br is output to the A/D converter 28.
チルト角センサ30およびアングル角センサ32は、そ
れぞれブレード10のチルト角およびアングル角を検出
するもので、例えば第2図に示すブレード10のセンタ
シャフト14およびセンタピン12における回転角を検
出するポテンショメータから構成される。これらのチル
ト角センサ30およびアングル角センサ32は、それぞ
れ検出したチルト角αおよびアングル角βを示すアナロ
グ信号をA/D変換器28に出力する。The tilt angle sensor 30 and the angle angle sensor 32 detect the tilt angle and angle angle of the blade 10, respectively, and are composed of, for example, potentiometers that detect the rotation angle of the center shaft 14 and center pin 12 of the blade 10 shown in FIG. be done. These tilt angle sensor 30 and angle angle sensor 32 output analog signals indicating the detected tilt angle α and angle angle β, respectively, to the A/D converter 28.
A/D変換器は入力する4つのアナログ信号をそれぞれ
デジタル信号に変換して中央処yf!装置(CPU)3
4に出力する。The A/D converter converts each of the four input analog signals into digital signals and performs central processing yf! Device (CPU) 3
Output to 4.
CPU34は上記A/D変換器28を介して入’r
’r
力する4つのデータ(α 、β 、α、β)に基づいて
、ブレード10が指示されたチルト角あるいはアングル
角となるように2本のシリンダ15゜16の各シリンダ
制御値を算出する。なお、CPU34の動作の詳細につ
いては後述する。The CPU 34 receives input via the A/D converter 28.
'r Based on the four input data (α, β, α, β), calculate each cylinder control value for the two cylinders 15° and 16 so that the blade 10 has the specified tilt angle or angle angle. . Note that details of the operation of the CPU 34 will be described later.
CPU34によって算出されたシリンダ制御値(各シリ
ンダへの流量指令値)は、増幅器38゜40を介して油
圧パルプ42に加えられる。油圧バルブ42.44は油
圧源(図示せず)から圧油が加えられており、増幅器3
8.40を介して入力する流量指令値に応じて所要の流
ff1(供給方向も含む)の作動油をシリンダ15.1
6に加える。Cylinder control values (flow rate command values to each cylinder) calculated by the CPU 34 are applied to the hydraulic pulp 42 via amplifiers 38 and 40. Hydraulic valves 42 and 44 are supplied with pressure oil from a hydraulic source (not shown) and are connected to amplifier 3.
The required flow ff1 (including the supply direction) of hydraulic oil is supplied to the cylinder 15.1 according to the flow rate command value input via 8.40.
Add to 6.
これにより、シリンダ15.16はそれぞれ所定のシリ
ンダ長となり、ブレード10は指示されたチルト角ある
いはアングル角になるように制御される。As a result, the cylinders 15, 16 each have a predetermined cylinder length, and the blade 10 is controlled to have the specified tilt angle or angle.
次に、CPU34の動作について第9図に示すフローチ
セートを参照しながら詳説する。Next, the operation of the CPU 34 will be explained in detail with reference to the flowchart shown in FIG.
第9図において、まずブレードの現在のチルト角αおよ
びアングル角βを入力する(ステップ100)。次に、
チルトレバーおよびアングルレバ−がともに中立か否か
を判別する(ステップ110)。なお、この判別は、チ
ルト角速度指令5rおよびアングル角速度指令β がO
が否かによって行なう。In FIG. 9, first, the current tilt angle α and angle angle β of the blade are input (step 100). next,
It is determined whether the tilt lever and the angle lever are both neutral (step 110). Note that this determination is made when the tilt angular velocity command 5r and the angle angular velocity command β are O.
It depends on whether or not.
そして、チルトレバーおよびアングルレバ−がともに中
立の場合には、ステップ100で入力したチルト角αお
よびアングル角βをそれぞれ初期値(9o、β0)とし
て記憶する(ステップ190)。When both the tilt lever and the angle lever are neutral, the tilt angle α and the angle angle β input in step 100 are respectively stored as initial values (9o, β0) (step 190).
一方、チルトレバーおよびアングルレバ−のうち少なく
ともいずれか一方が操作されていると、ステップ120
に進み、ここで現在のシリンダ15.16の各シリンダ
長L 、L を計算する。On the other hand, if at least one of the tilt lever and the angle lever is operated, step 120
Proceed to and here calculate each cylinder length L 1 , L 2 of the current cylinder 15.16.
[R
この計算に際し、本発明では前述したように、左右のシ
リンダが、該左右のシリンダの長さの組み合わせとブレ
ード姿勢(チルト角、アングル角)とが一対一に対応す
るように設けられているため、逆にチルト角、アングル
角から左右のシリンダ長を求めるようにしている。[R In this calculation, as described above, in the present invention, the left and right cylinders are provided so that the combination of the lengths of the left and right cylinders and the blade posture (tilt angle, angle angle) correspond one-to-one. Therefore, the left and right cylinder lengths are calculated from the tilt angle and angle angle.
第13図は左側シリンダ長と右側シリンダ長とによって
決定されるチルト角およびアングル角を示すグラフであ
る。同図において、点Oはチルト角およびアングル角が
ともに零のときの左右シリンダ長を示す。そして、左右
のシリンダ長の関係が矢印へ方向に進むと左チルト、矢
印B方向に進むと右チルト、矢印C方向に進むと左アン
グル、矢印り方向に進むと右アングルするようになる。FIG. 13 is a graph showing the tilt angle and angle angle determined by the left cylinder length and the right cylinder length. In the figure, point O indicates the left and right cylinder lengths when both the tilt angle and the angle angle are zero. When the relationship between the left and right cylinder lengths goes in the direction of the arrow, it will tilt to the left, if it goes in the direction of arrow B, it will tilt to the right, if it goes in the direction of arrow C, it will tilt to the left, and if it goes in the direction of the arrow, it will angle to the right.
これらの関係は前述の第4図と同等である。These relationships are equivalent to those shown in FIG. 4 above.
本発明では、上記第13図に示した左右シリンダ長とブ
レード姿勢との関係から、チルト角およびアングル角に
基づいて左右のシリンダ長を求めるための換算テーブル
を予めメモリ36(第1図)に準備し、チルト角および
アングル角によって決定される左右のシリンダ長をこの
換算テーブルから読み出すようにしている。In the present invention, a conversion table for determining the left and right cylinder lengths based on the tilt angle and the angle angle is stored in advance in the memory 36 (FIG. 1) from the relationship between the left and right cylinder lengths and the blade posture shown in FIG. 13 above. The left and right cylinder lengths determined by the tilt angle and angle angle are read out from this conversion table.
次に、チルト角速度指令:aゝおよびアングル角速度指
令Brを入力しくステップ130)、目標「
チルト角α および目標アングル角β1を次式から算出
する(ステップ140)。Next, the tilt angular velocity command: aゝ and the angle angular velocity command Br are input (step 130), and the target tilt angle α and target angle angle β1 are calculated from the following equation (step 140).
α1←α1+み1・Δt
・・・・・・(1)
β −βr+、3r・Δt
「
上式に示すように各目標角は、前回の各目標角にレバー
によって指示される角度増加分を加算することにより求
めるようにしている。なお、Δtはこのフローチャート
に示す1サイクルの処理時間を示す。また、初回の目標
角を求める場合には、ステップ190で記憶した初期値
(α 、β )を用いる。α1←α1+mi1・Δt (1) β −βr+, 3r・Δt “As shown in the above formula, each target angle is calculated by adding the angle increment instructed by the lever to each previous target angle. It is determined by adding. Note that Δt indicates the processing time of one cycle shown in this flowchart. Also, when determining the first target angle, the initial values (α, β) stored in step 190 are used. Use.
上記のように求めた各目標角(α 、β1)か「
ら前述のステップ120と同様にして目標シリンダ長(
L、r、 Rr)を求める(ステップ150)。From each of the target angles (α, β1) obtained above, the target cylinder length (
L, r, Rr) (step 150).
続いて、目標シリンダ長(LL’ 、 R’ )とし 現在のシリンダ長(L、L)との偏差Δオ、。Next, set the target cylinder length (LL', R') Deviation Δo from the current cylinder length (L, L).
[R Δ1Rを次式、 Δj [=1. ’ −L[ ・・・・・・(2) [ ΔJIR=LR−LR から算出しくステップ160) 、この偏差Δj[。[R Δ1R is the following formula, Δj [=1. ’ −L[ ・・・・・・(2) [ ΔJIR=LR-LR Step 160), this deviation Δj[.
Δ、IlRを速やかに零にするために必要な左右シリン
ダへの流量指令値V1.V1を次式
%式%
[
から求める(ステップ170)。なお、上式において、
A、8.Cは、比例、微分、積分補償要素の各係数であ
る。Flow rate command value V1. to the left and right cylinders required to quickly bring Δ, IlR to zero. V1 is obtained from the following formula % formula % [ (step 170). In addition, in the above formula,
A.8. C is each coefficient of proportional, differential, and integral compensation elements.
このようにして求めた流量指令値V4.vRは、前述し
たようにCPU34から出力される(ステップ180)
。そして、チルトレバーおよびアングルレバ−がともに
中立になるまで、ステップ100〜180を繰り返し実
行し、その結果、ブレードはレバーによって指示された
各速度でチルトあるいはアングルすることになる。Flow rate command value V4. thus obtained. vR is output from the CPU 34 as described above (step 180)
. Steps 100 to 180 are then repeated until both the tilt and angle levers are in neutral, resulting in the blade tilting or angulating at each speed instructed by the levers.
次に、シリンダに過負荷がかかるかシリンダストローク
エンドに達し、シリンダに圧油を供給する油圧回路がリ
リーフして左右のシリンダが指示した通りに動かない場
合の処理方法について説明する。Next, we will explain how to handle cases where the cylinder is overloaded or reaches the end of its stroke, the hydraulic circuit that supplies pressure oil to the cylinder is relieved, and the left and right cylinders do not move as instructed.
ブレードのチルト角のみを変化させる指令を与えたとき
に、左右のシリンダが指示した通りに動かない場合には
、アングル角は初期値から変化する。同様に、ブレード
のアングル角のみを変化させる指令を与えたときに、左
右のシリンダが指示通りに動かない場合には、チルト角
は初期値から変化する。When a command to change only the tilt angle of the blade is given, if the left and right cylinders do not move as instructed, the angle angle changes from its initial value. Similarly, when a command is given to change only the angle of the blade, if the left and right cylinders do not move as instructed, the tilt angle changes from its initial value.
以下に示す処理は、上述のレバー操作によるブレードの
制御終了後、ブレード姿勢の誤差(チルトもしくはアン
グル)が一定値よりも大きくなった場合にブレード姿勢
を修正し、チルト角もしくはアングル角を初期位置に戻
すようにしている。The process shown below corrects the blade posture when the blade posture error (tilt or angle) becomes larger than a certain value after the blade is controlled by the lever operation described above, and adjusts the tilt angle or angle to the initial position. I'm trying to change it back to .
第10図は上記処理を実行するためのフローチャートで
ある。なお、第9図に示した処理と同一処理(−点鎖線
で囲んだ部分等)には同符号を付し、その説明は省略す
る。FIG. 10 is a flowchart for executing the above processing. Note that the same processes as those shown in FIG. 9 (parts surrounded by dashed-dotted lines, etc.) are given the same reference numerals, and their explanations will be omitted.
同図において、まずFを1にセットする(ステップ20
0)。このFはレバー操作によるブレードの制御開始前
“1″か制御終了後110 IIかを示すフラグである
。In the same figure, F is first set to 1 (step 20
0). This flag F is a flag indicating whether it is "1" before the start of blade control by lever operation or 110 II after the control ends.
ステップ110においてチルトレバーおよびアングルレ
バ−がともに中立の場合には、ステップ205に進み、
ここでF=1か否かが判定される。If the tilt lever and the angle lever are both neutral in step 110, the process proceeds to step 205;
Here, it is determined whether F=1.
F=1の場合には、ブレード制御開始前なので、現在の
チルト角αおよびアングル角βを初期値(α。、β。)
として記憶する(ステップ190)。In the case of F=1, since the blade control has not yet started, the current tilt angle α and angle angle β are set to the initial values (α., β.).
(step 190).
いま、チルトレバーおよびアングルレバ−のうちいずれ
か一方を操作してブレード姿勢を変化させる場合につい
て説明する。Now, a case will be described in which the blade attitude is changed by operating either the tilt lever or the angle lever.
この場合、ステップ180でレバー操作に対して左右シ
リンダへのFffi指令[(V4.V、>が出力された
のち、ステップ210に進み、ここでチルトレバーが操
作されたか否かが判別される。In this case, in step 180, an Fffi command [(V4.V, >) is output to the left and right cylinders in response to the lever operation, and then the process proceeds to step 210, where it is determined whether the tilt lever has been operated.
そして、チルトレバーが操作されている場合にはTに1
をセットしくステップ215)、アングルレバ−が操作
されている場合にはAに1セツトする(ステップ220
)。Then, if the tilt lever is operated, 1 is applied to T.
(step 215), and if the angle lever is being operated, set it to A (step 220).
).
続いて、FにOをセツトシ(ステップ225)、ステッ
プ100に戻る。このようにして、ブレード姿勢制御が
行なわれ、その後チルトレバーおよびアングルレバ−が
ともに中立になって制御が終了すると、ステップ205
に進む。Subsequently, O is set in F (step 225), and the process returns to step 100. In this way, the blade attitude control is performed, and after that, both the tilt lever and the angle lever become neutral and the control is completed, step 205
Proceed to.
ステップ205では、ブレード制御終了後(F=O)の
ため、ステップ230に進み、ここでチルトレバーが操
作された(T=1>か、アングルレバ−が操作された(
A=1)かの判定が行われる。チルトレバーが操作され
た場合にはアングル角の初期値β。を入力しくステップ
235)、この初期値β。と現在のアングル各βとの偏
差の絶対値をとり、この絶対値が許容誤差ε以内か否か
の判別を行なう(ステップ240)。同様に、アングル
レバ−が操作された場合にはチルト角の初期値α。を入
力しくステップ245)、この初期値α。と現在のチル
ト角との偏差の絶対値をとり、この絶対値が許容誤差ε
以内か否かの判別を行なう(ステップ250)。In step 205, since the blade control is completed (F=O), the process proceeds to step 230, where the tilt lever is operated (T=1>) or the angle lever is operated (
A determination is made as to whether A=1). The initial value β of the angle when the tilt lever is operated. step 235), and this initial value β. The absolute value of the deviation between the angle and the current angle β is determined, and it is determined whether or not this absolute value is within the allowable error ε (step 240). Similarly, when the angle lever is operated, the initial value α of the tilt angle. step 245), and this initial value α. and the current tilt angle, and this absolute value is the allowable error ε
It is determined whether or not the value is within the range (step 250).
ステップ240,250において、
1β−βo1≦εあるいは1α−αo1≦εの場合には
ブレード姿勢の修正は行なわず、1β−β1〉εあるい
は;α−αoI〉εの場合にはステップ255に進む。In steps 240 and 250, if 1β-βo1≦ε or 1α-αo1≦ε, the blade attitude is not corrected, and if 1β-β1>ε or α-αoI>ε, the process proceeds to step 255.
ステップ255では、チルトレバーが操作された場合に
は現在のチルト角αおよびアングル角の初期値β。とに
基づいて目標シリンダ長(L r、LR’)を求め、
アングルレバ−が操し
作された場合には現在のアングル角βおよびチルト角の
初期値α。とに基づいて目標シリンダ長(L、’ 、L
R’ )を求め、ステップ160に進む。In step 255, if the tilt lever is operated, the current tilt angle α and the initial value β of the angle angle are determined. Find the target cylinder length (L r, LR') based on
When the angle lever is operated, the current angle angle β and the initial value α of the tilt angle. The target cylinder length (L, ', L
R') is determined and the process proceeds to step 160.
このようにして、本来角度変化が生じないはずの角度を
初期値に戻すことにより、ブレードの予定外の姿勢変化
を修正するようにしている。In this way, an unexpected change in the posture of the blade is corrected by returning the angle, which should not normally change, to its initial value.
次に、左右のシリンダが指示した通りに動かない場合の
他の処理方法について説明する。Next, another processing method when the left and right cylinders do not move as instructed will be described.
この処理方法は、左右のシリンダの速度を検出し、いず
れか一方がほぼ停止していると判定された場合には、ブ
レード制御を禁止し、ブレードの予定外の姿勢変化を防
止するものである。This processing method detects the speed of the left and right cylinders, and when it is determined that either cylinder is almost at a standstill, blade control is prohibited to prevent unplanned changes in blade posture. .
第11図は、上記処理を実行するためのフローチャート
である。なお、第9図に示した処理と同一処理(−点鎖
線で囲んだ部分)には同符号を付し、その説明は省略す
る。FIG. 11 is a flowchart for executing the above processing. Note that the same processes as those shown in FIG. 9 (portions surrounded by a dashed line) are given the same reference numerals, and their explanations will be omitted.
同図において、ステップ190で記憶したブレード姿勢
の初期値(α0.β0)に基づいて初期の左右シリンダ
長(L、L)を計算しておく[OR0
(ステップ300)。In the figure, initial left and right cylinder lengths (L, L) are calculated based on the initial values (α0.β0) of the blade posture stored in step 190 [OR0 (step 300).
さて、チルトレバーまたはアングルレバ−の操作に基づ
いて左右シリンダへの流量指令値(V、。Now, based on the operation of the tilt lever or angle lever, the flow rate command value (V,) is sent to the left and right cylinders.
VR)が出力されるとくステップ180) 、まず前回
の左シリンダ長’LTと現在の左シリンダ長L1との偏
差の絶対値をとり、この絶対値が許容値ε以内か否かを
判別する(ステップ310)。VR) is output (Step 180), first, the absolute value of the deviation between the previous left cylinder length 'LT and the current left cylinder length L1 is taken, and it is determined whether this absolute value is within the allowable value ε. step 310).
l L、■−LL+≦εの場合には、ステップ320に
進みl L[■−L、 l >εの場合にはステップ3
30に進む。ステップ320.330では再び前回の右
シリンダ長LrI□と現在布シリンダ長しRとの偏差の
絶対値をとり、この絶対値が許容値ε以内か否かを判別
する。ステップ320ではILR■−LR1≦εのとき
スツプ340に進み、l LR,−LRl >εのとき
制御を停止させる。またステップ330ではl LRl
−LR1≦εのとき制御を停止し、l L、、−LRl
>εのときステップ340に進む。If l L, ■-LL+≦ε, proceed to step 320; if l L[■-L, l >ε, proceed to step 3
Proceed to 30. In steps 320 and 330, the absolute value of the deviation between the previous right cylinder length LrI□ and the current cloth cylinder length R is again determined, and it is determined whether this absolute value is within the allowable value ε. In step 320, when ILR-LR1≦ε, the process advances to step 340, and when ILR,-LRl>ε, the control is stopped. Also, in step 330, l LRl
When −LR1≦ε, the control is stopped, l L,, −LRl
>ε, the process proceeds to step 340.
ステップ340では、現在の左右シリンダ長(L、L)
を(LL)に讃き換えて、
L RLT・ RT
ステップ100に戻す。なお、初回のLL[■・ RT
としては、ステップ300で求めた初期のシリンダ長(
L、L)を用いる。また、このフロー10 RO
チャートの1サイクルの処理は一定時間で繰り返し実行
されるため、ステップ310,320゜330で求めた
絶対値は、1サイクル時間当りのシリンダ長変化の絶対
値、すなわちシリンダ速度の絶対値を示す。そして、許
容値εはシリンダ速度がほぼOとなる値に相当する。In step 340, the current left and right cylinder lengths (L, L)
(LL) and return to step 100. Note that the initial LL [■・RT is the initial cylinder length (calculated in step 300).
L, L) is used. Also, since one cycle of processing in this Flow 10 RO chart is repeatedly executed in a fixed period of time, the absolute value obtained in steps 310, 320 and 330 is the absolute value of the change in cylinder length per cycle time, that is, the cylinder speed. indicates the absolute value of The allowable value ε corresponds to a value at which the cylinder speed becomes approximately O.
すなわち、ステップ310,320.330では、左右
シリンダの伸縮速度のうちいずれか一方がほぼ0に達す
ることを判別し、この場合にはブレード制御を禁止する
ようにしている。これは、第13図のグラフに示したよ
うに、ブレードがチルトまたはアングル制御される場合
には、左右シリンダは常に同時制御されており、上記の
ようにブレード制御中にいずれか一方のシリンダがほぼ
停止している場合には、そのシリンダには過負荷がかか
り、圧油がリリーフしていると考えられるからである。That is, in steps 310, 320, and 330, it is determined that one of the expansion and contraction speeds of the left and right cylinders reaches approximately 0, and in this case, blade control is prohibited. This is because, as shown in the graph of Figure 13, when the blade is tilted or angle controlled, the left and right cylinders are always controlled simultaneously, and as mentioned above, during blade control, one of the cylinders is This is because if the cylinder is almost stopped, it is considered that the cylinder is overloaded and the pressure oil is relieved.
このようにして、ブレードの予定外の姿勢変化を未然に
防止するようにしている。In this way, an unexpected change in the posture of the blade is prevented.
次に、左右のシリンダが指示通りに動かない場合の更に
他の処理方法について説明する。Next, another processing method when the left and right cylinders do not move as instructed will be described.
この処理方法は、左右のシリンダの速度を検出し、両シ
リンダがともにほぼ停止していると判定された場合には
、レバー操作によるブレード制御を禁止し、かつブレー
ド姿勢を初期状態に戻すようにするものである。This processing method detects the speed of the left and right cylinders, and when it is determined that both cylinders have almost stopped, prohibits blade control by lever operation and returns the blade posture to its initial state. It is something to do.
第12図は上記処理を実行するためのフローチャートで
ある。なお、第9図に示した処理と同一処理(−点鎖線
で囲んだ部分)には同符号を付し、その説明は省略する
。FIG. 12 is a flowchart for executing the above processing. Note that the same processes as those shown in FIG. 9 (portions surrounded by a dashed line) are given the same reference numerals, and their explanations will be omitted.
同図において、ステップ190で記憶したブレード姿勢
の初期値(α 、β )に基づいて初期の左右シリンダ
長(LL)を計算しておく[0・ RO
(ステップ400)。In the figure, the initial left and right cylinder lengths (LL) are calculated based on the initial values (α, β) of the blade postures stored in step 190 [0·RO (step 400).
さて、チルトレバーまたはアングルの操作に基づいて左
右シリンダへの流量指令値(V[、VR)が出力される
と(ステップ180)、前述の第11図に示した処理と
同様にして左右シリンダの速度を求め、その速度がほぼ
0に近いか否かの判別を行なう。Now, when the flow rate command value (V[, VR) to the left and right cylinders is output based on the tilt lever or angle operation (step 180), the left and right cylinders are controlled in the same way as the process shown in FIG. 11 above. The speed is determined and it is determined whether the speed is close to zero.
すなわち、ステップ405では、前回の左シリンダ長L
1□と現在の左シリンダ長し、との偏差の絶対値をとり
、この絶対値が許容値ε以内か否かを判別する。That is, in step 405, the previous left cylinder length L
The absolute value of the deviation between 1□ and the current left cylinder length is taken, and it is determined whether this absolute value is within the allowable value ε.
IL[■−L[l≦εの場合には、ステップ410に進
みl L[、−L、l >εの場合にはステップ415
に進む。ステップ410では再び前回の右シリンダ長し
R□と現在の右シリンダ長し11との偏差の絶対値をと
り、この絶対値が許容値ε以内か否かを判別する。そし
て、l LR,−LR1≦εの場合にはステップ420
に進み、
l LRl−LRl >εの場合にはステップ415に
進む。IL[■-L[If l≦ε, proceed to step 410; if l L[, -L, l>ε, step 415
Proceed to. In step 410, the absolute value of the deviation between the previous right cylinder length R□ and the current right cylinder length 11 is again determined, and it is determined whether this absolute value is within the allowable value ε. Then, if l LR, -LR1≦ε, step 420
If l LRl−LRl >ε, the process advances to step 415.
ステップ415は、現在の左右シリンダ長(L、L)を
(LL)に書き換えて、
L RLT・ ロ■
ステップ100に戻す。Step 415 rewrites the current left and right cylinder lengths (L, L) to (LL), and returns to step 100.
一方、左右シリンダの伸縮速度がともにほぼOに近いこ
とが判別されてステップ420に進むと、以下ステップ
420〜445の処理を行なうことによってブレード姿
勢を初期状態に戻す。On the other hand, when it is determined that both the expansion and contraction speeds of the left and right cylinders are close to O and the process proceeds to step 420, the blade attitude is returned to the initial state by performing the processes of steps 420 to 445.
すなわち、ステップ420では、レバー操作によるブレ
ード制御開始前の初期のブレード姿勢における左右シリ
ンダ長(L、L)と現在の左10 RO
右シリンダ長(L、LR)との偏差(Δ1.。That is, in step 420, a deviation (Δ1.
Δ、IIR)をそれぞれ求める。Δ, IIR) respectively.
続いて、これらの偏差の絶対値1ΔJLl。Then, the absolute value of these deviations is 1ΔJLl.
1ΔJR1がともに0近傍の成る許容値ε以内に入って
いるか否かを判別しくステップ425)、許容値ε以内
に入っている場合にはブレード姿勢が初期状態に戻った
と判定して停止する。It is determined whether or not both 1ΔJR1 are within the tolerance value ε near 0 (step 425), and if they are within the tolerance value ε, it is determined that the blade posture has returned to the initial state and the process is stopped.
一方、許容値ε以内に入っていない場合にはステップ4
20で求めた偏差Δ1 、ΔJnに基づ[
いて左右シリンダへの流量指令値を計算する(ステップ
430)。なお、この流量指令値の計鐸は、ステップ1
70と同様にして行なわれる。On the other hand, if it is not within the tolerance value ε, step 4
Based on the deviations Δ1 and ΔJn obtained in step 20, the flow rate command values for the left and right cylinders are calculated (step 430). Note that this flow rate command value is measured in step 1.
This is done in the same manner as in 70.
ステップ435では上記求めたF’1指令値■[。In step 435, the above-determined F'1 command value ■[.
VRを出力し、ステップ440では上記指令値によって
制御されるブレードのチルト角αおよびアングル角βを
入力する。そして、この入力したチルト角αおよびアン
グル角βによって現在の左右シリンダ長(L、L)を計
算しくステップ[口
445)、ステップ420に戻って再度初期値との偏差
計算が行なわれる。VR is output, and in step 440, the tilt angle α and angle angle β of the blade controlled by the above command values are input. Then, the current left and right cylinder lengths (L, L) are calculated using the input tilt angle α and angle angle β (step 445), and the process returns to step 420 to calculate the deviation from the initial value again.
なお、ブレードの目標チルト角および目標アングル角の
与え方としては、本実施例に限らず、例えばダイヤル等
によって直接目標チルト角および目標アングル角を与え
るようにしてもよい。また、実際のシリンダ長の計測も
ブレードのチルト角およびアングル角から換韓する本実
施例に限らず、シリンダ長を直接計測するようにしても
よい。Note that the method of giving the target tilt angle and the target angle angle of the blade is not limited to this embodiment, and the target tilt angle and the target angle angle may be given directly by, for example, a dial or the like. Further, the actual measurement of the cylinder length is not limited to the present embodiment in which the measurement is performed based on the tilt angle and the angle angle of the blade, and the cylinder length may be directly measured.
更に、シリンダの伸縮速度は、該シリンダに流出入する
単位時間当りの油量を計測することによって求めること
も可能である。Furthermore, the expansion and contraction speed of the cylinder can also be determined by measuring the amount of oil per unit time that flows into and out of the cylinder.
更にまた、目標シリンダ長と実際のシリンダ長との偏差
に基づいて左右シリンダへの流量指令値を求める方法に
限らず、現在のブレード姿勢から右チルト、左チルト、
右アングル、左アングルさせるために必要な左右シリン
ダへの流量比を予めメモリテーブルに準備し、現在のブ
レード姿勢と該ブレードのチルトまたはアングル動作指
令とに基づいて前記メモリテーブルから所望の流量比を
読み出し、この読み出した流量比となるように左右のシ
リンダへの流量指令値を決定するようにしてもよい。Furthermore, the method is not limited to the method of determining the flow rate command value for the left and right cylinders based on the deviation between the target cylinder length and the actual cylinder length.
The flow rate ratios to the left and right cylinders required for right and left angles are prepared in advance in a memory table, and the desired flow rate ratios are calculated from the memory table based on the current blade posture and the tilt or angle operation command for the blade. Alternatively, the flow rate command values for the left and right cylinders may be determined so as to match the read flow rate ratio.
以上説明したように本発明によれば、ブレードをチルト
およびアングルさせるためのシリンダを2本にしたため
、M4造の[化を図ることができ、かつチルト動作また
はアングル動作のみを行なうように上記2本のシリンダ
を複合制御することができる。As explained above, according to the present invention, since there are two cylinders for tilting and angulating the blade, it is possible to use M4 construction, and the above-mentioned two cylinders can be used to tilt and angle the blade. The book cylinder can be controlled in multiple ways.
また、ブレードにかかる負荷等によってブレードが予定
外の姿勢変化をした場合あるいは予定外の姿勢変化をす
る場合に、好適な対処をとることができ、これにより更
にブレードの制御性の向上を図ることができる。In addition, if the blade changes its posture in an unplanned manner due to a load applied to the blade, etc., appropriate measures can be taken, thereby further improving the controllability of the blade. I can do it.
第1図は本発明によるブルドーザのブレード制m装置の
一実施例を示すブロック図、第2図は本発明に係るブル
ドーザのブレードa4!Iの一実施例を示す斜視図、第
3図(a)は左右対称にシリンダを取り付けた場合の左
右シリンダ長の組み合わせとブレード姿勢との関係を示
すグラフ、第3図(b)は第3図(a)の一部拡大図、
第4図および第13図は左右シリンダ長の組み合わせと
ブレード姿勢との好ましい関係を示すグラフ、第5図お
よび第6図はそれぞれ第2図の平面図および背面図、第
7図および第8図はそれぞれアングルおよびチルト時に
おける左右シリンダの伸縮関係を示す図、第9図ないし
第12図はそれぞれ第1図に示すCPUの本発明に係る
処理手順を示すフローチtp−ト、第14図は従来のブ
レード捻構の一例を示す分解斜視図である。
10・・・ブレード、11・・・Cフレーム、12・・
・センタビン、14・・・センタシャツ小、15.16
・・・シリンダ、20・・・チルトレバー、22・・・
アングルレバー、30・・・チルト角センサ、32・・
・アングル角センサ、34・・・中央処理袋@(CPU
)、36・・・メモリ、42.44・・・油圧パルプ。
第2図
(0) (b)
第3図
第4図
第9@
=1−】シリ)ダ畏(mm)
5゜
第14図FIG. 1 is a block diagram showing an embodiment of a bulldozer blade controlling device according to the present invention, and FIG. 2 is a block diagram showing an embodiment of a bulldozer blade a4! according to the present invention. FIG. 3(a) is a graph showing the relationship between the combination of the left and right cylinder lengths and the blade posture when the cylinders are installed symmetrically, and FIG. 3(b) is a perspective view showing one embodiment of I. A partially enlarged view of figure (a),
Figures 4 and 13 are graphs showing the preferred relationship between the combination of left and right cylinder lengths and the blade posture, Figures 5 and 6 are the top and rear views of Figure 2, respectively, and Figures 7 and 8. 9 to 12 are flowcharts showing the processing procedure of the CPU shown in FIG. 1 according to the present invention, and FIG. 14 is a conventional diagram FIG. 2 is an exploded perspective view showing an example of blade twisting. 10...Blade, 11...C frame, 12...
・Senta Bin, 14...Senta Shirt Small, 15.16
...Cylinder, 20...Tilt lever, 22...
Angle lever, 30...Tilt angle sensor, 32...
・Angle angle sensor, 34...Central processing bag @ (CPU
), 36...memory, 42.44...hydraulic pulp. Fig. 2 (0) (b) Fig. 3 Fig. 4 Fig. 9 @ = 1-] Cylinder) (mm) 5゜ Fig. 14
Claims (6)
ングル自在に連結したブレードとの間に配設される第1
、第2のシリンダであって、これらの各シリンダの長さ
の組み合わせによって前記ブレードのチルト角及びアン
グル角が一義的に定まる態様で配設した第1、第2のシ
リンダと、前記ブレードの目標チルト角および目標アン
グル角をそれぞれ指示する指示手段と、 前記目標チルト角および目標アングル角に基づいて前記
ブレードを当該目標チルト角および目標アングル角にす
るに必要な前記第1、第2のシリンダのそれぞれの目標
シリンダ長を換算する手段と、 前記第1、第2のシリンダのそれぞれのシリンダ長を検
出する検出手段と、 前記換算した第1のシリンダの目標シリンダ長と前記検
出した第1のシリンダの検出シリンダ長とに基づいて該
第1のシリンダが前記目標シリンダ長になるように制御
する第1のシリンダ制御手段と、 前記換算した第2のシリンダの目標シリンダ長と前記検
出した第2のシリンダの検出シリンダ長とに基づいて該
第2のシリンダが前記目標シリンダ長になるように制御
する第2のシリンダ制御手段と、 を具えたブルドーザのブレード制御装置。(1) A first blade disposed between a C frame and a blade connected to the C frame so as to be tiltable and angular.
, a second cylinder, the first and second cylinders arranged in such a manner that the tilt angle and angle angle of the blade are uniquely determined by the combination of the lengths of these cylinders; and the target of the blade. an instruction means for respectively instructing a tilt angle and a target angle angle; and an instruction means for instructing the first and second cylinders necessary to make the blade reach the target tilt angle and the target angle angle based on the target tilt angle and the target angle angle. means for converting respective target cylinder lengths; detection means for detecting respective cylinder lengths of the first and second cylinders; and the converted target cylinder length of the first cylinder and the detected first cylinder length. a first cylinder control means that controls the first cylinder to have the target cylinder length based on the detected cylinder length of the second cylinder; A bulldozer blade control device comprising: second cylinder control means for controlling the second cylinder to have the target cylinder length based on the detected cylinder length of the cylinder.
及びアングル角によって定まる前記第1、第2のシリン
ダの各シリンダ長を記憶する記憶手段と、前記目標チル
ト角及び目標アングル角に基づいて前記記憶手段から対
応する前記第1、第2のシリンダの各シリンダ長を読み
出す読取手段とから成る特許請求の範囲第(1)項記載
のブルドーザのブレード制御装置。(2) The means for converting the target cylinder length includes a storage means for storing each cylinder length of the first and second cylinders determined by the tilt angle and the angle angle, and a means for converting the target cylinder length based on the target tilt angle and the target angle angle. A bulldozer blade control device according to claim 1, further comprising reading means for reading each cylinder length of the corresponding first and second cylinders from the storage means.
ードのチルト角及びアングル角をそれぞれ検出する角度
検出手段と、この角度検出手段によって検出したチルト
角及びアングル角に基づいて前記第1、第2のシリンダ
の各シリンダ長を換算する手段とから成る特許請求の範
囲第(1)項記載のブルドーザのブレード制御装置。(3) The detection means for detecting the cylinder length includes an angle detection means for detecting the tilt angle and the angle angle of the blade, and the first and the first cylinder lengths based on the tilt angle and the angle angle detected by the angle detection means. 2. A bulldozer blade control device according to claim 1, comprising means for converting each cylinder length of two cylinders.
ル自在に連結し、このブレードとCフレームとの間に各
シリンダの長さの組み合わせによって前記ブレードのチ
ルト角及びアングル角が一義的に定まる態様で第1、第
2のシリンダを配設し、目標とするチルト角及びアング
ル角に基づいて前記第1、第2のシリンダを複合制御す
るブルドーザのブレード制御方法において、 前記ブレードが制御される前のチルト角及びアングル角
を検出し、これらを初期値として記憶し、前記ブレード
のチルト角およびアングル角のうちいずれか一方の目標
角を指示し、 前記目標角の指示による前記第1、第2のシリンダの複
合制御終了後、指示されなかった他方の角度を検出し、 前記検出した他方の角度と該他方の角度の前記初期値と
の偏差をとり、 前記一方の角度の現在の角度を変えずに前記偏差が許容
範囲内に入るように前記第1、第2のシリンダを更に複
合制御して前記ブレードの予定外の姿勢変化を修正する
ようにしたことを特徴とするブルドーザのブレード制御
方法。(4) A mode in which the blade is connected to the C frame so as to be tiltable and angular, and the tilt angle and angle of the blade are uniquely determined by the combination of the lengths of the respective cylinders between the blade and the C frame. A method for controlling a bulldozer blade in which first and second cylinders are arranged and the first and second cylinders are jointly controlled based on a target tilt angle and an angle angle, wherein: before the blade is controlled; detecting a tilt angle and an angle angle, storing these as initial values, and instructing a target angle for either one of the tilt angle and the angle angle of the blade; After completing the combined control of the cylinder, detect the other angle that was not instructed, take the deviation between the detected other angle and the initial value of the other angle, and do not change the current angle of the one angle. A bulldozer blade control method, characterized in that the first and second cylinders are further controlled in a combined manner so that the deviation falls within an allowable range, thereby correcting an unplanned attitude change of the blade.
ル自在に連結し、このブレードとCフレームとの間に各
シリンダの長さのに組み合わせによって前記ブレードの
チルト角及びアングル角が一義的に定まる態様で第1、
第2のシリンダを配設し、目標とするチルト角及びアン
グル角に基づいて前記第1、第2のシリンダを複合制御
するブルドーザのブレード制御方法において、 前記ブレードのチルト角およびアングル角のうち少なく
とも一方の目標角を指示し、 前記目標角の指示による前記第1、第2のシリンダの複
合制御中に、該第1、第2のシリンダの伸縮速度のうち
少なくとも一方が或る許容最低速度以下になったか否か
を判別し、 前記第1、第2のシリンダの伸縮速度のうち少なくとも
一方が或る許容最低速度以下になったことが判別される
と、前記第1、第2のシリンダの制御を禁止し、前記ブ
レードの予定外の姿勢変化を防止するようにしたことを
特徴とするブルドーザのブレード制御方法。(5) A mode in which the blade is connected to the C frame so that it can tilt and angle freely, and the tilt angle and angle of the blade are uniquely determined by the combination of the length of each cylinder between the blade and the C frame. First,
A method for controlling a blade of a bulldozer, in which a second cylinder is arranged and the first and second cylinders are jointly controlled based on a target tilt angle and an angle angle, at least among the tilt angle and the angle angle of the blade. one target angle is instructed, and during the combined control of the first and second cylinders according to the instruction of the target angle, at least one of the expansion and contraction speeds of the first and second cylinders is below a certain allowable minimum speed; If it is determined that at least one of the expansion and contraction speeds of the first and second cylinders has become below a certain allowable minimum speed, the first and second cylinders 1. A method for controlling a bulldozer blade, characterized in that control is prohibited to prevent an unexpected change in attitude of the blade.
ル自在に連結し、このブレードとCフレームとの間に各
シリンダの長さの組み合わせによって前記ブレードのチ
ルト角及びアングル角が一義的に定まる態様で第1、第
2のシリンダを配設し、目標とするチルト角及びアング
ル角に基づいて前記第1、第2のシリンダを複合制御す
るブルドーザのブレードの制御方法において、 前記ブレードが制御される前のチルト角及びアングル角
を検出し、これを初期値として記憶し、前記ブレードの
チルト角およびアングル角のうち少なくとも一方の目標
角を指示し、 前記目標角の指示による前記第1、第2のシリンダの複
合制御中に、該第1、第2のシリンダの伸縮速度がとも
に或る許容最低速度以下になったか否かを判別し、 前記第1、第2のシリンダの伸縮速度がともに或る許容
最低速度以下になったことが判別されると、前記目標角
の指示による前記第1、第2のシリンダの制御を禁止し
、 その後、前記記憶した初期値を目標角として前記第1、
第2のシリンダを複合制御し、前記ブレードを初期のブ
レード姿勢に復帰させるようにしたことを特徴とするブ
ルドーザのブレード制御方法。(6) A mode in which the blade is connected to the C frame so as to be tiltable and angular, and the tilt angle and angle of the blade are uniquely determined by the combination of the lengths of the respective cylinders between the blade and the C frame. In a method for controlling a bulldozer blade, which includes a first cylinder and a second cylinder, and performs combined control of the first and second cylinders based on a target tilt angle and an angle angle, before the blade is controlled. detecting a tilt angle and an angle angle of the blade, storing the detected values as initial values, and instructing a target angle of at least one of the tilt angle and the angle angle of the blade; During the combined control of the cylinder, it is determined whether the expansion and contraction speeds of the first and second cylinders are both below a certain allowable minimum speed; When it is determined that the speed has fallen below the allowable minimum speed, control of the first and second cylinders based on the target angle instruction is prohibited, and then the first and second cylinders are controlled using the stored initial value as the target angle.
A method for controlling a bulldozer blade, characterized in that a second cylinder is controlled in a combined manner to return the blade to an initial blade posture.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP24465586A JPS63118426A (en) | 1986-10-15 | 1986-10-15 | Controller and controlling method for blade of bulldozer |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP24465586A JPS63118426A (en) | 1986-10-15 | 1986-10-15 | Controller and controlling method for blade of bulldozer |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS63118426A true JPS63118426A (en) | 1988-05-23 |
Family
ID=17121977
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP24465586A Pending JPS63118426A (en) | 1986-10-15 | 1986-10-15 | Controller and controlling method for blade of bulldozer |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS63118426A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2022041636A (en) * | 2020-09-01 | 2022-03-11 | 株式会社小松製作所 | Work machine |
WO2023238504A1 (en) * | 2022-06-08 | 2023-12-14 | 株式会社小松製作所 | Work machinery, and method and system for controlling work machinery |
-
1986
- 1986-10-15 JP JP24465586A patent/JPS63118426A/en active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2022041636A (en) * | 2020-09-01 | 2022-03-11 | 株式会社小松製作所 | Work machine |
WO2023238504A1 (en) * | 2022-06-08 | 2023-12-14 | 株式会社小松製作所 | Work machinery, and method and system for controlling work machinery |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CA1330363C (en) | Robot system | |
US10407282B2 (en) | Position control of a boom tip | |
CA2243266C (en) | Control apparatus for a construction machine | |
JP3645038B2 (en) | Aircraft flight control equipment | |
US6088633A (en) | Mobile body controlling gear | |
US5418441A (en) | Deflection correcting method for a robot | |
EP0900887A1 (en) | Controller of construction machine | |
JPS63118426A (en) | Controller and controlling method for blade of bulldozer | |
JPH05116081A (en) | Weight and center of gravity position correcting device for force control working machine | |
JP2004010043A (en) | Steering method and steering system of vehicle | |
JPS63103130A (en) | Control system for blade attitude of bulldozer | |
US20240352706A1 (en) | Work machine and method for controlling work machine | |
JPS63103132A (en) | Control system for attitude of blade of bulldozer | |
JP4275199B2 (en) | Boom control device for work equipment | |
JP2000211896A (en) | Angle controlling method and its device | |
JPH10183669A (en) | Control device for construction machine | |
JPH0745742B2 (en) | Excavation control method for hydraulic excavator | |
JPH0683453A (en) | Load compensation control method for robot | |
JP2674918B2 (en) | Hydraulic excavator | |
JPH10183670A (en) | Control device for construction machine | |
JP2687169B2 (en) | Slope work control device for construction machinery | |
JPS63103131A (en) | Control system for attitude of blade of bulldozer | |
JP2574671B2 (en) | Control device for working machine in power shovel | |
JPH08270019A (en) | Construction machine | |
JPH0320531B2 (en) |