JP6598685B2 - Excavator - Google Patents

Excavator Download PDF

Info

Publication number
JP6598685B2
JP6598685B2 JP2016000630A JP2016000630A JP6598685B2 JP 6598685 B2 JP6598685 B2 JP 6598685B2 JP 2016000630 A JP2016000630 A JP 2016000630A JP 2016000630 A JP2016000630 A JP 2016000630A JP 6598685 B2 JP6598685 B2 JP 6598685B2
Authority
JP
Japan
Prior art keywords
turning
output
turning angle
sensor
angle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2016000630A
Other languages
Japanese (ja)
Other versions
JP2017122602A (en
Inventor
岳哉 泉川
崇昭 守本
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sumitomo SHI Construction Machinery Co Ltd
Original Assignee
Sumitomo SHI Construction Machinery Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sumitomo SHI Construction Machinery Co Ltd filed Critical Sumitomo SHI Construction Machinery Co Ltd
Priority to JP2016000630A priority Critical patent/JP6598685B2/en
Priority to CN201710006268.XA priority patent/CN106988358B/en
Publication of JP2017122602A publication Critical patent/JP2017122602A/en
Application granted granted Critical
Publication of JP6598685B2 publication Critical patent/JP6598685B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/30Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
    • E02F3/32Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Component Parts Of Construction Machinery (AREA)
  • Operation Control Of Excavators (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Description

本発明は、旋回角度を導出する機能を備えたショベルに関する。   The present invention relates to an excavator having a function of deriving a turning angle.

旋回体に取り付けられたジャイロセンサの出力に基づいて走行体に対する旋回体の旋回角度を導出するショベルが知られている(例えば、特許文献1参照)。   There is known an excavator that derives a turning angle of a turning body with respect to a traveling body based on an output of a gyro sensor attached to the turning body (for example, see Patent Document 1).

また、旋回体及び走行体のそれぞれに取り付けられた一対の地磁気センサの出力差から走行体に対する旋回体の旋回角度を導出するショベルが知られている(例えば、特許文献2参照)。   There is also known an excavator that derives the turning angle of the turning body relative to the running body from the output difference between a pair of geomagnetic sensors attached to the turning body and the running body (see, for example, Patent Document 2).

特開2005−61024号公報Japanese Patent Laid-Open No. 2005-61024 特開平9−21605号公報Japanese Patent Laid-Open No. 9-21605

しかしながら、特許文献1の構成は、ジャイロセンサの出力である角速度を積算して旋回角度を算出するため、算出した旋回角度にはジャイロセンサ出力におけるノイズが積算されて大きな誤差が生じるおそれがある。また、特許文献2の地磁気センサは、周囲の磁場の影響を受け易いため、旋回角度を安定的に出力できないおそれがある。   However, since the configuration of Patent Document 1 calculates the turning angle by integrating the angular velocity that is the output of the gyro sensor, noise in the gyro sensor output may be added to the calculated turning angle and a large error may occur. Moreover, since the geomagnetic sensor of patent document 2 is easy to be influenced by the surrounding magnetic field, there exists a possibility that a turning angle cannot be output stably.

上述に鑑み、より小さい誤差で安定的に旋回角度を導出できるショベルを提供することが望ましい。   In view of the above, it is desirable to provide an excavator that can stably derive the turning angle with a smaller error.

本発明の実施例に係るショベルは、下部走行体と、前記下部走行体に旋回可能に搭載される上部旋回体と、前記上部旋回体に取り付けられる角速度センサと、旋回操作情報と前記角速度センサの出力とに基づいて前記上部旋回体の旋回角度を算出する演算処理装置と、前記上部旋回体に取り付けられる地磁気センサと、を備え、前記演算処理装置は、前記地磁気センサの出力を用いて旋回角度を算出する。

An excavator according to an embodiment of the present invention includes a lower traveling body, an upper revolving body that is turnably mounted on the lower traveling body, an angular velocity sensor that is attached to the upper revolving body, turning operation information, and the angular velocity sensor. And an arithmetic processing device that calculates a turning angle of the upper swing body based on an output, and a geomagnetic sensor attached to the upper swing body, the arithmetic processing device using the output of the geomagnetic sensor. you calculated.

上述の手段により、より小さい誤差で安定的に旋回角度を導出できるショベルを提供できる。   By the above-described means, it is possible to provide a shovel that can stably derive the turning angle with a smaller error.

本発明の実施例に係るショベルの側面図である。It is a side view of the shovel which concerns on the Example of this invention. 図1のショベルの駆動系の構成を示す図である。It is a figure which shows the structure of the drive system of the shovel of FIG. マシンガイダンス装置の構成例を示すブロック図である。It is a block diagram which shows the structural example of a machine guidance apparatus. 旋回角度導出処理のフローチャートである。It is a flowchart of turning angle derivation processing. 旋回操作が断続的に行われたときの各種物理量の時間的推移を示す図である。It is a figure which shows the time transition of various physical quantities when turning operation is performed intermittently.

図1は本発明の実施例に係るショベル(掘削機)の側面図である。ショベルの下部走行体1には旋回機構2を介して上部旋回体3が旋回可能に搭載される。上部旋回体3にはブーム4が取り付けられる。ブーム4の先端にはアーム5が取り付けられ、アーム5の先端にはエンドアタッチメントとしてのバケット6が取り付けられる。エンドアタッチメントとして、法面用バケット、浚渫用バケット等が用いられてもよい。   FIG. 1 is a side view of an excavator (excavator) according to an embodiment of the present invention. An upper swing body 3 is mounted on the lower traveling body 1 of the excavator via a swing mechanism 2 so as to be capable of swinging. A boom 4 is attached to the upper swing body 3. An arm 5 is attached to the tip of the boom 4, and a bucket 6 as an end attachment is attached to the tip of the arm 5. As an end attachment, a slope bucket, a kite bucket, or the like may be used.

ブーム4、アーム5、及びバケット6は、アタッチメントの一例として掘削アタッチメントを構成し、ブームシリンダ7、アームシリンダ8、及びバケットシリンダ9によりそれぞれ油圧駆動される。ブーム4にはブーム角度センサS1が取り付けられ、アーム5にはアーム角度センサS2が取り付けられ、バケット6にはバケット角度センサS3が取り付けられる。掘削アタッチメントには、バケットチルト機構が設けられてもよい。   The boom 4, the arm 5, and the bucket 6 constitute a drilling attachment as an example of the attachment, and are hydraulically driven by the boom cylinder 7, the arm cylinder 8, and the bucket cylinder 9, respectively. A boom angle sensor S1 is attached to the boom 4, an arm angle sensor S2 is attached to the arm 5, and a bucket angle sensor S3 is attached to the bucket 6. The excavation attachment may be provided with a bucket tilt mechanism.

ブーム角度センサS1はブーム4の回動角度を検出する。本実施例では、ブーム角度センサS1は水平面に対する傾斜を検出して上部旋回体3に対するブーム4の回動角度を検出する加速度センサである。   The boom angle sensor S1 detects the rotation angle of the boom 4. In the present embodiment, the boom angle sensor S <b> 1 is an acceleration sensor that detects a tilt angle with respect to the horizontal plane and detects a rotation angle of the boom 4 with respect to the upper swing body 3.

アーム角度センサS2はアーム5の回動角度を検出する。本実施例では、アーム角度センサS2は水平面に対する傾斜を検出してブーム4に対するアーム5の回動角度を検出する加速度センサである。   The arm angle sensor S2 detects the rotation angle of the arm 5. In the present embodiment, the arm angle sensor S <b> 2 is an acceleration sensor that detects the rotation angle of the arm 5 relative to the boom 4 by detecting the inclination with respect to the horizontal plane.

バケット角度センサS3はバケット6の回動角度を検出する。本実施例では、バケット角度センサS3は水平面に対する傾斜を検出してアーム5に対するバケット6の回動角度を検出する加速度センサである。掘削アタッチメントがバケットチルト機構を備える場合、バケット角度センサS3はチルト軸回りのバケット6の回動角度を追加的に検出する。   Bucket angle sensor S3 detects the rotation angle of bucket 6. In the present embodiment, the bucket angle sensor S3 is an acceleration sensor that detects the rotation angle of the bucket 6 with respect to the arm 5 by detecting the inclination with respect to the horizontal plane. When the excavation attachment includes a bucket tilt mechanism, the bucket angle sensor S3 additionally detects the rotation angle of the bucket 6 around the tilt axis.

ブーム角度センサS1、アーム角度センサS2、及びバケット角度センサS3は、可変抵抗器を利用したポテンショメータ、対応する油圧シリンダのストローク量を検出するストロークセンサ、連結ピン回りの回動角度を検出するロータリエンコーダ等であってもよい。   The boom angle sensor S1, the arm angle sensor S2, and the bucket angle sensor S3 are a potentiometer using a variable resistor, a stroke sensor that detects a stroke amount of a corresponding hydraulic cylinder, and a rotary encoder that detects a rotation angle around a connecting pin. Etc.

上部旋回体3にはキャビン10が設けられ且つエンジン11等の動力源が搭載される。また、上部旋回体3には機体傾斜センサS4、旋回角速度センサS5、カメラS6、通信装置S7、測位装置S8、地磁気センサS9が取り付けられる。   The upper swing body 3 is provided with a cabin 10 and is mounted with a power source such as an engine 11. In addition, a machine body tilt sensor S4, a turning angular velocity sensor S5, a camera S6, a communication device S7, a positioning device S8, and a geomagnetic sensor S9 are attached to the upper turning body 3.

機体傾斜センサS4は水平面に対する上部旋回体3の傾斜を検出する。本実施例では、機体傾斜センサS4は上部旋回体3の前後軸及び左右軸回りの傾斜角を検出する2軸加速度センサである。なお、上部旋回体3の前後軸及び左右軸は、例えば、互いに直交してショベルの旋回軸上の一点であるショベル中心点を通る。機体傾斜センサS4は、3軸加速度センサであってもよい。   The body tilt sensor S4 detects the tilt of the upper swing body 3 with respect to the horizontal plane. In the present embodiment, the body tilt sensor S4 is a biaxial acceleration sensor that detects the tilt angles of the upper swing body 3 around the front and rear axes and the left and right axes. In addition, the front-rear axis and the left-right axis of the upper swing body 3 pass through a shovel center point that is one point on the swing axis of the shovel, for example, orthogonal to each other. Airframe tilt sensor S4 may be a triaxial acceleration sensor.

旋回角速度センサS5は、上部旋回体3の旋回角速度を導出する。本実施例では、旋回角速度センサS5はジャイロセンサである。   The turning angular velocity sensor S5 derives the turning angular velocity of the upper turning body 3. In the present embodiment, the turning angular velocity sensor S5 is a gyro sensor.

カメラS6はショベルの周辺の画像を取得する撮像装置である。本実施例では、カメラS6は上部旋回体3に取り付けられる1又は複数台のカメラである。   The camera S6 is an imaging device that acquires an image around the excavator. In the present embodiment, the camera S6 is one or a plurality of cameras attached to the upper swing body 3.

通信装置S7は、ショベルと外部との間の通信を制御する装置である。通信装置S7は、例えば、GNSS(Global Navigation Satellite System)等の測量システムとショベルとの間の無線通信を制御する。ショベルは、通信装置S7を用いることで無線通信を介して目標施工面に関する情報等を含む設計データを取得できる。但し、ショベルは、半導体メモリ等を用いて設計データを取得してもよい。   The communication device S7 is a device that controls communication between the shovel and the outside. The communication device S7 controls wireless communication between a surveying system such as a GNSS (Global Navigation Satellite System) and an excavator, for example. The shovel can acquire design data including information on the target construction surface and the like via wireless communication by using the communication device S7. However, the shovel may acquire design data using a semiconductor memory or the like.

測位装置S8は、ショベルの位置及び向きを測定する装置である。本実施例では、測位装置S8は、電子コンパスを組み込んだGNSS受信機であり、ショベルの存在位置の緯度、経度、高度を測定し、且つ、ショベルの向きを測定する。   The positioning device S8 is a device that measures the position and orientation of the excavator. In the present embodiment, the positioning device S8 is a GNSS receiver that incorporates an electronic compass, and measures the latitude, longitude, and altitude of the location of the shovel and measures the direction of the shovel.

地磁気センサS9は地磁気を検出するセンサである。本実施例では、地磁気センサS9は3軸地磁気センサである。地磁気センサS9は、上部旋回体3に取り付けられた上部地磁気センサと下部走行体1に取り付けられた下部地磁気センサとの組み合わせで構成されてもよい。   The geomagnetic sensor S9 is a sensor that detects geomagnetism. In this embodiment, the geomagnetic sensor S9 is a triaxial geomagnetic sensor. The geomagnetic sensor S <b> 9 may be configured by a combination of an upper geomagnetic sensor attached to the upper swing body 3 and a lower geomagnetic sensor attached to the lower traveling body 1.

キャビン10内には、入力装置D1、音声出力装置D2、表示装置D3、記憶装置D4、ゲートロックレバーD5、コントローラ30、及びマシンガイダンス装置50が設置される。   In the cabin 10, an input device D1, an audio output device D2, a display device D3, a storage device D4, a gate lock lever D5, a controller 30, and a machine guidance device 50 are installed.

コントローラ30は、ショベルの駆動制御を行う主制御部として機能する。本実施例では、コントローラ30は、CPU及び内部メモリを含む演算処理装置で構成される。コントローラ30の各種機能は、CPUが内部メモリに格納されたプログラムを実行することで実現される。   The controller 30 functions as a main control unit that performs drive control of the shovel. In this embodiment, the controller 30 is composed of an arithmetic processing unit including a CPU and an internal memory. Various functions of the controller 30 are realized by the CPU executing programs stored in the internal memory.

マシンガイダンス装置50は、ショベルの操作をガイドする。本実施例では、マシンガイダンス装置50は、例えば、操作者が設定した目標施工面とバケット6の先端(爪先)位置との鉛直方向における距離を視覚的に且つ聴覚的に操作者に報知する。これにより、マシンガイダンス装置50は操作者によるショベルの操作をガイドする。なお、マシンガイダンス装置50は、その距離を視覚的に操作者に知らせるのみであってもよく、聴覚的に操作者に知らせるのみであってもよい。具体的には、マシンガイダンス装置50は、コントローラ30と同様、CPU及び内部メモリを含む演算処理装置で構成される。マシンガイダンス装置50の各種機能はCPUが内部メモリに格納されたプログラムを実行することで実現される。マシンガイダンス装置50は、コントローラ30とは別個に設けられてもよく、或いは、コントローラ30に組み込まれていてもよい。   The machine guidance device 50 guides the operation of the excavator. In the present embodiment, the machine guidance device 50 visually and audibly notifies the operator of the distance in the vertical direction between the target construction surface set by the operator and the tip (toe) position of the bucket 6, for example. Thereby, the machine guidance apparatus 50 guides the operation of the shovel by the operator. Note that the machine guidance device 50 may only notify the operator of the distance visually or may only notify the operator audibly. Specifically, like the controller 30, the machine guidance device 50 is configured by an arithmetic processing device including a CPU and an internal memory. Various functions of the machine guidance device 50 are realized by the CPU executing a program stored in the internal memory. The machine guidance device 50 may be provided separately from the controller 30 or may be incorporated in the controller 30.

入力装置D1は、ショベルの操作者がマシンガイダンス装置50に各種情報を入力するための装置である。本実施例では、入力装置D1は、表示装置D3の周囲に取り付けられるメンブレンスイッチである。入力装置D1としてタッチパネル等が用いられてもよい。   The input device D1 is a device for an excavator operator to input various information to the machine guidance device 50. In this embodiment, the input device D1 is a membrane switch attached around the display device D3. A touch panel or the like may be used as the input device D1.

音声出力装置D2は、マシンガイダンス装置50からの音声出力指令に応じて各種音声情報を出力する。本実施例では、音声出力装置D2として、マシンガイダンス装置50に直接接続される車載スピーカが利用される。なお、音声出力装置D2として、ブザー等の警報器が利用されてもよい。   The audio output device D2 outputs various audio information in response to an audio output command from the machine guidance device 50. In this embodiment, an in-vehicle speaker connected directly to the machine guidance device 50 is used as the audio output device D2. An alarm device such as a buzzer may be used as the audio output device D2.

表示装置D3は、マシンガイダンス装置50からの指令に応じて各種画像情報を出力する。本実施例では、表示装置D3として、マシンガイダンス装置50に直接接続される車載液晶ディスプレイが利用される。   The display device D3 outputs various image information in response to a command from the machine guidance device 50. In this embodiment, an in-vehicle liquid crystal display directly connected to the machine guidance device 50 is used as the display device D3.

記憶装置D4は、各種情報を記憶するための装置である。本実施例では、記憶装置D4として、半導体メモリ等の不揮発性記憶媒体が用いられる。記憶装置D4は、マシンガイダンス装置50等が出力する各種情報を記憶する。   The storage device D4 is a device for storing various information. In the present embodiment, a nonvolatile storage medium such as a semiconductor memory is used as the storage device D4. The storage device D4 stores various information output by the machine guidance device 50 and the like.

ゲートロックレバーD5は、ショベルが誤って操作されるのを防止する機構である。本実施例では、ゲートロックレバーD5は、キャビン10のドアと運転席との間に配置される。キャビン10から操作者が退出できないようにゲートロックレバーD5が引き上げられた場合に、各種操作装置は操作可能となる。一方、キャビン10から操作者が退出できるようにゲートロックレバーD5が押し下げられた場合には、各種操作装置は操作不能となる。   The gate lock lever D5 is a mechanism that prevents the shovel from being operated accidentally. In the present embodiment, the gate lock lever D5 is disposed between the door of the cabin 10 and the driver's seat. When the gate lock lever D5 is pulled up so that the operator cannot leave the cabin 10, the various operation devices can be operated. On the other hand, when the gate lock lever D5 is pushed down so that the operator can leave the cabin 10, the various operation devices become inoperable.

図2は、図1のショベルの駆動系の構成例を示す図である。図2において、機械的動力系は二重線、高圧油圧ラインは太実線、パイロットラインは破線、電気駆動・制御系は細実線でそれぞれ示される。   FIG. 2 is a diagram illustrating a configuration example of a drive system of the shovel of FIG. In FIG. 2, the mechanical power system is indicated by a double line, the high-pressure hydraulic line is indicated by a thick solid line, the pilot line is indicated by a broken line, and the electric drive / control system is indicated by a thin solid line.

エンジン11はショベルの動力源である。本実施例では、エンジン11は、エンジン負荷の増減にかかわらずエンジン回転数を一定に維持するアイソクロナス制御を採用したディーゼルエンジンである。エンジン11における燃料噴射量、燃料噴射タイミング、ブースト圧等は、エンジンコントローラユニット(ECU)D7により制御される。   The engine 11 is a power source for the excavator. In this embodiment, the engine 11 is a diesel engine that employs isochronous control that keeps the engine speed constant regardless of increase or decrease in engine load. The fuel injection amount, fuel injection timing, boost pressure and the like in the engine 11 are controlled by an engine controller unit (ECU) D7.

エンジン11には油圧ポンプとしてのメインポンプ14及びパイロットポンプ15が接続される。メインポンプ14には高圧油圧ラインを介してコントロールバルブ17が接続される。   The engine 11 is connected with a main pump 14 and a pilot pump 15 as hydraulic pumps. A control valve 17 is connected to the main pump 14 via a high pressure hydraulic line.

コントロールバルブ17は、ショベルの油圧系の制御を行う油圧制御装置である。右側走行用油圧モータ、左側走行用油圧モータ、ブームシリンダ7、アームシリンダ8、バケットシリンダ9、旋回用油圧モータ等の油圧アクチュエータは、高圧油圧ラインを介してコントロールバルブ17に接続される。なお、旋回用油圧モータは旋回用電動発電機であってもよい。   The control valve 17 is a hydraulic control device that controls the hydraulic system of the shovel. Hydraulic actuators such as a right traveling hydraulic motor, a left traveling hydraulic motor, a boom cylinder 7, an arm cylinder 8, a bucket cylinder 9, and a turning hydraulic motor are connected to a control valve 17 via a high pressure hydraulic line. The turning hydraulic motor may be a turning motor generator.

パイロットポンプ15にはパイロットラインを介して操作装置26が接続される。操作装置26はレバー及びペダルを含む。また、操作装置26は、油圧ライン及びゲートロック弁D6を介してコントロールバルブ17に接続される。   An operation device 26 is connected to the pilot pump 15 via a pilot line. The operating device 26 includes a lever and a pedal. The operating device 26 is connected to the control valve 17 via a hydraulic line and a gate lock valve D6.

ゲートロック弁D6は、コントロールバルブ17と操作装置26とを接続する油圧ラインの連通・遮断を切り換える。本実施例では、ゲートロック弁D6は、コントローラ30からの指令に応じて油圧ラインの連通・遮断を切り換える電磁弁である。コントローラ30は、ゲートロックレバーD5が出力する状態信号に基づいてゲートロックレバーD5の状態を判定する。そして、コントローラ30は、ゲートロックレバーD5が引き上げられた状態にあると判定した場合に、ゲートロック弁D6に対して連通指令を出力する。連通指令を受けると、ゲートロック弁D6は開いて油圧ラインを連通させる。その結果、操作装置26に対する操作者の操作が有効となる。一方、コントローラ30は、ゲートロックレバーD5が引き下げられた状態にあると判定した場合に、ゲートロック弁D6に対して遮断指令を出力する。遮断指令を受けると、ゲートロック弁D6は閉じて油圧ラインを遮断する。その結果、操作装置26に対する操作者の操作が無効となる。   The gate lock valve D6 switches communication / interruption of a hydraulic line connecting the control valve 17 and the operating device 26. In the present embodiment, the gate lock valve D6 is an electromagnetic valve that switches between connection and disconnection of the hydraulic line in accordance with a command from the controller 30. The controller 30 determines the state of the gate lock lever D5 based on the state signal output from the gate lock lever D5. When the controller 30 determines that the gate lock lever D5 is in the raised state, the controller 30 outputs a communication command to the gate lock valve D6. When the communication command is received, the gate lock valve D6 is opened to connect the hydraulic line. As a result, the operator's operation on the operation device 26 becomes effective. On the other hand, when the controller 30 determines that the gate lock lever D5 is in the lowered state, the controller 30 outputs a cutoff command to the gate lock valve D6. When the shutoff command is received, the gate lock valve D6 is closed to shut off the hydraulic line. As a result, the operator's operation on the operation device 26 becomes invalid.

圧力センサ29は、操作装置26の操作内容を圧力の形で検出する。圧力センサ29は、検出値をコントローラ30に対して出力する。   The pressure sensor 29 detects the operation content of the operating device 26 in the form of pressure. The pressure sensor 29 outputs the detection value to the controller 30.

また、図2はコントローラ30と表示装置D3との接続関係を示す。本実施例では、表示装置D3はマシンガイダンス装置50を介してコントローラ30に接続される。なお、表示装置D3、マシンガイダンス装置50、及びコントローラ30は、CAN等の通信ネットワークを介して接続されてもよく、専用線を介して接続されてもよい。   FIG. 2 shows the connection relationship between the controller 30 and the display device D3. In the present embodiment, the display device D3 is connected to the controller 30 via the machine guidance device 50. The display device D3, the machine guidance device 50, and the controller 30 may be connected via a communication network such as CAN or may be connected via a dedicated line.

表示装置D3は画像を生成する変換処理部D3aを含む。本実施例では、変換処理部D3aは、カメラS6の出力に基づいて表示用のカメラ画像を生成する。そのため、表示装置D3は、マシンガイダンス装置50を介し、マシンガイダンス装置50に接続されたカメラS6の出力を取得する。但し、カメラS6は、表示装置D3に接続されてもよく、コントローラ30に接続されてもよい。   The display device D3 includes a conversion processing unit D3a that generates an image. In the present embodiment, the conversion processing unit D3a generates a camera image for display based on the output of the camera S6. Therefore, the display device D3 acquires the output of the camera S6 connected to the machine guidance device 50 via the machine guidance device 50. However, the camera S6 may be connected to the display device D3 or may be connected to the controller 30.

また、変換処理部D3aは、コントローラ30又はマシンガイダンス装置50の出力に基づいて表示用の画像を生成する。本実施例では、変換処理部D3aは、コントローラ30又はマシンガイダンス装置50が出力する各種情報を画像信号に変換する。なお、コントローラ30が出力する情報は、例えば、エンジン冷却水の温度を示すデータ、作動油の温度を示すデータ、燃料の残量を示すデータ等を含む。また、マシンガイダンス装置50が出力する情報は、バケット6の先端(爪先)位置を示すデータ、作業対象の法面の向きを示すデータ、ショベルの向きを示すデータ、ショベルを法面に正対させるための操作方向を示すデータ等を含む。   The conversion processing unit D3a generates a display image based on the output of the controller 30 or the machine guidance device 50. In the present embodiment, the conversion processing unit D3a converts various information output from the controller 30 or the machine guidance device 50 into an image signal. The information output by the controller 30 includes, for example, data indicating the temperature of engine cooling water, data indicating the temperature of hydraulic oil, data indicating the remaining amount of fuel, and the like. The information output by the machine guidance device 50 includes data indicating the tip (toe) position of the bucket 6, data indicating the direction of the slope of the work target, data indicating the direction of the shovel, and the shovel facing the slope. For example, data indicating the operation direction is included.

なお、変換処理部D3aは、表示装置D3が有する機能としてではなく、コントローラ30又はマシンガイダンス装置50が有する機能として実現されてもよい。   Note that the conversion processing unit D3a may be realized not as a function of the display device D3 but as a function of the controller 30 or the machine guidance device 50.

また、表示装置D3は、蓄電池70から電力の供給を受けて動作する。なお、蓄電池70はエンジン11のオルタネータ11a(発電機)で発電した電力で充電される。蓄電池70の電力は、コントローラ30及び表示装置D3以外のショベルの電装品72等にも供給される。また、エンジン11のスタータ11bは、蓄電池70からの電力で駆動され、エンジン11を始動する。   Further, the display device D3 operates by receiving power from the storage battery 70. The storage battery 70 is charged with electric power generated by the alternator 11a (generator) of the engine 11. The electric power of the storage battery 70 is also supplied to the electrical equipment 72 of the excavator other than the controller 30 and the display device D3. Further, the starter 11 b of the engine 11 is driven by electric power from the storage battery 70 and starts the engine 11.

エンジン11は、エンジンコントローラユニットD7により制御される。エンジンコントローラユニットD7からは、エンジン11の状態を示す各種データ(例えば、水温センサ11cで検出される冷却水温(物理量)を示すデータ)がコントローラ30に常時送信される。したがって、コントローラ30は一時記憶部(メモリ)30aにこのデータを蓄積しておき、必要なときに表示装置D3に送信することができる。   The engine 11 is controlled by the engine controller unit D7. Various data indicating the state of the engine 11 (for example, data indicating the cooling water temperature (physical quantity) detected by the water temperature sensor 11c) is constantly transmitted from the engine controller unit D7 to the controller 30. Therefore, the controller 30 can store this data in the temporary storage unit (memory) 30a and transmit it to the display device D3 when necessary.

また、コントローラ30には以下のように各種のデータが供給され、コントローラ30の一時記憶部30aに格納される。   Various data are supplied to the controller 30 as described below and stored in the temporary storage unit 30a of the controller 30.

まず、可変容量式油圧ポンプであるメインポンプ14のレギュレータ14aから斜板傾転角を示すデータがコントローラ30に供給される。また、メインポンプ14の吐出圧力を示すデータが、吐出圧力センサ14bからコントローラ30に送られる。これらのデータ(物理量を表すデータ)は一時記憶部30aに格納される。また、メインポンプ14が吸入する作動油が貯蔵されたタンクとメインポンプ14との間の管路には油温センサ14cが設けられており、その管路を流れる作動油の温度を表すデータが油温センサ14cからコントローラ30に供給される。   First, data indicating the swash plate tilt angle is supplied to the controller 30 from the regulator 14a of the main pump 14 which is a variable displacement hydraulic pump. Further, data indicating the discharge pressure of the main pump 14 is sent from the discharge pressure sensor 14b to the controller 30. These data (data representing physical quantities) are stored in the temporary storage unit 30a. An oil temperature sensor 14c is provided in a pipe line between the main pump 14 and a tank in which the hydraulic oil sucked by the main pump 14 is stored, and data representing the temperature of the hydraulic oil flowing through the pipe line. It is supplied to the controller 30 from the oil temperature sensor 14c.

また、燃料収容部55における燃料収容量検出部55aから燃料収容量を示すデータがコントローラ30に供給される。本実施例では、燃料収容部55としての燃料タンクにおける燃料収容量検出部55aとしての燃料残量センサから燃料の残量状態を示すデータがコントローラ30に供給される。   Further, data indicating the fuel storage amount is supplied to the controller 30 from the fuel storage amount detection unit 55 a in the fuel storage unit 55. In the present embodiment, data indicating the remaining amount of fuel is supplied to the controller 30 from a fuel remaining amount sensor as the fuel storage amount detection unit 55 a in the fuel tank as the fuel storage unit 55.

具体的には、燃料残量センサは、液面に追従するフロートと、フロートの上下変動量を抵抗値に変換する可変抵抗器(ポテンショメータ)とで構成される。この構成により、燃料残量センサは、表示装置D3で燃料の残量状態を無段階表示させることができる。なお、燃料収容量検出部の検出方式は、使用環境等に応じて適宜選択され得るものであり、燃料の残量状態を段階表示させることができる検出方式が採用されてもよい。   Specifically, the fuel remaining amount sensor includes a float that follows the liquid level, and a variable resistor (potentiometer) that converts the amount of vertical fluctuation of the float into a resistance value. With this configuration, the fuel remaining amount sensor can continuously display the fuel remaining state on the display device D3. Note that the detection method of the fuel storage amount detection unit can be appropriately selected according to the use environment and the like, and a detection method capable of displaying the remaining fuel level in stages may be adopted.

また、操作装置26を操作した際にコントロールバルブ17に送られるパイロット圧が、圧力センサ29で検出され、検出したパイロット圧を示すデータがコントローラ30に供給される。   A pilot pressure sent to the control valve 17 when the operating device 26 is operated is detected by the pressure sensor 29, and data indicating the detected pilot pressure is supplied to the controller 30.

また、本実施例では、図2に示すように、ショベルは、キャビン10内にエンジン回転数調整ダイヤル75を備える。エンジン回転数調整ダイヤル75は、エンジン11の回転数を調整するためのダイヤルであり、本実施例ではエンジン回転数を4段階で切り換えできるようにする。また、エンジン回転数調整ダイヤル75からは、エンジン回転数の設定状態を示すデータがコントローラ30に常時送信される。また、エンジン回転数調整ダイヤル75は、SPモード、Hモード、Aモード、及びアイドリングモードの4段階でエンジン回転数を切り換えできるようにする。なお、図2は、エンジン回転数調整ダイヤル75でHモードが選択された状態を示す。   In this embodiment, as shown in FIG. 2, the excavator includes an engine speed adjustment dial 75 in the cabin 10. The engine rotation speed adjustment dial 75 is a dial for adjusting the rotation speed of the engine 11, and in this embodiment, the engine rotation speed can be switched in four stages. Further, data indicating the setting state of the engine speed is constantly transmitted from the engine speed adjustment dial 75 to the controller 30. Further, the engine speed adjustment dial 75 allows the engine speed to be switched in four stages of SP mode, H mode, A mode, and idling mode. FIG. 2 shows a state in which the H mode is selected with the engine speed adjustment dial 75.

SPモードは、作業量を優先したい場合に選択される回転数モードであり、最も高いエンジン回転数を利用する。Hモードは、作業量と燃費を両立させたい場合に選択される回転数モードであり、二番目に高いエンジン回転数を利用する。Aモードは、燃費を優先させながら低騒音でショベルを稼働させたい場合に選択される回転数モードであり、三番目に高いエンジン回転数を利用する。アイドリングモードは、エンジン11をアイドリング状態にしたい場合に選択される回転数モードであり、最も低いエンジン回転数を利用する。そして、エンジン11は、エンジン回転数調整ダイヤル75で設定された回転数モードのエンジン回転数で一定に回転数制御される。   The SP mode is a rotation speed mode that is selected when priority is given to the amount of work, and uses the highest engine speed. The H mode is a rotation speed mode that is selected when both the work amount and the fuel consumption are desired, and uses the second highest engine speed. The A mode is a rotation speed mode that is selected when it is desired to operate the shovel with low noise while giving priority to fuel consumption, and uses the third highest engine speed. The idling mode is a rotational speed mode that is selected when the engine 11 is desired to be in an idling state, and uses the lowest engine rotational speed. The engine 11 is controlled at a constant speed with the engine speed in the speed mode set with the engine speed adjustment dial 75.

次に、図3を参照しながら、マシンガイダンス装置50の各種機能要素について説明する。図3は、マシンガイダンス装置50の構成例を示す機能ブロック図である。   Next, various functional elements of the machine guidance device 50 will be described with reference to FIG. FIG. 3 is a functional block diagram illustrating a configuration example of the machine guidance device 50.

本実施例では、コントローラ30は、ショベル全体の動作の制御に加えて、マシンガイダンス装置50によるガイダンスを行うか否かを制御する。具体的には、コントローラ30は、ゲートロックレバーD5の状態、圧力センサ29からの検出信号等に基づいてマシンガイダンス装置50によるガイダンスを行うか否かを制御する。   In this embodiment, the controller 30 controls whether or not to perform guidance by the machine guidance device 50 in addition to controlling the operation of the entire shovel. Specifically, the controller 30 controls whether or not the guidance by the machine guidance device 50 is performed based on the state of the gate lock lever D5, the detection signal from the pressure sensor 29, and the like.

次に、マシンガイダンス装置50について説明する。本実施例では、マシンガイダンス装置50は、例えば、ブーム角度センサS1、アーム角度センサS2、バケット角度センサS3、機体傾斜センサS4、旋回角速度センサS5、入力装置D1、及びコントローラ30から出力される各種信号及びやデータを受信する。そして、マシンガイダンス装置50は、受信した信号及びデータに基づいてアタッチメント(例えば、バケット6)の実際の動作位置を算出する。そして、マシンガイダンス装置50は、アタッチメントの実際の動作位置が目標動作位置とは異なる場合に、音声出力装置D2及び表示装置D3に警報指令を送信し、警報を発令させる。   Next, the machine guidance device 50 will be described. In the present embodiment, the machine guidance device 50 includes, for example, a boom angle sensor S1, an arm angle sensor S2, a bucket angle sensor S3, a machine body inclination sensor S4, a turning angular velocity sensor S5, an input device D1, and various outputs output from the controller 30. Receive signals and some data. Then, the machine guidance device 50 calculates the actual operation position of the attachment (for example, the bucket 6) based on the received signal and data. Then, when the actual operation position of the attachment is different from the target operation position, the machine guidance device 50 transmits an alarm command to the audio output device D2 and the display device D3 to issue an alarm.

マシンガイダンス装置50は、様々な機能を担う機能部を含む。本実施例では、マシンガイダンス装置50は、アタッチメントの動作をガイダンスするための機能部として、傾斜角算出部501、高さ算出部503、比較部504、警報制御部505、及びガイダンスデータ出力部506を含む。また、マシンガイダンス装置50は、上部旋回体3の旋回角度を導出するための機能部として旋回角度導出部507を含む。   The machine guidance device 50 includes functional units that perform various functions. In the present embodiment, the machine guidance device 50 includes an inclination angle calculation unit 501, a height calculation unit 503, a comparison unit 504, an alarm control unit 505, and a guidance data output unit 506 as functional units for guiding the attachment operation. including. The machine guidance device 50 includes a turning angle deriving unit 507 as a functional unit for deriving the turning angle of the upper swing body 3.

傾斜角算出部501は、機体傾斜センサS4からの検出信号に基づいて、水平面に対する上部旋回体3の傾斜角(ショベルの傾斜角)を算出する。すなわち、傾斜角算出部501は、機体傾斜センサS4からの検出信号を用いて、ショベルの傾斜角を算出する。   The inclination angle calculation unit 501 calculates the inclination angle (excavator inclination angle) of the upper swing body 3 with respect to the horizontal plane based on the detection signal from the body inclination sensor S4. That is, the tilt angle calculation unit 501 calculates the tilt angle of the shovel using the detection signal from the body tilt sensor S4.

高さ算出部503は、傾斜角算出部501が算出した傾斜角と、センサS1〜S3の検出信号から算出されたブーム4、アーム5、バケット6の角度とから、エンドアタッチメントの作業部位としてのバケット6の先端(爪先)の高さを算出する。本実施例では、バケット6の先端で掘削を行うため、バケット6の先端(爪先)はエンドアタッチメントの作業部位に相当する。一方、バケット6の背面で土砂をならすような作業をするときには、バケット6の背面がエンドアタッチメントの作業部位に相当する。また、バケット6以外のエンドアタッチメントとしてブレーカを用いた場合には、ブレーカの先端がエンドアタッチメントの作業部位に相当する。   The height calculation unit 503 is used as a work part of the end attachment from the inclination angle calculated by the inclination angle calculation unit 501 and the angles of the boom 4, the arm 5, and the bucket 6 calculated from the detection signals of the sensors S <b> 1 to S <b> 3. The height of the tip (toe) of the bucket 6 is calculated. In this embodiment, since excavation is performed at the tip of the bucket 6, the tip (toe) of the bucket 6 corresponds to the work site of the end attachment. On the other hand, when the work for leveling earth and sand is performed on the back surface of the bucket 6, the back surface of the bucket 6 corresponds to the work part of the end attachment. When a breaker is used as an end attachment other than the bucket 6, the tip of the breaker corresponds to the work site of the end attachment.

比較部504は、高さ算出部503が算出したバケット6の先端(爪先)の高さと、ガイダンスデータ出力部506から出力されるガイダンスデータで示されるバケット6の先端(爪先)の目標高さとを比較する。ここで、目標高さは、予め入力された設計図面とショベルの現在位置と作業姿勢とから算出されるようにしてもよい。また、設定された過去のショベルの爪先位置と、入力された目標深さと、角度と現在の作業姿勢(現在の爪先位置)から算出されるようにしてもよい。   The comparison unit 504 calculates the height of the tip (toe) of the bucket 6 calculated by the height calculation unit 503 and the target height of the tip (toe) of the bucket 6 indicated by the guidance data output from the guidance data output unit 506. Compare. Here, the target height may be calculated from the design drawing inputted in advance, the current position of the excavator, and the working posture. Further, it may be calculated from the toe position of the past shovel that has been set, the input target depth, the angle, and the current working posture (current toe position).

警報制御部505は、比較部504での比較結果に基づいて、警報が必要と判断した場合には警報指令を音声出力装置D2及び表示装置D3の両方又は一方に送信する。音声出力装置D2及び表示装置D3は、警報指令を受けると所定の警報を発してショベルの操作者に通報する。   The alarm control unit 505 transmits an alarm command to both or one of the audio output device D2 and the display device D3 when it is determined that an alarm is necessary based on the comparison result in the comparison unit 504. When the sound output device D2 and the display device D3 receive an alarm command, the sound output device D2 and the display device D3 issue a predetermined alarm and notify the operator of the shovel.

ガイダンスデータ出力部506は、上述のように、マシンガイダンス装置50の記憶装置に予め格納されていたガイダンスデータからバケット6の目標高さのデータを抽出して比較部504に対して出力する。この際、ガイダンスデータ出力部506は、ショベルの傾斜角に対応するバケット6の目標高さのデータを出力する。   As described above, the guidance data output unit 506 extracts the target height data of the bucket 6 from the guidance data stored in advance in the storage device of the machine guidance device 50 and outputs it to the comparison unit 504. At this time, the guidance data output unit 506 outputs data on the target height of the bucket 6 corresponding to the inclination angle of the shovel.

旋回角度導出部507は、上部旋回体3の旋回角度を導出する。本実施例では、基準方位に対する上部旋回体3の旋回角度を導出する。基準方位は基準となる任意の方位であり、例えば、東、西、南、北等の方位、地面上の基準点に対する方位、下部走行体1が向く方位等である。本実施例では、旋回角度導出部507は、旋回情報と旋回角速度センサS5の出力とに基づいて上部旋回体3の旋回角度を導出する。   The turning angle deriving unit 507 derives the turning angle of the upper turning body 3. In this embodiment, the turning angle of the upper turning body 3 with respect to the reference azimuth is derived. The reference azimuth is an arbitrary azimuth serving as a reference, and is, for example, an azimuth such as east, west, south, or north, an azimuth with respect to a reference point on the ground, an azimuth that the lower traveling body 1 faces. In the present embodiment, the turning angle deriving unit 507 derives the turning angle of the upper turning body 3 based on the turning information and the output of the turning angular velocity sensor S5.

旋回情報は、例えば、操作装置26としての旋回操作レバーが生成するパイロット圧(以下、「旋回パイロット圧」とする。)、旋回操作レバーの操作量等の旋回操作情報を含む。また、旋回用油圧モータ又は旋回用電動発電機の回転数若しくは回転角、旋回用油圧モータに流入する作動油の圧力(以下、「旋回モータ圧」とする。)、旋回用電動発電機に供給される電流等の旋回動作情報を含む。なお、旋回用電動発電機の回転数若しくは回転角はレゾルバ等を用いて検出される。   The turning information includes, for example, turning operation information such as a pilot pressure (hereinafter referred to as “turning pilot pressure”) generated by a turning operation lever as the operation device 26, an operation amount of the turning operation lever, and the like. Also, the rotational speed or rotation angle of the turning hydraulic motor or turning motor generator, the pressure of hydraulic oil flowing into the turning hydraulic motor (hereinafter referred to as “turning motor pressure”), and the supply to the turning motor generator Information on the turning operation such as the current to be generated. The rotation speed or rotation angle of the turning motor generator is detected using a resolver or the like.

具体的には、旋回角度導出部507は、旋回情報に基づいて上部旋回体3が旋回中であるか否かを判定する。例えば、旋回角度導出部507は、旋回パイロット圧が所定圧力以上の場合に旋回中であると判定し、所定圧力未満の場合に旋回中でないと判定する。或いは、旋回角度導出部507は、旋回モータ圧が所定圧力以上の場合に旋回中であると判定し、所定圧力未満の場合に旋回中でないと判定してもよい。   Specifically, the turning angle deriving unit 507 determines whether or not the upper turning body 3 is turning based on the turning information. For example, the turning angle deriving unit 507 determines that the vehicle is turning when the turning pilot pressure is equal to or higher than a predetermined pressure, and determines that the vehicle is not turning when the turning pilot pressure is less than the predetermined pressure. Alternatively, the turning angle deriving unit 507 may determine that the vehicle is turning when the turning motor pressure is equal to or higher than a predetermined pressure, and may determine that the vehicle is not turning when the pressure is lower than the predetermined pressure.

そして、旋回中であると判定した場合、旋回角度導出部507は、旋回角速度センサS5が所定時間間隔で出力する角速度を積算して旋回角度を導き出す。旋回中でないと判定した場合には、旋回角度導出部507は、旋回角速度センサS5が所定時間間隔で出力する角速度の積算を中止する。旋回角速度センサS5のドリフトに起因する誤差が増大するのを防止するためである。   When it is determined that the vehicle is turning, the turning angle deriving unit 507 calculates the turning angle by integrating the angular velocities output by the turning angular velocity sensor S5 at predetermined time intervals. If it is determined that the vehicle is not turning, the turning angle deriving unit 507 stops integrating the angular velocities output by the turning angular velocity sensor S5 at predetermined time intervals. This is to prevent an increase in error due to the drift of the turning angular velocity sensor S5.

また、旋回角度導出部507は、地磁気センサS9の出力を用いて旋回角度を補正する。具体的には、旋回角度導出部507は、上部旋回体3が旋回中でないと判定した場合、地磁気センサS9の出力が所定の条件を満たしているか否かを判定する。例えば、旋回角度導出部507は、地磁気センサS9の出力が所定の閾値以上の場合に出力が所定の条件を満たしていると判定し、地磁気センサS9の出力が所定の閾値未満の場合に出力が所定の条件を満たしていないと判定する。この場合、旋回角度導出部507は、建物等の影響で地磁気センサS9の出力が弱まっているか否かを検出できる。或いは、旋回角度導出部507は、地磁気センサS9の出力の直近の所定時間における変動幅が何れも所定値未満の場合に出力が所定の条件を満たしていると判定し、変動幅の何れかが所定値以上の場合に出力が所定の条件を満たしていないと判定してもよい。或いは、旋回角度導出部507は、直近の所定時間における出力の分散が何れも所定値未満の場合に出力が所定の条件を満たしていると判定し、分散の何れかが所定値以上の場合に出力が所定の条件を満たしていないと判定してもよい。この場合、旋回角度導出部507は、地磁気センサS9の出力に対するノイズの影響が大きいか否かを検出できる。このようにして、コントローラ30は、地磁気センサS9の出力が安定しているか否かを判定する。   Further, the turning angle deriving unit 507 corrects the turning angle using the output of the geomagnetic sensor S9. Specifically, when it is determined that the upper swing body 3 is not turning, the turning angle deriving unit 507 determines whether the output of the geomagnetic sensor S9 satisfies a predetermined condition. For example, the turning angle deriving unit 507 determines that the output satisfies a predetermined condition when the output of the geomagnetic sensor S9 is equal to or greater than a predetermined threshold, and outputs when the output of the geomagnetic sensor S9 is less than the predetermined threshold. It is determined that the predetermined condition is not satisfied. In this case, the turning angle deriving unit 507 can detect whether the output of the geomagnetic sensor S9 is weakened due to the influence of a building or the like. Alternatively, the turning angle deriving unit 507 determines that the output satisfies the predetermined condition when the fluctuation range at the most recent predetermined time of the output of the geomagnetic sensor S9 is less than the predetermined value, and any of the fluctuation ranges is determined. You may determine with the output not satisfy | filling predetermined conditions, when it is more than a predetermined value. Alternatively, the turning angle deriving unit 507 determines that the output satisfies a predetermined condition when the variance of the output at the most recent predetermined time is less than the predetermined value, and when any of the variances is equal to or greater than the predetermined value. It may be determined that the output does not satisfy a predetermined condition. In this case, the turning angle deriving unit 507 can detect whether the influence of noise on the output of the geomagnetic sensor S9 is large. In this way, the controller 30 determines whether or not the output of the geomagnetic sensor S9 is stable.

そして、地磁気センサS9の出力が所定の条件を満たしていると判定した場合、旋回角度導出部507は、旋回角速度センサS5の出力ではなく地磁気センサS9の出力から旋回角度を導き出す。具体的には、上部旋回体3の向きを示す地磁気センサS9の出力に基づいて基準方位に対する上部旋回体3の旋回角度を導き出す。この場合、旋回角度導出部507は、例えば、旋回角度がゼロ度のとき、すなわち、基準方位と上部旋回体3の向きとが一致するときの地磁気センサS9の出力を基準値として記憶しておく。そして、旋回中でないと判定し且つ地磁気センサS9の出力が所定の条件を満たしていると判定した時点の地磁気センサS9の出力と基準値とに基づいて旋回角度を導き出す。   When it is determined that the output of the geomagnetic sensor S9 satisfies a predetermined condition, the turning angle deriving unit 507 derives the turning angle from the output of the geomagnetic sensor S9 instead of the output of the turning angular velocity sensor S5. Specifically, the turning angle of the upper swing body 3 with respect to the reference orientation is derived based on the output of the geomagnetic sensor S9 indicating the direction of the upper swing body 3. In this case, for example, the turning angle deriving unit 507 stores the output of the geomagnetic sensor S9 as a reference value when the turning angle is zero degrees, that is, when the reference azimuth and the direction of the upper turning body 3 coincide. . Then, the turning angle is derived based on the output of the geomagnetic sensor S9 and the reference value when it is determined that the vehicle is not turning and the output of the geomagnetic sensor S9 satisfies the predetermined condition.

或いは、下部走行体1の向きを示す下部地磁気センサの出力と上部旋回体3の向きを示す上部地磁気センサの出力とに基づいて下部走行体1に対する上部旋回体3の旋回角度を導き出してもよい。   Alternatively, the turning angle of the upper swing body 3 relative to the lower travel body 1 may be derived based on the output of the lower geomagnetic sensor indicating the orientation of the lower traveling body 1 and the output of the upper geomagnetic sensor indicating the orientation of the upper swing body 3. .

次に、図4を参照し、旋回角度導出部507が旋回角度を導出する処理(以下、「旋回角度導出処理」とする。)について説明する。図4は、旋回角度導出処理のフローチャートであり、旋回角度導出部507は所定周期で繰り返しこの旋回角度導出処理を実行する。   Next, a process in which the turning angle deriving unit 507 derives the turning angle (hereinafter referred to as “turning angle derivation process”) will be described with reference to FIG. FIG. 4 is a flowchart of the turning angle derivation process, and the turning angle derivation unit 507 repeatedly executes the turning angle derivation process at a predetermined cycle.

最初に、旋回角度導出部507は、上部旋回体3が旋回中であるか否かを判定する(ステップS1)。例えば、旋回角度導出部507は、旋回パイロット圧が所定圧力以上の場合に旋回中であると判定する。   First, the turning angle deriving unit 507 determines whether or not the upper turning body 3 is turning (step S1). For example, the turning angle deriving unit 507 determines that the turning is being performed when the turning pilot pressure is equal to or higher than a predetermined pressure.

そして、旋回中であると判定した場合(ステップS1のYES)、旋回角度導出部507は、旋回角速度センサS5の出力を用いて旋回角度を導き出す(ステップS2)。例えば、旋回角度導出部507は、旋回パイロット圧が所定圧力以上であると判定した場合に、旋回角速度センサS5が所定時間間隔で出力する角速度を積算して旋回角度を導き出す。   If it is determined that the vehicle is turning (YES in step S1), the turning angle deriving unit 507 derives the turning angle using the output of the turning angular velocity sensor S5 (step S2). For example, when the turning angle deriving unit 507 determines that the turning pilot pressure is equal to or higher than a predetermined pressure, the turning angle deriving unit 507 integrates the angular velocities output by the turning angular velocity sensor S5 at predetermined time intervals to derive the turning angle.

旋回中でないと判定した場合(ステップS1のNO)、旋回角度導出部507は、地磁気センサS9の出力が所定の条件を満たしているか否かを判定する(ステップS3)。例えば、旋回角度導出部507は、地磁気センサS9の出力の直近の所定時間における変動幅に基づいてそれらの出力が所定の条件を満たしているか否かを判定する。   If it is determined that the vehicle is not turning (NO in step S1), the turning angle deriving unit 507 determines whether the output of the geomagnetic sensor S9 satisfies a predetermined condition (step S3). For example, the turning angle deriving unit 507 determines whether or not these outputs satisfy a predetermined condition based on the fluctuation range of the output of the geomagnetic sensor S9 in the latest predetermined time.

そして、出力が所定の条件を満たしていると判定した場合(ステップS3のYES)、旋回角度導出部507は、地磁気センサS9の出力を用いて旋回角度を導き出す(ステップS4)。例えば、旋回角度導出部507は、地磁気センサS9の出力に基づいて基準方位に対する上部旋回体3の旋回角度を導き出す。或いは、下部地磁気センサの出力と上部地磁気センサの出力とに基づいて下部走行体1に対する上部旋回体3の旋回角度を導き出してもよい。   When it is determined that the output satisfies the predetermined condition (YES in step S3), the turning angle deriving unit 507 derives the turning angle using the output of the geomagnetic sensor S9 (step S4). For example, the turning angle deriving unit 507 derives the turning angle of the upper turning body 3 with respect to the reference direction based on the output of the geomagnetic sensor S9. Alternatively, the turning angle of the upper swing body 3 relative to the lower traveling body 1 may be derived based on the output of the lower geomagnetic sensor and the output of the upper geomagnetic sensor.

出力が所定の条件を満たしていないと判定した場合(ステップS3のNO)、旋回角度導出部507は、前回の旋回角度導出処理で導き出した旋回角度を用いて今回の旋回角度を導き出す(ステップS5)。例えば、旋回角度導出部507は、前回の旋回角度導出処理で導き出した旋回角度をそのまま今回の旋回角度として採用する。   When it is determined that the output does not satisfy the predetermined condition (NO in step S3), the turning angle deriving unit 507 derives the current turning angle using the turning angle derived in the previous turning angle derivation process (step S5). ). For example, the turning angle deriving unit 507 directly adopts the turning angle derived in the previous turning angle deriving process as the current turning angle.

次に、旋回操作が断続的に行われたときの各種物理量の時間的推移について説明する。図5は各種物理量の時間的推移を示す図であり、図5(A)が旋回パイロット圧の時間的推移を示し、図5(B)が旋回角速度(旋回角速度センサS5の出力)の時間的推移を示す。また、図5(C)が角速度センサ基準の旋回角度の時間的推移を示し、図5(D)が地磁気センサ基準の旋回角度の時間的推移を示し、図5(E)が導出旋回角度の時間的推移を示す。なお、横軸(時間軸)のスケールは各図で共通である。   Next, the temporal transition of various physical quantities when the turning operation is performed intermittently will be described. FIG. 5 is a diagram showing temporal transitions of various physical quantities, FIG. 5 (A) shows temporal transitions of the turning pilot pressure, and FIG. 5 (B) shows temporal changes of the turning angular velocity (output of the turning angular velocity sensor S5). Shows the transition. FIG. 5C shows the temporal transition of the turning angle based on the angular velocity sensor, FIG. 5D shows the temporal transition of the turning angle based on the geomagnetic sensor, and FIG. 5E shows the derived turning angle. Shows the time transition. The scale of the horizontal axis (time axis) is common to each figure.

角速度センサ基準の旋回角度は、旋回角速度センサS5の出力から導き出される旋回角度を意味する。また、地磁気センサ基準の旋回角度は、地磁気センサS9の出力から導き出される旋回角度を意味する。また、導出旋回角度は、旋回角度導出部507が最終的に導き出す旋回角度を意味する。   The turning angle based on the angular velocity sensor means a turning angle derived from the output of the turning angular velocity sensor S5. Moreover, the turning angle based on the geomagnetic sensor means a turning angle derived from the output of the geomagnetic sensor S9. Further, the derived turning angle means the turning angle finally derived by the turning angle deriving unit 507.

時刻t0から時刻t1の期間、すなわち、旋回操作レバーが操作されておらず上部旋回体3が旋回していない間、旋回角度導出部507は、地磁気センサS9の出力が所定の条件を満たしているか否かを判定する。そして、地磁気センサS9の出力が所定の条件を満たしていると判定した場合に地磁気センサS9の出力を用いて旋回角度を導き出す。旋回角速度センサS5の出力を用いて旋回角度を導き出した場合、出力のドリフトに起因する誤差を累積してしまうおそれがあるためである。本実施例では、旋回角速度センサS5の出力は、図5(B)に示すように僅かに右旋回側にドリフトしている。そのため、旋回角速度センサS5の出力を用いて旋回角度を導き出した場合、その旋回角度は、図5(C)に示すように、旋回していないにもかかわらず右旋回側に徐々に増大する。   During the period from time t0 to time t1, that is, while the turning operation lever is not operated and the upper turning body 3 is not turning, the turning angle deriving unit 507 satisfies whether the output of the geomagnetic sensor S9 satisfies a predetermined condition. Determine whether or not. Then, when it is determined that the output of the geomagnetic sensor S9 satisfies a predetermined condition, the turning angle is derived using the output of the geomagnetic sensor S9. This is because when the turning angle is derived using the output of the turning angular velocity sensor S5, errors due to the output drift may be accumulated. In this embodiment, the output of the turning angular velocity sensor S5 drifts slightly to the right turning side as shown in FIG. Therefore, when the turning angle is derived using the output of the turning angular velocity sensor S5, as shown in FIG. 5C, the turning angle gradually increases to the right turning side even if the turning is not performed. .

本実施例では、図5(D)に示すように地磁気センサS9の出力が所定の条件を満たしているため、旋回角度導出部507は、地磁気センサ基準の旋回角度を導出旋回角度として出力する。図5(D)のドットハッチング領域は地磁気センサ基準の旋回角度が導出旋回角度として採用されていることを示す。その結果、導出旋回角度は、図5(E)の実線で示すように、時刻t0から時刻t1まで変動することなく推移する。なお、図5(E)の実線は導出旋回角度の推移を示し、破線は角速度センサ基準の旋回角度の推移を示し、一点鎖線は地磁気センサ基準の旋回角度の推移を示す。   In this embodiment, as shown in FIG. 5D, since the output of the geomagnetic sensor S9 satisfies a predetermined condition, the turning angle deriving unit 507 outputs the turning angle based on the geomagnetic sensor as the derived turning angle. The dot hatching area in FIG. 5D indicates that the turning angle based on the geomagnetic sensor is adopted as the derived turning angle. As a result, the derived turning angle changes without fluctuation from time t0 to time t1, as indicated by the solid line in FIG. The solid line in FIG. 5 (E) shows the transition of the derived turning angle, the broken line shows the transition of the turning angle based on the angular velocity sensor, and the alternate long and short dash line shows the transition of the turning angle based on the geomagnetic sensor.

その後、時刻t1において旋回操作レバーが左旋回方向に傾けられると、旋回パイロット圧は、図5(A)に示すように中立レベルから左旋回側に増大する。さらに、時刻t2において旋回操作レバーが右旋回方向に傾けられると、旋回パイロット圧は、図5(A)に示すように右旋回側に増大する。   Thereafter, when the turning operation lever is tilted in the left turning direction at time t1, the turning pilot pressure increases from the neutral level to the left turning side as shown in FIG. Furthermore, when the turning operation lever is tilted in the right turning direction at time t2, the turning pilot pressure increases to the right turning side as shown in FIG.

このように、時刻t1から時刻t3の間、すなわち、旋回操作レバーが操作されて上部旋回体3が旋回している間、旋回角度導出部507は、旋回角速度センサS5の出力を用いて旋回角度を導き出す。旋回中においては、地磁気センサS9の出力よりも旋回角速度センサS5の出力の方が比較的安定しているためである。   Thus, the turning angle deriving unit 507 uses the output of the turning angular velocity sensor S5 to turn the turning angle between time t1 and time t3, that is, while the turning operation lever is operated and the upper turning body 3 is turning. To derive. This is because during turning, the output of the turning angular velocity sensor S5 is relatively more stable than the output of the geomagnetic sensor S9.

本実施例では、旋回角度導出部507は、角速度センサ基準の旋回角度を導出旋回角度として採用する。図5(C)のドットハッチング領域は角速度センサ基準の旋回角度が導出旋回角度として採用されていることを示す。その結果、導出旋回角度は、図5(E)の実線で示すように、一旦左旋回方向に増大した後で右旋回方向に増大する。   In the present embodiment, the turning angle deriving unit 507 adopts the turning angle based on the angular velocity sensor as the derived turning angle. The dot hatching area in FIG. 5C indicates that the turning angle based on the angular velocity sensor is adopted as the derived turning angle. As a result, as shown by the solid line in FIG. 5E, the derived turning angle once increases in the left turning direction and then increases in the right turning direction.

その後、時刻t3において旋回操作レバーが中立位置に戻されると、旋回パイロット圧は、図5(A)に示すように中立レベルに戻る。   Thereafter, when the turning operation lever is returned to the neutral position at time t3, the turning pilot pressure returns to the neutral level as shown in FIG.

その後、時刻t3から時刻t4の期間、すなわち、旋回操作レバーが操作されておらず上部旋回体3が旋回していない間、旋回角度導出部507は、地磁気センサS9の出力が所定の条件を満たしているか否かを再び判定する。そして、地磁気センサS9の出力が所定の条件を満たしていないと判定した場合、前回の旋回角度導出処理で導出した旋回角度をそのまま導出旋回角度として採用する。旋回角速度センサS5の出力を用いて旋回角度を導き出した場合、出力のドリフトに起因する誤差を累積してしまうおそれがあるためである。また、不安定な地磁気センサS9の出力を用いて旋回角度を導き出した場合、導出旋回角度が不安定となってしまうためである。本実施例では、地磁気センサS9の出力は、図5(D)に示すように比較的大きな変動幅で上下に変動している。そのため、地磁気センサS9の出力を用いて旋回角度を導き出した場合、その旋回角度は、図5(E)の一点鎖線で示すように、旋回していないにもかかわらず揺れ動く。   Thereafter, during the period from time t3 to time t4, that is, while the turning operation lever is not operated and the upper turning body 3 is not turning, the turning angle deriving unit 507 satisfies the condition that the output of the geomagnetic sensor S9 satisfies a predetermined condition. It is determined again whether or not. And when it determines with the output of geomagnetic sensor S9 not satisfy | filling predetermined conditions, the turning angle derived | led-out by the last turning angle derivation process is employ | adopted as a derived turning angle as it is. This is because when the turning angle is derived using the output of the turning angular velocity sensor S5, errors due to the output drift may be accumulated. Further, when the turning angle is derived using the output of the unstable geomagnetic sensor S9, the derived turning angle becomes unstable. In this embodiment, the output of the geomagnetic sensor S9 fluctuates up and down with a relatively large fluctuation width as shown in FIG. Therefore, when the turning angle is derived using the output of the geomagnetic sensor S9, the turning angle oscillates even though it is not turning, as indicated by the one-dot chain line in FIG.

本実施例では、図5(D)に示すように地磁気センサS9の出力が所定の条件を満たしていないため、旋回角度導出部507は、前回の旋回角度導出処理で導出した旋回角度をそのまま導出旋回角度として採用する。具体的には、旋回角度導出部507は、図5(E)の点A1で示す前回の旋回角度導出処理で導出した旋回角度を、時刻t3から時刻t4にわたって、導出旋回角度として採用し続ける。その結果、導出旋回角度は、時刻t3から時刻t4までの間、点A1で示す旋回角度を維持したまま推移する。   In this embodiment, as shown in FIG. 5D, the output of the geomagnetic sensor S9 does not satisfy the predetermined condition, so the turning angle deriving unit 507 derives the turning angle derived in the previous turning angle deriving process as it is. Adopted as a turning angle. Specifically, the turning angle deriving unit 507 continues to adopt the turning angle derived in the previous turning angle derivation process indicated by the point A1 in FIG. 5E as the derived turning angle from time t3 to time t4. As a result, the derived turning angle changes while maintaining the turning angle indicated by the point A1 from time t3 to time t4.

その後、時刻t4において旋回操作レバーが再び左旋回方向に傾けられると、旋回パイロット圧は、図5(A)に示すように中立レベルから左旋回側に増大する。そして、時刻t4から時刻t5の間、すなわち、旋回操作レバーが操作されて上部旋回体3が旋回している間、旋回角度導出部507は、旋回角速度センサS5の出力を用いて旋回角度を導き出す。その結果、導出旋回角度は、図5(E)の実線で示すように、右旋回の角度範囲において左旋回方向に減少する。   Thereafter, when the turning operation lever is tilted again in the left turning direction at time t4, the turning pilot pressure increases from the neutral level to the left turning side as shown in FIG. The turning angle deriving unit 507 derives the turning angle using the output of the turning angular velocity sensor S5 from time t4 to time t5, that is, while the turning operation lever is operated and the upper turning body 3 is turning. . As a result, as shown by the solid line in FIG. 5E, the derived turning angle decreases in the left turning direction in the right turning angle range.

その後、時刻t5において旋回操作レバーが中立位置に戻されると、旋回パイロット圧は、図5(A)に示すように中立レベルに戻る。そして、旋回角度導出部507は、地磁気センサS9の出力が所定の条件を満たしているか否かを再び判定する。そして、地磁気センサS9の出力が所定の条件を満たしていると判定した場合、旋回角度導出部507は、地磁気センサS9の出力を用いて導出旋回角度を補正する。具体的には、旋回角度導出部507は、図5(E)の点A2で示す角速度センサ基準の旋回角度を、点A3で示す地磁気センサ基準の旋回角度に補正する。角速度センサ基準の旋回角度には誤差が累積されているおそれがあるので、地磁気センサ基準の旋回角度が角速度センサ基準の旋回角度よりも正確と推定できるためである。   Thereafter, when the turning operation lever is returned to the neutral position at time t5, the turning pilot pressure returns to the neutral level as shown in FIG. Then, the turning angle deriving unit 507 determines again whether or not the output of the geomagnetic sensor S9 satisfies a predetermined condition. If it is determined that the output of the geomagnetic sensor S9 satisfies a predetermined condition, the turning angle deriving unit 507 corrects the derived turning angle using the output of the geomagnetic sensor S9. Specifically, the turning angle deriving unit 507 corrects the turning angle based on the angular velocity sensor indicated by the point A2 in FIG. 5E to the turning angle based on the geomagnetic sensor indicated by the point A3. This is because an error may be accumulated in the turning angle based on the angular velocity sensor, so that the turning angle based on the geomagnetic sensor can be estimated to be more accurate than the turning angle based on the angular velocity sensor.

このように、旋回角度導出部507は、旋回中であるか否か、及び、地磁気センサS9の出力が所定の条件を満たしているか否かに応じて旋回角速度センサの出力と地磁気センサS9の出力とを使い分けることで、より小さい誤差で安定的に旋回角度を導出できる。そして、導出された旋回角度は、例えば、マシンガイダンス装置50が旋回方向をガイドする際に利用される。   As described above, the turning angle deriving unit 507 determines whether the turning angular velocity sensor output and the geomagnetic sensor S9 output depending on whether the turning is in progress and whether the output of the geomagnetic sensor S9 satisfies a predetermined condition. By properly using and, the turning angle can be derived stably with a smaller error. The derived turning angle is used, for example, when the machine guidance device 50 guides the turning direction.

また、旋回角度導出部507は、旋回角速度センサS5及び地磁気センサS9のそれぞれの特性に応じて旋回角速度センサの出力と地磁気センサS9の出力とを使い分けることで、より小さい誤差で安定的に旋回角度を導出できる。   Further, the turning angle deriving unit 507 uses the output of the turning angular velocity sensor and the output of the geomagnetic sensor S9 in accordance with the characteristics of the turning angular velocity sensor S5 and the geomagnetic sensor S9, so that the turning angle can be stably performed with smaller errors. Can be derived.

例えば、旋回角度導出部507は、旋回中であると判定した場合、旋回角速度センサS5の出力を用いて旋回角度を導き出す。そのため、旋回中に不安定となる地磁気センサS9の出力を用いて旋回角度が導き出されてしまうのを防止できる。   For example, when the turning angle deriving unit 507 determines that the turning is in progress, the turning angle deriving unit 507 derives the turning angle using the output of the turning angular velocity sensor S5. Therefore, it is possible to prevent the turning angle from being derived using the output of the geomagnetic sensor S9 which becomes unstable during turning.

また、旋回角度導出部507は、旋回中でないと判定し、且つ、地磁気センサS9の出力が所定の条件を満たしていると判定した場合、地磁気センサS9の出力を用いて旋回角度を導き出す。そのため、出力がドリフトしているおそれがある旋回角速度センサS5の出力を用いて旋回角度が導き出された結果、旋回中でないにもかかわらず、旋回角度を変動させてしまうのを防止できる。   When the turning angle deriving unit 507 determines that the turning is not being performed and the output of the geomagnetic sensor S9 satisfies a predetermined condition, the turning angle deriving unit 507 derives the turning angle using the output of the geomagnetic sensor S9. Therefore, as a result of deriving the turning angle using the output of the turning angular velocity sensor S5 that may cause the output to drift, it is possible to prevent the turning angle from being changed even when the turning is not being performed.

また、旋回角度導出部507は、旋回中でないと判定し、且つ、地磁気センサS9の出力が所定の条件を満たしていないと判定した場合、前回の旋回角度導出処理で導き出した旋回角度を利用する。そのため、不安定な地磁気センサS9の出力、及び、出力がドリフトしているおそれがある旋回角速度センサS5の出力を用いて旋回角度が導き出されてしまうのを防止できる。   When the turning angle deriving unit 507 determines that the vehicle is not turning and determines that the output of the geomagnetic sensor S9 does not satisfy the predetermined condition, the turning angle deriving unit 507 uses the turning angle derived in the previous turning angle derivation process. . Therefore, it is possible to prevent the turning angle from being derived using the output of the unstable geomagnetic sensor S9 and the output of the turning angular velocity sensor S5 that may cause the output to drift.

以上、本発明の好ましい実施例について詳説したが、本発明は、上述した実施例に制限されることはなく、本発明の範囲を逸脱することなしに上述した実施例に種々の変形及び置換を加えることができる。   Although the preferred embodiments of the present invention have been described in detail above, the present invention is not limited to the above-described embodiments, and various modifications and substitutions can be made to the above-described embodiments without departing from the scope of the present invention. Can be added.

1・・・下部走行体 2・・・旋回機構 3・・・上部旋回体 4・・・ブーム 5・・・アーム 6・・・バケット 7・・・ブームシリンダ 8・・・アームシリンダ 9・・・バケットシリンダ 10・・・キャビン 11・・・エンジン 11a・・・オルタネータ 11b・・・スタータ 11c・・・水温センサ 14・・・メインポンプ 14a・・・レギュレータ 14b・・・吐出圧力センサ 14c・・・油温センサ 15・・・パイロットポンプ 17・・・コントロールバルブ 26・・・操作装置 29・・・圧力センサ 30・・・コントローラ 30a・・・一時記憶部 50・・・マシンガイダンス装置 55・・・燃料収容部 55a・・・燃料収容量検出部 70・・・蓄電池 72・・・電装品 75・・・エンジン回転数調整ダイヤル 501・・・傾斜角算出部 503・・・高さ算出部 504・・・比較部 505・・・警報制御部 506・・・ガイダンスデータ出力部 507・・・旋回角度導出部 S1・・・ブーム角度センサ S2・・・アーム角度センサ S3・・・バケット角度センサ S4・・・機体傾斜センサ S5・・・旋回角速度センサ S6・・・カメラ S7・・・通信装置 S8・・・測位装置 S9・・・地磁気センサ D1・・・入力装置 D2・・・音声出力装置 D3・・・表示装置 D3a・・・変換処理部 D4・・・記憶装置 D5・・・ゲートロックレバー D6・・・ゲートロック弁 D7・・・エンジンコントローラユニット   DESCRIPTION OF SYMBOLS 1 ... Lower traveling body 2 ... Turning mechanism 3 ... Upper turning body 4 ... Boom 5 ... Arm 6 ... Bucket 7 ... Boom cylinder 8 ... Arm cylinder 9 ... Bucket cylinder 10 ... cabin 11 ... engine 11a ... alternator 11b ... starter 11c ... water temperature sensor 14 ... main pump 14a ... regulator 14b ... discharge pressure sensor 14c ... Oil temperature sensor 15 ... Pilot pump 17 ... Control valve 26 ... Operation device 29 ... Pressure sensor 30 ... Controller 30a ... Temporary storage unit 50 ... Machine guidance device 55 ...・ Fuel storage unit 55a ... Fuel storage amount detection unit 70 ... Storage battery 72 ... Electrical component 75 ... Engine rotation Number adjustment dial 501 ... Inclination angle calculation unit 503 ... Height calculation unit 504 ... Comparison unit 505 ... Alarm control unit 506 ... Guidance data output unit 507 ... Turning angle deriving unit S1. ..Boom angle sensor S2 ... Arm angle sensor S3 ... Bucket angle sensor S4 ... Airframe tilt sensor S5 ... Turning angular velocity sensor S6 ... Camera S7 ... Communication device S8 ... Positioning device S9: Geomagnetic sensor D1: Input device D2: Audio output device D3: Display device D3a: Conversion processing unit D4: Storage device D5: Gate lock lever D6: Gate Lock valve D7 ... Engine controller unit

Claims (6)

下部走行体と、
前記下部走行体に旋回可能に搭載される上部旋回体と、
前記上部旋回体に取り付けられる角速度センサと、
旋回操作情報と前記角速度センサの出力とに基づいて前記上部旋回体の旋回角度を算出する演算処理装置と、
前記上部旋回体に取り付けられる地磁気センサと、を備え
前記演算処理装置は、前記地磁気センサの出力を用いて旋回角度を算出す
ショベル。
A lower traveling body,
An upper swivel body that is turnably mounted on the lower traveling body;
An angular velocity sensor attached to the upper swing body;
An arithmetic processing unit for calculating a turning angle of the upper turning body based on turning operation information and an output of the angular velocity sensor;
A geomagnetic sensor attached to the upper swing body ,
The arithmetic processing unit, we calculate the turning angle by using an output of the geomagnetic sensor,
Excavator.
前記演算処理装置は、前記旋回操作情報に基づいて前記上部旋回体が旋回していないと判定した場合、前記角速度センサの出力に基づく旋回角度の算出を中止する、
請求項1に記載のショベル。
When the arithmetic processing unit determines that the upper swing body is not turning based on the turning operation information, the calculation processing device stops calculating the turning angle based on the output of the angular velocity sensor.
The excavator according to claim 1.
前記旋回操作情報は、旋回操作レバーのパイロット圧を含む、
請求項1又は2に記載のショベル。
The turning operation information includes a pilot pressure of the turning operation lever.
The shovel according to claim 1 or 2.
前記演算処理装置は、前記地磁気センサの出力が所定の条件を満たしている場合に、前記地磁気センサの出力を用いて旋回角度を算出する、
請求項1乃至3の何れか一項に記載のショベル。
The arithmetic processing unit calculates a turning angle using the output of the geomagnetic sensor when the output of the geomagnetic sensor satisfies a predetermined condition;
The excavator according to any one of claims 1 to 3 .
前記演算処理装置は、前記上部旋回体が旋回していない場合に、前記地磁気センサの出力を用いて旋回角度を算出する、
請求項1乃至の何れか一項に記載のショベル。
The arithmetic processing unit calculates a turning angle using the output of the geomagnetic sensor when the upper turning body is not turning,
The excavator according to any one of claims 1 to 4.
前記演算処理装置は、前記下部走行体に対する前記上部旋回体の旋回角度を算出する、
請求項1乃至の何れか一項に記載のショベル。
The arithmetic processing unit calculates a turning angle of the upper turning body with respect to the lower traveling body;
The excavator according to any one of claims 1 to 5 .
JP2016000630A 2016-01-05 2016-01-05 Excavator Active JP6598685B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2016000630A JP6598685B2 (en) 2016-01-05 2016-01-05 Excavator
CN201710006268.XA CN106988358B (en) 2016-01-05 2017-01-05 Excavator

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016000630A JP6598685B2 (en) 2016-01-05 2016-01-05 Excavator

Publications (2)

Publication Number Publication Date
JP2017122602A JP2017122602A (en) 2017-07-13
JP6598685B2 true JP6598685B2 (en) 2019-10-30

Family

ID=59305686

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016000630A Active JP6598685B2 (en) 2016-01-05 2016-01-05 Excavator

Country Status (2)

Country Link
JP (1) JP6598685B2 (en)
CN (1) CN106988358B (en)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE112018000828B4 (en) 2017-09-01 2022-12-29 Komatsu Ltd. Working machine measuring system, working machine and measuring driving for working machine
JP6991056B2 (en) * 2017-12-21 2022-01-12 住友重機械工業株式会社 Excavator
EP3733978A4 (en) 2017-12-27 2021-04-14 Sumitomo (S.H.I.) Construction Machinery Co., Ltd. Excavator
KR102613270B1 (en) 2017-12-27 2023-12-12 스미토모 겐키 가부시키가이샤 shovel
DE102018200060B4 (en) * 2018-01-04 2024-05-08 Robert Bosch Gmbh Method for operating a mobile work machine and mobile work machine
JP7143117B2 (en) * 2018-05-22 2022-09-28 住友重機械工業株式会社 Excavator
WO2020067326A1 (en) * 2018-09-27 2020-04-02 住友重機械工業株式会社 Shovel
JP7228450B2 (en) * 2019-03-29 2023-02-24 住友重機械工業株式会社 Excavator
JP7229109B2 (en) 2019-06-19 2023-02-27 株式会社小松製作所 Work machine and work machine control method

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02130410A (en) * 1988-11-11 1990-05-18 Honda Motor Co Ltd Direction detector
JPH0921605A (en) * 1995-07-10 1997-01-21 Hitachi Constr Mach Co Ltd Apparatus for detecting turning angle of construction machine
JP4202209B2 (en) * 2003-08-11 2008-12-24 日立建機株式会社 Work machine position measurement and display system
EP2511677B1 (en) * 2011-04-12 2020-08-19 Tamtron Oy Monitoring system for a material transfer vehicle

Also Published As

Publication number Publication date
JP2017122602A (en) 2017-07-13
CN106988358B (en) 2021-06-29
CN106988358A (en) 2017-07-28

Similar Documents

Publication Publication Date Title
JP6598685B2 (en) Excavator
US10697152B2 (en) Excavator
US10687026B2 (en) Shovel
US11288827B2 (en) Measurement device of shovel
JP6401087B2 (en) Excavator and control method thereof
JP7146755B2 (en) Excavator
JP6462435B2 (en) Excavator
JP7354312B2 (en) How to update information on excavators and shovels
JP6639990B2 (en) Excavator
KR20200039613A (en) Shovel, shovel display device and shovel display method
EP3415694B1 (en) Excavator
JPWO2019026802A1 (en) Excavator

Legal Events

Date Code Title Description
A625 Written request for application examination (by other person)

Free format text: JAPANESE INTERMEDIATE CODE: A625

Effective date: 20180612

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190319

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190320

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20190517

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190718

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20191001

R150 Certificate of patent or registration of utility model

Ref document number: 6598685

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150