JPH0224759B2 - - Google Patents

Info

Publication number
JPH0224759B2
JPH0224759B2 JP25030685A JP25030685A JPH0224759B2 JP H0224759 B2 JPH0224759 B2 JP H0224759B2 JP 25030685 A JP25030685 A JP 25030685A JP 25030685 A JP25030685 A JP 25030685A JP H0224759 B2 JPH0224759 B2 JP H0224759B2
Authority
JP
Japan
Prior art keywords
boom
vehicle body
angle
length
vehicle
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
Application number
JP25030685A
Other languages
Japanese (ja)
Other versions
JPS62111899A (en
Inventor
Mitsuhiro Kishi
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hikoma Seisakusho Co Ltd
Original Assignee
Hikoma Seisakusho Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hikoma Seisakusho Co Ltd filed Critical Hikoma Seisakusho Co Ltd
Priority to JP25030685A priority Critical patent/JPS62111899A/en
Publication of JPS62111899A publication Critical patent/JPS62111899A/en
Publication of JPH0224759B2 publication Critical patent/JPH0224759B2/ja
Granted legal-status Critical Current

Links

Landscapes

  • Jib Cranes (AREA)
  • Forklifts And Lifting Vehicles (AREA)

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は高所作業車の転倒防止機構に関し、特
にブームの転倒危険角度を少なくし、バランス修
正を自動的に行うようにした高所作業車の転倒防
止機構に関する。
[Detailed Description of the Invention] [Industrial Application Field] The present invention relates to a fall prevention mechanism for a vehicle for working at height, and in particular for work at height, which reduces the danger angle of a boom overturning and automatically corrects the balance. Regarding a vehicle fall prevention mechanism.

〔従来の技術〕[Conventional technology]

この種の高所作業車には、車体上に左右方向に
旋回可能に設けられた旋回台上にブームを上下方
向に起伏自在に枢支し、このこのブームの先端に
バケツトを枢着しておき、このバケツトに作業者
を乗せたまま電柱や壁面に向けて旋回、起伏ある
いは伸縮させて足場のない高所での作業ができる
ようにしたものがある(いわゆるブーム式リフ
ト)。
This type of aerial work vehicle has a boom that is pivotally supported vertically on a swivel platform that is installed on the vehicle body so that it can be rotated left and right, and a bucket is pivoted to the tip of this boom. There are bucket lifts that allow workers to swivel, rise and fall, or expand and contract toward telephone poles or walls while carrying workers on them, allowing them to work at high places without scaffolding (so-called boom-type lifts).

ところで、このような高所作業車は、ブーム全
体の伸縮長さが例えば8〜15メートルもある。こ
のため、ブームを長く伸ばすとその重心が移動し
て転倒することがあり、従来においては転倒事故
を防止するため機械的な手段によりブームの長さ
とその角度を検出し、危険範囲に達するとそれ以
上ブームを伸ばせないようにしたり、ブームを下
方に傾けられないように制御していた。
By the way, the length of the entire boom of such an aerial work vehicle is, for example, 8 to 15 meters. For this reason, if the boom is extended for a long time, its center of gravity may shift and cause it to tip over.In order to prevent accidents from tipping over, conventional methods use mechanical means to detect the length and angle of the boom, and when the boom reaches a dangerous range, it The boom was controlled so that it could not be extended further or tilted downward.

〔発明が解決しようとする問題点〕[Problem that the invention seeks to solve]

このような従来の高所作業によれば安全な作業
範囲が狭いことから、作業範囲が限定されてしま
うという問題点があつた。
Such conventional high-place work has a problem in that the safe work range is narrow, resulting in a limited work range.

本発明は上述した問題点を解消するためになさ
れたもので、バランス修正動作を行わせることに
よりブームの転倒危険角度を小さくして作業範囲
を大きくとると共に、ブーム先端を上記バランス
修正動作にかかわらず常に同一位置に維持できる
ようにした高所作業車の転倒防止機構を提供する
ことを目的とする。
The present invention has been made in order to solve the above-mentioned problems, and by performing a balance correction operation, the risk angle of the boom toppling is reduced and the working range is widened, and the tip of the boom is adjusted to the above-mentioned balance correction operation. An object of the present invention is to provide an overturn prevention mechanism for an aerial work vehicle that can always maintain the same position.

〔問題点を解決する手段〕[Means to solve problems]

上記問題点を解決した本発明は、車体上に旋回
可能に設けられた旋回台と、この旋回台に枢支さ
れて俯角シリンダーと伸縮用シリンダーで伸縮起
伏自在に動作されるブームと、前記ブームの先端
に枢着されたバケツトとから成る高所作業車にお
いて、車体の左右両側に水平方向に伸縮できる張
出し体を設け、これらの張出し体の先端には車体
を持ち上げるアウトリガーを設け、張出し体には
持ち上げた状態の車体をその側方に水平方向へ移
動させることができる油圧作動機構を設け、ブー
ムにはその伸縮長を測定できる測長センサーを設
け、ブームの水平からの角度を検出できる角度セ
ンサーを設けると共に、張出し体にはアウトリガ
ーから車体までに距離を検出する位置センサーを
設け、前記測長センサーと角度センサーからの検
出信号を取り込み、これを予め設定しておいた転
倒危険範囲データーとつき合わせ、転倒危険範囲
にあると判定されたときには、位置センサーによ
る車体の位置を判別して上記油圧作動機構を駆動
制御し、車体を張出し体の長さ方向に従つて転倒
危険方向とは反対方向に移動制御できると共に、
車体の移動に対応して俯角シリンダーと伸縮用シ
リンダーを駆動してブームの角度及び長さを補正
することにより、車体が移動してもブームの先端
を同一の位置にあるように制御する油圧制御装置
を設けてなるものである。
The present invention, which solves the above-mentioned problems, has a swivel base that is rotatably provided on a vehicle body, a boom that is pivotably supported on the swivel base and is movable telescopically by a depression angle cylinder and a telescoping cylinder, and the boom. An aerial work vehicle consisting of a bucket that is pivotally attached to the tip of the vehicle body is provided with overhanging bodies that can expand and contract horizontally on both the left and right sides of the vehicle body, and outriggers that lift the vehicle body are provided at the tips of these overhanging bodies. is equipped with a hydraulic mechanism that can move the lifted vehicle body horizontally to the side, and the boom is equipped with a length measurement sensor that can measure the length of extension and contraction, and an angle sensor that can detect the angle of the boom from the horizontal. In addition to providing a sensor, a position sensor for detecting the distance from the outrigger to the vehicle body is provided on the overhanging body, and the detection signals from the length measurement sensor and angle sensor are taken in, and this is used as preset fall risk range data. When it is determined that the vehicle is in the overturn danger range, the position sensor determines the position of the vehicle body and drives and controls the above-mentioned hydraulic actuation mechanism, and the vehicle body is moved in the opposite direction of the overturn danger direction according to the length direction of the overhanging body. In addition to being able to control movement in the direction,
Hydraulic control that controls the tip of the boom to remain in the same position even if the vehicle moves by driving the depression angle cylinder and telescoping cylinder to correct the angle and length of the boom in response to vehicle body movement. It is equipped with a device.

〔作用〕[Effect]

まず、持ち上げ機構を所定の位置に設定して車
体を固定する。次いで、ブームを伸ばすなどの動
作をさせ、このときに測長センサー及び角度セン
サーからの検出信号を油圧制御装置に取り込む。
油圧制御装置は、その検出信号を危険範囲のデー
ターに付き合わせて、その範囲になつたら張出し
体を制御して車体を危険方向とは反対方向に車体
を水平移動させる。また、制御装置は車体の移動
に応じてブーム角度及び長さを駆動制御する。こ
れにより、重心をブームの反対側に移動させバラ
ンスを取ることで、転倒を防止することができる
と共に、ブーム先端は、車体が移動しているにも
かかわらず、同一線上に留まることができる。
First, the lifting mechanism is set in a predetermined position to secure the vehicle body. Next, the boom is extended or the like, and at this time detection signals from the length measurement sensor and the angle sensor are taken into the hydraulic control device.
The hydraulic control device matches the detection signal with the data of the danger range, and when the danger range is reached, controls the overhanging body to horizontally move the car body in the direction opposite to the dangerous direction. Further, the control device drives and controls the boom angle and length according to the movement of the vehicle body. As a result, by moving the center of gravity to the opposite side of the boom and maintaining balance, it is possible to prevent the boom from tipping over, and the tip of the boom can remain on the same line even though the vehicle body is moving.

〔実施例〕〔Example〕

以下、本発明を図示の実施例に基づいて説明す
る。
Hereinafter, the present invention will be explained based on illustrated embodiments.

第1図は本発明に係る転倒防止機構を備えた高
所作業車を示す斜視図、第2図は第1図における
高所作業車の側面図である。
FIG. 1 is a perspective view showing a vehicle for aerial work equipped with an overturn prevention mechanism according to the present invention, and FIG. 2 is a side view of the vehicle for aerial work in FIG. 1.

これらの図において、高所作業車1の車体2の
上に旋回台3を旋回可能に設け、旋回台3の上端
にブーム4を起伏自在に枢着し、このブーム4の
先端にバケツト5を枢着し、ブーム4を多段伸縮
式に構成してこれを図示しない伸縮用シリンダー
によつて長さを可変となし、かつバケツト5を常
に水平状態になるように図示しない平衡シリンダ
ーによつて制御させている。ブーム4と旋回台3
との間には俯仰角度を制御する俯角シリンダー6
を配設してある。車体2には、その前後の左右両
側に、上下方向に向けて配設した張出し体7と、
これらに設けたアウトリガー8とからなる持ち上
げ機構9を配設してある。
In these figures, a swivel base 3 is rotatably provided on the body 2 of an aerial work vehicle 1, a boom 4 is pivotably mounted on the upper end of the swivel base 3, and a bucket 5 is attached to the tip of the boom 4. The boom 4 is configured to be telescopic in multiple stages, and its length is made variable by a telescoping cylinder (not shown), and the bucket 5 is controlled to always be in a horizontal state by a balance cylinder (not shown). I'm letting you do it. Boom 4 and swivel base 3
A depression angle cylinder 6 for controlling the elevation angle is provided between the
are arranged. The vehicle body 2 has projecting bodies 7 disposed vertically on both the left and right sides of the front and back thereof,
A lifting mechanism 9 consisting of outriggers 8 provided on these is provided.

また、ブーム4には、伸縮長さを測定し電気信
号として出力する測長センサー10を取り付けて
ある。測長センサー10は巻尺式のもので、その
本体11をブーム4の基部に設け、その本体11
に出入する測長用帯体12の一端をブーム4の先
端固定点13に固定してなるもので、測長用帯体
12が本体11より引き出された長さを電気的信
号に変換して出力するように構成したものであ
る。旋回台3には、ブーム4の角度を測定し電気
的信号として出力する角度センサー14を設けて
ある。
Furthermore, a length measurement sensor 10 is attached to the boom 4 to measure the length of expansion and contraction and output it as an electrical signal. The length measurement sensor 10 is of a tape measure type, and its main body 11 is provided at the base of the boom 4.
One end of the length measuring band 12 that goes in and out of the boom 4 is fixed to the tip fixing point 13 of the boom 4, and the length measuring band 12 converts the length pulled out from the main body 11 into an electrical signal. It is configured to output. The swivel base 3 is provided with an angle sensor 14 that measures the angle of the boom 4 and outputs it as an electrical signal.

なお、前又は後の張出し体7R,7Lには、こ
れらの伸縮長を測定できる測長センサー17R,
17Lを設けてある。この測長センサー17R,
17Lは測長センサー10と同じ構造のものでよ
く、本体は車体2の張出し体7R,7Lの基部に
取付け、帯体の先端をアウトリガー8に固定して
ある。
In addition, the front or rear overhanging bodies 7R, 7L are equipped with length measurement sensors 17R, 17R, which can measure the extension/contraction length thereof.
17L is provided. This length measurement sensor 17R,
The length measuring sensor 17L may have the same structure as the length measuring sensor 10, and its main body is attached to the base of the projecting bodies 7R and 7L of the vehicle body 2, and the tip of the band body is fixed to the outrigger 8.

第3図は転倒防止機構を含む油圧制御系統を示
すものである。油圧制御装置15は操作盤16か
らの操作指令用の信号を取り込むと共に、測長セ
ンサー10、角度センサー14、張出し体7R,
7L用測長センサー17R,17Lからの信号を
取り込み、操作盤16からの指令か又はこれら指
令信号等に基づいて、駆動装置18をもつて駆動
される油圧ポンプ19から吐出される圧力油を制
御して各シリンダー6,20,21,22R,2
2L,23R,23L,24及び旋回台3を駆動
させる油圧モータ25をそれぞれ駆動制御できる
ように構成してある。油圧制御装置15では、第
4図に示すような安全領域(斜線を付した領域
X,X,Z)を記憶しているROM26が内蔵さ
れており、前記センサー10,14,17R,1
7Lからの信号を基にして演算結果をROM26
で参照し、上記安全領域X,X,Zを超えると判
断したときには、張出し体7R,7Lのための張
出し体用シリンダー22,23を駆動制御して重
心が移動した方向とは反対方向に車体2を移動さ
せるようにしてある。これにより、第4図の安全
領域X,X,Zは、破線で示す領域x,y,zの
ように拡大され、その領域は広げられる。
FIG. 3 shows a hydraulic control system including a fall prevention mechanism. The hydraulic control device 15 takes in signals for operation commands from the operation panel 16, and also controls the length measurement sensor 10, the angle sensor 14, the overhang body 7R,
It receives signals from the length measurement sensors 17R and 17L for 7L, and controls pressure oil discharged from a hydraulic pump 19 driven by a drive device 18 based on commands from the operation panel 16 or these command signals. and each cylinder 6, 20, 21, 22R, 2
2L, 23R, 23L, 24 and a hydraulic motor 25 for driving the swivel base 3 can be controlled. The hydraulic control device 15 has a built-in ROM 26 that stores safety areas (shaded areas X, X, Z) as shown in FIG.
The calculation result is stored in ROM26 based on the signal from 7L.
When it is determined that the above-mentioned safety ranges X, 2 is moved. As a result, the safety areas X, X, and Z in FIG. 4 are expanded to areas x, y, and z shown by broken lines, and the areas are widened.

第5図は上記油圧制御系統のうちの転倒防止機
構の機器構成を示すものである。
FIG. 5 shows the equipment configuration of the overturn prevention mechanism in the hydraulic control system.

油圧制御装置15は、油圧回路29と、これを
制御する制御装置30とから構成されている。
The hydraulic control device 15 includes a hydraulic circuit 29 and a control device 30 that controls the hydraulic circuit 29.

制御装置30は、各種の演算や処理を実行する
処理装置(CPU)31と、該CPU31に所定の
手段で処理等を実行させるプログラムを記憶して
いる読出専用メモリ(ROM)32と、各種デー
ター等を記憶しておくメモリ(RAM)33と、
操作盤16からの各種指令を取り込むと共に必要
な表示信号を操作盤16に与えるデジタル入出力
回路(DIO)34と、各種センサー10,14,
17R,17Lからの検出信号を取り込む入力回
路(I)35と、上記油圧回路29を制御する信
号を出力するデジタル出力回路(DO)36と、
これらを接続するバス37とから構成されてい
る。尚、ROM26はバス37に接続しある。
The control device 30 includes a processing device (CPU) 31 that executes various calculations and processes, a read-only memory (ROM) 32 that stores programs that cause the CPU 31 to execute processes, etc. by predetermined means, and a read-only memory (ROM) 32 that stores various data. A memory (RAM) 33 for storing information such as
A digital input/output circuit (DIO) 34 that receives various commands from the operation panel 16 and provides necessary display signals to the operation panel 16, and various sensors 10, 14,
An input circuit (I) 35 that takes in detection signals from 17R and 17L, and a digital output circuit (DO) 36 that outputs a signal that controls the hydraulic circuit 29.
It is composed of a bus 37 that connects these. Note that the ROM 26 is connected to a bus 37.

油圧回路29は、油圧ポンプ19により加圧さ
れた圧力油を電磁切換弁41,42,43及び4
4に供給できるように配管40が接続してあり、
電磁切換弁41,42,43及び44からの油を
油タンク45に導くように配管46が設けてあ
り、電磁切換弁41の出力側と伸縮用シリンダー
20とを配管47,48で連結し、電磁切換弁4
2の出力側と俯角シリンダー6とを配管49,5
0で連結し、電磁切換弁43の出力側を右側張出
し体用シリンダー22R,23Rの直列接続した
ものに配管51,52を介して連結し、電磁切換
弁44の出力側を左側張出し体用シリンダー22
L,23Lの直列接続したものに配管53,54
を介して連結して構成したものである。上記各電
磁切換弁41〜44は、制御装置30のDO36
を介して出力されるCPU31からの切換指令に
よりそれぞれ切り換えられるようになつており、
その指令に応じた作動油を各電磁切換弁41〜4
4の出力側に出力できるようになつている。
The hydraulic circuit 29 supplies pressure oil pressurized by the hydraulic pump 19 to electromagnetic switching valves 41, 42, 43, and 4.
A pipe 40 is connected so that it can be supplied to
A pipe 46 is provided to guide oil from the electromagnetic switching valves 41, 42, 43, and 44 to an oil tank 45, and the output side of the electromagnetic switching valve 41 and the telescopic cylinder 20 are connected by pipes 47, 48. Solenoid switching valve 4
Piping 49,5 connects the output side of 2 and the depression angle cylinder 6.
0, and the output side of the electromagnetic switching valve 43 is connected to the series-connected cylinders 22R and 23R for the right side overhang body via piping 51, 52, and the output side of the electromagnetic changeover valve 44 is connected to the cylinder for the left side overhang body. 22
Pipes 53 and 54 are connected in series with L and 23L.
It is configured by connecting through. Each of the electromagnetic switching valves 41 to 44 is connected to the DO 36 of the control device 30.
It is designed to be switched by a switching command from the CPU 31 outputted via the
Each electromagnetic switching valve 41 to 4 receives hydraulic oil according to the command.
It is possible to output to the output side of 4.

第6図は、第5図の転倒防止機構を示すブロツ
ク図である。
FIG. 6 is a block diagram showing the fall prevention mechanism of FIG. 5.

この図においても前述の構成要素と同一のもの
には同一の符号を付して説明を省略する。
In this figure as well, the same components as those described above are given the same reference numerals and their explanations will be omitted.

第6図において、55は手動駆動制御部、56
は主計算処理部、57は照合・制御部、58はF
レジスタ、59はGレジスタ、60は張出し体駆
動制御部、61は修正駆動制御部、62は警報
部、63は補助計算部である。
In FIG. 6, 55 is a manual drive control unit; 56 is a manual drive control unit;
is the main calculation processing unit, 57 is the collation/control unit, and 58 is F.
59 is a G register, 60 is an overhang body drive control section, 61 is a correction drive control section, 62 is an alarm section, and 63 is an auxiliary calculation section.

手動駆動制御部55は、信号65が“1”のと
きに操作盤16からの操作指令に基づいて電磁切
換弁41,42を切り換え制御し、信号65が
“0”のときには操作盤16からの操作指令に基
づく信号を電磁切換弁41,42に出さないよう
にしてある。
The manual drive control unit 55 switches and controls the electromagnetic switching valves 41 and 42 based on the operation command from the operation panel 16 when the signal 65 is "1", and controls the switching of the electromagnetic switching valves 41 and 42 based on the operation command from the operation panel 16 when the signal 65 is "0". A signal based on the operation command is not output to the electromagnetic switching valves 41 and 42.

主計算処理部56は、センサー10,14、補
助計算部63、及びその他必要な信号を取り込ん
で後述する第(1)式〜第(4)式の演算処理をして、そ
の演算結果を照合・制御部57に供給するように
してある。
The main calculation processing unit 56 takes in signals from the sensors 10, 14, the auxiliary calculation unit 63, and other necessary signals, performs calculation processing on equations (1) to (4), which will be described later, and collates the calculation results. - It is designed to be supplied to the control section 57.

照合・制御部57は、前記演算結果を基に、
ROM26に記憶させてある第1の安全領域
(X,Y,Z)、又は第2の安全領域(x,y,
z)を照合すると共に、制御の順序に応じてFレ
ジスタ58、Gレジスタ59を照合し、第1の安
全領域にあると判断したときはS信号65を
“1”とし、第2の安全領域にあると判断したと
きS信号65を一時“0”とすると共に移動制御
信号66を張出し体駆動制御部60に修正制御信
号67を修正駆動制御部61に出力し、張出し体
駆動制御部60により張出し体7R,7Lの移動
が完了したと補助計算部63からの信号により確
認すると信号65を“1”とし、信号66,67
の出力を停止し、第2の安全領域を超えると判断
されたときはS信号65を“0”とすると共にA
信号70を操作盤16の警報部62に出力する。
第2の安全領域にあつたものが第1の安全領域に
なつたと判断されたときは戻制御信号68を張出
し体駆動制御部60、修正戻制御信号69を修正
駆動制御部61に出力するようにしてある。
The collation/control unit 57, based on the calculation result,
The first safety area (X, Y, Z) or the second safety area (x, y,
z), and also checks the F register 58 and G register 59 according to the order of control, and when it is determined that it is in the first safe area, the S signal 65 is set to "1", and the second safe area is set. When the S signal 65 is temporarily set to "0", the movement control signal 66 is output to the overhang body drive control section 60, the correction control signal 67 is output to the correction drive control section 61, and the overhang body drive control section 60 When it is confirmed by the signal from the auxiliary calculation unit 63 that the movement of the overhanging bodies 7R and 7L has been completed, the signal 65 is set to "1", and the signals 66 and 67 are
When it is determined that the second safety area has been exceeded, the S signal 65 is set to “0” and the A
A signal 70 is output to the alarm section 62 of the operation panel 16.
When it is determined that what was in the second safety area has become the first safety area, a return control signal 68 is output to the overhang body drive control section 60, and a modified return control signal 69 is output to the modification drive control section 61. It is set as.

Fレジスタ58は照合・制御部57によりセツ
ト・リセツトされるようにしてある。Gレジスタ
59は手動駆動制御部55により、旋回台3の向
きがセツトされるようにしてある。
The F register 58 is set/reset by the collation/control section 57. The G register 59 is configured so that the direction of the swivel base 3 is set by the manual drive control section 55.

電磁切換弁41,42は、手動駆動制御部55
または修正駆動制御部61により切換制御される
ようにしてある。
The electromagnetic switching valves 41 and 42 are controlled by a manual drive control section 55.
Alternatively, switching control is performed by the correction drive control section 61.

電磁切換弁43,44は自動制御されている間
は張出し体駆動制御部60により切換制御される
ようにしてある。
The electromagnetic switching valves 43 and 44 are switched and controlled by the overhang body drive control section 60 while being automatically controlled.

尚、手動駆動制御部55、主計算処理部56、
照合・制御部57、修正駆動制御部61、張出し
体駆動制御部60、補助計算部63は、CPU3
1により構成されており、Fレジスタ58、Gレ
ジスタ59はRAM33内に設けられている。
Note that the manual drive control section 55, the main calculation processing section 56,
The collation/control unit 57, the correction drive control unit 61, the overhang body drive control unit 60, and the auxiliary calculation unit 63 are connected to the CPU 3.
1, and an F register 58 and a G register 59 are provided within the RAM 33.

次に、上記実施例の作用を説明する。 Next, the operation of the above embodiment will be explained.

第7図は本実施例の作用を証明するために示す
フローチヤート、第8図は修正制御及び修正戻制
御動作を説明するために示すフローチヤート、第
9図〜第11図は本実施例の作用を説明するため
に示す説明図である。
FIG. 7 is a flowchart shown to prove the operation of this embodiment, FIG. 8 is a flowchart shown to explain correction control and correction return control operations, and FIGS. 9 to 11 are flowcharts shown to demonstrate the operation of this embodiment. It is an explanatory diagram shown in order to explain an effect.

まず、張出し体7を所定の長さまで伸ばす。こ
の動作は操作盤16を操作して操作指令を発し
(ステツプS100)、この指令を取り込んだ油圧
制御装置15により張出し体用シリンダー22
R,22L,23R,23Lに作動油を供給して
各張出し体7を伸ばし(ステツプS101)、所
定の長さに各張出し体7が伸びたことを各測長セ
ンサー17R,17Lからの検出信号により油圧
制御装置15が検出すると(ステツプS102)、
その作動油の供給を停止する(ステツプS10
3)ことにより実現される。
First, the overhanging body 7 is extended to a predetermined length. This operation is performed by operating the operation panel 16 to issue an operation command (step S100), and receiving this command, the hydraulic control device 15 controls the overhang body cylinder 22.
Hydraulic oil is supplied to R, 22L, 23R, and 23L to extend each overhang body 7 (step S101), and a detection signal from each length measurement sensor 17R and 17L indicates that each overhang body 7 has been extended to a predetermined length. When the hydraulic control device 15 detects (step S102),
The supply of the hydraulic oil is stopped (step S10).
3) It is realized by

次に、アウトリガー8を伸ばして車体2を地上
より浮かせておく。これは、操作盤16を操作し
て操作指令を発し(ステツプS104)、この指
令を取り込んだ油圧制御装置15によりアウトリ
ガーシリンダー24に作動油を所定量供給する
(ステツプS105)ことにより実現される。
Next, the outriggers 8 are extended to raise the vehicle body 2 above the ground. This is accomplished by operating the operation panel 16 to issue an operation command (step S104), and having received this command, the hydraulic control device 15 supplies a predetermined amount of hydraulic fluid to the outrigger cylinder 24 (step S105).

このように張出し体7を所定長さ伸ばし、かつ
アウトリガー8を伸ばして車体2を浮かせた状態
が第7図に示されている。
FIG. 7 shows a state in which the overhanging body 7 is extended by a predetermined length and the outriggers 8 are extended to float the vehicle body 2 in this manner.

これにより旋回台3の回転、ブーム4の伸縮、
ブーム4の俯角の各制御が可能となる。
This allows rotation of the swivel base 3, extension and contraction of the boom 4,
It becomes possible to control the depression angle of the boom 4.

ステツプS107はブーム4の伸縮指令、ステ
ツプS108はブーム4の俯角制御指令、ステツ
プS109は旋回台3の回転制御指令がそれぞれ
個別に発生できる。これら信号は、手動駆動制御
部55に入力される。
In step S107, a command to extend and retract the boom 4, in step S108, a command to control the depression angle of the boom 4, and in step S109, a command to control the rotation of the swivel base 3 can be individually generated. These signals are input to the manual drive control section 55.

