JPH08246493A - Digging range-presetting apparatus for control of restricted range to be digged by construction machine - Google Patents

Digging range-presetting apparatus for control of restricted range to be digged by construction machine

Info

Publication number
JPH08246493A
JPH08246493A JP7052787A JP5278795A JPH08246493A JP H08246493 A JPH08246493 A JP H08246493A JP 7052787 A JP7052787 A JP 7052787A JP 5278795 A JP5278795 A JP 5278795A JP H08246493 A JPH08246493 A JP H08246493A
Authority
JP
Japan
Prior art keywords
reference light
setting
excavation
area
vehicle body
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.)
Granted
Application number
JP7052787A
Other languages
Japanese (ja)
Other versions
JP3497910B2 (en
Inventor
Hiroshi Watanabe
洋 渡邊
Toichi Hirata
東一 平田
Masakazu Haga
正和 羽賀
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.)
Hitachi Construction Machinery Co Ltd
Original Assignee
Hitachi Construction Machinery 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 Hitachi Construction Machinery Co Ltd filed Critical Hitachi Construction Machinery Co Ltd
Priority to JP05278795A priority Critical patent/JP3497910B2/en
Publication of JPH08246493A publication Critical patent/JPH08246493A/en
Application granted granted Critical
Publication of JP3497910B2 publication Critical patent/JP3497910B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool

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)
  • Component Parts Of Construction Machinery (AREA)

Abstract

PURPOSE: To dig as near a digging range preset as possible, by a method wherein presetting of the digging range is not changed even if the height of a construction machine body is changed by the movement of the body, and errors such as manufacturing tolerance for the body, sensor accuracy, setting tolerance and so an do not give influence on the digging range preset, in a digging range-presetting apparatus for a construction machine. CONSTITUTION: A reference light generators 80, 81 respectively emitting light 1, 2 are placed on the outside of a hydraulic power shovel, and a depth from the level of the reference light 1 to a reference point of a digging range is preset using an operating instrument. After that, in digging-work, a height from the center of a hydraulic power shovel body to the level of the reference light 1 is operated on the basis of the information about the position and posture of a front attachment 1A at the time when a reference light detector 70 detects the reference light 1, and a depth from the center of the body to the level of the reference point of the digging range is operated on the basis of that height operated and the depth preset. In the same manner, a distance from the center of the body at the time when a base light detector 71 detects the reference light 2 to the reference light 2 (a base point P) is operated, following which the depth, which is operated, from the center of the body to the level of the reference point, the distance from the center of the body to the level of the reference light 2, and an angle between them are stored.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は建設機械の領域制限掘削
制御に係わり、特に、多関節型のフロント装置を備えた
油圧ショベル等の建設機械において、フロント装置の動
き得る領域を制限した領域制限掘削制御の掘削領域設定
装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to area limiting excavation control of a construction machine, and more particularly, in a construction machine such as a hydraulic excavator having a multi-joint type front apparatus, area limitation in which a movable area of the front apparatus is limited. The present invention relates to an excavation area setting device for excavation control.

【0002】[0002]

【従来の技術】建設機械の代表例として油圧ショベルが
ある。油圧ショベルは垂直方向にそれぞれ回動可能なブ
ーム、アーム及びバケットからなるフロント装置と、上
部旋回体及び下部走行体からなる車体とで構成され、フ
ロント装置のブームの基端は上部旋回体の前部に支持さ
れている。このような油圧ショベルはフロント装置の動
作範囲が広いことを特徴とする建設機械であり、そのこ
とが便利である半面、特定の掘削形状よりフロントが突
出しては困る作業などに使われる場合にはオペレータに
慎重な操作を要求することになる。このため例えば特開
平4−136324号公報に示されるようにフロント装
置の作業範囲の制限を行うことが考えられている。この
特開平4−136324号公報には、制限領域(侵入不
可領域)の設定方法として、フロント装置の先端(バケ
ットの爪先)を制限領域(侵入不可領域)に動かし、そ
の位置を記憶するか、あるいは操作パネルから制限領域
を数値で入力設定する方法が示されている。
2. Description of the Related Art A hydraulic excavator is a typical example of construction machines. The hydraulic excavator is composed of a front device consisting of a boom, an arm, and a bucket that are vertically rotatable, and a vehicle body consisting of an upper revolving structure and a lower traveling structure, and the base end of the boom of the front device is in front of the upper revolving structure. Supported by the department. Such a hydraulic excavator is a construction machine that is characterized by a wide operating range of the front device.On the other hand, it is convenient, but when it is used for work where the front does not protrude beyond a specific excavation shape, It requires careful operation from the operator. For this reason, it is considered to limit the working range of the front device as disclosed in, for example, Japanese Patent Laid-Open No. 4-136324. In Japanese Patent Application Laid-Open No. 4-136324, as a method of setting a restricted area (inaccessible area), the tip of the front device (toe of a bucket) is moved to the restricted area (inaccessible area) and the position is stored. Alternatively, a method of inputting and setting the restricted area with a numerical value from the operation panel is shown.

【0003】また、油圧ショベルではブームなどのフロ
ント部材をそれぞれの手動操作レバーによって操作して
いるが、それぞれが関節部によって連結され回動運動を
行うものであるため、これらフロント部材を操作して所
定の領域、特に直線状に設定された領域を掘削すること
は非常に困難な作業であり、自動化が望まれている。そ
のような作業を自動化して行う構成とした場合、車体が
移動すると作業現場の地形の変化で油圧ショベル自身の
姿勢、高さが変化し、車体に関して設定していた領域を
車体が移動するごとに設定し直さなくてはならない。そ
こで、このような作業を容易にするための自動掘削方法
が特開平3−295933号公報に提案されている。こ
の自動掘削方法では、掘削地表面に設置したレーザ発振
器のレーザ光により車体に設置したセンサにて車体の高
さを検出し、その検出した車体高さに基づいて掘削深さ
(前者の例の制限領域に相当する)を決定して車体を停
止した状態で所定長さだけ直線掘削し、その後に車体を
所定距離走行させて停止状態で再び直線掘削する際に前
記レーザ光により車体高さ変位量を検出し、その高さ変
位量によって掘削深さを補正するようにしている。
Further, in hydraulic excavators, front members such as a boom are operated by respective manual operation levers. However, since each of them is connected by a joint portion to perform a rotary motion, these front members are operated. Excavation of a predetermined area, especially a linearly set area is a very difficult task, and automation is desired. When such a work is configured to be automated, when the vehicle body moves, the posture and height of the hydraulic excavator itself change due to changes in the terrain at the work site, and every time the vehicle body moves within the area set for the vehicle body. Must be reset to. Therefore, Japanese Patent Laid-Open No. 3-295933 proposes an automatic excavation method for facilitating such work. In this automatic excavation method, the height of the vehicle body is detected by the sensor installed on the vehicle body by the laser light of the laser oscillator installed on the surface of the excavation ground, and the excavation depth (of the former example is detected based on the detected vehicle body height. (Equivalent to the restricted area) is determined and linear excavation is performed for a predetermined length with the vehicle stopped, and then the vehicle height is displaced by the laser light when the vehicle travels a predetermined distance and recedes again with the vehicle stopped. The amount of displacement is detected and the excavation depth is corrected by the amount of height displacement.

【0004】[0004]

【発明が解決しようとする課題】しかしながら、上記従
来技術には次のような問題がある。
However, the above-mentioned prior art has the following problems.

【0005】まず、特開平4−136324号公報に記
載の従来技術では、車体を基準として制限領域(侵入不
可領域)を設定するので、車体が移動し作業現場の地形
の変化で油圧ショベル自身の姿勢、高さが変化すると、
それに応じて制限領域の設定深さが変化してしまう。例
えば地面が傾斜していれば、車体の移動とともに設定深
さも地面の傾斜面に沿って変化し、制限領域の設定面も
傾斜してしまう。
First, in the prior art disclosed in Japanese Patent Application Laid-Open No. 4-136324, a restriction area (an inaccessible area) is set on the basis of the vehicle body, so that the vehicle body moves and the excavator itself is changed due to the change of the terrain at the work site. When the posture and height change,
The set depth of the restricted area changes accordingly. For example, if the ground is tilted, the set depth changes along the tilted surface of the ground as the vehicle body moves, and the set surface of the restricted area also tilts.

【0006】また、特開平3−295933号公報に記
載の従来技術では、車体の移動に伴う車体高さの変化の
補正は行えるものの、操作パネルにより掘削深さを設定
する場合、車体を基準に掘削深さを設定するので、掘削
制御でバケットの先端位置を演算するとき、車体の製作
公差、あるいは制御に使用するフロント装置の位置、姿
勢を計測する角度センサの精度、取り付け公差などが誤
差として集積し、実際に掘削した深さが設定した掘削深
さと違ってしまい、設定通りに掘削することができな
い。
Further, in the prior art described in Japanese Patent Laid-Open No. 3-295933, although the change in the vehicle body height due to the movement of the vehicle body can be corrected, when the excavation depth is set by the operation panel, the vehicle body is used as a reference. Since the digging depth is set, when calculating the tip position of the bucket in digging control, the manufacturing tolerance of the vehicle body, the accuracy of the angle sensor that measures the position and posture of the front device used for control, the mounting tolerance, etc. It is impossible to excavate as set because the accumulated and actual excavation depth differs from the set excavation depth.

【0007】また、車体の移動により車体高さが変化す
ると車体からの掘削深さが変化することから、掘削深さ
の変化量に対してもフロント装置の位置、姿勢を計測す
るセンサの誤差が影響し、車体高さが変化する前と後で
は掘削深さが変化してしまう。
Further, since the excavation depth from the vehicle body changes when the vehicle body height changes due to the movement of the vehicle body, the error of the sensor for measuring the position and orientation of the front device also affects the amount of change in the excavation depth. As a result, the excavation depth changes before and after the vehicle body height changes.

【0008】更に、車体高さが変化してもレーザ光が確
実にセンサに当たりレーザ光を検出できるようにするた
めには、車体に多数のセンサを高さ方向に並べて設置す
る必要があり、センサの装備が複雑になる。
Furthermore, in order to ensure that the laser light hits the sensor even if the height of the vehicle body changes and the laser light can be detected, it is necessary to install a number of sensors on the vehicle body side by side in the height direction. Equipment becomes complicated.

【0009】同様に、車体に備えられたセンサにより高
さを補正することから、センサの大きさの制約から補正
できる高さは限られた範囲となる。
Similarly, since the height is corrected by the sensor provided on the vehicle body, the height that can be corrected is limited due to the restriction of the size of the sensor.

【0010】本発明の第1の目的は、車体の移動により
車体高さが変化しても掘削領域の設定が変化することの
ない建設機械の領域制限掘削制御の掘削領域設定装置を
提供することである。
A first object of the present invention is to provide an excavation area setting device for area limited excavation control of a construction machine in which the setting of the excavation area does not change even if the height of the vehicle body changes due to movement of the vehicle body. Is.

【0011】本発明の第2の目的は、車体の製作公差、
あるいは制御に使用するフロント装置の位置、姿勢を計
測するセンサの精度、取り付け公差などの誤差の影響が
少なく、設定した掘削領域との差を少なく掘削すること
ができる建設機械の領域制限掘削制御の掘削領域設定装
置を提供することである。
A second object of the present invention is to provide manufacturing tolerances for the vehicle body,
Alternatively, the accuracy of the sensor that measures the position and orientation of the front device used for control, the influence of errors such as mounting tolerances are small, and it is possible to excavate with a small difference from the set excavation area. A drilling area setting device is provided.

【0012】本発明の第3の目的は、車体の移動により
車体高さが変化しても掘削領域の設定が変化することが
なくかつフロント装置の位置、姿勢を計測するセンサの
誤差の影響による掘削深さの変化の少ない建設機械の領
域制限掘削制御の掘削領域設定装置を提供することであ
る。
A third object of the present invention is that the setting of the excavation area does not change even if the vehicle body height changes due to the movement of the vehicle body, and it is due to the influence of the error of the sensor for measuring the position and orientation of the front device. An object of the present invention is to provide an excavation area setting device for area limited excavation control of a construction machine with little change in excavation depth.

【0013】本発明の第4の目的は、車体の移動を補正
するために光を用いるとき、センサの構成をシンプルに
できる建設機械の領域制限掘削制御の掘削領域設定装置
を提供することである。
A fourth object of the present invention is to provide an excavation area setting device for area limited excavation control of a construction machine, which can simplify the structure of the sensor when light is used to correct the movement of the vehicle body. .

【0014】本発明の第5の目的は、車体の移動を広い
範囲で補正できる建設機械の領域制限掘削制御の掘削領
域設定装置を提供することである。
A fifth object of the present invention is to provide an excavation area setting device for area limited excavation control of a construction machine capable of correcting movement of a vehicle body in a wide range.

【0015】[0015]

【課題を解決するための手段】上記第1〜第5の目的を
達成するために、本発明による建設機械の領域制限掘削
制御装置は次の構成を採用する。すなわち、多関節型の
フロント装置を構成する上下方向に回動可能な複数のフ
ロント部材と、前記フロント装置を支持する車体とを備
え、前記複数のフロント部材をそれぞれ駆動制御してフ
ロント部材の動作範囲を制限制御する建設機械の領域制
限掘削制御の掘削領域設定装置において、(a)前記建
設機械の外部に設置され、掘削領域に対する高さ方向の
基準位置を示す基準光を発生する第1外部基準光発生装
置と;(b)前記建設機械の外部に設置され、掘削領域
に対する水平方向の基準位置を示す基準光を発生する第
2外部基準光発生装置と;(c)前記フロント装置に備
えられ、前記第1外部基準光発生装置の出力した基準光
を検出する第1検出手段と;(d)前記フロント装置に
備えられ、前記第2外部基準光発生装置の出力した基準
光を検出する第2検出手段と;(e)前記フロント装置
の位置と姿勢に関する状態量を検出する第3検出手段
と;(f)前記第3検出手段の信号に基づき前記フロン
ト装置の位置と姿勢を演算する第1演算手段と;(g)
前記第1外部基準光発生装置の発生する基準光と掘削領
域との位置関係を設定する第1設定手段と;(h)前記
第1検出手段が前記第1外部基準光発生装置の発生する
基準光を検出したときに、前記第1演算手段で演算した
前記フロント装置の位置と姿勢の情報に基づき前記車体
の位置変化に関する補正値を演算し、この補正値と前記
第1設定手段で設定した基準光と掘削領域との位置関係
とから前記車体と掘削領域の高さ方向の位置関係を演算
する第2演算手段と;(i)前記第2検出手段が前記第
2外部基準光発生装置の発生する基準光を検出したとき
に、前記第1演算手段で演算した前記フロント装置の位
置と姿勢の情報に基づき前記車体と掘削領域の水平方向
の位置関係を演算する第3演算手段と;(j)前記第2
演算手段で演算した基準光と掘削領域との高さ方向の位
置関係と、前記第3演算手段で演算した前記車体と掘削
領域の水平方向の位置関係と、前記第1設定手段で設定
した基準光と掘削領域との位置関係とから前記車体を基
準とした掘削領域を設定する第2設定手段と;を備える
構成とする。
In order to achieve the above first to fifth objects, the area limiting excavation control system for a construction machine according to the present invention adopts the following configuration. That is, a plurality of front members that constitute an articulated front device and are rotatable in the up-down direction, and a vehicle body that supports the front device are provided, and the plurality of front members are drive-controlled to operate the front members. In an excavation area setting device for area limited excavation control of a construction machine that limits and controls a range, (a) a first external device that is installed outside the construction machine and that generates reference light indicating a reference position in the height direction with respect to the excavation area. A reference light generator; (b) a second external reference light generator which is installed outside the construction machine and which generates reference light indicating a horizontal reference position with respect to the excavation area; and (c) the front device. First detecting means for detecting the reference light output from the first external reference light generating device; (d) output from the second external reference light generating device provided in the front device. Second detection means for detecting quasi-light; (e) third detection means for detecting a state quantity relating to the position and orientation of the front device; (f) position of the front device based on a signal from the third detection means. And a first calculation means for calculating a posture; (g)
First setting means for setting the positional relationship between the reference light generated by the first external reference light generating device and the excavation area; (h) the reference generated by the first external reference light generating device by the first detecting means. When light is detected, a correction value relating to a change in the position of the vehicle body is calculated based on the position and orientation information of the front device calculated by the first calculation means, and this correction value and the first setting means are set. Second computing means for computing the positional relationship in the height direction between the vehicle body and the excavation area based on the positional relationship between the reference light and the excavation area; and (i) the second detection means of the second external reference light generator. Third computing means for computing the horizontal positional relationship between the vehicle body and the excavation area based on the position and orientation information of the front device computed by the first computing means when the generated reference light is detected; j) the second
The positional relationship in the height direction between the reference light calculated by the calculating means and the excavation area, the horizontal positional relationship between the vehicle body and the excavation area calculated by the third calculating means, and the reference set by the first setting means. Second setting means for setting an excavation region based on the vehicle body based on a positional relationship between light and the excavation region;

