JP7287821B2 - 作業機制御装置、作業車両、および作業機制御方法 - Google Patents

Description

本発明は、作業機制御装置、作業車両、および作業機制御方法に関する。

ホイールローダなどの作業車両において、作業機を所定位置まで繰り返し操作することを容易かつ正確に行うことを目的として、作業機を所定位置まで自動的に駆動させる自動駆動制御（デテント制御、キックアウト制御）が行われる。
特許文献１には、作業機に掛かる荷重から特定される作業機の負荷状態に基づいて、自動駆動制御の可否を決定する技術が開示されている。

米国特許第９７９０６６０号明細書

自動駆動制御は、ブーム上げ、ブーム下げ、バケットチルト、バケットダンプの４操作それぞれについて実行することができる。しかしながら、バケットに作業対象物が収容されているときに、誤操作等によってバケットダンプに係る自動駆動制御がなされると、作業対象物がこぼれてしまう可能性がある。
本発明の目的は、自動駆動制御による作業対象物の落下を防止する作業機制御装置、作業車両、および作業機制御方法を提供することにある。

本発明の一態様によれば、作業機制御装置は、ブームおよびバケットを有する作業機を備える作業車両の作業機制御装置であって、前記作業車両の作業状態を判定する状態判定部と、前記作業状態に応じて、前記バケットを所定のダンプ角度まで自動的に駆動させる自動ダンプ制御の実行の可否を示す自動ダンプ可否モードを決定する自動ダンプ判定部とを備える。

上記態様によれば、作業機制御装置は、自動駆動制御による作業対象物の落下を防止する。

第１の実施形態に係る作業車両の側面図である。 第１の実施形態に係る運転室の内部の構成を示す上面図である。 第１の実施形態に係る作業車両の動力系統を示す模式図である。 第１の実施形態に係る作業車両の制御装置の構成を示す概略ブロック図である。 第１の実施形態に係る制御装置による自動ダンプ可否モードの設定方法を示すフローチャートである。 第１の実施形態に係る制御装置による自動駆動制御方法を示すフローチャートである。

〈第１の実施形態〉
以下、図面を参照しながら実施形態について詳しく説明する。
図１は、第１の実施形態に係る作業車両の側面図である。
第１の実施形態に係る作業車両１００は、ホイールローダである。作業車両１００は、車体１１０、作業機１２０、前輪部１３０、後輪部１４０、運転室１５０を備える。

車体１１０は、前車体１１１、後車体１１２、およびステアリングシリンダ１１３を備える。前車体１１１と後車体１１２とは車体１１０の上下方向に伸びるステアリング軸回りに回動可能に取り付けられている。前輪部１３０は、前車体１１１の下部に設けられ、後輪部１４０は、後車体１１２の下部に設けられる。
ステアリングシリンダ１１３は、油圧シリンダである。ステアリングシリンダ１１３の基端部は後車体１１２に取り付けられ、先端部は前車体１１１に取り付けられる。ステアリングシリンダ１１３は、作動油によって伸縮することで、前車体１１１と後車体１１２とのなす角度を規定する。つまり、ステアリングシリンダ１１３の伸縮により、前輪部１３０の舵角が規定される。

作業機１２０は、土砂等の作業対象物の掘削および運搬に用いられる。作業機１２０は、車体１１０の前部に設けられる。作業機１２０は、ブーム１２１、バケット１２２、ベルクランク１２３、リフトシリンダ１２４、バケットシリンダ１２５を備える。

ブーム１２１の基端部は、前車体１１１の前部にピンを介して取り付けられる。ブーム１２１の基端部には、ブーム角θ_Ｌを検出するためのブーム角センサ１２１１が設けられる。ブーム角θ_Ｌは、車体１１０から前方に伸びる直線と、ブーム１２１の基端部から先端部に伸びる直線とのなす角によって表される。ブーム角θ_Ｌが大きいほどブーム１２１の先端の位置が高くなり、ブーム角θ_Ｌが小さいほどブーム１２１の先端の位置が低くなる。なお、他の実施形態においては、リフトシリンダ１２４のストローク量を計測するリフトシリンダストロークセンサを設け、リフトシリンダ１２４のストローク量に基づいてブーム角θ_Ｌが検出されてもよい。

バケット１２２は、作業対象物を掘削するための刃と、掘削した作業対象物を運搬するための容器とを備える。バケット１２２の基端部は、ブーム１２１の先端部にピンを介して取り付けられる。

ベルクランク１２３は、バケットシリンダ１２５の動力をバケット１２２に伝達する。ベルクランク１２３の第１端は、バケット１２２の底部にリンク機構を介して取り付けられる。ベルクランク１２３の第２端は、バケットシリンダ１２５の先端部にピンを介して取り付けられる。ベルクランク１２３の中央部には、バケット角θ_Ｂを検出するためのバケット角センサ１２３１が設けられる。バケット角θ_Ｂは、車体１１０から前方に伸びる直線と、バケット１２２の底面に沿って伸びる直線とのなす角によって表される。バケット角θ_Ｂが正である場合、バケット１２２はチルト側に傾き、バケット角θ_Ｂが負である場合、バケット１２２はダンプ側に傾く。バケット角θ_Ｂは、バケット角センサ１２３１の計測値から求められるブーム１２１を基準としたバケット１２２の角度に、ブーム角θ_Ｌを加算することで求められる。

