特開 2024-73906 積込機械の制御装置、遠隔制御装置および制御方法

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公開特許公報(A)

(11)【公開番号】P2024073906

(43)【公開日】2024-05-30

(54)【発明の名称】積込機械の制御装置、遠隔制御装置および制御方法

(51)【国際特許分類】

   E02F 9/20 20060101AFI20240523BHJP

   E02F 3/43 20060101ALI20240523BHJP

   E02F 9/24 20060101ALI20240523BHJP

【ＦＩ】

E02F9/20 Q

E02F3/43 A

E02F9/24 L

【審査請求】未請求

【請求項の数】9

【出願形態】ＯＬ

(21)【出願番号】P 2022184885

(22)【出願日】2022-11-18

(71)【出願人】

【識別番号】000001236

【氏名又は名称】株式会社小松製作所

(74)【代理人】

【識別番号】110001634

【氏名又は名称】弁理士法人志賀国際特許事務所

(72)【発明者】

【氏名】根田 知樹

(72)【発明者】

【氏名】衞藤 朋幸

(72)【発明者】

【氏名】山村 正男

【テーマコード（参考）】

2D003

2D015

【Ｆターム（参考）】

2D003AA01

2D003AB02

2D003AB03

2D003AC09

2D003BA03

2D003BA04

2D003BA06

2D003BB08

2D003BB09

2D003BB10

2D003BB11

2D003DA04

2D003DB04

2D003DB05

2D003DC01

2D003FA02

2D015GA03

2D015GB07

2D015HB04

2D015HB05

(57)【要約】

【課題】積込機械の自動制御において、バケットが積込対象の内壁に接触することを防ぐ。
【解決手段】基準特定部は、積込対象の高さを特定する。作業機位置特定部は、作業具の高さを特定する。操作信号出力部は、作業具を積込対象の上から積込対象の外側へ移動させる自動制御時に、作業具が積込対象の上方に位置し、かつ作業具の高さが積込対象の高さより低い場合に、作業機を上昇させる信号を出力する。
【選択図】図５

【特許請求の範囲】

【請求項1】

旋回中心回りに旋回する旋回体と、作業具を有する前記旋回体に取り付けられた作業機とを備える積込機械の制御装置であって、
積込対象の高さを特定する基準特定部と、
前記作業具の高さを特定する作業機位置特定部と、
前記作業具を前記積込対象の上から前記積込対象の外側へ移動させる自動制御時に、前記作業具が前記積込対象の上方に位置し、かつ前記作業具の高さが前記積込対象の高さより低い場合に、前記作業機を上昇させる信号を出力する操作信号出力部と
を備える積込機械の制御装置。

【請求項2】

前記操作信号出力部は、
前記作業機を上昇させる操作信号によって前記作業具の高さが前記積込機械の高さより高くなった後に、前記旋回体を前記積込対象の外側へ向けて旋回させる操作信号を出力する
請求項１に記載の積込機械の制御装置。

【請求項3】

前記操作信号出力部は、
前記作業具の高さが前記積込機械の高さより低い場合に、前記作業機を上昇させる信号として、前記作業機のうち前記作業具を支持する部材を上昇させる操作信号を出力する
請求項１または請求項２に記載の積込機械の制御装置。

【請求項4】

前記操作信号出力部は、
前記作業具の高さが前記積込機械の高さより高い場合に、前記旋回体を前記積込対象の外側へ向けて旋回させる操作信号を出力する
請求項１または請求項２に記載の積込機械の制御装置。

【請求項5】

前記操作信号出力部は、
前記作業具の高さが前記積込機械の高さより低い場合に、旋回させる信号を出力しない
請求項４に記載の積込機械の制御装置。

【請求項6】

前記作業機位置特定部は、前記作業具の高さとして、作業具の最下点または、作業具の稼働範囲の最下点の高さを特定する
請求項１または請求項２に記載の積込機械の制御装置。

【請求項7】

オペレータから、前記自動制御の開始指示の入力を受け付ける入力部を備える
請求項１または請求項２に記載の積込機械の制御装置。

【請求項8】