【0016】好ましくは、前記第1設定手段は、前記第
1外部基準光発生装置の発生する基準光から前記掘削領
域の基準点までの深さと、前記掘削領域の境界の傾斜角
度を設定する手段である。
[0016] Preferably, the first setting means sets a depth from a reference light generated by the first external reference light generator to a reference point of the excavation area and an inclination angle of a boundary of the excavation area. Is.

【0017】また、好ましくは、前記第1設定手段は、
操作器により入力されたデータを基に前記基準光と設定
領域の位置関係を設定する手段である。
Preferably, the first setting means is
It is a means for setting the positional relationship between the reference light and the setting area based on the data input by the operation device.

【0018】前記第1設定手段は、前記フロント装置を
動かしフロント装置の先端が設定領域の基準点に来たと
き、前記第1演算手段で演算した前記フロント装置の位
置と姿勢の情報に基づき前記フロント装置の先端の位置
を演算する手段と、前記フロント装置を動かし前記第1
検出手段が前記第1外部基準光発生装置の発生する基準
光を検出したとき、前記第1演算手段で演算した前記フ
ロント装置の位置と姿勢の情報に基づき前記第1検出手
段の位置を演算する手段と、前記フロント装置の先端位
置と前記第1検出手段の位置とから前記基準光と設定領
域の位置関係を演算し、記憶する手段とを含む構成とし
てもよい。
The first setting means, when the front device is moved and the front end of the front device reaches a reference point of the setting area, the first setting means is based on the position and orientation information of the front device calculated by the first calculating means. A means for calculating the position of the tip of the front device, and the first device for moving the front device.
When the detection means detects the reference light generated by the first external reference light generation device, the position of the first detection means is calculated based on the information on the position and orientation of the front device calculated by the first calculation means. Means, and a means for calculating and storing the positional relationship between the reference light and the set area from the tip position of the front device and the position of the first detection means.

【0019】[0019]

【作用】以上のように構成した本発明においては、第1
及び第2検出手段が基準光を横切るごとに、第2演算手
段にて第1設定手段で設定した基準光と掘削領域の位置
関係を補正して車体と掘削領域の高さ方向の位置関係を
演算するとともに、第3演算手段で車体と掘削領域の水
平方向の位置関係を演算し、第2設定手段で車体を基準
とした掘削領域を設定するため、車体の移動による高さ
変化を毎回補正して掘削作業が行える。このため、車体
が移動し車体高さが変化しても掘削領域の設定は変化せ
ず、常に基準光を基準とした所定の深さ及び位置を掘削
することができる。
In the present invention constructed as above, the first
Every time the second detecting means crosses the reference light, the second calculating means corrects the positional relationship between the reference light and the excavation area set by the first setting means to determine the positional relationship between the vehicle body and the excavating area in the height direction. In addition to the calculation, the third calculation means calculates the horizontal positional relationship between the vehicle body and the excavation area, and the second setting means sets the excavation area with respect to the vehicle body. Therefore, the height change due to the movement of the vehicle body is corrected every time. Then excavation work can be performed. Therefore, even if the vehicle body moves and the vehicle body height changes, the setting of the excavation area does not change, and it is possible to always excavate a predetermined depth and position based on the reference light.

【0020】また、第1及び第2検出手段を実際に地面
に作用するフロント装置に設置し、これらの検出手段が
基準光を検出したときのフロント装置の位置と姿勢に基
づき車体を基準とした掘削領域を設定するので、この掘
削領域の設定に際して掘削領域設定演算と掘削制御演算
とで車体の製作公差や第1〜第3検出手段等の精度、取
付け公差などの誤差の影響が相殺されることとなる。こ
のため、掘削制御でフロント装置の位置を演算すると
き、基準光を車体に設置したセンサで検出する方法に比
較してそれらの誤差の影響が少なくなり、設定した掘削
領域との差を少なく設定通りに正確に掘削することがで
きる。
Further, the first and second detecting means are installed in a front device that actually acts on the ground, and the vehicle body is used as a reference based on the position and orientation of the front device when these detecting means detect the reference light. Since the excavation area is set, the influence of errors such as the manufacturing tolerance of the vehicle body, the accuracy of the first to third detection means and the like, the mounting tolerance and the like is offset by the excavation area setting calculation and the excavation control calculation when setting the excavation area. It will be. For this reason, when calculating the position of the front device in excavation control, the influence of these errors is reduced compared to the method of detecting the reference light by the sensor installed on the vehicle body, and the difference from the set excavation area is set to be small. Can be drilled exactly on the street.

【0021】また、フロント装置の位置、姿勢を計測す
る第1検出手段の誤差の影響を受け難いので、車体が移
動して車体高さが変化することにより車体からの掘削深
さが変化しても、その掘削深さの変化量に対する第1検
出手段の誤差の影響が少なくなり、車体高さが変化する
前と後で掘削深さが変化することが防止される。
Further, since it is hard to be influenced by the error of the first detecting means for measuring the position and posture of the front device, the excavation depth from the vehicle body changes due to the movement of the vehicle body to change the vehicle body height. However, the influence of the error of the first detection means on the amount of change in the excavation depth is reduced, and the excavation depth is prevented from changing before and after the vehicle body height changes.

【0022】更に、第1及び第2検出手段をフロント装
置に設置し、フロント装置を操作している最中に第1及
び第2検出手段が基準光を横切ることでそれぞれ基準光
を検出するので、第1及び第2検出手段(センサ)の設
置面積が小さくても確実に基準光を捕らえることがで
き、第1及び第2検出手段をそれぞれ小型でシンプルな
構成にできる。
Further, since the first and second detecting means are installed in the front device and the first and second detecting means cross the reference light while operating the front device, the reference light is detected respectively. The reference light can be reliably captured even if the installation area of the first and second detection means (sensors) is small, and the first and second detection means can be made small and simple respectively.

【0023】同様に、フロント装置を操作している最中
に第1検出手段が基準光を横切ることで基準光を検出す
るので、フロント装置の広い可動範囲を考えれば車体の
移動を広い範囲で補正できる。
Similarly, since the first detecting means detects the reference light by traversing the reference light while the front device is being operated, the movement of the vehicle body in a wide range is possible in consideration of the wide movable range of the front device. Can be corrected.

【0024】また、本発明においては、第1設定手段に
て第1外部基準光発生装置の発生する基準光から掘削領
域と基準点までの深さ、掘削領域の境界の傾斜角度を設
定することにより、勾配を付けた掘削領域を設定でき
る。
Further, in the present invention, the depth from the reference light generated by the first external reference light generator to the excavation area and the reference point and the inclination angle of the boundary of the excavation area are set by the first setting means. By this, it is possible to set an excavation area with a slope.

【0025】更に、本発明においては、第1設定手段
を、操作器により入力されたデータを基に基準光と設定
領域の位置関係を設定する手段とすることにより、作業
の初めに第1設定手段の設定を行っておけば、作業開始
時、あるいは車体を走行して移動するごとにフロント装
置を掘削領域の境界に位置決めするための補助員が不要
となる。また、補助員の指示による設定にかかる時間を
無くすことができ、作業時間を短縮できる。
Further, in the present invention, the first setting means is means for setting the positional relationship between the reference light and the setting area based on the data input by the operating device, so that the first setting is performed at the beginning of the work. By setting the means, it is not necessary to have an assistant for positioning the front device at the boundary of the excavation area at the start of work or each time the vehicle travels and moves. Further, the time required for setting by the instruction of the assistant can be eliminated, and the working time can be shortened.

【0026】また、本発明においては、第1設定手段
を、フロント装置の先端が設定領域の境界に来たときに
演算したフロント装置の先端の位置と、第1検出手段が
外部基準光発生装置の発生する基準光を検出したときに
演算した第1検出手段の位置とから基準光と設定領域の
位置関係を演算し、記憶する構成とすることにより、ダ
イレクトティーチングにより掘削領域を設定でき、作業
状況に合わせて所望の掘削領域を正確に設定することが
できる。
Further, in the present invention, the position of the front end of the front device calculated by the first setting means when the front end of the front device comes to the boundary of the setting area, and the first detecting means is the external reference light generating device. By calculating the positional relationship between the reference light and the setting area from the position of the first detecting means calculated when the reference light generated by the above is detected and stored, the excavation area can be set by direct teaching. The desired excavation area can be set accurately according to the situation.

【0027】[0027]

【実施例】本発明を第1実施例を図1〜図10により説
明する。図1において、本発明が適用される油圧ショベ
ルは、油圧ポンプ2と、この油圧ポンプ2からの圧油に
より駆動されるブームシリンダ3a、アームシリンダ3
b、バケットシリンダ3c、旋回モータ3d及び左右の
走行モータ3e,3fを含む複数の油圧アクチュエータ
と、これら油圧アクチュエータ3a〜3fのそれぞれに
対応して設けられた複数の操作レバー装置4a〜4f
と、油圧ポンプ2と複数の油圧アクチュエータ3a〜3
f間に接続され、油圧アクチュエータ3a〜3fに供給
される圧油の流量を制御する複数の流量制御弁5a〜5
fと、油圧ポンプ2と流量制御弁5a〜5fの間の圧力
が設定値以上になった場合に開くリリーフ弁6とを有
し、これらは油圧ショベルの被駆動部材を駆動する油圧
駆動装置を構成している。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS A first embodiment of the present invention will be described with reference to FIGS. 1, a hydraulic excavator to which the present invention is applied includes a hydraulic pump 2, a boom cylinder 3a and an arm cylinder 3 which are driven by pressure oil from the hydraulic pump 2.
b, a plurality of hydraulic actuators including a bucket cylinder 3c, a swing motor 3d, and left and right traveling motors 3e and 3f, and a plurality of operating lever devices 4a to 4f provided corresponding to the hydraulic actuators 3a to 3f, respectively.
And the hydraulic pump 2 and the plurality of hydraulic actuators 3a to 3
A plurality of flow rate control valves 5a to 5 which are connected between f and control the flow rate of the pressure oil supplied to the hydraulic actuators 3a to 3f.
f, and a relief valve 6 that opens when the pressure between the hydraulic pump 2 and the flow control valves 5a to 5f exceeds a set value, and these are hydraulic drive devices that drive the driven members of the hydraulic excavator. I am configuring.

【0028】また、油圧ショベルは、図2に示すよう
に、垂直方向にそれぞれ回動するブーム1a、アーム1
b及びバケット1cからなる多関節型のフロント装置1
Aと、上部旋回体1d及び下部走行体1eからなる車体
1Bとで構成され、フロント装置1Aのブーム1aの基
端は上部旋回体1dの前部に支持されている。ブーム1
a、アーム1b、バケット1c、上部旋回体1d及び下
部走行体1eはそれぞれブームシリンダ3a、アームシ
リンダ3b、バケットシリンダ3c、旋回モータ3d及
び左右の走行モータ3e,3fによりそれぞれ駆動され
る被駆動部材を構成し、それらの動作は上記操作レバー
装置4a〜4fにより指示される。
Further, as shown in FIG. 2, the hydraulic excavator includes a boom 1a and an arm 1 which rotate vertically.
articulated front device 1 including b and bucket 1c
A and a vehicle body 1B including an upper swing body 1d and a lower traveling body 1e, and a base end of a boom 1a of the front device 1A is supported by a front portion of the upper swing body 1d. Boom 1
a, an arm 1b, a bucket 1c, an upper swing body 1d, and a lower traveling body 1e are driven members respectively driven by a boom cylinder 3a, an arm cylinder 3b, a bucket cylinder 3c, a swing motor 3d, and left and right traveling motors 3e, 3f. And their operations are instructed by the operation lever devices 4a to 4f.

【0029】図1に戻り、操作レバー装置4a〜4fは
パイロット圧により対応する流量制御弁5a〜5fを駆
動する油圧パイロット方式であり、それぞれ、オペレー
タにより操作される操作レバー40と、操作レバー40
の操作量と操作方向に応じたパイロット圧を生成する1
対の減圧弁(図示せず)とより構成され、各減圧弁の一
次ポートはパイロットポンプ43に接続され、二次ポー
トはパイロットライン44a,44b;45a,45
b;46a,46b;47a,47b;48a,48
b;49a,49bを介して対応する流量制御弁の油圧
駆動部50a,50b;51a,51b;52a,52
b;53a,53b;54a,54b;55a,55b
に接続されている。
Returning to FIG. 1, the operating lever devices 4a to 4f are hydraulic pilot systems that drive the corresponding flow control valves 5a to 5f by pilot pressure, and the operating lever 40 and the operating lever 40 are operated by an operator, respectively.
1 Generates pilot pressure according to the operation amount and operation direction
It is composed of a pair of pressure reducing valves (not shown), the primary port of each pressure reducing valve is connected to the pilot pump 43, and the secondary ports are pilot lines 44a, 44b; 45a, 45.
b; 46a, 46b; 47a, 47b; 48a, 48
b; hydraulic drive units 50a, 50b; 51a, 51b; 52a, 52 of the corresponding flow control valves via 49a, 49b.
b; 53a, 53b; 54a, 54b; 55a, 55b
It is connected to the.

