JP2023154782A - 建設機械 - Google Patents

Abstract

【課題】マシンガイダンスシステムまたはマシンコントロールシステムの校正精度を向上させることが可能な建設機械を提供する。【解決手段】コントローラ２０は、作業機１の姿勢を作業機１の第１所定位置（バケット爪先位置）の座標に変換するための変換パラメータ（取付角度Δθ、リンク長Ｌ）の校正が指示された後の所定の時間の間に姿勢検出装置１４～１６が検出した作業機１の姿勢に基づいて、作業機１が静定しているか否かを判定し、作業機１が静定していると判定した場合に、前記所定の時間の間に姿勢検出装置１４～１６が検出した作業機１の姿勢と、前記変換パラメータの校正の指示がされた後に外部計測装置５０で計測された作業機１の第２所定位置（ピン位置ｐ０，ｐ１，ｐ２）の座標とに基づいて前記変換パラメータの更新値を算出する。【選択図】 図３

Description

本発明は、フロント作業機を有する油圧ショベルなどの建設機械に関し、特に、マシンガイダンスシステムまたはマシンコントロールシステムを搭載した建設機械に関する。

情報化施工への対応に伴い、ブーム、アーム、バケットなどの作業機構の位置や姿勢をオペレータへ表示するマシンガイダンスや、作業機構の位置を目標施工面に沿って動くように制御するマシンコントロールの機能を有する油圧ショベルが開発されている。

施工現場における自車の座標を利用して、マシンガイダンスやマシンコントロールの作業支援を行うものを３次元情報化施工（３Ｄ情報化施工）と呼ぶ。この３Ｄ情報化施工に対応する建設機械は自車位置を取得するためにＧＮＳＳ（Global Navigation Satellite System）が備え付けられている。油圧ショベルのようにフロント作業機を備える建設機械では、自車の位置だけでなく、作業機が向いている方向（方位）も作業支援に必要になるため、上部旋回体に２つのＧＮＳＳアンテナを備えた建設機械が公知である。

マシンガイダンスシステムにおいては、バケットの先端位置（爪先位置）が施工目標面に沿って動作するようにオペレータに各種情報を提示するため、自車の位置だけでなく、フロント作業機の姿勢情報が重要になる。このため、ブーム、アーム、バケットの角度を取得するために何らかのセンサが取り付けられている。この角度センサには、取付けの容易性や、角度センサの応答性の観点でＩＭＵ（Inertial Measurement Unit）センサが選定されることが多い。

マシンガイダンスシステムではフロント作業機の各部材（ブーム、アーム、バケット）の傾斜角を利用してショベルの爪先位置を算出するが、ＩＭＵセンサは自身の傾斜角を取得するものである。このため、ＩＭＵセンサが各部材に対して、どのくらい回転して取り付けられているかを示す「取付角度」を利用して、ＩＭＵセンサの傾斜角を各部材の傾斜角へと変換する。各部材の傾斜角の正確さが爪先座標の算出精度に影響するため、取付角度を正確に取得する必要がある。このような爪先座標の演算に必要なパラメータを正確な値に更新する作業を校正、またはキャリブレーションと呼ぶ。取付角度のキャリブレーション方法を開示する先行技術文献として、特許文献１が挙げられる。

特開２０１７－１８１３４０号公報

特許文献１では、外部計測装置（トータルステーション）で各部材の回転中心である連結部（回動ピン中心）の座標を取得し、各座標から算出される各部材の傾斜角と、傾斜センサ（ＩＭＵセンサ）が出力した傾斜角を比較することで取付角度を算出する方法を提示している。

例えば、ブームに取り付けられているＩＭＵセンサの取付角度を取得する場合、ブームフートピン位置ｐ０の座標（ｘ０，ｙ０，ｚ０）とブーム先端ピン位置ｐ１の座標（ｘ１，ｙ１，ｚ１）をトータルステーションで取得する。フロント作業機がトータルステーションの座標軸Ｘと並行に設置されていると仮定する（つまり、ｙ０＝ｙ１が成立する）と、ブームの角度θＢＭ－ＴＳは数１式で与えられる。

この作業と並行して、ＩＭＵセンサが出力した角度θＢＭ－ＩＭＵを記録しておくことで、数２式を用いて取付角度ΔθＢＭを算出できる。

トータルステーションは各座標を同時に取得することはできず、一点ずつ座標の計測を行うことになる。よって、各座標を取得する際に油圧ショベルの姿勢が変化すると正しく取付角度を算出することができなくなる恐れがある。
例えば、［１］ブームフートピン位置ｐ０の座標を取得し、［２］ＩＭＵセンサの角度情報を取得し、［３］ブーム先端ピン位置ｐ１の座標を取得する、という３つの手順で作業を行ったとする。この作業において、［２］から［３］の作業中にブーム先端ピン位置ｐ１の座標が（ｘ１，ｙ１，ｚ１）から（ｘ１＋δｘ，ｙ１，ｚ１＋δｚ）に変化すると、ブームの角度θＢＭ－ＴＳは数３式のようになる。

数１式と数３式で算出される角度θＢＭ－ＴＳは異なるため、取付角度ΔθＢＭも異なる値として算出されることになる。つまり、キャリブレーション作業中にフロント作業機の姿勢が変化してしまうと取付角度を正しく取得できない可能性がある。

当然、キャリブレーション作業を行う際には姿勢変化が起きないようにレバーを操作してはならないと注意喚起がなされる。ただし、オペレータが意図的にレバー操作を行わなくてもフロント作業機の姿勢変化は発生し得る。

例えば、フロント作業機は油圧シリンダで駆動されているため、温度変化で圧油が膨張、収縮するとシリンダ長が変化することで姿勢変化が発生する。その他、圧油がリークすることでシリンダのボトム圧、またはロッド圧が低下するとシリンダ長が変化する。また、シリンダ長の変化がない場合でも、油圧ショベルが軟土の地形に設置されていると、油圧ショベルの自重によって、地面への沈み込みが生じる場合もある。このような沈み込みが発生するとトータルステーションで計測する座標が変化するため、取付角度を正確に取得できず、キャリブレーションの精度が低下する可能性がある。

本発明は、上記の課題に鑑みてなされたものであり、その目的は、マシンガイダンスシステムまたはマシンコントロールシステムの校正精度を向上させることが可能な建設機械を提供することにある。

上記目的を達成するために、本発明は、下部走行体と、前記下部走行体に回動可能に取り付けられた上部旋回体と、前記上部旋回体に回動可能に取り付けられた多関節型の作業機と、前記作業機に取り付けられた姿勢検出装置と、前記姿勢検出装置で検出した前記作業機の姿勢を所定の変換パラメータを用いて前記作業機の第１所定位置の座標に変換するコントローラとを備え、前記コントローラは、前記姿勢検出装置で検出した前記作業機の姿勢と外部計測装置で計測した前記作業機の第２所定位置の座標とに基づいて前記変換パラメータの更新値を算出して校正を行う建設機械において、前記コントローラは、前記変換パラメータの校正の指示がされた後の所定の時間の間に前記姿勢検出装置が検出した前記作業機の姿勢に基づいて、前記作業機が静定しているか否かを判定し、前記作業機が静定していると判定した場合に、前記所定の時間の間に前記姿勢検出装置が検出した前記作業機の姿勢と、前記変換パラメータの校正の指示がされた後に前記外部計測装置で計測された前記第２所定位置の座標とに基づいて前記変換パラメータの更新値を算出するものとする。

以上のように構成した本発明によれば、作業機が静定している状態で取得された作業機の姿勢および座標を用いて、作業機の姿勢を作業機の第１所定位置の座標に変換するための変換パラエータが更新される。これにより、マシンガイダンスシステムまたはマシンコントロールシステムの校正精度を向上させることが可能となる。

本発明に係る建設機械によれば、マシンガイダンスシステムまたはマシンコントロールシステムの校正精度を向上させることが可能となる。

本発明の第１の実施例における油圧ショベルの外観を模式的に示す図 本発明の第１の実施例におけるコントローラの処理機能の一部を模式的に示す図 本発明の第１の実施例におけるコントローラの機能ブロック図 キャリブレーション実施時にモニタに表示される内容の一例を示す図 姿勢検出結果記録部に記録されたＩＭＵデータの一例を示す図 本発明の第１の実施例におけるキャリブレーション実行部の処理を示すフローチャート 本発明の第２の実施例におけるコントローラの機能ブロック図 本発明の第２の実施例におけるキャリブレーション実行部の処理を示すフローチャート 外部計測装置で設定された座標軸が座標計測に与える影響を説明する図 キャリブレーション実施時の姿勢の一例を示す図 本発明の第３の実施例の変形例におけるコントローラの機能ブロック図 本発明の第３の実施例におけるコントローラに記録されるデータのイメージを示す図 本発明の第３の実施例におけるキャリブレーション実行部の処理を示すフローチャート 本発明の第４の実施例におけるコントローラの機能ブロック図 本発明の第４の実施例におけるキャリブレーション実行部の処理を示すフローチャート

以下、本発明の実施形態に係る建設機械として油圧ショベルを例に挙げ、図面を参照して説明する。なお、各図中、同等の部材には同一の符号を付し、重複した説明は適宜省略する。

図１は、本発明の第１の実施例に係る油圧ショベルの外観を模式的に示す図である。図１において、油圧ショベル１００は、垂直方向にそれぞれ回動する複数のフロント部材（ブーム４、アーム５、バケット（作業具）６）を連結して構成された多関節型のフロント作業機１と、車体を構成する上部旋回体２及び下部走行体３とを備える。上部旋回体２は、下部走行体３に対して旋回可能に設けられている。

フロント作業機１のブーム４の基端は上部旋回体２の前部に垂直方向に回動可能に支持されており、アーム５の一端はブーム４の他端（先端）に垂直方向に回動可能に支持されており、アーム５の他端（先端）にはバケット６が垂直方向に回動可能に支持されている。ブーム４はブームフートピン４ｂ（図２に示す）を中心に回動し、アーム５はアームピン（ブーム先端ピン）５ｂを中心に回動し、バケット６はバケットピン６ｂを中心に回動する。ブーム４、アーム５、バケット６、上部旋回体２、及び下部走行体３は、油圧アクチュエータであるブームシリンダ４ａ、アームシリンダ５ａ、バケットシリンダ６ａ、旋回モータ（図示せず）、及び左右の走行モータ３ａ（一方のみ図示）によりそれぞれ駆動される。

オペレータが搭乗する運転室９には、油圧アクチュエータ２ａ～６ａを操作するための操作信号を出力する操作レバー９ａ，９ｂが設けられている。操作レバー９ａ，９ｂはそれぞれ前後左右方向に傾倒可能であり、各方向に油圧アクチュエータ２ａ～６ａの操作がそれぞれ割り当てられている。操作レバー９ａ，９ｂは、操作信号であるレバーの傾倒量（レバー操作量）を電気的に検知する検出装置（図示せず）を含み、検出装置が検出したレバー操作量を制御装置であるコントローラ２０に電気配線を介して出力する。

ブームシリンダ４ａ、アームシリンダ５ａ、バケットシリンダ６ａ、旋回モータ２ａ、及び左右の走行モータ３ａの動作制御は、エンジンや電動モータなどの原動機によって駆動される油圧ポンプ装置７から各油圧アクチュエータ２ａ～６ａに供給される作動油の方向及び流量をコントロールバルブ８で制御することにより行う。コントロールバルブ８は、パイロットポンプ（図示せず）から電磁比例弁を介して出力される駆動信号（パイロット圧）により操作される。操作レバー９ａ，９ｂからの操作信号に基づいてコントローラ２０で電磁比例弁を制御することにより、各油圧アクチュエータ２ａ～６ａの動作が制御される。なお、操作レバー９ａ，９ｂは油圧パイロット方式であっても良い。その場合、操作レバー９ａ，９ｂは、レバー操作量に応じたパイロット圧を出力するパイロット弁（図示せず）を含み、コントロールバルブ８は、パイロット弁から出力されるパイロット圧により操作される。

上部旋回体２には、姿勢センサとして慣性計測装置（ＩＭＵ：Inertial Measurement Unit）１３が配置されている。慣性計測装置１３は、角速度及び加速度を計測するものであり、姿勢検出装置を構成している。慣性計測装置１３が配置された上部旋回体２が静止している場合を考えると、慣性計測装置１３に設定されたＩＭＵ座標系における重力加速度の方向（鉛直下向き方向）と、慣性計測装置１３の取り付け状態（慣性計測装置１３と上部旋回体２との相対的な位置関係）とに基づいて、上部旋回体２の前後方向への傾き（ピッチ角）、左右方向への傾き（ロール角）をそれぞれ算出することができる。なお、ＩＭＵには角速度センサが内蔵されているため、角速度を積分することによって上部旋回体２の回転角度（ヨー角）を算出することもできるが、角速度センサの定常的な誤差（ジャイロバイアス）によって、正確な回転角度を算出することは容易ではないことに注意が必要である。なお、本実施例では、上記の傾き（角度）の演算機能が慣性計測装置に実装されていることを想定しているが、慣性計測装置に角度の算出機能が実装されていない場合は、後述のコントローラ２０に角度演算機能を実装すればよい。

また、上部旋回体２には２つのＧＮＳＳアンテナ１７ａ，１７ｂが取り付けられている。それぞれのＧＮＳＳアンテナで受信した衛星信号はＧＮＳＳ受信機１７ｃ（図２に示す）に入力され、アンテナ座標の演算や方位角の演算などの各種測位演算に利用される。ＧＮＳＳアンテナ１７ａ，１７ｂ及びＧＮＳＳ受信機１７ｃは、位置情報検出装置１７（図３に示す）を構成している。

ＧＮＳＳ受信機１７ｃは現場内に設置されたＧＮＳＳ固定局と無線通信によって接続することで、位置情報についてＲＴＫ（Real Time Kinematic）測位を実施する。ＧＮＳＳ固定局がない現場の場合には、インターネットを介して電子基準局の情報を取得するネットワーク型ＲＴＫを利用してもよい。以下、現場内の固定局の有無を問わず、ＧＮＳＳ受信機１７ｃはＲＴＫ測位が実行可能であることを想定する。

