JP7183805B2 - Anti-interference device - Google Patents

Anti-interference device Download PDF

Info

Publication number
JP7183805B2
JP7183805B2 JP2019003743A JP2019003743A JP7183805B2 JP 7183805 B2 JP7183805 B2 JP 7183805B2 JP 2019003743 A JP2019003743 A JP 2019003743A JP 2019003743 A JP2019003743 A JP 2019003743A JP 7183805 B2 JP7183805 B2 JP 7183805B2
Authority
JP
Japan
Prior art keywords
region
operation pattern
pattern
person
motion
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
Application number
JP2019003743A
Other languages
Japanese (ja)
Other versions
JP2020111970A (en
Inventor
誠司 佐伯
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kobelco Construction Machinery Co Ltd
Original Assignee
Kobelco Construction Machinery Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kobelco Construction Machinery Co Ltd filed Critical Kobelco Construction Machinery Co Ltd
Priority to JP2019003743A priority Critical patent/JP7183805B2/en
Publication of JP2020111970A publication Critical patent/JP2020111970A/en
Application granted granted Critical
Publication of JP7183805B2 publication Critical patent/JP7183805B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Component Parts Of Construction Machinery (AREA)
  • Operation Control Of Excavators (AREA)

Description

本発明は、下部走行体と、下部走行体に対して旋回可能に構成された上部旋回体と、上部旋回体に対して姿勢が変更可能に構成された作業装置とを備える建設機械における干渉防止装置に関するものである。 The present invention provides interference prevention in a construction machine comprising a lower traveling body, an upper revolving body configured to be able to turn with respect to the lower traveling body, and a work device configured to be able to change its posture with respect to the upper revolving body. It is related to the device.

従来より、建設機械においては、周囲に人物を検出した場合、建設機械の動作を制限又は停止させると共にオペレータに干渉の危険性を発報することで、建設機械と周囲の人物との干渉を未然に防ぐ機能が設けられている。しかし、建設機械の動作制限、動作停止、又は発報を過度に行うと却って作業効率の低下を招いてしまう。そこで、このような作業効率の低下を抑制するために種々の技術が提案されている。 Conventionally, when a person is detected in the vicinity of a construction machine, the operation of the construction machine is restricted or stopped, and the operator is notified of the danger of interference, thereby preventing interference between the machine and the surrounding person. It is equipped with a function to prevent However, if the operation of the construction machine is restricted, the operation is stopped, or the alarm is issued excessively, the work efficiency is rather reduced. Therefore, various techniques have been proposed to suppress such deterioration in work efficiency.

例えば、特許文献1では、油圧パワーショベルの周囲を複数の危険エリアに区分し、それぞれの危険エリアに対象物を検出するエリアセンサを設け、オペレータによる操作レバーの操作を検出すると、操作レバーに対応する危険エリアに設置されたエリアセンサからの信号を受信し、その信号が対象物を検出したことを示している場合、作業装置の動作を停止する技術が開示されている。 For example, in Patent Document 1, the circumference of a hydraulic power excavator is divided into a plurality of dangerous areas, and an area sensor for detecting an object is provided in each dangerous area. A technique is disclosed in which a signal is received from an area sensor installed in a dangerous area, and the operation of a working device is stopped when the signal indicates that an object has been detected.

また、特許文献2では、アームを動作させるときに、人検出装置が検出した人と姿勢検出装置が検出したアタッチメントの先端位置との距離が所定距離以下の場合、アームの動作を制限する技術が開示されている。 Further, in Patent Document 2, when the arm is operated, if the distance between the person detected by the human detection device and the tip position of the attachment detected by the posture detection device is less than or equal to a predetermined distance, a technique for limiting the movement of the arm is disclosed. disclosed.

特開平5-59752号公報JP-A-5-59752 特開2016-176289号公報JP 2016-176289 A

ところで、作業装置の先端位置に対して前方に人物が位置する場合、前記先端位置が後方に移動するように作業装置が動作しても、人物と作業装置とは干渉する可能性が低い。このように、人物と作業装置との干渉する可能性の高い作業装置の動作は、作業装置の先端位置に対する人物の位置に応じて異なる。 By the way, when a person is positioned in front of the tip position of the working device, even if the working device operates so that the tip position moves backward, the possibility of interference between the person and the working device is low. In this way, the operation of the working device, in which there is a high possibility of interference between the person and the working device, differs according to the position of the person with respect to the tip position of the working device.

しかし、特許文献1では、複数の危険エリアは、予め固定されており、作業装置の先端位置に応じて動的に設定されていないため、作業効率の悪化を招くという課題がある。 However, in Patent Literature 1, the plurality of dangerous areas are fixed in advance and are not dynamically set according to the tip position of the working device, so there is a problem that work efficiency is deteriorated.

具体的には、特許文献1では、複数の危険エリアは、上部旋回体の前方の領域、上部旋回体の左方の領域、上部旋回体の右方の領域、及び上部旋回体の後方の領域というように予め固定されている。そして、例えば、作業装置の操作レバーが操作された場合、上部旋回体の前方の危険エリアに人物がいれば一律に作業装置の動作が制限されている。 Specifically, in Patent Document 1, a plurality of dangerous areas are defined as a front area of the upper rotating body, a left area of the upper rotating body, a right area of the upper rotating body, and a rear area of the upper rotating body. It is fixed in advance. Then, for example, when the operation lever of the working device is operated, if a person is in the dangerous area in front of the upper rotating body, the operation of the working device is uniformly restricted.

そのため、特許文献1では、作業装置の先端位置が人物から離間するように作業装置が動作する場合においても作業装置の動作が一律に制限されてしまい、動作効率の悪化を招く。 Therefore, in Patent Literature 1, even when the working device operates such that the tip position of the working device is separated from the person, the operation of the working device is uniformly restricted, resulting in deterioration of the operating efficiency.

また、特許文献2は、作業装置の先端位置と人物との距離に応じて建設機械の動作を制限させる技術であり、建設機械の周囲に複数の領域を設定する技術ではないため、本願発明とは前提が異なる。また、特許文献2では、作業装置の先端位置と人物との距離が所定値以下の場合、建設機械の動作が一律に制限されているため、特許文献1と同様の課題が発生する。 Further, Patent Document 2 is a technique for limiting the movement of a construction machine according to the distance between the tip position of a working device and a person, and is not a technique for setting a plurality of areas around the construction machine. have different premises. Moreover, in Patent Document 2, when the distance between the tip position of the working device and the person is equal to or less than a predetermined value, the operation of the construction machine is uniformly restricted.

また、特許文献2では、作業装置の動作を制限した後においては、作業装置の先端位置と人物との距離が所定値以下の場合であっても該距離が大きくなる方向の建設機械の動作は制限されないことが開示されている。 Further, in Patent Document 2, even if the distance between the tip position of the working device and the person is less than or equal to a predetermined value after the operation of the working device is restricted, the operation of the construction machine in the direction in which the distance increases. disclosed to be non-limiting.

しかし、複数の領域において人物を検出する場合が想定されていないため、依然として作業効率の悪化を招くという課題がある。例えば、複数の人物がそれぞれ作業装置の先端位置に対して左前方に及び右前方に位置しているシーンを想定する。このシーンにおいては、右旋回又は左旋回を行ったとしても、両人物は作業装置の旋回半径の外側の領域に位置しており、作業装置と干渉する可能性は低いため、作業装置の動作を制限する必要はない。 However, since the case of detecting a person in a plurality of areas is not assumed, there is still the problem of deteriorating work efficiency. For example, assume a scene in which a plurality of persons are positioned to the left front and right front of the tip position of the working device. In this scene, even when turning right or left, both persons are positioned outside the turning radius of the work device and are unlikely to interfere with the work device. need not be restricted.

しかし、特許文献2では、このシーンにおいて、右旋回又は左旋回を行うと、両人物のうちいずれか一方の人物と作業装置の先端位置との距離が小さくなるため、作業装置の動作が制限され、作業効率が悪化する。 However, in Patent Document 2, when turning right or left in this scene, the distance between one of the two persons and the tip position of the working device becomes smaller, so the operation of the working device is restricted. and work efficiency deteriorates.

本発明は、上記課題を解決するためになされたものであり、建設機械の作業効率の低下を抑制しつつ人物と建設機械の干渉を防止し得る技術を提供することを目的とする。 SUMMARY OF THE INVENTION The present invention has been made to solve the above problems, and an object of the present invention is to provide a technique capable of preventing interference between a person and a construction machine while suppressing a decrease in work efficiency of the construction machine.

本発明の一態様に係る干渉防止装置は、下部走行体と、前記下部走行体に対して旋回可能に構成された上部旋回体と、前記上部旋回体に対して姿勢が変更可能に構成された作業装置とを備える建設機械における干渉防止装置であって、
オペレータの操作を受け付ける操作部と、
前記操作部が受け付けた操作に応じて前記作業装置及び前記上部旋回体の少なくとも一方を動作させる動作実行部と、
前記作業装置の姿勢を検出する第1センサと、
前記第1センサにより検出された姿勢に基づいて前記作業装置の先端位置を算出する位置算出部と、
前記位置算出部により算出された前記先端位置を基準に前記建設機械の周囲に複数の領域を設定する領域設定部と、
前記建設機械の周囲に位置する物体を検出する第2センサと、
前記第2センサにより検出された物体に基づいて前記複数の領域のそれぞれに対して人物の有無を判定する人物判定部と、
前記人物判定部が前記複数の領域のうち少なくとも1つの領域において前記人物がいると判定した場合、前記人物が検出された領域において、前記作業装置が前記人物と干渉する可能性のある予め定められた前記建設機械の動作パターンである制限動作パターンを制限し、且つ、前記作業装置が前記人物と干渉する可能性の低い予め定められた前記建設機械の前記動作パターンである許可動作パターンを許可するように前記動作実行部を制御する動作制限部とを備える。
An interference prevention device according to an aspect of the present invention includes a lower traveling body, an upper revolving body configured to be able to turn with respect to the lower traveling body, and a posture changeable with respect to the upper revolving body. An interference prevention device for a construction machine comprising a working device,
an operation unit that receives an operator's operation;
an operation execution unit that operates at least one of the work device and the upper rotating body according to the operation received by the operation unit;
a first sensor that detects the attitude of the working device;
a position calculation unit that calculates a tip position of the working device based on the orientation detected by the first sensor;
an area setting unit that sets a plurality of areas around the construction machine based on the tip position calculated by the position calculation unit;
a second sensor that detects objects positioned around the construction machine;
a person determination unit that determines the presence or absence of a person in each of the plurality of areas based on the object detected by the second sensor;
When the person determination unit determines that the person is present in at least one of the plurality of areas, the working device may interfere with the person in the area where the person is detected. limiting a restricted operation pattern, which is an operation pattern of the construction machine, and permitting a permitted operation pattern, which is a predetermined operation pattern of the construction machine with a low possibility that the work device will interfere with the person. and an operation restricting unit that controls the operation executing unit so as to control the operation executing unit.

この構成によれば、位置算出部により算出された作業装置の先端位置を基準に建設機械の周囲に複数の領域が設定される。そして、複数の領域のうち少なくとも1つの領域において人物が検出された場合、人物が検出された領域において、作業装置が人物と干渉する可能性が高い制限動作パターンが制限され、作業装置と人物とが干渉する可能性の低い許可動作パターンが許可される。 According to this configuration, a plurality of areas are set around the construction machine based on the tip position of the working device calculated by the position calculation section. Then, when a person is detected in at least one of the plurality of areas, in the area where the person is detected, the restricted operation pattern in which the work device is highly likely to interfere with the person is restricted. Allowed motion patterns that are less likely to interfere with

このように、本構成では、複数の領域は作業装置の先端位置を基準に設定されているため、各領域において、作業装置が人物と干渉する可能性の高い制限動作パターンと、作業装置が人物と干渉する可能性の低い許可動作パターンとを明確に切り分けることができる。そのため、ある領域に人物がいる場合、制限動作パターンを制限し、許可動作パターンを継続して動作させることができる。その結果、建設機械の作業効率の低下を抑制しつつ人物と建設機械との干渉を防止することができる。 As described above, in this configuration, since the plurality of areas are set based on the position of the tip of the working device, in each area, a restricted operation pattern in which the working device is highly likely to interfere with a person It is possible to clearly separate a permitted operation pattern that is unlikely to interfere with a permitted operation pattern. Therefore, when a person is present in a certain area, it is possible to restrict the restricted operation pattern and continue to operate the permitted operation pattern. As a result, it is possible to prevent interference between the person and the construction machine while suppressing a decrease in the work efficiency of the construction machine.

上記構成において、前記複数の領域のそれぞれに対して、前記制限動作パターンと前記許可動作パターンとが登録された動作パターン情報を記憶するメモリをさらに備え、
前記動作制限部は、前記動作パターン情報を参照して各領域に対する前記制限動作パターンと前記許可動作パターンとを決定することが好ましい。
In the above configuration, further comprising a memory for storing operation pattern information in which the restricted operation pattern and the permitted operation pattern are registered for each of the plurality of areas,
Preferably, the operation restricting unit refers to the operation pattern information to determine the restricted operation pattern and the permitted operation pattern for each area.

本構成によれば、動作パターン情報には、領域毎に制限動作パターンと許可動作パターンとが登録されているため、制限動作パターンと許可動作パターンとを迅速に決定できる。 According to this configuration, since the restricted motion pattern and the permitted motion pattern are registered in the motion pattern information for each region, the restricted motion pattern and the permitted motion pattern can be quickly determined.

上記構成において、前記作業装置は、前記上部旋回体に対して上下方向に回動可能に取り付けられた第1部材と、前記第1部材に対して前記上部旋回体の前後方向に回動可能に取り付けられた第2部材と、前記第2部材に対して前記上部旋回体の前後方向に回動可能に取り付けられた第3部材とを含み、
前記制限動作パターンは、
前記第2部材が後方に回動する第1動作パターンと、
前記第2部材が前方に回動する第2動作パターンと、
前記第3部材が地面を掘削する第3動作パターンと、
前記第1部材が下方に回動する移動する第4動作パターンと、
前記上部旋回体が左旋回する第5動作パターンと、
前記上部旋回体が右旋回する第6動作パターンとの少なくとも一つを含むことが好ましい。
In the above configuration, the working device includes: a first member attached to the upper revolving body so as to be rotatable in the vertical direction; a second member attached; and a third member attached to the second member so as to be rotatable in the longitudinal direction of the upper rotating body,
The restricted operation pattern is
a first operation pattern in which the second member rotates backward;
a second operation pattern in which the second member rotates forward;
a third movement pattern in which the third member excavates the ground;
a moving fourth movement pattern in which the first member rotates downward;
a fifth operation pattern in which the upper rotating body rotates to the left;
It is preferable to include at least one of a sixth operation pattern in which the upper rotating body rotates to the right.

本構成によれば、作業装置の取り得る動作パターンを制限できる。 According to this configuration, it is possible to limit the possible operation patterns of the working device.

上記構成において、前記複数の領域は、前記先端位置よりも内側の内側領域を含み、前記内側領域における前記制限動作パターンは、前記第5動作パターンと前記第6動作パターンとの少なくとも一つを含むことが好ましい。 In the above configuration, the plurality of regions include an inner region inside the tip position, and the limited motion pattern in the inner region includes at least one of the fifth motion pattern and the sixth motion pattern. is preferred.

本構成によれば、内側領域において作業装置が人物に接触する可能性の高い左旋回(第5動作パターン)ないし右旋回(第6動作パターン)を制限できる。 According to this configuration, left turning (fifth operation pattern) or right turning (sixth operation pattern), in which there is a high possibility that the work device will come into contact with a person in the inner area, can be restricted.

上記構成において、前記複数の領域は、前記先端位置よりも外側の外側領域を含み、前記外側領域における前記制限動作パターンは、少なくとも前記第2動作パターンを含むことが好ましい。 In the above configuration, it is preferable that the plurality of regions include an outer region outside the tip position, and the restricted motion pattern in the outer region includes at least the second motion pattern.

本構成によれば、外側領域において作業装置が人物に接触する可能性の高いアーム押し(第2動作パターン)が制限できる。なお、外側領域は作業装置の先端位置が最大半径となる位置よりも外側には設定されない。 According to this configuration, it is possible to limit arm pushing (second operation pattern) in which the working device is highly likely to come into contact with a person in the outer region. Note that the outer region is not set outside the position where the tip position of the working device has the maximum radius.

上記構成において、前記領域設定部は、前記先端位置における前記作業装置の横幅を基準に前記複数の領域を設定することが好ましい。 In the above configuration, it is preferable that the area setting section sets the plurality of areas based on the width of the working device at the tip position.

本構成によれば、先端位置における作業装置の横幅を考慮した動作パターンの制限ができる。 According to this configuration, it is possible to limit the operation pattern in consideration of the width of the working device at the tip position.

上記構成において、前記内側領域において、前記先端位置を含む前記作業装置の幅に対して内側に設定された第1領域を含み、前記第1領域における前記制限動作パターンは前記第1動作パターン、前記第3動作パターン、及び前記第4動作パターンを含むことが好ましい。 In the above configuration, the inner region includes a first region set inside the width of the working device including the tip position, and the restricted operation pattern in the first region is the first operation pattern, the It is preferable to include a third operation pattern and the fourth operation pattern.

本構成によれば、作業装置の内側に人物がいる場合において、人物に接触する可能性の高いアーム引き(第1動作パターン)、バケット掘削(第3動作パターン)、及びブーム下げ(第4動作パターン)が制限できる。 According to this configuration, when there is a person inside the working device, the arm pulling (first operation pattern), bucket excavation (third operation pattern), and boom lowering (fourth operation), which are likely to come into contact with the person, are performed. pattern) can be restricted.