ステツプS107でブーム4の伸縮指令が操作
盤16を介して発せられると、手動駆動制御部5
5は電磁切換弁41を駆動制御し(これはDIO3
4を介して得られる指令をCPU31に取り込み、
その指令を判定してDO36を介して電磁切換弁
41を駆動制御することによつて)、伸縮用シリ
ンダー20に作動油を供給してブーム4を伸張さ
せるか縮退させるかの動作をさせる(ステツプS
110)。次いで、測長センサー10からの検出
信号(l)と、角度センサー14からの検出信号
(θ)とを入力回路35を介して読み込みRAM
33に一時記憶させる(ステツプS111)。次
に、RAM33に記憶したデーターlとθとを用
いて主計算処理部56で下記(1)式と(2)式の計算を
する(ステツプS112)。
When an extension/retraction command for the boom 4 is issued via the operation panel 16 in step S107, the manual drive control section 5
5 drives and controls the electromagnetic switching valve 41 (this is DIO3
The instructions obtained through 4 are taken into the CPU 31,
By determining the command and controlling the electromagnetic switching valve 41 via the DO 36), hydraulic oil is supplied to the telescopic cylinder 20 to extend or retract the boom 4 (step S
110). Next, the detection signal (l) from the length measurement sensor 10 and the detection signal (θ) from the angle sensor 14 are read through the input circuit 35 and stored in the RAM.
33 (step S111). Next, using the data l and θ stored in the RAM 33, the main calculation processing section 56 calculates the following equations (1) and (2) (step S112).

