JPS63103131A - Control system for attitude of blade of bulldozer - Google Patents
Control system for attitude of blade of bulldozerInfo
- Publication number
- JPS63103131A JPS63103131A JP24708286A JP24708286A JPS63103131A JP S63103131 A JPS63103131 A JP S63103131A JP 24708286 A JP24708286 A JP 24708286A JP 24708286 A JP24708286 A JP 24708286A JP S63103131 A JPS63103131 A JP S63103131A
- Authority
- JP
- Japan
- Prior art keywords
- angle
- blade
- tilt
- cylinder
- cylinders
- 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 claims description 19
- 230000036544 posture Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 3
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 2
- 230000008602 contraction Effects 0.000 description 2
- 239000013256 coordination polymer Substances 0.000 description 2
- 230000007935 neutral effect Effects 0.000 description 2
- 230000001105 regulatory effect Effects 0.000 description 2
- 230000003321 amplification Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000010720 hydraulic oil Substances 0.000 description 1
- 229910052742 iron Inorganic materials 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 239000003921 oil Substances 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
Landscapes
- Operation Control Of Excavators (AREA)
Abstract
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明はブルドーザのブレードをシリンダによってチル
トおよびアングルさせるようにしたブルドーザのブレー
ド姿勢制御方法に関する。DETAILED DESCRIPTION OF THE INVENTION [Field of Industrial Application] The present invention relates to a bulldozer blade attitude control method in which the bulldozer blade is tilted and angled by a cylinder.
1従来ブルドーザのブレードをシリンダによってチルト
およびアングルさせるようにした橢構は、第10図に示
すように、ブレード1におけるセンタビンが配設される
ブラケット2と、Cフレーム3におけるジヨイント4と
を連結してブレード1をCフレーム3に対してセンタビ
ン及びジヨイント4の2つの軸回りに回動自在に配設し
、このCフレーム3とブレード1との間に2本のアング
ルシリンダ5a、5bおよび1本のチルトシリンダ6を
取り付けて構成されている。1. A conventional structure in which the blade of a bulldozer is tilted and angled by a cylinder connects a bracket 2 on which the center bin of the blade 1 is disposed and a joint 4 of the C frame 3, as shown in FIG. The blade 1 is arranged with respect to the C frame 3 so as to be rotatable around two axes, a center pin and a joint 4, and between the C frame 3 and the blade 1, two angle cylinders 5a, 5b and one angle cylinder are installed. It is constructed by attaching a tilt cylinder 6.
そして、ブレード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 the figure, 7 and 8 are lift cylinders, and 9 is a pitching prevention iron.
〔発明が解決しようとする問題点〕
しかし、上記従来のブレードのチルトおよびアングルの
制tiIl装置は、シリンダの数が多く、これに伴なっ
て機構も複雑となり、かつ作業m重量も増大するという
問題がある。[Problems to be Solved by the Invention] However, the conventional blade tilt and angle control device described above has a large number of cylinders, resulting in a complicated mechanism and an increase in work weight. There's a problem.
本発明は上記実情に鑑みてなされたもので、ブレードを
チルトおよびアングルさせるシリンダの数を2本にし、
握栴の簡略化、作業n重量の軽減を図り、かつチルト動
作またはアングル動作時にブレードのチルト角およびア
ングル角がその限界角を越える場合にはブレードの動作
を停止させることができるブルドーザのブレード姿勢制
御方法を提供することを目的とする。The present invention was made in view of the above-mentioned circumstances, and the number of cylinders for tilting and angulating the blade is reduced to two.
A bulldozer blade posture that simplifies handshaking, reduces work weight, and can stop blade operation if the tilt angle and angle angle of the blade exceed the limit angle during tilt or angle operation. The purpose is to provide a control method.
〔問題点を解決するための手段および作用〕本発明によ
れば、ブレードを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. In the first embodiment, the tilt angle and the angle angle of the blade are uniquely determined. A second cylinder is provided, and the first cylinder is controlled based on the tilt angle and angle angle as control targets. In a bulldozer blade attitude control method that performs combined control of a second cylinder, limit angles of the tilt angle and angle angle of the blade are set in advance, and a target angle of at least one of the tilt angle and the angle angle of the blade is set in advance. Instruct a new target angle to be changed, and change the first angle according to the instruction of the target angle. When the tilt angle and the angle angle of the blade are detected during the combined control of the second cylinder, and at least one of the detected tilt angle and the angle angle exceeds the set limit angle, the first... The operation of the second cylinder is stopped.
以下、本発明を添付図面を参照して詳細に説明する。 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 an embodiment of a bulldozer blade mechanism to which the present invention is applied. In the figure, a blade 10 is connected to a C frame 11 so as to be tiltable and angular. That is, the bracket 13 on which the center bin 12 of the blade 10 is disposed and the center shaft 14 of the C frame 11 are connected,
The blade 10 can rotate around the axis of the center bin 12 (angle direction) and around the axis of the center shaft 14 (tilt direction).
このブレード10とフレーム11との間には、ブレード
10をアングルおよびチルトさせるための2本のシリン
ダー5および16が取り付けられている。このシリンダ
ー5および16は、図示の、ようにブレード10の取付
部位に関して非対称に取り付けられており、またシリン
ダー5および16は、複合動作することにより、ブレー
ド10をアングル動作およびチルト動作させることかで
きる。Two cylinders 5 and 16 are attached between the blade 10 and the frame 11 to angle and tilt the blade 10. The cylinders 5 and 16 are attached asymmetrically with respect to the attachment site of the blade 10 as shown in the figure, and the cylinders 5 and 16 can perform a combined operation to angle and tilt the blade 10. .
次に、上記シリンダ15.16の好ましい取付態様につ
いて詳説する。Next, a preferred manner of mounting the cylinders 15, 16 will be explained in detail.
すなわち、左側シリンダ長と右側シリンダ長とによって
決定されるチルト角およびアングル角が第3図に示すグ
ラフの関係になるように2本のシリンダを取り付ける。That is, the two cylinders are installed so that the tilt angle and angle angle determined by the left cylinder length and the right cylinder length have the relationship shown in the graph shown in FIG.
なお、同図において点Oはチルト角およびアングル角が
ともに零のときの左右シリンダ長を示す。そして、左右
のシリンダ長の関係が矢印入方向に進むと左チルト、矢
印B方向に進むと右チルト、矢印C方向に進むと左アン
グル、矢印り方向に進むと右アングルすることを示す。Note that in the figure, point O indicates the left and right cylinder lengths when both the tilt angle and the angle angle are zero. Further, when the relationship between the left and right cylinder lengths goes in the direction of the arrow, it means a left tilt, when it goes in the direction of the arrow B, it means a right tilt, when it goes in the direction of the arrow C, it means a left angle, and when it goes in the direction of the arrow, it means a right angle.
また、ブレード動作と左右シリンダの伸縮との関係は、
第1表に示すように左アングル、右アングル、左チルト
、右チルトの4つの動作別にシリンダストローク変化が
全く異なる。In addition, the relationship between the blade movement and the expansion and contraction of the left and right cylinders is as follows.
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は縮退し、(
第7図参照)、また、左チルト時には左右のシリンダが
ともに縮退する(第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 when the angle is right, the left cylinder 15 is extended, the right cylinder 16 is retracted, and (
(See FIG. 7), and when tilting to the left, both the left and right cylinders retract (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 attitude control device according to the present invention.
同図において、チルトレバー2oおよびアングルレバ−
22はそれぞれブレード10のチルト角速度およびアン
グル角速度を指令するものであり、チルト角速度信号発
生器24およびアングル角速度信号発生器26はそれぞ
れチルトレバー20およびアングルレバ−22のレバー
操作量に応じたチルト角速度drおよびアングル角速度
731’を示すアナログ信号をA/D変換器28に出力
する。In the same figure, tilt lever 2o and 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 dr and angle angular velocity 731' 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つのアナログ信号をそれぞれ
デジタル信号に変換して中央処3!!!装置(CPU)
34に出力する。The A/D converter converts each of the four input analog signals into digital signals and sends them to the central processor 3! ! ! Device (CPU)
Output to 34.
CPU34は上記A/D変換器28を介して入’r
’r
力する4つのデータ(α 、β 、α、β)に基づいて
、ブレード30が指示されたチルト角あるいはアングル
角となるように2本のシリンダ15#16の各シリンダ
制11111iiを算出する。なお、CPU34の動作
の詳細については後述する。The CPU 34 receives input via the A/D converter 28.
'r Calculate each cylinder system 11111ii of the two cylinders 15#16 so that the blade 30 has the specified tilt angle or angle angle based on the four data (α, β, α, β) to be applied. . Note that details of the operation of the CPU 34 will be described later.
CPU34によって算出されたシリンダ制wJ値(各シ
リンダへの流量指令値)は、増幅器38゜40を介して
油圧パルプ42に加えられる。油圧バルブ42.44は
油圧源(図示せず)から圧油が加えられており、増幅器
38.40を介して入力する流量指令値に応じて所要の
流量(供給方向も含む)の作動油をシリンダ15.16
に加える。The cylinder control wJ value (flow rate command value to each cylinder) calculated by the CPU 34 is applied to the hydraulic pulp 42 via the amplifier 38-40. Hydraulic valves 42 and 44 are supplied with pressure oil from a hydraulic source (not shown), and supply the required flow rate (including the supply direction) of hydraulic oil according to the flow rate command value input via amplifiers 38 and 40. cylinder 15.16
Add to.
これにより、シリンダ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.
次に、CPLJ34の動作の詳細な説明に入る前に、本
発明が目的とする制御の概要について説明する。Next, before entering into a detailed explanation of the operation of the CPLJ 34, an overview of the control aimed at by the present invention will be explained.
第2図に示すようなブレード橢構においては左右シリン
ダ15.16のストロークエンドがブレードのチルト角
やアングル角の限界角を規制するためのストッパとはな
り得ない。すなわち、ブレード1、Cフレームおよびシ
リンダの相互の干渉を含む機械的干渉により、シリンダ
がストロークエンドに達する前にチルト角やアングル角
の限界角が現われる。In the blade structure shown in FIG. 2, the stroke ends of the left and right cylinders 15 and 16 cannot serve as stoppers for regulating the limit angles of the tilt angle and angle of the blade. That is, due to mechanical interference including mutual interference among the blade 1, the C frame, and the cylinder, the limit angle of the tilt angle or angle appears before the cylinder reaches the stroke end.
第4図は上記限界角の一例を示すもので、左チルト時の
チルト角αを正にとり、また左アングル角のアングル角
βを正にとると、αnaxおよびαminはそれぞれチ
ルト角αの最大限界角および最小限界角を示し、βla
Xおよびβninはそれぞれアングル角βの最大限界角
および最小限界角を示す。すなわち、ブレードは上記各
限界角の範囲内(第4図の斜線で示す範囲内)において
姿勢を変更することができる。Figure 4 shows an example of the above limit angles. If the tilt angle α when tilting to the left is positive, and the angle β of the left angle is positive, αnax and αmin are the maximum limits of the tilt angle α, respectively. and the minimum bounding angle, βla
X and βnin indicate the maximum limit angle and minimum limit angle of the angle angle β, respectively. That is, the blade can change its attitude within the range of each of the above-mentioned limit angles (within the range shown by diagonal lines in FIG. 4).
本発明では、チルト制御中あるいはアングル制御中に上
記範囲を越えるブレードの姿勢変更がある場合にはこれ
を禁止するようにしている。In the present invention, if there is a change in the posture of the blade that exceeds the above range during tilt control or angle control, this is prohibited.
次に、CP(J34の動作について第9図に示すフロー
チャートを参照しながら詳説する。Next, the operation of CP (J34) will be explained in detail with reference to the flowchart shown in FIG.
第9図において、まずブレードの現在のチルト角αおよ
びアングル角βを入力する(ステップ100)。次に、
チルトレバーおよびアングルレバ−がともに中立か否か
を判別する(ステップ110)。なお、この判別は、チ
ルト角速度指令α1およびアングル角速度指令jrが0
か否かによって行なう。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 α1 and the angle angular velocity command jr are 0.
It depends on whether or not.
そして、チルトレバーおよびアングルレバ−が、ともに
中立の場合には、ステップ100で入力したチルト角α
およびアングル角βをそれぞれ初期値(α 、β )と
して記憶する(ステップ240)。When the tilt lever and the angle lever are both neutral, the tilt angle α input in step 100 is
and angle angle β are respectively stored as initial values (α 1 , β 2 ) (step 240).
一方、チルトレバーおよびアングルレバ−のうち少なく
ともいずれか一方が操作されていると、ステップ120
に進み、ここで現在のシリンダ15.16の各シリンダ
長り、Lllを計算す[
る。On the other hand, if at least one of the tilt lever and the angle lever is operated, step 120
Proceed to step 1 and now calculate the length of each cylinder, Lll, of the current cylinder 15.16.
この計算に際し、本発明では前述したように、左右のシ
リンダが、該左右のシリンダの長さの組み合わせとブレ
ード姿勢(チルト角、アングル角)とが一対一に対応す
るように設けられているため、逆にチルト角、アングル
角から左右のシリンダ長を求めるようにしている。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. Conversely, the left and right cylinder lengths are determined from the tilt angle and angle angle.
すなわち、前述の第3図に示した左右シリンダ長とブレ
ード姿勢との関係から、チルト角およびアングル角に基
づいて左右のシリンダ長を求めるための換算テーブルを
予めメモリ36(第1図)に準備し、チルト角およびア
ングル角によって決定される左右のシリンダ長をこの換
算テーブルから読み出すようにしている。That is, from the relationship between the left and right cylinder lengths and the blade posture shown in FIG. 3 above, a conversion table for determining the left and right cylinder lengths based on the tilt angle and angle angle is prepared in advance in the memory 36 (FIG. 1). The left and right cylinder lengths determined by the tilt angle and angle angle are then read from this conversion table.
次に、チルト角速度指令ルーおよびアングル角速度指令
β1を入力しくステップ130)、目標チルト角α1お
よび目標アングル角β1を次式から埠出゛する(ステッ
プ140)。Next, the tilt angular velocity command R and angle angular velocity command β1 are input (step 130), and the target tilt angle α1 and target angle angle β1 are derived from the following equation (step 140).
α ←α1+6r ◆Δt
・・・・・・ (1)
β ←βr +5 r・Δt
上式に示すように各目標角は、前回の各目標角にレバー
によって指示される角度増幅弁を加算することにより求
めるようにしている。なお、Δtはこのフローチャート
に示す1サイクルの処理時間を示す。また、初回の目標
角を求める場合には、ステップ240で記憶した初期値
(α 、β0)を用いる。α ←α1+6r ◆Δt ・・・・・・ (1) β ←βr +5 r・Δt As shown in the above formula, each target angle is obtained by adding the angle amplification valve instructed by the lever to each previous target angle. I try to ask for more. Note that Δt indicates the processing time of one cycle shown in this flowchart. Furthermore, when determining the first target angle, the initial values (α, β0) stored in step 240 are used.
続いて、現在のチルト角αが予め設定したチルト角の最
小限界角αiinおよび最大限界角αlaXの範囲以内
に入っているか否かを判別する(ステップ150)。上
記範囲内に入っている場合にはステップ170に進み、
範囲内に入っていない場合にはステップ160に進む。Subsequently, it is determined whether the current tilt angle α is within the range of the preset minimum tilt angle αiin and maximum tilt angle αlaX (step 150). If it is within the above range, proceed to step 170;
If it is not within the range, the process advances to step 160.
ステップ160は上記ステップ140で求めた目標チル
ト角α1の絶対値1αr1が現在のチルト角αの絶対値
1α1よりも小さいか否かを判別する。そして、1α’
+1α1の場合にはステップ170に進み、1αr1
≧1α1の場合にはステップ190に進む。In step 160, it is determined whether the absolute value 1αr1 of the target tilt angle α1 obtained in step 140 is smaller than the absolute value 1α1 of the current tilt angle α. And 1α'
In the case of +1α1, the process proceeds to step 170, and 1αr1
If ≧1α1, the process proceeds to step 190.
また、アングル角についても同様に、ステップ170で
現在のアングル角βが予め設定したアングル角の最小限
界角βlinおよび最大限界角βlaXの範囲以内に入
っているか否かを判別し、上記範囲内に入っている場合
にはステップ200に進み、範囲内に入っていない場合
にはステップ180に進む。Similarly, regarding the angle angle, in step 170, it is determined whether the current angle angle β is within the range of the preset minimum limit angle βlin and maximum limit angle βlaX, and whether or not the current angle angle β is within the above range. If it is within the range, the process advances to step 200; if it is not within the range, the process advances to step 180.
ステップ180は上記ステップ140で求めた目標アン
グル角β の絶対値1βr1が現在のアングル角βの絶
対値1β1よりもの小さいか否かを判別する。そして、
1βr1く1β1の場合にはステップ200に進み、1
β1≧1β1の場合にはステップ190に進む。Step 180 determines whether the absolute value 1βr1 of the target angle β obtained in step 140 is smaller than the absolute value 1β1 of the current angle β. and,
If 1βr1 minus 1β1, the process proceeds to step 200, and 1
If β1≧1β1, the process proceeds to step 190.
ステップ190は左右のシリンダへの流量指令値V、V
、としてともに0の指令値を出力す[
る。これにより左右のシリンダの動作は停止する。Step 190 is the flow rate command values V, V to the left and right cylinders.
, both output command values of 0. This causes the left and right cylinders to stop operating.
すなわち、ステップ150〜180は、現在のチルト角
およびアングル角がともに設定した限界角の範囲内にあ
る場合、および設定した限界角を越えても制御目標角の
絶対値が現在の角度の絶対値よりも小さくなる場合(す
なわちブレード姿勢を前記限界角によって設定される範
囲内に戻す場合)にはシリンダの動作は禁止せず、次の
ステップ200に進めるが、それ以外の場合はステップ
190に進め、ブレード姿勢が所定範囲を越えないよう
に規制する。That is, in steps 150 to 180, if both the current tilt angle and the angle angle are within the set limit angle, and even if the set limit angle is exceeded, the absolute value of the control target angle is the absolute value of the current angle. (i.e., when the blade attitude is returned to within the range set by the limit angle), the operation of the cylinder is not prohibited and the process proceeds to the next step 200; otherwise, the process proceeds to step 190. , the blade posture is regulated so as not to exceed a predetermined range.
ステップ200では、ステップ140で求めた各目標角
(α 、β1)から前述のステップ120と同様にして
目標角シリンダ長(L、r、LRr)を求める。In step 200, the target angle cylinder lengths (L, r, LRr) are determined from each target angle (α, β1) determined in step 140 in the same manner as in step 120 described above.
次に、目標シリンダ長くLlr、 Rr)と現り 在のシリンダ長(L、L)との偏差Δ11゜[R ΔJIRを次式、 ΔJ=L、 ’−1゜ ・・・・・・ (2) から算出しくステップ210)、この偏差Δj2.。Next, the target cylinder length appears as Llr, Rr). Deviation from the current cylinder length (L, L) Δ11° [R ΔJIR is expressed by the following formula, ΔJ=L,'-1゜ ・・・・・・(2) Step 210), this deviation Δj2. .
ΔlRを速やかに零にするために必要な左右シリンダへ
の流量指令値V、、V□を次式、V =AΔJE+B
Δれ+CΣΔ11・Δt[
V =AΔIR+BΔjR+CΣΔJtR・Δt・・
・・・・ (3)
から求める(ステップ220)。なお、上式において、
A、B、Cは、比例、微分、積分補償要素の各係数であ
る。The flow rate command values V, , V□ for the left and right cylinders required to quickly bring ΔlR to zero can be calculated using the following formula: V = AΔJE+B
ΔR+CΣΔ11・Δt[V=AΔIR+BΔjR+CΣΔJtR・Δt・・
(3) Obtain from (step 220). In addition, in the above formula,
A, B, and C are coefficients of proportional, differential, and integral compensation elements.
このようにして求めた流量指令値■ 、VRは、[
前述したようにCPU34から出力される(ステップ2
30)。The flow rate command value ■ and VR obtained in this way are outputted from the CPU 34 as described above (step 2).
30).
なお、ブレードの目標チルト角および目標アングル角の
与え方としては、本実施例に限らず、例えばダイヤル等
によって直接目標角および目標角を与えるようにしても
よい。また、実際のシリンダ長の計測もブレードのチル
ト角およびアングル角から換算する本実施例に限らず、
シリンダ長を直接計測するようにしてもよい。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 angle and the target angle may be given directly by, for example, a dial or the like. In addition, the actual cylinder length measurement is not limited to this example where the conversion is made from the blade tilt angle and angle angle.
The cylinder length may also be directly measured.
更に、目標シリンダ長と実際のシリンダ長と偏差に基づ
いて左右シリンダへの流量指令値を求める方法に限らず
、現在のブレード姿勢から右チルト、左チルト、右アン
グル、左アングルさせるために必要な左右シリンダの流
量比を予めメモリテーブルに準備し、現在のブレード姿
勢と該ブレードのチルトまたはアングル動作指令とに基
づいて前記メモリテーブルから所望の流量比を読み出し
、この読み出した流量比となるように左右のシリンダへ
の流量指令値を決定するようにしてもよい。Furthermore, in addition to the method of determining the flow rate command value for the left and right cylinders based on the target cylinder length and actual cylinder length and deviation, it is also possible to The flow rate ratio of the left and right cylinders is prepared in advance in a memory table, and a desired flow rate ratio is read out from the memory table based on the current blade posture and the tilt or angle operation command of the blade, and the flow rate ratio is set to the read flow rate ratio. The flow rate command values for the left and right cylinders may be determined.
〔発明の効果]
以上説明したように本発明によれば、ブレードをチルト
およびアングルさせるためのシリンダを2本にしたため
、構造の簡略化を図ることができる。またチルト動作ま
たはアングル動作中に、ブレードのチルト角またはアン
グル角がその限界角を越える場合には、ブレードの動作
を停止させるようにしたため、ブレード、Cフレーム、
シリンダ間における機械的干渉を未然に防止することが
できる。[Effects of the Invention] As explained above, according to the present invention, since there are two cylinders for tilting and angulating the blade, the structure can be simplified. In addition, if the tilt angle or angle angle of the blade exceeds the limit angle during tilt or angle operation, the blade operation is stopped, so the blade, C frame,
Mechanical interference between cylinders can be prevented.
第1図は本発明によるブルドーザのブレード制御装置の
一実施例を示すブロック図、第2図は本発明に係るブル
ドーザのブレード機構の一実施例を示す斜視図、第3図
は左右シリンダ長の組み合わせとブレード姿勢との好ま
しい関係を示すグラフ、第4図はブレード姿勢のとり得
る範囲の一例を示すグラフ、第5図および第6図はそれ
ぞれ第2図の平面図および背面図、第7図および第8図
はそれぞれアングルおよびチルト時における左右シリン
ダの伸縮関係を示す図、第9図は第1図に示すCPLI
の本発明に係る処理手順を示すフローチャート、第10
図は従来のブレードamの一例を示す分解斜視図である
。
1o・・・ブレード、11・・・Cフレーム、12・・
・センタビン、14・・・センタシャツi〜、15.1
6・・・シリンダ、20・・・チルトレバー、22・・
・アングルレバ−130・・・チルト角センサ、32・
・・アングル角センサ、34・・・中央処理装置(CP
tJ) 、36・・・メモリ、42.44・・・油圧パ
ルプ。
第2図
8009001000 11001200130014
00 +500丘儒IJジノ〉夕ど(コ艷(mm )
第4図
第6図
第9図Fig. 1 is a block diagram showing an embodiment of a bulldozer blade control device according to the present invention, Fig. 2 is a perspective view showing an embodiment of a bulldozer blade mechanism according to the invention, and Fig. 3 is a block diagram showing an embodiment of a bulldozer blade control device according to the present invention. A graph showing a preferable relationship between combinations and blade postures, FIG. 4 is a graph showing an example of a possible range of blade postures, FIGS. 5 and 6 are respectively a plan view and a back view of FIG. 2, and FIG. 7 and Fig. 8 are diagrams showing the expansion/contraction relationship of the left and right cylinders during angle and tilt, respectively, and Fig. 9 is a diagram showing the CPLI shown in Fig. 1.
Flowchart showing the processing procedure according to the present invention, No. 10
The figure is an exploded perspective view showing an example of a conventional blade am. 1o...Blade, 11...C frame, 12...
・Senta Bin, 14...Senta Shirt i~, 15.1
6...Cylinder, 20...Tilt lever, 22...
・Angle lever 130...Tilt angle sensor, 32・
...Angle angle sensor, 34...Central processing unit (CP
tJ), 36...Memory, 42.44...Hydraulic pulp. Figure 2 8009001000 11001200130014
00 +500 Hill Confucian IJ Jino> Evening (ko 艷 (mm) Figure 4 Figure 6 Figure 9
Claims (2)
ル自在に連結し、このブレードとCフレームとの間に各
シリンダの長さの組み合わせによって前記ブレードのチ
ルト角及びアングル角が一義的に定まる態様で第1、第
2のシリンダを配設し、制御目標とするチルト角及びア
ングル角に基づいて前記第1、第2のシリンダを複合制
御するブルドーザのブレード姿勢制御方法において、前
記ブレードのチルト角及びアングル角の限界角を予め設
定しておき、 前記ブレードのチルト角及びアングル角のうち少なくと
も一方の目標角を変更する新たな目標角を指示し、 前記目標角の指示による前記第1、第2のシリンダの複
合制御中に前記ブレードのチルト角及びアングル角を検
出し、 前記検出したチルト角及びアングル角のうち少なくとも
一方が前記設定した限界角を越えると、前記第1、第2
のシリンダの動作を停止させるようにしたことを特徴と
するブルドーザのブレード姿勢制御方法。(1) 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 lengths of each cylinder between the blade and the C frame. In a bulldozer blade attitude control method, a bulldozer blade attitude control method includes providing a first cylinder and a second cylinder, and controlling the first and second cylinders in a combined manner based on a tilt angle and an angle angle as control targets. A limit angle of the angle angle is set in advance, and a new target angle for changing the target angle of at least one of the tilt angle and the angle angle of the blade is specified, and the first and second angles are changed according to the instruction of the target angle. detecting the tilt angle and angle angle of the blade during combined control of the cylinder; and when at least one of the detected tilt angle and angle angle exceeds the set limit angle, the first and second
A bulldozer blade attitude control method, characterized in that the operation of a cylinder is stopped.
くとも一方が前記設定した限界角を越え、かつ限界角を
越えた角度の制御目標角の絶対値がその検出した角度の
絶対値以上のとき、前記第1、第2のシリンダの動作を
停止させるようにしたことを特徴とする特許請求の範囲
第(1)項記載のブルドーザのブレード姿勢制御方法。(2) When at least one of the detected tilt angle and angle angle exceeds the set limit angle, and the absolute value of the control target angle of the angle exceeding the limit angle is greater than or equal to the absolute value of the detected angle; 2. A bulldozer blade attitude control method according to claim 1, wherein the first and second cylinders are stopped in operation.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP24708286A JPS63103131A (en) | 1986-10-17 | 1986-10-17 | Control system for attitude of blade of bulldozer |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP24708286A JPS63103131A (en) | 1986-10-17 | 1986-10-17 | Control system for attitude of blade of bulldozer |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS63103131A true JPS63103131A (en) | 1988-05-07 |
Family
ID=17158160
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP24708286A Pending JPS63103131A (en) | 1986-10-17 | 1986-10-17 | Control system for attitude of blade of bulldozer |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS63103131A (en) |
-
1986
- 1986-10-17 JP JP24708286A patent/JPS63103131A/en active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5826666A (en) | Apparatus and method for controlling a contruction machine | |
CA1255781A (en) | Boom control system | |
US4332517A (en) | Control device for an earthwork machine | |
CA1330363C (en) | Robot system | |
EP0900887A1 (en) | Controller of construction machine | |
JPH0145324B2 (en) | ||
JPS63103131A (en) | Control system for attitude of blade of bulldozer | |
JPH076212B2 (en) | Position control device for power shovel | |
JPS63103132A (en) | Control system for attitude of blade of bulldozer | |
JPH0428509B2 (en) | ||
JPS61126413A (en) | Tilt angle sensor of moving type crane | |
JPS63103130A (en) | Control system for blade attitude of bulldozer | |
JP2589566B2 (en) | Automatic control system for tunnel lining machine | |
JPH0644958Y2 (en) | Leveling equipment for aerial work vehicles | |
JPH02232430A (en) | Controller for depth of excavation of hydraulic shovel | |
JPS63118426A (en) | Controller and controlling method for blade of bulldozer | |
JPH0622717Y2 (en) | Leveling equipment for aerial work vehicles | |
JPH0324933B2 (en) | ||
JPH0441219B2 (en) | ||
JPH0745743B2 (en) | Linear excavation control device for hydraulic excavator | |
JPH0527433Y2 (en) | ||
JP3252689B2 (en) | Horizontal retraction of crane | |
JP2559714B2 (en) | Tractor | |
JPH01285106A (en) | Rolling structure of operating device of working vehicle | |
JPS6225903A (en) | Rolling controller of earth working machine |