【0030】以上のような油圧ショベルに本実施例によ
る掘削領域設定装置を含む領域制限掘削制御装置が搭載
されている。この制御装置は、予め作業に応じてフロン
ト装置の所定部位、例えばバケット1cの先端が動き得
る掘削領域の設定を指示する設定器7と、ブーム1a、
アーム1b及びバケット1cのそれぞれの回動支点に設
けられ、フロント装置1Aの位置と姿勢に関する状態量
としてそれぞれの回動角を検出する角度計8a,8b,
8cと、車体1Bの前後方向の傾斜角θを検出する傾斜
計8dと、ブーム用及びアーム用の操作レバー装置4
a,4bのパイロットライン44a,44b;45a,
45bに設けられ、操作レバー装置4a,4bからのパ
イロット圧を検出する圧力検出器60a,60b;61
a,61bと、油圧ショベルの外部に設置され掘削領域
に対する高さ方向の基準位置を示す基準光としてレーザ
光を発生する基準光発生器80(図2参照)と、油圧シ
ョベルの外部に設置され掘削領域に対する水平方向の基
準位置を示す基準光としてレーザ光を発生する基準光発
生器81(図2参照)と、フロント装置1aのアーム1
bに取り付けられ、基準光発生器80の出力した基準光
を検出する基準光検出器70と、フロント装置1aのア
ーム1bに取り付けられ、基準光発生器81の出力した
基準光を検出する基準光検出器71と、設定器7の設定
信号、角度計8a,8b,8c及び傾斜計8dの検出信
号、圧力検出器60a,60b;61a,61bの検出
信号、及び基準光検出器70,71の検出信号を入力
し、バケット1cの先端が動き得る掘削領域を設定する
と共に、領域を制限した掘削制御を行うための電気信号
を出力する制御ユニット9と、前記電気信号により駆動
される比例電磁弁10a,10b,11a,11bと、
シャトル弁12とで構成されている。シャトル弁12は
パイロットライン44aに設置され、パイロットライン
44a内のパイロット圧と比例電磁弁10aから出力さ
れる制御圧の高圧側を選択し、流量制御弁5aの油圧駆
動部50aに導く。比例電磁弁10b,11a,11b
はそれぞれパイロットライン44b,45a,45bに
設置され、それぞれの電気信号に応じてパイロットライ
ン内のパイロット圧を減圧して出力する。
An area limiting excavation control device including the excavation area setting device according to this embodiment is mounted on the hydraulic excavator as described above. This control device has a boom 1a, a setting device 7 for instructing setting of a predetermined portion of the front device, for example, an excavation region in which the tip of the bucket 1c can move in advance according to work.
Angle meters 8a, 8b, which are provided on the respective pivots of the arm 1b and the bucket 1c, and which detect the respective pivot angles as state quantities related to the position and posture of the front device 1A,
8c, an inclinometer 8d for detecting an inclination angle θ in the front-rear direction of the vehicle body 1B, and a boom and arm operation lever device 4
a, 4b pilot lines 44a, 44b; 45a,
Pressure detectors 60a, 60b; 61 provided on 45b for detecting pilot pressures from the operating lever devices 4a, 4b;
a and 61b, a reference light generator 80 (see FIG. 2) that is installed outside the hydraulic excavator and generates laser light as reference light indicating a reference position in the height direction with respect to the excavation area, and is installed outside the hydraulic excavator. A reference light generator 81 (see FIG. 2) that generates laser light as reference light indicating a horizontal reference position with respect to the excavation region, and the arm 1 of the front device 1a.
The reference light detector 70 attached to the reference light detector b for detecting the reference light output from the reference light generator 80, and the reference light attached to the arm 1b of the front device 1a for detecting the reference light output from the reference light generator 81. The detector 71, the setting signal of the setting device 7, the detection signals of the angle meters 8a, 8b, 8c and the inclinometer 8d, the pressure detectors 60a, 60b; the detection signals of 61a, 61b, and the reference light detectors 70, 71. A control unit 9 that inputs a detection signal, sets an excavation region in which the tip of the bucket 1c can move, and outputs an electric signal for performing excavation control with the region limited, and a proportional solenoid valve driven by the electric signal. 10a, 10b, 11a, 11b,
It is composed of a shuttle valve 12. The shuttle valve 12 is installed in the pilot line 44a, selects the pilot pressure in the pilot line 44a and the high pressure side of the control pressure output from the proportional solenoid valve 10a, and guides it to the hydraulic drive unit 50a of the flow rate control valve 5a. Proportional solenoid valves 10b, 11a, 11b
Are installed in the pilot lines 44b, 45a, 45b, respectively, and reduce the pilot pressure in the pilot lines in accordance with the respective electric signals and output.

【0031】以上の構成において、本実施例の掘削領域
設定装置は、設定器7、基準光発生器80,81、基準
光検出器70,71、角度計8a,8b,8c及び傾斜
計8dと、制御ユニット9の下記する機能により構成さ
れている。
In the above structure, the excavation area setting device of this embodiment includes a setting device 7, reference light generators 80 and 81, reference light detectors 70 and 71, angle meters 8a, 8b and 8c, and an inclinometer 8d. The control unit 9 has the following functions.

【0032】設定器7は、図3に示すように、掘削領域
の深さ、角度を入力するためのアップボタン7a及びダ
ウンボタン7b、深さ、角度のいずれを入力するかを選
択する選択ボタン7c,7d、入力した深さ、角度を表
示する表示装置7e及び入力した深さ、角度を設定信号
として制御ユニット9に出力し設定する領域設定スイッ
チ7fとで構成されている。なお、設定器7のボタン類
は適当な操作レバーのグリップ上に設けてもよい。ま
た、ICカードによる方法、バーコードによる方法、無
線通信による方法等、他の方法を用いてもよい。
The setting device 7, as shown in FIG. 3, is an up button 7a and a down button 7b for inputting the depth and angle of the excavation area, and a selection button for selecting which of depth and angle is to be input. 7c and 7d, a display device 7e that displays the input depth and angle, and an area setting switch 7f that outputs and sets the input depth and angle as setting signals to the control unit 9. The buttons of the setting device 7 may be provided on the grip of an appropriate operating lever. Further, other methods such as a method using an IC card, a method using a bar code, and a method using wireless communication may be used.

【0033】基準光発生器80は高さ方向の基準となる
基準光を発生するもので、図2に示すように掘削領域に
対して水平な方向にレーザ光を出すように地面に設置さ
れる。基準光発生器81は前後方向(水平方向)の基準
となる基準光を発生するもので、図2に示すように掘削
領域に対して垂直な方向にレーザ光を出すように地面に
設置される。基準光発生器80の発するレーザ光(基準
光)は一条のスポット光でもよいし、図示のように扇形
あるいは円形の光でもよい。基準光発生器81の発する
レーザ光(基準光)は図示のように扇形あるいは円形の
光がよく、特に、油圧ショベルから掘削領域の基準点ま
での距離を設定する位置で油圧ショベルの高さ方向に光
を広げるものがよい。
The reference light generator 80 generates reference light which serves as a reference in the height direction, and is installed on the ground so as to emit laser light in a direction horizontal to the excavation area as shown in FIG. . The reference light generator 81 generates reference light that serves as a reference in the front-rear direction (horizontal direction), and is installed on the ground so as to emit laser light in a direction perpendicular to the excavation area as shown in FIG. . The laser light (reference light) emitted from the reference light generator 80 may be a single spot light, or may be a fan-shaped light or a circular light as illustrated. The laser light (reference light) emitted from the reference light generator 81 is preferably fan-shaped or circular light as shown in the drawing. Particularly, at the position where the distance from the hydraulic excavator to the reference point of the excavation area is set, the height direction of the hydraulic excavator is set. It is better to spread the light to.

【0034】基準光検出器70は油圧ショベルのアーム
1bの背部に取り付けられ、基準光検出器71は油圧シ
ョベルのアーム1bの側部に取り付けられ、それぞれフ
ロント装置1Aを操作している最中に基準光発生器8
0,81の発生する基準光を検出し、アーム1bが基準
光を横切る瞬間を捕らえる構成としてある。基準光検出
器70,71はともに作業に支障ない程度にできるだけ
アーム1bの先端近くに設置され、実際に土に作用する
バケット1cの先端の近いところで基準光を検出する。
The reference light detector 70 is attached to the back of the arm 1b of the hydraulic excavator, and the reference light detector 71 is attached to the side of the arm 1b of the hydraulic excavator, while operating the front device 1A. Reference light generator 8
The reference light generated by 0, 81 is detected, and the moment when the arm 1b crosses the reference light is captured. The reference light detectors 70 and 71 are both installed as close as possible to the tip of the arm 1b so as not to interfere with the work, and detect the reference light near the tip of the bucket 1c that actually acts on the soil.

【0035】制御ユニット9は、上記の設定器7の設定
信号と、基準光検出器70,71、角度計8a,8b,
8c及び傾斜計8dの検出信号を用いて掘削領域を設定
する。この制御ユニット9による掘削領域設定方法を図
4及び図5を用いて説明する。なお、掘削領域は掘削領
域と制限領域の境界(以下、単に掘削領域の境界とい
う)を設定することにより設定され、本実施例はこの掘
削領域の境界として勾配を持つ斜面を設定するものであ
る。
The control unit 9 controls the setting signal of the setting device 7, the reference light detectors 70 and 71, the angle meters 8a and 8b, and
The excavation area is set using the detection signals of 8c and the inclinometer 8d. A method of setting the excavation area by the control unit 9 will be described with reference to FIGS. 4 and 5. The excavation area is set by setting a boundary between the excavation area and the restricted area (hereinafter, simply referred to as a boundary of the excavation area), and this embodiment sets a slope having a slope as the boundary of the excavation area. .

【0036】掘削領域の設定に際しては、まず、図4に
示すように、油圧ショベル本体の外部に基準光1が水平
な方向に出るように基準光発生器80を設定する。ま
た、図5に示すように、設定したい掘削領域の境界上に
位置する基準点P(図4参照;以下、単に掘削領域の基
準点Pという)の延長上に基準光が垂直な方向に出るよ
うに基準光発生器81を設置する。
In setting the excavation area, first, as shown in FIG. 4, the reference light generator 80 is set so that the reference light 1 is emitted in the horizontal direction outside the hydraulic excavator body. Further, as shown in FIG. 5, the reference light is emitted in the vertical direction on the extension of the reference point P (see FIG. 4; hereinafter simply referred to as the reference point P of the excavation area) located on the boundary of the excavation area to be set. Thus, the reference light generator 81 is installed.

【0037】次に、操作器7を用いて、基準光発生器8
0の発生する基準光1から設定したい掘削領域の上記基
準点Pまでの深さhrと、掘削領域の境界の傾斜角度θ
rを入力し、この深さhrと角度θrとにより基準光発
生器80の発生する基準光と掘削領域の位置関係を設定
する。すなわち、基準光を基準とした掘削領域を設定す
る。この設定はオペレータにより行われる。
Next, using the operating unit 7, the reference light generator 8
The depth hr from the reference light 1 generated from 0 to the reference point P of the excavation area to be set, and the inclination angle θ of the boundary of the excavation area
By inputting r, the positional relationship between the reference light generated by the reference light generator 80 and the excavation area is set by the depth hr and the angle θr. That is, the excavation area is set based on the reference light. This setting is performed by the operator.

【0038】次に、掘削作業に移行する。掘削作業にお
いては、角度計8a,8b,8c及び傾斜計8dの信号
に基づき制御ユニット9内でフロント装置1Aの位置と
姿勢が演算されており、フロント装置1Aのアーム1b
が基準光発生器80の発生する基準光1を横切った瞬間
を基準光検出器70にて捕らえ、基準光検出器70が基
準光1を検出した時のフロント装置1Aの位置と姿勢の
情報に基づき車体中心Oから基準光までの高さhfを演
算する。そして、この高さhfを補正値として、先に設
定した深さhrから車体中心Oに対する掘削領域の基準
点Pの深さhsを演算する。すなわち、油圧ショベルの
車体1Bを基準とした掘削領域の基準点Pの深さを演算
する。
Next, the excavation work is started. In excavation work, the position and orientation of the front device 1A is calculated in the control unit 9 based on the signals of the angle meters 8a, 8b, 8c and the inclinometer 8d, and the arm 1b of the front device 1A is calculated.
The reference light detector 70 captures the moment when the reference light 1 generated by the reference light generator 80 is crossed, and the information on the position and attitude of the front device 1A when the reference light detector 70 detects the reference light 1 is obtained. Based on this, the height hf from the vehicle body center O to the reference light is calculated. Then, using this height hf as a correction value, the depth hs of the reference point P of the excavation area with respect to the vehicle body center O is calculated from the previously set depth hr. That is, the depth of the reference point P in the excavation area with respect to the vehicle body 1B of the hydraulic excavator is calculated.

【0039】また同様に、図5に示すように、フロント
装置1Aのアーム1bが基準光発生器81の発生する基
準光2を横切った瞬間を基準光検出器71にて捕らえ、
基準光検出器71が基準光2を検出した時のフロント装
置1Aの位置と姿勢の情報に基づき車体中心Oから基準
光2(基準点P)までの距離hrxを演算する。
Similarly, as shown in FIG. 5, the reference light detector 71 captures the moment when the arm 1b of the front device 1A crosses the reference light 2 generated by the reference light generator 81.
The distance hrx from the vehicle body center O to the reference light 2 (reference point P) is calculated based on the information on the position and orientation of the front device 1A when the reference light detector 71 detects the reference light 2.

【0040】上記のようにして求めた掘削領域の基準点
Pの深さhs及び距離hrxと、設定器7を用いて設定
した角度θrとにより車体1Bを基準とした掘削領域を
設定する。
The depth hs and distance hrx of the reference point P of the excavation area obtained as described above and the angle θr set by the setting device 7 are used to set the excavation area with the vehicle body 1B as a reference.

【0041】以上は、アーム1bがそれぞれの基準光
1,2を横切るごとに行われ、油圧ショベルが走行して
位置を変えてもその場所で新たな掘削領域の設定が行わ
れる。
The above operation is performed every time the arm 1b crosses the reference lights 1 and 2, and even if the hydraulic excavator travels and changes its position, a new excavation area is set at that location.

【0042】制御ユニット9は以上の処理を行うもので
あり、それを要約して示すと図6のようである。図6に
おいて、制御ユニット9は第1設定手段100、第1演
算手段120、第2演算手段140、第3演算手段、第
2設定手段160の各機能を有している。第1設定手段
100は、設定器7により入力した掘削領域の基準点P
の深さhr、角度θrにより基準光1と掘削領域の位置
関係を設定する。第1演算手段120は、角度計8a,
8b,8c及び傾斜計8dの信号に基づきフロント装置
1Aの位置と姿勢を演算する。第2演算手段140は、
基準光検出器70が基準光1を検出した時のフロント装
置1Aの位置と姿勢の情報に基づき車体中心Oから基準
光1までの高さhfを補正値として演算し、この補正値
と第1設定手段100で設定した基準光1と掘削領域と
の位置関係とから車体中心Oから掘削領域の基準点Pま
での深さhsを演算する。第3演算手段150は、基準
光検出器71が基準光2を検出した時のフロント装置1
Aの位置と姿勢の情報に基づき車体中心Oから基準光2
(基準点P)までの距離hrxを演算する。第2設定手
段160は、第2演算手段で求めた基準点Pの深さhs
と、第3演算手段で求めた基準点Pまでの距離hrx
と、先に設定した基準点Pの角度θrとにより車体を基
準とした掘削領域を設定する。この車体1Bを基準とし
た掘削領域の設定が終了するとブロック180に示すよ
うに領域制限掘削制御に移行する。
The control unit 9 performs the above-mentioned processing, which is summarized in FIG. In FIG. 6, the control unit 9 has each function of the first setting means 100, the first calculating means 120, the second calculating means 140, the third calculating means, and the second setting means 160. The first setting means 100 is a reference point P of the excavation area input by the setting device 7.
The positional relationship between the reference light 1 and the excavation area is set by the depth hr and the angle θr. The first calculation means 120 includes a goniometer 8a,
The position and orientation of the front device 1A are calculated based on the signals from 8b and 8c and the inclinometer 8d. The second calculation means 140 is
The height hf from the vehicle body center O to the reference light 1 is calculated as a correction value based on the information on the position and orientation of the front device 1A when the reference light detector 70 detects the reference light 1, and the correction value and the first value are calculated. The depth hs from the vehicle body center O to the reference point P of the excavation area is calculated from the positional relationship between the reference light 1 set by the setting means 100 and the excavation area. The third calculation means 150 is used for the front device 1 when the reference light detector 71 detects the reference light 2.
Reference light 2 from the center O of the vehicle body based on the position and orientation information of A
The distance hrx to the (reference point P) is calculated. The second setting means 160 determines the depth hs of the reference point P obtained by the second calculating means.
And the distance hrx to the reference point P obtained by the third calculating means.
And the previously set angle θr of the reference point P, the excavation area with respect to the vehicle body is set. When the setting of the excavation area based on the vehicle body 1B is completed, the area limited excavation control is performed as shown in block 180.