旋回中心回りに旋回する旋回体と、作業具を有する前記旋回体に取り付けられた作業機とを備える積込機械の制御方法であって、
積込対象の高さを特定するステップと、
前記作業具の高さを特定するステップと、
前記作業具を前記積込対象の上から前記積込対象の外側へ移動させる自動制御時に、前記作業具が前記積込対象の上方に位置し、かつ前記作業具の高さが前記積込対象の高さより低い場合に、前記作業機を上昇させる信号を出力するステップと
を備える積込機械の制御方法。

【請求項9】

旋回中心回りに旋回する旋回体と、作業具を有する前記旋回体に取り付けられた作業機とを備える積込機械を遠隔制御する遠隔制御装置であって、
積込対象の高さを特定する基準特定部と、
前記作業具の高さを特定する作業機位置特定部と、
前記作業具を前記積込対象の上から前記積込対象の外側へ移動させる自動制御時に、前記作業具が前記積込対象の上方に位置し、かつ前記作業具の高さが前記積込対象の高さより低い場合に、前記作業機を上昇させる信号を、前記積込機械に出力する操作信号出力部と
を備える遠隔制御装置。

【発明の詳細な説明】

【技術分野】

【0001】

本開示は、積込機械の制御装置、遠隔制御装置および制御方法に関する。

【背景技術】

【0002】

特許文献１には、積込機械の半自動制御に関する技術が開示されている。特許文献１に係る半自動制御は、ダンプトラックなどの積込対象に対する積込完了後に、オペレータから掘削指示を受け付け、制御装置が積込機械の旋回及び作業機の駆動を制御することで、掘削位置までバケットを自動的に移動させる制御である。

【先行技術文献】

【特許文献】

【0003】

【特許文献1】特開２０２０－０４１３５２号公報

【発明の概要】

【発明が解決しようとする課題】

【0004】

ところで、オペレータは、荷を積込対象に積み込む際に、積込対象に加わる衝撃を抑えるために荷を低い位置で積み込むことがある。またオペレータはバケットで荷を均すことがある。このとき、バケットは積込対象である箱体の内側に位置する。したがって、半自動制御または全自動制御によって積込機械を旋回させるときに、バケットが積込対象の内壁に接触する可能性がある。以下、半自動制御および全自動制御を総称して自動制御とよぶ。

【0005】

本開示の目的は、積込機械の自動制御において、バケットが積込対象の内壁に接触することを防ぐ積込機械の制御装置、遠隔制御装置および制御方法を提供することにある。

【課題を解決するための手段】

【0006】

本開示の一態様によれば、積込機械の制御装置は、旋回中心回りに旋回する旋回体と、作業具を有する前記旋回体に取り付けられた作業機とを備える積込機械の制御装置であって、積込対象の高さを特定する基準特定部と、前記作業具の高さを特定する作業機位置特定部と、前記作業具を前記積込対象の上から前記積込対象の側方へ移動させる自動制御時に、前記作業具が前記積込対象の上方に位置し、かつ前記作業具の高さが前記積込対象の高さより低い場合に、前記作業機を上昇させる信号を出力する操作信号出力部とを備える。

【発明の効果】

【0007】

上記態様によれば、積込機械の制御装置は積込機械の自動制御において、バケットが積込対象である箱体の内壁に接触することを防ぐことができる。

【図面の簡単な説明】

【0008】

【図1】第一実施形態に係る積込機械の構成を示す概略図である。

【図2】第一実施形態に係る運転室の内部の構成を示す図である。

【図3】第一実施形態に係る制御装置の構成を示す概略ブロック図である。

【図4】第一実施形態に係る第一旋回における積込機械の動きの例を示す図である。

【図5】第一実施形態に係る第二旋回における積込機械の動きの例を示す図である。

【図6】第一実施形態に係るダンプ操作における積込機械の動きの例を示す図である。

【図7】第一実施形態に係る制御装置による第一旋回制御を示すフローチャートである。

【図8】第一実施形態に係る制御装置による第二旋回制御を示すフローチャートである。

【発明を実施するための形態】

【0009】

〈第一実施形態〉
以下、図面を参照しながら実施形態について詳しく説明する。

【0010】

《積込機械１００の構成》
図１は、第一実施形態に係る積込機械１００の構成を示す概略図である。
積込機械１００は、施工現場にて稼働し、土砂などの施工対象を掘削し、荷としてダンプトラックなどの積込対象Ｔのベッセルなど荷台に積み込む。積込機械１００の例としては、フェイスショベル、バックホウショベル、ロープショベルなどが挙げられる。また積込機械１００は電動駆動するものであってもよいし、油圧駆動するものであってもよい。第一実施形態に係る積込機械１００は、バックホウショベルである。積込機械１００は、走行体１１０、旋回体１２０、作業機１３０及び運転室１４０を備える。積込対象Ｔの例としては、ダンプトラック、ホッパなどが挙げられる。

【0011】

走行体１１０は、積込機械１００を走行可能に支持する。走行体１１０は、左右に設けられた２つの無限軌道１１１と、各無限軌道１１１を駆動するための２つの走行モータ１１２を備える。走行体１１０は、支持部の一例である。
旋回体１２０は、走行体１１０に旋回中心回りに旋回可能に支持される。
作業機１３０は、油圧により駆動する。作業機１３０は、旋回体１２０の前部に上下方向に駆動可能に支持される。
運転室１４０は、オペレータが搭乗し、積込機械１００の操作を行うためのスペースである。運転室１４０は、旋回体１２０の左前部に設けられる。
ここで、旋回体１２０のうち作業機１３０が取り付けられる部分を前部という。また、旋回体１２０について、前部を基準に、反対側の部分を後部、左側の部分を左部、右側の部分を右部という。

【0012】

《旋回体１２０の構成》
旋回体１２０は、エンジン１２１、油圧ポンプ１２２、コントロールバルブ１２３、旋回モータ１２４を備える。
エンジン１２１は、油圧ポンプ１２２を駆動する原動機である。エンジン１２１は、動力源の一例である。
油圧ポンプ１２２は、エンジン１２１により駆動される可変容量ポンプである。油圧ポンプ１２２は、コントロールバルブ１２３を介して各アクチュエータ（ブームシリンダ１３１Ｃ、アームシリンダ１３２Ｃ、バケットシリンダ１３３Ｃ、走行モータ１１２、及び旋回モータ１２４）に作動油を供給する。
コントロールバルブ１２３は、油圧ポンプ１２２から供給される作動油の流量を制御する。
旋回モータ１２４は、コントロールバルブ１２３を介して油圧ポンプ１２２から供給される作動油によって駆動し、旋回体１２０を旋回させる。

【0013】

《作業機１３０の構成》
作業機１３０は、ブーム１３１、アーム１３２、作業具としてのバケット１３３、ブームシリンダ１３１Ｃ、アームシリンダ１３２Ｃ、及びバケットシリンダ１３３Ｃを備える。作業具の他の例として、クラムバケット、チルトバケット、チルトローテートバケット、グラップル、リフティングマグネットなどの先端アタッチメントが挙げられる。

【0014】

ブーム１３１の基端部は、旋回体１２０にブームピンを介して回転可能に取り付けられる。なお、図１に示す積込機械１００においては、ブーム１３１が旋回体１２０の正面中央部分に設けられるが、これに限られず、ブーム１３１は左右方向にオフセットして取り付けられたものであってもよい。この場合、旋回体１２０の旋回中心は作業機１３０の動作平面上に位置しない。
アーム１３２は、ブーム１３１とバケット１３３とを連結する。アーム１３２の基端部は、ブーム１３１の先端部にアームピンを介して回転可能に取り付けられる。
バケット１３３は、アーム１３２の先端部にピンを介して回転可能に取り付けられる。バケット１３３を支持する部材として、ブーム１３１、アーム１３２がある。バケット１３３は、掘削した土砂を収容するための容器として機能する。バケット１３３は、開口が旋回体１２０側（後方）を向くように取り付けられる。つまり、バックホウショベルである積込機械１００は、バケット１３３を旋回体１２０の手前側に引き寄せることで掘削を行う。

【0015】

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

【0016】

《運転室１４０の構成》
図２は、第一実施形態に係る運転室１４０の内部の構成を示す図である。
運転室１４０内には、運転席１４１、操作端末１４２及び操作装置１４３が設けられる。操作端末１４２は、運転席１４１の近傍に設けられ、後述する制御装置１６０とのユーザインタフェースである。操作端末１４２は、例えばタッチパネルで構成された表示装置であり、オペレータが操作する操作部と、操作を受け付ける入力受付部があってもよい。また、表示装置には、エンジン水温計、燃料計の計測データなどが表示されている。また、操作端末１４２は、ＬＣＤなどの表示部を備えるものであってよい。前記タッチパネルは表示部の一例である。