上記構成において、前記外側領域において、前記先端位置を含む前記作業装置の幅に対して外側に設定された第2領域を含み、前記第2領域における前記制限動作パターンは前記第2動作パターンであることが好ましい。 In the above configuration, the outer region includes a second region set outside the width of the working device including the tip position, and the restricted operation pattern in the second region is the second operation pattern. is preferred.

本構成によれば、作業装置の先端位置に対して前方に人物が位置する場合において、作業装置と人物とが干渉する可能性の高いアーム押し(第2動作パターン)が制限できる。 According to this configuration, when the person is positioned in front of the tip position of the working device, it is possible to limit the arm pushing (second operation pattern) that is highly likely to cause interference between the working device and the person.

上記構成において、前記内側領域において、前記先端位置を含む前記作業装置の幅の左端よりも左側に設定された第3領域を含み、前記第3領域における前記制限動作パターンは前記第5動作パターンであることが好ましい。 In the above configuration, the inner region includes a third region set to the left of the left end of the width of the working device including the tip position, and the restricted operation pattern in the third region is the fifth operation pattern. Preferably.

本構成によれば、作業装置の左側に人物が位置する場合において、作業装置と人物とが干渉する可能性の高い左旋回(第5動作パターン)を制限できる。 According to this configuration, when the person is positioned on the left side of the work device, it is possible to limit the counterclockwise turn (fifth operation pattern) that is likely to cause interference between the work device and the person.

上記構成において、前記外側領域において、前記先端位置を含む前記作業装置の幅の左端よりも左側に設定された第4領域を含み、前記第4領域における前記制限動作パターンは前記第5動作パターンの動作時に前記第2動作パターンが動作される動作パターンであることが好ましい。 In the above configuration, the outer region includes a fourth region set to the left of the left end of the width of the working device including the tip position, and the restricted operation pattern in the fourth region is the fifth operation pattern. It is preferable that the second operation pattern is an operation pattern operated during operation.

本構成によれば、作業装置の左斜め前方に人物が位置する場合において、作業装置と人物とが干渉する可能性の高い左旋回時のアーム押し(第5動作パターン+第2動作パターン)を制限できる。 According to this configuration, when the person is positioned diagonally to the left of the work device, the arm push (fifth operation pattern + second operation pattern) during left turning, which is highly likely to interfere with the work device, is performed. can be restricted.

上記構成において、前記内側領域において、前記先端位置を含む前記作業装置の幅の右端よりも右側に設定された第5領域を含み、前記第5領域における前記制限動作パターンは前記第6動作パターンであることが好ましい。 In the above configuration, the inner region includes a fifth region set to the right of the right end of the width of the working device including the tip position, and the restricted operation pattern in the fifth region is the sixth operation pattern. Preferably.

本構成によれば、作業装置の右側に人物が位置する場合において、作業装置と人物とが干渉する可能性の高い右旋回(第6動作パターン)を制限できる。 According to this configuration, when the person is positioned on the right side of the work device, it is possible to limit the right turn (sixth operation pattern) that is likely to interfere with the work device and the person.

上記構成において、前記外側領域において、前記先端位置を含む前記作業装置の幅の右端よりも右側に設定された第6領域を含み、前記第6領域における前記制限動作パターンは前記第6動作パターンの動作時に前記第2動作パターンが動作される動作パターンであることが好ましい。 In the above configuration, the outer region includes a sixth region set to the right of the right end of the width of the working device including the tip position, and the restricted operation pattern in the sixth region is the sixth operation pattern. It is preferable that the second operation pattern is an operation pattern operated during operation.

本構成によれば、作業装置の右斜め前方に人物が位置する場合において、作業装置と人物とが干渉する可能性の高い右旋回時のアーム押し(第6動作パターン+第2動作パターン)を制限できる。 According to this configuration, when a person is positioned obliquely to the right of the work device, the arm is pushed (sixth operation pattern + second operation pattern) when turning right when there is a high possibility of interference between the work device and the person. can be restricted.

上記構成において、前記制限は、前記制限動作パターンの減速又は禁止を含むことが好ましい。 In the above configuration, the restriction preferably includes deceleration or prohibition of the restricted operation pattern.

本構成において、制限動作パターンとして減速を採用した場合、制限動作パターンは通常の速度よりも低速で実行されるものの禁止はされないため、作業が全く進捗しない事態を回避できる。一方、本構成において、制限動作パターンとして禁止を採用した場合、制限動作パターンが停止するため、安全を確保できる。 In this configuration, when deceleration is adopted as the limited operation pattern, the limited operation pattern is executed at a lower speed than the normal speed, but is not prohibited, so that it is possible to avoid a situation where the work does not progress at all. On the other hand, in this configuration, when prohibition is adopted as the restricted operation pattern, the restricted operation pattern is stopped, so safety can be ensured.

本発明によれば、建設機械の作業効率の低下を抑制しつつ人物と建設機械との干渉を防止することができる。 Advantageous Effects of Invention According to the present invention, interference between a person and a construction machine can be prevented while suppressing a decrease in work efficiency of the construction machine.

本発明の実施の形態における干渉防止装置が適用された建設機械の外観図である。1 is an external view of a construction machine to which an interference prevention device according to an embodiment of the invention is applied; FIG. 図1に示す建設機械の構成を示すブロック図である。2 is a block diagram showing the configuration of the construction machine shown in FIG. 1; FIG. 建設機械の周囲に設定された第1領域~第6領域の一例を示す図である。FIG. 4 is a diagram showing an example of first to sixth areas set around a construction machine; ATT最大半径を説明する図である。It is a figure explaining an ATT maximum radius. 動作パターンテーブルの一例を示す図である。It is a figure which shows an example of an operation pattern table. 油圧回路の詳細な構成を示すブロック図である。It is a block diagram showing a detailed configuration of a hydraulic circuit. 実施の形態に係る干渉防止装置の処理を示すフローチャートである。7 is a flowchart showing processing of the interference prevention device according to the embodiment; 本発明の変形例に係る第1領域、第3領域、及び第5領域をキャビン内から見たときの図である。It is a figure when the 1st field, the 3rd field, and the 5th field concerning a modification of the present invention are seen from inside a cabin. 本発明の変形例に係る第4領域、第2領域、及び第6領域をキャビン内から見たときの図である。It is a figure when the 4th field, the 2nd field, and the 6th field concerning the modification of the present invention are seen from inside a cabin.

以下添付図面を参照しながら、本発明の実施の形態について説明する。なお、以下の実施の形態は、本発明を具体化した例であって、本発明の技術的範囲を限定する性格のものではない。 Embodiments of the present invention will be described below with reference to the accompanying drawings. It should be noted that the following embodiments are specific examples of the present invention, and are not intended to limit the technical scope of the present invention.

図1は、本発明の実施の形態における干渉防止装置が適用された建設機械1の外観図である。建設機械1は、例えば、油圧ショベル、ハイブリッドショベル等のショベルカーで構成されている。但し、これは一例であり、建設機械1は、例えば、クレーン等の建設機械で構成されてもよい。 FIG. 1 is an external view of a construction machine 1 to which an interference prevention device according to an embodiment of the invention is applied. The construction machine 1 is, for example, an excavator such as a hydraulic excavator or a hybrid excavator. However, this is only an example, and the construction machine 1 may be constructed by a construction machine such as a crane.

建設機械1は、クローラ式の下部走行体2と、下部走行体2上に旋回可能に設けられた上部旋回体3と、上部旋回体3に取り付けられた作業装置4とを備えている。本明細書では、上部旋回体3から作業装置4が延びる方向を前方、前方に対する反対方向を後方と記述する。また、地面に対して垂直方向に延びる方向を上方、上方に対する反対方向を下方と記述する。また、後方から前方に見て左側の方向を左方、左方に対する反対方向を右方と記述する。また、前方及び後方を総称して前後方向、上方及び下方を総称して上下方向、並びに左方及び右方を総称して左右方向と記述する。 The construction machine 1 includes a crawler-type lower traveling body 2 , an upper revolving body 3 rotatably provided on the lower traveling body 2 , and a working device 4 attached to the upper revolving body 3 . In this specification, the direction in which the working device 4 extends from the upper revolving body 3 is described as forward, and the direction opposite to the front is described as rearward. A direction extending perpendicular to the ground is described as upward, and a direction opposite to the upward direction is described as downward. Also, the direction to the left when viewed from the rear to the front is described as left, and the direction opposite to the left is described as right. In addition, front and rear are collectively referred to as the front-rear direction, upward and downward are collectively referred to as the vertical direction, and left and right are collectively referred to as the left-right direction.

作業装置4は、上部旋回体3に対して上方又は下方に回動可能に取り付けられたブーム5と、ブーム5の先端部に対して前方又は後方に回動可能に取り付けられたアーム6と、アーム6の先端部に対して前方又は後方に回動可能に取り付けられたバケット7とを備えている。なお、バケット7はアーム6に対して取り外し可能に構成されている。したがって、アーム6の先端部にはバケット7以外の例えば、破砕機又はブレーカー等の先端タッチメントが取り付けられていてもよい。 The work device 4 includes a boom 5 attached rotatably upward or downward to the upper revolving body 3, an arm 6 attached rotatable forward or backward to the tip of the boom 5, A bucket 7 is attached to the tip of the arm 6 so as to be rotatable forward or backward. Note that the bucket 7 is configured to be removable from the arm 6 . Therefore, a tip attachment such as a crusher or a breaker other than the bucket 7 may be attached to the tip of the arm 6 .

また、作業装置4は、上部旋回体3に対してブーム5を回動させるブームシリンダC1と、ブーム5に対してアーム6を回動させるアームシリンダC2と、アーム6に対してバケット7を回動させるバケットシリンダC3とを備えている。上部旋回体3はオペレータが搭乗するキャビンを備えている。なお、ブーム5、アーム6、及びバケット7はそれぞれ第1部材、第2部材、及び第3部材の一例に相当する。 The work device 4 also includes a boom cylinder C1 for rotating the boom 5 with respect to the upper rotating body 3, an arm cylinder C2 for rotating the arm 6 with respect to the boom 5, and a bucket 7 with respect to the arm 6. and a bucket cylinder C3 for moving. The upper revolving body 3 has a cabin in which an operator boards. The boom 5, the arm 6, and the bucket 7 correspond to examples of the first member, the second member, and the third member, respectively.

図2は、図1に示す建設機械1の構成を示すブロック図である。建設機械1は、物体センサ11、ブーム角度センサ12、アーム角度センサ13、入力部14、サブコントローラ15、メインコントローラ16、油圧回路17、操作部18、旋回モータM1、ブームシリンダC1、アームシリンダC2、及びバケットシリンダC3を備える。なお、図2において、物体センサ11、ブーム角度センサ12、アーム角度センサ13、入力部14、サブコントローラ15、メインコントローラ16、油圧回路17、及び操作部18は干渉防止装置を構成する。 FIG. 2 is a block diagram showing the configuration of the construction machine 1 shown in FIG. 1. As shown in FIG. The construction machine 1 includes an object sensor 11, a boom angle sensor 12, an arm angle sensor 13, an input section 14, a sub-controller 15, a main controller 16, a hydraulic circuit 17, an operation section 18, a turning motor M1, a boom cylinder C1, and an arm cylinder C2. , and a bucket cylinder C3. 2, the object sensor 11, boom angle sensor 12, arm angle sensor 13, input unit 14, sub-controller 15, main controller 16, hydraulic circuit 17, and operation unit 18 constitute an interference prevention device.

物体センサ11は、建設機械1の周囲に位置する物体を検出するためのセンサである。具体的には、物体センサ11は、例えば、測定範囲内に位置する物体の深度を画素単位で検出するTOFセンサ等の距離画像センサ、或いは、カメラ等の画像センサで構成されている。物体センサ11は、作業装置4に対して可能な限り死角が生じない位置に取り付けられており、例えば、図1に示すように、上部旋回体3の前面において、視線が上部旋回体3の前方を向くように取り付けられてもよいし、上部旋回体3に設けられたキャビン内において視線が上部旋回体3の前方に向くように取り付けられてもよい。 The object sensor 11 is a sensor for detecting objects positioned around the construction machine 1 . Specifically, the object sensor 11 is composed of, for example, a distance image sensor such as a TOF sensor that detects the depth of an object located within the measurement range in units of pixels, or an image sensor such as a camera. The object sensor 11 is mounted at a position that minimizes blind spots with respect to the work device 4. For example, as shown in FIG. , or may be installed so that the line of sight faces forward of the upper revolving body 3 in the cabin provided in the upper revolving body 3 .

なお、物体センサ11は、所定のフレームレートで上部旋回体3の前方をセンシングし、得られたセンシングデータを所定のフレームレートでサブコントローラ15に出力する。ここで、物体センサ11が距離画像センサで構成される場合、センシングデータは、各画素の深度が垂直方向及び水平方向の2軸に対してマトリックス状に配列された距離画像データにより構成される。また、物体センサ11が画像センサで構成される場合、センシングデータは各画素の輝度が垂直方向及び水平方向の2軸に対してマトリックス状に配列された画像データにより構成される。 The object sensor 11 senses the front of the upper rotating body 3 at a predetermined frame rate, and outputs the obtained sensing data to the sub-controller 15 at a predetermined frame rate. Here, when the object sensor 11 is composed of a distance image sensor, the sensing data is composed of distance image data in which the depth of each pixel is arranged in a matrix with respect to two axes in the vertical direction and the horizontal direction. When the object sensor 11 is composed of an image sensor, the sensing data is composed of image data in which the luminance of each pixel is arranged in a matrix with respect to two axes in the vertical and horizontal directions.

サブコントローラ15は、物体センサ11により出力されたセンシングデータから人物を抽出し、抽出した人物の位置を特定し、特定した人物の位置を含むセンシングデータを所定のフレームレートでメインコントローラ16に出力する。 The sub-controller 15 extracts a person from the sensing data output by the object sensor 11, specifies the position of the extracted person, and outputs the sensing data including the specified position of the person to the main controller 16 at a predetermined frame rate. .

具体的には、サブコントローラ15は、物体センサ11が距離画像センサで構成される場合、人物のシルエットを持つ一群の画素データを距離画像データから抽出し、抽出した一群の画素データのうち例えば深度が最小である画素データを特定し、当該画素データの座標及び深度から、当該画素データに対応する図3に示す座標空間400上の位置を当該人物の位置として算出すればよい。 Specifically, when the object sensor 11 is a range image sensor, the sub-controller 15 extracts a group of pixel data having a silhouette of a person from the range image data, and for example, depth is specified, and from the coordinates and depth of the pixel data, the position on the coordinate space 400 shown in FIG. 3 corresponding to the pixel data is calculated as the position of the person.

また、サブコントローラ15は、物体センサ11が画像センサで構成される場合、人物のシルエットを持つ一群の画素データを画像データから抽出し、抽出した一群の画素データのうち、例えば人物の足元を示す画素データを特定し、特定した画素データの座標に対応する図3に示す座標空間400上の位置を求め、得られた位置を当該人物の位置として算出すればよい。なお、物体センサ11及びサブコントローラ15は第2センサの一例を構成する。後述するように座標空間400はX軸とY軸との2軸で表される座標空間であるため、各人物の座標空間400における位置はX成分とY成分との2つの成分で表されることになる。なお、サブコントローラ15は、物体センサ11の座標空間を座標空間400に変換するための予め定められた変換式を用いて、座標空間400上での人物の各位置を算出すればよい。 Further, when the object sensor 11 is composed of an image sensor, the sub-controller 15 extracts a group of pixel data having a person's silhouette from the image data, and among the extracted group of pixel data, for example, indicates the person's feet. The pixel data is identified, the position on the coordinate space 400 shown in FIG. 3 corresponding to the coordinates of the identified pixel data is obtained, and the obtained position is calculated as the position of the person. Note that the object sensor 11 and the sub-controller 15 constitute an example of a second sensor. As will be described later, since the coordinate space 400 is a coordinate space represented by two axes, the X axis and the Y axis, the position of each person in the coordinate space 400 is represented by two components, an X component and a Y component. It will be. The sub-controller 15 may calculate each position of the person on the coordinate space 400 using a predetermined conversion formula for converting the coordinate space of the object sensor 11 into the coordinate space 400 .

ブーム角度センサ12は、上部旋回体3に対してブーム5が取り付けられたブームフットピンに設けられ、上部旋回体3に対するブーム5の角度(以下、「ブーム角度」と記述する。)を検出し、メインコントローラ16に一定の周期又は角度が変化したタイミングで出力する。 The boom angle sensor 12 is provided on a boom foot pin to which the boom 5 is attached with respect to the upper swing structure 3, and detects the angle of the boom 5 with respect to the upper swing structure 3 (hereinafter referred to as "boom angle"). , to the main controller 16 at a constant period or at timing when the angle changes.

アーム角度センサ13は、ブーム5に対してアーム6が取り付けられた位置に設けられ、ブーム5に対するアーム6の角度(以下、「アーム角度」と記述する。)を検出し、メインコントローラ16に一定の周期又は角度が変化したタイミングで出力する。なお、ブーム角度センサ12及びアーム角度センサ13は第1センサの一例である。 The arm angle sensor 13 is provided at a position where the arm 6 is attached to the boom 5 and detects the angle of the arm 6 with respect to the boom 5 (hereinafter referred to as "arm angle"). is output at the timing when the period or angle of is changed. Note that the boom angle sensor 12 and the arm angle sensor 13 are examples of the first sensor.

入力部14は、キャビン内に設けられた、各種の操作ボタン、各種のスイッチ、及びタッチパネル式のディスプレイで構成され、本実施の形態では、特に、先端アタッチメントの最大半径(以下、「ATT最大半径H」と記述する。)及び先端アタッチメントの幅(以下、「ATT最大幅B」と記述する。)の入力を受け付ける。ここで、ATT最大半径Hとは、アーム6の先端のアームトップピンから先端アタッチメントの先端までの距離を指す。図4は、ATT最大半径Hを説明する図である。図4の例では、先端アタッチメントとしてバケット7が採用されている。したがって、ATT最大半径Hはアームトップピン901からバケット7の先端902までの距離が該当する。ATT最大幅Bは、図3に示すように上面視における先端アタッチメントの横幅の最大値が該当する。ここでは、先端アタッチメントとしてバケット7が採用されているため、バケット7の横幅の最大値がATT最大幅Bとなる。 The input unit 14 includes various operation buttons, various switches, and a touch panel display provided in the cabin. H") and the width of the tip attachment (hereinafter referred to as "ATT maximum width B"). Here, the ATT maximum radius H refers to the distance from the arm top pin at the tip of the arm 6 to the tip of the tip attachment. FIG. 4 is a diagram for explaining the ATT maximum radius H. FIG. In the example of FIG. 4, a bucket 7 is employed as the tip attachment. Therefore, the ATT maximum radius H corresponds to the distance from the arm top pin 901 to the tip 902 of the bucket 7 . The ATT maximum width B corresponds to the maximum lateral width of the tip attachment in top view as shown in FIG. Here, since the bucket 7 is adopted as the tip attachment, the maximum width of the bucket 7 is the ATT maximum width B. As shown in FIG.

旋回モータM1は、例えば、油圧モータで構成され、操作部18が受け付けた操作量に応じた旋回速度で、下部走行体10に対して上部旋回体3を左方及び右方の双方向に駆動する。ブームシリンダC1は、例えば、油圧シリンダで構成され、操作部18が受け付けた操作量に応じた起伏速度又は倒伏速度でブーム5を回動させる。アームシリンダC2は、例えば、油圧シリンダで構成され、操作部18が受け付けた操作量に応じた起伏速度又は倒伏速度でアーム6を回動させる。バケットシリンダC3は、例えば、油圧シリンダで構成され、操作部18が受け付けた操作量に応じた起伏速度又は倒伏速度でバケット7を回動させる。 The turning motor M1 is composed of, for example, a hydraulic motor, and drives the upper turning body 3 in both left and right directions with respect to the lower traveling body 10 at a turning speed according to the amount of operation received by the operation unit 18. do. The boom cylinder C<b>1 is configured by, for example, a hydraulic cylinder, and rotates the boom 5 at a raising/lowering speed or a lofting speed corresponding to the amount of operation received by the operation unit 18 . The arm cylinder C2 is configured by, for example, a hydraulic cylinder, and rotates the arm 6 at a raising/lowering speed or a laying down speed corresponding to the amount of operation received by the operation unit 18 . The bucket cylinder C3 is configured by, for example, a hydraulic cylinder, and rotates the bucket 7 at a lifting speed or a falling speed according to the amount of operation received by the operation unit 18 .

油圧回路17は、操作部18に入力された操作量に応じて作業装置4及び上部旋回体3の少なくとも一方を動作させる。油圧回路17は動作実行部の一例に相当する。 The hydraulic circuit 17 operates at least one of the work device 4 and the upper revolving body 3 according to the operation amount input to the operation unit 18 . The hydraulic circuit 17 corresponds to an example of an operation executing section.

図6は、油圧回路17の詳細な構成を示すブロック図である。油圧回路17は、右旋回操作弁171、左旋回操作弁172、上ブーム操作弁173、下ブーム操作弁174、上アーム操作弁175、下アーム操作弁176、上バケット操作弁177、下バケット操作弁178、旋回制御弁191、ブーム制御弁192、アーム制御弁193、及びバケット制御弁194を備える。また、操作部18は、上部旋回体3に対する操作を受け付ける旋回操作レバー181、ブーム5に対する操作を受け付けるブーム操作レバー182、アーム6に対する操作を受け付けるアーム操作レバー183、及びバケット7に対する操作を受け付けるバケット操作レバー184を備える。 FIG. 6 is a block diagram showing the detailed configuration of the hydraulic circuit 17. As shown in FIG. The hydraulic circuit 17 includes a right turn operation valve 171, a left turn operation valve 172, an upper boom operation valve 173, a lower boom operation valve 174, an upper arm operation valve 175, a lower arm operation valve 176, an upper bucket operation valve 177, and a lower bucket. An operation valve 178 , a swing control valve 191 , a boom control valve 192 , an arm control valve 193 and a bucket control valve 194 are provided. Further, the operation unit 18 includes a turning operation lever 181 that receives an operation for the upper swing body 3 , a boom operation lever 182 that receives an operation for the boom 5 , an arm operation lever 183 that receives an operation for the arm 6 , and a bucket for receiving an operation for the bucket 7 . An operating lever 184 is provided.

旋回操作レバー181は、右旋回の操作を受け付けた場合、操作量に応じたパイロット圧をパイロットラインL11を通じて旋回制御弁191に供給する。また、旋回操作レバー181は、左旋回の操作を受け付けた場合、操作量に応じたパイロット圧をパイロットラインL12を通じて旋回制御弁191に供給する。 The turning operation lever 181 supplies a pilot pressure corresponding to the amount of operation to the turning control valve 191 through the pilot line L11 when receiving a right turning operation. Further, when receiving a left turn operation, the turn operation lever 181 supplies a pilot pressure corresponding to the amount of operation to the turn control valve 191 through the pilot line L12.

旋回制御弁191は、パイロットラインL11及びパイロットラインL12のそれぞれと接続され、右旋回操作弁171又は左旋回操作弁172からのパイロット圧に応じて、図略の油圧ポンプから旋回モータM1への作動油の供給方向及び流量を制御する。 The swing control valve 191 is connected to each of the pilot line L11 and the pilot line L12, and controls a hydraulic pump (not shown) to the swing motor M1 according to the pilot pressure from the right swing operation valve 171 or the left swing operation valve 172. Controls the supply direction and flow rate of hydraulic oil.

右旋回操作弁171は、パイロットラインL11の途中に設けられた電磁制御弁で構成され、動作制限部164から出力される制限信号を受け付けることにより、旋回制御弁191に入力されるパイロット圧を減圧する。これにより、右旋回速度が減速される。 The right turn operation valve 171 is composed of an electromagnetic control valve provided in the middle of the pilot line L11, and receives a limit signal output from the operation limiter 164 to reduce the pilot pressure input to the turn control valve 191. Reduce pressure. As a result, the right turn speed is reduced.

左旋回操作弁172は、パイロットラインL12の途中に設けられた電磁制御弁で構成され、動作制限部164から出力される制限信号を受け付けることにより、旋回制御弁191に入力されるパイロット圧を減圧する。これにより、左旋回速度が減速される。 The left turn operation valve 172 is composed of an electromagnetic control valve provided in the middle of the pilot line L12, and receives a limit signal output from the operation limiter 164 to reduce the pilot pressure input to the turn control valve 191. do. As a result, the left turning speed is reduced.

ブーム操作レバー182は、ブーム5を上方に回動させる操作を受け付けた場合、操作量に応じたパイロット圧をパイロットラインL21を通じてブーム制御弁192に供給する。また、ブーム操作レバー182は、左旋回の操作を受け付けた場合、操作量に応じたパイロット圧をパイロットラインL22を通じてブーム制御弁192に供給する。 When receiving an operation to rotate the boom 5 upward, the boom control lever 182 supplies a pilot pressure corresponding to the amount of operation to the boom control valve 192 through the pilot line L21. In addition, when the boom control lever 182 receives a left turn operation, the boom control valve 192 is supplied with a pilot pressure corresponding to the amount of operation through the pilot line L22.

ブーム制御弁192は、パイロットラインL21及びパイロットラインL22のそれぞれと接続され、上ブーム操作弁173又は下ブーム操作弁174からのパイロット圧に応じて、図略の油圧ポンプからブームシリンダC1への作動油の供給方向及び流量を制御する。 The boom control valve 192 is connected to each of the pilot line L21 and the pilot line L22, and operates from a hydraulic pump (not shown) to the boom cylinder C1 according to the pilot pressure from the upper boom operation valve 173 or the lower boom operation valve 174. Controls the oil supply direction and flow rate.

上ブーム操作弁173は、パイロットラインL21の途中に設けられた電磁制御弁で構成され、動作制限部164から出力される制限信号を受け付けることにより、ブーム制御弁192に入力されるパイロット圧を減圧する。これにより、ブーム5の上方への回動速度が減速される。 The upper boom control valve 173 is composed of an electromagnetic control valve provided in the middle of the pilot line L21, and receives a limit signal output from the operation limiter 164 to reduce the pilot pressure input to the boom control valve 192. do. As a result, the upward rotation speed of the boom 5 is reduced.

下ブーム操作弁174は、パイロットラインL22の途中に設けられた電磁制御弁で構成され、動作制限部164から出力される制限信号を受け付けることにより、ブーム制御弁192に入力されるパイロット圧を減圧する。これにより、ブーム5の下方への回動速度が減速される。 The lower boom control valve 174 is composed of an electromagnetic control valve provided in the middle of the pilot line L22, and receives a limit signal output from the operation limiter 164 to reduce the pilot pressure input to the boom control valve 192. do. As a result, the downward rotation speed of the boom 5 is reduced.

アーム操作レバー183は、アーム6を上部旋回体3の前方に回動する操作を受け付けた場合、操作量に応じたパイロット圧をパイロットラインL31を通じてアーム制御弁193に供給する。また、アーム操作レバー183は、アーム6を上部旋回体3の下方に回動する操作を受け付けた場合、操作量に応じたパイロット圧をパイロットラインL32を通じてアーム制御弁193に供給する。 When the arm operation lever 183 receives an operation to rotate the arm 6 forward of the upper rotating body 3, it supplies a pilot pressure corresponding to the operation amount to the arm control valve 193 through the pilot line L31. Further, when receiving an operation to rotate the arm 6 downward of the upper rotating body 3, the arm control lever 183 supplies a pilot pressure corresponding to the amount of operation to the arm control valve 193 through the pilot line L32.

アーム制御弁193は、パイロットラインL31及びパイロットラインL32のそれぞれと接続され、上アーム操作弁175又は下アーム操作弁176からのパイロット圧に応じて、図略の油圧ポンプからアームシリンダC2への作動油の供給方向及び流量を制御する。 The arm control valve 193 is connected to each of the pilot line L31 and the pilot line L32, and operates from a hydraulic pump (not shown) to the arm cylinder C2 according to the pilot pressure from the upper arm operation valve 175 or the lower arm operation valve 176. Controls the oil supply direction and flow rate.

上アーム操作弁175は、パイロットラインL31の途中に設けられた電磁制御弁で構成され、動作制限部164から出力される制限信号を受け付けることにより、アーム制御弁193に入力されるパイロット圧を減圧する。これにより、アーム6の上方への回動速度が減速される。 The upper arm control valve 175 is composed of an electromagnetic control valve provided in the middle of the pilot line L31, and reduces the pilot pressure input to the arm control valve 193 by receiving a limit signal output from the operation limiter 164. do. As a result, the upward rotation speed of the arm 6 is reduced.

下アーム操作弁176は、パイロットラインL32の途中に設けられた電磁制御弁で構成され、動作制限部164から出力される制限信号を受け付けることにより、アーム制御弁193に入力されるパイロット圧を減圧する。これにより、アーム6の下方への回動速度が減速される。 The lower arm control valve 176 is composed of an electromagnetic control valve provided in the middle of the pilot line L32, and reduces the pilot pressure input to the arm control valve 193 by receiving a limit signal output from the operation limiter 164. do. As a result, the downward rotation speed of the arm 6 is reduced.

バケット操作レバー184は、バケット7を上部旋回体3の前方に回動させる操作を受け付けた場合、操作量に応じたパイロット圧をパイロットラインL41を通じてバケット制御弁194に供給する。また、バケット操作レバー184は、バケット7を上部旋回体3の後方に回動させる操作を受け付けた場合、操作量に応じたパイロット圧をパイロットラインL42を通じてバケット制御弁194に供給する。 The bucket control lever 184 supplies a pilot pressure corresponding to the amount of operation to the bucket control valve 194 through the pilot line L41 when receiving an operation to rotate the bucket 7 forward of the upper rotating body 3 . Further, when the bucket operation lever 184 receives an operation to rotate the bucket 7 rearward of the upper rotating body 3, the pilot pressure corresponding to the operation amount is supplied to the bucket control valve 194 through the pilot line L42.

バケット制御弁194は、パイロットラインL41及びパイロットラインL42のそれぞれと接続され、上バケット操作弁177又は下バケット操作弁178からのパイロット圧に応じて、図略の油圧ポンプからバケットシリンダC3への作動油の供給方向及び流量を制御する。 The bucket control valve 194 is connected to the pilot line L41 and the pilot line L42, respectively, and operates from a hydraulic pump (not shown) to the bucket cylinder C3 according to the pilot pressure from the upper bucket operation valve 177 or the lower bucket operation valve 178. Controls the oil supply direction and flow rate.

上バケット操作弁177は、パイロットラインL41の途中に設けられた電磁制御弁で構成され、動作制限部164から出力される制限信号を受け付けることにより、バケット制御弁194に入力されるパイロット圧を減圧する。これにより、バケット7の上方への回動速度が減速される。 The upper bucket control valve 177 is composed of an electromagnetic control valve provided in the middle of the pilot line L41. do. As a result, the upward rotation speed of the bucket 7 is reduced.

下バケット操作弁178は、パイロットラインL42の途中に設けられた電磁制御弁で構成され、動作制限部164から出力される制限信号を受け付けることにより、バケット制御弁194に入力されるパイロット圧を減圧する。これにより、バケット7の下方への回動速度が減速される。 The lower bucket control valve 178 is composed of an electromagnetic control valve provided in the middle of the pilot line L42, and receives a limit signal output from the operation limiter 164 to reduce the pilot pressure input to the bucket control valve 194. do. As a result, the downward rotation speed of the bucket 7 is reduced.

なお、右旋回操作弁171~下バケット操作弁178から出力されるパイロット圧は図略のパイロット圧センサにより検出されてメインコントローラ16に入力される。これにより、メインコントローラ16は、操作部18に入力された操作量が把握できる。 The pilot pressure output from the right turn operation valve 171 to the lower bucket operation valve 178 is detected by a pilot pressure sensor (not shown) and input to the main controller 16 . Thereby, the main controller 16 can grasp the operation amount input to the operation unit 18 .

図2に参照を戻す。メインコントローラ16は、CPU及びメモリを含むコンピュータ或いは専用の電気回路で構成され、建設機械1の全体制御を司る。メインコントローラ16は、位置算出部161、領域設定部162、人物判定部163、動作制限部164、及び動作パターン記憶部165を備える。 Refer back to FIG. The main controller 16 is composed of a computer including a CPU and memory or a dedicated electric circuit, and controls the construction machine 1 as a whole. The main controller 16 includes a position calculation unit 161 , an area setting unit 162 , a person determination unit 163 , an operation restriction unit 164 and an operation pattern storage unit 165 .

位置算出部161は、ブーム角度センサ12が検出したブーム角度及びアーム角度センサ13が検出したアーム角度に基づいて、作業装置4の先端位置を算出する。作業装置4の先端位置は、図3に示す座標空間400におけるX成分とY成分とによって規定される。 The position calculator 161 calculates the tip position of the work device 4 based on the boom angle detected by the boom angle sensor 12 and the arm angle detected by the arm angle sensor 13 . The tip position of the working device 4 is defined by the X component and the Y component in the coordinate space 400 shown in FIG.

図3を参照し、X軸は、上面視において、旋回中心軸Oを通る左右方向に設定された座標軸である。Y軸は、上面視において、旋回中心軸Oを通る前後方向に設定された座標軸である。 Referring to FIG. 3, the X axis is a coordinate axis set in the horizontal direction passing through the turning center axis O in a top view. The Y-axis is a coordinate axis set in the front-rear direction passing through the turning center axis O in a top view.

したがって、作業装置4の先端位置401のY成分の値は以下のように算出される。図4を参照し、位置算出部161は、まず、ブーム角度及びアーム角度と、ブーム5の既知の長さと、既知のアーム6の既知の長さとを用いた幾何演算を行うことで、上部旋回体3の旋回中心軸Oからアームトップピン901までの距離Lを算出する。次に、位置算出部161は、距離Lに入力部14に入力されたATT最大半径Hを加算した値を、作業装置4の先端位置401のY成分の値として算出する。 Therefore, the value of the Y component of the tip position 401 of the working device 4 is calculated as follows. Referring to FIG. 4 , the position calculation unit 161 first performs a geometric operation using the boom angle, the arm angle, the known length of the boom 5 , and the known length of the known arm 6 , so that the upper turning A distance L from the turning center axis O of the body 3 to the arm top pin 901 is calculated. Next, the position calculation unit 161 calculates a value obtained by adding the maximum ATT radius H input to the input unit 14 to the distance L as the value of the Y component of the tip position 401 of the work device 4 .

一方、図3を参照し、Y軸は上面視において作業装置4の中心線CL1上に設定されている。また、X軸及びY軸で示す座標空間400は、上部旋回体3の旋回角度に拘わらず、上部旋回体3を基準に設定される。したがって、作業装置4の先端位置401のX成分の値は、作業装置4の姿勢及び上部旋回体3の旋回角度に拘わらず0となる。但し、これは一例であり、Y軸が作業装置4の中心線CL1に対してX軸方向にずれた位置に設定されているのであれば、Y軸に対する中心線CL1のX軸方向へのずれ量が先端位置401のX成分の値となる。 On the other hand, referring to FIG. 3, the Y-axis is set on the center line CL1 of the work device 4 when viewed from above. A coordinate space 400 indicated by the X axis and the Y axis is set based on the upper revolving body 3 regardless of the revolving angle of the upper revolving body 3 . Therefore, the value of the X component of the tip position 401 of the work device 4 is 0 regardless of the posture of the work device 4 and the swing angle of the upper swing body 3 . However, this is only an example, and if the Y-axis is set at a position shifted in the X-axis direction with respect to the center line CL1 of the work device 4, the shift in the X-axis direction of the center line CL1 with respect to the Y-axis The amount becomes the value of the X component of tip position 401 .

ここでは、作業装置4の先端位置401のY成分の値は、距離LにATT最大半径Hを加算した値が採用されているが、これは一例であり、アームトップピン901のY成分の値が採用されてもよい。また、図4を参照し、距離LにATT最大半径Hを加算した値は、作業装置4の先端位置401のY成分を正確に表していない。そこで、作業装置4の先端位置401のY成分の値は、バケット7の先端902のY成分の値が採用されてもよい。この場合、アーム6に対するバケット7の角度を示すバケット角度を検出するためのバケット角度センサをアームトップピン901に配置する。そして、位置算出部161は、バケット角度センサが検出したバケット角度とATT最大半径Hとを用いてアームトップピン901からバケット7の先端902までの距離H’を算出する。そして、位置算出部161は、距離H’に距離Lを加算した値を先端位置401のY成分の値として算出すればよい。これにより、作業装置4の先端位置401のY成分の値をより正確に算出できる。 Here, the Y component value of the tip position 401 of the working device 4 is a value obtained by adding the ATT maximum radius H to the distance L, but this is an example, and the Y component value of the arm top pin 901 is may be adopted. Also, referring to FIG. 4 , the value obtained by adding the ATT maximum radius H to the distance L does not accurately represent the Y component of the tip position 401 of the working device 4 . Therefore, the Y component value of the tip 902 of the bucket 7 may be used as the Y component value of the tip position 401 of the working device 4 . In this case, a bucket angle sensor for detecting the bucket angle indicating the angle of the bucket 7 with respect to the arm 6 is arranged on the arm top pin 901 . Then, the position calculator 161 calculates the distance H′ from the arm top pin 901 to the tip 902 of the bucket 7 using the bucket angle detected by the bucket angle sensor and the ATT maximum radius H. Then, the position calculation unit 161 may calculate a value obtained by adding the distance L to the distance H′ as the value of the Y component of the tip position 401 . As a result, the value of the Y component at the tip position 401 of the working device 4 can be calculated more accurately.

図2に参照を戻す。領域設定部162は、位置算出部161により算出された作業装置4の先端位置401における作業装置4の横幅を基準に建設機械1の周囲に複数の領域を設定する。具体的には、領域設定部162は、図3に示す座標空間400に対して第1領域R1~第6領域R6の6つの領域を設定する。なお、座標空間400はメインコントローラ16が管理する建設機械1のローカル座標空間である。 Refer back to FIG. The region setting unit 162 sets a plurality of regions around the construction machine 1 based on the width of the work device 4 at the tip position 401 of the work device 4 calculated by the position calculation unit 161 . Specifically, the region setting unit 162 sets six regions, a first region R1 to a sixth region R6, in the coordinate space 400 shown in FIG. A coordinate space 400 is a local coordinate space of the construction machine 1 managed by the main controller 16 .

図3は、建設機械1の周囲に設定された第1領域R1~第6領域R6の一例を示す図である。第1領域R1~第6領域R6は、大きく、内周430の内側に位置する第1領域R1、第3領域R3、及び第5領域R5からなる内側領域と、内周430の外側に位置する、第4領域R4、第2領域R2、及び第6領域からなる外側領域とに2分される。内周430は、先端位置401のY成分の値を半径とする円弧である。外周440は、先端位置401のY成分の値をY軸方向に延ばした距離RMを半径とする円弧である。ここで、距離RMは、建設機械1の予め定められた最大旋回半径又はその最大旋回半径に所定のマージンを加えた距離が採用される。 FIG. 3 is a diagram showing an example of the first region R1 to sixth region R6 set around the construction machine 1. As shown in FIG. The first region R1 to the sixth region R6 are large, the inner region consisting of the first region R1, the third region R3, and the fifth region R5 located inside the inner circumference 430, and the inner region located outside the inner circumference 430. , a fourth region R4, a second region R2, and an outer region consisting of a sixth region. The inner circumference 430 is an arc whose radius is the value of the Y component of the tip position 401 . The outer circumference 440 is an arc whose radius is a distance RM obtained by extending the value of the Y component of the tip position 401 in the Y-axis direction. Here, as the distance RM, a predetermined maximum turning radius of the construction machine 1 or a distance obtained by adding a predetermined margin to the maximum turning radius is adopted.

内側領域は、先端位置401よりも建設機械1に対して内側にある領域である。具体的には、内側領域は、内周430とX軸とによって取り囲まれる領域であり、外側領域は、先端位置401よりも建設機械1に対して外側に位置する領域である。具体的には、外側領域は、内周430と外周440とX軸とによって取り囲まれる領域である。 The inner area is an area inside the construction machine 1 from the tip position 401 . Specifically, the inner area is an area surrounded by the inner circumference 430 and the X axis, and the outer area is an area located outside the tip position 401 with respect to the construction machine 1 . Specifically, the outer region is the region bounded by inner perimeter 430, outer perimeter 440, and the X-axis.

第1領域R1は、内側領域において先端位置401における作業装置4の幅に対して内側に設定された領域である。第1領域R1は、作業装置4の真下且つ先端位置401よりも上部旋回体3側の領域である。具体的には、第1領域R1は、ATT最大幅Bと同一の長さの横幅を持ち、X軸及び内周430によって取り囲まれたほぼ四角形状の領域である。 The first region R1 is a region set inside the width of the working device 4 at the tip position 401 in the inner region. The first region R<b>1 is a region directly below the working device 4 and closer to the upper revolving body 3 than the tip position 401 . Specifically, the first region R1 is a substantially quadrilateral region surrounded by the X-axis and the inner periphery 430 and having the same horizontal width as the ATT maximum width B. As shown in FIG.

第2領域R2は、第1領域R1の前方に隣接する領域である。第2領域R2は、外側領域において先端位置401における作業装置4の幅に対して外側に設定された領域である。具体的には、第2領域R2は、ATT最大幅Bと同一の長さの横幅を持ち、内周430及び外周440により取り囲まれたほぼ四角形状の領域である。なお、第1領域R1及び第2領域R2はそれぞれ長手方向がY軸と平行である。 The second region R2 is a region adjacent to the front of the first region R1. The second region R2 is a region set outside the width of the working device 4 at the tip position 401 in the outer region. Specifically, the second region R2 is a substantially rectangular region having a width equal to the ATT maximum width B and surrounded by an inner periphery 430 and an outer periphery 440 . The longitudinal direction of each of the first region R1 and the second region R2 is parallel to the Y-axis.

第3領域R3は、第1領域R1の左方に隣接する領域である。第3領域R3は、内側領域において先端位置401における作業装置4の幅の左端よりも左側に設定された領域である。具体的には、第3領域R3は内周430とX軸と第1領域R1の左方の境界線とによって取り囲まれた領域である。 The third region R3 is a region adjacent to the left of the first region R1. The third region R3 is a region set to the left of the left end of the width of the working device 4 at the tip position 401 in the inner region. Specifically, the third region R3 is a region surrounded by the inner periphery 430, the X axis, and the left boundary line of the first region R1.

第4領域R4は、第3領域R3の前方に設けられた領域である。第4領域R4は、外側領域において、先端位置401における作業装置4の幅の左端よりも左側に設定された領域である。具体的には、第4領域R4は、外周440と内周430とX軸と第2領域R2の左方の境界線とによって取り囲まれた領域である。 The fourth region R4 is a region provided in front of the third region R3. The fourth region R4 is a region set to the left of the left end of the width of the working device 4 at the tip position 401 in the outer region. Specifically, the fourth region R4 is a region surrounded by the outer periphery 440, the inner periphery 430, the X axis, and the left boundary line of the second region R2.

第5領域R5は、第1領域R1の右方に隣接する領域である。第5領域R5は、内側領域において、先端位置401における作業装置の幅の右端よりも右側に設定された領域である。具体的には、第5領域R5は、内周430とX軸と第1領域R1の右方の境界線とによって取り囲まれた領域である。 The fifth region R5 is a region adjacent to the right of the first region R1. The fifth region R5 is a region set to the right of the right end of the width of the working device at the tip position 401 in the inner region. Specifically, the fifth region R5 is a region surrounded by the inner circumference 430, the X axis, and the right boundary line of the first region R1.

第6領域R6は、第5領域R5の前方に設けられた領域である。第6領域R6は、外側領域において、先端位置401における作業装置4の幅の右端よりも右側に設定された領域である。具体的には、第6領域R6は、外周440と内周430とX軸と第2領域R2の右方の境界線とによって取り囲まれた領域である。以下、第1領域R1~第6領域R6を総称する場合、領域Rと記述する。 The sixth region R6 is a region provided in front of the fifth region R5. The sixth region R6 is a region set to the right of the right end of the width of the working device 4 at the tip position 401 in the outer region. Specifically, the sixth region R6 is a region surrounded by the outer periphery 440, the inner periphery 430, the X-axis, and the right boundary line of the second region R2. Hereinafter, when the first region R1 to the sixth region R6 are collectively referred to, they will be referred to as region R.

図2に参照を戻す。人物判定部163は、サブコントローラ15から出力されたセンシングデータに基づいて、第1領域R1~第6領域R6のそれぞれに対して人物の有無を検出する。上述したように、サブコントローラ15から出力されるセンシングデータは、物体センサ11が検出したセンシングデータに含まれる各人物の座標空間400上での位置が含まれている。そのため、人物判定部163は、サブコントローラ15から出力されたセンシングデータに含まれる各人物の位置が、座標空間400上に設定された第1領域R1~第6領域R6のいずれに属するかを判定することで、第1領域R1~第6領域R6のいずれの領域Rに人物がいるか否かを判定すればよい。 Refer back to FIG. Based on the sensing data output from the sub-controller 15, the person determination unit 163 detects the presence or absence of a person in each of the first to sixth regions R1 to R6. As described above, the sensing data output from the sub-controller 15 includes the position on the coordinate space 400 of each person included in the sensing data detected by the object sensor 11 . Therefore, the person determination unit 163 determines to which of the first region R1 to sixth region R6 set on the coordinate space 400 the position of each person included in the sensing data output from the sub-controller 15 belongs. By doing so, it is possible to determine whether or not a person is present in any one of the first to sixth regions R1 to R6.

動作制限部164は、領域設定部162が建設機械1の周囲に設定した第1領域R1~第6領域R6のうち、少なくとも1つの領域Rに人物がいると人物判定部163が判定した場合、人物が検出された領域Rにおいて、作業装置4が人物と干渉する可能性のある予め定められた建設機械1の動作パターンである制限動作パターンを制限し、且つ、作業装置4が人物と干渉する可能性の低い予め定められた建設機械1の動作パターンである許可動作パターンを許可するように油圧回路17を制御する。 When the person determination unit 163 determines that a person is present in at least one region R among the first region R1 to the sixth region R6 set around the construction machine 1 by the region setting unit 162, the operation restriction unit 164 In a region R where a person is detected, a restricted operation pattern, which is a predetermined operation pattern of the construction machine 1 in which the work device 4 may interfere with the person, is restricted and the work device 4 interferes with the person. The hydraulic circuit 17 is controlled to permit the permitted operation pattern, which is a predetermined operation pattern of the construction machine 1 with low possibility.

具体的には、動作制限部164は、図5に示す、第1領域R1~第6領域R6のそれぞれに対して、制限動作パターンと許可動作パターンとが予め登録された動作パターンテーブルT5(動作パターン情報の一例)を参照することで、第1領域R1~第6領域R6のそれぞれにおける制限動作パターンと許可動作パターンとを決定する。動作パターン記憶部165は、動作パターンテーブルT5を記憶する。 Specifically, the motion restriction unit 164 includes a motion pattern table T5 (motion pattern table T5) in which restricted motion patterns and permitted motion patterns are registered in advance for each of the first to sixth regions R1 to R6 shown in FIG. example of pattern information), the restricted operation pattern and the permitted operation pattern for each of the first region R1 to the sixth region R6 are determined. The motion pattern storage unit 165 stores the motion pattern table T5.

図5は、動作パターンテーブルT5の一例を示す図である。動作パターンテーブルT5は縦軸に動作パターン、横軸に第1領域R1~第6領域R6が割り当てられた2次元のテーブルである。動作パターンテーブルT5では、各領域Rに対して、第1動作パターン~第6動作パターンのうちのいずれか1又は複数が制限すべき動作パターンとして割り当てられている。図5において「制限」と記載されたセルは、対応する領域Rに人物がいれば、対応する動作パターンの動作が制限されることを示している。制限とは通常速度よりも遅い速度で作業装置4及び上部旋回体3を動作させることを指す。制限時におけるブーム5、アーム6、バケット7、及び上部旋回体3の各々の動作速度は、作業装置4が人物と干渉したとしても人物を負傷させない程度の予め定められた速度が採用される。 FIG. 5 is a diagram showing an example of the operation pattern table T5. The motion pattern table T5 is a two-dimensional table in which motion patterns are assigned to the vertical axis and the first to sixth regions R1 to R6 are assigned to the horizontal axis. In the motion pattern table T5, one or more of the first to sixth motion patterns are assigned to each region R as motion patterns to be restricted. In FIG. 5, a cell described as "restricted" indicates that if a person is present in the corresponding area R, the motion of the corresponding motion pattern is restricted. Limitation refers to operating the working device 4 and the upper revolving body 3 at a speed lower than the normal speed. The operating speeds of the boom 5, the arm 6, the bucket 7, and the upper rotating body 3 at the time of restriction are predetermined speeds that do not injure a person even if the working device 4 interferes with the person.

第1領域R1には第1動作パターン、第3動作パターン、第4動作パターン、第5動作パターン、及び第6動作パターンが制限動作パターンとして割り当てられている。第1動作パターンはアーム引きと呼ばれる動作パターンであり、アーム6を倒伏させる動作パターンである。第1動作パターンは、先端位置401が後方に移動して第1領域R1内の人物と干渉する可能性があるため、第1領域R1に割り当てられている。 A first motion pattern, a third motion pattern, a fourth motion pattern, a fifth motion pattern, and a sixth motion pattern are assigned to the first region R1 as restricted motion patterns. The first operation pattern is an operation pattern called arm pull, and is an operation pattern for laying down the arm 6 . The first motion pattern is assigned to the first region R1 because the tip position 401 may move backward and interfere with the person in the first region R1.

第3動作パターンは、バケット掘削と呼ばれる動作パターンであり、バケット7により地面を掘削させる動作パターンである。第3動作パターンは、第1領域R1内において前後に先端位置401が移動し、作業装置4が第1領域R1内の人物と干渉する可能性があるため、第1領域R1に割り当てられている。 The third operation pattern is an operation pattern called bucket excavation, and is an operation pattern for excavating the ground with the bucket 7 . The third motion pattern is assigned to the first region R1 because the tip position 401 moves back and forth within the first region R1 and the work device 4 may interfere with the person within the first region R1. .

第4動作パターンは、ブーム下げと呼ばれる動作パターンであり、ブーム5を上部旋回体3に対して倒伏させる動作パターンである。第4動作パターンは、先端位置401が第1領域R1の内側に向かい、作業装置4が第1領域R1内の人物と干渉する可能性があるため、第1領域R1に割り当てられている。 The fourth operation pattern is an operation pattern called boom lowering, and is an operation pattern in which the boom 5 is lowered with respect to the upper rotating body 3 . The fourth motion pattern is assigned to the first region R1 because the tip position 401 faces the inside of the first region R1 and the work device 4 may interfere with the person in the first region R1.

第5動作パターンは、上部旋回体3を左方に旋回させる動作パターンである。第5動作パターンは、第1領域R1内の人物が作業装置4の左側面と干渉する可能性があるため、第1領域R1に割り当てられている。 The fifth operation pattern is an operation pattern for turning the upper swing body 3 to the left. The fifth motion pattern is assigned to the first region R1 because there is a possibility that a person in the first region R1 will interfere with the left side surface of the work device 4. FIG.

第6動作パターンは、上部旋回体3を右方に旋回させる動作パターンである。第6動作パターンは、第1領域R1内の人物が作業装置4の右側面と干渉する可能性があるため、第1領域に割り当てられている。 The sixth operation pattern is an operation pattern for turning the upper swing body 3 to the right. The sixth motion pattern is assigned to the first region because there is a possibility that a person in the first region R1 will interfere with the right side surface of the working device 4. FIG.

これに対して、第2動作パターンと、左旋回時にアーム押しを行う動作パターン(以下、「第5動作パターン+第2動作パターン」と記述する。)と、右旋回時にアーム押しを行う動作パターン(以下、「第6動作パターン+第2動作パターン」と記述する。)とは、それぞれ、作業装置4の先端位置401が、第1領域R1に対して、前方、左斜め前方、及び右斜め前方に向かい、第1領域R1内の人物と干渉する可能性が低い。そのため、これらの動作パターンは、それぞれ、第1領域R1において許可動作パターンとして割り当てられている。 On the other hand, a second operation pattern, an operation pattern of pushing the arm when turning left (hereinafter described as "fifth operation pattern + second operation pattern"), and an operation of pushing the arm when turning right. The patterns (hereinafter referred to as "sixth operation pattern + second operation pattern") are defined as follows: the tip position 401 of the working device 4 is positioned forward, obliquely forward left, and rightward with respect to the first region R1. It is less likely to interfere with a person in the first region R1 as it faces diagonally forward. Therefore, these motion patterns are assigned as permitted motion patterns in the first region R1.

第2領域R2には、第2動作パターンが制限動作パターンとして割り当てられている。第2動作パターンは、アーム押しと呼ばれる動作パターンであり、アーム6を起伏させる動作パターンである。第2動作パターンは、先端位置401が前方に移動して第2領域R2に進入して第2領域R2内の人物と干渉する可能性があるため、第2領域R2に割り当てられている。一方、第2動作パターン以外の第1、第3~第6動作パターンはいずれも、先端位置401が第2領域R2に進入してこない。そのため、第1、第3~第6動作パターンは第2領域R2において許可動作パターンとして割り当てられている。 A second motion pattern is assigned to the second region R2 as a restricted motion pattern. The second operation pattern is an operation pattern called arm push, and is an operation pattern for raising and lowering the arm 6 . The second motion pattern is assigned to the second region R2 because the tip position 401 may move forward to enter the second region R2 and interfere with the person in the second region R2. On the other hand, the tip position 401 does not enter the second region R2 in any of the first, third to sixth operation patterns other than the second operation pattern. Therefore, the first, third to sixth operation patterns are assigned as permitted operation patterns in the second region R2.