【0043】上記第1設定手段100における基準光1
と掘削領域との位置関係を設定する機能の詳細を図7に
処理フローで示す。図中、破線で囲んだ部分は油圧ショ
ベルのオペレータが行わなくてはならない操作を示す。
Reference light 1 in the first setting means 100
The details of the function of setting the positional relationship between the excavation area and the excavation area are shown in the processing flow in FIG. In the figure, the part surrounded by the broken line shows the operation that the operator of the hydraulic excavator must perform.

【0044】まず、オペレータは地表から設定したい掘
削領域の基準点Pまでの深さhdと境界の傾斜角度θr
とを設計施工図面等により決め、それらの深さと角度を
設定器7のボタン7a〜7dを用いて入力し、表示装置
7eで確認した後、領域設定スイッチ7fを押す。制御
ユニット9では、処理101にて領域設定スイッチ7f
が押されたかどうかを判定し、押されていない場合は処
理101を続行し、押されると処理102へ移る。処理
102では、基準光1から設定したい掘削領域の基準点
Pまでの深さhrを次の(1)式で演算する。
First, the operator determines the depth hd from the ground surface to the reference point P of the excavation area to be set and the inclination angle θr of the boundary.
Are determined by the design and construction drawing, etc., the depths and angles thereof are input using the buttons 7a to 7d of the setting device 7, and after being confirmed on the display device 7e, the area setting switch 7f is pressed. In the control unit 9, in the process 101, the area setting switch 7f
It is determined whether or not has been pressed. If not, processing 101 is continued, and if it has been pressed, processing 102 is entered. In process 102, the depth hr from the reference light 1 to the reference point P of the excavation area to be set is calculated by the following equation (1).

【0045】 hr=hd+ho …(1) 上記(1)式において、hoは基準光発生器80の高さ
(地表から基準光1までの高さ)であり、この値hoは
既知であり、予め制御ユニット9に記憶しておく。そし
て、処理103に移り、深さhrと先に入力した角度θ
rを記憶する。なお、基準光発生器80の高さhoをオ
ペレータが覚えておき、この高さhoを含めた高さhr
を設定器7を用いてオペレータが直接入力してもよい。
また、設定器7に基準光発生器80の高さhoを入力す
るためのボタンを設け、オペレータの操作でこの高さh
oの設定を変えれるようにしてもよい。
Hr = hd + ho (1) In the equation (1), ho is the height of the reference light generator 80 (height from the ground surface to the reference light 1), and this value ho is known and It is stored in the control unit 9. Then, the process moves to step 103, and the depth hr and the previously inputted angle θ
Remember r. The operator remembers the height ho of the reference light generator 80, and the height hr including this height ho
The operator may directly input using the setting device 7.
Further, the setting device 7 is provided with a button for inputting the height ho of the reference light generator 80, and the height h can be operated by the operator.
The setting of o may be changed.

【0046】第2演算手段140、第3演算手段150
及び第2設定手段160における車体を基準とした掘削
領域を設定する機能の詳細を図8に処理フローで示す。
Second calculating means 140, third calculating means 150
The details of the function of setting the excavation area based on the vehicle body in the second setting means 160 are shown in the processing flow in FIG.

【0047】オペレータが操作レバー40(図1参照)
を操作してフロント装置1Aを動かすとき、まず、処理
141において基準光検出器70が基準光1を横切った
かどうかを判定する。横切っていない場合は、処理15
1に移り、基準光検出器71が基準光2を横切ったかど
うかを判定する。ここでも横切っていない場合は、掘削
領域の設定を変えずに次の領域制限掘削制御の処理へ飛
ぶ。処理141において基準光検出器70が基準光1を
横切ったと判定されると処理142へ行く。
The operator operates the operation lever 40 (see FIG. 1).
When operating the front device 1A by operating, the process 141 first determines whether or not the reference light detector 70 has crossed the reference light 1. If not, process 15
1 to determine whether the reference light detector 71 has crossed the reference light 2. If it does not traverse again, the process is skipped to the next region limited excavation control process without changing the excavation region setting. When it is determined in the process 141 that the reference light detector 70 has crossed the reference light 1, the process goes to a process 142.

【0048】処理142ではフロント装置1Aに備えら
れた角度計8a,8b及び傾斜計8dによりブーム1
a、アーム1bの角度α,β及び車体1Bの傾斜角θを
読み込む。次に処理143においてブーム、アームの角
度α,β及び傾斜角θを用いて基準光1を検出したとき
の車体中心Oから基準光検出器70までの高さhfを演
算する。
In process 142, the boom 1 is moved by the angle meters 8a and 8b and the inclinometer 8d provided on the front device 1A.
a, the angles α and β of the arm 1b, and the inclination angle θ of the vehicle body 1B are read. Next, in processing 143, the height hf from the vehicle body center O to the reference light detector 70 when the reference light 1 is detected using the boom and arm angles α and β and the tilt angle θ is calculated.

【0049】演算はまず次の(2)式により車体中心O
からブームとアームの接合点(アーム角度計8bの設置
点)の高さhbを求める。
First, the calculation is performed by the following equation (2):
Then, the height hb of the joint point between the boom and the arm (the installation point of the arm angle meter 8b) is obtained.

【0050】 hb=L1×cos(α−θ) …(2) 上記(2)式においてL1はブーム1aと車体1Bの接
合点(ブーム角度計8aの設置点)とブームとアームの
接合点との距離であり、この値は既知であり、予め制御
ユニット9に記憶しておく。
Hb = L1 × cos (α−θ) (2) In the above equation (2), L1 is the junction between the boom 1a and the vehicle body 1B (the installation point of the boom angle meter 8a), and the junction between the boom and the arm. Is a known distance and is stored in the control unit 9 in advance.

【0051】次にブームとアームの接合点から基準光検
出器70までの高さhflを(3)式により求める。
Next, the height hfl from the joining point of the boom and the arm to the reference light detector 70 is obtained by the equation (3).

【0052】 hfl=Lf×cos((α−θ)+(β−θf))…(3) 上記(3)式においてLfはブームとアームの接合点か
ら基準光検出器70の設置点までの距離であり、θfは
ブームとアームの接合点とアームとバケットの接合点
(バケット角度計8cの設置点)とを結ぶ直線に対する
基準光検出器70の取り付け角度であり、これらの値は
それぞれ既知であり、予め制御ユニット9に記憶してお
く。
Hfl = Lf × cos ((α−θ) + (β−θf)) (3) In the above equation (3), Lf is from the joint point of the boom and the arm to the installation point of the reference photodetector 70. Θf is a distance, and θf is a mounting angle of the reference photodetector 70 with respect to a straight line connecting a joint point between the boom and the arm and a joint point between the arm and the bucket (installation point of the bucket angle meter 8c), and these values are known. And is stored in the control unit 9 in advance.

【0053】次に高さhbとhflから式(4)により
車体中心Oから基準光検出器70までの高さhfを演算
する。
Next, the height hf from the center O of the vehicle body to the reference photodetector 70 is calculated from the heights hb and hfl by the equation (4).

【0054】 hf=hb+hfl …(4) 次は、処理144に移り、設定器7で設定した基準光1
から掘削領域の基準点Pまでの深さhrを読み込む。
Hf = hb + hfl (4) Next, the process moves to the process 144, and the reference light 1 set by the setter 7 is set.
To the reference point P of the excavation area is read.

【0055】次に、処理145において、先程演算した
車体中心Oから基準光検出器70までの高さhfを補正
値として、この値hfと設定器7で設定した基準光1か
ら掘削領域の基準点Pまでの深さhrとから、式(5)
により車体中心Oから掘削領域の基準点Pまでの深さh
sを演算する。
Next, in processing 145, the height hf from the vehicle body center O to the reference light detector 70 calculated above is used as a correction value, and this value hf and the reference light 1 set by the setting device 7 are used as the reference for the excavation area. From the depth hr to the point P, equation (5)
Depth h from the body center O to the reference point P in the excavation area
Calculate s.

【0056】 hs=hr+hf …(5) 一方、処理151において基準光検出器71が基準光2
を横切ったと判定されると処理152へ行く。
Hs = hr + hf (5) On the other hand, in process 151, the reference light detector 71 causes the reference light 2
If it is determined that the vehicle has crossed, the process goes to processing 152.

【0057】処理152ではフロント装置1Aに備えら
れた角度計8a,8b及び傾斜計8dによりブーム1
a、アーム1bの角度α,β及び車体1Bの傾斜角θを
読み込む。次に処理153においてブーム、アームの角
度α,β及び傾斜角θを用いて基準光1を検出したとき
の車体中心Oから基準光2(基準点P)までの距離hr
xを演算する。
In process 152, the boom 1 is moved by the angle meters 8a and 8b and the inclinometer 8d provided in the front device 1A.
a, the angles α and β of the arm 1b, and the inclination angle θ of the vehicle body 1B are read. Next, in processing 153, the distance hr from the vehicle body center O to the reference light 2 (reference point P) when the reference light 1 is detected using the boom and arm angles α and β and the tilt angle θ.
Calculate x.

【0058】最後に、処理161において処理145で
演算した掘削領域の基準点Pの深さhsと、処理152
で演算した基準点Pまでの距離hrxと、設定器7を用
いて設定した角度θrを記憶し、車体を基準とした掘削
領域を設定する。
Finally, in step 161, the depth hs of the reference point P of the excavation area calculated in step 145 and step 152
The distance hrx to the reference point P calculated in step 1 and the angle θr set using the setter 7 are stored, and the excavation area is set with the vehicle body as a reference.

【0059】以上において、処理141〜145は図6
に示す第2演算手段140に相当し、処理151〜15
3が図6に示す第3演算手段150に相当し、処理16
1が図6に示す第2設定手段160に相当する。
In the above, the processes 141 to 145 are shown in FIG.
Corresponding to the second calculation means 140 shown in FIG.
3 corresponds to the third calculation means 150 shown in FIG.
1 corresponds to the second setting means 160 shown in FIG.

【0060】以上を終了すると、次の領域制限掘削制御
の演算へ処理が移る。
When the above is completed, the process proceeds to the next area limiting excavation control calculation.

【0061】次に、上記の掘削領域設定機能を含む制御
ユニット9の全体制御機能を図9により説明する。図9
において、制御ユニット9は、第1掘削領域設定部9
a、フロント姿勢演算部9b、目標シリンダ速度演算部
9c、目標先端速度ベクトル演算部9d、方向変換制御
部9e、補正後目標シリンダ速度演算部9f、復元制御
演算部9g、補正後目標シリンダ速度演算部9h、目標
シリンダ速度選択部9i、目標パイロット圧演算部9
j、バルブ指令演算部9k、第1位置関係演算部9m、
第2位置関係演算部9p及び第2掘削領域設定部9nの
各機能を有している。
Next, the overall control function of the control unit 9 including the above-mentioned excavation area setting function will be described with reference to FIG. Figure 9
In the control unit 9, the first excavation area setting unit 9
a, front attitude calculation unit 9b, target cylinder speed calculation unit 9c, target tip speed vector calculation unit 9d, direction conversion control unit 9e, corrected target cylinder speed calculation unit 9f, restoration control calculation unit 9g, corrected target cylinder speed calculation Section 9h, target cylinder speed selection section 9i, target pilot pressure calculation section 9
j, valve command calculation unit 9k, first positional relationship calculation unit 9m,
It has the respective functions of the second positional relationship calculation unit 9p and the second excavation area setting unit 9n.

【0062】第1掘削領域設定部9aは図6の第1設定
手段100に相当するもので、図7に示す処理フローの
処理101〜103により基準光から掘削領域の基準点
Pまでの深さhrと角度θrにより基準光と掘削領域と
の位置関係を設定する。
The first excavation area setting unit 9a corresponds to the first setting means 100 of FIG. 6, and the depth from the reference light to the reference point P of the excavation area is set by the processing 101 to 103 of the processing flow shown in FIG. The positional relationship between the reference light and the excavation area is set by the hr and the angle θr.

【0063】フロント姿勢演算部9bは図5の第1演算
手段120に相当するもので、制御ユニット9に記憶し
たフロント装置1A及び車体1Bの各部寸法と、角度計
8a,8b,8cで検出した回動角α、β、γ及び傾斜
計で検出した傾斜角θを用いて設定及び制御に必要なフ
ロント装置1Aの位置及び姿勢を演算する。
The front attitude calculating section 9b corresponds to the first calculating means 120 in FIG. 5, and it is detected by the angle meters 8a, 8b, 8c and the respective dimensions of the front device 1A and the vehicle body 1B stored in the control unit 9. The position and orientation of the front device 1A necessary for setting and control are calculated using the rotation angles α, β, γ and the tilt angle θ detected by the inclinometer.

【0064】第1位置関係演算部9mは図6の第2演算
手段140に相当するもので、図7に示す処理フローの
処理141〜145により車体中心Oから掘削領域の基
準点Pまでの深さhsを演算する。
The first positional relationship calculating section 9m corresponds to the second calculating means 140 in FIG. 6, and the depth from the vehicle body center O to the reference point P in the excavation area is set by the processing 141 to 145 in the processing flow shown in FIG. Calculate hs.

【0065】第2位置関係演算部9pは図6の第3演算
手段150に相当するもので、図7に示す処理フローの
処理151〜153により車体中心Oから基準光2(基
準点P)までの距離hrxを演算する。
The second positional relationship calculating section 9p corresponds to the third calculating means 150 in FIG. 6, and from the vehicle body center O to the reference light 2 (reference point P) by the processing 151 to 153 of the processing flow shown in FIG. The distance hrx is calculated.

【0066】第2掘削領域設定部9nは図6の第2設定
手段160に相当するもので、図7に示す処理フローの
処理161により上記の深さhs及び距離hrxと、第
1掘削領域設定部9aに設定した角度θrとにより油圧
ショベルの車体1Bを基準とした掘削領域を設定する。
The second excavation area setting unit 9n corresponds to the second setting means 160 in FIG. 6, and the depth hs and distance hrx and the first excavation area setting in step 161 of the processing flow shown in FIG. The excavation area is set based on the vehicle body 1B of the hydraulic excavator by the angle θr set in the portion 9a.

【0067】フロント姿勢演算部9bにおいて、フロン
ト装置1Aの位置と姿勢はブーム1aの回動支点を原点
としたXY座標系で演算される。このXY座標系は本体
1Bに固定した直交座標系であり、垂直面内にあるもの
とする。例えば、フロント装置1Aのバケット1cの先
端位置は、ブーム1aの回動支点とアーム1bの回動支
点との距離をL1、アーム1bの回動支点とバケット1
cの回動支点との距離をL2、バケット1cの回動支点
とバケット1cの先端との距離をL3とすれば、XY座
標系により下記の式より求まる。
In the front posture calculation unit 9b, the position and posture of the front device 1A are calculated in the XY coordinate system with the pivot of the boom 1a as the origin. This XY coordinate system is an orthogonal coordinate system fixed to the main body 1B and is assumed to be in a vertical plane. For example, at the tip position of the bucket 1c of the front device 1A, the distance between the rotation fulcrum of the boom 1a and the arm 1b is L 1 , and the rotation fulcrum of the arm 1b and the bucket 1c.
If the distance between the rotation fulcrum of c and L 2 and the distance between the rotation fulcrum of the bucket 1c and the tip of the bucket 1c are L 3 , they can be obtained from the following formula using the XY coordinate system.

【0068】 X=L1sinα+L2sin(α+β)+L3sin(α+β+γ) Y=L1cosα+L2cos(α+β)+L3cos(α+β+γ) ただし、図4に示すように車体1Bが傾いたときは、バ
ケットと先端と地面との相対位置関係が変化するので、
掘削領域の設定が正しく行えなくなる。そこで本実施例
では、車体1Bの傾斜角θを傾斜計8dで検出し、フロ
ント姿勢演算部9bでその傾斜角θの値を入力し、XY
座標系を角度θ回転させたXbYb座標系でバケット先
端の位置を計算している。これにより、車体1Bが傾い
ていても正しい領域設定が行える。なお、車体が傾いた
ときには車体の傾きを修正してから作業するとか、車体
が傾斜しないような作業現場で用いる場合には、必ずし
も傾斜計は必要としない。
X = L 1 sin α + L 2 sin (α + β) + L 3 sin (α + β + γ) Y = L 1 cos α + L 2 cos (α + β) + L 3 cos (α + β + γ) However, when the vehicle body 1B is tilted as shown in FIG. Since the relative positional relationship between the bucket, the tip and the ground changes,
The excavation area cannot be set correctly. Therefore, in the present embodiment, the inclination angle θ of the vehicle body 1B is detected by the inclinometer 8d, and the value of the inclination angle θ is input to the front posture calculation unit 9b, and XY
The position of the bucket tip is calculated in the XbYb coordinate system in which the coordinate system is rotated by the angle θ. As a result, the correct area setting can be performed even if the vehicle body 1B is tilted. It should be noted that when the vehicle body is tilted, the inclinometer is not always necessary when the work is performed after correcting the vehicle body tilt or when the vehicle body is not tilted.

【0069】第1掘削領域設定部9a、補正値演算部9
m及び第2掘削領域設定部9nでは、深さhr,hs、
高さhf等をXbYb座標系の値に変換して処理する。
First excavation area setting unit 9a, correction value calculation unit 9
m and the second excavation area setting unit 9n, depths hr, hs,
The height hf and the like are converted into values in the XbYb coordinate system for processing.

【0070】目標シリンダ速度演算部9cでは操作レバ
ー装置4a,4bの操作信号として圧力検出器60a,
60b;61a,61bの検出信号を入力する。その操
作信号(パイロット圧)から流量制御弁5a,5bの目
標吐出流量(ブームシリンダ3a及びアームシリンダ3
bの目標速度)を計算する。
In the target cylinder speed calculation unit 9c, the pressure detector 60a, which is an operation signal for the operation lever devices 4a, 4b,
60b: Input the detection signals of 61a and 61b. From the operation signal (pilot pressure), the target discharge flow rate of the flow control valves 5a and 5b (boom cylinder 3a and arm cylinder 3
The target speed of b) is calculated.

【0071】目標先端速度ベクトル演算部9dでは、フ
ロント姿勢演算部9bで求めたバケットの先端位置及び
目標シリンダ速度演算部9cで求めた目標シリンダ速度
と、制御ユニット9に記憶してある先のL1,L2,L3
等の各部寸法とからバケット1cの先端の目標速度ベク
トルVcを求める。このとき、目標速度ベクトルVcは
図4に示すXaYa座標系の値として求める。このXa
Ya座標系は、図4に示す掘削領域の基準点Pに原点を
持ち、掘削領域の境界上にXa軸を持つ直交座標系であ
り、上記の深さhs、距離hrxだけXbYb座標系を
Xb方向及びYb方向に平行移動し、割譲機の角度θr
だけ回転移動することにより容易に求まる。ここで、X
aYa座標系での目標速度ベクトルVcのXa座標成分
Vcxは目標速度ベクトルVcの設定領域の境界に平行
な方向のベクトル成分となり、Ya座標成分Vcyは目
標速度ベクトルVcの設定領域の境界に垂直な方向のベ
クトル成分となる。
In the target tip speed vector calculation unit 9d, the bucket tip position obtained by the front attitude calculation unit 9b, the target cylinder speed obtained by the target cylinder speed calculation unit 9c, and the L value stored in the control unit 9 are stored. 1 , L 2 , L 3
The target velocity vector Vc at the tip of the bucket 1c is obtained from the dimensions of each part such as. At this time, the target velocity vector Vc is obtained as a value in the XaYa coordinate system shown in FIG. This Xa
The Ya coordinate system is an orthogonal coordinate system having an origin at a reference point P of the excavation area shown in FIG. 4 and an Xa axis on the boundary of the excavation area, and the XbYb coordinate system is Xb for the depth hs and the distance hrx. Direction and Yb direction move in parallel
It can be easily obtained by rotating only. Where X
The Xa coordinate component Vcx of the target speed vector Vc in the aYa coordinate system is a vector component in a direction parallel to the boundary of the set area of the target speed vector Vc, and the Ya coordinate component Vcy is perpendicular to the boundary of the set area of the target speed vector Vc. It becomes the vector component of the direction.

【0072】方向変換制御部9eでは、バケット1cの
先端が設定領域内でその境界近傍にあり、目標速度ベク
トルVcが設定領域の境界に接近する方向の成分を持つ
場合、垂直なベクトル成分を設定領域の境界に近づくに
つれて減じるように補正する。換言すれば、垂直方向の
ベクトル成分Vcyにそれよりも小さい設定領域から離
れる方向のベクトル(逆方向ベクトル)を加える。
The direction conversion control unit 9e sets a vertical vector component when the tip of the bucket 1c is in the vicinity of the boundary within the set area and the target velocity vector Vc has a component in the direction of approaching the boundary of the set area. It is corrected so that it decreases as it approaches the boundary of the region. In other words, a vector (reverse direction vector) smaller than the set area is added to the vertical vector component Vcy.

【0073】以上のように目標速度ベクトルVcの垂直
方向のベクトル成分Vcyを補正することにより、距離
Yaが小さくなるにしたがって垂直方向のベクトル成分
Vcyの減少量が大きくなるようベクトル成分Vcyが
減じられ、目標速度ベクトルVcは目標速度ベクトルV
caに補正される。ここで、設定領域の境界から距離Y
a1の範囲は方向変換領域または減速領域と呼ぶことが
できる。
By correcting the vertical vector component Vcy of the target velocity vector Vc as described above, the vector component Vcy is reduced so that the decrease amount of the vertical vector component Vcy increases as the distance Ya decreases. , The target speed vector Vc is the target speed vector V
It is corrected to ca. Here, the distance Y from the boundary of the setting area
The range of a1 can be called a direction change area or a deceleration area.

【0074】バケット1cの先端が上記のような補正後
の目標速度ベクトルVcaの通りに方向変換制御された
ときの軌跡の一例を図10に示す。目標速度ベクトルV
cが斜め下方に一定であるときには、その平行成分Vc
xは一定となり、垂直成分Vcyはバケット1cの先端
が設定領域の境界に近づくにしたがって(距離Yaが小
さくなるにしたがって)小さくなる。補正後の目標速度
ベクトルVcaはその合成であるので、軌跡は図示のご
とく設定領域の境界に近づくにつれて平行となる曲線状
となる。
FIG. 10 shows an example of the locus when the tip of the bucket 1c is subjected to the direction change control in accordance with the corrected target velocity vector Vca as described above. Target speed vector V
When c is constant obliquely downward, its parallel component Vc
x becomes constant, and the vertical component Vcy decreases as the tip of the bucket 1c approaches the boundary of the set region (as the distance Ya decreases). Since the corrected target velocity vector Vca is a combination thereof, the locus becomes a curved line that becomes parallel as it approaches the boundary of the set region as illustrated.

【0075】補正後目標シリンダ速度演算部9fでは、
方向変換制御部9eで求めた補正後の目標速度ベクトル
からブームシリンダ3a及びアームシリンダ3bの目標
シリンダ速度を演算する。これは目標先端速度ベクトル
演算部9dでの演算の逆演算である。
In the corrected target cylinder speed calculating section 9f,
The target cylinder speeds of the boom cylinder 3a and the arm cylinder 3b are calculated from the corrected target speed vector obtained by the direction change control unit 9e. This is an inverse operation of the operation in the target tip speed vector operation unit 9d.

【0076】復元制御部9gでは、バケット1cの先端
が設定領域の外に出たとき、設定領域の境界からの距離
に関係して、バケット先端が設定領域に戻るように目標
速度ベクトルを補正する。換言すれば、垂直方向のベク
トル成分Vcyにそれよりも大きな設定領域に接近する
方向のベクトル(逆方向ベクトル)を加える。このよう
に目標速度ベクトルVcの垂直方向のベクトル成分Vc
yを補正することにより、距離Yaが小さくなるにした
がって垂直方向のベクトル成分Vcyが小さくなるよ
う、目標速度ベクトルVcは目標速度ベクトルVcaに
補正される。
When the tip of the bucket 1c goes out of the set area, the restoration control section 9g corrects the target velocity vector so that the tip of the bucket returns to the set area in relation to the distance from the boundary of the set area. . In other words, a vector (reverse vector) in the direction approaching the set area larger than that is added to the vertical vector component Vcy. Thus, the vertical vector component Vc of the target velocity vector Vc
By correcting y, the target speed vector Vc is corrected to the target speed vector Vca so that the vertical vector component Vcy becomes smaller as the distance Ya becomes smaller.

【0077】バケット1cの先端が上記のような補正後
の目標速度ベクトルVcaの通りに復元制御されたとき
の軌跡の一例を図11に示す。目標速度ベクトルVcが
斜め下方に一定であるときには、その平行成分Vchは
一定となり、また復元ベクトル−KYaは距離Yaに比
例するので垂直成分はバケット1cの先端が設定領域の
境界に近づくにしたがって(距離Yaが小さくなるにし
たがって)小さくなる。補正後の目標速度ベクトルVc
aはその合成であるので、軌跡は図11のように設定領
域の境界に近づくにつれて平行となる曲線状となる。
FIG. 11 shows an example of the locus when the tip of the bucket 1c is restored and controlled according to the corrected target velocity vector Vca as described above. When the target velocity vector Vc is constant obliquely downward, its parallel component Vch is constant, and the restoration vector −KYa is proportional to the distance Ya, so that the vertical component of the vertical component becomes closer to the boundary of the set area ( It decreases as the distance Ya decreases). Corrected target velocity vector Vc
Since a is a combination of the two, the locus becomes a curved line that becomes parallel as it approaches the boundary of the set region, as shown in FIG.

【0078】このように復元制御部9gではバケット1
cの先端が設定領域に戻るように制御されるため、設定
領域外に復元領域が得られることになる。また、この復
元制御でも、バケット1cの先端の設定領域の境界に接
近する方向の動きが減速されることにより、結果として
バケット1cの先端の移動方向が設定領域の境界に沿っ
た方向に変換され、この意味でこの復元制御も方向変換
制御ということができる。
In this way, the restoration controller 9g uses the bucket 1
Since the tip of c is controlled to return to the setting area, a restoration area can be obtained outside the setting area. Also in this restoration control, the movement of the tip of the bucket 1c in the direction approaching the boundary of the setting area is decelerated, and as a result, the moving direction of the tip of the bucket 1c is converted to the direction along the boundary of the setting area. In this sense, this restoration control can also be called direction change control.

【0079】補正後目標シリンダ速度演算部9hでは、
復元制御部9gで求めた補正後の目標速度ベクトルから
ブームシリンダ3a及びアームシリンダ3bの目標シリ
ンダ速度を演算する。これは目標先端速度ベクトル演算
部9dでの演算の逆演算である。
In the corrected target cylinder speed calculator 9h,
The target cylinder speeds of the boom cylinder 3a and the arm cylinder 3b are calculated from the corrected target speed vector obtained by the restoration control unit 9g. This is an inverse operation of the operation in the target tip speed vector operation unit 9d.

【0080】ここで、復元制御を行う場合は、その復元
制御に必要なブームシリンダ及びアームシリンダの動作
方向を選択し、その動作方向における目標シリンダ速度
を演算する。ただし、復元制御ではブーム1aを上げる
ことでバケット先端を設定領域に戻すため、ブーム1の
上げ方向が必ず含まれる。その組み合わせも制御ソフト
で決まる。
Here, when the restoration control is performed, the operation directions of the boom cylinder and the arm cylinder required for the restoration control are selected, and the target cylinder speed in the operation direction is calculated. However, in the restoration control, since the bucket tip is returned to the set region by raising the boom 1a, the raising direction of the boom 1 is always included. The combination is also determined by the control software.

【0081】目標シリンダ速度選択部9iでは目標シリ
ンダ速度演算部9fで得た方向変換制御による目標シリ
ンダ速度と目標シリンダ速度演算部9hで得た復元制御
による目標シリンダ速度の値の大きい方(最大値)を選
択し、出力用の目標シリンダ速度とする。
In the target cylinder speed selector 9i, the larger of the target cylinder speed by the direction change control obtained by the target cylinder speed calculator 9f and the target cylinder speed by the restoration control obtained by the target cylinder speed calculator 9h (the maximum value) ) Is selected as the target cylinder speed for output.

【0082】目標パイロット圧演算部9jでは、目標パ
イロット圧としてパイロットライン44a,44b;4
5a,45bの目標パイロット圧を計算する。
In the target pilot pressure calculation unit 9j, the pilot lines 44a, 44b; 4 are set as the target pilot pressures.
Calculate the target pilot pressure of 5a, 45b.

【0083】バルブ指令演算部9kでは、目標パイロッ
ト圧演算部9jで計算した目標パイロット圧に応じた指
令値を演算し、対応する電気信号が比例電磁弁10a,
10b,11a,11bに出力される。
The valve command calculation unit 9k calculates a command value according to the target pilot pressure calculated by the target pilot pressure calculation unit 9j, and the corresponding electric signal is transmitted to the proportional solenoid valve 10a,
It is output to 10b, 11a, 11b.

【0084】以上のように構成した本実施例において
は、基準光検出器70,71が基準光1,2を横切るご
とに、基準光1と掘削領域の位置関係を補正して車体1
Bと掘削領域の高さ方向の位置関係を演算するととも
に、車体と掘削領域の水平方向の位置関係を演算し、車
体を基準とした掘削領域を設定するため、車体の移動に
よる高さ変化を毎回補正して掘削作業が行える。このた
め、車体が移動し車体高さが変化しても掘削領域の設定
は変化せず、常に基準光1,2を基準とした所定の深さ
及び位置を掘削することができる。
In the present embodiment constructed as described above, each time the reference light detectors 70, 71 cross the reference lights 1, 2, the positional relationship between the reference light 1 and the excavation area is corrected to correct the vehicle body 1.
In addition to calculating the positional relationship in the height direction between B and the excavation area, the positional relationship in the horizontal direction between the vehicle body and the excavation area is calculated, and the excavation area is set with respect to the vehicle body. Excavation work can be performed with correction every time. Therefore, even if the vehicle body moves and the vehicle body height changes, the setting of the excavation area does not change, and it is possible to always excavate a predetermined depth and position based on the reference lights 1 and 2.

