JP2022160278A - Work system - Google Patents

Work system Download PDF

Info

Publication number
JP2022160278A
JP2022160278A JP2021064930A JP2021064930A JP2022160278A JP 2022160278 A JP2022160278 A JP 2022160278A JP 2021064930 A JP2021064930 A JP 2021064930A JP 2021064930 A JP2021064930 A JP 2021064930A JP 2022160278 A JP2022160278 A JP 2022160278A
Authority
JP
Japan
Prior art keywords
attachment
work
start position
contact
determination unit
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.)
Pending
Application number
JP2021064930A
Other languages
Japanese (ja)
Inventor
大輔 野田
Daisuke Noda
展弘 福尾
Nobuhiro Fukuo
将貴 秋山
Masaki Akiyama
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 JP2021064930A priority Critical patent/JP2022160278A/en
Publication of JP2022160278A publication Critical patent/JP2022160278A/en
Pending legal-status Critical Current

Links

Images

Abstract

To improve efficiency of a work for a work object by an attachment.SOLUTION: A contact determination part 31 determines whether or not an attachment 15 becomes a contact state of contacting a work object O during movement of an attachment tip part 15t toward a work start position P3 from a movement start position P1. A work control part 33 allows the attachment 15 to start the work at a position of the attachment 15 when the contact determination part 31 determines that the attachment becomes the contact state.SELECTED DRAWING: Figure 1

Description

本発明は、アタッチメントに自動的に作業を行わせるための作業システムに関する。 The present invention relates to a work system for automatically performing work on an attachment.

例えば特許文献1などに、アタッチメントを有するショベルが記載されている。同文献の請求項1には「ショベルが相対的に安定性の低い姿勢になる可能性がある状態」などの条件が満たされた場合に、「操作装置を用いた前記アクチュエータの操作を制限する」と記載されている。 For example, Patent Literature 1 and the like describe a shovel having an attachment. In claim 1 of the same document, when a condition such as "a state in which the excavator may assume a relatively unstable posture" is satisfied, "the operation of the actuator using the operation device is restricted. ” is stated.

特開2020-158998号公報Japanese Patent Application Laid-Open No. 2020-158998

同文献に記載の技術では、所定の条件が満たされた場合に、アタッチメント(同文献ではブーム、アーム、バケット)の操作が制限される。アタッチメントの操作が制限されると、アタッチメントによる作業対象物に対する作業の効率が悪化する。 In the technique described in the document, the operation of the attachment (boom, arm, bucket in the document) is restricted when a predetermined condition is satisfied. If the operation of the attachment is restricted, the efficiency of work on the work target by the attachment will be degraded.

そこで、本発明は、アタッチメントによる作業対象物に対する作業の効率を向上させることができる作業システムを提供することを目的とする。 SUMMARY OF THE INVENTION Accordingly, it is an object of the present invention to provide a work system capable of improving the efficiency of work performed on a work object by an attachment.

作業システムは、下部本体と、上部旋回体と、アタッチメントと、作業制御部と、接触判定部と、を備える。前記上部旋回体は、前記下部本体に旋回可能に搭載される。前記アタッチメントは、前記上部旋回体に取り付けられ、作業対象物に対する作業を行う。前記作業制御部は、前記アタッチメントを自動的に作動させる制御を行う。前記接触判定部は、特定の移動開始位置から、前記作業対象物に対する作業の開始位置である作業開始位置に向かって、前記アタッチメントの先端部が移動している途中で、前記アタッチメントが前記作業対象物に接触した接触状態になったか否かを判定する。前記作業制御部は、前記接触状態であると前記接触判定部に判定されることなく前記移動開始位置から前記作業開始位置に前記アタッチメントの先端部が移動した場合、前記作業開始位置で前記アタッチメントに作業を開始させる。前記作業制御部は、前記接触状態であると前記接触判定部に判定された場合、前記接触状態であると判定されたときの前記アタッチメントの位置で、前記アタッチメントに作業を開始させる。 The work system includes a lower body, an upper revolving body, an attachment, a work control section, and a contact determination section. The upper rotating body is rotatably mounted on the lower body. The attachment is attached to the upper revolving body and performs work on the work target. The work control section performs control to automatically operate the attachment. The contact determination unit detects that the attachment is moving toward the work target while the tip of the attachment is moving from a specific movement start position toward the work start position, which is a work start position for the work target. It is determined whether or not it is in contact with an object. When the tip of the attachment moves from the movement start position to the work start position without being determined by the contact determination unit to be in the contact state, the work control unit moves the attachment to the work start position. let the work begin. When the contact determination unit determines that the contact state exists, the work control unit causes the attachment to start the work at the position of the attachment when it is determined that the contact state exists.

上記構成により、アタッチメントによる作業対象物に対する作業の効率を向上させることができる。 With the above configuration, it is possible to improve the efficiency of work on the work target by the attachment.

作業システム1の作業機械10などを横から見た図である。1 is a side view of a working machine 10 and the like of the working system 1. FIG. 図1に示す作業システム1のブロック図である。2 is a block diagram of the work system 1 shown in FIG. 1; FIG. 図2に示すコントローラ30の処理を示すフローチャートである。3 is a flowchart showing processing of the controller 30 shown in FIG. 2; 図1に示すアタッチメント15が前後方向Xに移動する場合の作業機械10などを横から見た図である。FIG. 2 is a side view of the work machine 10 and the like when the attachment 15 shown in FIG. 1 moves in the front-rear direction X; 図1に示すアタッチメント15が旋回方向θに移動する場合の作業機械10などを上から見た図である。FIG. 2 is a top view of the work machine 10 and the like when the attachment 15 shown in FIG. 1 moves in the turning direction θ;

図1~図5を参照して、作業システム1について説明する。 A work system 1 will be described with reference to FIGS. 1 to 5. FIG.

作業システム1は、図1に示すように、作業対象物Oに対する作業を行うためのシステムである。作業システム1は、作業機械10と、撮像装置21と、図2に示す姿勢検出部23と、アタッチメント速度センサ25と、アタッチメント負荷センサ27と、コントローラ30と、を備える。 The work system 1 is a system for performing work on a work object O, as shown in FIG. The work system 1 includes a work machine 10 , an imaging device 21 , an orientation detector 23 shown in FIG. 2 , an attachment speed sensor 25 , an attachment load sensor 27 and a controller 30 .

作業機械10は、図1に示すように、作業を行う機械であり、例えば建設作業を行う建設機械であり、例えばショベルである。作業機械10は、作業対象物Oに対する作業を行う。作業対象物Oは、例えば、土砂でもよく、砕石でもよく、廃棄物でもよい。作業対象物Oは、例えば、山形状(例えば土砂山)でもよく、地面Gに配置されてもよく(図4参照)、ピットP内に(壁Pwに囲まれるように)配置されてもよい。作業機械10は、下部走行体11(下部本体)と、上部旋回体13と、アタッチメント15と、駆動部17と、を備える。 As shown in FIG. 1, the work machine 10 is a machine that performs work, such as a construction machine that performs construction work, such as a shovel. The work machine 10 performs work on the work target O. As shown in FIG. The work object O may be earth and sand, crushed stone, or waste, for example. The work object O may be, for example, mountain-shaped (for example, a mound of earth and sand), may be placed on the ground G (see FIG. 4), or may be placed in a pit P (surrounded by walls Pw). . The work machine 10 includes a lower travel body 11 (lower main body), an upper revolving body 13 , an attachment 15 and a drive section 17 .

下部走行体11(下部本体)は、作業機械10を走行させる。下部走行体11は、例えばクローラを備える。 The lower traveling body 11 (lower main body) allows the work machine 10 to travel. The undercarriage 11 includes, for example, crawlers.

上部旋回体13は、下部走行体11に旋回可能に搭載される。上部旋回体13には、アタッチメント15が取り付けられる。上部旋回体13は、運転室13aと、カウンタウエイト13bと、を備える。運転室13aは、操作者が作業機械10の操作をすることが可能な部分である。作業機械10は、操作者に操作されなくてもよく、コントローラ30(図2参照)により自動的に操作される場合がある。カウンタウエイト13bは、作業機械10の前後方向Xのバランスをとるためのおもりである。 The upper revolving body 13 is rotatably mounted on the lower traveling body 11 . An attachment 15 is attached to the upper revolving body 13 . The upper swing body 13 includes an operator's cab 13a and a counterweight 13b. The operator's cab 13 a is a portion where the operator can operate the work machine 10 . Work machine 10 may not be operated by an operator, and may be automatically operated by controller 30 (see FIG. 2). The counterweight 13b is a weight for balancing the work machine 10 in the longitudinal direction X. As shown in FIG.

(作業機械10に関する方向の定義)
下部走行体11に対する上部旋回体13の旋回の回転軸(旋回中心13o(図5参照))が延びる方向を、上下方向Zとする。上下方向Zにおいて、下部走行体11から上部旋回体13に向かう側(向き)を上側Z1とし、その逆側を下側Z2とする。図5に示すように、上下方向Zから見たときにアタッチメント15が延びる方向(上部旋回体13に対してアタッチメント15が突出する方向)を、前後方向Xとする。前後方向Xにおいて、カウンタウエイト13bから、上部旋回体13へのアタッチメント15の取付部に向かう側を、「前側」とする。前後方向Xにおいて、上部旋回体13から前側を見たときの、上部旋回体13から遠い側を奥側X1とし、上部旋回体13に近い側を手前側X2とする。下部走行体11に対する上部旋回体13の旋回の方向(旋回中心13oを中心とする方向)を、旋回方向θとする。
(Definition of direction with respect to work machine 10)
A vertical direction Z is defined as the direction in which the rotation axis (turning center 13o (see FIG. 5)) of the upper turning body 13 with respect to the lower traveling body 11 extends. In the vertical direction Z, the side (orientation) from the lower traveling body 11 toward the upper revolving body 13 is defined as an upper side Z1, and the opposite side is defined as a lower side Z2. As shown in FIG. 5, the direction in which the attachment 15 extends (the direction in which the attachment 15 protrudes from the upper rotating body 13) when viewed from the up-down direction Z is defined as the front-rear direction X. As shown in FIG. In the front-rear direction X, the side from the counterweight 13b toward the attachment portion of the attachment 15 to the upper revolving body 13 is defined as the "front side." In the front-rear direction X, when the front side is viewed from the upper revolving body 13, the far side from the upper revolving body 13 is defined as the back side X1, and the side closer to the upper revolving body 13 is defined as the front side X2. The turning direction of the upper turning body 13 with respect to the lower traveling body 11 (the direction centering on the turning center 13o) is defined as a turning direction θ.

アタッチメント15は、図1に示すように、上部旋回体13に取り付けられ、作業対象物Oに対して作業を行う部分である。アタッチメント15は、ブーム15aと、アーム15bと、先端アタッチメント15cと、を備える。ブーム15aは、上部旋回体13に起伏可能(上下方向に回転可能)に取り付けられる。アーム15bは、ブーム15aに対して回転可能に取り付けられる。先端アタッチメント15cは、作業対象物Oに対する作業を行う部分である。先端アタッチメント15cは、アタッチメント15の先端部に設けられ、アーム15bに回転可能に取り付けられる。先端アタッチメント15cは、例えば土砂をすくう(掘削する)バケットでもよく、物を挟む装置(グラップルなど)でもよく、破砕や掘削などを行う装置(ブレーカなど)でもよい。先端アタッチメント15cの先端部(アタッチメント15の先端部)を、アタッチメント先端部15tとする。 The attachment 15 is a part that is attached to the upper revolving body 13 and performs work on the work object O, as shown in FIG. The attachment 15 includes a boom 15a, an arm 15b, and a tip attachment 15c. The boom 15a is attached to the upper revolving body 13 so as to be able to rise and fall (rotatable in the vertical direction). Arm 15b is rotatably attached to boom 15a. The tip attachment 15c is a part that performs work on the work object O. As shown in FIG. The tip attachment 15c is provided at the tip of the attachment 15 and rotatably attached to the arm 15b. The tip attachment 15c may be, for example, a bucket for scooping (excavating) earth and sand, a device for pinching an object (such as a grapple), or a device for crushing or excavating (such as a breaker). The tip of the tip attachment 15c (the tip of the attachment 15) is referred to as an attachment tip 15t.

駆動部17は、作業機械10を駆動させる。駆動部17は、例えば油圧アクチュエータを備えてもよく、電動アクチュエータを備えてもよい。上記「アクチュエータ」は、例えば伸縮可能なシリンダでもよく、モータでもよい。具体的には例えば、駆動部17は、ブームシリンダ17aと、アームシリンダ17bと、先端アタッチメントシリンダ17cと、旋回モータ17d(図2参照)と、を備える。ブームシリンダ17aは、上部旋回体13に対してブーム15aを起伏させるシリンダ(例えば油圧シリンダ)である。アームシリンダ17bは、ブーム15aに対してアーム15bを回転させるシリンダ(例えば油圧シリンダ)である。先端アタッチメントシリンダ17cは、アーム15bに対して先端アタッチメント15cを回転させるシリンダ(例えば油圧シリンダ)である。図2では、先端アタッチメントシリンダ17cを「先端ATTシリンダ」と記載した。旋回モータ17dは、図1に示す下部走行体11に対して上部旋回体13を旋回させるモータ(例えば油圧モータ、または電動モータ)である。旋回モータ17d(図2参照)は、図5に示す旋回中心13oを中心に、下部走行体11に対して上部旋回体13を旋回させる。その結果、旋回モータ17dは、旋回中心13oを中心に、下部走行体11に対してアタッチメント15を旋回させる。 The drive unit 17 drives the working machine 10 . The drive unit 17 may include, for example, a hydraulic actuator or an electric actuator. The "actuator" may be, for example, a telescopic cylinder or a motor. Specifically, for example, the drive unit 17 includes a boom cylinder 17a, an arm cylinder 17b, a tip attachment cylinder 17c, and a turning motor 17d (see FIG. 2). The boom cylinder 17 a is a cylinder (for example, a hydraulic cylinder) that raises and lowers the boom 15 a with respect to the upper swing body 13 . The arm cylinder 17b is a cylinder (for example, a hydraulic cylinder) that rotates the arm 15b with respect to the boom 15a. The tip attachment cylinder 17c is a cylinder (for example, a hydraulic cylinder) that rotates the tip attachment 15c with respect to the arm 15b. In FIG. 2, the tip attachment cylinder 17c is described as "tip ATT cylinder". The turning motor 17d is a motor (for example, a hydraulic motor or an electric motor) that turns the upper turning body 13 with respect to the lower traveling body 11 shown in FIG. The turning motor 17d (see FIG. 2) turns the upper turning body 13 with respect to the lower traveling body 11 about the turning center 13o shown in FIG. As a result, the turning motor 17d turns the attachment 15 with respect to the lower traveling body 11 around the turning center 13o.

撮像装置21は、図1に示すように、撮像対象物の、位置および形状の三次元情報を検出する。上記「撮像対象物」は、作業対象物O、および作業対象物Oの周辺物の少なくともいずれかである。撮像装置21は、距離の情報(奥行きの情報)を有する画像(距離画像)を取得する。撮像装置21は、距離画像と二次元画像とに基づいて、撮像対象物の三次元情報を検出してもよい。撮像装置21は、1つのみ設けられてもよく、複数設けられてもよい。撮像装置21は、作業機械10に搭載されてもよく、作業機械10の外部(例えば作業現場)に配置されてもよい。作業機械10に搭載されても、作業機械10の外部に配置されてもよい点は、図2に示す姿勢検出部23、アタッチメント速度センサ25、およびコントローラ30についても同様である。 The imaging device 21 detects three-dimensional information on the position and shape of an object to be imaged, as shown in FIG. The above-mentioned "object to be imaged" is at least one of the work object O and surrounding objects of the work object O. As shown in FIG. The imaging device 21 acquires an image (distance image) having distance information (depth information). The imaging device 21 may detect the three-dimensional information of the object to be imaged based on the distance image and the two-dimensional image. Only one imaging device 21 may be provided, or a plurality of imaging devices may be provided. The imaging device 21 may be mounted on the work machine 10 or may be arranged outside the work machine 10 (for example, at the work site). The attitude detection unit 23, the attachment speed sensor 25, and the controller 30 shown in FIG.

この撮像装置21(図1参照)は、レーザー光を用いて三次元の情報を検出する装置を備えてもよい。撮像装置21は、例えばLiDAR(Light Detection and RangingまたはLaser Imaging Detection and Ranging)を備えてもよく、TOF(Time Of Flight)センサを備えてもよい。撮像装置21は、電波を用いて三次元の情報を検出する装置(例えばミリ波レーダなど)を備えてもよい。撮像装置21は、ステレオカメラを備えてもよい。撮像装置21が三次元の情報と二次元の情報とに基づいて撮像対象物の三次元の位置および形状を検出する場合などには、撮像装置21は、二次元の画像を検出可能なカメラを備えてもよい。 The imaging device 21 (see FIG. 1) may include a device that detects three-dimensional information using laser light. The imaging device 21 may include, for example, LiDAR (Light Detection and Ranging or Laser Imaging Detection and Ranging), or may include a TOF (Time Of Flight) sensor. The imaging device 21 may include a device (such as a millimeter wave radar) that detects three-dimensional information using radio waves. The imaging device 21 may include a stereo camera. When the imaging device 21 detects the three-dimensional position and shape of the object to be imaged based on three-dimensional information and two-dimensional information, the imaging device 21 uses a camera capable of detecting two-dimensional images. You may prepare.

姿勢検出部23は、作業機械10(図1参照)の姿勢を検出する。姿勢検出部23は、ブームセンサ23aと、アームセンサ23bと、先端アタッチメントセンサ23c(図2では先端ATTセンサ)と、旋回センサ23dと、を備える。 Posture detection unit 23 detects the posture of work machine 10 (see FIG. 1). The posture detection unit 23 includes a boom sensor 23a, an arm sensor 23b, a tip attachment sensor 23c (tip ATT sensor in FIG. 2), and a turning sensor 23d.

ブームセンサ23aは、図1に示す上部旋回体13に対するブーム15aの回転角度(起伏角度)を検出する。ブームセンサ23a(図2参照)は、上部旋回体13に対するブーム15aの回転軸に取り付けられる角度センサを備えてもよい。ブームセンサ23aは、地面Gなどに対するブーム15aの傾斜角度を検出する傾斜センサを備えてもよい。ブームセンサ23aは、ブームシリンダ17aのストローク位置(シリンダチューブに対するシリンダロッドの位置)を検出するストロークセンサを備えてもよい。ブームセンサ23aは、二次元画像または距離画像に基づいてブーム15aの姿勢を検出するもの(画像に基づく検出を行うもの)でもよい。この場合、二次元画像または距離画像は、撮像装置21により撮像されてもよい。 The boom sensor 23a detects the rotation angle (hoisting angle) of the boom 15a with respect to the upper swing body 13 shown in FIG. Boom sensor 23 a (see FIG. 2 ) may comprise an angle sensor attached to the axis of rotation of boom 15 a relative to upper swing structure 13 . The boom sensor 23a may include a tilt sensor that detects the tilt angle of the boom 15a with respect to the ground G or the like. The boom sensor 23a may include a stroke sensor that detects the stroke position of the boom cylinder 17a (the position of the cylinder rod with respect to the cylinder tube). The boom sensor 23a may be one that detects the attitude of the boom 15a based on a two-dimensional image or a distance image (performs image-based detection). In this case, the two-dimensional image or the distance image may be captured by the imaging device 21 .

アームセンサ23b(図2参照)は、ブーム15aに対するアーム15bの回転角度を検出する。アームセンサ23bは、角度センサを備えてもよく、傾斜センサを備えてもよく、ストロークセンサを備えてもよく、画像に基づく検出を行うものでもよい(先端アタッチメントセンサ23c(図2参照)も同様)。先端アタッチメントセンサ23cは、アーム15bに対する先端アタッチメント15cの回転角度を検出する。旋回センサ23dは、下部走行体11に対する上部旋回体13の旋回の角度(旋回方向θ)を検出する。旋回センサ23dは、角度センサを備えてもよく、画像に基づく検出を行うものでもよい。 The arm sensor 23b (see FIG. 2) detects the rotation angle of the arm 15b with respect to the boom 15a. The arm sensor 23b may be provided with an angle sensor, an inclination sensor, a stroke sensor, or may perform detection based on an image (the same applies to the tip attachment sensor 23c (see FIG. 2)). ). The tip attachment sensor 23c detects the rotation angle of the tip attachment 15c with respect to the arm 15b. The turning sensor 23 d detects the turning angle (turning direction θ) of the upper turning body 13 with respect to the lower traveling body 11 . The turning sensor 23d may include an angle sensor, or may perform detection based on an image.

アタッチメント速度センサ25(図2参照)は、アタッチメント15の作動速度を検出する。例えば、アタッチメント速度センサ25は、姿勢検出部23(図2参照)と兼用されてもよい。例えば、アタッチメント速度センサ25は、姿勢検出部23によるアタッチメント15の姿勢の検出結果(例えば角度など)を、アタッチメント15の作動速度に変換してもよい。具体的には例えば、アタッチメント速度センサ25は、ブームセンサ23a(図2参照)に検出された、上部旋回体13に対するブーム15aの起伏角度を、上部旋回体13に対するブーム15aの回転速度(角速度)に変換してもよい。例えば、アタッチメント速度センサ25は、ブームシリンダ17aのストローク位置を、ブームシリンダ17aのストローク速度に変換してもよい。そして、アタッチメント速度センサ25は、ブームシリンダ17aの速度を、上部旋回体13に対するブーム15aの回転速度に変換してもよい。アーム15bの作動速度、および先端アタッチメント15cの作動速度についても、角度やストロークが、速度に変換されてもよい。下部走行体11に対する上部旋回体13の旋回速度(すなわちアタッチメント15の旋回速度)についても、旋回角度が旋回速度に変換されてもよい。なお、アタッチメント速度センサ25は、姿勢検出部23と兼用されなくてもよく、姿勢検出部23による検出結果を用いずにアタッチメント15の作動速度を検出してもよい。 Attachment speed sensor 25 (see FIG. 2) detects the operating speed of attachment 15 . For example, the attachment speed sensor 25 may also be used as the attitude detection section 23 (see FIG. 2). For example, the attachment speed sensor 25 may convert the detection result of the orientation of the attachment 15 (for example, angle) by the orientation detection unit 23 into the operating speed of the attachment 15 . Specifically, for example, the attachment speed sensor 25 converts the hoisting angle of the boom 15a with respect to the upper swing structure 13 detected by the boom sensor 23a (see FIG. 2) into the rotational speed (angular velocity) of the boom 15a with respect to the upper swing structure 13. can be converted to For example, the attachment speed sensor 25 may convert the stroke position of the boom cylinder 17a to the stroke speed of the boom cylinder 17a. Then, the attachment speed sensor 25 may convert the speed of the boom cylinder 17a into the rotation speed of the boom 15a relative to the upper rotating body 13. FIG. As for the operating speed of the arm 15b and the operating speed of the tip attachment 15c, the angle or stroke may also be converted into speed. As for the revolving speed of the upper revolving body 13 with respect to the lower traveling body 11 (that is, the revolving speed of the attachment 15), the revolving angle may be converted into the revolving speed. Note that the attachment speed sensor 25 may not be used as the orientation detection unit 23 and may detect the operating speed of the attachment 15 without using the detection result of the orientation detection unit 23 .

アタッチメント負荷センサ27(図2参照)は、アタッチメント15に作用する上下方向Zの負荷を検出する。アタッチメント負荷センサ27は、ブーム15a、アーム15b、および先端アタッチメント15cの少なくともいずれかに作用する上下方向Zの負荷を検出する。具体的には例えば、アタッチメント負荷センサ27は、ブーム15aに作用する上下方向Zの負荷を検出する場合、ブームシリンダ17aを作動させる作動油の油圧を検出してもよい。 The attachment load sensor 27 (see FIG. 2) detects the load in the vertical direction Z acting on the attachment 15 . The attachment load sensor 27 detects a load in the vertical direction Z acting on at least one of the boom 15a, the arm 15b, and the tip attachment 15c. Specifically, for example, when detecting a load acting on the boom 15a in the vertical direction Z, the attachment load sensor 27 may detect the oil pressure of hydraulic oil that operates the boom cylinder 17a.

コントローラ30(図2参照)は、信号の入出力、演算(処理)、情報の記憶などを行う。例えば、図2に示すコントローラ30は、撮像装置21(図1参照)、姿勢検出部23、アタッチメント速度センサ25、およびアタッチメント負荷センサ27から検出結果を受信する。例えば、コントローラ30は、駆動部17を駆動させるための信号を出力する。コントローラ30は、接触判定部31と、作業制御部33と、を備える。 The controller 30 (see FIG. 2) performs signal input/output, computation (processing), information storage, and the like. For example, the controller 30 shown in FIG. 2 receives detection results from the imaging device 21 (see FIG. 1), the orientation detection section 23, the attachment speed sensor 25, and the attachment load sensor 27. FIG. For example, the controller 30 outputs a signal for driving the drive section 17 . The controller 30 includes a contact determination section 31 and a work control section 33 .

接触判定部31は、後述する接触状態であるか否かの判定を行う。作業制御部33は、作業機械10を自動的に作動させる。作業制御部33は、アタッチメント15(図1参照)を自動的に作動させる制御を行う。作業制御部33は、ブームシリンダ17a、アームシリンダ17b、先端アタッチメントシリンダ17c、および旋回モータ17dのそれぞれを制御する。 The contact determination unit 31 determines whether or not there is a contact state, which will be described later. The work control unit 33 automatically operates the work machine 10 . The work control unit 33 performs control to automatically operate the attachment 15 (see FIG. 1). The work control unit 33 controls the boom cylinder 17a, the arm cylinder 17b, the tip attachment cylinder 17c, and the swing motor 17d.

(作業システム1の作動の概要)
作業システム1は、次のように作動するように構成される。コントローラ30(図2参照)が、作業機械10を制御(自動運転)し、アタッチメント15に作業を行わせる。このときのアタッチメント15の作動の具体例は、次の通りである。
(Overview of operation of work system 1)
The work system 1 is configured to operate as follows. A controller 30 (see FIG. 2) controls (automatically operates) the work machine 10 and causes the attachment 15 to perform work. A specific example of the operation of the attachment 15 at this time is as follows.

