JP2001098585A - Excavating work guidance device and excavation control device for construction machine - Google Patents

Abstract

PROBLEM TO BE SOLVED: To accurately excavate even complicated three-dimensional topography changing in a shape of the excavating topography as target topography according to a movement of a construction machine and according to a movement of an excavating work machine such as a bucket. SOLUTION: A crossing line 58 of a plane 57 passing through a three- dimensional position of a present bucket 44 and three-dimensional target topography 51 is arithmetically operated, and a position of the crossing line 58 for showing the three-dimensional target topography 51 and a position of the bucket 44 are diaplayed on the same image screen 24a.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【０００１】[0001]

【発明の属する技術分野】本発明は、掘削用作業機を備
えた建設機械に関する。特にバケットなどの掘削用作業
機を作動させて３次元の地形を３次元の目標地形にする
掘削作業を行う際に掘削作業をガイダンスする装置に関
する。また上記掘削用作業機を制御する装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a construction machine provided with a working machine for excavation. In particular, the present invention relates to a device for guiding an excavation operation when an excavation operation such as a bucket is operated to convert a three-dimensional terrain into a three-dimensional target terrain. The present invention also relates to a device for controlling the excavating work machine.

【０００２】[0002]

【従来の技術】土木作業における法面の掘削は、作業者
の技量が最も要求される作業の一つである。たとえば傾
斜地に道路、鉄道またはビルなどの構造物を構築する場
合には、まず最初に切土または盛土などの作業を行って
必要な地盤を形成する。そしてその地盤の周囲の地面の
崩壊を防ぐために法面を形成する。2. Description of the Related Art Excavation of a slope in civil engineering work is one of the tasks requiring the most skill of workers. For example, when constructing a structure such as a road, a railroad, or a building on a slope, a necessary ground is first formed by performing work such as cutting or embankment. Then, a slope is formed to prevent collapse of the ground around the ground.

【０００３】この法面の加工をおこなう際には、高度な
加工精度が要求される。特に切土部分つまり掘削によっ
て得られる斜面に要求される加工精度は極めて高い。[0003] When machining this slope, a high degree of machining accuracy is required. In particular, the machining accuracy required for the cut portion, that is, the slope obtained by excavation, is extremely high.

【０００４】また掘削していない地山と掘削により掘り
起こされた地山とでは、その土の量が変化する。掘り起
こされた地山部分ではその密度が低くなっており、掘削
していない地山と比べてその強度が低下する。したがっ
て余分な掘削（これを余堀りと呼ぶ）を行ってしまうと
地盤の強度が低下する。このため法面の掘削をおこなう
際には、余堀りはできる限り避けねばならない。一旦、
余堀りを行ってしまうと、単に埋め戻すだけでは足り
ず、コンパクタなどを用いて法面を十分に締め固める必
要があり、その分作業の遅延を招くからである。このよ
うに法面の掘削作業は極めて精密に行わねばならず、む
やみに余堀りを行うことはできない。[0004] In addition, the amount of soil changes between the unexcavated ground and the ground excavated by excavation. The excavated ground part has a low density, and its strength is lower than that of the unexcavated ground. Therefore, if extra excavation is performed (this is called overdigging), the strength of the ground decreases. For this reason, when excavating slopes, overdigging should be avoided as much as possible. Once
This is because, if over-excavation is performed, simply backfilling is not sufficient, and it is necessary to sufficiently compact the slope using a compactor or the like, which delays the work. As described above, the excavation work on the slope has to be performed extremely precisely, and it is impossible to unnecessarily perform the excavation.

【０００５】掘削前の原地盤は、掘削後の目標法面より
も当然高いところに位置している。このため目標の法面
を直接水糸などで指示することはできない。そこで従来
より法面の掘削作業は油圧ショベルによってつぎのよう
にして行われていた。[0005] The original ground before excavation is naturally located higher than the target slope after excavation. For this reason, the target slope cannot be specified directly with a water thread or the like. Therefore, the excavation work of the slope has been conventionally performed by a hydraulic excavator as follows.

【０００６】すなわち、 １）原地盤の測量を行う。[0006] That is, 1) the survey of the original ground is performed.

【０００７】２）そして測量結果を記した杭と板を、原
地盤に設置する。これは帳張りと呼ばれる。[0007] 2) Then, a pile and a plate on which the results of the survey are recorded are placed on the original ground. This is called bookkeeping.

【０００８】３）そして油圧ショベルのオペレータは、
その板に記された角度と同様の角度の法面となるように
その板より一定距離下方まで（たとえば１メートル下ま
で）掘削する。つまり作業機用操作レバーを操作して油
圧ショベルの作業機を作動させる。3) The operator of the excavator
Excavation is performed a certain distance below the plate (for example, to one meter below) so that the slope has an angle similar to the angle written on the plate. That is, the operating lever of the hydraulic shovel is operated by operating the operating lever for the working machine.

【０００９】しかし上記帳張りを構築するためには、目
標地形に沿って多数点の精密な測量が必要である。この
ため測量作業に多大な時間を要する。さらには、その帳
張りに従って油圧ショベルを操作するオペレータにも極
めて高度な操作技量が要求される。[0009] However, in order to construct the above-mentioned bookkeeping, precise surveying of many points along the target terrain is required. Therefore, a long time is required for the surveying operation. Further, an operator who operates the hydraulic shovel according to the bookkeeping requires extremely high operation skill.

【００１０】しかも法面は傾斜地や山間地に形成される
ことが多く、その形状が単純な平面となることは稀であ
る。構造物（道路など）の形状や地山の形状に合わせた
複雑な３次元的曲面となることが多い。このためたとえ
上記帳張りに従って正確に作業がなされたとしても目標
とする地形に、完全には一致しないという問題点があっ
た。In addition, the slope is often formed on a slope or mountainous land, and its shape is rarely a simple plane. It often has a complicated three-dimensional curved surface that matches the shape of a structure (such as a road) or the shape of the ground. For this reason, there is a problem that even if the work is correctly performed in accordance with the above-mentioned bookkeeping, it does not completely match the target terrain.

【００１１】３次元の目標地形にする土工作業を行う際
にこの土工作業を補助するガイダンス装置に関する発明
が従来より特許出願等され公知になっている。An invention relating to a guidance device for assisting an earthwork operation when performing an earthwork operation to obtain a three-dimensional target terrain has been conventionally filed and publicly known.

【００１２】たとえば特開平２−２５２８２５号公報
（従来技術Ａ）には、現場全体を複数のブロックに区切
り、各ブロック毎に現在の地形と目標の地形との偏差を
求め、この偏差に応じた盛土量をそのブロックまで建設
機械に運搬させるという発明が記載されている。For example, Japanese Patent Application Laid-Open No. 2-252825 (Prior Art A) discloses that the entire site is divided into a plurality of blocks, and a deviation between the current terrain and a target terrain is determined for each block, and the deviation is determined according to the deviation. The invention is described in which the embankment amount is transported to a construction machine to the block.

【００１３】また特開平７−１８０１０７号公報（従来
技術Ｂ）には、道路工事の計画線データを記憶させ、ブ
ルドーザ、アスファルトフィニッシャー等のブレードの
現在の高さが上記工事計画線に沿った高さとなるように
ブレード高さを制御して道路に舗装材を敷設するという
発明が記載されている。Japanese Patent Application Laid-Open No. 7-180107 (Prior Art B) stores road construction plan line data, and the current height of blades such as bulldozers and asphalt finishers is set along the construction plan line. There is described an invention in which a pavement material is laid on a road by controlling the height of a blade so as to be as follows.

【００１４】さらに特開平６−７３７５５号公報（従来
技術Ｃ）には、バックホウのバケットの現在位置と、予
め決められた切土計画線とをディスプレイ上に表示する
という発明が記載されている。Further, Japanese Patent Application Laid-Open No. Hei 6-73755 (prior art C) discloses an invention in which the present position of a backhoe bucket and a predetermined cutting plan line are displayed on a display.

【００１５】また特開平１０−１０３９２５号公報（従
来技術Ｄ）には、油圧ショベルの車体に対するバケット
の相対的な位置を計測し、バケットの位置を表示画面上
に表示するという発明が記載されている。Japanese Patent Application Laid-Open No. 10-103925 (prior art D) discloses an invention in which the relative position of a bucket with respect to the body of a hydraulic shovel is measured and the position of the bucket is displayed on a display screen. I have.

【００１６】[0016]

【発明が解決しようとする課題】本発明が対象としてい
る作業は、道路などの構造物の法面を掘削する作業であ
る。この構造物の法面の形状は、場所に応じて変化す
る。つまり油圧ショベルの移動位置、上部旋回体により
バケットを旋回させたときのバケット位置が異なれば、
それに応じて掘削により得られるべき目標３次元地形は
異なる。The work to which the present invention is directed is the work of excavating a slope of a structure such as a road. The shape of the slope of this structure changes depending on the location. In other words, if the moving position of the excavator and the bucket position when the bucket is swung by the upper swing body are different,
The target three-dimensional terrain to be obtained by excavation differs accordingly.

【００１７】これに対して上記従来技術Ａには、油圧シ
ョベルで掘削作業を行う場合の適応例については記載さ
れていない。On the other hand, the above-mentioned prior art A does not describe an example of adaptation when excavating work is performed by a hydraulic shovel.

【００１８】また従来技術Ｂは、ブルドーザ、アスファ
ルトフィニッシャー等により、すでに掘削作業の終了し
た道路上に舗装材を敷設する敷設作業を対象としてい
る。しかもブレードの位置を計測しブレードの高さを計
測位置に合わせるならい制御であり、油圧ショベルには
適用することができない。よって現在の地形から目標地
形になるように地山を下方に掘削する掘削作業を対象と
する本発明とは本質的に異なる。Further, the prior art B is directed to a laying operation of laying a pavement material on a road which has already been excavated by a bulldozer, an asphalt finisher, or the like. Moreover, the control is performed as long as the position of the blade is measured and the height of the blade is adjusted to the measured position, and cannot be applied to a hydraulic shovel. Therefore, the present invention is essentially different from the present invention, which is directed to an excavation operation of excavating a ground below a current terrain so as to become a target terrain.

【００１９】また従来技術Ｃは、バックホウのバケット
の現在位置と、予め決められた切土計画線とをディスプ
レイ上に表示するものであり、表示内容から掘削作業を
ガイダンスすることができる。しかし従来技術Ｃは固定
的な切土計画線に沿って掘削することを前提としてい
る。本発明のように油圧ショベルが移動するに応じて、
バケットを旋回により移動させるに応じて、目標とする
法面の形状が変化する複雑な地形を掘削することを前提
とするものはない。目標とする法面の形状が逐次変化す
る複雑な地形を掘削させようとするには、油圧ショベル
が移動する毎に、バケットを旋回により移動させるに応
じて、法面の形状を入力し直す複雑な作業を要する。こ
のため従来技術Ｃは、場所に応じて法面の形状が変化す
る複雑な３次元地形の掘削に対しては、実用的ではない
という問題がある。In the prior art C, the current position of the backhoe bucket and a predetermined cutting plan line are displayed on a display, and the excavation work can be guided from the displayed contents. However, the prior art C is premised on excavating along a fixed cut planning line. As the excavator moves as in the present invention,
There is no premise for excavating a complex terrain in which the shape of the target slope changes as the bucket is moved by turning. In order to excavate complicated terrain where the shape of the target slope changes sequentially, it is necessary to re-enter the shape of the slope as the bucket is moved by turning each time the excavator moves. Work is required. For this reason, the prior art C has a problem that it is not practical for excavation of complicated three-dimensional terrain in which the shape of the slope changes depending on the place.

【００２０】また従来技術Ｄは車体との関係でバケット
の位置を表示するものであり、表示内容から掘削作業を
ガイダンスすることができる。しかし従来技術Ｄは目標
とする地形との関係でバケットを表示するものではな
い。よって単純な形状の法面の掘削作業に対しては有用
ではあろうが、場所によって形状が異なる複雑な形状の
法面の掘削に対しては有用ではない。In the prior art D, the position of the bucket is displayed in relation to the vehicle body. Excavation work can be guided from the displayed contents. However, the prior art D does not display buckets in relation to the target terrain. Therefore, it may be useful for digging a slope having a simple shape, but is not useful for digging a slope having a complicated shape whose shape varies depending on a place.

【００２１】本発明はこうした実状に鑑みてなされたも
のであり、建設機械が移動するに応じてまたバケット等
の掘削用作業機が移動するに応じて、その掘削すべき地
形の形状が変化する複雑な３次元地形であっても、目標
とする地形に精度よく掘削することができるようにする
ことを解決課題とするものである。The present invention has been made in view of such circumstances, and the shape of the terrain to be excavated changes as the construction machine moves and as the excavating work machine such as a bucket moves. An object of the present invention is to make it possible to excavate on a target terrain with high accuracy even on a complicated three-dimensional terrain.

【００２２】[0022]

【課題を解決するための手段および作用効果】上記解決
課題を達成するため、第１発明は、掘削用の作業機を作
動させて３次元の地形を３次元の目標地形にする掘削作
業を行う建設機械に適用され、当該掘削作業をガイダン
スする建設機械の掘削作業ガイダンス装置において、前
記掘削用作業機の３次元位置を計測する位置計測手段
と、前記位置計測手段により計測した掘削用作業機の位
置を通過する平面を演算する平面演算手段と、前記平面
演算手段によって演算された平面を示すデータと、前記
３次元目標地形を示すデータとに基づいて、前記平面と
前記３次元目標地形との交線を演算する交線演算手段
と、前記交線演算手段によって演算された前記３次元目
標地形を示す交線の位置と前記掘削用作業機の位置との
相対位置関係を提示する提示手段とを具えたことを特徴
とする。In order to achieve the above-mentioned object, a first aspect of the present invention is to perform an excavation operation by operating a work machine for excavation to convert a three-dimensional terrain into a three-dimensional target terrain. An excavation work guidance device for a construction machine applied to a construction machine and guiding the excavation work, wherein a position measurement unit that measures a three-dimensional position of the excavation work machine, and an excavation work machine that is measured by the position measurement unit. Plane calculating means for calculating a plane passing through a position; data indicating the plane calculated by the plane calculating means; and data indicating the three-dimensional target terrain, based on the data indicating the three-dimensional target terrain. Intersection calculation means for calculating the intersection, and a relative positional relationship between the position of the intersection indicating the three-dimensional target terrain calculated by the intersection calculation means and the position of the excavator is presented. And characterized in that it comprises a a presentation means.

