特開2024-106574積込機械の制御装置、積込機械の制御方法および積込機械の制御システム
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】公開特許公報(A)
(11)【公開番号】P2024106574
(43)【公開日】2024-08-08
(54)【発明の名称】積込機械の制御装置、積込機械の制御方法および積込機械の制御システム
(51)【国際特許分類】
E02F 3/43 20060101AFI20240801BHJP
E02F 9/20 20060101ALI20240801BHJP
【ＦＩ】
E02F3/43 A
E02F9/20 Q
【審査請求】未請求
【請求項の数】8
【出願形態】ＯＬ
(21)【出願番号】P 2023010906
(22)【出願日】2023-01-27
(71)【出願人】
【識別番号】000001236
【氏名又は名称】株式会社小松製作所
(74)【代理人】
【識別番号】110001634
【氏名又は名称】弁理士法人志賀国際特許事務所
(72)【発明者】
【氏名】畠 一尋
(72)【発明者】
【氏名】西郷 雄祐
【テーマコード（参考）】
2D003
【Ｆターム（参考）】
2D003AA01
2D003AB02
2D003AB03
2D003AB04
2D003AC09
2D003BA03
2D003BB04
2D003BB07
2D003DA04
2D003DB04
2D003FA02
(57)【要約】
【課題】積込機械の制御装置は積込機械の自動制御中に、オペレータの操作に応じて積込機械を制御する。
【解決手段】操作信号入力部は、操作装置の操作に基づく前記複数のリンク部品それぞれの手動操作信号の入力を受け付ける。移動制御部は、複数のリンク部品それぞれの自動操作信号を生成する。出力判定部は、複数のリンク部品それぞれについて手動操作信号及び自動操作信号の何れを出力するかの判定を行う。このとき出力判定部は、複数のリンク部品の少なくとも１つについて、手動操作信号の操作量が所定の第一の閾値を超えた場合、少なくとも１つのリンク部品に係る手動操作信号を出力すると判定する。
【選択図】図１
【解決手段】操作信号入力部は、操作装置の操作に基づく前記複数のリンク部品それぞれの手動操作信号の入力を受け付ける。移動制御部は、複数のリンク部品それぞれの自動操作信号を生成する。出力判定部は、複数のリンク部品それぞれについて手動操作信号及び自動操作信号の何れを出力するかの判定を行う。このとき出力判定部は、複数のリンク部品の少なくとも１つについて、手動操作信号の操作量が所定の第一の閾値を超えた場合、少なくとも１つのリンク部品に係る手動操作信号を出力すると判定する。
【選択図】図１
【特許請求の範囲】
【請求項1】
旋回中心回りに旋回する旋回体と、前記旋回体を支持する支持部と、作業具を含む複数のリンク部品で構成され前記旋回体に取り付けられた作業機とを備える積込機械の制御装置であって、
操作装置の操作に基づく前記複数のリンク部品それぞれの手動操作信号の入力を受け付ける操作信号入力部と、
前記複数のリンク部品それぞれの自動操作信号を生成する移動制御部と、
前記複数のリンク部品それぞれについて前記手動操作信号及び前記自動操作信号の何れを出力するかの判定を行う出力判定部と、
前記判定の結果に基づいて、前記手動操作信号又は前記自動操作信号を出力する操作信号出力部と
を備え、
前記出力判定部は、前記複数のリンク部品の少なくとも１つについて、前記手動操作信号の操作量が所定の第一の閾値を超えた場合、前記少なくとも１つのリンク部品に係る前記手動操作信号を出力すると判定する
積込機械の制御装置。
操作装置の操作に基づく前記複数のリンク部品それぞれの手動操作信号の入力を受け付ける操作信号入力部と、
前記複数のリンク部品それぞれの自動操作信号を生成する移動制御部と、
前記複数のリンク部品それぞれについて前記手動操作信号及び前記自動操作信号の何れを出力するかの判定を行う出力判定部と、
前記判定の結果に基づいて、前記手動操作信号又は前記自動操作信号を出力する操作信号出力部と
を備え、
前記出力判定部は、前記複数のリンク部品の少なくとも１つについて、前記手動操作信号の操作量が所定の第一の閾値を超えた場合、前記少なくとも１つのリンク部品に係る前記手動操作信号を出力すると判定する
積込機械の制御装置。
【請求項2】
前記出力判定部は、前記複数のリンク部品の少なくとも１つについて、前記手動操作信号の操作方向と前記自動操作信号の操作方向とが互いに逆方向になった場合に、前記手動操作信号を出力すると判定する
請求項１に記載の積込機械の制御装置。
請求項１に記載の積込機械の制御装置。
【請求項3】
前記出力判定部は、前記複数のリンク部品の少なくとも１つについて、前記手動操作信号の操作量が所定の第二の閾値を超えた場合、前記複数のリンク部品すべてについて前記手動操作信号を出力すると判定する
請求項２に記載の積込機械の制御装置。
請求項２に記載の積込機械の制御装置。
【請求項4】
前記出力判定部は、前記複数のリンク部品の少なくとも１つについて、前記手動操作信号の操作方向と前記自動操作信号の操作方向とが同じであり、かつ前記手動操作信号の操作量が前記自動操作信号の操作量より大きくなった場合、前記少なくとも１つのリンク部品について前記手動操作信号を出力すると判定する
請求項１に記載の積込機械の制御装置。
請求項１に記載の積込機械の制御装置。
【請求項5】
前記移動制御部は、前記作業具を積込対象の上方から、上方からの平面視において前記積込対象から離れた目標位置まで自動的に移動させる自動制御を行うために前記複数のリンク部品及び前記旋回体の前記自動操作信号を生成し、
前記出力判定部は、前記自動制御において、前記複数のリンク部品の少なくとも１つについて前記手動操作信号の操作量が所定の第一の閾値を超えた場合、前記少なくとも１つのリンク部品に係る前記手動操作信号を出力すると判定する
請求項１から請求項４の何れか１項に記載の積込機械の制御装置。
前記出力判定部は、前記自動制御において、前記複数のリンク部品の少なくとも１つについて前記手動操作信号の操作量が所定の第一の閾値を超えた場合、前記少なくとも１つのリンク部品に係る前記手動操作信号を出力すると判定する
請求項１から請求項４の何れか１項に記載の積込機械の制御装置。
【請求項6】
前記出力判定部は、前記自動制御において前記作業具が前記積込対象の上方に位置する場合に、前記手動操作信号の有無にかかわらず前記自動操作信号を出力すると判定する
請求項５に記載の積込機械の制御装置。
請求項５に記載の積込機械の制御装置。
【請求項7】
旋回中心回りに旋回する旋回体と、前記旋回体を支持する支持部と、作業具を含む複数のリンク部品で構成され前記旋回体に取り付けられた作業機とを備える積込機械の制御方法であって、
操作装置の操作に基づく前記複数のリンク部品それぞれの手動操作信号の入力を受け付けるステップと、
前記複数のリンク部品それぞれの自動操作信号を生成するステップと、
前記複数のリンク部品それぞれについて前記手動操作信号及び前記自動操作信号の何れを出力するかの判定を行うステップと、
前記判定の結果に基づいて、前記手動操作信号又は前記自動操作信号を出力するステップと
を備え、
前記判定を行うステップでは、前記複数のリンク部品の少なくとも１つについて前記手動操作信号の操作量が所定の第一の閾値を超えた場合、前記少なくとも１つのリンク部品に係る前記手動操作信号を出力すると判定する
積込機械の制御方法。
操作装置の操作に基づく前記複数のリンク部品それぞれの手動操作信号の入力を受け付けるステップと、
前記複数のリンク部品それぞれの自動操作信号を生成するステップと、
前記複数のリンク部品それぞれについて前記手動操作信号及び前記自動操作信号の何れを出力するかの判定を行うステップと、
前記判定の結果に基づいて、前記手動操作信号又は前記自動操作信号を出力するステップと
を備え、
前記判定を行うステップでは、前記複数のリンク部品の少なくとも１つについて前記手動操作信号の操作量が所定の第一の閾値を超えた場合、前記少なくとも１つのリンク部品に係る前記手動操作信号を出力すると判定する
積込機械の制御方法。
【請求項8】
旋回中心回りに旋回する旋回体と、前記旋回体を支持する支持部と、作業具を含む複数のリンク部品で構成され前記旋回体に取り付けられた作業機とを備える積込機械の制御システムであって、
操作装置の操作に基づく前記複数のリンク部品それぞれの手動操作信号の入力を受け付ける操作信号入力部と、
前記複数のリンク部品それぞれの自動操作信号を生成する移動制御部と、
前記複数のリンク部品それぞれについて前記手動操作信号及び前記自動操作信号の何れを出力するかの判定を行う出力判定部と、
前記判定の結果に基づいて、前記手動操作信号又は前記自動操作信号を出力する操作信号出力部と
を備え、
前記出力判定部は、前記複数のリンク部品の少なくとも１つについて、前記手動操作信号の操作量が所定の第一の閾値を超えた場合、前記少なくとも１つのリンク部品に係る前記手動操作信号を出力すると判定する
積込機械の制御システム。
操作装置の操作に基づく前記複数のリンク部品それぞれの手動操作信号の入力を受け付ける操作信号入力部と、
前記複数のリンク部品それぞれの自動操作信号を生成する移動制御部と、
前記複数のリンク部品それぞれについて前記手動操作信号及び前記自動操作信号の何れを出力するかの判定を行う出力判定部と、
前記判定の結果に基づいて、前記手動操作信号又は前記自動操作信号を出力する操作信号出力部と
を備え、
前記出力判定部は、前記複数のリンク部品の少なくとも１つについて、前記手動操作信号の操作量が所定の第一の閾値を超えた場合、前記少なくとも１つのリンク部品に係る前記手動操作信号を出力すると判定する
積込機械の制御システム。
【発明の詳細な説明】
【技術分野】
【0001】
本開示は、積込機械の制御装置、積込機械の制御方法および積込機械の制御システムに関する。
【背景技術】
【0002】
特許文献１には、積込機械の自動制御に関する技術が開示されている。特許文献１に係る自動制御は、ダンプトラックなどの積込対象に対する積込完了後に、オペレータから掘削指示を受け付け、制御装置が積込機械の旋回及び作業機の駆動を制御することで、自動掘削を行う制御である。
【先行技術文献】
【特許文献】
【0003】
【特許文献1】特開２０２０－０４１３５２号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
ところで、自動制御による制御後のバケット（作業具）の位置と、オペレータが意図するバケットの位置とは、一致しない場合もある。このような場合に、オペレータは、所望の位置にバケットを移動させるために自動制御中に積込機械を操作する可能性がある。
【0005】
本開示の目的は、積込機械の自動制御中に、オペレータの操作に応じて積込機械を制御する積込機械の制御装置、積込機械の制御方法および積込機械の制御システムを提供することにある。
【課題を解決するための手段】
【0006】
本開示の一態様は、旋回中心回りに旋回する旋回体と、前記旋回体を支持する支持部と、作業具を含む複数のリンク部品で構成され前記旋回体に取り付けられた作業機とを備える積込機械の制御システムであって、操作装置の操作に基づく前記複数のリンク部品それぞれの手動操作信号の入力を受け付ける操作信号入力部と、前記複数のリンク部品それぞれの自動操作信号を生成する移動制御部と、前記複数のリンク部品それぞれについて前記手動操作信号及び前記自動操作信号の何れを出力するかの判定を行う出力判定部と、前記判定の結果に基づいて、前記手動操作信号又は前記自動操作信号を出力する操作信号出力部とを備え、前記出力判定部は、前記複数のリンク部品の少なくとも１つについて前記手動操作信号の操作方向と前記自動操作信号の操作方向とが互いに逆になった場合、前記複数のリンク部品すべてについて前記手動操作信号を出力すると判定する。
【発明の効果】
【0007】
上記態様によれば、積込機械の制御装置は積込機械の自動制御中に、オペレータの操作に応じて積込機械を制御することができる。
【図面の簡単な説明】
【0008】
【図1】第一実施形態に係る積込機械の構成を示す概略図である。
【図2】第一実施形態に係る運転室の内部の構成を示す図である。
【図3】第一実施形態に係る制御装置の構成を示す概略ブロック図である。
【図4】第一実施形態に係る第一旋回における積込機械の動きの例を示す図である。
【図5】第一実施形態に係る第二旋回における積込機械の動きの例を示す図である。
【図6】第一実施形態に係る制御装置の動作の一部を示すフローチャートである。
【図7】第一実施形態に係る制御装置の旋回制御を示すフローチャート（パート１）である。
【図8】第一実施形態に係る制御装置の旋回制御を示すフローチャート（パート２）である。
【図9】第一実施形態に係る制御装置の旋回制御を示すフローチャート（パート３）である。
【発明を実施するための形態】
【0009】
〈第一実施形態〉
以下、図面を参照しながら実施形態について詳しく説明する。
以下、図面を参照しながら実施形態について詳しく説明する。
【0010】
《積込機械１００の構成》
図１は、第一実施形態に係る積込機械１００の構成を示す概略図である。
積込機械１００は、施工現場にて稼働し、土砂などの施工対象を掘削し、ダンプトラックなどの積込対象Ｔに積み込む。積込機械１００の例としては、フェイスショベル、バックホウショベル、ロープショベルなどが挙げられる。また積込機械１００は電動駆動するものであってもよいし、油圧駆動するものであってもよい。第一実施形態に係る積込機械１００は、フェイスショベルである。積込機械１００は、走行体１１０、旋回体１２０、作業機１３０及び運転室１４０を備える。
図１は、第一実施形態に係る積込機械１００の構成を示す概略図である。
積込機械１００は、施工現場にて稼働し、土砂などの施工対象を掘削し、ダンプトラックなどの積込対象Ｔに積み込む。積込機械１００の例としては、フェイスショベル、バックホウショベル、ロープショベルなどが挙げられる。また積込機械１００は電動駆動するものであってもよいし、油圧駆動するものであってもよい。第一実施形態に係る積込機械１００は、フェイスショベルである。積込機械１００は、走行体１１０、旋回体１２０、作業機１３０及び運転室１４０を備える。
【0011】
走行体１１０は、積込機械１００を走行可能に支持する。走行体１１０は、左右に設けられた２つの無限軌道１１１と、各無限軌道１１１を駆動するための２つの走行モータ１１２を備える。走行体１１０は、支持部の一例である。
旋回体１２０は、走行体１１０に旋回中心回りに旋回可能に支持される。
作業機１３０は、油圧により駆動する。作業機１３０は、旋回体１２０の前部に上下方向に駆動可能に支持される。運転室１４０は、オペレータが搭乗し、積込機械１００の操作を行うためのスペースである。運転室１４０は、旋回体１２０の左前部に設けられる。
ここで、旋回体１２０のうち作業機１３０が取り付けられる部分を前部という。また、旋回体１２０について、前部を基準に、反対側の部分を後部、左側の部分を左部、右側の部分を右部という。
旋回体１２０は、走行体１１０に旋回中心回りに旋回可能に支持される。
作業機１３０は、油圧により駆動する。作業機１３０は、旋回体１２０の前部に上下方向に駆動可能に支持される。運転室１４０は、オペレータが搭乗し、積込機械１００の操作を行うためのスペースである。運転室１４０は、旋回体１２０の左前部に設けられる。
ここで、旋回体１２０のうち作業機１３０が取り付けられる部分を前部という。また、旋回体１２０について、前部を基準に、反対側の部分を後部、左側の部分を左部、右側の部分を右部という。
【0012】
《旋回体１２０の構成》
旋回体１２０は、エンジン１２１、油圧ポンプ１２２、コントロールバルブ１２３、旋回モータ１２４を備える。
エンジン１２１は、油圧ポンプ１２２を駆動する原動機である。エンジン１２１は、動力源の一例である。
油圧ポンプ１２２は、エンジン１２１により駆動される可変容量ポンプである。油圧ポンプ１２２は、コントロールバルブ１２３を介して各アクチュエータ（ブームシリンダ１３１Ｃ、スティックシリンダ１３２Ｃ、バケットシリンダ１３３Ｃ、クラムシリンダ１３３２Ｃ、走行モータ１１２、及び旋回モータ１２４）に作動油を供給する。
コントロールバルブ１２３は、油圧ポンプ１２２から供給される作動油の流量を制御する。
旋回モータ１２４は、コントロールバルブ１２３を介して油圧ポンプ１２２から供給される作動油によって駆動し、旋回体１２０を旋回させる。
旋回体１２０は、エンジン１２１、油圧ポンプ１２２、コントロールバルブ１２３、旋回モータ１２４を備える。
エンジン１２１は、油圧ポンプ１２２を駆動する原動機である。エンジン１２１は、動力源の一例である。
油圧ポンプ１２２は、エンジン１２１により駆動される可変容量ポンプである。油圧ポンプ１２２は、コントロールバルブ１２３を介して各アクチュエータ（ブームシリンダ１３１Ｃ、スティックシリンダ１３２Ｃ、バケットシリンダ１３３Ｃ、クラムシリンダ１３３２Ｃ、走行モータ１１２、及び旋回モータ１２４）に作動油を供給する。
コントロールバルブ１２３は、油圧ポンプ１２２から供給される作動油の流量を制御する。
旋回モータ１２４は、コントロールバルブ１２３を介して油圧ポンプ１２２から供給される作動油によって駆動し、旋回体１２０を旋回させる。
【0013】
《作業機１３０の構成》
作業機１３０は、ブーム１３１、スティック１３２、作業具としてのクラムバケット１３３、ブームシリンダ１３１Ｃ、スティックシリンダ１３２Ｃ、及びバケットシリンダ１３３Ｃを備える。作業具の一例として、バケット、チルトバケット、チルトローテートバケットなどが挙げられる。
作業機１３０は、ブーム１３１、スティック１３２、作業具としてのクラムバケット１３３、ブームシリンダ１３１Ｃ、スティックシリンダ１３２Ｃ、及びバケットシリンダ１３３Ｃを備える。作業具の一例として、バケット、チルトバケット、チルトローテートバケットなどが挙げられる。
【0014】
ブーム１３１の基端部は、旋回体１２０にブームピンを介して回転可能に取り付けられる。なお、図１に示す積込機械１００においては、ブーム１３１が旋回体１２０の正面中央部分に設けられるが、これに限られず、ブーム１３１は左右方向にオフセットして取り付けられたものであってもよい。この場合、旋回体１２０の旋回中心は作業機１３０の動作平面上に位置しない。
スティック１３２は、ブーム１３１とクラムバケット１３３とを連結する。スティック１３２の基端部は、ブーム１３１の先端部にスティックピンを介して回転可能に取り付けられる。
クラムバケット１３３は、スティック１３２の先端部にピンを介して回転可能に取り付けられるバックオール１３３１と、土砂などを掘削するための刃を有するクラムシェル１３３２と、バックオール１３３１とクラムシェル１３３２とを開閉するためのクラムシリンダ１３３２Ｃを有する。バックオール１３３１とクラムシェル１３３２とはピンを介して開閉可能に連結される。バックオール１３３１とクラムシェル１３３２とが閉じているとき、バックオール１３３１及びクラムシェル１３３２は、掘削した土砂を収容するための容器として機能する。他方、バックオール１３３１とクラムシェル１３３２とが開くことで、収容した土砂を排土することができる。クラムシリンダ１３３２Ｃの基端部は、バックオール１３３１に取り付けられる。クラムシリンダ１３３２Ｃの先端部は、クラムシェル１３３２に取り付けられる。クラムバケット１３３は、開口が旋回体１２０の前方を向くように取り付けられる。すなわち、掘削時に、クラムバケット１３３の開口と旋回体１２０とはほぼ同じ方向を向く。
ブーム１３１、スティック１３２およびクラムバケット１３３は、複数のリンク部品の一例である。
スティック１３２は、ブーム１３１とクラムバケット１３３とを連結する。スティック１３２の基端部は、ブーム１３１の先端部にスティックピンを介して回転可能に取り付けられる。
クラムバケット１３３は、スティック１３２の先端部にピンを介して回転可能に取り付けられるバックオール１３３１と、土砂などを掘削するための刃を有するクラムシェル１３３２と、バックオール１３３１とクラムシェル１３３２とを開閉するためのクラムシリンダ１３３２Ｃを有する。バックオール１３３１とクラムシェル１３３２とはピンを介して開閉可能に連結される。バックオール１３３１とクラムシェル１３３２とが閉じているとき、バックオール１３３１及びクラムシェル１３３２は、掘削した土砂を収容するための容器として機能する。他方、バックオール１３３１とクラムシェル１３３２とが開くことで、収容した土砂を排土することができる。クラムシリンダ１３３２Ｃの基端部は、バックオール１３３１に取り付けられる。クラムシリンダ１３３２Ｃの先端部は、クラムシェル１３３２に取り付けられる。クラムバケット１３３は、開口が旋回体１２０の前方を向くように取り付けられる。すなわち、掘削時に、クラムバケット１３３の開口と旋回体１２０とはほぼ同じ方向を向く。
ブーム１３１、スティック１３２およびクラムバケット１３３は、複数のリンク部品の一例である。
【0015】
ブームシリンダ１３１Ｃは、ブーム１３１を作動させるための油圧シリンダである。ブームシリンダ１３１Ｃの基端部は、旋回体１２０に取り付けられる。ブームシリンダ１３１Ｃの先端部は、ブーム１３１に取り付けられる。
スティックシリンダ１３２Ｃは、スティック１３２を駆動するための油圧シリンダである。スティックシリンダ１３２Ｃの基端部は、ブーム１３１に取り付けられる。スティックシリンダ１３２Ｃの先端部は、スティック１３２に取り付けられる。
バケットシリンダ１３３Ｃは、クラムバケット１３３を駆動するための油圧シリンダである。バケットシリンダ１３３Ｃの基端部は、ブーム１３１に取り付けられる。バケットシリンダ１３３Ｃの先端部は、バックオール１３３１に接続されるリンク部材に取り付けられる。
スティックシリンダ１３２Ｃは、スティック１３２を駆動するための油圧シリンダである。スティックシリンダ１３２Ｃの基端部は、ブーム１３１に取り付けられる。スティックシリンダ１３２Ｃの先端部は、スティック１３２に取り付けられる。
バケットシリンダ１３３Ｃは、クラムバケット１３３を駆動するための油圧シリンダである。バケットシリンダ１３３Ｃの基端部は、ブーム１３１に取り付けられる。バケットシリンダ１３３Ｃの先端部は、バックオール１３３１に接続されるリンク部材に取り付けられる。
【0016】
《運転室１４０の構成》
図２は、第一実施形態に係る運転室１４０の内部の構成を示す図である。
運転室１４０内には、運転席１４１、操作端末１４２及び操作装置１４３が設けられる。操作端末１４２は、運転席１４１の近傍に設けられ、後述する制御装置１６０とのユーザインタフェースである。操作端末１４２は、例えばタッチパネルで構成された表示装置であり、オペレータが操作する操作部と、操作を受け付ける入力受付部があってもよい。また、表示装置には、エンジン水温計、燃料計の計測データなどが表示されている。また、操作端末１４２は、ＬＣＤなどの表示部を備えるものであってよい。前記タッチパネルは表示部の一例である。
図２は、第一実施形態に係る運転室１４０の内部の構成を示す図である。
運転室１４０内には、運転席１４１、操作端末１４２及び操作装置１４３が設けられる。操作端末１４２は、運転席１４１の近傍に設けられ、後述する制御装置１６０とのユーザインタフェースである。操作端末１４２は、例えばタッチパネルで構成された表示装置であり、オペレータが操作する操作部と、操作を受け付ける入力受付部があってもよい。また、表示装置には、エンジン水温計、燃料計の計測データなどが表示されている。また、操作端末１４２は、ＬＣＤなどの表示部を備えるものであってよい。前記タッチパネルは表示部の一例である。
【0017】
操作装置１４３は、オペレータの手動操作によって走行体１１０、旋回体１２０及び作業機１３０を駆動させるための装置である。操作装置１４３は、左操作レバー１４３ＬＯ、右操作レバー１４３ＲＯ、左フットペダル１４３ＬＦ、右フットペダル１４３ＲＦ、左走行レバー１４３ＬＴ、右走行レバー１４３ＲＴ、クラムオープンペダル１４３ＣＯ、クラムクローズペダル１４３ＣＣ、旋回ブレーキペダル１４３ＴＢ、開始スイッチ１４３ＳＷを備える。
【0018】
左操作レバー１４３ＬＯは、運転席１４１の左側に設けられる。右操作レバー１４３ＲＯは、運転席１４１の右側に設けられる。
【0019】
左操作レバー１４３ＬＯは、旋回体１２０の旋回転作、及び、スティック１３２の掘削／ダンプ動作を行うための操作機構である。具体的には、積込機械１００のオペレータが左操作レバー１４３ＬＯを前方に倒すと、スティック１３２がダンプ動作する。また、積込機械１００のオペレータが左操作レバー１４３ＬＯを後方に倒すと、スティック１３２が掘削動作する。また、積込機械１００のオペレータが左操作レバー１４３ＬＯを右方向に倒すと、旋回体１２０が右旋回する。また、積込機械１００のオペレータが左操作レバー１４３ＬＯを左方向に倒すと、旋回体１２０が左旋回する。なお、他の実施形態においては、左操作レバー１４３ＬＯを前後方向に倒した場合に旋回体１２０が右旋回又は左旋回し、左操作レバー１４３ＬＯが左右方向に倒した場合にスティック１３２が掘削動作又はダンプ動作してもよい。
【0020】
右操作レバー１４３ＲＯは、クラムバケット１３３の掘削／ダンプ動作、及び、ブーム１３１の上げ／下げ動作を行うための操作機構である。具体的には、積込機械１００のオペレータが右操作レバー１４３ＲＯを前方に倒すと、ブーム１３１の下げ動作が実行される。また、積込機械１００のオペレータが右操作レバー１４３ＲＯを後方に倒すと、ブーム１３１の上げ動作が実行される。また、積込機械１００のオペレータが右操作レバー１４３ＲＯを右方向に倒すと、クラムバケット１３３のダンプ動作が行われる。また、積込機械１００のオペレータが右操作レバー１４３ＲＯを左方向に倒すと、クラムバケット１３３の掘削動作が行われる。なお、他の実施形態においては、右操作レバー１４３ＲＯを前後方向に倒した場合に、クラムバケット１３３がダンプ動作又は掘削動作し、右操作レバー１４３ＲＯを左右方向に倒した場合にブーム１３１が上げ動作又は下げ動作してもよい。
【0021】
左フットペダル１４３ＬＦは、運転席１４１の前方の床面の左側に配置される。右フットペダル１４３ＲＦは、運転席１４１の前方の床面の右側に配置される。左走行レバー１４３ＬＴは、左フットペダル１４３ＬＦに軸支され、左走行レバー１４３ＬＴの傾斜と左フットペダル１４３ＬＦの押し下げが連動するように構成される。右走行レバー１４３ＲＴは、右フットペダル１４３ＲＦに軸支され、右走行レバー１４３ＲＴの傾斜と右フットペダル１４３ＲＦの押し下げが連動するように構成される。
【0022】
左フットペダル１４３ＬＦ及び左走行レバー１４３ＬＴは、走行体１１０の左側履帯の回転駆動に対応する。具体的には、積込機械１００のオペレータが左フットペダル１４３ＬＦ又は左走行レバー１４３ＬＴを前方に倒すと、左側履帯は前進方向に回転する。また、積込機械１００のオペレータが左フットペダル１４３ＬＦ又は左走行レバー１４３ＬＴを後方に倒すと、左側履帯は後進方向に回転する。
【0023】
右フットペダル１４３ＲＦ及び右走行レバー１４３ＲＴは、走行体１１０の右側履帯の回転駆動に対応する。具体的には、積込機械１００のオペレータが右フットペダル１４３ＲＦ又は右走行レバー１４３ＲＴを前方に倒すと、右側履帯は前進方向に回転する。また、積込機械１００のオペレータが右フットペダル１４３ＲＦ又は右走行レバー１４３ＲＴを後方に倒すと、右側履帯は後進方向に回転する。
【0024】
クラムオープンペダル１４３ＣＯ及びクラムクローズペダル１４３ＣＣは、左フットペダル１４３ＬＦの左側に配置される。クラムオープンペダル１４３ＣＯはクラムクローズペダル１４３ＣＣの右隣に配置される。クラムオープンペダル１４３ＣＯが押し下げられると、クラムバケット１３３が押し下げ量に応じた速度で開く。クラムクローズペダル１４３ＣＣが押し下げられると、クラムバケット１３３が押し下げ量に応じた速度で閉じる。
【0025】
旋回ブレーキペダル１４３ＴＢは、右フットペダル１４３ＲＦの右側に配置される。旋回ブレーキペダル１４３ＴＢが押し下げられると、コントロールバルブ１２３と旋回モータ１２４とを結ぶ油圧回路のリリーフ圧を増大させる。具体的には、旋回ブレーキペダル１４３ＴＢが押し下げられたときに、コントロールバルブ１２３と旋回モータ１２４とを結ぶ油圧回路に設けられた可変リリーフバルブのソレノイドを励磁することで、可変リリーフバルブのリリーフ圧を増大させる。これにより、旋回に係るブレーキ力を増加させることができる。
【0026】
開始スイッチ１４３ＳＷは、例えば左操作レバー１４３ＬＯのハンドル部分に設けられる。なお、開始スイッチ１４３ＳＷは、運転席１４１に着座したオペレータの近傍に位置するように配置されればよい。開始スイッチ１４３ＳＷが押下されると、制御装置１６０に自動制御指示信号が出力される。制御装置１６０は、自動制御指示信号の入力を受け付けると、自動制御を開始する。
【0027】
自動制御は、所定の動作を実現するために積込機械１００が自律的に作業機１３０および旋回体１２０の駆動を制御することである。第１の実施形態における自動制御は、掘削した土砂を積み込むためにブーム１３１を上げながら旋回体１２０が積込対象Ｔを向くまで旋回し、積込対象Ｔの上方でクラムバケット１３３を開き、その後、次の掘削のためにブーム１３１を下げながら所定の方位まで旋回する一連の動作を、積込機械１００が自律的に行う制御である。なお、他の実施形態に係る自動制御は、掘削した土砂を積み込む動作を行わないものであってもよい。例えば、他の実施形態に係る自動制御は、積込対象Ｔの上方に位置するクラムバケット１３３を、次の掘削のために所定の位置まで下ろす動作を自律的に行う制御であってもよい。この場合、掘削した土砂を積み込む動作はオペレータの手動操作で行ってよい。以下、開始スイッチ１４３ＳＷが押下されたときに旋回体１２０が向く方位（初期方位）から積込対象Ｔを向く方位までの旋回を「第一旋回」とよび、積込対象Ｔを向く方位から初期方位までの旋回を「第二旋回」とよぶ。第一実施形態においては、初期方位を、第二旋回における目標方位とする。なお、他の実施形態においては、これに限られず、オペレータによって予め指定された方位を第二旋回における目標方位として設定してもよい。また、自動制御では、第一旋回および第二旋回の終了時の作業機１３０の姿勢が所定の目標姿勢となるように、作業機１３０を駆動させる。第一旋回における目標姿勢は、クラムバケット１３３が積込対象Ｔの上方に位置し、かつクラムバケット１３３の開口が上を向く姿勢である。第二旋回における目標姿勢は、クラムバケット１３３が掘削対象の近傍に位置し、かつクラムバケット１３３の開口が前を向く掘削準備姿勢である。なお、他の実施形態においては、第二旋回における目標姿勢は、開始スイッチ１４３ＳＷが押下されたときの作業機１３０の姿勢（初期姿勢）であってもよいし、またはあらかじめ決められた姿勢でもよい。なお、通常、掘削対象は積込対象Ｔの高さより低い位置となる。そのため、積込機械１００は、第一旋回および第二旋回において、積込対象Ｔと作業機１３０とが接触しないように作業機１３０の駆動を制御する。自動制御の詳細は後述する。
【0028】
《計測系の構成》
図１に示すように、積込機械１００は、位置方位演算器１５１、傾斜計測器１５２、ブーム角度センサ１５３、スティック角度センサ１５４、バケット角度センサ１５５、検出装置１５６を備える。
図１に示すように、積込機械１００は、位置方位演算器１５１、傾斜計測器１５２、ブーム角度センサ１５３、スティック角度センサ１５４、バケット角度センサ１５５、検出装置１５６を備える。
【0029】
位置方位演算器１５１は、旋回体１２０の位置及び旋回体１２０が向く方位を演算する。位置方位演算器１５１は、ＧＮＳＳを構成する人工衛星から測位信号を受信する２つの受信器を備える。２つの受信器は、それぞれ旋回体１２０の異なる位置に設置される。位置方位演算器１５１は、受信器が受信した測位信号に基づいて、現場座標系における旋回体１２０の代表点（ショベル座標系の原点）の位置を検出する。
位置方位演算器１５１は、２つの受信器が受信した各測位信号を用いて、一方の受信器の設置位置に対する他方の受信器の設置位置の関係として、旋回体１２０の向く方位を演算する。旋回体１２０が向く方位とは、旋回体１２０の正面に直交する方向であって、作業機１３０のブーム１３１からクラムバケット１３３へ伸びる直線の延在方向の水平成分に等しい。
位置方位演算器１５１は、２つの受信器が受信した各測位信号を用いて、一方の受信器の設置位置に対する他方の受信器の設置位置の関係として、旋回体１２０の向く方位を演算する。旋回体１２０が向く方位とは、旋回体１２０の正面に直交する方向であって、作業機１３０のブーム１３１からクラムバケット１３３へ伸びる直線の延在方向の水平成分に等しい。
【0030】
傾斜計測器１５２は、旋回体１２０の加速度及び角速度を計測し、計測結果に基づいて旋回体１２０の姿勢（例えば、ロール角、ピッチ角、ヨー角）および旋回速度を検出する。傾斜計測器１５２は、例えば旋回体１２０の下面に設置される。傾斜計測器１５２は、例えば、慣性計測装置（ＩＭＵ：Inertial Measurement Unit）を用いることができる。
【0031】
ブーム角度センサ１５３は、ブーム１３１に取り付けられ、ブーム１３１の傾斜角を検出する。
スティック角度センサ１５４は、スティック１３２に取り付けられ、スティック１３２の傾斜角を検出する。
バケット角度センサ１５５は、クラムバケット１３３のバックオール１３３１に取り付けられ、クラムバケット１３３の傾斜角を検出する。
第一実施形態に係るブーム角度センサ１５３、スティック角度センサ１５４、及びバケット角度センサ１５５は、地平面に対する傾斜角を検出する。なお、他の実施形態に係る角度センサはこれに限られず、他の基準面に対する傾斜角を検出してもよい。例えば、他の実施形態においては、角度センサは、ブーム１３１、スティック１３２及びクラムバケット１３３の基端部に設けられたポテンショメータによって相対回転角を検出してもよいし、ブームシリンダ１３１Ｃ、スティックシリンダ１３２Ｃ及びバケットシリンダ１３３Ｃのシリンダ長さを計測し、シリンダ長さを角度に変換することで傾斜角を検出するものであってもよい。
スティック角度センサ１５４は、スティック１３２に取り付けられ、スティック１３２の傾斜角を検出する。
バケット角度センサ１５５は、クラムバケット１３３のバックオール１３３１に取り付けられ、クラムバケット１３３の傾斜角を検出する。
第一実施形態に係るブーム角度センサ１５３、スティック角度センサ１５４、及びバケット角度センサ１５５は、地平面に対する傾斜角を検出する。なお、他の実施形態に係る角度センサはこれに限られず、他の基準面に対する傾斜角を検出してもよい。例えば、他の実施形態においては、角度センサは、ブーム１３１、スティック１３２及びクラムバケット１３３の基端部に設けられたポテンショメータによって相対回転角を検出してもよいし、ブームシリンダ１３１Ｃ、スティックシリンダ１３２Ｃ及びバケットシリンダ１３３Ｃのシリンダ長さを計測し、シリンダ長さを角度に変換することで傾斜角を検出するものであってもよい。
【0032】
検出装置１５６は、積込機械１００の周囲に存在する物体の三次元位置を検出する。検出装置１５６の例としては、ステレオカメラ、レーザスキャナ、ＵＷＢ（Ultra Wide Band）測距装置などが挙げられる。検出装置１５６は、例えば運転室１４０の上部に、検出方向が前方を向くように設けられる。なお、検出装置１５６は、積込機械１００の周囲を撮像可能であれば、どこに設けられてもよい。例えば、運転室１４０外の旋回体１２０の側壁等に設けられていてもよい。また検出方向は前方を向かなくてもよい。検出装置１５６は、物体の三次元位置を、検出装置１５６の位置を基準とした座標系で特定する。なお、他の実施形態に係る積込機械１００は、複数の検出装置１５６を備えてもよい。
【0033】
《制御装置１６０の構成》
図３は、第一実施形態に係る制御装置１６０の構成を示す概略ブロック図である。
積込機械１００は、制御装置１６０を備える。制御装置１６０は、操作端末１４２に実装されるものであってもよいし、操作端末１４２と別個に設けられ、操作端末１４２からの入出力を受け付けるものであってもよい。制御装置１６０は、操作装置１４３から操作信号を受信する。制御装置１６０は、受信した操作信号又は自動制御のために生成された操作信号をコントロールバルブ１２３に出力することで、作業機１３０、旋回体１２０及び走行体１１０を駆動させる。以下、操作装置１４３から受信した操作信号を手動操作信号ともよび、自動制御のために生成された操作信号を自動操作信号ともよぶ。なお、自動操作信号は、旋回体１２０および作業機１３０を駆動させる操作信号からなり、走行体１１０を駆動させる操作信号を含まない。
図３は、第一実施形態に係る制御装置１６０の構成を示す概略ブロック図である。
積込機械１００は、制御装置１６０を備える。制御装置１６０は、操作端末１４２に実装されるものであってもよいし、操作端末１４２と別個に設けられ、操作端末１４２からの入出力を受け付けるものであってもよい。制御装置１６０は、操作装置１４３から操作信号を受信する。制御装置１６０は、受信した操作信号又は自動制御のために生成された操作信号をコントロールバルブ１２３に出力することで、作業機１３０、旋回体１２０及び走行体１１０を駆動させる。以下、操作装置１４３から受信した操作信号を手動操作信号ともよび、自動制御のために生成された操作信号を自動操作信号ともよぶ。なお、自動操作信号は、旋回体１２０および作業機１３０を駆動させる操作信号からなり、走行体１１０を駆動させる操作信号を含まない。
【0034】
制御装置１６０は、プロセッサ６１０、メインメモリ６３０、ストレージ６５０、インタフェース６７０を備えるコンピュータである。ストレージ６５０は、プログラムを記憶する。プロセッサ６１０は、プログラムをストレージ６５０から読み出してメインメモリ６３０に展開し、プログラムに従った処理を実行する。
【0035】
ストレージ６５０の例としては、半導体メモリ、磁気ディスク、光磁気ディスク、光ディスク等が挙げられる。ストレージ６５０は、制御装置１６０の共通通信線に直接接続された内部メディアであってもよいし、インタフェース６７０を介して制御装置１６０に接続される外部メディアであってもよい。メインメモリ６３０及びストレージ６５０は、一時的でない有形の記憶媒体である。
【0036】
プロセッサ６１０は、プログラムの実行により、計測データ取得部６１１、マップ生成部６１２、操作信号入力部６１３、作業機位置特定部６１４、積込対象特定部６１５、旋回角度特定部６１６、回避角度特定部６１７、目標姿勢決定部６１８、移動制御部６１９、クラム制御部６２０、出力判定部６２１、操作信号出力部６２２を備える。
【0037】
計測データ取得部６１１は、積込機械１００の計測系による計測データを取得する。具体的には、計測データ取得部６１１は、位置方位演算器１５１、傾斜計測器１５２、ブーム角度センサ１５３、スティック角度センサ１５４、バケット角度センサ１５５、及び検出装置１５６から計測データを取得する。計測データ取得部６１１は、傾斜計測器１５２が計測した旋回体１２０の角速度を積分することで、旋回体１２０の角度を算出する。
【0038】
マップ生成部６１２は、検出装置１５６から取得した計測データを用いて積込機械１００の周囲を表すマップデータを生成する。マップ生成部６１２は、例えばＳＬＡＭ（Simultaneous Localization and Mapping）技術によってマップデータを生成する。マップデータは、車体座標系で表される。車体座標系は、旋回体１２０の旋回中心を原点とし、前後方向に伸びる軸、左右方向に伸びる軸、上下方向に伸びる軸で表される直交座標系である。検出装置１５６は、旋回体１２０に固定されているため、マップ生成部６１２は、ＳＬＡＭの計算結果を、旋回中心と検出装置１５６との位置関係に基づいて平行移動させることで、車体座標系のマップデータを生成することができる。マップ生成部６１２が生成したマップデータは、メインメモリ６３０に記録される。
【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】
《作用・効果》
このように、第一実施形態に係る制御装置１６０は、複数のリンク部品の少なくとも１つについて手動操作信号の操作方向と自動操作信号の操作方向とが互いに逆方向になり、かつ手動操作信号の操作量の絶対値が最大操作量を判定する第二の閾値を超えた場合、複数のリンク部品すべてについて手動操作信号を出力する。自動操作信号の操作方向と逆向き、かつ操作量の絶対値が最大操作量を判定する第二の閾値を超える手動操作は、オペレータによる接触回避操作である可能性が高い。そのため、制御装置１６０は、接触回避操作以降、複数のリンク部品のすべてを手動操作に切り替えることで、自動操作による作業機１３０の下降によって接触が生じることを防ぐことができる。つまり、第一実施形態に係る制御装置１６０は、積込機械１００の自動制御中に、オペレータの操作の意図に応じて積込機械１００を制御することができる。
このように、第一実施形態に係る制御装置１６０は、複数のリンク部品の少なくとも１つについて手動操作信号の操作方向と自動操作信号の操作方向とが互いに逆方向になり、かつ手動操作信号の操作量の絶対値が最大操作量を判定する第二の閾値を超えた場合、複数のリンク部品すべてについて手動操作信号を出力する。自動操作信号の操作方向と逆向き、かつ操作量の絶対値が最大操作量を判定する第二の閾値を超える手動操作は、オペレータによる接触回避操作である可能性が高い。そのため、制御装置１６０は、接触回避操作以降、複数のリンク部品のすべてを手動操作に切り替えることで、自動操作による作業機１３０の下降によって接触が生じることを防ぐことができる。つまり、第一実施形態に係る制御装置１６０は、積込機械１００の自動制御中に、オペレータの操作の意図に応じて積込機械１００を制御することができる。
【0087】
また、第一実施形態に係る制御装置１６０は、複数のリンク部品の少なくとも１つについて、手動操作信号の操作量が最大操作量を判定する第二の閾値を超えずに、手動操作信号の操作方向と自動操作信号の操作方向とが互いに逆方向になったとき、かつ操作量が第一の閾値を超えた場合、当該リンク部品について手動操作信号を出力する。また、制御装置１６０は、手動操作信号の操作方向と自動操作信号の操作方向とが同じであり、かつ手動操作信号の操作量が自動操作信号の操作量より大きくなった場合、当該リンク部品について手動操作信号を出力する。
最大操作量に至らない程度に、自動操作信号の操作方向と逆方向に操作される手動操作は、オペレータが下降速度を低下させるためになされた操作である可能性が高い。また、自動操作信号の操作方向と同じ方向に、かつ自動操作より大きい操作量でなされる手動操作は、オペレータが下降速度を増加させるためになされた操作である可能性が高い。そのため、制御装置１６０は、このような操作がなされた場合、操作されたリンク部品について手動操作に切り替えることで、対象のリンク部品についてオペレータの意図に応じた駆動を実現することができる。なお、第一実施形態では、自動操作信号の操作方向と同じ方向に、かつ自動操作より大きい操作量でなされる手動操作が入力された場合に、操作されたリンク部品について手動操作に切り替えるが、これに限られない。例えば、他の実施形態においては、自動操作信号の操作方向と同じ方向に第一閾値を超える操作量でなされる手動操作が入力された場合に、当該操作量が自動操作より大きいか否かに関わらず、操作されたリンク部品について手動操作に切り替えてもよい。
最大操作量に至らない程度に、自動操作信号の操作方向と逆方向に操作される手動操作は、オペレータが下降速度を低下させるためになされた操作である可能性が高い。また、自動操作信号の操作方向と同じ方向に、かつ自動操作より大きい操作量でなされる手動操作は、オペレータが下降速度を増加させるためになされた操作である可能性が高い。そのため、制御装置１６０は、このような操作がなされた場合、操作されたリンク部品について手動操作に切り替えることで、対象のリンク部品についてオペレータの意図に応じた駆動を実現することができる。なお、第一実施形態では、自動操作信号の操作方向と同じ方向に、かつ自動操作より大きい操作量でなされる手動操作が入力された場合に、操作されたリンク部品について手動操作に切り替えるが、これに限られない。例えば、他の実施形態においては、自動操作信号の操作方向と同じ方向に第一閾値を超える操作量でなされる手動操作が入力された場合に、当該操作量が自動操作より大きいか否かに関わらず、操作されたリンク部品について手動操作に切り替えてもよい。
【0088】
さらに、第一実施形態に係る制御装置１６０は、このような操作がなされたときに、操作されていない他のリンク部品について手動操作に切り替えない。これにより、制御装置１６０は、他のリンク部品に係る自動操作を妨げることなく、対象のリンク部品についてオペレータの意図に応じた駆動を実現することができる。例えば、作業機についてオペレータの操作があった場合にすべてのリンク部品を手動操作に切り替える場合、オペレータによる他のリンク部品についての操作が遅れると、その分時間のロスが生じ、作業効率が低下する可能性がある。これに対し、第一実施形態のように他のリンク部品について自動操作から手動操作に切り替えないことで、オペレータによる他のリンク部品についての操作が遅れたとしても、他のリンク部品については自動操作がなされるため、時間のロスが生じず、作業効率が低下しない。
【0089】
第一実施形態に係る制御装置１６０は、第二旋回に係る自動制御において、自動操作と手動操作の切替を行う。これは、第二旋回は、次の自動制御によって定められる掘削開始位置がオペレータの意図する位置と異なる可能性が高く、また作業機１３０を下降させる操作であるために障害物との接触のリスクが存在するためである。他方、他の実施形態においては、第一旋回においても、同様に自動操作信号の操作方向と逆方向に操作される手動操作が最大操作量でなされた場合に、すべてのリンク部品について動作を停止させてもよい。ただし、第一旋回においては、積込対象Ｔとの接触を防ぐために、制御装置１６０は、作業機１３０の駆動に加え、旋回体１２０の駆動も停止させるのが好ましい場合がある。このとき、制御装置１６０は、旋回体１２０の駆動が停止した後にすべてのリンク部品の駆動を停止させてもよい。
【0090】
第一実施形態に係る制御装置１６０は、クラムバケット１３３が積込対象Ｔの上方に位置する場合には、手動操作信号の有無にかかわらず自動操作信号を出力する。すなわち、クラムバケット１３３が積込対象Ｔの上方に位置する場合には、リンク部品を下降させる手動操作信号が入力されても自動操作信号を出力し続ける。これにより、クラムバケット１３３が積込対象Ｔの上方に位置する間に作業機１３０が下降してクラムバケット１３３と積込対象Ｔとが接触することを防ぐことができる。
【0091】
〈他の実施形態〉
以上、図面を参照して一実施形態について詳しく説明してきたが、具体的な構成は上述のものに限られることはなく、様々な設計変更等をすることが可能である。すなわち、他の実施形態においては、上述の処理の順序が適宜変更されてもよい。また、一部の処理が並列に実行されてもよい。
以上、図面を参照して一実施形態について詳しく説明してきたが、具体的な構成は上述のものに限られることはなく、様々な設計変更等をすることが可能である。すなわち、他の実施形態においては、上述の処理の順序が適宜変更されてもよい。また、一部の処理が並列に実行されてもよい。
【0092】
上述した実施形態に係る制御装置１６０は、単独のコンピュータによって構成されるものであってもよいし、制御装置１６０の構成を複数のコンピュータに分けて配置し、複数のコンピュータが互いに協働することで制御装置１６０として機能するものであってもよい。このとき、制御装置１６０を構成する一部のコンピュータが積込機械１００の内部に搭載され、他のコンピュータが積込機械１００の外部に設けられてもよい。
【0093】
上述した実施形態に係る目標姿勢は、予め設定されてメインメモリ６３０又はストレージ６５０に記録されるが、これに限られない。例えば、他の実施形態に係る積込機械１００は、操作端末１４２の操作によって目標姿勢を変更可能に構成してもよい。例えば、他の実施形態に係る積込機械１００は、操作端末１４２にブーム１３１、スティック１３２及びクラムバケット１３３の位置及び角度を表す数値を入力することで目標姿勢を変更してもよい。また他の実施形態に係る積込機械１００は、オペレータの操作によって作業機１３０を好ましい姿勢に制御した後、操作端末１４２を操作することで、作業機位置特定部６１４が作業機１３０の姿勢を特定し、目標姿勢を当該姿勢で上書きしてもよい。
【0094】
上述した実施形態に係る制御装置１６０は、検出装置１５６の計測データに基づくＳＬＡＭのマップデータに基づいて積込対象を特定するが、これに限られない。例えば、他の実施形態に係る制御装置１６０は、積込対象の緯度、経度及び向く方位の入力を受け付け、位置方位演算器１５１の計測結果から積込対象の車体座標系における位置及び形状を計算してもよい。また、他の実施形態に係る制御装置１６０は、車体座標系でなく、緯度、経度及び高度で表されるグローバル座標系に基づいて積込機械１００を制御してもよい。この場合、制御装置１６０は、目標旋回角度や旋回角度などの角度を、グローバル座標系の基準方位に対する角度として計算してもよい。
【0095】
上述した実施形態に係る制御装置１６０は、傾斜計測器１５２が計測した旋回体１２０の角速度を積分することで、旋回体１２０の角度を算出するが、これに限られない。例えば、他の実施形態に係る制御装置１６０は、位置方位演算器１５１が計測する方位の差分に基づいて旋回体１２０の角度を算出してもよい。また他の実施形態においては、旋回モータ１２４に設けた回転角センサの検出値を用いて旋回体１２０の角度を特定してもよい。
【0096】
上述した実施形態に係る制御装置１６０は、旋回角度と干渉回避角度の比較に基づいて自動制御を行うが、これに限られない。例えば、他の実施形態に係る制御装置１６０は、クラムバケット１３３の位置と積込対象Ｔの外形のうち旋回体１２０の旋回方向の最も後方の点ｐ１（図４）との比較に基づいて自動制御を行ってもよい。例えば、他の実施形態に係る制御装置１６０は、クラムバケット１３３が点ｐ１の近傍の領域に位置するように旋回開始タイミングを調整してよい。
また他の実施形態においては、制御装置１６０は、クラムバケット１３３が予め指定された軌跡を通るように、各リンク部品および旋回体１２０の自動制御信号を生成してもよい。軌跡は、例えば所定の曲線関数とのフィッティングによって決定されてもよいし、手動操作によるティーチングによって決定されてもよい。軌跡は、クラムバケット１３３の姿勢、各リンク部品および旋回体１２０の姿勢、または操作信号を、時系列に並べたものによって表されてよい。
また他の実施形態においては、制御装置１６０は、クラムバケット１３３が予め指定された軌跡を通るように、各リンク部品および旋回体１２０の自動制御信号を生成してもよい。軌跡は、例えば所定の曲線関数とのフィッティングによって決定されてもよいし、手動操作によるティーチングによって決定されてもよい。軌跡は、クラムバケット１３３の姿勢、各リンク部品および旋回体１２０の姿勢、または操作信号を、時系列に並べたものによって表されてよい。
【0097】
上述した実施形態に係る積込機械１００は、オペレータが運転室１４０に搭乗して直接操作するものであるが、これに限られない。例えば、他の実施形態に係る積込機械１００は、遠隔操作により動作するものであってもよい。すなわち、他の実施形態では、遠隔に設けられた操作装置１４３から通信によって操作信号が制御装置１６０に伝送されてよい。また、制御装置１６０は、遠隔地に設けられたコンピュータによって構成されてもよいし、積込機械１００と遠隔地とのそれぞれに設けられたコンピュータに機能を分担させた制御システムで構成されてもよい。
【0098】
上述した実施形態に係る自動制御は、クラムバケット１３３を掘削完了時の位置から、積込点へ移動させ、さらに次の掘削を開始するための位置へ移動させるものであるが、これに限られない。例えば、他の実施形態においては、クラムバケット１３３を、手動操作により掘削完了時の位置から積込点へ移動させて排土し、積込機械１００が積込点から次の掘削を開始するための位置への移動（第二旋回）のみを自動制御するようにしてもよい。この場合、オペレータはクラムバケット１３３が積込点へ到達した後に、次の掘削を開始するための位置へ作業機を駆動させるための信号を、操作レバーなどに設けたスイッチ操作により制御装置１６０に出力するようにしてもよい。前述のスイッチからの信号により、制御装置１６０は、上述した実施形態に係る自動制御の場合と同様に、作業機１３０の姿勢が掘削開始時とは別の予め設定した目標姿勢となるように作業機１３０を制御する。また、他の実施形態においては、第一旋回動作を行わない状態から自動制御によって第二旋回を行うようにしてもよい。
【0099】
上述した実施形態に係る制御装置１６０は、スティック１３２の先端の位置Ｐに基づいて作業機１３０を制御するが、スティック１３２の先端の位置Ｐはスティック１３２の先端の中心であってもよいし、左右にずれた位置であってもよい。また、他の実施形態においては、スティック１３２の先端の位置Ｐに代えて、クラムバケット１３３の任意の位置に基づいて作業機１３０を制御してもよい。
【符号の説明】
【0100】
１００…積込機械 １１０…走行体 １１１…無限軌道 １１２…走行モータ １２０…旋回体 １２１…エンジン １２２…油圧ポンプ １２３…コントロールバルブ １２４…旋回モータ １３０…作業機 １３１…ブーム １３１Ｃ…ブームシリンダ １３２…スティック １３２Ｃ…スティックシリンダ １３３…クラムバケット １３３１…バックオール １３３２…クラムシェル １３３２Ｃ…クラムシリンダ １３３Ｃ…バケットシリンダ １４０…運転室 １４１…運転席 １４２…操作端末 １４３…操作装置 １５１…位置方位演算器 １５２…傾斜計測器 １５３…ブーム角度センサ １５４…スティック角度センサ １５５…バケット角度センサ １５６…検出装置 １６０…制御装置 ６１０…プロセッサ ６１１…計測データ取得部 ６１２…マップ生成部 ６１３…操作信号入力部 ６１４…作業機位置特定部 ６１５…積込対象特定部 ６１６…旋回角度特定部 ６１７…回避角度特定部 ６１８…目標姿勢決定部 ６１９…移動制御部 ６２０…クラム制御部 ６２１…出力判定部 ６２２…操作信号出力部 ６３０…メインメモリ ６５０…ストレージ ６７０…インタフェース Ｔ…積込対象
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】