アタッチメント15が、作業対象物Oに対する作業(例えば掘削)を行い、先端アタッチメント15cが、作業対象物Oを運搬可能な状態(例えばすくった状態、把持した状態など)になる。この状態で、アタッチメント15が、作業対象物Oを所定位置に運搬する。具体的には例えば、アタッチメント15が、作業対象物Oを持ち上げるとともに、上部旋回体13が、旋回を行う(作業機械10が持ち上げ旋回を行う)。次に、アタッチメント15が、図示しない積込対象物(例えば運搬車両の荷台など)の上方で作業対象物Oを解放(例えば排土)する。次に、先端アタッチメント15c(さらに詳しくはアタッチメント先端部15t)が、作業対象物Oに対する作業を行う予定位置(作業開始位置P3)に移動する。この移動のとき、例えば、上部旋回体13が、旋回(復帰旋回)を行うとともに、先端アタッチメント15cの高さ(上下方向Zの位置)が変えられる。このように、作業機械10では、例えば、作業、持ち上げ旋回、解放、および復帰旋回の一連の作動が繰り返される。なお、上記の作業機械10の作動は一例であり、作業機械10の作動は様々に行われ得る。 The attachment 15 performs work (for example, excavation) on the work object O, and the tip attachment 15c is in a state in which the work object O can be transported (for example, a scooped state, a gripped state, etc.). In this state, the attachment 15 carries the work object O to a predetermined position. Specifically, for example, the attachment 15 lifts the work object O, and the upper swing body 13 swings (the work machine 10 lifts and swings). Next, the attachment 15 releases (for example, dumps) the work object O above an unillustrated loading object (for example, a loading platform of a transportation vehicle). Next, the tip attachment 15c (more specifically, the attachment tip portion 15t) moves to the planned position (work start position P3) where the work on the work object O is to be performed. During this movement, for example, the upper turning body 13 turns (return turning), and the height (position in the vertical direction Z) of the tip attachment 15c is changed. In this manner, work machine 10 repeats a series of operations, for example, work, lift turn, release, and return turn. The operation of the work machine 10 described above is an example, and the operation of the work machine 10 can be performed in various ways.

(アタッチメント先端部15tの移動)
作業制御部33(図2参照)は、移動開始位置P1から作業開始位置P3にアタッチメント先端部15tが移動するように、作業機械10の作動の制御を行う。
(Movement of attachment tip 15t)
The work control unit 33 (see FIG. 2) controls the operation of the work machine 10 so that the attachment tip 15t moves from the movement start position P1 to the work start position P3.

移動開始位置P1は、コントローラ30(例えば接触判定部31)(図2参照)に設定された特定の位置である。移動開始位置P1は、接触判定部31による判定(後述)が行われるときの、アタッチメント先端部15tの移動の開始位置である。例えば、移動開始位置P1は、上記の復帰旋回におけるアタッチメント先端部15tの軌跡上のある位置でもよく(図5参照)、復帰旋回の開始時のアタッチメント先端部15tの位置でもよい。図5に示すように、移動開始位置P1は、先端アタッチメント15cによる作業が行われる範囲(作業対象エリアOa)の内と外との境界と重なる点でもよい。例えば、先端アタッチメント15cによる作業は、作業対象エリアOaの少なくとも一部で行われる。 The movement start position P1 is a specific position set in the controller 30 (for example, the contact determination unit 31) (see FIG. 2). The movement start position P1 is the movement start position of the attachment tip portion 15t when a determination (described later) by the contact determination section 31 is performed. For example, the movement start position P1 may be a position on the trajectory of the attachment tip 15t in the return turning (see FIG. 5), or may be the position of the attachment tip 15t at the start of the return turning. As shown in FIG. 5, the movement start position P1 may be a point that overlaps the boundary between the inside and outside of the range (work target area Oa) where the work is performed by the tip attachment 15c. For example, the work by the tip attachment 15c is performed in at least part of the work target area Oa.

作業開始位置P3は、図1に示す先端アタッチメント15cによる作業対象物Oに対する作業(例えば掘削)が開始されるときの、アタッチメント先端部15tの位置である。作業開始位置P3は、例えばコントローラ30(図2参照)により自動的に設定されてもよい。具体的には、作業開始位置P3は、撮像装置21に撮像された距離画像に基づいて、コントローラ30により自動的に設定されてもよい。作業開始位置P3の高さは、操作者によるアタッチメント15でのティーチング(教示)によって設定されてもよい。作業開始位置P3の高さは、作業者による携帯情報端末(例えばタブレット、スマートフォンなど)への入力(例えば数値入力)によって設定されてもよい。作業開始位置P3と同様に、移動開始位置P1についても、コントローラ30により自動的に設定されてもよく、アタッチメント15でのティーチングによって設定されてもよく、携帯情報端末への入力によって設定されてもよい。 The work start position P3 is the position of the attachment tip portion 15t when the work (for example, excavation) on the work object O by the tip attachment 15c shown in FIG. 1 is started. The work start position P3 may be automatically set by the controller 30 (see FIG. 2), for example. Specifically, the work start position P3 may be automatically set by the controller 30 based on the distance image captured by the imaging device 21 . The height of the work start position P3 may be set by teaching with the attachment 15 by the operator. The height of the work start position P3 may be set by the operator's input (for example, numerical value input) to a mobile information terminal (for example, tablet, smartphone, etc.). As with the work start position P3, the movement start position P1 may be automatically set by the controller 30, set by teaching with the attachment 15, or set by input to the portable information terminal. good.

(アタッチメント15と作業対象物Oとの接触)
移動開始位置P1と作業開始位置P3との間に作業対象物Oが存在する場合が想定される。この場合、アタッチメント先端部15tが移動開始位置P1から作業開始位置P3に移動しているときに、アタッチメント15が作業対象物Oに接触することが想定される。具体例は次の通りである。
(Contact between attachment 15 and work object O)
It is assumed that the work object O exists between the movement start position P1 and the work start position P3. In this case, it is assumed that the attachment 15 comes into contact with the work object O while the attachment tip 15t is moving from the movement start position P1 to the work start position P3. Specific examples are as follows.

[上下方向Zの接触の例]例えば、作業開始位置P3の真上に作業対象物Oが存在する場合などが想定される。例えば、ティーチングや携帯情報端末への入力によって設定された作業開始位置P3の高さが、作業対象物Oの高さよりも低い場合などに、作業開始位置P3の真上に作業対象物Oが存在する場合が想定される。このような場合、作業対象物Oよりも上側Z1から作業開始位置P3に向かって下側Z2にアタッチメント先端部15tが移動すると、アタッチメント15(例えば先端アタッチメント15c)が作業対象物Oに接触する。この状態でアタッチメント15がさらに下げられようとすると、作業機械10が(車体が)、地面Gに対して持ち上がろうとする。すると、作業機械10が、地面Gに対して傾き、不安定になる場合がある。なお、図1に示す例では、アタッチメント先端部15tが作業対象物Oに接触する場合を示したが、アタッチメント15のうち作業対象物Oに接触する部分は、アタッチメント先端部15tとは限らず、先端アタッチメント15cとは限らない。 [Example of contact in the vertical direction Z] For example, it is assumed that the work object O exists directly above the work start position P3. For example, when the height of the work start position P3 set by teaching or input to the portable information terminal is lower than the height of the work target O, the work target O exists directly above the work start position P3. It is assumed that In such a case, the attachment 15 (for example, the tip attachment 15c) comes into contact with the work object O when the attachment tip 15t moves from above the work object O to the work start position P3 from above Z1 to below Z2. When the attachment 15 is further lowered in this state, the work machine 10 (the vehicle body) tries to be lifted from the ground G. As a result, the work machine 10 may tilt with respect to the ground G and become unstable. Although the example shown in FIG. 1 shows the case where the attachment tip portion 15t contacts the work object O, the portion of the attachment 15 that contacts the work object O is not limited to the attachment tip portion 15t. It is not limited to the tip attachment 15c.

[前後方向Xの接触の例]例えば、図4に示すように、移動開始位置P1よりも奥側X1に作業開始位置P3がある場合について考える。この場合、移動開始位置P1と作業開始位置P3との前後方向Xにおける間に、作業開始位置P3よりも高い位置に、作業対象物Oが存在する場合などが想定される。このような場合、先端アタッチメント15cが、移動開始位置P1から作業開始位置P3に向かって移動すると、作業開始位置P3よりも手前側X2で作業対象物Oに接触する(つっかえる)場合がある。 [Example of Contact in Front-Back Direction X] For example, as shown in FIG. 4, consider the case where the work start position P3 is located on the back side X1 of the movement start position P1. In this case, it is assumed that the work target O exists at a position higher than the work start position P3 between the movement start position P1 and the work start position P3 in the front-back direction X. In such a case, when the tip attachment 15c moves from the movement start position P1 toward the work start position P3, it may come into contact with (get stuck in) the work object O on the front side X2 of the work start position P3.