【００２３】また第２発明は、作業機の先端部にバケッ
トが設けられ、当該作業機を作動させて３次元の地形を
３次元の目標地形にする掘削作業を行う建設機械に適用
され、当該掘削作業をガイダンスする建設機械の掘削作
業ガイダンス装置において、前記バケットの３次元位置
を計測する位置計測手段と、前記位置計測手段により計
測したバケット位置を通過する平面を演算する平面演算
手段と、前記平面演算手段によって演算された平面を示
すデータと、前記３次元目標地形を示すデータとに基づ
いて、前記平面と前記３次元目標地形との交線を演算す
る交線演算手段と、前記交線演算手段によって演算され
た前記３次元目標地形を示す交線の位置と前記バケット
の位置とを同一画面上に表示する表示手段とを具えたこ
とを特徴とする。Further, the second invention is applied to a construction machine in which a bucket is provided at the tip of the work machine, and the work machine is operated to perform excavation work for converting the three-dimensional terrain to the three-dimensional target terrain. An excavation work guidance device for a construction machine for guiding excavation work, wherein: a position measuring means for measuring a three-dimensional position of the bucket; a plane calculating means for calculating a plane passing through a bucket position measured by the position measuring means; Intersection calculating means for calculating an intersection between the plane and the three-dimensional target terrain based on the data indicating the plane calculated by the plane calculating means and the data indicating the three-dimensional target terrain; A display means for displaying the position of the intersection line indicating the three-dimensional target terrain calculated by the calculation means and the position of the bucket on the same screen.

【００２４】第１発明、第２発明によれば、図６（ａ）
に示すように現在のバケット４４の３次元位置を通過す
る平面５７と、３次元目標地形５１との交線５８が演算
され、図６（ｂ）に示すように、３次元目標地形５１を
示す交線５８の位置とバケット４４の位置とが同一画面
２４ａ上に表示される。According to the first invention and the second invention, FIG.
The intersection line 58 between the plane 57 passing through the current three-dimensional position of the bucket 44 and the three-dimensional target terrain 51 is calculated as shown in FIG. 6 and the three-dimensional target terrain 51 is shown as shown in FIG. The position of the intersection line 58 and the position of the bucket 44 are displayed on the same screen 24a.

【００２５】第１発明、第２発明によれば建設機械が移
動するに応じてまたバケット４４等の掘削用作業機が移
動するに応じて、掘削すべき地形の形状が変化する複雑
な３次元地形であっても、現在のバケット４４の位置に
対応する目標地形５１を示す交線５８の位置を、バケッ
ト４４の位置との関係で表示することができる。複雑な
形状の３次元地形をバケット４４との位置関係でオペレ
ータに分かりやすく表示することができる。よって本発
明によれば、場所によって掘削すべき地形の形状が異な
る複雑な３次元地形を、精度よく掘削することができ
る。According to the first and second aspects of the present invention, the shape of the terrain to be excavated changes as the construction machine moves and as the excavator such as the bucket 44 moves. Even in the case of the terrain, the position of the intersection line 58 indicating the target terrain 51 corresponding to the current position of the bucket 44 can be displayed in relation to the position of the bucket 44. The three-dimensional terrain having a complicated shape can be displayed in an easy-to-understand manner for the operator in the positional relationship with the bucket 44. Therefore, according to the present invention, it is possible to excavate a complicated three-dimensional terrain in which the shape of the terrain to be excavated varies depending on the location.

【００２６】なお第１発明の「掘削用作業機」はバケッ
ト以外のあらゆる掘削用作業機を含む概念である。また
第１発明の「提示手段」は表示手段以外のあらゆる情報
提示手段を含む概念である。たとえばグラフィック表示
に限ることなく、交線５８とバケット４４との相対的な
位置関係を、数値でオペレータに提示してもよい。また
交線５８とバケット４４との相対的な位置関係を音声に
よってオペレータに提示してもよい。The "working machine for digging" of the first invention is a concept including all working machines for digging other than buckets. The "presenting means" of the first invention is a concept including all information presenting means other than the display means. For example, without being limited to the graphic display, the relative positional relationship between the intersection line 58 and the bucket 44 may be presented to the operator by numerical values. Further, the relative positional relationship between the intersection line 58 and the bucket 44 may be presented to the operator by voice.

【００２７】第３発明は、第２発明において、前記位置
計測手段は、前記バケットの先端の３次元位置を計測す
るものであり、前記平面演算手段は、前記バケットの先
端位置を通過する平面を演算するものであることを特徴
とする。In a third aspect based on the second aspect, the position measuring means measures a three-dimensional position of a tip of the bucket, and the plane calculating means calculates a plane passing through the tip of the bucket. It is characterized by calculating.

【００２８】第３発明によれば、図６（ａ）に示すよう
に、バケット４４の先端４４ａの３次元位置が計測さ
れ、このバケット先端４４ａを通過する平面５７が演算
される。According to the third aspect, as shown in FIG. 6A, the three-dimensional position of the tip 44a of the bucket 44 is measured, and the plane 57 passing through the bucket tip 44a is calculated.

【００２９】第４発明は、第１発明または第２発明にお
いて、前記掘削用作業機または前記バケットはアクチュ
エータが駆動されることにより作動するものであり、前
記平面演算手段は、前記アクチュエータが駆動されたと
きに前記掘削用作業機または前記バケットが作動する面
を含む平面を演算するものであることを特徴とする。According to a fourth invention, in the first invention or the second invention, the excavating work machine or the bucket is operated by driving an actuator, and the plane calculating means is configured to drive the actuator. And calculating a plane including a surface on which the excavating work machine or the bucket operates.

【００３０】第４発明によれば、図４（ａ）に示すよう
に掘削用作業機またはバケット４４はアクチュエータ
（油圧シリンダ）が駆動されることにより作動する。そ
して図４（ｂ）に示すようにアクチュエータが駆動され
たときに掘削用作業機またはバケット４４が作動する面
を含む平面５７′が演算される。According to the fourth invention, as shown in FIG. 4 (a), the excavating work machine or the bucket 44 operates by driving an actuator (hydraulic cylinder). Then, as shown in FIG. 4B, a plane 57 'including the surface on which the excavator or bucket 44 operates when the actuator is driven is calculated.

【００３１】このように建設機械４０の車体４１が地面
に対して傾斜している場合、バケット４４はオフセット
されている場合であったとしても、アクチュエータが駆
動されたときのバケット４４の移動軌跡に含む平面５
７′が確実に求められる。そしてこの平面５７′と３次
元目標地形５１との交線５８′が求められ、表示画面２
４ａ上に表示される。このためアクチュエータを駆動さ
せてバケット４４を交線５８′に沿って移動させれば、
傾斜、オフセット等のバケット位置の変化、ずれがあっ
たとしても、目標地形５１を常に精度よく掘削すること
ができる。As described above, when the vehicle body 41 of the construction machine 40 is inclined with respect to the ground, even if the bucket 44 is offset, the movement path of the bucket 44 when the actuator is driven is determined. Plane 5 including
7 'is definitely required. Then, an intersection line 58 'between the plane 57' and the three-dimensional target terrain 51 is obtained, and the display screen 2
4a. Therefore, by driving the actuator to move the bucket 44 along the intersection line 58 ',
The target terrain 51 can always be excavated with high accuracy even if there is a change or displacement of the bucket position such as inclination or offset.

【００３２】第５発明は、第１発明または第２発明にお
いて、現在の３次元地形データと、目標構造物の縁部の
３次元形状を示すデータと、法面の形状データとに基づ
いて、前記目標構造物の縁部を法尻とする３次元目標地
形のデータを作成する３次元目標地形データ作成手段を
さらに具えたことを特徴とする。In a fifth aspect based on the first or second aspect, the current three-dimensional topographic data, the data indicating the three-dimensional shape of the edge of the target structure, and the shape data of the slope are based on: The apparatus further includes a three-dimensional target terrain data creating unit that creates three-dimensional target terrain data having an edge of the target structure as a bottom.

【００３３】第５発明によれば、図５に示すように、現
在の３次元地形５０のデータと、目標構造物５２の縁部
５３の形状を示すデータと、法面５４の形状を示すデー
タとに基づいて、目標構造物５２の縁部５３を法尻とす
る３次元目標地形５１のデータが作成される。簡単なデ
ータを入力するだけで複雑な３次元目標地形５１を自動
的に作成することができる。According to the fifth aspect, as shown in FIG. 5, data of the current three-dimensional topography 50, data indicating the shape of the edge 53 of the target structure 52, and data indicating the shape of the slope 54. Based on the above, data of the three-dimensional target terrain 51 with the edge 53 of the target structure 52 as the bottom is created. A complicated three-dimensional target terrain 51 can be automatically created simply by inputting simple data.

【００３４】第６発明は、掘削用の作業機を作動させて
３次元の地形を３次元の目標地形にする掘削作業を行う
建設機械に適用され、前記掘削用作業機を制御する建設
機械の掘削制御装置において、前記掘削用作業機の３次
元位置を計測する位置計測手段と、前記位置計測手段に
より計測した掘削用作業機の位置を通過する平面を演算
する平面演算手段と、前記平面演算手段によって演算さ
れた平面を示すデータと、前記３次元目標地形を示すデ
ータとに基づいて、前記平面と前記３次元目標地形との
交線を演算する交線演算手段と、前記交線演算手段によ
って演算された前記３次元目標地形を示す交線を、目標
移動経路とし、当該目標移動経路に沿って前記掘削用作
業機が移動するように当該掘削用作業機を制御する制御
手段とを具えたことを特徴とする。The sixth invention is applied to a construction machine which performs an excavation operation by operating a work machine for excavation to convert a three-dimensional terrain into a three-dimensional target terrain. In the excavation control device, position measurement means for measuring a three-dimensional position of the work equipment for excavation, plane calculation means for calculating a plane passing through the position of the work equipment for excavation measured by the position measurement means, and the plane calculation Intersection calculating means for calculating a line of intersection between the plane and the three-dimensional target terrain based on the data indicating the plane calculated by the means and the data indicating the three-dimensional target terrain, and the intersection calculating means Control means for controlling the excavation work machine so that the excavation work machine moves along the target movement path, using the intersection line indicating the three-dimensional target terrain calculated by the above as a target movement path. Octopus The features.

【００３５】第６発明によれば、図６（ａ）に示すよう
に現在のバケット４４の３次元位置を通過する平面５７
と、３次元目標地形５１との交線５８が演算される。According to the sixth invention, as shown in FIG. 6A, the plane 57 passing through the current three-dimensional position of the bucket 44 is used.
Then, an intersection line 58 with the three-dimensional target terrain 51 is calculated.

【００３６】そして図１０に示すように、３次元目標地
形５１を示す交線５８が目標移動経路Ｔcとされ、この
目標移動経路Ｔcに沿ってバケット４４が移動するよう
にバケット４４が制御される。As shown in FIG. 10, the intersection line 58 indicating the three-dimensional target terrain 51 is set as the target moving path Tc, and the bucket 44 is controlled so that the bucket 44 moves along the target moving path Tc. .

【００３７】よって本発明によれば、場所によって掘削
すべき地形の形状が異なる複雑な３次元地形を、精度よ
く掘削することができる。この場合オペレータがバケッ
ト４４を操作せずとも自動的に掘削作業がなされる。よ
って第１発明、第２発明の効果に加えて、オペレータの
労力が軽減されるという効果が得られる。Therefore, according to the present invention, it is possible to excavate a complicated three-dimensional terrain in which the shape of the terrain to be excavated differs depending on the location with high accuracy. In this case, excavation work is automatically performed without the operator operating the bucket 44. Therefore, in addition to the effects of the first invention and the second invention, an effect that the labor of the operator is reduced is obtained.

【００３８】第７発明は、掘削用の作業機を作動させて
３次元の地形を３次元の目標地形にする掘削作業を行う
建設機械に適用され、掘削用操作手段の操作に応じて前
記掘削用作業機を制御する作業機コントローラを備えた
建設機械の掘削制御装置において、前記建設機械に外部
より装着自在であって、前記３次元目標地形のデータ
を、前記作業機コントローラに出力する外部コントロー
ラと、前記掘削用操作手段の操作に応じて前記掘削用作
業機を制御する第１の制御モードと、前記３次元目標地
形データに基づき当該３次元目標地形上の目標移動経路
に沿って前記掘削用作業機が移動するように当該掘削用
作業機を制御する第２の制御モードのいずれかの制御モ
ードを選択する制御モード選択手段と、前記外部コント
ローラが前記建設機械に装着されているか否かを判断す
る判断手段と、前記判断手段によって前記外部コントロ
ーラが前記建設機械に装着されていると判断された場合
には、前記制御モード選択手段の選択結果に応じた制御
モードを前記作業機コントローラで実行させ、前記判断
手段によって前記外部コントローラが前記建設機械に装
着されていないと判断された場合には、前記制御モード
選択手段の選択いかんにかかわらず前記第１の制御モー
ドを前記作業機コントローラで実行させることを特徴と
する。The seventh invention is applied to a construction machine which performs excavation work by operating a work machine for excavation to convert a three-dimensional terrain into a three-dimensional target terrain. An excavation control device for a construction machine having a work machine controller for controlling a work machine, wherein the external controller is attachable to the construction machine from the outside and outputs the three-dimensional target terrain data to the work machine controller. A first control mode for controlling the excavating work machine in accordance with the operation of the excavating operation means, and the excavation along a target movement path on the three-dimensional target terrain based on the three-dimensional target terrain data. Mode selection means for selecting any one of the second control modes for controlling the excavating work machine so that the work machine moves, and the external controller comprises Determining means for determining whether or not the external controller is mounted on the construction machine; and determining whether or not the external controller is mounted on the construction machine by the control mode selecting means. A mode is executed by the work machine controller, and when the determination unit determines that the external controller is not mounted on the construction machine, the first control is performed regardless of the selection of the control mode selection unit. A mode is executed by the work machine controller.

【００３９】第７発明によれば、図１に示すように、外
部コントローラ２５が建設機械に装着されていると判断
された場合には、制御モード選択手段１３の選択結果に
応じた制御モードが作業機コントローラ２１で実行され
る。すなわち第１の制御モードが選択されると、掘削用
操作手段１１の操作に応じて掘削用作業機が制御され
る。また第２の制御モードが選択されると外部コントロ
ーラ２５から出力される３次元目標地形データに基づき
当該３次元目標地形上の目標移動経路に沿って掘削用作
業機が移動するように当該掘削用作業機が制御される。According to the seventh aspect, as shown in FIG. 1, when it is determined that the external controller 25 is mounted on the construction machine, the control mode according to the selection result of the control mode selection means 13 is changed. This is executed by the work machine controller 21. That is, when the first control mode is selected, the excavating work machine is controlled in accordance with the operation of the excavating operation means 11. Further, when the second control mode is selected, the excavating work machine moves based on the three-dimensional target terrain data output from the external controller 25 along the target movement path on the three-dimensional target terrain. The work machine is controlled.