第3領域R3には、第5動作パターンが制限動作パターンとして割り当てられている。第3領域R3は作業装置4の左側に位置するため、左旋回が行われると、第3領域R3内の人物が作業装置4の左側面と干渉する可能性がある。そこで、第5動作パターンは第3領域R3において制限動作パターンとして割り当てられている。一方、第5動作パターン以外の第1~第4、第6動作パターンはいずれも、先端位置401が第3領域R3に進入してこない。そのため、第1~第4、第6動作パターンは、第3領域R3において許可動作パターンとして割り当てられている。 A fifth motion pattern is assigned to the third region R3 as a restricted motion pattern. Since the third region R3 is located on the left side of the work device 4, there is a possibility that a person in the third region R3 will interfere with the left side of the work device 4 when the vehicle is turned to the left. Therefore, the fifth motion pattern is assigned as the restricted motion pattern in the third region R3. On the other hand, the tip position 401 does not enter the third region R3 in any of the first to fourth and sixth operation patterns other than the fifth operation pattern. Therefore, the first to fourth and sixth operation patterns are assigned as permitted operation patterns in the third region R3.

第4領域R4には、「第5動作パターン+第2動作パターン」が制限動作パターンとして割り当てられている。「第5動作パターン+第2動作パターン」は、上部旋回体3を左旋回させながらアーム押しを行う動作パターンである。左旋回時にアーム押しが行われると、先端位置401が左斜め前方に移動するため、作業装置4が第4領域R4内の人物と干渉する可能性がある。そこで、「第5動作パターン+第2動作パターン」は第4領域R4において制限動作パターンとして割り当てられている。一方、「第5動作パターン+第2動作パターン」以外の動作パターンはいずれも、先端位置401が第4領域R4に進入してこない。そのため、「第5動作パターン+第2動作パターン」以外の動作パターンは、第4領域において許可動作パターンとして割り当てられている。 "Fifth motion pattern+second motion pattern" is assigned to the fourth region R4 as a restricted motion pattern. “Fifth operation pattern+second operation pattern” is an operation pattern in which the upper rotating body 3 is rotated to the left while the arm is pushed. If the arm is pushed during left turning, the tip position 401 moves obliquely forward to the left, so there is a possibility that the work device 4 will interfere with a person in the fourth region R4. Therefore, "fifth motion pattern+second motion pattern" is assigned as a restricted motion pattern in the fourth region R4. On the other hand, the tip position 401 does not enter the fourth region R4 in any of the motion patterns other than the "fifth motion pattern+second motion pattern". Therefore, motion patterns other than "fifth motion pattern+second motion pattern" are assigned as permitted motion patterns in the fourth area.

第5領域R5には、第6動作パターンが制限動作パターンとして割り当てられている。第5領域R5は作業装置4の右方に位置するため、右旋回が行われると、第5領域R5内の人物が作業装置の右側面と干渉する可能性がある。そこで、第6動作パターンは第5領域R5において制限動作パターンとして割り当てられている。一方、第6動作パターン以外の動作パターンはいずれも、先端位置401が第5領域R5に進入してこない。そのため、第6動作パターン以外の動作パターンは、第5領域R5において許可動作パターンとして割り当てられている。 The sixth motion pattern is assigned as the restricted motion pattern to the fifth region R5. Since the fifth region R5 is located on the right side of the work device 4, there is a possibility that a person in the fifth region R5 will interfere with the right side of the work device when the work device 4 turns to the right. Therefore, the sixth motion pattern is assigned as the restricted motion pattern in the fifth region R5. On the other hand, in any of the motion patterns other than the sixth motion pattern, the tip position 401 does not enter the fifth region R5. Therefore, motion patterns other than the sixth motion pattern are assigned as permitted motion patterns in the fifth region R5.

第6領域R6には、「第6動作パターン+第2動作パターン」が制限動作パターンとして割り当てられている。「第6動作パターン+第2動作パターン」は、上部旋回体3を右旋回させながらアーム押しを行う動作パターンである。右旋回時にアーム押しが行われると、先端位置401が右斜め前方に移動して、作業装置4が第6領域R6内の人物と干渉する可能性がある。そこで、「第6動作パターン+第2動作パターン」は、第6領域R6において制限動作パターンとして割り当てられている。一方、「第6動作パターン+第2動作パターン」以外の動作パターンはいずれも、作業装置4が第6領域R6に進入してこない。そのため、「第6動作パターン+第2動作パターン」以外の動作パターンは、第6領域R6において許可動作パターンとして割り当てられている。 "Sixth motion pattern+second motion pattern" is assigned to the sixth region R6 as a restricted motion pattern. The “sixth operation pattern+second operation pattern” is an operation pattern in which the upper rotating body 3 is rotated to the right and the arm is pushed. If the arm is pushed during right turning, the tip position 401 may move obliquely forward to the right, and the work device 4 may interfere with a person in the sixth region R6. Therefore, "sixth motion pattern+second motion pattern" is assigned as a restricted motion pattern in the sixth region R6. On the other hand, the work device 4 does not enter the sixth area R6 in any of the operation patterns other than the "sixth operation pattern+second operation pattern". Therefore, motion patterns other than "sixth motion pattern+second motion pattern" are assigned as permitted motion patterns in the sixth region R6.

操作部18は、図6で説明した旋回操作レバー181、ブーム操作レバー182、アーム操作レバー183、及びバケット操作レバー184で構成されている。 The operation unit 18 is composed of the swing operation lever 181, the boom operation lever 182, the arm operation lever 183, and the bucket operation lever 184 described in FIG.

動作制限部164は、アーム6を倒伏させる第1動作パターンを制限する場合、下アーム操作弁176に制限信号を出力する。また、動作制限部164は、アームを起伏させる第2動作パターンを制限する場合、上アーム操作弁175に制限信号を出力する。 The motion limiting section 164 outputs a limiting signal to the lower arm operation valve 176 when limiting the first motion pattern for laying down the arm 6 . In addition, the motion limiting section 164 outputs a limiting signal to the upper arm control valve 175 when limiting the second motion pattern for raising and lowering the arm.

また、動作制限部164は、バケット7に掘削させる第3動作パターンを制限する場合、上ブーム操作弁173、下ブーム操作弁174、上アーム操作弁175、下アーム操作弁176、上バケット操作弁177、及び下バケット操作弁178に制限信号を出力する。 Further, when restricting the third operation pattern for excavating the bucket 7, the operation restricting unit 164 operates the upper boom operation valve 173, the lower boom operation valve 174, the upper arm operation valve 175, the lower arm operation valve 176, the upper bucket operation valve 177 and lower bucket control valve 178.

また、動作制限部164は、ブーム5を倒伏させる第4動作パターンを制限する場合、下ブーム操作弁174に制限信号を出力する。また、動作制限部164は、上部旋回体3を左旋回させる第5動作パターンを制限する場合、左旋回操作弁172に制限信号を出力する。 In addition, the motion limiting section 164 outputs a limiting signal to the lower boom operation valve 174 when limiting the fourth motion pattern for laying down the boom 5 . In addition, when restricting the fifth operation pattern for turning the upper rotating body 3 to the left, the operation restricting section 164 outputs a restriction signal to the left-turning operation valve 172 .

また、動作制限部164は、上部旋回体3を右旋回させる第6動作パターンを制限する場合、右旋回操作弁171に制限信号を出力する。また、動作制限部164は、左旋回させながらアーム6を起伏させる「第5動作パターン+第2動作パターン」を制限する場合、左旋回操作弁172及び上アーム操作弁175に制限信号を出力する。 In addition, the motion limiting section 164 outputs a limiting signal to the right turning operation valve 171 when limiting the sixth motion pattern for turning the upper swing body 3 to the right. In addition, when limiting the “fifth operation pattern + second operation pattern” in which the arm 6 is raised and lowered while turning left, the operation restricting unit 164 outputs a restriction signal to the left turn operation valve 172 and the upper arm operation valve 175 . .

また、動作制限部164は、右旋回させながらアーム6を起伏させる「第6動作パターン+第2動作パターン」を制限する場合、右旋回操作弁171及び上アーム操作弁175に制限信号を出力する。 In addition, when restricting the “sixth motion pattern + second motion pattern” for raising and lowering the arm 6 while rotating it to the right, the motion restricting unit 164 outputs a restriction signal to the right turn operation valve 171 and the upper arm operation valve 175 . Output.

図7は、実施の形態に係る干渉防止装置の処理を示すフローチャートである。S1では、入力部14は、ATT最大半径H及びATT最大幅Bを取得し、メモリに記憶する。なお、ATT最大半径H及びATT最大幅Bが既にメモリに記憶されている場合、領域設定部162は、メモリからATT最大半径H及びATT最大幅Bを読み出せばよい。 FIG. 7 is a flow chart showing processing of the interference prevention device according to the embodiment. In S1, the input unit 14 acquires the ATT maximum radius H and ATT maximum width B, and stores them in the memory. Note that if the ATT maximum radius H and ATT maximum width B are already stored in the memory, the area setting unit 162 may read the ATT maximum radius H and ATT maximum width B from the memory.

S2では、位置算出部161は、ブーム角度センサ12が検出したブーム角度と、アーム角度センサ13が検出したアーム角度とを取得する。S3では、S2で取得したブーム角度及びアーム角度を用いて、作業装置4の先端位置401を算出する。 In S<b>2 , the position calculator 161 acquires the boom angle detected by the boom angle sensor 12 and the arm angle detected by the arm angle sensor 13 . In S3, the tip position 401 of the working device 4 is calculated using the boom angle and the arm angle acquired in S2.

S4では、領域設定部162は、S3で算出された先端位置401を基準に座標空間400に対して第1領域R1~第6領域R6を設定する。これにより、建設機械1の周囲に図3に示すような6つの領域Rが設定されることになる。 In S4, the region setting unit 162 sets the first region R1 to sixth region R6 in the coordinate space 400 based on the tip position 401 calculated in S3. As a result, six areas R are set around the construction machine 1 as shown in FIG.

S5では、物体センサ11は建設機械1の周囲のセンシングデータ取得する。S6では、サブコントローラ15は、物体センサ11が取得したセンシングデータから人物を検出する。S6において人物が検出されなかった場合(S6でNO)、処理はS2に戻る。一方、S6において人物が検出された場合(S6でYES)、サブコントローラ15は、検出した人物の位置を算出し、算出した位置を含むセンシングデータをメインコントローラ16に出力する(S7)。ここで、複数の人物が検出された場合、センシングデータには複数の人物のそれぞれの位置が含まれる。 At S<b>5 , the object sensor 11 acquires sensing data around the construction machine 1 . In S<b>6 , the sub-controller 15 detects a person from sensing data acquired by the object sensor 11 . If no person is detected in S6 (NO in S6), the process returns to S2. On the other hand, if a person is detected in S6 (YES in S6), the sub-controller 15 calculates the position of the detected person and outputs sensing data including the calculated position to the main controller 16 (S7). Here, when multiple persons are detected, the sensing data includes the respective positions of the multiple persons.

S8では、人物判定部163は、サブコントローラ15から出力されたセンシングデータに含まれる人物の位置を用いて、第1領域R1に人物がいるか否かを判定する。第1領域R1に人物がいない場合(S8でNO)、動作制限部164は、第1、第3、第4、第5、及び第6動作パターンの制限を解除する(S9)。一方、第1領域R1に人物がいる場合(S8でYES)、動作制限部164は、第1、第3、第4、第5、及び第6動作パターンを制限する(S10)。 In S<b>8 , the person determination unit 163 uses the person's position included in the sensing data output from the sub-controller 15 to determine whether or not there is a person in the first region R<b>1 . When there is no person in the first region R1 (NO in S8), the motion restriction unit 164 cancels the restriction on the first, third, fourth, fifth, and sixth motion patterns (S9). On the other hand, if there is a person in the first region R1 (YES in S8), the motion restriction unit 164 restricts the first, third, fourth, fifth, and sixth motion patterns (S10).

S11では、人物判定部163は、サブコントローラ15から出力されたセンシングデータに含まれる人物の位置を用いて、第2領域R2に人物がいるか否かを判定する。第2領域R2に人物がいない場合(S11でNO)、動作制限部164は、第2動作パターンの制限を解除する(S12)。一方、第2領域R2に人物がいる場合(S11でYES)、動作制限部164は、第2動作パターンを制限する(S13)。 In S<b>11 , the person determination unit 163 uses the position of the person included in the sensing data output from the sub-controller 15 to determine whether or not there is a person in the second region R<b>2 . When there is no person in the second region R2 (NO in S11), the motion restriction unit 164 cancels the restriction on the second motion pattern (S12). On the other hand, if there is a person in the second region R2 (YES in S11), the motion limiting unit 164 limits the second motion pattern (S13).

S14では、人物判定部163は、サブコントローラ15から出力されたセンシングデータに含まれる人物の位置を用いて、第3領域R3に人物がいるか否かを判定する。第3領域R3に人物がいない場合(S14でNO)、動作制限部164は、第5動作パターンの制限を解除する(S15)。一方、第2領域R2に人物がいる場合(S14でYES)、動作制限部164は、第5動作パターンを制限する(S16)。 In S<b>14 , the person determination unit 163 uses the person's position included in the sensing data output from the sub-controller 15 to determine whether or not there is a person in the third region R<b>3 . When there is no person in the third region R3 (NO in S14), the motion restriction unit 164 cancels the restriction on the fifth motion pattern (S15). On the other hand, if there is a person in the second region R2 (YES in S14), the motion limiting unit 164 limits the fifth motion pattern (S16).

S17では、人物判定部163は、サブコントローラ15から出力されたセンシングデータに含まれる人物の位置を用いて、第4領域R4に人物がいるか否かを判定する。第4領域R4に人物がいない場合(S17でNO)、動作制限部164は、「第5動作パターン+第2動作パターン」の制限を解除する(S18)。一方、第4領域R4に人物がいる場合(S17でYES)、動作制限部164は、「第5動作パターン+第2動作パターン」を制限する(S19)。 In S<b>17 , the person determination unit 163 uses the person's position included in the sensing data output from the sub-controller 15 to determine whether or not there is a person in the fourth region R<b>4 . If there is no person in the fourth region R4 (NO in S17), the motion restriction unit 164 cancels the restriction of "fifth motion pattern+second motion pattern" (S18). On the other hand, if there is a person in the fourth region R4 (YES in S17), the motion restriction unit 164 restricts the "fifth motion pattern+second motion pattern" (S19).

