JP7809945B2 - Location Information Setting System - Google Patents
Location Information Setting SystemInfo
- Publication number
- JP7809945B2 JP7809945B2 JP2021179511A JP2021179511A JP7809945B2 JP 7809945 B2 JP7809945 B2 JP 7809945B2 JP 2021179511 A JP2021179511 A JP 2021179511A JP 2021179511 A JP2021179511 A JP 2021179511A JP 7809945 B2 JP7809945 B2 JP 7809945B2
- Authority
- JP
- Japan
- Prior art keywords
- old
- work machine
- position information
- reference position
- new
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Landscapes
- Operation Control Of Excavators (AREA)
- Component Parts Of Construction Machinery (AREA)
Description
本発明は、作業機械に関する位置情報を設定する位置情報設定システムに関する。 The present invention relates to a position information setting system that sets position information related to a work machine.
例えば特許文献1に記載の発明では、位置情報(同文献では教示データ)に従って作動する作業機械と、この作業機械以外の他の作業機械と、の接触や衝突の防止が図られている(同文献の[0003]などを参照)。同文献に記載の発明では、位置情報が設定されたときの作業機械の位置に対する、現在の作業機械の位置ずれが検出される(同文献の[0031]などを参照)。 For example, the invention described in Patent Document 1 aims to prevent contact or collision between a work machine operating according to position information (referred to as teaching data in the document) and other work machines (see, for example, [0003] in the document). The invention described in the document detects the deviation of the current position of the work machine from the position of the work machine when the position information was set (see, for example, [0031] in the document).
同文献に記載の発明では、作業現場に対して作業機械がずれると、位置情報(同文献では教示データ)も作業現場に対してずれる。作業機械が元の位置からずれた状態で作業機械が適切に作業を行うには、位置情報の再設定が必要となり、手間がかかる。 In the invention described in this document, if the work machine shifts relative to the work site, the position information (teach data in this document) also shifts relative to the work site. For the work machine to perform work appropriately when it has shifted from its original position, the position information needs to be reset, which is time-consuming.
そこで、本発明は、作業現場に対して作業機械が移動した場合に、位置情報を設定し直す必要をなくすことができる位置情報設定システムを提供することを目的とする。 Therefore, the present invention aims to provide a position information setting system that eliminates the need to reset position information when a work machine moves relative to a work site.
位置情報設定システムは、作業機械に関する位置情報を設定する位置情報設定部を備える。前記位置情報設定部は、旧位置に前記作業機械が配置されたときと、前記旧位置とは異なる新位置に前記作業機械が配置されたときとで、前記作業機械が配置された作業現場に対する前記位置情報の位置が変わらないように、前記位置情報を設定する。 The position information setting system includes a position information setting unit that sets position information related to a work machine. The position information setting unit sets the position information so that the position of the position information relative to the work site where the work machine is located does not change between when the work machine is located at an old position and when the work machine is located at a new position different from the old position.
上記構成により、作業現場に対して作業機械が移動した場合に、位置情報を設定し直す必要をなくすことができる。 The above configuration eliminates the need to reset location information when the work machine moves relative to the work site.
(第1実施形態)
図1~図7を参照して、第1実施形態の位置情報設定システム1について説明する。
(First embodiment)
A location information setting system 1 according to a first embodiment will be described with reference to FIGS.
位置情報設定システム1は、図3に示す位置情報D(後述)を設定するシステムである。位置情報設定システム1は、作業機械10が移動する前に設定された位置情報Dを、作業機械10が移動した後にも(立ち位置がずれた場合にも)利用できるようにする。本実施形態では、位置情報設定システム1は、作業機械10が旧位置P1に配置されたときに設定された旧位置情報D1を、作業機械10が新位置P2に配置されたときにも新位置情報D2として利用できるようにする。位置情報設定システム1は、作業機械10と、図2に示す姿勢センサ21と、走行センサ23と、特徴物検出装置25と、コントローラ30と、報知部80と、を備える。 The position information setting system 1 is a system that sets position information D (described below) shown in Figure 3. The position information setting system 1 makes it possible to use the position information D that was set before the work machine 10 moved, even after the work machine 10 has moved (even if the standing position has shifted). In this embodiment, the position information setting system 1 makes it possible to use the old position information D1 that was set when the work machine 10 was located at the old position P1, as new position information D2 when the work machine 10 is located at the new position P2. The position information setting system 1 comprises the work machine 10, an attitude sensor 21 shown in Figure 2, a travel sensor 23, a feature detection device 25, a controller 30, and an alarm unit 80.
作業機械10は、図1に示すように、作業を行う機械であり、例えば建設作業を行う建設機械であり、例えばショベルでもよく、クレーンでもよい。以下では、作業機械10がショベルである場合について説明する。作業機械10は、機械本体10aと、アタッチメント15と、を備える。 As shown in FIG. 1, the work machine 10 is a machine that performs work, such as a construction machine that performs construction work, and may be, for example, a shovel or a crane. The following describes a case in which the work machine 10 is a shovel. The work machine 10 comprises a machine body 10a and an attachment 15.
機械本体10aは、作業機械10の本体部であり、下部走行体11と、上部旋回体13と、を備える。下部走行体11は、作業機械10を走行させる。下部走行体11は、例えばクローラを備える。上部旋回体13は、下部走行体11に旋回可能に搭載される。下部走行体11に対する上部旋回体13の回転軸を旋回中心13aとする。上部旋回体13は、運転室13cを備える。運転室13cは、操作者が作業機械10を操作することが可能な部分である。作業機械10は、運転室13c内の操作者により操作されなくてもよく、遠隔操作されてもよく、自動運転されてもよい。 The machine body 10a is the main body of the work machine 10 and includes a lower traveling body 11 and an upper rotating body 13. The lower traveling body 11 allows the work machine 10 to travel. The lower traveling body 11 includes, for example, crawlers. The upper rotating body 13 is rotatably mounted on the lower traveling body 11. The axis of rotation of the upper rotating body 13 relative to the lower traveling body 11 is the rotation center 13a. The upper rotating body 13 includes a cab 13c. The cab 13c is the part where an operator can operate the work machine 10. The work machine 10 does not have to be operated by an operator in the cab 13c, and may be remotely controlled or automatically operated.
アタッチメント15は、作業を行う部分であり、例えば、ブーム15bと、アーム15cと、先端アタッチメント15dと、を備える。ブーム15bは、上部旋回体13に起伏可能(上下方向に回転可能)に取り付けられる。アーム15cは、ブーム15bに対して回転可能に取り付けられる。先端アタッチメント15dは、アタッチメント15の先端部に設けられ、アーム15cに回転可能に取り付けられる。先端アタッチメント15dは、例えば土砂をすくうバケットでもよく、物を挟む装置(グラップルなど)でもよく、破砕や掘削などを行う装置(ブレーカなど)でもよい。アタッチメント15の特定の部位を、特定部位15eとする。特定部位15eは、図1に示す例では先端アタッチメント15dの先端部であり、先端アタッチメント15dの先端部でなくてもよく、例えばアーム15cの先端部などでもよい。 The attachment 15 is the part that performs work and includes, for example, a boom 15b, an arm 15c, and a tip attachment 15d. The boom 15b is attached to the upper rotating body 13 so that it can be raised and lowered (rotated up and down). The arm 15c is rotatably attached to the boom 15b. The tip attachment 15d is provided at the tip of the attachment 15 and rotatably attached to the arm 15c. The tip attachment 15d may be, for example, a bucket for scooping soil and sand, a device for clamping objects (such as a grapple), or a device for crushing or excavating (such as a breaker). A specific part of the attachment 15 is referred to as the specific part 15e. In the example shown in Figure 1, the specific part 15e is the tip of the tip attachment 15d, but it does not have to be the tip of the tip attachment 15d; it may be, for example, the tip of the arm 15c.
姿勢センサ21は、作業機械10の姿勢を検出する。姿勢センサ21は、下部走行体11に対する上部旋回体13の旋回角度、およびアタッチメント15の姿勢を検出する。具体的には例えば、姿勢センサ21は、旋回センサ21aと、ブームセンサ21bと、アームセンサ21cと、先端アタッチメントセンサ21dと、を備える。 The attitude sensor 21 detects the attitude of the work machine 10. The attitude sensor 21 detects the rotation angle of the upper rotating body 13 relative to the lower traveling body 11, and the attitude of the attachment 15. Specifically, for example, the attitude sensor 21 includes a rotation sensor 21a, a boom sensor 21b, an arm sensor 21c, and a tip attachment sensor 21d.
旋回センサ21aは、上部旋回体13の姿勢(角度、向き)を検出する。例えば、旋回センサ21aは、下部走行体11に対する上部旋回体13の旋回角度を検出する。旋回センサ21aは、下部走行体11に対する上部旋回体13の回転軸や回転支持部などに取り付けられる角度センサを備えてもよい。旋回センサ21aは、二次元画像および距離画像(後述)の少なくともいずれかに基づいて上部旋回体13の姿勢を検出するものでもよい。この場合、二次元画像および距離画像の少なくともいずれかは、特徴物検出装置25により撮像されてもよい(ブームセンサ21b、アームセンサ21c、先端アタッチメントセンサ21d、走行センサ23についても同様)。 The rotation sensor 21a detects the attitude (angle, direction) of the upper rotating body 13. For example, the rotation sensor 21a detects the rotation angle of the upper rotating body 13 relative to the lower running body 11. The rotation sensor 21a may include an angle sensor attached to the rotation axis or rotation support part of the upper rotating body 13 relative to the lower running body 11. The rotation sensor 21a may detect the attitude of the upper rotating body 13 based on at least one of a two-dimensional image and a distance image (described below). In this case, at least one of the two-dimensional image and the distance image may be captured by the feature detection device 25 (the same applies to the boom sensor 21b, arm sensor 21c, tip attachment sensor 21d, and travel sensor 23).
ブームセンサ21bは、ブーム15bの姿勢を検出する。例えば、ブームセンサ21bは、上部旋回体13に対するブーム15bの回転角度を検出する。ブームセンサ21bは、水平面に対するブーム15bの角度を検出する傾斜センサ(ジャイロセンサ、加速度センサ、慣性計測装置など)を備えてもよい(アームセンサ21cおよび先端アタッチメントセンサ21dも同様)。ブームセンサ21bは、上部旋回体13に対するブーム15bの回転軸や回転支持部に取り付けられる角度センサ(例えばロータリエンコーダなど)を備えてもよい(アームセンサ21cおよび先端アタッチメントセンサ21dも同様)。ブームセンサ21bは、ブーム15bを駆動するシリンダ(ブームシリンダ)のストロークを検出するストロークセンサを備えてもよい(アームセンサ21cおよび先端アタッチメントセンサ21dも同様)。ブームセンサ21bは、二次元画像および距離画像(後述)の少なくともいずれかに基づいてブーム15bの姿勢を検出するものでもよい(アームセンサ21cおよび先端アタッチメントセンサ21dも同様)。 The boom sensor 21b detects the attitude of the boom 15b. For example, the boom sensor 21b detects the rotation angle of the boom 15b relative to the upper rotating structure 13. The boom sensor 21b may include an inclination sensor (such as a gyro sensor, acceleration sensor, or inertial measurement unit) that detects the angle of the boom 15b relative to the horizontal plane (the same applies to the arm sensor 21c and the tip attachment sensor 21d). The boom sensor 21b may include an angle sensor (such as a rotary encoder) attached to the rotation axis or rotation support of the boom 15b relative to the upper rotating structure 13 (the same applies to the arm sensor 21c and the tip attachment sensor 21d). The boom sensor 21b may include a stroke sensor that detects the stroke of the cylinder (boom cylinder) that drives the boom 15b (the same applies to the arm sensor 21c and the tip attachment sensor 21d). The boom sensor 21b may detect the attitude of the boom 15b based on at least one of a two-dimensional image and a distance image (described below) (the same applies to the arm sensor 21c and the tip attachment sensor 21d).
アームセンサ21cは、アーム15cの姿勢を検出する。例えば、アームセンサ21cは、ブーム15bに対するアーム15cの回転角度を検出する。先端アタッチメントセンサ21dは、先端アタッチメント15dの姿勢を検出する。例えば、先端アタッチメントセンサ21dは、アーム15cに対する先端アタッチメント15dの回転角度を検出する。 The arm sensor 21c detects the posture of the arm 15c. For example, the arm sensor 21c detects the rotation angle of the arm 15c relative to the boom 15b. The tip attachment sensor 21d detects the posture of the tip attachment 15d. For example, the tip attachment sensor 21d detects the rotation angle of the tip attachment 15d relative to the arm 15c.
走行センサ23(図2参照)は、下部走行体11の走行を検出する。走行センサ23は、下部走行体11を駆動するモータ(走行モータ)の作動を検出してもよい。走行センサ23は、走行モータを駆動させるための指令を検出してもよい。走行センサ23は、二次元画像および距離画像(後述)の少なくともいずれかに基づいて、下部走行体11の走行を検出してもよい。 The travel sensor 23 (see Figure 2) detects the travel of the lower running structure 11. The travel sensor 23 may detect the operation of a motor (travel motor) that drives the lower running structure 11. The travel sensor 23 may also detect a command to drive the travel motor. The travel sensor 23 may detect the travel of the lower running structure 11 based on at least one of a two-dimensional image and a distance image (described below).
特徴物検出装置25は、作業機械10の周囲の特徴物を検出する。特徴物検出装置25は、作業機械10の姿勢を検出してもよい(姿勢センサ21でもよい)。特徴物検出装置25は、検出対象物(例えば、特徴物、作業機械10など)を撮像する撮像装置である。特徴物検出装置25は、検出対象物の二次元情報(例えば二次元画像における位置、形状など)を検出してもよい。特徴物検出装置25は、二次元の情報を検出するカメラ(単眼カメラ)を備えてもよい。特徴物検出装置25は、検出対象物の三次元情報(例えば三次元座標、三次元形状など)を検出してもよく、距離の情報(奥行きの情報)を有する画像(距離画像)を取得してもよい。特徴物検出装置25は、レーザー光を用いて三次元の情報を検出する装置を備えてもよく、例えばLIDAR(Light Detection and Ranging)を備えてもよく、例えばTOF(Time Of Flight)センサを備えてもよい。特徴物検出装置25は、電波を用いて三次元の情報を検出する装置(例えばミリ波レーダなど)を備えてもよい。特徴物検出装置25は、ステレオカメラを備えてもよい。特徴物検出装置25は、距離画像と二次元画像とに基づいて、検出対象物の三次元情報を検出してもよい。特徴物検出装置25は、1つのみ設けられてもよく、複数設けられてもよい。特徴物検出装置25は、作業機械10に搭載されてもよく、作業機械10の外部に配置されてもよい。 The feature detection device 25 detects features around the work machine 10. The feature detection device 25 may detect the attitude of the work machine 10 (or may be the attitude sensor 21). The feature detection device 25 is an imaging device that captures images of the detection target (e.g., feature, work machine 10, etc.). The feature detection device 25 may detect two-dimensional information of the detection target (e.g., position, shape, etc. in a two-dimensional image). The feature detection device 25 may be equipped with a camera (monocular camera) that detects two-dimensional information. The feature detection device 25 may detect three-dimensional information of the detection target (e.g., three-dimensional coordinates, three-dimensional shape, etc.), or may acquire an image (distance image) containing distance information (depth information). The feature detection device 25 may be equipped with a device that detects three-dimensional information using laser light, such as a LIDAR (Light Detection and Ranging) sensor, or a TOF (Time Of Flight) sensor. The feature detection device 25 may be equipped with a device that detects three-dimensional information using radio waves (such as millimeter-wave radar). The feature detection device 25 may be equipped with a stereo camera. The feature detection device 25 may detect three-dimensional information of the detection target based on a range image and a two-dimensional image. Only one feature detection device 25 may be provided, or multiple feature detection devices 25 may be provided. The feature detection device 25 may be mounted on the work machine 10, or may be located external to the work machine 10.
コントローラ30(図2参照)は、信号の入出力、演算(処理)、情報の記憶などを行うコンピュータである。例えば、図2に示すコントローラ30の機能は、記憶装置に記憶されたプログラムが演算装置で実行されることにより実現される。コントローラ30は、1つの装置でもよく、複数の装置でもよい。コントローラ30は、作業機械10に搭載されてもよく、作業機械10の外部に配置されてもよい。コントローラ30は、作業機械10(図1参照)の作動を制御する装置を含んでもよく、作業機械10を自動運転させる制御を行ってもよい。コントローラ30は、運転室13c(図1参照)内に配置されてもよく、作業機械10の外部の携帯端末(タブレットなど)に設けられてもよく、作業機械10の外部のサーバなどに設けられてもよい。コントローラ30は、特定部位位置演算部41と、旧基準位置設定部51と、旧位置情報設定部53(位置情報設定部)と、記憶部55と、新基準位置設定部61と、新位置情報設定部63(位置情報設定部)と、報知制御部71と、を備える。 The controller 30 (see Figure 2) is a computer that performs signal input/output, calculations (processing), information storage, etc. For example, the functions of the controller 30 shown in Figure 2 are realized by a calculation device executing a program stored in a storage device. The controller 30 may be a single device or multiple devices. The controller 30 may be mounted on the work machine 10 or may be located external to the work machine 10. The controller 30 may include a device that controls the operation of the work machine 10 (see Figure 1), and may control the automatic operation of the work machine 10. The controller 30 may be located in the cab 13c (see Figure 1), or may be provided on a mobile terminal (such as a tablet) external to the work machine 10, or on a server external to the work machine 10. The controller 30 includes a specific body part position calculation unit 41, a previous reference position setting unit 51, a previous position information setting unit 53 (position information setting unit), a memory unit 55, a new reference position setting unit 61, a new position information setting unit 63 (position information setting unit), and a notification control unit 71.
特定部位位置演算部41は、姿勢センサ21の検出結果に基づいて、特定部位15e(図1参照)の位置(座標)を演算する。 The specific body part position calculation unit 41 calculates the position (coordinates) of the specific body part 15e (see Figure 1) based on the detection results of the posture sensor 21.
旧基準位置設定部51は、図3に示す作業機械10が旧位置P1に配置されたときの所定の基準位置R(旧基準位置R1)を設定する(詳細は後述)。旧位置情報設定部53(図2参照)(位置情報設定部)は、作業機械10が旧位置P1に配置されたときに位置情報D(旧位置情報D1)を設定する(詳細は後述)。記憶部55(図2参照)は、各種情報を記憶する。例えば、記憶部55は、旧基準位置R1および旧位置情報D1を記憶する(詳細は後述)。記憶部55は、新基準位置R2を記憶してもよい。新基準位置設定部61(図2参照)は、作業機械10が新位置P2に配置されたときの基準位置R(新基準位置R2)を設定する(詳細は後述)。新位置情報設定部63(図2参照)(位置情報設定部)は、作業機械10が新位置P2に配置されたときの位置情報D(新位置情報D2)を演算(設定)する(詳細は後述)。図2に示す報知制御部71は、報知に関する制御(後述)を行う。 The old reference position setting unit 51 sets a predetermined reference position R (old reference position R1) when the work machine 10 shown in Figure 3 is located at the old position P1 (details will be described later). The old position information setting unit 53 (see Figure 2) (position information setting unit) sets position information D (old position information D1) when the work machine 10 is located at the old position P1 (details will be described later). The memory unit 55 (see Figure 2) stores various information. For example, the memory unit 55 stores the old reference position R1 and old position information D1 (details will be described later). The memory unit 55 may also store a new reference position R2. The new reference position setting unit 61 (see Figure 2) sets a reference position R (new reference position R2) when the work machine 10 is located at the new position P2 (details will be described later). The new position information setting unit 63 (see Figure 2) (position information setting unit) calculates (sets) position information D (new position information D2) when the work machine 10 is located at the new position P2 (details will be described later). The notification control unit 71 shown in Figure 2 controls notifications (described below).
報知部80(第1報知部、第2報知部)は、作業者に対して報知を行う。報知部80は、光(表示含む)による報知を行ってもよく、音(音声、警告音など)による報知を行ってもよく、振動による報知を行ってもよい。具体的には例えば、報知部80は、携帯端末(例えば、タブレット、スマートフォンなど)でもよく、運転室13c内の表示機やスピーカでもよく、作業機械10の遠隔操作を行うためのモニタやスピーカなどでもよい。報知部80による報知の内容については後述する。 The notification unit 80 (first notification unit, second notification unit) notifies the operator. The notification unit 80 may notify by light (including display), sound (voice, warning sound, etc.), or vibration. Specifically, for example, the notification unit 80 may be a mobile terminal (e.g., tablet, smartphone, etc.), a display and speaker in the operator's cab 13c, or a monitor and speaker for remotely operating the work machine 10. The content of the notification by the notification unit 80 will be described later.
(作動)
本実施形態の位置情報設定システム1は、次のように作動するように構成される。以下では、図4に示す各ステップ(S11~S32)については図4を参照して説明する。図3に示すように、作業機械10が旧位置P1に配置されているときに、旧基準位置設定部51(図2参照)が旧基準位置R1を設定し(ステップS11)、旧位置情報設定部53(図2参照)が旧位置情報D1を設定する(ステップS12、S13)。その後、作業機械10が、旧位置P1から新位置P2に移動する(ステップS20)。作業機械10が新位置P2に配置されているときに、新基準位置設定部61(図2参照)が新基準位置R2を設定する(ステップS21)。そして、新位置情報設定部63(図2参照)が、旧位置情報D1、旧基準位置R1、および新基準位置R2に基づいて、新位置情報D2を演算する(ステップS22、S31、S32)。位置情報設定システム1の作動の詳細は、次の通りである。
(Operation)
The position information setting system 1 of this embodiment is configured to operate as follows. Each step (S11 to S32) shown in FIG. 4 will be described below with reference to FIG. 4. As shown in FIG. 3, when the work machine 10 is located at the old position P1, the old reference position setting unit 51 (see FIG. 2) sets the old reference position R1 (step S11), and the old position information setting unit 53 (see FIG. 2) sets the old position information D1 (steps S12 and S13). The work machine 10 then moves from the old position P1 to the new position P2 (step S20). When the work machine 10 is located at the new position P2, the new reference position setting unit 61 (see FIG. 2) sets the new reference position R2 (step S21). Then, the new position information setting unit 63 (see FIG. 2) calculates the new position information D2 based on the old position information D1, the old reference position R1, and the new reference position R2 (steps S22, S31, and S32). Details of the operation of the position information setting system 1 are as follows.
(機械座標系)
図3に示す特定部位15eの位置、旧基準位置R1、新基準位置R2、旧位置情報D1、および新位置情報D2のそれぞれは、機械座標系で表される。機械座標系は、作業機械10を基準とした座標系であり、さらに詳しくは、上部旋回体13を基準とした座標系である。例えば、機械座標系の原点の位置は、旋回中心13a上に設定される。機械座標系の原点の位置は、例えば、上部旋回体13の高さ方向における所定の位置(例えば上部旋回体13の底面の位置)などに設定される(図1参照)。旧位置P1および新位置P2のそれぞれは、機械座標系の原点の位置である。さらに詳しくは、「作業機械10が旧位置P1に配置されている」ことは、作業現場における旧位置P1に、機械座標系の原点が配置されていることを意味する(新位置P2も同様)。
(machine coordinate system)
The position of the specific portion 15e shown in Figure 3, the old reference position R1, the new reference position R2, the old position information D1, and the new position information D2 are each expressed in a machine coordinate system. The machine coordinate system is a coordinate system based on the work machine 10, and more specifically, a coordinate system based on the upper rotating body 13. For example, the position of the origin of the machine coordinate system is set on the center of rotation 13a. The position of the origin of the machine coordinate system is set, for example, at a predetermined position in the height direction of the upper rotating body 13 (for example, the position of the bottom surface of the upper rotating body 13) (see Figure 1). The old position P1 and the new position P2 are each the position of the origin of the machine coordinate system. More specifically, "the work machine 10 is located at the old position P1" means that the origin of the machine coordinate system is located at the old position P1 at the work site (the same applies to the new position P2).
具体的には例えば、図1に示すように、機械座標系におけるZ軸は、旋回中心13aの軸が延びる方向である。機械座標系におけるY軸は、Z軸に直交する方向であって、上部旋回体13からアタッチメント15が突出する方向(上部旋回体13の前後方向)である。図3に示すように、機械座標系におけるX軸は、Z軸およびY軸に直交する方向(上部旋回体13の幅方向)である。なお、機械座標系は、直交座標系である必要はない。例えば、機械座標系は、円筒座標系でもよく、旋回中心13aを中心とする円周に沿った方向(旋回方向)の座標軸を含んでもよい。 Specifically, for example, as shown in FIG. 1, the Z axis in the machine coordinate system is the direction in which the axis of the swivel center 13a extends. The Y axis in the machine coordinate system is a direction perpendicular to the Z axis and is the direction in which the attachment 15 protrudes from the upper rotating body 13 (the front-to-rear direction of the upper rotating body 13). As shown in FIG. 3, the X axis in the machine coordinate system is a direction perpendicular to the Z axis and Y axis (the width direction of the upper rotating body 13). Note that the machine coordinate system does not have to be a Cartesian coordinate system. For example, the machine coordinate system may be a cylindrical coordinate system, or may include a coordinate axis in a direction along the circumference of a circle centered on the swivel center 13a (the swivel direction).
(基準位置R)
位置情報設定システム1では、基準位置Rが設定される。基準位置Rは、作業機械10の外部(作業現場)の、所定の位置である。基準位置Rは、作業現場に対して移動しない。さらに詳しくは、作業現場に対して作業機械10が移動しても、基準位置Rは、作業現場に対して移動しない。「作業現場」は、作業機械10の外部であって、作業機械10が配置されている現場(場所)である。なお、「作業現場」で作業が行われる必要はない。基準位置Rは、互いに異なる複数の点を含む。基準位置Rは、2点設定されてもよく、3点以上設定されてもよい。具体的には例えば、基準位置Rは、第1の基準位置Raと、第2の基準位置Rbと、を含む。基準位置Rには、旧基準位置R1と、新基準位置R2と、がある。旧基準位置R1は、作業機械10が旧位置P1に配置されたときの機械座標系で表される基準位置Rの情報(具体的には座標)である。新基準位置R2は、作業機械10が新位置P2に配置されたときの機械座標系で表される基準位置Rの情報(具体的には座標)である。
(Reference position R)
In the position information setting system 1, a reference position R is set. The reference position R is a predetermined position outside the work machine 10 (work site). The reference position R does not move relative to the work site. More specifically, even if the work machine 10 moves relative to the work site, the reference position R does not move relative to the work site. The "work site" is a site (location) outside the work machine 10 where the work machine 10 is located. It is not necessary for work to be performed at the "work site." The reference position R includes a plurality of points that are different from one another. Two points may be set as the reference position R, or three or more points may be set as the reference position R. Specifically, for example, the reference position R includes a first reference position Ra and a second reference position Rb. The reference position R includes an old reference position R1 and a new reference position R2. The old reference position R1 is information (specifically, coordinates) of the reference position R expressed in the machine coordinate system when the work machine 10 was located at the old position P1. The new reference position R2 is information (specifically, coordinates) of the reference position R expressed in the machine coordinate system when the work machine 10 is placed at the new position P2.
(旧基準位置R1)
旧基準位置設定部51(図2参照)は、旧基準位置R1を設定(決定)する(図4のステップS11)。旧基準位置設定部51に設定された旧基準位置R1は、記憶部55(図2参照)に記憶される。記憶部55に記憶されることは、旧位置情報設定部53(図2参照)に設定される旧位置情報D1、および新基準位置設定部61(図2参照)に設定される新基準位置R2についても同様である。旧基準位置R1の設定は、例えば、1日の中での作業機械10による作業の開始時(始業時)に行われてもよく、新たな作業現場での作業機械10の作業開始時に行われてもよく、作業機械10が新たな作業計画に従って新たな作業を開始するときに行われてもよい。
(Old reference position R1)
The old reference position setting unit 51 (see FIG. 2) sets (determines) the old reference position R1 (step S11 in FIG. 4). The old reference position R1 set in the old reference position setting unit 51 is stored in the memory unit 55 (see FIG. 2). The old position information D1 set in the old position information setting unit 53 (see FIG. 2) and the new reference position R2 set in the new reference position setting unit 61 (see FIG. 2) are also stored in the memory unit 55. The old reference position R1 may be set, for example, at the start of work by the work machine 10 in a day (at the start of work), or when the work machine 10 starts work at a new work site, or when the work machine 10 starts new work in accordance with a new work plan.
(旧基準位置R1の具体的設定方法)
旧基準位置R1は、様々な方法により設定可能である。例えば、旧基準位置R1は、ティーチングに基づいて設定されてもよく(下記[例1a]参照)、ティーチング以外の手動の入力操作に基づいて設定されてもよい(下記[例1b]参照)。旧基準位置R1は、特徴物検出装置25の検出結果に基づいて設定されてもよい(下記[例1c]参照)。
(Specific Method for Setting Old Reference Position R1)
The old reference position R1 can be set by various methods. For example, the old reference position R1 may be set based on teaching (see Example 1a below), or may be set based on a manual input operation other than teaching (see Example 1b below). The old reference position R1 may also be set based on the detection result of the feature detection device 25 (see Example 1c below).
[例1a]旧基準位置R1は、ティーチングに基づいて設定されてもよい。さらに詳しくは、旧基準位置設定部51(図2参照)は、アタッチメント15の特定部位15eが基準位置Rに配置されたときの姿勢センサ21(図2参照)の検出結果に基づいて、旧基準位置R1を設定してもよい。具体的には例えば、ティーチングは、次のように行われる。作業者(オペレータ)が作業機械10に搭乗して作業機械10を操作する、または、作業者が作業機械10を遠隔操作する。作業者は、作業機械10を操作することで、特定部位15eを基準位置Rに配置させる(基準位置Rに合わせる)。例えば、この状態で、作業者は、決定操作を行う。特定部位位置演算部41(図2参照)は、特定部位15eが基準位置Rに配置されたときの姿勢センサ21の検出結果に基づいて、特定部位15eの位置を算出する。旧基準位置設定部51(図2参照)は、特定部位15eの位置に基づいて、旧基準位置R1を設定する。設定された旧基準位置R1は、記憶部55(図2参照)に記憶される。基準位置Rが複数設定される場合、複数の基準位置Rのそれぞれ(第1の基準位置Ra、および第2の基準位置Rbのそれぞれ)が、ティーチングにより旧基準位置R1として設定される。 [Example 1a] The old reference position R1 may be set based on teaching. More specifically, the old reference position setting unit 51 (see FIG. 2) may set the old reference position R1 based on the detection results of the attitude sensor 21 (see FIG. 2) when the specific part 15e of the attachment 15 is positioned at the reference position R. Specifically, for example, teaching is performed as follows: The worker (operator) rides on the work machine 10 and operates the work machine 10, or the worker remotely operates the work machine 10. The worker operates the work machine 10 to position the specific part 15e at the reference position R (align it with the reference position R). For example, in this state, the worker performs a confirm operation. The specific part position calculation unit 41 (see FIG. 2) calculates the position of the specific part 15e based on the detection results of the attitude sensor 21 when the specific part 15e is positioned at the reference position R. The old reference position setting unit 51 (see FIG. 2) sets the old reference position R1 based on the position of the specific part 15e. The set old reference position R1 is stored in the memory unit 55 (see Figure 2). If multiple reference positions R are set, each of the multiple reference positions R (first reference position Ra and second reference position Rb) is set as the old reference position R1 by teaching.
[例1b]旧基準位置R1は、ティーチング以外の作業者の手動の入力操作に基づいて設定されてもよい。この「入力操作」は、例えば、作業機械10の外部の装置(例えばタブレット、遠隔操作装置など)により行われてもよく、例えば作業機械10の内部(例えば運転室13c内)の装置により行われてもよい。この「入力操作」は、具体的には例えば、画面に表示された作業現場の画像や図形から基準位置Rの位置を指定する操作(タッチ操作やカーソル操作など)でもよく、基準位置Rの座標を数値入力する操作などでもよい。 [Example 1b] The old reference position R1 may be set based on a manual input operation by an operator other than teaching. This "input operation" may be performed, for example, by a device external to the work machine 10 (e.g., a tablet, remote control device, etc.), or by a device inside the work machine 10 (e.g., inside the cab 13c). Specifically, this "input operation" may be, for example, an operation to specify the position of the reference position R from an image or graphic of the work site displayed on a screen (e.g., a touch operation or cursor operation), or an operation to input the coordinates of the reference position R numerically.
[例1c]旧基準位置R1は、特徴物検出装置25の検出結果に基づいて設定されてもよい。旧基準位置設定部51(図2参照)は、特徴物検出装置25の検出結果に基づいて旧基準位置R1を設定してもよい。この設定の具体例は、例えば次の通りである。[例1c-1]例えば、予め(特徴物検出装置25による検出よりも前に)、作業現場の基準位置Rに目印(マーカー)が設けられる。目印は、特定の色彩、形状、模様などを有するものなどであり、具体的には例えばAR(Augmented Reality)マーカーなどである。特徴物検出装置25は、この目印の位置を検出する。そして、旧基準位置設定部51(図2参照)は、特徴物検出装置25に検出された目印の位置を、旧基準位置R1として設定してもよい。[例1c-2]例えば、特徴物検出装置25は、作業現場に存在する物の形状(現場形状)を検出(学習)する。特徴物検出装置25は、検出した形状から、特徴点(例えば物体の角など)を抽出する。そして、旧基準位置設定部51(図2参照)は、特徴物検出装置25が抽出した特徴点の位置を、旧基準位置R1として設定してもよい。特徴物検出装置25に検出される物は、例えば、障害物Oの一部の点でもよく、壁、ブロック、柱などの一部の点でもよい。 [Example 1c] The old reference position R1 may be set based on the detection results of the feature detection device 25. The old reference position setting unit 51 (see Figure 2) may set the old reference position R1 based on the detection results of the feature detection device 25. Specific examples of this setting are as follows: [Example 1c-1] For example, a marker is set at the reference position R of the work site in advance (before detection by the feature detection device 25). The marker may have a specific color, shape, pattern, etc., and specifically, may be an AR (Augmented Reality) marker, for example. The feature detection device 25 detects the position of this marker. Then, the old reference position setting unit 51 (see Figure 2) may set the position of the marker detected by the feature detection device 25 as the old reference position R1. [Example 1c-2] For example, the feature detection device 25 detects (learns) the shapes of objects present at the work site (site shape). The feature detection device 25 extracts feature points (such as the corners of an object) from the detected shape. The old reference position setting unit 51 (see FIG. 2) may then set the positions of the feature points extracted by the feature detection device 25 as the old reference position R1. The object detected by the feature detection device 25 may be, for example, a partial point of an obstacle O, or a partial point of a wall, block, pillar, etc.
(間隔Ri)
基準位置Rが複数設けられる場合、複数の基準位置Rどうしの間隔Riが広いほど、ティーチングによる旧基準位置R1の設定の精度、または、特徴物検出装置25の検出結果に基づく旧基準位置R1の設定の精度が向上する。間隔Riが広いほど、基準位置Rの現実の座標に対する、旧基準位置設定部51(図2参照)に設定された旧基準位置R1の座標の差異(誤差)が小さくなる。間隔Riは、具体的には、第1の基準位置Raと、第2の基準位置Rbと、の距離である。
(Interval Ri)
When multiple reference positions R are provided, the wider the interval Ri between the multiple reference positions R, the more accurate the setting of the old reference position R1 by teaching or the setting of the old reference position R1 based on the detection results of the feature detection device 25. The wider the interval Ri, the smaller the difference (error) between the actual coordinates of the reference position R and the coordinates of the old reference position R1 set in the old reference position setting unit 51 (see FIG. 2 ). Specifically, the interval Ri is the distance between the first reference position Ra and the second reference position Rb.
例えば、旧基準位置設定部51(図2参照)は、間隔Riが、所定の間隔閾値よりも狭い場合、旧基準位置R1を設定しなくてもよく、報知部80(図2参照)に報知を行わせてもよい。上記「間隔閾値」は、コントローラ30(図2参照)に予め(旧基準位置R1の設定前に)設定される。 For example, if the interval Ri is narrower than a predetermined interval threshold, the old reference position setting unit 51 (see FIG. 2) may not set the old reference position R1 and may cause the notification unit 80 (see FIG. 2) to issue a notification. The "interval threshold" is set in advance (before the old reference position R1 is set) in the controller 30 (see FIG. 2).
[例2a]上記「間隔閾値」は、図1に示す作業機械10の構成要素の寸法に基づく大きさに設定されてもよい。例えば、間隔閾値は、ブーム15b、アーム15c、および先端アタッチメント15dの少なくともいずれかの寸法に基づく大きさ(例えばブーム15bの長さの所定値倍など)でもよい。 [Example 2a] The above-mentioned "distance threshold" may be set to a value based on the dimensions of the components of the work machine 10 shown in FIG. 1. For example, the distance threshold may be a value based on the dimensions of at least one of the boom 15b, arm 15c, and tip attachment 15d (e.g., a predetermined multiple of the length of the boom 15b).
[例2b]間隔閾値は、図3に示す作業機械10の作動範囲に基づく大きさに設定されてもよい。例えば、間隔閾値は、アタッチメント15がY軸方向に最も伸ばされた状態から最も縮められた状態までの先端アタッチメント15dのY軸方向における移動距離に基づく大きさ(例えば移動距離の所定値倍など)でもよい。 [Example 2b] The clearance threshold may be set to a magnitude based on the operating range of the work machine 10 shown in Figure 3. For example, the clearance threshold may be a magnitude based on the movement distance of the tip attachment 15d in the Y-axis direction from the most extended state to the most retracted state of the attachment 15 in the Y-axis direction (e.g., a predetermined multiple of the movement distance).
[例2c]間隔閾値は、下部走行体11に対する上部旋回体13の旋回角度により規定されてもよい。さらに詳しくは、間隔閾値は、アタッチメント15が第1の基準位置Raを向いたときから第2の基準位置Rbを向いたときまでの旋回角度差(具体的には例えば90度など)でもよい。 [Example 2c] The gap threshold may be defined by the swing angle of the upper swing body 13 relative to the lower running body 11. More specifically, the gap threshold may be the swing angle difference (specifically, for example, 90 degrees) between when the attachment 15 faces the first reference position Ra and when it faces the second reference position Rb.
[例2d]間隔閾値は、作業機械10の目標とする作業位置に関する距離に基づく大きさに設定されてもよい。例えば、間隔閾値は、作業機械10の目標掘削位置から目標排土位置までの距離に基づく大きさ(この距離の所定値倍など)でもよい。 [Example 2d] The interval threshold may be set to a magnitude based on the distance to the target work position of the work machine 10. For example, the interval threshold may be a magnitude based on the distance from the target excavation position of the work machine 10 to the target soil unloading position (e.g., a predetermined multiple of this distance).
[例2e]旧基準位置R1の設定よりも前に旧位置情報D1が設定されている場合は、間隔閾値は、旧位置情報D1の寸法に基づく大きさに設定されてもよい。例えば、間隔閾値は、作業範囲D13(後述)の辺の寸法に基づく大きさ(辺の寸法の所定値倍など)でもよい。例えば、間隔閾値は、旧位置P1から前方制限D11y(後述)までの距離に基づく大きさ(距離の所定値倍など)でもよい。 [Example 2e] If the old position information D1 is set before the old reference position R1 is set, the interval threshold may be set to a size based on the dimensions of the old position information D1. For example, the interval threshold may be a size based on the dimensions of the sides of the work range D13 (described below) (e.g., a predetermined multiple of the side dimensions). For example, the interval threshold may be a size based on the distance from the old position P1 to the forward limit D11y (described below) (e.g., a predetermined multiple of the distance).
(位置情報D)
位置情報Dは、作業機械10に関する位置の情報である。位置情報Dには、旧位置情報D1と、新位置情報D2と、がある。旧位置情報D1は、作業機械10が旧位置P1に配置されたときの機械座標系で表される位置情報Dの情報(例えば座標など)である。新位置情報D2は、作業機械10が新位置P2に配置されたときの機械座標系で表される位置情報Dの情報(例えば座標など)である。具体的には例えば、位置情報Dは、作業機械10の作動(例えば作業など)に関する位置の情報などである。
(location information D)
The position information D is position information related to the work machine 10. The position information D includes old position information D1 and new position information D2. The old position information D1 is information (e.g., coordinates) of the position information D expressed in a machine coordinate system when the work machine 10 was located at the old position P1. The new position information D2 is information (e.g., coordinates) of the position information D expressed in a machine coordinate system when the work machine 10 was located at the new position P2. Specifically, for example, the position information D is position information related to the operation (e.g., work) of the work machine 10.
[例3a]位置情報Dは、作業機械10の作業を制限する範囲である作業制限範囲D11の情報でもよい。作業制限範囲D11は、例えば、特定部位15eの侵入を制限する範囲でもよく、アタッチメント15の侵入を制限する範囲でもよい。位置情報Dが作業制限範囲D11である場合は、位置情報設定システム1は、制限位置設定システムである。 [Example 3a] The position information D may be information on a work restriction range D11, which is a range that restricts the work of the work machine 10. The work restriction range D11 may be, for example, a range that restricts the entry of a specific part 15e, or a range that restricts the entry of an attachment 15. When the position information D is a work restriction range D11, the position information setting system 1 is a restricted position setting system.
[例3a1]作業制限範囲D11は、前方制限D11yを含んでもよい。[例3a1-1]前方制限D11yは、作業機械10が旧位置P1に配置されるとともに、作業機械10が(上部旋回体13が)所定の向きを向いているときの、Y軸方向に関する制限である。この場合、前方制限D11yは、上から見たときに直線状である。この前方制限D11yよりも前方(上部旋回体13から遠い側)での作業が、制限(例えば禁止)される。具体的には例えば、作業機械10を接触させたくない物体が存在する場合に、この物体よりも上部旋回体13側に、前方制限D11yが設定されてもよい。また、例えば、作業範囲D13(後述)の内部と外部との境界などに、前方制限D11yが設定されてもよい。[例3a1-2]前方制限D11yは、上から見たときに旋回中心13aを中心とした円弧状に設定されてもよい。 [Example 3a1] The work limit range D11 may include a forward limit D11y. [Example 3a1-1] The forward limit D11y is a limit in the Y-axis direction when the work machine 10 is located at the previous position P1 and the work machine 10 (the upper rotating body 13) is facing a specified direction. In this case, the forward limit D11y is linear when viewed from above. Work forward of this forward limit D11y (on the side farther from the upper rotating body 13) is restricted (e.g., prohibited). Specifically, for example, if there is an object that you do not want the work machine 10 to come into contact with, the forward limit D11y may be set closer to the upper rotating body 13 than this object. Furthermore, for example, the forward limit D11y may be set at the boundary between the inside and outside of the work range D13 (described below). [Example 3a1-2] The forward limit D11y may be set in the shape of an arc centered on the rotation center 13a when viewed from above.
[例3a2]作業制限範囲D11は、旋回制限D11θを含んでもよい。旋回制限D11θは、作業機械10が旧位置P1に配置されているときの、下部走行体11に対する上部旋回体13の旋回角度に関する制限である。具体的には例えば、図3に示す例では、旋回制限D11θを超えて上部旋回体13が旋回する(図3では右旋回する)と、アタッチメント15が障害物Oに接触する場合がある。そこで、旋回制限D11θは、アタッチメント15の障害物Oへの接触を抑制できるような位置に設定される。 [Example 3a2] The work limit range D11 may include a swing limit D11θ. The swing limit D11θ is a limit on the swing angle of the upper swing unit 13 relative to the lower running unit 11 when the work machine 10 is located at the previous position P1. Specifically, in the example shown in Figure 3, if the upper swing unit 13 swings beyond the swing limit D11θ (turns right in Figure 3), the attachment 15 may come into contact with the obstacle O. Therefore, the swing limit D11θ is set to a position that prevents the attachment 15 from coming into contact with the obstacle O.
[例3b]位置情報Dは、作業機械10が作業を行う範囲である作業範囲D13の情報を含んでもよい。さらに詳しくは、コントローラ30(図2参照)は、作業範囲D13内の作業対象物(例えば土)に対して作業を行うように、作業機械10を自動運転させる場合がある。この作業範囲D13が、位置情報Dに含まれてもよい。 [Example 3b] The position information D may include information on a work range D13, which is the range within which the work machine 10 performs work. More specifically, the controller 30 (see FIG. 2) may automatically operate the work machine 10 so that it performs work on a work object (e.g., soil) within the work range D13. This work range D13 may be included in the position information D.
[例3c]位置情報Dは、アタッチメント15(特定部位15e)の目標経路の情報を含んでもよい。さらに詳しくは、コントローラ30(図2参照)は、コントローラ30に設定された目標経路に従ってアタッチメント15(例えば特定部位15e)が移動するように、作業機械10を自動運転させる場合がある。この目標経路が、位置情報Dに含まれてもよい。 [Example 3c] The position information D may include information on the target route of the attachment 15 (specific part 15e). More specifically, the controller 30 (see FIG. 2) may automatically operate the work machine 10 so that the attachment 15 (e.g., specific part 15e) moves according to a target route set in the controller 30. This target route may be included in the position information D.
(旧位置情報D1)
旧位置情報設定部53(図2参照)は、旧位置情報D1を設定する(図4のステップS12、S13)。旧位置情報設定部53は、機械座標系で表した旧位置情報D1を設定する。なお、旧基準位置R1の設定(図4のステップS11)、および、旧位置情報D1の設定(図4のステップS12、S13)のどちらが先に行われてもよい。
(Old location information D1)
The old position information setting unit 53 (see FIG. 2) sets old position information D1 (steps S12 and S13 in FIG. 4). The old position information setting unit 53 sets old position information D1 expressed in the machine coordinate system. Note that either setting of the old reference position R1 (step S11 in FIG. 4) or setting of the old position information D1 (steps S12 and S13 in FIG. 4) may be performed first.
(旧位置情報D1の具体的設定方法)
旧位置情報D1は、様々な方法により設定可能である。旧位置情報D1は、位置情報用基準位置D0に基づいて設定されてもよい(下記[例4a]参照)(図4のステップS12)、旧位置情報D1は、位置情報用基準位置D0に基づくことなく設定されてもよい(下記[例4b]参照)。旧位置情報D1は、ティーチングに基づいて設定されてもよく(下記[例5a]参照)、ティーチング以外の手動の入力操作に基づいて設定されてもよい(下記[例5b]参照)。旧位置情報D1は、特徴物検出装置25の検出結果から設定されてもよい(下記[例5c]参照)。
(Specific Method of Setting Old Location Information D1)
The old position information D1 can be set by various methods. The old position information D1 may be set based on the position information reference position D0 (see Example 4a below) (step S12 in FIG. 4 ). The old position information D1 may be set without being based on the position information reference position D0 (see Example 4b below). The old position information D1 may be set based on teaching (see Example 5a below). The old position information D1 may be set based on a manual input operation other than teaching (see Example 5b below). The old position information D1 may be set from the detection results of the feature detection device 25 (see Example 5c below).
[例4a]旧位置情報D1は、位置情報用基準位置D0に基づいて設定されてもよい(図4のステップS12)。位置情報用基準位置D0は、位置情報Dを特定するための基準となる位置である。位置情報用基準位置D0は、1点のみ設定されてもよく、複数点設定されてもよい。例えば、位置情報用基準位置D0に基づいて、作業制限範囲D11が設定されてもよい。例えば、1点の位置情報用基準位置D0に基づいて、複数種類の作業制限範囲D11(具体的には例えば、前方制限D11yおよび旋回制限D11θ)が設定されてもよい。また、例えば、作業範囲D13が上から見て多角形である場合に、作業範囲D13の角の位置の情報に基づいて、作業範囲D13が設定されてもよい。具体的には例えば、作業範囲D13が上から見て四角形(例えば長方形)である場合に、作業範囲D13の角(例えば作業範囲D13の対角となる2点、または4点など)の位置の情報に基づいて、上から見て四角形の作業範囲D13が設定されてもよい。 [Example 4a] The old position information D1 may be set based on the position information reference position D0 (step S12 in FIG. 4). The position information reference position D0 is a reference position for identifying the position information D. The position information reference position D0 may be set to one point or multiple points. For example, the work limit range D11 may be set based on the position information reference position D0. For example, multiple types of work limit ranges D11 (specifically, a forward limit D11y and a turning limit D11θ) may be set based on a single position information reference position D0. Furthermore, for example, if the work range D13 is polygonal when viewed from above, the work range D13 may be set based on information about the positions of the corners of the work range D13. Specifically, for example, if the work range D13 is quadrangular (e.g., rectangular) when viewed from above, the quadrangular work range D13 may be set based on information about the positions of the corners of the work range D13 (e.g., two or four points that are diagonal corners of the work range D13).
[例4b]旧位置情報D1は、位置情報用基準位置D0に基づくことなく設定されてもよい。例えば、旧位置情報D1は、上から見た形状(平面形状)を表す二次元情報、立体形状を表す三次元情報、目標経路を表す複数点の情報などに基づいて、位置情報Dを設定してもよい。 [Example 4b] The old position information D1 may be set without being based on the position information reference position D0. For example, the old position information D1 may be set based on two-dimensional information representing the shape as seen from above (planar shape), three-dimensional information representing the three-dimensional shape, information on multiple points representing the target route, etc.
[例5a]旧位置情報D1は、ティーチングに基づいて設定されてもよい。[例5a1]例えば、位置情報用基準位置D0(上記[例4a]参照)が、ティーチングに基づいて設定されてもよい。この場合、特定部位位置演算部41(図2参照)は、特定部位15eが位置情報用基準位置D0に配置されたときの姿勢センサ21(図2参照)の検出結果に基づいて、位置情報用基準位置D0の位置を算出する。そして、旧位置情報設定部53(図2参照)は、位置情報用基準位置D0の位置に基づいて、旧位置情報D1を設定する(ティーチングの具体例は上記[例1a]を参照)。[例5a2]また、例えば、旧位置情報D1は、位置情報用基準位置D0に基づくことなく、ティーチングに基づいて設定されてもよい。具体的には例えば、旧位置情報D1が、アタッチメント15(特定部位15e)の目標経路である場合、目標経路である旧位置情報D1が、ティーチングに基づいて設定されてもよい。この場合、作業者は、アタッチメント15を操作することで、目標経路として設定したい経路に沿って特定部位15eを移動させる。そして、旧位置情報設定部53(図2参照)は、特定部位15eが移動したときの姿勢センサ21(図2参照)の検出結果に基づいて、旧位置情報D1である目標経路を設定する。 [Example 5a] The old position information D1 may be set based on teaching. [Example 5a1] For example, the position information reference position D0 (see Example 4a above) may be set based on teaching. In this case, the specific part position calculation unit 41 (see Figure 2) calculates the position of the position information reference position D0 based on the detection result of the posture sensor 21 (see Figure 2) when the specific part 15e is placed at the position information reference position D0. The old position information setting unit 53 (see Figure 2) then sets the old position information D1 based on the position information reference position D0 (see Example 1a above for a specific example of teaching). [Example 5a2] Furthermore, for example, the old position information D1 may be set based on teaching, without being based on the position information reference position D0. Specifically, for example, if the old position information D1 is a target route for the attachment 15 (specific part 15e), the old position information D1, which is the target route, may be set based on teaching. In this case, the worker operates the attachment 15 to move the specific part 15e along the route that they wish to set as the target route. The previous position information setting unit 53 (see Figure 2) then sets the target route, which is the previous position information D1, based on the detection results of the attitude sensor 21 (see Figure 2) when the specific part 15e moves.
[例5b]旧位置情報D1は、ティーチング以外の作業者の手動の入力操作に基づいて設定されてもよい(上記[例1b]を参照)。 [Example 5b] The previous position information D1 may be set based on manual input operations by the operator other than teaching (see [Example 1b] above).
[例5c]旧位置情報D1は、特徴物検出装置25の検出結果に基づいて設定されてもよい(上記[例1c]を参照)。 [Example 5c] The previous location information D1 may be set based on the detection results of the feature detection device 25 (see [Example 1c] above).
(作業機械10の移動)
旧位置情報D1および旧基準位置R1が設定された後に、作業機械10が、旧位置P1から新位置P2に移動する(図4のステップS20)。新位置P2は、旧位置P1とは異なる位置(作業現場における位置)である。新位置P2は、作業現場に対して下部走行体11が旧位置P1から移動(例えば走行)した後の、作業機械10の位置である。なお、作業現場に対して下部走行体11が旧位置P1から移動(例えば走行)しなければ、上部旋回体13の旋回およびアタッチメント15の作動の少なくともいずれかが行われても、作業機械10は旧位置P1に配置されたままである。また、作業機械10が、旧位置P1から複数回移動して現在の位置まで移動した場合、現在の作業機械10の位置が、新位置P2である。
(Movement of the work machine 10)
After the old position information D1 and the old reference position R1 are set, the work machine 10 moves from the old position P1 to the new position P2 (step S20 in FIG. 4). The new position P2 is a position (position at the work site) different from the old position P1. The new position P2 is the position of the work machine 10 after the undercarriage 11 has moved (e.g., traveled) from the old position P1 relative to the work site. Note that if the undercarriage 11 does not move (e.g., travel) from the old position P1 relative to the work site, the work machine 10 will remain located at the old position P1 even if at least one of the upper rotating body 13 swings and the attachment 15 is operated. Furthermore, if the work machine 10 has moved from the old position P1 multiple times to reach its current position, the current position of the work machine 10 is the new position P2.
(新基準位置R2)
新基準位置設定部61(図2参照)は、新位置P2に作業機械10が配置されたときの機械座標系で表した基準位置R(新基準位置R2)を設定する(図4のステップS21)。新基準位置設定部61は、作業機械10が旧位置P1に配置されたときに設定された旧基準位置R1を、作業機械10が新位置P2に配置されたときに新基準位置R2として再設定する。
(New reference position R2)
The new reference position setting unit 61 (see FIG. 2) sets a reference position R (new reference position R2) expressed in the machine coordinate system when the work machine 10 is located at new position P2 (step S21 in FIG. 4). The new reference position setting unit 61 resets the old reference position R1, which was set when the work machine 10 was located at old position P1, as the new reference position R2 when the work machine 10 is located at new position P2.
基準位置Rの再設定が行われる理由は、次の通りである。旧基準位置R1および旧位置情報D1のそれぞれは、作業機械10を基準とした機械座標系で表される。そのため、作業現場に対して作業機械10が旧位置P1から新位置P2に移動すると、作業現場に対して旧基準位置R1および旧位置情報D1も移動する。コントローラ30(図2参照)は(作業機械10は)、例えば図3において二点鎖線で示す位置(D5)に、基準位置R(位置Qa、位置Qb)および位置情報Dがあると判断してしまう。そこで、位置情報設定システム1は、作業機械10が旧位置P1に配置されたときと新位置P2に配置されたときとで、作業現場に対する位置情報Dの位置が変わらないように演算を行う。この演算のために、新基準位置設定部61(図2参照)は、基準位置Rを再設定(新基準位置R2を設定し)し、新位置情報設定部63(図2参照)は、新基準位置R2などに基づいて位置情報Dを演算する(詳細は後述)。なお、新基準位置R2が設定された後に、作業機械10が移動した場合は、移動後の位置で新基準位置R2が再度設定される。 The reason for resetting the reference position R is as follows. The old reference position R1 and old position information D1 are each expressed in a machine coordinate system based on the work machine 10. Therefore, when the work machine 10 moves from the old position P1 to the new position P2 relative to the work site, the old reference position R1 and old position information D1 also move relative to the work site. The controller 30 (see Figure 2) (the work machine 10) will determine that the reference position R (position Qa, position Qb) and position information D are located at, for example, the position (D5) indicated by the two-dot chain line in Figure 3. Therefore, the position information setting system 1 performs calculations so that the position information D relative to the work site does not change when the work machine 10 is located at the old position P1 and when it is located at the new position P2. For this calculation, the new reference position setting unit 61 (see Figure 2) resets the reference position R (sets a new reference position R2), and the new position information setting unit 63 (see Figure 2) calculates the position information D based on the new reference position R2, etc. (details will be described later). If the work machine 10 moves after the new reference position R2 is set, the new reference position R2 will be set again at the position after the movement.
(新基準位置R2の具体的設定方法)
新基準位置R2は、旧基準位置R1の具体的設定方法と同様に、様々に設定可能である。例えば、旧基準位置R1と新基準位置R2とが、同一の方法により設定されてもよく、互いに異なる方法により設定されてもよい。具体的には例えば、旧基準位置R1がティーチングに基づいて設定された場合に、新基準位置R2もティーチングに基づいて設定されてもよく、新基準位置R2は特徴物検出装置25に基づいて検出されてもよい。
(Specific Method for Setting New Reference Position R2)
The new reference position R2 can be set in various ways, similar to the specific setting method of the old reference position R1. For example, the old reference position R1 and the new reference position R2 may be set using the same method or different methods. Specifically, for example, if the old reference position R1 is set based on teaching, the new reference position R2 may also be set based on teaching, and the new reference position R2 may be detected based on the feature detection device 25.
(新位置情報D2の演算)
新位置情報設定部63(図2参照)は、新位置P2に作業機械10が配置されたときの位置情報D(すなわち新位置情報D2)を演算(設定)する(図4のステップS22、S31、S32)。新位置情報設定部63は、旧位置情報D1、旧基準位置R1、および新基準位置R2に基づいて、新位置情報D2を演算する。
(Calculation of new position information D2)
The new position information setting unit 63 (see FIG. 2) calculates (sets) position information D (i.e., new position information D2) when the work machine 10 is located at new position P2 (steps S22, S31, S32 in FIG. 4). The new position information setting unit 63 calculates the new position information D2 based on the old position information D1, the old reference position R1, and the new reference position R2.
(新位置情報D2の演算の具体例)
新位置情報D2の演算の詳細は、次の通りである。なお、新位置情報D2の演算は、様々に行うことが可能である。上記のように、作業機械10が旧位置P1のときに、旧基準位置R1および旧位置情報D1が設定され(図4のステップS11、S12、S13)、記憶部55(図2参照)に記憶される。また、作業機械10が新位置P2のときに、新基準位置R2が設定される(ステップS21)。ここで、作業現場における新基準位置R2の位置は、作業現場における旧基準位置R1の位置と同じ位置である。よって、記憶部55に記憶された旧基準位置R1の情報と、新基準位置R2と、に基づいて、新位置P2に対する旧位置P1の相対位置が決まる(ステップS22)。すなわち、作業機械10が新位置P2に配置されたときの機械座標系で表した旧位置P1(具体的には座標)が決まる。作業機械10が旧位置P1に配置されていたときの位置情報D(すなわち旧位置情報D1)は、記憶部55(図2参照)に記憶されている。よって、新位置P2に対する旧位置P1の位置と、旧位置P1に対する旧位置情報D1の位置と、に基づいて、作業機械10が新位置P2に配置されたときの機械座標系で表した位置情報D(すなわち新位置情報D2)が決まる(ステップS32)。
(Specific example of calculation of new position information D2)
The details of the calculation of the new position information D2 are as follows. Note that the calculation of the new position information D2 can be performed in a variety of ways. As described above, when the work machine 10 is at the old position P1, the old reference position R1 and old position information D1 are set (steps S11, S12, S13 in FIG. 4) and stored in the memory unit 55 (see FIG. 2). Furthermore, when the work machine 10 is at the new position P2, a new reference position R2 is set (step S21). Here, the position of the new reference position R2 at the work site is the same as the position of the old reference position R1 at the work site. Therefore, the relative position of the old position P1 with respect to the new position P2 is determined based on the information on the old reference position R1 stored in the memory unit 55 and the new reference position R2 (step S22). In other words, the old position P1 (specifically, coordinates) expressed in the machine coordinate system when the work machine 10 was located at the new position P2 is determined. The position information D when the work machine 10 was located at the old position P1 (i.e., old position information D1) is stored in the memory unit 55 (see FIG. 2). Therefore, based on the position of the old position P1 relative to the new position P2 and the position of the old position information D1 relative to the old position P1, the position information D expressed in the machine coordinate system when the work machine 10 was located at the new position P2 (i.e., new position information D2) is determined (step S32).
位置情報用基準位置D0に基づいて旧位置情報D1が設定される場合(ステップS12、S13)は、新位置情報D2は、次のように算出される。この場合、新位置P2に対する旧位置P1の位置と、旧位置P1に対する位置情報用基準位置D0の位置と、に基づいて、作業機械10が新位置P2に配置されたときの機械座標系で表した位置情報用基準位置D0の位置が決まる(ステップS31)。この位置情報用基準位置D0に基づいて、作業機械10が新位置P2に配置されたときの機械座標系で表した位置情報D(すなわち新位置情報D2)が決まる(ステップS32)。 When old position information D1 is set based on the position information reference position D0 (steps S12, S13), new position information D2 is calculated as follows. In this case, the position of the position information reference position D0 expressed in the machine coordinate system when the work machine 10 is located at the new position P2 is determined based on the position of the old position P1 relative to the new position P2 and the position of the position information reference position D0 relative to the old position P1 (step S31). Based on this position information reference position D0, position information D expressed in the machine coordinate system when the work machine 10 is located at the new position P2 (i.e., new position information D2) is determined (step S32).
(新位置情報D2の演算のさらなる具体例:その1)
新位置情報D2の演算のさらなる具体例は、次の通りである。この例では、基準位置Rが2点設定され、位置情報用基準位置D0に基づいて位置情報Dが設定され、地面の傾斜は考慮しないこととする(新位置情報D2の演算のさらなる具体例の、その2およびその3も同様)。
(Further specific example of calculation of new position information D2: Part 1)
A further specific example of the calculation of the new position information D2 is as follows: In this example, two reference positions R are set, the position information D is set based on the position information reference position D0, and the slope of the ground is not taken into consideration (the same applies to the second and third specific examples of the calculation of the new position information D2).
上記のように、作業機械10が旧位置P1に配置されているときに、旧基準位置R1、および旧位置情報D1が設定される(ステップS11、S12、S13)。その後、図5に示すように、作業機械10が新位置P2に配置されたときに新基準位置R2が設定される(ステップS21)。第1の基準位置Raと第2の基準位置Rbとを通る直線L1が算出される。「直線L1が算出される」とは、直線L1の方向および直線L1が通る点が算出されることを意味する(他の直線も同様)。作業機械10が新位置P2に配置されているときの機械座標系のX軸を、直線L2とする。直線L1と直線L2との交点β11の座標が算出される。直線L1の垂線であって第1の基準位置Raを通る直線L3が算出される。直線L2と直線L3との交点β12の座標が算出される。よって、交点β11、交点β12、および第1の基準位置Raの3点の座標が決まる。その結果、直線L1、直線L2、および直線L3により構成される三角形が決まる。この三角形の余弦定理により、直線L1と直線L2とがなす角度α11が算出される。 As described above, when the work machine 10 is located at the old position P1, the old reference position R1 and old position information D1 are set (steps S11, S12, S13). Then, as shown in FIG. 5, when the work machine 10 is located at the new position P2, a new reference position R2 is set (step S21). A straight line L1 passing through the first reference position Ra and the second reference position Rb is calculated. "Calculating the straight line L1" means that the direction of the straight line L1 and the point through which the straight line L1 passes are calculated (the same applies to other straight lines). The X-axis of the machine coordinate system when the work machine 10 is located at the new position P2 is set to the straight line L2. The coordinates of the intersection β11 between the straight lines L1 and L2 are calculated. A straight line L3, which is perpendicular to the straight line L1 and passes through the first reference position Ra, is calculated. The coordinates of the intersection β12 between the straight lines L2 and L3 are calculated. Therefore, the coordinates of the three points, intersection point β11, intersection point β12, and first reference position Ra, are determined. As a result, a triangle formed by lines L1, L2, and L3 is determined. Using the cosine theorem of this triangle, the angle α11 between lines L1 and L2 is calculated.
旧位置P1(未知の位置)を通り、直線L1と平行な直線を、直線L4とする。旧位置P1を通り、直線L2と平行(X軸と平行)な直線を、直線L5とする。直線L2と直線L4とがなす角度α12、および、直線L4と直線L5とがなす角度α13のそれぞれは、算出された角度α11と等しい。なお、図5に示す二重丸印(「◎」)を付した角度は互いに等しい。 Let us assume that the line that passes through the old position P1 (unknown position) and is parallel to the line L1 is line L4. Let us assume that the line that passes through the old position P1 and is parallel to the line L2 (parallel to the X-axis) is line L5. The angle α12 formed by the lines L2 and L4, and the angle α13 formed by the lines L4 and L5, are both equal to the calculated angle α11. Note that the angles marked with a double circle ("◎") in Figure 5 are equal to each other.
旧基準位置R1が設定されたときの情報に基づき、直線L3、直線L4、および線分L6により構成される三角形の情報(各辺の長さ、角度)が算出され、記憶部55(図2参照)に記憶される。具体的には、記憶部55には、線分L6の長さ、旧位置P1から交点β13までの長さ、および第1の基準位置Raから交点β13までの長さが記憶される。上記の線分L6は、旧位置P1と第1の基準位置Raとを結ぶ線分である。上記の交点β13は、直線L3と直線L4との交点である。算出された直線L3、算出された交点β12の座標、および、第1の基準位置Raから交点β13までの距離(記憶部55に記憶された距離)に基づいて、交点β13の座標が算出される。そして、直線L4の方向(直線L1と平行)、算出された交点β13の座標、および旧位置P1から交点β13までの距離(記憶部55に記憶された距離)に基づいて、旧位置P1の座標が算出される(ステップS22)。 Based on the information when the old reference position R1 was set, information about the triangle formed by lines L3, L4, and line segment L6 (the length and angle of each side) is calculated and stored in memory unit 55 (see Figure 2). Specifically, memory unit 55 stores the length of line segment L6, the length from old position P1 to intersection point β13, and the length from first reference position Ra to intersection point β13. Line segment L6 above is a line segment connecting old position P1 and first reference position Ra. Intersection point β13 is the intersection of lines L3 and L4. The coordinates of intersection point β13 are calculated based on the calculated line L3, the calculated coordinates of intersection point β12, and the distance from first reference position Ra to intersection point β13 (the distance stored in memory unit 55). Then, the coordinates of the previous position P1 are calculated based on the direction of the line L4 (parallel to the line L1), the calculated coordinates of the intersection point β13, and the distance from the previous position P1 to the intersection point β13 (the distance stored in the memory unit 55) (step S22).
直線L3、直線L4、および線分L6により構成される三角形(記憶部55(図2参照)に記憶された三角形)の余弦定理により、直線L4と線分L6とがなす角度α14が算出されてもよい。 The angle α14 between line L4 and line segment L6 may be calculated using the cosine law of the triangle formed by line L3, line L4, and line segment L6 (the triangle stored in memory unit 55 (see Figure 2)).
図3に示す位置情報用基準位置D0が設定されたときの情報に基づき、直線L4、線分L7、および直線L8により構成される三角形の情報(各辺の長さ、角度)が算出され、記憶部55(図2参照)に記憶される。具体的には、旧位置P1と位置情報用基準位置D0とを結ぶ線分L7の長さが、記憶部55に記憶される。直線L1の垂線であって、位置情報用基準位置D0を通る直線L8が算出され、記憶部55に記憶される。直線L4と直線L8との交点を、交点β14とする。直線L4、線分L7、および直線L8により構成される三角形の余弦定理により、直線L4と線分L7とがなす角度α15が算出され、記憶部55に記憶される。線分L7の長さと角度α15とに基づいて(「線分L7の長さ」×sin(角度α15)により)、位置情報用基準位置D0から交点β14までの距離が算出され、記憶部55に記憶される。また、線分L7と直線L8とがなす角度と、線分L7の長さと、に基づいて、旧位置P1から交点β14までの距離が算出され、記憶部55に記憶される。 Based on the information when the position information reference position D0 shown in Figure 3 was set, information (lengths and angles of each side) of the triangle formed by line L4, line segment L7, and line L8 is calculated and stored in memory unit 55 (see Figure 2). Specifically, the length of line segment L7 connecting old position P1 and position information reference position D0 is stored in memory unit 55. Line L8, which is perpendicular to line L1 and passes through position information reference position D0, is calculated and stored in memory unit 55. The intersection of line L4 and line L8 is defined as intersection point β14. Using the cosine theorem for the triangle formed by line L4, line segment L7, and line L8, angle α15 formed by line L4 and line segment L7 is calculated and stored in memory unit 55. Based on the length of line segment L7 and angle α15 ("length of line segment L7" x sin(angle α15)), the distance from position information reference position D0 to intersection point β14 is calculated and stored in memory unit 55. Also, based on the angle between line segment L7 and straight line L8 and the length of line segment L7, the distance from old position P1 to intersection point β14 is calculated and stored in memory unit 55.
図5に示す、算出された旧位置P1の座標と、直線L4の方向(直線L1と平行)と、旧位置P1から交点β14までの距離(記憶部55(図2参照)に記憶された距離)と、から交点β14の座標が算出される。算出された交点β14の座標と、直線L8の方向(直線L1に直交する方向)と、位置情報用基準位置D0から交点β14までの距離(記憶部55に記憶された距離)と、から位置情報用基準位置D0の座標が算出される(ステップS31)。 The coordinates of intersection β14 are calculated from the calculated coordinates of old position P1 shown in Figure 5, the direction of line L4 (parallel to line L1), and the distance from old position P1 to intersection β14 (the distance stored in memory unit 55 (see Figure 2)). The coordinates of position information reference position D0 are calculated from the calculated coordinates of intersection β14, the direction of line L8 (the direction perpendicular to line L1), and the distance from position information reference position D0 to intersection β14 (the distance stored in memory unit 55) (step S31).
なお、上記の算出の手順において、旧位置P1や位置情報用基準位置D0の算出に利用されていない値(例えば角度α12、α13、α14)が、旧位置P1や位置情報用基準位置D0の算出に利用されてもよい。また、上記の算出の手順では算出されていないが導き出すことができる値が算出され、旧位置P1や位置情報用基準位置D0の算出に利用されてもよい。具体的には例えば、算出された角度α15から、算出された角度α14を引いた角度(α15-α14)が算出および利用されてもよい。 Note that in the above calculation procedure, values not used in calculating the old position P1 or the position information reference position D0 (for example, angles α12, α13, and α14) may be used in calculating the old position P1 or the position information reference position D0. Also, values that are not calculated in the above calculation procedure but can be derived may be calculated and used in calculating the old position P1 or the position information reference position D0. Specifically, for example, the angle obtained by subtracting the calculated angle α14 from the calculated angle α15 (α15 - α14) may be calculated and used.
(新位置情報D2の演算のさらなる具体例:その2)
上記のように、作業機械10が旧位置P1に配置されているときに、旧基準位置R1、および旧位置情報D1が設定される(ステップS11、S12、S13)。作業機械10が旧位置P1に配置されているときに、旧基準位置R1の第1の基準位置Raが設定されることで、旧位置P1から第1の基準位置Raまでの長さ(すなわち線分L6の長さ)が求められる。また、直線L1と線分L6とがなす角度α21が求められる。求められた線分L6の長さ、および角度α21が、記憶部55(図2参照)に記憶される。
(Further specific example of calculation of new position information D2: Part 2)
As described above, when the work machine 10 is located at the old position P1, the old reference position R1 and old position information D1 are set (steps S11, S12, S13). When the work machine 10 is located at the old position P1, the first reference position Ra of the old reference position R1 is set, and the length from the old position P1 to the first reference position Ra (i.e., the length of the line segment L6) is determined. In addition, the angle α21 formed between the straight line L1 and the line segment L6 is determined. The determined length and angle α21 of the line segment L6 are stored in the memory unit 55 (see FIG. 2).
その後、作業機械10が新位置P2に配置されたときに新基準位置R2が設定される(ステップS21)。新基準位置R2の第1の基準位置Raおよび第2の基準位置Rbの座標から、作業機械10が新位置P2に配置されたときの機械座標系で表した、直線L1が求められる。ここで、線分L6の長さ、および角度α21は、記憶部55(図2参照)に記憶されている。よって、これらの既知の情報(第1の基準位置Raの座標、第2の基準位置Rbの座標、線分L6の長さ、および角度α21)に基づいて、未知の情報である旧位置P1が算出される。そして、記憶部55に記憶された旧位置P1に対する位置情報用基準位置D0の情報に基づいて、作業機械10が新位置P2に配置されたときの機械座標系で表した位置情報用基準位置D0の位置が算出される(図4のステップS31)。そして、位置情報用基準位置D0に基づいて、新位置情報D2が算出される(図4のステップS32)。 Thereafter, when the work machine 10 is positioned at the new position P2, a new reference position R2 is set (step S21). From the coordinates of the first reference position Ra and the second reference position Rb of the new reference position R2, a straight line L1 expressed in the machine coordinate system when the work machine 10 was positioned at the new position P2 is determined. Here, the length of the line segment L6 and the angle α21 are stored in the memory unit 55 (see Figure 2). Therefore, the unknown information, the old position P1, is calculated based on this known information (the coordinates of the first reference position Ra, the coordinates of the second reference position Rb, the length of the line segment L6, and the angle α21). Then, based on the information on the position information reference position D0 for the old position P1 stored in the memory unit 55, the position of the position information reference position D0 expressed in the machine coordinate system when the work machine 10 was positioned at the new position P2 is calculated (step S31 in Figure 4). Then, based on the position information reference position D0, new position information D2 is calculated (step S32 in Figure 4).
(新位置情報D2の演算のさらなる具体例:その3)
例えば、旧位置情報D1が座標変換(回転および平行移動)されることで、新位置情報D2が算出されてもよい。具体的には例えば、図5に示す例では、角度α22が算出される。角度α22は、座標変換前の第1の基準位置Ra(位置Qa)から座標変換前の第2の基準位置Rb(位置Qb)への向きと、作業機械10が新位置P2に配置されたときに設定された第1の基準位置Raから第2の基準位置Rbへの向きと、がなす角度である。そして、記憶部55(図2参照)に記憶されている旧位置情報D1が、新位置P2を中心として角度α22だけ回転させられる(この回転を「角度α22の回転」という)。また、角度α22の回転が行われた後の位置Qa(図示なし)を始点、作業機械10が新位置P2に配置されたときに設定された第1の基準位置Raを終点、とするベクトルが算出される。そして、このベクトルの方向および距離だけ、角度α22の回転後の旧位置情報D1(図示なし)を平行移動させる。その結果、新位置情報D2が算出される。
(Further specific example of calculation of new position information D2: Part 3)
For example, new position information D2 may be calculated by subjecting old position information D1 to coordinate transformation (rotation and translation). Specifically, in the example shown in FIG. 5 , angle α22 is calculated. Angle α22 is the angle formed between the direction from the first reference position Ra (position Qa) before the coordinate transformation to the second reference position Rb (position Qb) before the coordinate transformation, and the direction from the first reference position Ra set when the work machine 10 was located at the new position P2 to the second reference position Rb. Then, the old position information D1 stored in memory unit 55 (see FIG. 2 ) is rotated by angle α22 around the new position P2 (this rotation is referred to as "rotation by angle α22"). In addition, a vector is calculated whose start point is position Qa (not shown) after rotation by angle α22 and whose end point is the first reference position Ra set when the work machine 10 was located at the new position P2. Then, the old position information D1 (not shown) after rotation by the angle α22 is translated by the direction and distance of this vector, resulting in the calculation of new position information D2.
(地面の傾斜を考慮する場合)
作業機械10が配置される地面に傾斜がある場合が想定される。この場合、Z軸が鉛直方向に対して傾き、X軸およびY軸の少なくともいずれかが水平方向に対して傾く。そこで、コントローラ30(図2参照)(新位置情報設定部63(図2参照))は、地面の傾斜を考慮して新位置情報D2を演算してもよい。この場合、例えば、作業機械10の傾斜を検出する傾斜センサ(図示なし)が設けられる。コントローラ30(図2参照)は、傾斜センサの検出値に基づいて、X軸、Y軸、およびZ軸の各値を、水平および鉛直に延びる軸の座標系に変換する。そして、変換後の座標系を、上記「機械座標系」としてもよい。
(When considering the slope of the ground)
It is possible that the ground on which the work machine 10 is placed is inclined. In this case, the Z-axis is inclined relative to the vertical direction, and at least one of the X-axis and Y-axis is inclined relative to the horizontal direction. Therefore, the controller 30 (see FIG. 2) (new position information setting unit 63 (see FIG. 2)) may calculate new position information D2 taking the inclination of the ground into account. In this case, for example, an inclination sensor (not shown) that detects the inclination of the work machine 10 is provided. Based on the detected values of the inclination sensor, the controller 30 (see FIG. 2) converts the values of the X-axis, Y-axis, and Z-axis into a coordinate system of axes extending horizontally and vertically. The converted coordinate system may then be referred to as the "machine coordinate system."
上記の座標系の変換が行われることなく、地面の傾斜を考慮した新位置情報D2の演算が行われてもよい。具体的には例えば、基準位置Rとして、互いに異なる3点以上の点が設定されてもよい。この場合、基準位置Rとして基準となる平面を設定することができる。そのため、旧基準位置R1および新基準位置R2が設定される際に、この基準となる平面に対する作業機械10の傾斜を決定することができる。よって、作業機械10が旧位置P1に配置されていたときの(旧位置情報D1が設定されたときの)作業機械10の傾斜を、作業機械10が新位置P2に配置されているときの機械座標系で表すことができる。その結果、作業機械10の傾斜を考慮した新位置情報D2を演算することができる。 New position information D2 that takes into account the inclination of the ground may be calculated without converting the coordinate system as described above. Specifically, for example, three or more different points may be set as the reference position R. In this case, a reference plane can be set as the reference position R. Therefore, when the old reference position R1 and new reference position R2 are set, the inclination of the work machine 10 relative to this reference plane can be determined. Therefore, the inclination of the work machine 10 when it was located at the old position P1 (when the old position information D1 was set) can be expressed in the machine coordinate system when the work machine 10 is located at the new position P2. As a result, new position information D2 that takes into account the inclination of the work machine 10 can be calculated.
基準位置Rは1点のみ設定されてもよい。例えば、上部旋回体13の方位を検出するセンサ(例えば地磁気を利用したものなど)により、旧位置P1から基準位置Rに向かう方位、および新位置P2から基準位置Rに向かう方位が検出されてもよい。そして、新位置情報設定部63(図2参照)は、これらの方位に基づいて新位置情報D2を算出してもよい。 Only one reference position R may be set. For example, a sensor (such as one that uses geomagnetism) that detects the orientation of the upper rotating body 13 may detect the orientation from the old position P1 toward the reference position R and the orientation from the new position P2 toward the reference position R. The new position information setting unit 63 (see Figure 2) may then calculate new position information D2 based on these orientations.
(報知)
作業現場に対して作業機械10が移動しても、作業現場に対する位置情報Dは移動しない。その結果、作業機械10を基準として見れば、作業機械10の移動に伴って、位置情報Dが移動する。その結果、図6に示すように、作業機械10の移動後の(新位置P2に配置されたとき)の位置情報Dが、適切な情報ではなくなる場合がある。
(Notification)
Even if the work machine 10 moves relative to the work site, the position information D for the work site does not move. As a result, when viewed from the work machine 10 as a reference, the position information D moves as the work machine 10 moves. As a result, as shown in Figure 6, there are cases where the position information D after the work machine 10 has moved (when it is placed at new position P2) is no longer appropriate information.
[例6a]例えば、位置情報Dが作業制限範囲D11や作業範囲D13である場合、作業機械10の移動後に作業機械10が作業可能となる範囲が狭すぎる場合が想定される。図6に示す例では、作業機械10が作業可能な範囲は、作業範囲D13と、前方制限D11yと、旋回制限D11θと、に囲まれ、障害物Oを含まない領域A1である。この例では、作業機械10は、領域A1の外部かつ上部旋回体13の近傍(手前側)の領域では作業ができない。この例では、作業機械10の移動前(図3参照)に比べ、作業機械10が実質的に作業可能な範囲が狭くなっている。[例6b]また、例えば、位置情報Dが特定部位15eの目標経路である場合、作業機械10の移動後に、特定部位15eを目標経路に適切に配置できない場合が想定される。 [Example 6a] For example, if the position information D is the restricted work range D11 or the work range D13, it is conceivable that the range in which the work machine 10 can work after the work machine 10 has moved will be too narrow. In the example shown in FIG. 6, the range in which the work machine 10 can work is area A1, which is surrounded by the work range D13, the forward limit D11y, and the turning limit D11θ, and does not include the obstacle O. In this example, the work machine 10 cannot work in the area outside area A1 or in the vicinity (front side) of the upper rotating body 13. In this example, the range in which the work machine 10 can actually work is narrower than before the work machine 10 moved (see FIG. 3). [Example 6b] Furthermore, for example, if the position information D is the target route for the specific part 15e, it is conceivable that the specific part 15e cannot be appropriately positioned on the target route after the work machine 10 has moved.
上記のような問題を抑制できるように、報知部80(図2参照)が報知を行うことが好ましい。以下では、各ステップについては図7を参照して説明する。 To prevent the above problems, it is preferable for the notification unit 80 (see Figure 2) to issue a notification. Each step will be explained below with reference to Figure 7.
報知部80(第1報知部)(図2参照)は、図3に示す作業機械10が旧位置P1から移動したときに報知を行ってもよい(図7のステップS120)。具体的には例えば、旧位置P1に配置されていた作業機械10が走行を開始したことを、図2に示す走行センサ23が検出したときに、報知制御部71は、報知部80に報知を行わせてもよい。 The notification unit 80 (first notification unit) (see Figure 2) may issue a notification when the work machine 10 shown in Figure 3 moves from the previous position P1 (step S120 in Figure 7). Specifically, for example, when the travel sensor 23 shown in Figure 2 detects that the work machine 10 located at the previous position P1 has started traveling, the notification control unit 71 may cause the notification unit 80 to issue a notification.
報知部80(第2報知部)は、図3に示す旧位置P1から新位置P2までの距離が、所定の距離閾値以上のときに(図7のステップS123でYESのときに)、報知を行ってもよい(図7のステップS124)。上記「旧位置P1から新位置P2までの距離」は、例えば、旧位置P1から新位置P2までの直線距離である。旧位置P1から新位置P2までの距離が距離閾値以上のとき、新位置情報設定部63は、新位置情報D2を算出しなくてもよく、算出してもよい(図7のステップS124からステップS31に進んでもよい)。 The notification unit 80 (second notification unit) may issue a notification (step S124 in FIG. 7) when the distance from the old position P1 to the new position P2 shown in FIG. 3 is equal to or greater than a predetermined distance threshold (YES in step S123 in FIG. 7). The "distance from the old position P1 to the new position P2" is, for example, the straight-line distance from the old position P1 to the new position P2. When the distance from the old position P1 to the new position P2 is equal to or greater than the distance threshold, the new position information setting unit 63 may or may not calculate new position information D2 (the process may proceed from step S124 to step S31 in FIG. 7).
報知部80(図2参照)は、位置情報Dの妥当性を確保させる行動を作業者に促すような報知を行ってもよい。この報知は、表示による報知でもよく、音声による報知でもよい。具体的には例えば、報知部80は、作業機械10が移動したときに、旧位置P1側に移動する(元の位置に戻る)ことを促す通知を行ってもよい。報知部80は、作業機械10が移動したときに、旧位置情報D1の再設定を促す通知を行ってもよい。具体的には例えば、報知部80は、作業機械10が移動したときに、作業制限範囲D11の再設定(例えば位置情報用基準位置D0の再設定)を促す通知を行ってもよく、特定部位15eの目標経路の再設定を促す通知を行ってもよい。 The notification unit 80 (see Figure 2) may issue a notification to prompt the worker to take action to ensure the validity of the position information D. This notification may be a visual or audio notification. Specifically, for example, when the work machine 10 moves, the notification unit 80 may issue a notification to prompt the worker to move toward the old position P1 (return to the original position). When the work machine 10 moves, the notification unit 80 may issue a notification to prompt the worker to reset the old position information D1. Specifically, for example, when the work machine 10 moves, the notification unit 80 may issue a notification to prompt the worker to reset the work limit range D11 (e.g., reset the position information reference position D0), or may issue a notification to prompt the worker to reset the target route for the specific portion 15e.
報知部80(図2参照)は、位置に関する報知(表示)を行ってもよい。具体的には例えば、報知部80は、作業現場を示す表示を行ってもよく、作業現場を上から見た表示を行ってもよく、作業現場を立体的に示す表示を行ってもよい。報知部80は、位置情報Dを示す図形を表示してもよく、基準位置Rを示す図形(例えば点など)を表示してもよく、作業機械10の位置(旧位置P1、新位置P2の少なくともいずれか)を示す図形(例えば点等)を表示してもよい。 The notification unit 80 (see Figure 2) may provide a notification (display) regarding the position. Specifically, for example, the notification unit 80 may provide a display showing the work site, a display of the work site as seen from above, or a display showing the work site in three dimensions. The notification unit 80 may display a graphic indicating the position information D, a graphic (e.g., a dot) indicating the reference position R, or a graphic (e.g., a dot) indicating the position of the work machine 10 (at least one of the old position P1 and the new position P2).
(第1の発明の効果)
図3に示す位置情報設定システム1による効果は、次の通りである。位置情報設定システム1は、作業機械10に関する位置情報Dを設定する位置情報設定部(旧位置情報設定部53(図2参照)および新位置情報設定部63(図2参照))を備える。
(Effects of the first invention)
The effects of the position information setting system 1 shown in Fig. 3 are as follows: The position information setting system 1 is equipped with a position information setting unit (old position information setting unit 53 (see Fig. 2) and new position information setting unit 63 (see Fig. 2)) that sets position information D related to the work machine 10.
[構成1]位置情報設定部(53、63)は、旧位置P1に作業機械10が配置されたときと、旧位置P1とは異なる新位置P2に作業機械10が配置されたときとで、作業機械10が配置された作業現場に対する位置情報Dの位置が変わらないように、位置情報Dを設定する。 [Configuration 1] The position information setting unit (53, 63) sets the position information D so that the position of the position information D relative to the work site where the work machine 10 is located does not change when the work machine 10 is located at the old position P1 and when the work machine 10 is located at a new position P2 that is different from the old position P1.
上記[構成1]により、作業現場に対して作業機械10が移動した場合でも、作業現場に対する位置情報Dの位置が変わらない。よって、位置情報設定システム1は、作業現場に対して作業機械10が移動した場合に、位置情報Dを設定し直す必要をなくすことができる。 With the above [Configuration 1], even if the work machine 10 moves relative to the work site, the position of the position information D relative to the work site does not change. Therefore, the position information setting system 1 eliminates the need to reset the position information D when the work machine 10 moves relative to the work site.
(第2の発明の効果)
[構成2-1]位置情報設定システム1は、旧基準位置R1を設定する旧基準位置設定部51(図2参照)と、新基準位置R2を設定する新基準位置設定部61(図2参照)と、を備える。旧基準位置R1は、旧位置P1に作業機械10が配置されたときの作業機械10を基準とした機械座標系で、作業機械10の外部の基準位置Rを表したものである。新基準位置R2は、新位置P2に作業機械10が配置されたときの機械座標系で、基準位置Rを表したものである。
(Effects of the second invention)
[Configuration 2-1] The position information setting system 1 comprises an old reference position setting unit 51 (see Figure 2) that sets an old reference position R1, and a new reference position setting unit 61 (see Figure 2) that sets a new reference position R2. The old reference position R1 represents a reference position R outside the work machine 10 in a machine coordinate system that uses the work machine 10 as a reference when the work machine 10 is located at the old position P1. The new reference position R2 represents the reference position R in a machine coordinate system when the work machine 10 is located at the new position P2.
[構成2-2]位置情報設定部(53、63)は、旧位置情報設定部53(図2参照)と、新位置情報設定部63(図2参照)と、を備える。旧位置情報設定部53は、旧位置情報D1を設定する。旧位置情報D1は、旧位置P1に作業機械10が配置されたときの機械座標系で、位置情報Dを表したものである。 [Configuration 2-2] The position information setting unit (53, 63) includes an old position information setting unit 53 (see Figure 2) and a new position information setting unit 63 (see Figure 2). The old position information setting unit 53 sets old position information D1. The old position information D1 represents the position information D in the machine coordinate system when the work machine 10 was located at the old position P1.
[構成2-3]新位置情報設定部63(図2参照)は、旧位置情報D1、旧基準位置R1、および新基準位置R2に基づいて、新位置情報D2を演算する。新位置情報D2は、新位置P2に作業機械10が配置されたときの機械座標系で位置情報Dを表したものである。 [Configuration 2-3] The new position information setting unit 63 (see Figure 2) calculates new position information D2 based on the old position information D1, the old reference position R1, and the new reference position R2. The new position information D2 represents the position information D in the machine coordinate system when the work machine 10 is located at the new position P2.
上記[構成2-1]では、旧位置P1に作業機械10が配置されたときの基準位置R(旧基準位置R1)と、新位置P2に作業機械10が配置されたときの基準位置R(新基準位置R2)と、が設定される。旧基準位置R1と新基準位置R2とは、作業機械10の外部の同じ基準位置Rである。よって、新位置情報設定部63(図2参照)(上記[構成2-3])は、旧基準位置R1および新基準位置R2に基づいて、新位置P2に対する旧位置P1の相対位置を算出することができる。また、上記[構成2-2]では、旧位置P1に作業機械10が配置されたときの位置情報D(旧位置情報D1)が設定される。すなわち、旧位置P1に対する位置情報Dの相対位置が設定される。よって、新位置情報設定部63(図2参照)は、新位置P2に対する旧位置P1の相対位置、および、旧位置P1に対する旧位置情報D1の相対位置に基づいて、新位置情報D2を算出することができる。この新位置情報D2は、作業機械10が新位置P2に配置されたときの機械座標系で表した位置情報Dである。上記[構成2-1]、[構成2-2]、および[構成2-3]では、作業現場に対する作業機械10の位置が直接的に検出されなくても、新位置情報D2を算出することができる。なお、作業現場に対する作業機械10の位置が直接的に検出される例については後述する。 In the above [Configuration 2-1], a reference position R (old reference position R1) when the work machine 10 is located at the old position P1 and a reference position R (new reference position R2) when the work machine 10 is located at the new position P2 are set. The old reference position R1 and the new reference position R2 are the same reference position R outside the work machine 10. Therefore, the new position information setting unit 63 (see Figure 2) (above [Configuration 2-3]) can calculate the relative position of the old position P1 with respect to the new position P2 based on the old reference position R1 and the new reference position R2. Furthermore, in the above [Configuration 2-2], position information D (old position information D1) when the work machine 10 is located at the old position P1 is set. In other words, the relative position of the position information D with respect to the old position P1 is set. Therefore, the new position information setting unit 63 (see FIG. 2) can calculate new position information D2 based on the relative position of the old position P1 with respect to the new position P2, and the relative position of the old position information D1 with respect to the old position P1. This new position information D2 is position information D expressed in the machine coordinate system when the work machine 10 is located at the new position P2. In the above [Configuration 2-1], [Configuration 2-2], and [Configuration 2-3], new position information D2 can be calculated even if the position of the work machine 10 relative to the work site is not directly detected. An example in which the position of the work machine 10 relative to the work site is directly detected will be described later.
(第3の発明の効果)
[構成3]基準位置Rは、作業現場の互いに異なる複数の点(第1の基準位置Ra、第2の基準位置Rb)である。
(Effects of the third invention)
[Configuration 3] The reference positions R are a plurality of different points (first reference position Ra, second reference position Rb) at the work site.
上記[構成3]により、例えば作業機械10の位置(旧位置P1または新位置P2)から基準位置Rに向かう方位の検出などを行わなくても、新位置情報D2を算出することができる。 With the above [Configuration 3], new position information D2 can be calculated without, for example, detecting the direction from the work machine 10's position (old position P1 or new position P2) toward the reference position R.
(第4の発明の効果)
[構成4]位置情報設定システム1は、作業機械10の周囲の特徴物を検出する特徴物検出装置25を備える。旧基準位置設定部51(図2参照)および新基準位置設定部61(図2参照)の少なくともいずれかは、特徴物検出装置25の検出結果に基づいて、機械座標系で表した基準位置R(旧基準位置R1、新基準位置R2)を設定する。
(Effects of the fourth invention)
[Configuration 4] The position information setting system 1 includes a feature detection device 25 that detects feature objects around the work machine 10. At least one of the old reference position setting unit 51 (see FIG. 2) and the new reference position setting unit 61 (see FIG. 2) sets a reference position R (old reference position R1, new reference position R2) expressed in the machine coordinate system based on the detection results of the feature detection device 25.
上記[構成4]により、機械座標系で表した基準位置R(旧基準位置R1および新基準位置R2の少なくともいずれか)を作業者が手動で設定する必要がない。よって、作業者の手間を抑制することができる。 With the above [Configuration 4], the operator does not need to manually set the reference position R (at least one of the old reference position R1 and the new reference position R2) expressed in the machine coordinate system. This reduces the operator's workload.
(第5の発明の効果)
図1に示すように、位置情報設定システム1は、下部走行体11と、上部旋回体13と、アタッチメント15と、姿勢センサ21と、を備える。上部旋回体13は、下部走行体11に旋回可能に取り付けられる。アタッチメント15は、上部旋回体13に取り付けられる。姿勢センサ21は、下部走行体11に対する上部旋回体13の旋回角度、およびアタッチメント15の姿勢を検出する。
(Effects of the fifth invention)
1 , the position information setting system 1 includes a lower traveling body 11, an upper rotating body 13, an attachment 15, and an attitude sensor 21. The upper rotating body 13 is rotatably attached to the lower traveling body 11. The attachment 15 is attached to the upper rotating body 13. The attitude sensor 21 detects the rotation angle of the upper rotating body 13 relative to the lower traveling body 11 and the attitude of the attachment 15.
[構成5]図2に示す旧基準位置設定部51および新基準位置設定部61の少なくともいずれかは、機械座標系で表した基準位置R(旧基準位置R1、新基準位置R2)を設定する。この設定は、図3に示すアタッチメント15の特定部位15eが基準位置Rに配置されたときの姿勢センサ21(図2参照)の検出結果に基づいて行われる。 [Configuration 5] At least one of the old reference position setting unit 51 and the new reference position setting unit 61 shown in Figure 2 sets the reference position R (old reference position R1, new reference position R2) expressed in the machine coordinate system. This setting is performed based on the detection results of the posture sensor 21 (see Figure 2) when the specific portion 15e of the attachment 15 shown in Figure 3 is positioned at the reference position R.
上記[構成5]では、作業者がアタッチメント15を操作し、基準位置Rとして設定したい位置に特定部位15eを配置することで、基準位置R(旧基準位置R1、および新基準位置R2の少なくともいずれか)を確実に設定することができる。よって、例えば、特徴物検出装置25の不具合によって誤った位置を基準位置Rとして検出してしまう、といった問題が生じない。 In the above [Configuration 5], the worker operates the attachment 15 and places the specific part 15e at the position he or she wants to set as the reference position R, thereby reliably setting the reference position R (at least one of the old reference position R1 and the new reference position R2). Therefore, problems such as an incorrect position being detected as the reference position R due to a malfunction of the feature detection device 25 do not occur.
(第7の発明の効果)
[構成7]位置情報Dは、作業機械10の作業を制限する範囲である作業制限範囲D11の情報である。
(Effects of the seventh invention)
[Configuration 7] The position information D is information on a work restriction range D11, which is a range within which work by the work machine 10 is restricted.
上記[構成7]により、次の効果が得られる。作業制限範囲D11の位置は、例えば作業現場の障害物Oの位置などに基づいて設定されることが想定される。この場合、作業制限範囲D11として適切な位置(作業現場における位置)は、作業機械10が移動しても変わらないことが想定される。上記[構成1]および[構成7]では、作業現場に対して作業機械10が移動した場合でも、作業現場に対する作業制限範囲D11の位置が変わらない。よって、作業現場に対して作業機械10が移動した場合に、作業制限範囲D11を設定し直さなくても、作業機械10の作業を作業制限範囲D11に基づいて制限することができる。 The above [Configuration 7] provides the following effect. It is assumed that the position of the work restriction range D11 is set based on, for example, the position of an obstacle O at the work site. In this case, it is assumed that the appropriate position for the work restriction range D11 (position at the work site) will not change even if the work machine 10 moves. In the above [Configuration 1] and [Configuration 7], the position of the work restriction range D11 relative to the work site does not change even if the work machine 10 moves relative to the work site. Therefore, when the work machine 10 moves relative to the work site, the work of the work machine 10 can be restricted based on the work restriction range D11 without having to re-set the work restriction range D11.
(第8の発明の効果)
[構成8]位置情報設定システム1は、作業機械10が旧位置P1から移動したときに報知を行う報知部80(第1報知部)(図2参照)を備える(図7のステップS120を参照)。
(Effect of the eighth invention)
[Configuration 8] The position information setting system 1 includes a notification unit 80 (first notification unit) (see Figure 2) that issues a notification when the work machine 10 moves from the previous position P1 (see step S120 in Figure 7).
上記[構成8]により、次の効果が得られる。上記[構成1]では、作業現場に対して作業機械10が移動しても、作業現場に対する位置情報Dの位置は変わらない。一方、作業現場に対して作業機械10が移動すると、作業機械10から見た位置情報Dの位置は変わる。すると、作業機械10が旧位置P1に配置されていたときには妥当であった位置情報D(すなわち旧位置情報D1)が、作業機械10の移動後には妥当ではなくなる場合がある。そこで、上記[構成8]では、作業機械10が旧位置P1から移動したときに、報知部80(図2参照)が報知を行う。よって、位置情報Dが妥当でない情報になる可能性があることを、作業者に報知することができる。 The above [Configuration 8] provides the following effect. In the above [Configuration 1], even if the work machine 10 moves relative to the work site, the position of the position information D relative to the work site does not change. On the other hand, when the work machine 10 moves relative to the work site, the position of the position information D as seen from the work machine 10 changes. As a result, position information D (i.e., old position information D1) that was valid when the work machine 10 was located at old position P1 may no longer be valid after the work machine 10 moves. Therefore, in the above [Configuration 8], the notification unit 80 (see Figure 2) issues a notification when the work machine 10 moves from old position P1. Therefore, it is possible to notify the worker that position information D may become invalid.
(第9の発明の効果)
[構成9]位置情報設定システム1は、旧位置P1から新位置P2までの距離が、所定の距離閾値以上のときに報知を行う報知部80(第2報知部)(図2参照)を備える(図7のステップS124を参照)。
(Effect of the ninth invention)
[Configuration 9] The location information setting system 1 is equipped with an alarm unit 80 (second alarm unit) (see Figure 2) that issues an alarm when the distance from the old position P1 to the new position P2 is greater than or equal to a predetermined distance threshold (see step S124 in Figure 7).
上記[構成9]では、作業機械10が所定の距離閾値を超えて移動したときに、報知部80(図2参照)が報知を行う。よって、位置情報Dが妥当でない情報になる可能性があることを、作業者に報知することができる(詳細は[構成8]による効果を参照)。 In the above [Configuration 9], the notification unit 80 (see Figure 2) issues a notification when the work machine 10 moves beyond a predetermined distance threshold. This allows the operator to be notified that the position information D may be invalid (see the effects of [Configuration 8] for details).
(第2実施形態)
主に図8および図9を参照して、第2実施形態の位置情報設定システム201について、第1実施形態との相違点を説明する。なお、第2実施形態の位置情報設定システム201のうち、第1実施形態との共通点については、説明を省略する。
Second Embodiment
The differences between the location information setting system 201 of the second embodiment and the first embodiment will be described below, mainly with reference to Figures 8 and 9. Note that, among the location information setting system 201 of the second embodiment, the commonalities with the first embodiment will not be described.
第1実施形態では、図3に示すように、機械座標系の位置情報D(旧位置情報D1および新位置情報D2)、基準位置R(旧基準位置R1および新基準位置R2)が設定された。一方、本実施形態では、図8に示すように、現場座標系での作業機械10の位置が検出され、現場座標系の位置情報Dが設定される。本実施形態では、基準位置R(図3参照)は設定される必要がない。位置情報設定システム201は、位置検出部227と、位置情報設定部253と、を備える。 In the first embodiment, as shown in FIG. 3, position information D (old position information D1 and new position information D2) in the machine coordinate system and reference position R (old reference position R1 and new reference position R2) were set. On the other hand, in this embodiment, as shown in FIG. 8, the position of the work machine 10 in the site coordinate system is detected and position information D in the site coordinate system is set. In this embodiment, there is no need to set the reference position R (see FIG. 3). The position information setting system 201 includes a position detection unit 227 and a position information setting unit 253.
位置検出部227は、図9に示すように、現場座標系で表した作業機械10の位置を検出する。現場座標系は、作業機械10が配置された作業現場を基準とした座標系(例えばグローバル座標系など)である。作業現場に対して作業機械10が移動しても、現場座標系は、作業現場に対して移動しない。位置検出部227(図8参照)は、作業機械10の基準となる部位の、作業現場に対する位置および向きを検出する。作業機械10の基準となる部位は、例えば、旋回中心13a上の位置であり、例えば上部旋回体13の底面の位置などである。作業機械10の基準となる部位は、上部旋回体13へのブーム15bの取付部(ブームフット)などでもよい。位置検出部227は、位置測位システム(例えば衛星測位システムなど)により検出を行うものでもよい。位置測位システムは、衛星測位システムでもよく、例えばGNSS(global navigation satellite system)でもよい。この場合、位置検出部227は、GNSSアンテナ227aを備える。位置測位システムは、衛星測位システムでなくてもよく、例えばトータルステーションを用いたものでもよい。 As shown in Figure 9, the position detection unit 227 detects the position of the work machine 10 expressed in a site coordinate system. The site coordinate system is a coordinate system (e.g., a global coordinate system) based on the work site where the work machine 10 is located. Even if the work machine 10 moves relative to the work site, the site coordinate system does not move relative to the work site. The position detection unit 227 (see Figure 8) detects the position and orientation of the reference part of the work machine 10 relative to the work site. The reference part of the work machine 10 is, for example, a position on the rotation center 13a, such as the position of the bottom of the upper rotating body 13. The reference part of the work machine 10 may also be the attachment part (boom foot) of the boom 15b to the upper rotating body 13. The position detection unit 227 may perform detection using a positioning system (e.g., a satellite positioning system). The positioning system may be a satellite positioning system, such as a global navigation satellite system (GNSS). In this case, the position detection unit 227 is equipped with a GNSS antenna 227a. The positioning system does not have to be a satellite positioning system, and may be one that uses a total station, for example.
位置情報設定部253(図8参照)は、現場座標系で表した位置情報Dを設定する。位置情報Dの具体的設定方法は、旧位置情報設定部53(図2参照)での旧位置情報D1(図3参照)の設定方法と同様である。 The position information setting unit 253 (see Figure 8) sets position information D expressed in the on-site coordinate system. The specific method for setting position information D is the same as the method for setting old position information D1 (see Figure 3) by the old position information setting unit 53 (see Figure 2).
(作動)
図9に示す位置情報設定システム201の作動の、第1実施形態との相違点は次の通りである。作業機械10が旧位置P1に配置されたときに、位置情報設定部253(図8参照)が現場座標系の位置情報Dを設定する。その後、作業機械10が新位置P2に移動する。位置情報Dは現場座標系で表されるので、作業機械10が旧位置P1から新位置P2に移動しても、作業現場に対する位置情報Dの位置は変わらない。また、作業機械10の現場座標系における位置は、位置検出部227により検出される。よって、コントローラ30(図8参照)は、現場座標系での作業機械10の位置、および現場座標系での位置情報Dを把握することができる。その結果、作業機械10は、新位置P2に移動した後も、旧位置P1で設定された位置情報Dを利用することができる。具体的には例えば、位置情報Dが作業制限範囲D11である場合、作業機械10が新位置P2に移動した後も、作業機械10の作業可能な範囲を作業制限範囲D11に基づいて制限することができる。
(Operation)
The operation of the position information setting system 201 shown in Figure 9 differs from the first embodiment in the following ways. When the work machine 10 is placed at the old position P1, the position information setting unit 253 (see Figure 8) sets position information D in the site coordinate system. The work machine 10 then moves to the new position P2. Because the position information D is expressed in the site coordinate system, the position of the position information D relative to the work site does not change even when the work machine 10 moves from the old position P1 to the new position P2. The position of the work machine 10 in the site coordinate system is detected by the position detection unit 227. Therefore, the controller 30 (see Figure 8) can grasp the position of the work machine 10 in the site coordinate system, and the position information D in the site coordinate system. As a result, the work machine 10 can use the position information D set at the old position P1 even after it has moved to the new position P2. Specifically, for example, if the position information D is a work restriction range D11, the workable range of the work machine 10 can be limited based on the work restriction range D11 even after it has moved to the new position P2.
(第6の発明の効果)
図9に示す位置情報設定システム201による効果は、次の通りである。
(Effect of the sixth invention)
The position information setting system 201 shown in FIG. 9 has the following advantages.
[構成6]位置情報設定システム201は、位置検出部227を備える。位置検出部227は、作業現場を基準とした現場座標系で表した作業機械10の位置を検出する。位置情報設定部253(図8参照)は、現場座標系で表した位置情報Dを設定する。 [Configuration 6] The position information setting system 201 includes a position detection unit 227. The position detection unit 227 detects the position of the work machine 10 expressed in a site coordinate system based on the work site. The position information setting unit 253 (see Figure 8) sets position information D expressed in the site coordinate system.
上記[構成6]では、基準位置R(図3参照)を設定しなくても、上記[構成1]による効果を得ることができる。よって、基準位置Rを設定するための装置(例えば特徴物検出装置25)を設ける必要や、基準位置Rを設定するための操作者の操作(例えばティーチングなど)を行う必要をなくすことができる。また、基準位置Rに関するコントローラ30(図8参照)の処理をなくすことができる。なお、本実施形態の位置情報設定システム201は、特徴物検出装置25を備えてもよく、例えば位置情報Dを設定するために特徴物検出装置25の検出値が用いられてもよい。 In the above [Configuration 6], the effects of the above [Configuration 1] can be achieved without setting the reference position R (see Figure 3). This eliminates the need to provide a device for setting the reference position R (e.g., the feature detection device 25) or for the operator to operate the device (e.g., teaching) to set the reference position R. It also eliminates the need for processing by the controller 30 (see Figure 8) related to the reference position R. Note that the position information setting system 201 of this embodiment may be equipped with the feature detection device 25, and the detection value of the feature detection device 25 may be used to set the position information D, for example.
(変形例)
上記実施形態は様々に変形されてもよい。例えば、互いに異なる実施形態の構成要素どうしが組み合わされてもよい。具体的には例えば、旧基準位置R1、新基準位置R2、および旧位置情報D1に基づいて新位置情報D2が設定される場合(第1実施形態参照)に、作業機械10が位置検出部227(図9参照)を備えていてもよい。例えば、図3、および図8に示す各構成要素どうしの接続は変更されてもよい。例えば、図4および図7に示すフローチャートのステップの順序が変更されてもよく、ステップの一部が行われなくてもよい。例えば、閾値(例えば間隔閾値、距離閾値)などの値は一定でもよく、手動操作により変えられてもよく、何らかの条件に応じて自動的に変えられてもよい。例えば、構成要素の数が変更されてもよく、構成要素の一部が設けられなくてもよい。例えば、構成要素どうしの固定や連結などは、直接的でも間接的でもよい。例えば、互いに異なる複数の部材や部分として説明したものが、一つの部材や部分とされてもよい。例えば、一つの部材や部分として説明したものが、互いに異なる複数の部材や部分に分けて設けられてもよい。例えば、各構成要素は、各特徴(作用機能、配置、形状、作動など)の一部のみを有してもよい。
(Modification)
The above-described embodiment may be modified in various ways. For example, components of different embodiments may be combined. Specifically, for example, when new position information D2 is set based on the old reference position R1, the new reference position R2, and the old position information D1 (see the first embodiment), the work machine 10 may be equipped with a position detection unit 227 (see FIG. 9 ). For example, the connections between the components shown in FIGS. 3 and 8 may be changed. For example, the order of the steps in the flowcharts shown in FIGS. 4 and 7 may be changed, or some of the steps may not be performed. For example, values such as thresholds (e.g., interval thresholds, distance thresholds) may be constant, may be changed by manual operation, or may be changed automatically in response to certain conditions. For example, the number of components may be changed, or some of the components may not be provided. For example, components may be fixed or connected directly or indirectly. For example, what has been described as multiple different members or parts may be combined into a single member or part. For example, what has been described as a single member or part may be provided as multiple different members or parts. For example, each component may have only a part of each characteristic (function, arrangement, shape, operation, etc.).
1、201 位置情報設定システム
10 作業機械
11 下部走行体
13 上部旋回体
15 アタッチメント
15e 特定部位
21 姿勢センサ
25 特徴物検出装置
51 旧基準位置設定部
53 旧位置情報設定部
61 新基準位置設定部
63 新位置情報設定部
80 報知部(第1報知部、第2報知部、第3報知部、第4報知部)
227 位置検出部
253 位置情報設定部
D 位置情報
D1 旧位置情報
D2 新位置情報
D11 作業制限範囲
P1 旧位置
P2 新位置
R 基準位置
R1 旧基準位置
R2 新基準位置
1, 201 Position information setting system 10 Work machine 11 Lower traveling body 13 Upper rotating body 15 Attachment 15e Specific part 21 Attitude sensor 25 Feature detection device 51 Old reference position setting unit 53 Old position information setting unit 61 New reference position setting unit 63 New position information setting unit 80 Notification unit (first notification unit, second notification unit , third notification unit, fourth notification unit )
227 Position detection unit 253 Position information setting unit D Position information D1 Old position information D2 New position information D11 Work restriction range P1 Old position P2 New position R Reference position R1 Old reference position R2 New reference position
Claims (7)
前記作業機械の下部走行体に対する前記作業機械の上部旋回体の旋回角度、および前記作業機械のアタッチメントの姿勢を検出する姿勢センサと、
旧基準位置設定部と、
新基準位置設定部と、
を備え、
前記位置情報設定部は、旧位置に前記作業機械が配置されたときと、前記旧位置とは異なる新位置に前記作業機械が配置されたときとで、前記作業機械が配置された作業現場に対する前記位置情報の位置が変わらないように、前記位置情報を設定し、
前記作業機械を基準とした座標系を機械座標系としたとき、
前記旧基準位置設定部は、前記旧位置に前記作業機械が配置されたときの前記機械座標系で、前記作業機械の外部の基準位置を表した旧基準位置を設定し、
前記新基準位置設定部は、前記新位置に前記作業機械が配置されたときの前記機械座標系で前記基準位置を表した新基準位置を設定し、
前記位置情報設定部は、
前記旧位置に前記作業機械が配置されたときの前記機械座標系で前記位置情報を表した旧位置情報を設定する旧位置情報設定部と、
前記新位置に前記作業機械が配置されたときの前記機械座標系で前記位置情報を表した新位置情報を、前記旧位置情報、前記旧基準位置、および前記新基準位置に基づいて演算する新位置情報設定部と、
を備え、
前記旧基準位置設定部および前記新基準位置設定部の少なくともいずれかは、前記アタッチメントの特定部位が前記基準位置に配置されたときの前記姿勢センサの検出結果に基づいて、前記機械座標系で表した前記基準位置を設定する、
位置情報設定システム。 a position information setting unit that sets position information that is information about a position outside the work machine;
an attitude sensor that detects the swing angle of an upper swing body of the work machine relative to a lower traveling body of the work machine and the attitude of an attachment of the work machine;
A previous reference position setting unit;
a new reference position setting unit;
Equipped with
the position information setting unit sets the position information so that the position of the position information relative to the work site where the work machine is located does not change between when the work machine is located at an old position and when the work machine is located at a new position different from the old position,
When the coordinate system based on the work machine is defined as a machine coordinate system,
the old reference position setting unit sets an old reference position that represents a reference position outside the work machine in the machine coordinate system when the work machine was placed at the old position,
the new reference position setting unit sets a new reference position that represents the reference position in the machine coordinate system when the work machine is placed at the new position,
The location information setting unit
an old position information setting unit that sets old position information that represents the position information in the machine coordinate system when the work machine was located at the old position;
a new position information setting unit that calculates new position information that represents the position information in the machine coordinate system when the work machine is placed at the new position, based on the old position information, the old reference position, and the new reference position;
Equipped with
at least one of the old reference position setting unit and the new reference position setting unit sets the reference position expressed in the machine coordinate system based on a detection result of the attitude sensor when the specific part of the attachment is placed at the reference position;
Location setting system.
旧基準位置設定部と、
新基準位置設定部と、
を備え、
前記位置情報設定部は、旧位置に前記作業機械が配置されたときと、前記旧位置とは異なる新位置に前記作業機械が配置されたときとで、前記作業機械が配置された作業現場に対する前記位置情報の位置が変わらないように、前記位置情報を設定し、
前記作業機械を基準とした座標系を機械座標系としたとき、
前記旧基準位置設定部は、前記旧位置に前記作業機械が配置されたときの前記機械座標系で、前記作業機械の外部の基準位置を表した旧基準位置を設定可能であり、
前記新基準位置設定部は、前記新位置に前記作業機械が配置されたときの前記機械座標系で前記基準位置を表した新基準位置を設定し、
前記位置情報設定部は、
前記旧位置に前記作業機械が配置されたときの前記機械座標系で前記位置情報を表した旧位置情報を設定する旧位置情報設定部と、
前記新位置に前記作業機械が配置されたときの前記機械座標系で前記位置情報を表した新位置情報を、前記旧位置情報、前記旧基準位置、および前記新基準位置に基づいて演算する新位置情報設定部と、
を備え、
前記基準位置は、前記作業現場の互いに異なる複数の点であり、
前記旧基準位置設定部は、複数の前記基準位置どうしの間隔が所定の間隔閾値よりも狭い場合、複数の前記基準位置を前記旧基準位置として設定しない、または、第1報知部に報知を行わせる、
位置情報設定システム。 a position information setting unit that sets position information that is information about a position outside the work machine;
A previous reference position setting unit;
a new reference position setting unit;
Equipped with
the position information setting unit sets the position information so that the position of the position information relative to the work site where the work machine is located does not change between when the work machine is located at an old position and when the work machine is located at a new position different from the old position,
When the coordinate system based on the work machine is defined as a machine coordinate system,
the old reference position setting unit is capable of setting an old reference position that represents a reference position outside the work machine in the machine coordinate system when the work machine was disposed at the old position,
the new reference position setting unit sets a new reference position that represents the reference position in the machine coordinate system when the work machine is placed at the new position,
The position information setting unit
an old position information setting unit that sets old position information that represents the position information in the machine coordinate system when the work machine was located at the old position;
a new position information setting unit that calculates new position information that represents the position information in the machine coordinate system when the work machine is placed at the new position, based on the old position information, the old reference position, and the new reference position;
Equipped with
the reference positions are a plurality of different points in the work site,
When an interval between the plurality of reference positions is narrower than a predetermined interval threshold, the old reference position setting unit does not set the plurality of reference positions as the old reference positions or causes a first notification unit to issue a notification.
Location setting system.
前記作業機械の周囲の特徴物を検出する特徴物検出装置を備え、
前記旧基準位置設定部および前記新基準位置設定部の少なくともいずれかは、前記特徴物検出装置の検出結果に基づいて、前記機械座標系で表した前記基準位置を設定する、
位置情報設定システム。 3. The position information setting system according to claim 2,
a feature detection device for detecting a feature around the work machine,
at least one of the old reference position setting unit and the new reference position setting unit sets the reference position expressed in the machine coordinate system based on a detection result of the feature detection device;
Location setting system.
報知を行う第2報知部を備え、
前記第2報知部は、
前記作業機械が前記旧位置から移動した後に、前記作業機械が作業可能となる範囲が所定値よりも狭くなる場合、
前記位置情報が前記作業機械のアタッチメントの特定部位の目標経路である場合であって、前記作業機械が前記旧位置から移動した後に、前記特定部位を前記目標経路に配置できない場合、および、
前記旧位置に配置されていた前記作業機械が走行を開始した場合、
のうち少なくともいずれかの場合に報知を行う、
位置情報設定システム。 The position information setting system according to any one of claims 1 to 3,
a second notification unit that issues a notification ;
The second notification unit is
If the range in which the work machine is capable of working becomes narrower than a predetermined value after the work machine has moved from the previous position,
When the position information is a target path for a specific part of an attachment of the work machine, and the specific part cannot be located on the target path after the work machine moves from the previous position, and
When the work machine located at the old position starts traveling,
In at least one of the cases, a notification is made.
Location setting system.
報知を行う第3報知部を備え、
前記第3報知部は、前記作業機械が前記旧位置から移動したときに、前記作業機械を前記旧位置側に移動させることを促す通知、および、前記位置情報の再設定を促す通知、の少なくともいずれかの通知を行う、
位置情報設定システム。 The position information setting system according to any one of claims 1 to 4,
a third notification unit that issues a notification ;
when the work machine has moved from the old position, the third notification unit issues at least one of a notification urging the work machine to move toward the old position and a notification urging the work machine to reset the position information.
Location setting system.
前記位置情報は、前記作業機械の作業を制限する範囲である作業制限範囲の情報である、
位置情報設定システム。 The position information setting system according to any one of claims 1 to 5 ,
The position information is information about a work restriction range, which is a range in which work by the work machine is restricted.
Location setting system.
前記旧位置から前記新位置までの距離が、所定の距離閾値以上のときに報知を行う第4報知部を備える、
位置情報設定システム。 The position information setting system according to any one of claims 1 to 6 ,
a fourth notification unit that issues a notification when the distance from the old position to the new position is equal to or greater than a predetermined distance threshold;
Location setting system.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2021179511A JP7809945B2 (en) | 2021-11-02 | 2021-11-02 | Location Information Setting System |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2021179511A JP7809945B2 (en) | 2021-11-02 | 2021-11-02 | Location Information Setting System |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2023068408A JP2023068408A (en) | 2023-05-17 |
| JP7809945B2 true JP7809945B2 (en) | 2026-02-03 |
Family
ID=86327034
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2021179511A Active JP7809945B2 (en) | 2021-11-02 | 2021-11-02 | Location Information Setting System |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7809945B2 (en) |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2017049792A (en) | 2015-09-02 | 2017-03-09 | 株式会社中電工 | Designated range monitoring system |
| US20170089032A1 (en) | 2014-03-18 | 2017-03-30 | Novatron Oy | System and method for positioning construction machine |
| JP2019173467A (en) | 2018-03-29 | 2019-10-10 | コベルコ建機株式会社 | Construction machine |
| JP2020183624A (en) | 2019-04-26 | 2020-11-12 | 住友建機株式会社 | Shovel |
| JP2021055276A (en) | 2019-09-27 | 2021-04-08 | 日立建機株式会社 | Work machine |
| JP2021055381A (en) | 2019-09-30 | 2021-04-08 | 日立建機株式会社 | Area setting support system and work vehicle equipped with the same |
| JP2022157472A (en) | 2021-03-31 | 2022-10-14 | 日立建機株式会社 | Construction machine |
-
2021
- 2021-11-02 JP JP2021179511A patent/JP7809945B2/en active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20170089032A1 (en) | 2014-03-18 | 2017-03-30 | Novatron Oy | System and method for positioning construction machine |
| JP2017049792A (en) | 2015-09-02 | 2017-03-09 | 株式会社中電工 | Designated range monitoring system |
| JP2019173467A (en) | 2018-03-29 | 2019-10-10 | コベルコ建機株式会社 | Construction machine |
| JP2020183624A (en) | 2019-04-26 | 2020-11-12 | 住友建機株式会社 | Shovel |
| JP2021055276A (en) | 2019-09-27 | 2021-04-08 | 日立建機株式会社 | Work machine |
| JP2021055381A (en) | 2019-09-30 | 2021-04-08 | 日立建機株式会社 | Area setting support system and work vehicle equipped with the same |
| JP2022157472A (en) | 2021-03-31 | 2022-10-14 | 日立建機株式会社 | Construction machine |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2023068408A (en) | 2023-05-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| AU2022209235B2 (en) | Display control device and display control method | |
| AU2019292457B2 (en) | Display control device, display control system, and display control method | |
| JP2002328022A (en) | Terrain shape measurement device and guidance device | |
| JP7080750B2 (en) | Display control system, remote control system, display control device, and display control method | |
| JP6918716B2 (en) | Construction machinery | |
| JP7023813B2 (en) | Work machine | |
| WO2018026021A1 (en) | Management system | |
| AU2025203439A1 (en) | Construction management system, data processing device, and construction management method | |
| AU2021354304B2 (en) | Display control device and display method | |
| JP7809945B2 (en) | Location Information Setting System | |
| JP2008025163A (en) | Drilling positioning control method for rock drill-equipped truck, and boom positioning control method for construction machinery | |
| AU2021352215B2 (en) | Display control device and display control method | |
| EP4692475A1 (en) | Position identification system, position identification device, and position identification method | |
| JP2021156000A (en) | Work machine | |
| JP2025153388A (en) | Driving plan setting system | |
| WO2026028798A1 (en) | Information presentation system | |
| US20250314047A1 (en) | Work machine implement control for autonomous subterranean surveying and marking applications | |
| US20240135554A1 (en) | Visual localization and feature detection for an implement tracking system | |
| JP2025153189A (en) | Construction System | |
| WO2024214297A1 (en) | Topography measurement device, topography measurement system, work machine, topography measurement method, reference point setting registration method, and program | |
| JP2025071764A (en) | Work information setting system, work information setting program, and work information setting method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20240805 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20250325 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20250507 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20250626 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20251007 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20251208 |
|
| 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: 20251223 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20260105 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7809945 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |