JP2023081170A - 作業機械のためのシステム、方法、及び作業機械 - Google Patents

Abstract

【課題】作業機械において、構成部分の一部が交換された後でも、作業機械全体の重心位置を精度よく算出する。
【解決手段】システムは、第１部分を含む複数の構成部分を有する作業機械のためのシステムである。当該システムは、記憶装置と、入力装置と、コントローラとを備える。記憶装置は、複数の構成部分のそれぞれの重心位置を記憶している。入力装置は、第１部分の重心位置を決定するための第１パラメータの入力を受け付ける。コントローラは、複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を算出する。コントローラは、入力装置によって第１パラメータが入力されたときには、第１パラメータによって、第１部分の重心位置を設定する。コントローラは、設定された第１部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を設定する。
【選択図】図４

Description

本発明は、作業機械のためのシステム、方法、及び作業機械に関する。

従来、作業機械全体の重心位置を算出して作業機械の転倒の可能性を判別する技術が知られている。例えば、特許文献１では、油圧ショベルの重心位置を求めるための計算モデルとして、集中質点モデルが使用される。集中質点モデルでは、油圧ショベルの各構成部分の重心に質量が集中していると見なされる。油圧ショベルは、ブームと、アームと、バケットと、旋回体と、走行体とを備えている。油圧ショベルの重心位置は、ブームの重心位置と、アームの重心位置と、バケットの重心位置と、旋回体の重心位置と、走行体の重心位置とを合成することで決定される。

特開２０１９－５２４９９号公報

作業機械は、出荷後に、構成部分の一部が別の部品に交換されることがある。例えば、油圧ショベルのバケットが、別の種類のアタッチメントに交換されることがある。或いは、旋回体のカウンタウェイトが、別の仕様のものに交換されることがある。そのような場合、交換後の構成部分の重心位置は、交換前の構成部品の重心位置から変化する。そのため、作業機械全体の重心位置を精度よく算出することが困難になる。本発明の目的は、作業機械において、構成部分の一部が交換された後でも、作業機械全体の重心位置を精度よく算出することにある。

本発明の第１の態様に係るシステムは、第１部分を含む複数の構成部分を有する作業機械のためのシステムである。当該システムは、記憶装置と、入力装置と、コントローラとを備える。記憶装置は、複数の構成部分のそれぞれの重心位置を記憶している。入力装置は、第１部分の重心位置を決定するための第１パラメータの入力を受け付ける。コントローラは、複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を算出する。コントローラは、入力装置によって第１パラメータが入力されたときには、第１パラメータによって、第１部分の重心位置を設定する。コントローラは、設定された第１部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を設定する。

本発明の第２の態様に係る方法は、第１部分を含む複数の構成部分を有する作業機械を制御するための方法である。当該方法は、複数の構成部分のそれぞれの重心位置を取得することと、複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を算出することと、入力装置を介して、第１部分の重心位置を決定するための第１パラメータの入力を受け付けることと、入力装置によって第１パラメータが入力されたときには、第１パラメータによって、第１部分の重心位置を設定することと、設定された第１部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を設定すること、を備える。

本発明の第３の態様に係る作業機械は、複数の構成部分と、記憶装置と、入力装置と、コントローラとを備える。複数の構成部分は、第１部分を含む。記憶装置は、複数の構成部分のそれぞれの重心位置を記憶している。入力装置は、第１部分の重心位置を決定するための第１パラメータの入力を受け付ける。コントローラは、複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を算出する。コントローラは、入力装置によって第１パラメータが入力されたときには、第１パラメータによって、第１部分の重心位置を設定する。コントローラは、設定された第１部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を設定する。

本発明によれば、作業機械の第１部分が交換された場合、交換後の第１部分の第１パラメータが、入力装置を介して入力されることで、第１部分の重心位置が設定される。そして、設定された第１部分の重心位置に基づいて、作業機械全体の重心位置が算出される。それにより、第１部品が交換された後でも、作業機械全体の重心位置が精度よく算出される。

実施形態に係る作業機械の側面図である。 作業機械の制御システムの構成を示すブロック図である。 作業機械の構成を模式的に示す図である。 作業機械全体の重心位置を算出するための処理を示すフローチャートである。 作業機械の複数の構成部分の重心位置を示す図である。 アタッチメントの設定画面の一例を示す図である。 アームの設定画面の一例を示す図である。 ブームの設定画面の一例を示す図である。 旋回体の設定画面の一例を示す図である。 走行体の設定画面の一例を示す図である。 仕様データの一例を示す図である。 転倒余裕度の算出方法を示す図である。 転倒の可能性を示す画面の一例を示す図である。 変形例に係るアタッチメントの設定画面の一例を示す図である。 変形例に係るブーム及びアームの設定画面の一例を示す図である。 変形例に係る旋回体及び走行体の設定画面の一例を示す図である。

以下、図面を参照して、本発明の一実施形態に係る作業機械について説明する。図１は、実施形態に係る作業機械１の側面図である。作業機械１は、車体２と作業機３とを備えている。車体２は、旋回体４と走行体５とを含む。旋回体４は、走行体５に対して旋回可能に支持されている。旋回体４には、運転室６が配置されている。旋回体４には、カウンタウェイト７が取り付けられている。

旋回体４は、駆動源１１と油圧ポンプ１２とを含む。駆動源１１は、例えば内燃エンジンである。ただし、駆動源１１は、電動モータ、或いはエンジンと電動モータとのハイブリッド機構であってもよい。油圧ポンプ１２は、駆動源１１によって駆動され、作動油を吐出する。作業機械１は、旋回モータ１３を備えている。油圧ポンプ１２２４から吐出された作動油は、旋回モータ１３に供給される。それにより、旋回モータ１３は、旋回体４を旋回させる。走行体５は、履帯１４を含む。履帯１４が回転することにより作業機械１が走行する。

作業機３は、車体２に取り付けられている。作業機３は、車体２に対して動作可能である。作業機３は、ブーム１５と、アーム１６と、アタッチメント１７とを含む。ブーム１５は、ブームピン１８を介して車体２に回転可能に取り付けられている。アーム１６は、アームピン１９を介してブーム１５に回転可能に取り付けられている。アタッチメント１７は、アタッチメントピン２０を介して、アーム１６に回転可能に取り付けられている。

作業機３は、ブームシリンダ２１と、アームシリンダ２２と、アタッチメントシリンダ２３とを含む。ブームシリンダ２１と、アームシリンダ２２と、アタッチメントシリンダ２３とは、それぞれ油圧シリンダである。ブームシリンダ２１と、アームシリンダ２２と、アタッチメントシリンダ２３とは、油圧ポンプ１２から作動油によって駆動される。ブームシリンダ２１が伸縮することで、ブーム１５が動作する。アームシリンダ２２が伸縮することで、アーム１６が動作する。アタッチメントシリンダ２３が伸縮することで、アタッチメント１７が動作する。

図２は、作業機械１の制御システム１０を示すブロック図である。図２に示すように、制御システム１０は、操作装置３１と、入力装置３２と、ディスプレイ３３とを備える。操作装置３１と、入力装置３２と、ディスプレイ３３とは、運転室６に配置されている。操作装置３１は、作業機３、旋回体４、及び走行体５を操作するための装置である。操作装置３１は、作業機３、旋回体４、及び走行体５を駆動するためのオペレータによる操作を受け付け、操作に応じた操作信号を出力する。操作装置３１は、例えば、レバー、ペダル、スイッチ等を含む。

入力装置３２は、作業機械１の制御の設定を行うためのオペレータによる操作を受け付け、操作に応じた操作信号を出力する。入力装置３２は、例えばタッチスクリーンである。或いは、入力装置３２は、レバー、或いはスイッチを含んでもよい。ディスプレイ３３は、ディスプレイ３３に入力される指令信号に応じた画像を表示する。ディスプレイ３３は、作業機械１の制御の設定を行うための画面を表示する。

制御システム１０は、コントローラ３０と記憶装置３６とを含む。コントローラ３０は、取得したデータに基づいて作業機械１を制御するようにプログラムされている。コントローラ３０は、CPU（Central Processing Unit）などのプロセッサ３４と、RAM（Random Access Memory）、及びROM（Read Only Memory）などのメモリ３５とを含む。記憶装置３６は、半導体メモリ、或いはハードディスクなどを含む。記憶装置３６は、非一時的な（non-transitory）コントローラ３０で読み取り可能な記録媒体の一例である。記憶装置３６は、作業機械１を制御するためのプログラムとデータとを記憶している。コントローラ３０は、操作装置３１及び入力装置３２から操作信号を取得する。コントローラ３０は、操作信号に基づいて、作業機３と旋回体４と走行体５とを制御する。

制御システム１０は、車体位置センサ４１を備えている。車体位置センサ４１は、車体２の位置を検出する。車体位置センサ４１は、旋回体４に配置されている。車体位置センサ４１は、例えば、GNSS(Global Navigation Satellite System)を用いた位置センサである。車体位置センサ４１は、基準座標系における旋回体４の位置を検出する。基準座標系は、作業機械１の外部に原点ＯＷ（図５参照）を有しており、例えば世界測地系に従う座標系である。コントローラ３０は、車体位置センサ４１から、旋回体４の位置を示す位置データを取得する。

制御システム１０は、車体方向センサ４２を備えている。車体方向センサ４２は、旋回体４に取り付けられている。車体方向センサ４２は、旋回体４の向きを検出する。

車体方向センサ４２は、例えば、慣性計測装置（Inertial Measurement Unit：IMU）である。車体方向センサ４２は、旋回体４のヨー角とロール角とピッチ角とを、構成部分の向きとして検出する。コントローラ３０は、車体方向センサ４２から、旋回体４の向きを示す方向データを取得する。

制御システム１０は、旋回角度センサ４６と、ブーム角度センサ４７と、アーム角度センサ４８と、アタッチメント角度センサ４９とを含む。旋回角度センサ４６は、走行体５に対する旋回体４の旋回角度を検出する。コントローラ３０は、旋回体４の向きと、旋回体４の旋回角度とから、走行体５の向きを算出する。

図３は、作業機械１の構成を模式的に示す図である。ブーム角度センサ４７は、ブーム角θ１を検出する。ブーム角θ１は、旋回体４に対するブーム１５の傾斜角を示す。アーム角度センサ４８は、アーム角θ２を検出する。アーム角θ２は、ブーム１５に対するアーム１６の傾斜角を示す。アタッチメント角度センサ４９は、アタッチメント角θ３を検出する。アタッチメント角θ３は、アーム１６に対するアタッチメント１７の傾斜角を示す。

アタッチメント角度センサ４９は、例えばストロークセンサである。アタッチメント角度センサ４９は、アタッチメントシリンダ２３のストローク量を検出する。コントローラ３０は、ストローク量から、アタッチメント角θ３を算出する。アーム角度センサ４８と、ブーム角度センサ４７とは、例えばIMUである。或いは、アーム角度センサ４８と、ブーム角度センサ４７とは、ストロークセンサであってもよい。アタッチメント角度センサ４９は、IMUであってもよい。

或いは、ブーム角度センサ４７と、アーム角度センサ４８と、アタッチメント角度センサ４９とは、それぞれ、ブーム角θ１と、アーム角θ２と、アタッチメント角θ３とを直接的に検出する角度センサであってもよい。コントローラ３０は、旋回角度センサ４６と、ブーム角度センサ４７と、アーム角度センサ４８と、アタッチメント角度センサ４９とから、旋回角度と、ブーム角θ１と、アーム角θ２と、アタッチメント角θ３とを示す角度データを取得する。

次に、作業機械１全体の重心位置を算出するためにコントローラ３０によって実行される処理について説明する。本実施形態では、作業機械１が複数の構成部分に分けられ、各構成部分の重心位置と重量とから、作業機械１全体の重心位置が求められる。図４は、作業機械１全体の重心位置を算出するための処理を示すフローチャートである。

図４に示すように、ステップＳ１では、コントローラ３０は、位置データを取得する。コントローラ３０は、位置データにより、基準座標系での旋回体４の位置を取得する。ステップＳ２では、コントローラ３０は、方向データを取得する。コントローラ３０は、方向データにより、旋回体４の向きを取得する。ステップＳ３では、コントローラ３０は、角度データを取得する。コントローラ３０は、角度データにより、旋回角度と、ブーム角θ１と、アーム角θ２と、アタッチメント角θ３とを取得する。

ステップＳ４では、コントローラ３０は、寸法データを取得する。寸法データは、作業機械１全体の重心位置を算出するための各構成部分の寸法を示す。図３に示すように、寸法データは、例えば、ブーム長さＬ１と、アーム長さＬ２と、アタッチメント長さＬ３とを含む。ブーム長さＬ１は、ブームピン１８とアームピン１９との間の長さである。アーム長さＬ２は、アームピン１９とアタッチメントピン２０との間の長さである。アタッチメント長さは、アタッチメントピン２０とアタッチメント１７の先端Ｐ１との間の長さである。寸法データは、記憶装置３６に記憶されている。コントローラ３０は、記憶装置３６から寸法データを取得する。

ステップＳ５では、コントローラ３０は、構成部分の重心位置を取得する。図５は、作業機械１の複数の構成部分の重心位置を示す図である。記憶装置３６は、旋回体４の重心位置Ｇ１と、走行体５の重心位置Ｇ２と、ブーム１５の重心位置Ｇ３と、アーム１６の重心位置Ｇ４と、アタッチメント１７の重心位置Ｇ５とを記憶している。

旋回体４の重心位置Ｇ１は、旋回体４の座標系で表される。旋回体４の座標系は、旋回体４に固定された座標系であり、旋回体４に原点Ｏ１を有する。走行体５の重心位置Ｇ２は、走行体５の座標系で表される。走行体５の座標系は、走行体５に固定された座標系であり、走行体５に原点Ｏ２を有する。

