JP2021055302A - 作業機械 - Google Patents

Abstract

【課題】姿勢センサの交換に伴うキャリブレーション作業に要する時間を短縮する。【解決手段】作業機械は、流体圧シリンダがストロークエンドの状態における、流体圧シリンダに対応するフロント部材の相対角度が記憶される記憶装置と、姿勢センサが交換されたか否かを判定し、姿勢センサが交換されたと判定された場合、交換されたと判定された姿勢センサが取り付けられているフロント部材を特定し、特定されたフロント部材に対応する流体圧シリンダがストロークエンドの状態にあるか否かを判定し、特定されたフロント部材に対応する流体圧シリンダがストロークエンドの状態にあると判定されると、特定されたフロント部材に取り付けられた姿勢センサの出力信号から得られる角度情報と、記憶装置に記憶されている特定されたフロント部材の相対角度と、に基づいて、角度情報を補正するための補正量を演算する制御装置と、を備える。【選択図】図１４

Description

本発明は、作業機械に関する。

複数のフロント部材が連結されてなるフロント作業装置を備えた油圧ショベルが知られている。そして、油圧ショベルには、オペレータの掘削操作を補助する制御システムが備えられることがある。この制御システムは、例えば、操作装置によって掘削操作がなされた場合に、フロント部材の角度情報及びフロント部材の寸法情報等に基づいてフロント作業装置の先端（例えばバケットの爪先）の位置を演算する。そして、バケットの爪先と目標面との位置関係に基づいて、フロント作業装置の先端の位置が目標面上及びその上方の領域内に保持されるように、フロント作業装置の動作を制御する。このような制御システムを用いることにより、油圧ショベルによる掘削面の仕上げ作業や法面の成形作業を容易に行うことができる。

この種の制御システムでは、各部材に取り付けられる姿勢センサの出力信号に基づいて各部材の角度情報を取得する。ここで、各部材の角度情報を適切に得るためには、予め、フロント部材の角度とそのフロント部材に取り付けられる姿勢センサの取付角度との差を計測する。そして、その計測結果を補正量として記憶装置に記憶させておき、姿勢センサの出力信号から得られる角度情報を記憶装置に記憶されている補正量で補正する必要がある。

このように、姿勢センサの出力信号に基づいてフロント部材の角度情報を適切に得るために、予め補正量を計測しておく作業のことをキャリブレーション作業という。キャリブレーション作業は、油圧ショベルの製造工場において姿勢センサを取り付けたとき、及び、現場で姿勢センサを新しいものに交換したとき等に行われる。

特許文献１には、測量装置によって油圧ショベルの複数の測定点の座標を測量し、測量した結果に基づいて、油圧ショベルのブーム、アーム及びバケット等のフロント部材の傾斜角度を取得し、フロント部材の傾斜角度と、フロント部材の取り付けられた傾斜センサの出力値と、に基づいて、傾斜センサの補正量を取得する方法が開示されている。

特開２０１８−１４６４０８号公報

しかしながら、測量装置によって補正量を取得する場合には、測量装置の準備、設置作業及び測量作業等に手間がかかり、現場において姿勢センサを交換したときのキャリブレーション作業に時間を要するという問題がある。キャリブレーション作業が完了するまでは油圧ショベルによる作業を行うことができないため、工期が延びてしまうおそれがある。

本発明は、姿勢センサの交換に伴うキャリブレーション作業に要する時間を短縮することを目的とする。

本発明の一態様による作業機械は、回動可能に連結される複数のフロント部材及びフロント部材を駆動する複数の流体圧シリンダを有する多関節型の作業装置と、作業装置が回動可能に連結されるベース部材と、複数のフロント部材のそれぞれに取り付けられ複数のフロント部材のそれぞれの姿勢に関する情報を取得する複数の姿勢センサと、情報が記憶される記憶装置と、作業機械を制御する制御装置と、を備える。記憶装置には、流体圧シリンダがストロークエンドの状態における、流体圧シリンダに対応するフロント部材の相対角度が記憶される。制御装置は、姿勢センサが交換されたか否かを判定し、姿勢センサが交換されたと判定された場合、交換されたと判定された姿勢センサが取り付けられているフロント部材を特定し、特定されたフロント部材に対応する流体圧シリンダがストロークエンドの状態にあるか否かを判定し、特定されたフロント部材に対応する流体圧シリンダがストロークエンドの状態にあると判定されると、特定されたフロント部材に取り付けられた姿勢センサの出力信号から得られる角度情報と、記憶装置に記憶されている特定されたフロント部材の相対角度と、に基づいて、角度情報を補正するための補正量を演算する。

本発明によれば、姿勢センサの交換に伴うキャリブレーション作業に要する時間を短縮することができる。

図１は、第１実施形態に係る油圧ショベルの側面図である。 図２は、運転室の内部を運転席の後側から前方に向かって見たときの概略図である。 図３は、油圧ショベルが備える油圧システムについて示す図である。 図４は、油圧ショベルの制御装置に接続される装置について説明する図である。 図５は、第１実施形態に係る油圧ショベルの姿勢について説明する図である。 図６は、第１実施形態に係る制御装置の機能ブロック図である。 図７は、第１実施形態に係る制御装置により実行される演算処理の内容を示すフローチャートである。 図８は、第１実施形態に係る制御装置により実行されるストロークエンド状態フラグの設定処理の内容を示すフローチャートである。 図９は、第１実施形態に係る制御装置により実行される取付部材特定処理の内容を示すフローチャートである。 図１０は、第１実施形態に係る制御装置により実行される取付部材特定（２部材）処理の内容を示すフローチャートである。 図１１は、第１実施形態に係る制御装置により実行される取付部材特定（３部材）処理の内容を示すフローチャートである。 図１２は、第１実施形態に係る制御装置により実行される補正量設定処理の内容を示すフローチャートである。 図１３は、第１実施形態に係る制御装置により実行される補正量設定（１部材）処理の内容を示すフローチャートである。 図１４は、第１実施形態に係る制御装置により実行されるブームＩＭＵの補正量設定処理の内容を示すフローチャートである。 図１５は、第１実施形態に係る制御装置により実行されるアームＩＭＵの補正量設定処理の内容を示すフローチャートである。 図１６は、第１実施形態に係る制御装置により実行されるバケットＩＭＵの補正量設定処理の内容を示すフローチャートである。 図１７は、第１実施形態に係る制御装置により実行される補正量設定（２部材）処理の内容を示すフローチャートである。 図１８は、第１実施形態に係る制御装置により実行される補正量設定（３部材）処理の内容を示すフローチャートである。 図１９は、第２実施形態に係る油圧ショベルの姿勢について説明する図である。 図２０は、第２実施形態に係る制御装置により実行される補正量設定処理の内容を示すフローチャートである。 図２１は、変形例１に係る制御装置により実行される補正量設定処理の内容を示すフローチャートである。

＜第１実施形態＞
図面を参照して、本発明の実施形態に係る作業機械について説明する。本実施形態では、作業機械が、クローラ式の油圧ショベルである例について説明する。

図１は、本発明の第１実施形態に係る油圧ショベル１の側面図である。説明の便宜上、図１に示すように油圧ショベル１の前後および上下方向を規定する。つまり、本実施形態では、特に断り書きのない場合は、運転席の前方（同図中では左方向）を油圧ショベル１の前方とする。油圧ショベル１は、走行体２と、走行体２上に旋回可能に搭載された旋回体３とを備える。走行体２は、左右一対のクローラを走行モータ２ａ，２ｂ（図３参照）によって駆動することにより走行する。

旋回体３は、ベース部材となる旋回フレーム８と、旋回フレーム８の前部左側に設けられる運転室７と、旋回フレーム８の後部に設けられるカウンタウエイト３２と、旋回フレーム８における運転室７の後側に設けられるエンジン室３３と、を有する。エンジン室３３には、動力源であるエンジンや油圧機器等が収容されている。旋回フレーム８の前部中央にはフロント作業装置１０が回動可能に連結されている。

フロント作業装置１０は、回動可能に連結される複数のフロント部材及びフロント部材を駆動する複数の油圧シリンダ（流体圧シリンダ）を有する多関節型の作業装置である。本実施形態では、３つのフロント部材としてのブーム１１、アーム１２及びバケット１３が、直列的に連結される。ブーム１１は、その基端部が旋回フレーム（ベース部材）８の前部においてブームピン１１ｂ（図５参照）によって回動可能に連結される。アーム１２は、その基端部がブーム１１の先端部においてアームピン１２ｂによって回動可能に連結される。バケット１３は、アーム１２の先端部においてバケットピン１３ｂによって回動可能に連結される。フロント部材（１１，１２，１３）同士を連結する連結軸及びフロント部材であるブーム１１とベース部材である旋回フレーム８を連結する連結軸は、互いに平行に配置され、それぞれの部材（８，１１，１２，１３）は同一面内で相対回転可能とされている。

ブーム１１は、アクチュエータである油圧シリンダ（以下、ブームシリンダ１１ａとも記す）によって駆動され、旋回フレーム８に対して回動する。アーム１２は、アクチュエータである油圧シリンダ（以下、アームシリンダ１２ａとも記す）によって駆動され、ブーム１１に対して回動する。バケット１３は、アクチュエータである油圧シリンダ（以下、バケットシリンダ１３ａとも記す）によって駆動され、アーム１２に対して回動する。油圧シリンダ１１ａ，１２ａ，１３ａは、一端が閉塞された有底筒状のシリンダチューブと、シリンダチューブの他端の開口を塞ぐヘッドカバーと、ヘッドカバーを貫通し、シリンダチューブに挿入されるシリンダロッドと、シリンダロッドの先端に設けられ、シリンダチューブ内をロッド側室とボトム側室とに区画するピストンと、を備える。ブームシリンダ１１ａは、その一端側がブーム１１に接続され他端側が旋回フレーム８に接続されている。アームシリンダ１２ａは、その一端側がアーム１２に接続され他端側がブーム１１に接続されている。バケットシリンダ１３ａは、その一端側がリンク部材を介してバケット１３に接続され他端側がアーム１２に接続されている。

ベース部材（旋回フレーム８）と、複数のフロント部材（ブーム１１、アーム１２及びバケット１３）のそれぞれには、それらの部材のそれぞれの姿勢に関する情報（以下、姿勢情報と記す）を取得する姿勢センサとしてのＩＭＵ（Inertial Measurement Unit：慣性計測装置）５０ａ〜５０ｄが取り付けられている。なお、本実施形態では旋回フレーム８にＩＭＵ５０ｄを取り付けているが、これに限定されることはない。ＩＭＵ５０ｄは、旋回フレーム８に対して回動不能に取り付けられた部材であれば、旋回体３の任意の部材（例えば、エンジン室３３のカバー、カウンタウエイト３２等）に取り付けてもよい。

図２は、運転室７の内部を運転席７５の後側から前方に向かって見たときの概略図である。図２に示すように、運転室７内には、オペレータが着座する運転席７５と、油圧ショベル１の各部を操作するための操作レバー（Ｂ１〜Ｂ４）と、油圧ショベル１の動作を制御する制御装置１００と、制御装置１００からの信号に基づいて表示画像を表示画面に表示させる表示装置１８と、が設けられている。運転席７５の右側には、バケット操作及びブーム操作を行うための右操作レバーＢ１が設けられ、運転席７５の左側には、旋回操作及びアーム操作を行うための左操作レバーＢ２が設けられている。運転席７５の前側には左右一対の走行レバー（左走行レバーＢ４及び右走行レバーＢ３）が設けられている。左走行レバーＢ４は左側のクローラ操作を行うための操作レバーであり、右走行レバーＢ３は右側のクローラ操作を行うための操作レバーである。

表示装置１８は、例えば、液晶パネル等から構成され、制御装置１００に接続されており、制御装置１００からの表示制御信号に基づき、所定の表示画像を表示画面に表示させる。表示装置１８は、運転席７５側からみて右側のピラー７６に取り付けられている。制御装置１００は、運転室７における運転席７５の後方に設けられている。

図３は、油圧ショベル１が備える油圧システムについて示す図である。油圧ショベル１は、複数の操作レバー装置Ａ１〜Ａ６を備える。操作レバー装置Ａ１，Ａ３は、右操作レバーＢ１を共有している。右操作レバーＢ１で操作レバー装置Ａ１を操作するとブームシリンダ１１ａが駆動され、ブーム１１が旋回体３に対して回動する。右操作レバーＢ１で操作レバー装置Ａ３を操作するとバケットシリンダ１３ａが駆動され、バケット１３がアーム１２に対して回動する。操作レバー装置Ａ２，Ａ４は、左操作レバーＢ２を共有している。左操作レバーＢ２で操作レバー装置Ａ２を操作するとアームシリンダ１２ａが駆動され、アーム１２がブーム１１に対して回動する。左操作レバーＢ２で操作レバー装置Ａ４を操作すると旋回モータ３ａが駆動され、旋回体３が旋回する。

操作レバー装置Ａ５は右走行レバーＢ３を有し、右走行レバーＢ３で操作レバー装置Ａ５を操作すると右側の走行モータ２ａが駆動される。操作レバー装置Ａ６は左走行レバーＢ４を有し、左走行レバーＢ４で操作レバー装置Ａ６を操作すると左側の走行モータ２ｂが駆動される。

旋回体３には、エンジンによって駆動される油圧ポンプ（メインポンプ４８及びパイロットポンプ４９）、及びバルブ等の油圧機器が搭載されている。メインポンプ４８は、可変容量型の油圧ポンプであり、複数の油圧アクチュエータ（ブームシリンダ１１ａ、アームシリンダ１２ａ、バケットシリンダ１３ａ等）を駆動する圧油を吐出する。パイロットポンプ４９は固定容量型の油圧ポンプであり、パイロットポンプ４９から吐出される作動油は、各操作レバー装置Ａ１〜Ａ６に導かれる。なお、メインポンプ４８と油圧アクチュエータとを接続する回路の最高圧力は、リリーフ弁４５によって規定される。

パイロットポンプ４９の吐出配管であるポンプライン４９ａはロック弁３９を経由し、複数に分岐して操作レバー装置Ａ１〜Ａ６及びマシンコントロール用の電磁弁ユニット１６に接続される。本実施形態のロック弁３９は電磁切換弁であり、そのソレノイドは運転室７に配置されたゲートロックレバー（不図示）の位置センサと電気的に接続されている。ゲートロックレバーのポジションは、位置センサで検出され、位置センサからゲートロックレバーのポジションに応じた信号がロック弁３９に入力される。ゲートロックレバーのポジションがロック位置にあればロック弁３９が閉じてポンプライン４９ａが遮断され、ロック解除位置にあればロック弁３９が開いてポンプライン４９ａが開通する。ポンプライン４９ａが遮断された状態では操作レバー装置Ａ１〜Ａ６による操作が無効化され、旋回や掘削等の動作が禁止される。