【0085】また、基準光検出器70,71を実際に地
面に作用する部材であるバケットを備えたフロント装置
1Aのバケット先端に近いところに設置し、これらの基
準光検出器70,71が基準光1,2を検出したときの
フロント装置1Aの位置と姿勢に基づき車体1Bを基準
とした掘削領域を設定するので、この掘削領域の設定に
際して掘削領域設定演算と掘削制御演算とで車体1Bの
製作公差や、基準光検出器70,71、角度センサ8a
〜8c等の精度、取付け公差の誤差の影響が相殺される
ことになる。このため、掘削制御でバケット1cの先端
位置を演算するとき、基準光1,2を車体1Bに設置し
たセンサで検出する方法に比較して、上記の公差や精度
の誤差の影響が少なくなり、設定した掘削領域との差を
少なく設定通りに正確に掘削することができる。
Further, the reference light detectors 70 and 71 are installed near the tip of the bucket of the front device 1A having a bucket which is a member that actually acts on the ground. Since the excavation area based on the vehicle body 1B is set based on the position and posture of the front device 1A when the lights 1 and 2 are detected, the excavation area setting calculation and the excavation control operation are performed to set the excavation area of the vehicle body 1B. Manufacturing tolerances, reference light detectors 70 and 71, angle sensor 8a
The effects of the accuracy of 8c and the error of the mounting tolerance are offset. Therefore, when the tip position of the bucket 1c is calculated by the excavation control, the influence of the above tolerance and accuracy error is reduced as compared with the method of detecting the reference lights 1 and 2 by the sensor installed in the vehicle body 1B. Excavation can be performed exactly as set with little difference from the set excavation area.

【0086】今、このことを更に説明する。特開平3−
295933号公報に記載の従来技術では、前述したよ
うに基準光による車体高さの補正は行える。掘削を行う
ときには車体高さを補正し、車体中心から設定された深
さhsにバケット先端を動かすように制御する。このと
き、制御装置は制御装置に設定されているブーム、アー
ム、バケットの寸法L1,L2,L3及び角度センサか
ら検出された各フロント部材の角度α,β,γを用いバ
ケット先端がhsの位置になるように制御演算を行う。
しかし、実際のフロント部材には製作誤差があり、例え
ばブームはL1+εL1、アームはL2+εL2、バケット
はL3+εL3の寸法になっている。また、センサから検
出した角度α,β,γは真の角度α′,β′,γ′に対
してセンサ取り付け誤差、センサ自身の検出誤差等によ
りεα,εβ,εγの誤差を含んている。そのため、制
御装置が、 hs(L1,L2,L3,α(hs),β(hs),γ(hs)) にバケット先端を制御しようとしても、実際には hs′(L1′,L′,L3′,α′(hs),β′(hs),γ′(hs)) =hs′(L1+εL1,L2+εL2,L3+εL3,α(hs)+εα, β(hs)+εβ,γ(hs)+εγ) …(6) の位置になってしまう。
Now, this will be further described. JP-A-3-
In the conventional technique disclosed in Japanese Patent No. 295933, the vehicle body height can be corrected by the reference light as described above. When excavating, the height of the vehicle body is corrected, and the tip of the bucket is controlled to move to the set depth hs from the center of the vehicle body. At this time, the control device uses the dimensions L1, L2, L3 of the boom, arm, and bucket set in the control device and the angles α, β, γ of the front members detected by the angle sensor, and the bucket tip is at the position hs. The control calculation is performed so that
However, there are manufacturing errors in the actual front member, for example, the boom has dimensions L1 + εL1, the arm has dimensions L2 + εL2, and the bucket has dimensions L3 + εL3. Further, the angles α, β, γ detected by the sensor include errors εα, εβ, εγ with respect to the true angles α ′, β ′, γ ′ due to sensor mounting errors, detection errors of the sensor itself, and the like. Therefore, even if the control device tries to control the bucket tip to hs (L1, L2, L3, α (hs), β (hs), γ (hs)), it is actually hs' (L1 ', L', L3 ', α' (hs), β '(hs), γ' (hs)) = hs' (L1 + εL1, L2 + εL2, L3 + εL3, α (hs) + εα, β (hs) + εβ, γ (hs) + εγ) ... It becomes the position of (6).

【0087】ここで、L1,L2,L3:設計値 α,β,γ:検出値 L1′L2′L3′,α′,β′,γ′:実際値 εL1,εL2,εL3,εα,εβ,εγ:誤差 また、L1′=L1+εL1 L2′=L2+εL2 L3′=L3+εL3 α=α′+εα β=β′+εβ γ=γ′+εγ ただし、α(hs),β(hs),γ(hs),α′(hs),β′(h
s),γ′(hs)はフロント装置がhs検出の姿勢をとった
ときの角度の検出値と実際値。
Here, L1, L2, L3: Design values α, β, γ: Detected values L1'L2'L3 ', α', β ', γ': Actual values εL1, εL2, εL3, εα, εβ, εγ: error Also, L1 ′ = L1 + εL1 L2 ′ = L2 + εL2 L3 ′ = L3 + εL3 α = α ′ + εα β = β ′ + εβ γ = γ ′ + εγ where α (hs), β (hs), γ (hs), α ′ (Hs), β ′ (h
s) and γ '(hs) are the detected value and the actual value of the angle when the front device takes the hs detection posture.

【0088】例えば、目標のブーム角が30°とする
と、制御装置は検出値α(hs)=30°になるようにフロ
ント装置を制御する。このとき、検出値αと実際の角度
α′にεα=0.5°の誤差が合った場合には、実際に
はα′=30.5°の位置に制御されてしまう。
For example, when the target boom angle is 30 °, the control device controls the front device so that the detected value α (hs) = 30 °. At this time, when the detected value α and the actual angle α ′ have an error of εα = 0.5 °, the position is actually controlled to α ′ = 30.5 °.

【0089】一方、本実施例ではフロント装置(アー
ム)に基準光検出器70を設けているので、基準光1を
検出器70が横切ったときの検出器70の位置hfは制
御ユニット9の内部では、 hf(L1,Lfα(hf),β(hf),θf) で演算された位置と認識される。その時の実際の検出器
70は、 hf′(L1′,Lf′,α′(hf),β′(hf),θf′) =hf′(L1+εL1,Lf+εLf,α(hf)+εα,β(hf)+εβ, θf+εθf) の位置にある。このときのバケット先端の位置は、 (L1′,L2′,L3′,α′(hf),β′(hf),γ′(hf)) =(L1+εL1,L2+εLf,L3+εL3,α(hf)+εα(hf), β(hf)+εβ(hf),γ(hf)+εγ(hf)) …(7) の位置になっている。
On the other hand, in this embodiment, since the reference light detector 70 is provided in the front device (arm), the position hf of the detector 70 when the detector 70 crosses the reference light 1 is the inside of the control unit 9. Then, it is recognized as the position calculated by hf (L1, Lfα (hf), β (hf), θf). The actual detector 70 at that time is as follows: hf '(L1', Lf ', α' (hf), β '(hf), θf') = hf '(L1 + εL1, Lf + εLf, α (hf) + εα, β (hf ) + Εβ, θf + εθf). The position of the bucket tip at this time is (L1 ', L2', L3 ', α' (hf), β '(hf), γ' (hf)) = (L1 + εL1, L2 + εLf, L3 + εL3, α (hf) + εα (hf), β (hf) + εβ (hf), γ (hf) + εγ (hf)) (7).

【0090】ここで、εθf:b検出器70の取り付け
誤差 α(hf),β(hf),γ(hf):フロント装置がhf検出の姿
勢をとったときの角度の検出値 α′(hf),β′(hf),γ′(hf):フロント装置がhf検
出の姿勢をとったときの角度の検出値 このとき、基準光検出器70は真の基準光1の位置にあ
るので、制御ユニット9は誤差を含んだ形で真の基準光
1の位置を検出したことになる。このhfを領域制限制
御に用いれば、制御ユニット9内の検出位置hfと実際
の位置hf′の誤差はhfを検出したときと同じ誤差を
含んでいるので、実際には相殺されて真のhf′の位置
に一致する。
Here, εθf: b mounting error of the detector 70 α (hf), β (hf), γ (hf): Detected value α ′ (hf of the angle when the front device takes the hf detection posture. ), Β ′ (hf), γ ′ (hf): Detected value of the angle when the front device takes the hf detection posture At this time, the reference photodetector 70 is at the position of the true reference light 1, The control unit 9 has detected the position of the true reference light 1 including an error. If this hf is used for the area limiting control, the error between the detected position hf in the control unit 9 and the actual position hf 'includes the same error as when the hf is detected, so that it is actually canceled out and the true hf is eliminated. It matches the position of ′.

【0091】例えば、基準光1を検出したときに実際の
ブーム角α′=30°であったとし、センサ8aによる
検出値にεα=0.5°の誤差があるとすると、α=2
9.5°で検出される。この検出値α=29.5°を用
いれば、実際にはα′=30°の位置、つまり基準光1
の真の位置と一致するので、誤差は相殺される。
For example, suppose that the actual boom angle α '= 30 ° when the reference light 1 is detected, and the detected value by the sensor 8a has an error of εα = 0.5 °, α = 2.
Detected at 9.5 °. If this detected value α = 29.5 ° is used, the position of α ′ = 30 °, that is, the reference light 1 is actually used.
Since it matches the true position of, the error is canceled out.

【0092】次に、領域制限制御を行うときにこのhf
を用いて補正されたhsを目標にバケット先端位置を制
御すると、少なくともhfに内在されている誤差は先に
述べたように実際の基準光位置から考えると相殺され、
残りはhfを検出したときの姿勢からバケット先端をh
sに移動するまでのセンサの誤差によるものになる。こ
のとき実際には、バケット先端は、 hs′(L1′,L2′,L3′,α′,β′(hs),γ′(hs)) =hs′(L1+εL1,L2+εLf,L3+εL3,α(hs)+εα(hs), β(hs)+εβ(hs),γ(hs)+εγ(hs)) …(8) にある。
Next, when the area restriction control is performed, this hf
When the bucket tip position is controlled with the target hs corrected by using, the error contained in at least hf is canceled when considering from the actual reference light position as described above.
For the rest, h is the tip of the bucket from the posture when hf is detected.
It is due to the error of the sensor until it moves to s. At this time, the bucket tip is actually hs '(L1', L2 ', L3', α ', β' (hs), γ '(hs)) = hs' (L1 + εL1, L2 + εLf, L3 + εL3, α (hs ) + Εα (hs), β (hs) + εβ (hs), γ (hs) + εγ (hs)) (8).

【0093】ここで、α(hs),β(hs),γ(hs):フロン
ト装置がhsの制御姿勢をとったときの角度の検出値 α′(hs),β′(hs),γ′(hs):フロント装置がhsの
制御姿勢をとったときの角度の検出値 このとき、本実施例では(7)式に従いhf検出時の位
置は基準光1の真の位置であるので、従来技術と異な
り、hf検出時からhsへ姿勢を制御したときの偏差α
(hs)−α(hf),β(hs)−β(hf),γ(hs)−γ(hf)に係わ
る誤差、 Δεα=εα(hs)−εα(hf) …(9) Δεβ=εβ(hs)−εβ(hf) …(10) Δεγ=εγ(hs)−εγ(hf) …(11) が実際に領域制限制御を行ったときの誤差に係わり、軽
微なものとなる。また、本実施例では、基準光検出器7
0をフロント装置に備えて、基準光検出時と掘削時の姿
勢変化を極力少なくすることができ、その場合は(9)
〜(11)式に係わる誤差は更に少なくすることができ
る。
Here, α (hs), β (hs), γ (hs): detected values α ′ (hs), β ′ (hs), γ of the angle when the front device takes the hs control posture. ′ (Hs): Detected value of angle when the front device takes the control attitude of hs At this time, in this embodiment, the position at the time of hf detection is the true position of the reference light 1 according to the equation (7). Different from the prior art, the deviation α when the attitude is controlled from hf detection to hs
Error relating to (hs) -α (hf), β (hs) -β (hf), γ (hs) -γ (hf), Δεα = εα (hs) -εα (hf) (9) Δεβ = εβ (hs) -εβ (hf) (10) Δεγ = εγ (hs) -εγ (hf) (11) is a slight amount due to the error when the area limiting control is actually performed. Further, in the present embodiment, the reference light detector 7
By equipping the front device with 0, it is possible to minimize posture changes during reference light detection and excavation. In that case, (9)
It is possible to further reduce the error related to equations (11).

【0094】なお、後述するダイレクトティーチングに
よる場合は、hrを設定する場合の誤差も設定時に取り
込み、制御時に操作できることからより正確な掘削の制
御ができる。
In the case of direct teaching, which will be described later, an error in setting hr can be taken in at the time of setting and can be operated during control, so that more accurate excavation control can be performed.

【0095】また、本実施例では、フロント装置1Aの
位置と姿勢を検出する角度センサ8a〜8cの誤差の影
響を受け難いので、車体が移動して車体高さが変化する
ことにより車体からの掘削深さが変化しても、その掘削
深さの変化量に対する角度センサ8a〜8cの誤差の影
響が少なくなり、車体高さが変化する前と後で掘削深さ
が変化することが防止される。
Further, in the present embodiment, since it is difficult to be influenced by the error of the angle sensors 8a to 8c for detecting the position and the posture of the front device 1A, the vehicle body moves and the vehicle body height is changed, so that the vehicle body height from the vehicle body is changed. Even if the excavation depth changes, the influence of the error of the angle sensors 8a to 8c on the variation amount of the excavation depth is reduced, and the excavation depth is prevented from changing before and after the vehicle body height changes. It

【0096】更に、特開平3−295933号公報に記
載の従来技術では、車体に備えられた基準光検出器が基
準光を検出できる広い範囲にあることが必要である。本
実施例では、基準光検出器70,71をフロント装置1
Aに設置し、フロント装置1Aを操作している最中に基
準光検出器70,71が基準光1,2を横切ることでそ
れぞれ基準光1,2を検出するので、基準光検出器7
0,71の設置面積が小さくても確実に基準光1,2を
捕らえることができ、基準光検出器70,71をそれぞ
れ小型でシンプルな構成にできる。
Further, in the conventional technique disclosed in Japanese Patent Laid-Open No. 3-295933, it is necessary that the reference light detector provided in the vehicle body is in a wide range capable of detecting the reference light. In the present embodiment, the reference light detectors 70 and 71 are connected to the front device 1.
Since the reference light detectors 70 and 71 cross the reference lights 1 and 2 to detect the reference lights 1 and 2 respectively while the front device 1A is being operated, the reference light detector 7 is installed.
Even if the installation areas of 0 and 71 are small, the reference lights 1 and 2 can be reliably captured, and the reference light detectors 70 and 71 can be made small and simple.

【0097】同様に、フロント装置1Aを操作している
最中に基準光検出器70,71が基準光1,2を横切る
ことで基準光1,2を検出するので、フロント装置1A
の広い可動範囲を考えれば車体の移動を広い範囲で補正
できる。
Similarly, the reference light detectors 70 and 71 detect the reference lights 1 and 2 by traversing the reference lights 1 and 2 while operating the front device 1A.
Considering the wide movable range, the movement of the vehicle body can be corrected in a wide range.

【0098】また、特開平3−295933号公報に記
載の従来技術では、上記のように車体に備えられた基準
光検出器が基準光を検出できる範囲にあることが必要で
あり、基準光検出器の大きさを考えれば大きな制約とな
る。本実施例では、基準光検出器70,71はフロント
装置1A、特にアームに備えられるので、フロント装置
の広い可動範囲を考えれば基準光発生器80,81の設
置場所は大きな制約を受ない。このことは、例えば図1
2に示すように、車体1Bと同じ高さの地面に適当な基
準光発生器の設置場所がない場合に、溝Gの中に基準光
発生器80,81を設置することができるなどのメリッ
トがある。また、このことにより先の誤差の問題から基
準光検出時の姿勢と掘削時の姿勢との間の変化を少なく
するように基準光発生器80,81を設置することがで
き、掘削の精度を向上することができる。
Further, in the prior art disclosed in Japanese Patent Laid-Open No. 3-295933, it is necessary that the reference photodetector provided in the vehicle body be within the range in which the reference light can be detected, as described above. Considering the size of the vessel, it becomes a big limitation. In the present embodiment, the reference light detectors 70 and 71 are provided in the front device 1A, especially in the arm, so that the installation locations of the reference light generators 80 and 81 are not greatly restricted considering the wide movable range of the front device. This is shown in FIG.
As shown in 2, when there is no suitable reference light generator installation place on the ground level with the vehicle body 1B, the reference light generators 80, 81 can be installed in the groove G. There is. Further, by this, the reference light generators 80 and 81 can be installed so as to reduce the change between the posture at the time of detecting the reference light and the posture at the time of excavation due to the problem of the above error, and the accuracy of the excavation can be improved. Can be improved.

【0099】更に、本実施例によれば、作業の初めに基
準光発生器80,81を設置し、設定器7を用いて設定
を行っておけば、作業開始時、あるいは油圧ショベル本
体を走行して移動するごとにバケット1cの先端を掘削
領域の境界に位置決めするための補助員が不要となる。
また、補助員の指示による設定にかかる時間を無くすこ
とができ、作業時間を短縮できる。
Furthermore, according to the present embodiment, if the reference light generators 80 and 81 are installed at the beginning of the work and the setting is performed using the setting device 7, the work is started or the hydraulic excavator body is moved. Therefore, an auxiliary member for positioning the tip of the bucket 1c at the boundary of the excavation area every time it moves is unnecessary.
Further, the time required for setting by the instruction of the assistant can be eliminated, and the working time can be shortened.

【0100】また、基準光発生器80,81は車体の外
部に設置され、一度設置されればその位置を変える必要
がなく、車体が移動しても掘削領域の基準として継続的
に使用できる。
Further, the reference light generators 80 and 81 are installed outside the vehicle body, and once installed, there is no need to change their positions, and they can be continuously used as a reference for the excavation area even if the vehicle body moves.

【0101】本発明の第2の実施例を図13〜図15に
より説明する。本実施例は第1の実施例の第1設定手段
100(図5参照)における基準光と掘削領域の位置関
係の設定をダイレクトティーチングで行うものである。
A second embodiment of the present invention will be described with reference to FIGS. In this embodiment, the positional relationship between the reference light and the excavation area in the first setting means 100 (see FIG. 5) of the first embodiment is set by direct teaching.

【0102】すなわち、第1の実施例では、第1設定手
段100において基準光から掘削領域の基準点Pまでの
深さhrを設定器7のアップボタン7a及びダウンボタ
ン7c(図3参照)等を使用して設定した。本実施例で
は、オペレータの操作レバーの操作でバケット1cの先
端を図13に二点鎖線で示すように設定したい基準点P
に動かして、その場所をダイレクトティーチングするこ
とにより基準点Pの深さhrを設定する。
That is, in the first embodiment, the depth hr from the reference light to the reference point P of the excavation area in the first setting means 100 is set by the up button 7a and the down button 7c of the setter 7 (see FIG. 3) and the like. Set using. In the present embodiment, the reference point P at which the tip of the bucket 1c is desired to be set as shown by the chain double-dashed line in FIG.
To set the depth hr of the reference point P by moving the position to and teaching the location directly.

【0103】図14に掘削領域のダイレクトティーチン
グによる設定方法の処理フローを示す。図中、破線で囲
んだ部分の操作,は油圧ショベルのオペレータが行
わなくてはならない動作を示す。
FIG. 14 shows a processing flow of the setting method by direct teaching of the excavation area. In the figure, the operations surrounded by broken lines indicate the operations that the operator of the hydraulic excavator must perform.

【0104】まず、オペレータは図14のに示すよう
に、操作レバーを操作してバケット1cの先端を掘削領
域の基準点Pに来るようにフロント装置1Aを動かす。
バケット1cの先端が基準点Pに来ると、オペレータは
設定器7を用いて角度θrを入力した後、領域設定スイ
ッチ7f(図3参照)を押す。
First, the operator operates the operation lever to move the front device 1A so that the tip of the bucket 1c comes to the reference point P in the excavation area, as shown in FIG.
When the tip of the bucket 1c reaches the reference point P, the operator inputs the angle θr using the setting device 7, and then pushes the area setting switch 7f (see FIG. 3).

【0105】制御ユニット9(図1参照)では、処理1
90において領域設定スイッチ7fが押されたかどうか
を判定し、押されていない場合は処理190を継続す
る。領域設定スイッチ7fが押されると処理191へ移
る。
In the control unit 9 (see FIG. 1), the process 1
At 90, it is determined whether or not the area setting switch 7f is pressed. If not, the process 190 is continued. When the area setting switch 7f is pressed, the process proceeds to processing 191.

【0106】処理191ではその時のフロント装置1A
の姿勢から、車体中心Oからバケット1cの先端までの
深さhsを演算する。
In process 191, the front device 1A at that time
From this posture, the depth hs from the vehicle body center O to the tip of the bucket 1c is calculated.

【0107】次に、オペレータは図14のに示すよう
に、再び操作レバーを操作して基準光検出器70が基準
光1を横切り基準光1を検出できるようにフロント装置
1Aを動かす。
Next, as shown in FIG. 14, the operator operates the operation lever again to move the front device 1A so that the reference light detector 70 can cross the reference light 1 and detect the reference light 1.

【0108】制御ユニットはその間に処理192におい
て基準光検出器70が基準光1を検出したかどうかの判
定を継続する。ここで、基準光1を検出すると処理19
3へ移る。
In the meantime, the control unit continues to determine in process 192 whether reference light detector 70 has detected reference light 1. Here, if the reference light 1 is detected, the process 19 is performed.
Move to 3.

【0109】処理193では、その時のフロント装置1
Aの姿勢から、車体中心Oから基準光検出器70までの
高さhfoを演算する。
In process 193, the front device 1 at that time is
From the posture of A, the height hfo from the center O of the vehicle body to the reference photodetector 70 is calculated.

【0110】次に処理194において、基準光1から掘
削領域の基準点Pまでの深さhrを、 hr=hs−hfo …(12) の演算により求める。
Next, in process 194, the depth hr from the reference light 1 to the reference point P of the excavation area is obtained by the calculation of hr = hs-hfo (12).

【0111】最後に、処理195において、上記のよう
にして求めた深さhrと設定器7を用いて入力した角度
θrとを記憶し、設定を完了する。
Finally, in process 195, the depth hr obtained as described above and the angle θr input using the setting device 7 are stored, and the setting is completed.

【0112】以上のように基準光1を基準とした掘削領
域の基準点Pの深さhrと角度θrの設定が完了する
と、掘削制御を開始する。本実施例の第1設定手段以外
の構成は第1の実施例と同じであり、掘削作業に際して
は図6に示す第1演算手段120、第2演算手段14
0、第3演算手段150及び第2設定手段160によ
り、図15に示すように処理195で設定したhrを使
用し、基準光1を検出するごとに補正値hfを求めて深
さhsを更新し、車体を基準とした掘削領域を設定しつ
つ領域制限掘削制御を行う。
When the setting of the depth hr and the angle θr of the reference point P in the excavation area with reference to the reference light 1 is completed as described above, excavation control is started. The configuration other than the first setting means of this embodiment is the same as that of the first embodiment, and during excavation work, the first calculating means 120 and the second calculating means 14 shown in FIG. 6 are used.
0, the third calculating means 150, and the second setting means 160 use the hr set in the process 195 as shown in FIG. 15, and each time the reference light 1 is detected, the correction value hf is obtained and the depth hs is updated. Then, the area limiting excavation control is performed while setting the excavation area based on the vehicle body.

【0113】本実施例によればダイレクトティーチング
により掘削領域を設定するので、作業状況に合わせて所
望の掘削領域を正確に設定することができる。
According to the present embodiment, since the excavation area is set by direct teaching, the desired excavation area can be set accurately according to the work situation.

【0114】[0114]

【発明の効果】本発明によれば、車体が移動し作業現場
の地形の変化で油圧ショベルの高さが変化しても、常に
基準光を基準とした所定の深さ及び位置を掘削すること
ができ。
According to the present invention, even if the height of the hydraulic excavator changes due to the movement of the vehicle body and the change of the terrain at the work site, it is possible to always excavate a predetermined depth and position based on the reference light. Can

【0115】また、掘削時に、基準光を車体に設置した
センサで検出する方法に比較して、車体の製作公差やセ
ンサ等の精度、取付け公差の誤差の影響を受難く、設定
した掘削領域との差を少なく設定通りに正確に掘削する
ことができる。
Further, in comparison with the method of detecting the reference light by the sensor installed on the vehicle body at the time of excavation, it is less susceptible to the manufacturing tolerance of the vehicle body, the accuracy of the sensor, etc. It is possible to excavate exactly according to the setting with less difference.

【0116】また、センサの誤差の影響を受け難いの
で、車体の移動により車体からの掘削深さが変化して
も、車体高さが変化する前と後で掘削深さが変化するこ
とが防止できる。
Further, since it is not easily affected by the error of the sensor, even if the excavation depth from the vehicle body changes due to the movement of the vehicle body, it is possible to prevent the excavation depth from changing before and after the vehicle body height changes. it can.

【0117】更に、第1及び第2検出手段の設置面積が
小さくても確実に基準光を捕らえることができるので、
第1及び第2検出手段を小型でシンプルな構成にでき
る。
Furthermore, the reference light can be reliably captured even if the installation area of the first and second detecting means is small.
The first and second detecting means can be made small and simple.

【0118】また、第1検出手段を設置したフロント装
置の広い可動範囲を考えれば車体の移動を広い範囲で補
正できる。
Further, considering the wide movable range of the front device having the first detecting means, the movement of the vehicle body can be corrected in a wide range.

【0119】また、本発明によれば、勾配を付けた掘削
領域を設定して領域制限掘削制御により上下水道管の埋
設用の溝掘りのような作業が容易になる。
Further, according to the present invention, an operation such as digging a groove for burying a water and sewer pipe is facilitated by setting an excavated area having a slope and controlling the area limited excavation.

【0120】また、本発明によれば、操作器を用いて作
業の初めに第1設定手段の設定を行っておけば、作業開
始時、あるいは車体を走行して移動するごとにフロント
装置を掘削領域の境界に位置決めするための補助員が不
要となる。また、補助員の指示による設定にかかる時間
を無くすことができ、作業時間を短縮できる。
Further, according to the present invention, if the first setting means is set at the beginning of the work using the operation device, the front device is excavated at the start of the work or each time the vehicle travels and moves. There is no need for assistants to position the boundaries of the area. Further, the time required for setting by the instruction of the assistant can be eliminated, and the working time can be shortened.

【0121】更に、本発明によれば、ダイレクトティー
チングにより第1設定手段の設定を行うので、作業状況
に合わせて所望の掘削領域を正確に設定することができ
る。
Furthermore, according to the present invention, since the setting of the first setting means is performed by direct teaching, a desired excavation area can be set accurately according to the working situation.

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

【図1】本発明の第1の実施例による掘削領域設定装置
を備えた建設機械の領域制限掘削制御装置を油圧駆動装
置と共に示す図である。
FIG. 1 is a diagram showing an area limiting excavation control device for a construction machine equipped with an excavation area setting device according to a first embodiment of the present invention together with a hydraulic drive device.

【図2】本発明が適用された油圧ショベルの外観とその
周囲の設定領域の形状を示す図である。
FIG. 2 is a diagram showing an appearance of a hydraulic excavator to which the present invention is applied and a shape of a setting area around the hydraulic excavator.

【図3】設定器の外観を示す図である。FIG. 3 is a diagram showing an appearance of a setting device.

【図4】第1の実施例の掘削領域設定装置により掘削領
域を設定する際の水平方向の基準光との関係を示す図で
ある。
FIG. 4 is a diagram showing a relationship with a reference light in a horizontal direction when setting an excavation region by the excavation region setting device of the first embodiment.

【図5】第1の実施例の掘削領域設定装置により掘削領
域を設定する際の高さ方向の基準光との関係を示す図で
ある。
FIG. 5 is a diagram showing a relationship with reference light in a height direction when setting an excavation region by the excavation region setting device of the first embodiment.

【図6】第1の実施例の掘削領域設定装置の構成を示す
図である。。
FIG. 6 is a diagram showing a configuration of an excavation area setting device according to a first embodiment. .

【図7】第1の実施例の掘削領域設定装置における第1
設定手段の処理フローを示す図である。
FIG. 7 is a first view of the excavation area setting device of the first embodiment.
It is a figure which shows the processing flow of a setting means.

【図8】第1の実施例の掘削領域設定装置における第2
演算手段、第3演算手段及び第2設定手段の処理フロー
を示す図である。
FIG. 8 is a second view of the excavation area setting device of the first embodiment.
It is a figure which shows the processing flow of a calculating means, a 3rd calculating means, and a 2nd setting means.

【図9】制御ユニットの全体の制御機能を示す機能ブロ
ック図である。
FIG. 9 is a functional block diagram showing an overall control function of the control unit.

【図10】領域制限掘削制御においてバケットの先端が
演算通りに方向変換制御されたときの軌跡の一例を示す
図である。
FIG. 10 is a diagram showing an example of a trajectory when the tip end of the bucket is subjected to direction change control as calculated in the area limited excavation control.

【図11】領域制限掘削制御においてバケットの先端が
演算通りに復元制御されたときの軌跡の一例を示す図で
ある。
FIG. 11 is a diagram showing an example of a trajectory when the tip of the bucket is restored and restored as calculated in the area limited excavation control.

【図12】車体と同じ高さに適当な基準光発生器の設置
場所がない場合に、溝の中に基準光発生器を設置した状
態を示す図である。
FIG. 12 is a view showing a state in which the reference light generator is installed in the groove when there is no suitable installation place for the reference light generator at the same height as the vehicle body.

【図13】本発明の第2の実施例の掘削領域設定装置に
より掘削領域を設定する際の基準光との関係を示す図で
ある。
FIG. 13 is a diagram showing a relationship with reference light when setting an excavation region by the excavation region setting device according to the second embodiment of the present invention.

【図14】第2の実施例の掘削領域設定装置における第
1設定手段の処理フローを示す図である。
FIG. 14 is a diagram showing a processing flow of first setting means in the excavation area setting device of the second embodiment.

【図15】第2の実施例の掘削領域設定装置による掘削
領域を設定したときの最初の設定時とその後の移動時の
関係を示す図である。
FIG. 15 is a diagram showing the relationship between the first setting and the subsequent movement when the excavation area is set by the excavation area setting device of the second embodiment.