ブーム１５の重心位置Ｇ３は、ブーム１５の座標系で表される。ブーム１５の座標系は、ブーム１５に固定された座標系であり、ブーム１５に原点Ｏ３を有する。アーム１６の重心位置Ｇ４は、アーム１６の座標系で表される。アーム１６の座標系は、アーム１６に固定された座標系であり、アーム１６に原点Ｏ４を有する。アタッチメント１７の重心位置Ｇ５は、アタッチメント１７の座標系で表される。アタッチメント１７の座標系は、アタッチメント１７に固定された座標系であり、アタッチメント１７に原点Ｏ５を有する。コントローラ３０は、記憶装置３６から、各構成部分の重心位置Ｇ１－Ｇ５を取得する。

ステップＳ６では、コントローラ３０は、構成部分の重量を取得する。記憶装置３６は、旋回体４の重量と、走行体５の重量と、ブーム１５の重量と、アーム１６の重量と、アタッチメント１７の重量とを記憶している。コントローラ３０は、記憶装置３６から、各構成部分の重量を取得する。

ステップＳ７では、コントローラ３０は、座標の変換行列を取得する。コントローラ３０は、旋回体４の変換行列と、走行体５の変換行列と、ブーム１５の変換行列と、アーム１６の変換行列と、アタッチメント１７の変換行列とを取得する。旋回体４の変換行列は、旋回体４の座標系から基準座標系への変換行列である。走行体５の変換行列は、走行体５の座標系から旋回体４の座標系への変換行列である。ブーム１５の変換行列は、ブーム１５の座標系から旋回体４の座標系への変換行列である。アーム１６の変換行列は、アーム１６の座標系からブーム１５の座標系への変換行列である。アタッチメント１７の変換行列は、アタッチメント１７の座標系からアーム１６の座標系への変換行列である。

各構成部分の変換行列は、各構成部分の姿勢に応じて変化する。記憶装置３６は、旋回体４の座標系と、走行体５の座標系と、ブーム１５の座標系と、アーム１６の座標系と、アタッチメント１７の座標系とのそれぞれの原点Ｏ１－Ｏ５の位置関係を記憶している。コントローラ３０は、各座標系の原点Ｏ１－Ｏ５の位置関係と、上述した寸法データと、位置データと、方向データと、角度データとに基づいて、各構成部分の変換行列を算出する。

ステップＳ８では、コントローラ３０は、作業機械１全体の重心位置Ｇ０を算出する。コントローラ３０は、各構成部分の重心位置Ｇ１－Ｇ５と重量と変換行列とに基づいて、作業機械１全体の重心位置Ｇ０を算出する。詳細には、コントローラ３０は、まず、以下の式（１）～（５）により、各構成部分の重心位置を基準座標系に変換する。
^world P _upper= ^world T _upper ^upper P (1)
^world P_under = ^world T _upper ^upper T _under ^under P (2)
^world P_boom = ^world T _upper ^upper T _boom ^boom P (3)
^world P_arm = ^world T _upper ^upper T _boom ^boom T _arm ^arm P (4)
^world P_attachment = ^world T _upper ^upper T_boom ^boom T _arm ^arm T _attachment ^attachment P (5)
^world P _upperは、基準座標系での旋回体４の重心位置Ｇ１を示す。^upper Pは、旋回体４の座標系での旋回体４の重心位置Ｇ１を示す。^world T _upperは、旋回体４の座標系から基準座標系への変換行列を示す。

^world P_underは、基準座標系での走行体５の重心位置Ｇ２を示す。^upper T _underは、走行体５の座標系から旋回体４の座標系への変換行列を示す。^under Pは、走行体５の座標系での走行体５の重心位置Ｇ２を示す。

^world P_boomは、基準座標系でのブーム１５の重心位置Ｇ３を示す。^upper T _boomは、ブーム１５の座標系から旋回体４の座標系への変換行列を示す。^boom Pは、ブーム１５の座標系でのブーム１５の重心位置Ｇ３を示す。

^world P_armは、基準座標系でのアーム１６の重心位置Ｇ４を示す。^boom T _armは、アーム１６の座標系からブーム１５の座標系への変換行列を示す。^arm Pは、アーム１６の座標系でのアーム１６の重心位置Ｇ４を示す。

^world P_attachmentは、基準座標系でのアタッチメント１７の重心位置Ｇ５を示す。^arm T _attachmentは、アタッチメント１７の座標系からアーム１６の座標系への変換行列を示す。^attachment Pは、アタッチメント１７の座標系でのアタッチメント１７の重心位置Ｇ５を示す。