上記の操作レバー装置Ａ１〜Ａ６はそれぞれ油圧パイロット方式の一対の減圧弁を含んで構成されている。これら操作レバー装置Ａ１〜Ａ６はパイロットポンプ４９の吐出圧を元圧として、それぞれオペレータによる操作レバーＢ１〜Ｂ４の操作量と操作方向に応じて制御弁ユニット１５を駆動するパイロット圧を生成し出力する。制御弁ユニット１５は流量制御弁Ｄ１〜Ｄ６を有し、メインポンプ４８からブームシリンダ１１ａ、アームシリンダ１２ａ、バケットシリンダ１３ａ、旋回モータ３ａ及び走行モータ２ａ，２ｂに供給される作動油の流れを制御する。

流量制御弁Ｄ１は操作レバー装置Ａ１からパイロットラインＣ１，Ｃ２を介して受圧室Ｅ１，Ｅ２に入力されるパイロット圧で駆動されてブームシリンダ１１ａを駆動する。流量制御弁Ｄ２は操作レバー装置Ａ２からパイロットラインＣ３，Ｃ４を介して受圧室Ｅ３，Ｅ４に入力されるパイロット圧で駆動されてアームシリンダ１２ａを駆動する。流量制御弁Ｄ３は操作レバー装置Ａ３からパイロットラインＣ５，Ｃ６を介して受圧室Ｅ５，Ｅ６に入力されるパイロット圧で駆動されてバケットシリンダ１３ａを駆動する。同様に流量制御弁Ｄ４〜Ｄ６は操作レバー装置Ａ４〜Ａ６からパイロットラインＣ７〜Ｃ１２を介して受圧室Ｅ７〜Ｅ１２に入力されるパイロット圧で駆動されて対応する油圧アクチュエータを駆動する。

図４は、油圧ショベル１の制御装置１００に接続される装置について説明する図である。図４に示すように、制御装置１００には、ブーム上げ操作が行われたときに操作レバー装置Ａ１から出力されるパイロット圧を検出する圧力センサ６１ａと、ブーム下げ操作が行われたときに操作レバー装置Ａ１から出力されるパイロット圧を検出する圧力センサ６１ｂと、アームクラウド操作が行われたときに操作レバー装置Ａ２から出力されるパイロット圧を検出する圧力センサ６２ａと、アームダンプ操作が行われたときに操作レバー装置Ａ２から出力されるパイロット圧を検出する圧力センサ６２ｂと、バケットクラウド操作が行われたときに操作レバー装置Ａ３から出力されるパイロット圧を検出する圧力センサ６３ａと、バケットダンプ操作が行われたときに操作レバー装置Ａ３から出力されるパイロット圧を検出する圧力センサ６３ｂと、が接続されている。各圧力センサ（６１ａ，６１ｂ，６２ａ，６２ｂ，６３ａ，６３ｂ）は、フロント部材を操作するためのパイロット圧力を検出するものであるため、総称してパイロット圧センサ６０とも記す。

制御装置１００には、ブームシリンダ１１ａのボトム側油室の圧力を検出する圧力センサ７１ａと、ブームシリンダ１１ａのロッド側油室の圧力を検出する圧力センサ７１ｂと、アームシリンダ１２ａのボトム側油室の圧力を検出する圧力センサ７２ａと、アームシリンダ１２ａのロッド側油室の圧力を検出する圧力センサ７２ｂと、バケットシリンダ１３ａのボトム側油室の圧力を検出する圧力センサ７３ａと、バケットシリンダ１３ａのロッド側油室の圧力を検出する圧力センサ７３ｂと、が接続されている。各圧力センサ（７１ａ，７１ｂ，７２ａ，７２ｂ，７３ａ，７３ｂ）は、フロント部材を駆動する油圧シリンダの圧力室（ボトム側油室及びロッド側油室）の圧力（以下、シリンダ圧力とも記す）を検出するものであるため、総称してシリンダ圧センサ７０とも記す。

制御装置１００には、ブームＩＭＵ５０ａ、アームＩＭＵ５０ｂ、バケットＩＭＵ５０ｃ及び旋回体ＩＭＵ５０ｄが、車載ネットワーク９０を介して制御装置１００に接続されている。

以下の説明では、ブーム１１に取り付けられているＩＭＵ５０ａ、アーム１２に取り付けられているＩＭＵ５０ｂ、バケットに取り付けられているＩＭＵ５０ｃ、及び旋回フレーム８に取り付けられているＩＭＵ５０ｄを総称してＩＭＵ５０とも記す。また、フロント部材に取り付けられているＩＭＵ５０ａ，５０ｂ，５０ｃを総称してフロントＩＭＵ５０Ｆとも記す。

各ＩＭＵ５０には、それぞれ固有の識別情報としてのＩＤが割り当てられている。各ＩＭＵ５０は、姿勢情報に当該識別情報を付加した信号を車載ネットワーク９０に出力することにより、車載ネットワーク９０上を伝達される複数の姿勢情報がそれぞれどのＩＭＵ５０で取得されたものであるかを識別することができる。

図５は、油圧ショベル１の姿勢について説明する図である。図５に示すように、油圧ショベル１の姿勢は、旋回体３を基準に設定されたローカル座標系で規定される。このローカル座標系では、ブームピン１１ｂの中心に原点が設定され、旋回体３の旋回中心軸に平行となる軸がＺ軸として設定され、Ｚ軸と直交する方向（旋回体３の前後方向）に延在する軸がＸ軸として設定される。

ＩＭＵ５０は、部材の姿勢に関する情報として、部材の直交３軸の角速度及び加速度を検出して取得する。また、本実施形態では、ＩＭＵ５０は、検出した加速度に基づいて、部材の姿勢に関する情報（角度情報）としての対地角度を演算して取得する。例えば、ＩＭＵ５０が取り付けられた部材（ブーム１１、アーム１２、バケット１３及び旋回体３）などの被搭載部材が静止しているときには、ＩＭＵ５０に作用する重力加速度の方向（つまり、鉛直下向き方向）に基づき、各部材に取り付けられたＩＭＵ５０の対地角度θｇｉ（ｊ）を演算し、制御装置１００に出力する。つまり、ＩＭＵ５０は、フロント部材の対地角度を取得するための対地角センサとして機能する。制御装置１００は、ＩＭＵ５０の出力信号から得られる角度情報であるＩＭＵ５０の対地角度θｇｉ（ｊ）を後述する記憶装置１２０に一時的に記憶する。

ここで、ｊは、各部材を表す符号であり、０から３までの整数である。ｊ＝０は旋回フレーム８（旋回体３）を表し、ｊ＝１はブーム１１を表し、ｊ＝２はアーム１２を表し、ｊ＝３はバケット１３を表す。なお、本実施形態では、ＩＭＵ５０が対地角度θｇｉ（ｊ）を演算し、その演算結果を表す信号を制御装置１００に出力する例について説明するが、対地角度θｇｉ（ｊ）の演算は、制御装置１００が行ってもよい。つまり、ＩＭＵ５０から出力される加速度を表す信号に基づいて、制御装置１００が対地角度θｇｉ（ｊ）を演算してもよい。

次に、ＩＭＵ５０の対地角度θｇｉ（ｊ）を補正することにより、各部材の対地角度θｇ（ｊ）を取得する方法について説明する。対地角度θｇ（ｊ）は、鉛直軸Ｖに直交する水平面（基準面）Ｈに対する部材の傾斜角度である。なお、対地角度θｇ（ｊ）は、図５に示すように油圧ショベル１を左側から見たときに、フロント部材の回動支点を通る水平面Ｈを基準として、水平面Ｈにおける回動支点よりも前側から回動支点を中心とした周方向における時計回りに１８０度の範囲（例えば矢印８１参照）までは正の値をとり、水平面Ｈにおける回動支点よりも前側から回動支点を中心とした周方向における反時計回りに１８０度の範囲（例えば矢印８２参照）では負の値をとる。つまり、各部材の姿勢を表す直線（Ｌ１，Ｌ２，Ｌ３）が水平面Ｈよりも上方に位置する場合は、対地角度θｇ（ｊ）は正の値となり、各部材の姿勢を表す直線（Ｌ１，Ｌ２，Ｌ３）が水平面Ｈよりも下方に位置する場合は、対地角度θｇ（ｊ）は負の値となる。

旋回体３の対地角度θｇ（０）は、水平面（基準面）Ｈに対する旋回体３の傾斜角度、すなわち水平面ＨとＸ軸のなす角である。ブーム１１の対地角度θｇ（１）は、ブームピン１１ｂの中心からアームピン１２ｂの中心に向かって延在する直線Ｌ１と、水平面Ｈとのなす角である。アーム１２の対地角度θｇ（２）は、アームピン１２ｂの中心からバケットピン１３ｂの中心に向かって延在する直線Ｌ２と、水平面Ｈとのなす角である。バケット１３の対地角度θｇ（３）は、バケットピン１３ｂの中心からバケット１３の先端（所定位置）に向かって延在する直線Ｌ３と、水平面Ｈとのなす角である。

ここで、ＩＭＵ５０が各部材の姿勢を表す直線（Ｌ１，Ｌ２，Ｌ３及びＸ軸）と平行にＩＭＵ５０が取り付けられる場合、ＩＭＵ５０の対地角度θｇｉ（ｊ）と、各部材の対地角度θｇ（ｊ）とは等しくなる。しかしながら、ＩＭＵ５０が各部材を表す直線（Ｌ１，Ｌ２，Ｌ３及びＸ軸）と平行に取り付けられていない場合、ＩＭＵ５０の取付角度、すなわち直線（Ｌ１，Ｌ２，Ｌ３及びＸ軸）に対するＩＭＵ５０の傾斜角度の分だけ、対地角度θｇｉ（ｊ）と対地角度θｇ（ｊ）との間に差が生じる。したがって、各部材の対地角度θｇ（ｊ）を取得するためには、予めＩＭＵ５０の取付角度を補正量θｃ（ｊ）として記憶しておき、この補正量θｃ（ｊ）によってＩＭＵ５０の対地角度θｇｉ（ｊ）を補正する必要がある。

各部材（旋回体３、ブーム１１、アーム１２、バケット１３）の対地角度θｇ（ｊ）と、その部材に取り付けられるＩＭＵ５０の対地角度θｇｉ（ｊ）と、そのＩＭＵ５０の取付角度（すなわち、補正量）θｃ（ｊ）との関係は、次式（１）で表される。

θｇ（ｊ）＝θｇｉ（ｊ）＋θｃ（ｊ） ・・・（１）

また、各部材間の相対角度（以下、フロント部材角度と記す）θｒ（ｋ）は、次式（２）により表される。

θｒ（ｋ）＝θｇ（ｋ）−θｇ（ｋ−１） ・・・（２）
ここで、ｋは、１から３までの整数である。θｒ（１）は、Ｘ軸に対するブーム１１の傾斜角度、すなわちブーム１１と旋回体３との相対角度であり、以下、ブーム角度とも記す。θｒ（２）は、ブーム１１に対するアーム１２の傾斜角度、すなわちアーム１２とブーム１１との相対角度であり、以下、アーム角度とも記す。θｒ（３）は、アーム１２に対するバケット１３の傾斜角度、すなわちバケット１３とアーム１２との相対角度であり、以下、バケット角度θｒ（３）とも記す。このように、ブーム１１の相対角度としては、ブーム１１と旋回体３との相対角度とブーム１１とアーム１２との相対角度とがあり、アーム１２の相対角度としては、アーム１２とブーム１１の相対角度とアーム１２とバケット１３との相対角度とがある。なお、バケット１３の相対角度としては、バケット１３とアーム１２の相対角度のみとなる。

また、ブームシリンダ１１ａが最伸長状態となったとき、すなわちブーム１１が旋回体３に対してその回動範囲における第１の回動限界に位置する状態（以下、第１のストロークエンドの状態とも記す）となったときのブーム角度θｒ（１）を第１角度θｒｘ１１とも記す。ブームシリンダ１１ａが最収縮状態となったとき、すなわちブーム１１が旋回体３に対してその回動範囲における第２の回動限界に位置する状態（以下、第２のストロークエンドの状態とも記す）となったときのブーム角度θｒ（２）を第２角度θｒｘ１２とも記す。アームシリンダ１２ａが最収縮状態となったとき、すなわちアーム１２がブーム１１に対してその回動範囲における第１の回動限界に位置する状態（以下、第１のストロークエンドの状態とも記す）となったときのアーム角度θｒ（２）を第１角度θｒｘ２１とも記す。アームシリンダ１２ａが最伸長状態、すなわちアーム１２がブーム１１に対してその回動範囲における第２の回動限界に位置する状態（以下、第２のストロークエンドの状態とも記す）となったときのアーム角度θｒ（２）を第２角度θｒｘ２２とも記す。バケットシリンダ１３ａが最収縮状態、すなわちバケット１３がアーム１２に対してその回動範囲における第１の回動限界に位置する状態（以下、第１のストロークエンドの状態とも記す）となったときのバケット角度θｒ（３）を第１角度θｒｘ３１とも記す。バケットシリンダ１３ａが最伸長状態、すなわちバケット１３がアーム１２に対してその回動範囲における第２の回動限界に位置する状態（以下、第２のストロークエンドの状態とも記す）となったときのバケット角度θｒ（３）を第２角度θｒｘ３２とも記す。

図６は、制御装置１００の機能ブロック図である。制御装置１００は、動作回路としてのＣＰＵ（Central Processing Unit）、情報が記憶される記憶装置１２０（図４参照）としてのＲＯＭ（Read Only Memory）及びＲＡＭ（Random Access Memory）、並びに入出力インタフェース（Ｉ／Ｏインタフェース）、その他の周辺回路を備えたマイクロコンピュータで構成される。制御装置１００は、各種演算を行う演算装置として機能し、油圧ショベル１に搭載される各種機器を制御する。制御装置１００は、１つのマイクロコンピュータで構成してもよいし、複数のマイクロコンピュータで構成することも可能である。記憶装置１２０には、各種演算が実行可能なプログラムが格納されている。すなわち、記憶装置１２０は、本実施形態の機能を実現するプログラムを読み取り可能な記憶媒体である。なお、記憶装置１２０は、制御装置１００内に設けてもよいし、その一部または全部を制御装置１００の外部に設けてもよい。

図６に示すように、制御装置１００は、記憶装置１２０に記憶されているプログラムを実行することにより、識別部１１１、取付部材特定部１１２、補正量取得部１１３、角度演算部１１４、角度記憶部１１５、補正量演算部１１６及びストロークエンド判定部１１７として機能する。また、制御装置１００の記憶装置１２０には、識別テーブル１２１、補正量テーブル１２２及び角度テーブル１２３が記憶されている。

識別テーブル１２１は、ＩＭＵ５０のＩＤ（例えば、「０１」，「０２」，「０３」，「０４」）と、ＩＭＵ５０が取り付けられている部材名（例えば、「ブーム」、「アーム」、「バケット」、「旋回体」）と、が関連付けられているデータテーブルである。

識別部１１１は、識別テーブル１２１を参照し、ＩＭＵ５０から取得したＩＤと、識別テーブル１２１に存在するＩＤとを比較することによって、ＩＭＵ５０が交換されたか否かを判定する。なお、本実施形態では、交換対象となるＩＭＵ５０がフロントＩＭＵ５０Ｆである場合について説明する。

識別部１１１は、フロントＩＭＵ５０Ｆから取得した全てのＩＤが識別テーブル１２１に存在する場合、フロントＩＭＵ５０Ｆは交換されていないと判定する。識別部１１１は、フロントＩＭＵ５０Ｆから取得したＩＤのうち、１つでも識別テーブル１２１に存在しない新たなＩＤがある場合、フロントＩＭＵ５０Ｆは交換されたと判定する。

例えば、ブームＩＭＵ５０ａが、古いもの（ＩＤ＝０１）から新しいもの（ＩＤ＝１１）に交換された場合、識別テーブル１２１には、新しいブームＩＭＵ５０ａのＩＤが存在しないため、識別部１１１は、フロントＩＭＵ５０Ｆが交換されたと判定する。

フロントＩＭＵ５０Ｆは交換されていないと判定された場合、識別部１１１は、ＩＭＵ５０から取得したＩＤとそのＩＤに対応する部材名を補正量取得部１１３に出力する。フロントＩＭＵ５０Ｆが交換されたと判定された場合、識別部１１１は、ＩＭＵ５０から取得したＩＤを取付部材特定部１１２に出力する。

取付部材特定部１１２は、フロントＩＭＵ５０Ｆが交換されたと判定された場合、交換されたと判定されたフロントＩＭＵ５０Ｆ、すなわち識別テーブル１２１に存在していないＩＤを有するフロントＩＭＵ５０Ｆが取り付けられているフロント部材を特定する。取付部材特定部１１２は、特定したフロント部材の部材名と、特定したフロント部材に取り付けられているフロントＩＭＵ５０ＦのＩＤとを関連付けて、識別テーブル１２１を更新する。

例えば、ブームＩＭＵ５０ａが、古いもの（ＩＤ＝０１）から新しいもの（ＩＤ＝１１）に交換された場合、取付部材特定部１１２は、新しいＩＤのＩＭＵ５０が取り付けられたフロント部材はブーム１１であると特定し、新しいＩＤ「１１」と、部材名「ブーム」とを関連付けて、識別テーブル１２１に記憶する。

補正量テーブル１２２は、ＩＭＵ５０のＩＤと補正量θｃ（ｊ）とが関連付けられているデータテーブルである。

補正量取得部１１３は、補正量テーブル１２２を参照し、識別部１１１から取得した全てのフロントＩＭＵ５０ＦのＩＤと、補正量テーブル１２２に存在するＩＤとを比較することによって、全てのフロントＩＭＵ５０Ｆに対する補正量が設定されているか否かを判定する。識別部１１１から取得した全てのフロントＩＭＵ５０ＦのＩＤが補正量テーブル１２２に存在する場合、補正量取得部１１３は、フロントＩＭＵ５０Ｆに対する補正量は設定されていると判定し、取得したＩＤに対応する補正量θｃ（ｊ）を補正量テーブル１２２から取得する。補正量取得部１１３は、取得したＩＤと、そのＩＤに対応する補正量θｃ（ｊ）を角度演算部１１４に出力する。補正量取得部１１３は、識別部１１１から取得したＩＤのうち、１つでも補正量テーブル１２２に存在しない新たなＩＤがある場合、フロントＩＭＵ５０Ｆに対する補正量は設定されていないと判定し、新たなＩＤを未設定ＩＤとして補正量演算部１１６に出力する。

角度演算部１１４は、ＩＭＵ５０の出力信号から得られる角度情報であるＩＭＵ５０の対地角度θｇｉ（ｊ）と、補正量取得部１１３で取得された補正量θｃ（ｊ）と、に基づいて、式（１）により、各部材の対地角度θｇ（ｊ）を演算する。なお、演算された角度情報である対地角度θｇ（ｊ）は記憶装置１２０に一時的に記憶される。そして、角度演算部１１４は、各部材の対地角度θｇ（ｋ）に基づいて、式（２）により、フロント部材と、そのフロント部材に連結される部材との相対角度（フロント部材角度θｒ（ｋ））を演算する。

具体的には、角度演算部１１４は、旋回体３の対地角度θｇ（０）とブーム１１の対地角度θｇ（１）とに基づいて、旋回体３に対するブーム１１の相対角度、すなわちブーム角度θｒ（１）を演算する。角度演算部１１４は、ブーム１１の対地角度θｇ（１）とアーム１２の対地角度θｇ（２）とに基づいて、ブーム１１に対するアーム１２の相対角度、すなわちアーム角度θｒ（２）を演算する。角度演算部１１４は、アーム１２の対地角度θｇ（２）とバケット１３の対地角度θｇ（３）とに基づいて、アーム１２に対するバケット１３の相対角度、すなわちバケット角度θｒ（３）を演算する。

角度演算部１１４で演算された角度情報であるフロント部材角度θｒ（ｋ）は、記憶装置１２０（図４参照）に一時的に記憶される。記憶装置１２０に記憶されたフロント部材角度θｒ（ｋ）は、バケット１３の先端（バケット爪先）の位置を演算するのに用いられる。制御装置１００は、操作レバー装置Ａ１〜Ａ３の少なくとも１つが操作された場合に、記憶装置１２０に記憶されている情報に基づいて、一定条件下でオペレータの操作に介入してフロント作業装置１０の動作を制限制御するマシンコントロールを行う。

マシンコントロールは、目標面とバケット爪先の位置関係、及び操作状況に応じて制御装置１００が電磁弁ユニット１６を制御することで実行される。例えば、制御装置１００は、ブーム下げ操作をする際に、バケット爪先が目標面よりも下方に侵入しないようにブーム下げ動作を停止させる停止制御を実行する。また、制御装置１００は、バケット１３の先端の位置が目標面上及びその上方の領域内に保持されるように、フロント作業装置１０の動作を制御する領域制限制御（整地制御ともいう）を実行する。

領域制限制御では、目標面から下側の領域がフロント作業装置１０によって掘削されないようにブームシリンダ１１ａ、アームシリンダ１２ａ及びバケットシリンダ１３ａの少なくとも１つを制御する。これにより、オペレータによるアーム操作によってバケット爪先が目標面に沿って移動する。具体的には、目標面に垂直な方向のバケット爪先の速度ベクトルがゼロになるように、アーム操作に伴うアーム動作中にブーム上げまたはブーム下げの微動が指令される。回動運動であるアーム動作によるバケット爪先の軌跡を目標面に沿って直線軌道に補正するためである。

ストロークエンド判定部１１７は、パイロット圧センサ６０での検出結果に基づいて、操作されているフロント部材が１つであるか否かを判定する。ストロークエンド判定部１１７は、パイロット圧センサ６０で検出されたパイロット圧力Ｐｐのうち、閾値Ｐｐ０以上のものが１つである場合、操作されているフロント部材が１つであると判定する。ストロークエンド判定部１１７は、パイロット圧センサ６０で検出されたパイロット圧力Ｐｐのうち、閾値Ｐｐ０以上のものが２つ以上である場合、あるいは、１つもない場合、操作されているフロント部材は１つでないと判定する。なお、閾値Ｐｐ０は、操作レバーが操作されているか否かを判定する閾値であり、予め制御装置１００の記憶装置１２０に記憶されている。

操作されているフロント部材が１つである場合、ストロークエンド判定部１１７は、そのフロント部材を駆動する油圧シリンダ（１１ａ，１２ａ，１３ａ）の圧力に基づいて、その油圧シリンダがストロークエンドの状態にあるか否かを判定する。すなわち、ストロークエンド判定部１１７は、そのフロント部材を駆動するシリンダ圧力に基づいて、そのフロント部材がその基端側で連結される基端側の部材に対して、その回動支点を中心とする回動範囲における回動限界の状態にあるか否かを判定する回動限界状態判定部として機能する。

シリンダ圧センサ７０で検出されたシリンダ圧力Ｐａが閾値Ｐａ０以上である場合、ストロークエンド判定部１１７は、その油圧シリンダはストロークエンド状態であり、その油圧シリンダによって駆動されるフロント部材は回動限界の状態にあると判定する。

シリンダ圧センサ７０で検出されたシリンダ圧力Ｐａが閾値Ｐａ０未満である場合、ストロークエンド判定部１１７は、その油圧シリンダはストロークエンド状態ではなく、その油圧シリンダによって駆動されるフロント部材は回動限界の状態ではないと判定する。

なお、閾値Ｐａ０は、メインポンプ４８と油圧シリンダとを接続する油路に設けられるリリーフ弁４５（図３参照）が作動していることを表す圧力値であり、予め制御装置１００の記憶装置１２０に記憶されている。つまり、シリンダ圧力Ｐａが閾値Ｐａ０以上であるときとは、リリーフ弁４５が作動し（すなわち開弁し）、作動油がリリーフ弁４５を通じてタンクに排出されている状態であることを意味している。

例えば、ブームシリンダ１１ａのボトム側油室圧Ｐａが閾値Ｐａ０以上である場合、ブームシリンダ１１ａは、ストロークエンド状態（最伸長状態）であって、ブーム１１が旋回体３に対して回動限界の状態（上限）にあると判定する。また、ブームシリンダ１１ａのロッド側油室圧Ｐａが閾値Ｐａ以上である場合、ブームシリンダ１１ａは、ストロークエンド状態（最収縮状態）であって、ブーム１１が旋回体３に対して回動限界の状態（下限）にあると判定する。

所定の油圧シリンダがストロークエンドの状態にあると判定されると、ストロークエンド判定部１１７は、ストロークエンド状態フラグＦをオンに設定する。油圧シリンダがストロークエンドの状態にないと判定されると、ストロークエンド判定部１１７は、ストロークエンド状態フラグＦをオフに設定する。ストロークエンド状態フラグＦは、フロント部材毎に設定される。ストロークエンド判定部１１７が設定したストロークエンド状態フラグＦの情報及びストロークエンドの状態にある油圧シリンダに対応するフロント部材の部材名の情報は、角度記憶部１１５及び補正量演算部１１６に出力される。

油圧シリンダがストロークエンドの状態にあると判定されると、角度記憶部１１５は、角度演算部１１４で演算されたフロント部材角度θｒ（ｋ）のうち、ストロークエンドの状態にあると判定された油圧シリンダに対応するフロント部材の相対角度（すなわち、回動限界の状態にあると判定されたフロント部材とそのフロント部材が回動限界の状態で連結される部材との相対角度）と、ストロークエンドの状態にある油圧シリンダに対応するフロント部材（すなわち、回動限界の状態にあるフロント部材）の部材名と、を関連付けて角度テーブル１２３に記憶する。なお、本実施形態では、ストロークエンドの状態にある油圧シリンダに対応するフロント部材とは、ストロークエンドの状態にあるブームシリンダ１１ａに対応するブーム１１、ストロークエンドの状態にあるアームシリンダ１２ａに対応するアーム１２、及び、ストロークエンドの状態にあるバケットシリンダ１３ａに対応するバケット１３のことをいう。また、回動限界の状態にあるフロント部材とは、旋回フレーム８に対して回動限界の状態にあるブーム１１、ブーム１１に対して回動限界の状態にあるアーム１２、アーム１２に対して回動限界の状態にあるバケット１３のことをいう。

なお、フロント部材がその基端側で連結される部材に対して回動限界の状態、すなわち油圧シリンダがストロークエンドの状態は、油圧シリンダが最伸長状態のときと最収縮状態のときとで、フロント部材毎に２つずつある。このため、角度テーブル１２３には、ブーム１１が第１の回動限界の状態（第１のストロークエンドの状態）のときのブーム角度θｒ（１）である第１角度θｒｘ１１と、ブーム１１が第２の回動限界の状態（第２のストロークエンドの状態）のときのブーム角度θｒ（１）である第２角度θｒｘ１２と、アーム１２が第１の回動限界の状態（第１のストロークエンドの状態）のときのアーム角度θｒ（２）である第１角度θｒｘ２１、アーム１２が第２の回動限界の状態（第２のストロークエンドの状態）のときのアーム角度θｒ（２）である第２角度θｒｘ２２、バケット１３が第１の回動限界の状態（第１のストロークエンドの状態）のときのバケット角度θｒ（３）である第１角度θｒｘ３１、及び、バケット１３が第２の回動限界の状態（第２のストロークエンドの状態）のときのバケット角度θｒ（３）である第２角度θｒｘ３２と、が記憶される。なお、第１角度θｒｘ１１及び第２角度θｒｘ１２を総称して、ブーム限界角度θｒｘ１とも記す。第１角度θｒｘ２１及び第２角度θｒｘ２２を総称して、アーム限界角度θｒｘ２とも記す。第１角度θｒｘ３１及び第２角度θｒｘ３２を総称して、バケット限界角度θｒｘ３とも記す。

このように、角度テーブル１２３には、油圧シリンダがストロークエンドの状態における、油圧シリンダに対応するフロント部材の相対角度（すなわち、回動限界の状態にあるフロント部材と、そのフロント部材が回動限界の状態で連結される部材と、の相対角度）θｒｘ１，θｒｘ２，θｒｘ３が記憶される。

補正量演算部１１６は、補正量取得部１１３から入力された未設定ＩＤのＩＭＵ５０に対する補正量θｃ（ｋ）を演算し、演算した補正量θｃ（ｋ）と未設定ＩＤとを関連付けて、補正量テーブル１２２に記憶する。これにより、交換された新たなフロントＩＭＵ５０Ｆに対する補正量θｃ（ｋ）が設定される。

補正量θｃ（ｋ）は、式（１）及び式（２）の関係から、次式（３）により演算される。

θｃ（ｋ）＝θｒ（ｋ）−θｇｉ（ｋ）＋θｇ（ｋ−１） ・・・（３）
ここで、θｒ（ｋ）には、角度テーブル１２３に記憶されている回動限界の状態にあるフロント部材と、そのフロント部材に回動限界の状態で連結される部材との相対角度（すなわち、油圧シリンダがストロークエンドの状態における、油圧シリンダに対応するフロント部材の相対角度）が用いられる。また、θｇｉ（ｋ）及びθｇ（ｋ−１）には、フロント部材が回動限界の状態にあると判定されたとき（すなわち、フロント部材を駆動する油圧シリンダがストロークエンドの状態にあると判定されたとき）に演算された値が用いられる。

