JP7514173B2 - Work Machine - Google Patents
Work Machine Download PDFInfo
- Publication number
- JP7514173B2 JP7514173B2 JP2020194386A JP2020194386A JP7514173B2 JP 7514173 B2 JP7514173 B2 JP 7514173B2 JP 2020194386 A JP2020194386 A JP 2020194386A JP 2020194386 A JP2020194386 A JP 2020194386A JP 7514173 B2 JP7514173 B2 JP 7514173B2
- Authority
- JP
- Japan
- Prior art keywords
- control area
- upper rotating
- rotating body
- area
- work machine
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000001514 detection method Methods 0.000 claims description 34
- 238000004364 calculation method Methods 0.000 claims description 14
- 238000010586 diagram Methods 0.000 description 11
- 230000007717 exclusion Effects 0.000 description 10
- 238000000034 method Methods 0.000 description 8
- 230000006870 function Effects 0.000 description 7
- 238000009795 derivation Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 6
- 238000010276 construction Methods 0.000 description 3
- 230000007257 malfunction Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 239000002689 soil Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Images
Landscapes
- Component Parts Of Construction Machinery (AREA)
Description
本発明は、作業機械に関する。 The present invention relates to a work machine.
作業機械において、安全性向上のために、作業機械の周囲の物体を検出する物体検出装置を設け、物体検出装置の検出結果を用いて、作業機械を減速または停止するシステムが提案されている。 To improve safety in work machines, a system has been proposed in which an object detection device is provided to detect objects around the work machine, and the detection results of the object detection device are used to slow down or stop the work machine.
例えば特許文献1では、作業機械周囲の任意の領域(以下、制御領域と記載)への物体の侵入有無と制御領域毎に予め定められたレバー入力で、作業機械を動作させるアクチュエータの減速・停止動作を制御する衝突防止装置などが提案されている。
For example,
しかしながら、作業機械においては、上部旋回体から見た下部走行体に備えられた構造体(以下、下部構造体とも記載)の位置が旋回角度に応じて変化し、かつ、少なくともその一部が旋回中心から見て上部旋回体より外側に位置する構造体(具体的には、ブレード、ロングクローラ、小旋回機、クランプアーム、ホイールショベルなど)が設けられている場合がある。下部走行体の走行動作における衝突に関して、下部構造体を持つ作業機械においては、上部旋回体の旋回姿勢によって、衝突箇所が上部旋回体か下部走行体か下部構造体かが異なる。そのため、例えば上記特許文献1に記載の従来技術では、走行における安全装置としての効果が軽減(過剰な速度での衝突)または過剰(大きく手前で停止する)になる場合がある。
However, in a work machine, the position of a structure (hereinafter also referred to as a lower structure) provided on a lower running body as viewed from an upper rotating body changes depending on the rotation angle, and at least a part of the structure (specifically, a blade, a long crawler, a small rotating machine, a clamp arm, a wheel shovel, etc.) may be provided that is located outside the upper rotating body as viewed from the center of rotation. Regarding collisions during the traveling operation of the lower running body, in a work machine having a lower structure, the collision point differs between the upper rotating body, the lower running body, or the lower structure depending on the rotating posture of the upper rotating body. Therefore, for example, in the conventional technology described in
本発明は、上記課題を鑑みてなされたものであり、その目的は、ブレード等の下部構造体を持つショベル等の作業機械において、より安全に衝突を防止することができる作業機械を提供することにある。 The present invention was made in consideration of the above problems, and its purpose is to provide a work machine, such as a shovel, that has a lower structure such as a blade and can more safely prevent collisions.
上記課題を解決するために、本発明の作業機械は、下部走行体と、前記下部走行体に回動可能に設けられた上部旋回体と、前記上部旋回体と前記下部走行体の相対角度である旋回角度を検出する旋回角度検出装置と、前記下部走行体に備えられ、前記上部旋回体から見た位置が前記旋回角度に応じて変化する、かつ、少なくともその一部が旋回中心から見て前記上部旋回体より外側に位置する下部構造体と、作業機械の周囲の監視対象物を検出する物体検出装置と、前記物体検出装置の検出結果を用いて、作業機械の動作を制限する動作制限制御を行う制御装置と、を備える作業機械であって、前記制御装置は、前記上部旋回体の形状および前記旋回角度を基に上部旋回体制御領域を演算する上部旋回体制御領域演算部と、前記下部走行体および前記下部構造体の形状を基に予め算出された下部走行体制御領域を記録した下部走行体制御領域記録部と、前記旋回角度が変更される毎に、前記旋回角度と前記上部旋回体制御領域と前記下部走行体制御領域に応じて、前記動作制限制御の制御対象となる制御領域を変更する制御領域変更部と、を備えることを特徴とする。 In order to solve the above problems, the work machine of the present invention comprises a lower running body, an upper rotating body rotatably provided on the lower running body, a swing angle detection device which detects the swing angle which is the relative angle between the upper rotating body and the lower running body, a lower structure which is provided on the lower running body and whose position as seen from the upper rotating body changes depending on the swing angle and at least a part of which is located outside the upper rotating body as seen from the center of swing, an object detection device which detects objects to be monitored around the work machine, and an operating device which uses the detection results of the object detection device to limit the operation of the work machine. and a control device that performs operation limit control, the control device comprising: an upper rotating body control area calculation unit that calculates an upper rotating body control area based on the shape of the upper rotating body and the swing angle ; a lower running body control area recording unit that records a lower running body control area calculated in advance based on the shapes of the lower running body and the lower structure; and a control area changing unit that changes the control area to be controlled by the operation limit control in accordance with the swing angle, the upper rotating body control area, and the lower running body control area each time the swing angle is changed.
本発明によれば、より安全に衝突を防止することができる作業機械を提供できる。 The present invention provides a work machine that can prevent collisions more safely.
上記以外の課題、構成および効果は、以下の実施形態の説明により明らかにされる。 Other issues, configurations and advantages will become clear from the description of the embodiments below.
以下、本発明の実施形態を図面を用いて説明する。各図において、同一の機能を有する部分には同一の符号を付して繰り返し説明を省略する場合がある。 Embodiments of the present invention will be described below with reference to the drawings. In each drawing, parts having the same functions are given the same reference numerals, and repeated description may be omitted.
以下、本発明の実施形態に係る作業機械として、一般的な油圧ショベルを挙げて説明する。ただし、本発明は、ブレード、ロングクローラ、小旋回機、クランプアームなどの下部構造体を下部走行体に搭載可能であれば、油圧ショベル以外の作業機械にも適用可能である。 The following describes a typical hydraulic excavator as a work machine according to an embodiment of the present invention. However, the present invention can also be applied to work machines other than hydraulic excavators, so long as the lower structure, such as the blade, long crawler, small turning machine, and clamp arm, can be mounted on the lower traveling body.
[実施例1]
<1.全体構成>
図1は、本発明の実施例1に係る作業機械1の一例である油圧ショベルの斜視図である。
[Example 1]
<1. Overall structure>
FIG. 1 is a perspective view of a hydraulic excavator that is an example of a
(油圧ショベル1の構成)
油圧ショベル1は、下部走行体1Cと、旋回装置4を介して下部走行体1Cに回動(旋回)可能なように備え付けられた上部旋回体1Bと、上部旋回体1Bに取り付けられた作業装置1Aとを備えている。
(Configuration of hydraulic excavator 1)
The
作業装置1Aは、上部旋回体1Bと回動可能に取り付けられたブーム8と、ブーム8と回動可能に取り付けられたアーム9と、アーム9と回動可能に取り付けられたバケット10と、バケット10およびアーム9と回動可能に取り付けられたバケットリンク13と、ブーム8と上部旋回体1Bに接続され、ブーム8と上部旋回体1Bとの回動角度を任意に変更するブームシリンダ5と、ブーム8とアーム9に接続され、ブーム8とアーム9の回動角度を任意に変更するアームシリンダ6と、アーム9とバケットリンク13に接続され、バケット10の回動角度を任意に変更するバケットシリンダ7で構成される。
The
下部走行体1Cは、走行モータ3により左右の履帯(クローラとも呼ぶ)を駆動して走行し、車体を任意位置へ移動可能にする。旋回装置4は、下部走行体1Cと上部旋回体1Bの回動角度(すなわち、旋回角度)を任意に変更する旋回モータ11で構成される。また、下部走行体1C(本例では、その走行方向の前部もしくは後部)に、ブレード2が回動可能(例えばピッチ方向に回動可能)なように備えられ、ブレード2と下部走行体1Cに接続され、ブレード2の回動角度を任意に変更するブレードシリンダ12を備える。ブレード2は、下部走行体1Cに対して回動可能であるとともに、上部旋回体1Bから見た位置が上部旋回体1Bの下部走行体1Cに対する旋回角度に応じて変化する、かつ、その一部が旋回中心から見て上部旋回体1Bより外側に位置する機構を持つ構造体である。
The lower traveling
なお、本実施例では、下部走行体1Cに備えられた下部構造体としてブレード2について述べるが、下部走行体1Cに可動可能に備えられ、上部旋回体1Bから見た位置が旋回角度に応じて変わる、かつ、少なくともその一部が旋回中心から見て上部旋回体1Bより外側に位置する機構を持つ構造体であれば、同様の技術が適用可能である。具体的には、前記ブレードの他、ロングクローラ、小旋回機、クランプアーム、ホイールショベルなどが考えられる。
In this embodiment, the
上部旋回体1Bには、油圧ショベル1の各アクチュエータ(3、5、6、7、11、12)を操作する操作レバーなどが配備され、オペレータが搭乗する操縦室15、エンジン(原動機)16、油圧ショベル1を制御する制御装置100などが設置される。制御装置100は、図示は省略するが、各種演算を行うCPU(Central Processing Unit)、CPUによる演算を実行するためのプログラムを格納するROM(Read Only Memory)やHDD(Hard Disk Drive)などの記憶装置、CPUがプログラムを実行する際の作業領域となるRAM(Random Access Memory)などを含むコンピュータとして構成されている。制御装置100の各機能は、CPUが、記憶装置に格納された各種プログラムをRAMにロードして実行することにより、実現される。
The upper rotating
油圧ショベル1は、センサとして、上部旋回体1Bに設置され、周囲の物体(監視対象物)を検出できる物体検出装置52(52a、52b、52c、52d)と、上部旋回体1Bと下部走行体1Cの相対角度である旋回角度を検出する旋回角度検出装置53とを備える。物体検出装置52は、カメラ、超音波センサ、赤外線センサ、マイクロ波センサなどで構成される。物体検出装置52は、図示のように油圧ショベル1に設置されたセンサで構成しても良いし、油圧ショベル1が作業を行う施工現場などに設置されたセンサで構成しても良い。また、旋回角度検出装置53は、旋回中心に設けられた旋回角度センサなどで構成される。なお、旋回角度検出装置53は、上部旋回体1B上に備えられたGNSS、カメラなどで構成しても良いし、油圧ショベル1が作業を行う施工現場などに設置されたセンサ(カメラなど)で、上部旋回体1Bと下部走行体1Cの旋回角度を検出する構成でも良い。
The
また、図示は省略するが、油圧ショベル1は、センサとして、作業装置1A(のブーム8、アーム9、バケット10)の姿勢変化を計測する姿勢計測装置(IMUなど)を備える。
Although not shown in the figure, the
本実施例の制御装置100は、前記した物体検出装置52および旋回角度検出装置53の検出結果を用いて、油圧ショベル1(の下部走行体1Cおよび作業装置1Aを含む上部旋回体1B)を減速または停止する動作制限制御を実行する。
The
(制御装置100の構成)
図2は、本発明の実施例1に係る制御装置100の機能ブロック図である。
(Configuration of control device 100)
FIG. 2 is a functional block diagram of the
本実施例1の制御装置100は、前記動作制限制御を実現するため、図2に示すように、上部旋回体制御領域記録部101、下部走行体制御領域記録部102、制御領域変更部103、動作制限制御部104から構成される。
To realize the above-mentioned motion restriction control, the
制御装置100は、上部旋回体制御領域記録部101に予め上部旋回体1Bの形状より算出した上部旋回体制御領域501を記録している。また、下部走行体制御領域記録部102に予めブレード2および下部走行体1Cの形状より算出した下部走行体制御領域502を記録している。
The
制御領域変更部103は、上部旋回体制御領域501と下部走行体制御領域502と旋回角度検出装置53の旋回角度より、動作制限制御部104による動作の制限(減速・停止)を講ずる(換言すれば、動作制限制御の制御対象となる)領域(以下、制御領域と記載)503を変更する。動作制限制御部104は、制御領域変更部103により変更された制御領域503と物体検出装置52の検出結果より、走行または旋回の減速・停止動作を行う制御指令を生成して、アクチュエータである走行モータ3や旋回モータ11などを制御する。
The control
(上部旋回体制御領域501、下部走行体制御領域502、制御領域503の導出例)
図3に、本実施例による上部旋回体制御領域記録部101に記録された上部旋回体制御領域501と、下部走行体制御領域記録部102に記録された下部走行体制御領域502と、ある姿勢のときの制御領域変更部103により変更された制御領域503の一例を示す。
(Example of derivation of upper rotating
Figure 3 shows an example of an upper rotating
上部旋回体制御領域501は、作業装置1Aを含む上部旋回体1Bの幾何形状と下部走行体1Cの走行停止特性を基に導出したものである。
The upper rotating
また、下部走行体制御領域502は、下部走行体1Cの幾何形状とブレード2の幾何形状と下部走行体1Cの走行停止特性を基に導出したものである。
The lower running
また、制御領域503は、上部旋回体制御領域501と下部走行体制御領域502と上部旋回体1Bと下部走行体1Cの相対角度である旋回角度(旋回角度検出装置53の検出角度)とブレード2の可動領域512を基に導出したものである。
The
より詳しくは、下部走行体制御領域502については、次の手順で導出できる。
(A1)下部走行体1C(ブレード2を含む)をモデル化し、左右の履帯(クローラとも呼ぶ)に対して、地面接地範囲内での速度中心を仮定し、走行動作の回転中心を導出する(図4の(a))。速度中心は、地面の摩擦および運動方程式による地面垂直抗力などから導出してもよい。
(A2)下部走行体1C(ブレード2を含む)を、走行動作の回転中心回りに停止に必要な距離分回転させる(図4の(b))。
(A3)前述の(A1)→(A2)を履帯(クローラ)の動き分(前後最小速度~最大速度、接地位置の変動分)繰り返して、すべての動きを重ねた領域を計算する(図4の(c))。
More specifically, the lower
(A1) The
(A2) The
(A3) The above-mentioned (A1) → (A2) is repeated for the amount of movement of the track (crawler) (minimum to maximum longitudinal speed, fluctuation in ground contact position), and the area where all movements are overlapped is calculated (Figure 4 (c)).
これにより、下部走行体1Cおよびブレード2の周囲に(換言すれば、下部走行体1Cおよびブレード2を包囲するような)所定幅の下部走行体制御領域502を算出する(図3参照)。
This allows a lower
上部旋回体制御領域501については、次の手順で導出できる。
(B1)作業装置1Aを含む上部旋回体1Bについて、前記した下部走行体制御領域502の手順(A1)→(A2)→(A3)と同様に計算を行う(図5の(a))。
(B2)下部走行体1Cとの相対角度をずらしながら、前記した(B1)をすべての相対角度に対して行い、すべての動きを重ねた領域を計算する(図5の(b))。
The upper rotating
(B1) For the upper
(B2) While shifting the relative angle with the
これにより、作業装置1Aを含む上部旋回体1Bの周囲に(換言すれば、作業装置1Aを含む上部旋回体1Bを包囲するような)所定幅の上部旋回体制御領域501を算出する(図3参照)。
This allows the calculation of an upper rotating
なお、上部旋回体制御領域501および下部走行体制御領域502の算出に当たって、不整地および土材質がわからないため、摩擦などの動作の計算に必要な要素が分からない場合、それらの要素は実験的に決めてもよい。
When calculating the upper rotating
制御領域503は、旋回角度検出装置53で検出した旋回角度が変更される毎に、前記手順で算出した上部旋回体制御領域501を旋回中心回りで旋回角度だけ回転させ、下部走行体1Cから見た上部旋回体制御領域501を計算し、回転させた上部旋回体制御領域501と前記手順で算出した下部走行体制御領域502の双方の領域を足し合わせる(和をとる)。また、足し合わせた領域からブレード2の可動領域512(図3の二点鎖線枠内参照)を除外して制御領域503とする。つまり、本実施例の制御領域503は、ブレード2を回動(例えば、ピッチ方向に上げ下げ)しても引っ掛からない領域、すなわち、ブレード2の可動領域512以外の領域である。なお、ブレード2の可動領域512は、ブレード2の幾何形状および幾何構造から予め設定されても良いし、後述の実施例2のブレード姿勢センサ(姿勢計測装置)17を使用し、ブレード姿勢センサ(姿勢計測装置)17で計測したブレード2の姿勢変化などから導出しても良い。
Each time the rotation angle detected by the rotation
<2.動作>
図6は、本実施例の制御領域変更部103の制御領域導出に関するフローチャートである。
2. Operation
FIG. 6 is a flowchart relating to the control region derivation by the control
まず、車体の旋回角度が変更されるまで、待つ(S001)。次に、上部旋回体制御領域記録部101より予め定められた上部旋回体制御領域501を読み込む(S002)。上部旋回体制御領域501を旋回角度に応じて回転させ、下部走行体1Cから見た上部旋回体制御領域501を計算する(S003)。下部走行体制御領域記録部102より予め定められた下部走行体制御領域502を読み込む(S004)。回転後の上部旋回体制御領域501と下部走行体制御領域502の双方の領域を足し合わせて(和をとり)制御領域503とする(S005)。また、このとき、足し合わせた領域からブレード2の可動領域512を除外する。
First, the system waits until the rotation angle of the vehicle body is changed (S001). Next, the predetermined upper rotating
動作制限制御部104は、制御領域変更部103により変更された制御領域503と物体検出装置52の検出結果を読み込み、制御領域503の内側に物体が侵入していると判断した場合、走行または旋回の減速・停止動作を行う制御指令を生成して、走行モータ3や旋回モータ11などを制御する。これにより、油圧ショベル1を構成する下部走行体1Cおよび上部旋回体1B(作業装置1Aを含む)を減速または停止する動作制限制御を実行することで、油圧ショベル1と周囲物体との衝突を回避できる。
The motion
<3.実施例特有の効果>
以上で説明したように、本実施例1の油圧ショベル1の制御装置100は、前記上部旋回体1Bの形状を基に予め算出された上部旋回体制御領域501を記録した上部旋回体制御領域記録部101と、前記下部走行体1Cおよび前記下部構造体(ブレード2)の形状を基に予め算出された下部走行体制御領域502を記録した下部走行体制御領域記録部102と、前記旋回角度が変更される毎に、前記旋回角度と前記上部旋回体制御領域501と前記下部走行体制御領域502に応じて、前記動作制限制御の制御対象となる制御領域503を変更する制御領域変更部103と、を備える。
3. Effects specific to the embodiment
As described above, the
本実施例1によれば、旋回角度に応じた適切な制御領域503が設定でき、安全性が向上する。
According to this
[実施例2]
<1.全体構成>
図7は、本発明の実施例2に係る作業機械1の一例である油圧ショベルの斜視図である。
[Example 2]
<1. Overall structure>
Second Embodiment FIG. 7 is a perspective view of a hydraulic excavator, which is an example of a
(油圧ショベル1の構成)
本実施例2の作業機械1は、実施例1に加え、ブレード2上に備え付けられ、ブレード2の姿勢変化を計測する姿勢計測装置としてのブレード姿勢センサ17を備える。
(Configuration of hydraulic excavator 1)
The working
なお、本実施例では、下部走行体1Cに備えられた下部構造体としてブレード2について記載するが、実施例1の構造に加え、アクチュエータによる機構変化がある構造体と構造体の姿勢が演算可能なセンサであれば、構造体の幾何形状やセンサ個数は問わず如何なるものでもよい。具体的には、前記ブレードの他、PATブレード、クランプアームなどが考えられる。
In this embodiment, the
(制御装置100の構成)
図8は、本発明の実施例2に係る制御装置100の機能ブロック図である。
(Configuration of control device 100)
FIG. 8 is a functional block diagram of a
本実施例2の制御装置100は、実施例1に加え、ブレード姿勢センサ17により計測されたブレード姿勢により変更されるブレード2の幾何構造(幾何形状)の可動後の領域(以下、下部走行体除外領域と記載)613を演算する下部走行体除外領域演算部202を備える。また、下部走行体除外領域演算部202の下部走行体除外領域613を上部旋回体制御領域+下部走行体制御領域から除外して制御領域603とする機能を有した制御領域変更部203を備える。
The
(制御領域603、下部走行体除外領域613の導出例)
図9に、上部旋回体制御領域と下部走行体制御領域が足し合わされた制御領域603と下部走行体除外領域613の一例を示す。
(Example of Derivation of
FIG. 9 shows an example of a
上記実施例1では、制御領域503は、上部旋回体制御領域501と下部走行体制御領域502と上部旋回体1Bと下部走行体1Cの相対角度である旋回角度(旋回角度検出装置53の検出角度)とブレード2の可動領域512を基に導出し、ブレード2を回動(例えば、ピッチ方向に上げ下げ)しても引っ掛からない領域、すなわち、ブレード2の可動領域512以外の領域を、制御領域503とした。
In the above-mentioned Example 1, the
一方、本実施例2では、制御領域603は、上部旋回体制御領域と下部走行体制御領域と上部旋回体1Bと下部走行体1Cの相対角度である旋回角度(旋回角度検出装置53の検出角度)とブレード姿勢センサ17により計測されたブレード姿勢を基に導出する。つまり、ブレード2の動作に応じて動的に制御領域603を変更、すなわち、現在のブレード2の姿勢をフィードバックして、制御領域603を変更する。制御領域603は、ブレード姿勢センサ17により計測されたブレード姿勢に対応したブレード2(の幾何形状)の可動後の領域(下部走行体除外領域)613のみを除いた領域を、制御領域603とする。
On the other hand, in this
これにより、除外領域を実際のブレード2に沿った形にできるため、より適切に障害物を検知できる。例えば、図9に示す物体614、615(上記実施例1では除外されて検出されない)が除外されずに検出できるため、より安全性が向上する。
This allows the exclusion area to be shaped to match the
<2.動作>
図10は、本実施例の制御領域変更部203の制御領域導出に関するフローチャートである。
2. Operation
FIG. 10 is a flowchart relating to the control region derivation by the control
図10に示す本実施例2のフローチャートは、実施例1のフローチャートから和の部分を除き、S201~S202を追加する。S001~S004の実施後、ブレード姿勢から演算した下部走行体除外領域613を読み込む(S201)。回転後の上部旋回体制御領域と下部走行体制御領域を足し合わせて(和をとり)、足し合わせた領域から下部走行体除外領域613を減算する領域を制御領域603とする(S202)。
The flowchart of this
<3.実施例特有の効果>
以上で説明したように、本実施例2の油圧ショベル1は、前記下部構造体(ブレード2)の姿勢変化を計測する姿勢計測装置(ブレード姿勢センサ17)を備え、前記制御領域変更部203は、前記旋回角度が変更される毎に、前記上部旋回体制御領域を前記旋回中心回りで前記旋回角度だけ回転させ、回転後の前記上部旋回体制御領域と前記下部走行体制御領域とを足し合わせ、前記姿勢計測装置(ブレード姿勢センサ17)によって計測された前記下部構造体(ブレード2)の姿勢および幾何構造から演算される前記下部構造体(ブレード2)の幾何形状の領域(つまり、現在の下部構造体の領域)を除外して前記制御領域603とする。
3. Effects specific to the embodiment
As described above, the
本実施例2によれば、ブレード構造体の動作による油圧ショベル1の誤動作を避けることができ、より誤作動の少ない油圧ショベル1を提供できる。
According to this
[実施例3]
<1.全体構成>
(制御装置100の構成)
図11は、本発明の実施例3に係る制御装置100の機能ブロック図である。
[Example 3]
<1. Overall structure>
(Configuration of control device 100)
FIG. 11 is a functional block diagram of a
本実施例3の制御装置100は、実施例1の上部旋回体制御領域記録部101に代わり、上部旋回体1Bの形状と旋回角度を基に制御領域(回転後の上部旋回体制御領域)を演算する上部旋回体制御領域演算部301を備える。
The
詳しくは、上記実施例1では、旋回角度を定めずに(換言すれば、動作中にフィードバックせずに)上部旋回体制御領域を計算した。 In more detail, in the above Example 1, the upper rotating body control area was calculated without determining the rotation angle (in other words, without feedback during operation).
一方、本実施例3では、動作中に、旋回角度検出装置53の旋回角度を基に(換言すれば、動作中にフィードバックして)、上部旋回体制御領域を再計算する(導出方法については、図5を併せて参照)。例えば走行動作後の上部旋回体制御領域を、走行動作前の旋回角度検出装置53の旋回角度を基に再計算する。そのため、動作中の必要最低限の領域を、上部旋回体制御領域として算出できる。
On the other hand, in this
制御領域変更部303は、上部旋回体制御領域演算部301で算出した上部旋回体制御領域と下部走行体制御領域記録部102に記録している下部走行体制御領域と旋回角度検出装置53の旋回角度より、動作制限制御の制御対象となる制御領域を変更する。
The control
<2.動作>
図12は、本実施例の制御領域変更部303の制御領域導出に関するフローチャートである。
2. Operation
FIG. 12 is a flowchart relating to the control region derivation by the control
図12に示す本実施例3のフローチャートは、実施例1のS002、S003に代わり、S001の後、上部旋回体制御領域演算部301で上部旋回体1Bの形状と旋回角度に応じて演算した(回転後の)上部旋回体制御領域を読み込む(S302)。下部走行体制御領域記録部102より予め定められた下部走行体制御領域を読み込む(S004)。(回転後の)上部旋回体制御領域と下部走行体制御領域の双方の領域を足し合わせて(和をとり)制御領域とする(S005)。
In the flowchart of the
<3.実施例特有の効果>
以上で説明したように、本実施例3の油圧ショベル1の制御装置100は、前記上部旋回体制御領域記録部101に代わり、前記上部旋回体の形状および前記旋回角度を基に上部旋回体制御領域を演算する上部旋回体制御領域演算部301を備える。
3. Effects specific to the embodiment
As described above, the
本実施例3によれば、実施例1の効果に加え、より安全な誤動作の少ない油圧ショベル1を提供できる。
According to this
[実施例4]
<1.全体構成>
本発明の実施例4に係る作業機械の一例である油圧ショベルを図13に示す。
[Example 4]
<1. Overall structure>
Fourth embodiment A hydraulic excavator, which is an example of a work machine according to the present invention, is shown in FIG.
(油圧ショベル1の構成)
本実施例4の作業機械1は、実施例1に加え、例えば操縦室15に現在の制御領域703を表示する表示装置18を備える。
(Configuration of hydraulic excavator 1)
The working
<2.動作>
表示装置18の表示画面の一例を図14に示す。
2. Operation
An example of the display screen of the
表示装置18には同一画面上に、制御領域703、油圧ショベル1が俯瞰図または三次元図で表記されている。
The
<3.実施例特有の効果>
以上で説明したように、本実施例4の油圧ショベル1は、現在の前記制御領域703を表示する表示装置18を備える。
3. Effects specific to the embodiment
As described above, the
本実施例4によれば、オペレータが制御領域703を容易に確認することができ、施工効率を改善することができる。
According to this embodiment 4, the operator can easily check the
なお、本発明は上記した実施形態に限られるものではなく、様々な変形形態が含まれる。上記した実施形態は本発明をわかり易く説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。 The present invention is not limited to the above-described embodiment, but includes various modified forms. The above-described embodiment has been described in detail to explain the present invention in an easy-to-understand manner, and is not necessarily limited to having all of the configurations described.
また、上記した実施形態のコントローラの各機能は、それらの一部または全部を、例えば集積回路で設計することによりハードウェアで実現してもよい。また、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、コントローラ内の記憶装置の他に、ハードディスク、SSD(Solid State Drive)等の記録装置、または、ICカード、SDカード、DVD等の記録媒体に置くことができる。 Furthermore, each function of the controller in the above-described embodiment may be realized in hardware, for example by designing some or all of them in an integrated circuit. Also, each function may be realized in software by a processor interpreting and executing a program that realizes each function. Information such as the programs, tables, and files that realize each function may be stored in a storage device within the controller, a hard disk, an SSD (Solid State Drive), or other recording device, or an IC card, SD card, DVD, or other recording medium.
1 油圧ショベル(作業機械)
1A 作業装置
1B 上部旋回体
1C 下部走行体
2 ブレード(下部構造体)
3 走行モータ
4 旋回装置
11 旋回モータ
12 ブレードシリンダ
15 操縦室
16 エンジン(原動機)
17 ブレード姿勢センサ(姿勢計測装置)(実施例2)
18 表示装置(実施例4)
52 物体検出装置
53 旋回角度検出装置
100 制御装置
101 上部旋回体制御領域記録部
102 下部走行体制御領域記録部
103 制御領域変更部
104 動作制限制御部
202 下部走行体除外領域演算部(実施例2)
203 制御領域変更部(実施例2)
301 上部旋回体制御領域演算部(実施例3)
303 制御領域変更部(実施例3)
501 上部旋回体制御領域
502 下部走行体制御領域
503 制御領域
603 制御領域
613 下部走行体除外領域
703 制御領域
1. Hydraulic excavator (work machine)
3 Travel motor 4
17 Blade attitude sensor (attitude measuring device) (Example 2)
18 Display device (Example 4)
52
203 Control area change unit (Example 2)
301 Upper rotating body control area calculation unit (Example 3)
303 Control area change unit (Example 3)
501 Upper rotating
Claims (6)
前記下部走行体に回動可能に設けられた上部旋回体と、
前記上部旋回体と前記下部走行体の相対角度である旋回角度を検出する旋回角度検出装置と、
前記下部走行体に備えられ、前記上部旋回体から見た位置が前記旋回角度に応じて変化する、かつ、少なくともその一部が旋回中心から見て前記上部旋回体より外側に位置する下部構造体と、
作業機械の周囲の監視対象物を検出する物体検出装置と、
前記物体検出装置の検出結果を用いて、作業機械の動作を制限する動作制限制御を行う制御装置と、を備える作業機械であって、
前記制御装置は、
前記上部旋回体の形状および前記旋回角度を基に上部旋回体制御領域を演算する上部旋回体制御領域演算部と、
前記下部走行体および前記下部構造体の形状を基に予め算出された下部走行体制御領域を記録した下部走行体制御領域記録部と、
前記旋回角度が変更される毎に、前記旋回角度と前記上部旋回体制御領域と前記下部走行体制御領域に応じて、前記動作制限制御の制御対象となる制御領域を変更する制御領域変更部と、を備えることを特徴とする作業機械。 A lower running body;
An upper rotating body rotatably provided on the lower traveling body;
a rotation angle detection device for detecting a rotation angle which is a relative angle between the upper rotating body and the lower traveling body;
a lower structure provided on the lower traveling body, the position of which as viewed from the upper rotating body changes according to the rotation angle, and at least a portion of which is located outside the upper rotating body as viewed from the rotation center;
an object detection device that detects a monitored object around the work machine;
A control device that uses a detection result of the object detection device to perform operation limiting control to limit an operation of the work machine,
The control device includes:
an upper rotating body control area calculation unit that calculates an upper rotating body control area based on a shape of the upper rotating body and the rotation angle ;
a lower structure control area recording unit that records a lower structure control area calculated in advance based on the shapes of the lower structure and the lower structure;
a control area changing unit that changes a control area to be controlled by the operation limit control in accordance with the swing angle, the upper swing body control area, and the lower running body control area each time the swing angle is changed.
前記上部旋回体制御領域は、前記上部旋回体の周囲に設定された領域であり、
前記下部走行体制御領域は、前記下部構造体および前記下部走行体の周囲に設定された領域であり、
前記制御領域変更部は、前記旋回角度が変更される毎に、前記上部旋回体制御領域を前記旋回中心回りで前記旋回角度だけ回転させ、回転後の前記上部旋回体制御領域と前記下部走行体制御領域とを足し合わせ、前記下部構造体の可動領域を除外して前記制御領域とすることを特徴とする作業機械。 2. The work machine according to claim 1,
The upper rotating body control area is an area set around the upper rotating body,
the undercarriage control area is an area set around the lower structure and the undercarriage,
the control area changing unit rotates the upper rotating body control area around the rotation center by the rotation angle each time the rotation angle is changed, adds up the upper rotating body control area and the lower running body control area after the rotation, and excludes the movable area of the lower structure to obtain the control area.
前記上部旋回体制御領域は、前記上部旋回体の幾何形状と前記下部走行体の走行停止特性を基に算出され、
前記下部走行体制御領域は、前記下部走行体の幾何形状と前記下部構造体の幾何形状と前記下部走行体の走行停止特性を基に算出されることを特徴とする作業機械。 2. The work machine according to claim 1,
The upper rotating body control area is calculated based on a geometric shape of the upper rotating body and a running stopping characteristic of the lower traveling body,
A work machine, characterized in that the undercarriage control area is calculated based on the geometric shape of the undercarriage, the geometric shape of the lower structure, and the travel stopping characteristics of the undercarriage.
前記作業機械は、前記下部構造体の姿勢変化を計測する姿勢計測装置を備え、
前記制御領域変更部は、前記旋回角度が変更される毎に、前記上部旋回体制御領域を前記旋回中心回りで前記旋回角度だけ回転させ、回転後の前記上部旋回体制御領域と前記下部走行体制御領域とを足し合わせ、前記姿勢計測装置によって計測された前記下部構造体の姿勢および幾何構造から演算される前記下部構造体の幾何形状の領域を除外して前記制御領域とすることを特徴とする作業機械。 2. The work machine according to claim 1,
The work machine includes a posture measuring device that measures a posture change of the lower structure,
a control area changing unit that rotates the upper rotating body control area around the rotation center by the rotation angle each time the rotation angle is changed, adds up the upper rotating body control area and the lower running body control area after the rotation, and excludes the area of the geometric shape of the lower structure calculated from the posture and geometric structure of the lower structure measured by the posture measuring device to obtain the control area.
前記作業機械は、現在の前記制御領域を表示する表示装置を備えることを特徴とする作業機械。 2. The work machine according to claim 1,
The work machine is characterized in that it is provided with a display device that displays the current control area.
前記上部旋回体は、ブーム、アーム、バケットからなる作業装置を含むことを特徴とする作業機械。 2. The work machine according to claim 1,
A work machine characterized in that the upper rotating body includes a work implement consisting of a boom, an arm, and a bucket.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020194386A JP7514173B2 (en) | 2020-11-24 | 2020-11-24 | Work Machine |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020194386A JP7514173B2 (en) | 2020-11-24 | 2020-11-24 | Work Machine |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2022083117A JP2022083117A (en) | 2022-06-03 |
JP7514173B2 true JP7514173B2 (en) | 2024-07-10 |
Family
ID=81811699
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020194386A Active JP7514173B2 (en) | 2020-11-24 | 2020-11-24 | Work Machine |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7514173B2 (en) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120098654A1 (en) | 2010-10-23 | 2012-04-26 | William Ebert | Heavy equipment proximity sensor |
JP2016194481A (en) | 2015-04-01 | 2016-11-17 | 新日鐵住金株式会社 | Safety device, and monitoring method, for work vehicles |
JP2018159194A (en) | 2017-03-22 | 2018-10-11 | コベルコ建機株式会社 | Construction machine |
JP2020007867A (en) | 2018-07-12 | 2020-01-16 | コベルコ建機株式会社 | Safety device for slewing type working machine |
JP2020012323A (en) | 2018-07-19 | 2020-01-23 | 日立建機株式会社 | Work machine |
JP2020153156A (en) | 2019-03-20 | 2020-09-24 | ヤンマーパワーテクノロジー株式会社 | Blade control system of work vehicle |
-
2020
- 2020-11-24 JP JP2020194386A patent/JP7514173B2/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120098654A1 (en) | 2010-10-23 | 2012-04-26 | William Ebert | Heavy equipment proximity sensor |
JP2016194481A (en) | 2015-04-01 | 2016-11-17 | 新日鐵住金株式会社 | Safety device, and monitoring method, for work vehicles |
JP2018159194A (en) | 2017-03-22 | 2018-10-11 | コベルコ建機株式会社 | Construction machine |
JP2020007867A (en) | 2018-07-12 | 2020-01-16 | コベルコ建機株式会社 | Safety device for slewing type working machine |
JP2020012323A (en) | 2018-07-19 | 2020-01-23 | 日立建機株式会社 | Work machine |
JP2020153156A (en) | 2019-03-20 | 2020-09-24 | ヤンマーパワーテクノロジー株式会社 | Blade control system of work vehicle |
Also Published As
Publication number | Publication date |
---|---|
JP2022083117A (en) | 2022-06-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108699799B (en) | Working machine | |
KR102118386B1 (en) | Working machine | |
JP6775089B2 (en) | Work machine | |
JP6770862B2 (en) | Construction machinery control device | |
JP2019112839A (en) | Obstacle detecting device for construction machine | |
US20220112693A1 (en) | Monitoring device and construction machine | |
JP6859812B2 (en) | Interference monitoring device | |
KR102588223B1 (en) | working machine | |
KR102579791B1 (en) | construction machinery | |
JP7217691B2 (en) | construction machinery | |
JP7514173B2 (en) | Work Machine | |
US20230137344A1 (en) | Work machine | |
JP6316664B2 (en) | Work machine | |
JP7198366B2 (en) | working machine | |
KR102643531B1 (en) | Control systems of working machines and working machines | |
JP7360568B2 (en) | working machine | |
WO2020179346A1 (en) | Work machine | |
CN114258446B (en) | Work vehicle and control method for work vehicle | |
WO2023105944A1 (en) | Work machine | |
JP7375260B2 (en) | working machine | |
US20230129397A1 (en) | Work vehicle implement joint orientation system and method | |
JP2793953B2 (en) | Hydraulic excavator front controller | |
JP2022145032A (en) | Construction machine | |
JP2023145210A (en) | Work machine | |
JP2023066442A (en) | Construction machine |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20231025 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20240418 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20240507 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240606 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20240625 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240628 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7514173 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |