JP3686745B2

JP3686745B2 - Self-driving construction machinery

Info

Publication number: JP3686745B2
Application number: JP19415597A
Authority: JP
Inventors: 英人石橋; 榑沼　　透; 誠二山下; 好幸永野; 一宏菅原; 昭橋本; 元安田
Original assignee: Hitachi Construction Machinery Co Ltd
Current assignee: Hitachi Construction Machinery Co Ltd
Priority date: 1997-07-18
Filing date: 1997-07-18
Publication date: 2005-08-24
Anticipated expiration: 2017-07-18
Also published as: JPH1136372A

Description

【０００１】
【発明の属する技術分野】
本発明は、自動運転を行う建設機械に係わり、特に周辺装置との衝突を防止する手段を備えた自動運転建設機械に関する。
【０００２】
【従来の技術】
油圧ショベルを用いた自動化の一手法として、特公昭５４−７１２１号公報に示されているように、教示・再生によるシステムがある。この従来技術は、教示動作によって得られた角度、位置等の動作状態量を記憶し、再生時に前述した記憶値を用いて油圧ショベルを再生動作させるものであり、この油圧ショベルの周囲環境を考慮していない形式の自己完結型のシステムである。
【０００３】
【発明が解決しようとする課題】
通常、作業現場では、油圧ショベル等の建設機械はトラックやクラッシャ等の他の作業機械と共同して運転される場合が多く、これを自動化するに当たって、他の作業機械や周辺装置との接触や衝突を防止しなければならない。
【０００４】
しかし、上記の自己完結形のシステムでは、他の作業機械等と相対的な位置ずれがなければ、衝突はあり得ないため接触等を防止するために特別な手段は取られていなかった。例えば、自動運転中に油圧ショベルの車体が傾斜した場合、想定した動作軌跡からのずれが生じるため、機械同士が接触する可能性がある。しかし、従来の自動運転建設機械では車体の傾斜の影響に関しては考慮されていないものが多かった。
【０００５】
接触等を防止する手段としては、視覚センサ等の外界センサを積極的に用いて他の作業機械の位置を認識するシステムや、ＧＰＳ等を用いるシステムを用いる方法等が考えられるが、これらのシステムはセンサや装置が高価なものとなり、また、検出したデータを処理して所望のデータとするための処理負担も大きく、実用的ではない。
【０００６】
本発明は、上記の問題点に鑑みて、車体が傾斜した場合に、比較的簡単な方法で、他の作業機械等との接触防止を図った自動運転建設機械を提供することにある。
【０００７】
【課題を解決するための手段】
本発明は、上記の課題を達成するために次のような手段を採用した。
【０００８】
教示された掘削から放土までの一連の動作を再生操作により繰り返し動作する自動運転建設機械において、
該自動運転建設機械は、
該自動運転建設機械の基準面に対する傾斜角を検出する傾斜角検出手段と、
前記傾斜角を計測すべき該自動運転建設機械の計測位置を記憶する計測位置記憶手段と、
前記基準面に対する許容される傾斜量を記憶する傾斜閾値記憶手段と、
前記傾斜角を計測すべき計測位置において、前記検出された傾斜角が前記傾斜量の範囲を越える時は、該自動運転建設機械の動作を停止させる停止信号を出力する車体傾斜判定手段とを備え、
前記傾斜閾値記憶手段は、前者が後者より小さく、それぞれが前記基準面に対して許容される第１の傾斜量と第２の傾斜量とを記憶しており、
前記車体傾斜判定手段は、前記傾斜角を計測すべき計測位置において、前記検出された傾斜角が、前記第１の傾斜量を越え第２の傾斜量を越えない時は、所定の再生動作の終了後に前記停止信号を出力し、前記検出された傾斜角が、前記第２の傾斜量を越える時は直ちに前記停止信号を出力することを特徴とする自動運転建設機械。
【００１１】
【発明の実施の形態】
以下に本発明の一実施形態を図１〜図４を用いて説明する。
【００１２】
図１は本実施形態に係わる自動運転される油圧ショベル（以下自動運転ショベルという）の全体構成図である。
【００１３】
図において、１は図示されていない土石貯留所に貯留された土石を掘削して後述する砕石機２に放出する油圧ショベル、２は油圧ショベル１から投下された土石を砕石する砕石機、３は油圧ショベル１の再生操作を行うのに適した任意の場所に設置された操作ボックスである。
【００１４】
油圧ショベル１は、走行体１０と、走行体１０上に旋回可能に設けられた旋回体１１と、旋回体１１に俯仰動可能に設けられたブーム１２と、ブーム１２の先端に回動可能に設けられたアーム１３と、アーム１３の先端に回動可能に設けられたバケット１４と、ブーム１２、アーム１３、バケット１４をそれぞれ俯仰動作するためのシリンダ１５，１６，１７と、旋回体１１に設けられた運転室１８と、操作ボックス３との間で信号の送受信を行うアンテナ１９とから構成されている。
【００１５】
また、θは地面４に対する油圧ショベル１の傾斜角を表し、油圧ショベル１には、地面４に対する傾斜角θを検出する傾斜角センサ１１１、旋回体１１の旋回角を検出する角度センサ１１２、旋回体１１とブーム１２との俯仰角を検出する角度センサ１１３と、ブーム１２とアーム１３の回動角を検出する角度センサ１１４、アーム１３とバケット１４との回動角を検出する角度センサ１１５が設けられている。
【００１６】
また、砕石機２は、走行体２０と、ホッパ２１と、ホッパ２１の下方に設けられた砕石部２２と、砕石部２２の下方に設けられたコンベア２３とから構成されており、２４は砕石機２によって粉砕された土石を示す。
【００１７】
また、操作ボックス３は、支持台３０と、支持台３０に固定された教示再生操作装置３１とから構成され、教示再生操作装置３１には、再生起動釦３１１と、再生停止釦３１２と、非常停止釦３１３と、教示再生操作装置３１本体と機械的かつ電気的に接続可能に設けられ、教示時に操作される教示操作部３１４と、教示結果を表示する表示部３１４１と、油圧ショベル１のアンテナ１９との間で信号の送受信を行うアンテナ３１５とを備えている。
【００１８】
次に、本実施形態に係わる自動運転ショベルの制御機構を図２に示すブロック図を用いて説明する。
【００１９】
なお、図において、図１に示した油圧ショベル１と操作ボックス３の構成と対応する部分については同一符号を付して説明を省略する。
【００２０】
図において、３１６は再生時に操作される再生操作部、３１７は教示操作部３１４または再生操作部３１６から出力される信号を後述する自動運転コントローラ５０に出力するための所定の信号に形成するための車外信号生成部、３１８および５４はそれぞれ教示再生操作装置３１と自動運転コントローラ５０間のデータを送受信するための車外無線装置および車内無線装置である。
【００２１】
なお、信号生成部３１７は、マイクロコンピュータを使用した一般的なコントローラで構成され、入力した信号に相当する指令コードを生成する機能を有する。
【００２２】
５は車内搭載装置を示し、５０は自動運転コントローラ、５１は自動運転コントローラ５０から出力される駆動電流によって駆動される補助制御弁、５２は、補助制御弁５１から出力される油圧信号により制御され、アクチュエータに流入する油量または油圧を制御する主制御弁、５３は図１に示す油圧ショベル１の各部を作動するためのシリンダ１５，１６，１７等のアクチュエータ、３１４’は教示操作部である。
【００２３】
教示時は、通常、運転室１８内に装着される教示操作部３１４’からの操作によって教示が行われ、自動運転コントローラ５０はその操作に従って、各角度センサ１１２〜１１５からの検出値を入力して演算し、後に説明するように所定の記憶領域に教示位置データおよび教示コマンドとして記憶する。なお、図において、教示操作部３１４は、運転室１８内の教示操作部３１４’から外されて教示再生操作装置３１に装着されている時の状態を示す。再生時は、再生操作部３１６から再生起動釦３１１をオンすることによって、車外信号生成部３１７において形成された所定の信号が無線装置３１５，１９を介して自動運転コントローラ５０に送信され、再生処理が開始される。自動運転コントローラ５０において再生処理が開始されると、記憶されている教示位置データが呼び出され、角度センサ１１２〜１１５から得られた現在位置情報と対比しながら、この教示位置データに合致するように、旋回体１１、ブーム１２、アーム１３、バケット１４をそれぞれ作動するための補助制御弁５１に駆動電流を出力する。補助制御弁５１からさらに主制御弁５２を介して各アクチュエータ５３の油圧を制御して油圧ショベル１の自動運転を行う。
【００２４】
次に、本実施形態に係わる自動運転ショベルにおける機能構成を図３に示すブロック図を用いて説明する。
【００２５】
なお、図３において、図１および図２に示した構成と対応する部分については同一符号を付して説明を省略する。
【００２６】
５０１は角度センサ１１２から１１５において検出された角度信号を現在の位置データに演算する現在位置演算部、５０２は、教示時、教示操作部３１４または３１４’からの操作により、教示コマンドと、現在位置演算部５０１から得られた油圧ショベル１の現在位置を教示位置データとして出力する教示処理部、５０３は教示処理部５０２から出力された教示コマンドを格納する教示コマンド格納部、５０４は教示処理部５０２から出力された教示位置データを格納する教示位置格納部、５０５は、再生操作部３１６からの起動信号により起動された時、教示コマンド格納部５０３に格納されている教示コマンドを逐次解釈して教示位置格納部５０４から所定の教示位置データの出力を指示するコマンドインタプリタ部、５０６はコマンドインタプリタ部５０５からの指令に応じて教示位置格納部５０４から教示位置データを出力処理する教示位置出力処理部、５０７は、油圧ショベル１が各教示位置間を円滑に動作するように、教示位置出力処理部５０６から出力された教示位置データから教示位置データ間に演算によって補間された教示位置データを作成し出力するサーボ前処理部、５０８はサーボ前処理部５０７から出力された補間された教示位置データと現在位置演算部５０１から出力される現在位置データとを対比して油圧ショベル１の各部を所定の位置に制御するための駆動電流を出力するサーボ制御部、５０９は、教示時に教示データと共に記憶され、車体傾斜の判定を行う油圧ショベル１の計測位置が記憶されている計測位置格納部、５１０は計測位置においてどの程度の車体傾斜を許容するかの許容傾斜量が記憶されている傾斜閾値格納部、５１１は油圧ショベル１に設けられた傾斜角センサ１１１からの検出値を所定の傾斜角データに演算する現在傾斜演算部、５１２は、コマンドインタプリタ部５０５の指示により制御され、計測位置格納部５０９、傾斜閾値格納部５１０、現在傾斜演算部５１１からの各データに基づいて、油圧ショベル１の傾斜を判定して、その結果をコマンドインタプリタ部５０５およびサーボ前処理部５０７に出力する車体傾斜判定部である。
【００２７】
次に本実施形態の自動運転ショベルの動作を図３に基づいて説明する。
【００２８】
教示操作は、教示操作部３１４または３１４’から操作される。通常は、教示操作部３１４’が油圧ショベル１の運転室１８内に装着され、運転室から教示操作が行われる。
【００２９】
教示操作部３１４’が運転室１８内に装着され、教示操作が行われると、その指令は教示処理部５０２に入力され、教示処理部５０２で現在位置演算部５０１から現在位置データを入力して、各教示点に対応する教示コマンドと教示位置データを生成する。生成された教示コマンドと教示位置データはそれぞれ、教示コマンド格納部５０３と教示位置格納部５０４に格納される。
【００３０】
ここで、教示コマンドとは、例えば、ｖ＝０．７のような速度の指令命令、ｍｏｖｅＰ１、ｍｏｖｅＰ２、・・・ｍｏｖｅＰｎのような位置の動作命令から構成される。ここでｖは速度を表すコマンド、ｍｏｖｅは動作を表すコマンド、Ｐ１・・・Ｐｎはラベルを表す。これらの教示コマンドのパラメータは、各油圧ショベルの各部の関節の角度情報を示すラベルに相当し、そのラベル情報は、教示位置データとして教示位置格納部５０４に格納される。
【００３１】
再生処理は、再生起動釦３１１をオンすることによって、コマンドインタプリタ部５０５は、起動命令により教示コマンド格納部５０３に格納されている教示コマンドを順次読み出し実行する。教示コマンドがｍｏｖｅ命令の場合は、教示位置出力処理部５０６に、教示位置格納部５０４から該当するパラメータを出力し、サーボ前処理部５０７に転送する。サーボ前処理部５０７は、コマンドインタプリタ部５０５から与えられた目標速度で各関節が動作するように角度の補間計算を行い、サーボ制御部５０８に角度目標値を出力する。サーボ制御部５０８は、現在位置演算部５０１で演算された現在位置をもとに、フイードバック制御を行い、補助制御弁５１を駆動するための駆動電流を出力する。これにより、主制御弁５２が制御されてアクチュエータ５３に、所定の圧油を供給し、油圧ショベル１の各関節を駆動する。
【００３２】
一方、車体傾斜判定部５１２は、計測位置格納部５０９から車体傾斜を判定すべき計測位置を入手し、油圧ショベル１がその位置に達すると、現在傾斜演算部５１１から現在の傾斜角データを入力し、さらに傾斜閾値格納部５１０から入力される傾斜閾値データと対比して傾斜角データが許容範囲内にあるか否かを判定する。判定の結果、傾斜角データが傾斜閾値データの範囲内にある時は、コマンドインタプリタ部５０５に正常信号を送出し、コマンドインタプリタ部５０５は次のコマンドを読んで処理を継続する。また、傾斜角データが傾斜閾値データの許容範囲を越える時は、コマンドインタプリタ部５０５に停止信号を送出し、コマンドインタプリタ部５０５における次処理を停止させると共に、停止信号をサーボ前処理部５０７に送出する。サーボ前処理部５０７は処理を停止して油圧ショベル１の動作を停止させ、油圧ショベル１と砕石機２等の他の作業機械との接触を回避させる。
【００３３】
次に、図３に示す車体傾斜判定部５１２における接触防止判定の処理手順を図４に示すフローチャートを用いて説明する。
【００３４】
ここで、α₁は現在のサイクルのみ放土可能な傾斜量を表し、この傾斜量以上では、次のサイクルの動作において傾斜量が増加して接触が発生する可能性があると判断される傾斜量を表し、α₂は接触防止のための限界傾斜量を表す。
【００３５】
再生処理時、即ち自動運転が行われている状態において、ステップ１において、計測位置格納部５０９に格納されている計測位置である放土開始位置に達したか否かが判断され、放土開始位置に達すると、ステップ２において、現在傾斜演算部５１１からその時の傾斜角データであるθを読み込む。ステップ３において、傾斜閾値格納部５１０から傾斜量α₁を読み込み、傾斜角データθと傾斜量α₁とを対比する。ここでθ＜α₁の時は正常であると判断して、ステップ４において、サイクル停止フラグをＯＦＦにし、ステップ５において放土を行う。ステップ８でサイクル停止フラグがＯＮかＯＦＦかが判断され、ＯＦＦの場合は、ステップ９において自動運転の次の動作が実行される。ステップ３において、θ≧α₁の時は、ステップ６に移行し、傾斜角データθがα₁≦θ＜α₂の範囲内にあるか否かが判断される。範囲内にある時は、ステップ７において、サイクル停止フラグをＯＮにして、ステップ５で放土し、ステップ８においてサイクル停止フラグがＯＮであるので、ステップ１０において異常と判定し、コマンドインタプリタ部５０５およびサーボ前処理部５０７に停止信号を出力する。ステップ６において、傾斜角データθがα₁≦θ＜α₂の範囲内にない時は、放土することなく直ちにステップ１０に移行して、停止信号を出力する。
【００３６】
上記のごとく、本実施形態によれば、自動運転ショベルが地面等の基準面に対して傾斜した時、自動運転ショベルと他の産業機械との接触防止を図ることができ、自動運転ショベルとしての信頼性を向上させることができる。
【００３７】
また、車体傾斜の計測位置を教示によって与えることができるので、検出装置の調整が不要となり取り扱いが簡単となり、また傾斜角センサを簡単に設置することができる。
【００３８】
【発明の効果】
以上のごとく、本発明によれば、自動運転建設機械に傾斜角検出手段を設け、所定の計測位置で、傾斜角検出手段によって検出された傾斜角と所定の傾斜閾値とを対比し、自動運転建設機械の車体傾斜を判定するようにしたので、簡単な構成で車体傾斜の検出が可能となり、他の作業機械との接触を容易に回避することができる。
【図面の簡単な説明】
【図１】本発明の一実施形態に係わる自動運転ショベルの全体構成図である。
【図２】本実施形態に係わる、自動運転ショベルの制御機構を示すブロック図である。
【図３】本実施形態に係わる、自動運転ショベルの機能構成を示すブロック図である。
【図４】図３に示す車体傾斜判定部５１２の車体傾斜判定の処理手順を示すフローチャートである。
【符号の説明】
３操作ボックス
３１教示再生操作装置
５車内搭載装置
５０自動運転コントローラ
１１１傾斜センサ
１１２〜１１５角度センサ
３１４，３１４’ 教示操作部
３１６再生操作部
５０１現在位置演算部
５０３教示コマンド格納部
５０４教示位置格納部
５０５コマンドインタプリタ部
５０７サーボ前処理部
５０８サーボ制御部
５０９計測位置格納部
５１０傾斜閾値格納部
５１１現在傾斜演算部
５１２車体傾斜判定部[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a construction machine that performs automatic operation, and more particularly, to an automatic operation construction machine that includes means for preventing a collision with a peripheral device.
[0002]
[Prior art]
As a method of automation using a hydraulic excavator, there is a system based on teaching and reproduction as disclosed in Japanese Patent Publication No. 54-7121. This prior art stores the operating state quantities such as the angle and position obtained by the teaching operation, and regenerates the hydraulic excavator using the stored value at the time of reproduction, and considers the surrounding environment of the hydraulic excavator. This is a self-contained system that has not been completed.
[0003]
[Problems to be solved by the invention]
Normally, construction machines such as hydraulic excavators are often operated in cooperation with other work machines such as trucks and crushers at the work site, and in order to automate this, contact with other work machines and peripheral equipment and Collisions must be prevented.
[0004]
However, in the above self-contained system, there is no collision if there is no relative displacement with other work machines and the like, so no special measures have been taken to prevent contact or the like. For example, when the vehicle body of a hydraulic excavator is tilted during automatic operation, there is a possibility that the machines come into contact with each other because a deviation from an assumed operation locus occurs. However, many conventional automatic construction machines do not take into account the effects of vehicle body tilt.
[0005]
As means for preventing contact and the like, a system that actively uses an external sensor such as a visual sensor to recognize the position of another work machine, a method that uses a system that uses GPS, and the like can be considered. The sensor and the apparatus are expensive, and the processing load for processing the detected data into desired data is large, which is not practical.
[0006]
In view of the above problems, the present invention is to provide an automatic driving construction machine that prevents contact with other work machines and the like by a relatively simple method when the vehicle body is inclined.
[0007]
[Means for Solving the Problems]
The present invention employs the following means in order to achieve the above-described problems.
[0008]
In an automatic operation construction machine that repeats a series of operations from excavation to earthing as taught by regenerating operation,
The automatic operation construction machine is
An inclination angle detecting means for detecting an inclination angle with respect to a reference plane of the automatic operation construction machine;
Measurement position storage means for storing the measurement position of the automatic operation construction machine to measure the inclination angle;
Tilt threshold storage means for storing an allowable tilt amount with respect to the reference plane;
A vehicle body inclination determination means for outputting a stop signal for stopping the operation of the automatic operation construction machine when the detected inclination angle exceeds the range of the inclination amount at the measurement position where the inclination angle is to be measured. ,
The inclination threshold value storage means stores the first inclination amount and the second inclination amount, each of which is smaller than the latter and each of which is allowed with respect to the reference plane,
The vehicle body inclination determination means performs a predetermined regenerating operation when the detected inclination angle exceeds the first inclination amount and does not exceed the second inclination amount at the measurement position where the inclination angle is to be measured. An automatic operation construction machine that outputs the stop signal after completion and outputs the stop signal immediately when the detected inclination angle exceeds the second inclination amount .
[0011]
DETAILED DESCRIPTION OF THE INVENTION
An embodiment of the present invention will be described below with reference to FIGS.
[0012]
FIG. 1 is an overall configuration diagram of an automatically operated hydraulic excavator (hereinafter referred to as an automatic operation shovel) according to the present embodiment.
[0013]
In the figure, 1 is a hydraulic excavator that excavates debris stored in a debris reservoir not shown, and releases it to a lithotripter 2 described later, 2 is a lithotripter that crushes debris dropped from the hydraulic excavator 1, 3 This is an operation box installed at an arbitrary place suitable for performing the regeneration operation of the hydraulic excavator 1.
[0014]
The hydraulic excavator 1 includes a traveling body 10, a revolving body 11 provided on the traveling body 10 so as to be capable of turning, a boom 12 provided on the revolving body 11 so as to be able to be lifted and lowered, and a pivot at the tip of the boom 12. The arm 13 provided, the bucket 14 pivotably provided at the tip of the arm 13, the cylinders 15, 16, and 17 for raising and lowering the boom 12, the arm 13, and the bucket 14, respectively, It is comprised from the operator's cab 18 provided and the antenna 19 which transmits / receives a signal between the operation boxes 3. FIG.
[0015]
Θ represents the inclination angle of the excavator 1 with respect to the ground 4. The excavator 1 includes an inclination angle sensor 111 for detecting the inclination angle θ with respect to the ground 4, an angle sensor 112 for detecting the turning angle of the revolving structure 11, and turning. An angle sensor 113 that detects the elevation angle between the body 11 and the boom 12, an angle sensor 114 that detects the rotation angle between the boom 12 and the arm 13, and an angle sensor 115 that detects the rotation angle between the arm 13 and the bucket 14. Is provided.
[0016]
The lithotripter 2 is composed of a traveling body 20, a hopper 21, a crushed stone portion 22 provided below the hopper 21, and a conveyor 23 provided below the crushed stone portion 22. The earth and stone crushed by the machine 2 is shown.
[0017]
The operation box 3 includes a support base 30 and a teaching playback operation device 31 fixed to the support base 30. The teaching playback operation device 31 includes a playback start button 311, a playback stop button 312, A stop button 313, a teaching operation unit 314 which is provided so as to be mechanically and electrically connectable to the main body of the teaching reproduction operation device 31 and is operated during teaching, a display unit 3141 for displaying a teaching result, and an antenna of the excavator 1 19 is provided with an antenna 315 for transmitting and receiving signals to and from 19.
[0018]
Next, the control mechanism of the automatic driving shovel according to the present embodiment will be described with reference to the block diagram shown in FIG.
[0019]
In the figure, portions corresponding to the configurations of the hydraulic excavator 1 and the operation box 3 shown in FIG.
[0020]
In the figure, reference numeral 316 denotes a reproduction operation unit operated at the time of reproduction, and 317 forms a signal output from the teaching operation unit 314 or the reproduction operation unit 316 into a predetermined signal for outputting to an automatic operation controller 50 described later. Outside-vehicle signal generation units 318 and 54 are an outside-vehicle wireless device and an inside-vehicle wireless device for transmitting and receiving data between the teaching reproduction operation device 31 and the automatic driving controller 50, respectively.
[0021]
The signal generation unit 317 is configured by a general controller using a microcomputer and has a function of generating a command code corresponding to the input signal.
[0022]
Reference numeral 5 denotes an in-vehicle device, 50 is an automatic operation controller, 51 is an auxiliary control valve driven by a drive current output from the automatic operation controller 50, and 52 is controlled by a hydraulic signal output from the auxiliary control valve 51. , A main control valve for controlling the amount of oil or hydraulic pressure flowing into the actuator, 53 is an actuator such as cylinders 15, 16, and 17 for operating each part of the excavator 1 shown in FIG. 1, and 314 'is a teaching operation unit .
[0023]
At the time of teaching, teaching is normally performed by an operation from a teaching operation unit 314 ′ mounted in the cab 18, and the automatic operation controller 50 inputs detection values from the angle sensors 112 to 115 according to the operation. As described later, it is stored as teaching position data and teaching commands in a predetermined storage area. In the figure, the teaching operation unit 314 is shown as being removed from the teaching operation unit 314 ′ in the cab 18 and attached to the teaching reproduction operation device 31. At the time of reproduction, by turning on the reproduction activation button 311 from the reproduction operation unit 316, a predetermined signal formed in the outside signal generation unit 317 is transmitted to the automatic operation controller 50 via the wireless devices 315 and 19, and reproduction processing is performed. Is started. When the reproduction process is started in the automatic operation controller 50, the stored teaching position data is called up so that it matches the teaching position data while being compared with the current position information obtained from the angle sensors 112 to 115. The drive current is output to the auxiliary control valve 51 for operating the swing body 11, the boom 12, the arm 13, and the bucket 14, respectively. The hydraulic pressure of each actuator 53 is controlled from the auxiliary control valve 51 via the main control valve 52 to automatically operate the hydraulic excavator 1.
[0024]
Next, the functional configuration of the automatic excavator according to the present embodiment will be described with reference to the block diagram shown in FIG.
[0025]
3, parts corresponding to those shown in FIGS. 1 and 2 are denoted by the same reference numerals, and description thereof is omitted.
[0026]
Reference numeral 501 denotes a current position calculation unit that calculates an angle signal detected by the angle sensors 112 to 115 into current position data. Reference numeral 502 denotes a teaching command and a current position by an operation from the teaching operation unit 314 or 314 ′ during teaching. A teaching processing unit that outputs the current position of the hydraulic excavator 1 obtained from the arithmetic unit 501 as teaching position data, 503 is a teaching command storage unit that stores teaching commands output from the teaching processing unit 502, and 504 is a teaching processing unit 502. The teaching position storage unit 505 for storing the teaching position data output from, when activated by the activation signal from the reproduction operation unit 316, sequentially teaches the teaching commands stored in the teaching command storage unit 503 and teaches them. A command interpreter unit for instructing output of predetermined teaching position data from the position storage unit 504, 506 is a command A teaching position output processing unit 507 for outputting teaching position data from the teaching position storage unit 504 in response to a command from the interpreter unit 505, outputs a teaching position so that the excavator 1 operates smoothly between the teaching positions. A servo preprocessing unit that generates and outputs teaching position data interpolated between teaching position data from teaching position data output from the processing unit 506, and 508 indicates an interpolated teaching position output from the servo preprocessing unit 507. The servo control unit 509 outputs a driving current for controlling each part of the hydraulic excavator 1 to a predetermined position by comparing the data and the current position data output from the current position calculation unit 501. The measurement position storage unit 510 stores the measurement position of the hydraulic excavator 1 that is stored and determines the vehicle body tilt. An inclination threshold value storage unit 511 for storing an allowable inclination amount indicating whether or not to allow the vehicle body inclination is calculated to calculate a detection value from an inclination angle sensor 111 provided in the hydraulic excavator 1 into predetermined inclination angle data. The tilt calculation unit 512 is controlled by an instruction from the command interpreter unit 505, and determines the tilt of the excavator 1 based on the data from the measurement position storage unit 509, the tilt threshold storage unit 510, and the current tilt calculation unit 511. The vehicle body inclination determination unit outputs the result to the command interpreter unit 505 and the servo preprocessing unit 507.
[0027]
Next, the operation of the automatic driving excavator of this embodiment will be described with reference to FIG.
[0028]
The teaching operation is operated from the teaching operation unit 314 or 314 ′. Normally, the teaching operation unit 314 ′ is mounted in the cab 18 of the excavator 1, and a teaching operation is performed from the cab.
[0029]
When the teaching operation unit 314 ′ is installed in the cab 18 and a teaching operation is performed, the instruction is input to the teaching processing unit 502, and the current position data is input from the current position calculation unit 501 by the teaching processing unit 502. Then, a teaching command and teaching position data corresponding to each teaching point are generated. The generated teaching command and teaching position data are stored in the teaching command storage unit 503 and the teaching position storage unit 504, respectively.
[0030]
Here, the teaching command includes, for example, a speed command command such as v = 0.7, and an operation command at a position such as move P1, move P2,..., Move Pn. Here, v represents a command representing speed, move represents a command representing operation, and P1... Pn represent labels. These teaching command parameters correspond to labels indicating the angle information of the joints of each part of each hydraulic excavator, and the label information is stored in the teaching position storage unit 504 as teaching position data.
[0031]
In the reproduction process, when the reproduction activation button 311 is turned on, the command interpreter unit 505 sequentially reads and executes the teaching commands stored in the teaching command storage unit 503 according to the activation instruction. When the teaching command is a move command, the corresponding parameter is output from the teaching position storage unit 504 to the teaching position output processing unit 506 and transferred to the servo preprocessing unit 507. The servo preprocessing unit 507 performs angle interpolation calculation so that each joint operates at the target speed given from the command interpreter unit 505, and outputs the angle target value to the servo control unit 508. The servo controller 508 performs feedback control based on the current position calculated by the current position calculator 501 and outputs a drive current for driving the auxiliary control valve 51. As a result, the main control valve 52 is controlled, and predetermined pressure oil is supplied to the actuator 53 to drive each joint of the excavator 1.
[0032]
On the other hand, the vehicle body inclination determination unit 512 obtains the measurement position from which the vehicle body inclination should be determined from the measurement position storage unit 509, and inputs the current inclination angle data from the current inclination calculation unit 511 when the hydraulic excavator 1 reaches the position. Further, it is determined whether or not the tilt angle data is within the allowable range in comparison with the tilt threshold data input from the tilt threshold storage unit 510. As a result of the determination, when the tilt angle data is within the range of the tilt threshold data, a normal signal is sent to the command interpreter unit 505, and the command interpreter unit 505 reads the next command and continues processing. When the tilt angle data exceeds the allowable range of the tilt threshold data, a stop signal is sent to the command interpreter unit 505, the next process in the command interpreter unit 505 is stopped, and the stop signal is sent to the servo pre-processing unit 507. To do. The servo preprocessing unit 507 stops the process to stop the operation of the excavator 1 and avoids contact between the excavator 1 and another work machine such as the lithotripter 2.
[0033]
Next, the processing procedure of the contact prevention determination in the vehicle body inclination determination part 512 shown in FIG. 3 is demonstrated using the flowchart shown in FIG.
[0034]
Here, α ₁ represents the amount of inclination that can be released only in the current cycle. Above this amount of inclination, it is determined that there is a possibility that the amount of inclination will increase and contact may occur in the operation of the next cycle. Represents α, and α ₂ represents a limit inclination amount for preventing contact.
[0035]
At the time of regeneration processing, that is, in the state where automatic operation is performed, in step 1, it is determined whether or not the earth release start position that is the measurement position stored in the measurement position storage unit 509 has been reached, and the earth release starts. When the position is reached, in step 2, the current inclination calculation unit 511 reads θ which is the inclination angle data at that time. In step 3, the inclination amount α ₁ is read from the inclination threshold storage unit 510, and the inclination angle data θ and the inclination amount α ₁ are compared. Here, when θ <α ₁ is determined to be normal, the cycle stop flag is turned OFF in step 4 and earthing is performed in step 5. In step 8, it is determined whether the cycle stop flag is ON or OFF. If it is OFF, in step 9, the next operation of the automatic operation is executed. In step 3, when θ ≧ α ₁ , the process proceeds to step 6 and it is determined whether or not the inclination angle data θ is in the range of α ₁ ≦ θ <α ₂ . If it is within the range, the cycle stop flag is turned on in step 7 and released in step 5, and the cycle stop flag is turned on in step 8. Therefore, it is determined that there is an abnormality in step 10, and the command interpreter unit 505 In addition, a stop signal is output to the servo preprocessing unit 507. In step 6, when the tilt angle data θ is not within the range of α ₁ ≦ θ <α ₂ , the process immediately proceeds to step 10 without releasing the earth and outputs a stop signal.
[0036]
As described above, according to the present embodiment, when the automatic driving excavator is inclined with respect to the reference surface such as the ground, it is possible to prevent contact between the automatic driving excavator and other industrial machines. Reliability can be improved.
[0037]
Further, since the measurement position of the vehicle body tilt can be given by teaching, the adjustment of the detection device is not required, the handling is simplified, and the tilt angle sensor can be easily installed.
[0038]
【The invention's effect】
As described above, according to the present invention, the automatic operation construction machine is provided with the inclination angle detection means, and the inclination angle detected by the inclination angle detection means is compared with the predetermined inclination threshold at the predetermined measurement position, so that the automatic operation is performed. Since the vehicle body inclination of the construction machine is determined, the vehicle body inclination can be detected with a simple configuration, and contact with other work machines can be easily avoided.
[Brief description of the drawings]
FIG. 1 is an overall configuration diagram of an automatic driving excavator according to an embodiment of the present invention.
FIG. 2 is a block diagram illustrating a control mechanism of an automatic driving shovel according to the present embodiment.
FIG. 3 is a block diagram showing a functional configuration of an automatic driving excavator according to the present embodiment.
4 is a flowchart showing a processing procedure of vehicle body inclination determination of a vehicle body inclination determination unit 512 shown in FIG.
[Explanation of symbols]
3 Operation Box 31 Teaching Reproduction Operation Device 5 In-Vehicle Device 50 Automatic Operation Controller 111 Inclination Sensors 112 to 115 Angle Sensors 314 and 314 ′ Teaching Operation Unit 316 Reproduction Operation Unit 501 Current Position Calculation Unit 503 Teaching Command Storage Unit 504 Teaching Position Storage Unit 505 Command interpreter unit 507 Servo preprocessing unit 508 Servo control unit 509 Measurement position storage unit 510 Inclination threshold storage unit 511 Current inclination calculation unit 512 Car body inclination determination unit

Claims

In an automatic operation construction machine that repeats a series of operations from excavation to earthing as taught by regenerating operation,
The automatic operation construction machine is
An inclination angle detecting means for detecting an inclination angle with respect to a reference plane of the automatic operation construction machine;
Measurement position storage means for storing the measurement position of the automatic operation construction machine to measure the inclination angle;
Tilt threshold storage means for storing an allowable tilt amount with respect to the reference plane;
A vehicle body inclination determination means for outputting a stop signal for stopping the operation of the automatic operation construction machine when the detected inclination angle exceeds the range of the inclination amount at the measurement position where the inclination angle is to be measured. ,
The inclination threshold value storage means stores the first inclination amount and the second inclination amount, each of which is smaller than the latter and each of which is allowed with respect to the reference plane,
The vehicle body inclination determination means performs a predetermined regenerating operation when the detected inclination angle exceeds the first inclination amount and does not exceed the second inclination amount at the measurement position where the inclination angle is to be measured. An automatic operation construction machine that outputs the stop signal after completion and outputs the stop signal immediately when the detected inclination angle exceeds the second inclination amount .