フロント作業機１の構成要素であるブーム４、アーム５、バケット６にはそれぞれの姿勢を計測するために慣性計測装置１４～１６が適切な位置に設置されている。慣性計測装置１４～１６も、上部旋回体２に取り付けられた慣性計測装置１３と同様に、姿勢検出装置を構成している。以降、各慣性計測装置１３～１６を区別するため、設置場所に応じて、適宜、車体ＩＭＵ１３、ブームＩＭＵ１４、アームＩＭＵ１５、バケットＩＭＵ１６と呼ぶ。なお、バケットＩＭＵ１６はバケット６でなく、バケット６と連動して回動するリンク部材（バケットリンク）１８に設置しても良い。バケットリンク１８にＩＭＵを設置した場合は、幾何学的な関係性を利用して、バケットリンク１８の傾きをバケット６の傾きに変換すればよい。

図２は、油圧ショベル１００に搭載されるコントローラ２０の処理機能を模式的に示す図である。図２において、コントローラ２０は、油圧ショベル１００の動作を制御するための種々の機能を有するものであり、その一部としてポジショニング演算部２１、モニタ表示制御部２２、油圧システム制御部２３、施工目標面演算部２４、及びキャリブレーション実行部２５の各機能を有している。なお、図２では、処理機能２１～２５を一つのコントローラで実行するように描いているが、各処理機能を複数のコントローラで実行しても良い。例えば油圧ショベル１００に５つのコントローラが備えられている場合、各処理機能２１～２５をそれぞれ別のコントローラで実行しても良い。また、キャリブレーション実行部２５は油圧ショベル１００に搭載されたコントローラ２０に実装されなくても良く、別の端末に実装されていても良い。

ポジショニング演算部２１は、ＧＮＳＳ受信機１７ｃで算出した位置情報と慣性計測装置１３～１６の検出結果に基づいて、油圧ショベル１００の作業現場内での座標、方位、及びフロント作業機１の姿勢を算出する姿勢演算処理を行う。ポジショニング演算部２１で作業機１の姿勢を算出するには、油圧ショベル１００の各種寸法（後述するリンク長）やセンサの取り付け情報（取付角度）を変換パラメータとして利用する必要がある。これらの変換パラメータを正確な値（以下、更新値）で更新する作業を校正またはキャリブレーションと呼ぶ。このキャリブレーションに関わる演算はキャリブレーション実行部２５で実行される。

モニタ表示制御部２２は、運転室９に設けられたモニタ３０（図４に示す）の表示を制御するものであり、施工目標面演算部２４で算出された施工目標面と、ポジショニング演算部２１で算出されたフロント作業機１の姿勢とに基づいて、オペレータに対する操作支援の指示内容を算出し、モニタ３０に表示する。すなわち、モニタ表示制御部２２は、例えば、ブーム４、アーム５、バケット６などの被駆動部材を有するフロント作業機１の姿勢や、バケット６の先端位置と角度をモニタ３０に表示してオペレータの操作を支援するマシンガイダンスシステムとしての機能の一部を担っている。モニタ３０は単なる表示デバイスでなく、タッチパネルを備えたタブレット端末に置き換えて入力デバイスとして利用することが望ましい。以下、モニタ３０がタブレット端末で構成されているものとして説明する。

油圧システム制御部２３は、油圧ポンプ装置７やコントロールバルブ８、各油圧アクチュエータ２ａ～６ａ等からなる油圧ショベル１００の油圧システムを制御するものであり、施工目標面演算部２４で算出された施工目標面と、ポジショニング演算部２１で算出されたフロント作業機１の姿勢とに基づいて、フロント作業機１の動作を算出し、その動作を実現するように油圧ショベル１００の油圧システムを制御する。すなわち、油圧システム制御部２３は、例えば、バケット６の先端が目標施工面に一定以上近づかないように動作に制限をかけたり、バケット６の先端位置が目標施工面に沿って動くよう制御したりするマシンコントロールシステムとしての機能の一部を担っている。

施工目標面演算部２４は、施工管理者によって予め記憶装置４０に記憶されている３次元施工図面などの施工情報と、ポジショニング演算部２１で算出した油圧ショベル１００の位置情報および姿勢情報とに基づいて、施工対象の目標形状を定義する施工目標面を算出する。モニタ表示制御部２２および施工目標面演算部２４はマシンガイダンスシステムを構成し、油圧システム制御部２３および施工目標面演算部２４はマシンコントロールシステムを構成している。

キャリブレーション実行部２５は、姿勢検出装置１３～１６で取得したデータと外部計測装置５０で取得したデータを利用して、各種パラメータ（具体的には、油圧ショベルの各種寸法やＩＭＵセンサの取付角度）を算出する。算出したパラメータはポジショニング演算部２１及びモニタ表示制御部２２で利用される。

図３は、コントローラ２０の機能ブロック図である。図３では、説明を簡略するため、図２に示した機能の一部（ポジショニング演算部２１、モニタ表示制御部２２、キャリブレーション実行部２５以外）を省略している。

本実施例におけるキャリブレーション実行部２５は、姿勢検出結果記録部２５ａ、姿勢情報変化検出部２５ｂ、外部計測結果記録部２５ｃ、及び校正値演算部２５ｄ、校正結果記録部２５ｅで構成される。

姿勢検出結果記録部２５ａは、姿勢検出装置１３～１６が出力した検出情報を記録する。検出情報の記録開始のタイミングと記録終了のタイミングは任意に変更することができ、キャリブレーション作業時にオペレータまたはコントローラ２０の指示によって記録開始、終了が制御される。

オペレータの指示で記録開始を行う場合の記録開始と終了のタイミングの一例を図４を用いて説明する。図４は、キャリブレーション実施時にモニタ３０に表示される内容の一例を示している。オペレータはモニタ３０に表示される指示に従って操作を行う。ここでは、ブーム４を対象としたキャリブレーションを例に説明するが、その他の部材（アーム５、バケット６）についても同様である。

まず、キャリブレーション開始時に図４（ａ）のように、油圧ショベル１００がキャリブレーションを行う姿勢になったことをオペレータに確認する指示をモニタ３０に表示する。オペレータが油圧ショベル１００の姿勢を図４（ａ）に合わせることができたと判断すると、画面上の「はい」をタップする。姿勢検出結果記録部２５ａは「はい」をタップしたことをトリガとして、ブームＩＭＵ１４のデータの記録を始める。その後、モニタ３０には図４（ｂ）に示すように外部計測装置５０で座標を取得すべき位置ｐ０，ｐ１の指示が表示される。オペレータはモニタに表示された位置ｐ０，ｐ１の座標を外部計測装置５０で取得した後に画面上の「はい」をタップする。このタップのタイミングに合わせて、姿勢検出結果記録部２５ａはブームＩＭＵ１４のデータの記録を停止する。

なお、外部計測装置５０、コントローラ２０、モニタ３０がそれぞれ情報の授受ができる構成になっている場合、図４（ｂ）中のピン位置ｐ０，ｐ１それぞれの座標を外部計測装置５０で取得した時点で自動的に「はい」がタップされたものとしても良い。つまり、ピン位置ｐ０の座標を外部計測装置５０で取得すると同時に姿勢検出結果記録部２５ａがデータの記録を開始し、ピン位置ｐ１の座標を外部計測装置５０で取得すると同時に姿勢検出結果記録部２５ａがデータの記録を終了する仕組みとしても良い。本機能は後述の外部計測結果記録部２５ｃに記録された座標データを参照することで実行される。また、姿勢検出結果記録部２５ａは、ＩＭＵセンサが出力するサンプリング周期（例えば１０ｍｓ）のデータをそのまま記録しても良いし、記憶容量を節約するため、ＩＭＵが出力したデータを等間隔に間引いて１００ｍｓごとのデータを記録する方式にしても良い。