H=lsinθ …(1) V=lcosθ …(2) ただし、H;ブーム4の水平方向の長さ、 V;ブーム4の垂直方向の長さ、 l;ブーム4の長さ、 θ;ブーム4と水平面の角度、 さらに、ステツプS113では、主計算処理部
56からの演算結果を照合・制御部57に取り込
み、その照合・制御部57はROM26に記憶さ
せてある第4図に示す第1の安全領域(X,Y,
Z)に、上記計算結果をつき合わせ、安全領域か
否かを照合・制御部57で判定させる(ステツプ
S114)。ステツプS114で、照合・制御部
57で安全領域(YES)であると判定されると、
ステツプS115に移つて、ここでFレジスタ5
8をチエツクし前回異常処理ループであつたかを
判定し、異常が無ければS信号65を“1”とし
てステツプS116に移る。
H=lsinθ...(1) V=lcosθ...(2) However, H: Horizontal length of boom 4, V: Vertical length of boom 4, l: Length of boom 4, θ: Boom 4 and the angle of the horizontal plane.Furthermore, in step S113, the calculation result from the main calculation processing section 56 is taken into the collation/control section 57, and the collation/control section 57 calculates the first one shown in FIG. Safety area (X, Y,
Z) is compared with the above calculation results, and the verification/control unit 57 determines whether or not it is in the safe area (step S114). In step S114, if the collation/control unit 57 determines that it is in the safe area (YES),
Proceeding to step S115, the F register 5 is
8 is checked to determine whether it was the previous abnormality processing loop, and if there is no abnormality, the S signal 65 is set to "1" and the process moves to step S116.

ステツプS116では、現在の制御がブーム4
の長さ制御である場合はステツプS117に移
り、所望の長さになつたと判定したときは、ステ
ツプS117で操作盤16を操作して手動駆動制
御部55にブーム長さ制御の停止指令を与える。
すると、これをDIO34を介して得たCPU31
が電磁切換弁41をDO36を介して停止位置に
にして停止させる(ステツプS118)。尚、ス
テツプS116で所望の長さでないときはステツ
プS107に戻る。
In step S116, the current control is
If it is length control, the process moves to step S117, and if it is determined that the desired length has been reached, the operation panel 16 is operated in step S117 to give a stop command for boom length control to the manual drive control section 55. .
Then, CPU31 obtained this through DIO34
then moves the electromagnetic switching valve 41 to the stop position via the DO 36 and stops it (step S118). Note that if the desired length is not found in step S116, the process returns to step S107.

ステツプS108で、操作盤16が操作されて
ブーム4の角度制御指令が発せられると、手動駆
動制御装置55により電磁切換弁42が制御され
(これをDIO34を介してCPU31に取り込まれ
た指令をCPU31で判定してDO36を介して電
磁切換弁42を駆動制御することによつて)、俯
角シリンダー6に作動油を供給してブーム4を持
ち上げる(ステツプS120)。
In step S108, when the operation panel 16 is operated and a command to control the angle of the boom 4 is issued, the manual drive control device 55 controls the electromagnetic switching valve 42 (this command is taken into the CPU 31 via the DIO 34). (by controlling the electromagnetic switching valve 42 via the DO 36), hydraulic oil is supplied to the depression angle cylinder 6 and the boom 4 is lifted (step S120).

次いで、主計算処理部56は各センサー10,
14からの信号を取り込み(ステツプS111)、
これを基に主計算処理部56で演算し(ステツプ
S112)、照合・制御部57にその結果を与え
る。照合・制御部57は、ROM26に記憶させ
た第4図に示す第1の安全領域(X,Y,Z)を
照合し、危険領域でないときにステツプS115
でFレジスタ58をチエツクし異常処理ループを
通つてないことを条件にステツプS116に移
る。このステツプS116では角度制御と判定さ
れるので、ステツプS121で所望の角度になつ
たと判定したときは、ステツプS122で操作盤
16を操作してブーム4の角度制御を停止指令に
する。すると、手動駆動制御部55により電磁切
換弁42が停止位置にし(これは、DIO34を介
して指令を得たCPU31が電磁切換弁42をDO
36を介して停止位置にして)ブーム4の角度制
御を停止させる(ステツプS123)。尚、ステ
ツプS121で所望の角度でないときは、ステツ
プS108に戻る。
Next, the main calculation processing unit 56 calculates each sensor 10,
14 (step S111),
Based on this, the main calculation processing section 56 performs calculations (step S112), and provides the results to the collation/control section 57. The verification/control unit 57 verifies the first safe area (X, Y, Z) shown in FIG.
Then, the F register 58 is checked, and on the condition that the abnormality processing loop has not been passed, the process moves to step S116. Since it is determined in step S116 that angle control is required, when it is determined in step S121 that the desired angle has been reached, the operation panel 16 is operated in step S122 to issue a command to stop the angle control of the boom 4. Then, the manual drive control unit 55 sets the electromagnetic switching valve 42 to the stop position (this means that the CPU 31, which received the command via the DIO 34, switches the electromagnetic switching valve 42 to the DO position.
36 to the stop position) to stop the angle control of the boom 4 (step S123). Note that if it is determined in step S121 that the angle is not the desired angle, the process returns to step S108.

一方、主計算処理部56からの演算結果を照
合・制御部57がROM26を照合し(ステツプ
S111〜ステツプS114)、第2の安全領域
を超えたと判定されると、照合・制御部57はF
レジスタ58を照合し(ステツププS124)、
このFレジスタ58に何もセツトされていないと
きにステツプS125に移り、ブーム4の移動を
停止すべく照合・制御部57は信号65を“0”
として手動駆動制御部55を動作停止とする(こ
れは、CPU31がDO36を介して電磁切換弁4
1,42を停止位置に制御することによつて得ら
れる)。
On the other hand, the collation/control unit 57 collates the calculation result from the main calculation processing unit 56 with the ROM 26 (steps S111 to S114), and when it is determined that the second safety area has been exceeded, the collation/control unit 57
Check the register 58 (step S124),
When nothing is set in this F register 58, the process moves to step S125, and the verification/control unit 57 sets the signal 65 to "0" in order to stop the movement of the boom 4.
(This means that the CPU 31 stops the operation of the electromagnetic switching valve 4 via the DO 36.
1, 42 to the stop position).

次いで、照合・制御部57はGレジスタを照合
してブーム4の向きに関するデーターを判定し
(ステツプS126)、“右”の場合はステツプS
127に、“左”の場合はステツプS128に移
る。ステツプS127の制御は、照合・制御部5
7が張出し体制御部60に移動制御信号66を出
し、電磁切換弁43,44を駆動する(これは、
CPU31が張出し体シリンダー22L,23L
を縮退させ、かつ張出し体シリンダー22R,2
3Rを伸張させるように電磁切換弁43,44を
駆動制御することによつて得られる)。
Next, the collation/control unit 57 collates the G register to determine data regarding the direction of the boom 4 (step S126), and if it is "right", the data is determined in step S126.
In step S127, if it is "left", the process moves to step S128. The control in step S127 is performed by the verification/control unit 5.
7 outputs a movement control signal 66 to the overhang body control unit 60 to drive the electromagnetic switching valves 43 and 44 (this
CPU31 is an overhang body cylinder 22L, 23L
and the overhang body cylinders 22R, 2
3R).