このように、本実施形態に係る制御装置１００は、フロントＩＭＵ５０Ｆが交換されたか否かを判定し、フロントＩＭＵ５０Ｆが交換されたと判定された場合、交換されたと判定されたフロントＩＭＵ５０Ｆ（新たなフロントＩＭＵ５０Ｆ）が取り付けられているフロント部材を特定し、特定されたフロント部材に対応する油圧シリンダがストロークエンドの状態にあるか否か（すなわち、特定されたフロント部材が回動限界の状態にあるか否か）を判定する。そして、制御装置１００は、特定されたフロント部材がストロークエンドの状態にあると判定されると（すなわち、特定されたフロント部材が回動限界の状態にあると判定されると）、特定されたフロント部材に取り付けられた新たなフロントＩＭＵ５０Ｆの出力信号から得られる角度情報である未補正の対地角度θｇｉ（ｋ）と、特定されたフロント部材が回動限界の状態で連結される部材の補正済みの対地角度θｇ（ｋ−１）と、記憶装置１２０に記憶されている特定されたフロント部材の相対角度（すなわち、特定されたフロント部材とその特定されたフロント部材に回動限界の状態で連結される部材との相対角度）であるフロント部材角度θｒ（ｋ）と、に基づいて、未補正の対地角度θｇｉ（ｋ）を補正するための補正量（フロントＩＭＵ５０Ｆの取付角度）θｃ（ｋ）を演算する。

図７は、制御装置１００により実行される演算処理の内容を示すフローチャートである。図７に示すフローチャートの処理は、例えば、図示しないイグニッションスイッチのオンにより開始され、図示しない初期設定が行われた後、所定の制御周期で繰り返し実行される。

図７に示すように、ステップＳ１１において、制御装置１００は、各種情報を取得し、ステップＳ１６へ進む。各種情報には、ＩＭＵ５０のＩＤ、ＩＭＵ５０の対地角度θｇｉ（ｊ）、フロント部材毎のストロークエンド状態フラグＦの設定情報等が含まれる。

ステップＳ１６において、制御装置１００は、ステップＳ１１で取得したフロントＩＭＵ５０ＦのＩＤに基づいて、フロントＩＭＵ５０Ｆが新しいものに交換されたか否かを判定する。ステップＳ１１で取得したフロントＩＭＵ５０Ｆの全てのＩＤが識別テーブル１２１に存在する場合、制御装置１００は、フロントＩＭＵ５０Ｆは交換されていないと判定し、ステップＳ２１へ進む。ステップＳ１１で取得したフロントＩＭＵ５０ＦのＩＤのうち、１つでも識別テーブル１２１に存在しない新たなＩＤがある場合、制御装置１００は、フロントＩＭＵ５０Ｆは交換されたと判定し、ステップＳ６０へ進む。

ステップＳ２１において、全てのフロントＩＭＵ５０Ｆに対する補正量が設定されているか否かを判定する。ステップＳ１１で取得したフロントＩＭＵ５０Ｆの全てのＩＤが補正量テーブル１２２に存在する場合、制御装置１００は、フロントＩＭＵ５０Ｆに対する補正量は設定されていると判定し、ステップＳ２３へ進む。ステップＳ１１で取得したフロントＩＭＵ５０ＦのＩＤのうち、１つでも補正量テーブル１２２に存在しない新たなＩＤがある場合、制御装置１００は、フロントＩＭＵ５０Ｆに対する補正量は設定されていないと判定し、ステップＳ７０へ進む。

ステップＳ２３において、制御装置１００は、補正量テーブル１２２を参照し、ステップＳ１１で取得したＩＭＵ５０のＩＤに関連付けられた補正量θｃ（ｊ）を取得し、ステップＳ２６へ進む。

ステップＳ２６において、制御装置１００は、ステップＳ１１で取得したＩＭＵ５０の対地角度θｇｉ（ｊ）と、ステップＳ２３で取得した補正量θｃ（ｊ）と、に基づいて、式（１）により、各部材の対地角度θｇ（ｊ）を演算し、ステップＳ３１へ進む。

ステップＳ３１において、制御装置１００は、ステップＳ２６で演算された各部材の対地角度θｇ（ｊ）に基づいて、式（２）により、部材間の相対角度（フロント部材角度θｒ（ｋ））を演算し、ステップＳ４０へ進む。

ステップＳ４０において、制御装置１００は、各フロント部材を駆動する油圧シリンダがストロークエンドの状態にあるか否かを判定する。ステップＳ１１で取得したストロークエンド状態フラグＦのうちオンに設定されているものがある場合、制御装置１００は、フラグＦがオンに設定されている油圧シリンダがストロークエンドの状態にあると判定し、ステップＳ５１へ進む。ステップＳ１１で取得したストロークエンド状態フラグＦのうちオンに設定されているものがない場合、制御装置１００は、各フロント部材を駆動する油圧シリンダがいずれもストロークエンドの状態にないと判定し、ステップＳ１１へ戻る。

ここで、図８を参照して、制御装置１００により実行されるストロークエンド状態フラグの設定処理の内容について説明する。図８は、制御装置１００により実行されるストロークエンド状態フラグの設定処理の内容を示すフローチャートである。図８に示すフローチャートの処理は、例えば、図示しないイグニッションスイッチのオンにより開始され、図示しない初期設定が行われた後、所定の制御周期で繰り返し実行される。

図８に示すように、ステップＳ４１において、制御装置１００は、パイロット圧センサ６０で検出されるパイロット圧力Ｐｐを取得し、ステップＳ４３へ進む。ステップＳ４３において、制御装置１００は、ステップＳ４１で取得したパイロット圧力Ｐｐのうち、閾値Ｐｐ０以上のものが１つであるか否かを判定する。ステップＳ４３において、パイロット圧力Ｐｐが閾値Ｐｐ０以上のものが１つであると判定された場合、ステップＳ４５へ進む。ステップＳ４３において、パイロット圧力Ｐｐが閾値Ｐｐ０以上のものが１つでないと判定された場合、ステップＳ４９へ進む。

ステップＳ４５において、制御装置１００は、ステップＳ４３において閾値Ｐｐ０以上のパイロット圧力Ｐｐによって操作されるフロント部材（油圧シリンダ）を特定し、ステップＳ４６へ進む。

ステップＳ４６において、制御装置１００は、シリンダ圧センサ７０で検出されたシリンダ圧力のうち、操作されているフロント部材を駆動する油圧シリンダの圧力Ｐａを取得し、ステップＳ４７へ進む。

ステップＳ４７において、制御装置１００は、ステップＳ４６で取得したシリンダ圧力Ｐａが閾値Ｐａ０以上であるか否かを判定する。ステップＳ４７において、シリンダ圧力Ｐａが閾値Ｐａ０以上であると判定されると、ステップＳ４８へ進む。ステップＳ４７において、シリンダ圧力Ｐａが閾値Ｐａ０未満であると判定されると、ステップＳ４９へ進む。

ステップＳ４８において、制御装置１００は、操作されているフロント部材に対応する油圧シリンダがストロークエンドの状態にあるとして、その油圧シリンダに対するストロークエンド状態フラグＦをオンに設定し、本制御周期における図８のフローチャートに示す処理を終了する。ステップＳ４９において、制御装置１００は、操作されているフロント部材に対応する油圧シリンダはストロークエンドの状態にないとして、その油圧シリンダに対するストロークエンド状態フラグＦをオフに設定し、本制御周期における図８のフローチャートに示す処理を終了する。

図８に示す処理により、ストロークエンド状態フラグＦがオンに設定されていると、図７に示すステップＳ４０において、油圧シリンダがストロークエンドの状態にあると判定され、ステップＳ５１へ進む。ステップＳ５１において、制御装置１００は、ストロークエンドの状態の油圧シリンダに対応するフロント部材の相対角度（すなわち、ストロークエンドの状態の油圧シリンダに対応する回動限界の状態のフロント部材と、そのフロント部材に回動限界状態で連結される部材と、の相対角度）θｒ（ｋ）と、その油圧シリンダに対応する回動限界の状態のフロント部材の部材名と、を関連付けて角度テーブル１２３に記憶し、本制御周期における図７のフローチャートに示す処理を終了する。

このように、制御装置１００は、フロント部材を駆動する油圧シリンダがストロークエンドの状態にあるか否かを監視し、油圧シリンダがストロークエンドの状態にあると判定されると、その油圧シリンダに対応するフロント部材の相対角度（すなわち、回動限界の状態のフロント部材とそのフロント部材が回動限界の状態で連結される部材との相対角度）θｒ（ｋ）を角度テーブル１２３に記憶する。このようにして記憶された相対角度θｒ（ｋ）、すなわちブーム限界角度θｒｘ１、アーム限界角度θｒｘ２及びバケット限界角度θｒｘ３は、フロントＩＭＵ５０Ｆが交換されたとき、交換されたフロントＩＭＵ５０Ｆに対する補正量θｃ（ｋ）を設定する際に使用される。

次に、フロントＩＭＵ５０Ｆが古いものから新しいものに交換された場合に、新しいフロントＩＭＵ５０Ｆに対する補正量、すなわち新しいＩＭＵ５０Ｆの出力信号から得られる対地角度θｇｉ（ｋ）を補正するための補正量θｃ（ｋ）を設定する処理（補正量設定処理）について説明する。

補正量設定処理に先立って、交換されたフロントＩＭＵ５０Ｆが取り付けられているフロント部材を特定する処理（取付部材特定処理）について説明する。図７に示すステップＳ１６において、フロントＩＭＵ５０Ｆが交換されたと判定されると、取付部材特定処理（Ｓ６０）が実行される。

図９を参照して、制御装置１００により実行される取付部材特定処理（Ｓ６０）の内容について説明する。図９は、制御装置１００により実行される取付部材特定処理（Ｓ６０）の内容を示すフローチャートである。図９に示すように、取付部材特定処理（Ｓ６０）が実行されると、まず、ステップＳ６１において、制御装置１００は、ステップＳ１１で取得したＩＤのうち識別テーブル１２１に存在しないＩＤ、すなわち交換されたフロントＩＭＵ５０のＩＤ（以下、新ＩＤとも記す）の数が１つであるか否かを判定する。ステップＳ６１において、新ＩＤの数が１つでないと判定されると、ステップＳ６２へ進む。ステップＳ６２において、制御装置１００は、交換されたフロントＩＭＵ５０Ｆの新ＩＤの数が２つであるか否かを判定する。

ステップＳ６１において、新ＩＤの数が１つであると判定されると、ステップＳ６３へ進む。ステップＳ６３において、制御装置１００は、取付部材特定（１部材）処理を実行する。この処理では、識別テーブル１２１に存在するＩＤのうち、ステップＳ１１で取得したＩＤと整合しなかったＩＤ（以下、未受信ＩＤとも記す）を新ＩＤに書き換える。つまり、ステップＳ６３では、交換後の新しいフロントＩＭＵ５０Ｆが取り付けられるフロント部材は、ブーム１１、アーム１２及びバケット１３のうち、未受信ＩＤに関連付けられたフロント部材であることが特定される。

ステップＳ６２において、新ＩＤの数が２つであると判定されると、ステップＳ６５へ進む。ステップＳ６５において、制御装置１００は、取付部材特定（２部材）処理（図１０参照）を実行する。ステップＳ６２において、新ＩＤの数が２つでないと判定されると、すなわち新ＩＤの数は３つであると判定されると、ステップＳ６７へ進む。ステップＳ６７において、制御装置１００は、取付部材特定（３部材）処理（図１１参照）を実行する。

図１０を参照して、制御装置１００により実行される取付部材特定（２部材）処理について説明する。図１０は、制御装置１００により実行される取付部材特定（２部材）処理の内容を示すフローチャートである。図１０に示すように、ステップＳ６５１において、制御装置１００は、識別テーブル１２１を参照し、未受信ＩＤに関連付けられている部材名（以下、不明部材名とも記す）に「バケット」があるか否かを判定する。ステップＳ６５１において、不明部材名に「バケット」があると判定されると、ステップＳ６５２へ進み、ステップＳ６５１において、不明部材名に「バケット」がないと判定されると、ステップＳ６６２へ進む。

ステップＳ６５２において、制御装置１００は、表示制御信号を表示装置１８に出力し、バケット１３の操作のみを指示する表示画像を表示装置１８の表示画面に表示させ、ステップＳ６５３へ進む。表示装置１８の表示画面に、バケット１３の操作のみを指示する表示画像が表示されるため、オペレータは、操作指示に従ってバケット１３のみを操作する。

ステップＳ６５３において、制御装置１００は、各フロントＩＭＵ５０ＦのＩＤ及びフロントＩＭＵ５０Ｆの対地角度θｇｉ（ｊ）を取得し、ステップＳ６５５へ進む。ステップＳ６５５において、制御装置１００は、対地角度θｇｉ（ｊ）が変化したフロントＩＭＵ５０ＦのＩＤと、部材名「バケット」とを関連付けて識別テーブル１２１に記憶し、ステップＳ６５７へ進む。本実施形態では、この記憶処理において、部材名「バケット」に関連付けられた未受信ＩＤを、対地角度θｇｉ（ｊ）が変化したフロントＩＭＵ５０Ｆの新ＩＤで書き換える。このように、ステップＳ６５５では、交換後の新しいフロントＩＭＵ５０Ｆのうちの一つが取り付けられるフロント部材が、バケット１３であることが特定される。

ステップＳ６６２において、制御装置１００は、表示制御信号を表示装置１８に出力し、アーム１２の操作のみを指示する表示画像を表示装置１８の表示画面に表示させ、ステップＳ６６３へ進む。表示装置１８の表示画面に、アーム１２の操作のみを指示する表示画像が表示されるため、オペレータは、操作指示に従ってアーム１２のみを操作する。

ステップＳ６６３において、制御装置１００は、各フロントＩＭＵ５０ＦのＩＤ及びフロントＩＭＵ５０Ｆの対地角度θｇｉ（ｊ）を取得し、ステップＳ６６５へ進む。ステップＳ６６５において、制御装置１００は、対地角度θｇｉ（ｊ）が変化したフロントＩＭＵ５０ＦのＩＤと、部材名「アーム」とを関連付けて識別テーブル１２１に記憶し、ステップＳ６６９へ進む。本実施形態では、この記憶処理において、部材名「アーム」に関連付けられた未受信ＩＤを、対地角度θｇｉ（ｊ）が変化したフロントＩＭＵ５０Ｆの新ＩＤで書き換える。このように、ステップＳ６６５では、交換後の新しいフロントＩＭＵ５０Ｆのうちの一つが取り付けられるフロント部材が、アーム１２であることが特定される。

ステップＳ６５７において、制御装置１００は、識別テーブル１２１を参照し、未受信ＩＤに関連付けられた不明部材名に「アーム」があるか否かを判定する。ステップＳ６５７において、不明部材名に「アーム」があると判定されると、ステップＳ６５９へ進み、ステップＳ６５７において、不明部材名に「アーム」がないと判定されると、ステップＳ６６９へ進む。

ステップＳ６５９において、制御装置１００は、新ＩＤのうち、ステップＳ６５５で特定されなかった残りの新ＩＤと、部材名「アーム」とを関連付けて識別テーブル１２１に記憶し、図１０に示す取付部材特定（２部材）処理を終了する。なお、本実施形態では、この記憶処理（ステップＳ６５９）において、部材名「アーム」に関連付けられた未受信ＩＤを、残りの新ＩＤで書き換える。このように、ステップＳ６５９では、交換後の新しいフロントＩＭＵ５０Ｆのうちの残りの一つが取り付けられるフロント部材が、アーム１２であることが特定される。

ステップＳ６６９において、制御装置１００は、新ＩＤのうち、ステップＳ６５５またはステップＳ６６５で特定されなかった残りの新ＩＤと、部材名「ブーム」とを関連付けて識別テーブル１２１に記憶し、図１０に示す取付部材特定（２部材）処理を終了する。なお、本実施形態では、この記憶処理（ステップＳ６６９）において、部材名「ブーム」に関連付けられた未受信ＩＤを、残りの新ＩＤで書き換える。このように、ステップＳ６６９では、交換後の新しいフロントＩＭＵ５０Ｆのうちの残りの一つが取り付けられるフロント部材が、ブーム１１であることが特定される。

図１１を参照して、制御装置１００により実行される取付部材特定（３部材）処理について説明する。図１１は、制御装置１００により実行される取付部材特定（３部材）処理の内容を示すフローチャートである。図１１に示すように、ステップＳ６７２において、制御装置１００は、表示制御信号を表示装置１８に出力し、バケット１３の操作のみを指示する表示画像を表示装置１８の表示画面に表示させ、ステップＳ６７３へ進む。表示装置１８の表示画面に、バケット１３の操作のみを指示する表示画像が表示されるため、オペレータは、操作指示に従ってバケット１３のみを操作する。

ステップＳ６７３において、制御装置１００は、各フロントＩＭＵ５０ＦのＩＤ及びフロントＩＭＵ５０Ｆの対地角度θｇｉ（ｊ）を取得し、ステップＳ６７５へ進む。ステップＳ６７５において、制御装置１００は、対地角度θｇｉ（ｊ）が変化したフロントＩＭＵ５０ＦのＩＤと、部材名「バケット」とを関連付けて識別テーブル１２１に記憶し、ステップＳ６８２へ進む。本実施形態では、この記憶処理において、部材名「バケット」に関連付けられた未受信ＩＤを、対地角度θｇｉ（ｊ）が変化したフロントＩＭＵ５０Ｆの新ＩＤで書き換える。このように、ステップＳ６７５では、交換後の新しいフロントＩＭＵ５０Ｆのうちの一つが取り付けられるフロント部材が、バケット１３であることが特定される。

ステップＳ６８２において、制御装置１００は、表示制御信号を表示装置１８に出力し、アーム１２の操作のみを指示する表示画像を表示装置１８の表示画面に表示させ、ステップＳ６８３へ進む。表示装置１８の表示画面に、アーム１２の操作のみを指示する表示画像が表示されるため、オペレータは、操作指示に従ってアーム１２のみを操作する。

ステップＳ６８３において、制御装置１００は、各フロントＩＭＵ５０ＦのＩＤ及びフロントＩＭＵ５０Ｆの対地角度θｇｉ（ｊ）を取得し、ステップＳ６８５へ進む。ステップＳ６８５において、制御装置１００は、対地角度θｇｉ（ｊ）が変化したフロントＩＭＵ５０ＦのＩＤと、部材名「アーム」とを関連付けて識別テーブル１２１に記憶し、ステップＳ６８９へ進む。このように、ステップＳ６８５では、交換後の新しいフロントＩＭＵ５０Ｆのうちの一つが取り付けられるフロント部材が、アーム１２であることが特定される。

ステップＳ６８９において、制御装置１００は、新ＩＤのうち、ステップＳ６７５及びステップＳ６８５で特定されなかった残りの新ＩＤと、部材名「ブーム」とを関連付けて識別テーブル１２１に記憶し、図１１に示す取付部材特定（３部材）処理を終了する。なお、本実施形態では、この記憶処理（ステップＳ６８９）において、部材名「ブーム」に関連付けられた未受信ＩＤを、残りの新ＩＤで書き換える。このように、ステップＳ６８９では、交換後の新しいフロントＩＭＵ５０Ｆのうちの残りの一つが取り付けられるフロント部材が、ブーム１１であることが特定される。

以上のとおり、取付部材特定処理（Ｓ６０）が実行されることにより、新ＩＤと、そのＩＤに対応する部材名が識別テーブル１２１に記憶されるが、交換されたフロントＩＭＵ５０Ｆに対する補正量は未だ設定されていない。次に、交換されたフロントＩＭＵ５０Ｆに対する補正量を設定する処理（補正量設定処理）について説明する。図７に示すステップＳ２１において、ＩＭＵ５０の補正量が設定されていないと判定されると、補正量設定処理（Ｓ７０）が実行される。

図１２を参照して、制御装置１００により実行される補正量設定処理（Ｓ７０）の内容について説明する。図１２は、制御装置１００により実行される補正量設定処理（Ｓ７０）の内容を示すフローチャートである。図１２に示すように、補正量設定処理（Ｓ７０）が実行されると、まず、ステップＳ７１において、制御装置１００は、ステップＳ１１で取得したＩＤのうち補正量テーブル１２２に存在しないＩＤ、すなわち補正量が設定されていないＩＤである未設定ＩＤの数が１つであるか否かを判定する。ステップＳ７１において、未設定ＩＤの数が１つでないと判定されると、ステップＳ７２へ進む。ステップＳ７２において、制御装置１００は、未設定ＩＤの数が２つであるか否かを判定する。

ステップＳ７１において、未設定ＩＤの数が１つであると判定されると、ステップＳ１１０へ進む。ステップＳ１１０において、制御装置１００は、補正量設定処理（１部材）処理（図１３参照）を実行する。ステップＳ７２において、未設定ＩＤの数が２つであると判定されると、ステップＳ１２０へ進む。ステップＳ１２０において、制御装置１００は、補正量設定（２部材）処理（図１７参照）を実行する。ステップＳ７２において、未設定ＩＤの数が２つでないと判定されると、すなわち未設定ＩＤの数は３つであると判定されると、ステップＳ１３０へ進む。ステップＳ１３０において、制御装置１００は、補正量設定（３部材）処理（図１８参照）を実行する。

図１３を参照して、制御装置１００により実行される補正量設定（１部材）処理について説明する。図１３は、制御装置１００により実行される補正量設定（１部材）処理の内容を示すフローチャートである。図１３に示すように、ステップＳ１１０１において、制御装置１００は、識別テーブル１２１を参照し、未設定ＩＤに関連付けられている部材名（以下、未設定部材名とも記す）に「ブーム」があるか否かを判定する。ステップＳ１１０１において、未設定部材名に「ブーム」がないと判定されると、ステップＳ１１０２へ進む。ステップＳ１１０２において、制御装置１００は、識別テーブル１２１を参照し、未設定部材名に「アーム」があるか否かを判定する。

ステップＳ１１０１において、未設定部材名に「ブーム」があると判定されると、ステップＳ１１１０へ進む。ステップＳ１１１０において、制御装置１００は、ブームＩＭＵ５０ａの対地角度θｇｉ（１）を補正するための補正量θｃ（１）を設定する処理（ブームＩＭＵの補正量設定処理）を実行する（図１４参照）。ステップＳ１１０２において、未設定部材名に「アーム」があると判定されると、ステップＳ１１４０へ進む。ステップＳ１１４０において、制御装置１００は、アームＩＭＵ５０ｂの対地角度θｇｉ（２）を補正するための補正量θｃ（２）を設定する処理（アームＩＭＵの補正量設定処理）を実行する（図１５参照）。ステップＳ１１０２において、未設定部材名に「アーム」がないと判定されると、すなわち未設定部材名に「バケット」があると判定されると、ステップＳ１１７０へ進む。ステップＳ１１７０において、制御装置１００は、バケットＩＭＵ５０ｃの対地角度θｇｉ（３）を補正するための補正量θｃ（３）を設定する処理（バケットＩＭＵの補正量設定処理）を実行する（図１６参照）。

図１４を参照して、制御装置１００により実行されるブームＩＭＵの補正量設定処理（Ｓ１１１０）の内容について説明する。図１４は、制御装置１００により実行されるブームＩＭＵの補正量設定処理（Ｓ１１１０）の内容を示すフローチャートである。なお、ブームＩＭＵの補正量設定処理（Ｓ１１１０）における補正量の演算は、ブームシリンダ１１ａを第１のストロークエンド状態（すなわち、ブーム１１を第１の回動限界の状態）にしてから行ってもよいし、ブームシリンダ１１ａを第２のストロークエンド状態（すなわち、ブーム１１を第２の回動限界の状態）にしてから行ってもよいが、以下では、前者の場合の例について説明する。

図１４に示すように、ステップＳ１１１１において、制御装置１００は、角度テーブル１２３からブーム限界角度θｒｘ１（θｒｘ１１）と、旋回体ＩＭＵ５０ｄから旋回体ＩＭＵ５０ｄの対地角度θｇｉ（０）と、補正量テーブル１２２から旋回体ＩＭＵ５０ｄに対する補正量θｃ（０）と、を取得し、ステップＳ１１１４に進む。

ステップＳ１１１４において、制御装置１００は、表示制御信号を表示装置１８に出力し、ブームシリンダ１１ａがストロークエンド（第１のストロークエンド）の状態となるまでブーム１１を操作させる操作指示を表す表示画像を表示装置１８の表示画面に表示させ、ステップＳ１１１７へ進む。表示装置１８の表示画面に、ブームシリンダ１１ａがストロークエンド（第１のストロークエンド）の状態となるまでブーム１１を操作させる操作指示を表す表示画像が表示されるため、オペレータは、操作指示に従ってブーム１１の操作（ブーム上げ操作）を行う。

ステップＳ１１１７において、制御装置１００は、ストロークエンド状態フラグＦの情報及びストロークエンドの状態の油圧シリンダに対応するフロント部材（すなわち、回動限界の状態にあるフロント部材）の部材名の情報を取得し、ステップＳ１１２０へ進む。ステップＳ１１２０において、制御装置１００は、ステップＳ１１１７で取得した情報に基づいて、ブームシリンダ１１ａがストロークエンドの状態（第１のストロークエンドの状態）であるか否かを判定する。ステップＳ１１２０において、ブームシリンダ１１ａがストロークエンドの状態（第１のストロークエンドの状態）であると判定されると、ステップＳ１１２３へ進み、ブームシリンダ１１ａはストロークエンドの状態（第１のストロークエンドの状態）でないと判定されると、ステップＳ１１１７へ戻る。

ステップＳ１１２３において、制御装置１００は、旋回体ＩＭＵ５０ｄの対地角度θｇ（０）と補正量θｃ（０）に基づいて、式（１）により旋回体３の対地角度θｇ（０）を演算する。また、ステップＳ１１２３において、制御装置１００は、ブームＩＭＵ５０ａの出力信号からブームＩＭＵ５０ａの対地角度θｇｉ（１）を取得し、ステップＳ１１２６へ進む。

ステップＳ１１２６において、制御装置１００は、ステップＳ１１１１で取得したストロークエンドの状態（第１のストロークエンドの状態）におけるブーム角度θｒ（１）＝θｒｘ１（θｒｘ１１）と、ステップＳ１１２３で取得したブームＩＭＵ５０ａの対地角度θｇｉ（１）と、ステップＳ１１２３で演算した旋回体３の対地角度θｇ（０）と、に基づいて、式（３）により補正量θｃ（１）を演算し、ステップＳ１１２９へ進む。

ステップＳ１１２９において、制御装置１００は、識別テーブル１２１において「ブーム」に関連付けられた未設定ＩＤと、ステップＳ１１２６で演算された補正量θｃ（１）とを関連付けて補正量テーブル１２２に記憶し、図１４に示すブームＩＭＵの補正量設定処理を終了する。なお、図１４に示す処理は、ブームシリンダ１１ａを第２のストロークエンドの状態にして行う場合も同様であるため、説明を省略する。

図１５を参照して、制御装置１００により実行されるアームＩＭＵの補正量設定処理（Ｓ１１４０）の内容について説明する。図１５は、制御装置１００により実行されるアームＩＭＵの補正量設定処理（Ｓ１１４０）の内容を示すフローチャートである。なお、アームＩＭＵの補正量設定処理（Ｓ１１４０）における補正量の演算は、アームシリンダ１２ａを第１のストロークエンド状態（すなわち、アーム１２を第１の回動限界の状態）にしてから行ってもよいし、アームシリンダ１２ａを第２のストロークエンド状態（すなわち、アーム１２を第２の回動限界の状態）にしてから行ってもよいが、以下では、前者の場合の例について説明する。

図１５に示すように、ステップＳ１１４１において、制御装置１００は、角度テーブル１２３からアーム限界角度θｒｘ２（θｒｘ２１）と、ブームＩＭＵ５０ａからブームＩＭＵ５０ａの対地角度θｇｉ（１）と、補正量テーブル１２２からブームＩＭＵ５０ａに対する補正量θｃ（１）と、を取得し、ステップＳ１１４４に進む。

ステップＳ１１４４において、制御装置１００は、表示制御信号を表示装置１８に出力し、アームシリンダ１２ａがストロークエンド（第１のストロークエンド）の状態となるまでアーム１２を操作させる操作指示を表す表示画像を表示装置１８の表示画面に表示させ、ステップＳ１１４７へ進む。表示装置１８の表示画面に、アームシリンダ１２ａがストロークエンド（第１のストロークエンド）の状態となるまでアーム１２を操作させる操作指示を表す表示画像が表示されるため、オペレータは、操作指示に従ってアーム１２の操作（アームダンプ操作）を行う。

ステップＳ１１４７において、制御装置１００は、ストロークエンド状態フラグＦの情報及びストロークエンドの状態の油圧シリンダに対応するフロント部材（すなわち、回動限界の状態にあるフロント部材）の部材名の情報を取得し、ステップＳ１１５０へ進む。ステップＳ１１５０において、制御装置１００は、ステップＳ１１４７で取得した情報に基づいて、アームシリンダ１２ａがストロークエンドの状態（第１のストロークエンドの状態）であるか否かを判定する。ステップＳ１１５０において、アームシリンダ１２ａがストロークエンドの状態（第１のストロークエンドの状態）であると判定されると、ステップＳ１１５３へ進み、アームシリンダ１２ａはストロークエンドの状態（第１のストロークエンドの状態）でないと判定されると、ステップＳ１１４７へ戻る。

ステップＳ１１５３において、制御装置１００は、ブームＩＭＵ５０ａの対地角度θｇｉ（１）と補正量θｃ（１）に基づいて、式（１）によりブーム１１の対地角度θｇ（１）を演算する。また、ステップＳ１１５３において、制御装置１００は、アームＩＭＵ５０ｂの出力信号からアームＩＭＵ５０ｂの対地角度θｇｉ（２）を取得し、ステップＳ１１５６へ進む。

ステップＳ１１５６において、制御装置１００は、ステップＳ１１４１で取得したストロークエンドの状態（第１のストロークエンドの状態）におけるアーム角度θｒ（２）＝θｒｘ２（θｒｘ２１）と、ステップＳ１１５３で取得したアームＩＭＵ５０ｂの対地角度θｇｉ（２）と、ステップＳ１１５３で演算したブーム１１の対地角度θｇ（１）と、に基づいて、式（３）により補正量θｃ（２）を演算し、ステップＳ１１５９へ進む。

ステップＳ１１５９において、制御装置１００は、識別テーブル１２１において「アーム」に関連付けられた未設定ＩＤと、ステップＳ１１５６で演算された補正量θｃ（２）とを関連付けて補正量テーブル１２２に記憶し、図１５に示すアームＩＭＵの補正量設定処理を終了する。なお、図１５に示す処理は、アームシリンダ１２ａを第２のストロークエンドの状態にして行う場合も同様であるため、説明を省略する。

図１６を参照して、制御装置１００により実行されるバケットＩＭＵの補正量設定処理（Ｓ１１７０）の内容について説明する。図１６は、制御装置１００により実行されるバケットＩＭＵの補正量設定処理（Ｓ１１７０）の内容を示すフローチャートである。なお、バケットＩＭＵの補正量設定処理（Ｓ１１７０）における補正量の演算は、バケットシリンダ１３ａを第１のストロークエンド状態（すなわち、バケット１３を第１の回動限界の状態）にしてから行ってもよいし、バケットシリンダ１３ａを第２のストロークエンド状態（すなわち、バケット１３を第２の回動限界の状態）にしてから行ってもよいが、以下では、前者の場合の例について説明する。

図１６に示すように、ステップＳ１１７１において、制御装置１００は、角度テーブル１２３からバケット限界角度θｒｘ３（θｒｘ３１）と、アームＩＭＵ５０ｂからアームＩＭＵ５０ｂの対地角度θｇｉ（２）と、補正量テーブル１２２からアームＩＭＵ５０ｂに対する補正量θｃ（２）と、を取得し、ステップＳ１１７４に進む。

ステップＳ１１７４において、制御装置１００は、表示制御信号を表示装置１８に出力し、バケットシリンダ１３ａがストロークエンド（第１のストロークエンド）の状態となるまでバケット１３を操作させる操作指示を表す表示画像を表示装置１８の表示画面に表示させ、ステップＳ１１７７へ進む。表示装置１８の表示画面に、バケットシリンダ１３ａがストロークエンド（第１のストロークエンド）の状態となるまでバケット１３を操作させる操作指示を表す表示画像が表示されるため、オペレータは、操作指示に従ってバケット１３の操作（バケットダンプ操作）を行う。

ステップＳ１１７７において、制御装置１００は、ストロークエンド状態フラグＦの情報及びストロークエンドの状態の油圧シリンダに対応するフロント部材（すなわち、回動限界の状態にあるフロント部材）の部材名の情報を取得し、ステップＳ１１８０へ進む。ステップＳ１１８０において、制御装置１００は、ステップＳ１１７７で取得した情報に基づいて、バケットシリンダ１３ａがストロークエンドの状態（第１のストロークエンドの状態）であるか否かを判定する。ステップＳ１１８０において、バケットシリンダ１３ａがストロークエンドの状態（第１のストロークエンドの状態）であると判定されると、ステップＳ１１８３へ進み、バケットシリンダ１３ａはストロークエンドの状態（第１のストロークエンドの状態）でないと判定されると、ステップＳ１１７７へ戻る。

ステップＳ１１８３において、制御装置１００は、アームＩＭＵ５０ｂの対地角度θｇｉ（２）と補正量θｃ（２）に基づいて、式（１）によりアーム１２の対地角度θｇ（２）を演算する。また、ステップＳ１１８３において、制御装置１００は、バケットＩＭＵ５０ｃの出力信号からバケットＩＭＵ５０ｃの対地角度θｇｉ（３）を取得し、ステップＳ１１８６へ進む。

ステップＳ１１８６において、制御装置１００は、ステップＳ１１７１で取得したストロークエンドの状態（第１のストロークエンドの状態）におけるバケット角度θｒ（３）＝θｒｘ３（θｒｘ３１）と、ステップＳ１１８３で取得したバケットＩＭＵ５０ｃの対地角度θｇｉ（３）と、ステップＳ１１８３で演算したアーム１２の対地角度θｇ（２）と、に基づいて、式（３）により補正量θｃ（３）を演算し、ステップＳ１１８９へ進む。

ステップＳ１１８９において、制御装置１００は、識別テーブル１２１において「バケット」に関連付けられた未設定ＩＤと、ステップＳ１１８６で演算された補正量θｃ（３）とを関連付けて補正量テーブル１２２に記憶し、図１６に示すバケットＩＭＵの補正量設定処理を終了する。なお、図１６に示す処理は、バケットシリンダ１３ａを第２のストロークエンドの状態にして行う場合も同様であるため、説明を省略する。

図１７を参照して、制御装置１００により実行される補正量設定（２部材）処理について説明する。図１７は、制御装置１００により実行される補正量設定（２部材）処理の内容を示すフローチャートである。図１７に示すように、ステップＳ１２０１において、制御装置１００は、識別テーブル１２１を参照し、未設定ＩＤに関連付けられている部材名である未設定部材名に「ブーム」があるか否かを判定する。

ステップＳ１２０１において、未設定部材名に「ブーム」があると判定されると、ステップＳ１２０４へ進み、ブームＩＭＵの補正量設定処理を実行する。ステップＳ１２０４におけるブームＩＭＵの補正量設定処理は、上述したブームＩＭＵの補正量設定処理（Ｓ１１１０）と同様であるため、説明を省略する。

ステップＳ１２０１において、未設定部材名に「ブーム」がないと判定されると、ステップＳ１２１１へ進み、アームＩＭＵの補正量設定処理を実行する。ステップＳ１２１１におけるアームＩＭＵの補正量設定処理は、上述したアームＩＭＵの補正量設定処理（Ｓ１１４０）と同様であるため、説明を省略する。

ステップＳ１２０４において、ブームＩＭＵの補正量設定処理が終了すると、ステップＳ１２０７へ進む。ステップＳ１２０７において、制御装置１００は、識別テーブル１２１を参照し、未設定ＩＤに関連付けられている部材名である未設定部材名に「アーム」があるか否かを判定する。

ステップＳ１２０７において、未設定部材名に「アーム」があると判定されると、ステップＳ１２０９へ進み、アームＩＭＵの補正量設定処理を実行する。ステップＳ１２０９におけるアームＩＭＵの補正量設定処理は、上述したアームＩＭＵの補正量設定処理（Ｓ１１４０）と同様であるため、説明を省略する。

ステップＳ１２０７において、未設定部材名に「アーム」がないと判定されると、すなわち未設定部材名に「バケット」があると判定されると、ステップＳ１２１５へ進み、バケットＩＭＵの補正量設定処理を実行する。ステップＳ１２１５におけるバケットＩＭＵの補正量設定処理は、上述したバケットＩＭＵの補正量設定処理（Ｓ１１７０）と同様であるため、説明を省略する。

アームＩＭＵの補正量設定処理（Ｓ１２０９）またはバケットＩＭＵの補正量設定処理（Ｓ１２１５）が終了すると、図１７に示す補正量設定（２部材）処理を終了する。

図１８を参照して、制御装置１００により実行される補正量設定（３部材）処理について説明する。図１８は、制御装置１００により実行される補正量設定（３部材）処理の内容を示すフローチャートである。

図１８に示すように、補正量設定（３部材）処理では、ステップＳ１３０１において、制御装置１００は、設定済みの補正量θｃ（０）によって得られる旋回体３の対地角度θｇ（０）に基づいて、未設定のブームＩＭＵ５０ａの補正量θｃ（１）を設定するためのブームＩＭＵの補正量設定処理を実行する。ステップＳ１３０１におけるブームＩＭＵの補正量設定処理は、上述したブームＩＭＵの補正量設定処理（Ｓ１１１０）と同様であるため、説明を省略する。

ブームＩＭＵの補正量設定処理（Ｓ１３０１）が終了すると、ステップＳ１３０４へ進む。ステップＳ１３０４において、制御装置１００は、ステップＳ１３０１で設定済みの補正量θｃ（１）によって得られるブーム１１の対地角度θｇ（１）に基づいて、未設定のアームＩＭＵ５０ｂの補正量θｃ（２）を設定するためのアームＩＭＵの補正量設定処理を実行する。ステップＳ１３０４におけるアームＩＭＵの補正量設定処理は、上述したアームＩＭＵの補正量設定処理（Ｓ１１４０）と同様であるため、説明を省略する。

アームＩＭＵの補正量設定処理（Ｓ１３０４）が終了すると、ステップＳ１３０７へ進む。ステップＳ１３０７において、制御装置１００は、ステップＳ１３０４で設定済みの補正量θｃ（２）によって得られるアーム１２の対地角度θｇ（２）に基づいて、未設定のバケットＩＭＵ５０ｃの補正量θｃ（３）を設定するためのバケットＩＭＵの補正量設定処理を実行する。ステップＳ１３０７におけるバケットＩＭＵの補正量設定処理は、上述したバケットＩＭＵの補正量設定処理（Ｓ１１７０）と同様であるため、説明を省略する。

バケットＩＭＵの補正量設定処理（Ｓ１３０７）が終了すると、図１８に示す補正量設定（３部材）処理を終了する。

上述した実施形態によれば、次の作用効果を奏する。

（１）作業機械が備える制御装置１００は、姿勢センサ（フロントＩＭＵ５０Ｆ）が交換されたか否かを判定し、姿勢センサ（フロントＩＭＵ５０Ｆ）が交換されたと判定された場合、交換されたと判定された姿勢センサ（フロントＩＭＵ５０Ｆ）が取り付けられているフロント部材（例えばブーム１１）を特定する。制御装置１００は、特定されたフロント部材（例えばブーム１１）に対応する油圧シリンダ（例えばブームシリンダ１１ａ）がストロークエンドの状態にあるか否かを判定し、特定されたフロント部材（例えばブーム１１）に対応する油圧シリンダ（例えばブームシリンダ１１ａ）がストロークエンドの状態にあると判定されると、特定されたフロント部材（例えばブーム１１）に取り付けられた姿勢センサ（例えばブームＩＭＵ５０ａ）の出力信号から得られる角度情報（例えばブームＩＭＵ５０ａの対地角度θｇｉ（１））と、記憶装置１２０に記憶されている特定されたフロント部材（例えばブーム１１）の相対角度（例えば、ブーム１１とブーム１１に回動限界の状態で連結される旋回体３（部材）との相対角度であるブーム角度θｒ（１））と、に基づいて、角度情報（例えばブームＩＭＵ５０ａの対地角度θｇｉ（１））を補正するための補正量（例えばθｃ（１））を演算し、記憶装置１２０に記憶する。

つまり、本実施形態では、姿勢センサ（フロントＩＭＵ５０）を交換した場合に、作業機械（油圧ショベル１）が備える制御装置１００によって、補正量θｃ（ｋ）の演算が可能であるため、姿勢センサ（フロントＩＭＵ５０Ｆ）の交換の都度、測量装置による測量作業によって補正量θｃ（ｋ）を計測する必要がない。したがって、本実施形態によれば、姿勢センサ（フロントＩＭＵ５０Ｆ）の交換に伴うキャリブレーション作業に要する時間を短縮することができる。その結果、作業現場において姿勢センサ（フロントＩＭＵ５０Ｆ）を交換する場合であっても、キャリブレーション作業に起因して、工期が延びてしまうことを防止することができる。

（２）そして、掘削作業時には、制御装置１００は、交換後の新たな姿勢センサ（フロントＩＭＵ５０Ｆ）の出力信号から得られる角度情報（未補正の対地角度θｇｉ（ｋ）を補正量θｃ（ｋ）で補正し、補正した角度情報（補正済みの対地角度θｇ（ｋ））から得られるフロント部材角度（相対角度θｒ（ｋ））に基づいて、作業装置（フロント作業装置）１０の動作を制御する。例えば、補正されたフロント部材角度θｒは、バケット１３の先端等の位置の演算に用いられ、その演算結果に基づいて、フロント作業装置１０の動作の制御（マシンコントロール）が行われる。本実施形態によれば、フロントＩＭＵ５０Ｆが交換された場合に、補正量を精度よく演算することができるので、フロント作業装置１０の動作の制御についても、長期に亘って精度よく制御することができる。

（３）制御装置１００は、フロント部材の相対角度（すなわち、フロント部材とそのフロント部材に連結される部材との相対角度）を演算し、油圧シリンダ（例えばブームシリンダ１１ａ）がストロークエンドの状態にあると判定されると、その油圧シリンダに対応するフロント部材（例えばブーム１１）の相対角度θｒ（ｋ）を記憶装置１２０に記憶する。したがって、油圧ショベル１を長期間に亘って使用すること等に起因して、油圧シリンダがストロークエンドの状態となったときのフロント部材の相対角度にずれが生じた場合であっても、フロントＩＭＵ５０を交換した場合に、補正量を精度よく演算することができる。

＜第２実施形態＞
図１９及び図２０を参照して、第２実施形態に係る油圧ショベル２０１について説明する。なお、図中、第１実施形態と同一もしくは相当部分には同一の参照番号を付し、相違点を主に説明する。図１９は、第２実施形態に係る油圧ショベル２０１の姿勢について説明する図である。第１実施形態では、姿勢センサとして、フロント部材の対地角度を取得するための対地角センサ（フロントＩＭＵ５０Ｆ）が各フロント部材に取り付けられる例について説明したが、本発明はこれに限定されない。

上記第１実施形態で説明した対地角センサ（フロントＩＭＵ５０Ｆ）に代えて、回転角センサを各フロント部材に取り付けるようにしてもよい。回転角センサを設ける場合にも、その取付角度によっては、回転角センサの出力信号から得られる回転角度と、実際のフロント部材の回転角度との間に差が生じるため、取付角度に応じた補正量による補正が必要である。以下、姿勢センサが、フロント部材の回転角度を取得するための回転角センサである場合について説明する。

図１９に示すように、第２実施形態に係る油圧ショベル２０１は、フロント部材の姿勢情報（回転角度）を取得する複数の姿勢センサとしての回転角センサ２５０と、油圧ショベル２０１の各部の動作を制御する制御装置２００と、を備える。ブーム１１の回動支点に設けられる回転角センサ２５０は、ブーム角度θｒ（１）に応じた信号（電圧）を制御装置２００に出力するポテンショメータであり、ブーム角センサ２５０ａとも記す。アーム１２の回動支点に設けられる回転角センサ２５０は、アーム角度θｒ（２）に応じた信号（電圧）を制御装置２００に出力するポテンショメータであり、アーム角センサ２５０ｂとも記す。バケット１３の回動支点に設けられる回転角センサ２５０は、バケット角度θｒ（３）に応じた信号（電圧）を制御装置２００に出力するポテンショメータである。

制御装置２００は、上記第１実施形態と同様、回転角センサ（姿勢センサ）２５０が交換されたか否かを判定し、回転角センサ（姿勢センサ）２５０が交換されたと判定された場合、交換されたと判定された新たな回転角センサ（姿勢センサ）２５０が取り付けられているフロント部材を特定する。

制御装置２００は、特定されたフロント部材に対応する油圧シリンダがストロークエンドの状態にあると判定されると、特定されたフロント部材に取り付けられた回転角センサ（姿勢センサ）２５０の出力信号（電圧）から得られる角度情報である未補正の回転角度θｒｕ（ｋ）と、記憶装置１２０に記憶されている特定されたフロント部材の相対角度（すなわち、特定されたフロント部材と、その特定されたフロント部材に回動限界の状態で連結される部材との相対角度）θｒ（ｋ）と、の差を、未補正の回転角度θｒｕ（ｋ）を補正するための補正量θｃ（ｋ）として設定する。つまり、補正量θｃ（ｋ）は、次式（４）で表される。

θｃ（ｋ）＝θｒｕ（ｋ）−θｒ（ｋ） ・・・（４）

図２０を参照して、制御装置２００により実行される補正量設定処理について説明する。図２０は、制御装置２００により実行される補正量設定処理の内容を示すフローチャートである。

制御装置２００は、各フロント部材の回転角センサ２５０が交換されたと判定された場合、上記第１実施形態と同様の取付部材特定処理を実行し、その後、図２０に示す補正量設定処理を実行する。

図２０に示すように、ステップＳ２１０において、制御装置２００は、表示制御信号を表示装置１８に出力し、未設定部材を駆動する油圧シリンダがストロークエンドの状態となるまで未設定部材を操作させる操作指示を表す表示画像を表示装置１８の表示画面に表示させ、ステップＳ２２０へ進む。例えば、ブーム角センサ２５０ａ、アーム角センサ２５０ｂ及びバケット角センサ２５０ｃが全て交換された場合、表示装置１８の表示画面には、ブームシリンダ１１ａ，アームシリンダ１２ａ及びバケットシリンダ１３ａがストロークエンドの状態となるまで、ブーム１１、アーム１２及びバケット１３を操作させる操作指示を表す表示画像が表示される。

操作指示の表示処理が完了すると、制御装置２００は、ステップＳ２２２からステップＳ２４８までの処理を繰り返し行うループ処理を実行する（ステップＳ２２０，Ｓ２６０）。このループ処理は、交換された全ての回転角センサ２５０に対する補正量の設定が完了すると終了し、ループ処理が終了すると図２０に示す補正量設定処理が終了する。

ループ処理では、ステップＳ２２２において、制御装置２００は、ストロークエンド状態フラグＦの情報及びストロークエンドの状態にある油圧シリンダに対応するフロント部材（すなわち、回動限界の状態にあるフロント部材）の部材名の情報を取得し、それらの情報に基づいて、ブームシリンダ１１ａがストロークエンドの状態にあるか否か（すなわち、ブーム１１が回動限界の状態にあるか否か）を判定する。ステップＳ２２２において、ブームシリンダ１１ａがストロークエンドの状態にあると判定されると、ステップＳ２２５へ進み、ブームシリンダ１１ａはストロークエンドの状態にないと判定されると、ステップＳ２６０へ進む。

ステップＳ２２５において、制御装置２００は、ブーム角センサ２５０ａの出力信号から得られた未補正の回転角度θｒｕ（１）と、角度テーブル１２３に記憶されている回動限界の状態におけるブーム１１の相対角度（すなわち、ストロークエンドの状態にあるブームシリンダ１１ａに対応するブーム１１の相対角度）であるブーム角度θｒ（１）（＝ブーム限界角度θｒｘ１）と、に基づいて、式（４）により補正量θｃ（１）を演算し、補正量テーブル１２２に記憶する。

ステップＳ２２５において、ブーム角センサ２５０ａに対する補正量θｃ（１）の設定が完了すると、ステップＳ２２８へ進み、表示装置１８の表示画面に表示されている表示画像のうち、ブーム１１に対する操作指示の表示画像を非表示化し、ステップＳ２３２へ進む。

ステップＳ２３２において、制御装置２００は、ストロークエンド状態フラグＦの情報及びストロークエンドの状態にある油圧シリンダに対応するフロント部材（すなわち、回動限界の状態にあるフロント部材）の部材名の情報を取得し、それらの情報に基づいて、アームシリンダ１２ａがストロークエンドの状態にあるか否か（すなわち、アーム１２が回動限界の状態にあるか否か）を判定する。ステップＳ２３２において、アームシリンダ１２ａがストロークエンドの状態にあると判定されると、ステップＳ２３５へ進み、アームシリンダ１２ａはストロークエンドの状態にないと判定されると、ステップＳ２６０へ進む。

ステップＳ２３５において、制御装置２００は、アーム角センサ２５０ｂの出力信号から得られた未補正の回転角度θｒｕ（２）と、角度テーブル１２３に記憶されている回動限界の状態におけるアーム１２の相対角度（すなわち、ストロークエンドの状態にあるアームシリンダ１２ａに対応するアーム１２の相対角度）であるアーム角度θｒ（２）（＝アーム限界角度θｒｘ２）と、に基づいて、式（４）により補正量θｃ（２）を演算し、補正量テーブル１２２に記憶する。

ステップＳ２３５において、アーム角センサ２５０ｂに対する補正量θｃ（２）の設定が完了すると、ステップＳ２３８へ進み、表示装置１８の表示画面に表示されている表示画像のうち、アーム１２に対する操作指示の表示画像を非表示化し、ステップＳ２４２へ進む。

ステップＳ２４２において、制御装置２００は、ストロークエンド状態フラグＦの情報及びストロークエンドの状態にある油圧シリンダに対応するフロント部材（すなわち、回動限界の状態にあるフロント部材）の部材名の情報を取得し、それらの情報に基づいて、バケットシリンダ１３ａがストロークエンドの状態にあるか否か（すなわち、バケット１３が回動限界の状態にあるか否か）を判定する。ステップＳ２４２において、バケットシリンダ１３ａがストロークエンドの状態にあると判定されると、ステップＳ２４５へ進み、バケットシリンダ１３ａはストロークエンドの状態にないと判定されると、ステップＳ２６０へ進む。

ステップＳ２４５において、制御装置２００は、バケット角センサ２５０ｃの出力信号から得られた未補正の回転角度θｒｕ（３）と、角度テーブル１２３に記憶されている回動限界の状態におけるバケット１３の相対角度（すなわち、ストロークエンドの状態にあるバケットシリンダ１３ａに対応するバケット１３の相対角度）であるバケット角度θｒ（３）（＝バケット限界角度θｒｘ３）と、に基づいて、式（４）により補正量θｃ（３）を演算し、補正量テーブル１２２に記憶する。

ステップＳ２４５において、バケット角センサ２５０ｃに対する補正量θｃ（３）の設定が完了すると、ステップＳ２４８へ進み、表示装置１８の表示画面に表示されている表示画像のうち、バケット１３に対する操作指示の表示画像を非表示化し、ステップＳ２６０へ進む。

このような第２実施形態によれば、第１実施形態と同様の作用効果を奏する。

次のような変形例も本発明の範囲内であり、変形例に示す構成と上述の実施形態で説明した構成を組み合わせたり、上述の異なる実施形態で説明した構成同士を組み合わせたり、以下の異なる変形例で説明する構成同士を組み合わせることも可能である。

＜変形例１＞
第１実施形態では、未設定部材に取り付けられる姿勢センサに対する補正量θｃ（ｋ）は、未設定部材の基端側で連結されている基端側の部材の対地角度θｇ（ｋ−１）と、記憶装置１２０に記憶されている未設定部材とその未設定部材の基端側で連結されている部材との相対角度θｒ（ｋ）と、に基づいて、式（３）によって演算する例について説明した。つまり、未設定部材の基端側で連結されている基端側の部材の対地角度θｇ（ｋ−１）と、未設定部材とその未設定部材の基端側で連結されている基端側の部材との相対角度θｒ（ｋ）が既知である場合に、未設定部材の姿勢センサに対する補正量θｃ（ｋ）を演算する例について説明した。しかしながら、本発明はこれに限定されない。

未設定部材の先端側で連結されている先端側の部材の対地角度θｇ（ｋ＋１）と、未設定部材とその未設定部材の先端側で連結されている先端側の部材との相対角度θｒ（ｋ＋１）が既知である場合、次式（３ａ）によって、未設定部材に取り付けられている姿勢センサに対する補正量θｃ（ｋ）を演算してもよい。

θｃ（ｋ）＝θｇ（ｋ＋１）−θｒ（ｋ＋１）−θｇｉ（ｋ） ・・・（３ａ）

この場合、制御装置１００は、図２１に示すフローチャートのような補正量設定処理を実行することにより、補正量を演算することができる。図２１は、変形例１に係る制御装置１００により実行される補正量設定処理の内容を示すフローチャートである。

制御装置１００は、ＩＭＵ５０が交換されたと判定された場合、上記第１実施形態と同様の取付部材特定処理を実行し、その後、図２１に示す補正量設定処理を実行する。

図２１に示すように、ステップＳ３１０において、制御装置１００は、表示制御信号を表示装置１８に出力し、未設定部材及び未設定部材の先端側の部材を回動限界まで操作させる操作指示を表す表示画像を表示装置１８の表示画面に表示させ、ステップＳ３２０へ進む。

操作指示の表示処理が完了すると、制御装置１００は、ステップＳ３３０からステップＳ３６０までの処理及びステップＳ３３５からステップＳ３６５までの処理を並列に繰り返し行うループ処理を実行する（ステップＳ３２０，Ｓ３７０）。このループ処理は、交換された全てのＩＭＵ５０に対する補正量の設定が完了すると終了し、ループ処理が終了すると図２１に示す補正量設定処理が終了する。

ループ処理では、ステップＳ３３０において、制御装置１００は、未設定部材の先端側の部材のＩＭＵ５０に対する補正量が設定されているか否かを判定する。ステップＳ３３０において、未設定部材の先端側の部材のＩＭＵ５０に対する補正量が設定されていると判定されると、ステップＳ３４０へ進み、未設定部材の先端側の部材のＩＭＵ５０に対する補正量が設定されていないと判定されると、ステップＳ３７０へ進む。

ステップＳ３４０において、制御装置１００は、ストロークエンド状態フラグＦの情報及びストロークエンドの状態にある油圧シリンダに対応するフロント部材（すなわち、回動限界の状態にあるフロント部材）の部材名の情報を取得し、それらの情報に基づいて、未設定部材とその先端側で連結される先端側の部材とを接続する油圧シリンダがストロークエンドの状態にあるか否か、すなわち未設定部材の先端側の部材が回動限界の状態にあるか否かを判定する。この判定処理（Ｓ３４０）は、未設定部材の先端側の部材が、その基端側で連結される基端側の部材に対して回動限界の状態にあるか否かを判定する処理、換言すれば、未設定部材がその先端側で連結される先端側の部材に対して回動限界の状態にあるか否かを判定する処理といえる。ステップＳ３４０において、未設定部材の先端側の部材が回動限界の状態にあると判定されると、すなわち未設定部材がその先端側で連結される先端側の部材に対して回動限界の状態にあると判定されるとステップＳ３５０へ進む。また、別の言い方をすれば、ステップＳ３４０において、未設定部材とその先端側で連結される先端側の部材とを接続する油圧シリンダがストロークエンドの状態にあると判定されるとステップＳ３５０へ進む。ステップＳ３４０において、未設定部材の先端側の部材は回動限界の状態にないと判定されると、すなわち未設定部材はその先端側で連結される先端側の部材に対して回動限界の状態にないと判定されると、ステップＳ３７０へ進む。また、別の言い方をすれば、ステップＳ３４０において、未設定部材とその先端側で連結される先端側の部材とを接続する油圧シリンダがストロークエンドの状態にないと判定されるとステップＳ３７０へ進む。

ステップＳ３５０において、制御装置１００は、未設定部材に取り付けられている新しいＩＭＵ５０の対地角度θｇｉ（ｋ）と、未設定部材の先端側の部材の対地角度θｇ（ｋ＋１）と、記憶装置１２０に記憶されている未設定部材とその先端側の部材との相対角度θｒ（ｋ＋１）と、に基づき、式（３ａ）によって、未設定部材に取り付けられている新しいＩＭＵ５０に対する補正量θｃ（ｋ）を演算する。そして、制御装置１００は、演算した補正量θｃ（ｋ）を記憶装置１２０に記憶し、ステップＳ３６０へ進む。

ステップＳ３６０において、制御装置１００は、表示装置１８の表示画面に表示されている表示画像のうち、ステップＳ３５０で補正量が設定された部材の先端側の部材に対する操作指示の表示画像を非表示化し、ステップＳ３７０へ進む。

また、ループ処理では、ステップＳ３３５において、制御装置１００は、未設定部材の基端側の部材のＩＭＵ５０に対する補正量が設定されているか否かを判定する。ステップＳ３３５において、未設定部材の基端側の部材のＩＭＵ５０に対する補正量が設定されていると判定されると、ステップＳ３４５へ進み、未設定部材の基端側の部材のＩＭＵ５０に対する補正量が設定されていないと判定されると、ステップＳ３７０へ進む。

ステップＳ３４５において、制御装置１００は、ストロークエンド状態フラグＦの情報及びストロークエンドの状態にある油圧シリンダに対応するフロント部材（すなわち、回動限界の状態にあるフロント部材）の部材名の情報を取得し、それらの情報に基づいて、未設定部材がその基端側で連結される基端側の部材に対して回動限界の状態にあるか否か、すなわち未設定部材とその基端側で連結される基端側の部材とを接続する油圧シリンダがストロークエンドの状態にあるか否かを判定する。ステップＳ３４５において、未設定部材が回動限界の状態にあると判定されると、すなわち未設定部材とその基端側で連結される基端側の部材とを接続する油圧シリンダがストロークエンドの状態にあると判定されると、ステップＳ３５５へ進む。ステップＳ３４５において、未設定部材は回動限界の状態にないと判定されると、すなわち未設定部材とその基端側で連結される基端側の部材とを接続する油圧シリンダがストロークエンドの状態にないと判定されると、ステップＳ３７０へ進む。

ステップＳ３５５において、制御装置１００は、未設定部材に取り付けられている新しいＩＭＵ５０の対地角度θｇｉ（ｋ）と、未設定部材の基端側の部材の対地角度θｇ（ｋ−１）と、記憶装置１２０に記憶されいている未設定部材とその未設定部材の基端側の部材との相対角度θｒ（ｋ）と、に基づき、式（３）によって、未設定部材に取り付けられている新しいＩＭＵ５０に対する補正量θｃ（ｋ）を演算する。そして、制御装置１００は、演算した補正量θｃ（ｋ）を記憶装置１２０に記憶し、ステップＳ３６５へ進む。

ステップＳ３６５において、制御装置１００は、表示装置１８の表示画面に表示されている表示画像のうち、ステップＳ３５５で補正量が設定された部材に対する操作指示の表示画像を非表示化し、ステップＳ３７０へ進む。

上記実施形態では、オペレータは、補正量の設定作業（キャリブレーション作業）において、制御装置１００は、基端側のフロント部材から先端側に向かって順番に補正量を設定する処理を実行していたのに対し（図１７及び図１８参照）、本変形例１では、補正量の設定順序の自由度が向上する。例えば、ブームＩＭＵ５０ａ及びアームＩＭＵ５０ｂが交換された場合について説明する。

この場合、表示装置１８の表示画面には、ブーム１１を回動限界まで操作させる操作指示、アーム１２を回動限界まで操作させる操作指示及びバケット１３を回動限界まで操作させる操作指示を表す表示画像が表示される（ステップＳ３１０）。

そして、オペレータは、次の４パターンの操作手順により、補正量θｃ（１），θｃ（２）を設定することができる。

第１の操作手順のパターンは、以下のとおりである。オペレータは、バケット１３を回動限界まで操作することにより、アームＩＭＵ５０ｂに対する補正量θｃ（２）を設定し（Ｓ３３０でＹ→Ｓ３４０でＹ→Ｓ３５０）、次に、アーム１２を回動限界まで操作することにより、ブームＩＭＵ５０ａに対する補正量θｃ（１）を設定する（Ｓ３３０でＹ→Ｓ３４０でＹ→Ｓ３５０）ことができる。

第２の操作手順のパターンは、以下のとおりである。オペレータは、ブーム１１を回動限界まで操作することにより、ブームＩＭＵ５０ａに対する補正量θｃ（１）を設定し（Ｓ３３５でＹ→Ｓ３４５でＹ→Ｓ３５５）、次に、アーム１２を回動限界まで操作することにより、アームＩＭＵ５０ｂに対する補正量θｃ（２）を設定する（Ｓ３３５でＹ→Ｓ３４５でＹ→Ｓ３５５）ことができる。

第３の操作手順のパターンは、以下のとおりである。オペレータは、ブーム１１を回動限界まで操作することにより、ブームＩＭＵ５０ａに対する補正量θｃ（１）を設定し（Ｓ３３５でＹ→Ｓ３４５でＹ→Ｓ３５５）、次に、バケット１３を回動限界まで操作することにより、アームＩＭＵ５０ｂに対する補正量θｃ（２）を設定する（Ｓ３３０でＹ→Ｓ３４０でＹ→Ｓ３５０）ことができる。

第４の操作手順のパターンは、以下のとおりである。オペレータは、バケット１３を回動限界まで操作することにより、アームＩＭＵ５０ｂに対する補正量θｃ（２）を設定し（Ｓ３３０でＹ→Ｓ３４０でＹ→Ｓ３５０）、次に、ブーム１１を回動限界まで操作することにより、ブームＩＭＵ５０ａに対する補正量θｃ（１）を設定する（Ｓ３３５でＹ→Ｓ３４５でＹ→Ｓ３５５）ことができる。

このように、本変形例１に係る制御装置１００は、姿勢センサ（ＩＭＵ５０）が交換されたとして特定されたフロント部材とその基端側で連結される基端側の部材とを接続する油圧シリンダがストロークエンドの状態にあると判定されると、特定されたフロント部材に取り付けられた姿勢センサ（ＩＭＵ５０）の出力信号から得られる角度情報である未補正の対地角度θｇｉ（ｋ）と、特定されたフロント部材の基端側で回動限界の状態で連結される基端側の部材の対地角度θｇ（ｋ−１）と、記憶装置１２０に記憶されている特定されたフロント部材と特定されたフロント部材の基端側で回動限界の状態で連結される基端側の部材との相対角度θｒ（ｋ）と、に基づいて、未補正の対地角度を補正するための補正量θｃ（ｋ）を演算する。また、制御装置１００は、姿勢センサ（ＩＭＵ５０）が交換されたとして特定されたフロント部材とその先端側で連結される先端側の部材とを接続する油圧シリンダがストロークエンドの状態にあると判定されると、特定されたフロント部材に取り付けられた姿勢センサ（ＩＭＵ５０）の出力信号から得られる角度情報である未補正の対地角度θｇｉ（ｋ）と、特定されたフロント部材の先端側で回動限界の状態で連結される先端側の部材の対地角度θｇ（ｋ＋１）と、記憶装置１２０に記憶されている特定されたフロント部材と特定されたフロント部材の先端側で回動限界の状態で連結される先端側の部材との相対角度θｒ（ｋ＋１）と、に基づいて、未補正の対地角度を補正するための補正量θｃ（ｋ）を演算する。したがって、本変形例１によれば、キャリブレーション作業における操作の自由度を向上することができる。

＜変形例２＞
なお、制御装置１００は、姿勢センサ（ＩＭＵ５０）が交換されたとして特定されたフロント部材とその基端側で連結される基端側の部材とを接続する油圧シリンダがストロークエンドの状態にあると判定されたときに、特定されたフロント部材に取り付けられた姿勢センサ（ＩＭＵ５０）の出力信号から得られる角度情報である未補正の対地角度θｇｉ（ｋ）と、特定されたフロント部材の基端側で回動限界の状態で連結される基端側の部材の対地角度θｇ（ｋ−１）と、記憶装置１２０に記憶されている特定されたフロント部材と特定されたフロント部材の基端側で回動限界の状態で連結される基端側の部材との相対角度θｒ（ｋ）と、に基づいて、未補正の対地角度を補正するための補正量θｃ（ｋ）を演算しないようにしてもよい。この場合、制御装置１００は、姿勢センサ（ＩＭＵ５０）が交換されたとして特定されたフロント部材とその先端側で連結される先端側の部材とを接続する油圧シリンダがストロークエンドの状態にあると判定されると、特定されたフロント部材に取り付けられた姿勢センサ（ＩＭＵ５０）の出力信号から得られる角度情報である未補正の対地角度θｇｉ（ｋ）と、特定されたフロント部材の先端側で回動限界の状態で連結される先端側の部材の対地角度θｇ（ｋ＋１）と、記憶装置１２０に記憶されている特定されたフロント部材と特定されたフロント部材の先端側で回動限界の状態で連結される先端側の部材との相対角度θｒ（ｋ＋１）と、に基づいて、未補正の対地角度を補正するための補正量θｃ（ｋ）を演算する。

＜変形例３＞
上記実施形態では、フロント部材を駆動する油圧シリンダのシリンダ圧力に基づいて、その油圧シリンダがストロークエンドの状態にあるか否か（すなわち、フロント部材が回動限界の状態にあるか否か）を判定する例について説明したが、本発明はこれに限定されない。ＩＭＵ５０等の姿勢センサの検出結果に基づいて、油圧シリンダがストロークエンドの状態にあるか否かを判定してもよい。この場合、制御装置１００は、フロント部材を操作しているにもかかわらず、そのフロント部材に取り付けられているＩＭＵ５０により検出される姿勢情報に変化がない場合に、そのフロント部材を駆動する油圧シリンダがストロークエンドの状態にあると判定する。また、油圧シリンダのストロークをストロークセンサにより検出し、その検出結果に基づいて油圧シリンダがストロークエンドの状態にあるか否かを判定してもよい。さらに、フロント部材またはフロント部材を駆動する油圧シリンダにリミットスイッチを設け、リミットスイッチの検出結果に基づいて油圧シリンダがストロークエンドの状態にあるか否かを判定してもよい。

＜変形例４＞
上記実施形態では、制御装置１００が、フロント部材を駆動する油圧シリンダがストロークエンドの状態にあるか否かを判定し、油圧シリンダがストロークエンドの状態にあると判定されると、ストロークエンドの状態にあると判定された油圧シリンダに対応するフロント部材の相対角度θｒ（ｋ）を記憶装置１２０に記憶する例について説明したが、本発明はこれに限定されない。例えば、製造工場において測量により得られた相対角度θｒ（ｋ）を記憶装置１２０に記憶させておいてもよい。この場合においても、現場等でフロントＩＭＵ５０Ｕを交換した際に、キャリブレーション作業に要する時間を短縮することができる。

なお、上記実施形態で説明したように、ＩＭＵ５０の補正量が全て既知であるときに、ストロークエンドの状態の油圧シリンダに対応するフロント部材の相対角度θｒ（ｋ）を演算し、記憶できる構成とすることにより、製造工場での測量作業を省略または簡略化でき、製造工数の低減を図ることができるため、好適である。

＜変形例５＞
上記第１実施形態では、フロント部材の対地角度を取得するための対地角センサとして、ＩＭＵ５０を設ける例について説明したが、本発明はこれに限定されない。ＩＭＵ５０に代えて、振り子式の傾斜角センサを設けてもよい。

＜変形例６＞
上記実施形態では、フロント作業装置１０が、ブーム１１、アーム１２及びバケット１３で構成される例について説明したが、本発明はこれに限定されない。作業装置の構造、関節の数等は、任意に構成することができる。例えば、バケット１３の代わりに油圧で開閉して物体を把持するグラップルを装備してもよい。

＜変形例７＞
上記実施形態では、作業機械がクローラ式の油圧ショベル１である場合を例に説明したが、本発明はこれに限定されない。ホイール式の油圧ショベル等、多関節式の作業装置を備える種々の作業機械に本発明を適用することができる。

以上、本発明の実施形態について説明したが、上記実施形態は本発明の適用例の一部を示したに過ぎず、本発明の技術的範囲を上記実施形態の具体的構成に限定する趣旨ではない。

１，２０１・・・油圧ショベル（作業機械）、８・・・旋回フレーム（ベース部材）、１０・・・フロント作業装置（作業装置）、１１・・・ブーム（フロント部材）、１１ａ・・・ブームシリンダ（流体圧シリンダ）、１２・・・アーム（フロント部材）、１２ａ・・・アームシリンダ（流体圧シリンダ）、１３・・・バケット（フロント部材）、１３ａ・・・バケットシリンダ（流体圧シリンダ）、５０・・・ＩＭＵ（姿勢センサ）、１００，２００・・・制御装置、１２０・・・記憶装置、２５０・・・回転角センサ（姿勢センサ）、θｃ・・・補正量、θｇ・・・対地角度、θｇｉ・・・対地角度（未補正の対地角度）、θｒ・・・相対角度、θｒｕ・・・回転角度（未補正の回転角度）

Claims (5)

1. 回動可能に連結される複数のフロント部材及び前記フロント部材を駆動する複数の流体圧シリンダを有する多関節型の作業装置と、前記作業装置が回動可能に連結されるベース部材と、前記複数のフロント部材のそれぞれに取り付けられ前記複数のフロント部材のそれぞれの姿勢に関する情報を取得する複数の姿勢センサと、情報が記憶される記憶装置と、作業機械を制御する制御装置と、を備えた作業機械において、
   前記記憶装置には、前記流体圧シリンダがストロークエンドの状態における、前記流体圧シリンダに対応する前記フロント部材の相対角度が記憶され、
   前記制御装置は、
   前記姿勢センサが交換されたか否かを判定し、
   前記姿勢センサが交換されたと判定された場合、前記交換されたと判定された前記姿勢センサが取り付けられているフロント部材を特定し、
   前記特定されたフロント部材に対応する前記流体圧シリンダがストロークエンドの状態にあるか否かを判定し、
   前記特定されたフロント部材に対応する前記流体圧シリンダがストロークエンドの状態にあると判定されると、前記特定されたフロント部材に取り付けられた前記姿勢センサの出力信号から得られる角度情報と、前記記憶装置に記憶されている前記特定されたフロント部材の相対角度と、に基づいて、前記角度情報を補正するための補正量を演算する、
   ことを特徴とする作業機械。
2. 請求項１に記載の作業機械において、
   前記制御装置は、
   前記フロント部材の相対角度を演算し、
   前記流体圧シリンダがストロークエンドの状態にあると判定されると、その流体圧シリンダに対応する前記フロント部材の相対角度を前記記憶装置に記憶する、
   ことを特徴とする作業機械。
3. 請求項１に記載の作業機械において、
   前記姿勢センサは、フロント部材の対地角度を取得するための対地角センサであり、
   前記制御装置は、
   前記特定されたフロント部材に対応する前記流体圧シリンダがストロークエンドの状態にあると判定されると、前記特定されたフロント部材に取り付けられた前記姿勢センサの出力信号から得られる角度情報である未補正の対地角度と、前記特定されたフロント部材が連結される部材の対地角度と、前記記憶装置に記憶されている前記特定されたフロント部材の相対角度と、に基づいて、前記未補正の対地角度を補正するための補正量を演算する
   ことを特徴とする作業機械。
4. 請求項３に記載の作業機械において、
   前記制御装置は、
   前記特定されたフロント部材とその基端側で連結される基端側の部材とを接続する前記流体圧シリンダがストロークエンドの状態にあると判定されると、前記特定されたフロント部材に取り付けられた前記姿勢センサの出力信号から得られる角度情報である未補正の対地角度と、前記基端側の部材の対地角度と、前記記憶装置に記憶されている前記特定されたフロント部材と前記基端側の部材との相対角度と、に基づいて、前記未補正の対地角度を補正するための補正量を演算し、
   前記特定されたフロント部材とその先端側で連結される先端側の部材とを接続する前記流体圧シリンダがストロークエンドの状態にあると判定されると、前記特定されたフロント部材に取り付けられた前記姿勢センサの出力信号から得られる角度情報である未補正の対地角度と、前記先端側の部材の対地角度と、前記記憶装置に記憶されている前記特定されたフロント部材と前記先端側の部材との相対角度と、に基づいて、前記未補正の対地角度を補正するための補正量を演算する、
   ことを特徴とする作業機械。
5. 請求項１に記載の作業機械において、
   前記姿勢センサは、前記フロント部材の回転角度を取得するための回転角センサであり、
   前記制御装置は、
   前記特定されたフロント部材に対応する前記流体圧シリンダがストロークエンドの状態にあると判定されると、前記特定されたフロント部材に取り付けられた前記姿勢センサの出力信号から得られる角度情報である未補正の回転角度と、前記記憶装置に記憶されている前記特定されたフロント部材の相対角度と、の差を、前記未補正の回転角度を補正するための補正量として設定する、
   ことを特徴とする作業機械。

Images