次にコントローラ３０は、以下の式（６）により、作業機械１全体の重心位置Ｇ０を算出する。
^world P_all = (^world P _upper ・ mass _upper + ^world P _under ・ mass _under + ^world P _boom ・ mass _boom + ^world P _arm ・ mass _arm + ^world P _attachment ・ mass _attachment ) / mass _all (6)
^world P_all は、基準座標系での作業機械１全体の重心位置Ｇ０を示す。mass _upper は、旋回体４の重量を示す。mass _underは、走行体５の重量を示す。mass_boomは、ブーム１５の重量を示す。mass _armは、アーム１６の重量を示す。mass _attachmentは、アタッチメント１７の重量を示す。mass_allは、作業機械１全体の重量を示す。

ステップＳ９では、コントローラ３０は、入力装置３２を介したパラメータの入力があったかを判定する。入力装置３２は、各構成部分の重心位置を決定するためのパラメータの入力を受け付ける。詳細には、コントローラ３０は、図６から図１０に示す設定画面をディスプレイ３３に表示させる。

図６は、アタッチメント１７の設定画面５１の一例を示す図である。アタッチメント１７の設定画面５１では、アタッチメント１７の複数の種類が表示される。アタッチメント１７の複数の種類は、寸法、及び／又は、重量、或いは機能の異なるアタッチメント１７の種類を示す。アタッチメント１７が交換された場合、作業者は、入力装置３２を用いて、交換後のアタッチメント１７の種類を選択する。コントローラ３０は、選択されたアタッチメント１７の種類を、アタッチメント１７の重心位置Ｇ５のパラメータとして取得する。

図７は、アーム１６の設定画面５２の一例を示す図である。アーム１６の設定画面５２では、アーム１６の複数の種類が表示される。アーム１６の複数の種類は、寸法、及び／又は、重量の異なるアーム１６の複数の種類を示す。アーム１６が交換された場合、作業者は、入力装置３２を用いて、交換後のアーム１６の種類を選択する。コントローラ３０は、選択されたアーム１６の種類を、アーム１６の重心位置Ｇ４のパラメータとして取得する。

図８は、ブーム１５の設定画面５３の一例を示す図である。ブーム１５の設定画面５３では、ブーム１５の複数の種類が表示される。ブーム１５の複数の種類は、寸法、及び／又は、重量の異なるブーム１５の複数の種類を示す。ブーム１５が交換された場合、作業者は、入力装置３２を用いて、交換後のブーム１５の種類を選択する。コントローラ３０は、選択されたブーム１５の種類を、ブーム１５の重心位置Ｇ３のパラメータとして取得する。

図９は、旋回体４の設定画面５４の一例を示す図である。旋回体４の設定画面５４では、カウンタウェイト７の複数の種類が表示される。カウンタウェイト７の複数の種類は、寸法、及び／又は、重量の異なるカウンタウェイト７の複数の種類を示す。カウンタウェイト７が交換された場合、作業者は、入力装置３２を用いて、交換後のカウンタウェイト７の種類を選択する。コントローラ３０は、選択されたカウンタウェイト７の種類を、旋回体４の重心位置Ｇ１のパラメータとして取得する。

図１０は、走行体５の設定画面５５の一例を示す図である。走行体５の設定画面５５では、履帯１４の複数の種類が表示される。履帯１４の複数の種類は、寸法、及び／又は、重量の異なる履帯１４の複数の種類を示す。履帯１４が交換された場合、作業者は、入力装置３２を用いて、交換後の履帯１４の種類を選択する。コントローラ３０は、選択された履帯１４の種類を、走行体５の重心位置Ｇ２のパラメータとして取得する。

入力装置３２によって、いずれかの構成部分の重心位置のパラメータが入力されたときには、処理はステップＳ１０に進む。ステップＳ１０では、コントローラ３０は、パラメータが入力された構成部分の重心位置を更新する。

例えば、アタッチメント１７がバケットＡからバケットＢに交換された場合、作業者は、アタッチメント１７の設定画面５１において、入力装置３２を用いてバケットＢを選択する。

記憶装置３６は、アタッチメント１７の各種類の仕様データを記憶している。図１１に示すように、仕様データ５６は、アタッチメント１７の複数の種類と、複数の種類のそれぞれに対応するアタッチメント１７の寸法と重量とを含む。アタッチメント１７の寸法は、例えば上述したアタッチメント長さＬ３を含む。コントローラ３０は、選択された種類に対応する寸法と重量とによって、アタッチメント１７の寸法データと重量とを更新する。また、コントローラ３０は、更新されたアタッチメント１７の寸法データと重量とによって、アタッチメント１７の重心位置Ｇ５を更新する。

旋回体４、走行体５、ブーム１５、アーム１６についても同様に、記憶装置３６は、旋回体４、走行体５、ブーム１５、アーム１６のそれぞれについて、仕様データを記憶している。旋回体４の仕様データは、カウンタウェイト７の複数の種類と、複数の種類のそれぞれに対応するカウンタウェイト７の寸法と重量とを含む。入力装置３２によってカウンタウェイト７の種類が選択されると、コントローラ３０は、選択されたカウンタウェイト７の寸法データと重量とによって、旋回体４の重心位置Ｇ１を更新する。

走行体５の仕様データは、走行体５の複数の種類と、複数の種類のそれぞれに対応する走行体５の寸法と重量とを含む。入力装置３２によって履帯１４の種類が選択されると、コントローラ３０は、選択された履帯１４の寸法データと重量とによって、走行体５の重心位置Ｇ２を更新する。

ブーム１５の仕様データは、ブーム１５の複数の種類と、複数の種類のそれぞれに対応するブーム１５の寸法と重量とを含む。入力装置３２によってブーム１５の種類が選択されると、コントローラ３０は、選択されたブーム１５の寸法データと重量とによって、ブーム１５の重心位置Ｇ３を更新する。

アーム１６の仕様データは、アーム１６の複数の種類と、複数の種類のそれぞれに対応するアーム１６の寸法と重量とを含む。入力装置３２によってアーム１６の種類が選択されると、コントローラ３０は、選択されたアーム１６の寸法データと重量とによって、アーム１６の重心位置Ｇ４を更新する。

ステップＳ１１では、コントローラ３０は、構成部分の重量を更新する。コントローラ３０は、入力装置３２によってパラメータが入力された構成部分の重量を、上述した仕様データによって更新する。ステップＳ１２では、コントローラ３０は、座標の変換行列を更新する。コントローラ３０は、入力装置３２によってパラメータが入力された構成部分の変換行列を、上述した仕様データによって更新する。そして、処理は、ステップＳ１～Ｓ８に戻り、コントローラ３０は、更新された構成部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械１全体の重心位置Ｇ０を更新する。

例えば、アタッチメント１７が交換された場合には、入力装置３２によって交換後のアタッチメント１７の種類が選択されることで、アタッチメント１７の重心位置Ｇ５と重量と変換行列とが更新される。そして、上述した式（１）～（６）により、更新されたアタッチメント１７の重心位置Ｇ５と重量と変換行列と、他の構成部分の重心位置Ｇ１－Ｇ４と重量と変換行列とによって、作業機械１全体の重心位置Ｇ０を算出することで、作業機械１全体の重心位置Ｇ０が更新される。

なお、以上の説明では、説明の容易のために、作業機械１、及び、各構成部分の幅方向の寸法については、説明を省略している。ただし、重心位置の算出において、作業機械１、及び、各構成部分の幅方向の寸法が考慮されてもよい。

以上のように、コントローラ３０は、作業機械１全体の重心位置Ｇ０を算出する。コントローラ３０は、作業機械１全体の重心位置Ｇ０に基づいて、作業機械１の転倒の可能性を判別する。例えば、図１２に示すように、コントローラ３０は、転倒余裕度Ｑに基づいて、作業機械１の転倒の可能性を判別してもよい。転倒余裕度Ｑは、作業機械１が転倒する際に、作業機械１全体の重心位置Ｇ０が描く軌跡Ａ１の最大高さＨ１と、重心位置の初期高さＨ０との差で示される。転倒余裕度Ｑが大きいほど、転倒の可能性が低い。

コントローラ３０は、転倒余裕度Ｑに応じて、警告表示をディスプレイ３３に表示させてもよい。例えば、図１３に示すように、コントローラ３０は、転倒の可能性を示す画面５７をディスプレイ３３に表示させてもよい。転倒の可能性を示す画面５７では、作業機械１の画像６１と供に、作業機械１の周囲を複数に分割したエリア６２Ａ－６２Ｌが表示される。

コントローラ３０は、各エリア６２Ａ－６２Ｌの方向への作業機械１の転倒余裕度Ｑを算出する。コントローラ３０は、転倒余裕度Ｑに応じて、各エリア６２Ａ－６２Ｌを異なる色で表示する。例えば、転倒余裕度Ｑが閾値以下となったエリア６２Ｈ－６２Ｊを他のエリアと異なる色で表示する。

以上説明した本実施形態に係る作業機械１の制御システム１０では、作業機械１の構成部分の一部が交換された場合に、交換後の構成部分のパラメータが、入力装置３２を介して入力されることで、当該構成部分の重心位置が更新される。そして、更新された構成部分の重心位置に基づいて、作業機械１全体の重心位置Ｇ０が算出される。それにより、構成部分の一部が交換された後でも、作業機械１全体の重心位置Ｇ０が精度よく算出される。

以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。

作業機械１は、上述した油圧ショベルに限らず、ブルドーザ、ホイールローダ、或いはモータグレーダなどの他の作業機械であってもよい。作業機３の構造は、上述した実施形態のものに限らず、変更されてもよい。例えば、作業機３は、ブーム１５、アーム１６、及びアタッチメント１７の３軸構造に限らず、４軸以上の構造を有してもよい。

作業機械１は、遠隔操縦可能な車両であってもよい。その場合、制御システム１０３の一部は、作業機械１の外部に配置されてもよい。例えば、コントローラ３０は、作業機械１の外部に配置されてもよい。操作装置３１、入力装置３２、ディスプレイ３３は、作業機械１の外部に配置されてもよい。入力装置３２とディスプレイ３３とは、作業機械１と別体のコンピュータであってもよい。例えば、入力装置３２とディスプレイ３３とは、作業機械１のサービスマンによって操作されるコンピュータに含まれてもよい。

コントローラ３０は、互いに別体の複数のコントローラを含んでもよい。上述したコントローラ３０による処理は、複数のコントローラに分散して実行されてもよい。コントローラ３０は、複数のプロセッサを含んでもよい。上述したコントローラ３０による処理は、複数のプロセッサに分散して実行されてもよい。

コントローラ３０による処理は、上記の実施形態のものに限らず、変更されてもよい。上述した処理の一部が省略されてもよい。或いは、上述した処理の一部が変更されてもよい。例えば、上記の実施形態では、作業機械１全体の重心位置Ｇ０を計算するために、作業機械１が、旋回体４、走行体５、ブーム１５、アーム１６、アタッチメント１７の５つの構成部分に分けられている。しかし、構成部分の数は５つに限らず、５つより少なくてもよく、或いは５つより多くてもよい。

上記の実施形態では、コントローラ３０は、転倒余裕度Ｑに応じて、警告表示をディスプレイ３３に表示している。しかし、コントローラ３０は、転倒余裕度Ｑに応じて、警告音を発してもよい。上記の実施形態では、コントローラ３０は、作業機械１全体の重心位置Ｇ０に基づいて、転倒余裕度Ｑを算出している。しかし、コントローラ３０は、単に作業機械１全体の重心位置Ｇ０をディスプレイ３３に表示してもよい。

上記の実施形態では、構成部分の重心位置を算出するためのパラメータとして、構成部分の種類が、入力装置３２を用いて選択されている。しかし、パラメータは、構成部分の種類に限らず、各構成部分の重心位置であってもよい。或いは、パラメータは、各構成部分の寸法及び重量であってもよい。

例えば、図１４は、変形例に係るアタッチメント１７の設定画面５８の一例を示す図である。図１４に示すように、アタッチメント１７の設定画面５８は、アタッチメント１７の寸法の入力欄７１と重量の入力欄７２とを含んでもよい。

図１５は、変形例に係るブーム１５及びアーム１６の設定画面５９の一例を示す図である。図１５に示すように、ブーム１５及びアーム１６の設定画面５９は、ブーム１５の寸法の入力欄７３と重量の入力欄７４とを含んでもよい。ブーム１５及びアーム１６の設定画面５９は、アーム１６の寸法の入力欄７５と重量の入力欄７６とを含んでもよい。

図１６は、変形例に係る旋回体４及び走行体５の設定画面６０の一例を示す図である。図１６に示すように、旋回体４及び走行体５の設定画面６０は、旋回体４の寸法の入力欄７７Ａ，７７Ｂと重量の入力欄７８とを含んでもよい。或いは、旋回体４及び走行体５の設定画面６０は、カウンタウェイト７の寸法の入力欄と重量の入力欄とを含んでもよい。

図１６に示すように、旋回体４及び走行体５の設定画面６０は、走行体５の寸法の入力欄７９Ａ－７９Ｃと重量の入力欄８０とを含んでもよい。或いは、旋回体４及び走行体５の設定画面６０は、履帯１４の寸法の入力欄と重量の入力欄とを含んでもよい。

本発明によれば、作業機械において、一部の構成部分が交換された後でも、作業機械全体の重心位置を精度よく算出することができる。

２：車体
３：作業機
４：旋回体
５：走行体
７：カウンタウェイト
１４：履帯
１７：アタッチメント
３６：記憶装置
３２：入力装置
３０：コントローラ
Ｇ０：作業機械全体の重心位置
Ｇ１－Ｇ５：構成部分の重心位置