同時に、照合・制御部57からは修正制御信号
が修正駆動制御部61に供給され、修正制御用の
信号が電磁切換弁41,42に与えられる(これ
は、CPU31によりDO36を介して行われる
(ステツプS129))。尚、修正制御動作は後述
するが、これによりパケツト5は車体2の移動に
関わらず、一定位置に留まることになる。
At the same time, a correction control signal is supplied from the verification/control section 57 to the correction drive control section 61, and a signal for correction control is given to the electromagnetic switching valves 41 and 42 (this is done by the CPU 31 via the DO 36). Step S129)). Note that the correction control operation will be described later, but as a result of this, the packet 5 remains at a fixed position regardless of the movement of the vehicle body 2.

ステツプS128での制御は、照合・制御部5
7が張出し体駆動制御部60に移動制御信号66
を出し、電磁切換弁43,44を駆動する(これ
は、CPU31が張出し体シリンダー22L,2
3Lを伸張させ、かつ張出し体シリンダー22
R,23Rを縮退させるように電磁切換弁41,
42を駆動制御することによつて得られる)。同
時に、照合・制御部57からは修正制御用の信号
が電磁切換弁41,42に与えられる(これは、
CPU31によりDO36を介して行われる(ステ
ツプS130)。この修正動作も後述する。ステ
ツプS129,130を終了すると、ステツプS
131へ移り、ここで張出し体7が所定の長さに
移動したか判定し移動しないときはステツプS1
26に戻り、移動したときはステツプS132に
移る。例えばステツプS126→128→130
→131の各ステツプを終了すると、車体2と張
出し体7の関係だけに注目すれば、第9図又は第
10図の状態から第11図の状態に移動すること
になる。
The control in step S128 is performed by the verification/control unit 5.
7 sends a movement control signal 66 to the overhang body drive control section 60.
and drives the electromagnetic switching valves 43 and 44 (this is because the CPU 31 operates the overhang body cylinders 22L and 2
3L is extended and the overhang body cylinder 22
Solenoid switching valve 41, so as to retract R, 23R.
42). At the same time, a correction control signal is given from the verification/control unit 57 to the electromagnetic switching valves 41 and 42 (this is
This is performed by the CPU 31 via the DO 36 (step S130). This correction operation will also be described later. After completing steps S129 and 130, step S
The process moves to step S131, where it is determined whether the overhanging body 7 has moved to a predetermined length, and if it has not moved, the process proceeds to step S1.
The process returns to step S132, and if it has moved, the process moves to step S132. For example, step S126→128→130
→ When each step 131 is completed, the state will move from the state shown in FIG. 9 or 10 to the state shown in FIG. 11 if attention is paid only to the relationship between the vehicle body 2 and the overhang body 7.

ステツプS132では、照合・制御部57はS
信号65を“1”としてステツプS125で停止
していたブーム4の移動を許可し、かつ、照合・
制御部57はステツプS133でFレジスタ58
に車体2を“右”、“左”のいずれに移動させたか
セツトする。センサー10,14からの検出信号
(l,θ)を入力回路35を介してRAM33に
記憶する(ステツプS134)。次いで主計算処
理部56が第(1)式、第(2)式を計算をする。つま
り、RAM33からのデーター(l,θ)を基に
CPU31では上記(1)式、(2)式の計算をする(ス
テツプS135)。
In step S132, the collation/control unit 57
The signal 65 is set to "1" to permit movement of the boom 4 that was stopped in step S125, and verification/
The control unit 57 sets the F register 58 in step S133.
Set whether the vehicle body 2 is moved to the "right" or "left". The detection signals (l, θ) from the sensors 10 and 14 are stored in the RAM 33 via the input circuit 35 (step S134). Next, the main calculation processing unit 56 calculates equations (1) and (2). In other words, based on the data (l, θ) from RAM33
The CPU 31 calculates the above equations (1) and (2) (step S135).

照合・制御部57は、第2の安全領域(x,
y,z)に前記主計算処理部56からの演算結果
を突き合わせ(ステツプS136)、安全と判断
するとステツプS166の処理に移し、危険と判
断するとステツプS138の処理に移す。照合・
制御部57は、ステツプS138の処理として警
報部62にA信号70を与えることにより警報を
発し、次いでS信号65を“0”として停止制御
する(これは、CPU31によりDO36を介して
電磁切換弁41,42を停止位置にすることによ
つて得られる(ステツプS139))。
The verification/control unit 57 operates in a second safety area (x,
y, z) with the calculation result from the main calculation processing unit 56 (step S136), and if it is determined to be safe, the process moves to step S166, and if it is determined to be dangerous, the process moves to step S138. Verification/
The control section 57 issues an alarm by giving the A signal 70 to the alarm section 62 as a process in step S138, and then controls the stop by setting the S signal 65 to "0" (this is done by the CPU 31 via the DO 36 to control the electromagnetic switching valve). 41 and 42 to the stop position (step S139)).

ところで、一度第1の安全領域から外れると、
必ずステツプS124に移るが、2回目以降フロ
ーの場合はステツプS124でステツプS134
にジヤンプすることになるので、第1及び第2の
安全領域内にあるか否かの判定だけになる。
By the way, once you get out of the first safety area,
The process always moves to step S124, but in the case of the second or subsequent flow, the process moves to step S134 in step S124.
Therefore, only a determination is made as to whether or not it is within the first and second safe areas.

ここで再びステツプS114で第1の安全領域
に入ると、ステツプS115に移り、Fレジスタ
58のチエツクが照合・制御部57によりなされ
る。ここでは、一度以上危険範囲となつたことで
ステツプS124〜ステツプS137の処理がな
されていることから、Fレジスタ58に“右”、
“左”の設定がされているので、ステツプS14
0に移ることになる。
When the first safe area is entered again in step S114, the process moves to step S115, where the F register 58 is checked by the collation/control unit 57. Here, since the process from step S124 to step S137 has been carried out because it has entered the danger range more than once, "right" is written in the F register 58.
Since “left” is set, step S14
It will move to 0.

先ず、照合・制御部57は信号65を“0”と
してブームの動きを時停止させる(ステツプS1
40)。次いで、照合・制御部57は、Gレジス
タ59を照合してブーム4の向きを判断する(ス
テツプS141)。ブーム4が右に向いていると
きは、ステツプS142に移り、照合・制御部5
7から張出し体駆動制御部60に信号を与え、車
体2を右に移動させて元の位置になるように制御
する。次いで、照合・制御部57は、修正駆動制
御部61に修正戻制御信号を与えて、張出し体シ
リンダー22R,22L,23R,23Lの戻り
があつてもブーム4の先端が同一位置にあるよう
に制御する(ステツプS143)。ついで、補助
計算部63からの信号により車体2が元の位置に
戻つたか否かを照合・制御部57が判断し、元に
戻つていないときは、ステツプS141に移り、
元に戻つたときはステツプS148に移る。ステ
ツプS148では照合・制御部57はS信号65
を“1”にして一時停止を解除し、ステツプS1
49で照合・制御部57はFレジスタ58をリセ
ツトしてからステツプS116に移る。尚、ステ
ツプS146,S147は、ステツプS142,
S143と同じ制御で方向が異なるだけである。
First, the collation/control unit 57 sets the signal 65 to "0" to temporarily stop the movement of the boom (step S1).
40). Next, the collation/control unit 57 collates the G register 59 and determines the direction of the boom 4 (step S141). When the boom 4 is facing to the right, the process moves to step S142, and the verification/control unit 5
A signal is given from 7 to the overhang body drive control section 60 to control the vehicle body 2 to move to the right and return to its original position. Next, the collation/control unit 57 gives a correction return control signal to the correction drive control unit 61 so that the tip of the boom 4 remains at the same position even if the overhang body cylinders 22R, 22L, 23R, and 23L return. control (step S143). Next, the verification/control unit 57 determines whether the vehicle body 2 has returned to its original position based on the signal from the auxiliary calculation unit 63, and if it has not returned to its original position, the process moves to step S141.
When it returns to the original state, the process moves to step S148. In step S148, the verification/control unit 57 receives the S signal 65.
is set to "1" to cancel the temporary stop and proceed to step S1.
In step S49, the collation/control unit 57 resets the F register 58, and then proceeds to step S116. Note that steps S146 and S147 are different from steps S142 and S147.
This is the same control as S143, only the direction is different.

第8図は修正制御及び修正戻制御を示すフロー
チヤートであり、これに基づいてその動作を説明
するが、その前にこのフローチヤートで採用する
原理を説明する。
FIG. 8 is a flowchart showing correction control and correction return control, and the operation thereof will be explained based on this, but before that, the principle employed in this flowchart will be explained.

第12図は修正制御及び修正戻制御の原理を説
明するために示す説明図である。
FIG. 12 is an explanatory diagram shown to explain the principle of correction control and correction return control.

第12図において、Pはブーム4の先端、Oは
ブーム4の枢支点、Vは先端Pまでの高さ、Hは
枢支点Oと先端Pまでの水平距離である。危険範
囲と判定された時点において、高さをV(a)、水平
距離H(a)、ブーム4の長さl(a)、角度をθ(a)とす
る。
In FIG. 12, P is the tip of the boom 4, O is the pivot point of the boom 4, V is the height to the tip P, and H is the horizontal distance between the pivot point O and the tip P. At the time when it is determined to be in the dangerous range, let the height be V(a), the horizontal distance H(a), the length l(a) of the boom 4, and the angle θ(a).

ここで、車体2が矢符M方向にΔθだけ移動し
た際に先端Pをそのままの位置にするためには θ(b)=tan-1{V(a)/(H(a)+ΔH)}、 l(b)=V(a)/sinθ(b) とすればよい。さらに、ΔH移動したとすると、
先端Pをそのままの位置とするためには、 θ(c)=tan-1{V(a)/H(a)+2ΔH)}、 l(c)=V(a)/sinθ(c) とすればよい。したがつて、その車体の移動に応
じて、 θ(b)=tan-1{V(a)/(H(a)+ΔH)}、 θ(c)=tan-1{V(a)/(H(a)+2ΔH)}、 …… θ(x)=tan-1{V(a)/(H0+xΔH)} =tan-1{V(a)/H(a)+H(x))}、 …… θ(n)=tan-1{V(a)/H(a)+nΔH)}、 =tan-1{V(a)/H(a)+H(n))} l(b)=V(a)/sinθ(b) l(c)=V(a)/sinθ(c) …… l(x)=V(a)/sinθ(x) …… l(n)=V(a)/sinθ(n) となる。したがつて、このように車体2が移動す
る毎に、その水平移動距離H(x)を基に角度θ
(x)及びブーム長さl(x)を求め、この角度θ
(x)及び長さl(x)に実際の長さを一致させる
ように制御すれば、先端Pはその位置に留まるこ
とになる。
Here, in order to keep the tip P in the same position when the vehicle body 2 moves by Δθ in the direction of arrow M, θ(b)=tan -1 {V(a)/(H(a)+ΔH)} , l(b)=V(a)/sinθ(b). Furthermore, if we move by ΔH,
In order to keep the tip P at the same position, θ(c)=tan -1 {V(a)/H(a)+2ΔH)}, l(c)=V(a)/sinθ(c). Bye. Therefore, depending on the movement of the vehicle body, θ(b)=tan -1 {V(a)/(H(a)+ΔH)}, θ(c)=tan -1 {V(a)/( H(a)+2ΔH)}, ... θ(x)=tan -1 {V(a)/(H 0 +xΔH)} = tan -1 {V(a)/H(a)+H(x))} , ... θ(n)=tan -1 {V(a)/H(a)+nΔH)}, =tan -1 {V(a)/H(a)+H(n))} l(b)= V(a)/sinθ(b) l(c)=V(a)/sinθ(c)...l(x)=V(a)/sinθ(x)...l(n)=V(a) /sinθ(n). Therefore, each time the vehicle body 2 moves in this way, the angle θ is calculated based on the horizontal movement distance H(x).
(x) and boom length l(x), and this angle θ
(x) and the length l(x) to match the actual length, the tip P will remain at that position.

逆に、枢支点がOnにあるときに車体2が矢符
N方向に移動する場合は、次のようにすればよ
い。
Conversely, if the vehicle body 2 moves in the direction of arrow N when the pivot point is on, the following procedure may be used.

θ(n)=tan-1{V(a)/(H(a)+H(n))}、 θ(n−1) =tan-1{V(a)/(H(a)+H(n)−ΔH)} …… θ(x)=tan-1{V(a)/(H(a)+H(n)−H
(x))}、 …… θ(b)= tan-1{V(a)/(H(a)+H(n)−H(n−1))
}、 θ(a)=tan-1(V(a)/H(a)) l(n)=V(a)/sinθ(n) l(n−1)=V(a)/sinθ(n−1) …… l(x)=V(a)/sinθ(x) …… l(b)=V(a)/sinθ(b) l(a)=V(a)/sinθ(a) このようにして求めたθ(x),l(x)に実際
の角度とブーム長さを一致させれば、車体2のN
方向への移動にかかわらず、先端Pは同じ位置に
留まつていることになる。
θ(n) = tan -1 {V(a)/(H(a)+H(n))}, θ(n-1) = tan -1 {V(a)/(H(a)+H(n )−ΔH)} ... θ(x)=tan -1 {V(a)/(H(a)+H(n)−H
(x))}, ... θ(b)= tan -1 {V(a)/(H(a)+H(n)-H(n-1))
}, θ(a)=tan -1 (V(a)/H(a)) l(n)=V(a)/sinθ(n) l(n-1)=V(a)/sinθ(n -1) ... l(x) = V(a)/sinθ(x) ... l(b) = V(a)/sinθ(b) l(a) = V(a)/sinθ(a) This If the actual angle and boom length are matched to θ(x) and l(x) obtained in this way, the N of the vehicle body 2 is
Regardless of the direction of movement, the tip P remains at the same position.

それでは、上記原理に基づいて動作する修正制
御及び修正戻制御について第8図のフローチヤー
トを参照しながら説明する。この第8図のフロー
チヤートは、第7図に示すフローチヤートのステ
ツプS120及びS130、又はステツプS14
3及びS147を詳細に説明したものである。
Now, correction control and correction return control that operate based on the above principle will be explained with reference to the flowchart of FIG. 8. The flowchart of FIG. 8 includes steps S120 and S130 or step S14 of the flowchart shown in FIG.
3 and S147 are explained in detail.

ステツプS200では、照合・制御部57によ
り修正制御か、修正戻制御かの判定がされる。
In step S200, the collation/control unit 57 determines whether the control is correction control or correction return control.

ここで、修正制御と判定されたときの動作を説
明する。修正制御と判定されたときは、ステツプ
S201に移つて、このステツプS201でブー
ム4の向きが“右”か“左”かに応じてステツプ
S202か、S203に移ることになる。これ
は、入力されてくる角度センサー14からのデー
ターを用いやすいようにするためのものである。
次いで、ステツプS204では、ブーム4を伸ば
し制御と指定すると共に、角度を下降制御と指定
し、かつ使用する式を第(3―1)式を用いる指
定をする。
Here, the operation when it is determined that corrective control is required will be explained. When it is determined that the corrective control is required, the process moves to step S201, and the process moves to step S202 or S203 depending on whether the direction of the boom 4 is "right" or "left" in step S201. This is to make it easier to use the input data from the angle sensor 14.
Next, in step S204, the boom 4 is designated as extension control, the angle is designated as descending control, and the formula to be used is designated to use equation (3-1).

次いで、主計算処理部56は、補助計算部63
からのデーターを基にステツプS204で指定さ
れた第(3―1)式を用いてブーム角度θ(x)
を計算してその結果を照合・制御部57に与え
る。
Next, the main calculation processing section 56 executes the auxiliary calculation section 63.
The boom angle θ(x) is calculated using equation (3-1) specified in step S204 based on the data from
is calculated and the result is given to the verification/control section 57.

θ(x)=tan-1{V(a)/(H(a)+H(x))}
…(3―1) ただし、H(a)は第1の安全領域から初めて危険
領域に移つた際のバケツトと(ブーム4)下端枢
支部との水平距離。
θ(x)=tan -1 {V(a)/(H(a)+H(x))}
...(3-1) However, H(a) is the horizontal distance between the bucket and the lower end pivot point (boom 4) when moving from the first safety area to the danger area for the first time.

V(a)は、第1の安全領域から初めて危険領域に
移つた際のブーム4の先端とブーム4の下端枢支
点との垂直距離。
V(a) is the vertical distance between the tip of the boom 4 and the lower end pivot point of the boom 4 when moving from the first safety area to the danger area for the first time.

H(x)は車体2の水平移動距離。 H(x) is the horizontal movement distance of the vehicle body 2.

ステツプS206では、、主計算処理部56が、
上記ステツプS205で求めたθ(x)を基に第
(4)式を用いてブーム長さl(x)を計算してその
結果を照合・制御部57に与える。
In step S206, the main calculation processing unit 56
Based on θ(x) obtained in step S205 above,
The boom length l(x) is calculated using equation (4) and the result is provided to the collation/control unit 57.

l(x)=V(a)/sinθ(x) …(4) ステツプS207では、先ず照合・制御部57
から修正制御信号67が修正駆動制御部61に与
えられるから、該修正駆動制御部61は電磁切換
弁41を駆動制御して伸縮用シリンダー20を伸
ばすようにする。次に、照合・制御部57は、ス
テツプS205で求めたθ(x)と角度センサー
14からの実測定値と照合し、一致していなけれ
ば、照合・制御部57は修正制御信号67を修正
駆動制御部61に与えて俯角シリンダー6を下降
させる制御をする(ステツプS209)。次いで、
ステツプS210では、前のステツプで求めたθ
(x)と角度センサー14からの実測定値、及び
前のステツプで求めたl(x)と測長センサー1
0からの実測定値の両方が一致しているか否かを
判定し、両方が一致していなければステツプS2
11に移つて、l(x)が実測値と一致している
かを判定する。ステツプS211で不一致のとき
はステツプS207に移り、ステツプS211で
一致しているときはステツプS213に移り、こ
こで伸縮用シリンダー20の移動を停止するよう
に修正駆動制御部61を制御して、しかる後にス
テツプS209に移る。
l(x)=V(a)/sinθ(x)...(4) In step S207, first, the verification/control unit 57
Since the correction control signal 67 is given to the correction drive control section 61, the correction drive control section 61 drives and controls the electromagnetic switching valve 41 to extend the telescopic cylinder 20. Next, the collation/control unit 57 collates θ(x) obtained in step S205 with the actual measurement value from the angle sensor 14, and if they do not match, the collation/control unit 57 sends the correction control signal 67 to the correction drive. The control unit 61 is controlled to lower the depression angle cylinder 6 (step S209). Then,
In step S210, θ obtained in the previous step is
(x), the actual measurement value from the angle sensor 14, and l(x) obtained in the previous step and the length measurement sensor 1.
It is determined whether both of the actual measured values from 0 match, and if they do not match, step S2
Moving on to step 11, it is determined whether l(x) matches the actually measured value. If they do not match in step S211, the process moves to step S207, and if they match in step S211, the process moves to step S213, where the correction drive control section 61 is controlled to stop the movement of the telescopic cylinder 20, and then Afterwards, the process moves to step S209.

ステツプS208で、θ(x)と実測定値が一
致すると、ステツプS212に移り、俯角シリン
ダー6の駆動を停止する。
If θ(x) and the actual measured value match in step S208, the process moves to step S212, and the driving of the depression angle cylinder 6 is stopped.

ステツプS210で、両方とも一致がとられた
ときには、ステツプS214に移り、このステツ
プで伸縮用シリンダー20、俯角シリンダー6の
停止制御をするように照合・制御部57により修
正駆動制御部61が制御される。以上の制御フロ
ーにより、車体2の移動にかかわらずバケツト5
の位置及び高さは車体2が移動を始める直前の位
置に留まつたままとなる。
When both match in step S210, the process moves to step S214, and in this step, the correction drive control unit 61 is controlled by the verification/control unit 57 to stop the telescopic cylinder 20 and the depression angle cylinder 6. Ru. With the above control flow, regardless of the movement of the vehicle body 2, the bucket 5
The position and height of remain at the position immediately before the vehicle body 2 started moving.

一方、ステツプS200で修正戻制御と判定さ
れたときの動作を説明する。
On the other hand, the operation when it is determined in step S200 that the correction return control is to be performed will be explained.

ステツプS215ではブーム4の向きを判定す
る。この判定方法は前述と同じである。また、ス
テツプS216及びS217はステツプS202
及びS203同じである。次いで、ステツプS2
18では、伸縮用シリンダー20を縮める制御と
指定し、俯角シリンダー6を上昇させる制御と指
定し、かつ使用する式を第(3―2)式を用いる
指定をする。このステツプS218を通つた後は
ステツプS205に移り、以後の動作は前述と同
じフローを通り、前述の動きとは逆になる。すな
わち、バケツト5は、車体2が元の位置に戻る動
きがあつても、修正戻制御が開始される直前の位
置と高さに留まることになる。
In step S215, the direction of the boom 4 is determined. This determination method is the same as described above. Further, steps S216 and S217 are similar to step S202.
and S203 are the same. Next, step S2
In step 18, control is specified to retract the telescoping cylinder 20, control to raise the depression angle cylinder 6 is specified, and equation (3-2) is specified as the equation to be used. After passing through step S218, the process moves to step S205, and the subsequent operations follow the same flow as described above, but are opposite to those described above. That is, even if the vehicle body 2 moves back to its original position, the bucket 5 remains at the position and height immediately before the corrective return control was started.

ここに、第(3―2)式を示す。 Here, equation (3-2) is shown.

