(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2023-12-12
(45)【発行日】2023-12-20
(54)【発明の名称】作業機械の制御システム、作業機械、作業機械の制御方法
(51)【国際特許分類】
E02F 9/26 20060101AFI20231213BHJP
E02F 3/43 20060101ALI20231213BHJP
【ＦＩ】
E02F9/26 B
E02F3/43 C
【請求項の数】
8
(21)【出願番号】P 2019214573
(22)【出願日】2019-11-27
(65)【公開番号】P2021085216
(43)【公開日】2021-06-03
【審査請求日】2022-10-17
(73)【特許権者】
【識別番号】000001236
【氏名又は名称】株式会社小松製作所
(74)【代理人】
【識別番号】110001634
【氏名又は名称】弁理士法人志賀国際特許事務所
(72)【発明者】
【氏名】松山 徹
【審査官】亀谷 英樹
(56)【参考文献】
【文献】国際公開第２０１６／１８６２１８（ＷＯ，Ａ１）
【文献】国際公開第２０１６／１５８７７９（ＷＯ，Ａ１）
【文献】特開２０１９－１７３３６２（ＪＰ，Ａ）
【文献】国際公開第２０１５／１７３９３５（ＷＯ，Ａ１）
【文献】国際公開第２０１５／１８６１８０（ＷＯ，Ａ１）
(58)【調査した分野】(Int.Cl.，ＤＢ名)
Ｅ０２Ｆ ９／２０－９／２２
Ｅ０２Ｆ ３／４２－３／４３
Ｅ０２Ｆ ３／８４－３／８５
Ｅ０２Ｆ ９／２６
(57)【特許請求の範囲】
【請求項1】
ブーム軸回りに回転可能なブームと、前記ブーム軸と平行なアーム軸回りに回転可能なアームと、前記アーム軸と平行なバケット軸回りに回転可能かつ前記バケット軸と異なるアタッチメント軸回りに回転可能なバケットとを含む作業機を備える作業機械の制御システムであって、前記バケット上の複数の点それぞれと掘削対象の目標形状を示す目標設計面との距離であるバケット距離のうち、最も短い最短バケット距離を算出する距離算出部と、
前記最短バケット距離に基づいて、前記バケットが前記目標設計面に進入しないように、前記作業機の速度を抑制するための介入制御量を算出する介入制御部と、
前記バケットの刃先と前記目標設計面とが平行に近づくように、前記バケットを前記アタッチメント軸回りに回転させるアタッチメント制御量を算出するアタッチメント制御部と、
前記介入制御量および前記アタッチメント制御量に従って前記作業機を移動させた場合に、前記最短バケット距離が増加する可能性があるか否かを判定し、増加する可能性があると判定した場合に、前記アタッチメント制御量による前記アタッチメント軸回りの回転を制限するアタッチメント制限部と
を備える作業機械の制御システム。
【請求項2】
前記アタッチメント制限部は、前記バケットの刃先と前記目標設計面との角度が所定範囲を超える場合に、前記最短バケット距離が増加する可能性があると判定する
請求項１に記載の作業機械の制御システム。
【請求項3】
ブーム軸回りに回転可能なブームと、前記ブーム軸と平行なアーム軸回りに回転可能なアームと、前記アーム軸と平行なバケット軸回りに回転可能かつ前記バケット軸と異なるアタッチメント軸回りに回転可能なバケットとを含む作業機を備える作業機械の制御システムであって、
前記バケット上の複数の点それぞれと掘削対象の目標形状を示す目標設計面との距離であるバケット距離のうち、最も短い最短バケット距離を算出する距離算出部と、
操作装置から前記作業機の操作量を取得する操作量取得部と、
前記最短バケット距離に基づいて前記作業機の許容速度を算出し、前記許容速度と前記操作量とに基づいて、前記作業機の速度を抑制するための介入制御量を算出する介入制御部と、
前記バケットの刃先と前記目標設計面とが平行に近づくように、前記バケットを前記アタッチメント軸回りに回転させるアタッチメント制御量と、前記バケット距離との関係を表すアタッチメント関数を前記許容速度に応じて変化させるアタッチメント制限部と、
前記アタッチメント関数を用いて前記アタッチメント制御量を算出するアタッチメント制御部と、
を備える作業機械の制御システム。
【請求項4】
ブーム軸回りに回転可能なブームと、前記ブーム軸と平行なアーム軸回りに回転可能なアームと、前記アーム軸と平行なバケット軸回りに回転可能かつ前記バケット軸と異なるアタッチメント軸回りに回転可能なバケットとを含む作業機を備える作業機械の制御システムであって、
前記バケット上の複数の点それぞれと掘削対象の目標形状を示す目標設計面との距離であるバケット距離のうち、最も短い最短バケット距離を算出する距離算出部と、
操作装置から前記作業機の操作量を取得する操作量取得部と、
前記最短バケット距離に基づいて前記作業機の許容速度を算出し、前記許容速度と前記操作量とに基づいて、前記作業機の速度を抑制するための介入制御量を算出する介入制御部と、
前記バケットの刃先と前記目標設計面とが平行に近づくように、前記バケットを前記アタッチメント軸回りに回転させるアタッチメント制御量を算出するアタッチメント制御部と、
前記許容速度に基づいて前記バケット距離を一定に保つことができる許容制御量を算出し、前記アタッチメント制御量の絶対値を前記許容制御量以下に制限するアタッチメント制限部と、
を備える作業機械の制御システム。
【請求項5】
ブーム軸回りに回転可能なブームと、前記ブーム軸と平行なアーム軸回りに回転可能なアームと、
前記アーム軸と平行なバケット軸回りに回転可能かつ前記バケット軸と直交するアタッチメント軸回りに回転可能なバケットと、
請求項１から請求項４の何れか１項に記載の作業機械の制御システムと
を備える作業機械。
【請求項6】
ブーム軸回りに回転可能なブームと、前記ブーム軸と平行なアーム軸回りに回転可能なアームと、前記アーム軸と平行なバケット軸回りに回転可能かつ前記バケット軸と異なるアタッチメント軸回りに回転可能なバケットとを含む作業機を備える作業機械の制御方法であって、前記バケット上の複数の点それぞれと掘削対象の目標形状を示す目標設計面との距離であるバケット距離のうち、最も短い最短バケット距離を算出するステップと、
前記最短バケット距離に基づいて、前記バケットが前記目標設計面に進入しないように、前記作業機の速度を抑制するための介入制御量を算出するステップと、
前記バケットの刃先と前記目標設計面とが平行に近づくように、前記バケットを前記アタッチメント軸回りに回転させるアタッチメント制御量を算出するステップと、
前記介入制御量および前記アタッチメント制御量に従って前記作業機を移動させた場合に、前記最短バケット距離が増加する可能性があるか否かを判定するステップと、
増加する可能性があると判定した場合に、前記アタッチメント制御量による前記アタッチメント軸回りの回転を制限するステップと、
を備える作業機械の制御方法。
【請求項7】
ブーム軸回りに回転可能なブームと、前記ブーム軸と平行なアーム軸回りに回転可能なアームと、前記アーム軸と平行なバケット軸回りに回転可能かつ前記バケット軸と異なるアタッチメント軸回りに回転可能なバケットとを含む作業機を備える作業機械の制御方法であって、
前記バケット上の複数の点それぞれと掘削対象の目標形状を示す目標設計面との距離であるバケット距離のうち、最も短い最短バケット距離を算出するステップと、
操作装置から前記作業機の操作量を取得するステップと、
前記最短バケット距離に基づいて前記作業機の許容速度を算出し、前記許容速度と前記操作量とに基づいて、前記作業機の速度を抑制するための介入制御量を算出するステップと、
前記バケットの刃先と前記目標設計面とが平行に近づくように、前記バケットを前記アタッチメント軸回りに回転させるアタッチメント制御量と、前記バケット距離との関係を表すアタッチメント関数を前記許容速度に応じて変化させるステップと、
前記アタッチメント関数を用いて前記アタッチメント制御量を算出するステップと、
を備える作業機械の制御方法。
【請求項8】
ブーム軸回りに回転可能なブームと、前記ブーム軸と平行なアーム軸回りに回転可能なアームと、前記アーム軸と平行なバケット軸回りに回転可能かつ前記バケット軸と異なるアタッチメント軸回りに回転可能なバケットとを含む作業機を備える作業機械の制御方法であって、
前記バケット上の複数の点それぞれと掘削対象の目標形状を示す目標設計面との距離であるバケット距離のうち、最も短い最短バケット距離を算出するステップと、
操作装置から前記作業機の操作量を取得するステップと、
前記最短バケット距離に基づいて前記作業機の許容速度を算出し、前記許容速度と前記操作量とに基づいて、前記作業機の速度を抑制するための介入制御量を算出するステップと、
前記バケットの刃先と前記目標設計面とが平行に近づくように、前記バケットを前記アタッチメント軸回りに回転させるアタッチメント制御量を算出するステップと、
前記許容速度に基づいて前記バケット距離を一定に保つことができる許容制御量を算出し、前記アタッチメント制御量の絶対値を前記許容制御量以下に制限するステップと、
を備える作業機械の制御方法。
【発明の詳細な説明】
【技術分野】
【0001】
本開示は、作業機械の制御システム、作業機械、および作業機械の制御方法に関する。
【背景技術】
【0002】
油圧ショベルに取り付けられるバケットとして、作業機の動作平面に対する角度を調整可能なチルトバケットが知られている。特許文献１には、チルトバケットが目標設計面に対して平行になるようにチルト角度を自動制御で調整する技術が開示されている。
【先行技術文献】
【特許文献】
【0003】
【文献】国際公開第２０１６／１５８７７９号
【発明の概要】
【発明が解決しようとする課題】
【0004】
特許文献１に記載された技術によれば、バケットが、目標設計面から所定距離だけ離れたチルト制御開始線に侵入することで、自動チルト制御が行われる。自動チルト制御によってチルト角度が調整されると、バケットは目標設計面から離れる方向へ移動することとなる。
【0005】
一方で、油圧ショベルのような作業機械においては、掘削対象の目標形状を示す目標設計面に沿ってバケットが移動するように、バケットが目標設計面に侵入しないように作業機を自動制御する介入制御が知られている。介入制御は、目標設計面とバケットとの距離に応じて減速するように作業機を制御する。そのため、介入制御と自動チルト制御とが同時に行われる場合に、自動チルト制御によってバケットが目標設計面から離れる速度が、介入制御によって制限されるブームまたはアームの下降速度がより速いと、介入制御に係る作業機の制御量が不安定になる可能性がある。これは、チルト角度を制御する自動チルト制御のみならず、目標設計面に対して平行になるようにバケットをローテート軸回りに回転させる自動ローテート制御を行う場合も、同様である。
【0006】
本開示の目的は、作業機の動作の安定を保ちながら、介入制御と自動チルト制御または自動ローテート制御とを同時に行うことができる作業機械の制御システム、作業機械、および作業機械の制御方法を提供することにある。
【課題を解決するための手段】
【0007】
本発明の第１の態様によれば、作業機械の制御システムは、ブーム軸回りに回転可能なブームと、前記ブーム軸と平行なアーム軸回りに回転可能なアームと、前記アーム軸と平行なバケット軸回りに回転可能かつ前記バケット軸と異なるアタッチメント軸回りに回転可能なバケットと備える作業機械の制御システムであって、前記バケット上の点と掘削対象の掘削対象の目標形状を示す目標設計面との距離であるバケット距離を算出する距離算出部と、前記バケット距離に基づいて、前記バケットが前記目標設計面に進入しないように、前記作業機の速度を抑制するための介入制御量を算出する介入制御部と、前記バケットの刃先と掘削対象の目標形状を示す目標設計面とが平行に近づくように、前記バケットを前記アタッチメント軸回りに回転させる前記アタッチメント制御量を算出するアタッチメント制御部と、前記介入制御量および前記アタッチメント制御量に基づく作業機の移動によって、前記バケット距離が増加しないように前記アタッチメント軸回りの回転を制限するアタッチメント制限部とを備える。
【発明の効果】
【0008】
上記態様によれば、作業機械の制御システムは、作業機の動作の安定を保ちながら、介入制御と自動チルト制御または自動ローテート制御とを同時に行うことができる。
【図面の簡単な説明】
【0009】
【図1】作業機械および作業機の姿勢の例を示す図である。
【図2】第１の実施形態に係る作業機械の構成を示す概略図である。
【図3】第１の実施形態に係るバケットの構成を示す正面図である。
【図4】第１の実施形態に係る運転室の内部の構成を示す図である。
【図5】第１の実施形態に係る制御装置の構成を示す概略ブロック図である。
【図6】第１の実施形態に係る制御装置の動作を示すフローチャートである。
【図7】チルト自動制御における目標設計面と刃先上の点との関係を示す図である。
【図8】第１の実施形態に係るバケットの距離差とチルト角速度の目標値の関係を示すチルト関数の例を示す図である。
【図9】第２の実施形態に係る制御装置の動作を示すフローチャートである。
【図10】第３の実施形態に係る制御装置の動作を示すフローチャートである。
【発明を実施するための形態】
【0010】
〈座標系〉
図１は、作業機械１００および作業機１５０の姿勢の例を示す図である。
以下の説明においては、三次元の現場座標系（Ｘｇ、Ｙｇ、Ｚｇ）および三次元の車体座標系（Ｘｍ、Ｙｍ、Ｚｍ）を規定して、これらに基づいて位置関係を説明する。
図１は、作業機械１００および作業機１５０の姿勢の例を示す図である。
以下の説明においては、三次元の現場座標系（Ｘｇ、Ｙｇ、Ｚｇ）および三次元の車体座標系（Ｘｍ、Ｙｍ、Ｚｍ）を規定して、これらに基づいて位置関係を説明する。
【0011】
現場座標系は、施工現場に設けられたＧＮＳＳ（Global Navigation Satellite System）基準局の位置を基準点として南北に伸びるＸｇ軸、東西に伸びるＹｇ軸、鉛直方向に伸びるＺｇ軸から構成される座標系である。ＧＮＳＳの例としては、ＧＰＳ（Global Positioning System）が挙げられる。なお、他の実施形態においては、現場座標系に代えて緯度および経度などで表されるグローバル座標系を用いてもよい。
車体座標系は、作業機械１００の旋回体１３０に規定された代表点Ｏを基準として、後述する運転室１７０内のオペレータの着座位置から見て前後に伸びるＸｍ軸、左右に伸びるＹｍ軸、上下に伸びるＺｍ軸から構成される座標系である。旋回体１３０の代表点Ｏを基準として前方を＋Ｘｍ方向、後方を－Ｘｍ方向、左方を＋Ｙｍ方向、右方を－Ｙｍ方向、上方向を＋Ｚｍ方向、下方向を－Ｚｍ方向とよぶ。
現場座標系と車体座標系とは、現場座標系における作業機械１００の位置および傾きを特定することで、互いに変換することができる。
車体座標系は、作業機械１００の旋回体１３０に規定された代表点Ｏを基準として、後述する運転室１７０内のオペレータの着座位置から見て前後に伸びるＸｍ軸、左右に伸びるＹｍ軸、上下に伸びるＺｍ軸から構成される座標系である。旋回体１３０の代表点Ｏを基準として前方を＋Ｘｍ方向、後方を－Ｘｍ方向、左方を＋Ｙｍ方向、右方を－Ｙｍ方向、上方向を＋Ｚｍ方向、下方向を－Ｚｍ方向とよぶ。
現場座標系と車体座標系とは、現場座標系における作業機械１００の位置および傾きを特定することで、互いに変換することができる。
【0012】
〈第１の実施形態〉
《作業機械１００の構成》
図２は、第１の実施形態に係る作業機械１００の構成を示す概略図である。
作業機械１００は、施工現場にて稼働し、土砂などの掘削対象を施工する。第１の実施形態に係る作業機械１００は、油圧ショベルである。
作業機械１００は、走行体１１０、旋回体１３０、作業機１５０、運転室１７０、制御装置１９０を備える。
走行体１１０は、作業機械１００を走行可能に支持する。走行体１１０は、例えば左右１対の無限軌道である。旋回体１３０は、走行体１１０に旋回中心回りに旋回可能に支持される。作業機１５０は、油圧により駆動する。作業機１５０は、旋回体１３０の前部に上下方向に駆動可能に支持される。運転室１７０は、オペレータが搭乗し、作業機械１００の操作を行うためのスペースである。運転室１７０は、旋回体１３０の前部に設けられる。制御装置１９０は、オペレータの操作に基づいて、走行体１１０、旋回体１３０、および作業機１５０を制御する。制御装置１９０は、例えば運転室１７０の内部に設けられる。
《作業機械１００の構成》
図２は、第１の実施形態に係る作業機械１００の構成を示す概略図である。
作業機械１００は、施工現場にて稼働し、土砂などの掘削対象を施工する。第１の実施形態に係る作業機械１００は、油圧ショベルである。
作業機械１００は、走行体１１０、旋回体１３０、作業機１５０、運転室１７０、制御装置１９０を備える。
走行体１１０は、作業機械１００を走行可能に支持する。走行体１１０は、例えば左右１対の無限軌道である。旋回体１３０は、走行体１１０に旋回中心回りに旋回可能に支持される。作業機１５０は、油圧により駆動する。作業機１５０は、旋回体１３０の前部に上下方向に駆動可能に支持される。運転室１７０は、オペレータが搭乗し、作業機械１００の操作を行うためのスペースである。運転室１７０は、旋回体１３０の前部に設けられる。制御装置１９０は、オペレータの操作に基づいて、走行体１１０、旋回体１３０、および作業機１５０を制御する。制御装置１９０は、例えば運転室１７０の内部に設けられる。
【0013】
《旋回体１３０の構成》
図２に示すように、旋回体１３０は、位置方位検出器１３１および傾斜検出器１３２を備える。
図２に示すように、旋回体１３０は、位置方位検出器１３１および傾斜検出器１３２を備える。
【0014】
位置方位検出器１３１は、旋回体１３０の現場座標系における位置および旋回体１３０が向く方位を演算する。位置方位検出器１３１は、ＧＮＳＳを構成する人工衛星から測位信号を受信する２つのアンテナを備える。２つのアンテナは、それぞれ旋回体１３０の異なる位置に設置される。例えば２つのアンテナは、旋回体１３０のカウンターウェイト部に設けられる。位置方位検出器１３１は、２つのアンテナの少なくとも一方が受信した測位信号に基づいて、現場座標系における旋回体１３０の代表点Ｏの位置を検出する。位置方位検出器１３１は、２つのアンテナのそれぞれが受信した測位信号を用いて、現場座標系において旋回体１３０が向く方位を検出する。
【0015】
傾斜検出器１３２は、旋回体１３０の加速度および角速度を計測し、計測結果に基づいて旋回体１３０の傾き（例えば、Ｘｍ軸に対する回転を表すロール、およびＹｍ軸に対する回転を表すピッチ）を検出する。傾斜検出器１３２は、例えば運転室１７０の下方に設置される。傾斜検出器１３２の例としては、ＩＭＵ（Inertial Measurement Unit：慣性計測装置）が挙げられる。
【0016】
《作業機１５０の構成》
図２に示すように、作業機１５０は、ブーム１５１、アーム１５２、第１リンク１５３、第２リンク１５４、およびバケット１５５を備える。
図２に示すように、作業機１５０は、ブーム１５１、アーム１５２、第１リンク１５３、第２リンク１５４、およびバケット１５５を備える。
【0017】
ブーム１５１の基端部は、旋回体１３０にブームピンＰ１を介して取り付けられる。以下、ブームピンＰ１の中心軸をブーム軸Ｘ１とよぶ。
アーム１５２は、ブーム１５１とバケット１５５とを連結する。アーム１５２の基端部は、ブーム１５１の先端部にアームピンＰ２を介して取り付けられる。以下、アームピンＰ２の中心軸をアーム軸Ｘ２とよぶ。
第１リンク１５３の第１端は、アーム１５２の先端側の側面に第１リンクピンＰ３を介して取り付けられる。第１リンク１５３の第２端は、第２リンク１５４の第１端に、バケットシリンダピンＰ４を介して取り付けられる。
バケット１５５は、土砂などを掘削するための刃先と掘削した土砂を収容するための収容部とを備える。バケット１５５の基端部は、アーム１５２のアーム１５２の先端部にバケットピンＰ５を介して取り付けられる。以下、バケットピンＰ５の中心軸をバケット軸Ｘ３とよぶ。またバケット１５５の基端部は、第２リンク１５４の第２端に、第２リンクピンＰ６を介して取り付けられる。
ブーム軸Ｘ１、アーム軸Ｘ２、およびバケット軸Ｘ３は、互いに平行である。
アーム１５２は、ブーム１５１とバケット１５５とを連結する。アーム１５２の基端部は、ブーム１５１の先端部にアームピンＰ２を介して取り付けられる。以下、アームピンＰ２の中心軸をアーム軸Ｘ２とよぶ。
第１リンク１５３の第１端は、アーム１５２の先端側の側面に第１リンクピンＰ３を介して取り付けられる。第１リンク１５３の第２端は、第２リンク１５４の第１端に、バケットシリンダピンＰ４を介して取り付けられる。
バケット１５５は、土砂などを掘削するための刃先と掘削した土砂を収容するための収容部とを備える。バケット１５５の基端部は、アーム１５２のアーム１５２の先端部にバケットピンＰ５を介して取り付けられる。以下、バケットピンＰ５の中心軸をバケット軸Ｘ３とよぶ。またバケット１５５の基端部は、第２リンク１５４の第２端に、第２リンクピンＰ６を介して取り付けられる。
ブーム軸Ｘ１、アーム軸Ｘ２、およびバケット軸Ｘ３は、互いに平行である。
【0018】
作業機１５０は、動力を発生させるアクチュエータである複数の油圧シリンダを備える。具体的には、作業機１５０は、ブームシリンダ１５６、アームシリンダ１５７、およびバケットシリンダ１５８を備える。
ブームシリンダ１５６は、ブーム１５１を作動させるための油圧シリンダである。ブームシリンダ１５６の基端部は、旋回体１３０に取り付けられる。ブームシリンダ１５６の先端部は、ブーム１５１に取り付けられる。ブームシリンダ１５６には、ブームシリンダ１５６のストローク量を検出するブームシリンダストロークセンサ１５６１が設けられる。
アームシリンダ１５７は、アーム１５２を駆動するための油圧シリンダである。アームシリンダ１５７の基端部は、ブーム１５１に取り付けられる。アームシリンダ１５７の先端部は、アーム１５２に取り付けられる。アームシリンダ１５７には、アームシリンダ１５７のストローク量を検出するアームシリンダストロークセンサ１５７１が設けられる。
バケットシリンダ１５８は、バケット１５５を駆動するための油圧シリンダである。バケットシリンダ１５８の基端部は、アーム１５２に取り付けられる。バケットシリンダ１５８の先端部は、第２リンクピンＰ６を介して第１リンク１５３の第２端および第２リンク１５４の第１端に取り付けられる。バケットシリンダ１５８には、バケットシリンダ１５８のストローク量を検出するバケットシリンダストロークセンサ１５８１が設けられる。
ブームシリンダ１５６は、ブーム１５１を作動させるための油圧シリンダである。ブームシリンダ１５６の基端部は、旋回体１３０に取り付けられる。ブームシリンダ１５６の先端部は、ブーム１５１に取り付けられる。ブームシリンダ１５６には、ブームシリンダ１５６のストローク量を検出するブームシリンダストロークセンサ１５６１が設けられる。
アームシリンダ１５７は、アーム１５２を駆動するための油圧シリンダである。アームシリンダ１５７の基端部は、ブーム１５１に取り付けられる。アームシリンダ１５７の先端部は、アーム１５２に取り付けられる。アームシリンダ１５７には、アームシリンダ１５７のストローク量を検出するアームシリンダストロークセンサ１５７１が設けられる。
バケットシリンダ１５８は、バケット１５５を駆動するための油圧シリンダである。バケットシリンダ１５８の基端部は、アーム１５２に取り付けられる。バケットシリンダ１５８の先端部は、第２リンクピンＰ６を介して第１リンク１５３の第２端および第２リンク１５４の第１端に取り付けられる。バケットシリンダ１５８には、バケットシリンダ１５８のストローク量を検出するバケットシリンダストロークセンサ１５８１が設けられる。
【0019】
《バケット１５５の構成》
図３は、第１の実施形態に係るバケット１５５の構成を示す正面図である。
第１の実施形態に係るバケット１５５は、バケット軸Ｘ３に直交する軸であるチルト軸Ｘ４回りに回転可能なチルトバケットである。チルト軸Ｘ４は、バケット１５５を回転させるアタッチメント軸の一例である。
図３に示すように、バケット１５５は、バケット本体１６１と、ジョイント１６２と、チルトシリンダ１６３とを備える。
図３は、第１の実施形態に係るバケット１５５の構成を示す正面図である。
第１の実施形態に係るバケット１５５は、バケット軸Ｘ３に直交する軸であるチルト軸Ｘ４回りに回転可能なチルトバケットである。チルト軸Ｘ４は、バケット１５５を回転させるアタッチメント軸の一例である。
図３に示すように、バケット１５５は、バケット本体１６１と、ジョイント１６２と、チルトシリンダ１６３とを備える。
【0020】
ジョイント１６２の基端部には、バケットピンＰ５を介してアーム１５２を取り付けるための取付孔を有する前側ブラケット１６２１および第２リンクピンＰ６を介して第２リンク１５４を取り付けるための取付孔を有する後側ブラケット１６２２が設けられる。すなわち、前側ブラケット１６２１の取付孔は、バケット軸Ｘ３を通るように設けられる。
ジョイント１６２の先端部は、チルトピンＰ７を介してバケット本体１６１の基端部に取り付けられる。チルトピンＰ７は、バケット軸Ｘ３に直交するように設けられる。チルトピンＰ７の中心軸は、チルト軸Ｘ４をなす。
ジョイント１６２の先端部は、チルトピンＰ７を介してバケット本体１６１の基端部に取り付けられる。チルトピンＰ７は、バケット軸Ｘ３に直交するように設けられる。チルトピンＰ７の中心軸は、チルト軸Ｘ４をなす。
【0021】
バケット本体１６１の基端部の一端（左端または右端）には、チルトシリンダ１６３を取り付けるためのチルトブラケット１６１１が設けられる。
チルトシリンダ１６３は、チルト軸Ｘ４回りにバケット本体１６１を回転するための油圧シリンダである。チルトシリンダ１６３の基端部は、チルトシリンダエンドピンＰ８を介してチルトブラケット１６１１に取り付けられる。チルトシリンダ１６３の先端部は、チルトシリンダトップピンＰ９を介してジョイント１６２に取り付けられる。チルトシリンダエンドピンＰ８およびチルトシリンダトップピンＰ９は、それぞれチルトピンＰ７と平行に設けられる。これにより、バケット本体１６１は、チルトシリンダ１６３の駆動によってチルト軸Ｘ４回りに回転する。
チルトシリンダ１６３には、チルトシリンダ１６３のストローク量を検出するチルトシリンダストロークセンサ１６３１が設けられる。
チルトシリンダ１６３は、チルト軸Ｘ４回りにバケット本体１６１を回転するための油圧シリンダである。チルトシリンダ１６３の基端部は、チルトシリンダエンドピンＰ８を介してチルトブラケット１６１１に取り付けられる。チルトシリンダ１６３の先端部は、チルトシリンダトップピンＰ９を介してジョイント１６２に取り付けられる。チルトシリンダエンドピンＰ８およびチルトシリンダトップピンＰ９は、それぞれチルトピンＰ７と平行に設けられる。これにより、バケット本体１６１は、チルトシリンダ１６３の駆動によってチルト軸Ｘ４回りに回転する。
チルトシリンダ１６３には、チルトシリンダ１６３のストローク量を検出するチルトシリンダストロークセンサ１６３１が設けられる。
【0022】
【0023】
操作装置１７２は、オペレータの手動操作によって走行体１１０、旋回体１３０および作業機１５０を駆動させるためのインタフェースである。操作装置１７２は、左操作レバー１７２１、右操作レバー１７２２、左フットペダル１７２３、右フットペダル１７２４、左走行レバー１７２５、右走行レバー１７２６を備える。
【0024】
左操作レバー１７２１は、運転席１７１の左側に設けられる。右操作レバー１７２２は、運転席１７１の右側に設けられる。
【0025】
左操作レバー１７２１は、旋回体１３０の旋回動作、ならびに、アーム１５２の引き動作および押し動作を行うための操作機構である。具体的には、オペレータが左操作レバー１７２１を前方に倒すと、アームシリンダ１５７が駆動し、アーム１５２が押し動作する。また、オペレータが左操作レバー１７２１を後方に倒すと、アームシリンダ１５７が駆動し、アーム１５２が引き動作する。また、オペレータが左操作レバー１７２１を右方向に倒すと、旋回体１３０が右旋回する。また、オペレータが左操作レバー１７２１を左方向に倒すと、旋回体１３０が左旋回する。
【0026】
右操作レバー１７２２は、バケット１５５の掘削動作およびダンプ動作、ならびに、ブーム１５１の上げ動作および下げ動作を行うための操作機構である。具体的には、オペレータが右操作レバー１７２２を前方に倒すと、ブームシリンダ１５６が駆動し、ブーム１５１の下げ動作が実行される。また、オペレータが右操作レバー１７２２を後方に倒すと、ブームシリンダ１５６が駆動し、ブーム１５１の上げ動作が実行される。また、オペレータが右操作レバー１７２２を右方向に倒すと、バケットシリンダ１５８が駆動し、バケット１５５のダンプ動作が行われる。また、オペレータが右操作レバー１７２２を左方向に倒すと、バケットシリンダ１５８が駆動し、バケット１５５の掘削動作が行われる。
なお、左操作レバー１７２１および右操作レバー１７２２の操作方向と、作業機１５０の動作方向および旋回体１３０の旋回方向の関係は、上述の関係でなくてもよい。
なお、左操作レバー１７２１および右操作レバー１７２２の操作方向と、作業機１５０の動作方向および旋回体１３０の旋回方向の関係は、上述の関係でなくてもよい。
【0027】
また、右操作レバー１７２２の上部には、図示しないチルト操作ボタンが設けられる。具体的には、オペレータがチルト操作ボタンを左方向にスライドさせると、チルトシリンダ１６３が駆動し、オペレータから見て左方向にバケット１５５のチルト回転動作が行われる。オペレータがチルト操作ボタンを右方向にスライドさせると、チルトシリンダ１６３が駆動し、オペレータから見て右方向にバケット１５５のチルト回転動作が行われる。なお、チルト操作ボタンは、左右方向に回転させる構成であってもよい。また、チルト操作は、オペレータの図示しないペダルによる操作で実現されてもよい。
【0028】
左フットペダル１７２３は、運転席１７１の前方の床面の左側に配置される。右フットペダル１７２４は、運転席１７１の前方の床面の右側に配置される。左走行レバー１７２５は、左フットペダル１７２３に軸支され、左走行レバー１７２５の傾斜と左フットペダル１７２３の押し下げが連動するように構成される。右走行レバー１７２６は、右フットペダル１７２４に軸支され、右走行レバー１７２６の傾斜と右フットペダル１７２４の押し下げが連動するように構成される。
【0029】
左フットペダル１７２３および左走行レバー１７２５は、走行体１１０の左側履帯の回転駆動に対応する。具体的には、走行体１１０の駆動輪が後方にある場合、オペレータが左フットペダル１７２３または左走行レバー１７２５を前方に倒すと、左側履帯は前進方向に回転する。また、オペレータが左フットペダル１７２３または左走行レバー１７２５を後方に倒すと、左側履帯は後進方向に回転する。
【0030】
右フットペダル１７２４および右走行レバー１７２６は、走行体１１０の右側履帯の回転駆動に対応する。具体的には、走行体１１０の駆動輪が後方にある場合、オペレータが右フットペダル１７２４または右走行レバー１７２６を前方に倒すと、右側履帯は前進方向に回転する。また、オペレータが右フットペダル１７２４または右走行レバー１７２６を後方に倒すと、右側履帯は後進方向に回転する。
【0031】
《制御装置１９０の構成》
制御装置１９０は、施工現場において設定された目標設計面にバケット１５５が侵入しないようにバケット１５５が掘削対象に接近する方向の動作を制限する。目標設計面は、掘削対象の目標形状を示す。制御装置１９０が目標設計面に基づいてバケット１５５の動作を制限することを介入制御ともいう。
制御装置１９０は、施工現場において設定された目標設計面にバケット１５５が侵入しないようにバケット１５５が掘削対象に接近する方向の動作を制限する。目標設計面は、掘削対象の目標形状を示す。制御装置１９０が目標設計面に基づいてバケット１５５の動作を制限することを介入制御ともいう。
【0032】
ここで、オペレータがブーム１５１の下げ操作を行い、バケット１５５の刃先を目標設計面で停止させるための介入制御である停止制御について説明する。制御装置１９０は、バケット１５５と目標設計面との距離が所定の停止制御距離未満になった場合に、ブーム１５１の下げ方向への移動に伴うバケット１５５の刃先と目標設計面との距離に応じて、目標設計面にバケット１５５が侵入しないように、ブーム１５１の操作量を補正するための停止制御量を算出する。これにより、オペレータがブーム１５１を操作するだけで、制御装置１９０がブームシリンダ１５６の操作量を補正することでバケット１５５の動作を制限し、設計面へのバケット１５５の刃先の侵入を自動的に防止する。
なお、他の実施形態においては、制御装置１９０は、停止制御においてアーム１５２またはバケット１５５の操作量を補正してもよい。また、他の実施形態においては、制御装置１９０は、停止制御に加え、または停止制御に代えて、オペレータがアーム１５２の操作を行ったときに、ブーム１５１を上げ方向へ移動させることでバケット１５５の刃先が目標設計面に侵入しないように介入制御を行ってもよい。
なお、他の実施形態においては、制御装置１９０は、停止制御においてアーム１５２またはバケット１５５の操作量を補正してもよい。また、他の実施形態においては、制御装置１９０は、停止制御に加え、または停止制御に代えて、オペレータがアーム１５２の操作を行ったときに、ブーム１５１を上げ方向へ移動させることでバケット１５５の刃先が目標設計面に侵入しないように介入制御を行ってもよい。
【0033】
また、制御装置１９０は、バケット１５５と目標設計面との距離が所定のチルト制御距離未満になった場合に、バケット１５５の刃先と目標設計面とが平行になるように、バケット１５５をチルト軸Ｘ４回りに回転させる。制御装置１９０が目標設計面に基づいてバケット１５５をチルト軸Ｘ４回りに回転させることを自動チルト制御ともいう。
【0034】
図５は、第１の実施形態に係る制御装置１９０の構成を示す概略ブロック図である。
制御装置１９０は、プロセッサ２１０、メインメモリ２３０、ストレージ２５０、インタフェース２７０を備えるコンピュータである。
制御装置１９０は、プロセッサ２１０、メインメモリ２３０、ストレージ２５０、インタフェース２７０を備えるコンピュータである。
【0035】
ストレージ２５０は、一時的でない有形の記憶媒体である。ストレージ２５０の例としては、磁気ディスク、光ディスク、光磁気ディスク、半導体メモリ等が挙げられる。ストレージ２５０は、制御装置１９０のバスに直接接続された内部メディアであってもよいし、インタフェース２７０または通信回線を介して制御装置１９０に接続される外部メディアであってもよい。ストレージ２５０は、作業機械１００を制御するためのプログラムを記憶する。
【0036】
プログラムは、制御装置１９０に発揮させる機能の一部を実現するためのものであってもよい。例えば、プログラムは、ストレージ２５０に既に記憶されている他のプログラムとの組み合わせ、または他の装置に実装された他のプログラムとの組み合わせによって機能を発揮させるものであってもよい。なお、他の実施形態においては、制御装置１９０は、上記構成に加えて、または上記構成に代えてＰＬＤ（Programmable Logic Device）などのカスタムＬＳＩ（Large Scale Integrated Circuit）を備えてもよい。ＰＬＤの例としては、ＰＡＬ(Programmable Array Logic)、ＧＡＬ(Generic Array Logic)、ＣＰＬＤ(Complex Programmable Logic Device)、ＦＰＧＡ（Field Programmable Gate Array）が挙げられる。この場合、プロセッサによって実現される機能の一部または全部が当該集積回路によって実現されてよい。
【0037】
ストレージ２５０には、予め目標設計面を示す設計面データが記憶される。設計面データは、現場座標系で表される三次元データであって、複数の三角形ポリゴンによって表される。設計面データを構成する三角形ポリゴンは、それぞれ隣接する他の三角形ポリゴンと共通の辺を有する。つまり、設計面データは、複数の平面から構成される連続した平面を表す。なお、他の実施形態においては、設計面データが三角形ポリゴン以外の多角形面によって構成されてもよく、また点群データなどの他の形式で表されてもよい。
なお、本実施形態では、設計面データはストレージ２５０に記憶されるとしたが、これに限られない。設計面データは、外部メモリや、図示しないサーバから図示しない通信回線を介して、ダウンロードされてもよい。
なお、本実施形態では、設計面データはストレージ２５０に記憶されるとしたが、これに限られない。設計面データは、外部メモリや、図示しないサーバから図示しない通信回線を介して、ダウンロードされてもよい。
【0038】
プロセッサ２１０は、プログラムを実行することで、検出値取得部２１１、バケット位置特定部２１２、目標平面決定部２１３、距離算出部２１４、操作量取得部２１５、停止制御部２１６、チルト制御部２１７、チルト制限部２１８、出力部２１９として機能する。
【0039】
検出値取得部２１１は、ブームシリンダストロークセンサ１５６１、アームシリンダストロークセンサ１５７１、バケットシリンダストロークセンサ１５８１、チルトシリンダストロークセンサ１６３１、位置方位検出器１３１、および傾斜検出器１３２のそれぞれの検出値を取得する。つまり、検出値取得部２１１は、旋回体１３０の現場座標系における位置、旋回体１３０が向く方位、旋回体１３０の傾き、ブームシリンダ１５６のストローク長、アームシリンダ１５７のストローク長、バケットシリンダ１５８のストローク長、およびチルトシリンダ１６３のストローク長を取得する。
【0040】
バケット位置特定部２１２は、検出値取得部２１１が取得した検出値に基づいて、バケット１５５の刃先上の複数の点の位置を特定する。例えば、バケット位置特定部２１２は、バケット１５５の刃先を４等分する５つの点の位置をそれぞれ特定する。バケット１５５の刃先の位置の特定方法は後述する。
【0041】
目標平面決定部２１３は、停止制御およびチルト制御の対象とする目標平面を決定する。目標平面は、目標設計面を構成する複数の三角形ポリゴンの少なくとも１つを通る平面である。具体的には、目標平面決定部２１３は、以下の手順で目標平面を決定する。目標平面決定部２１３は、設計面データとバケット位置特定部２１２が特定した複数の点の位置とに基づいて、当該複数の点それぞれについて、目標設計面を構成する三角形ポリゴンのうち当該点に対向するものと当該点との間の距離を算出する。このとき、複数の点は、それぞれ異なる三角形ポリゴンと対向し得る。目標平面決定部２１３は、最も短い距離に係る三角形ポリゴンを特定し、当該三角形ポリゴンを通る平面を、目標平面に決定する。
【0042】
距離算出部２１４は、バケット位置特定部２１２が特定した複数の点の位置と目標平面決定部２１３が決定した目標平面とに基づいて、複数の点と目標平面との間の距離を算出する。
【0043】
操作量取得部２１５は、操作装置１７２から操作量を示す操作信号を取得する。操作量取得部２１５は、少なくともブーム１５１の上げ操作および下げ操作に係る操作量、アーム１５２の押し操作および引き操作に係る操作量、並びにバケット１５５の掘削操作、ダンプ操作およびチルト操作に係る操作量を取得する。
【0044】
停止制御部２１６は、操作量取得部２１５が取得した操作装置１７２の操作量と、距離算出部２１４が算出した距離のうち最も短いもの（最短バケット距離）とに基づいて、作業機１５０の停止制御を行う。具体的には、停止制御部２１６は、以下の手順で停止制御量を算出する。距離算出部２１４が算出した最短バケット距離を、バケット１５５と目標平面との距離から許容速度を求める許容速度関数に代入することで、バケット１５５の許容速度を算出する。なお、許容速度関数によれば、許容速度はバケットと目標平面との距離に対して単調増加する。「単調増加」とは、一方の値が増加したときに、常に他方の値が増加し、または変化しないこと（単調非減少）をいう。停止制御部２１６は、許容速度を、停止制御量として算出する。停止制御部２１６は、バケット１５５が目標設計面に進入しないように作業機の速度を抑制するための介入制御量を算出する介入制御部の一例である。停止制御量は介入制御量の一例である。
【0045】
チルト制御部２１７は、距離算出部２１４が算出した距離のうち、バケット１５５の刃先の左端から目標平面までの距離である第１距離と、バケット１５５の刃先の右端から目標平面までの距離である第２距離との差に基づいて、自動チルト制御を行う。バケット１５５の刃先の左端および右端は、それぞれ第１バケット点および第２バケット点の一例である。なお、他の実施形態においては、第１バケット点および第２バケット点は、バケット１５５上の他の点であってもよい。ただし、第２バケット点は、第１バケット点を通りかつバケット１５５の刃先に平行な直線上に存在するという条件を満たす必要がある。すなわち、他の実施形態においては、第１バケット点および第２バケット点は、底面上の点など、必ずしも刃先上の点でなくてもよい。チルト制御部２１７は、アタッチメント制御部の一例である。
【0046】
チルト制限部２１８は、第１距離と第２距離との差が所定の長さ閾値を超える場合に、チルト制御部２１７による自動チルト制御をキャンセルする。すなわち、チルト制限部２１８は、バケット１５５の刃先と目標設計面との角度が所定範囲を超える場合に、自動チルト制御を行わない。なお所定の長さ閾値は、第１距離と第２距離の差から決定される自動チルト制御量と介入制御量に基づいて算出される。すなわち、チルト制限部２１８は、許容速度から所定の長さ閾値を算出する。
チルト制限部２１８は、最短バケット距離が増加しないようにアタッチメント軸回りの回転を制限するアタッチメント制限部の一例である。
チルト制限部２１８は、最短バケット距離が増加しないようにアタッチメント軸回りの回転を制限するアタッチメント制限部の一例である。
【0047】
出力部２１９は、操作量取得部２１５が取得した操作量、停止制御部２１６によって算出される停止制御量、およびチルト制御部２１７によって算出されるチルト制御量に基づいて、各アクチュエータに制御信号を出力する。
【0048】
《バケット１５５の刃先位置の特定方法》
ここで、図１および図３を参照しながら、バケット位置特定部２１２によるバケット１５５の刃先の位置の特定方法について説明する。車体座標系におけるバケット１５５の刃先の位置は、ブーム長Ｌ１、アーム長Ｌ２、ジョイント長Ｌ３、バケット長Ｌ４、ブーム相対角α、アーム相対角β、バケット相対角γ、チルト角η、車体座標系におけるブームピンＰ１の位置、および現場座標系における代表点Ｏの位置に基づいて特定することができる。
ここで、図１および図３を参照しながら、バケット位置特定部２１２によるバケット１５５の刃先の位置の特定方法について説明する。車体座標系におけるバケット１５５の刃先の位置は、ブーム長Ｌ１、アーム長Ｌ２、ジョイント長Ｌ３、バケット長Ｌ４、ブーム相対角α、アーム相対角β、バケット相対角γ、チルト角η、車体座標系におけるブームピンＰ１の位置、および現場座標系における代表点Ｏの位置に基づいて特定することができる。
【0049】
ブーム長Ｌ１は、ブームピンＰ１からアームピンＰ２までの既知の長さである。
アーム長Ｌ２は、アームピンＰ２からバケットピンＰ３までの既知の長さである。
ジョイント長Ｌ３は、バケットピンＰ３からチルトピンＰ７までの既知の長さである。
バケット長Ｌ４は、チルトピンＰ７からバケット１５５の刃先の中心点までの既知の長さである。
アーム長Ｌ２は、アームピンＰ２からバケットピンＰ３までの既知の長さである。
ジョイント長Ｌ３は、バケットピンＰ３からチルトピンＰ７までの既知の長さである。
バケット長Ｌ４は、チルトピンＰ７からバケット１５５の刃先の中心点までの既知の長さである。
【0050】
ブーム相対角αは、ブームピンＰ１から旋回体１３０の上方向（＋Ｚｍ方向）に伸びる半直線と、ブームピンＰ１からアームピンＰ２へ伸びる半直線とがなす角によって表される。なお、図１に示すように、旋回体１３０の傾きθによって、旋回体１３０の上方向（＋Ｚｍ方向）と鉛直上方向（＋Ｚｇ方向）は必ずしも一致しない。
アーム相対角βは、ブームピンＰ１からアームピンＰ２へ伸びる半直線と、アームピンＰ２からバケットピンＰ３へ伸びる半直線とがなす角によって表される。
バケット相対角γは、アームピンＰ２からバケットピンＰ３へ伸びる半直線と、バケットピンＰ３からチルトピンＰ７へ伸びる半直線とがなす角によって表される。
チルト角ηは、チルトピンＰ７から、バケットピンＰ３およびチルトピンＰ７に直交する方向へ伸びる半直線と、チルトピンＰ７からバケット１５５の刃先の中心点へ伸びる半直線とがなす角によって表される。
アーム相対角βは、ブームピンＰ１からアームピンＰ２へ伸びる半直線と、アームピンＰ２からバケットピンＰ３へ伸びる半直線とがなす角によって表される。
バケット相対角γは、アームピンＰ２からバケットピンＰ３へ伸びる半直線と、バケットピンＰ３からチルトピンＰ７へ伸びる半直線とがなす角によって表される。
チルト角ηは、チルトピンＰ７から、バケットピンＰ３およびチルトピンＰ７に直交する方向へ伸びる半直線と、チルトピンＰ７からバケット１５５の刃先の中心点へ伸びる半直線とがなす角によって表される。
【0051】
バケット１５５の刃先の現場座標系における位置は、例えば以下の手順で特定される。バケット位置特定部２１２は、車体座標系におけるブームピンＰ１の位置とブーム相対角αとブーム長さＬ１とに基づいて、車体座標系におけるアームピンＰ２の位置を特定する。バケット位置特定部２１２は、車体座標系におけるアームピンＰ２の位置とアーム相対角βとアーム長Ｌ２とに基づいて、車体座標系におけるバケットピンＰ３の位置を特定する。バケット位置特定部２１２は、車体座標系におけるバケットピンＰ３の位置と、バケット相対角γと、ジョイント長Ｌ３とに基づいて、車体座標系におけるチルトピンＰ７の位置を特定する。バケット位置特定部２１２は、車体座標系におけるチルトピンＰ７の位置と、チルト角ηと、バケット長Ｌ４とに基づいて、車体座標系におけるバケット１５５の刃先の中心点の位置を特定する。また、バケット位置特定部２１２は、刃先の中心点から刃先の任意の点までの距離を特定し、刃先の中心点の位置から、チルト角ηの方向に、刃先の中心点から任意の点までの距離だけずらした位置を計算することで、刃先の任意の点の位置を特定することができる。例えば、バケット位置特定部２１２は、刃先の中心点の位置から、チルト角ηの正負の方向にそれぞれ刃先の幅方向の長さの１／２だけずらした位置を計算することで、刃先の両端の位置を特定することができる。
【0052】
ブーム相対角α、アーム相対角β、バケット相対角γ、およびチルト角ηは、それぞれ、ブームシリンダストロークセンサ１５６１の検出値、アームシリンダストロークセンサ１５７１の検出値、バケットシリンダストロークセンサ１５８１の検出値、およびチルトシリンダストロークセンサ１６３１の検出値によって特定される。バケット位置特定部２１２は、旋回体１３０の現場座標系における位置、旋回体１３０が向く方位、および旋回体１３０の姿勢に基づいて、車体座標系におけるバケット１５５の刃先の位置を、現場座標系における位置に変換する。
なお、ブーム相対角α、アーム相対角β、バケット相対角γ、およびチルト角ηの検出は、シリンダストロークセンサによって行うものに限られず、角度センサによって行ってもよい。
なお、ブーム相対角α、アーム相対角β、バケット相対角γ、およびチルト角ηの検出は、シリンダストロークセンサによって行うものに限られず、角度センサによって行ってもよい。
【0053】
《制御装置１９０の動作》
図６は、第１の実施形態に係る制御装置１９０の動作を示すフローチャートである。図７は、チルト自動制御における目標設計面と刃先上の点との関係を示す図である。
作業機械１００のオペレータが作業機械１００の操作を開始すると、制御装置１９０は、所定の制御周期ごとに以下に示す制御を実行する。
図６は、第１の実施形態に係る制御装置１９０の動作を示すフローチャートである。図７は、チルト自動制御における目標設計面と刃先上の点との関係を示す図である。
作業機械１００のオペレータが作業機械１００の操作を開始すると、制御装置１９０は、所定の制御周期ごとに以下に示す制御を実行する。
【0054】
操作量取得部２１５は、操作装置１７２からブーム１５１に係る操作量、アーム１５２に係る操作量、バケット１５５に係る操作量、チルトに係る操作量、および旋回体１３０の旋回に係る操作量を取得する（ステップＳ１）。検出値取得部２１１は、位置方位検出器１３１、傾斜検出器１３２、ブームシリンダストロークセンサ１５６１、アームシリンダストロークセンサ１５７１、バケットシリンダストロークセンサ１５８１、チルトシリンダストロークセンサ１６３１のそれぞれが検出した情報を取得する（ステップＳ２）。
【0055】
バケット位置特定部２１２は、各油圧シリンダのストローク長からブーム相対角α、アーム相対角β、バケット相対角γ、およびチルト角ηを算出する（ステップＳ３）。またバケット位置特定部２１２は、ステップＳ２で取得した検出値、ステップＳ３で算出した角度、および既知の作業機１５０の長さパラメータに基づいて、バケット１５５の刃先を４等分する５つの点の現場座標系における位置を算出する（ステップＳ４）。以下、バケット１５５の刃先上の５つの点を、刃先の左端から順に、点ｐ１、点ｐ２、点ｐ３、点ｐ４、点ｐ５とよぶ。すなわち、点ｐ１は刃先の左端の点であり、点ｐ５は刃先の右端の点であり、点ｐ３は刃先の中心点である。
なお、角度センサやＩＭＵを用いて直接的に角度が検出される場合、ステップＳ３は省略されてもよい。
なお、角度センサやＩＭＵを用いて直接的に角度が検出される場合、ステップＳ３は省略されてもよい。
【0056】
目標平面決定部２１３は、ストレージ２５０から設計面データを読み出し、点ｐ１－ｐ５それぞれについて、目標設計面との間の距離を算出する（ステップＳ５）。ステップＳ５において、目標平面決定部２１３は、点ｐ１－ｐ５のそれぞれについて、当該点から鉛直方向（Ｚｇ軸方向）に伸びる方向に対向する三角形ポリゴンとの距離を算出する。図７に示す例においては、目標平面決定部２１３は、点ｐ１－ｐ３と三角形ポリゴンｔ１との距離Ｌ１１－Ｌ１３、および点ｐ４－ｐ５と三角形ポリゴンｔ２との距離Ｌ１４－Ｌ１５を算出する。バケット１５５の刃先の位置を現場座標系で特定した場合は、現場座標系に基づく設計面データを用いる。バケット１５５の刃先の位置を車体座標系で特定した場合は、車体座標系に基づく設計面データを用いてもよい。例えば、車体座標系に基づく設計面データは、現場座標系に基づく設計面データを、位置方位検出器１３１および傾斜検出器１３２の検出値に基づいて車体座標系に変換したものであってよい。
【0057】
次に、目標平面決定部２１３は、最も短い距離に係る三角形ポリゴンを特定し、当該三角形ポリゴンを通る平面を、目標平面ｇ１に決定する（ステップＳ６）。図７に示す例においては、距離Ｌ１１から距離Ｌ１５のうち、点ｐ３と三角形ポリゴンｔ１との距離Ｌ１３が最も短いため、目標平面決定部２１３は、三角形ポリゴンｔ１を通る平面を目標平面ｇ１に決定する。
【0058】
距離算出部２１４は、ステップＳ４で算出した刃先両端の点ｐ１、ｐ５の位置と、ステップＳ６で決定した目標平面ｇ１とに基づいて、点ｐ１と目標平面ｇ１との間の距離Ｌ２１、および点ｐ５と目標平面ｇ１との間の距離Ｌ２２を算出する（ステップＳ７）。ステップＳ７において、目標平面決定部２１３は、点ｐ１および点ｐ５のそれぞれについて、目標平面ｇ１の法線方向における目標平面ｇ１との距離Ｌ２１、Ｌ２２を算出する。距離算出部２１４は、距離Ｌ２１および距離Ｌ２１の短い方を、最短バケット距離として特定する。
【0059】
次に、チルト制御部２１７は、ステップＳ１で取得した操作量に基づいて、オペレータによるチルト操作入力があるか否かを判定する（ステップＳ８）。例えば、チルト制御部２１７は、チルト操作量の絶対値が所定値未満である場合に、操作入力がないと判定する。チルト操作がない場合（ステップＳ８：ＮＯ）、チルト制御部２１７は、ステップＳ７で特定した最短バケット距離が、チルト制御距離ｔｈ２未満であるか否かを判定する（ステップＳ９）。
【0060】
最短バケット距離がチルト制御距離ｔｈ２未満である場合（ステップＳ９：ＹＥＳ）、チルト制御部２１７は、ステップＳ７で算出した距離Ｌ２１と距離Ｌ２２との差（距離差）を算出する（ステップＳ１０）。
停止制御部２１６は、ステップＳ７で特定した最短バケット距離と、ステップＳ１で取得した操作量とに基づいて、バケット１５５の速度を算出する（ステップＳ１１）。具体的には、停止制御部２１６は、最短バケット距離を許容速度関数に代入することで、バケット１５５の許容速度を算出する。また、停止制御部２１６は、ステップＳ１で取得した操作量に基づいて、当該操作量に従って作業機１５０を制御したときのバケット１５５の速度（非介入速度）を算出する。停止制御部２１６は、許容速度と非介入速度のうち遅い方を、バケット１５５の速度とする。
チルト制限部２１８は、ステップＳ１１で算出したバケット１５５の速度に基づいて、バケット１５５のチルト軸Ｘ４回りの回転に係る許容制御量を決定する（ステップＳ１２）。なお、チルト制限部２１８は、バケット１５５の速度が遅いほど、許容制御量を小さい値に決定する。
チルト制御部２１８は、許容制御量から所定の長さ閾値を算出する（ステップＳ１３）。所定の長さ閾値は、許容制御量が小さいほど小さい値に設定される。
ここで、チルト制限部２１８は、ステップＳ１０で算出した距離差がステップＳ１３で算出した所定の長さ閾値を超えるか否かを判定する（ステップＳ１４）。距離差が所定の長さ閾値を超えない場合（ステップＳ１４：ＮＯ）、チルト制御部２１７は、ステップＳ１０で算出した距離差に基づいてチルト制御量を算出する（ステップＳ１５）。
停止制御部２１６は、ステップＳ７で特定した最短バケット距離と、ステップＳ１で取得した操作量とに基づいて、バケット１５５の速度を算出する（ステップＳ１１）。具体的には、停止制御部２１６は、最短バケット距離を許容速度関数に代入することで、バケット１５５の許容速度を算出する。また、停止制御部２１６は、ステップＳ１で取得した操作量に基づいて、当該操作量に従って作業機１５０を制御したときのバケット１５５の速度（非介入速度）を算出する。停止制御部２１６は、許容速度と非介入速度のうち遅い方を、バケット１５５の速度とする。
チルト制限部２１８は、ステップＳ１１で算出したバケット１５５の速度に基づいて、バケット１５５のチルト軸Ｘ４回りの回転に係る許容制御量を決定する（ステップＳ１２）。なお、チルト制限部２１８は、バケット１５５の速度が遅いほど、許容制御量を小さい値に決定する。
チルト制御部２１８は、許容制御量から所定の長さ閾値を算出する（ステップＳ１３）。所定の長さ閾値は、許容制御量が小さいほど小さい値に設定される。
ここで、チルト制限部２１８は、ステップＳ１０で算出した距離差がステップＳ１３で算出した所定の長さ閾値を超えるか否かを判定する（ステップＳ１４）。距離差が所定の長さ閾値を超えない場合（ステップＳ１４：ＮＯ）、チルト制御部２１７は、ステップＳ１０で算出した距離差に基づいてチルト制御量を算出する（ステップＳ１５）。
【0061】
図８は、第１の実施形態に係るバケットの距離差とチルト角速度の目標値の関係を示すチルト関数の例を示す図である。図８に示すバケットの距離差は、図７に示す距離Ｌ２１から距離Ｌ２２を減算して得られるものであって、図７における反時計回りの角速度を正とするものである。
ステップＳ１５において、チルト制御部２１７は、図８に示すような予め定められたチルト関数に距離差を代入することで、チルト角速度の目標値を決定する。チルト関数は、バケット１５５の距離差に基づいてチルト角速度の目標値を求める関数である。チルト関数において、チルト角速度の目標値は、バケット１５５の距離差に対して単調増加する。また、チルト関数において、チルト角速度の上限値および下限値が定められており、距離差の絶対値が所定値を超えるとチルト角速度の目標値は一定となる。そして、チルト制御部２１７は、決定したチルト角速度の目標値に基づいて、チルト制御量を決定する。
ステップＳ１５において、チルト制御部２１７は、図８に示すような予め定められたチルト関数に距離差を代入することで、チルト角速度の目標値を決定する。チルト関数は、バケット１５５の距離差に基づいてチルト角速度の目標値を求める関数である。チルト関数において、チルト角速度の目標値は、バケット１５５の距離差に対して単調増加する。また、チルト関数において、チルト角速度の上限値および下限値が定められており、距離差の絶対値が所定値を超えるとチルト角速度の目標値は一定となる。そして、チルト制御部２１７は、決定したチルト角速度の目標値に基づいて、チルト制御量を決定する。
【0062】
なお、チルト操作がなされている場合（ステップＳ８：ＹＥＳ）、ならびに距離Ｌ２１および距離Ｌ２２の両方がチルト制御距離ｔｈ２以上である場合（ステップＳ９：ＮＯ）、チルト制御部２１７は、チルト制御量を算出しない。また、ステップＳ１６において、距離差が所定の長さ閾値を超える場合（ステップＳ１４：ＹＥＳ）、チルト制限部２１８は、チルト制御部２１７の自動チルト制御をキャンセルする。このとき、制御装置１９０は、表示や音声などによって、自動チルト制御を行わない旨をオペレータに通知してもよい。
【0063】
そして、出力部２１９は、作業機１５０に係る各操作量およびチルト制御部２１７によって算出されるチルト制御量に基づいて、各アクチュエータに制御信号を出力する（ステップＳ１６）。自動チルト制御を実行している場合、チルトシリンダ１６３は、チルト制御部２１７で生成された信号に従って駆動する。自動チルト制御を実行しない場合、チルトシリンダ１６３は、オペレータ操作量に基づく信号に従って駆動する。
【0064】
《作用・効果》
このように、第１の実施形態に係る制御装置１９０は、バケット１５５が目標設計面に侵入しないようにするための停止制御量およびバケット１５５と目標設計面とを平行に近づけるためのチルト制御量を算出する。そして、制御装置１９０は、停止制御量およびチルト制御量に基づく作業機１５０の移動によって最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限する。チルト軸Ｘ４回りの回転の制限によって最短バケット距離の変化は時間に対して単調減少となるため、制御装置１９０による停止制御量の変化を安定させることができる。したがって、制御装置１９０は、作業機１５０の動作の安定を保ちながら、停止制御と自動チルト制御とを同時に行うことができる。
このように、第１の実施形態に係る制御装置１９０は、バケット１５５が目標設計面に侵入しないようにするための停止制御量およびバケット１５５と目標設計面とを平行に近づけるためのチルト制御量を算出する。そして、制御装置１９０は、停止制御量およびチルト制御量に基づく作業機１５０の移動によって最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限する。チルト軸Ｘ４回りの回転の制限によって最短バケット距離の変化は時間に対して単調減少となるため、制御装置１９０による停止制御量の変化を安定させることができる。したがって、制御装置１９０は、作業機１５０の動作の安定を保ちながら、停止制御と自動チルト制御とを同時に行うことができる。
【0065】
特に、チルト軸Ｘ４回りの回転を制限しない場合、チルト制御距離の近傍において最短バケット距離が増加すると、チルト制御のＯＮ／ＯＦＦが繰り返し切り替わることで、作業機１５０の動きが不安定になる可能性が高い。そのため、制御装置１９０が、最短バケット距離が増加しないようにチルト軸Ｘ４回りの回転を制限することで、チルト制御のＯＮ／ＯＦＦの切り替わりが頻発することを抑え、作業機１５０の動きを安定させることができる。
【0066】
また、第１の実施形態に係る制御装置１９０は、刃先の両端の距離差が長さ閾値を超える場合、すなわちバケット１５５の刃先と目標設計面との角度が所定範囲を超える場合に、チルト軸Ｘ４回りの回転を停止させることで、最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限する。第１の実施形態においては、バケット１５５の刃先と目標設計面との角度が大きいほどチルト制御量が大きくなる。そのため、長さ閾値を、チルト制御量によるバケット１５５の最下点の上昇速度が、停止制御による作業機１５０の許容速度を超えない範囲に設定しておくことで、最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限することができる。
なお、第１の実施形態においては、バケット１５５の刃先と目標設計面との角度が所定範囲を超える場合には自動チルト制御がなされないが、オペレータの操作によってバケット１５５のチルト角ηを目標設計面に近づけ、刃先両端の距離差を長さ閾値以下とすることで、自動チルト制御を有効にすることができる。
なお、第１の実施形態においては、バケット１５５の刃先と目標設計面との角度が所定範囲を超える場合には自動チルト制御がなされないが、オペレータの操作によってバケット１５５のチルト角ηを目標設計面に近づけ、刃先両端の距離差を長さ閾値以下とすることで、自動チルト制御を有効にすることができる。
【0067】
〈第２の実施形態〉
第１の実施形態に係る制御装置１９０は、バケット１５５の刃先と目標設計面との角度が所定範囲を超える場合に、自動チルト制御をキャンセルする。これに対し、第２の実施形態に係る制御装置１９０は、作業機１５０の許容速度に応じてチルト関数を変化させることで、最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限する。
第１の実施形態に係る制御装置１９０は、バケット１５５の刃先と目標設計面との角度が所定範囲を超える場合に、自動チルト制御をキャンセルする。これに対し、第２の実施形態に係る制御装置１９０は、作業機１５０の許容速度に応じてチルト関数を変化させることで、最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限する。
【0068】
第２の実施形態に係る制御装置１９０は、図５に示すように第１の実施形態と同様の構成を有する。他方、第２の実施形態に係る制御装置１９０は、第１の実施形態とチルト制限部２１８の動作が異なる。
第２の実施形態に係るチルト制限部２１８は、停止制御部２１６が算出する許容速度に応じて、チルト関数に係る傾きを変化させる。具体的には、チルト制限部２１８は、停止制御部２１６が算出する許容速度が小さいほど、バケット１５５の刃先の両端の距離差に対するチルト角速度の目標値が小さくなるように、チルト関数に係る傾き（距離差に係るゲイン）を変化させる。許容速度とチルト関数に係る傾きとの関係は予め定められる。なお、チルト関数に係る傾きは、チルト角速度の目標値に従ってバケット１５５を回転させたときにバケット１５５の最下点の移動速度が許容速度を超えないように定められる。
第２の実施形態に係るチルト制限部２１８は、停止制御部２１６が算出する許容速度に応じて、チルト関数に係る傾きを変化させる。具体的には、チルト制限部２１８は、停止制御部２１６が算出する許容速度が小さいほど、バケット１５５の刃先の両端の距離差に対するチルト角速度の目標値が小さくなるように、チルト関数に係る傾き（距離差に係るゲイン）を変化させる。許容速度とチルト関数に係る傾きとの関係は予め定められる。なお、チルト関数に係る傾きは、チルト角速度の目標値に従ってバケット１５５を回転させたときにバケット１５５の最下点の移動速度が許容速度を超えないように定められる。
【0069】
《制御装置１９０の動作》
図９は、第２の実施形態に係る制御装置１９０の動作を示すフローチャートである。
制御装置１９０は、第１の実施形態と同様に、ステップＳ１からステップＳ１１の処理を行う。ステップＳ１１において停止制御部２１６が操作量と最短バケット距離に基づいてバケット１５５の速度を算出すると、チルト制限部２１８は、ステップＳ１１で算出したバケット１５５の速度に基づいて、チルト関数の傾きを決定する（ステップＳ１１１）。すなわち、チルト制限部２１８は、予め定められたバケット１５５の速度とチルト関数に係る傾きとの関係から、ステップＳ１１で算出したバケット１５５の速度に対応する傾きを特定する。そして、チルト制御部２１７は、ステップＳ１１１で決定したチルト関数に、ステップＳ１０で算出した距離差を代入することでチルト制御量を算出する（ステップＳ１５）。以降、制御装置１９０は、第１の実施形態と同様に、ステップＳ１６の処理を行う。
図９は、第２の実施形態に係る制御装置１９０の動作を示すフローチャートである。
制御装置１９０は、第１の実施形態と同様に、ステップＳ１からステップＳ１１の処理を行う。ステップＳ１１において停止制御部２１６が操作量と最短バケット距離に基づいてバケット１５５の速度を算出すると、チルト制限部２１８は、ステップＳ１１で算出したバケット１５５の速度に基づいて、チルト関数の傾きを決定する（ステップＳ１１１）。すなわち、チルト制限部２１８は、予め定められたバケット１５５の速度とチルト関数に係る傾きとの関係から、ステップＳ１１で算出したバケット１５５の速度に対応する傾きを特定する。そして、チルト制御部２１７は、ステップＳ１１１で決定したチルト関数に、ステップＳ１０で算出した距離差を代入することでチルト制御量を算出する（ステップＳ１５）。以降、制御装置１９０は、第１の実施形態と同様に、ステップＳ１６の処理を行う。
【0070】
《作用・効果》
このように、第２の実施形態に係る制御装置１９０は、バケット１５５の速度に応じてチルト関数を変化させる。これにより、バケット１５５の速度が小さいほどチルト角速度の目標値が小さくなるため、最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限することができる。
なお、第２の実施形態によれば、制御装置１９０は、バケット１５５の刃先と目標設計面との角度が所定範囲を超える場合にも、自動チルト制御を実行することができる。
このように、第２の実施形態に係る制御装置１９０は、バケット１５５の速度に応じてチルト関数を変化させる。これにより、バケット１５５の速度が小さいほどチルト角速度の目標値が小さくなるため、最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限することができる。
なお、第２の実施形態によれば、制御装置１９０は、バケット１５５の刃先と目標設計面との角度が所定範囲を超える場合にも、自動チルト制御を実行することができる。
【0071】
なお、第２の実施形態に係るチルト制限部２１８は、停止制御部２１６が算出する許容速度に応じて、チルト関数に係る傾きを変化させるが、これに限られない。例えば、他の実施形態に係るチルト制限部２１８は、許容速度に応じて、チルト関数に係る上限値および下限値を変化させてもよい。この場合、チルト角速度の目標値の上限値および下限値は、当該上限値または下限値に従ってバケット１５５を回転させたときに、バケット１５５の最下点の移動速度が許容速度を超えないように定められる。また、他の実施形態においては、停止制御部２１６が算出する許容速度に応じて、チルト関数に係る傾きならびに上限値および下限値を変化させてもよい。
【0072】
〈第３の実施形態〉
第３の実施形態に係る制御装置１９０は、許容速度に基づいて最短バケット距離を一定に保つことができる許容制御量を算出し、チルト制御量を許容制御量以下に制限する。
第３の実施形態に係る制御装置１９０は、許容速度に基づいて最短バケット距離を一定に保つことができる許容制御量を算出し、チルト制御量を許容制御量以下に制限する。
【0073】
第３の実施形態に係る制御装置１９０は、図５に示すように第１の実施形態と同様の構成を有する。他方、第３の実施形態に係る制御装置１９０は、第１の実施形態とチルト制限部２１８の動作が異なる。
第３の実施形態に係るチルト制限部２１８は、停止制御部２１６が算出する許容速度をバケット１５５のチルト軸Ｘ４回りの回転速度に変換することで、許容角速度を算出する。例えば、チルト制限部２１８は、チルトピンＰ７からバケット１５５の刃先の一端までの長さで許容速度を除算することで、許容角速度を算出する。そして、チルト制限部２１８は、許容角速度をチルト制御量に変換することで、許容制御量を算出する。そして、チルト制限部２１８は、チルト制御部２１７が算出したチルト制御量を許容制御量以下に制限する。
第３の実施形態に係るチルト制限部２１８は、停止制御部２１６が算出する許容速度をバケット１５５のチルト軸Ｘ４回りの回転速度に変換することで、許容角速度を算出する。例えば、チルト制限部２１８は、チルトピンＰ７からバケット１５５の刃先の一端までの長さで許容速度を除算することで、許容角速度を算出する。そして、チルト制限部２１８は、許容角速度をチルト制御量に変換することで、許容制御量を算出する。そして、チルト制限部２１８は、チルト制御部２１７が算出したチルト制御量を許容制御量以下に制限する。
【0074】
《制御装置１９０の動作》
図１０は、第３の実施形態に係る制御装置１９０の動作を示すフローチャートである。
制御装置１９０は、第１の実施形態と同様に、ステップＳ１からステップＳ１２の処理を行う。ステップＳ１２において許容制限量を算出すると、チルト制御部２１７は、チルト関数にステップＳ１０で算出した距離差を代入することでチルト制御量を算出する（ステップＳ１５）。
図１０は、第３の実施形態に係る制御装置１９０の動作を示すフローチャートである。
制御装置１９０は、第１の実施形態と同様に、ステップＳ１からステップＳ１２の処理を行う。ステップＳ１２において許容制限量を算出すると、チルト制御部２１７は、チルト関数にステップＳ１０で算出した距離差を代入することでチルト制御量を算出する（ステップＳ１５）。
【0075】
次に、チルト制限部２１８は、ステップＳ１５で算出したチルト制御量の絶対値がステップＳ１２で算出した許容制御量を超えるか否かを判定する（ステップＳ２１１）。チルト制御量の絶対値が許容制御量を超える場合（ステップＳ２１１：ＹＥＳ）、チルト制限部２１８は、チルト制御量を、絶対値が許容制御量に等しくなるよう制限する。すなわち、チルト制限部２１８は、チルト制御量の符号を維持したまま、その絶対値を許容制御量の絶対値に書き換える（ステップＳ２１２）。他方、チルト制御量の絶対値が許容制御量以下である場合（ステップＳ２１１：ＮＯ）、チルト制御量を書き換えない。
以降、制御装置１９０は、第１の実施形態と同様に、ステップＳ１６の処理を行う。
以降、制御装置１９０は、第１の実施形態と同様に、ステップＳ１６の処理を行う。
【0076】
《作用・効果》
このように、第３の実施形態に係る制御装置１９０は、許容速度に基づいて最短バケット距離を一定に保つことができる許容制御量を算出し、チルト制御量の絶対値を許容制御量以下に制限する。これにより、制御装置１９０は、最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限することができる。
なお、第３の実施形態によれば、制御装置１９０は、バケット１５５の刃先と目標設計面との角度が所定範囲を超える場合にも、自動チルト制御を実行することができる。
このように、第３の実施形態に係る制御装置１９０は、許容速度に基づいて最短バケット距離を一定に保つことができる許容制御量を算出し、チルト制御量の絶対値を許容制御量以下に制限する。これにより、制御装置１９０は、最短バケット距離が増加しないように、チルト軸Ｘ４回りの回転を制限することができる。
なお、第３の実施形態によれば、制御装置１９０は、バケット１５５の刃先と目標設計面との角度が所定範囲を超える場合にも、自動チルト制御を実行することができる。
【0077】
〈他の実施形態〉
以上、図面を参照して一実施形態について詳しく説明してきたが、具体的な構成は上述のものに限られることはなく、様々な設計変更等をすることが可能である。すなわち、他の実施形態においては、上述の処理の順序が適宜変更されてもよい。また、一部の処理が並列に実行されてもよい。
以上、図面を参照して一実施形態について詳しく説明してきたが、具体的な構成は上述のものに限られることはなく、様々な設計変更等をすることが可能である。すなわち、他の実施形態においては、上述の処理の順序が適宜変更されてもよい。また、一部の処理が並列に実行されてもよい。
【0078】
上述した実施形態に係る制御装置１９０は、単独のコンピュータによって構成されるものであってもよいし、制御装置１９０の構成を複数のコンピュータに分けて配置し、複数のコンピュータが互いに協働することで制御システムとして機能するものであってもよい。このとき、制御装置１９０を構成する一部のコンピュータが作業機械１００の内部に搭載され、他のコンピュータが作業機械１００の外部に設けられてもよい。
【0079】
上述した実施形態に係る制御装置１９０は、図７に示す基準に基づいて距離Ｌ１１－Ｌ１５ならびに距離Ｌ２１および距離Ｌ２２を求めるが、これに限られない。例えば、他の実施形態に係る制御装置１９０は、距離Ｌ１１－Ｌ１５を三角形ポリゴンの法線方向に対する距離として求めてもよいし、バケット１５５の刃先に直交する方向に対する距離として求めてもよい。また他の実施形態に係る制御装置１９０は、距離Ｌ２１および距離Ｌ２２を鉛直方向に対する距離として求めてもよいし、バケット１５５の刃先に直交する方向に対する距離として求めてもよい。
【0080】
上述した実施形態に係る制御装置１９０は、バケット１５５の停止制御および自動チルト制御を行うが、これに限られない。例えば、他の実施形態に係る制御装置１９０は、バケット１５５の停止制御を行わずに自動チルト制御を行ってもよい。
【0081】
上述した実施形態においては、バケット１５５の刃先の両端と目標設計面との差に基づいてチルト制御量を算出するが、これに限られない。例えば、他の実施形態においては、チルトシリンダが計測するチルト角ηに基づいてチルト制御量を算出してもよい。
【0082】
上述した実施形態においては、制御装置１９０は、バケット１５５の刃先の両端と目標設計面との差に基づいてチルト制御量を算出するが、これに限られない。例えば、他の実施形態に係る制御装置１９０は、第１距離Ｌ２１と第２距離Ｌ２２の一方がチルト制御距離ｔｈ２未満になった場合に、その時の第１距離Ｌ２１と第２距離Ｌ２２の他方に基づいて、チルト制御量を算出してもよい。例えば、制御装置１９０は、第１距離Ｌ２１がチルト制御距離ｔｈ２未満になった場合に、その時の第２距離Ｌ２２の大きさに基づいてチルト制御量を算出してもよい。また例えば、制御装置１９０は、第１距離Ｌ２１と第２距離Ｌ２２の他方の距離が所定値以上である場合に、チルト軸Ｘ４回りの回転をさせないようにしてもよい。
【0083】
上述した実施形態においては、制御装置１９０は、バケット１５５のチルト軸Ｘ４回りの回転を制御することで、バケット１５５の刃先と目標設計面とを平行に近づけるが、これに限られない。他の実施形態においては、作業機械１００のバケット１５５が、ローテート軸回りに回転可能なローテートバケットである場合に、制御装置１９０がローテート軸回りの回転を制御することで、バケット１５５の刃先と目標設計面とを平行に近づけてもよい。ローテート軸は、アタッチメント軸の一例である。
【0084】
上述した実施形態に係る制御装置１９０は、常に自動チルト制御を有効にしているが、これに限られない。他の実施形態に係る操作装置１７２は、自動チルト制御の有効／無効を切り替えるためのスイッチを備えていてもよい。この場合、制御装置１９０は、当該スイッチの状態に基づいて自動チルト制御を行うか否かを判断してもよい。すなわち、制御装置１９０は、スイッチがＯＮである場合において、チルト操作入力がなく（ステップＳ８：ＮＯ）、かつバケット１５５の刃先と目標平面ｇ１との間の距離がチルト制御距離ｔｈ２未満である（ステップＳ９：ＹＥＳ）場合に、自動チルト制御を行う。一方で、制御装置１９０は、スイッチがＯＦＦである場合には、チルト操作入力がなく、かつバケット１５５の刃先と目標平面ｇ１との間の距離がチルト制御距離ｔｈ２未満であったとしても、自動チルト制御を行わない。当該スイッチはオペレータが操作できる態様であれば、図示しないモニタの機能として設けられてもよいし、操作レバーなどに配置されてもよい。
【0085】
上述した実施形態においては、制御装置１９０は、チルト制御量から長さ閾値を算出することとしたが、これに限られない。他の実施形態においては、長さ閾値は固定値であってもよい。
【符号の説明】
【0086】
１００…作業機械 １１０…走行体 １３０…旋回体 １３１…位置方位検出器 １３２…傾斜検出器 １５０…作業機 １５１…ブーム １５２…アーム １５５…バケット １６１…バケット本体 １６２…ジョイント １６３…チルトシリンダ １９０…制御装置 ２１１…検出値取得部 ２１２…バケット位置特定部 ２１３…目標平面決定部 ２１４…距離算出部 ２１５…操作量取得部 ２１６…停止制御部 ２１７…チルト制御部 ２１８…チルト制限部 ２１９…出力部
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】