S20では、人物判定部163は、サブコントローラ15から出力されたセンシングデータに含まれる人物の位置を用いて、第5領域R5に人物がいるか否かを判定する。第5領域R5に人物がいない場合(S20でNO)、動作制限部164は、第6動作パターンの制限を解除する(S21)。一方、第5領域R5に人物がいる場合(S20でYES)、動作制限部164は、第6動作パターンを制限する(S22)。 In S20, the person determination unit 163 uses the position of the person included in the sensing data output from the sub-controller 15 to determine whether or not there is a person in the fifth region R5. When there is no person in the fifth region R5 (NO in S20), the motion restriction unit 164 cancels the restriction on the sixth motion pattern (S21). On the other hand, if there is a person in the fifth region R5 (YES in S20), the motion restriction unit 164 limits the sixth motion pattern (S22).

S23では、人物判定部163は、サブコントローラ15から出力されたセンシングデータに含まれる人物の位置を用いて、第6領域R6に人物がいるか否かを判定する。第6領域R6に人物がいない場合(S23でNO)、動作制限部164は、「第6動作パターン+第2動作パターン」の制限を解除する(S24)。一方、第6領域R6に人物がいる場合(S23でYES)、動作制限部164は、「第6動作パターン+第2動作パターン」を制限する(S25)。S24又はS25の処理が終了すると、処理はS2に戻り、S2~S25の処理が繰り返し実行される。 In S23, the person determination unit 163 uses the position of the person included in the sensing data output from the sub-controller 15 to determine whether or not there is a person in the sixth region R6. When there is no person in the sixth region R6 (NO in S23), the motion restriction unit 164 cancels the restriction of "sixth motion pattern + second motion pattern" (S24). On the other hand, if there is a person in the sixth region R6 (YES in S23), the motion restriction unit 164 restricts "sixth motion pattern+second motion pattern" (S25). When the process of S24 or S25 ends, the process returns to S2, and the processes of S2 to S25 are repeatedly executed.

このように、本実施の形態によれば、第1領域R1~第6領域R6は作業装置4の先端位置401を基準に設定されているため、各領域Rにおいて作業装置4が人物と干渉する可能性の高い制限動作パターンと、作業装置が人物と干渉する可能性の低い許可動作パターンとを明確に切り分けることができる。そして、ある領域に人物がいる場合、その人物に対して干渉する可能性の高い動作パターンを制限し、許可動作パターンを継続して動作させることができる。その結果、建設機械の作業効率の低下を抑制しつつ人物と建設機械との干渉を防止することができる。 Thus, according to the present embodiment, since the first region R1 to sixth region R6 are set with reference to the tip position 401 of the working device 4, the working device 4 interferes with the person in each region R. It is possible to clearly separate a restricted operation pattern with a high possibility and a permitted operation pattern with a low possibility that the working device will interfere with the person. Then, when a person is present in a certain area, it is possible to restrict motion patterns that are highly likely to interfere with the person, and to allow the permitted motion pattern to continue to operate. As a result, it is possible to prevent interference between the person and the construction machine while suppressing a decrease in the work efficiency of the construction machine.

なお、本発明は以下の変形例が採用できる。 The present invention can employ the following modified examples.

(1)上記実施の形態では図3に示すように6つの領域Rが設定されているが、領域Rの設定個数は6つに限定されない。領域Rの設定個数は、例えば、2個以上5個以下又は7個以上であってもよい。 (1) Although six regions R are set as shown in FIG. 3 in the above embodiment, the number of regions R to be set is not limited to six. The set number of regions R may be, for example, 2 or more and 5 or less, or 7 or more.

(2)上記実施の形態では、図5に示すように制限される動作パターンの個数は6つであったが、本発明はこれに限定されず、2個以上5個以下又は7個以上であってもよい。 (2) In the above embodiment, the number of operation patterns is limited to six as shown in FIG. There may be.

(3)上記実施の形態では、先端アタッチメントとしてバケットが装着されている場合を主に説明したが、先端アタッチメントとして回転グラップルが装着されている場合、アーム6に対する回転角度及び回転グラップルが備える2本の爪の挟み角に応じて、ATT最大幅Bが変化する。この場合、回転グラップルの回転角度及び挟み角のそれぞれを検出する角度センサを作業装置4に設置する。そして、領域設定部162は、これらの角度センサが検出した回転角度及び挟み角に応じたATT最大幅Bを算出し、算出したATT最大幅Bの横幅を持つ第1領域R1及び第2領域R2を設定すればよい。 (3) In the above embodiment, the case where the bucket is attached as the tip attachment has been mainly described. The ATT maximum width B changes according to the pinching angle of the claws. In this case, the working device 4 is provided with an angle sensor for detecting the rotation angle and the pinching angle of the rotating grapple. Then, the area setting unit 162 calculates the maximum ATT width B corresponding to the rotation angle and the pinch angle detected by these angle sensors, and the first area R1 and the second area R2 having the calculated maximum ATT width B are calculated. should be set.

(4)上記実施の形態では、物体センサ11は、キャビン内又は上部旋回体3の前面に設けられているとして説明したが、作業装置4に設けられてもよい。 (4) In the above embodiment, the object sensor 11 is provided in the cabin or on the front surface of the upper rotating body 3 , but may be provided in the work device 4 .

(5)図3の例では、内周430として、先端位置401のY成分の値を半径とする円弧が採用されたこれは一例であり、先端位置401を通るX軸と平行な直線が採用されてもよい。また、外周440として、X軸から距離RMだけ離間したX軸と平行な直線が採用されてもよい。この場合、第3領域R3及び第4領域R4の横幅と第5領域R5及び第6領域R6の横幅とを同じ長さに設定し、第1領域R1~第6領域R6のそれぞれを四角形の領域で構成してもよい。 (5) In the example of FIG. 3, an arc having a radius equal to the value of the Y component of the tip position 401 is adopted as the inner circumference 430. This is an example, and a straight line parallel to the X axis passing through the tip position 401 is adopted. may be Alternatively, a straight line parallel to the X-axis separated from the X-axis by the distance RM may be employed as the outer circumference 440 . In this case, the horizontal width of the third region R3 and the fourth region R4 and the horizontal width of the fifth region R5 and the sixth region R6 are set to the same length, and each of the first region R1 to the sixth region R6 is a rectangular region. may be configured with

図8は、本発明の変形例に係る第1領域R1、第3領域R3、及び第5領域R5をキャビン内から見たときの図である。なお、図8では、説明の便宜上、第2領域R2、第4領域R4、及び第6領域R6の図示は省略している。 FIG. 8 is a diagram of the first region R1, the third region R3, and the fifth region R5 according to the modification of the present invention as seen from inside the cabin. In addition, in FIG. 8, illustration of the second region R2, the fourth region R4, and the sixth region R6 is omitted for convenience of explanation.

図8に示すように、第1領域R1は、作業装置4の真下に設定されているが、前方側の一辺が円弧状ではなく左右方向に平行である点が図3と相違している。 As shown in FIG. 8, the first region R1 is set directly below the working device 4, but differs from FIG. 3 in that one side on the front side is not arcuate but parallel to the left-right direction.

第3領域R3は、第1領域R1の左隣に設定された四角形状の領域であり、前方の一辺が、第1領域R1の前方の一辺と連なっている。 The third region R3 is a quadrangular region set to the left of the first region R1, and the front side thereof is continuous with the front side of the first region R1.

第5領域R5は、第1領域R1の右隣に設定されてた四角形状の領域であり、前方の一辺が、第1領域R1の前方の一辺と連なっている。 The fifth region R5 is a rectangular region that is set to the right of the first region R1, and has a front side that is continuous with a front side of the first region R1.

第1領域R1に人物601が位置している場合、アーム引き(第1動作パターン)と、バケット掘削(第3動作パターン)と、ブーム下げ(第4動作パターン)と、左旋回(第5動作パターン)と、右旋回(第6動作パターン)とが制限される。第3領域R3に人物602が位置している場合、動作パターンテーブルT5にしたがって、左旋回(第5動作パターン)が制限される。第5領域R5に人物603が位置している場合、動作パターンテーブルT5にしたがって、右旋回(第6動作パターン)が制限される。 When the person 601 is positioned in the first region R1, the arm is pulled (first operation pattern), the bucket is excavated (third operation pattern), the boom is lowered (fourth operation pattern), and the left turn (fifth operation) is performed. pattern) and turning to the right (sixth operation pattern) are restricted. When the person 602 is positioned in the third region R3, the left turn (fifth motion pattern) is restricted according to the motion pattern table T5. When the person 603 is positioned in the fifth region R5, the right turn (sixth motion pattern) is restricted according to the motion pattern table T5.

以上により、作業装置4が人物601、602、603と干渉する可能性の高い動作パターンのみを制限し、残りの動作パターンは継続して通常動作させることができる。また、作業装置4が人物601、602、603と干渉したとしても、作業装置4は通常時の速度に比べて大幅に低い速度で動作するため、人物601、602、603の安全を確保しつつ可能な限り作業を継続させることができる。 As described above, it is possible to limit only the operation patterns in which the work device 4 has a high possibility of interfering with the persons 601, 602, and 603, and to continue the normal operation in the remaining operation patterns. In addition, even if the working device 4 interferes with the persons 601, 602, 603, the working device 4 operates at a significantly lower speed than the normal speed. Work can continue as long as possible.

図9は、本発明の変形例に係る第4領域R4、第2領域R2、及び第6領域R6をキャビン内から見たときの図である。なお、図9では、説明の便宜上、第1領域R1、第3領域R3、及び第5領域R5の図示は省略している。 FIG. 9 is a diagram of the fourth region R4, the second region R2, and the sixth region R6 according to the modification of the present invention as seen from inside the cabin. In addition, in FIG. 9, illustration of 1st area|region R1, 3rd area|region R3, and 5th area|region R5 is abbreviate|omitted for convenience of explanation.

図9に示すように、第2領域R2は作業装置4の前方に設定されているが、前方側の一辺が円弧状でなく左右方向と平行な直線状である点が図3と相違している。 As shown in FIG. 9, the second region R2 is set in front of the working device 4, but differs from FIG. there is

第4領域R4は、第2領域R2の左隣に設定された四角形状の領域であり、前方の一辺が、第2領域R2の前方の一辺と連なっている。 The fourth region R4 is a quadrangular region set to the left of the second region R2, and the front side thereof is continuous with the front side of the second region R2.

第6領域R6は、第2領域R2の右隣に設定されてた四角形状の領域であり、前方の一辺が、第2領域R2の前方の一辺と連なっている。 The sixth region R6 is a quadrangular region set to the right of the second region R2, and one front side thereof is continuous with one front side of the second region R2.

第2領域R2に人物701が位置している場合、アーム押し(第2動作パターン)が制限される。第4領域R4に人物702が位置する場合、左旋回しながらアーム押しを行う動作パターン(「第5動作パターン+第2動作パターン」)が制限される。第6領域R6に人物703が位置している場合、右旋回しながらアーム押しを行う動作パターン(「第6動作パターン+第2動作パターン」)が制限される。以上により、作業装置4が人物701、702、703と干渉する可能性の高い動作パターンのみを制限し、残りの動作パターンは継続して通常動作させることができる。また、作業装置4が人物701、702、703と干渉したとしても、作業装置4は通常時の速度に比べて大幅に低い速度で動作するため、人物701、702、703の安全を確保しつつ可能な限り作業を継続させることができる。 When the person 701 is positioned in the second region R2, arm pressing (second operation pattern) is restricted. When the person 702 is positioned in the fourth region R4, the motion pattern (“fifth motion pattern+second motion pattern”) of pushing the arm while turning left is restricted. When the person 703 is positioned in the sixth region R6, the motion pattern (“sixth motion pattern+second motion pattern”) of pushing the arm while turning to the right is restricted. As described above, it is possible to limit only the operation patterns in which the work device 4 has a high possibility of interfering with the persons 701, 702, and 703, and to continue the normal operation in the remaining operation patterns. Moreover, even if the working device 4 interferes with the persons 701, 702, and 703, the working device 4 operates at a significantly lower speed than the normal speed. Work can continue as long as possible.

(6)なお、上記実施の形態では、制限とは、減速を意味したが、本発明はこれに限定されず、停止を意味してもよい。この場合、動作制限部164は、動作を停止させるための制限信号を右旋回操作弁171~下バケット操作弁178に適宜出力し、旋回モータM1、及びブームシリンダC1~バケットシリンダC3を適宜停止させればよい。 (6) In the above embodiment, "restriction" means deceleration, but the present invention is not limited to this, and may mean "stop". In this case, the motion limiter 164 appropriately outputs a limit signal for stopping the operation to the right swing operation valve 171 to the lower bucket operation valve 178, and stops the swing motor M1 and the boom cylinder C1 to bucket cylinder C3. Let it be.

(7)上記実施の形態では、旋回操作レバー181が操作量に応じたパイロット圧を出力する構成が採用されていたが、本発明はこれに限定されない。例えば、メインコントローラ16は、旋回操作レバー181からの操作量に応じたパイロット圧を右旋回操作弁171及び左旋回操作弁172に生成させる制御信号を右旋回操作弁171及び左旋回操作弁172に出力する構成が採用されてもよい。この場合、動作制限部164は、動作制限を行う場合、操作量を低下させた制御信号を右旋回操作弁171及び左旋回操作弁172に出力すればよい。このことは、ブーム5、アーム6、及びバケット7についても同じである。 (7) In the above-described embodiment, the turning operation lever 181 employs a configuration in which the pilot pressure is output according to the amount of operation, but the present invention is not limited to this. For example, the main controller 16 outputs a control signal to the right turn operation valve 171 and the left turn operation valve 172 to cause the right turn operation valve 171 and the left turn operation valve 172 to generate a pilot pressure corresponding to the amount of operation from the turn operation lever 181 . 172 may be employed. In this case, the operation restriction unit 164 may output a control signal with a reduced operation amount to the right turn operation valve 171 and the left turn operation valve 172 when restricting the operation. The same is true for boom 5 , arm 6 and bucket 7 .

(8)図5の例では、第1領域R1に対し、制限動作パターンとして、第1、第3、第4、第5、第6動作パターンが割り当てられているがこれは一例である。第1領域R1において、第5動作パターン及び第6動作パターンは制限動作パターンから省かれてもよい。また、頻繁に掘削動作が行われる場合、第1領域R1においては、第3動作パターンは制限動作パターンから省かれてもよい。 (8) In the example of FIG. 5, the first, third, fourth, fifth, and sixth operation patterns are assigned to the first region R1 as restricted operation patterns, but this is just an example. In the first region R1, the fifth motion pattern and the sixth motion pattern may be omitted from the restricted motion patterns. Further, when the excavation motion is frequently performed, the third motion pattern may be omitted from the restricted motion patterns in the first region R1.