リフトシリンダ１２４は、油圧シリンダである。リフトシリンダ１２４の基端部は前車体１１１の前部に取り付けられる。リフトシリンダ１２４の先端部はブーム１２１に取り付けられる。リフトシリンダ１２４が作動油によって伸縮することによって、ブーム１２１が上げ方向または下げ方向に駆動する。

バケットシリンダ１２５は、油圧シリンダである。バケットシリンダ１２５の基端部は、前車体１１１の前部に取り付けられる。バケットシリンダ１２５の先端部は、ベルクランク１２３を介してバケット１２２に取り付けられている。バケットシリンダ１２５が、作動油によって伸縮することによって、バケット１２２がチルト方向またはダンプ方向に駆動する。

運転室１５０は、オペレータが搭乗し、作業車両１００の操作を行うためのスペースである。運転室１５０は、後車体１１２の上部に設けられる。
図２は、第１の実施形態に係る運転室の内部の構成を示す上面図である。運転室１５０の内部には、シート１５１、アクセルペダル１５２、ブレーキペダル１５３、ステアリングハンドル１５４、前後切替スイッチ１５５、シフトスイッチ１５６、ブームレバー１５７、バケットレバー１５８、停止スイッチ１５９が設けられる。

アクセルペダル１５２は、作業車両１００に生じさせる走行の駆動力（牽引力）を設定するために操作される。
ブレーキペダル１５３は、作業車両１００に生じさせる走行の制動力を設定するために操作される。
ステアリングハンドル１５４は、作業車両１００の舵角を設定するために操作される。
前後切替スイッチ１５５は、作業車両１００の進行方向を設定するために操作される。
シフトスイッチ１５６は、動力伝達装置の速度範囲を設定するために操作される。

ブームレバー１５７は、ブーム１２１の上げ操作または下げ操作の速度を設定するために操作される。ブームレバー１５７は、前方へ傾けられることにより下げ操作を受け付け、後方へ傾けられることにより上げ操作を受け付ける。以下、ブーム１２１の上げ操作および下げ操作を、リフト操作ともいう。また、ブームレバー１５７は、前方へ一定角度以上傾けられることで、ブーム１２１を所定の下降位置まで自動的に駆動させる自動駆動制御（自動下げ制御）の開始指令を制御装置３００に出力する。ブームレバー１５７は、後方へ一定角度以上傾けられることで、ブーム１２１を所定の上昇位置まで自動的に駆動させる自動駆動制御（自動上げ制御）の開始指令を制御装置３００に出力する。下降位置は、例えばリフトシリンダ１２４を最大限に縮めたときの位置であってもよい、作業車両１００の接地高さ相当の位置であってよい。上昇位置は、例えばリフトシリンダ１２４を最大限に伸ばしたときの位置であってよい。また、下降位置および上昇位置は、オペレータによって任意に設定されてもよい。なお、上昇位置および下降位置は上記の例に限られないが、いずれの場合においても、上昇位置は下降位置より車体座標系において上方に設定される。
ブームレバー１５７は、自動駆動制御の開始指令を出力した後に、中立位置に戻る。なお、他の実施形態においては、ブームレバー１５７は、自動駆動制御の開始指令を出力した後、自動駆動制御が終了するまで位置が固定されてもよい。なお、ブームレバー１５７が固定された場合も、オペレータがブームレバー１５７を操作することで、固定を解除することができる。

バケットレバー１５８は、バケット１２２のダンプ操作またはチルト操作の速度を設定するために操作される。バケットレバー１５８は、前方へ傾けられることによりダンプ操作を受け付け、後方へ傾けられることによりチルト操作を受け付ける。また、バケットレバー１５８は、前方へ一定角度以上傾けられることで、バケット１２２を所定のダンプ角度まで自動的に駆動させる自動駆動制御（自動ダンプ制御）の開始指令を制御装置３００に出力する。バケットレバー１５８は、後方へ一定角度以上傾けられることで、バケット１２２を所定のチルト角度まで自動的に駆動させる自動駆動制御（自動チルト制御）の開始指令を制御装置３００に出力する。ダンプ角度は、例えば水平に対して所定角度だけダンプ方向に傾けた角度であってよい。チルト角度は、例えば水平に対して所定角度だけチルト方向に傾けた角度であってよい。ダンプ角度およびチルト角度は、オペレータによって任意に設定されてもよい。なお、ダンプ角度およびチルト角度は上記の例に限られない。また、ダンプ角度およびチルト角度は同じ角度（例えば、いずれも水平）であってもよい。
バケットレバー１５８は、自動駆動制御の開始指令を出力した後に、中立位置に戻る。なお、他の実施形態においては、バケットレバー１５８は、自動駆動制御の開始指令を出力した後、自動駆動制御が終了するまで位置が固定されてもよい。なお、バケットレバー１５８が固定された場合も、オペレータがバケットレバー１５８を操作することで、固定を解除することができる。