姿勢情報変化検出部２５ｂは、姿勢検出結果記録部２５ａに記録されているＩＭＵデータを解析し、図４（ａ）の姿勢でキャリブレーションを行っているときにフロント作業機１に姿勢変化が生じていないことを確認する。取得したＩＭＵデータに基づいて姿勢変化の有無を判定する方法を図５を用いて説明する。

図５（ａ）は、フロント作業機１の姿勢に変化が生じなかった場合に姿勢検出結果記録部２５ａに記録されたＩＭＵデータの一例を示している。図中の黒点が各時刻で取得したデータを表している。

ＩＭＵセンサの出力は、各種ノイズやエンジン振動の影響によって、常にばらついている。このため、姿勢変化がない場合でもＩＭＵセンサの出力は変化し得る。このばらつきを「姿勢変化」として誤判定しないように、各時刻のデータが初期値またはデータ全体の平均値に対して許容範囲を設け、この許容範囲を逸脱するデータがない限り姿勢変化はないと判断する。この許容範囲は、ＩＭＵセンサの仕様書に記載されているセンサ精度を参考に設定してもよいし、フロント作業機１に姿勢変化が生じないようにバケット爪先を地面（望ましくは定盤）上に設置した図５（ｂ）のような状態で取得したＩＭＵデータを解析して得られた分散値σ^２を利用して、±３σの範囲を許容範囲としてもよい。

図５（ｃ）は、フロント作業機１の姿勢が変化してしまった場合に姿勢検出結果記録部２５ａに記録されたＩＭＵデータの一例を示している。前述のとおり、取得したデータは設定した許容範囲を逸脱する。このような判定を行うことで、図４（ｂ）に示したピン位置ｐ０，ｐ１の座標取得を行う間の姿勢変化を検出できる。一般にマシンガイダンスに採用されるＩＭＵセンサは０．１～０．３ｄｅｇ程度の角度検出精度があるため、フロント作業機１のわずかな姿勢変化も検出することが可能である。

外部計測結果記録部２５ｃは、外部計測装置５０で取得した座標データをコントローラ２０内の記憶領域に記録する。座標データは３次元空間の座標（ｘ，ｙ，ｚ）である。

校正値演算部２５ｄは、姿勢検出結果記録部２５ａに記録されているＩＭＵデータと外部計測結果記録部２５ｃに記録されている座標データを利用して変換パラメータを算出する。姿勢検出結果記録部２５ａに記録されているＩＭＵデータはばらつきを有するため、ばらつきの影響を抑制するため、例えば、数４式のような平均処理を行う。

なお、数４式のθｉはサンプリングステップｉに記録されたＩＭＵデータを示し、Ｎは姿勢検出結果記録部２５ａに記録されているＩＭＵデータの個数を意味する。

一方、外部計測結果記録部２５ｃに記録されている、図４（ｂ）におけるブームフートピン位置ｐ０の座標を（ｘ０，ｙ０，ｚ０）、ブーム先端ピン位置ｐ１の座標を（ｘ１，ｙ１，ｚ１）とすると、数１式よりブーム４の角度θＢＭ－ＴＳを算出できる。そして、数１式１と数４式を利用し、数２式に倣った数５式によってブームＩＭＵ１４の取付角度ΔθＢＭを算出できる。

また、外部計測結果記録部２５ｃに記録されている座標データを利用すれば、ブーム４のリンク長ＬＢＭは数６式で与えられる。

前述のとおり、数１式および数５式はフロント作業機１の姿勢が変化していないときにのみ成立する。よって、校正値演算部２５ｄは姿勢情報変化検出部２５ｂにて、姿勢変化が検出されなかったときにのみ実行されることが望ましい。

校正結果記録部２５ｅは、校正値演算部２５ｄで算出した取付角度Δθとリンク長Ｌを記録する。なお、姿勢情報変化検出部２５ｂで姿勢変化が検出された場合は、校正値演算部２５ｄの演算が実行されないため、取付角度Δθ、リンク長Ｌともに記録されない。校正結果記録部２５ｅに記録された取付角度Δθ、リンク長Ｌは、ポジショニング演算部２１による姿勢演算や、モニタ表示制御部２２による油圧ショベル１００の描画に反映される。

図６は、キャリブレーション実行部２５の処理を示すフローチャートである。図６に示す処理は、フロント作業機１の各部材（ブーム４、アーム５、バケット６）ごとに実施される。以下、各ステップについて順に説明する。

まず、ステップＦＣ１０１で、キャリブレーション実施時の所定の姿勢を作成するようオペレータに指示する。本実施例では、モニタ表示制御部２２がキャリブレーション実施時の姿勢（図４（ａ）に一例を示す）をモニタ３０に表示する。オペレータは、フロント作業機１の姿勢をモニタ３０に表示されているキャリブレーション姿勢に合わせる。

ステップＦＣ１０１に続き、ステップＦＣ１０２で、フロント作業機１の姿勢の準備が完了した否かをオペレータに確認する。オペレータが姿勢の準備が完了したと判断し、図４（ａ）に示すモニタ３０上の「はい」をタップすると、ステップＦＣ１０２でＹＥＳと判定され、ステップＦＣ１０３に遷移する。姿勢の準備が完了するまでステップＦＣ１０２でＮＯと判定され、ステップＦＣ１０１に遷移する。

ステップＦＣ１０３でＩＭＵデータの記録を開始する。この処理は姿勢検出結果記録部２５ａにより実行される。ＩＭＵデータの記録を開始した後、ステップＦＣ１０４に遷移する。

ステップＦＣ１０４で、外部計測装置５０による座標計測および記録が実行される。この処理は外部計測結果記録部２５ｃにより実行される。必要な座標データが取得されるまでステップＦＣ１０５でＮＯと判定され、オペレータは外部計測装置５０による計測を継続する。必要な座標データが取得されるとステップＦＣ１０５でＹＥＳと判定され、ステップＦＣ１０６に遷移する。

ステップＦＣ１０６でＩＭＵデータの記録を終了する。この処理も姿勢検出結果記録部２５ａにより実行される。ＩＭＵデータの記録を終了した後、ステップＦＣ１０７に遷移する。

ステップＦＣ１０７で、記録されたＩＭＵデータを処理し、ステップＦＣ１０８で作業機１の姿勢変化の有無を判定する。姿勢変化がない場合はステップＦＣ１０８でＹＥＳと判定され、ステップＦＣ１０９に遷移する。ステップＦＣ１０７，ＦＣ１０８の処理は姿勢情報変化検出部２５ｂによって実行される。

ステップＦＣ１０９で、記録されたＩＭＵデータおよび座標データを用いて変換パラメータ（取付角度Δθ、リンク長Ｌ）を算出する。この処理は校正値演算部２５ｄによって実行される。変換パラメータを算出すると、ステップＦＣ１１０に遷移する。

ステップＦＣ１１０では、算出した変換パラメータをコントローラ２０のメモリに記録する。この処理は校正結果記録部２５ｅによって実行される。

ステップＦＣ１０８で姿勢変化がある（ＮＯ）と判定した場合、記録されているＩＭＵデータおよび座標データが変換パラメータの算出に適していないため、変換パラメータを算出することなく当該フローを終了する。

（まとめ）
本実施例では、下部走行体３と、下部走行体３に回動可能に取り付けられた上部旋回体２と、上部旋回体２に回動可能に取り付けられた多関節型の作業機１と、作業機１に取り付けられた姿勢検出装置１４～１６と、姿勢検出装置１４～１６で検出した作業機１の姿勢を所定の変換パラメータ（取付角度Δθ、リンク長Ｌ）を用いて作業機１の第１所定位置（バケット爪先位置）の座標に変換するコントローラ２０とを備え、コントローラ２０は、姿勢検出装置１４～１６で検出した作業機１の姿勢と外部計測装置５０で計測した作業機１の第２所定位置（ピン位置ｐ０，ｐ１，ｐ２）の座標とに基づいて前記変換パラメータの更新値を算出して校正を行う油圧ショベル（建設機械）１００において、コントローラ２０は、前記変換パラメータの校正の指示がされた後の所定の時間（ステップＦＣ１０３～ＦＣ１０６）の間に姿勢検出装置１４～１６が検出した作業機１の姿勢に基づいて、作業機１が静定しているか否かを判定し、作業機１が静定していると判定した場合に、前記所定の時間の間に姿勢検出装置１４～１６が検出した作業機１の姿勢と、前記変換パラメータの校正の指示がされた後に外部計測装置５０で計測された前記第２所定位置の座標とに基づいて前記変換パラメータの更新値を算出する。

以上のように構成された本実施例によれば、作業機１が静定している状態で取得した作業機１の姿勢および座標を用いて、作業機１の姿勢を作業機１の第１所定位置（バケット爪先位置）の座標に変換するための変換パラエータ（取付角度Δθ、リンク長Ｌ）が更新される。これにより、作業機１の第１所定位置（バケット爪先位置）の座標を算出する機能を有するマシンガイダンスシステムまたはマシンコントロールシステムの校正精度を向上させることが可能となる。

本発明の第２の実施例について、第１の実施例との相違点を中心に説明する。図７は、本実施例におけるコントローラ２０の機能ブロック図である。図７において、第１の実施例（図３に示す）との相違点は、キャリブレーション実行部２５に再校正通知部２５ｆを追加した点である。再校正通知部２５ｆは、姿勢情報変化検出部２５ｂで姿勢変化があると判定した場合に、再校正を促す情報をモニタ３０に表示するようモニタ表示制御部２２に指示する。

図８は、本実施例におけるキャリブレーション実行部２５の処理を示すフローチャートである。図８において、ステップＦＣ２０１～ＦＣ２１０は第１の実施例におけるステップＦＣ１０１～ＦＣ１１０と同一の処理である。第１の実施例（図６に示す）との相違点は、ステップＦＣ２１１を追加した点である。ステップＦＣ２０８でフロント作業機１の姿勢変化がある（ＹＥＳ）と判定した場合は、ステップＦＣ２１１で再校正を促す情報をオペレータに通知し、当該フローを終了する。この処理は再校正通知部２５ｆによって実行される。

（まとめ）
本実施例における油圧ショベル（建設機械）１００は、コントローラ２０から入力された情報を出力可能なモニタ（報知装置）３０を備え、コントローラ２０は、変換パラメータを校正する際に、フロント作業機１が静定していないと判定した場合は、再校正を促す情報をモニタ（報知装置）３０に出力する。

以上のように構成された本実施例によれば、キャリブレーション実施中にフロント作業機１の姿勢が変化した場合に、オペレータが速やかにキャリブレーションをやり直すことが可能となる。

本発明の第３の実施例について、第１の実施例との相違点を中心に説明する。第１の実施例では、外部計測装置５０の座標軸がフロント作業機１の座標軸と同一である（ピン位置ｐ０の計測時とピン位置ｐ１の計測時とでＹ座標に変化がない）ことを前提条件としている。外部計測装置５０の座標軸は自由に設定できるため、この前提条件は実用的である。しかし、オペレータがこの座標軸の設定作業を誤った場合、この前提条件が成立しなくなる。また、第１の実施例では１つの姿勢で取得した外部計測装置５０のデータを利用して変換パラメータを算出するが、外部計測装置５０による計測を失敗していた場合（例えば、正しい座標位置に照準を合わせることができなかった場合や、ピン位置に取り付けたターゲットがずれてしまった場合）には正しい演算を実行できない。本実施例は、座標軸の設定が正しいか否かを検証する機能、および外部計測装置５０で取得した座標が適切か否かを検証する機能を追加したものである。

図９は、油圧ショベル１００を上空から見た図（鳥瞰図）であり、外部計測装置５０で設定された座標軸が座標計測に与える影響を説明する図である。

図９（ａ）は、外部計測装置５０のＸ座標がフロント作業機１の方向と平行に設定された理想的な状態を示している。これに対して、図９（ｂ）はフロント作業機１に対して時計回りに回転した座標軸Ｘ’，Ｙ’，Ｚを設定した状態を示している。

図９（ａ）の状態であれば、ブームフートピン位置ｐ０とブーム先端ピン位置ｐ１とを結ぶ直線がＸ軸に対して平行であるため、数１式を利用してブームＩＭＵ１４の角度θＢＭ－ＴＳを算出できる。しかし、図９（ｂ）の状態では、ブームフートピン位置ｐ０とブーム先端ピン位置ｐ１とを結ぶ直線がＸ’軸に対して平行でないため、数１式を利用することができない。

このような座標軸の設定が好ましくない状態は、ブームフートピン位置ｐ０、ブーム先端ピン位置ｐ１それぞれのＹ座標を確認することで検出できる。具体的には、ブームフートピン位置ｐ０のＹ座標（ｙ０）とブーム先端ピン位置ｐ１のＹ座標（ｙ１）が等しくなければ座標軸は不適切であると判断できる。

また、外部計測装置５０のＹ軸がフロント作業機１の回動平面と直交するように設定されていれば、ブーム４の姿勢を変更してもピン位置ｐ１，ｐ２（ブーム４の非回動中心位置）のＹ座標は変化しない。従って、異なる複数の姿勢で取得したピン位置ｐ１，ｐ２のＹ座標の変化量が閾値を超えた場合に座標軸の設定が適切でないと判定できる。許容可能な座標軸の回転角度をφ（例えば、０．５ｄｅｇ）とすると、ブーム先端ピン位置ｐ１のＹ座標の許容変化量ΔＹは数７式で与えられる。

座標軸の設定が正しいか否かを判定する際は、Ｙ座標の変化量ができるだけ大きく表れる複数の姿勢で座標を計測することが望ましい。従って、計測するピンのＸ座標ができるだけ大きく変化するような複数の姿勢を指定する。例えば、ブーム４をキャリブレーションの対象とする場合、ブーム４をできるだけ下げた姿勢（図１０（ａ）に示す）とブーム４をできるだけ上げた姿勢（図１０（ｂ）に示す）の２姿勢で外部計測装置５０による座標計測を行う。

図１１は、本実施例におけるコントローラ２０の機能ブロック図である。図１１において、第１の実施例（図３に示す）との相違点は、キャリブレーション実行部２５に外部計測結果分析部２５ｇを追加し、外部計測結果分析部２５ｇの分析結果に応じて再校正を通知する機能を再校正通知部２５ｆに追加した点である。

本実施例では複数の姿勢でデータを取得するため、変換パラメータ（取付角度Δθ、リンク長Ｌ）を複数回算出することが可能である。よって、姿勢検出結果記録部２５ａと姿勢情報変化検出部２５ｂはそれぞれ、各姿勢でのデータの記録と姿勢変化の有無を判定する。なお、姿勢の変更中に取得されたデータはキャリブレーションに利用しない。

外部計測結果記録部２５ｃは各姿勢で取得した各ピン位置ｐ０，ｐ１，ｐ２の座標を記録する。２つの姿勢でデータ取得を行った場合にコントローラ２０に記録されるデータのイメージを図１２に示す。外部計測結果記録部２５ｃにはそれぞれの姿勢で計測された位置ｐ１，ｐ２の座標データが記録され、姿勢検出結果記録部２０ｅ１にはそれぞれの姿勢で連続記録された角度データが記録される。姿勢検出結果記録部２５ａに記憶されるデータ数Ｎは校正作業の時間によって異なる。

外部計測結果分析部２５ｇは外部計測結果記録部２５ｃに記録されている座標データを分析し、座標軸および取得したデータの妥当性を検証する。

まず、座標軸が正しく設定されているかは、ピン位置ｐ１，ｐ２のＹ座標の変化量が閾値Ｔｈ（例えば、外部計測装置５０の計測精度）以下であるという条件（数８式）を満たすか否かで判定できる。

数８式のいずれかを満足しない場合、外部計測装置５０の座標軸が適切でないと判定する。なお、ピン位置ｐ１，ｐ２のいずれか一方のＹ座標のみでも座標軸の判定は可能であるが、数８式のように２つのピン位置ｐ１，ｐ２のＹ座標を用いることにより判定精度を高めることができる。

次に、各座標の妥当性を確認する手法について説明する。まず、複数の姿勢を指定する際に、これらの複数の姿勢において変化しない位置が存在することを前提とする。例えば、ブーム４のキャリブレーションを行う場合に、ブーム４のみを操作して複数の姿勢を作成すれば、これら複数の姿勢においてブームフートピン位置ｐ０は不変である。この事実に注目すると、数９式で示すブームフートピン位置ｐ０の変化量Δｐ０が所定の閾値（例えば、外部計測装置５０の計測精度）を上回っていると、外部計測装置５０の計測条件が不適切であると判定できる。

同様に、同一部材の各ピン間の距離であるリンク長が短時間に変化することはないため、数１０式で算出される各計測毎のブーム４のリンク長ＬＢＭ１，ＬＢＭ２の変化量が、所定の閾値（例えば、外部計測装置５０の計測精度）を上回っていると、外部計測装置５０の計測条件が不適切であると判定できる。

外部計測結果分析部２５ｇで計測条件が不適切であると判定された場合は、外部計測結果記録部２５ｃに記録されている座標が変換パラメータの算出に不適切であるため、再校正通知部２５ｆは再校正を通知し、校正値演算部２５ｄは変換パラメータを算出しない。

なお、上記の説明では２姿勢での校正作業について説明しているが、２姿勢以上であればさらに多くの姿勢で校正作業を行ってもよい。ただし、姿勢を増やしすぎると作業時間が増えるため、２～４姿勢程度が望ましい。

本実施例では複数の姿勢で計測を行うため、変換パラメータ（取付角度Δθ、リンク長Ｌ）は計測回数ｎに応じて算出される。各計測で得られた変換パラメータから最終的な変換パラメータ（変換パラメータの更新値）を決定する方法は種々考えられる。例えば、いずれか１回の計測で得られた変換パラメータを最終的なパラメータとして選択しても良いし、各計測のばらつきの影響を抑制するため、数１１式のように各計測で得られた変換パラメータの平均値を最終的なパラメータとして採用しても良い。

図１３は、本実施例におけるキャリブレーション実行部２５の処理を示すフローチャートである。図１３において、ステップＦＣ３０１～ＦＣ３０８は、第１の実施例におけるステップＦＣ１０１～ＦＣ１０８（図６に示す）と同一である。

ステップＦＣ３０８で姿勢変化がある（ＮＯ）と判定した場合は、ステップＦＣ３０９で、作業機１の姿勢変化に伴って不適切な座標が計測されたため再校正が必要であることをオペレータに通知し、ステップＦＣ３０１に遷移する。ステップＦＣ３０８で姿勢変化がない（ＹＥＳ）と判定した場合は、ステップＦＣ３１０に遷移する。

ステップＦＣ３１０で、ステップ３０１で作成を指示したキャリブレーション実施時の所定の第１姿勢と異なる、キャリブレーション実施時の所定の第２姿勢の作成を指示し、ステップＦＣ３１１に遷移する。ステップＦＣ３１１でステップＦＣ３０２～ＦＣ３０７と同一の処理を実行し、ステップＦＣ３１２に遷移する。

ステップＦＣ３１２で姿勢変化がないか否かを判定する。姿勢変化がある（ＮＯ）と判定した場合は、作業機１の姿勢変化に伴って不適切な座標が計測されたため再校正が必要であることをオペレータに通知し（ステップＦＣ３１３）、ステップＦＣ３１１に遷移する。姿勢変化がない（ＹＥＳ）と判定した場合はステップＦＣ３１４に遷移する。

ステップＦＣ３１４で、外部計測装置５０で取得した各位置ｐ０，ｐ１，ｐ２の座標を分析する。この処理は外部計測結果分析部２５ｇにより実行される。

ステップＦＣ３１５で、第１姿勢と第２姿勢で取得した位置ｐ１，ｐ２のＹ座標に変化があるか否かを判定する。Ｙ座標に変化がある（ＮＯ）と判定した場合は、外部計測装置５０の座標軸が不適切であるため再校正が必要であることをオペレータに通知し、変換パラメータを算出することなく当該フローを終了する。これにより、不適切な座標軸の下で計測された座標に基づいて変換パラメータが算出されることを防止するとともに、オペレータが速やかに座標軸を修正することが可能となる。

ステップＦＣ３１５でＹ座標に変化がない（ＹＥＳ）と判定した場合は、ステップＦＣ３１６に遷移し、各姿勢で算出されたリンク長に変化がないか否かを判定する。リンク長に変化がある（ＮＯ）と判定した場合は、外部計測装置５０で計測した座標が不適切であるため再校正が必要であることをオペレータに通知し、変換パラメータを算出することなく当該フローを終了する。これにより、不適切な座標に基づいて変換パラメータが算出されることを防止するとともに、オペレータが速やかに座標の再計測を実施することが可能となる。

ステップＦＣ３１６でリンク長に変化がない（ＹＥＳ）と判定した場合は、ステップＦＣ３１７で変換パラメータを算出し、ステップＦＣ３１８に遷移する。

ステップＦＣ３１８で、変換パラメータをコントローラ２０のメモリに記録し、当該フローを終了する。

（まとめ）
本実施例におけるコントローラ２０は、作業機１の回動中心位置（ピン位置ｐ０）が移動しない複数の姿勢において外部計測装置５０で計測した作業機１の非回動中心位置（ピン位置ｐ１）の座標を取得し、前記複数の姿勢における前記非回動中心位置の水平方向の変化量が第１閾値（許容変化量ΔＹ）を上回る場合に、外部計測装置５０の座標軸が適切でないと判定し、変換パラメータ（取付角度Δθ、リンク長Ｌ）を校正する際に、作業機１が静定していると判定した場合であっても、外部計測装置５０の座標軸が適切でないと判定した場合は、前記変換パラメータの更新値を算出しない。