【0017】

操作装置１４３は、オペレータの手動操作によって走行体１１０、旋回体１２０及び作業機１３０を駆動させるための装置である。操作装置１４３は、左操作レバー１４３ＬＯ、右操作レバー１４３ＲＯ、左フットペダル１４３ＬＦ、右フットペダル１４３ＲＦ、左走行レバー１４３ＬＴ、右走行レバー１４３ＲＴ、旋回ブレーキペダル１４３ＴＢ、開始スイッチ１４３ＳＷを備える。

【0018】

左操作レバー１４３ＬＯは、運転席１４１の左側に設けられる。右操作レバー１４３ＲＯは、運転席１４１の右側に設けられる。

【0019】

左操作レバー１４３ＬＯは、旋回体１２０の旋回動作、及び、アーム１３２の掘削／ダンプ動作を行うための操作機構である。具体的には、積込機械１００のオペレータが左操作レバー１４３ＬＯを前方に倒すと、アーム１３２がダンプ動作する。また、積込機械１００のオペレータが左操作レバー１４３ＬＯを後方に倒すと、アーム１３２が掘削動作する。また、積込機械１００のオペレータが左操作レバー１４３ＬＯを右方向に倒すと、旋回体１２０が右旋回する。また、積込機械１００のオペレータが左操作レバー１４３ＬＯを左方向に倒すと、旋回体１２０が左旋回する。なお、他の実施形態においては、左操作レバー１４３ＬＯを前後方向に倒した場合に旋回体１２０が右旋回又は左旋回し、左操作レバー１４３ＬＯが左右方向に倒した場合にアーム１３２が掘削動作又はダンプ動作してもよい。

【0020】

右操作レバー１４３ＲＯは、バケット１３３の掘削／ダンプ動作、及び、ブーム１３１の上げ／下げ動作を行うための操作機構である。具体的には、積込機械１００のオペレータが右操作レバー１４３ＲＯを前方に倒すと、ブーム１３１の下げ動作が実行される。また、積込機械１００のオペレータが右操作レバー１４３ＲＯを後方に倒すと、ブーム１３１の上げ動作が実行される。また、積込機械１００のオペレータが右操作レバー１４３ＲＯを右方向に倒すと、バケット１３３のダンプ動作が行われる。また、積込機械１００のオペレータが右操作レバー１４３ＲＯを左方向に倒すと、バケット１３３の掘削動作が行われる。なお、他の実施形態においては、右操作レバー１４３ＲＯを前後方向に倒した場合に、バケット１３３がダンプ動作又は掘削動作し、右操作レバー１４３ＲＯを左右方向に倒した場合にブーム１３１が上げ動作又は下げ動作してもよい。

【0021】

左フットペダル１４３ＬＦは、運転席１４１の前方の床面の左側に配置される。右フットペダル１４３ＲＦは、運転席１４１の前方の床面の右側に配置される。左走行レバー１４３ＬＴは、左フットペダル１４３ＬＦに軸支され、左走行レバー１４３ＬＴの傾斜と左フットペダル１４３ＬＦの押し下げが連動するように構成される。右走行レバー１４３ＲＴは、右フットペダル１４３ＲＦに軸支され、右走行レバー１４３ＲＴの傾斜と右フットペダル１４３ＲＦの押し下げが連動するように構成される。

【0022】

左フットペダル１４３ＬＦ及び左走行レバー１４３ＬＴは、走行体１１０の左側履帯の回転駆動に対応する。具体的には、積込機械１００のオペレータが左フットペダル１４３ＬＦ又は左走行レバー１４３ＬＴを前方に倒すと、左側履帯は前進方向に回転する。また、積込機械１００のオペレータが左フットペダル１４３ＬＦ又は左走行レバー１４３ＬＴを後方に倒すと、左側履帯は後進方向に回転する。

【0023】

右フットペダル１４３ＲＦ及び右走行レバー１４３ＲＴは、走行体１１０の右側履帯の回転駆動に対応する。具体的には、積込機械１００のオペレータが右フットペダル１４３ＲＦ又は右走行レバー１４３ＲＴを前方に倒すと、右側履帯は前進方向に回転する。また、積込機械１００のオペレータが右フットペダル１４３ＲＦ又は右走行レバー１４３ＲＴを後方に倒すと、右側履帯は後進方向に回転する。