【００４０】しかし外部コントローラ２５が建設機械に
装着されていないと判断された場合には、外部コントロ
ーラ２５からは３次元目標地形データが作業機コントロ
ーラ２１に出力されていない状態である。このため制御
モード選択手段１３の選択いかんにかかわらず第１の制
御モードが作業機コントローラ２１で実行される。すな
わち掘削用操作手段１１の操作に応じて掘削用作業機が
制御される。However, when it is determined that the external controller 25 is not mounted on the construction machine, the external controller 25 has not output the three-dimensional target terrain data to the work machine controller 21. Therefore, the first control mode is executed by the work implement controller 21 irrespective of the selection of the control mode selection means 13. That is, the work machine for excavation is controlled according to the operation of the operation means 11 for excavation.

【００４１】第７発明によれば、外部コントローラ２５
が装着されているときのみ、制御モードの切り替え選択
が有効であると判定し外部コントローラ２５が未装着な
場合には操作手段１１に応じた制御のみを実行させるよ
うしているので、外部コントローラ２５が未装着な場合
の誤動作を防止することができる。According to the seventh aspect, the external controller 25
Only when is mounted, it is determined that the control mode switching selection is valid, and when the external controller 25 is not mounted, only the control according to the operation means 11 is executed. Can be prevented from malfunctioning when the device is not mounted.

【００４２】[0042]

【発明の実施の形態】以下図面を参照して、本発明に係
る掘削作業ガイダンス装置および掘削制御装置の実施の
形態について説明する。BRIEF DESCRIPTION OF THE DRAWINGS FIG. 1 is an exploded perspective view of an excavation work guidance apparatus and an excavation control apparatus according to the present invention.

【００４３】図３は、実施形態の建設機械の幾何的関係
を示す図である。建設機械としては油圧ショベル４０を
想定している。図３（ａ）は油圧ショベル４０の側面図
であり、図３（ｂ）は油圧ショベル４０の後面図であ
る。FIG. 3 is a diagram showing a geometric relationship of the construction machine according to the embodiment. The hydraulic excavator 40 is assumed as a construction machine. FIG. 3A is a side view of the excavator 40, and FIG. 3B is a rear view of the excavator 40.

【００４４】同図３に示すように油圧ショベル４０の車
体４１の下部には履帯４９が設けられている。履帯４９
が回転することにより油圧ショベル４０は走行する。車
体４１の前方には、ブーム４２、アーム４３、バケット
４４からなる作業機４７が設けられている。ブーム４
２、アーム４３、バケット４４の長さはそれぞれ、Ｌ
1、Ｌ2、Ｌ3である。作業機４７は、車体４１に対して
ブーム４２、アーム４３、バケット４４が順次連結され
るように構成されている。ブーム４２の根元４２ｄは車
体４１の前方所定箇所に連結されている。作業機４７の
先端部には、土砂を掘削する掘削用作業機としてのバケ
ット４４が設けられている。バケット４４の先端は４４
ａで示される。車体４１（上部旋回体）は履帯４９（下
部旋回体）に対して相対的に旋回移動される。したがっ
て旋回に伴い作業機４７の位置、バケット４４の位置が
変化する。As shown in FIG. 3, a crawler belt 49 is provided below the body 41 of the excavator 40. Crawler track 49
The hydraulic excavator 40 travels by rotating. A work machine 47 including a boom 42, an arm 43, and a bucket 44 is provided in front of the vehicle body 41. Boom 4
2, the length of the arm 43 and the bucket 44 are L
1, L2 and L3. The work machine 47 is configured such that the boom 42, the arm 43, and the bucket 44 are sequentially connected to the vehicle body 41. The base 42d of the boom 42 is connected to a predetermined location in front of the vehicle body 41. At the tip of the working machine 47, a bucket 44 as an excavating working machine for excavating earth and sand is provided. The tip of the bucket 44 is 44
a. The vehicle body 41 (upper revolving structure) is revolved relative to the crawler belt 49 (lower revolving structure). Therefore, the position of the work implement 47 and the position of the bucket 44 change with the turning.

【００４５】ブーム４２、アーム４３、バケット４４に
は、それぞれ傾斜角センサ２７、２８、２９が設けられ
ている。傾斜角センサ２７、２８、２９ではそれぞれ、
ブーム４２の重力方向（鉛直下方）に対する傾斜角θ
1、アーム４３の重力方向に対する傾斜角θ2、バケット
４４の重力方向に対する傾斜角θ3が検出される。The boom 42, the arm 43, and the bucket 44 are provided with inclination angle sensors 27, 28, 29, respectively. In the inclination angle sensors 27, 28, 29, respectively,
Tilt angle θ of boom 42 with respect to the direction of gravity (vertical downward)
1. The inclination angle θ2 of the arm 43 with respect to the direction of gravity and the inclination angle θ3 of the bucket 44 with respect to the direction of gravity are detected.

【００４６】車体４１には、２つのＲＴＫ−ＧＰＳ（Re
aＬ Time Kinematic-GＬobaＬ Positioning System）用
アンテナ４５、４６が車体座標系Ｘ1−Ｙ1−Ｚ1のＹ1軸
（水平軸）に沿って一定距離だけ離間して設けられてい
る。ＧＰＳアンテナ４５、４６で受信されたＧＰＳ電波
に応じた信号は３次元位置センサ３０（ＧＰＳ位置セン
サ）に入力される。３次元位置センサ３０では、ＧＰＳ
アンテナ４５、４６の設置位置Ｐ1、Ｐ2の位置が検出さ
れる。なお図３（ｂ）は車体４１が重力方向（鉛直線）
に対してθ0だけ傾斜した状態を示している。The vehicle body 41 has two RTK-GPSs (Re
aL Time Kinematic-GLobaL Positioning System) antennas 45, 46 are provided at a fixed distance along the Y1 axis (horizontal axis) of the vehicle body coordinate system X1-Y1-Z1. Signals corresponding to the GPS radio waves received by the GPS antennas 45 and 46 are input to the three-dimensional position sensor 30 (GPS position sensor). In the three-dimensional position sensor 30, the GPS
The positions of the installation positions P1, P2 of the antennas 45, 46 are detected. FIG. 3B shows the vehicle body 41 in the direction of gravity (vertical line).
3 shows a state inclined by θ0.

【００４７】図４はオフセットブームを備えた油圧ショ
ベル４０を示している。図４（ａ）は側面図であり、図
４（ｂ）は図４（ａ）の矢視Ａ図である。この作業機
は、車体４１に対して第１ブーム４２ａ、第２ブーム４
２ｂ、オフセットブーム４２ｃ、アーム４３、バケット
４４が順次連結されるように構成されている。FIG. 4 shows a hydraulic excavator 40 having an offset boom. FIG. 4A is a side view, and FIG. 4B is an A view of FIG. This work machine is configured such that a first boom 42a, a second boom 4
2b, the offset boom 42c, the arm 43, and the bucket 44 are sequentially connected.

【００４８】図４（ｂ）に示すようにオフセットブーム
４２ｃは車体４１に対して左右に回動（オフセット動
作）自在となっている。オフセットブーム４２ｃが第１
ブーム４２ａに対してオフセット角θ4だけ左右に傾斜
されると、このオフセット角θ4に応じたオフセット分
だけバケットは４４から４４′へと左右にオフセットさ
れる。オフセット動作前のバケット４４が移動する移動
経路を含む平面を５７とすると、オフセット動作後のバ
ケット４４′が移動する移動経路を含む平面は５７′と
なる。平面５７と平面５７′とはオフセット分だけずれ
ている。As shown in FIG. 4B, the offset boom 42c is rotatable left and right (offset operation) with respect to the vehicle body 41. Offset boom 42c is the first
When the bucket is inclined left and right by an offset angle θ4 with respect to the boom 42a, the bucket is offset left and right from 44 to 44 ′ by an offset corresponding to the offset angle θ4. Assuming that the plane including the movement path of the bucket 44 before the offset operation is 57, the plane including the movement path of the bucket 44 'after the offset operation is 57'. The plane 57 and the plane 57 'are shifted by an offset.

【００４９】図１、図２は油圧ショベル４０に搭載され
る制御装置の構成を示すブロック図である。図１は角度
センサ２７、２８、２９が油圧ショベル４０に標準で装
着されていない場合に後からこれら角度センサを装着し
たときの構成を示すブロック図である。一方図２は角度
センサ２７、２８、２９が油圧ショベル４０に標準で装
着されている場合の構成を示すブロック図である。FIGS. 1 and 2 are block diagrams showing the configuration of a control device mounted on the excavator 40. FIG. 1 is a block diagram showing a configuration when the angle sensors 27, 28, and 29 are not mounted as standard on the hydraulic excavator 40, and are later mounted. FIG. 2 is a block diagram showing a configuration in which the angle sensors 27, 28, and 29 are mounted on the hydraulic excavator 40 as standard.

【００５０】本実施形態では、掘削用操作レバー１１の
操作に応じて作業機４７を制御する第１の制御モード
と、後述するように目標移動経路に沿ってバケット先端
４４ａが移動するように作業機４７を制御する第２の制
御モードのいずれかが実行される。第１の制御モードお
よび第２の制御モードは作業機制御コントローラ２１で
実行される。目標移動経路を演算するために必要な３次
元目標地形データは外部コントローラ２５から出力され
る。In the present embodiment, the first control mode for controlling the work implement 47 in accordance with the operation of the excavating operation lever 11 and the work for moving the bucket tip 44a along the target movement path as described later. One of the second control modes for controlling the machine 47 is executed. The first control mode and the second control mode are executed by the work implement controller 21. The three-dimensional target terrain data necessary for calculating the target movement route is output from the external controller 25.

【００５１】油圧ショベル４０は汎用機械であり、常時
目標移動経路に沿ってバケット４４を自動的に移動させ
るという第２の制御モードを必要とするわけではない。
すなわち特に精度を要求されない掘削作業や、３次元Ｃ
ＡＤデータなしで行う掘削作業も同じ油圧ショベルで行
わせる必要がある。そこで本実施形態では、通常の油圧
ショベル４０に対して、第２の制御モードの機能を後付
けで装着できるように構成されている。The hydraulic excavator 40 is a general-purpose machine, and does not necessarily require the second control mode of automatically moving the bucket 44 along the target moving path at all times.
That is, excavation work that does not particularly require precision,
Excavation work performed without AD data also needs to be performed by the same hydraulic excavator. Thus, in the present embodiment, the function of the second control mode can be retrofitted to the normal hydraulic excavator 40.

【００５２】第２の制御モードを作業機制御コントロー
ラ２１で実行させるのに必要な機能は、外部コントロー
ラ２５に分担させている。この外部コントローラ２５は
油圧ショベル４０の外部より装着自在となっている。The functions necessary for causing the work implement controller 21 to execute the second control mode are assigned to the external controller 25. The external controller 25 can be mounted from outside the hydraulic excavator 40.

【００５３】図１に示すように、油圧ショベル４０の作
業機４７は油圧シリンダ２３が駆動されることにより作
動される。すなわちブーム４２、アーム４３、バケット
４４毎に油圧シリンダが設けられている。作業機４７は
作業機用操作レバー１１が操作されることに応じて作動
される。ブーム４２、アーム４３、バケット４４毎に操
作レバーが設けられている。操作レバー１２は後述する
ように移動経路をオフセットさせるために用いられるレ
バーである。操作切換スイッチ１３は第１の制御モード
と第２の制御モードのいずれかの制御モードを選択して
切り換えるスイッチである。操作レバー１１、１２、操
作切換スイッチ１３によって入力装置１０が構成されて
いる。As shown in FIG. 1, the working machine 47 of the excavator 40 is operated by driving the hydraulic cylinder 23. That is, a hydraulic cylinder is provided for each of the boom 42, the arm 43, and the bucket 44. The work machine 47 is operated in response to the operation of the work machine operation lever 11. An operation lever is provided for each of the boom 42, the arm 43, and the bucket 44. The operation lever 12 is a lever used to offset the movement path as described later. The operation changeover switch 13 is a switch for selecting and switching any one of the first control mode and the second control mode. The input device 10 includes the operation levers 11 and 12 and the operation changeover switch 13.

【００５４】外部コントローラ２５には後述するように
３次元目標地形を示すデータが所定のメモリに記憶され
ている。外部コントローラ２５にはグラフィックインタ
ーフェース（ＧＵＩ）２４とセンサ群２６が接続されて
いる。センサ群２６は角度センサ２７〜２９と３次元位
置センサ３０とからなる。外部コントローラ２５では、
３次元位置センサ３０の検出結果と角度センサ２７〜２
９の検出結果とに基づきバケット先端４４ａの位置Ｐgt
が演算される。そしてこのバケット先端４４ａの位置Ｐ
gtと上記メモリに記憶された３次元目標地形５１のデー
タとに基づいてバケット先端４４ａが移動すべき３次元
目標地形５１上の交線５８が演算される。そしてこれら
バケット４４（バケット先端４４ａ）と交線５８との相
対位置関係が、グラフィックインターフェース２４上に
設けられた表示画面２４ａに表示される（図６参照）。
またグラフィックインターフェース２４上には、自動掘
削開始ボタン２４ｂが設けられている。この自動掘削開
始ボタン２４ｂがオンされている間、移動指令が外部コ
ントローラ２５に入力される。グラフィックインターフ
ェース２４上には、目標移動経路Ｔc上の移動方法、移
動速度を指定するスイッチが設けられている。The external controller 25 stores data indicating a three-dimensional target terrain in a predetermined memory as described later. A graphic interface (GUI) 24 and a sensor group 26 are connected to the external controller 25. The sensor group 26 includes angle sensors 27 to 29 and a three-dimensional position sensor 30. In the external controller 25,
Detection results of three-dimensional position sensor 30 and angle sensors 27-2
9, the position Pgt of the bucket tip 44a
Is calculated. And the position P of this bucket tip 44a
Based on gt and the data of the three-dimensional target terrain 51 stored in the memory, an intersection line 58 on the three-dimensional target terrain 51 to which the bucket tip 44a should move is calculated. Then, the relative positional relationship between the bucket 44 (bucket tip 44a) and the intersection line 58 is displayed on a display screen 24a provided on the graphic interface 24 (see FIG. 6).
On the graphic interface 24, an automatic excavation start button 24b is provided. While the automatic excavation start button 24b is on, a movement command is input to the external controller 25. A switch is provided on the graphic interface 24 for designating a moving method and a moving speed on the target moving path Tc.