以上のように構成された本実施例によれば、外部計測装置５０の座標軸が適切な場合に限り変換パラメータ（取付角度Δθ、リンク長Ｌ）が更新されるため、第１の実施例よりも高い精度でマシンガイダンスシステムまたはマシンコントロールシステムを校正することが可能となる。

また、本実施例におけるコントローラ２０は、作業機１の回動中心位置（ピン位置ｐ０）が移動しない複数の姿勢において外部計測装置５０で計測した前記回動中心位置および作業機１の非回動中心位置（ピン位置ｐ１）の座標を取得し、前記複数の姿勢における前記回動中心位置と前記非回動中心位置との距離の変化量が第２閾値（例えば、外部計測装置５０の計測精度）を上回る場合に、外部計測装置５０で計測した座標が適切でないと判定し、変換パラメータ（取付角度Δθ、リンク長Ｌ）を校正する際に、作業機１が静定していると判定した場合であっても、外部計測装置５０で計測した座標が適切でないと判定した場合は、前記変換パラメータの更新値を算出しない。これにより、外部計測装置５０で計測した座標が適切な場合に限り変換パラメータ（取付角度Δθ、リンク長Ｌ）が更新されるため、第１の実施例よりも高い精度でマシンガイダンスシステムまたはマシンコントロールシステムを校正することが可能となる。

また、本実施例における油圧ショベル（建設機械）１００は、コントローラ２０から入力された情報を出力可能なモニタ（報知装置）３０を備え、コントローラ２０は、作業機１の回動中心位置（ピン位置ｐ０）が移動しない複数の姿勢（第１姿勢、第２姿勢）において外部計測装置５０で計測した前記回動中心位置および作業機１の非回動中心位置の座標を取得し、前記複数の姿勢における前記非回動中心位置の水平方向（Ｙ軸方向）の変化量が第１閾値（許容変化量ΔＹ）を上回る場合に、外部計測装置５０の座標軸が適切でないと判定し、前記複数の姿勢における前記回動中心位置と前記非回動中心位置との距離の変化量が第２閾値（例えば、外部計測装置５０の計測精度）を上回る場合に、外部計測装置５０で計測した座標が適切でないと判定し、変換パラメータ（取付角度Δθ、リンク長Ｌ）を校正する際に、作業機１が静定していると判定した場合であっても、外部計測装置５０で計測した座標軸が適切でないと判定した場合、または、外部計測装置５０で計測した座標が適切でないと判定した場合は、前記変換パラメータの更新値を算出せず、作業機１が静定していないと判定した場合、外部計測装置５０で計測した座標軸が適切でないと判定した場合、または、外部計測装置５０で計測した座標が適切でないと判定した場合は、再校正を促す情報をモニタ（報知装置）３０に出力する。これにより、外部計測装置５０の座標軸が適切でない場合、または、外部計測装置５０で計測した座標が適切でない場合に、オペレータが速やかにキャリブレーションをやり直すことが可能となる。

本発明の第４の実施例について、第３の実施例との相違点を中心に説明する。第３の実施例によれば、高精度なキャリブレーションを実現できる一方で、作業機１の姿勢変化がある場合や外部計測装置５０の座標軸または計測座標が不適切な場合に多くの手戻り作業が発生するという課題がある。本実施例はこの課題を解決するものである。

図１４は、本実施例におけるコントローラの機能ブロック図である。図１４において、第３の実施例（図１１に示す）との相違点は、姿勢情報変化検出部２５ｂの演算結果に応じて校正作業のタイミングを通知する機能を再校正通知部２５ｆに追加した点である。

本実施例における姿勢検出結果記録部２５ａは常にバッファ領域に最新の一定時間（例えば３分間）のＩＭＵデータを保持しており、姿勢情報変化検出部２５ｂはこのバッファ領域のＩＭＵデータを分析し、姿勢変化がない場合に再校正通知部２５ｆを介して、オペレータに外部計測装置５０による座標計測の実施を促す。第１～第３の実施例は、取得したデータを後から分析して姿勢変化があった場合にデータのとり直しを行う形態であるが、本実施例は姿勢変化がないことを確認してから外部計測装置５０のデータを取得するため、データのとり直しが少なくなることが期待できる。また、本実施例は、第３の実施例から実施手順を変更することで作業効率の向上を図っている。

図１５は、本実施例におけるキャリブレーション実行部２５の処理を示すフローチャートである。

まず、ステップＦＣ４０１で、特定の姿勢を指定せずに作業機１を回動させるようオペレータに指示し、オペレータがフロント作業機１を回動させている間、外部計測装置５０から作業機１の各ピン位置の座標を取得する。座標の取得が完了した後にステップＦＣ４０２に遷移する。

ステップＦＣ４０２で、外部計測装置５０から取得した座標を分析し、ステップＦＣ４０３に遷移する。

ステップＦＣ４０３で、各ピン位置のＹ座標に変化があるか否かを判定する。Ｙ座標に変化がある（ＮＯ）と判定した場合は、ステップＦＣ４０４でフロント作業機１の座標軸を修正するようオペレータに指示し、ステップＦＣ４０１に遷移する。オペレータは上部旋回体２をさせることにより、フロント作業機１の座標軸を外部計測装置５０の座標軸に合わせる。Ｙ座標に変化がない（ＹＥＳ）と判定した場合はステップＦＣ４０５に遷移する。このように座標軸の修正を最初に行うことにより、やり直し工数を減らすことができる。以上の処理は、外部計測結果記録部２５ｃおよび外部計測結果分析部２５ｇによって実行される。

ステップＦＣ４０５で、キャリブレーション実施時の所定の第１姿勢を作成するようオペレータに指示する。オペレータは指示に従って第１姿勢を作成する。第１姿勢の作成が完了した後にステップＦＣ４０６に遷移する。

ステップＦＣ４０６でＩＭＵデータを監視し、ステップＦＣ４０７でＩＭＵデータに変化がない（姿勢変化がない）か否かを判定する。姿勢変化がある（ＮＯ）と判定された場合はステップＦＣ４０６に遷移し、姿勢変化がない（ＹＥＳ）と判定された場合はステップＦＣ４０８に遷移する。

ステップＦＣ４０８で、外部計測装置５０で計測した座標を取得し、ステップＦＣ４０９に遷移する。

ステップＦＣ４０９で、キャリブレーション実施時の所定の第２姿勢を作成するようオペレータに指示する。オペレータは指示に従って第２姿勢を作成する。第２姿勢の作成が完了した後にステップＦＣ４１０に遷移する。

ステップＦＣ４１０でＩＭＵデータを監視し、ステップＦＣ４１１でＩＭＵデータに変化がない（姿勢変化がない）か否かを判定する。姿勢変化がある（ＮＯ）と判定した場合はステップＦＣ４１０に遷移し、姿勢変化がない（ＹＥＳ）と判定した場合はステップＦＣ４１２に遷移する。

ステップＦＣ４１２で、外部計測装置５０で計測した座標を取得し、ステップＦＣ４１３に遷移する。

ステップＦＣ４１３で、外部計測装置５０で計測した座標を分析し、ステップＦＣ４１４で作業機１の寸法（リンク長）に変化がないか否かを判定する。

ステップＦＣ４１３で寸法に変化がない（ＹＥＳ）と判定した場合はステップＦＣ４１５で変換パラメータを算出し、ステップＦＣ４１６で変換パラメータを記録した後、当該フローを終了する。