【0024】

開始スイッチ１４３ＳＷは、例えば左操作レバー１４３ＬＯのハンドル部分に設けられる。なお、開始スイッチ１４３ＳＷは、運転席１４１に着座したオペレータの近傍に位置するように配置されればよい。開始スイッチ１４３ＳＷが押下されると、制御装置１６０に自動制御指示信号が出力される。制御装置１６０は、自動制御指示信号の入力を受け付けると、自動制御を開始する。

【0025】

自動制御は、所定の動作を実現するために積込機械１００が自律的に作業機１３０および旋回体１２０の駆動を制御することである。第１の実施形態における自動制御は、掘削対象の掘削によって積込対象Ｔの側方にバケット１３３が位置する状態から、ブーム１３１を上げながら積込対象Ｔを向く方位まで旋回する一連の動作である第一旋回と、積込によって積込対象Ｔの上にバケット１３３が位置する状態から、ブーム１３１を下げながら所定の方位まで旋回する一連の動作である第二旋回とを、積込機械１００が自律的に行う制御である。積込対象Ｔの側方とは、ベッセルなど荷を積み込む荷台の外側をいう。なお、他の実施形態に係る自動制御は、第二旋回のみを行うものであってもよい。第一実施形態においては、第一旋回および第二旋回における旋回体１２０の目標方位およびバケット１３３の目標姿勢は、それぞれ予め指定された方位および姿勢とする。なお、通常、掘削対象は積込対象Ｔの高さより低い位置となる。そのため、積込機械１００は、第一旋回および第二旋回において、積込対象Ｔと作業機１３０とが接触しないように作業機１３０の駆動を制御する。自動制御の詳細は後述する。
開始スイッチ１４３ＳＷの押下の度に実行される自動制御が第一旋回と第二旋回とで切り替わる。また、他の実施形態においては、操作装置１４３が２つの開始スイッチ１４３ＳＷを備え、それぞれに第一旋回と第二旋回とが割り当てられてもよい。

【0026】

《計測系の構成》
図１に示すように、積込機械１００は、位置方位演算器１５１、傾斜計測器１５２、ブームストロークセンサ１５３、アームストロークセンサ１５４、バケットストロークセンサ１５５を備える。

【0027】

位置方位演算器１５１は、旋回体１２０の位置及び旋回体１２０が向く方位を演算する。位置方位演算器１５１は、ＧＮＳＳを構成する人工衛星から測位信号を受信する２つの受信器を備える。２つの受信器は、それぞれ旋回体１２０の異なる位置に設置される。位置方位演算器１５１は、受信器が受信した測位信号に基づいて、現場座標系における旋回体１２０の代表点（ショベル座標系の原点）の位置を検出する。
位置方位演算器１５１は、２つの受信器が受信した各測位信号を用いて、一方の受信器の設置位置に対する他方の受信器の設置位置の関係として、旋回体１２０の向く方位を演算する。旋回体１２０が向く方位とは、旋回体１２０の正面に直交する方向である。旋回体１２０が向く方位は、作業機１３０のブーム１３１からバケット１３３へ伸びる直線の延在方向の水平成分に等しい。

【0028】

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

【0029】

ブームストロークセンサ１５３は、ブームシリンダ１３１Ｃに取り付けられ、ブームシリンダ１３１Ｃのシリンダ長を検出する。ブームシリンダ１３１Ｃのシリンダ長は、旋回体１２０に対するブーム１３１の相対角度に換算可能である。
アームストロークセンサ１５４は、アームシリンダ１３２Ｃに取り付けられ、アームシリンダ１３２Ｃのシリンダ長を検出する。アームシリンダ１３２Ｃのシリンダ長は、ブーム１３１に対するアーム１３２の相対角度に換算可能である。
バケットストロークセンサ１５５は、バケットシリンダ１３３Ｃに取り付けられ、バケットシリンダ１３３Ｃのシリンダ長を検出する。バケットシリンダ１３３Ｃのシリンダ長は、アーム１３２に対するバケット１３３の相対角度に換算可能である。
第一実施形態に係る積込機械１００は、ブームストロークセンサ１５３、アームストロークセンサ１５４、及びバケットストロークセンサ１５５を用いて作業機１３０の各リンク部品の角度を特定するが、他の実施形態においてはこれに限られない。例えば、他の実施形態においては、ストロークセンサに代えて、リンク部品の相対回転角を検出するポテンショメータを備えてもよいし、各リンク部品の対地角を検出する傾斜センサを備えてもよい。