[旋回方向θの接触の例]例えば、図5に示すように、移動開始位置P1と作業開始位置P3との旋回方向θにおける間に、作業開始位置P3よりも高い位置に、作業対象物Oが存在する場合などが想定される。このような場合、先端アタッチメント15cが、移動開始位置P1から作業開始位置P3に向かって旋回すると、作業開始位置P3よりも移動開始位置P1に近い側で作業対象物Oに接触する(つっかえる)場合がある。 [Example of Contact in Turning Direction θ] For example, as shown in FIG. is assumed to exist. In such a case, when the tip attachment 15c turns from the movement start position P1 toward the work start position P3, it contacts (hangs) the work object O on the side closer to the movement start position P1 than the work start position P3. There is

そこで、作業制御部33(図2参照)は、移動開始位置P1から作業開始位置P3に移動している途中でアタッチメント15が作業対象物Oに接触する場合は、作業開始位置P3を変更する。変更後のP3を、変更後作業開始位置P3aという。コントローラ30による制御の詳細は以下の通りである。 Therefore, the work control unit 33 (see FIG. 2) changes the work start position P3 when the attachment 15 contacts the work object O while moving from the movement start position P1 to the work start position P3. P3 after the change is referred to as a post-change work start position P3a. The details of the control by the controller 30 are as follows.

(変更後作業開始位置P3a)
コントローラ30(図2参照)の作動などについて、図3に示すフローチャートを参照して説明する。以下では、フローチャートに示す各ステップについては、図3を参照して説明する。ステップS11では、作業制御部33(図2参照)が、移動開始位置P1から作業開始位置P3に向かってアタッチメント15を移動させる制御を行う。具体的には例えば、作業制御部33が、アタッチメント15に復帰旋回動作を行わせる。
(Changed work start position P3a)
The operation of the controller 30 (see FIG. 2) and the like will be described with reference to the flowchart shown in FIG. Each step shown in the flowchart will be described below with reference to FIG. In step S11, the work control unit 33 (see FIG. 2) performs control to move the attachment 15 from the movement start position P1 toward the work start position P3. Specifically, for example, the work control unit 33 causes the attachment 15 to perform a return turning motion.

ステップS12では、アタッチメント先端部15tが作業開始位置P3に到達したか否かが、接触判定部31(図2参照)に判定される。アタッチメント先端部15tが作業開始位置P3に到達していない場合(ステップS21でNOの場合)、フローは、ステップS21~S24およびS31に進む。アタッチメント先端部15tが作業開始位置P3に到達していない場合は、移動開始位置P1から作業開始位置P3に向かってアタッチメント先端部15tが移動している途中である。アタッチメント先端部15tが作業開始位置P3に到達した場合、フローはS41に進む。 In step S12, it is determined by the contact determination section 31 (see FIG. 2) whether or not the tip end portion 15t of the attachment has reached the work start position P3. If the attachment tip 15t has not reached the work start position P3 (NO in step S21), the flow proceeds to steps S21 to S24 and S31. If the attachment tip 15t has not reached the work start position P3, it means that the attachment tip 15t is in the process of moving from the movement start position P1 toward the work start position P3. When the attachment tip portion 15t reaches the work start position P3, the flow proceeds to S41.

ステップS21~S24およびS31では、接触判定部31(図2参照)は、アタッチメント15が作業対象物Oに接触した状態である「接触状態」であるか否かを判定する。 In steps S21 to S24 and S31, the contact determination section 31 (see FIG. 2) determines whether or not the attachment 15 is in a "contact state" in which the work object O is in contact.

ステップS21~S24では、接触判定部31(図2参照)は、アタッチメント15が作業対象物Oに接触し、アタッチメント15が停止または略停止した状態であるか否かを判定する。具体的には、接触判定部31は、アタッチメント速度センサ25(図2参照)に検出されたアタッチメント15の作動速度が速度閾値以下である場合、接触状態であると判定する。上記の速度閾値は、接触判定部31に予め(この判定の前に)設定される(以下の各閾値も同様)。 In steps S21 to S24, the contact determination unit 31 (see FIG. 2) determines whether the attachment 15 is in contact with the work object O and the attachment 15 is in a stopped or substantially stopped state. Specifically, when the operating speed of the attachment 15 detected by the attachment speed sensor 25 (see FIG. 2) is equal to or less than the speed threshold, the contact determination unit 31 determines that the contact state is established. The above speed threshold is set in advance (before this determination) in the contact determination unit 31 (the same applies to each threshold below).

さらに詳しくは、ステップS21では、接触判定部31(図2参照)は、上部旋回体13に対するブーム15aの回転速度が、ブーム速度閾値(ブーム15aの回転速度に関する速度閾値)以下か否かを判定する。例えば、ブーム15aの回転速度がブーム速度閾値以下である状態が所定時間以上継続した場合に、接触判定部31は、ブーム15aの回転速度がブーム速度閾値以上であると判定する。上記「所定時間」は、接触判定部31に予め設定された時間に関する閾値である。 More specifically, in step S21, the contact determination unit 31 (see FIG. 2) determines whether or not the rotational speed of the boom 15a relative to the upper rotating body 13 is equal to or lower than the boom speed threshold (speed threshold relating to the rotational speed of the boom 15a). do. For example, when the rotation speed of the boom 15a is equal to or lower than the boom speed threshold for a predetermined time or longer, the contact determination unit 31 determines that the rotation speed of the boom 15a is equal to or higher than the boom speed threshold. The “predetermined time” is a threshold related to time preset in the contact determination unit 31 .

同様に、ステップS22では、接触判定部31(図2参照)は、ブーム15aに対するアーム15bの回転速度が、アーム速度閾値(アーム15bの回転速度に関する速度閾値)以下か否かを判定する。ステップS23では、接触判定部31は、アーム15bに対する先端アタッチメント15cの回転速度が、先端アタッチメント速度閾値(先端アタッチメント15cの回転速度に関する速度閾値)以下か否かを判定する。図3では、先端アタッチメント15cを「先端ATT」と記載した。ステップS24では、接触判定部31は、図1に示す下部走行体11に対するアタッチメント15の(上部旋回体13の)旋回速度が、旋回速度閾値(アタッチメント15の旋回速度に関する速度閾値)以下か否かを判定する。 Similarly, in step S22, the contact determination unit 31 (see FIG. 2) determines whether or not the rotation speed of the arm 15b relative to the boom 15a is equal to or less than an arm speed threshold (speed threshold relating to the rotation speed of the arm 15b). In step S23, the contact determination unit 31 determines whether or not the rotation speed of the tip attachment 15c with respect to the arm 15b is equal to or less than the tip attachment speed threshold (the speed threshold for the rotation speed of the tip attachment 15c). In FIG. 3, the tip attachment 15c is described as "tip ATT". In step S24, the contact determination unit 31 determines whether or not the turning speed of the attachment 15 (of the upper turning body 13) with respect to the lower traveling body 11 shown in FIG. judge.

ブーム15aの回転速度、アーム15bの回転速度、先端アタッチメント15cの回転速度、およびアタッチメント15の旋回速度のそれぞれが各速度閾値以下である場合(ステップS21~S24のすべてでYESの場合)、フローはステップS25に進む。この場合、接触判定部31(図2参照)は、アタッチメント15が停止または略停止していると判定する。一方、この条件が満たされない場合(ステップS21~S24の少なくともいずれかでNOの場合)、接触判定部31は、アタッチメント15が停止または略停止していないと判定する。この場合、接触判定部31は、アタッチメント15は接触状態ではない、と判定する。この場合、フローはステップS12に戻る。 When each of the rotation speed of the boom 15a, the rotation speed of the arm 15b, the rotation speed of the tip attachment 15c, and the turning speed of the attachment 15 is equal to or less than each speed threshold (YES in all steps S21 to S24), the flow is Proceed to step S25. In this case, the contact determination unit 31 (see FIG. 2) determines that the attachment 15 is stopped or substantially stopped. On the other hand, if this condition is not satisfied (NO in at least one of steps S21 to S24), the contact determination section 31 determines that the attachment 15 has stopped or not nearly stopped. In this case, the contact determination unit 31 determines that the attachment 15 is not in contact. In this case, the flow returns to step S12.