(9)上記実施の形態では、第1領域R1~第6領域R6が設定されたが、本発明はこれに限定されず、外側領域及び内側領域の2つの領域が設定されてもよい。この変形例において、内側領域に人物がいる場合、少なくとも第5動作パターン(左旋回)及び第6動作パターン(右旋回)の少なくとも一つが制限動作パターンとして設定されればよい。また、この変形例において、外側領域に人物がいる場合、少なくとも第2動作パターンが制限動作パターンとして設定されればよい。 (9) Although the first to sixth regions R1 to R6 are set in the above embodiment, the present invention is not limited to this, and two regions, an outer region and an inner region, may be set. In this modified example, when there is a person in the inner region, at least one of the fifth motion pattern (left turn) and the sixth motion pattern (right turn) should be set as the restricted motion pattern. Also, in this modification, if there is a person in the outer area, at least the second motion pattern should be set as the restricted motion pattern.

1 :建設機械
2 :下部走行体
3 :上部旋回体
4 :作業装置
5 :ブーム
6 :アーム
7 :バケット
11 :物体センサ
12 :ブーム角度センサ
13 :アーム角度センサ
14 :入力部
15 :サブコントローラ
16 :メインコントローラ
17 :油圧回路
18 :操作部
161 :位置算出部
162 :領域設定部
163 :人物判定部
164 :動作制限部
165 :動作パターン記憶部
401 :先端位置
R1 :第1領域
R2 :第2領域
R3 :第3領域
R4 :第4領域
R5 :第5領域
R6 :第6領域
T5 :動作パターンテーブル
Reference Signs List 1: construction machine 2: lower running body 3: upper rotating body 4: working device 5: boom 6: arm 7: bucket 11: object sensor 12: boom angle sensor 13: arm angle sensor 14: input section 15: sub-controller 16 : Main controller 17 : Hydraulic circuit 18 : Operation unit 161 : Position calculation unit 162 : Area setting unit 163 : Person determination unit 164 : Operation restriction unit 165 : Operation pattern storage unit 401 : Tip position R1 : First area R2 : Second Region R3: Third region R4: Fourth region R5: Fifth region R6: Sixth region T5: Operation pattern table

Claims (13)

下部走行体と、前記下部走行体に対して旋回可能に構成された上部旋回体と、前記上部旋回体に対して姿勢が変更可能に構成された作業装置とを備える建設機械における干渉防止装置であって、
オペレータの操作を受け付ける操作部と、
前記操作部が受け付けた操作に応じて前記作業装置及び前記上部旋回体の少なくとも一方を動作させる動作実行部と、
前記作業装置の姿勢を検出する第1センサと、
前記第1センサにより検出された姿勢に基づいて前記作業装置の先端位置を算出する位置算出部と、
前記位置算出部により算出された前記先端位置を基準に前記建設機械の周囲に複数の領域を設定する領域設定部と、
前記建設機械の周囲に位置する物体を検出する第2センサと、
前記第2センサにより検出された物体に基づいて前記複数の領域のそれぞれに対して人物の有無を判定する人物判定部と、
前記人物判定部が前記複数の領域のうち少なくとも1つの領域において前記人物がいると判定した場合、前記人物が検出された領域において、前記作業装置が前記人物と干渉する可能性のある予め定められた前記建設機械の動作パターンである制限動作パターンを制限し、且つ、前記作業装置が前記人物と干渉する可能性の低い予め定められた前記建設機械の前記動作パターンである許可動作パターンを許可するように前記動作実行部を制御する動作制限部とを備える干渉防止装置。
An interference prevention device for a construction machine comprising a lower traveling body, an upper revolving body configured to be able to turn with respect to the lower traveling body, and a working device configured to be able to change its posture with respect to the upper revolving body. There is
an operation unit that receives an operator's operation;
an operation execution unit that operates at least one of the work device and the upper rotating body according to the operation received by the operation unit;
a first sensor that detects the attitude of the working device;
a position calculation unit that calculates a tip position of the working device based on the orientation detected by the first sensor;
an area setting unit that sets a plurality of areas around the construction machine based on the tip position calculated by the position calculation unit;
a second sensor that detects objects positioned around the construction machine;
a person determination unit that determines the presence or absence of a person in each of the plurality of areas based on the object detected by the second sensor;
When the person determination unit determines that the person is present in at least one of the plurality of areas, the working device may interfere with the person in the area where the person is detected. limiting a restricted operation pattern, which is an operation pattern of the construction machine, and permitting a permitted operation pattern, which is a predetermined operation pattern of the construction machine with a low possibility that the work device will interfere with the person. and an operation restricting unit that controls the operation executing unit as follows.
前記複数の領域のそれぞれに対して、前記制限動作パターンと前記許可動作パターンとが登録された動作パターン情報を記憶するメモリをさらに備え、
前記動作制限部は、前記動作パターン情報を参照して各領域に対する前記制限動作パターンと前記許可動作パターンとを決定する請求項1記載の干渉防止装置。
further comprising a memory for storing operation pattern information in which the restricted operation pattern and the permitted operation pattern are registered for each of the plurality of areas;
2. The interference prevention device according to claim 1, wherein the operation restriction unit refers to the operation pattern information to determine the restricted operation pattern and the permitted operation pattern for each area.
前記作業装置は、前記上部旋回体に対して上下方向に回動可能に取り付けられた第1部材と、前記第1部材に対して前記上部旋回体の前後方向に回動可能に取り付けられた第2部材と、前記第2部材に対して前記上部旋回体の前後方向に回動可能に取り付けられた第3部材とを含み、
前記制限動作パターンは、
前記第2部材が後方に回動する第1動作パターンと、
前記第2部材が前方に回動する第2動作パターンと、
前記第3部材が地面を掘削する第3動作パターンと、
前記第1部材が下方に回動する移動する第4動作パターンと、
前記上部旋回体が左旋回する第5動作パターンと、
前記上部旋回体が右旋回する第6動作パターンとの少なくとも一つを含む請求項1又は2記載の干渉防止装置。
The working device includes a first member attached to the upper revolving body so as to be rotatable in the vertical direction, and a second member attached to the upper revolving body to be rotatable in the front-rear direction with respect to the first member. and a third member rotatably attached to the second member in the longitudinal direction of the upper rotating body,
The restricted operation pattern is
a first operation pattern in which the second member rotates backward;
a second operation pattern in which the second member rotates forward;
a third movement pattern in which the third member excavates the ground;
a moving fourth movement pattern in which the first member rotates downward;
a fifth operation pattern in which the upper rotating body rotates to the left;
3. The interference prevention device according to claim 1 or 2, comprising at least one of a sixth operation pattern in which the upper rotating body rotates to the right.
前記複数の領域は、前記先端位置よりも内側の内側領域を含み、前記内側領域における前記制限動作パターンは、前記第5動作パターンと前記第6動作パターンとの少なくとも一つを含む請求項3に記載の干渉防止装置。 4. The method according to claim 3, wherein the plurality of regions include an inner region inside the tip position, and the limited motion pattern in the inner region includes at least one of the fifth motion pattern and the sixth motion pattern. An anti-interference device as described. 前記複数の領域は、前記先端位置よりも外側の外側領域を含み、前記外側領域における前記制限動作パターンは、少なくとも前記第2動作パターンを含む請求項3又は4に記載の干渉防止装置。 5. The interference prevention device according to claim 3, wherein the plurality of areas include an outer area outside the tip position, and the limited operation pattern in the outer area includes at least the second operation pattern. 前記領域設定部は、前記先端位置における前記作業装置の横幅を基準に前記複数の領域を設定する請求項1~5のいずれかに記載の干渉防止装置。 The interference prevention device according to any one of claims 1 to 5, wherein the region setting section sets the plurality of regions based on the width of the working device at the tip position. 前記内側領域において、前記先端位置を含む前記作業装置の幅に対して内側に設定された第1領域を含み、前記第1領域における前記制限動作パターンは前記第1動作パターン、前記第3動作パターン、及び前記第4動作パターンを含む請求項4に記載の干渉防止装置。 The inner area includes a first area set inside the width of the working device including the tip position, and the limited operation pattern in the first area is the first operation pattern and the third operation pattern. , and the fourth operation pattern. 前記外側領域において、前記先端位置を含む前記作業装置の幅に対して外側に設定された第2領域を含み、前記第2領域における前記制限動作パターンは前記第2動作パターンである請求項5に記載の干渉防止装置。 6. The outer region includes a second region set outside a width of the working device including the tip position, and the restricted operation pattern in the second region is the second operation pattern. An anti-interference device as described. 前記内側領域において、前記先端位置を含む前記作業装置の幅の左端よりも左側に設定された第3領域を含み、前記第3領域における前記制限動作パターンは前記第5動作パターンである請求項4又は7に記載の干渉防止装置。 5. The inner area includes a third area set to the left of the left end of the width of the working device including the tip position, and the limited operation pattern in the third area is the fifth operation pattern. Or the interference prevention device according to 7. 前記外側領域において、前記先端位置を含む前記作業装置の幅の左端よりも左側に設定された第4領域を含み、前記第4領域における前記制限動作パターンは前記第5動作パターンの動作時に前記第2動作パターンが動作される動作パターンである請求項5又は8に記載の干渉防止装置。 The outer region includes a fourth region set on the left side of the left end of the width of the working device including the tip position, and the restricted operation pattern in the fourth region is the fifth operation pattern during operation of the fifth operation pattern. 9. An interference prevention device according to claim 5 or 8, wherein two operation patterns are operated operation patterns. 前記内側領域において、前記先端位置を含む前記作業装置の幅の右端よりも右側に設定された第5領域を含み、前記第5領域における前記制限動作パターンは前記第6動作パターンである請求項4、7、9のいずれかに記載の干渉防止装置。 5. The inner area includes a fifth area set to the right of the right end of the width of the working device including the tip position, and the restricted operation pattern in the fifth area is the sixth operation pattern. , 7, 9. 前記外側領域において、前記先端位置を含む前記作業装置の幅の右端よりも右側に設定された第6領域を含み、前記第6領域における前記制限動作パターンは前記第6動作パターンの動作時に前記第2動作パターンが動作される動作パターンである請求項5、8、10のいずれかに記載の干渉防止装置。 The outer region includes a sixth region set to the right of the right end of the width of the working device including the tip position, and the restricted operation pattern in the sixth region is the sixth operation pattern when the sixth operation pattern is operated. 11. An interference prevention device according to any one of claims 5, 8 and 10, wherein two operation patterns are operated operation patterns. 前記動作制限部は、前記制限動作パターンの実行時における動作速度を減速すること又は前記制限動作パターンの実行時における動作を停止させることを含む制限により前記制限動作パターンを制限する請求項1~12のいずれかに記載の干渉防止装置。 12. The motion limiting unit limits the restricted motion pattern by a restriction including decelerating the motion speed when the restricted motion pattern is executed or stopping the motion when the restricted motion pattern is executed. An anti-interference device according to any one of
JP2019003743A 2019-01-11 2019-01-11 Anti-interference device Active JP7183805B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019003743A JP7183805B2 (en) 2019-01-11 2019-01-11 Anti-interference device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019003743A JP7183805B2 (en) 2019-01-11 2019-01-11 Anti-interference device

Publications (2)

Publication Number Publication Date
JP2020111970A JP2020111970A (en) 2020-07-27
JP7183805B2 true JP7183805B2 (en) 2022-12-06

Family

ID=71666805

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019003743A Active JP7183805B2 (en) 2019-01-11 2019-01-11 Anti-interference device

Country Status (1)

Country Link
JP (1) JP7183805B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2023005582A (en) 2021-06-29 2023-01-18 コベルコ建機株式会社 Intrusion detection system

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003105807A (en) 2001-09-27 2003-04-09 Komatsu Ltd Stop control method in intrusion-prohibitive region for service car and its controller
JP2014181509A (en) 2013-03-19 2014-09-29 Sumitomo Heavy Ind Ltd Periphery monitoring apparatus for working machine
JP2016176289A (en) 2015-03-20 2016-10-06 住友建機株式会社 Construction machine

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2700710B2 (en) * 1990-06-21 1998-01-21 新キャタピラー三菱株式会社 Warning device for construction machinery
JP2785081B2 (en) * 1991-07-22 1998-08-13 日立建機株式会社 Work machine alarm system
JP2955078B2 (en) * 1991-08-30 1999-10-04 株式会社小松製作所 Vehicle collision prevention device

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003105807A (en) 2001-09-27 2003-04-09 Komatsu Ltd Stop control method in intrusion-prohibitive region for service car and its controller
JP2014181509A (en) 2013-03-19 2014-09-29 Sumitomo Heavy Ind Ltd Periphery monitoring apparatus for working machine
JP2016176289A (en) 2015-03-20 2016-10-06 住友建機株式会社 Construction machine

Also Published As

Publication number Publication date
JP2020111970A (en) 2020-07-27

Similar Documents

Publication Publication Date Title
KR102118386B1 (en) Working machine
KR102024701B1 (en) Working machine
CN111051619B (en) Working machine
JP2021088929A (en) Shovel, system for shovel, and control method of shovel
CN111032969B (en) Working machine
KR102601073B1 (en) working machine
KR102459283B1 (en) working machine
EP3730699A1 (en) Work machine
KR20180103967A (en) Working machine
JP2016194237A (en) Work machine
CN113439141B (en) Working machine
KR20190034648A (en) Working machine
WO2020166241A1 (en) Monitoring device and construction machine
JP7183805B2 (en) Anti-interference device
CN112384663A (en) Excavator
KR102602948B1 (en) working machine
JP2005194825A (en) Work unit controller in construction machine
JP2812892B2 (en) Work machine interference prevention device for construction machinery
JP4602505B2 (en) Work posture transition device for bent boom type work vehicle
JP7036868B2 (en) Work machine control device and control method
WO2023223841A1 (en) Work machine safety device
JP6152178B1 (en) Work machine and work machine interference avoidance method
KR20240095459A (en) Working machines and control methods of working machines
JP2793953B2 (en) Hydraulic excavator front controller
JP2021098587A (en) Crane performance line display device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20211125

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220816

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220823

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221013

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: 20221025

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221107

R150 Certificate of patent or registration of utility model

Ref document number: 7183805

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150