θ(x)=tan-1 {V(a)/(H(a)+H(n)−H(x))
…(3―2) 尚、ステツプS109で操作盤16を操作して
旋回台3の回転指令を与えると、これが油圧制御
装置15に取り込まれ、直ちに油圧モータ25を
旋回駆動する(ステツプS150)。ステツプS
151で所望の回転角になつたかを操作者が判定
し、所望となつていなければステツプS109に
戻り、所望となつていたときはステツプS152
に移り、操作盤16を停止制御する。これによ
り、油圧制御装置15は旋回台3用の油圧モータ
25を停止し(ステツプS153)、その回転角
方向を所定のGレジスタ(RAM33内に設けて
ある)59に記憶させておく(ステツプS15
4)。この回転方向は移動させる毎に更新できる
ようにしてあり、基本位置にブーム4が戻つたと
きにはGレジスタ59はリセツトされるようにし
てある。
θ(x)=tan -1 {V(a)/(H(a)+H(n)-H(x))
(3-2) In step S109, when the operation panel 16 is operated to give a rotation command for the swivel base 3, this command is taken into the hydraulic control device 15, and the hydraulic motor 25 is immediately driven to swivel (step S150). Step S
In step 151, the operator determines whether the desired rotation angle has been reached. If the desired rotation angle has not been achieved, the process returns to step S109; if the desired rotation angle has been achieved, the process returns to step S152.
Then, the operation panel 16 is controlled to stop. As a result, the hydraulic control device 15 stops the hydraulic motor 25 for the swivel base 3 (step S153), and stores the rotation angle direction in a predetermined G register (provided in the RAM 33) 59 (step S15).
4). This direction of rotation can be updated each time the boom 4 is moved, and the G register 59 is reset when the boom 4 returns to its basic position.

それでは、上記フローチヤートを使つて動作の
一例を説明する。
Now, an example of the operation will be explained using the above flowchart.

ステツプS107,S108で同時にブーム4
の伸びと俯角が制御されたとすると、ステツプS
110,S120→S110〜S117,S12
1と処理されて、第9図の状態からブーム4が伸
びて第1図及び第2図の状態になる。そして、所
望の状態にブーム4がなつたときに、それぞれス
テツプS117〜S119,S121〜S123
に移り停止する。
Boom 4 at the same time in steps S107 and S108
Assuming that the elongation and depression angle of S are controlled, step S
110, S120 → S110 to S117, S12
1 and the boom 4 extends from the state shown in FIG. 9 to the state shown in FIGS. 1 and 2. Then, when the boom 4 is in the desired state, steps S117 to S119 and S121 to S123 are performed, respectively.
and stop.

次いで、ステツプS109に移してステツプS
140〜S141の処理をし、旋回台3を回転さ
せる。所望の回転位置に旋回台3がきたときにス
テツプS152〜S154の処理をすると、第1
0図の如くになる。
Next, the process moves to step S109, and the process proceeds to step S109.
Processes 140 to S141 are performed, and the swivel base 3 is rotated. If steps S152 to S154 are performed when the swivel base 3 reaches the desired rotational position, the first
It will look like Figure 0.

このときステツプS114で危険と判定される
と、以後ステツプS124以降の処理がなされる
(ステツプS124〜137)。これにより、第1
1図に示すように、車体2が転倒方向とは反対方
向に移動し安全となる。このとき、第8図の処理
がなされて、バケツト5は一定の位置に保たれて
いる。第11図に示すように、車体2は破線の状
態から実線の状態に移るが、バケツト5は元の位
置に留まることができるものである。また、危険
角度から離れると、ステツプS114で必ずステ
ツプS115に移るので、張出し体7は元の位置
(第10図)に設定されることになる。このとき
も、第8図の処理がなされ、第11図に示すよう
に車体2が実線から破線に移つても、バケツト5
はもとの位置に留まることができる。
At this time, if it is determined in step S114 that it is dangerous, the processing from step S124 onwards is performed (steps S124-137). This allows the first
As shown in FIG. 1, the vehicle body 2 moves in the opposite direction to the overturning direction, making it safer. At this time, the process shown in FIG. 8 is performed, and the bucket bag 5 is kept at a constant position. As shown in FIG. 11, the vehicle body 2 moves from the broken line state to the solid line state, but the bucket bag 5 can remain in its original position. Furthermore, when the operator leaves the dangerous angle, the process always moves from step S114 to step S115, so that the projecting body 7 is set to its original position (FIG. 10). At this time, even if the process shown in FIG. 8 is performed and the vehicle body 2 moves from the solid line to the broken line as shown in FIG.
can remain in its original position.

このように本実施例は動作するので、第1の危
険領域(第4図の斜線X,Y,Zの領域外)にな
ると自動的に車体2を転倒方向とは反対側に移動
させると共にバケツト5を元の位置に留めておく
ことができ、重心バランスがとられると共にバケ
ツト5の移動がないので転倒を防止できると共に
バケツト移動による危険がなくなる。危険範囲を
離れると車体2は再び元の位置(第10図)に復
帰できる。
Since this embodiment operates in this way, when the first danger area (outside the area indicated by the diagonal lines X, Y, and Z in FIG. 4) is reached, the vehicle body 2 is automatically moved to the opposite side of the overturning direction and the bucket truck is moved. 5 can be kept at the original position, the center of gravity is balanced, and since the bucket 5 does not move, it is possible to prevent it from falling over, and there is no danger due to the bucket shifting. When the vehicle body 2 leaves the dangerous area, it can return to its original position (FIG. 10).

〔発明の効果〕〔Effect of the invention〕

本発明によれば、上述のようになつているので
ブームの転倒危険範囲を著しく小さくして作業範
囲を拡大できると共に、ブーム先端の移動がない
ので安全であるという効果がある。
According to the present invention, as described above, the work area can be enlarged by significantly reducing the danger range of the boom overturning, and there is also the advantage of safety because there is no movement of the tip of the boom.

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

第1図は本発明に係る実施例を示す斜視図、第
2図は同実施例を示す側面図、第3図は油圧制御
系統を示す系統図、第4図は安全領域を示す説明
図、第5図は同実施例の転倒防止機構を示す系統
図、第6図は転倒防止機構を示すブロツク図、第
7図は同実施例の作用を説明するために示すフロ
ーチヤート、第8図は修正制御及び修正戻制御を
示すフローチヤート、第9図〜第11図は同実施
例を説明するための説明図、第12図は修正制御
及び修正戻制御の原理を説明するために示す説明
図である。 2…車体、3…旋回台、4…ブーム、7…張出
し体、9…持ち上げ機構、10…測長センサー、
14…角度センサー、15…油圧制御装置、26
…ROM、29…油圧回路、30…制御装置、5
5…手動駆動制御部、56…主計算処理部、57
…照合・制御部、58…Fレジスタ、59…Gレ
ジスタ、60…張出し体駆動制御部、61…修正
駆動制御部。
FIG. 1 is a perspective view showing an embodiment according to the present invention, FIG. 2 is a side view showing the same embodiment, FIG. 3 is a system diagram showing a hydraulic control system, and FIG. 4 is an explanatory diagram showing a safety area. Fig. 5 is a system diagram showing the fall prevention mechanism of the same embodiment, Fig. 6 is a block diagram showing the fall prevention mechanism, Fig. 7 is a flow chart shown to explain the operation of the same embodiment, and Fig. 8 is a system diagram showing the fall prevention mechanism of the same embodiment. A flowchart showing correction control and correction return control, FIGS. 9 to 11 are explanatory diagrams for explaining the same embodiment, and FIG. 12 is an explanatory diagram shown for explaining the principle of correction control and correction return control. It is. 2...Vehicle body, 3...Swivel base, 4...Boom, 7...Extended body, 9...Lifting mechanism, 10...Length measurement sensor,
14... Angle sensor, 15... Hydraulic control device, 26
...ROM, 29...hydraulic circuit, 30...control device, 5
5... Manual drive control section, 56... Main calculation processing section, 57
... Collation/control section, 58... F register, 59... G register, 60... Overhang body drive control section, 61... Correction drive control section.

Claims (1)

【特許請求の範囲】 1 車体上に旋回可能に設けられた旋回台と、こ
の旋回台に枢支されて俯角シリンダーと伸縮用シ
リンダーで伸縮起伏自在に動作されるブームと、
前記ブームの先端に枢着されたバケツトとから成
る高所作業車において、 車体の左右両側に水平方向に伸縮できる張出し
体を設け、これらの張出し体の先端には車体を持
ち上げるアウトリガーを設け、張出し体には持ち
上げた状態の車体をその側方に水平方向へ移動さ
せることができる油圧作動機構を設け、ブームに
はその伸縮長を測定できる測長センサーを設け、
ブームの水平からの角度を検出できる角度センサ
ーを設けると共に、張出し体にはアウトリガーか
ら車体までに距離を検出する位置センサーを設
け、前記測長センサーと角度センサーからの検出
信号を取り込み、これを予め設定しておいた転倒
危険範囲データーとつき合わせ、転倒危険範囲に
あると判定されたときには、位置センサーによる
車体の位置を判別して上記油圧作動機構を駆動制
御し、車体を張出し体の長さ方向に従つて転倒危
険方向とは反対方向に移動制御できると共に、車
体の移動に対応して俯角シリンダーと伸縮用シリ
ンダーを駆動してブームの角度及び長さを補正す
ることにより、車体が移動してもブームの先端を
同一の位置にあるように制御する油圧制御装置を
設けたことを特徴とする高所作業車の転倒防止機
構。
[Scope of Claims] 1. A swivel base that is rotatably provided on the vehicle body, and a boom that is pivotally supported by the swivel base and that can be telescopically operated using a depression angle cylinder and a telescopic cylinder.
The above-mentioned aerial work vehicle consists of a bucket that is pivotally attached to the tip of the boom, and overhangs that can be extended and contracted in the horizontal direction are provided on both the left and right sides of the vehicle body, and outriggers that lift the vehicle body are provided at the tips of these overhangs, and the overhang The body is equipped with a hydraulic mechanism that can move the lifted vehicle horizontally to the side, and the boom is equipped with a length sensor that can measure the length of the boom.
An angle sensor that can detect the angle of the boom from the horizontal is provided, and a position sensor that detects the distance from the outrigger to the vehicle body is provided on the overhanging body, and the detection signals from the length measurement sensor and angle sensor are captured and When it is determined that the vehicle is in the fall danger range by comparing it with the set fall risk range data, the position sensor determines the position of the vehicle body and drives and controls the above-mentioned hydraulic actuating mechanism to extend the vehicle body to the length of the body. The vehicle body can be controlled to move in the direction opposite to the direction in which the vehicle is at risk of overturning, and the angle and length of the boom can be corrected by driving the depression angle cylinder and telescoping cylinder in response to the vehicle body movement. A fall prevention mechanism for an aerial work vehicle, characterized in that it is equipped with a hydraulic control device that controls the tip of the boom so that it remains in the same position even when the boom is in the same position.
JP25030685A 1985-11-08 1985-11-08 Reversing preventive mechanism of height service car Granted JPS62111899A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP25030685A JPS62111899A (en) 1985-11-08 1985-11-08 Reversing preventive mechanism of height service car

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP25030685A JPS62111899A (en) 1985-11-08 1985-11-08 Reversing preventive mechanism of height service car

Publications (2)

Publication Number Publication Date
JPS62111899A JPS62111899A (en) 1987-05-22
JPH0224759B2 true JPH0224759B2 (en) 1990-05-30

Family

ID=17205941

Family Applications (1)

Application Number Title Priority Date Filing Date
JP25030685A Granted JPS62111899A (en) 1985-11-08 1985-11-08 Reversing preventive mechanism of height service car

Country Status (1)

Country Link
JP (1) JPS62111899A (en)

Also Published As

Publication number Publication date
JPS62111899A (en) 1987-05-22

Similar Documents

Publication Publication Date Title
CN106586918B (en) A kind of folding arm high-altitude operation vehicle control method that automatic amplitude limit can be achieved
EP0539207B1 (en) Safety apparatus for construction equipment
EP1038823B1 (en) Safety system for boom-equipped vehicle
JPH07125987A (en) Suspension load/overturning moment detecting device for mobile crane
JPS60188592A (en) Controller of liftable and expansible structure
JPH08119582A (en) Overturning alarm device of working vehicle and overturning preventing method
JPH0224759B2 (en)
US11235961B2 (en) Height adjustment assistance device, crane comprising same, and height adjustment method
JP7189490B2 (en) Auxiliary device for position adjustment and mobile crane
JPH04235895A (en) Control device for lifting long cargo by crane vertically from ground
JPH0224758B2 (en)
JPH11139771A (en) Revolving deceleration control device of crane and controlling method thereof
JPH0618120U (en) Boom work vehicle safety device
JPH0230906B2 (en)
JPS6181395A (en) Safety controller for height service car
JP2528907Y2 (en) Detector abnormality detector used for work equipment
JPH11171477A (en) Automatic horizontal forming device available in vehicle with outrigger
JP4039819B2 (en) Bend-and-lift boom type aerial work platform
JP7122151B2 (en) Safety device for aerial work platform
JP3836288B2 (en) Control equipment for aerial work platforms
JPH0672694A (en) Safety device for work machine
JPH0740699U (en) Working means inspection device
JP3938883B2 (en) Safety equipment for aerial work platforms
JP3428509B2 (en) Aerial work vehicle
JPH0646947Y2 (en) Leveling device