【0030】

《制御装置１６０の構成》
図３は、第一実施形態に係る制御装置１６０の構成を示す概略ブロック図である。
積込機械１００は、制御装置１６０を備える。制御装置１６０は、操作端末１４２に実装されるものであってもよいし、操作端末１４２と別個に設けられ、操作端末１４２からの入出力を受け付けるものであってもよい。制御装置１６０は、操作装置１４３から操作信号を受信する。制御装置１６０は、受信した操作信号又は自動制御のために生成された操作信号をコントロールバルブ１２３に出力することで、作業機１３０、旋回体１２０及び走行体１１０を駆動させる。以下、操作装置１４３から受信した操作信号を手動操作信号ともよび、自動制御のために生成された操作信号を自動操作信号ともよぶ。なお、自動操作信号は、旋回体１２０および作業機１３０を駆動させる操作信号からなり、走行体１１０を駆動させる操作信号を含まない。自動制御中に、オペレータによる手動操作信号を受信した場合、制御装置１６０は自動制御を停止してもよい。

【0031】

制御装置１６０は、プロセッサ６１０、メインメモリ６３０、ストレージ６５０、インタフェース６７０を備えるコンピュータである。ストレージ６５０は、プログラムを記憶する。プロセッサ６１０は、プログラムをストレージ６５０から読み出してメインメモリ６３０に展開し、プログラムに従った処理を実行する。

【0032】

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

【0033】

プロセッサ６１０は、プログラムの実行により、計測データ取得部６１１、操作信号入力部６１２、作業機位置特定部６１３、基準特定部６１４、角度特定部６１５、移動制御部６１６、操作信号出力部６１７を備える。

【0034】

計測データ取得部６１１は、積込機械１００の計測系による計測データを取得する。具体的には、計測データ取得部６１１は、位置方位演算器１５１、傾斜計測器１５２、ブームストロークセンサ１５３、アームストロークセンサ１５４およびバケットストロークセンサ１５５から計測データを取得する。計測データ取得部６１１は、傾斜計測器１５２が計測した旋回体１２０の角速度を積分することで、旋回体１２０の角度を算出する。

【0035】

操作信号入力部６１２は、操作装置１４３からオペレータが手動で操作された操作信号の入力を受け付ける。操作信号には、ブーム１３１の上げ操作や下げ操作をする駆動信号、アーム１３２の上げ操作や下げ操作をする駆動信号、バケット１３３のダンプ操作や掘削操作をする駆動信号、旋回体１２０の右旋回操作や左旋回操作をする駆動信号、走行体１１０の走行操作をする駆動信号、ならびに積込機械１００の自動制御指示信号が含まれる。

【0036】

作業機位置特定部６１３は、計測データ取得部６１１が取得した計測データに基づいて、旋回体１２０を基準とする車体座標系におけるアーム１３２の先端Ｐの位置（図４）およびバケット１３３の最下点Ｑの位置（図４）を特定する。バケット１３３の最下点Ｑとは、バケット１３３の外形のうち地表面からの距離が最も短い点をいう。

【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】

１００…積込機械 １１０…走行体 １１１…無限軌道 １１２…走行モータ １２０…旋回体 １２１…エンジン １２２…油圧ポンプ １２３…コントロールバルブ １２４…旋回モータ １３０…作業機 １３１…ブーム １３１Ｃ…ブームシリンダ １３２…アーム １３２Ｃ…アームシリンダ １３３…バケット １３３Ｃ…バケットシリンダ １４０…運転室 １４１…運転席 １４２…操作端末 １４３…操作装置 １５１…位置方位演算器 １５２…傾斜計測器 １５３…ブームストロークセンサ １５４…アームストロークセンサ １５５…バケットストロークセンサ １６０…制御装置 ６１０…プロセッサ ６１１…計測データ取得部 ６１２…操作信号入力部 ６１３…作業機位置特定部 ６１４…基準特定部 ６１５…角度特定部 ６１６…移動制御部 ６１７…操作信号出力部 ６３０…メインメモリ ６５０…ストレージ ６７０…インタフェース Ｔ…積込対象

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】