【符号の説明】[Explanation of symbols]

1A フロント装置 1B 車体 1a ブーム 1b アーム 1c バケット 1d 上部旋回体 1e 下部走行体 2 油圧ポンプ 3a〜3f 油圧アクチュエータ 4a〜4f;204a〜204f 操作レバー装置 5a〜5f 流量制御弁 6 リリーフ弁 7 設定器 8a,8b,8c 角度計(第2検出手段) 8d 傾斜計(第2検出手段) 9 制御ユニット 9a 第1掘削領域設定部(第1設定手段) 9b フロント姿勢演算部(第1演算手段) 9c 目標シリンダ速度演算部 9d 目標先端速度ベクトル演算部 9e 方向変換制御部 9f 補正後目標シリンダ速度演算部 9g 復元制御部 9h 補正後目標シリンダ速度演算部 9i 目標シリンダ速度選択部 9j 目標パイロット圧演算部 9k バルブ指令演算部 9m 第1位置関係演算部(第2演算手段) 9n 第2掘削領域設定部(第2設定手段) 9p 第2位置関係演算部(第3演算手段) 10a 比例電磁弁 10b,11a,11b 比例電磁弁 12 シャトル弁 44a,44b〜49a,49b パイロットライン 60a,60b,61a,61b 圧力検出器 70 基準光検出器(第1検出手段) 71 基準光検出器(第2検出手段) 80 基準光発生器(第1外部基準光発生装置) 81 基準光発生器(第2外部基準光発生装置) 100 第1設定手段 120 第1演算手段 140 第2演算手段 150 第3演算手段 160 第2設定手段 1A Front device 1B Vehicle body 1a Boom 1b Arm 1c Bucket 1d Upper revolving structure 1e Lower traveling structure 2 Hydraulic pump 3a to 3f Hydraulic actuators 4a to 4f; 204a to 204f Operation lever device 5a to 5f Flow control valve 6 Relief valve 7 Setting device 8a , 8b, 8c Angle meter (second detecting means) 8d Inclinometer (second detecting means) 9 Control unit 9a First excavation area setting section (first setting means) 9b Front attitude calculation section (first calculation means) 9c Target Cylinder speed calculation unit 9d Target tip speed vector calculation unit 9e Direction conversion control unit 9f Corrected target cylinder speed calculation unit 9g Restoration control unit 9h Corrected target cylinder speed calculation unit 9i Target cylinder speed selection unit 9j Target pilot pressure calculation unit 9k Valve Command computing unit 9m First positional relationship computing unit (second computing means) 9n 2 excavation area setting section (second setting means) 9p Second positional relationship calculation section (third calculation means) 10a Proportional solenoid valve 10b, 11a, 11b Proportional solenoid valve 12 Shuttle valve 44a, 44b to 49a, 49b Pilot line 60a, 60b, 61a, 61b Pressure detector 70 Reference light detector (first detection means) 71 Reference light detector (second detection means) 80 Reference light generator (first external reference light generation device) 81 Reference light generator ( Second external reference light generator) 100 First setting means 120 First calculating means 140 Second calculating means 150 Third calculating means 160 Second setting means

Claims (4)

【特許請求の範囲】[Claims] 【請求項1】 多関節型のフロント装置を構成する上下
方向に回動可能な複数のフロント部材と、前記フロント
装置を支持する車体とを備え、前記複数のフロント部材
をそれぞれ駆動制御してフロント部材の動作範囲を制限
制御する建設機械の領域制限掘削制御の掘削領域設定装
置において、 (a)前記建設機械の外部に設置され、掘削領域に対す
る高さ方向の基準位置を示す基準光を発生する第1外部
基準光発生装置と; (b)前記建設機械の外部に設置され、掘削領域に対す
る水平方向の基準位置を示す基準光を発生する第2外部
基準光発生装置と; (c)前記フロント装置に備えられ、前記第1外部基準
光発生装置の出力した基準光を検出する第1検出手段
と; (d)前記フロント装置に備えられ、前記第2外部基準
光発生装置の出力した基準光を検出する第2検出手段
と; (e)前記フロント装置の位置と姿勢に関する状態量を
検出する第3検出手段と; (f)前記第3検出手段の信号に基づき前記フロント装
置の位置と姿勢を演算する第1演算手段と; (g)前記第1外部基準光発生装置の発生する基準光と
掘削領域との位置関係を設定する第1設定手段と; (h)前記第1検出手段が前記第1外部基準光発生装置
の発生する基準光を検出したときに、前記第1演算手段
で演算した前記フロント装置の位置と姿勢の情報に基づ
き前記車体の位置変化に関する補正値を演算し、この補
正値と前記第1設定手段で設定した基準光と掘削領域と
の位置関係とから前記車体と掘削領域の高さ方向の位置
関係を演算する第2演算手段と; (i)前記第2検出手段が前記第2外部基準光発生装置
の発生する基準光を検出したときに、前記第1演算手段
で演算した前記フロント装置の位置と姿勢の情報に基づ
き前記車体と掘削領域の水平方向の位置関係を演算する
第3演算手段と; (j)前記第2演算手段で演算した基準光と掘削領域と
の高さ方向の位置関係と、前記第3演算手段で演算した
前記車体と掘削領域の水平方向の位置関係と、前記第1
設定手段で設定した基準光と掘削領域との位置関係とか
ら前記車体を基準とした掘削領域を設定する第2設定手
段と; を備えることを特徴とする建設機械の領域制限掘削制御
の掘削領域設定装置。
1. A front device comprising a plurality of vertically movable front members constituting an articulated front device, and a vehicle body supporting the front device, the front members being driven and controlled respectively. In an excavation area setting device for area limitation excavation control of a construction machine that limits and controls the operating range of a member, (a) is installed outside the construction machine and generates reference light indicating a reference position in the height direction with respect to the excavation area A first external reference light generating device; (b) a second external reference light generating device which is installed outside the construction machine and generates reference light indicating a horizontal reference position with respect to the excavation area; (c) the front A first detection means provided in the device for detecting the reference light output from the first external reference light generation device; and (d) an output of the second external reference light generation device provided in the front device. Second detection means for detecting the reference light, (e) third detection means for detecting a state quantity relating to the position and orientation of the front device, and (f) the front device based on a signal from the third detection device. First calculating means for calculating the position and orientation; (g) first setting means for setting the positional relationship between the reference light generated by the first external reference light generating device and the excavation area; (h) the first When the detecting means detects the reference light generated by the first external reference light generating device, the correction value for the position change of the vehicle body is calculated based on the information on the position and the posture of the front device calculated by the first calculating means. Second calculating means for calculating and calculating the positional relationship in the height direction between the vehicle body and the excavation area based on the correction value and the positional relationship between the reference light set by the first setting means and the excavation area; The second detection means is the second external Third, when the reference light generated by the quasi-light generator is detected, the horizontal positional relationship between the vehicle body and the excavation area is calculated based on the position and orientation information of the front device calculated by the first calculating means. (J) A positional relationship in the height direction between the reference light and the excavation area calculated by the second calculating means, and a horizontal positional relationship between the vehicle body and the excavation area calculated by the third calculating means. , The first
Second setting means for setting the excavation area based on the vehicle body based on the positional relationship between the reference light and the excavation area set by the setting means; Setting device.
【請求項2】 請求項1記載の建設機械の領域制限掘削
制御の掘削領域設定装置において、前記第1設定手段
は、前記第1外部基準光発生装置の発生する基準光から
前記掘削領域の基準点までの深さと、前記掘削領域の境
界の傾斜角度を設定する手段であることを特徴とする建
設機械の領域制限掘削制御の掘削領域設定装置。
2. The excavation area setting device for area limited excavation control of a construction machine according to claim 1, wherein the first setting means determines a reference of the excavation area from reference light generated by the first external reference light generator. An excavation area setting device for area limited excavation control of a construction machine, which is means for setting a depth to a point and an inclination angle of a boundary of the excavation area.
【請求項3】 請求項1記載の建設機械の領域制限掘削
制御の掘削領域設定装置において、前記第1設定手段
は、操作器により入力されたデータを基に前記基準光と
設定領域の位置関係を設定する手段であることを特徴と
する建設機械の領域制限掘削制御の掘削領域設定装置。
3. The excavation area setting device for area limited excavation control of a construction machine according to claim 1, wherein the first setting means has a positional relationship between the reference light and the setting area based on data input by an operating device. An excavation area setting device for area limited excavation control of a construction machine, which is a means for setting an excavation area.
【請求項4】 請求項1記載の建設機械の領域制限掘削
制御の掘削領域設定装置において、前記第1設定手段
は、前記フロント装置を動かしフロント装置の先端が設
定領域の基準点に来たとき、前記第1演算手段で演算し
た前記フロント装置の位置と姿勢の情報に基づき前記フ
ロント装置の先端の位置を演算する手段と、前記フロン
ト装置を動かし前記第1検出手段が前記第1外部基準光
発生装置の発生する基準光を検出したとき、前記第1演
算手段で演算した前記フロント装置の位置と姿勢の情報
に基づき前記第1検出手段の位置を演算する手段と、前
記フロント装置の先端位置と前記第1検出手段の位置と
から前記基準光と設定領域の位置関係を演算し、記憶す
る手段とを含むことを特徴とする建設機械の領域制限掘
削制御の掘削領域設定装置。
4. The excavation area setting device for area limited excavation control of a construction machine according to claim 1, wherein the first setting means moves the front device so that a front end of the front device reaches a reference point of the setting region. Means for calculating the position of the tip of the front device based on the information on the position and orientation of the front device calculated by the first calculating means, and the first detecting means for moving the front device to cause the first external reference light to move. A means for calculating the position of the first detecting means based on the position and orientation information of the front device calculated by the first calculating means when the reference light generated by the generating device is detected; and a tip position of the front device. And a position of the first detection means to calculate and store a positional relationship between the reference light and the set area, and a means for storing the positional relationship. apparatus.
JP05278795A 1995-03-13 1995-03-13 Excavation area setting device for area restriction excavation control of construction machinery Expired - Fee Related JP3497910B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP05278795A JP3497910B2 (en) 1995-03-13 1995-03-13 Excavation area setting device for area restriction excavation control of construction machinery

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP05278795A JP3497910B2 (en) 1995-03-13 1995-03-13 Excavation area setting device for area restriction excavation control of construction machinery

Publications (2)

Publication Number Publication Date
JPH08246493A true JPH08246493A (en) 1996-09-24
JP3497910B2 JP3497910B2 (en) 2004-02-16

Family

ID=12924555

Family Applications (1)

Application Number Title Priority Date Filing Date
JP05278795A Expired - Fee Related JP3497910B2 (en) 1995-03-13 1995-03-13 Excavation area setting device for area restriction excavation control of construction machinery

Country Status (1)

Country Link
JP (1) JP3497910B2 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1998036131A1 (en) * 1997-02-13 1998-08-20 Hitachi Construction Machinery Co., Ltd. Slope excavation controller of hydraulic shovel, target slope setting device and slope excavation forming method
WO2001025549A1 (en) * 1999-10-01 2001-04-12 Hitachi Construction Machinery Co., Ltd. Target excavation surface setting device for excavation machine, recording medium therefor and display unit
WO2010074003A1 (en) * 2008-12-25 2010-07-01 Nitta Yoshimasa Excavation assisting device and excavation assisting method
WO2021085479A1 (en) * 2019-10-31 2021-05-06 日立建機株式会社 Construction machine
KR20220039801A (en) * 2020-03-24 2022-03-29 히다찌 겐끼 가부시키가이샤 working machine

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1998036131A1 (en) * 1997-02-13 1998-08-20 Hitachi Construction Machinery Co., Ltd. Slope excavation controller of hydraulic shovel, target slope setting device and slope excavation forming method
US6076029A (en) * 1997-02-13 2000-06-13 Hitachi Construction Machinery Co., Ltd. Slope excavation controller of hydraulic shovel, target slope setting device and slope excavation forming method
WO2001025549A1 (en) * 1999-10-01 2001-04-12 Hitachi Construction Machinery Co., Ltd. Target excavation surface setting device for excavation machine, recording medium therefor and display unit
EP1186720A1 (en) * 1999-10-01 2002-03-13 Hitachi Construction Machinery Co., Ltd. Target excavation surface setting device for excavation machine, recording medium therefor and display unit
US6532409B1 (en) 1999-10-01 2003-03-11 Hitachi Construction Machinery Co., Ltd. Target excavation surface setting device for excavation machine, recording medium therefor and display unit
EP1186720A4 (en) * 1999-10-01 2008-11-19 Hitachi Construction Machinery Target excavation surface setting device for excavation machine, recording medium therefor and display unit
WO2010074003A1 (en) * 2008-12-25 2010-07-01 Nitta Yoshimasa Excavation assisting device and excavation assisting method
JP2010168885A (en) * 2008-12-25 2010-08-05 Naomasa Nitta Excavation support device and excavation support method
WO2021085479A1 (en) * 2019-10-31 2021-05-06 日立建機株式会社 Construction machine
JP2021070991A (en) * 2019-10-31 2021-05-06 日立建機株式会社 Construction machine
KR20220038761A (en) * 2019-10-31 2022-03-29 히다치 겡키 가부시키 가이샤 construction machinery
CN114302995A (en) * 2019-10-31 2022-04-08 日立建机株式会社 Construction machine
KR20220039801A (en) * 2020-03-24 2022-03-29 히다찌 겐끼 가부시키가이샤 working machine

Also Published As

Publication number Publication date
JP3497910B2 (en) 2004-02-16

Similar Documents

Publication Publication Date Title
KR100353566B1 (en) A slope excavation control device of a hydraulic excavator, a target slope setting device, and a slope excavation forming method
JP3609164B2 (en) Excavation area setting device for area limited excavation control of construction machinery
US5960378A (en) Excavation area setting system for area limiting excavation control in construction machines
JP4024042B2 (en) Target excavation surface setting device of excavating machine, its recording medium and display device
US11377815B2 (en) Construction machine
JPWO2018051511A1 (en) Work machine
JP2001098585A (en) Excavating work guidance device and excavation control device for construction machine
WO1995030059A1 (en) Aera limiting digging control device for a building machine
WO2019175917A1 (en) Work machine
JPH09291560A (en) Locus controller of construction machine
CN111794298B (en) System for controlling movement of multiple links of an excavator
US20210355651A1 (en) Shovel
KR19990081852A (en) Control device of construction machinery
JP3497910B2 (en) Excavation area setting device for area restriction excavation control of construction machinery
JPH108490A (en) Front control device of construction machine and area setting method
JP3522878B2 (en) Excavation area setting device for area restriction excavation control of construction machinery
JP7314429B2 (en) working machine
JP3682352B2 (en) Front control device for construction machinery
JP3713358B2 (en) Front control device for construction machinery
JP2000355957A (en) Zone restrictive excavation controller for hydraulic shovel
CN115387413B (en) Intelligent auxiliary construction benchmark correction method and system for excavator and excavator
JPH0776453B2 (en) Work machine trajectory control device
JPH07317097A (en) Linear excavation work device
CN116234960A (en) Excavation position determination system, excavation control system, and construction machine
JP2605172B2 (en) Work machine trajectory control device

Legal Events

Date Code Title Description
FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20071128

Year of fee payment: 4

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20081128

Year of fee payment: 5

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20081128

Year of fee payment: 5

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20091128

Year of fee payment: 6

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20101128

Year of fee payment: 7

LAPS Cancellation because of no payment of annual fees