ステップS31では、接触判定部31(図2参照)は、アタッチメント負荷センサ27に検出された負荷が負荷閾値(アタッチメント15の負荷に関する閾値)以上か否かを判定する。この判定では、アタッチメント15が作業機械10を地面Gに対して持ち上げ、作業機械10を傾けようとしている状態、または傾けている状態か否かが判定される。この判定では、接触判定部31は、アタッチメント15(具体的には例えばブーム15a)に作用する上下方向Zの負荷(図3では「ブーム負荷」)が負荷閾値以上か否かを判定する。アタッチメント15に作用する上下方向Zの負荷が負荷閾値以上である場合、フローはステップS32に進む。アタッチメント15に作用する上下方向Zの負荷が負荷閾値未満である場合、接触判定部31は、アタッチメント15は接触状態ではない、と判定する。この場合、フローはステップS12に戻る。 In step S31, the contact determination unit 31 (see FIG. 2) determines whether or not the load detected by the attachment load sensor 27 is equal to or greater than a load threshold (threshold relating to the load of the attachment 15). In this determination, it is determined whether or not the attachment 15 lifts the work machine 10 with respect to the ground G and is about to tilt the work machine 10 or is tilting it. In this determination, the contact determination unit 31 determines whether or not the load in the vertical direction Z (“boom load” in FIG. 3) acting on the attachment 15 (specifically, for example, the boom 15a) is greater than or equal to the load threshold. If the load in the vertical direction Z acting on the attachment 15 is greater than or equal to the load threshold, the flow proceeds to step S32. When the load in the vertical direction Z acting on the attachment 15 is less than the load threshold, the contact determination unit 31 determines that the attachment 15 is not in contact. In this case, the flow returns to step S12.

アタッチメント15の作動速度が速度閾値以下(S21~S24のすべてでYES)、およびアタッチメント15に作用する上下方向Zの負荷が負荷閾値以上(S31でYES)、の少なくともいずれかの条件が満たされる場合、フローはステップS32に進む。この場合、接触判定部31は、アタッチメント15は接触状態である、と判定する。この場合、フローはステップS41に進む。 If at least one of the conditions that the operating speed of the attachment 15 is equal to or less than the speed threshold (YES in all of S21 to S24) and that the load in the vertical direction Z acting on the attachment 15 is equal to or greater than the load threshold (YES in S31) is satisfied. , the flow proceeds to step S32. In this case, the contact determination unit 31 determines that the attachment 15 is in the contact state. In this case, the flow proceeds to step S41.

(アタッチメント15の速度および負荷の判定)
接触判定部31(図2参照)は、アタッチメント15の作動速度が速度閾値以下であるか否かの判定(速度判定)と、アタッチメント15の負荷が負荷閾値以上であるか否かの判定(負荷判定)と、に基づいて、接触状態であるか否かを判定することが好ましい。この理由は、次の通りである。アタッチメント15が、作業機械10を地面Gに対して浮かせ、下部走行体11を地面Gに対して傾けているときは、アタッチメント15は停止(または略停止)していない。そのため、速度判定のみが行われる場合、アタッチメント15が作業対象物Oに接触しているにもかかわらず、「接触状態である」と判定されない。一方、アタッチメント15が作業対象物Oに接触して停止(または略停止)しているが、アタッチメント15に作用する負荷は小さい場合がある。具体的には例えば、アタッチメント15が作業対象物Oに接触してからのブームシリンダ17aのストローク量が小さい場合などには、ブームシリンダ17aに作用する負荷が小さく、ブームシリンダ17aに供給される作動油の圧力が、大きくは立たない。このような場合、アタッチメント15が作業対象物Oに接触しているにもかかわらず、「接触状態である」と判定されない。一方、速度判定と負荷判定との両方が行われる場合は、アタッチメント15が作業対象物Oに接触しているか否かを適切に判定することができる。
(Determination of speed and load of attachment 15)
The contact determination unit 31 (see FIG. 2) determines whether the operating speed of the attachment 15 is equal to or less than the speed threshold (speed determination), and determines whether the load of the attachment 15 is equal to or greater than the load threshold (load It is preferable to determine whether or not the contact state is established based on the determination). The reason for this is as follows. When the attachment 15 floats the work machine 10 with respect to the ground G and tilts the undercarriage 11 with respect to the ground G, the attachment 15 is not stopped (or substantially stopped). Therefore, when only speed determination is performed, even though the attachment 15 is in contact with the work object O, it is not determined to be in a "contact state." On the other hand, although the attachment 15 is in contact with the work object O and is stopped (or substantially stopped), the load acting on the attachment 15 may be small. Specifically, for example, when the stroke amount of the boom cylinder 17a after the attachment 15 contacts the work object O is small, the load acting on the boom cylinder 17a is small, and the operation supplied to the boom cylinder 17a is small. Oil pressure does not stand up greatly. In such a case, even though the attachment 15 is in contact with the work object O, it is not determined to be in a “contact state”. On the other hand, when both the speed determination and the load determination are performed, it can be appropriately determined whether the attachment 15 is in contact with the work object O or not.

なお、速度判定と負荷判定とのいずれか一方のみでも、アタッチメント15が作業対象物Oに接触しているか否かを適切に判定することができる場合は、速度判定と負荷判定とのいずれか一方のみが行われてもよい。 Note that if it is possible to appropriately determine whether or not the attachment 15 is in contact with the work object O with only one of the speed determination and the load determination, either the speed determination or the load determination may be used. may only be performed.

ステップS41では、作業制御部33(図2参照)は、作業対象物Oに対する作業をアタッチメント15に開始させる。さらに詳しくは、接触状態であると接触判定部31(図2参照)に判定されることなく、移動開始位置P1から作業開始位置P3にアタッチメント先端部15tが移動した場合(ステップS12でNOの場合)、作業制御部33は、次の処理を行う。この場合、作業制御部33は、作業開始位置P3でアタッチメント15に作業を開始させる。さらに詳しくは、作業制御部33は、アタッチメント先端部15tが作業開始位置P3に配置された状態から、アタッチメント15に作業対象物Oに対する作業を開始させる。 In step S41, the work control unit 33 (see FIG. 2) causes the attachment 15 to start work on the work object O. As shown in FIG. More specifically, when the attachment tip 15t moves from the movement start position P1 to the work start position P3 without being determined by the contact determination unit 31 (see FIG. 2) to be in the contact state (NO in step S12). ), the work control unit 33 performs the following processing. In this case, the work control unit 33 causes the attachment 15 to start work at the work start position P3. More specifically, the work control unit 33 causes the attachment 15 to start working on the work object O from a state in which the tip end portion 15t of the attachment is arranged at the work start position P3.

また、接触判定部31(図2参照)により、接触状態であると判定された場合(ステップS32からステップS41に進んだ場合)、作業制御部33(図2参照)は、次の処理を行う。この場合、作業制御部33は、接触判定部31に接触状態であると判定されたときのアタッチメント15の位置で、アタッチメント15に作業を開始させる。この場合、接触判定部31は、接触判定部31に接触状態であると判定されたときのアタッチメント15の位置に、作業開始位置P3を変更する(作業開始位置P3を、変更後作業開始位置P3aに変更する)。さらに詳しくは、作業制御部33は、アタッチメント先端部15tが変更後作業開始位置P3aに配置された状態から、アタッチメント15に作業対象物Oに対する作業を開始させる。よって、接触状態であると判定された場合でも、アタッチメント15による作業対象物Oに対する作業が行われる。 Further, when the contact determination unit 31 (see FIG. 2) determines that there is a contact state (when proceeding from step S32 to step S41), the work control unit 33 (see FIG. 2) performs the following processing. . In this case, the work control unit 33 causes the attachment 15 to start the work at the position of the attachment 15 when the contact determination unit 31 determines that it is in the contact state. In this case, the contact determination unit 31 changes the work start position P3 to the position of the attachment 15 when the contact determination unit 31 determines that it is in the contact state (changes the work start position P3 to the post-change work start position P3a). ). More specifically, the work control unit 33 causes the attachment 15 to start working on the work object O from a state in which the tip end portion 15t of the attachment is arranged at the post-change work start position P3a. Therefore, even when it is determined that the work object O is in the contact state, the work on the work object O by the attachment 15 is performed.

ステップS41の次に、フローは「エンド」に進む。その後、コントローラ30(図2参照)は、例えば、上記の持ち上げ旋回、および作業対象物Oの解放を作業機械10に行わせる。その後、コントローラ30は、作業機械10に復帰旋回を行わせるときに、図3に示す処理を再び行う。 After step S41, the flow proceeds to "END". After that, the controller 30 (see FIG. 2) causes the work machine 10 to lift and turn and release the work object O as described above, for example. After that, the controller 30 performs the processing shown in FIG. 3 again when causing the work machine 10 to perform the return turning.