【００５５】外部コントローラ２５から作業機制御コン
トローラ２１に対して、３次元目標地形５１のデータ、
３次元位置センサ３０で検出される車体４１上の位置デ
ータＰ1、Ｐ2、目標移動経路Ｔc上の移動方法および移
動速度を指示する移動方法/移動速度指令データ、自動
掘削開始ボタン２４ｂの操作に応じた移動指令データ、
角度センサ２７〜２９で検出されたブーム４２等の現在
角度データがそれぞれ出力される。From the external controller 25 to the work machine control controller 21, data of the three-dimensional target terrain 51,
According to the position data P1, P2 on the vehicle body 41 detected by the three-dimensional position sensor 30, the moving method / moving speed command data for instructing the moving method and moving speed on the target moving path Tc, and the operation of the automatic excavation start button 24b. Movement command data,
Current angle data of the boom 42 and the like detected by the angle sensors 27 to 29 are output respectively.

【００５６】作業機制御コントローラ２１では、入力装
置１０から入力された操作指示信号、外部コントローラ
２５から入力されたデータに基づき、作業機４７を作動
させるための制御信号が生成され、比例制御弁２２に出
力される。The work machine control controller 21 generates a control signal for operating the work machine 47 based on the operation instruction signal input from the input device 10 and the data input from the external controller 25, and generates a proportional control valve 22. Is output to

【００５７】すなわち操作切換スイッチ１３により第１
の制御モードが選択操作されている場合には、操作レバ
ー１１の操作に応じて作業機４７を作動させるための制
御信号が生成、出力される。また操作切換スイッチ１３
により第２の制御モードが選択操作されている場合に
は、外部コントローラ２５から入力された３次元目標地
形データ等に基づいて目標移動経路Ｔcが作成され、目
標移動経路Ｔcに沿ってバケット先端４４ａを自動的に
移動させるための制御指令が生成、出力される。ただし
自動掘削開始ボタン２４ｂがオンされ移動指令が入力さ
れている間だけバケット先端４４ａが目標移動経路Ｔc
に沿って自動的に移動される（図１０参照）。つまり上
記交線５８を目標移動経路Ｔcとして掘削作業が自動的
に行われる。自動掘削開始ボタン２４ｂがオペレータの
手が離れ移動指令が入力されなくなると、かかる自動的
な掘削作業は行われない。That is, the operation changeover switch 13 causes the first
When the control mode is selected, a control signal for operating the work implement 47 in accordance with the operation of the operation lever 11 is generated and output. Operation switch 13
When the second control mode is selected, the target travel path Tc is created based on the three-dimensional target terrain data input from the external controller 25, and the bucket tip 44a is formed along the target travel path Tc. Is automatically generated and output. However, only when the automatic excavation start button 24b is turned on and the movement command is input, the bucket tip 44a moves to the target movement path Tc.
(See FIG. 10). That is, excavation work is automatically performed using the intersection line 58 as the target movement path Tc. When the automatic excavation start button 24b leaves the operator's hand and no movement command is input, such automatic excavation work is not performed.

【００５８】作業機制御コントローラ２１から出力され
た制御指令は、比例制御弁２２に加えられる。比例制御
弁２２からは加えられた制御指令に応じた流量の圧油が
流出され、油圧シリンダ２３に供給される。油圧シリン
ダ２３は、比例制御弁２２から供給された圧油に応じて
駆動される。油圧シリンダ２３が駆動されるに応じて作
業機４７が作動される。The control command output from the work implement control controller 21 is applied to the proportional control valve 22. From the proportional control valve 22, pressure oil of a flow rate according to the applied control command flows out and is supplied to the hydraulic cylinder 23. The hydraulic cylinder 23 is driven according to the pressure oil supplied from the proportional control valve 22. The work implement 47 is operated in response to the driving of the hydraulic cylinder 23.

【００５９】なお外部コントローラ２５で目標移動経路
Ｔcを作成して、この目標移動経路Ｔcを示すデータを作
業機制御コントローラ２１に出力してもよい。The external controller 25 may create the target moving path Tc, and output data indicating the target moving path Tc to the work implement controller 21.

【００６０】ただし図２に示すように、角度センサ２７
〜２９が作業機制御コントローラ２１に接続されている
場合には、作業機制御コントローラ２１から外部コント
ローラ２５に対してブーム４２等の現在角度を示すデー
タが出力される。これにより外部コントローラ２５にお
いてバケット先端位置Ｐgtを求め交線５８を演算するこ
とが可能となる。However, as shown in FIG.
In the case where .about.29 are connected to the work implement control controller 21, the work implement control controller 21 outputs data indicating the current angle of the boom 42 and the like to the external controller 25. This allows the external controller 25 to determine the bucket tip position Pgt and calculate the intersection line 58.

【００６１】なお外部コントローラ２５としては、上述
したように３次元データを記憶する高度なものだけでは
なく、スキャン式レーザなどを用いて２次元データを記
憶する単純なものでもよい。The external controller 25 is not limited to an advanced controller for storing three-dimensional data as described above, but may be a simple controller for storing two-dimensional data using a scanning laser or the like.

【００６２】外部コントローラ２５が車体４１に装着さ
れているか否かは、外部コントローラ２５のコネクタに
接続されているか否かにより車体４１に設けた他のコン
トローラにより判断される。車体４１内の複数のコント
ローラは信号線によってシリアルに接続されており、信
号線上をフレーム信号が伝送されることにより、コント
ローラ間でデータが授受される。そしてフレーム信号が
信号線上を伝送することにより、各コントローラに接続
されたセンサ、アクチュエータのエラー等の異常判定が
行われる。したがって外部コントローラ２５が装着され
ているときには、この外部コントローラ２５に接続され
た角度センサ２７〜２９および３次元位置センサ３０な
どの異常判定が行われる。Whether or not the external controller 25 is mounted on the vehicle body 41 is determined by another controller provided on the vehicle body 41 based on whether or not the external controller 25 is connected to the connector of the external controller 25. A plurality of controllers in the vehicle body 41 are serially connected by signal lines, and data is transmitted and received between the controllers by transmitting a frame signal on the signal lines. Then, by transmitting the frame signal on the signal line, abnormality determination such as an error of a sensor or an actuator connected to each controller is performed. Therefore, when the external controller 25 is mounted, abnormality determination of the angle sensors 27 to 29 and the three-dimensional position sensor 30 connected to the external controller 25 is performed.

【００６３】異常があった場合にはその旨がたとえば表
示画面２４ｂに表示される。そしてたとえオペレータが
第２の制御モードを選択操作した場合でも、第２の制御
モードを実行しないように作業機制御コントローラ２１
に対して指示される。角度センサ２７〜２９および３次
元位置センサ３０に異常があると第２の制御モードが異
常になるからである。ただし角度センサ２７〜２９およ
び３次元位置センサ３０に異常があったとしても操作レ
バー１１の操作に基づく第１の制御モードが可能であ
る。よって操作切換スイッチ１３の選択如何にかかわら
ず、第１の制御モードを実行するように作業機制御コン
トローラ２１に対して指示が出される。また外部コント
ローラ２５が装着されていないと判断された場合には、
外部コントローラ２５に関する異常判定はなされない。When there is an abnormality, the fact is displayed on the display screen 24b, for example. Even if the operator selects and operates the second control mode, the work implement control controller 21 does not execute the second control mode.
Instructed. This is because if the angle sensors 27 to 29 and the three-dimensional position sensor 30 are abnormal, the second control mode becomes abnormal. However, even if the angle sensors 27 to 29 and the three-dimensional position sensor 30 are abnormal, the first control mode based on the operation of the operation lever 11 is possible. Therefore, regardless of the selection of the operation changeover switch 13, an instruction is issued to the work implement controller 21 to execute the first control mode. If it is determined that the external controller 25 is not mounted,
No abnormality is determined for the external controller 25.

【００６４】外部コントローラ２５が装着されていると
判断された場合には、操作切換スイッチ１３の選択結果
に応じた制御モードが作業機制御コントローラ２１で実
行される。すなわち操作切換スイッチ１３で第１の制御
モードが操作選択されている場合には、操作レバー１１
の操作に応じて作業機４７が制御される。また操作切換
スイッチ１３によって第２の制御モードが操作選択され
ている場合には、目標移動経路Ｔcに沿ってバケット先
端４４ａが移動するように作業機４７が制御される。When it is determined that the external controller 25 is mounted, a control mode according to the selection result of the operation changeover switch 13 is executed by the work implement control controller 21. That is, when the first control mode is selected by the operation switch 13, the operation lever 11
The work implement 47 is controlled according to the operation of. When the second control mode is selected by the operation changeover switch 13, the work implement 47 is controlled so that the bucket tip 44a moves along the target movement path Tc.

【００６５】しかし外部コントローラ２５が装着されて
いないと判断された場合には、外部コントローラ２５か
らは３次元目標地形データが作業機制御コントローラ２
１に出力されていない状態である。このため操作切換ス
イッチ１３の選択いかんにかかわらず第１の制御モード
が作業機制御コントローラ２１で実行される。すなわち
操作レバー１１の操作に応じて作業機４７が制御され
る。However, when it is determined that the external controller 25 is not mounted, the three-dimensional target terrain data is transmitted from the external controller 25 to the work implement controller 2.
1 is not output. Therefore, the first control mode is executed by the work implement controller 21 regardless of the selection of the operation changeover switch 13. That is, the work implement 47 is controlled according to the operation of the operation lever 11.

【００６６】このように外部コントローラ２５が装着さ
れているときのみ、制御モードの切り替え選択が有効で
あると判定し外部コントローラ２５が未装着な場合には
操作レバー１１に応じた制御のみを実行させるようして
いる。このため外部コントローラ２５が未装着な場合の
誤動作を防止することができる。As described above, only when the external controller 25 is mounted, it is determined that the control mode switching selection is valid, and when the external controller 25 is not mounted, only the control corresponding to the operation lever 11 is executed. Like that. For this reason, it is possible to prevent a malfunction when the external controller 25 is not mounted.

【００６７】以下外部コントローラ２５、作業機制御コ
ントローラ２１で実行される演算内容について説明す
る。In the following, description will be made on the contents of calculations executed by the external controller 25 and the work implement controller 21.

【００６８】・３次元目標地形データの作成 道路という構造物５２を例にとり３次元目標地形データ
の作成方法について説明する。Creation of three-dimensional target terrain data A method of creating three-dimensional target terrain data will be described using a structure 52 as a road as an example.

【００６９】図５（ａ）に示すように現在地形５０から
３次元目標地形５１を得るためには、３次元の現在地形
５０のデータが必要である。たとえばＧＰＳやトータル
ステーションなどの一般的な測量装置を用いて地表の複
数の点の３次元座標位置データが計測される。そして各
点の３次元座標位置データが関連づけられ３次元現在地
形データとされる。なお本実施の形態では、近傍の３点
を選択し３角形ポリゴンとなしこの３角形ポリゴンの集
合が３次元現在地形データとされる。As shown in FIG. 5A, in order to obtain the three-dimensional target terrain 51 from the current terrain 50, data of the three-dimensional current terrain 50 is required. For example, three-dimensional coordinate position data of a plurality of points on the ground surface is measured using a general surveying device such as a GPS or a total station. Then, the three-dimensional coordinate position data of each point is associated with each other and becomes three-dimensional current terrain data. In the present embodiment, three neighboring points are selected and no triangle polygon is set, and a set of these triangle polygons is used as three-dimensional current terrain data.

【００７０】図１１は現在地形データから道路という構
造物５２を生成するまでの手順を概念的に示している。FIG. 11 conceptually shows a procedure for generating a structure 52 called a road from the current topographic data.

【００７１】図１１（ａ）に示すように、まず３次元現
在地形データが入力され、上方より見た地形図が生成さ
れる。そして上方より見た地形図の上でＩＰ点と呼ばれ
る中間点７０が定められる。そしてこの中間点７０を結
ぶ直線がクロソイド、単曲線、ヘアピンなどの適当な曲
線で接続され、上方より見た道路の中心線（平面線形）
７１が定められる。As shown in FIG. 11A, first, three-dimensional current terrain data is input, and a terrain map viewed from above is generated. Then, an intermediate point 70 called an IP point is determined on the topographic map viewed from above. A straight line connecting the intermediate points 70 is connected by an appropriate curve such as a clothoid, a single curve, or a hairpin, and the center line of the road viewed from above (horizontal alignment).
71 are defined.

【００７２】さらに図１１（ｂ）に示すように３次元現
在地形データに基づき、平面線形７１に沿った高さ方向
Ｚの地形データ７２が求められる。これは縦断面と呼ば
れる。そしてこの縦断面７２上でＩＰ点７０が定めら
れ、曲線で補完することによって縦断面で見た道路の中
心線（縦断線形）７１′が定められる。こうして道路の
中心線７１′の３次元位置が最終的に決定される。Further, as shown in FIG. 11B, the topographic data 72 in the height direction Z along the horizontal line 71 is obtained based on the three-dimensional current topographic data. This is called a longitudinal section. Then, an IP point 70 is determined on the vertical section 72, and the center line (vertical alignment) 71 'of the road viewed in the vertical section is determined by complementing the IP point 70 with a curve. Thus, the three-dimensional position of the center line 71 'of the road is finally determined.

【００７３】つぎに図１１（ｃ）に示すように道路中心
線７１′に対して、道路の道幅、歩道の有無などを定め
ることによって、構造物５２の３次元形状が求められ
る。そして構造物５２の縁部５３の３次元形状が決定さ
れる。縁部５３の３次元形状は曲線を含む複雑な形状と
なる。Next, as shown in FIG. 11C, the three-dimensional shape of the structure 52 is determined by determining the width of the road, the presence or absence of a sidewalk, and the like with respect to the road center line 71 '. Then, the three-dimensional shape of the edge 53 of the structure 52 is determined. The three-dimensional shape of the edge 53 is a complicated shape including a curve.

【００７４】図５（ａ）は現在地形５０を示すデータ
と、構造物５２の形状を示すデータと、法面５４の角度
等の形状を示すデータと、縁５３の形状を示すデータと
に基づき法面５４の３次元目標地形５１を示すデータを
作成する様子を概念的に示している。FIG. 5A shows data based on data indicating the current topography 50, data indicating the shape of the structure 52, data indicating the shape of the slope 54 such as the angle, and data indicating the shape of the edge 53. A concept of creating data indicating the three-dimensional target terrain 51 on the slope 54 is conceptually shown.

【００７５】まず最初に法面５４の角度、法面５４、５
４間の小段５５を設ける間隔を示すデータが入力され
る。そして現在の３次元地形５０のデータと、構造物５
２の縁部５３の形状を示すデータと、法面５４の角度デ
ータとに基づいて、構造物５２の縁部５３を法尻とする
３次元目標地形５１のデータつまり法面５４の形状デー
タが作成される。法面５４の形状データを図５（ｂ）に
示す。このように簡単なデータを入力するだけで複雑な
３次元目標地形５１を自動的に作成することがで法面５
４の形状データは図５（ｃ）に示すように３角形ポリゴ
ン５６の集合として表される。３角形ポリゴン５６の集
合が３次元目標地形データとして外部コントローラ２５
のメモリに記憶される。First, the angle of the slope 54, the slopes 54, 5
Data indicating the intervals at which the small steps 55 between the four rows are provided is input. And the data of the current three-dimensional terrain 50 and the structure 5
Based on the data indicating the shape of the edge 53 of the second and the angle data of the slope 54, the data of the three-dimensional target terrain 51 having the edge 53 of the structure 52 as the slope, that is, the shape data of the slope 54 is Created. FIG. 5B shows the shape data of the slope 54. By simply inputting such simple data, a complicated three-dimensional target terrain 51 can be automatically created.
The shape data of No. 4 is represented as a set of triangular polygons 56 as shown in FIG. A set of triangular polygons 56 is used as the three-dimensional target terrain data by the external controller 25.
Is stored in the memory.

【００７６】・バケットの現在位置の演算 図３を参照して３次元位置センサ３０、傾斜角度センサ
２７〜２９の検出結果に基づきバケット先端４４ａの現
在位置を演算する処理の内容を説明する。Calculation of Current Position of Bucket The contents of processing for calculating the current position of the bucket tip 44a based on the detection results of the three-dimensional position sensor 30 and the inclination angle sensors 27 to 29 will be described with reference to FIG.

【００７７】まずブーム４２の根元４２ｄの座標位置を
求めるために、車体座標系｛Ｘ１，Ｙ１，Ｚ１｝を求め
る。First, the body coordinate system {X1, Y1, Z1} is obtained in order to obtain the coordinate position of the root 42d of the boom 42.

【００７８】３次元位置センサ３０では座標位置Ｐ１、
Ｐ２が検出される。すると、 Ｙ１＝（Ｐ１−Ｐ２）／｜Ｐ１−Ｐ２｜ となる。In the three-dimensional position sensor 30, the coordinate position P1,
P2 is detected. Then, Y1 = (P1-P2) / | P1-P2 |

【００７９】そして傾斜角度センサ２７〜２９では、Ｙ
１を水平軸として重力方向に対する傾きθ1、θ2、θ3
が検出される。In the inclination angle sensors 27 to 29, Y
Tilts θ1, θ2, θ3 with respect to the direction of gravity with 1 as the horizontal axis
Is detected.

【００８０】Ｙ１とＺの２つのベクトルで表される平面
を通り、Ｙ１と垂直なベクトルＺ’を導入すると、 （Ｚ’，Ｙ１）＝０ …（2.1） Ｚ’＝（１−ａ）Ｚ＋ａＹ１ …（2.2） という関係が成り立つ。When a vector Z ′ passing through a plane represented by two vectors Y1 and Z and perpendicular to Y1 is introduced, (Z ′, Y1) = 0 (2.1) Z ′ = (1−a) Z + aY1 … (2.2)

【００８１】（2.1）式および（2.2）式より、 Ｚ’＝Ｚ＋｛（Ｚ，Ｙ１）／（（Ｚ，Ｙ１）−１）｝
（Ｙ１−Ｚ） となり、さらに、Ｙ１およびＺ’と垂直なベクトルを
Ｘ’とすると、 Ｘ’＝Ｙ１⊥Ｚ’ となる。From the equations (2.1) and (2.2), Z ′ = Z + {(Z, Y1) / ((Z, Y1) −1)}
(Y1-Z), and when a vector perpendicular to Y1 and Z ′ is X ′, X ′ = Y1⊥Z ′.

【００８２】車体座標系は、これをＹ１軸周りにθ0だ
け回転させたものであるから、 となる。The vehicle body coordinate system is obtained by rotating this around the Y1 axis by θ0. Becomes

【００８３】この車体座標系内でのバケット先端４４ａ
の位置座標（ｘＬt、ｙＬt、ｚＬt）は、傾斜角度セン
サ２７〜２９の検出角度θ1、θ2、θ3およびブーム４
２、アーム４３、バケット４４の長さＬ1、Ｌ2、Ｌ3を
用いて、 ｘＬt＝０ …（2.4） ｚＬt＝−Ｌb2＋Ｌ１ｃｏｓθ1−Ｌ2ｃｏｓθ2−Ｌ3ｃｏｓθ3 …（2.5） ｙＬt＝Ｌb1＋Ｌ1ｓｉｎθ1＋Ｌ2ｓｉｎθ2＋Ｌ3ｓｉｎθ3 …（2.6） と演算することができる。よってグローバル座標系での
バケット先端４４ａの位置座標Ｐgtは、 Ｐgt＝ｘＬt・Ｘ１＋ｙＬt・Ｙ1＋ｚＬt・Ｚ1＋Ｐ1…
（2.7） となる。The bucket tip 44a in the vehicle body coordinate system
Position coordinates (xLt, yLt, zLt) are determined by the detection angles θ1, θ2, θ3 of the tilt angle sensors 27 to 29 and the boom 4
2. Using the lengths L1, L2, and L3 of the arm 43 and the bucket 44, xLt = 0 (2.4) zLt = -Lb2 + L1cos.theta.1-L2cos.theta.2-L3cos.theta.3 (2.5) it can. Therefore, the position coordinates Pgt of the bucket tip 44a in the global coordinate system are as follows: Pgt = xLt.X1 + yLt.Y1 + zLt.Z1 + P1.
(2.7)

【００８４】なお本実施の形態では、２つのＧＰＳアン
テナ４５、４６を車体４１に取り付けた場合を示してい
る。この場合車体４１の旋回等に伴うＧＰＳアンテナの
経路を計測して油圧ショベル４０の傾きおよび傾斜方向
を計測してもよい。また３つ以上のＧＰＳアンテナを用
いて車体４１の位置を計測することもできる。さらにＧ
ＰＳアンテナを、アーム４３やブーム４２に取り付けて
もよい。またＧＰＳの代わりにロボティックトータルス
テーションなど他の３次元位置計測装置を用いてもよ
い。This embodiment shows a case where two GPS antennas 45 and 46 are attached to the vehicle body 41. In this case, the inclination and the inclination direction of the excavator 40 may be measured by measuring the path of the GPS antenna accompanying the turning of the vehicle body 41 and the like. Also, the position of the vehicle body 41 can be measured using three or more GPS antennas. Further G
The PS antenna may be attached to the arm 43 or the boom 42. Another three-dimensional position measuring device such as a robotic total station may be used instead of the GPS.

【００８５】また角度センサ２７〜２９としては、ブー
ム４２、アーム４３、バケット４４の重力方向に対する
傾きを検出する検出器に限ることなく、ポテンショメー
タなどの任意の角度センサを用いることができる。また
レーザ距離計測装置を用いて角度を検出してもよい。The angle sensors 27 to 29 are not limited to detectors for detecting the inclination of the boom 42, the arm 43, and the bucket 44 with respect to the direction of gravity, and any angle sensor such as a potentiometer can be used. Alternatively, the angle may be detected using a laser distance measuring device.

【００８６】・平面と３次元目標地形との交線の演算 オペレータが操作レバー１１を操作したとき油圧シリン
ダ２３が駆動されバケット４４の先端４４ａは、Ｙ１−
Ｚ１平面内を移動することによって、掘削作業がなされ
る。すなわちバケット先端４４ａは上記演算された現在
の先端位置Ｐｇｔを通るＹ１−Ｚ１平面内を移動するこ
とによって掘削作業が行われる。Calculation of the intersection line between the plane and the three-dimensional target terrain When the operator operates the operation lever 11, the hydraulic cylinder 23 is driven and the tip 44a of the bucket 44
Excavation work is performed by moving in the Z1 plane. In other words, the excavation work is performed by moving the bucket tip 44a in the Y1-Z1 plane passing through the calculated current tip position Pgt.

【００８７】そこで図６（ａ）に示すように現在のバケ
ット先端４４ａの位置Ｐgtを通過する平面５７が演算さ
れる。Therefore, as shown in FIG. 6A, a plane 57 passing through the current position Pgt of the bucket tip 44a is calculated.

【００８８】つぎにメモリに記憶された３次元目標地形
５１のデータが読み出され、平面５７と目標地形５１と
の交線５８が演算される。この交線５８が、バケット先
端４４ａが移動すべき目標移動経路Ｔcとなる。この交
線５８に沿ってバケット先端４４ａを移動させることに
よって、現在のバケット下方における現在地形５０を３
次元目標地形５１に掘削することができる。３次元目標
地形データは、三角形ポリゴン５６の集合として表現さ
れるので、交線５８は各三角形ポリゴン５６上の線分で
表現されることになる。Next, the data of the three-dimensional target terrain 51 stored in the memory is read, and an intersection line 58 between the plane 57 and the target terrain 51 is calculated. This intersection line 58 becomes the target movement path Tc to which the bucket tip 44a should move. By moving the bucket tip 44a along the intersection line 58, the current terrain 50 below the current bucket can be changed by three.
Excavation can be performed on the dimensional target terrain 51. Since the three-dimensional target terrain data is represented as a set of triangular polygons 56, the intersection line 58 is represented by a line segment on each triangular polygon 56.

【００８９】そして図６（ｂ）に示すように、３次元目
標地形５１を示す交線５８の位置とバケット４４の位置
とが同一の表示画面２４ａ上に表示される。As shown in FIG. 6B, the position of the intersection line 58 indicating the three-dimensional target terrain 51 and the position of the bucket 44 are displayed on the same display screen 24a.

【００９０】油圧ショベル４０の走行に伴う移動や車体
４１の旋回によってバケット４４の現在位置が変化した
としても、表示画面２４ａ上には、現在のバケット４４
の位置と現在のバケット４４の下方における３次元目標
地形５１を示す交線５８が表示されることになる。よっ
てオペレータは、この表示画面２４ａを見ることによっ
て、掘削すべき交線５８の位置を、バケット４４の位置
との関係で正確に把握することができる。そしてこの表
示画面２４ａを見ながら操作レバー１１を操作すれば現
在地形５０を目標地形５１に精度よく掘削することがで
きる。なおこのとき操作切換スイッチ１３は第１の制御
モードに選択されている。Even if the current position of the bucket 44 is changed by the movement of the excavator 40 or the turning of the vehicle body 41, the current bucket 44 is displayed on the display screen 24a.
And an intersection line 58 indicating the three-dimensional target terrain 51 below the current bucket 44 is displayed. Therefore, by looking at the display screen 24a, the operator can accurately grasp the position of the intersection line 58 to be excavated in relation to the position of the bucket 44. If the operation lever 11 is operated while looking at the display screen 24a, the current terrain 50 can be excavated on the target terrain 51 with high accuracy. At this time, the operation changeover switch 13 has been selected to the first control mode.

【００９１】このように本実施形態によれば油圧ショベ
ル４０が移動するに応じてまたバケット４４が移動する
に応じて、そのバケット４４の下方の掘削すべき地形の
形状が変化する複雑な３次元地形であっても、現在のバ
ケット４４の位置に対応する目標地形５１を示す交線５
８の位置を、バケット４４の位置との関係で表示するこ
とができる。つまり複雑な形状の３次元地形をバケット
４４との位置関係でオペレータに分かりやすく表示する
ことができる。よって本実施形態によれば、場所によっ
て掘削すべき地形の形状が異なる複雑な３次元地形であ
っても、精度よく掘削することができる。As described above, according to the present embodiment, as the excavator 40 moves and the bucket 44 moves, the shape of the terrain to be excavated below the bucket 44 changes. Even if it is a terrain, an intersection line 5 indicating the target terrain 51 corresponding to the current position of the bucket 44
The position of No. 8 can be displayed in relation to the position of the bucket 44. That is, the three-dimensional terrain having a complicated shape can be displayed in an easy-to-understand manner for the operator in the positional relationship with the bucket 44. Therefore, according to the present embodiment, excavation can be accurately performed even for a complicated three-dimensional terrain in which the shape of the terrain to be excavated differs depending on the location.

【００９２】なおバケット４４と交線５８の表示の仕方
は図４（ｂ）に示す表示の仕方に限定されるものではな
い。図６（ａ）に示すようにバケット４４と交線５８と
の位置関係を３次元的に表示してもよい。この場合図７
に示すように、バケット４４の幅Ｗを考慮して、バケッ
ト４４の幅Ｗ分の交線５８′を表示してもよい。バケッ
ト４４の幅Ｗ分の交線５８′が掘削すべき部分（これを
斜線にて示す）となる。Note that the manner of displaying the bucket 44 and the intersection line 58 is not limited to the manner of display shown in FIG. As shown in FIG. 6A, the positional relationship between the bucket 44 and the intersection line 58 may be displayed three-dimensionally. In this case, FIG.
As shown in (5), the intersection line 58 'for the width W of the bucket 44 may be displayed in consideration of the width W of the bucket 44. An intersection line 58 'corresponding to the width W of the bucket 44 is a portion to be excavated (this is indicated by oblique lines).

【００９３】またバケット４４のみを表示するのではな
くバケット４４を含む作業機４７全体を表示してもよ
い。さらには図８に示すように表示画面２４ａ上に油圧
ショベル４０全体を表示して、車体４１に対する作業機
４７の現在姿勢を画面２４ａから認識できるようにして
もよい。Further, instead of displaying only the bucket 44, the entire work machine 47 including the bucket 44 may be displayed. Further, as shown in FIG. 8, the entire hydraulic excavator 40 may be displayed on the display screen 24a so that the current posture of the work implement 47 with respect to the vehicle body 41 can be recognized from the screen 24a.

【００９４】さらには図９（ａ）に示すようにバケット
先端４４ａの動作範囲を表示してもよい。この場合ブー
ム４２、アーム４３、バケット４４を動作させたときの
動作範囲５９を表示することができる。また特定の作業
機たとえばアーム４３、バケット４４を動作させたとき
の動作範囲６０を表示することができる。さらには図９
（ｂ）に示すようにバケット４４の姿勢を一定にしたと
きの動作範囲６１を表示してもよい。Further, as shown in FIG. 9A, the operating range of the bucket tip 44a may be displayed. In this case, the operation range 59 when the boom 42, the arm 43, and the bucket 44 are operated can be displayed. Further, an operation range 60 when a specific work machine such as the arm 43 or the bucket 44 is operated can be displayed. Further, FIG.
As shown in (b), the operation range 61 when the posture of the bucket 44 is fixed may be displayed.

【００９５】動作範囲５９、６０、６１を表示すること
で、交線５８との関係で油圧ショベル４０が掘削作業に
適した位置にいるか否かを判断することができる。By displaying the operation ranges 59, 60, and 61, it is possible to determine whether or not the excavator 40 is at a position suitable for excavation work in relation to the intersection line 58.

【００９６】なお目標地形５１を示す交線５８だけでは
なく、現在地形５０を示す交線、現在地形５０の下の土
や岩などの状態を併せて表示してもよい。In addition to the intersection line 58 indicating the target terrain 51, the intersection line indicating the current terrain 50 and the state of the soil and rocks under the current terrain 50 may also be displayed.