停止スイッチ１５９は、各種自動駆動制御を停止するために操作される。停止スイッチ１５９は、押下されることにより停止指令を制御装置３００に出力する。停止スイッチ１５９は、例えばバケットレバー１５８に設けられる。

《動力系統》
図３は、第１の実施形態に係る作業車両の動力系統を示す模式図である。
作業車両１００は、エンジン２１０、ＰＴＯ２２０（Power Take Off）、変速機２３０、フロントアクスル２４０、リアアクスル２５０、可変容量ポンプ２６０を備える。

エンジン２１０は、例えばディーゼルエンジンである。エンジン２１０には、燃料噴射装置２１１およびエンジン回転計２１２が設けられる。燃料噴射装置２１１は、エンジン２１０のシリンダ内に噴射する燃料量を調整することで、エンジン２１０の駆動力を制御する。エンジン回転計２１２は、エンジン２１０の回転数を計測する。
ＰＴＯ２２０は、エンジン２１０の駆動力の一部を、可変容量ポンプ２６０に伝達する。つまり、ＰＴＯ２２０は、エンジン２１０の駆動力を、変速機２３０、および可変容量ポンプ２６０に分配する。

変速機２３０は、入力軸に入力される駆動力を変速して出力軸から出力する。変速機２３０の入力軸はＰＴＯ２２０に接続され、出力軸はフロントアクスル２４０およびリアアクスル２５０に接続される。つまり、変速機２３０は、ＰＴＯ２２０によって分配されたエンジン２１０の駆動力をフロントアクスル２４０およびリアアクスル２５０に伝達する。

フロントアクスル２４０は、変速機２３０が出力する駆動力を前輪部１３０に伝達する。これにより、前輪部１３０が回転する。
リアアクスル２５０は、変速機２３０が出力する駆動力を後輪部１４０に伝達する。これにより、後輪部１４０が回転する。

可変容量ポンプ２６０は、エンジン２１０からの駆動力によって駆動される。可変容量ポンプ２６０から吐出された作動油は、コントロールバルブ２６１を介してリフトシリンダ１２４、およびバケットシリンダ１２５に供給される。可変容量ポンプ２６０には、ポンプ圧計２６２およびポンプ容量計２６３が設けられる。ポンプ圧計２６２は、可変容量ポンプ２６０からの作動油の吐出圧を計測する。ポンプ容量計２６３は、可変容量ポンプ２６０の斜板角等に基づいて可変容量ポンプ２６０の容量を計測する。
コントロールバルブ２６１は、可変容量ポンプ２６０から吐出された作動油の流量を制御し、作動油をリフトシリンダ１２４とバケットシリンダ１２５とに分配する。

《制御装置》
作業車両１００は、作業車両１００を制御するための制御装置３００を備える。制御装置３００は、作業機制御装置の一例である。
制御装置３００は、ブームレバー１５７およびバケットレバー１５８の操作量に応じて、またオペレータによる自動駆動制御の指令に応じて、コントロールバルブ２６１に制御信号を出力する。

図４は、第１の実施形態に係る作業車両の制御装置の構成を示す概略ブロック図である。制御装置３００は、プロセッサ３１０、メインメモリ３３０、ストレージ３５０、インタフェース３７０を備えるコンピュータである。

ストレージ３５０は、一時的でない有形の記憶媒体である。ストレージ３５０の例としては、磁気ディスク、光磁気ディスク、半導体メモリ等が挙げられる。ストレージ３５０は、制御装置３００のバスに直接接続された内部メディアであってもよいし、インタフェース３７０または通信回線を介して制御装置３００に接続される外部メディアであってもよい。ストレージ３５０は、作業車両１００を制御するためのプログラムを記憶する。

プログラムは、制御装置３００に発揮させる機能の一部を実現するためのものであってもよい。例えば、プログラムは、ストレージに既に記憶されている他のプログラムとの組み合わせ、または他の装置に実装された他のプログラムとの組み合わせによって機能を発揮させるものであってもよい。なお、他の実施形態においては、コンピュータは、上記構成に加えて、または上記構成に代えてＰＬＤ（Programmable Logic Device）などのカスタムＬＳＩ（Large Scale Integrated Circuit）を備えてもよい。ＰＬＤの例としては、ＰＡＬ(Programmable Array Logic)、ＧＡＬ(Generic Array Logic)、ＣＰＬＤ(Complex Programmable Logic Device)、ＦＰＧＡ（Field Programmable Gate Array）が挙げられる。この場合、プロセッサによって実現される機能の一部または全部が当該集積回路によって実現されてよい。

