JP3226406B2 - Hydraulic excavator linear excavation control device - Google Patents
Hydraulic excavator linear excavation control deviceInfo
- Publication number
- JP3226406B2 JP3226406B2 JP01078594A JP1078594A JP3226406B2 JP 3226406 B2 JP3226406 B2 JP 3226406B2 JP 01078594 A JP01078594 A JP 01078594A JP 1078594 A JP1078594 A JP 1078594A JP 3226406 B2 JP3226406 B2 JP 3226406B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle body
- bucket
- turning
- angle
- angle sensor
- 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 - Fee Related
Links
Landscapes
- Operation Control Of Excavators (AREA)
Description
【0001】[0001]
【産業上の利用分野】本発明は、油圧ショベルのバケッ
トによる掘削深さをレーザ光を基準として制御して直線
掘削する直線掘削制御装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a linear excavation control apparatus for excavating a straight line by controlling the excavation depth of a bucket of a hydraulic excavator based on a laser beam.
【0002】[0002]
【従来の技術】油圧ショベルのレーザ光を基準とした直
線掘削制御装置としては、例えば特開平3−29593
3号公報に示すものが知られている。つまり、掘削地表
面に設置したレーザ発振器と、油圧ショベルの車体に取
付けたレーザ受光器と、このレーザ受光器によるレーザ
光の受光位置によってバケットの掘削深さを制御するコ
ントローラを備えた油圧ショベルの掘削制御装置が知ら
れている。2. Description of the Related Art As a straight excavation control device based on a laser beam of a hydraulic excavator, for example, Japanese Unexamined Patent Publication No. Hei.
No. 3 is known. That is, a hydraulic excavator including a laser oscillator installed on the surface of an excavation ground, a laser receiver mounted on the body of the excavator, and a controller that controls the excavation depth of the bucket based on a laser light receiving position of the laser receiver. Excavation control devices are known.
【0003】[0003]
【発明が解決しようとする課題】かかるレーザ光を用い
た掘削制御装置はレーザ光によって車体高さを検出し、
その車体高さと設定掘削深さに基づいてバケット先端部
の高さを制御してレーザ光と平行に掘削するので、レー
ザ光が水平に対して傾斜していても車体が旋回せずに走
行しながら掘削する場合には問題がないのが、車体を旋
回して掘削する場合には掘削深さに誤差が生ずる。An excavation control device using such a laser beam detects the height of the vehicle body by the laser beam,
Since the excavation is performed in parallel with the laser beam by controlling the height of the bucket tip based on the vehicle body height and the set excavation depth, the vehicle travels without turning even if the laser beam is inclined with respect to the horizontal. Although there is no problem when excavating while excavating while turning the vehicle body, an error occurs in the excavation depth.
【0004】つまり、レーザ光が水平に対して傾斜して
いる場合に車体を旋回するとバケットも旋回し、バケッ
ト先端部とレーザ光との距離が変化するが、レーザ光に
より検出した車体高さは同一であるから、旋回前と旋回
後のバケット先端部の高さ指令は同一となり、前述のバ
ケット先端部とレーザ光との距離の差だけ掘削深さに誤
差が生じる。[0004] That is, when the vehicle body turns while the laser light is inclined with respect to the horizontal, the bucket also turns, and the distance between the tip of the bucket and the laser light changes. Since they are the same, the height commands at the tip of the bucket before turning and after the turning are the same, and an error occurs in the excavation depth by the difference between the distance between the tip of the bucket and the laser beam.
【0005】そこで、本発明は前述の課題を解決できる
ようにした油圧ショベルの掘削制御装置を提供すること
を目的とする。Accordingly, an object of the present invention is to provide a hydraulic shovel excavation control device which can solve the above-mentioned problems.
【0006】[0006]
【課題を解決するための手段】走行体1に旋回自在に設
けた車体2に設けたレーザ受光器11と、ブーム3の角
度を検出するブーム角度センサ13と、アーム5の角度
を検出するアーム角度センサ14と、バケット7の角度
を検出するバケット角度センサ15と、前記車体2の旋
回角度を検出する旋回角センサ12と、コントローラ2
0を備え、このコントローラ20を、各角度センサの検
出信号によって車体2の基準位置に対するバケット先端
部の高さを演算する機能と、レーザ受光器11のレーザ
受光位置によってレーザ光Aと車体2の相対的な高さ変
位を検出する機能と、旋回角センサ12の車体旋回角度
により車体旋回時のバケット先端部高さ変位量を演算す
る機能と、前記高さ変位と車体旋回時のバケット先端部
高さ変位量に基づいてレーザ光Aを基準として掘削深さ
を常に一定とすべくブーム3、アーム5、バケット7に
動作指令を出力する機能を有するものとした油圧ショベ
ルの直線掘削制御装置。Means for Solving the Problems A laser light receiver 11 provided on a vehicle body 2 rotatably provided on a traveling body 1, a boom angle sensor 13 for detecting an angle of a boom 3, and an arm for detecting an angle of an arm 5 An angle sensor 14, a bucket angle sensor 15 for detecting an angle of the bucket 7, a turning angle sensor 12 for detecting a turning angle of the vehicle body 2, and a controller 2
The controller 20 has a function of calculating the height of the tip of the bucket with respect to the reference position of the vehicle body 2 based on the detection signal of each angle sensor, and the laser light A and the vehicle body 2 A function of detecting a relative height displacement, a function of calculating a height displacement amount of a bucket tip at the time of turning the vehicle body by the turning angle sensor 12, a function of calculating the height displacement and a bucket tip portion at the time of turning the vehicle body, A linear excavation control device for a hydraulic excavator having a function of outputting an operation command to the boom 3, the arm 5, and the bucket 7 so that the excavation depth is always constant based on the laser beam A based on the height displacement amount.
【0007】[0007]
【作 用】車体2を旋回した時にはバケット先端部の
高さが、その旋回角度とレーザ光の水平となす角度に応
じて補正されるから、レーザ光が水平に対して傾斜して
いる場合に車体2を旋回して掘削してもレーザ光を基準
とする掘削深さを同一にできる。[Operation] When the vehicle body 2 is turned, the height of the tip of the bucket is corrected according to the turning angle and the angle between the horizontal and the laser light. Even when the vehicle body 2 is turned and excavated, the excavation depth based on the laser beam can be made the same.
【0008】[0008]
【実 施 例】図1に示すように、走行体1に車体2が
旋回自在に設けられ、この車体2にブーム3をブームシ
リンダ4で上下回動自在に設け、そのブーム3にアーム
5をアームシリンダ6で上下回動自在に設けると共に、
そのアーム5にバケット7をバケットシリンダ8で上下
回動自在に設けて油圧ショベルを構成し、その車体2に
は前後傾斜計9、左右傾斜計10、レーザ光を受光する
レーザ受光器11、車体2の旋回角度を検出する旋回角
センサ12が設けてあると共に、ブーム3の回動支点に
ブーム角度センサ13、アーム5の回動支点にアーム角
度センサ14、バケット7の回動支点にバケット角度セ
ンサ15が設けてあり、掘削地にはレーザ発振器16が
設置され、このレーザ発振器16のレーザ光Aを前記レ
ーザ受光器11で受光するようにしてある。[Embodiment] As shown in FIG. 1, a vehicle 2 is rotatably provided on a traveling body 1, a boom 3 is provided on the vehicle 2 so as to be vertically rotatable by a boom cylinder 4, and an arm 5 is attached to the boom 3. The arm cylinder 6 is provided so as to be vertically rotatable.
A bucket 7 is provided on the arm 5 so as to be vertically rotatable by a bucket cylinder 8 to constitute a hydraulic shovel. The vehicle body 2 has a front and rear inclinometer 9, a left and right inclinometer 10, a laser receiver 11 for receiving laser light, a vehicle body 2, a boom angle sensor 13 at the pivot point of the boom 3, an arm angle sensor 14 at the pivot point of the arm 5, and a bucket angle sensor at the pivot point of the bucket 7. A sensor 15 is provided, and a laser oscillator 16 is provided at the excavation site. The laser light A of the laser oscillator 16 is received by the laser light receiver 11.
【0009】次に制御部の一例を図2に基づいて説明す
る。前記前後傾斜計9、左右傾斜計10、ブーム角度セ
ンサ13、アーム角度センサ14、バケット角度センサ
15の信号は図2に示すようにコントローラ20の演算
回路21における自動掘削制御回路22に入力されて従
来と同様にバケット先端部の高さを車体の所定位置を基
準として演算して制御指令を制御回路23に出力し、そ
の制御回路23よりブーム用、アーム用、バケット用の
電磁比例制御弁24,25,26に制御電流を出力して
ブームシリンダ4、アームシリンダ6、バケットシリン
ダ8を伸縮してバケット先端部の高さを目標掘削深さと
して掘削を行なう。Next, an example of the control unit will be described with reference to FIG. The signals from the front and rear inclinometer 9, the left and right inclinometer 10, the boom angle sensor 13, the arm angle sensor 14, and the bucket angle sensor 15 are input to an automatic excavation control circuit 22 in an arithmetic circuit 21 of a controller 20, as shown in FIG. As in the prior art, the height of the tip of the bucket is calculated based on a predetermined position of the vehicle body, and a control command is output to the control circuit 23. The control circuit 23 outputs an electromagnetic proportional control valve 24 for the boom, arm, and bucket. , 25, 26 to extend and retract the boom cylinder 4, the arm cylinder 6, and the bucket cylinder 8 to perform excavation with the height of the bucket tip as the target excavation depth.
【0010】前記レーザ受光器11はレーザ光Aを受光
することでレーザ光Aに対するレーザ受光器11の変位
を検出し、その信号を前記演算回路21における車体高
さの変位量演算回路27に入力し、前後傾斜計9からの
車体前後傾斜角度及び左右傾斜計10から車体左右傾斜
角度に基づいて車体2の高さ変位量を演算して自動掘削
制御回路22にフィードバックして制御指令を補正して
バケット先端部の高さを補正すると共に、その指令値に
基づく掘削深さを表示部28に表示する。The laser light receiver 11 detects the displacement of the laser light receiver 11 with respect to the laser light A by receiving the laser light A, and inputs the signal to a displacement amount calculation circuit 27 of the vehicle height in the calculation circuit 21. Then, the height displacement amount of the vehicle body 2 is calculated based on the vehicle body front-rear inclination angle from the front-rear inclinometer 9 and the vehicle left-right inclination angle from the left-right inclinometer 10 and is fed back to the automatic excavation control circuit 22 to correct the control command. And corrects the height of the bucket tip, and displays the excavation depth on the display unit 28 based on the command value.
【0011】以上の様に掘削制御することで掘削深さが
レーザ光Aを基準として常に同一深さとなるから、レー
ザ光Aと平行に掘削できるが、図3と図4に実線で示す
ように車体2がレーザ光Aと平行となった姿勢より走行
体1を停止して仮想線で示すように車体2を旋回すると
バケット7も旋回し、バケット先端部7aとレーザ光A
との距離がLだけ変化する。これに対してレーザ受光器
11のレーザ受光位置は変位しないからバケット先端部
高さ指令が変化せず、レーザ光Aに対する掘削深さが前
記Lだけ異なって誤差となる。By performing the excavation control as described above, the excavation depth is always the same with respect to the laser light A, so that the excavation can be performed in parallel with the laser light A. As shown in FIGS. When the traveling body 1 is stopped from the posture in which the vehicle body 2 is parallel to the laser beam A and the vehicle body 2 is pivoted as indicated by a virtual line, the bucket 7 also pivots, and the bucket tip 7a and the laser beam A
Is changed by L. On the other hand, since the laser receiving position of the laser receiver 11 is not displaced, the height command of the bucket tip does not change, and the excavation depth for the laser beam A differs by the L, resulting in an error.
【0012】そこで、図2に示すようにコントローラ2
0の演算回路21にバケット先端部高さ変位量演算回路
29を設け、旋回角度センサ12で検出した演算角度に
基づいてバケット先端部高さ変位量を演算し、その値を
自動掘削制御回路22にフィードバックして制御指令を
補正し、バケット先端部高さを補正する。Therefore, as shown in FIG.
0, a bucket tip height displacement calculating circuit 29 is provided in the arithmetic circuit 21 for calculating the bucket tip height displacement based on the calculated angle detected by the turning angle sensor 12, and the calculated value is used as an automatic excavation control circuit 22. To correct the control command to correct the height of the bucket tip.
【0013】つまり、バケット先端部の高さ変位量、つ
まり図3における誤差LはL=tanα×L1 となる。
但し、αはレーザ光Aの水平となす角度、L1 は旋回し
た時の車体前後方向に対するバケット移動距離である。
前記レーザ光Aの水平となす角度αはあらかじめ設定入
力され、バケット移動距離L1 はL1 =L2 (cosθ
×L2 )となる。但し、L2 は旋回中心2aからバケッ
ト先端部までの長さであり、ブーム長さ、アーム長さ、
バケット長さと各角度によりブーム、アーム、バケット
の実際の長さを演算し、その値にブーム枢着点から旋回
中心2aまでの距離を加算することで求められ、θは車
体2の旋回角度であり、旋回角度センサ11の車体旋回
前の検出値と車体旋回後の検出値の差により検出され
る。[0013] That is, the height displacement of the bucket tip, i.e. the error L in FIG. 3 becomes L = tan [alpha × L 1.
However, alpha is the angle formed by the horizontal laser beam A, L 1 is a bucket moving distance with respect to the longitudinal direction of the vehicle body when turning.
The angle α between the laser beam A and the horizontal is set and input in advance, and the bucket moving distance L 1 is L 1 = L 2 (cos θ).
× L 2 ). However, L 2 is the length from the turn center 2a to the bucket tip, the boom length, arm length,
The actual length of the boom, arm, and bucket is calculated from the bucket length and each angle, and the distance is calculated by adding the distance from the boom pivot point to the turning center 2a. Θ is the turning angle of the vehicle body 2. Yes, it is detected by the difference between the detected value of the turning angle sensor 11 before the turning of the vehicle body and the detection value after the turning of the vehicle body.
【0014】このようにして演算したバケット先端部の
高さ変位量を旋回前のバケット先端部高さの値に加算し
て車体2が旋回した時のバケット先端部高さとする。こ
れにより、車体2を旋回してもレーザ光Aからの掘削深
さを同一にできる。The height displacement of the bucket tip calculated in this way is added to the value of the bucket tip height before turning to obtain the bucket tip height when the vehicle body 2 turns. Thereby, even if the vehicle body 2 is turned, the excavation depth from the laser beam A can be made the same.
【0015】[0015]
【発明の効果】車体2を旋回した時にはバケット先端部
の高さが、その旋回角度とレーザ光の水平となす角度に
応じて補正されるから、レーザ光が水平に対して傾斜し
ている場合に車体2を旋回して掘削してもレーザ光を基
準とする掘削深さを同一にできる。When the vehicle body 2 is turned, the height of the tip of the bucket is corrected according to the turning angle and the angle between the horizontal and the laser light. Even when the vehicle body 2 is turned and excavated, the excavation depth based on the laser beam can be made the same.
【図1】本発明の実施例を示す全体説明図である。FIG. 1 is an overall explanatory diagram showing an embodiment of the present invention.
【図2】制御回路の説明図である。FIG. 2 is an explanatory diagram of a control circuit.
【図3】掘削動作の説明正面図である。FIG. 3 is an explanatory front view of an excavation operation.
【図4】掘削動作の説明平面図である。FIG. 4 is an explanatory plan view of an excavation operation.
1…走行体、2…車体、3…ブーム、5…アーム、7…
バケット、11…レーザ受光器、12…旋回角度セン
サ、13…ブーム角度センサ、14…アーム角度セン
サ、15…バケット角度センサ、20…コントローラ。DESCRIPTION OF SYMBOLS 1 ... Running body, 2 ... Body, 3 ... Boom, 5 ... Arm, 7 ...
Bucket, 11 laser receiver, 12 turning angle sensor, 13 boom angle sensor, 14 arm angle sensor, 15 bucket angle sensor, 20 controller.
Claims (2)
けたレーザ受光器11と、ブーム3の角度を検出するブ
ーム角度センサ13と、アーム5の角度を検出するアー
ム角度センサ14と、バケット7の角度を検出するバケ
ット角度センサ15と、前記車体2の旋回角度を検出す
る旋回角センサ12と、コントローラ20を備え、 このコントローラ20を、各角度センサの検出信号によ
って車体2の基準位置に対するバケット先端部の高さを
演算する機能と、レーザ受光器11のレーザ受光位置に
よってレーザ光Aと車体2の相対的な高さ変位を検出す
る機能と、旋回角センサ12の車体旋回角度により車体
旋回時のバケット先端部高さ変位量を演算する機能と、
前記高さ変位と車体旋回時のバケット先端部高さ変位量
に基づいてレーザ光Aを基準として掘削深さを常に一定
とすべくブーム3、アーム5、バケット7に動作指令を
出力する機能を有するものとした油圧ショベルの直線掘
削制御装置。1. A laser receiver 11 provided on a vehicle body 2 rotatably provided on a traveling body 1, a boom angle sensor 13 for detecting an angle of a boom 3, and an arm angle sensor 14 for detecting an angle of an arm 5. A bucket angle sensor 15 for detecting an angle of the bucket 7, a turning angle sensor 12 for detecting a turning angle of the vehicle body 2, and a controller 20. The controller 20 is used as a reference for the vehicle body 2 based on a detection signal of each angle sensor. A function for calculating the height of the tip of the bucket with respect to the position, a function for detecting a relative height displacement between the laser beam A and the vehicle body 2 based on the laser receiving position of the laser light receiver 11, and a vehicle turning angle of the turning angle sensor 12. A function of calculating the amount of height displacement of the tip of the bucket during turning of the vehicle body,
A function of outputting an operation command to the boom 3, the arm 5, and the bucket 7 so that the excavation depth is always constant based on the laser beam A based on the height displacement and the amount of height displacement of the tip of the bucket during turning of the vehicle body. A linear excavation control device for a hydraulic excavator.
と車体旋回後の旋回角センサ12の検出値より車体旋回
角度を演算し、この車体旋回角度とレーザ光の水平とな
す角度に基づいて車体旋回時のバケット先端部高さ変位
量を演算するようにした請求項1記載の油圧ショベルの
直線掘削制御装置。2. A body turning angle is calculated from a detected value of the turning angle sensor 12 before turning of the vehicle body and a detected value of the turning angle sensor 12 after turning of the vehicle body, and based on the angle between the body turning angle and the horizontal angle of the laser beam. 2. The linear excavation control device for a hydraulic shovel according to claim 1, wherein the amount of height displacement of the tip of the bucket during the turning of the vehicle body is calculated.
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP01078594A JP3226406B2 (en) | 1994-02-02 | 1994-02-02 | Hydraulic excavator linear excavation control device |
KR1019960702803A KR100202203B1 (en) | 1993-11-30 | 1994-11-30 | Linear excavation control apparatus for a hydraulic power shovel |
EP95902281A EP0731221A4 (en) | 1993-11-30 | 1994-11-30 | Linear excavating control device for a hydraulic power shovel |
US08/648,107 US5713144A (en) | 1993-11-30 | 1994-11-30 | Linear excavation control apparatus for a hydraulic power shovel |
PCT/JP1994/002017 WO1995015420A1 (en) | 1993-11-30 | 1994-11-30 | Linear excavating control device for a hydraulic power shovel |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP01078594A JP3226406B2 (en) | 1994-02-02 | 1994-02-02 | Hydraulic excavator linear excavation control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH07216929A JPH07216929A (en) | 1995-08-15 |
JP3226406B2 true JP3226406B2 (en) | 2001-11-05 |
Family
ID=11759997
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP01078594A Expired - Fee Related JP3226406B2 (en) | 1993-11-30 | 1994-02-02 | Hydraulic excavator linear excavation control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3226406B2 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113720967A (en) * | 2021-07-28 | 2021-11-30 | 中国人民解放军63653部队 | Sand autonomous collection method based on angle discretization |
CN114164806A (en) * | 2021-12-24 | 2022-03-11 | 青海大学 | Depth-adjustable ditch opener for slag hill drainage ditch in mining area and working method of ditch opener |
-
1994
- 1994-02-02 JP JP01078594A patent/JP3226406B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH07216929A (en) | 1995-08-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102488448B1 (en) | shovel | |
KR100202203B1 (en) | Linear excavation control apparatus for a hydraulic power shovel | |
US6389345B2 (en) | Method and apparatus for determining a cross slope of a surface | |
JP6259170B2 (en) | Work machine control device and work machine | |
JP6450008B2 (en) | Work machine control device and work machine | |
CN106460363B (en) | Control system, the control method of Work machine and Work machine of Work machine | |
WO2021106938A1 (en) | Working machine control system, working machine, and working machine control method | |
WO2019181189A1 (en) | Display system of turning work vehicle | |
WO1998010147A1 (en) | Construction machine with laser measuring instrument | |
JP3226406B2 (en) | Hydraulic excavator linear excavation control device | |
JPH0152560B2 (en) | ||
JPH0525994A (en) | Automatic controller for prelining machine | |
JP3669947B2 (en) | Rolling control device for work equipment | |
JPH0657782A (en) | Automatic blade controlling device for bulldozer | |
JPH07216930A (en) | Linear excavation control device for hydraulic shovel | |
JP3351487B2 (en) | Excavation depth control device for hydraulic excavator | |
JP7229109B2 (en) | Work machine and work machine control method | |
JP3389303B2 (en) | Linear excavation control device of hydraulic excavator | |
WO2024171607A1 (en) | Work machine | |
JPH0617589B2 (en) | Excavator control equipment | |
JP2869807B2 (en) | Working machine operating device for articulated construction machinery | |
JPH0258411B2 (en) | ||
CN114787455B (en) | Work machine control system, work machine, and work machine control method | |
JP3765461B2 (en) | Construction machine work equipment controller | |
JPH02232430A (en) | Controller for depth of excavation of hydraulic shovel |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20070831 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080831 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080831 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090831 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090831 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100831 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100831 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110831 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110831 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120831 Year of fee payment: 11 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120831 Year of fee payment: 11 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130831 Year of fee payment: 12 |
|
LAPS | Cancellation because of no payment of annual fees |