ステップＦＣ４１３で寸法に変化がある（ＮＯ）と判定した場合は、ステップＦＣ４１７で、作業機１の寸法変化に伴って不適切な座標が計測されたため再校正が必要であることをオペレータに通知し、当該フローを終了する。

（まとめ）
本実施形態における油圧ショベル（建設機械）１００は、コントローラ２０から入力された情報を出力可能なモニタ（報知装置）３０を備え、コントローラ２０は、変換パラメータ（取付角度Δθ、リンク長Ｌ）を校正する際に、作業機１が静定していると判定した場合に、外部計測装置５０による計測を促す情報をモニタ（報知装置）３０に出力する。

以上のように構成された本実施例によれば、第３の実施例と同様に、高精度なキャリブレーションを実現することが可能となる。また、作業機１が静定していることを確認した後に外部計測装置５０で座標を計測することにより、作業機１の姿勢変化に伴う手戻り作業（座標の再計測）が回避されるため、キャリブレーションの作業効率を向上させることが可能となる。

以上、本発明の実施例について詳述したが、本発明は上記した実施例に限定されるものではなく、様々な変形例が含まれる。例えば、上記した実施例は、本発明を分かり易く説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施例の構成に他の実施例の構成の一部を加えることも可能であり、ある実施例の構成の一部を削除し、あるいは、他の実施例の一部と置き換えることも可能である。

１…フロント作業機、２…上部旋回体、２ａ…旋回モータ（油圧アクチュエータ）、３…下部走行体、３ａ…走行モータ（油圧アクチュエータ）、４…ブーム、４ａ…ブームシリンダ（油圧アクチュエータ）、４ｂ…ブームフートピン、５…アーム、５ａ…アームシリンダ（油圧アクチュエータ）、５ｂ…アームピン（ブーム先端ピン）、６…バケット、６ａ…バケットシリンダ（油圧アクチュエータ）、６ｂ…バケットピン、７…油圧ポンプ装置、８…コントロールバルブ、９…運転室、９ａ，９ｂ…操作レバー、１３～１６…ＩＭＵセンサ（慣性計測装置、姿勢検出装置）、１７…位置情報検出装置、１７ａ…ＧＮＳＳアンテナ、１７ｂ…ＧＮＳＳアンテナ、１７ｃ…ＧＮＳＳ受信機、１８…リンク部材（バケットリンク）、２０…コントローラ、２１…姿勢検出結果記録部、２１…ポジショニング演算部、２２…モニタ表示制御部、２３…油圧システム制御部、２４…施工目標面演算部、２５…キャリブレーション実行部、２５ａ…姿勢検出結果記録部、２５ｂ…姿勢情報変化検出部、２５ｃ…外部計測結果記録部、２５ｄ…校正値演算部、２５ｅ…校正結果記録部、２５ｆ…再校正通知部、２５ｇ…外部計測結果分析部、３０…モニタ（報知装置）、４０…記憶装置、５０…外部計測装置、１００…油圧ショベル（建設機械）、ｐ０…ブームフートピン位置（第２所定位置、回動中心位置）、ｐ１…ブーム先端ピン位置（第２所定位置、非回動中心位置）、ｐ２…バケットピン位置（第２所定位置、非回動中心位置）。

Claims (6)

1. 下部走行体と、
   前記下部走行体に回動可能に取り付けられた上部旋回体と、
   前記上部旋回体に回動可能に取り付けられた多関節型の作業機と、
   前記作業機に取り付けられた姿勢検出装置と、
   前記姿勢検出装置で検出した前記作業機の姿勢を所定の変換パラメータを用いて前記作業機の第１所定位置の座標に変換するコントローラとを備え、
   前記コントローラは、前記姿勢検出装置で検出した前記作業機の姿勢と外部計測装置で計測した前記作業機の第２所定位置の座標とに基づいて前記変換パラメータの更新値を算出して校正を行う建設機械において、
   前記コントローラは、
   前記変換パラメータの校正の指示がされた後の所定の時間の間に前記姿勢検出装置が検出した前記作業機の姿勢に基づいて、前記作業機が静定しているか否かを判定し、
   前記作業機が静定していると判定した場合に、前記所定の時間の間に前記姿勢検出装置が検出した前記作業機の姿勢と、前記変換パラメータの校正の指示がされた後に前記外部計測装置で計測された前記第２所定位置の座標とに基づいて前記変換パラメータの更新値を算出する
   ことを特徴とする建設機械。
2. 請求項１に記載の建設機械において、
   前記コントローラから入力された情報を出力可能な報知装置を備え、
   前記コントローラは、前記変換パラメータを校正する際に、前記作業機が静定していないと判定した場合は、再校正を促す情報を前記報知装置に出力する
   ことを特徴とする建設機械。
3. 請求項１に記載の建設機械において、
   前記コントローラは、
   前記作業機の回動中心位置が移動しない複数の姿勢において前記外部計測装置で計測した前記作業機の非回動中心位置の座標を取得し、
   前記複数の姿勢における前記非回動中心位置の水平方向の変化量が第１閾値を上回る場合に、前記外部計測装置の座標軸が適切でないと判定し、
   前記変換パラメータを校正する際に、前記作業機が静定していると判定した場合であっても、前記外部計測装置の座標軸が適切でないと判定した場合は、前記更新値を算出しない
   ことを特徴とする建設機械。
4. 請求項１に記載の建設機械において、
   前記コントローラは、
   前記作業機の回動中心位置が移動しない複数の姿勢において前記外部計測装置で計測した前記回動中心位置および前記作業機の非回動中心位置の座標を取得し、
   前記複数の姿勢における前記回動中心位置と前記非回動中心位置との距離の変化量が第２閾値を上回る場合に、前記外部計測装置で計測した座標が適切でないと判定し、
   前記変換パラメータを校正する際に、前記作業機が静定していると判定した場合であっても、前記外部計測装置で計測した座標が適切でないと判定した場合は、前記更新値を算出しない
   ことを特徴とする建設機械。
5. 請求項１に記載の建設機械において、
   前記コントローラから入力された情報を出力可能な報知装置を備え、
   前記コントローラは、
   前記作業機の回動中心が移動しない複数の姿勢において前記外部計測装置で計測した前記作業機の回動中心位置および非回動中心位置の座標を取得し、
   前記複数の姿勢における前記非回動中心位置の水平方向の変化量が第１閾値を上回る場合に、前記外部計測装置の座標軸が適切でないと判定し、
   前記複数の姿勢における前記回動中心位置と前記非回動中心位置との距離の変化量が第２閾値を上回る場合に、前記外部計測装置で計測した座標が適切でないと判定し、
   前記変換パラメータを校正する際に、前記作業機が静定していると判定した場合であっても、前記外部計測装置で計測した座標軸が適切でないと判定した場合、または、前記外部計測装置で計測した座標が適切でないと判定した場合は、前記更新値を算出せず、
   前記作業機が静定していないと判定した場合、前記外部計測装置で計測した座標軸が適切でないと判定した場合、または、前記外部計測装置で計測した座標が適切でないと判定した場合は、再校正を促す情報を前記報知装置に出力する
   ことを特徴とする建設機械。
6. 請求項１に記載の建設機械において、
   前記コントローラから入力された情報を出力可能な報知装置を備え、
   前記コントローラは、前記変換パラメータを校正する際に、前記作業機が静定していると判定した場合に、前記外部計測装置による計測を促す情報を前記報知装置に出力する
   ことを特徴とする建設機械。

Images