【００９７】なお本実施形態では、バケット４４と交線
５８を表示画面２４上にグラフィック表示している。し
かし本発明としては逐次変化する現在のバケット４４と
現在の交線５８との相対位置関係をオペレータに提示し
て掘削作業をガイダンスすることができればよい。たと
えば交線５８とバケット４４との相対的な位置関係を、
数値（たとえばバケット先端４４ａから交線５８までの
距離）でオペレータに提示してもよい。また交線５８と
バケット４４との相対的な位置関係を音声（たとえば
「バケット先端下方Ｘｍに交線あり」）によってオペレ
ータに提示してもよい。In the present embodiment, the bucket 44 and the intersection line 58 are graphically displayed on the display screen 24. However, according to the present invention, it is only required that the relative positional relationship between the current bucket 44 and the current intersection line 58 that changes sequentially be presented to the operator to guide the excavation work. For example, the relative positional relationship between the intersection line 58 and the bucket 44 is
The numerical value (for example, the distance from the bucket tip 44a to the intersection line 58) may be presented to the operator. Further, the relative positional relationship between the intersection line 58 and the bucket 44 may be presented to the operator by voice (for example, “there is an intersection line below the bucket tip Xm”).

【００９８】・掘削制御 上記表示画面２４ａに表示される交線５８は、操作切換
スイッチ１３で第２の制御モードが選択されて自動掘削
を行うときの目標移動経路Ｔcとなる。自動掘削開始ボ
タン２４ｂがオンされている間、作業機制御コントロー
ラ２１では自動掘削の制御が実行される。また自動掘削
開始ボタン２４ｂがオフされると、自動掘削制御が中止
される。Excavation Control The intersection line 58 displayed on the display screen 24a becomes the target movement path Tc when the second control mode is selected by the operation changeover switch 13 and the automatic excavation is performed. While the automatic excavation start button 24b is on, the work implement control controller 21 controls automatic excavation. When the automatic excavation start button 24b is turned off, the automatic excavation control is stopped.

【００９９】目標移動経路Ｔcは車体座標系の２次元平
面Ｚ１−Ｙ１上の点列｛Ｐt1，Ｐt2，…，Ｐtm｝で表現
される。The target movement path Tc is represented by a point sequence {Pt1, Pt2,..., Ptm} on the two-dimensional plane Z1-Y1 of the vehicle body coordinate system.

【０１００】バケット４４の取り付け方法によって掘削
方向が定まる。たとえばバックホウの場合には車体４１
に対して遠方から手前に掘削される。このため車体座標
系で原点から遠い点から掘削が開始される。こうして掘
削の方向が求められる。The direction of excavation is determined by the method of mounting the bucket 44. For example, in the case of a backhoe, the vehicle body 41
It is excavated from a distance. Therefore, excavation is started from a point far from the origin in the vehicle body coordinate system. Thus, the direction of excavation is determined.

【０１０１】つぎに目標移動経路Ｔc上の開始点と終了
点が求められる。オペレータはグラフィックインターフ
ェース２４で水平掘削を行うか法面掘削を行うかを移動
方法を指示している。Next, a start point and an end point on the target movement route Tc are obtained. The operator instructs, on the graphic interface 24, a moving method of performing horizontal excavation or slope excavation.

【０１０２】法面掘削の場合には、図１０に示すように
バケット４４の現在高さと同じ高さから掘削が開始され
る。目標移動経路Ｔc中でバケット４４の現在のＺ１軸
上の座標値と同じ座標値になる点が求められ、これが掘
削開始点Ｐto1とされる。なお目標移動経路Ｔcがバケッ
ト４４の現在高さよりも低い場合には、目標移動経路Ｔ
c中で車体４１から最も遠い点が掘削開始点Ｐto1とされ
る。この掘削開始点が油圧ショベル４０の動作範囲内に
入らない場合には、動作範囲内で車体４１に最も遠い点
が掘削開始点Ｐto1とされる。In the case of slope excavation, excavation is started from the same height as the current height of the bucket 44 as shown in FIG. A point having the same coordinate value as the current coordinate value of the bucket 44 on the Z1 axis in the target movement path Tc is obtained, and this is set as the excavation start point Pto1. If the target travel route Tc is lower than the current height of the bucket 44, the target travel route Tc
The point farthest from the vehicle body 41 in c is set as the excavation start point Pto1. If this excavation start point does not fall within the operation range of the excavator 40, the point farthest from the vehicle body 41 within the operation range is set as the excavation start point Pto1.

【０１０３】これに対して水平掘削の場合には、バケッ
ト４４の現在のＹ１軸上の座標値と同じ座標値になる点
が求められ、これを掘削開始点Ｐto1とされる。なお目
標移動経路Ｔc中に現在のＹ１軸上の座標値と同じ座標
値になる点が存在しない場合には、法面掘削の場合と同
様に車体４１から最も遠い点が掘削開始点Ｐto1とされ
る。この掘削開始点が油圧ショベル４０の動作範囲内に
入らない場合には、動作範囲内で車体４１に最も遠い点
が掘削開始点Ｐto1とされる。On the other hand, in the case of horizontal excavation, a point having the same coordinate value as the current coordinate value on the Y1 axis of the bucket 44 is obtained, and this point is set as the excavation start point Pto1. If there is no point having the same coordinate value as the current coordinate value on the Y1 axis in the target movement route Tc, the point farthest from the vehicle body 41 is set as the excavation start point Pto1 as in the case of the slope excavation. You. If this excavation start point does not fall within the operation range of the excavator 40, the point farthest from the vehicle body 41 within the operation range is set as the excavation start point Pto1.

【０１０４】次に終了点が求められる。法面掘削の場合
には図１０に示すように油圧ショベル４０の履帯４９が
接している地面の高さにて掘削が終了される。目標移動
経路Ｔc中で油圧ショベル４０の地面の現在のＺ１軸上
の座標値と同じ座標値となる点が求められ、これが掘削
終了点Ｐtomとされる。なお目標移動経路Ｔc中に地面の
現在のＺ１軸上の座標値と同じ座標値となる点が存在し
ない場合には、車体４１に最も近い点が掘削終了点Ｐto
mとされる。この掘削終了点が油圧ショベル４０の動作
範囲内に入らない場合には、動作範囲内で車体４１に最
も近い点が掘削終了点Ｐtomとされる。Next, an end point is obtained. In the case of slope excavation, as shown in FIG. 10, excavation is completed at the level of the ground where the crawler belt 49 of the excavator 40 is in contact. A point having the same coordinate value as the current coordinate value on the Z1 axis on the ground of the excavator 40 in the target movement path Tc is obtained, and this is set as the excavation end point Ptom. If no point having the same coordinate value as the current coordinate value of the ground on the Z1 axis exists in the target movement path Tc, the point closest to the vehicle body 41 is the excavation end point Pto
m. When the excavation end point does not fall within the operation range of the excavator 40, the point closest to the vehicle body 41 within the operation range is set as the excavation end point Ptom.

【０１０５】これに対して水平掘削の場合には、油圧シ
ョベル４０の履帯４９の縁部の現在のＹ１軸上の座標値
と同じ座標値になる点が求められ、これを掘削終了点Ｐ
tomとされる。なお目標移動経路Ｔc中に現在の履帯縁部
のＹ１軸上の座標値と同じ座標値になる点が存在しない
場合には、法面掘削の場合と同様に車体４１に最も近い
点が掘削終了点Ｐtomとされる。この掘削終了点が油圧
ショベル４０の動作範囲内に入らない場合には、動作範
囲内で車体４１に最も近い点が掘削終了点Ｐtomとされ
る。On the other hand, in the case of horizontal excavation, a point having the same coordinate value as the current coordinate value on the Y1 axis at the edge of the crawler belt 49 of the excavator 40 is obtained.
tom. If there is no point in the target movement route Tc having the same coordinate value as the current coordinate value on the Y1 axis of the crawler belt edge, the point closest to the vehicle body 41 ends as in the case of the slope excavation. The point is set to Ptom. When the excavation end point does not fall within the operation range of the excavator 40, the point closest to the vehicle body 41 within the operation range is set as the excavation end point Ptom.