図1に示すアタッチメント15が変更後作業開始位置P3aで作業を開始し、この作業が完了し、例えば持ち上げ旋回および作業対象物Oの解放が行われた後、再び図3に示す処理が行われる場合について説明する。[例1]この場合、図1に示すアタッチメント先端部15tの移動目標が、変更後作業開始位置P3aから、変更前の作業開始位置P3に戻されてもよい。[例1a]例えば、アタッチメント15が、作業対象物Oに接触したこと、および、変更後作業開始位置P3aで作業を行ったことにより、作業対象物Oの形状が変化する。すると、アタッチメント先端部15tが、変更前の作業開始位置P3に到達できる場合がある。この場合、アタッチメント15が、変更前の作業開始位置P3での作業を行うことができる。[例1b]また、接触状態であると判定されたときのアタッチメント15の位置(いわば障害物)を避けるように、移動開始位置P1から変更前の作業開始位置P3にアタッチメント先端部15tが移動してもよい。図5において、この場合のアタッチメント先端部15tの移動経路の一例を、二点鎖線で示した。[例2]また、アタッチメント先端部15tの移動目標が、変更後作業開始位置P3aでも、「変更前の作業開始位置P3」でもない位置(新たな作業開始位置P3)とされてもよい。 After the attachment 15 shown in FIG. 1 starts the work at the post-change work start position P3a and the work is completed, for example, the lifting and turning and the release of the work object O are performed, the processing shown in FIG. 3 is performed again. A case will be described. [Example 1] In this case, the movement target of the attachment tip portion 15t shown in FIG. 1 may be returned from the post-change work start position P3a to the pre-change work start position P3. [Example 1a] For example, the shape of the work object O changes when the attachment 15 comes into contact with the work object O and performs work at the post-change work start position P3a. Then, the attachment tip portion 15t may reach the work start position P3 before the change. In this case, the attachment 15 can perform the work at the work start position P3 before the change. [Example 1b] In addition, the tip portion 15t of the attachment moves from the movement start position P1 to the work start position P3 before the change so as to avoid the position of the attachment 15 when it is determined to be in contact (so to speak, an obstacle). may In FIG. 5, an example of the movement path of the attachment tip portion 15t in this case is indicated by a chain double-dashed line. [Example 2] Further, the movement target of the attachment tip portion 15t may be a position (new work start position P3) that is neither the post-change work start position P3a nor the "pre-change work start position P3".

(第1の発明の効果)
図1に示すように、作業システム1による効果は、次の通りである。作業システム1は、下部走行体11(下部本体)と、上部旋回体13と、アタッチメント15と、作業制御部33(図2参照)と、接触判定部31(図2参照)と、を備える。上部旋回体13は、下部走行体11に旋回可能に搭載されたものである。アタッチメント15は、上部旋回体13に取り付けられ、作業対象物Oに対する作業を行う。作業制御部33は、アタッチメント15を自動的に作動させる制御を行う。接触判定部31は、特定の移動開始位置P1から作業開始位置P3に向かって、アタッチメント先端部15tが移動している途中で、アタッチメント15が作業対象物Oに接触した接触状態になったか否かを判定する。作業開始位置P3は、作業対象物Oに対する作業の開始位置である。作業制御部33は、接触状態であると接触判定部31に判定されることなく、移動開始位置P1から作業開始位置P3にアタッチメント先端部15tが移動した場合、作業開始位置P3でアタッチメント15に作業を開始させる。
(Effect of the first invention)
As shown in FIG. 1, the effects of the work system 1 are as follows. The work system 1 includes a lower traveling body 11 (lower main body), an upper revolving body 13, an attachment 15, a work control section 33 (see FIG. 2), and a contact determination section 31 (see FIG. 2). The upper revolving body 13 is mounted on the lower traveling body 11 so as to be able to revolve. The attachment 15 is attached to the upper revolving body 13 and performs work on the work object O. As shown in FIG. The work control unit 33 performs control to automatically operate the attachment 15 . The contact determination unit 31 determines whether or not the attachment 15 has come into contact with the work object O while the attachment tip 15t is moving from the specific movement start position P1 toward the work start position P3. judge. The work start position P3 is the work start position for the work object O. As shown in FIG. If the contact determination unit 31 does not determine that the attachment is in the contact state and the attachment tip 15t moves from the movement start position P1 to the work start position P3, the work control unit 33 causes the attachment 15 to work at the work start position P3. to start.

[構成1]作業制御部33は、接触状態であると接触判定部31に判定された場合、接触状態であると判定されたときのアタッチメント15の位置で、アタッチメント15に作業を開始させる。 [Configuration 1] When the contact determination unit 31 determines that the contact state is established, the work control unit 33 causes the attachment 15 to start the work at the position of the attachment 15 when it is determined that the contact state is established.

上記[構成1]により、アタッチメント15が作業対象物Oに接触した接触状態になった場合でも、接触状態であると判定されたときのアタッチメント15の位置で、作業対象物Oに対する作業をアタッチメント15に開始させる。よって、アタッチメント15が接触状態になった場合でも、作業対象物Oに対するアタッチメント15による作業を行うことができる。よって、例えばアタッチメント15が接触状態になった場合にアタッチメント15の作動が制限される場合などに比べ、アタッチメント15による作業対象物Oに対する作業の効率を向上させることができる。 According to the above [Configuration 1], even when the attachment 15 comes into contact with the work object O, the attachment 15 performs the work on the work object O at the position of the attachment 15 when it is determined that it is in the contact state. to start. Therefore, even when the attachment 15 comes into contact with the work object O, the work can be performed by the attachment 15 . Therefore, compared with the case where the operation of the attachment 15 is restricted when the attachment 15 comes into contact, for example, the efficiency of the work on the work object O by the attachment 15 can be improved.

(第2の発明の効果)
[構成2]作業システム1は、アタッチメント15の作動速度を検出するアタッチメント速度センサ25(図2参照)を備える。接触判定部31(図2参照)は、アタッチメント速度センサ25に検出されたアタッチメント15の作動速度が、接触判定部31に設定された速度閾値以下である場合、接触状態であると判定する。
(Effect of the second invention)
[Configuration 2] The work system 1 includes an attachment speed sensor 25 (see FIG. 2) that detects the operating speed of the attachment 15 . When the operating speed of the attachment 15 detected by the attachment speed sensor 25 is less than or equal to the speed threshold set in the contact determination unit 31, the contact determination unit 31 (see FIG. 2) determines that the contact state is established.

上記[構成2]では、アタッチメント15が停止または略停止しているときのアタッチメント15の速度を速度閾値として設定した場合、次の効果が得られる。この場合、アタッチメント15が停止または略停止しているときに、接触状態であると接触判定部31が判定する。よって、アタッチメント15が作業開始位置P3に移動できない状態であることを、適切に判定することができる。 In the above [Configuration 2], when the speed of the attachment 15 when the attachment 15 is stopped or nearly stopped is set as the speed threshold, the following effects are obtained. In this case, the contact determination unit 31 determines that the contact state is established when the attachment 15 is stopped or substantially stopped. Therefore, it can be appropriately determined that the attachment 15 cannot be moved to the work start position P3.

(第3の発明の効果)
[構成3]作業システム1は、アタッチメント15に作用する上下方向Zの負荷を検出するアタッチメント負荷センサ27(図2参照)を備える。接触判定部31(図2参照)は、アタッチメント負荷センサ27に検出された負荷が、接触判定部31に設定された負荷閾値以上である場合、接触状態であると判定する。
(Effect of the third invention)
[Configuration 3] The work system 1 includes an attachment load sensor 27 (see FIG. 2) that detects a load in the vertical direction Z acting on the attachment 15 . When the load detected by the attachment load sensor 27 is equal to or greater than the load threshold set in the contact determination section 31, the contact determination section 31 (see FIG. 2) determines that the contact state is established.

上記[構成3]では、アタッチメント15が下部走行体11および上部旋回体13を持ち上げようとしているときのアタッチメント15の負荷を負荷閾値として設定した場合、次の効果が得られる。この場合、アタッチメント15が下部走行体11および上部旋回体13を持ち上げようとしているときに、接触状態であると接触判定部31に判定される。よって、アタッチメント15が作業開始位置P3に移動できない状態であることを、適切に判定することができる。 In the above [Configuration 3], when the load of the attachment 15 when the attachment 15 is about to lift the lower traveling body 11 and the upper revolving body 13 is set as the load threshold, the following effects are obtained. In this case, when the attachment 15 is about to lift the lower traveling body 11 and the upper rotating body 13, the contact determining section 31 determines that they are in contact. Therefore, it can be appropriately determined that the attachment 15 cannot be moved to the work start position P3.

(第4の発明の効果)
[構成4]作業システム1は、上記[構成2]および[構成3]を備える。
(Effect of the fourth invention)
[Configuration 4] The work system 1 has the above [Configuration 2] and [Configuration 3].