Claims (16)

1. 第１部分を含む複数の構成部分を有する作業機械のためのシステムであって、
   前記複数の構成部分のそれぞれの重心位置を記憶している記憶装置と、
   前記第１部分の重心位置を決定するための第１パラメータの入力を受け付ける入力装置と、
   コントローラと、
   を備え、
   前記コントローラは、
   前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を算出し、
   前記入力装置によって前記第１パラメータが入力されたときには、前記第１パラメータによって、前記第１部分の重心位置を設定し、
   設定された前記第１部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定する、
   システム。
2. 前記記憶装置は、前記第１部分の複数の種類と、前記複数の種類のそれぞれに対応する前記第１部分の寸法と重量とを含む仕様データを記憶しており、
   前記第１パラメータは、前記第１部分の複数の種類から選択される、
   請求項１に記載のシステム。
3. 前記第１パラメータは、前記第１部分の寸法と重量とを含む、
   請求項１に記載のシステム。
4. 前記第１パラメータは、前記第１部分の重心位置を含む、
   請求項１に記載のシステム。
5. 前記複数の構成部分は、第２部分をさらに含み、
   前記入力装置は、前記第２部分の重心位置を決定するための第２パラメータの入力を受け付け、
   前記コントローラは、前記入力装置によって前記第２パラメータが入力されたときには、前記第２パラメータによって、前記第２部分の重心位置を設定し、
   設定された前記第２部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定する、
   請求項１から４のいずれかに記載のシステム。
6. 前記記憶装置は、前記第２部分の複数の種類と、前記複数の種類のそれぞれに対応する前記第２部分の寸法と重量とを含む仕様データを記憶しており、
   前記第２パラメータは、前記第２部分の複数の種類のいずれかから選択される、
   請求項５に記載のシステム。
7. 前記第２パラメータは、前記第２部分の寸法と重量とを含む、
   請求項５に記載のシステム。
8. 前記第２パラメータは、前記第２部分の重心位置を含む、
   請求項５に記載のシステム。
9. ディスプレイをさらに備え、
   前記コントローラは、前記第１パラメータの入力欄を前記ディスプレイに表示させる、
   請求項１から４のいずれかに記載のシステム。
10. ディスプレイをさらに備え、
    前記コントローラは、前記第２パラメータの入力欄を前記ディスプレイに表示させる、
    請求項５から８のいずれかに記載のシステム。
11. 前記作業機械は、
    車体と、
    交換可能なアタッチメントを含み、前記車体に対して動作可能な作業機と、
    を有し、
    前記第１部分は、前記アタッチメントである、
    請求項１から１０に記載のシステム。
12. 前記作業機械は、カウンタウェイトを含む旋回体を有し、
    前記第１部分は、前記旋回体であり、
    前記第１パラメータは、前記カウンタウェイトの種類、又は、前記カウンタウェイトの寸法及び重量を示す、
    請求項１から１０のいずれかに記載のシステム。
13. 前記作業機械は、履帯を含む走行体を有し、
    前記第１部分は、前記走行体であり、
    前記第１パラメータは、前記履帯の種類、又は、前記履帯の寸法及び重量を示す、
    請求項１から１０のいずれかに記載のシステム。
14. 第１部分を含む複数の構成部分を有する作業機械を制御するための方法であって、
    前記複数の構成部分のそれぞれの重心位置を取得することと、
    前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を算出することと、
    入力装置を介して、前記第１部分の重心位置を決定するための第１パラメータの入力を受け付けることと、
    前記入力装置によって前記第１パラメータが入力されたときには、前記第１パラメータによって、前記第１部分の重心位置を設定することと、
    設定された前記第１部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定すること、
    を備える方法。
15. 前記複数の構成部分は、第２部分をさらに含み、
    前記入力装置は、前記第２部分の重心位置を決定するための第２パラメータの入力を受け付け、
    前記入力装置によって前記第２パラメータが入力されたときには、前記第２パラメータによって、前記第２部分の重心位置を設定することと、
    設定された前記第２部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定すること、
    をさらに備える請求項１４に記載の方法。
16. 作業機械であって、
    第１部分を含む複数の構成部分と、
    前記複数の構成部分のそれぞれの重心位置を記憶している記憶装置と、
    前記第１部分の重心位置を決定するための第１パラメータの入力を受け付ける入力装置と、
    コントローラと、
    を備え、
    前記コントローラは、
    前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を算出し、
    前記入力装置によって前記第１パラメータが入力されたときには、前記第１パラメータによって、前記第１部分の重心位置を設定し、
    設定された前記第１部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定する、
    作業機械。

Images