プログラムが通信回線によって制御装置３００に配信される場合、配信を受けた制御装置３００が当該プログラムをメインメモリ３３０に展開し、上記処理を実行してもよい。
また、当該プログラムは、前述した機能の一部を実現するためのものであってもよい。さらに、当該プログラムは、前述した機能をストレージ３５０に既に記憶されている他のプログラムとの組み合わせで実現するもの、いわゆる差分ファイル（差分プログラム）であってもよい。

プロセッサ３１０は、プログラムを実行することで、操作量取得部３１１、指令入力部３１２、計測値取得部３１３、牽引力算出部３１４、状態判定部３１５、自動ダンプ判定部３１６、駆動制御部３１７を備える。
また、プログラムの実行により、メインメモリ３３０には、モード記憶部３３１の記憶領域が確保される。モード記憶部３３１は、自動ダンプ制御の実行可否を示す自動ダンプ可否モードを記憶する。自動ダンプ可否モードは、自動ダンプ制御の実行を許可する自動ダンプ許可モード、または自動ダンプ制御の実行を禁止する自動ダンプ禁止モードのいずれかの値をとる。

操作量取得部３１１は、ブームレバー１５７およびバケットレバー１５８の操作量を取得する。
指令入力部３１２は、ブームレバー１５７およびバケットレバー１５８から自動駆動制御の開始指令の入力を受け付ける。また指令入力部３１２は、停止スイッチ１５９から自動駆動制御の停止指令の入力を受け付ける。

計測値取得部３１３は、燃料噴射装置２１１、エンジン回転計２１２、ポンプ圧計２６２、ポンプ容量計２６３、ブーム角センサ１２１１、およびバケット角センサ１２３１から計測値を取得する。すなわち、計測値取得部３１３は、燃料噴射装置２１１の燃料噴射量、エンジン２１０の回転数、可変容量ポンプ２６０の吐出圧、可変容量ポンプ２６０の容量、ブーム角θ_Ｌ、およびバケット角θ_Ｂの計測値を取得する。

牽引力算出部３１４は、計測値取得部３１３が取得した計測値に基づいて、作業車両１００の牽引力を算出する。
例えば、牽引力算出部３１４は、変速機２３０が無段変速機である場合、以下の手順で牽引力を算出することができる。牽引力算出部３１４は、燃料噴射量の計測値とエンジン２１０の回転数からエンジン２１０の出力トルクを算出する。また牽引力算出部３１４は、可変容量ポンプ２６０の吐出圧および容量から可変容量ポンプ２６０の負荷トルクを算出する。牽引力算出部３１４は、出力トルクから負荷トルクを減算することで得られる走行トルクに、変速機２３０の減速比、アクスルの減速比、およびトルク効率を乗算し、これを車輪の有効径で除算することで、牽引力を算出する。
また例えば、牽引力算出部３１４は、変速機２３０がトルクコンバータである場合、以下の手順で牽引力を算出することができる。牽引力算出部３１４は、エンジン２１０の回転数を１０００ｒｐｍで除算したものを二乗した値に変速機２３０のプライマリトルク係数およびトルク比を乗算することで走行トルクを算出する。プライマリトルク係数およびトルク比は、変速機２３０の入出力回転比によって定まる特性値である。牽引力算出部３１４は、走行トルクに、変速機２３０の減速比、アクスルの減速比、およびトルク効率を乗算し、これを車輪の有効径で除算することで、牽引力を算出する。

状態判定部３１５は、牽引力算出部３１４が算出した牽引力、計測値取得部３１３が取得したブーム角θ_Ｌおよびバケット角θ_Ｂの計測値、ならびに操作量取得部３１１が取得したブームレバー１５７およびバケットレバー１５８の操作量に基づいて、作業車両１００の作業状態を判定する。作業状態は、少なくとも掘削状態とダンプ状態とを含む。
具体的には、状態判定部３１５は、牽引力が牽引力閾値以上であり、かつブーム角θ_Ｌがブーム角閾値以下であり、かつバケット角θ_Ｂがバケット角範囲内であり、かつブームレバーの上げ操作またはバケットレバーのチルト操作が一定時間継続している場合に、作業状態が掘削状態であると判定する。牽引力閾値は、掘削中に発揮される牽引力に相当する閾値である。ブーム角閾値は、バケット１２２の基端部が接地高さより所定の許容高さだけ高い位置にあるときのブーム角θ_Ｌに相当する閾値である。つまり、ブーム角θ_Ｌがブーム角閾値以下のとき、バケット１２２は接地高さを含む所定の高さ範囲内に位置する。高さ範囲は下限を有しなくてよい。バケット角範囲は、０度を含む範囲である。すなわち、バケット角θ_Ｂがバケット角範囲内にある場合、バケット１２２の底面は車体１１０の前方と略平行となる。
また、状態判定部３１５は、バケット角θ_Ｂが所定のダンプ閾値未満である場合に、作業状態がダンプ状態であると判定する。ダンプ閾値は、負の値であって、バケット角範囲の下限値より低い値である。すなわち、バケット角θ_Ｂがダンプ閾値未満である場合、バケット１２２の底面はダンプ方向に傾いている。

作業車両１００の作業状態が掘削状態である場合、バケット１２２には作業対象物が収容されている。他方、作業車両１００の作業状態がダンプ状態である場合、バケット１２２から作業対象物がダンプされ、バケット１２２に作業対象物が収容されていない。つまり、作業状態が掘削状態になってからダンプ状態になるまでの間、バケット１２２には作業対象物が収容されている可能性が高い。他方、作業状態がダンプ状態になってから掘削状態になるまでの間、バケット１２２には作業対象物が収容されていない可能性が高い。

自動ダンプ判定部３１６は、作業状態が掘削状態であると判定された場合に、モード記憶部３３１が記憶する自動ダンプ可否モードの値を、自動ダンプ禁止モードに書き換える。他方、自動ダンプ判定部３１６は、作業状態がダンプ状態であると判定された場合に、モード記憶部３３１が記憶する自動ダンプ可否モードの値を、自動ダンプ許可モードに書き換える。

駆動制御部３１７は、自動駆動制御の開始指令を受け付けた場合に、自動駆動制御に係る駆動信号を生成し、コントロールバルブ２６１に出力する。ただし、自動ダンプ制御に係る開始指令を受け付けた場合、駆動制御部３１７は、モード記憶部３３１が記憶する自動ダンプ可否モードの値が、自動ダンプ許可モードである場合にのみ、自動ダンプ制御に係る駆動信号をコントロールバルブ２６１に出力する。
また駆動制御部３１７は、自動駆動制御を行っていない場合、ブームレバー１５７およびバケットレバー１５８の操作量に応じた駆動信号を生成し、コントロールバルブ２６１に出力する。

《自動ダンプ可否モードの設定》
図５は、第１の実施形態に係る制御装置による自動ダンプ可否モードの設定方法を示すフローチャートである。
制御装置３００は、所定の制御周期ごとに、以下に示す自動ダンプ可否モードの設定処理を実行する。
まず、操作量取得部３１１は、ブームレバー１５７およびバケットレバー１５８の操作量を取得する（ステップＳ１）。また、計測値取得部３１３は、燃料噴射装置２１１、エンジン回転計２１２、ポンプ圧計２６２、ポンプ容量計２６３、ブーム角センサ１２１１、およびバケット角センサ１２３１から計測値を取得する（ステップＳ２）。

次に、牽引力算出部３１４は、ステップＳ２で取得した計測値に基づいて、作業車両１００の牽引力を算出する（ステップＳ３）。状態判定部３１５は、ステップＳ３で算出した牽引力が牽引力閾値以上であるか否かを判定する（ステップＳ４）。牽引力が牽引力閾値以上である場合（ステップＳ４：ＹＥＳ）、状態判定部３１５は、ステップＳ２で取得したブーム角θ_Ｌがブーム角閾値以下であるか否かを判定する（ステップＳ５）。ブーム角θ_Ｌがブーム角閾値以下である場合（ステップＳ５：ＹＥＳ）、状態判定部３１５は、ステップＳ２で取得したバケット角θ_Ｂがバケット角範囲内であるか否かを判定する（ステップＳ６）。バケット角θ_Ｂがバケット角範囲内である場合（ステップＳ６：ＹＥＳ）、ステップＳ１で取得したブームレバー１５７またはバケットレバー１５８の操作量に基づいて、ブーム１２１の上げ操作またはバケット１２２のチルト操作の継続時間が一定時間以上であるか否かを判定する（ステップＳ７）。

牽引力が牽引力閾値以上であり、ブーム角θ_Ｌがブーム角閾値以下であり、バケット角θ_Ｂがバケット角範囲内であり、かつブーム１２１の上げ操作またはバケット１２２のチルト操作の継続時間が一定時間以上である場合（ステップＳ７：ＹＥＳ）、状態判定部３１５は、作業状態が掘削状態であると判定する（ステップＳ８）。状態判定部３１５によって作業状態が掘削状態であると判定されると、自動ダンプ判定部３１６は、モード記憶部３３１が記憶する自動ダンプ可否モードの値を自動ダンプ禁止モードに書き換え、処理を終了する（ステップＳ９）。

他方、牽引力が牽引力閾値未満である場合（ステップＳ４：ＮＯ）、ブーム角θ_Ｌがブーム角閾値より大きい場合（ステップＳ５：ＮＯ）、バケット角θ_Ｂがバケット角範囲外である場合（ステップＳ６：ＮＯ）、または、ブーム１２１の上げ操作およびバケット１２２のチルト操作の継続時間が一定時間未満である場合（ステップＳ７：ＮＯ）、状態判定部３１５は、バケット角θ_Ｂがダンプ閾値未満であるか否かを判定する（ステップＳ１０）。バケット角θ_Ｂがダンプ閾値未満である場合（ステップＳ１０：ＹＥＳ）、状態判定部３１５は、作業状態がダンプ状態であると判定する（ステップＳ１１）。状態判定部３１５によって作業状態がダンプ状態であると判定されると、自動ダンプ判定部３１６は、モード記憶部３３１が記憶する自動ダンプ可否モードの値を自動ダンプ許可モードに書き換え、処理を終了する（ステップＳ１２）。

制御装置３００は、所定の制御周期ごとに、上記の自動ダンプ可否モードの設定処理を実行することで、モード記憶部３３１が記憶する自動ダンプ可否モードの値を更新する。

《自動駆動制御》
図６は、第１の実施形態に係る制御装置による自動駆動制御方法を示すフローチャートである。
指令入力部３１２が自動駆動制御の開始指令の入力を受け付けると、制御装置３００は、以下に示す自動駆動制御を実行する。まず、駆動制御部３１７は、入力された開始指令が、自動ダンプ制御に係る開始指令であるか否かを判定する（ステップＳ３１）。
自動ダンプ制御に係る開始指令が入力された場合（ステップＳ３１：ＹＥＳ）、駆動制御部３１７は、モード記憶部３３１が記憶する自動ダンプ可否モードの値が自動ダンプ許可モードであるか否かを判定する（ステップＳ３２）。駆動制御部３１７は、自動ダンプ可否モードの値が自動ダンプ禁止モードである場合（ステップＳ３２：ＮＯ）、自動ダンプ制御を行わずに処理を終了する。

他方、自動上げ制御、自動下げ制御、もしくは自動チルト制御に係る開始指令が入力された場合（ステップＳ３１：ＮＯ）、または、自動ダンプ可否モードの値が自動ダンプ許可モードである場合（ステップＳ３２：ＹＥＳ）、駆動制御部３１７は、所定の駆動速度に係る駆動指令をコントロールバルブ２６１に出力する（ステップＳ３３）。

計測値取得部３１３は、ブーム角センサ１２１１およびバケット角センサ１２３１から計測値を取得する（ステップＳ３４）。駆動制御部３１７は、制御対象（ブーム１２１またはバケット１２２）の角度が所定角度（上昇角度、下降角度、チルト角度、またはダンプ角度）に達したか否かを判定する（ステップＳ３５）。制御対象の角度が所定角度に達していない場合（ステップＳ３５：ＮＯ）、指令入力部３１２は、停止指示の入力を受け付けたか否かを判定する（ステップＳ３６）。停止指示が入力されていない場合（ステップＳ３６：ＮＯ）、操作量取得部３１１は、自動駆動制御に係る操作レバー（ブームレバー１５７またはバケットレバー１５８）の操作量が、開始指令の入力直後に所定の遊び範囲に戻った後に、再度遊び範囲を超えたか否かを判定する（ステップＳ３７）。操作レバーの操作量が遊び範囲を超えない場合（ステップＳ３７：ＮＯ）、ステップＳ３３に戻り、駆動指令の出力を継続する。なお、他の実施形態において、自動駆動の開始指令の入力後に操作レバーが固定される場合、操作量取得部３１１は、ステップＳ３７において、操作レバーの操作量が固定を解除される範囲内であるか否かを判定する。

他方、制御対象の角度が所定角度に達した場合（ステップＳ３５：ＹＥＳ）、停止指示が入力された場合（ステップＳ３６：ＹＥＳ）、自動駆動制御に係る操作レバーの操作量が遊び範囲を超えた場合（ステップＳ３７：ＹＥＳ）、駆動制御部３１７は、コントロールバルブ２６１への駆動指令の出力を停止し（ステップＳ３８）、処理を終了する。

《作用・効果》
このように、第１の実施形態に係る制御装置３００は、作業車両１００の牽引力と作業機１２０の姿勢とに基づいて、作業車両１００の作業状態を判定し、作業状態に応じて自動ダンプ可否モードを決定する。これにより、制御装置３００は、自動駆動制御による作業対象物の落下を防止することができる。
より具体的には、制御装置３００は、作業状態が掘削状態であると判定された場合に、自動ダンプ可否モードを、自動ダンプ禁止モードに切り替える。作業車両１００が掘削作業を行うと、それ以降バケット１２２には作業対象物が収容される。そのため、制御装置３００は、作業状態が掘削状態となった以降に自動ダンプ可否モードを自動ダンプ禁止モードとすることで、自動駆動制御による作業対象物の落下を防止することができる。

また、第１の実施形態に係る制御装置３００は、作業状態がダンプ状態であると判定された場合に、自動ダンプ可否モードを、自動ダンプ許可モードに切り替える。作業車両１００がダンプ操作を行うと、バケット１２２から作業対象物が降ろされ、それ以降バケット１２２内に作業対象物がなくなる。そのため、制御装置３００は、作業状態がダンプ状態となった以降に自動ダンプ可否モードを自動ダンプ許可モードとすることで、作業対象物の落下の可能性が低い状態で自動駆動制御を受け付けることができる。

第１の実施形態に係る制御装置３００は、牽引力が所定の閾値以上であることを、掘削状態と判定するための条件に含む。これは、掘削作業中の牽引力が、作業対象物にバケット１２２を差し込んだ状態で作業車両１００が前進するために掘削作業をしていないときと比較して高くなるためである。また第１の実施形態に係る制御装置３００は、バケット角θ_Ｂがバケット角度範囲内にあり、かつバケット１２２の高さが作業車両１００の接地高さを含む所定の高さ範囲内にあることを、掘削状態と判定するための条件に含む。これは、掘削の開始の際に、オペレータがバケット１２２の姿勢を、底面を地面に沿わせた姿勢にするためである。また第１の実施形態に係る制御装置３００は、作業機１２０の操作装置の操作が一定時間継続していることを、掘削状態と判定するための条件に含む。これは、掘削時にブーム１２１を上昇させながらバケット１２２をチルトさせる必要があるためである。
なお、他の実施形態においては、作業機１２０の操作装置の操作が一定時間継続していることを、掘削状態の判定の条件に含まなくてよい。例えば、他の実施形態においては、これに代えて、作業機１２０の操作装置の操作量に対して作業機１２０の駆動量が所定の閾値より小さいことを、掘削状態と判定するための条件に含んでよい。

また、第１の実施形態に係る制御装置３００は、停止スイッチ１５９の押下によって自動駆動制御を停止させる。これにより、オペレータの誤操作等によって自動駆動制御が開始してしまった場合にも、オペレータは当該自動駆動制御を容易に停止させることができる。

〈他の実施形態〉
以上、図面を参照して一実施形態について詳しく説明してきたが、具体的な構成は上述のものに限られることはなく、様々な設計変更等をすることが可能である。他の実施形態においては、上述の処理の順序が適宜変更されてもよい。また、一部の処理が並列に実行されてもよい。

上述した実施形態に係る作業車両１００は、ブームレバー１５７またはバケットレバー１５８を所定の傾き角以上傾けることで、自動駆動制御の開始指令を出力するが、これに限られない。例えば、他の実施形態に係る作業車両１００は、ブームレバー１５７およびバケットレバー１５８と別個に、自動駆動制御の開始を指示するためのスイッチを備えてもよい。当該スイッチは、停止スイッチ１５９と兼用されてよい。

また上述した実施形態に係る作業車両１００は、ブームレバー１５７およびバケットレバー１５８を別個に備えるが、これに限られない。例えば、他の実施形態においては、ブームレバー１５７およびバケットレバー１５８の機能をまとめた作業機レバーを１つ備えるものであってもよい。

また上述した実施形態に係る作業車両１００は、ホイールローダであるが、これに限られない。例えば、他の実施形態においては、作業車両１００は、ブルドーザおよびその他の作業車両であってよい。

また、上述した実施形態に係る作業車両１００は、自動駆動制御をブーム１２１の上げ操作および下げ操作、ならびにバケット１２２のチルト操作およびダンプ操作のそれぞれについて行うが、これに限られない。例えば、他の実施形態に係る作業車両１００は、自動ダンプ制御を含む、少なくとも１つの自動駆動制御を実現するものであってよい。

また、上述した実施形態に係る作業車両１００は、バケット角θ_Ｂに基づいて、バケット１２２のチルト操作およびダンプ操作の自動駆動制御を行うが、これに限られない。例えば、他の実施形態に係る作業車両１００は、バケットシリンダ１２５のストローク量を求め、バケットシリンダ１２５のストローク量に基づいてチルト操作およびダンプ操作の自動駆動制御を行ってもよい。バケットシリンダ１２５のストローク量は、バケットシリンダ１２５にストロークセンサを設けることによって求めてもよいし、ベルクランク１２３に設けられた角度センサの計測値とブーム角θ_Ｌとに基づいて算出してもよい。また、作業機１２０の機構上、ブーム１２１が駆動すると、バケットシリンダ１２５を駆動させていなくても、ベルクランク角が変化する。そのため、作業車両１００の制御装置３００は、バケット１２２が接地した状態におけるバケットシリンダ１２５のストローク量（基準ストローク量）を予め計測しておき、基準ストローク量とバケットシリンダ１２５のストローク量との差に基づいて、バケット１２２のチルト操作およびダンプ操作の自動駆動制御を行う。これにより、ブーム１２１を地表付近まで下げたときにバケット１２２の底面を地表に対して略平行にすることができる。この場合、ダンプ角度、チルト角度、および掘削条件の判定に用いるバケット角範囲は、基準ストローク量に対するストローク量の値に換算して比較される。