上記[構成4]により、次の効果が得られる。アタッチメント15が下部走行体11および上部旋回体13を持ち上げようとしていないが、アタッチメント15が停止または略停止しているときに、接触状態であると接触判定部31に判定させることができる。また、アタッチメント15が停止または略停止していないが、アタッチメント15が下部走行体11および上部旋回体13を持ち上げようとしているときに、接触状態であると接触判定部31に判定させることができる。したがって、アタッチメント15が作業開始位置P3に移動できない状態であることを、適切に判定することができる。 [Configuration 4] provides the following effects. When the attachment 15 is not trying to lift the lower running body 11 and the upper rotating body 13, but the attachment 15 is stopped or almost stopped, the contact determination section 31 can determine that the contact state is established. Also, when the attachment 15 is trying to lift the lower running body 11 and the upper rotating body 13 although the attachment 15 is not stopped or almost stopped, the contact determining part 31 can determine that they are in contact. Therefore, it can be appropriately determined that the attachment 15 cannot be moved to the work start position P3.

(変形例)
上記実施形態は様々に変形されてもよい。例えば、上記実施形態の各構成要素の配置や形状が変更されてもよい。例えば、図2に示す各構成要素の接続は変更されてもよい。例えば、図3に示すフローチャートのステップの順序が変更されてもよく、ステップの一部が行われなくてもよい。例えば、上記の各閾値(速度閾値、負荷閾値など)や範囲(例えば作業対象エリアOa)などは、一定でもよく、手動操作により変えられてもよく、何らかの条件に応じて自動的に変えられてもよい。例えば、構成要素の数が変更されてもよく、構成要素の一部が設けられなくてもよい。例えば、構成要素どうしの固定や連結などは、直接的でも間接的でもよい。例えば、互いに異なる複数の部材や部分として説明したものが、一つの部材や部分とされてもよい。例えば、一つの部材や部分として説明したものが、互いに異なる複数の部材や部分に分けて設けられてもよい。具体的には例えば、図2に示すコントローラ30の構成要素(作業制御部33および接触判定部31)は、1つのコントローラ30にまとめて設けられてもよく、別々に設けられてもよい。
(Modification)
The above embodiments may be modified in various ways. For example, the arrangement and shape of each component of the above embodiment may be changed. For example, the connection of each component shown in FIG. 2 may be changed. For example, the order of steps in the flow chart shown in FIG. 3 may be changed, and some steps may not be performed. For example, each threshold (speed threshold, load threshold, etc.) and range (for example, work target area Oa) may be constant, may be changed by manual operation, or may be changed automatically according to some conditions. good too. For example, the number of components may vary and some components may not be provided. For example, fixing, coupling, etc. between components may be direct or indirect. For example, what has been described as a plurality of different members or parts may be treated as one member or part. For example, what has been described as one member or portion may be divided into a plurality of different members or portions. Specifically, for example, the components of the controller 30 shown in FIG. 2 (the work control unit 33 and the contact determination unit 31) may be collectively provided in one controller 30 or may be provided separately.

1 作業システム
11 下部走行体(下部本体)
13 上部旋回体
15 アタッチメント
25 アタッチメント速度センサ
27 アタッチメント負荷センサ
31 接触判定部
33 作業制御部
O 作業対象物
P1 移動開始位置
P3 作業開始位置
1 work system 11 lower running body (lower main body)
13 upper rotating body 15 attachment 25 attachment speed sensor 27 attachment load sensor 31 contact determination section 33 work control section O work target P1 movement start position P3 work start position

Claims (4)

下部本体と、
前記下部本体に旋回可能に搭載された上部旋回体と、
前記上部旋回体に取り付けられ、作業対象物に対する作業を行うアタッチメントと、
前記アタッチメントを自動的に作動させる制御を行う作業制御部と、
特定の移動開始位置から、前記作業対象物に対する作業の開始位置である作業開始位置に向かって、前記アタッチメントの先端部が移動している途中で、前記アタッチメントが前記作業対象物に接触した接触状態になったか否かを判定する接触判定部と、
を備え、
前記作業制御部は、前記接触状態であると前記接触判定部に判定されることなく前記移動開始位置から前記作業開始位置に前記アタッチメントの先端部が移動した場合、前記作業開始位置で前記アタッチメントに作業を開始させ、
前記作業制御部は、前記接触状態であると前記接触判定部に判定された場合、前記接触状態であると判定されたときの前記アタッチメントの位置で、前記アタッチメントに作業を開始させる、
作業システム。
a lower body;
an upper revolving body rotatably mounted on the lower body;
an attachment attached to the upper revolving structure for performing work on a work target;
a work control unit that controls to automatically operate the attachment;
A contact state in which the attachment is in contact with the work object while the tip of the attachment is moving from a specific movement start position toward the work start position, which is the work start position for the work object. A contact determination unit that determines whether or not the
with
When the tip of the attachment moves from the movement start position to the work start position without being determined by the contact determination unit to be in the contact state, the work control unit moves the attachment to the work start position. start work,
When the contact determination unit determines that the contact state exists, the work control unit causes the attachment to start the work at the position of the attachment when the contact state is determined.
working system.
請求項1に記載の作業システムであって、
前記アタッチメントの作動速度を検出するアタッチメント速度センサを備え、
前記接触判定部は、前記アタッチメント速度センサに検出された前記アタッチメントの作動速度が、前記接触判定部に設定された速度閾値以下である場合、前記接触状態であると判定する、
作業システム。
The work system according to claim 1,
An attachment speed sensor that detects the operating speed of the attachment;
The contact determination unit determines that the contact state exists when the operating speed of the attachment detected by the attachment speed sensor is equal to or less than a speed threshold set in the contact determination unit.
working system.
請求項1に記載の作業システムであって、
前記アタッチメントに作用する上下方向の負荷を検出するアタッチメント負荷センサを備え、
前記接触判定部は、前記アタッチメント負荷センサに検出された負荷が、前記接触判定部に設定された負荷閾値以上である場合、前記接触状態であると判定する、
作業システム。
The work system according to claim 1,
an attachment load sensor that detects a vertical load acting on the attachment;
The contact determination unit determines that the contact state exists when the load detected by the attachment load sensor is equal to or greater than a load threshold set in the contact determination unit.
working system.
請求項1に記載の作業システムであって、
前記アタッチメントの作動速度を検出するアタッチメント速度センサと、
前記アタッチメントに作用する上下方向の負荷を検出するアタッチメント負荷センサと、
を備え、
前記接触判定部は、前記アタッチメント速度センサに検出された前記アタッチメントの作動速度が、前記接触判定部に設定された速度閾値以下である場合、前記接触状態であると判定し、
前記接触判定部は、前記アタッチメント速度センサに検出された前記アタッチメントの作動速度が、前記接触判定部に設定された速度閾値以下である場合、前記接触状態であると判定する、
作業システム。
The work system according to claim 1,
an attachment speed sensor that detects the operating speed of the attachment;
an attachment load sensor that detects a vertical load acting on the attachment;
with
The contact determination unit determines that the contact state exists when the operating speed of the attachment detected by the attachment speed sensor is equal to or less than a speed threshold set in the contact determination unit,
The contact determination unit determines that the contact state exists when the operating speed of the attachment detected by the attachment speed sensor is equal to or less than a speed threshold set in the contact determination unit.
working system.
JP2021064930A 2021-04-06 2021-04-06 Work system Pending JP2022160278A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2021064930A JP2022160278A (en) 2021-04-06 2021-04-06 Work system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2021064930A JP2022160278A (en) 2021-04-06 2021-04-06 Work system

Publications (1)

Publication Number Publication Date
JP2022160278A true JP2022160278A (en) 2022-10-19

Family

ID=83657625

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021064930A Pending JP2022160278A (en) 2021-04-06 2021-04-06 Work system

Country Status (1)

Country Link
JP (1) JP2022160278A (en)

Similar Documents

Publication Publication Date Title
US20170073935A1 (en) Control System for a Rotating Machine
JPWO2018043104A1 (en) Wheel loader and control method of wheel loader
US10358796B2 (en) Operator assist features for excavating machines based on perception system feedback
JP6521691B2 (en) Shovel
US20170073925A1 (en) Control System for a Rotating Machine
US9454147B1 (en) Control system for a rotating machine
WO2020170687A1 (en) Safety device and construction machine
JP6585532B2 (en) Small excavator
JP2023021362A (en) Control device and control method of loading machine
WO2020166241A1 (en) Monitoring device and construction machine
JP2003247246A (en) Work machine controller improving cycle time
JP7287829B2 (en) Excavator
JP7147389B2 (en) working machine
CN114207220B (en) Motion teaching system
JP7217691B2 (en) construction machinery
JP2022160278A (en) Work system
JP7449314B2 (en) Excavators, remote control support equipment
WO2022215414A1 (en) Excavation system
WO2023090121A1 (en) Work system
JP2020045746A (en) Construction machine
WO2023074176A1 (en) Work machine
WO2022091519A1 (en) Route setting system
WO2022270016A1 (en) Monitoring system
WO2023149307A1 (en) Automatic driving system for work machine, work machine, and automatic driving program
JP2023066361A (en) Work machine

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20240314