JPWO2019012651A1 - 油圧ショベルおよび油圧ショベルの較正方法 - Google Patents

油圧ショベルおよび油圧ショベルの較正方法 Download PDF

Info

Publication number
JPWO2019012651A1
JPWO2019012651A1 JP2017560627A JP2017560627A JPWO2019012651A1 JP WO2019012651 A1 JPWO2019012651 A1 JP WO2019012651A1 JP 2017560627 A JP2017560627 A JP 2017560627A JP 2017560627 A JP2017560627 A JP 2017560627A JP WO2019012651 A1 JPWO2019012651 A1 JP WO2019012651A1
Authority
JP
Japan
Prior art keywords
boom
pin
hydraulic excavator
vehicle body
bucket
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.)
Granted
Application number
JP2017560627A
Other languages
English (en)
Other versions
JP6782256B2 (ja
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.)
Komatsu Ltd
Original Assignee
Komatsu 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 Komatsu Ltd filed Critical Komatsu Ltd
Publication of JPWO2019012651A1 publication Critical patent/JPWO2019012651A1/ja
Application granted granted Critical
Publication of JP6782256B2 publication Critical patent/JP6782256B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • E02F9/265Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
    • 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/283Dredgers; 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 single arm pivoted directly on the chassis
    • 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
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • 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
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • 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
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/439Automatic repositioning of the implement, e.g. automatic dumping, auto-return
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/261Surveying the work-site to be treated
    • E02F9/262Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2004Control mechanisms, e.g. control levers

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Component Parts Of Construction Machinery (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

ブーム(6)は、車本(1)に取り付けられている。ブームピン(13)は、ブーム(6)を車本(1)に揺動可能に支持している。車本(1)には貫通孔(3ba)が設けられている。貫通孔(3ba)は、ブームピン(13)の位置を知ることのできる部材(たとえばブームピン(13)またはブーム角度検出部(16))を油圧ショベル(100)の側方から貫通孔(3ba)を通して観測できるように設けられている。

Description

本発明は、油圧ショベルおよび油圧ショベルの較正方法に関するものである。
従来、作業機の作業点の現在位置を検出する位置検出装置を備える油圧ショベルが知られている。たとえば、特開2002−181538号公報(特許文献1)に開示されている油圧ショベルでは、GPS(Global Positioning System)アンテナからの位置情報に基づいて、バケットの刃先の位置座標が演算される。具体的には、GPSアンテナとブームピンとの位置関係、ブームとアームとバケットとのそれぞれの長さ、ブームとアームとバケットとのそれぞれの方向角などのパラメータに基づいて、バケットの刃先の位置座標が演算される。
特開2002−181538号公報
演算されたバケットの刃先の位置座標の精度は、上述したパラメータの精度の影響を受ける。これらのパラメータは、設計値に対して誤差を有することが通常である。このため、油圧ショベルの位置検出装置の初期設定時には、パラメータを外部計測装置によって計測し、その計測されたパラメータに基づいて、演算されたバケット刃先の位置座標を較正する必要がある。
上記較正を行なうには、外部計測装置によってブームピンとアンテナとの位置関係を知る必要がある。ブームピンの位置を知るためには、外部計測装置にてブームピンを観測する必要がある。しかしながらブームピンを観測するために車両本体のカバーを開ける必要があり、較正作業が煩雑になる。またブームピンが見えるようにカバーを開く必要があるため、油圧ショベルの車体強度が低くなる。
本開示の目的は、外部計測装置にてブームピンを観測する際に車両本体のカバーを開ける必要がない油圧ショベルおよび油圧ショベルの較正方法を提供することである。
本開示における油圧ショベルは、車両本体と、ブームと、ブームピンとを備えている。ブームは、車両本体に取り付けられている。ブームピンは、ブームを車両本体に揺動可能に支持している。車両本体には貫通孔が設けられている。貫通孔は、ブームピンの位置を取得するためのブーム位置取得部位を油圧ショベルの側方から貫通孔を通して観測できるように設けられている。
本開示における油圧ショベルの較正方法は、車両本体と、車両本体に取り付けられたブームとブームの先端に取り付けられたアームとアームの先端に取り付けられた作業具とを有する作業機と、ブームを車両本体に揺動可能に支持するブームピンと、少なくともブームピンの位置を含む複数のパラメータに基づいて作業具に含まれる作業点の現在位置を演算するためのコントローラと、を備えた油圧ショベルにおいて上記パラメータを較正する方法である。上記油圧ショベルの較正方法においては、車両本体の側面に設けられた貫通孔を通じて油圧ショベルの側方から、ブームピンの位置を取得するためのブーム位置取得部位を観測することにより取得されたブームピンの位置に基づいて上記パラメータが較正される。
本開示によれば、貫通孔を通じてブームピンの位置を観測することができるため、較正作業時にブームピンを観測するために車両本体のカバーなどを開ける必要はない。よって較正作業は簡易になるとともに、車両本体の強度を高く保つことができる。
本開示の一実施形態に係る油圧ショベルの構成を示す斜視図である。 図1に示す油圧ショベルの一部を拡大して示す斜視図である。 図2の矢印方向から見た油圧ショベルの構成を示す側面図である。 図1に示す油圧ショベルの一部を破断して示す正面図である。 油圧ショベルの構成を模式的に示す側面図(A)、背面図(B)、平面図(C)である。 油圧ショベルが備える制御系の構成を示すブロック図である。 設計地形の構成の一例を示す図である。 本開示の一実施形態に係る油圧ショベルの案内画面の一例を示す図である。 パラメータのリストを示す図である。 ブームの側面図である。 アームの側面図である。 バケットおよびアームの側面図である。 バケットの側面図である。 シリンダの長さを示すパラメータの演算方法を示す図である。 オペレータが較正時に行う作業手順を示すフローチャートである。 外部計測装置の設置位置を示す図である。 作業機の5つの姿勢での刃先の位置を示す側面図である。 第1〜第5位置の各位置におけるシリンダのストローク長さを示す表である。 旋回角の異なる3つの刃先の位置を示す平面図である。 較正装置の較正に係わる処理機能を示す機能ブロック図である。 座標変換情報の演算方法を示す図である。 座標変換情報の演算方法を示す図である。
以下、図面を参照して、本開示の一実施形態に係る油圧ショベルの構成および較正方法について説明する。
(油圧ショベルの構成)
まず本実施形態に係る油圧ショベルの構成について図1〜図5を用いて説明する。
図1は、較正装置による較正が実施される油圧ショベル100の斜視図である。油圧ショベル100は、車体(車両本体)1と、作業機2とを有する。車体1は、旋回体3と、運転室4と、走行体5とを有する。旋回体3は、走行体5に旋回可能に取り付けられている。旋回体3は、油圧ポンプ37(図6参照)、図示しないエンジンなどの装置を収容している。運転室4は旋回体3の前部に載置されている。運転室4内には、後述する表示入力装置38および操作装置25が配置される(図6参照)。走行体5は履帯5a、5bを有しており、履帯5a、5bが回転することにより油圧ショベル100が走行する。
作業機2は、車体1の前部に取り付けられている。作業機2は、ブーム6と、アーム7と、バケット8と、ブームシリンダ10と、アームシリンダ11と、バケットシリンダ12とを有する。
ブーム6の基端部は、ブームピン13を介して車体1の前部に揺動可能に取り付けられている。ブームピン13は、ブーム6の旋回体3に対する揺動中心に相当する。アーム7の基端部は、アームピン14を介してブーム6の先端部に揺動可能に取り付けられている。アームピン14は、アーム7のブーム6に対する揺動中心に相当する。アーム7の先端部には、バケットピン15を介してバケット8が揺動可能に取り付けられている。バケットピン15は、バケット8のアーム7に対する揺動中心に相当する。
ブームシリンダ10、アームシリンダ11およびバケットシリンダ12の各々は、油圧によって駆動される油圧シリンダである。ブームシリンダ10の基端部は、ブームシリンダフートピン10aを介して旋回体3に揺動可能に取り付けられている。ブームシリンダ10の先端部は、ブームシリンダトップピン10bを介してブーム6に揺動可能に取り付けられている。ブームシリンダ10は、油圧によって伸縮することによって、ブーム6を駆動する。
アームシリンダ11の基端部は、アームシリンダフートピン11aを介してブーム6に揺動可能に取り付けられている。アームシリンダ11の先端部は、アームシリンダトップピン11bを介してアーム7に揺動可能に取り付けられている。アームシリンダ11は、油圧によって伸縮することによって、アーム7を駆動する。
バケットシリンダ12の基端部は、バケットシリンダフートピン12aを介してアーム7に揺動可能に取り付けられている。バケットシリンダ12の先端部は、バケットシリンダトップピン12bを介して第1リンク部材47の一端および第2リンク部材48の一端に揺動可能に取り付けられている。
第1リンク部材47の他端は、第1リンクピン47aを介してアーム7の先端部に揺動可能に取り付けられている。第2リンク部材48の他端は、第2リンクピン48aを介してバケット8に揺動可能に取り付けられている。バケットシリンダ12は、油圧によって伸縮することによって、バケット8を駆動する。
車体1には、RTK−GNSS(Real Time Kinematic-Global Navigation Satellite Systems)用の2つのアンテナ21、22が取り付けられている。アンテナ21はたとえば運転室4に取り付けられ、アンテナ22はたとえば旋回体3に取り付けられていてもよい。
アンテナ21、22は、車幅方向に沿って一定距離だけ互いに離間して配置されている。アンテナ21(以下、「基準アンテナ21」と呼ぶ)は、車体1の現在位置を検出するためのアンテナである。アンテナ22(以下、「方向アンテナ22」と呼ぶ)は、車体1(具体的には旋回体3)の向きを検出するためのアンテナである。なお、アンテナ21、22は、GPS用のアンテナであってもよい。
旋回体3は、外装パネルとして、土砂カバー3a(カバー)と、板金パネル3bと、エンジンフード3cとを有している。土砂カバー3aおよびエンジンフード3cの各々は、たとえば樹脂よりなっており、開閉可能に設けられている。板金パネル3bは、たとえば金属よりなっており、旋回体3に対して移動不能に固定されている。
この旋回体3には、貫通孔3baが設けられている。貫通孔3baは、たとえば板金パネル3bに設けられている。貫通孔3baは、キャップ91(図4)で塞がれている。キャップ91は、旋回体3の板金パネル3bに取り付けられており、旋回体3の板金パネル3bから取り外し可能である。キャップ91が旋回体3の板金パネル3bから取り外された場合、貫通孔3baは、油圧ショベル100の外部に対して開口する。
この貫通孔3baは、油圧ショベル100の側方から貫通孔3baを通して、ブームピン13の位置を知ることのできる部材を観測できるように構成されている。図1に示す構成においては、ブームピン13の位置を知ることのできる部材は、たとえばブームピン13自身である。具体的には貫通孔3baは、油圧ショベル100の側方から貫通孔3baを通して、ブームピン13の端面に示された、ブームピン13の軸中心を示すマークを観測できるように構成されている。
また図2に示されるように、ブームピン13の位置を知ることのできる部材は、ブーム角度検出部16であってもよい。ブーム角度検出部16は、ブームピン13の端面13aaの側方に配置されている。このブーム角度検出部16は、たとえばブーム6の揺動角度を検出するためのエンコーダである。
ブーム角度検出部16は、本体部16aと、連結部16bとを有している。本体部16aは車体1に固定されている。本体部16aは、たとえば連結部16bの回転角度を検出するポテンショメータを有している。連結部16bはブームピン13の軸を中心に回転可能であり、ブーム6に連結されている。
連結部16bは、ブーム6の揺動と連動してブームピン13の軸を中心に回動する。連結部16bが回動した角度によって、本体部16aにおけるポテンショメータの抵抗値が変動する。その抵抗値に基づいてブーム6の揺動角度が検出される。
ブーム角度検出部16が上記のように配置されている場合、図3に示されるように、貫通孔3baは、油圧ショベル100の側方から貫通孔3baを通してブーム角度検出部16の表面を観測できるように構成されている。具体的には貫通孔3baは、油圧ショベル100の側方から貫通孔3baを通して、ブーム角度検出部16の表面に示された、ブームピン13の軸中心を示すマークを観測できるように構成されている。
貫通孔3baは、ブームピン13の軸中心の延長線上に配置されていてもよい。ただし油圧ショベル100の側方から貫通孔3baを通してブームピン13の端面またはブーム角度検出部16の表面を観測できるのであれば、貫通孔3baは、ブームピン13の軸中心の延長線上に配置されていなくてもよい。
図4に示されるように、ブームピン13は、軸部13aと、フランジ部13bとを有していてもよい。軸部13aとフランジ部13bとは一体的に構成されている。この場合、貫通孔3baは、油圧ショベル100の側方から貫通孔3baを通してフランジ部13bのたとえば円形の端面を観測できるように構成されていてもよい。
フランジ部13bは、軸部13aの端部に位置している。フランジ部13bの外径DCは、軸部13aの外径DBよりも大きい。貫通孔3baの開口径DAは、軸部13aの外径DBよりも大きく、かつフランジ部13bの外径DCよりも小さい。貫通孔3baの開口径DAは、ブームピン13の最大径DCよりも小さい。
土砂カバー3aは、たとえば後端を回転中心として前端が上下に回動することにより開閉可能である。図4において実線で示された土砂カバー3aは閉じた状態にある。また破線で示された土砂カバー3aは開いた状態にあり、土砂カバー3aの前端が上方に立ち上がった状態にある。
このように土砂カバー3aが閉じた状態または開いた状態のいずれの状態にあっても、貫通孔3baを通してブームピン13の端面またはブーム角度検出部16の表面を観測できるように貫通孔3baは構成されている。
土砂カバー3aは、ブーム6の側方であって、ブーム6を基準として貫通孔3baと同じ側の側方に配置されている。具体的には、土砂カバー3aおよび貫通孔3baの双方は、ブーム6のたとえば右側に配置されている。
また土砂カバー3aおよび貫通孔3baの双方は、ブーム6を基準として運転室4と反対側の側方に配置されている。具体的には、土砂カバー3aおよび貫通孔3baの双方はブーム6のたとえば右側に配置されており、運転室4はブーム6のたとえば左側に配置されている。
なお、ブーム6は、レボフレームから立設した1対のブラケット(ブーム取付部)3dにブームピン13を介して揺動可能に取り付けられている。
図5(A)、(B)、(C)のそれぞれは、油圧ショベル100の構成を模式的に示す側面図、背面図、平面図である。図5(A)に示されるように、ブーム6の長さ(ブームピン13とアームピン14との間の長さ)はL1である。アーム7の長さ(アームピン14とバケットピン15との間の長さ)はL2である。バケット8の長さ(バケットピン15とバケット8の刃先Pとの間の長さ)はL3である。バケット8の刃先Pとは、バケット8の刃先の幅方向における中点Pを意味する。
(油圧ショベルの制御系)
次に、本実施形態に係る油圧ショベルの制御系について図5〜図7を用いて説明する。
図6は、油圧ショベル100が備える制御系の構成を示すブロック図である。油圧ショベル100は、ブーム角度検出部16と、アーム角度検出部17と、バケット角度検出部18とを有している。ブーム角度検出部16、アーム角度検出部17およびバケット角度検出部18は、それぞれブーム6、アーム7、バケット8に設けられている。角度検出部16〜18の各々は、たとえばポテンショメータであってもよく、またストロークセンサであってもよい。
図5(A)に示されるように、ブーム角度検出部16は、車体1に対するブーム6の揺動角αを間接的に検出する。アーム角度検出部17は、ブーム6に対するアーム7の揺動角βを間接的に検出する。バケット角度検出部18は、アーム7に対するバケット8の揺動角γを間接的に検出する。揺動角α、β、γの演算方法については後に詳細に説明する。
図5(A)に示されるように、車体1は、位置検出部19を有している。位置検出部19は、油圧ショベル100の車体1の現在位置を検出する。位置検出部19は、2つのアンテナ21、22と、3次元位置センサ23とを有する。
アンテナ21、22の各々で受信されたGNSS電波に応じた信号は3次元位置センサ23に入力される。3次元位置センサ23は、アンテナ21、22のグローバル座標系における現在位置を検出する。
なお、グローバル座標系は、GNSSによって計測される座標系であり、地球に固定された原点を基準とした座標系である。これに対して、後述する車体座標系は、車体1(具体的には旋回体3)に固定された原点を基準とする座標系である。
位置検出部19は、基準アンテナ21と方向アンテナ22との位置によって、後述する車体座標系のx軸のグローバル座標系での方向角を検出する。
図6に示されるように、車体1は、ロール角センサ24と、ピッチ角センサ29とを有する。ロール角センサ24は、図5(B)に示されるように、重力方向(鉛直線)に対する車体1の幅方向の傾斜角θ1(以下、「ロール角θ1」と呼ぶ)を検出する。ピッチ角センサ29は、図5(A)に示されるように、重力方向に対する車体1の前後方向の傾斜角θ2(以下、「ピッチ角θ2」と呼ぶ)を検出する。
なお、本実施形態において、幅方向とは、バケット8の幅方向を意味しており、車幅方向と一致している。ただし、作業機2が後述するチルトバケットを備える場合には、バケット8の幅方向と車幅方向とが一致しないことがあり得る。
図6に示されるように、油圧ショベル100は、操作装置25と、作業機コントローラ26と、作業機制御装置27と、油圧ポンプ37とを有する。操作装置25は、作業機操作部材31と、作業機操作検出部32と、走行操作部材33と、走行操作検出部34と、旋回操作部材51と、旋回操作検出部52とを有する。
作業機操作部材31は、オペレータが作業機2を操作するための部材であり、たとえば操作レバーである。作業機操作検出部32は、作業機操作部材31の操作内容を検出して、検出信号として作業機コントローラ26へ送る。
走行操作部材33は、オペレータが油圧ショベル100の走行を操作するための部材であり、たとえば操作レバーである。走行操作検出部34は、走行操作部材33の操作内容を検出して、検出信号として作業機コントローラ26へ送る。
旋回操作部材51は、オペレータが旋回体3の旋回を操作するための部材であり、たとえば操作レバーである。旋回操作検出部52は、旋回操作部材51の操作内容を検出して、検出信号として作業機コントローラ26へ送る。
作業機コントローラ26は、記憶部35と、演算部36とを有している。記憶部35は、RAM(Random Access Memory)、ROM(Read Only Memory)などを有している。演算部36はCPU(Central Processing Unit)などを有している。作業機コントローラ26は、主として作業機2の動作および旋回体3の旋回の制御を行う。作業機コントローラ26は、作業機操作部材31の操作に応じて作業機2を動作させるための制御信号を生成して、作業機制御装置27に出力する。
作業機制御装置27は、比例制御弁などの油圧制御機器を有している。作業機制御装置27は、作業機コントローラ26からの制御信号に基づいて、油圧ポンプ37から油圧シリンダ10〜12に供給される作動油の流量を制御する。油圧シリンダ10〜12は、作業機制御装置27から供給された作動油に応じて駆動される。これにより、作業機2が動作する。
作業機コントローラ26は、旋回操作部材51の操作に応じて旋回体3を旋回させるための制御信号を生成して、旋回モータ49に出力する。これにより、旋回モータ49が駆動され、旋回体3が旋回する。
油圧ショベル100は、表示システム28を有する。表示システム28は、作業エリア内の地面を掘削して後述する設計面のような形状に形成するための情報をオペレータに提供するためのシステムである。表示システム28は、表示入力装置38と、表示コントローラ39とを有する。
表示入力装置38は、タッチパネル式の入力部41と、LCD(Liquid Crystal Display)などの表示部42とを有する。表示入力装置38は、掘削を行うための情報を提供するための案内画面を表示する。また、案内画面には、各種のキーが表示される。オペレータは、案内画面上の各種のキーに触れることにより、表示システム28の各種の機能を実行させることができる。案内画面については後に詳細に説明する。
表示コントローラ39は、表示システム28の各種の機能を実行する。表示コントローラ39と作業機コントローラ26とは、無線あるいは有線の通信手段により互いに通信可能となっている。表示コントローラ39は、RAM、ROMなどの記憶部43と、CPUなどの演算部44とを有している。演算部44は、記憶部43に記憶されている各種のデータと、位置検出部19の検出結果とに基づいて、案内画面を表示するための各種の演算を実行する。
表示コントローラ39の記憶部43には、設計地形データが予め作成されて記憶されている。設計地形データは、3次元の設計地形の形状および位置に関する情報である。設計地形は、作業対象となる地面の目標形状を示す。表示コントローラ39は、設計地形データや上述した各種のセンサからの検出結果などのデータに基づいて、案内画面を表示入力装置38に表示させる。具体的には、図7に示されるように、設計地形は、三角形ポリゴンによってそれぞれ表現される複数の設計面45によって構成されている。なお、図7では複数の設計面のうちの一部のみに符号45が付されており、他の設計面の符号は省略されている。オペレータは、これらの設計面45のうちの1つ、または、複数の設計面45を目標面70として選択する。表示コントローラ39は、目標面70の位置をオペレータに知らせるための案内画面を表示入力装置38に表示させる。
表示コントローラ39の演算部44は、位置検出部19の検出結果と、記憶部43に記憶されている複数のパラメータとに基づいて、バケット8の刃先Pの現在位置を演算する。この演算部44は、第1現在位置演算部44aと、第2現在位置演算部44bとを有する。第1現在位置演算部44aは、後述する作業機パラメータに基づいて、バケット8の刃先Pの車体座標系における現在位置を演算する。第2現在位置演算部44bは、後述するアンテナパラメータと、位置検出部19が検出したアンテナ21、22のグローバル座標系における現在位置と、第1現在位置演算部44aが演算したバケット8の刃先Pの車体座標系における現在位置とから、バケット8の刃先Pのグローバル座標系における現在位置を演算する。
較正装置60は、上述した揺動角α、β、γの演算と、バケット8の刃先P位置の演算とをするために必要なパラメータを較正する装置である。較正装置60は、油圧ショベル100および外部計測装置62と共に、上述したパラメータを較正するための較正システムを構成する。
外部計測装置62は、バケット8の刃先Pの位置を計測する装置であり、たとえば、トータルステーションである。較正装置60は、有線または無線によって外部計測装置62とデータ通信を行うことができる。また、較正装置60は、有線または無線によって表示コントローラ39とデータ通信を行うことができる。較正装置60は、外部計測装置62によって計測された情報に基づいて図9に示されるパラメータの較正を行う。パラメータの較正は、たとえば、油圧ショベル100の出荷時やメンテナンス後の初期設定において実行される。
較正装置60は、入力部63と、表示部64と、演算部65(コントローラ)とを有する。入力部63は、後述する第1作業点位置情報、第2作業点位置情報、アンテナ位置情報、バケット情報が入力される部分である。入力部63は、オペレータがそれらの情報を手入力するための構成を備えており、たとえば複数のキーを有する。入力部63は、数値の入力が可能であればタッチパネル式のものであってもよい。表示部64は、たとえばLCDであり、較正を行うための操作画面が表示される部分である。演算部65は、入力部63を介して入力された情報に基づいて、パラメータを較正する処理を実行する。
(油圧ショベルにおける案内画面)
次に、本実施形態に係る油圧ショベルの案内画面について図8を用いて説明する。
図8は、本開示の一実施形態に係る油圧ショベルの案内画面を示す図である。図8に示されるように、案内画面53は、目標面70とバケット8の刃先Pとの位置関係を示す。案内画面53は、作業対象である地面が目標面70と同じ形状になるように油圧ショベル100の作業機2を誘導するための画面である。
案内画面53は、平面図73aと、側面図73bとを含む。平面図73aは、作業エリアの設計地形と油圧ショベル100の現在位置とを示す。側面図73bは、目標面70と油圧ショベル100との位置関係を示す。
案内画面53の平面図73aは、複数の三角形ポリゴンによって平面視による設計地形を表現している。より具体的には、平面図73aは、油圧ショベル100の旋回平面を投影面として設計地形を表現している。したがって、平面図73aは、油圧ショベル100の真上から見た図であり、油圧ショベル100が傾いたときには設計面45が傾くことになる。また、複数の設計面45から選択された目標面70は、他の設計面45と異なる色で表示される。なお、図8では、油圧ショベル100の現在位置が平面視による油圧ショベルのアイコン61で示されているが、他のシンボルによって示されてもよい。
また平面図73aは、油圧ショベル100を目標面70に対して正対させるための情報を含んでいる。油圧ショベル100を目標面70に対して正対させるための情報は、正対コンパス73として表示される。正対コンパス73は、目標面70に対する正対方向と油圧ショベル100を旋回させるべき方向とを示すアイコンである。オペレータは、正対コンパス73により、目標面70への正対度を確認することができる。
案内画面53の側面図73bは、目標面70とバケット8の刃先Pとの位置関係を示す画像と、目標面70とバケット8の刃先Pとの間の距離を示す距離情報88とを含む。具体的には、側面図73bは、設計面線81と、目標面線82と、側面視による油圧ショベル100のアイコン75とを含む。設計面線81は、目標面70以外の設計面45の断面を示す。目標面線82は目標面70の断面を示す。設計面線81と目標面線82とは、図7に示されるように、バケット8の刃先Pの幅方向における中点P(以下、単に「バケット8の刃先P」と呼ぶ)の現在位置を通る平面77と設計面45との交線80を演算することにより求められる。バケット8の刃先Pの現在位置を演算する方法については後に詳細に説明する。
以上のように、案内画面53では、設計面線81と、目標面線82と、バケット8を含む油圧ショベル100との相対位置関係が画像によって表示される。オペレータは、目標面線82に沿ってバケット8の刃先Pを移動させることによって、現在の地形が設計地形になるように、容易に掘削することができる。
(刃先Pの現在位置の演算方法)
次に、上述したバケット8の刃先Pの現在位置の演算方法について図5、図6および図9を用いて説明する。
図9は、記憶部43に記憶されているパラメータのリストを示す。図9に示されるように、パラメータは、作業機パラメータと、アンテナパラメータとを含む。作業機パラメータは、ブーム6、アーム7およびバケット8の各々の寸法と、揺動角とを示す複数のパラメータを含む。アンテナパラメータは、アンテナ21、22の各々とブーム6との位置関係を示す複数のパラメータを含む。
バケット8の刃先Pの現在位置の演算において、まず図5に示されるように、ブームピン13の軸と後述する作業機2の動作平面との交点を原点とする車体座標系x−y−zを設定する。なお、以下の説明においてブームピン13の位置は、ブームピン13の車幅方向における中点の位置を意味するものとする。また角度検出部16〜18(図6)の検出結果から、上述したブーム6、アーム7、バケット8の現在の揺動角α、β、γ(図5(A))が演算される。揺動角α、β、γの演算方法については後述する。車体座標系でのバケット8の刃先Pの座標(x、y、z)は、ブーム6、アーム7、バケット8の揺動角α、β、γと、ブーム6、アーム7、バケット8の長さL1、L2、L3とを用いて、以下の数1式により演算される。
Figure 2019012651
また、数1式から求められた車体座標系でのバケット8の刃先Pの座標(x、y、z)は、以下の数2式により、グローバル座標系での座標(X、Y、Z)に変換される。
Figure 2019012651
ただし、ω、φ、κは以下の数3式のように表される。
Figure 2019012651
ここで、上述したとおり、θ1はロール角である。θ2はピッチ角である。また、θ3は、Yaw角であり、上述した車体座標系のx軸のグローバル座標系での方向角である。したがって、Yaw角θ3は、位置検出部19によって検出された基準アンテナ21と方向アンテナ22との位置に基づいて演算される。(A、B、C)は、車体座標系における原点のグローバル座標系での座標である。
上述したアンテナパラメータは、アンテナ21、22と車体座標系における原点との位置関係(アンテナ21、22とブームピン13の車幅方向における中点との位置関係)を示す。具体的には、図5(B)および図5(C)に示されるように、アンテナパラメータは、ブームピン13と基準アンテナ21との間の車体座標系のx軸方向の距離Lbbxと、ブームピン13と基準アンテナ21との間の車体座標系のy軸方向の距離Lbbyと、ブームピン13と基準アンテナ21との間の車体座標系のz軸方向の距離Lbbzとを含む。
またアンテナパラメータは、ブームピン13と方向アンテナ22との間の車体座標系のx軸方向の距離Lbdxと、ブームピン13と方向アンテナ22との間の車体座標系のy軸方向の距離Lbdyと、ブームピン13と方向アンテナ22との間の車体座標系のz軸方向の距離Lbdzとを含む。
(A、B、C)は、アンテナ21、22が検出したグローバル座標系におけるアンテナ21、22の座標と、アンテナパラメータとに基づいて演算される。
以上のようにしてバケット8の刃先Pのグローバル座標系における現在位置(座標(X、Y、Z))が演算により求められる。
図7に示されるように、表示コントローラ39は、上記のように演算したバケット8の刃先Pの現在位置と、記憶部43に記憶された設計地形データとに基づいて、3次元設計地形とバケット8の刃先Pを通る平面77との交線80を演算する。そして、表示コントローラ39は、この交線80のうち目標面70を通る部分を上述した目標面線82(図8)として演算する。また表示コントローラ39は、この交線80のうち目標面線82以外の部分を設計面線81(図8)として演算する。
(揺動角α、β、γの演算方法)
次に、角度検出部16〜18の各々の検出結果から、ブーム6、アーム7、バケット8の現在の揺動角α、β、γを演算する方法について図10〜図14を用いて説明する。
図10は、ブーム6の側面図である。ブーム6の揺動角αは、図10に示されている作業機パラメータを用いて、以下の数4式によって表される。
Figure 2019012651
図10に示されるように、Lboom2_xは、ブームシリンダフートピン10aとブームピン13との間の車体1の水平方向(車体座標系のx軸方向に相当する)の距離である。Lboom2_zは、ブームシリンダフートピン10aとブームピン13との間の車体1の鉛直方向(車体座標系のz軸方向に相当する)の距離である。Lboom1は、ブームシリンダトップピン10bとブームピン13との間の距離である。Lboom2は、ブームシリンダフートピン10aとブームピン13との間の距離である。boom_cylは、ブームシリンダフートピン10aとブームシリンダトップピン10bとの間の距離である。
側面視においてブームピン13とアームピン14とを結ぶ方向をxboom軸とし、xboom軸に垂直な方向をzboom軸とする。Lboom1_xは、ブームシリンダトップピン10bとブームピン13との間のxboom軸方向の距離である。Lboom1_zは、ブームシリンダトップピン10bとブームピン13との間のzboom軸方向の距離である。
図11は、アーム7の側面図である。アーム7の揺動角βは、図10および図11に示されている作業機パラメータを用いて、以下の数5式によって表される。
Figure 2019012651
図10に示されるように、Lboom3_xは、アームシリンダフートピン11aとアームピン14との間のxboom軸方向の距離である。Lboom3_zは、アームシリンダフートピン11aとアームピン14との間のzboom軸方向の距離である。Lboom3は、アームシリンダフートピン11aとアームピン14との間の距離である。arm_cylは、アームシリンダフートピン11aとアームシリンダトップピン11bとの間の距離である。
図11に示されるように、側面視においてアームシリンダトップピン11bとバケットピン15とを結ぶ方向をxarm2軸とし、xarm2軸に垂直な方向をzarm2軸とする。また、側面視においてアームピン14とバケットピン15とを結ぶ方向をxarm1軸とする。
Larm2は、アームシリンダトップピン11bとアームピン14との間の距離である。Larm2_xは、アームシリンダトップピン11bとアームピン14との間のxarm2軸方向の距離である。Larm2_zは、アームシリンダトップピン11bとアームピン14との間のzarm2軸方向の距離である。
Larm1_xは、アームピン14とバケットピン15との間のxarm2軸方向の距離である。Larm1_zは、アームピン14とバケットピン15との間のzarm2軸方向の距離である。アーム7の揺動角βは、xboom軸とxarm1軸との間のなす角である。
図12は、バケット8およびアーム7の側面図である。図13は、バケット8の側面図である。バケット8の揺動角γは、図11〜図13に示されている作業機パラメータを用いて、以下の数6式によって表される。
Figure 2019012651
図11に示されるように、Larm3_z2は、第1リンクピン47aとバケットピン15との間のzarm2軸方向の距離である。Larm3_x2は、第1リンクピン47aとバケットピン15との間のxarm2軸方向の距離である。
図12に示されるように、Ltmpは、バケットシリンダトップピン12bとバケットピン15との間の距離である。Larm4は、第1リンクピン47aとバケットピン15との間の距離である。Lbucket1は、バケットシリンダトップピン12bと第1リンクピン47aとの間の距離である。Lbucket2は、バケットシリンダトップピン12bと第2リンクピン48aとの間の距離である。Lbucket3は、バケットピン15と第2リンクピン48aとの間の距離である。バケット8の揺動角γは、xbucket軸とxarm1軸との間のなす角である。
図13に示されるように、側面視においてバケットピン15とバケット8の刃先Pとを結ぶ方向をxbucket軸とし、xbucket軸に垂直な方向をzbucket軸とする。Lbucket4_xは、バケットピン15と第2リンクピン48aとの間のxbucket軸方向の距離である。Lbucket4_zは、バケットピン15と第2リンクピン48aとの間のzbucket軸方向の距離である。
なお、上述したLtmpは以下の数7式によって表される。
Figure 2019012651
図11に示されるように、Larm3は、バケットシリンダフートピン12aと第1リンクピン47aとの間の距離である。Larm3_x1は、バケットシリンダフートピン12aとバケットピン15との間のxarm2軸方向の距離である。Larm3_z1は、バケットシリンダフートピン12aとバケットピン15との間のzarm2軸方向の距離である。
また、上述したboom_cylは、図14に示されるように、ブーム角度検出部16が検出したブームシリンダ10のストローク長bssにブームシリンダオフセットboftを加えた値である。同様に、arm_cylは、アーム角度検出部17が検出したアームシリンダ11のストローク長assにアームシリンダオフセットaoftを加えた値である。同様に、bucket_cylは、バケット角度検出部18が検出したバケットシリンダ12のストローク長bkssにバケットシリンダ12の最小距離を含んだバケットシリンダオフセットbkoftを加えた値である。
以上のようにして角度検出部16〜18の各々の検出結果から、ブーム6、アーム7、バケット8の現在の揺動角α、β、γが演算により求められる。
(オペレータによる較正作業)
次に、本実施形態に係る油圧ショベルにおけるオペレータによる較正作業について図2、図4、図15〜図19を用いて説明する。
図15は、オペレータが較正時に行う作業手順を示すフローチャートである。図15に示されるように、まずステップS1において、オペレータは、キャップ91を旋回体3の板金パネル3bから取り外し、貫通孔3baを油圧ショベル100の外部に向けて開口させる(図4)。そして、オペレータは、外部計測装置62を設置する。このとき、オペレータは、図16に示されるように、ブームピン13の真後ろに所定の距離Dxと真横に所定の距離Dyとを隔てて外部計測装置62を設置する。また、ステップS2において、オペレータは、外部計測装置62を用いてブームピン13の端面(側面)における中心位置を測定する。
このとき、図1〜図4に示されるように、オペレータは、外部計測装置62を用いて、油圧ショベル100の側方から貫通孔3baを通してブームピン13の端面(またはブーム角度検出部16の表面)を観測することにより、ブームピン13の端面における中心位置を測定する。具体的にはオペレータは、油圧ショベル100の側方から貫通孔3baを通して、ブームピン13の端面(またはブーム角度検出部16の表面)に示された、ブームピン13の軸中心を示すマークを観測することにより、ブームピン13の端面における中心位置を測定する。
ステップS3において、オペレータは、外部計測装置62を用いて作業機2の5つの姿勢での刃先Pの位置を測定する。ここでは、オペレータは、作業機操作部材31を操作して、図17に示される第1位置P1から第5位置P5までの5つの位置にバケット8の刃先Pの位置を移動させる。
このとき、旋回体3は旋回させずに走行体5に対して固定された状態を維持する。そして、オペレータは、第1位置P1から第5位置P5の各位置での刃先Pの座標を、外部計測装置62を用いて測定する。第1位置P1および第2位置P2は、地面上において車体前後方向に異なる位置である。第3位置P3および第4位置P4は、空中において車体前後方向に異なる位置である。第3位置P3および第4位置P4は、第1位置P1および第2位置P2に対して、上下方向に異なる位置である。第5位置P5は、第1位置P1と第2位置P2と第3位置P3と第4位置P4との間の位置である。
図18は、第1位置P1〜第5位置P5の各位置における各シリンダ10〜12のストローク長さを、最大を100%、最小を0%として示している。図18に示されるように、第1位置P1では、アームシリンダ11のストローク長さが最小となっている。すなわち、第1位置P1は、アーム7の揺動角が最小となる作業機の姿勢での刃先Pの位置である。
第2位置P2では、アームシリンダ11のストローク長さが最大となっている。すなわち、第2位置P2は、アーム7の揺動角が最大となる作業機の姿勢での刃先Pの位置である。
第3位置P3では、アームシリンダ11のストローク長が最小であり、バケットシリンダ12のストローク長が最大となっている。すなわち、第3位置P3は、アーム7の揺動角が最小となりかつバケット8の揺動角が最大となる作業機2の姿勢での刃先Pの位置である。
第4位置P4では、ブームシリンダ10のストローク長が最大となっている。すなわち、第4位置P4は、ブーム6の揺動角が最大となる作業機2の姿勢での刃先Pの位置である。
第5位置P5では、アームシリンダ11、ブームシリンダ10、バケットシリンダ12のいずれのシリンダ長も、最小ではなく、また最大でもない、中間的な値になっている。すなわち、第5位置P5は、アーム7の揺動角、ブーム6の揺動角、バケット8の揺動角のいずれも最大ではなく、また最小でもない中間的な値になっている。
ステップS4において、オペレータは、第1作業点位置情報を較正装置60の入力部63に入力する。第1作業点位置情報は、外部計測装置62で計測されたバケット8の刃先Pの第1位置P1〜第5位置P5での座標を示す。したがって、オペレータは、ステップS4において外部計測装置62を用いて計測したバケット8の刃先Pの第1位置P1〜第5位置P5での座標を、較正装置60の入力部63に入力する。
ステップS5において、オペレータは、外部計測装置62を用いてアンテナ21、22の位置を測定する。ここでは、図16に示されるように、オペレータは、基準アンテナ21上の第1計測点P11と第2計測点P12との位置を外部計測装置62を用いて計測する。第1計測点P11および第2計測点P12は、基準アンテナ21の上面の中心を基準にして対称に配置されている。基準アンテナ21の上面の形状が長方形または正方形である場合には、第1計測点P11および第2計測点P12は、基準アンテナ21の上面上の対角の2点である。
また、図16に示されるように、オペレータは、方向アンテナ22上の第3計測点P13と第4計測点P14との位置を外部計測装置62を用いて計測する。第3計測点P13および第4計測点P14は、方向アンテナ22の上面の中心を基準にして対称に配置されている。第1計測点P11および第2計測点P12と同様に、第3計測点P13および第4計測点P14は、方向アンテナ22の上面上の対角の2点である。
なお、第1計測点P11〜第4計測点P14には計測を容易にするために目印が付されていることが好ましい。たとえば、アンテナ21、22の部品として含まれるボルトなどが目印として用いられてもよい。
ステップS6において、オペレータは、アンテナ位置情報を較正装置60の入力部63に入力する。アンテナ位置情報は、ステップS5において、オペレータが外部計測装置62を用いて計測した第1計測点P11〜第4計測点P14の位置を示す座標を含む。
ステップS7において、オペレータは、旋回角の異なる3つの刃先Pの位置を測定する。ここでは図19に示されるように、オペレータは、旋回操作部材51を操作して、旋回体3を旋回させる。このとき、作業機2の姿勢は固定された状態に維持する。そして、オペレータは、外部計測装置62を用いて、旋回角の異なる3つの刃先Pの位置(以下、「第1旋回位置P21」、「第2旋回位置P22」、「第3旋回位置P23」と呼ぶ)を測定する。
ステップS8において、オペレータは、第2作業点位置情報を較正装置60の入力部63に入力する。第2作業点位置情報は、ステップS7において、オペレータが外部計測装置62を用いて計測した第1旋回位置P21と第2旋回位置P22と第3旋回位置P23とを示す座標を含む。
ステップS9において、オペレータは、バケット情報を較正装置60の入力部63に入力する。バケット情報は、バケット8の寸法に関する情報である。バケット情報は、上述したバケットピン15と第2リンクピン48aとの間のxbucket軸方向の距離(Lbucket4_x)と、バケットピン15と第2リンクピン48aとの間のzbucket軸方向の距離(Lbucket4_z)とを含む。オペレータは、設計値または外部計測装置62などの計測手段によって計測した値を、バケット情報として入力する。
ステップS10において、オペレータは、較正装置60に較正の実行を指示する。
(較正装置60で実行される較正方法)
次に、較正装置60で実行される処理について図6、図9および図20〜図22を用いて説明する。
図20は、演算部65の較正に係わる処理機能を示す機能ブロック図である。図20に示されるように、演算部65は、車体座標系演算部65aと、座標変換部65bと、第1較正演算部65cと、第2較正演算部65dとを有している。
車体座標系演算部65aは、入力部63によって入力された第1作業点位置情報と第2作業点位置情報とに基づいて、座標変換情報を演算する。座標変換情報は、外部計測装置62を基準とした座標系を車体座標系に変換するための情報である。上述した第1作業点位置情報とアンテナ位置情報は、外部計測装置62によって計測されたものであるため、外部計測装置62を基準とした座標系(xp、yp、zp)によって表わされている。座標変換情報は、第1作業点位置情報とアンテナ位置情報とを、外部計測装置62を基準とした座標系から車体座標系(x、y、z)に変換するための情報である。以下、座標変換情報の演算方法について説明する。
まず、図20および図21に示されるように、車体座標系演算部65aは、第1作業点位置情報に基づいて作業機2の動作平面Aに垂直な第1単位法線ベクトルAHを演算する。車体座標系演算部65aは、第1作業点位置情報に含まれる5つの位置より最小二乗法を用いて作業機2の動作平面を算出し、それに基づいて第1単位法線ベクトルAHを演算する。なお、第1単位法線ベクトルAHは、第1作業点位置情報に含まれる5つの位置のうち他の2つの位置より外れていない3つの位置の座標から求められる2つのベクトルa1、a2に基づいて演算されても良い。
次に、車体座標系演算部65aは、第2作業点位置情報に基づいて旋回体3の旋回平面BAに垂直な第2単位法線ベクトルBHAを演算する。具体的には、車体座標系演算部65aは、第2作業点位置情報に含まれる第1旋回位置P21、第2旋回位置P22、第3旋回位置P23(図19)の座標から求められる2つのベクトルb1、b2に基づいて、旋回平面BAに垂直な第2単位法線ベクトルBHAを演算する。
次に、図22に示されるように、車体座標系演算部65aは、上述した作業機2の動作平面Aと、旋回平面BAとの交線ベクトルDABを演算する。車体座標系演算部65aは、交線ベクトルDABを通り作業機2の動作平面Aに垂直な平面Bの単位法線ベクトルを、補正された第2単位法線ベクトルBHとして演算する。そして、車体座標系演算部65aは、第1単位法線ベクトルAHと補正された第2単位法線ベクトルBHとに垂直な第3単位法線ベクトルCHを演算する。第3単位法線ベクトルCHは、動作平面Aと平面Bとの双方に垂直な平面Cの法線ベクトルである。
座標変換部65bは、外部計測装置62で計測された第1作業点位置情報とアンテナ位置情報とを、座標変換情報を用いて、外部計測装置62における座標系(xp、yp、zp)から油圧ショベル100における車体座標系(x、y、z)に変換する。座標変換情報は、上述した第1単位法線ベクトルAHと、補正された第2単位法線ベクトルBHと、第3単位法線ベクトルCHとを含む。具体的には以下の数8式に示されるように、ベクトルpで示されている外部計測装置62の座標系での座標と、座標変換情報の各法線ベクトルAH、BH、CHとの内積により車体座標系での座標が演算される。
Figure 2019012651
第1較正演算部65cは、車体座標系に変換された第1作業点位置情報に基づいて、数値解析を用いることにより、パラメータの較正値を演算する。具体的には、以下の数9式に示されるように、最小二乗法によりパラメータの較正値を演算する。
Figure 2019012651
上記のkの値は、第1作業点位置情報の第1位置P1〜第5位置P5に相当する。したがって、n=5である。(x1、z1)は、車体座標系での第1位置P1の座標である。(x2、z2)は、車体座標系での第2位置P2の座標である。(x3、z3)は、車体座標系での第3位置P3の座標である。(x4、z4)は、車体座標系での第4位置P4の座標である。(x5、z5)は、車体座標系での第5位置P5の座標である。
この数9式の関数Jが最小になる点を探索していることにより、作業機パラメータの較正値が演算される。具体的には図9のリストにおいてNo.1〜29の作業機パラメータの較正値が演算される。
なお、図9のリストに含まれる作業機パラメータのうち、バケットピン15と第2リンクピン48aとの間のxbucket軸方向の距離Lbucket4_x、および、バケットピン15と第2リンクピン48aとの間のzbucket軸方向の距離Lbucket4_zは、バケット情報として入力された値が用いられる。
第2較正演算部65dは、入力部63に入力されたアンテナ位置情報に基づいてアンテナパラメータを較正する。具体的には、第2較正演算部65dは、第1計測点P11と第2計測点P12との中点の座標を基準アンテナ21の位置の座標として演算する。具体的には、基準アンテナ21の位置の座標は上述したブームピン13と基準アンテナ21との間の車体座標系のx軸方向の距離Lbbxと、ブームピン13と基準アンテナ21との間の車体座標系のy軸方向の距離Lbbyと、ブームピン13と基準アンテナ21との間の車体座標系のz軸方向の距離Lbbzとによって表される。
また、第2較正演算部65dは、第3計測点P13と第4計測点P14との中点の座標を方向アンテナ22の位置の座標として演算する。具体的には、方向アンテナ22の位置の座標は、ブームピン13と方向アンテナ22との間の車体座標系のx軸方向の距離Lbdxと、ブームピン13と方向アンテナ22との間の車体座標系のy軸方向の距離Lbdyと、ブームピン13と方向アンテナ22との間の車体座標系のz軸方向の距離Lbdzとによって表される。そして、第2較正演算部65dは、これらのアンテナ21、22の位置の座標をアンテナパラメータLbbx、Lbby、Lbbz、Lbdx、Lbdy、Lbdzの較正値として出力する。
第1較正演算部65cによって演算された作業機パラメータと、第2較正演算部65dによって演算されたアンテナパラメータと、バケット情報とは、表示コントローラ39の記憶部43に保存され、上述した刃先P位置の演算に用いられる。
次に、本実施の形態の作用効果について説明する。
本実施の形態においては、図1〜図4に示されるように、貫通孔3baは、ブームピンの位置を知ることのできる部材(ブームピン13またはブーム角度検出部16)を油圧ショベル100の側方から貫通孔3baを通して観測できるように設けられている。これにより、較正作業時にブームピン13の位置を知ることのできる部材を観測するために車体1の土砂カバー3aなどを開ける必要はない。よって較正作業は簡易になるとともに、車本1の強度を高く保つことができる。
また本実施の形態においては、図2および図3に示されるように、ブームピン13の位置を知ることのできる部材は、ブーム角度検出部16であってもよい。ブーム角度検出部16の連結部16bは、ブーム6の揺動と連動してブームピン13の軸を中心に回動する。このため貫通孔3baを通じてブーム角度検出部16の連結部16bを観測することにより、ブームピン13の軸中心を知ることができ、ブームピン13の位置を知ることができる。
また本実施の形態においては、図1に示されるように、ブームピン13の位置を知ることのできる部材はブームピン13自身であってもよい。このようにブームピン13の端面を貫通孔3baを通じて直接観測することにより、ブームピン13の位置を正確に知ることが可能となる。
また本実施の形態においては、図4に示されるように、貫通孔3baの開口径DAは、ブームピン13の最大径DCよりも小さい。このようにブームピン13が貫通孔3baを通ることができない程度にまで貫通孔3baの開口径DAを小さくすることにより、さらに車体1の強度を向上させることができる。
また本実施の形態においては、図1に示されるように、貫通孔3baは、ブーム6を基準として運転室4とは反対側に位置する。これにより貫通孔3baを通じてブームピン13の位置を知ることのできる部材を観測する際に運転室4が障害になることはない。
また本実施の形態においては、図1に示されるように、貫通孔3baは、ブームピン13の軸線の延長線上に位置している。これにより貫通孔3baを通じてブームピン13の位置を知ることのできる部材を確実に観測することが可能となる。
また本実施の形態においては、図1に示されるように、車体1に対して開閉可能な土砂カバー3aが、ブーム6の側方であってブーム6を基準として貫通孔3baと同じ側に配置されている。また貫通孔3baは、土砂カバー3aを閉じた状態でブームピン13の位置を知ることのできる部材を観測できるように構成されている。これにより、較正作業時において土砂カバー3aを開く必要はなく、較正作業はより簡易になる。
今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて請求の範囲によって示され、請求の範囲と均等の意味および範囲内でのすべての変更が含まれることが意図される。
1 車本、2 作業機、3 旋回体、3a 土砂カバー、3b 板金パネル、3ba 貫通孔、3c エンジンフード、4 運転室、5 走行体、5a,5b 履帯、6 ブーム、7 アーム、8 バケット、10 ブームシリンダ、10a ブームシリンダフートピン、10b ブームシリンダトップピン、11 アームシリンダ、11a アームシリンダフートピン、11b アームシリンダトップピン、12 バケットシリンダ、12a バケットシリンダフートピン、12b バケットシリンダトップピン、13 ブームピン、13a 軸部、13aa 端面、13b フランジ部、14 アームピン、15 バケットピン、16 ブーム角度検出部、16a 本体部、16b 連結部、17 アーム角度検出部、18 バケット角度検出部、19 位置検出部、21 基準アンテナ、22 方向アンテナ、23 3次元位置センサ、24 ロール角センサ、25 操作装置、26 作業機コントローラ、27 作業機制御装置、28 表示システム、29 ピッチ角センサ、31 作業機操作部材、32 作業機操作検出部、33 走行操作部材、34 走行操作検出部、35,43 記憶部、36,44,65 演算部、37 油圧ポンプ、38 表示入力装置、39 表示コントローラ、41,63 入力部、42,64 表示部、44a 第1現在位置演算部、44b 第2現在位置演算部、45 設計面、47 第1リンク部材、47a 第1リンクピン、48 第2リンク部材、48a 第2リンクピン、49 旋回モータ、51 旋回操作部材、52 旋回操作検出部、53 案内画面、60 較正装置、61,75 アイコン、62 外部計測装置、65a 車体座標系演算部、65b 座標変換部、65c 第1較正演算部、65d 第2較正演算部、70 目標面、73 正対コンパス、73a 平面図、73b 側面図、77 平面、80 交線、81 設計面線、82 目標面線、88 距離情報、91 キャップ、100 油圧ショベル。

Claims (8)

  1. 油圧ショベルであって、
    車両本体と、
    前記車両本体に取り付けられたブームと、
    前記ブームを前記車両本体に揺動可能に支持するブームピンとを備え、
    前記車両本体には貫通孔が設けられており、
    前記貫通孔は、前記ブームピンの位置を取得するためのブーム位置取得部位を、前記油圧ショベルの側方から前記貫通孔を通して観測できるように設けられている、油圧ショベル。
  2. 前記ブームピンの端面の側方に配置されたブーム角度検出部をさらに備え、
    前記ブーム角度検出部は前記ブーム位置取得部位を有する、請求項1に記載の油圧ショベル。
  3. 前記ブームピンは前記ブーム位置取得部位を有する、請求項1に記載の油圧ショベル。
  4. 前記貫通孔の径は、前記ブームピンの最大径よりも小さい、請求項1に記載の油圧ショベル。
  5. 運転室をさらに備え、
    前記貫通孔は、前記ブームを基準として前記運転室とは反対側に位置する、請求項1に記載の油圧ショベル。
  6. 前記貫通孔は、前記ブームピンの軸線の延長線上に位置している、請求項1に記載の油圧ショベル。
  7. 前記車両本体は、前記ブームの側方であって前記ブームを基準として前記貫通孔と同じ側に配置された、開閉可能なカバーを有し、
    前記貫通孔は、前記カバーを閉じた状態で前記ブーム位置取得部位を観測できるように構成されている、請求項1に記載の油圧ショベル。
  8. 車両本体と、前記車両本体に取り付けられたブームと前記ブームの先端に取り付けられたアームと前記アームの先端に取り付けられた作業具とを有する作業機と、前記ブームを前記車両本体に揺動可能に支持するブームピンと、少なくとも前記ブームピンの位置を含む複数のパラメータに基づいて前記作業具に含まれる作業点の現在位置を演算するためのコントローラと、を備えた油圧ショベルにおいて前記パラメータを較正する方法であって、
    前記車両本体の側面に設けられた貫通孔を通じて前記油圧ショベルの側方から、前記ブームピンの位置を取得するためのブーム位置取得部位を観測することにより取得された前記ブームピンの位置に基づいて前記パラメータを較正する、油圧ショベルの較正方法。
JP2017560627A 2017-07-13 2017-07-13 油圧ショベル Active JP6782256B2 (ja)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2017/025549 WO2019012651A1 (ja) 2017-07-13 2017-07-13 油圧ショベルおよび油圧ショベルの較正方法

Publications (2)

Publication Number Publication Date
JPWO2019012651A1 true JPWO2019012651A1 (ja) 2020-05-07
JP6782256B2 JP6782256B2 (ja) 2020-11-11

Family

ID=65002503

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017560627A Active JP6782256B2 (ja) 2017-07-13 2017-07-13 油圧ショベル

Country Status (6)

Country Link
US (1) US10422111B2 (ja)
JP (1) JP6782256B2 (ja)
KR (1) KR20190019889A (ja)
CN (1) CN109496245B (ja)
DE (1) DE112017000125B4 (ja)
WO (1) WO2019012651A1 (ja)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CL2012000933A1 (es) * 2011-04-14 2014-07-25 Harnischfeger Tech Inc Un metodo y una pala de cable para la generacion de un trayecto ideal, comprende: un motor de oscilacion, un motor de izaje, un motor de avance, un cucharon para excavar y vaciar materiales y, posicionar la pala por medio de la operacion del motor de izaje, el motor de avance y el motor de oscilacion y; un controlador que incluye un modulo generador de un trayecto ideal.
WO2018062210A1 (ja) * 2016-09-30 2018-04-05 住友重機械工業株式会社 ショベル
KR102463068B1 (ko) * 2016-09-30 2022-11-02 스미토모 겐키 가부시키가이샤 쇼벨
JP6779759B2 (ja) * 2016-11-21 2020-11-04 日立建機株式会社 建設機械
JP7141894B2 (ja) * 2018-09-05 2022-09-26 日立建機株式会社 作業機械
JP7117238B2 (ja) * 2018-12-27 2022-08-12 日立建機株式会社 作業車両
FI128483B (en) * 2019-04-25 2020-06-15 Novatron Oy Measuring arrangement for measuring the three-dimensional position and orientation of the central axis of the first axis with respect to the central axis of the second axis
JP7326058B2 (ja) * 2019-07-31 2023-08-15 ヤンマーパワーテクノロジー株式会社 建設機械及びアンテナ取付構造
CN113740859A (zh) * 2021-08-19 2021-12-03 北京踏歌智行科技有限公司 一种适用于矿区装载设备的位置计算方法
CN115030247B (zh) * 2022-05-27 2023-10-31 三一重机有限公司 一种臂架位姿信息的校正方法、装置及挖掘机

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000352072A (ja) * 1999-06-11 2000-12-19 Sumitomo Constr Mach Co Ltd 旋回型土木・建設機械の燃料タンク
JP2004052361A (ja) * 2002-07-19 2004-02-19 Sumitomo (Shi) Construction Machinery Manufacturing Co Ltd 油圧ショベルの燃料タンク取付構造
US6934616B2 (en) * 2002-12-17 2005-08-23 Caterpillar Inc System for determining an implement arm position
JP2012202063A (ja) * 2011-03-24 2012-10-22 Komatsu Ltd 油圧ショベルの較正装置及び油圧ショベルの較正方法
WO2015137526A1 (ja) * 2015-03-27 2015-09-17 株式会社小松製作所 作業機械の較正装置、及び作業機械の作業機パラメータの較正方法
WO2015137527A1 (ja) * 2015-03-27 2015-09-17 株式会社小松製作所 作業機械の較正装置、及び作業機械の作業機パラメータの較正方法
WO2016013691A1 (ja) * 2015-10-15 2016-01-28 株式会社小松製作所 位置計測システム及び位置計測方法
JP2016069864A (ja) * 2014-09-29 2016-05-09 コベルコ建機株式会社 建設機械のインテリア配設構造
JP2016205095A (ja) * 2015-04-28 2016-12-08 キャタピラー エス エー アール エル 回動角度検出装置

Family Cites Families (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1077663A (ja) * 1996-09-04 1998-03-24 Shin Caterpillar Mitsubishi Ltd レーザ計測機付き建設機械
JP2002181538A (ja) 2000-12-14 2002-06-26 Topcon Corp Gpsを用いた施工端部位置検出装置
US6865464B2 (en) * 2002-12-17 2005-03-08 Caterpillar Inc. System for determining an implement arm position
JP5237408B2 (ja) * 2011-03-24 2013-07-17 株式会社小松製作所 油圧ショベルの較正システム及び較正方法
JP5237409B2 (ja) 2011-03-24 2013-07-17 株式会社小松製作所 油圧ショベルの較正装置及び油圧ショベルの較正方法
JP5789279B2 (ja) * 2013-04-10 2015-10-07 株式会社小松製作所 掘削機械の施工管理装置、油圧ショベルの施工管理装置、掘削機械及び施工管理システム
WO2015040726A1 (ja) 2013-09-19 2015-03-26 株式会社小松製作所 測定治具
DE112014000091B4 (de) * 2014-05-14 2016-11-24 Komatsu Ltd. Kalibriersystem und Kalibrierverfahren für einen Bagger
WO2015186179A1 (ja) * 2014-06-02 2015-12-10 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
US9598845B2 (en) * 2014-06-04 2017-03-21 Komatsu Ltd. Posture computing apparatus for work machine, work machine, and posture computation method for work machine
CN105992851A (zh) * 2014-09-09 2016-10-05 株式会社小松制作所 挖掘机械的显示系统、挖掘机械以及图像显示方法
CN104541001B (zh) * 2014-09-10 2015-12-09 株式会社小松制作所 作业车辆
WO2015167022A1 (ja) * 2015-05-29 2015-11-05 株式会社小松製作所 作業機械の制御システム及び作業機械
CN113073692B (zh) * 2015-09-16 2023-07-04 住友重机械工业株式会社 挖土机以及挖土机用控制装置
US9663917B2 (en) * 2015-10-16 2017-05-30 Komatsu Ltd. Work vehicle, bucket device, and method for obtaining tilt angle
CN106029994B (zh) * 2016-03-29 2020-04-03 株式会社小松制作所 校正系统、作业机械和校正方法
CN206233295U (zh) * 2016-11-28 2017-06-09 阿特拉斯科普柯(南京)建筑矿山设备有限公司 动力电池驱动的地下铲运机

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000352072A (ja) * 1999-06-11 2000-12-19 Sumitomo Constr Mach Co Ltd 旋回型土木・建設機械の燃料タンク
JP2004052361A (ja) * 2002-07-19 2004-02-19 Sumitomo (Shi) Construction Machinery Manufacturing Co Ltd 油圧ショベルの燃料タンク取付構造
US6934616B2 (en) * 2002-12-17 2005-08-23 Caterpillar Inc System for determining an implement arm position
JP2012202063A (ja) * 2011-03-24 2012-10-22 Komatsu Ltd 油圧ショベルの較正装置及び油圧ショベルの較正方法
JP2016069864A (ja) * 2014-09-29 2016-05-09 コベルコ建機株式会社 建設機械のインテリア配設構造
WO2015137526A1 (ja) * 2015-03-27 2015-09-17 株式会社小松製作所 作業機械の較正装置、及び作業機械の作業機パラメータの較正方法
WO2015137527A1 (ja) * 2015-03-27 2015-09-17 株式会社小松製作所 作業機械の較正装置、及び作業機械の作業機パラメータの較正方法
JP2016205095A (ja) * 2015-04-28 2016-12-08 キャタピラー エス エー アール エル 回動角度検出装置
WO2016013691A1 (ja) * 2015-10-15 2016-01-28 株式会社小松製作所 位置計測システム及び位置計測方法

Also Published As

Publication number Publication date
CN109496245A (zh) 2019-03-19
CN109496245B (zh) 2020-12-15
DE112017000125B4 (de) 2022-10-27
JP6782256B2 (ja) 2020-11-11
KR20190019889A (ko) 2019-02-27
US10422111B2 (en) 2019-09-24
DE112017000125T5 (de) 2019-02-28
WO2019012651A1 (ja) 2019-01-17
US20190078302A1 (en) 2019-03-14

Similar Documents

Publication Publication Date Title
JP6782256B2 (ja) 油圧ショベル
JP5237408B2 (ja) 油圧ショベルの較正システム及び較正方法
JP5237409B2 (ja) 油圧ショベルの較正装置及び油圧ショベルの較正方法
JP5328830B2 (ja) 油圧ショベルの較正装置及び油圧ショベルの較正方法
JP5823046B1 (ja) 油圧ショベルの較正システム及び較正方法
JP5841300B1 (ja) 作業機械の較正装置、及び作業機械の作業機パラメータの較正方法
JP6068730B2 (ja) 作業機械、及び作業機械の作業機パラメータ補正方法
JP6845810B2 (ja) 油圧ショベルおよび油圧ショベルの較正方法
JP2012233353A (ja) 油圧ショベルの較正システム及び油圧ショベルの較正方法
KR102131316B1 (ko) 작업 기계의 교정 방법, 교정 장치 및 작업 기계의 교정 시스템

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200303

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200721

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200902

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20201019

R150 Certificate of patent or registration of utility model

Ref document number: 6782256

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250