１００…作業車両 １１０…車体 １１１…前車体 １１２…後車体 １１３…ステアリングシリンダ １２０…作業機 １２１…ブーム １２１１…ブーム角センサ １２２…バケット １２３…ベルクランク １２３１…バケット角センサ １２４…リフトシリンダ １２５…バケットシリンダ １３０…前輪部 １４０…後輪部 １５０…運転室 １５１…シート １５２…アクセルペダル １５３…ブレーキペダル １５４…ステアリングハンドル １５５…前後切替スイッチ １５６…シフトスイッチ １５７…ブームレバー １５８…バケットレバー １５９…停止スイッチ ２１０…エンジン ２１１…燃料噴射装置 ２１２…エンジン回転計 ２２０…ＰＴＯ ２３０…変速機 ２４０…フロントアクスル ２５０…リアアクスル ２６０…可変容量ポンプ ２６１…コントロールバルブ ２６２…ポンプ圧計 ２６３…ポンプ容量計 ３００…制御装置 ３１０…プロセッサ ３１１…操作量取得部 ３１２…指令入力部 ３１３…計測値取得部 ３１４…牽引力算出部 ３１５…状態判定部 ３１６…自動ダンプ判定部 ３１７…駆動制御部 ３３０…メインメモリ ３３１…モード記憶部 ３５０…ストレージ ３７０…インタフェース

Claims (11)

1. ブームおよびバケットを有する作業機を備える作業車両の作業機制御装置であって、
   前記作業車両の作業状態を判定する状態判定部と、
   前記作業状態に応じて、前記バケットを所定のダンプ角度まで自動的に駆動させる自動ダンプ制御の実行の可否を示す自動ダンプ可否モードを決定する自動ダンプ判定部と、
   前記自動ダンプ可否モードに応じて前記自動ダンプ制御に係る駆動指令を出力する駆動制御部と、
   を備える作業機制御装置。
2. 前記自動ダンプ判定部は、前記作業状態が掘削状態であると判定された場合に、前記自動ダンプ可否モードを、前記自動ダンプ制御の実行を禁止するモードに切り替える
   請求項１に記載の作業機制御装置。
3. 前記状態判定部は、前記作業車両の牽引力が所定の閾値以上であり、かつ前記バケットの角度が、前記バケットの底面が前記作業車両に対して平行となる角度を含む所定の角度範囲内にあり、かつ前記バケットの高さが、前記作業車両の接地高さを含む所定の高さ範囲内にある場合に、前記作業状態が掘削状態であると判定する
   請求項２に記載の作業機制御装置。
4. 前記状態判定部は、前記牽引力が所定の閾値以上であり、かつ前記バケットの角度が、前記バケットの底面が前記作業車両に対して平行となる角度を含む所定の角度範囲内にあり、かつ前記バケットの高さが、前記作業車両の接地高さを含む所定の高さ範囲内にあり、かつ前記作業機の操作装置の操作が一定時間継続している場合に、前記作業状態が掘削状態であると判定する
   請求項３に記載の作業機制御装置。
5. 前記自動ダンプ判定部は、前記作業状態がダンプ状態であると判定された場合に、前記自動ダンプ可否モードを、前記自動ダンプ制御の実行を許可するモードに切り替える
   請求項１から請求項４の何れか１項に記載の作業機制御装置。
6. 前記状態判定部は、前記バケットの角度が、前記作業車両に対して平行となる角度よりダンプ方向に所定角度以上傾いた場合に、前記作業状態がダンプ状態であると判定する 請求項５に記載の作業機制御装置。
7. 前記自動ダンプ制御の開始指令を受け付ける指令入力部と、
   前記自動ダンプ制御の開始指令を受け付け、かつ前記自動ダンプ可否モードが前記自動ダンプ制御の実行を許可するモードである場合に、前記自動ダンプ制御に係る駆動指令を出力する駆動制御部と
   を備える請求項１から請求項６の何れか１項に記載の作業機制御装置。
8. 前記指令入力部は、前記自動ダンプ制御、前記バケットを所定のチルト角度まで自動的に駆動させる自動チルト制御、前記ブームを所定の上昇位置まで自動的に駆動させる自動上昇制御、および前記ブームを所定の下降位置まで自動的に駆動させる自動下降制御の開始指令を受け付け、
   前記駆動制御部は、前記自動チルト制御、前記自動上昇制御、または前記自動下降制御の開始指令を受け付けた場合、前記自動ダンプ可否モードに関わらず、前記自動チルト制御、前記自動上昇制御、または前記自動下降制御に係る駆動指令を出力する
   請求項７に記載の作業機制御装置。
9. 前記指令入力部は、前記作業車両に設けられた停止スイッチの押下による停止指令を受け付け、
   前記駆動制御部は、前記停止指令を受け付けた場合に、前記駆動指令の出力を停止する 請求項７または請求項８に記載の作業機制御装置。
10. ブームおよびバケットを有する作業機と、
    請求項１から請求項９の何れか１項に記載の作業機制御装置と
    を備える作業車両。
11. ブームおよびバケットを有する作業機を備える作業車両の作業機制御方法であって、
    前記作業車両の作業状態を判定するステップと、
    前記作業状態に応じて、前記バケットを所定のダンプ角度まで自動的に駆動させる自動ダンプ制御の実行の可否を示す自動ダンプ可否モードを決定するステップと、
    前記自動ダンプ可否モードに応じて前記自動ダンプ制御に係る駆動指令を出力するステップと、
    を備える作業機制御方法。

Images