JPH0313377B2 - - Google Patents
Info
- Publication number
- JPH0313377B2 JPH0313377B2 JP56152020A JP15202081A JPH0313377B2 JP H0313377 B2 JPH0313377 B2 JP H0313377B2 JP 56152020 A JP56152020 A JP 56152020A JP 15202081 A JP15202081 A JP 15202081A JP H0313377 B2 JPH0313377 B2 JP H0313377B2
- Authority
- JP
- Japan
- Prior art keywords
- arm
- boom
- trajectory
- angle
- tip
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Lifetime
Links
- 238000009412 basement excavation Methods 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000000034 method Methods 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 9
- 238000006073 displacement reaction Methods 0.000 description 4
- 239000010720 hydraulic oil Substances 0.000 description 2
- 239000003921 oil Substances 0.000 description 2
- NCGICGYLBXGBGN-UHFFFAOYSA-N 3-morpholin-4-yl-1-oxa-3-azonia-2-azanidacyclopent-3-en-5-imine;hydrochloride Chemical compound Cl.[N-]1OC(=N)C=[N+]1N1CCOCC1 NCGICGYLBXGBGN-UHFFFAOYSA-N 0.000 description 1
- 230000001934 delay Effects 0.000 description 1
- 238000011010 flushing procedure Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000002945 steepest descent method Methods 0.000 description 1
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Operation Control Of Excavators (AREA)
Description
【発明の詳細な説明】
本発明は油圧シヨベルのバツクホウやローダシ
ヨベルなどのバケツト刃先の移動軌跡すなわち掘
削軌跡を制御する方法に関するものである。DETAILED DESCRIPTION OF THE INVENTION The present invention relates to a method for controlling the movement locus, that is, the excavation locus, of a bucket tip of a hydraulic shovel or a loader shovel.
第1図は油圧シヨベルを示す図で、走行可能な
シヨベル本体上の旋回体1の前部にはブーム2が
ブームシリンダ5によつて回動可能に枢着され、
またブーム2の先端にはアーム3がアームシリン
ダ6によつて回動可能に枢着され、さらにアーム
3の先端にはバケツト4がバケツトシリンダ7に
よつて回動可能に枢着されている。各シリンダは
運転席8に配置された操作レバーにより操作され
る。単純な掘削作業は、これらの油圧シリンダを
順次操作することによつて行なえるが、斜面の仕
上げ作業や溝底を水平に掘削する作業のようにバ
ケツト4を一定の直線に沿つて動かす場合には、
各油圧シリンダを同時に操作しなければならな
い。従来、このような作業を行なえるのは非常に
熟練した運転者に限られ、ほとんどの場合は手作
業に頼つているため作業能率が劣る。 FIG. 1 shows a hydraulic excavator, in which a boom 2 is pivotally attached to the front part of a revolving structure 1 on a movable excavator body by a boom cylinder 5,
An arm 3 is rotatably attached to the tip of the boom 2 by an arm cylinder 6, and a bucket 4 is rotatably attached to the tip of the arm 3 by a bucket cylinder 7. . Each cylinder is operated by an operating lever located on the driver's seat 8. Simple excavation work can be performed by sequentially operating these hydraulic cylinders, but when moving the bucket 4 along a fixed straight line, such as finishing a slope or horizontally excavating the bottom of a trench, teeth,
Each hydraulic cylinder must be operated simultaneously. Conventionally, only highly skilled drivers are able to carry out such work, and in most cases they rely on manual labor, resulting in poor work efficiency.
第1図に示す油圧シヨベルにおいて、のよ
うな直線に沿つて掘削を行なうためには、バケツ
ト4の取付位置であるアーム3の先端部Cを
P′Q′のような直線に沿つて動かす移動軌跡の制御
と、バケツト4の刃先が掘削面に対して一定の角
度を保つようなバケツト姿勢の制御とを同時に行
なう必要がある。アーム先端の移動軌跡の制御は
ブームシリンダ5およびアームシリンダ6の同時
操作により、また、バケツト4の姿勢の制御はバ
ケツトシリンダ7の操作により行なわれる。 In the hydraulic excavator shown in Fig. 1, in order to excavate along a straight line such as
It is necessary to simultaneously control the locus of movement along a straight line such as P'Q' and control the attitude of the bucket so that the cutting edge of the bucket 4 maintains a constant angle with respect to the excavation surface. The movement locus of the tip of the arm is controlled by simultaneous operation of the boom cylinder 5 and the arm cylinder 6, and the attitude of the bucket 4 is controlled by the operation of the bucket cylinder 7.
アーム3先端の移動軌跡を制御するための種々
の発明、考案がなされている。たとえば、特開昭
49−132801などがある。しかし、これらの装置に
おいては、軌跡を制御するのに、アームシリンダ
6、ブームシリンダ5の位置や角度を常にフイー
ドバツクして制御しているので、油圧シヨベルの
ように慣性体の重量が大きく、また作動油の圧縮
性のため、系の安定性、速応性に問題があり、ハ
ンチングをおこしたり、制御系に遅れが生じて、
実際に要求されるスピードで制御できないなどの
実現性に欠ける問題点がある。この問題を解決す
べく第2図に示す方法が提案されている。 Various inventions and ideas have been made to control the movement locus of the tip of the arm 3. For example, Tokukai Akira
49-132801 etc. However, in these devices, the trajectory is controlled by constantly feedbacking the positions and angles of the arm cylinder 6 and boom cylinder 5, so the weight of the inertial body is large like a hydraulic excavator, and Due to the compressibility of the hydraulic oil, there are problems with system stability and quick response, causing hunting and delays in the control system.
There are problems with the lack of feasibility, such as the inability to control at the speed actually required. In order to solve this problem, a method shown in FIG. 2 has been proposed.
第2図はアーム先端の移動軌跡を制御するため
の従来の制御装置の一例を示したものである。図
において、10,11はそれぞれブームシリンダ
5、アームシリンダ6に接続された可変吐出量ポ
ンプ、12,13はポンプ10,11の吐出量、
吐出方向を決めるすなわち斜板の傾転量、傾転方
向を決める吐出量コントローラである。この吐出
量コントローラ12,13は制御装置26(説明
後述)の信号により制御される。14,15はポ
ンプ10,11の斜板の傾転量、傾転方向すなわ
ち吐出量、吐出方向を検出する変位計、16,1
7はドレンから逃げた油や、シリンダ5,6のボ
トム側とロツド側の面積差により管路に不足する
作動油の補給をするチヤージポンプ、18,19
はシヤトルバルブ、20,21は余分の油をタン
ク29に戻すためのフラツシングバルブ、22,
23は管路の圧力を常に一定圧力に保持するリリ
ーフバルブ、24,25はチヤージポンプ16,
17の吐出側管路に設けられたリリーフバルブ、
26は吐出量コントローラ12,13を制御する
制御装置、27はポンプ10(吐出量コントロー
ラ12)を操作するためのブームレバー、28は
ポンプ11(吐出量コントローラ13)を操作す
るためのアームレバー、30はブーム2とアーム
3との相対角度を検出する角度計である。 FIG. 2 shows an example of a conventional control device for controlling the movement locus of the tip of the arm. In the figure, 10 and 11 are variable discharge volume pumps connected to the boom cylinder 5 and arm cylinder 6, respectively, 12 and 13 are the discharge volumes of the pumps 10 and 11,
This is a discharge amount controller that determines the discharge direction, that is, the amount and direction of tilting of the swash plate. The discharge amount controllers 12 and 13 are controlled by signals from a control device 26 (described later). 14 and 15 are displacement meters that detect the amount and direction of tilting of the swash plates of the pumps 10 and 11, that is, the discharge amount and the discharge direction;
7 is a charge pump that replenishes the oil that escaped from the drain and the hydraulic oil that is insufficient in the pipe line due to the difference in area between the bottom side and rod side of cylinders 5 and 6, 18, 19
is a shuttle valve, 20, 21 is a flushing valve for returning excess oil to the tank 29, 22,
23 is a relief valve that always maintains the pressure in the pipeline at a constant pressure; 24 and 25 are charge pumps 16;
A relief valve provided in the discharge side pipe of No. 17,
26 is a control device for controlling the discharge rate controllers 12 and 13; 27 is a boom lever for operating the pump 10 (discharge rate controller 12); 28 is an arm lever for operating the pump 11 (discharge rate controller 13); 30 is an angle meter that detects the relative angle between the boom 2 and the arm 3.
第3図は第2図に示した制御装置26の一例を
示す図である。図において26a,26b,26
dは増幅器、26eは掛算器、26fは加算器、
26g,26hは比較器、26iはスイツチ、2
6jはブーム2とアーム3との相対角度を検出す
る角度計30の出力信号θを入力し、信号θを掘
削する軌跡に応じた関数に基づいて信号Qに変換
する関数発生器である。 FIG. 3 is a diagram showing an example of the control device 26 shown in FIG. 2. In the figure, 26a, 26b, 26
d is an amplifier, 26e is a multiplier, 26f is an adder,
26g, 26h are comparators, 26i is a switch, 2
6j is a function generator which inputs the output signal θ of the angle meter 30 that detects the relative angle between the boom 2 and the arm 3, and converts the signal θ into a signal Q based on a function corresponding to the excavation trajectory.
つぎに上述した従来の掘削制御装置の動作につ
いて説明する。まず、軌跡制御をしないときに
は、スイツチ26iを開いておく。このとき、ア
ームレバー28を操作すると、アームレバー28
の操作信号AMLが増幅器26aを経て、吐出量
コントローラ13にPAMとして送られ、ポンプ1
1の斜板が作動し、ポンプ11の吐出量が変化す
る。この結果アームシリンダ6がポンプ11の吐
出量に応じて変位する。この変位量は信号PAMOと
して変位計15から出力される。この信号PAMOは
比較器26gに送られて、偏差PAM−PAMOが増幅
器26aに送られ、PAM=PAMOとなるようにポン
プ11の斜板が制御される。同様に、ブームレバ
ー27の操作量に応じた速度でブームシリンダ5
が作動される。 Next, the operation of the conventional excavation control device mentioned above will be explained. First, when not performing trajectory control, the switch 26i is left open. At this time, when the arm lever 28 is operated, the arm lever 28
The operation signal AML is sent to the discharge amount controller 13 as P AM through the amplifier 26a, and the pump 1
The swash plate 1 operates, and the discharge amount of the pump 11 changes. As a result, the arm cylinder 6 is displaced in accordance with the discharge amount of the pump 11. This amount of displacement is output from the displacement meter 15 as a signal P AMO . This signal P AMO is sent to the comparator 26g, the deviation P AM -P AMO is sent to the amplifier 26a, and the swash plate of the pump 11 is controlled so that P AM =P AMO . Similarly, the boom cylinder 5 is operated at a speed corresponding to the operation amount of the boom lever 27.
is activated.
つぎに、軌跡制御を行う場合について説明す
る。この場合にはスイツチ26iを閉じておく。
このとき、関数発生器26jから信号θをある関
数に基づいて変換した信号が出力される。この関
数発生器26jは例えばアーム先端Cを設定軌跡
上′′に動かすには、ブーム2とアーム3との相
対角度がある角度のときブームシリンダ5をアー
ムシリンダ6の速度の何倍の速度で作動させれば
よいかを決めるものであり、上記関数はあらかじ
め計算して、関数発生器26jに記憶させてお
く。そして、関数発生器26jの出力信号Qと増
幅器26dの出力信号KPAMOが掛算器26eに入
力される。これにより掛算器26eからは信号
QKPAMOが出力される。そして、信号QKPAMOが
加算器26fを介して増幅器26bに入力され、
増幅器26bの出力信号PBOによつて吐出量コン
トローラ12が制御され、ポンプ10の吐出量す
なわちブームシリンダ5の速度が制御される。し
たがつてオペレータがアームレバー28を適宜操
作すると、その操作信号に基づいて、ブーム2が
あらかじめ関数発生器26jに設定された関数に
従つてアーム3と関連した動作を行ない、アーム
先端Cが設定された軌跡上を動く。このように、
フイードバツクをとらないで軌跡を制御できるの
で、ハンチングもなく、大きいスピードで制御す
ることができる。 Next, a case in which trajectory control is performed will be described. In this case, switch 26i is closed.
At this time, the function generator 26j outputs a signal obtained by converting the signal θ based on a certain function. For example, in order to move the arm tip C along a set trajectory, the function generator 26j sets the boom cylinder 5 at several times the speed of the arm cylinder 6 when the relative angle between the boom 2 and the arm 3 is a certain angle. This is to determine whether or not to operate the function, and the above function is calculated in advance and stored in the function generator 26j. Then, the output signal Q of the function generator 26j and the output signal KP AMO of the amplifier 26d are input to the multiplier 26e. As a result, the signal from the multiplier 26e is
QKP AMO is output. Then, the signal QKP AMO is input to the amplifier 26b via the adder 26f,
The discharge amount controller 12 is controlled by the output signal PBO of the amplifier 26b, and the discharge amount of the pump 10, that is, the speed of the boom cylinder 5 is controlled. Therefore, when the operator operates the arm lever 28 appropriately, based on the operation signal, the boom 2 performs an operation related to the arm 3 according to the function set in advance in the function generator 26j, and the arm tip C moves according to the set value. move on the trajectory. in this way,
Since the trajectory can be controlled without taking feedback, there is no hunting and the control can be performed at high speed.
しかし、この装置においては、関数発生器26
jに記憶させておく関数は、各種の検出器、装置
が正常であることを前提にして、計算している
が、実際には各種の誤差がある。例えば、アーム
3とブーム2の相対角度を検出する角度計のゼロ
点およびゲインのずれがあつた場合やアームレバ
ー28、ブームレバー27の操作量に応じた速度
でアームシリンダ7、ブームシリンダ5が作動し
ない場合、すなわち、第3図におけるAML信号
とアームシリンダ7の速度VAMが第4図の実線の
ようになつているような場合である。これらの誤
差は、装置組立時における取付け時や時間が経過
することによつて生ずる経年変化などにより、ど
うしても生ずるものなので、実際上なくすことは
できない誤差である。従来例ではこれらの誤差が
あると、アーム3の先端Cの軌跡は設定した軌跡
と大幅にずれてしまう欠点があつた。 However, in this device, the function generator 26
The functions stored in j are calculated on the assumption that various detectors and devices are normal, but in reality there are various errors. For example, if there is a shift in the zero point and gain of the angle meter that detects the relative angle between the arm 3 and the boom 2, or if the arm cylinder 7 and boom cylinder 5 move at a speed corresponding to the amount of operation of the arm lever 28 and boom lever 27, This is a case where the AML signal in FIG. 3 and the velocity V AM of the arm cylinder 7 are as shown by the solid line in FIG. 4. These errors inevitably occur during installation during device assembly or due to secular changes that occur over time, so they are errors that cannot be eliminated in practice. In the conventional example, these errors caused the trajectory of the tip C of the arm 3 to deviate significantly from the set trajectory.
本発明は上述の事柄にもとづいてなされたもの
で、掘削軌跡制御装置を構成する各装置にゼロ点
のずれやゲインのずれがあつても、アームの先端
の軌跡を設定通りに制御することができる油圧シ
ヨベルの掘削軌跡制御方法を提供することを目的
とする。 The present invention has been made based on the above-mentioned matters, and it is possible to control the trajectory of the tip of the arm as set even if there is a shift in the zero point or a shift in the gain in each device that makes up the excavation trajectory control device. The purpose of this invention is to provide a method for controlling the excavation trajectory of a hydraulic excavator.
本発明は上記の目的を達成するために、関数発
生器に記憶された関数に基づいて軌跡制御を行な
つた場合の軌跡と設定した軌跡とを比較して、ア
ームの先端の軌跡のずれ量を測定し、この測定量
から関数の誤差量を演算して、関数発生器の関数
を補正することによつて、アームの先端の軌跡が
設定した軌跡になるように制御するようにしたも
のである。 In order to achieve the above object, the present invention compares the trajectory when trajectory control is performed based on a function stored in a function generator with a set trajectory, and determines the amount of deviation in the trajectory of the tip of the arm. is controlled so that the trajectory of the tip of the arm follows the set trajectory by calculating the error amount of the function from this measured amount and correcting the function of the function generator. be.
以下本発明を添附図面の一実施例に基づいて詳
しく説明する。 The present invention will be described in detail below based on one embodiment of the accompanying drawings.
第5図は第1図におけるブーム2、アーム3の
位置関係を示すために、ブーム2の回動点Aを座
標原点としたX−Y座標系にアーム回動点Bおよ
びバケツト回動点C(アーム3の先端C)を夫々
示したものである。第5図において各部の角度お
よび長さをつぎのように定める。 In order to show the positional relationship between the boom 2 and the arm 3 in FIG. 1, FIG. (Tip C of arm 3) is shown respectively. In FIG. 5, the angles and lengths of each part are determined as follows.
X軸:A,B,Cを含む平面とAを含み車輛接地
面と平行な平面との交線
Y軸:Aを通り、車輛接地面に垂直な直線
L1:
L2:
L:
α:Y軸と線分ABのなす角(ブーム角)
θ:線分ABと線分BCのなす角(アーム角)
γ:線分ABと線分ACのなす角
各回動点A,Bには角度検出器、例えばポテン
シヨメータ(図示せず)が配設されている。X-axis: Intersection between the plane containing A, B, and C and the plane containing A and parallel to the vehicle ground plane Y-axis: A straight line passing through A and perpendicular to the vehicle ground plane L 1 : L 2 : L: α: Angle between Y axis and line segment AB (boom angle) θ: Angle between line segment AB and line segment BC (arm angle) γ: Angle between line segment AB and line segment AC Each rotation point A and B have an angle A detector, for example a potentiometer (not shown), is provided.
第6図は本発明に用いられる制御装置の一実施
例を示したもので、図において、50,51はブ
ーム角αとアーム角θを検出する角度検出器、5
2,53はアーム3の先端Cの軌跡の速度成分
dx/dt、dy/dtを与える装置である。これは、レバー
を2本用いて、それぞれの速度成分dx/dt、dy/dtを
与えてもよいし、速度レバーとx/yを与えるレ
バーもしくはポテンシヨメータであつてもよい。
54は軌跡制御開始スイツチ49がONしたとき
の軌跡制御開始時におけるブーム角α0(角度検出
器50より与えられる)とアーム角θ0(角度検出
器51より与えられる)およびアーム3の先端C
の軌跡の速度成分dx/dt、dy/dtよりブーム角速度指
令値α0(ポンプ10の吐出量)とアーム角速度指
令値θ0(ポンプ11の吐出量)を演算する演算器、
55,56はブーム角αとアーム角θの各角速度
α〓1、θ〓1を検出する微分器、57,58はブームポ
ンプ吐出量コントローラ12への出力α〓2とアーム
ポンプ吐出量コントローラ13への出力θ〓2を軌跡
制御を行なつたときのブーム角速度α〓1およびアー
ム角速度θ〓1でそれぞれ割り算し、α〓2/α〓1とθ
〓2/θ〓1
とをそれぞれ求める割り算器、59,60は割り
算器57,58の出力α〓2/α〓1とθ〓2/θ〓1とを
それぞ
れブーム角α、アーム角θに対して記憶しておく
記憶装置である。この記憶装置59,60は軌跡
制御開始スイツチ49のONと同時に記憶されて
いた内容を次段の記憶装置61,62に転送し、
そして新らたな入力値を逐次記憶する。61,6
2は制御開始スイツチ49のONと同時に記憶装
置59,60から転送された内容を記憶し、ブー
ム角α、アーム角θの変化に応じて、記憶されて
いる値を逐次出力する記憶装置である。この記憶
装置61,62はn−1回目の軌跡制御によつて
ブーム角α、アーム角θに対応して記憶したα2/
α1とθ2/θ1とをn回目の軌跡制御のブーム角α、
アーム角θに対応して、記憶されているn−1回
目のα〓2/α〓1とθ〓2/θ〓1の値を逐次出力する。
63,
64は演算器54の出力値α〓0、θ〓0と記憶装置6
1,62の出力値α〓2/α〓1、θ〓2/θ〓1とを掛算
する掛
算器、65,66は手動−自動の切換スイツチで
ある。この切換スイツチ65,66を図の状態に
しておくと、ブームレバー27、アームレバー2
8の操作量に対応した信号がポンプ吐出量コント
ローラ12,13に送られて、ブームシリンダ
5、アームシリンダ6が動く。切換スイツチ6
5,66を切換えると、掛算器63,64の信号
がポンプ吐出量コントローラ12,13に送られ
アーム3の先端Cが設定された軌跡になるよう
に、ブームシリンダ5、アームシリンダ6が動
く。 FIG. 6 shows an embodiment of the control device used in the present invention. In the figure, 50 and 51 are angle detectors for detecting the boom angle α and arm angle θ;
2,53 is the velocity component of the trajectory of the tip C of arm 3
This is a device that provides dx/dt and dy/dt. This may be done by using two levers to provide respective speed components dx/dt and dy/dt, or by a lever or potentiometer that provides a speed lever and x/y.
54 indicates the boom angle α 0 (given by the angle detector 50), the arm angle θ 0 (given by the angle detector 51), and the tip C of the arm 3 at the start of the trajectory control when the trajectory control start switch 49 is turned on.
a computing unit that calculates a boom angular velocity command value α 0 (discharge amount of the pump 10) and an arm angular velocity command value θ 0 (discharge amount of the pump 11) from the velocity components dx/dt, dy/dt of the trajectory;
55 and 56 are differentiators that detect the respective angular velocities α〓 1 and θ〓 1 of the boom angle α and arm angle θ, and 57 and 58 are outputs α〓 2 to the boom pump discharge amount controller 12 and the arm pump discharge amount controller 13 Divide the output θ〓 2 by the boom angular velocity α〓 1 and the arm angular velocity θ〓 1 when performing trajectory control, and calculate α〓 2 /α〓 1 and θ
〓 2 /θ〓 1
Dividers 59 and 60 store the outputs α〓 2 /α〓 1 and θ〓 2 /θ〓 1 of the dividers 57 and 58 for the boom angle α and arm angle θ, respectively. It is a storage device. These storage devices 59 and 60 transfer the stored contents to the next stage storage devices 61 and 62 at the same time as the trajectory control start switch 49 is turned on.
Then, new input values are stored one after another. 61,6
2 is a storage device that stores the contents transferred from the storage devices 59 and 60 at the same time as the control start switch 49 is turned on, and sequentially outputs the stored values according to changes in the boom angle α and arm angle θ. . The storage devices 61 and 62 store α 2 /
Let α 1 and θ 2 /θ 1 be the boom angle α of the n-th trajectory control,
Corresponding to the arm angle θ, the n-1th stored values of α〓 2 /α〓 1 and θ〓 2 /θ〓 1 are sequentially output.
63,
64 is the output value α〓 0 , θ〓 0 of the arithmetic unit 54 and the storage device 6
Multipliers 65 and 66 are manual/automatic changeover switches for multiplying the output values α〓 2 /α〓 1 and θ〓 2 /θ〓 1 of 1 and 62, respectively. When the changeover switches 65 and 66 are set to the state shown in the figure, the boom lever 27 and arm lever 2
A signal corresponding to the manipulated variable 8 is sent to the pump discharge amount controllers 12 and 13, and the boom cylinder 5 and arm cylinder 6 move. Changeover switch 6
5 and 66, the signals from the multipliers 63 and 64 are sent to the pump discharge amount controllers 12 and 13, and the boom cylinder 5 and arm cylinder 6 move so that the tip C of the arm 3 follows the set trajectory.
次に上述した制御装置の動作を説明する。ま
ず、切換スイツチ65,66を手動側にしてアー
ム3の先端Cを任意の位置に設定する。次に切換
スイツチ65,66を自動側に倒す。そして、希
望すべき軌跡のX、Y軸の速度成分dx/dt、dy/dtを
与えると共に軌跡制御開始スイツチ49をONす
ると、演算器54で初期のブーム角α0およびアー
ム角θ0とX、Y軸の速度成分dx/dt、dy/dtに基づい
て、ブーム角速度指令値α〓0、アーム角速度指令値
θ〓0を演算し、そして出力する。この演算方法は
種々あり、例えば特開昭49−132801の最急降下法
などがある。そして、記憶装置61,62の出力
が常に1であれば、α〓2=α〓0、θ〓2=θ〓0となり
α〓0、θ〓0
がそのまま吐出量コントローラ12,13へ入力
されポンプ10,11の吐出量が制御され、ブー
ムシリンダ5、アームシリンダ6の速度が制御さ
れ、アーム3の先端Cの軌跡が制御される。ま
た、ブームシリンダ5、アームシリンダ6の変化
に対応してブーム角α、アーム角θも変化し、そ
れらの変化が角度検出器50,51で検出され、
微分器55,56で微分される。そして、割り算
器57,58でそれぞれの値α〓1、θ〓1でブームポン
プ吐出量コントローラ12への入力値α〓2とアーム
ポンプ吐出量コントローラ13への入力値θ〓2を割
り算し、ブーム角α、アーム角θに対応して記憶
装置59,60に記憶する。第7図はブームポン
プ吐出量コントローラ12への入力値α〓2と実際に
動いたブーム角速度α〓1の一例を示したものであ
り、第8図はブームシリンダ5が第7図のように
動いた場合に記憶装置59に記憶されたデータの
一例を示したものである。 Next, the operation of the above-mentioned control device will be explained. First, the changeover switches 65 and 66 are set to the manual side, and the tip C of the arm 3 is set at an arbitrary position. Next, turn the changeover switches 65 and 66 to the automatic side. Then, when the velocity components dx/dt, dy/dt of the desired trajectory on the X and Y axes are given, and the trajectory control start switch 49 is turned on, the calculator 54 calculates the initial boom angle α 0 , arm angle θ 0 , and , Y-axis velocity components dx/dt, dy/dt, a boom angular velocity command value α〓 0 and an arm angular velocity command value θ〓 0 are calculated and output. There are various methods for this calculation, such as the steepest descent method disclosed in Japanese Patent Application Laid-Open No. 132801/1983. If the outputs of the storage devices 61 and 62 are always 1, then α〓 2 = α〓 0 , θ〓 2 = θ〓 0 , and α〓 0 , θ〓 0
is directly input to the discharge amount controllers 12 and 13 to control the discharge amount of the pumps 10 and 11, the speeds of the boom cylinder 5 and the arm cylinder 6, and the trajectory of the tip C of the arm 3. In addition, the boom angle α and arm angle θ also change in response to changes in the boom cylinder 5 and arm cylinder 6, and these changes are detected by angle detectors 50 and 51.
It is differentiated by differentiators 55 and 56. Then, the input value α〓 2 to the boom pump discharge amount controller 12 and the input value θ〓 2 to the arm pump discharge amount controller 13 are divided by the respective values α〓 1 and θ〓 1 using the dividers 57 and 58, The boom angle α and arm angle θ are stored in the storage devices 59 and 60 in correspondence with each other. FIG. 7 shows an example of the input value α〓 2 to the boom pump discharge amount controller 12 and the actual boom angular velocity α〓 1 , and FIG. 8 shows an example of the boom cylinder 5 as shown in FIG. This shows an example of data stored in the storage device 59 when the robot moves.
次に、また手動でアーム3の先端Cを任意の位
置(通常前回の位置とほぼ同じ位置)に設定す
る。そして、再びdx/dt dy/dtを与え軌跡制御開始
スイツチ49をONすると、記憶装置59,60
の記憶内容が記憶装置61,62に転送される。
そして、演算器54の演算出力値α〓0、θ〓0と第8図
に示した記憶値(アームに対しては別の記憶値が
ある。)とを掛算器63,64で掛算することに
より、例えば、第7図のaからbまでは吐出量コ
ントローラ12への入力値α〓2に対して、実際のブ
ーム角速度α〓1が小さく出てしまうので、第8図の
a′からb′のように1より大きい値と演算出力値α0
とを掛算し、第7図のcからdまでは吐出量コン
トローラ12への入力値α〓2に対して、負の速度が
大きく出てしまうので、第8図のc′からd′のよう
に1より小さい値と演算出力値α〓0とを掛算するこ
とにより、演算出力値α〓0を補正して、吐出量コン
トローラ12,13への入力とする。 Next, manually set the tip C of the arm 3 to an arbitrary position (usually approximately the same position as the previous position). Then, when dx/dt dy/dt is given again and the trajectory control start switch 49 is turned on, the storage devices 59 and 60
The stored contents are transferred to the storage devices 61 and 62.
Then, the calculation output values α〓 0 , θ〓 0 of the calculation unit 54 are multiplied by the stored value shown in FIG. 8 (there is another stored value for the arm) using multipliers 63 and 64. For example, from a to b in FIG. 7, the actual boom angular velocity α 〓 1 is smaller than the input value α 〓 2 to the discharge rate controller 12, so the values shown in FIG.
Values larger than 1 like a′ to b′ and calculation output value α 0
From c to d in Fig. 7, a large negative velocity appears relative to the input value α 〓 2 to the discharge rate controller 12, so from c' to d' in Fig. 8, By multiplying the calculated output value α〓 0 by a value smaller than 1, the calculated output value α〓 0 is corrected and is input to the discharge amount controllers 12 and 13.
以上説明した補正動作を次に図を用いて詳しく
説明する。第9図は、例えば吐出量コントローラ
12の特性を示したもので、入力α〓2に対して出力
であるブーム角速度α〓1が図中実線であるべき特性
のものが破線のような特性になつていた場合、す
なわちゲインが変化していた場合の一例である。 The correction operation described above will now be explained in detail using the drawings. Figure 9 shows, for example, the characteristics of the discharge rate controller 12, where the boom angular velocity α〓 1 , which is the output for the input α〓 2 , should be a solid line in the figure, but the characteristic is like a broken line. This is an example of a case where the gain has changed, that is, the gain has changed.
この場合には、まず、演算器54の出力α0がブ
ーム角速度α1を1.5(図中e1)にすべく吐出量コン
トローラ12へe2の信号を出力するが、破線で示
すような特性のために、実際には0.75(図中f1)
の速度しか得られない。したがつて次の軌跡制御
時には、演算器54の出力α〓0(=1.5)にα〓2/α
〓1=
1.5/0.75=2の値を掛算した3の値(図中g2)を
吐出量コントローラ12へ出力する。その結果、
ブーム角速度α〓1は1.5(図中e1)になり、設定した
速度と一致する。 In this case, first, the output α 0 of the calculator 54 outputs a signal e 2 to the discharge amount controller 12 in order to make the boom angular velocity α 1 1.5 (e 1 in the figure), but the characteristics shown by the broken line Therefore, it is actually 0.75 (f 1 in the figure)
You can only get the speed of Therefore, during the next trajectory control, the output α〓 0 (=1.5) of the computing unit 54 is changed to α〓 2 /α
〓 1 =
A value of 3 (g 2 in the figure) obtained by multiplying the value of 1.5/0.75=2 is output to the discharge amount controller 12. the result,
The boom angular speed α〓 1 becomes 1.5 (e 1 in the figure), which matches the set speed.
第10図は第9図と同じく吐出量コントローラ
12の特性を示したもので、この図の場合はゼロ
点がずれていた場合である。 FIG. 10, like FIG. 9, shows the characteristics of the discharge amount controller 12, and this figure shows the case where the zero point has shifted.
この場合には第9図の場合と同様に、まず、演
算器54の出力α〓0がブーム角速度α〓1を1.5(図中
h1)にすべく吐出量コントローラ12へh2の信号
を出力するが、破線のような特性のために、実際
には1(図中i1)の速度しか得られない。したが
つて次の軌跡制御時には演算器54の出力α〓0(=
1.5)にα〓2/α〓1=1.5/1=1.5の値を掛算した2.2
5
の値(図中j2)を吐出量コントローラ12へ出力
する。その結果、ブーム角速度α〓1は2(図中j1)
となり、設定した速度(1.5)より大きい値とな
る。そして、次の軌跡制御時にはα〓(=1.5)に
α〓2/α〓1=2.5/2=1.25の値を掛算した1.875の値
(図中k2)を吐出量コントローラ12へ出力する。
その結果、ブーム角速度α〓1は1.375(図中k1)とな
り、前回、前々回の軌跡制御時におけるブーム角
速度α〓1の誤差より小さくなる。そして、軌跡制御
毎にこの補正動作を行なうことにより、設定速度
α〓1=1.5に徐々に近づくことがわかる。 In this case, as in the case of FIG .
h 1 ), a signal of h 2 is output to the discharge amount controller 12, but due to the characteristics shown by the broken line, in reality only a speed of 1 (i 1 in the figure) can be obtained. Therefore, during the next trajectory control, the output α〓 0 (=
1.5) multiplied by α〓 2 / α〓 1 = 1.5/1 = 1.5, 2.2
Five
( j2 in the figure) is output to the discharge amount controller 12. As a result, the boom angular velocity α〓 1 is 2 (j 1 in the figure)
This is a value larger than the set speed (1.5). Then, during the next trajectory control, a value of 1.875 (k 2 in the figure), which is obtained by multiplying α〓 (=1.5) by a value of α〓 2 /α〓 1 =2.5/2=1.25, is output to the discharge amount controller 12.
As a result, the boom angular velocity α〓 1 becomes 1.375 (k 1 in the figure), which is smaller than the error in the boom angular velocity α〓 1 during the previous trajectory control and the time before the previous. It can be seen that by performing this correction operation for each trajectory control, the set speed α〓 1 =1.5 is gradually approached.
第11図は本発明に用いられる制御装置の他の
実施例を示すもので、図において第6図と同符号
のものは同じ部分を示している。第11図におい
て、71,72は吐出コントローラ12,13へ
の出力α〓2、θ〓2とブーム角速度α〓1、θ〓1の差を
とる減
算器、73,74は演算器54の出力値α〓0、θ〓0と
記憶装置61,62の出力値α〓2−α〓1、θ〓2−θ
〓1を加
える加算器である。 FIG. 11 shows another embodiment of the control device used in the present invention, in which the same reference numerals as in FIG. 6 indicate the same parts. In FIG. 11, 71 and 72 are subtractors that take the difference between the outputs α〓 2 and θ〓 2 to the discharge controllers 12 and 13 and the boom angular velocities α〓 1 and θ〓 1 , and 73 and 74 are the outputs of the calculator 54. Values α〓 0 , θ〓 0 and output values α〓 2 −α〓 1 , θ〓 2 −θ of the storage devices 61 and 62
〓 It is an adder that adds 1 .
上述した制御装置による補正動作を図を用いて
説明する。第12図は第9図と同様に吐出量コン
トローラ12のゲインが変化していた場合の一例
である。この場合には、まず、演算器54の出力
α〓0がブーム角速度α〓1を1.5(図中l1)にすべく吐
出
量コントローラ12へl2の信号を出力するが、破
線のような特性のために、実際には0.75(図中
m1)の速度しか得られない。したがつて次の軌
跡制御時には、演算器54の出力α〓0(=1.5)にα〓
2
−α〓1=0.75の値を加算した2.25の値(図中n2)を
吐出量コントローラ12へ出力する。その結果ブ
ーム角速度α1は1.125(図中n1)となり、前回より
設定した速度(1.5)に近い値になる。そして、
軌跡制御毎にこの補正を行なうことにより、設定
速度α〓1=1.5に徐々に近づく。また、第9図のよ
うに吐出量コントローラ12のゼロ点がずれてい
た場合には、1回の補正で設定速度にすることが
可能であることはすぐわかる。 The correction operation by the above-mentioned control device will be explained using the drawings. FIG. 12 is an example in which the gain of the discharge amount controller 12 is changing as in FIG. 9. In this case, first, the output α〓 0 of the calculator 54 outputs a signal l 2 to the discharge rate controller 12 in order to set the boom angular velocity α〓 1 to 1.5 (l 1 in the figure). Due to the characteristics, it is actually 0.75 (in the figure
m 1 ). Therefore, during the next trajectory control, the output α〓 0 (=1.5) of the calculator 54 is changed to α〓
2
A value of 2.25 (n 2 in the figure) obtained by adding the value of −α〓 1 =0.75 is output to the discharge amount controller 12 . As a result, the boom angular velocity α 1 becomes 1.125 (n 1 in the figure), which is a value close to the velocity (1.5) set from the previous time. and,
By performing this correction for each trajectory control, the set speed α〓 1 =1.5 is gradually approached. Further, if the zero point of the discharge amount controller 12 is shifted as shown in FIG. 9, it is immediately clear that the set speed can be achieved with one correction.
第13図は本発明に用いられる制御装置のもう
一つの実施例を示すもので、図において第6図と
同符号のものは同じ装置を示している。75は演
算器で、この演算器75はアーム3の先端Cを設
定軌跡上に動かす場合にアーム角度θがある角度
のときブーム角速度α〓をアーム角速度θ〓の何倍で
動かせば良いかを決めるものである。76,7
7,79は掛算器、80は割算器、78は演算器
で、この演算器78はアーム3の先端Cが設定軌
跡上を動いているときのブーム角α〓とアーム角θ〓
からブーム角速度α〓とアーム角速度θ〓との比を求
めるものである。 FIG. 13 shows another embodiment of the control device used in the present invention, and in the figure, the same reference numerals as in FIG. 6 indicate the same devices. Reference numeral 75 denotes a computing unit, and this computing unit 75 determines how many times the boom angular velocity α should be moved as compared to the arm angular velocity θ when the arm angle θ is a certain angle when moving the tip C of the arm 3 on a set trajectory. It's up to you to decide. 76,7
7 and 79 are multipliers, 80 is a divider, and 78 is an arithmetic unit. This arithmetic unit 78 calculates the boom angle α〓 and arm angle θ〓 when the tip C of the arm 3 is moving on the set trajectory.
The ratio between the boom angular velocity α〓 and the arm angular velocity θ〓 is obtained from .
次に、上述した演算器75,78の演算内容に
ついて詳しく説明する。 Next, the calculation contents of the above-mentioned calculation units 75 and 78 will be explained in detail.
第3図において、アーム3の先端Cの座標
(X、Y)は次式によつて求まる。 In FIG. 3, the coordinates (X, Y) of the tip C of the arm 3 are determined by the following equation.
x=L1sinα+L2sin(α+θ) ……(1)
y=L1cosα+L2cos(α+θ) ……(2)
式(1)、(2)を時間で微分すると、
dx/dt=x〓=L1cosα・α〓
+L2cos(α+θ)・(α〓+θ〓)……(3)
dy/dt=y〓=−L1sinα・α〓
−L2sin(α+θ)・(α〓+θ〓)……(4)
となる。ここで、たとえば、アーム3の先端Cを
水平方向に平行に移動させる場合には式(4)=0と
すれば良い。x = L 1 sin α + L 2 sin (α + θ) ... (1) y = L 1 cos α + L 2 cos (α + θ) ... (2) When formulas (1) and (2) are differentiated with respect to time, dx / dt = x〓 =L 1 cosα・α〓 +L 2 cos(α+θ)・(α〓+θ〓)……(3) dy/dt=y〓=−L 1 sinα・α〓 −L 2 sin(α+θ)・(α〓 +θ〓)...(4). Here, for example, when moving the tip C of the arm 3 in parallel to the horizontal direction, equation (4) may be set to 0.
L1・sinα・α〓+L2・sin(α+θ)
・(α〓+θ〓)=0 ……(5)
L1・sinα・α〓+L2・sin(α+θ)
・α〓+L2・sin(α+θ)・θ〓=0 ……(6)
∴α/θ=L2・sin(α+θ)/L1・sinα+L2・sin(
α+θ)……(7)
となる。次に、yを一定にするためのブーム角α
とアーム角θの関係を求める。 L 1・sinα・α〓+L 2・sin(α+θ) ・(α〓+θ〓)=0 ...(5) L 1・sinα・α〓+L 2・sin(α+θ) ・α〓+L 2・sin( α+θ)・θ〓=0 ...(6) ∴α/θ=L 2・sin(α+θ)/L 1・sinα+L 2・sin(
α+θ)...(7) Next, the boom angle α to keep y constant
Find the relationship between the arm angle θ and the arm angle θ.
まず、角度γとアーム角θとの関係は正弦定理
より、
sinγ=−L2/Lsin(θ+180゜) ……(8)
∴γ=sin-1(−L2/Lsin(θ+180゜)……(9)
ここでL=L2 1+L2 2−2L1L2cos(θ+180゜)
また、軌跡制御開始時のアーム3の先端Cの位
置をy0とすると、
y=y0=Lsin(90゜−(α+γ) ……(10)
∴α=90゜−γ−sin-1(y0/L) ……(11)
よつて、式(9)を式(11)に代入して次式を得る。 First, the relationship between the angle γ and the arm angle θ is determined from the sine theorem as sinγ=−L 2 /Lsin (θ+180°) ……(8) ∴γ=sin -1 (−L 2 /Lsin (θ+180°)… (9) Here, L=L 2 1 +L 2 2 −2L 1 L 2 cos(θ+180°) Also, if the position of the tip C of arm 3 at the start of trajectory control is y 0 , then y=y 0 =Lsin( 90゜−(α+γ) ……(10) ∴α=90゜−γ−sin -1 (y 0 /L) ……(11) Therefore, by substituting formula (9) into formula (11), we get Get the formula.
α=90゜−sin-1(L2/Lsin(θ
+180゜))−sin-1(y0/L)……(12)
したがつて、軌跡制御開始スイツチ49がON
したときのブーム角αとアーム角θとから、アー
ム3の先端Cの高さy0を求める。次にこのy0とア
ーム角θを順次式(12)に代入することにより、アー
ム3の先端Cが水平移動するためのブーム角度α
が求まる。このαとθを式(7)に代入することによ
り、アーム角θに対するブーム角速度α〓とアーム
角速度θ〓の比を求めることができる。演算器75
では以上説明した演算を軌跡制御開始スイツチ4
9がONしたときに行ない、第14図に示すよう
な値を記憶しておく。 α=90°−sin -1 (L 2 /Lsin(θ
+180゜)) -sin -1 (y 0 /L)...(12) Therefore, the trajectory control start switch 49 is turned on.
The height y 0 of the tip C of the arm 3 is determined from the boom angle α and arm angle θ. Next, by sequentially substituting this y 0 and arm angle θ into equation (12), the boom angle α for horizontal movement of the tip C of arm 3 can be calculated.
is found. By substituting α and θ into equation (7), the ratio of boom angular velocity α and arm angular velocity θ to arm angle θ can be determined. Arithmetic unit 75
Now, the calculations explained above are applied to trajectory control start switch 4.
This is done when 9 is turned ON, and the value shown in FIG. 14 is memorized.
演算器78では軌跡制御時におけるブーム角
α、アーム角θを逐次取り込み、式(7)を用いて演
算しα〓1/θ〓1を計算する。 The calculator 78 sequentially takes in the boom angle α and arm angle θ during trajectory control, and calculates α〓 1 /θ〓 1 by using equation (7).
次に上述した制御装置の動作を説明する。ま
ず、切換スイツチ65を手動側にしてアーム3の
先端Cを任意の位置に設定する。次に切換スイツ
チ65を自動側に倒す。そして、軌跡制御開始ス
イツチ49をONすると、演算器75は前記した
演算を行ない、例えば第14図に示すような値を
演算し、記憶する。次にアームレバー28を操作
すると、操作量に応じたアーム角速度指令値θ〓0が
ポンプ吐出量コントローラ13に送られ、アーム
シリンダ6が動き、アーム角θが変化する。演算
器75ではこの時々刻々と変化するアーム角θを
取り込み、アーム角θに対応した値α0/θ0を時々刻
刻と出力する。そして、この値とアーム角速度指
令値θ〓0を掛算器76で掛算し、ブーム角速度指令
値α〓0を得る。そして、記憶装置61の出力がアー
ム角θに対応して常に1であればα〓2=α〓0となり、
α〓2が吐出量コントローラ12へ入力され、ポンプ
10の吐出量が制御される。この結果ブームシリ
ンダ5の速度が制御され、アーム3の先端Cの軌
跡が制御される。また、ブームシリンダ5、アー
ムシリンダ6の動きに対応してブーム角α、アー
ム角θも動く。演算器78では、このブーム角
α、アーム角θを逐次取り込み、式(7)を用いて
α〓1/θ1を逐次演算する。そして、掛算器79で
α〓1/θ〓1とアーム角速度指令値θ〓0を掛算する。
次
に、この出力値α〓1θ〓0/θ〓1で吐出量コントロー
ラ1
3への入力値α〓2を割算器80で割り算し、α〓2θ〓
1/
α〓1θ〓0を得る。そして、アーム角θに対応して記憶
装置59に記憶する。 Next, the operation of the above-mentioned control device will be explained. First, the changeover switch 65 is set to the manual side and the tip C of the arm 3 is set at an arbitrary position. Next, turn the changeover switch 65 to the automatic side. Then, when the trajectory control start switch 49 is turned on, the calculator 75 performs the above-mentioned calculations, and calculates and stores the values shown in FIG. 14, for example. Next, when the arm lever 28 is operated, an arm angular velocity command value θ〓 0 corresponding to the operation amount is sent to the pump discharge amount controller 13, the arm cylinder 6 moves, and the arm angle θ changes. The arithmetic unit 75 takes in the arm angle θ which changes from time to time, and outputs the value α 0 /θ 0 corresponding to the arm angle θ from time to time. Then, this value is multiplied by the arm angular velocity command value θ〓 0 by a multiplier 76 to obtain the boom angular velocity command value α〓 0 . If the output of the storage device 61 is always 1 corresponding to the arm angle θ, then α〓 2 = α〓 0 ,
α〓 2 is input to the discharge amount controller 12, and the discharge amount of the pump 10 is controlled. As a result, the speed of the boom cylinder 5 is controlled, and the trajectory of the tip C of the arm 3 is controlled. Furthermore, the boom angle α and the arm angle θ also move in response to the movements of the boom cylinder 5 and arm cylinder 6. The calculator 78 sequentially takes in the boom angle α and arm angle θ, and sequentially calculates α〓 1 /θ 1 using equation (7). Then, a multiplier 79 multiplies α〓 1 /θ〓 1 by arm angular velocity command value θ〓 0 .
Next, with this output value α〓 1 θ〓 0 /θ〓 1 , the discharge amount controller 1
The input value α〓 2 to 3 is divided by the divider 80, and α〓 2 θ〓
1 /
We get α〓 1 θ〓 0 . Then, it is stored in the storage device 59 in correspondence with the arm angle θ.
次に、また手動でアーム3の先端Cを任意の位
置(通常前回の位置とほぼ同じ位置)に設定す
る。そして、再び軌跡制御開始スイツチ49を
ONすると記憶装置59の内容が記憶装置61に
転送される。そして、アームレバー28を操作す
ることにより、ブーム角速度指令値α〓0がアーム角
θに対応して時々刻々出力される。このブーム角
速度指令値α〓0と記憶装置61の出力α〓2θ〓1/α
〓1θ〓0を
掛算器77で掛算し、α〓2=α2θ1/α1θ0α〓0なる
信号を吐
出量コントローラ12へ出力する。すなわち、た
とえばアーム角θの実際の速度が指令値より大き
く出る場合(θ〓1>θ〓0)は、ブーム角速度指令値α
〓0
よりも大きい値α〓2を吐出量コントローラ12へ出
力する。また、ブーム角αの実際の速度が指令値
より大きく出る場合(α〓1>α〓2)は、ブーム角速度
指令値α〓0よりも小さい値α〓2を吐出量コントローラ
12へ出力する。したがつて、吐出量コントロー
ラ12,13などにゲインやゼロ点の誤差があつ
ても、設定した速度に制御することができ、アー
ム3の先端Cの軌跡を制御することができる。 Next, manually set the tip C of the arm 3 to an arbitrary position (usually approximately the same position as the previous position). Then, turn the trajectory control start switch 49 again.
When turned ON, the contents of the storage device 59 are transferred to the storage device 61. Then, by operating the arm lever 28, the boom angular velocity command value α〓 0 is outputted momentarily in correspondence with the arm angle θ. This boom angular velocity command value α〓 0 and the output of the storage device 61 α〓 2 θ〓 1 /α
1 θ 0 is multiplied by the multiplier 77 and a signal α 2 = α 2 θ 1 /α 1 θ 0 α 0 is output to the discharge amount controller 12. That is, for example, if the actual speed of arm angle θ is greater than the command value (θ〓 1 > θ〓 0 ), the boom angular speed command value α
〓 0
A value α〓 2 larger than 2 is output to the discharge amount controller 12. Furthermore, if the actual speed of the boom angle α is greater than the command value (α〓 1 >α〓 2 ), a value α〓 2 smaller than the boom angular velocity command value α〓 0 is output to the discharge amount controller 12 . Therefore, even if there is an error in gain or zero point in the discharge amount controllers 12, 13, etc., the speed can be controlled to a set speed, and the trajectory of the tip C of the arm 3 can be controlled.
なお、上述の実施例においては、ハード演算器
を用いたが、マイクロコンピユータを用いても良
い。また、上述の実施例ではアーム3の先端Cの
軌跡制御について説明したが、バケツト4の軌跡
を制御する場合でも、角速度指令値と実際の角速
度から設定した軌跡になるように指令値を補正す
ることができる。さらに、上述の実施例では、ア
ーム3の先端Cの軌跡制御を行なう指令値とし
て、アーム角θとブーム角αの角速度を与えた
が、アームシリンダ6、ブームシリンダ5の速度
を与えても良い。また、アーム角θ、ブーム角α
をポテンシヨメータで検出したが、アームシリン
ダ6、ブームシリンダ5の変位を検出してもよ
い。さらに、第6図、第11図の実施例では、ア
ーム角速度θ、ブーム角速度α〓を角度から微分し
ているが、角速度計をつけてもよい。また、第1
3図に示す実施例では、軌跡制御開始スイツチ4
9がONしたときのα0、θ0からy0を求めて、アー
ム3の先端Cを水平移動させるべきα0/θ0を演算し
ているが、時々刻々とy0を演算してα0/θ0を演算し
ても良い。 In addition, in the above-mentioned embodiment, a hardware arithmetic unit is used, but a microcomputer may also be used. Further, in the above embodiment, the trajectory control of the tip C of the arm 3 was explained, but even when controlling the trajectory of the bucket 4, the command value is corrected so that the trajectory is set based on the angular velocity command value and the actual angular velocity. be able to. Further, in the above embodiment, the angular velocities of the arm angle θ and the boom angle α are given as the command values for controlling the trajectory of the tip C of the arm 3, but the velocities of the arm cylinder 6 and the boom cylinder 5 may also be given. . Also, arm angle θ, boom angle α
is detected by a potentiometer, but the displacement of the arm cylinder 6 and boom cylinder 5 may also be detected. Further, in the embodiments shown in FIGS. 6 and 11, the arm angular velocity θ and the boom angular velocity α are differentiated from the angle, but an angular velocity meter may be provided. Also, the first
In the embodiment shown in FIG. 3, the trajectory control start switch 4
By calculating y 0 from α 0 and θ 0 when 9 is ON, α 0 /θ 0 to horizontally move the tip C of arm 3 is calculated. 0 /θ 0 may also be calculated.
以上説明したように、本発明によれば、掘削軌
跡制御装置を構成する各装置に何らかの原因でゼ
ロ点のずれやゲインのずれがあつても軌跡を設定
通りに制御することができるので、掘削軌跡作業
精度を向上させることができる。 As explained above, according to the present invention, even if there is a shift in the zero point or a shift in the gain for some reason in each device constituting the excavation trajectory control device, the trajectory can be controlled as set. The accuracy of trajectory work can be improved.
第1図は油圧シヨベルの構成を示す側面図、第
2図および第3図は従来の掘削制御装置の一例を
示す構成図、第4図は従来の装置によつて得られ
るポンプの特性を表わす図、第5図は本発明の原
理を説明するために供するアーム、ブームの座標
位置、角度等を定義するための説明図、第6図は
本発明に用いられる制御装置の一例の構成を示す
図、第7図〜第10図はその動作説明のための特
性図、第11図は本発明に用いられる制御装置の
他の例の構成を示す図、第12図はその動作説明
のための特性図、第13図は本発明に用いられる
制御装置のさらに他の例の構成を示す図、第14
図はその動作説明のための特性図である。
2……ブーム、3……アーム、4……バケツ
ト、12,13……吐出量コントローラ、27,
28……操作レバー、52,53……角度検出
器、54,75,78……演算器、59,60,
61,62……記憶装置。
Fig. 1 is a side view showing the configuration of a hydraulic excavator, Figs. 2 and 3 are block diagrams showing an example of a conventional excavation control device, and Fig. 4 shows the characteristics of a pump obtained by the conventional device. Figure 5 is an explanatory diagram for defining the coordinate positions, angles, etc. of the arm and boom used to explain the principle of the present invention, and Figure 6 shows the configuration of an example of a control device used in the present invention. 7 to 10 are characteristic diagrams for explaining its operation, FIG. 11 is a diagram showing the configuration of another example of the control device used in the present invention, and FIG. 12 is a diagram for explaining its operation. Characteristic diagram, FIG. 13 is a diagram showing the configuration of still another example of the control device used in the present invention, FIG.
The figure is a characteristic diagram for explaining its operation. 2...Boom, 3...Arm, 4...Bucket, 12, 13...Discharge rate controller, 27,
28... Operating lever, 52, 53... Angle detector, 54, 75, 78... Arithmetic unit, 59, 60,
61, 62...Storage device.
Claims (1)
ブームシリンダによつて回動されるブームを枢着
し、このブームの先端にアームシリンダによつて
回動されるアームを枢着し、このアームの先端に
バケツトを取付けた油圧シヨベルにおいて、操作
盤により掘削面の勾配や掘削速度などの条件を与
え、それらの条件の下で軌跡制御を行うに必要な
各油圧シリンダの速度(または角速度)を演算器
を用いて計算し、その演算結果に基いて軌跡制御
を行つた場合の実際の速度と演算した速度との誤
差量を演算して記憶し、次に行う軌跡制御時にこ
の誤差量を用いて演算器の計算結果値を補正した
演算値に基き軌跡制御を行う工程を逐次繰返し、
制御された実際の軌跡を設定した軌跡に近づける
ようにしたことを特徴とする油圧シヨベルの掘削
軌跡制御方法。1 At the front of the revolving structure on the movable shovel body,
In a hydraulic excavator, a boom rotated by a boom cylinder is pivotally attached, an arm rotated by an arm cylinder is pivotally attached to the tip of the boom, and a bucket is attached to the tip of the arm. Given the conditions such as the slope of the excavation surface and the excavation speed, the velocity (or angular velocity) of each hydraulic cylinder required to perform trajectory control under these conditions is calculated using a calculator, and based on the calculation results. Calculate and store the amount of error between the actual speed and the calculated speed when trajectory control is performed, and use this error amount to correct the calculated value of the calculator during the next trajectory control. The process of performing base trajectory control is repeated one after another,
A method for controlling the excavation trajectory of a hydraulic excavator, characterized in that the actual controlled trajectory is brought closer to a set trajectory.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP15202081A JPS5854136A (en) | 1981-09-28 | 1981-09-28 | Control method for excavating trace of hydraulic shovel |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP15202081A JPS5854136A (en) | 1981-09-28 | 1981-09-28 | Control method for excavating trace of hydraulic shovel |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS5854136A JPS5854136A (en) | 1983-03-31 |
JPH0313377B2 true JPH0313377B2 (en) | 1991-02-22 |
Family
ID=15531298
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP15202081A Granted JPS5854136A (en) | 1981-09-28 | 1981-09-28 | Control method for excavating trace of hydraulic shovel |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS5854136A (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59203131A (en) * | 1983-05-02 | 1984-11-17 | Kubota Ltd | Slewing type working vehicle |
JPH076212B2 (en) * | 1985-02-27 | 1995-01-30 | 株式会社小松製作所 | Position control device for power shovel |
JPH076209B2 (en) * | 1985-09-24 | 1995-01-30 | 株式会社小松製作所 | Control device for work equipment in power shovel |
KR20210060866A (en) * | 2019-11-19 | 2021-05-27 | 두산인프라코어 주식회사 | Method and system for controlling construction machinery |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS50603A (en) * | 1973-03-21 | 1975-01-07 |
-
1981
- 1981-09-28 JP JP15202081A patent/JPS5854136A/en active Granted
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS50603A (en) * | 1973-03-21 | 1975-01-07 |
Also Published As
Publication number | Publication date |
---|---|
JPS5854136A (en) | 1983-03-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3306301B2 (en) | Front control device for construction machinery | |
US5424623A (en) | Coordinated control for a work implement | |
US5160239A (en) | Coordinated control for a work implement | |
JP3091667B2 (en) | Excavation control device for construction machinery | |
JP2002167794A (en) | Front control device for hydraulic backhoe | |
JPH0313377B2 (en) | ||
JPS6033940A (en) | Controller for straight excavation by oil-pressure shovel | |
JPS6234888B2 (en) | ||
JPS6234889B2 (en) | ||
JPS59195938A (en) | Linear excavation controller for oil-pressure shovel | |
JPH0257168B2 (en) | ||
JPS59195937A (en) | Linear excavation controller for oil-pressure shovel | |
JP2000303492A (en) | Front controller for construction machinery | |
JPS5898530A (en) | Controller for rectiliner excavation performed by hydraulic shovel | |
JPH0480168B2 (en) | ||
JPH0559745A (en) | Operator locus controller for arm-type working machine | |
JPH0320531B2 (en) | ||
JP2983783B2 (en) | Work machine constant speed trajectory control device | |
JPH0745742B2 (en) | Excavation control method for hydraulic excavator | |
JPS6136426A (en) | Service device locus controller for service machine in arm system | |
JPS6145025B2 (en) | ||
JPS6095035A (en) | Controller for locus of working instrument of hydraulic shovel | |
JPH0328543B2 (en) | ||
JPH10317417A (en) | Posture-controller for multi-joint working machine | |
JPS6211135B2 (en) |