【０１０６】このようにしてバケット先端４４ａが実際
に移動可能な範囲で、移動開始点Ｐto1と移動終了点Ｐt
omが求められ、点列｛Ｐt1，Ｐt2，…，Ｐtm｝が点列Ｔ
ｃ＝｛Ｐto1，Ｐto2，…，Ｐtom｝に再構成される。Thus, within the range in which the bucket tip 44a can actually move, the movement start point Pto1 and the movement end point Pt
om is obtained, and the point sequence {Pt1, Pt2,.
c = {Pto1, Pto2,..., Ptom}.

【０１０７】各目標点Ｐto1，Ｐto2，…，Ｐtomにおけ
るバケット４４の姿勢角度θ3はオペレータにより選択
される。たとえば各目標点におけるバケット４４の姿勢
角度θ3を、現在位置における角度に維持してもよい。
また初期の２つの目標点Ｐto1，Ｐto2で定まる直線の角
度にバケット４４の背面の角度が合うようにバケット姿
勢角度θ3を定めて、この姿勢角度を維持したまま各目
標点を移動させてもよい。なおバケット４４の背面の角
度に維持する方法は仕上げ作業に用いられる。The attitude angle θ3 of the bucket 44 at each of the target points Pto1, Pto2,..., Ptom is selected by the operator. For example, the posture angle θ3 of the bucket 44 at each target point may be maintained at the angle at the current position.
Further, the bucket attitude angle θ3 may be determined so that the angle of the back surface of the bucket 44 matches the angle of the straight line defined by the two initial target points Pto1 and Pto2, and each target point may be moved while maintaining this attitude angle. . The method of maintaining the angle at the back of the bucket 44 is used for finishing work.

【０１０８】バケット先端４４ａの現在位置Ｐgtから目
標移動経路Ｔcの最初の点Ｐto1までは、各軸制御により
ブーム４２、アーム４３、バケット４４の各軸（各油圧
シリンダ２３）が駆動制御される。すなわち２点Ｐgt、
Ｐto1間における油圧シリンダのロッドの移動位置が演
算され、 （油圧シリンダの位置変化量）／（油圧シリンダの最大
移動速度） が最も大きい軸が最大速度で移動される。その他の軸
は、最大速度となる軸と同時に目標点Ｐto1に到達する
ように制御される。From the current position Pgt of the bucket tip 44a to the first point Pto1 of the target movement path Tc, the respective axes (the hydraulic cylinders 23) of the boom 42, the arm 43 and the bucket 44 are controlled by the respective axis controls. That is, two points Pgt,
The movement position of the rod of the hydraulic cylinder between Pto1 is calculated, and the axis with the largest ((position change amount of the hydraulic cylinder) / (maximum moving speed of the hydraulic cylinder)) is moved at the maximum speed. The other axes are controlled so as to reach the target point Pto1 at the same time as the axis having the maximum speed.

【０１０９】このときバケット先端４４ａの移動経路は
非直線になる。２点間の制御は比較的簡単であり移動速
度は最大となる。油圧シリンダは２点間を等速度で移動
させてもよい。ただし振動を防止するために適当な加減
速パターンを設定して、２点間をこの加減速パターンに
したがって移動させてもよい。At this time, the movement path of the bucket tip 44a is non-linear. The control between the two points is relatively simple and the movement speed is maximized. The hydraulic cylinder may be moved at a constant speed between two points. However, an appropriate acceleration / deceleration pattern may be set in order to prevent vibration, and movement between two points may be performed according to the acceleration / deceleration pattern.

【０１１０】各軸制御で移動させる場合に、バケット４
４あるいはアーム４３などが、目標移動経路Ｔcあるい
は現在地形５０と干渉する場合には、干渉を避けるよう
に補助点が自動的に作成され、この補助点を経由して目
標点Ｐto1まで移動される。When moving by each axis control, the bucket 4
When the arm 4 or the arm 43 interferes with the target movement route Tc or the current terrain 50, an auxiliary point is automatically created so as to avoid the interference, and the auxiliary point is moved to the target point Pto1 via the auxiliary point. .

【０１１１】バケット先端４４ａが目標移動経路Ｔcの
移動開始点Ｐto1に到達されると、バケット４４の姿勢
角度θ3が維持されたまま、バケット先端４４ａが目標
移動経路Ｔc上に保って移動される。具体的にはバケッ
ト先端４４ａが、設定した目標移動速度で移動される。
目標移動速度はグラフィックインターフェース２４で設
定される。When the bucket tip 44a reaches the movement start point Pto1 on the target movement path Tc, the bucket tip 44a is moved while maintaining the attitude angle θ3 of the bucket 44 on the target movement path Tc. Specifically, the bucket tip 44a is moved at the set target moving speed.
The target moving speed is set by the graphic interface 24.

【０１１２】以下目標移動経路Ｔcに沿ってバケット先
端４４ａの移動をサーボ制御する処理の内容について説
明する。A description will now be given of the contents of the processing for servo-controlling the movement of the bucket tip 44a along the target movement path Tc.

【０１１３】すなわちバケット先端４４ａの微少時間ご
との位置（ｙｔｏ，ｚｔｏ）および角度θｔｏが、目標
移動経路Ｔcのデータから求められる。そしてこのバケ
ット先端位置および角度に対応する各軸（ブーム４２、
アーム４３、バケット４４）の目標回転角度θ1、θ2、
θ3が求められる。そしてこの目標回転角度になるよう
にブーム４２、アーム４３、バケット４４の各油圧シリ
ンダ２３がサーボ制御される。That is, the position (yto, zto) and angle θto of the bucket tip 44a at every minute time are obtained from the data of the target movement path Tc. Each axis (boom 42, boom 42,
Arm 43, bucket 44) target rotation angles θ1, θ2,
θ3 is required. Then, the hydraulic cylinders 23 of the boom 42, the arm 43, and the bucket 44 are servo-controlled so that the target rotation angle is obtained.

【０１１４】Ｙ１−Ｚ１平面上におけるバケット先端４
４ａの目標位置、角度を｛ｙto，ｚto ，θto ｝とす
ると、各軸の回転角度θ1、θ2、θ3が以下に示すよう
に一律に定まる。The bucket tip 4 on the Y1-Z1 plane
Assuming that the target position and angle of 4a are {yto, zto, θto}, the rotation angles θ1, θ2, θ3 of the respective axes are uniformly determined as shown below.

【０１１５】｛θ1 ，θ2，θ3｝＝ｆｒ｛ｙto，ｚto，
θto｝ ただしｆrは所定の関数である。この関数ｆrの内容は以
下のとおりである。{Θ1, θ2, θ3} = fr {yto, zto,
θto｝ where fr is a predetermined function. The contents of this function fr are as follows.

【０１１６】θ3＝θto （4.1） また、（2.5）式および（2.6）式より ｙＬt−Ｌb1−Ｌ3ｓｉｎθto＝Ｌ1ｓｉｎθ1＋Ｌ2ｓｉｎθ2 ｚＬt＋Ｌb2＋Ｌ3ｃｏｓθto＝Ｌ1ｃｏｓθ1−Ｌ2ｃｏｓθ2 となる。Θ3 = θto (4.1) From the equations (2.5) and (2.6), yLt−Lb1−L3sinθto = L1sinθ1 + L2sinθ2 zLt + Lb2 + L3cosθto = L1cosθ1−L2cosθ2

【０１１７】ここで、 ｙＬt−Ｌb1−Ｌ3ｓｉｎθto＝ｍ ｚＬt＋Ｌb2＋Ｌ3ｃｏｓθto＝ｎ とおくと、 ｍ＝Ｌ1ｓｉｎθ1＋Ｌ2ｓｉｎθ2 ｎ＝Ｌ1ｃｏｓθ1−Ｌ2ｃｏｓθ2 となる。Here, if yLt-Lb1-L3 sinθto = mzLt + Lb2 + L3cosθto = n, then m = L1sinθ1 + L2sinθ2n = L1cosθ1-L2cosθ2.

【０１１８】両辺を２乗して加算すると、 ｍ^2＋ｎ^2＝Ｌ1^2＋Ｌ2^2−２Ｌ1・Ｌ2ｃｏｓ（θ1＋
θ2） となる。なお^2は２乗を意味するものとする。When both sides are squared and added, m ^ 2 + n ^ 2 = L1 ^ 2 + L2 ^ 2-2L1 · L2cos (θ1 +
θ2). Note that ^ 2 means a square.

【０１１９】したがって、 θ1＋θ2＝ｃｏｓ-1｛（Ｌ1^2＋Ｌ2^2−ｍ^2−ｎ^2）／
２Ｌ1・Ｌ2｝ が得られる。Therefore, θ1 + θ2 = cos-1 ｛(L1 ^ 2 + L2 ^ 2-m ^ 2-n ^ 2) /
2L1 · L2｝ is obtained.

【０１２０】（2.5）式より ｍ＝Ｌ1ｓｉｎθ1＋Ｌ2ｓｉｎθ2 が得られる。これより、 ｍ＝（Ｌ1−Ｌ2ｃｏｓ（θ1＋θ2））ｓｉｎθ1＋Ｌ2ｓ
ｉｎ（θ1＋θ2）ｃｏｓθ1 となる。ここで、 とおくと、 １＝ｋ1ｓｉｎθ1＋ｋ2ｃｏｓθ1 となる。よってθ1は、 となる。θ2も同様にして求められる。こうして目標回
転角度θ１，θ２，θ３が演算される。From equation (2.5), m = L1 sin θ1 + L2 sin θ2 is obtained. From this, m = (L1−L2cos (θ1 + θ2)) sin θ1 + L2s
in (θ1 + θ2) cos θ1. here, Then, 1 = k1 sin θ1 + k2 cos θ1. Therefore θ1 is Becomes θ2 is similarly obtained. Thus, the target rotation angles θ1, θ2, θ3 are calculated.

【０１２１】つぎに重力方向に対してなす角度θ１，θ
２，θ３が、車体４１に対してブーム４２がなす相対的
な角度θ′1、ブーム４２に対してアーム４３がなす相
対的な角度θ′2、アーム４３に対してバケット４４が
なす相対的な角度θ′3に変換される。これら相対角度
θ′1、θ′2、θ′3は、重力方向に対してなす角度θ
１，θ２，θ３の加減算によって容易に求められる。そ
して現在の相対角度θ′1、θ′2、θ′3が目標とする
相対角度θ′1、θ′2、θ′3となるように、ブーム４
２、アーム４３、バケット４４の各油圧シリンダ２３が
駆動制御される。こうしてバケット先端４４ａは目標移
動経路Ｔcに沿って移動され、現在地形５０が目標地形
５１に精度よく掘削される。Next, angles θ1, θ formed with respect to the direction of gravity
2 and θ3 are the relative angle θ′1 of the boom 42 with respect to the vehicle body 41, the relative angle θ′2 of the arm 43 with the boom 42, and the relative angle of the bucket 44 with the arm 43. Angle θ'3. These relative angles θ′1, θ′2, and θ′3 form an angle θ with respect to the direction of gravity.
It is easily obtained by addition and subtraction of 1, θ2 and θ3. The boom 4 is moved so that the current relative angles θ′1, θ′2, θ′3 become the target relative angles θ′1, θ′2, θ′3.
2. The drive of each hydraulic cylinder 23 of the arm 43 and the bucket 44 is controlled. Thus, the bucket tip 44a is moved along the target movement path Tc, and the current terrain 50 is excavated on the target terrain 51 with high accuracy.

【０１２２】そして図１０に示すように、３次元目標地
形５１を示す交線５８が目標移動経路Ｔcとされ、この
目標移動経路Ｔcに沿ってバケット４４が移動するよう
にバケット４４が制御される。As shown in FIG. 10, the intersection line 58 indicating the three-dimensional target terrain 51 is set as the target moving path Tc, and the bucket 44 is controlled so that the bucket 44 moves along the target moving path Tc. .

【０１２３】このように第２の制御モードで自動掘削を
行った場合には、表示画面２４ａを確認しながら手動で
掘削作業を行う第１の制御モードの場合と同様に、現在
のバケット位置下方の目標地形５１に沿ってバケット先
端４４ａが自動的に移動するので、場所によって掘削す
べき地形の形状が異なる複雑な３次元地形であっても、
精度よく掘削することができる。さらに第２の制御の場
合にはオペレータがバケット４４を操作せずとも自動的
に掘削作業がなされる。このため第１の制御モードに比
べてオペレータの労力が軽減されるという効果が得られ
る。As described above, when the automatic excavation is performed in the second control mode, similarly to the case of the first control mode in which the excavation work is manually performed while checking the display screen 24a, the lower part of the current bucket position is used. The bucket tip 44a automatically moves along the target terrain 51, so even if the shape of the terrain to be excavated differs depending on the location,
Excavation can be performed with high accuracy. Further, in the case of the second control, excavation work is automatically performed without the operator operating the bucket 44. Therefore, an effect is obtained that the operator's labor is reduced as compared with the first control mode.

【０１２４】なお上述した実施の形態では、地面に対し
て垂直なＹ１−Ｚ１平面内をバケット先端４４ａが移動
することを前提としている。しかし油圧ショベル４０の
車体４１は図３（ｂ）に示すように掘削作業の進行に伴
い地面に対して角度θ0だけ傾斜することもある。この
場合には作業機４７の油圧シリンダ２３が駆動されるこ
とによりバケット４４は地面に対して角度θ0だけ傾斜
した平面に沿って移動する。このため傾斜角度θ0に応
じた平面５７を新たに求め直して、交線５８つまり目標
移動経路Ｔcを再度演算してもよい。The above-described embodiment is based on the premise that the bucket tip 44a moves in a Y1-Z1 plane perpendicular to the ground. However, as shown in FIG. 3B, the vehicle body 41 of the excavator 40 may be inclined by an angle θ0 with respect to the ground as the excavation operation proceeds. In this case, when the hydraulic cylinder 23 of the work machine 47 is driven, the bucket 44 moves along a plane inclined by an angle θ0 with respect to the ground. Therefore, the plane 57 corresponding to the inclination angle θ0 may be newly obtained, and the intersection line 58, that is, the target moving path Tc may be calculated again.

【０１２５】具体的には図６（ａ）に示すように地面に
対して垂直な平面５７に対して角度θ0だけ傾斜されバ
ケット先端４４ａの現在位置を通過する平面５７″が新
たに演算される。そしてこの平面５７″と３次元目標地
形５１との交線５８″が求められ、表示画面２４ａ上に
表示される。また交線５８″が目標移動経路Ｔcとされ
この目標移動経路Ｔcに沿ってバケット先端４４ａが移
動されるように各油圧シリンダ２３が自動制御される。More specifically, as shown in FIG. 6 (a), a plane 57 ″ which is inclined by an angle θ0 with respect to a plane 57 perpendicular to the ground and passes through the current position of the bucket tip 44a is newly calculated. Then, an intersection 58 "between the plane 57" and the three-dimensional target terrain 51 is obtained and displayed on the display screen 24a. The intersection 58 "is set as the target movement path Tc and along the target movement path Tc. Each hydraulic cylinder 23 is automatically controlled such that the bucket tip 44a is moved.

【０１２６】また作業機が車体４１に対して左右に傾斜
することができる作業機を備えた建設機械の場合には、
作業機の傾斜に応じてバケット先端４４ａが移動する平
面が変化する。この場合にも同様にして油圧シリンダ２
３が駆動されたときにバケット先端４４ａが移動する面
を含む平面５７″を求め、この平面５７″に応じた交線
５８″を求めればよい。平面５７″としては主に掘削力
を負担する作業機（アームなど）の油圧シリンダの移動
によって定まる平面を求めればよい。In the case of a construction machine having a working machine capable of tilting left and right with respect to the vehicle body 41,
The plane on which the bucket tip 44a moves changes according to the inclination of the work machine. In this case, the hydraulic cylinder 2
The plane 57 "including the surface on which the bucket tip 44a moves when the 3 is driven may be obtained, and the intersection 58" corresponding to this plane 57 "may be obtained. The plane 57" mainly bears the excavating force. A plane determined by the movement of the hydraulic cylinder of the working machine (such as an arm) may be obtained.

【０１２７】また図４に示すようにオフセットブーム４
２ｃを備えた油圧ショベル４０の場合にもオフセット動
作に応じて正確な交線５８つまり目標移動経路Ｔcを求
めることがきる。すなわち図４（ｂ）に示すように車体
４１に対してバケット４４がオフセットしていない場合
には平面５７が演算され、車体４１に対してバケット４
４がオフセットされている場合には平面５７′が演算さ
れる。オフセットされたときにはバケット先端４４ａの
現在位置を通過しかつ平面５７に対してオフセットされ
た平面５７′が新たに演算される。そしてこの平面５
７′と３次元目標地形５１との交線５８′が求められ、
表示画面２４ａ上に表示される。また交線５８′が目標
移動経路Ｔcとされこの目標移動経路Ｔcに沿ってバケッ
ト先端４４ａが移動されるように各油圧シリンダ２３が
自動制御される。Further, as shown in FIG.
In the case of the hydraulic excavator 40 having the hydraulic excavator 2c, an accurate intersection line 58, that is, the target moving path Tc can be obtained in accordance with the offset operation. That is, when the bucket 44 is not offset with respect to the vehicle body 41 as shown in FIG.
If 4 is offset, plane 57 'is computed. When it is offset, a plane 57 'that passes through the current position of the bucket tip 44a and is offset from the plane 57 is newly calculated. And this plane 5
An intersection line 58 'between the 7' and the three-dimensional target terrain 51 is obtained,
It is displayed on the display screen 24a. The intersection line 58 'is used as the target movement path Tc, and the hydraulic cylinders 23 are automatically controlled so that the bucket tip 44a moves along the target movement path Tc.

【０１２８】このように本実施形態によれば、傾斜、オ
フセット等のバケット位置の変化、ずれがあったとして
も、目標地形５１を常に精度よく掘削することができ
る。As described above, according to the present embodiment, the target terrain 51 can always be excavated with high accuracy even if there is a change or displacement of the bucket position such as inclination or offset.

【０１２９】・移動速度、移動経路の調整 第２の制御モードで自動掘削を行う場合上述した実施形
態では、移動速度が指定され、一定速度で目標移動経路
Ｔcに沿ってバケット先端４４ａが移動されるものとし
て説明した。しかし操作レバー１１の操作量に応じた速
度でバケット先端４４ａを目標移動経路Ｔcに沿って移
動させるとともに、操作レバー１２の操作量に応じた分
だけ目標移動経路Ｔcをオフセットさせてオフセットさ
れた移動経路Ｔ′c上に沿ってバケット先端４４ａを移
動させてもよい。Adjustment of Traveling Speed and Traveling Path When Excavation is Performed in the Second Control Mode In the above-described embodiment, the traveling speed is specified, and the bucket tip 44a is moved at a constant speed along the target traveling path Tc. Described as However, the bucket tip 44a is moved along the target movement path Tc at a speed corresponding to the operation amount of the operation lever 11, and the movement is offset by offsetting the target movement path Tc by an amount corresponding to the operation amount of the operation lever 12. The bucket tip 44a may be moved along the path T'c.

【０１３０】すなわち目標移動経路Ｔc上の目標点｛ｙt
o，ｚto｝は、目標移動経路Ｔcの移動開始点Ｐto1から
の移動距離Ｓに応じて定まる。これはｆｔを移動距離
Ｓ、目標移動経路Ｔcの関数としてつぎの式で表され
る。That is, the target point ｛yt on the target movement route Tc
o, zto} is determined according to the movement distance S from the movement start point Pto1 of the target movement path Tc. This is expressed by the following equation, where ft is a function of the moving distance S and the target moving path Tc.

【０１３１】 ｛ｙto，ｚto｝＝ｆｔ（Ｓ，Ｔc） …（５） のように求まる。{Yto, zto} = ft (S, Tc) (5)

【０１３２】目標移動経路Ｔc上の移動速度ｖをｖ0一定
として移動距離Ｓを求めるとつぎのようになる。When the moving distance S is determined with the moving speed v on the target moving route Tc being fixed at v0, the following is obtained.

【０１３３】Ｓ＝ｖ0・ｔ …（６） となる。ただしｖ0は定数である。S = v0 · t (6) Here, v0 is a constant.

【０１３４】また移動速度ｖを一定とせずに操作レバー
１１の操作量（操作角度）φに応じてサンプリング時刻
ｎにおける移動距離Ｓnを求めると、ｆlever1（φ）を
操作角度φの関数としてつぎのようになる。When the moving distance Sn at the sampling time n is obtained according to the operation amount (operation angle) φ of the operation lever 11 without keeping the movement speed v constant, flever1 (φ) is calculated as a function of the operation angle φ as follows. Become like

【０１３５】Ｓn＝Ｓn-1＋ｆlever1（φ） …（７） 移動速度ｖはｖ＝ｆlever1（φ）/ｔとなり操作レバー
１１の操作角度φに応じて変化する。Sn = Sn-1 + flever1 (φ) (7) The moving speed v becomes v = flever1 (φ) / t, and changes according to the operation angle φ of the operation lever 11.

【０１３６】移動速度ｖ0が指定されている場合には上
記（６）式が（５）式に代入されて目標移動経路Ｔc上
の目標点｛ｙto，ｚto｝が演算される。操作レバー１１
が操作された場合には上記（７）式が（５）式に代入さ
れて目標点｛ｙto，ｚto｝が演算される。When the moving speed v0 is specified, the above equation (6) is substituted into the equation (5), and the target point {yto, zto} on the target moving path Tc is calculated. Operation lever 11
Is operated, the above equation (7) is substituted into the equation (5), and the target point {yto, zto} is calculated.

【０１３７】また操作レバー１２の操作量（操作角度）
ηに応じて、目標移動経路Ｔcに対する逐次のオフセッ
ト量Ｆnを求めると、ｆlever2（η）を操作角度ηの関
数としてつぎのようになる。The operation amount (operation angle) of the operation lever 12
When the successive offset amount Fn with respect to the target movement route Tc is determined according to η, flever2 (η) is obtained as follows as a function of the operation angle η.

【０１３８】Ｆn＝Ｆn-1＋ｆlever2（η） …（８） 操作レバー１２が操作された場合には上記（８）式で得
られたオフセット量Ｆnが次式に示すようにＹ１軸上の
座標値ｙtoに加えられて新たな目標移動経路Ｔ′cが生
成される。Fn = Fn-1 + flever2 (η) (8) When the operation lever 12 is operated, the offset amount Fn obtained by the above equation (8) is represented by the coordinate value on the Y1 axis as shown in the following equation. A new target movement route T'c is generated in addition to yto.

【０１３９】ｙto＝ｙto＋Ｆn …（９） Ｙ１軸方向にオフセットする代わりにＺ１軸方向にオフ
セットさせてもよい。この場合には上記（８）式で得ら
れたオフセット量Ｆnが次式に示すようにＺ１軸上の座
標値ｚtoに加えられて新たな目標移動経路Ｔ′cが生成
される。Yto = yto + Fn (9) Instead of offsetting in the Y1 axis direction, it may be offset in the Z1 axis direction. In this case, the offset amount Fn obtained by the above equation (8) is added to the coordinate value zto on the Z1 axis as shown in the following equation to generate a new target movement path T'c.

【０１４０】ｚto＝ｚto＋Ｆn …（１０） なおＹ１軸、Ｚ１軸のいずれにオフセットさせるかは、
目標経路Ｔcの角度によって自動的に決定される。Zto = zto + Fn (10) Note that which of the Y1 axis and the Z1 axis is to be offset is
It is automatically determined by the angle of the target route Tc.

【０１４１】なおバケット４４の角度θtoに関しては一
定にすることができる。ただし移動終了点Ｐtomが動作
範囲内に入らない場合には、移動終了点Ｐtomが動作範
囲内に入るようにバケット４４の角度θtoを求め、移動
開始点Ｐto1から移動終了点Ｐtomまで一定の速度で補間
してもよい。The angle θto of the bucket 44 can be made constant. However, when the movement end point Ptom does not fall within the operation range, the angle θto of the bucket 44 is determined so that the movement end point Ptom falls within the operation range, and the speed is constant at a constant speed from the movement start point Pto1 to the movement end point Ptom. Interpolation may be performed.

【０１４２】なお本実施形態ではブーム、アーム、バケ
ットといったリンク機構によって構成される作業機を備
えた建設機械に適用される場合について説明したが、こ
れに限定されることなく、あらゆる構造、形式の掘削用
作業機を備えた建設機械に適用することができる。In this embodiment, the case where the present invention is applied to a construction machine having a working machine constituted by a link mechanism such as a boom, an arm, and a bucket has been described. The present invention can be applied to a construction machine having a working machine for excavation.

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

【図１】図１は実施形態の制御装置の構成例を示すブロ
ック図である。FIG. 1 is a block diagram illustrating a configuration example of a control device according to an embodiment;

【図２】図２は実施形態の制御装置の他の構成例を示す
ブロック図である。FIG. 2 is a block diagram illustrating another configuration example of the control device according to the embodiment;

【図３】図３（ａ）、（ｂ）は、実施形態の油圧ショベ
ルの幾何的関係を示す図である。FIGS. 3A and 3B are diagrams illustrating a geometric relationship of the excavator according to the embodiment;

【図４】図４（ａ）、（ｂ）はオフセットブームを備え
た油圧ショベルの構成を示す図である。FIGS. 4A and 4B are diagrams showing a configuration of a hydraulic shovel provided with an offset boom.

【図５】図５（ａ）、（ｂ）、（ｃ）は法面の形状のデ
ータの内容を概念的に示す図である。FIGS. 5A, 5B, and 5C are diagrams conceptually showing the contents of slope surface shape data.

【図６】図６（ａ）、（ｂ）は表示画面に表示される内
容を説明する図である。FIGS. 6A and 6B are diagrams illustrating contents displayed on a display screen.

【図７】図７は表示画面に表示される内容を説明する図
である。FIG. 7 is a diagram for explaining contents displayed on a display screen;

【図８】図８は表示画面に表示される内容を説明する図
である。FIG. 8 is a diagram for explaining contents displayed on a display screen.

【図９】図９（ａ）、（ｂ）は表示画面に表示される内
容を説明する図である。FIGS. 9A and 9B are diagrams illustrating contents displayed on a display screen.

【図１０】図１０は掘削制御の内容を説明する図であ
る。FIG. 10 is a diagram illustrating the contents of excavation control.

【図１１】図１１（ａ）、（ｂ）、（ｃ）は現在地形デ
ータから道路という構造物を生成するまでの手順を概念
的に示す図である。FIGS. 11A, 11B, and 11C are diagrams conceptually showing a procedure until a structure called a road is generated from current terrain data.

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

１１、１２ 操作レバー １３ 操作切換スイッチ ２１ 作業機制御コントローラ ２３ 油圧シリンダ ２５ 外部コントローラ ２４ グラフィックインターフェース ２４ａ 表示画面 ４４ バケット ４４ａ バケット先端 ５０ ３次元現在地形 ５１ ３次元目標地形 ５７ 平面 ５８ 交線 11, 12 Operation lever 13 Operation changeover switch 21 Work implement control controller 23 Hydraulic cylinder 25 External controller 24 Graphic interface 24a Display screen 44 Bucket 44a Bucket tip 50 3D current terrain 51 3D target terrain 57 Plane 58 Intersecting line

Claims (7)

【特許請求の範囲】[Claims] 【請求項１】 掘削用の作業機を作動させて３次元の地
形を３次元の目標地形にする掘削作業を行う建設機械に
適用され、当該掘削作業をガイダンスする建設機械の掘
削作業ガイダンス装置において、 前記掘削用作業機の３次元位置を計測する位置計測手段
と、 前記位置計測手段により計測した掘削用作業機の位置を
通過する平面を演算する平面演算手段と、 前記平面演算手段によって演算された平面を示すデータ
と、前記３次元目標地形を示すデータとに基づいて、前
記平面と前記３次元目標地形との交線を演算する交線演
算手段と、 前記交線演算手段によって演算された前記３次元目標地
形を示す交線の位置と前記掘削用作業機の位置との相対
位置関係を提示する提示手段とを具えたことを特徴とす
る建設機械の掘削作業ガイダンス装置。The present invention relates to a construction machine excavation operation guidance apparatus for applying to a construction machine that performs an excavation operation to make a three-dimensional terrain a three-dimensional target terrain by operating an excavation work machine and guiding the excavation operation. Position measuring means for measuring a three-dimensional position of the excavating work machine; plane calculating means for calculating a plane passing through the position of the excavating work machine measured by the position measuring means; Intersection calculating means for calculating a line of intersection between the plane and the three-dimensional target terrain, based on the data indicating the three-dimensional target terrain and the data indicating the three-dimensional target terrain. A digging operation guidance device for a construction machine, comprising: a presentation means for presenting a relative positional relationship between a position of an intersection line indicating the three-dimensional target terrain and a position of the digging work machine. . 【請求項２】 作業機の先端部にバケットが設けられ、
当該作業機を作動させて３次元の地形を３次元の目標地
形にする掘削作業を行う建設機械に適用され、当該掘削
作業をガイダンスする建設機械の掘削作業ガイダンス装
置において、 前記バケットの３次元位置を計測する位置計測手段と、 前記位置計測手段により計測したバケット位置を通過す
る平面を演算する平面演算手段と、 前記平面演算手段によって演算された平面を示すデータ
と、前記３次元目標地形を示すデータとに基づいて、前
記平面と前記３次元目標地形との交線を演算する交線演
算手段と、 前記交線演算手段によって演算された前記３次元目標地
形を示す交線の位置と前記バケットの位置とを同一画面
上に表示する表示手段とを具えたことを特徴とする建設
機械の掘削作業ガイダンス装置。2. A bucket is provided at a tip of the working machine,
The present invention is applied to a construction machine that performs an excavation operation to convert a three-dimensional terrain into a three-dimensional target terrain by operating the work machine, and a digging operation guidance device for the construction machine that guides the digging operation. , A plane calculating means for calculating a plane passing through the bucket position measured by the position measuring means, data indicating the plane calculated by the plane calculating means, and indicating the three-dimensional target terrain. An intersection calculating means for calculating an intersection between the plane and the three-dimensional target terrain based on the data; a position of the intersection indicating the three-dimensional target terrain calculated by the intersection calculating means; And a display means for displaying the position of the excavator on the same screen. 【請求項３】 前記位置計測手段は、前記バケットの先
端の３次元位置を計測するものであり、 前記平面演算手段は、前記バケットの先端位置を通過す
る平面を演算するものであることを特徴とする請求項２
記載の建設機械の掘削作業ガイダンス装置。3. The position measuring means measures a three-dimensional position of a tip of the bucket, and the plane calculating means calculates a plane passing through the position of the tip of the bucket. Claim 2
An excavation work guidance device for a construction machine according to the above. 【請求項４】 前記掘削用作業機または前記バケットは
アクチュエータが駆動されることにより作動するもので
あり、 前記平面演算手段は、前記アクチュエータが駆動された
ときに前記掘削用作業機または前記バケットが作動する
面を含む平面を演算するものであることを特徴とする請
求項１または２記載の建設機械の掘削作業ガイダンス装
置。4. The excavating work machine or the bucket operates when an actuator is driven, and the plane calculating means is configured to control the excavating work machine or the bucket when the actuator is driven. The excavation work guidance device for a construction machine according to claim 1 or 2, wherein a plane including an operating surface is calculated. 【請求項５】 現在の３次元地形データと、目標構造物
の縁部の形状を示すデータと、法面の形状を示すデータ
とに基づいて、前記目標構造物の縁部を法尻とする３次
元目標地形のデータを作成する３次元目標地形データ作
成手段をさらに具えたことを特徴とする請求項１または
２記載の建設機械の掘削作業ガイダンス装置。5. An edge of the target structure is defined as a bottom based on current three-dimensional topographic data, data indicating the shape of the edge of the target structure, and data indicating the shape of the slope. The excavation work guidance device for a construction machine according to claim 1 or 2, further comprising a three-dimensional target terrain data creating means for creating three-dimensional target terrain data. 【請求項６】 掘削用の作業機を作動させて３次元の地
形を３次元の目標地形にする掘削作業を行う建設機械に
適用され、前記掘削用作業機を制御する建設機械の掘削
制御装置において、 前記掘削用作業機の３次元位置を計測する位置計測手段
と、 前記位置計測手段により計測した掘削用作業機の位置を
通過する平面を演算する平面演算手段と、 前記平面演算手段によって演算された平面を示すデータ
と、前記３次元目標地形を示すデータとに基づいて、前
記平面と前記３次元目標地形との交線を演算する交線演
算手段と、 前記交線演算手段によって演算された前記３次元目標地
形を示す交線を、目標移動経路とし、当該目標移動経路
に沿って前記掘削用作業機が移動するように当該掘削用
作業機を制御する制御手段とを具えたことを特徴とする
建設機械の掘削制御装置。6. An excavation control device for a construction machine, which is applied to a construction machine that performs an excavation operation by operating a work machine for excavation to convert a three-dimensional terrain into a three-dimensional target terrain, and controls the work machine for excavation. In the above, a position measuring means for measuring a three-dimensional position of the excavating work machine, a plane calculating means for calculating a plane passing through the position of the excavating work machine measured by the position measuring means, and a calculation by the plane calculating means Intersection calculating means for calculating an intersection between the plane and the three-dimensional target terrain, based on the data indicating the obtained plane and the data indicating the three-dimensional target terrain, And control means for controlling the excavating work machine so that the excavating work machine moves along the target moving route. Characteristic Excavation control system for a construction machine to be. 【請求項７】 掘削用の作業機を作動させて３次元の地
形を３次元の目標地形にする掘削作業を行う建設機械に
適用され、掘削用操作手段の操作に応じて前記掘削用作
業機を制御する作業機コントローラを備えた建設機械の
掘削制御装置において、 前記建設機械に外部より装着自在であって、前記３次元
目標地形のデータを、前記作業機コントローラに出力す
る外部コントローラと、 前記掘削用操作手段の操作に応じて前記掘削用作業機を
制御する第１の制御モードと、前記３次元目標地形デー
タに基づき当該３次元目標地形上の目標移動経路に沿っ
て前記掘削用作業機が移動するように当該掘削用作業機
を制御する第２の制御モードのいずれかの制御モードを
選択する制御モード選択手段と、 前記外部コントローラが前記建設機械に装着されている
か否かを判断する判断手段と、 前記判断手段によって前記外部コントローラが前記建設
機械に装着されていると判断された場合には、前記制御
モード選択手段の選択結果に応じた制御モードを前記作
業機コントローラで実行させ、前記判断手段によって前
記外部コントローラが前記建設機械に装着されていない
と判断された場合には、前記制御モード選択手段の選択
いかんにかかわらず前記第１の制御モードを前記作業機
コントローラで実行させることを特徴とする建設機械の
掘削制御装置。7. A digging work machine which is applied to a construction machine which performs digging work by operating a digging work machine to convert a three-dimensional terrain into a three-dimensional target terrain, and in accordance with an operation of a digging operation means. An excavation control device for a construction machine including a work machine controller for controlling the work machine, an external controller which is attachable to the construction machine from the outside and outputs the three-dimensional target terrain data to the work machine controller, A first control mode for controlling the excavating work machine in accordance with an operation of the excavating operation means, and the excavating work machine along a target movement path on the three-dimensional target terrain based on the three-dimensional target terrain data Control mode selecting means for selecting one of the second control modes for controlling the excavating work machine such that the excavating work machine moves, and the external controller is mounted on the construction machine. Determining means for determining whether or not the external controller is mounted on the construction machine by the determining means, and setting a control mode according to the selection result of the control mode selecting means. The first control mode is executed by the work machine controller, and when the determination unit determines that the external controller is not mounted on the construction machine, the first control mode is set regardless of the selection of the control mode selection unit. An excavation control device for a construction machine, which is executed by the work machine controller.