JP2019132057A - 積込機械の制御装置および制御方法 - Google Patents

Abstract

【課題】積込対象の位置を鑑みて自動積込の停止を適切に制御する。【解決手段】移動処理部は、バケットの自動移動の開始指示に基づいて、バケットを積込点へ移動させるための作業機および旋回体の操作信号を生成する。停止処理部は、バケットの自動移動の停止指示に基づいて、旋回体の旋回を制動させ、バケットの高さが前記積込点より低い場合に、作業機を退避させる操作信号をさらに生成する。【選択図】図３

Description

本発明は、積込機械の制御装置および制御方法に関する。

特許文献１には、積込機械の自動積込制御に関する技術が開示されている。自動積込制御とは、制御装置が積込機械のオペレータ等から積込点の指定を受け付け、制御装置が旋回体および作業機の動作を制御することで、バケットを積込点へ移動させる制御である。

特開平９−２５６４０７号公報

積込機械の自動積込制御中において、障害の発生等が生じた場合など、自動積込制御を停止する必要がある場合がある。このとき、作業機が設けられた旋回体の旋回動作の慣性により、旋回動作を即座に停止できない可能性がある。一方、作業機の上下動作の慣性は作業機が設けられた旋回体の旋回動作の慣性より小さいことから、作業機の動作は、旋回体の旋回動作と比較して早期に停止する。そのため、旋回動作中かつ作業機上昇中に自動積込制御が停止されると、作業機の上昇が停止した状態で、慣性により旋回が続くため、バケットの軌跡が制御での目標軌跡よりも低くなり、バケットと積込対象とが干渉する可能性がある。
本発明の目的は、積込対象の位置を鑑みて自動積込の停止を制御する積込機械の制御装置および制御方法を提供することにある。

本発明の第１の態様によれば、積込機械制御装置は、旋回中心回りに旋回する旋回体と、前記旋回体に取り付けられバケットを有する作業機とを備える積込機械を制御する制御装置であって、前記バケットの自動移動の開始指示に基づいて、前記バケットを積込点へ移動させるための前記作業機および前記旋回体の操作信号を生成する移動処理部と、前記バケットの自動移動の停止指示に基づいて、前記旋回体の旋回を制動させ、前記バケットの高さが前記積込点より低い場合に、前記作業機を退避させる操作信号をさらに生成する停止処理部とを備える。

上記態様によれば、積込機械の制御装置は、積込対象の位置を鑑みて自動積込の停止を適切に制御することができる。

第１の実施形態に係る積込機械の構成を示す概略図である。 第１の実施形態に係る制御装置の構成を示す概略ブロック図である。 第１の実施形態に係るバケットの経路の例を示す図である。 第１の実施形態に係る自動積込制御方法を示すフローチャートである。 第１の実施形態に係る自動積込制御方法を示すフローチャートである。 第１の実施形態に係る自動積込制御方法を示すフローチャートである。

以下、図面を参照しながら実施形態について詳しく説明する。
〈第１の実施形態〉
《積込機械の構成》
図１は、第１の実施形態に係る積込機械の構成を示す概略図である。
積込機械１００は、土砂を運搬車両などへ積込を行う作業機械である。第１の実施形態に係る積込機械１００は、油圧ショベルである。なお、他の実施形態に係る積込機械１００は、油圧ショベル以外の積込機械であってもよい。また図１に示す積込機械１００はフェイスショベルであるが、バックホウショベルやロープショベルであってもよい。
積込機械１００は、走行体１１０と、走行体１１０に支持される旋回体１２０と、油圧により作動し旋回体１２０に支持される作業機１３０とを備える。旋回体１２０は、旋回中心を中心として旋回自在に支持される。

作業機１３０は、ブーム１３１と、アーム１３２と、バケット１３３と、ブームシリンダ１３４と、アームシリンダ１３５と、バケットシリンダ１３６と、ブーム角度センサ１３７と、アーム角度センサ１３８と、バケット角度センサ１３９とを備える。

ブーム１３１の基端部は、旋回体１２０にピンを介して取り付けられる。
アーム１３２は、ブーム１３１とバケット１３３とを連結する。アーム１３２の基端部は、ブーム１３１の先端部にピンを介して取り付けられる。
バケット１３３は、土砂などを掘削するための刃と掘削した土砂を収容するための容器とを備える。バケット１３３の基端部は、アーム１３２の先端部にピンを介して取り付けられる。

ブームシリンダ１３４は、ブーム１３１を作動させるための油圧シリンダである。ブームシリンダ１３４の基端部は、旋回体１２０に取り付けられる。ブームシリンダ１３４の先端部は、ブーム１３１に取り付けられる。
アームシリンダ１３５は、アーム１３２を駆動するための油圧シリンダである。アームシリンダ１３５の基端部は、ブーム１３１に取り付けられる。アームシリンダ１３５の先端部は、アーム１３２に取り付けられる。
バケットシリンダ１３６は、バケット１３３を駆動するための油圧シリンダである。バケットシリンダ１３６の基端部は、ブーム１３１に取り付けられる。バケットシリンダ１３６の先端部は、バケット１３３に取り付けられる。

ブーム角度センサ１３７は、ブーム１３１に取り付けられ、ブーム１３１の傾斜角を検出する。
アーム角度センサ１３８は、アーム１３２に取り付けられ、アーム１３２の傾斜角を検出する。
バケット角度センサ１３９は、バケット１３３に取り付けられ、バケット１３３の傾斜角を検出する。
第１の実施形態に係るブーム角度センサ１３７、アーム角度センサ１３８、およびバケット角度センサ１３９は、地平面に対する傾斜角を検出する。なお、他の実施形態に係る角度センサはこれに限られず、他の基準面に対する傾斜角を検出してもよい。例えば、他の実施形態においては、角度センサは、ブーム１３１、アーム１３２およびバケット１３３の基端部に設けられたポテンショメータによって相対回転角を検出してもよいし、ブームシリンダ１３４、アームシリンダ１３５およびバケットシリンダ１３６のシリンダ長さを計測し、シリンダ長さを角度に変換することで傾斜角を検出するものであってもよい。

旋回体１２０には、運転室１２１が設けられる。運転室１２１の内部には、オペレータが着座するための運転席１２２、積込機械１００を操作するための操作装置１２３、検出方向に存在する対象物の三次元位置を検出するための検出装置１２４が設けられる。操作装置１２３は、オペレータの操作に応じて、ブームシリンダ１３４の操作信号、アームシリンダ１３５の操作信号、バケットシリンダ１３６の操作信号、旋回体１２０の左右への旋回操作信号、走行体１１０の前後進のための走行操作信号を生成し、制御装置１２８に出力する。また操作装置１２３は、オペレータの操作に応じて作業機１３０に自動積込制御を開始させるための積込指示信号、および自動積込制御を停止させるための積込停止指示信号を生成し、制御装置１２８に出力する。積込指示信号は、バケット１３３の自動移動の開始指示の一例である。積込停止指示信号は、バケット１３３の自動移動の停止指示の一例である。操作装置１２３は、例えばレバー、オルタネートスイッチおよびペダルにより構成される。積込指示信号および積込停止指示信号はオルタネートスイッチの操作により生成される。例えば、オルタネートスイッチがＯＮになったときに、積込指示信号が出力され、そのオルタネートスイッチがＯＦＦになったときに、積込停止指示信号が出力される。操作装置１２３は、運転席１２２の近傍に配置される。操作装置１２３は、オペレータが運転席１２２に座ったときにオペレータの操作可能な範囲内に位置する。
検出装置１２４の例としては、ステレオカメラ、レーザスキャナ、ＵＷＢ（Ultra Wide Band）測距装置などが挙げられる。検出装置１２４は、例えば検出方向が積込機械１００の運転室１２１の前方を向くように設けられる。検出装置１２４は、対象物の三次元位置を、検出装置１２４の位置を基準とした座標系で特定する。
なお、第１の実施形態に係る積込機械１００は、運転席１２２に着座するオペレータの操作に従って動作するが、他の実施形態においてはこれに限られない。例えば、他の実施形態に係る積込機械１００は、積込機械１００の外部で操作するオペレータの遠隔操作によって操作信号や積込指示信号が送信され動作するものであってもよい。

積込機械１００は、位置方位演算器１２５、傾斜計測器１２６、油圧装置１２７、制御装置１２８を備える。

位置方位演算器１２５は、旋回体１２０の位置および旋回体１２０が向く方位を演算する。位置方位演算器１２５は、ＧＮＳＳを構成する人工衛星から測位信号を受信する２つの受信器を備える。２つの受信器は、それぞれ旋回体１２０の異なる位置に設置される。位置方位演算器１２５は、受信器が受信した測位信号に基づいて、現場座標系における旋回体１２０の代表点（ショベル座標系の原点）の位置を検出する。
位置方位演算器１２５は、２つの受信器が受信した各測位信号を用いて、一方の受信器の設置位置に対する他方の受信器の設置位置の関係として、旋回体１２０の向く方位を演算する。

傾斜計測器１２６は、旋回体１２０の加速度および角速度（旋回速度）を計測し、計測結果に基づいて旋回体１２０の姿勢（例えば、ロール角、ピッチ角、ヨー角）を検出する。傾斜計測器１２６は、例えば旋回体１２０の下面に設置される。傾斜計測器１２６は、例えば、慣性計測装置（ＩＭＵ：Inertial Measurement Unit）を用いることができる。

油圧装置１２７は、作動油タンク、油圧ポンプ、および流量制御弁を備える。油圧ポンプは、図示しないエンジンの動力で駆動し、流量制御弁を介してブームシリンダ１３４、アームシリンダ１３５、バケットシリンダ１３６、旋回体１２０を回転させる図示しない旋回モータ、および走行体１１０を走行させる図示しない走行モータに作動油を供給する。流量制御弁はロッド状のスプールを有し、スプールの位置によってブームシリンダ１３４、アームシリンダ１３５、およびバケットシリンダ１３６に供給する作動油の流量を調整する。スプールは、制御装置１２８から受信する制御指令に基づいて駆動される。つまり、ブームシリンダ１３４、アームシリンダ１３５、およびバケットシリンダ１３６に供給される作動油の量は、制御装置１２８によって制御される。

制御装置１２８は、操作装置１２３から操作信号を受信する。制御装置１２８は、受信した操作信号に基づいて、作業機１３０、旋回体１２０、または走行体１１０を駆動させる。

《制御装置の構成》
図２は、第１の実施形態に係る制御装置の構成を示す概略ブロック図である。
制御装置１２８は、プロセッサ１１００、メインメモリ１２００、ストレージ１３００、インタフェース１４００を備えるコンピュータである。ストレージ１３００は、プログラムを記憶する。プロセッサ１１００は、プログラムをストレージ１３００から読み出してメインメモリ１２００に展開し、プログラムに従った処理を実行する。

ストレージ１３００の例としては、ＨＤＤ、ＳＳＤ、磁気ディスク、光磁気ディスク、ＣＤ−ＲＯＭ、ＤＶＤ−ＲＯＭ等が挙げられる。ストレージ１３００は、制御装置１２８の共通通信線に直接接続された内部メディアであってもよいし、インタフェース１４００を介して制御装置１２８に接続される外部メディアであってもよい。ストレージ１３００は、一時的でない有形の記憶媒体である。

プロセッサ１１００は、プログラムの実行により、車両情報取得部１１０１、検出情報取得部１１０２、操作信号入力部１１０３、バケット位置特定部１１０４、積込位置特定部１１０５、回避位置特定部１１０６、移動処理部１１０７、停止処理部１１０８、操作信号出力部１１０９を備える。

車両情報取得部１１０１は、旋回体１２０の旋回速度、位置および方位、ブーム１３１、アーム１３２およびバケット１３３の傾斜角、走行体１１０の走行速度、ならびに旋回体１２０の姿勢を取得する。以下、車両情報取得部１１０１が取得する積込機械１００に係る情報を車両情報とよぶ。

検出情報取得部１１０２は、検出装置１２４から三次元位置情報を取得し、積込対象２００（例えば、運搬車両やホッパ）の位置および形状を特定する。

操作信号入力部１１０３は、操作装置１２３から操作信号の入力を受け付ける。ブーム１３１の操作信号、アーム１３２の操作信号、バケット１３３の操作信号、旋回体１２０の旋回操作信号、走行体１１０の走行操作信号、ならびに積込機械１００の積込指示信号および積込停止指示信号が含まれる。

バケット位置特定部１１０４は、車両情報取得部１１０１が取得した車両情報に基づいて、ショベル座標系におけるアーム１３２の先端の位置Ｐおよびアーム１３２の先端からバケット１３３の最下点までの高さＨｂを特定する。バケット１３３の最下点とは、バケット１３３の外形のうち地表面からの距離が最も短い点をいう。特に、バケット位置特定部１１０４は、積込指示信号の入力を受け付けたときのアーム１３２の先端の位置Ｐを掘削完了位置Ｐ１０として特定する。図３は、第１の実施形態に係るバケットの経路の例を示す図である。具体的には、バケット位置特定部１１０４は、ブーム１３１の傾斜角と既知のブーム１３１の長さ（基端部のピンから先端部のピンまでの距離）とに基づいて、ブーム１３１の長さの垂直方向成分および水平方向成分を求める。同様に、バケット位置特定部１１０４は、アーム１３２の長さの垂直方向成分および水平方向成分を求める。バケット位置特定部１１０４は、積込機械１００の位置から、積込機械１００の方位および姿勢から特定される方向に、ブーム１３１およびアーム１３２の長さの垂直方向成分の和および水平方向成分の和だけ離れた位置を、アーム１３２の先端の位置Ｐ（図１に示すアーム１３２の先端部のピンの位置Ｐ）として特定する。また、バケット位置特定部１１０４は、バケット１３３の傾斜角と既知のバケット１３３の形状とに基づいて、バケット１３３の鉛直方向の最下点を特定し、アーム１３２の先端から最下点までの高さＨｂを特定する。

積込位置特定部１１０５は、操作信号入力部１１０３に積込指示信号が入力された場合に、検出情報取得部１１０２が特定した積込対象２００の位置および形状に基づいて、積込位置Ｐ１３を特定する。積込位置特定部１１０５は、車両情報取得部１１０１が取得した旋回体１２０の位置、方位および姿勢に基づいて積込対象２００の位置情報が示す積込点Ｐ２１を現場座標系からショベル座標系に変換する。積込位置特定部１１０５は、特定した積込点Ｐ２１から、積込機械１００の旋回体１２０の向く方向にバケット１３３の中心からアーム１３２の先端までの距離Ｄ１だけ離れた位置を、積込位置Ｐ１３の平面位置として特定する。つまり、アーム１３２の先端が積込位置Ｐ１３に位置するとき、バケット１３３の中心は積込点Ｐ２１に位置することとなる。したがって、制御装置１２８は、アーム１３２の先端が積込位置Ｐ１３へ移動するように制御することで、バケット１３３の中心を積込点Ｐ２１に移動させることができる。積込位置特定部１１０５は、積込対象２００の高さＨｔに、バケット位置特定部１１０４が特定したアーム１３２の先端からバケット１３３の最下点までの高さＨｂと、バケット１３３の制御余裕分の高さとを加算することで、積込位置Ｐ１３の高さを特定する。なお、他の実施形態においては、積込位置特定部１１０５は、制御余裕分の高さを加算せずに積込位置Ｐ１３を特定してもよい。すなわち、積込位置特定部１１０５は、高さＨｔに高さＨｂを加算することで、積込位置Ｐ１３の高さを特定してもよい。

回避位置特定部１１０６は、積込位置特定部１１０５が特定した積込位置Ｐ１３と、車両情報取得部１１０１が取得した積込機械１００の位置と、検出情報取得部１１０２が特定した積込対象２００の位置および形状に基づいて、バケット１３３が積込対象２００と干渉しない点である干渉回避位置Ｐ１２を特定する。干渉回避位置Ｐ１２は、積込位置Ｐ１３と同じ高さを有し、かつ旋回体１２０の旋回中心からの距離が、当該旋回中心から積込位置Ｐ１３までの距離と等しく、かつ下方に積込対象２００が存在しない位置である。回避位置特定部１１０６は、例えば、旋回体１２０の旋回中心を中心とし、当該旋回中心と積込位置Ｐ１３との距離を半径とする円を特定し、当該円上の位置のうち、バケット１３３の外形が平面視で積込対象２００と干渉せず、かつ積込位置Ｐ１３に最も近い位置を、干渉回避位置Ｐ１２と特定する。回避位置特定部１１０６は、積込対象２００の位置および形状、ならびにバケット１３３の既知の形状に基づいて、積込対象２００とバケット１３３とが干渉するか否かを判定することができる。ここで、「同じ高さ」、「距離が等しい」とは、必ずしも高さまたは距離が完全に一致するものに限られず、多少の誤差やマージンが許容されるものとする。

移動処理部１１０７は、操作信号入力部１１０３が積込指示信号の入力を受け付けた場合に、積込位置特定部１１０５が特定した積込位置Ｐ１３、回避位置特定部１１０６が特定した干渉回避位置Ｐ１２に基づいて、バケット１３３を積込位置Ｐ１３まで移動させるための操作信号を生成する。すなわち、移動処理部１１０７は、掘削完了位置Ｐ１０から、旋回開始位置Ｐ１１および干渉回避位置Ｐ１２を経由して、積込位置Ｐ１３に到達するように、操作信号を生成する。また、移動処理部１１０７は、ブーム１３１およびアーム１３２が駆動してもバケット１３３の角度が変化しないように、バケット１３３の操作信号を生成する。

停止処理部１１０８は、ステップＰ１０からステップＰ１３までの移動の途中で操作信号入力部１１０３が積込停止指示信号の入力を受け付けた場合に、旋回体１２０および作業機１３０を制動させるための操作信号を生成する。旋回体１２０は作業機１３０より慣性モーメントが大きいため、停止処理部１１０８は、積込停止指示信号を受け付けてから旋回体１２０が停止するまで、または作業機１３０が所定高さに達するまで、作業機１３０を上昇させる操作信号を出力する。これにより、停止処理部１１０８は、積込停止指示信号の入力を受け付けた後、旋回体１２０の慣性による旋回によって作業機１３０が積込対象２００に接触することを防ぐことができる。

操作信号出力部１１０９は、操作信号入力部１１０３に入力された操作信号、移動処理部１１０７が生成した操作信号、または停止処理部１１０８が生成した操作信号を出力する。

《動作》
積込機械１００のオペレータは、積込機械１００と積込対象２００とが積込処理可能な位置関係にあると判断すると、操作装置１２３のオルタネートスイッチをＯＮにする。これにより、操作装置１２３は、積込指示信号を生成し出力する。

図４−図６は、第１の実施形態に係る自動積込制御方法を示すフローチャートである。制御装置１２８は、オペレータから積込指示信号の入力を受け付けると、図４−図６に示す自動積込制御を実行する。

車両情報取得部１１０１は、旋回体１２０の位置および方位、ブーム１３１、アーム１３２およびバケット１３３の傾斜角、ならびに旋回体１２０の姿勢および旋回速度を取得する（ステップＳ１）。バケット位置特定部１１０４は、車両情報取得部１１０１が取得した旋回体１２０の位置および方位に基づいて、旋回体１２０の旋回中心の位置を特定する（ステップＳ２）。また検出情報取得部１１０２は、検出装置１２４から、積込対象２００の三次元位置情報を取得し、三次元位置情報から積込対象２００の位置および形状を特定する（ステップＳ３）。

バケット位置特定部１１０４は、車両情報取得部１１０１が取得した車両情報に基づいて、積込指示信号の入力時のアーム１３２の先端の位置Ｐ、およびアーム１３２の先端からバケット１３３の最下点までの高さＨｂを特定する（ステップＳ４）。バケット位置特定部１１０４は、当該位置Ｐを掘削完了位置Ｐ１０と特定する。

積込位置特定部１１０５は、ステップＳ１で取得した旋回体１２０の位置、方位および姿勢に基づいて検出情報取得部１１０２が取得した積込対象２００の位置情報を現場座標系からショベル座標系に変換する。積込位置特定部１１０５は、検出情報取得部１１０２が特定した積込対象２００の位置および形状に基づいて、積込位置Ｐ１３の平面位置を特定する（ステップＳ５）。このとき、積込位置特定部１１０５は、積込対象２００の高さＨｔに、ステップＳ３で特定したアーム１３２の先端からバケット１３３の最下点までの高さＨｂと、バケット１３３の制御余裕分の高さとを加算することで、積込位置Ｐ１３の高さを特定する（ステップＳ６）。

回避位置特定部１１０６は、ステップＳ２で特定した旋回中心から積込位置Ｐ１３までの平面距離を特定する（ステップＳ７）。回避位置特定部１１０６は、旋回中心から特定した平面距離だけ離れた位置であって、バケット１３３の外形が平面視で積込対象２００と干渉せず、かつ積込位置Ｐ１３から最も近い位置を、干渉回避位置Ｐ１２として特定する（ステップＳ８）。

操作信号入力部１１０３は、オペレータから積込停止指示信号の入力を受け付けたか否かを判定する（ステップＳ９）。つまり、操作信号入力部１１０３は、自動積込制御中にオルタネートスイッチがＯＦＦにされたか否かを判定する。
積込停止指示信号の入力を受け付けていない場合（ステップＳ９：ＮＯ）、移動処理部１１０７は、アーム１３２の先端の位置が積込位置Ｐ１３に至ったか否かを判定する（ステップＳ１０）。アーム１３２の先端の位置が積込位置Ｐ１３に至っていない場合（ステップＳ１０：ＮＯ）、移動処理部１１０７は、アーム１３２の先端の位置が干渉回避位置Ｐ１２の近傍にあるか否かを判定する（ステップＳ１１）。例えば、移動処理部１１０７は、アーム１３２の先端の高さと干渉回避位置Ｐ１２の高さとの差が所定の閾値未満であり、または旋回体１２０の旋回中心からアーム１３２の先端までの平面距離と旋回中心から干渉回避位置Ｐ１２までの平面距離との差が所定の閾値未満であるか否かを判定する。アーム１３２の先端の位置が干渉回避位置Ｐ１２の近傍にない場合（ステップＳ１１：ＮＯ）、移動処理部１１０７は、アーム１３２の先端を干渉回避位置Ｐ１２まで移動させるブーム１３１およびアーム１３２の操作信号を生成する（ステップＳ１２）。このとき、移動処理部１１０７は、ブーム１３１およびアーム１３２の位置および速度に基づいて、操作信号を生成する。

また移動処理部１１０７は、生成したブーム１３１およびアーム１３２の操作信号に基づいてブーム１３１およびアーム１３２の角速度の和を算出し、当該角速度の和と同じ速度でバケット１３３を回動させる操作信号を生成する（ステップＳ１３）。これにより、移動処理部１１０７は、バケット１３３の対地角を保持する操作信号を生成することができる。なお、他の実施形態においては、移動処理部１１０７は、ブーム角度センサ１３７、アーム角度センサ１３８およびバケット角度センサ１３９の検出値より算出されるバケット１３３の対地角度が、自動制御開始時の対地角度と等しくなるようにバケット１３３を回動させる操作信号を生成してもよい。

アーム１３２の先端の位置が干渉回避位置Ｐ１２の近傍にある場合（ステップＳ１１：ＹＥＳ）、移動処理部１１０７は、作業機を駆動する操作信号を生成しない。つまり、ブーム１３１、アーム１３２およびバケット１３３の操作信号を生成しない。

移動処理部１１０７は、車両情報取得部１１０１が取得した車両情報に基づいて、旋回体１２０の旋回速度が所定速度未満であるか否かを判定する（ステップＳ１４）。すなわち、移動処理部１１０７は、旋回体１２０が旋回中であるか否かを判定する。
旋回体１２０の旋回速度が所定速度未満である場合（ステップＳ１４：ＹＥＳ）、移動処理部１１０７は、バケット１３３の高さが掘削完了位置Ｐ１０の高さから干渉回避位置Ｐ１２の高さに至るまでの時間である上昇時間を特定する（ステップＳ１５）。バケット１３３の上昇時間に基づいて、現在時刻から旋回操作信号を出力した場合に、アーム１３２の先端が干渉回避位置Ｐ１２または干渉回避位置Ｐ１２より高い点を通過することになるか否かを判定する（ステップＳ１６）。現在時刻から旋回操作信号を出力した場合に、アーム１３２の先端が干渉回避位置Ｐ１２または干渉回避位置Ｐ１２より高い点を通過することになる場合（ステップＳ１６：ＹＥＳ）、移動処理部１１０７は、旋回操作信号を生成する（ステップＳ１７）。
現在時刻から旋回操作信号を出力した場合に、アーム１３２の先端が干渉回避位置Ｐ１２より低い点を通過することになる場合（ステップＳ１６：ＮＯ）、移動処理部１１０７は、旋回操作信号を生成しない。

旋回体１２０の旋回速度が所定速度以上である場合（ステップＳ１４：ＮＯ）、移動処理部１１０７は、現在時刻から旋回操作信号の出力を停止した場合（旋回の制動を開始した場合）に、アーム１３２の先端が積込位置Ｐ１３に到達することになるか否かを判定する（ステップＳ１８）。なお、旋回体１２０は、旋回操作信号の出力の停止後、減速しながらも慣性により旋回し続け、その後停止する。現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端が積込位置Ｐ１３に到達することになる場合（ステップＳ１８：ＹＥＳ）、移動処理部１１０７は、旋回操作信号を生成しない。これにより、旋回体１２０の制動が開始される。
他方、現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端が積込位置Ｐ１３より手前で停止することになる場合（ステップＳ１８：ＮＯ）、移動処理部１１０７は、旋回操作信号を生成する（ステップＳ１９）。

ステップＳ１０からステップＳ１９の処理でブーム１３１、アーム１３２およびバケット１３３の操作信号、並びに旋回体１２０の旋回操作信号の少なくともいずれか１つを生成すると、操作信号出力部１１０９は、生成した操作信号を油圧装置１２７に出力する（ステップＳ２０）。そして、車両情報取得部１１０１は、車両情報を取得する（ステップＳ２１）。これにより、車両情報取得部１１０１は、出力した操作信号によって駆動した後の車両情報を取得することができる。制御装置１２８は、処理をステップＳ９に戻し、操作信号の生成を繰り返し実行する。

他方、ステップＳ１０にて、アーム１３２の先端の位置が積込位置Ｐ１３に至っている場合（ステップＳ１０：ＹＥＳ）、移動処理部１１０７は操作信号を生成しない。したがって、アーム１３２の先端の位置が積込位置Ｐ１３に至ると、作業機１３０および旋回体１２０は停止する。アーム１３２の先端の位置が積込位置Ｐ１３に至っている場合（ステップＳ１０：ＹＥＳ）、すなわちステップＳ１０からステップＳ１９の処理で移動処理部１１０７が操作信号を生成しておらず、かつ作業機１３０および旋回体１２０が静止している場合、移動処理部１１０７は、バケット１３３を積込動作させる操作信号を生成する（ステップＳ２２）。バケット１３３を積込動作させる操作信号の例としては、バケット１３３を積込方向に回動させる操作信号や、バケット１３３がクラムバケットである場合におけるクラムシェルを開く操作信号が挙げられる。操作信号出力部１１０９は、生成した操作信号を油圧装置１２７に出力する（ステップＳ２３）。そして、制御装置１２８は、自動積込制御を終了する。

ここで、図３を用いて、自動積込制御時の積込機械１００の動作について説明する。
自動積込制御が開始されると、ブーム１３１およびアーム１３２は、掘削完了位置Ｐ１０から旋回開始位置Ｐ１１へ向けて上昇する。このとき、バケット１３３は、掘削終了時の角度を維持するように駆動する。

アーム１３２の先端が旋回開始位置Ｐ１１にくると、旋回体１２０は積込位置Ｐ１３へ向けて旋回を開始する。このとき、アーム１３２の先端は干渉回避位置Ｐ１２の高さに至っていないため、ブーム１３１およびアーム１３２の上昇は継続される。またこのとき、図３に示すように、旋回中心からアーム１３２の先端（位置Ｐ１０ａ、位置Ｐ１０ｂ）までの距離が、旋回中心から干渉回避位置Ｐ１２までの距離と異なる場合、制御装置１２８は、旋回中心からアーム１３２の先端までの距離が旋回中心から干渉回避位置Ｐ１２までの距離と等しくなるように、作業機１３０を旋回半径方向にも移動させる。アーム１３２の先端が旋回開始位置Ｐ１１から干渉回避位置Ｐ１２へ移動する途中で、アーム１３２の先端の高さが干渉回避位置Ｐ１２と等しくなるように、ブーム１３１、アーム１３２およびバケット１３３は減速する。

アーム１３２の先端が干渉回避位置Ｐ１２にくると、作業機１３０の駆動は停止する。一方、旋回体１２０は旋回を継続する。すなわち、干渉回避位置Ｐ１２から積込位置Ｐ１３までの間、アーム１３２の先端は、作業機１３０の駆動によらず、旋回体１２０の旋回のみにより移動する。アーム１３２の先端が旋回開始位置Ｐ１１から積込位置Ｐ１３へ移動する途中で、アーム１３２の先端の位置が積込位置Ｐ１３と等しくなるように、旋回体１２０は減速する。

アーム１３２の先端が積込位置Ｐ１３にくると、作業機１３０および旋回体１２０の駆動は停止する。その後、バケット１３３が積込動作を実行する。

上述の自動積込制御により、積込機械１００は、バケット１３３がすくった土砂を自動的に積込対象２００に積込することができる。オペレータは、作業機１３０による掘削と、積込指示信号の入力による自動積込制御とを、積込対象２００の積載量が最大積載量を超えない程度に繰り返し実行する。

他方、ステップＳ９において操作信号入力部１１０３が積込停止指示信号の入力を受け付けた場合（ステップＳ９：ＹＥＳ）、停止処理部１１０８は、旋回体１２０の操作信号の生成を停止する（ステップＳ２４）。これにより、旋回体１２０は、制動を始める。なお、積込機械１００が旋回動作を制動させる制動装置を備える場合、操作信号の生成の停止に加え、さらに制動装置に制動制御信号を出力してもよい。制動装置の例としては、油圧装置１２７内部に設けられるブレーキ弁や、ディスクブレーキやドラムブレーキなどの摩擦ブレーキなどが挙げられる。停止処理部１１０８は、車両情報取得部１１０１が取得した車両情報に基づいて、旋回体１２０の旋回速度が所定速度未満であるか否かを判定する（ステップＳ２５）。すなわち、停止処理部１１０８は、旋回体１２０が旋回中であるか否かを判定する。

旋回体１２０の旋回速度が所定速度以上である場合（ステップＳ２５：ＮＯ）、すなわち旋回体１２０が旋回中である場合、停止処理部１１０８は、アーム１３２の先端の高さが干渉回避位置Ｐ１２の高さ未満であるか否かを判定する（ステップＳ２６）。バケット１３３の高さが干渉回避位置Ｐ１２の高さ未満である場合（ステップＳ２６：ＹＥＳ）、停止処理部１１０８は、ブーム１３１およびアーム１３２を上昇させる操作信号を生成する（ステップＳ２７）。また移動処理部１１０７は、生成したブーム１３１およびアーム１３２の操作信号に基づいてブーム１３１およびアーム１３２の角速度の和を算出し、当該角速度の和と同じ速度でバケット１３３を回動させる操作信号を生成する（ステップＳ２８）。
そして、操作信号出力部１１０９は、停止処理部１１０８が生成した作業機１３０の操作信号を油圧装置１２７に出力する（ステップＳ２９）。つまり、停止処理部１１０８は、旋回体１２０が回転しており、かつアーム１３２の先端の高さが干渉回避位置Ｐ１２の高さ未満である場合に、作業機１３０の操作信号の生成を停止しない。

これにより、操作信号の出力がなくなった後の慣性による旋回体１２０の回転中、バケット１３３の上昇が継続される。これにより、アーム１３２の先端が干渉回避位置Ｐ１２まで上がりきっていない状態で停止し、慣性による旋回体１２０の回転によって作業機１３０が積込対象２００に当たることを防ぐことができる。
そして、車両情報取得部１１０１は、車両情報を取得する（ステップＳ３０）。これにより、車両情報取得部１１０１は、出力した操作信号によって駆動した後の車両情報を取得することができる。制御装置１２８は、処理をステップＳ２５に戻し、自動積込の停止処理を繰り返し実行する。

他方、旋回体１２０の旋回速度が所定速度未満である場合（ステップＳ２５：ＹＥＳ）、すなわち旋回体１２０の旋回が停止した場合、停止処理部１１０８は、作業機１３０の操作信号の生成を停止する（ステップＳ３１）。これは、旋回体１２０が停止しているために作業機１３０が旋回によって積込対象２００に当たる可能性がなくなったためである。
また、アーム１３２の先端の高さが干渉回避位置Ｐ１２の高さ以上である場合（ステップＳ２６：ＮＯ）、停止処理部１１０８は、作業機１３０の操作信号の生成を停止する（ステップＳ３１）。これは、バケット１３３が積込対象２００より高い位置まで移動していることから、旋回体１２０が旋回したとしても作業機１３０が積込対象２００に当たる可能性がなくなったためである。

《作用・効果》
第１の実施形態に係る積込機械１００は、積込指示信号を受け付けると作業機１３０および旋回体１２０の操作信号を生成し、積込停止指示信号を受け付けると旋回体を旋回させる操作信号の生成を停止する。このとき、積込機械１００は、バケット１３３の高さが積込点Ｐ２１より低い場合に、作業機１３０を上昇させる操作信号をさらに生成する。これにより、積込機械１００は、何らかの事情で自動積込を停止した場合に、操作信号の生成の停止後、慣性による旋回体１２０の回転によって作業機１３０が積込対象２００に当たることを防ぐことができる。

また、第１の実施形態に係る積込機械１００は、バケット１３３の高さが積込点Ｐ２１以上の高さになった場合に、作業機１３０を上昇させる操作信号の生成を停止する。これにより、積込機械１００は、作業機１３０が積込対象２００に当たる可能性がなくなった後、速やかに作業機１３０を停止させることができる。

また、第１の実施形態に係る積込機械１００は、旋回体１２０の旋回速度が所定の速度未満になった場合に、作業機１３０を上昇させる操作信号の生成を停止する。これにより、積込機械１００は、作業機１３０が積込対象２００に当たる可能性がなくなった後、速やかに作業機１３０を停止させることができる。

〈他の実施形態〉
以上、図面を参照して一実施形態について詳しく説明してきたが、具体的な構成は上述のものに限られることはなく、様々な設計変更等をすることが可能である。
例えば、第１の実施形態に係る積込機械１００の操作装置１２３は、オルタネートスイッチのＯＦＦによって積込停止指示信号を出力するが、他の実施形態ではこれに限られない。例えば、オルタネートスイッチ以外のスイッチでも良い。また、他の実施形態に係る積込機械１００の制御装置１２８は操作装置１２３により、自動積込中に旋回方向と逆方向の旋回操作がなされたときなど、スイッチ操作以外の操作で判断して積込停止指示信号を生成してもよい。また制御装置１２８は、自動積込制御中に行うべきでない操作（例えば、走行操作）がなされたときに、積込停止指示信号を生成してもよい。また制御装置１２８は、図示しない障害が検出された場合など、自動積込制御に望ましくない車両状態になることを判断して、積込停止指示信号を生成してもよい。

また、第１の実施形態に係る積込機械１００の制御装置１２８は、積込停止指示信号を受け付けた後、自動的に作業機１３０の操作信号を生成するが、これに限られない。例えば、他の実施形態に係る積込機械１００において、制御装置１２８が積込停止指示信号を受け付けた後、オペレータの操作により操作装置１２３が作業機１３０の操作信号を出力してもよい。この場合、制御装置１２８は、操作装置１２３が出力する操作信号に係る上昇速度が自動的に生成される操作信号に係る上昇速度より高い場合に、操作装置１２３が出力する操作信号にしたがって作業機１３０を制御する。他方、制御装置１２８は、操作装置１２３が出力する操作信号に係る上昇速度が、自動的に生成される操作信号に係る上昇速度以下である場合、自動的に生成した操作信号にしたがって作業機１３０を制御する。

また、第１の実施形態に係る積込機械１００は、検出装置１２４が検出した積込対象２００の三次元位置に基づいて積込位置Ｐ１３、干渉回避位置Ｐ１２を特定するが、これに限られない。例えば、他の実施形態に係る積込機械１００は、オペレータによって入力された積込対象２００の座標に基づいて積込位置Ｐ１３、干渉回避位置Ｐ１２を特定してもよい。積込機械１００が運転席１２２にタッチパネルなどの入力装置を備える場合、オペレータが当該入力装置に積込対象２００の座標を入力することで、制御装置１２８が積込位置Ｐ１３、干渉回避位置Ｐ１２を特定してもよい。また例えば、他の実施形態に係る積込機械１００は、オペレータの手動操作による１杯目の積込対象２００への積込操作を記憶し、当該積込操作に基づいて積込位置Ｐ１３、干渉回避位置Ｐ１２を特定してもよい。
また他の実施形態において、積込対象２００が固定されている場合、積込機械１００は、既知の積込対象２００の位置に基づいて積込位置Ｐ１３、干渉回避位置Ｐ１２を特定してもよい。例えば、積込対象２００がＧＮＳＳによる自車位置特定機能を有する運搬車両である場合、積込機械１００は、積込場所に停車した積込対象２００から位置および方位を示す情報を取得し、当該情報に基づいて積込位置Ｐ１３、干渉回避位置Ｐ１２を特定してもよい。

また、上述した実施形態においては、制御装置１２８が作業機１３０を退避させるために作業機１３０を上昇させるが、他の退避方法を用いてもよい。例えば、他の実施形態においては、作業機１３０を上昇させることで退避するほか、作業機１３０を縮めた姿勢にすることで退避させてもよい。作業機１３０を縮めた姿勢とは、ブーム１３１を上昇させると共にアーム１３２を手前に回動することをいう。これにより、作業機１３０の姿勢は旋回半径方向に縮んだ姿勢となり、作業機１３０がこの姿勢をとることにより、積込対象２００との干渉を回避するように構成しても良い。

１００…積込機械 １２０…旋回体 １３０…作業機 １３１…ブーム １３２…アーム １３３…バケット １２３…操作装置 １２４…検出装置 １２８…制御装置 １１０１…車両情報取得部 １１０２…検出情報取得部 １１０３…操作信号入力部 １１０４…バケット位置特定部 １１０５…積込位置特定部 １１０６…回避位置特定部 １１０７…移動処理部 １１０８…停止処理部 １１０９…操作信号出力部 ２００…積込対象 Ｐ１０…掘削完了位置 Ｐ１１…旋回開始位置 Ｐ１２…干渉回避位置 Ｐ１３…積込位置 Ｐ２１…積込点

Claims (4)

1. 旋回中心回りに旋回する旋回体と、前記旋回体に取り付けられバケットを有する作業機とを備える積込機械を制御する制御装置であって、
   前記バケットの自動移動の開始指示に基づいて、前記バケットを積込点へ移動させるための前記作業機および前記旋回体の操作信号を生成する移動処理部と、
   前記バケットの自動移動の停止指示に基づいて、前記旋回体の旋回を制動させ、前記バケットの高さが前記積込点より低い場合に、前記作業機を退避させる操作信号をさらに生成する停止処理部と
   を備える制御装置。
2. 前記停止処理部は、前記バケットの高さが前記積込点以上の高さになった場合に、前記作業機を上昇させる操作信号の生成を停止する
   請求項１に記載の制御装置。
3. 前記停止処理部は、前記旋回体の旋回速度が所定の速度未満になった場合に、前記作業機を上昇させる操作信号の生成を停止する
   請求項１または請求項２に記載の制御装置。
4. 旋回中心回りに旋回する旋回体と、前記旋回体に取り付けられバケットを有する作業機とを備える積込機械の制御方法であって、
   前記バケットの自動移動の開始指示を受けた場合に、前記バケットを積込点へ移動させるための前記作業機および前記旋回体の操作信号を生成するステップと、
   前記バケットの自動移動の停止指示を受けた場合に、前記旋回体の旋回を制動させるステップと、
   前記バケットの自動移動の停止指示を受け、かつ前記バケットの高さが前記積込点より低い場合に、前記作業機を退避させる操作信号を生成するステップと
   を備える積込機械の制御方法。

Images