(57)【要約】  制御システムは、コントローラを備える。コントローラは、作業対象の現況地形を示す現況地形データを取得する。コントローラは、目標変位データを参照して、現況地形から鉛直方向に変位した目標設計地形を決定する。目標変位データは、作業開始位置からの移動量に応じた作業機の目標変位を示す。コントローラは、目標設計地形に向って作業機を移動させる指令信号を生成する。
2018142453.tif 000002
【特許請求の範囲】
【請求項１】
作業機を有する作業車両の制御システムであって、
コントローラを備え、
前記コントローラは、
作業対象の現況地形を示す現況地形データを取得し、
作業開始位置からの移動量に応じた前記作業機の目標変位を示す目標変位データを参照して、前記現況地形から鉛直方向に変位した目標設計地形を決定し、
前記目標設計地形に向かって前記作業機を移動させる指令信号を生成する、
ようにプログラムされている、
作業車両の制御システム。
【請求項２】
前記目標変位データは、第１領域と第２領域とを含み、
前記第１領域は、前記第２領域よりも前記移動量が小さいときに開始される領域であり、
前記第１領域では、前記第２領域よりも大きな前記目標変位が規定される、
請求項１に記載の作業車両の制御システム。
【請求項３】
前記目標変位データは、前記第１領域と前記第２領域との間に位置する移行領域を含み、
前記移行領域では、前記移動量の増大に応じて徐々に減少する前記目標変位が規定される、
請求項２に記載の作業車両の制御システム。
【請求項４】
前記目標変位データは、掘削開始位置と前記第１領域との間に位置する掘削開始領域を含み、
前記掘削開始領域では、前記移動量の増大に応じて徐々に増大する前記目標変位が規定される、
請求項２に記載の作業車両の制御システム。
【請求項５】
前記第１領域では、前記目標変位は第１目標値で一定であり、
前記第２領域では、前記目標変位は前記第１目標値よりも小さい第２目標値で一定である、
請求項２に記載の作業車両の制御システム。
【請求項６】
前記コントローラは、
前記作業機の現在の保有土量を取得し、
前記現在の保有土量が所定の閾値より大きくなったかを判定し、
前記現在の保有土量が所定の閾値より大きくなったかの判定結果に基づいて前記目標変位データを更新する、
ようにプログラムされている、
請求項１に記載の作業車両の制御システム。
【請求項７】
前記目標変位データでは、前記移動量が第１終了値であるときに、前記第１領域が終了し、
前記コントローラは、
前記作業機の現在の保有土量を取得し、
前記現在の保有土量が所定の閾値より大きくなった時点での前記作業車両の移動量を、前記第１終了値の更新値として取得し、
前記更新値が前記第１終了値の現在値よりも小さいときには、前記第１終了値を前記更新値に更新する、
ようにプログラムされている、
請求項２に記載の作業車両の制御システム。
【請求項８】
前記コントローラは、
複数の制御モードから選択された制御モードを受け付け、
前記目標変位を、選択された前記制御モードに応じて変更する、
ようにプログラムされている、
請求項１に記載の作業車両の制御システム。
【請求項９】
前記コントローラは、
前記現況地形の平滑化を行い、
平滑化された前記現況地形から前記目標変位分、鉛直方向に変位した目標設計地形を決定する、
ようにプログラムされている、
請求項１から８のいずれかに記載の作業車両の制御システム。
【請求項１０】
前記作業機は、ブレードを含み、
前記作業開始位置からの移動量は、ブレードの移動量である、
請求項１に記載の作業車両の制御システム。
【請求項１１】
作業車両の作業機の軌跡を設定する方法であって、
作業対象の現況地形を示す現況地形データを取得し、
作業開始位置からの移動量に応じた前記作業機の目標変位を示す目標変位データを参照して、前記現況地形から鉛直方向に変位した目標設計地形を決定することを備える、
作業機の軌跡設定方法。
【請求項１２】
前記目標変位データは、第１領域と第２領域とを含み、
前記第１領域は、前記第２領域よりも前記移動量が小さいときに開始される領域であり、
前記第１領域では、前記第２領域よりも大きな前記目標変位が規定される、
請求項１１に記載の作業機の軌跡設定方法。
【請求項１３】
前記目標変位データは、前記第１領域と前記第２領域との間に位置する移行領域を含み、
前記移行領域では、前記移動量の増大に応じて徐々に減少する前記目標変位が規定される、
請求項１２に記載の作業機の軌跡設定方法。
【請求項１４】
前記作業機の現在の保有土量を取得し、
前記現在の保有土量が所定の閾値より大きくなったかを判定し、
前記現在の保有土量が所定の閾値より大きくなったかの判定結果に基づいて前記目標変位データを更新することをさらに備える、
請求項１１に記載の作業機の軌跡設定方法。
【請求項１５】
複数の制御モードから選択された制御モードを受け付け、
前記目標変位を、選択された前記制御モードに応じて変更することをさらに備える、
請求項１１に記載の作業機の軌跡設定方法。
【請求項１６】
前記現況地形の平滑化を行うことをさらに備え、
平滑化された前記現況地形から前記目標変位分、鉛直方向に変位した目標設計地形が決定される、
請求項１１から１５のいずれかに記載の作業機の軌跡設定方法。
【請求項１７】
作業機を有する作業車両の制御システムであって、
コントローラを備え、
前記コントローラは、
作業対象の現況地形を示す現況地形データを取得し、
作業開始位置からの移動量と、前記作業機への負荷に関する目標負荷パラメータと、の関係を規定する目標負荷パラメータデータを参照して、前記現況地形から鉛直方向に変位した目標設計地形を決定し、
前記目標設計地形に向かって前記作業機を移動させる指令信号を生成する、
ようにプログラムされている、
作業車両の制御システム。
【請求項１８】
前記目標設計地形は、前記現況地形に対して鉛直方向に変位しており、
前記コントローラは、前記目標負荷パラメータの大きさに応じて、前記現況地形と前記目標設計地形との間の目標変位を決定する、
請求項１７に記載の作業車両の制御システム。
【請求項１９】
前記目標負荷パラメータは、前記作業機の目標土量を示す、
請求項１７に記載の作業車両の制御システム。
【請求項２０】
前記目標設計地形は、前記現況面に対して鉛直方向に変位しており、
前記目標負荷パラメータは、前記現況面と前記目標設計地形との間の目標変位を示す、
請求項１７に記載の作業車両の制御システム。
【請求項２１】
前記目標負荷パラメータデータは、第１領域と第２領域とを含み、
前記第１領域は、前記第２領域よりも前記移動量が小さいときに開始される領域であり、
前記第１領域では、前記第２領域よりも大きな前記目標負荷パラメータが規定される、
請求項１７に記載の作業車両の制御システム。
【請求項２２】
前記目標負荷パラメータデータは、前記第１領域と前記第２領域との間に位置する移行領域を含み、
前記移行領域では、前記移動量の増大に応じて徐々に減少する前記目標負荷パラメータが規定される、
請求項２１に記載の作業車両の制御システム。
【請求項２３】
前記コントローラは、
前記作業機の現在の保有土量を取得し、
前記現在の保有土量が所定の閾値より大きくなったかを判定し、
前記現在の保有土量が所定の閾値より大きくなったかの判定結果に基づいて前記目標負荷パラメータデータを更新する、
ようにプログラムされている、
請求項１７に記載の作業車両の制御システム。
【請求項２４】
前記コントローラは、
複数の制御モードから選択された制御モードを受け付け、
前記目標負荷パラメータを、選択された前記制御モードに応じて変更する、
ようにプログラムされている、
請求項１７から２３のいずれかに記載の作業車両の制御システム。
【請求項２５】
作業車両のブレードを制御するための制御システムであって、
コントローラを備え、
前記コントローラは、
前記作業現場の表面の形状を示す現況地形データを取得し、
前記ブレードの進行パスにおいて作業開始点から進んだ距離である移動量と、前記現況地形データとに基づいて、目標設計地形データを決定し、
前記目標設計地形データに従って前記ブレードを制御する、
ようにプログラムされている、
作業車両の制御システム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、作業車両の制御システム、及び作業機の軌跡設定方法に関する。
【背景技術】
【０００２】
従来、ブルドーザ、或いはグレーダ等の作業車両において、ブレードなどの作業機の位置を自動的に調整する制御が提案されている。例えば、特許文献1では、掘削作業において、ブレードに係る負荷を目標負荷に一致させる負荷制御により、ブレードの位置が自動調整される。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特許第5247939号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
上述した従来の制御によれば、ブレードへの負荷が過剰に大きくなったときにブレードを上昇させることにより、シュースリップの発生を抑えることができる。これにより、効率良く作業を行うことができる。【０００５】
しかし、従来の制御では、図12に示すように、まず設計地形100に沿うようにブレードが制御される。その後、ブレードへの負荷が大きくなると、負荷制御によってブレードを上昇させる（図12のブレードの軌跡200参照）。従って、大きな起伏のある地形300を掘削する場合には、ブレードに係る負荷が急速に大きくなることで、ブレードを急速に上昇させてしまうことがあり得る。その場合、凹凸の大きな地形が形成されることになるため、スムーズに掘削作業を行うことは困難である。また、掘削される地形が荒れ易くなり、仕上がりの品質が低下することが懸念される。【０００６】
本発明の課題は、自動制御によって、効率良く、且つ、仕上がりの品質の良い作業を作業車両に行わせることにある。
【課題を解決するための手段】
【０００７】
第1の態様は、作業機を有する作業車両の制御システムであって、コントローラを備える。コントローラは、作業対象の現況地形を示す現況地形データを取得する。コントローラは、目標変位データを参照して、現況地形から鉛直方向に変位した目標設計地形を決定する。目標変位データは、作業開始位置からの移動量に応じた作業機の目標変位を示す。コントローラは、目標設計地形に向って作業機を移動させる指令信号を生成する。【０００８】
第2の態様は、作業車両の作業機の軌跡を設定する方法であって、以下の処理を備える。第1の処理は、作業対象の現況地形を示す現況地形データを取得することである。第2の処理は、目標変位データを参照して、現況地形から鉛直方向に変位した目標設計面を決定することである。目標変位データは、作業開始位置からの移動量に応じた作業機の目標変位を示す。【０００９】
第3の態様は、作業機を有する作業車両の制御システムであって、コントローラを備える。コントローラは、作業対象の現況地形を示す現況地形データを取得する。コントローラは、目標負荷パラメータデータを参照して、現況地形から鉛直方向に変位した目標設計地形を決定する。目標負荷パラメータデータは、作業開始位置からの移動量と、作業機への負荷に関する目標負荷パラメータと、の関係を規定する。コントローラは、目標設計地形に向って作業機を移動させる指令信号を生成する。【００１０】
第4の態様は、作業車両のブレードを制御するための制御システムであって、コントローラを備える。コントローラは、現況地形データを取得する。現況地形データは、作業現場の表面の形状を示す。コントローラは、移動量と現況地形データとに基づいて、目標設計地形データを決定する。移動量は、ブレードの進行パスにおいて作業開始点から進んだ距離である。コントローラは、目標設計地形データに従ってブレードを制御する。
【発明の効果】
【００１１】
本発明によれば、自動制御によって、効率良く、且つ、仕上がりの品質の良い作業を作業車両に行わせることができる。
【図面の簡単な説明】
【００１２】
【図１】実施形態に係る作業車両を示す側面図である。
【図２】作業車両の駆動系と制御システムとの構成を示すブロック図である。
【図３】作業車両の構成を示す模式図である。
【図４】作業機の自動制御の処理を示すフローチャートである。
【図５】最終設計地形、現況地形、及び目標設計地形の一例を示す図である。
【図６】目標変位データの一例を示す図である。
【図７】目標変位を決定するための処理を示すフローチャートである。
【図８】第1変形例に係る制御システムの構成を示すブロック図である。
【図９】第２変形例に係る制御システムの構成を示すブロック図である。
【図１０】目標負荷パラメータデータの例を示す図である。
【図１１】目標設計地形の他の例を示す図である。
【図１２】従来技術による掘削作業を示す図である。
【発明を実施するための形態】
【００１３】
以下、実施形態に係る作業車両について、図面を参照しながら説明する。図1は、実施形態に係る作業車両1を示す側面図である。本実施形態に係る作業車両1は、ブルドーザである。作業車両1は、車体11と、走行装置12と、作業機13と、を備えている。
【００１４】
車体11は、運転室14とエンジン室15とを有する。運転室14には、図示しない運転席が配置されている。エンジン室15は、運転室14の前方に配置されている。走行装置12は、車体11の下部に取り付けられている。走行装置12は、左右一対の履帯16を有している。なお、図1では、左側の履帯16のみが図示されている。履帯16が回転することによって、作業車両1が走行する。作業車両1の走行は、自律走行、セミ自律走行、オペレータの操作による走行のいずれの形式であってもよい。
【００１５】
作業機13は、車体11に取り付けられている。作業機13は、リフトフレーム17と、ブレード18と、リフトシリンダ19と、を有する。
【００１６】
リフトフレーム17は、車幅方向に延びる軸線Ｘを中心として上下に動作可能に車体11に取り付けられている。リフトフレーム17は、ブレード18を支持している。ブレード18は、車体11の前方に配置されている。ブレード18は、リフトフレーム17の上下動に伴って上下に移動する。
【００１７】
リフトシリンダ19は、車体11とリフトフレーム17とに連結されている。リフトシリンダ19が伸縮することによって、リフトフレーム17は、軸線Ｘを中心として上下に回転する。
【００１８】
図2は、作業車両1の駆動系2と制御システム3との構成を示すブロック図である。図2に示すように、駆動系2は、エンジン22と、油圧ポンプ23と、動力伝達装置24と、を備えている。
【００１９】
油圧ポンプ23は、エンジン22によって駆動され、作動油を吐出する。油圧ポンプ23から吐出された作動油は、リフトシリンダ19に供給される。なお、図2では、1つの油圧ポンプ23が図示されているが、複数の油圧ポンプが設けられてもよい。
【００２０】
動力伝達装置24は、エンジン22の駆動力を走行装置12に伝達する。動力伝達装置24は、例えば、HST（Hydro Static Transmission）であってもよい。或いは、動力伝達装置24は、例えば、トルクコンバーター、或いは複数の変速ギアを有するトランスミッションであってもよい。
【００２１】
制御システム3は、操作装置25aと、制御モードの設定装置25bと、コントローラ26と、制御弁27とを備える。操作装置25aは、作業機13及び走行装置12を操作するための装置である。操作装置25aは、運転室14に配置されている。操作装置25aは、作業機13及び走行装置12を駆動するためのオペレータによる操作を受け付け、操作に応じた操作信号を出力する。操作装置25aは、例えば、操作レバー、ペダル、スイッチ等を含む。
【００２２】
例えば、走行装置12用の操作装置25aは、前進位置と後進位置と中立位置とに操作可能に設けられる。操作装置25aの位置を示す操作信号は、コントローラ26に出力される。コントローラ26は、操作装置25aの操作位置が前進位置であるときには、作業車両1が前進するように、走行装置12、或いは動力伝達装置24を制御する。操作装置25aの操作位置が後進位置であるときには、コントローラ26は、作業車両1が後進するように、走行装置12、或いは動力伝達装置24を制御する。
【００２３】
制御モードの設定装置25bは、例えばタッチパネル式の入力装置である。ただし、設定装置25bは、スイッチ等の他の入力装置であってもよい。制御モードは、後述するように、負荷モードと、ブレード仕様によるモードとを含む。負荷モードは、「Light」、「Normal」、「Heavy」のモードから選択できる。「Light」は、ブレード18への負荷が軽い制御モードである。「Heavy」は、ブレード18への負荷が重い制御モードである。「Normal」は、ブレード18への負荷が「Light」と「Heavy」の間である制御モードである。
【００２４】
ブレード仕様は、例えば、「Full」モードと「Semi」モードとから選択できる。「Full」モードは、大型のブレード18が装着されているときの制御モードであり、「Semi」モードは、小型のブレード18が装着されているときの制御モードである。
【００２５】
コントローラ26は、取得したデータに基づいて作業車両1を制御するようにプログラムされている。コントローラ26は、例えばCPU等の処理装置を含む。コントローラ26は、操作装置25aから操作信号を取得する。コントローラ26は、操作信号に基づいて、制御弁27を制御する。なお、コントローラ26は、一体に限らず、複数のコントローラに分かれていてもよい。
【００２６】
制御弁27は、比例制御弁であり、コントローラ26からの指令信号によって制御される。制御弁27は、リフトシリンダ19などの油圧アクチュエータと、油圧ポンプ23との間に配置される。制御弁27は、油圧ポンプ23からリフトシリンダ19に供給される作動油の流量を制御する。コントローラ26は、上述した操作装置25aの操作に応じてブレード18が動作するように、制御弁27への指令信号を生成する。これにより、リフトシリンダ19が、操作装置25aの操作量に応じて、制御される。なお、制御弁27は、圧力比例制御弁であってもよい。或いは、制御弁27は、電磁比例制御弁であってもよい。
【００２７】
制御システム3は、リフトシリンダセンサ29を備える。リフトシリンダセンサ29は、リフトシリンダ19のストローク長さ（以下、「リフトシリンダ長Ｌ」という。）を検出する。図3に示すように、コントローラ26は、リフトシリンダ長Ｌに基づいてブレード18のリフト角θliftを算出する。図3は、作業車両1の構成を示す模式図である。
【００２８】
図3では、作業機13の原点位置が二点鎖線で示されている。作業機13の原点位置は、水平な地面上でブレード18の刃先が地面に接触した状態でのブレード18の位置である。リフト角θliftは、作業機13の原点位置からの角度である。
【００２９】
図2に示すように、制御システム3は、位置検出装置31を備えている。位置検出装置31は、作業車両1の位置を測定する。位置検出装置31は、GNSS(Global Navigation Satellite System)レシーバ32と、IMU 33と、を備える。GNSSレシーバ32は、例えばGPS（Global Positioning System）用の受信機である。GNSSレシーバ32のアンテナは、運転室14上に配置される。GNSSレシーバ32は、衛星より測位信号を受信し、測位信号によりアンテナの位置を演算して車体位置データを生成する。コントローラ26は、GNSSレシーバ32から車体位置データを取得する。
【００３０】
IMU 33は、慣性計測装置（Inertial Measurement Unit）である。IMU 33は、車体傾斜角データと車体加速度データを取得する。車体傾斜角データは、車両前後方向の水平に対する角度（ピッチ角）、および車両横方向の水平に対する角度（ロール角）を含む。車体加速度データは、作業車両1の加速度を含む。コントローラ26は、車体加速度データにより、作業車両1の進行方向と車速とを得る。コントローラ26は、IMU 33から車体傾斜角データ及び車体加速度データを取得する。
【００３１】
コントローラ26は、リフトシリンダ長Ｌと、車体位置データと、車体傾斜角データとから、刃先位置P0を演算する。図3に示すように、コントローラ26は、車体位置データに基づいて、GNSSレシーバ32のグローバル座標を算出する。コントローラ26は、リフトシリンダ長Ｌに基づいて、リフト角θliftを算出する。コントローラ26は、リフト角θliftと車体寸法データに基づいて、GNSSレシーバ32に対する刃先位置P0のローカル座標を算出する。コントローラ26は、車体加速度データから作業車両1の進行方向と車速とを算出する。車体寸法データは、記憶装置28に記憶されており、GNSSレシーバ32に対する作業機13の位置を示す。コントローラ26は、GNSSレシーバ32のグローバル座標と刃先位置P0のローカル座標と車体傾斜角データとに基づいて、刃先位置P0のグローバル座標を算出する。コントローラ26は、刃先位置P0のグローバル座標を刃先位置データとして取得する。
【００３２】
制御システム3は、記憶装置28を備えている。記憶装置28は、例えばメモリーと補助記憶装置とを含む。記憶装置28は、例えば、RAM、或いはROMなどであってもよい。記憶装置28は、半導体メモリ、或いはハードディスクなどであってもよい。記憶装置28は、非一時的な（non-transitory）コンピュータで読み取り可能な記録媒体の一例である。記憶装置28は、プロセッサによって実行可能であり作業車両1を制御するためのコンピュータ指令を記録している。
【００３３】
記憶装置28は、設計地形データと作業現場地形データとを記憶している。設計地形データは、最終設計地形を示す。最終設計地形は、作業現場の表面の最終的な目標形状である。設計地形データは、例えば、三次元データ形式の土木施工図である。作業現場地形データは、作業現場の現況の地形を示す。作業現場地形データは、例えば、三次元データ形式の現況地形測量図である。作業現場地形データは、例えば、航空レーザ測量で得ることができる。
【００３４】
コントローラ26は、現況地形データを取得する。現況地形データは、作業現場の現況地形を示す。作業現場の現況地形は、作業車両1の進行方向に沿う領域の地形である。現況地形データは、作業現場地形データと上述の位置検出装置31から得られる作業車両1の位置と進行方向とからコントローラ26での演算により取得される。コントローラ26は、現況地形データと、設計地形データと、刃先位置データとに基づいて、作業機13を自動的に制御する。
【００３５】
なお、作業機13の自動制御は、オペレータによる手動操作と合わせて行われる半自動制御であってもよい。或いは、作業機13の自動制御は、オペレータによる手動操作無しで行われる完全自動制御であってもよい。
【００３６】
以下、コントローラ26によって実行される、掘削における作業機13の自動制御について説明する。図4は、掘削作業における作業機13の自動制御の処理を示すフローチャートである。
【００３７】
図4に示すように、ステップS101では、コントローラ26は、現在位置データを取得する。ここでは、コントローラ26は、上述したように、ブレード18の現在の刃先位置P0を取得する。
【００３８】
ステップS102では、コントローラ26は、設計地形データを取得する。図5に示すように、設計地形データは、作業車両1の進行方向において、複数の参照点での最終設計地形60の高さZdesignを含む。複数の参照点は、作業車両１の進行方向に沿う所定間隔ごとの複数地点を示す。複数の参照点は、ブレード18の進行パス上にある。なお、図5では、最終設計地形60は、水平方向に平行な平坦な形状であるが、これと異なる形状であってもよい。
【００３９】
ステップS103では、コントローラ26は、現況地形データを取得する。コントローラ26は、記憶装置28より得られる作業現場地形データと、位置検出装置31より得られる車体の位置データ及び進行方向データから演算により、現況地形データを取得する。
【００４０】
現況地形データは、作業車両1の進行方向に位置する地形を示す情報である。図5は、現況地形50の断面を示す。なお、図5において、縦軸は、地形の高さを示しており、横軸は、作業車両1の進行方向における現在位置からの距離を示している。
【００４１】
詳細には、現況地形データは、作業車両1の進行方向において、現在位置から所定の地形認識距離dnまでの複数の参照点での現況地形50の高さZ0~Znを含む。本実施形態において、現在位置は、作業車両1の現在の刃先位置P0に基づいて定められる位置である。ただし、現在位置は、作業車両1の他の部分の現在位置に基づいて定められてもよい。複数の参照点は、所定間隔、例えば１ｍごとに並んでいる。
【００４２】
ステップS104では、コントローラ26は、選択された制御モードを取得する。コントローラ26は、上述した設定装置25bによって選択された制御モードを取得する。
【００４３】
ステップS105では、コントローラ26は、掘削開始位置を取得する。例えば、コントローラ26は、刃先位置P0が、現況地形50の高さZ0を最初に下回ったときの位置を掘削開始位置として取得する。これにより、ブレード18の刃先が下げられて現況地形50を掘削し始めた位置が掘削開始位置として取得される。ただし、コントローラ26は、他の方法によって、掘削開始位置を取得してもよい。例えば、コントローラ26は、操作装置25aの操作に基づいて、掘削開始位置を取得してもよい。例えば、コントローラ26は、ボタン、或いは、タッチパネルによる画面操作などの操作に基づいて、掘削開始位置を取得してもよい。
【００４４】
ステップS106では、コントローラ26は、作業車両1の移動量を取得する。コントローラ26は、ブレード18の進行パスにおいて掘削開始位置から現在位置まで進んだ距離を、移動量として取得する。作業車両1の移動量は、車体11の移動量であってもよい。或いは、作業車両1の移動量は、ブレード18の刃先の移動量であってもよい。
【００４５】
ステップS107では、コントローラ26は、目標設計地形データを決定する。目標設計地形データは、図5に破線で記載された目標設計地形70を示す。目標設計地形70は、作業におけるブレード18の刃先の望まれる軌跡を示す。目標設計地形70は、掘削作業の結果として望まれる地形プロファイルである。図5に示すように、コントローラ26は、現況地形50から、変位距離ΔZ、下方に変位した目標設計地形70を決定する。変位距離ΔZは、各参照点での鉛直方向における目標変位である。本実施形態において、変位距離ΔZは、各参照点での目標深さであり、現況地形50の下方におけるブレード18の目標位置を示す。ブレード18の目標位置とは、ブレード18の刃先位置を意味する。言い換えれば、変位距離ΔZは、ブレード18によって掘削される単位移動量当たりの土量を示す。従って、目標設計地形データは、複数の参照点と複数の目標土量との関係を示す。
【００４６】
なお、コントローラ26は、最終設計地形60を下方に越えないように、目標設計地形70を決定する。従って、コントローラ26は、掘削作業時には、最終設計地形60以上、且つ、現況地形50より下方に位置する目標設計地形70を決定する。
【００４７】
詳細には、コントローラ26は、以下の数1式により、目標設計地形70の高さZを決定する。
［数1］
Z = Zm - ΔZ
ΔZ = t1*t2* Z_offset
Zm（m＝1,・・・, n）は、複数の参照点での現況地形50の高さZ0~Znである。ΔZは変位距離であり、図5では掘削深さを示す。t1は、作業車両が利用可能な牽引力の大きさを示す牽引力データに基づく倍率である。牽引力データは、選択された負荷モードに応じて決定される。負荷モードが「Light」、「Normail」、「Heavy」の順に、t1が大きくなる。
【００４８】
t2は、ブレード仕様データによる倍率である。ブレード仕様データは、選択されたブレード仕様に応じて決定される。「Full」モードでは、「Semi」モードよりもt2は大きい。
【００４９】
Z_offsetは、作業車両1の移動量に応じて決定される目標変位である。目標変位Z_offsetは、ブレード18への負荷に関係する目標負荷パラメータの一例である。目標変位Z_offsetは、地表からのブレード18の高さ方向（鉛直方向）の変位量を示す。図６は、目標変位データCの一例を示す図である。目標変位データCは、ブレード18の地表からの鉛直下方向への掘削深さ（目標変位）Z_offsetを、作業車両1の水平方向の移動量nの従属変数として示す。作業車両1の水平方向の移動量nは、ブレード18の水平方向の移動量と実質的に同じ値である。コントローラ26は、図6に示す目標変位データCを参照して、作業車両1の移動量nから、目標変位Z_offsetを決定する。
【００５０】
図6に示すように、目標変位データCは、作業車両1の移動量nと、目標変位Z_offsetと、の関係を規定する。目標変位データCは、記憶装置28に記憶されている。以降は説明を簡単にするため、t1とt2の値を1として変位距離ΔZは目標変位Z_offsetに等しいとする。
【００５１】
図6に示すように、目標変位データCは、開始時データc1と、掘削時データc2と、移行時データc3と、運土時データc4とを含む。開始時データc1は、掘削開始領域での移動量nと目標変位Z_offsetとの関係を規定する。掘削開始領域は、掘削開始点Sから定常掘削開始点Dまでの領域である。開始時データc1で示されるように、掘削開始領域では、移動量nの増大に応じて徐々に増大する目標変位Z_offsetが規定される。開始時データc1は、移動量ｎに対して線的に増加する目標変位Z_offsetを規定する。
【００５２】
掘削時データc2は、掘削領域での移動量nと目標変位Z_offsetとの関係を規定する。掘削領域は、定常掘削開始点Dから運土移行開始点Tまでの領域（第１領域）である。掘削時データc2で示されるように、掘削領域では、目標変位Z_offsetは、一定値に規定される。掘削時データc2は、移動量ｎに対して一定の目標変位Z_offsetを規定する。
【００５３】
移行時データc3は、運土移行領域での移動量nと目標変位Z_offsetとの関係を規定する。運土移行領域は、定常掘削終了点Tから運土開始点Pまでの領域である。移行時データc3で示されるように、運土移行領域では、移動量nの増大に応じて徐々に減少する目標変位Z_offsetが規定される。移行時データc3は、移動量nに対して線的に減少する目標変位Z_offsetを規定する。
【００５４】
運土時データc4は、運土領域での移動量nと目標変位Z_offsetとの関係を規定する。運土領域は、運土開始点Pから開始される領域（第２領域）である。運土時データc4に示されるように、運土領域では、目標変位Z_offsetは一定値に規定される。運土時データc4は、移動量ｎに対して一定の目標変位Z_offsetを規定する。
【００５５】
詳細には、掘削領域は、第1開始値b1から開始され、第1終了値b2で終了する。運土領域は、第2開始値b3から開始される。第1終了値b2は、第2開始値b3よりも小さい。従って、掘削領域は、運土領域よりも、移動量nが小さいときに開始される。掘削領域での目標変位Z_offsetは、第1目標値a1で一定である。運土領域での目標変位Z_offsetは、第2目標値a2で一定である。第1目標値a1は、第2目標値a2よりも大きい。従って、掘削領域では運土領域よりも大きな変位距離ΔZが規定される。
【００５６】
掘削開始位置での目標変位Z_offsetは、開始値a0である。開始値a0は、第1目標値a1よりも小さい。開始目標値a0は、第2目標値a2よりも小さい。
【００５７】
図7は、目標変位Z_offsetの決定処理を示すフローチャートである。説明を簡単にするため、以下に説明する決定処理では、作業車両1の走行は前進のみであるものとする。決定処理は、操作装置25aが前進の位置に移動すると開始される。ステップS201では、コントローラ26は、移動量nが0以上、且つ、第1開始値b1未満であるか判定する。移動量nが0以上、且つ、第1開始値b1未満であるときには、ステップS202において、コントローラ26は、移動量nの増大に応じて、目標変位Z_offsetを開始値a0から徐々に増大させる。
【００５８】
開始値a0は、定数であり、記憶装置28に記憶されている。開始値a0は、掘削開始時にブレード18への負荷が過剰に大きくならない程度に小さな値であることが好ましい。第1開始値b1は、図6に示す掘削開始領域での傾きc1、開始値a0、及び第1目標値a1から演算により求められる。傾きc1は、定数であり、記憶装置28に記憶されている。傾きc1は、掘削開始から掘削作業に迅速に移行可能であると共に、ブレード18への負荷が過剰に大きくならない程度の値であることが好ましい。
【００５９】
ステップS203では、コントローラ26は、移動量nが、第1開始値b1以上、且つ、第1終了値b2未満であるか判定する。移動量nが、第1開始値b1以上、且つ、第1終了値b2未満であるときには、ステップS204において、コントローラ26は、目標変位Z_offsetを第1目標値a1に設定する。第1目標値a1は、定数であり、記憶装置28に記憶されている。第1目標値a1は、効率よく掘削を行うことができると共に、ブレード18への負荷が過剰に大きくならない程度の値であることが好ましい。
【００６０】
ステップS205では、コントローラ26は、移動量nが、第1終了値b2以上、且つ、第2開始値b3未満であるか判定する。移動量nが、第1終了値b2以上、且つ、第2開始値b3未満であるときには、ステップS206において、コントローラ26は、移動量nの増大に応じて、目標変位Z_offsetを第1目標値a1から徐々に低減させる。
【００６１】
第1終了値b2は、ブレード18の現在の保有土量が、所定の閾値を越えるときの移動量である。従って、ブレード18の現在の保有土量が、所定の閾値を越えたときに、コントローラ26は、目標変位Z_offsetを第1目標値a1から低減させる。所定の閾値は、例えばブレード18の最大容量に基づいて決定される。例えば、ブレード18の現在の保有土量は、ブレード18への負荷が測定され、当該負荷から演算により決定されてもよい。或いは、ブレード18の画像がカメラによって取得され、当該画像を分析することによって、ブレード18の現在の保有土量が算出されてもよい。
【００６２】
なお、作業開始時には、第1終了値b2として、所定の初期値が設定される。作業開始後には、ブレード18の保有土量が所定の閾値を越えたときの移動量が更新値として記憶され、第1終了値b2は記憶された更新値に基づいて更新される。
【００６３】
ステップS207では、コントローラ26は、移動量nが、第2開始値b3以上であるか判定する。移動量nが、第2開始値b3以上であるかときには、ステップS208において、コントローラ26は、目標変位Z_offsetを第2目標値a2に設定する。
【００６４】
第2目標値a2は、定数であり、記憶装置28に記憶されている。第2目標値a2は、運土作業に適した値に設定されることが好ましい。第2開始値b3は、図6に示す運土移行領域での傾きc2、第1目標値a1、及び第2目標値a2から演算により求められる。傾きc2は、定数であり、記憶装置28に記憶されている。傾きc2は、掘削作業から運土作業に迅速に移行可能であると共に、ブレード18への負荷が過剰に大きくならない程度の値であることが好ましい。
【００６５】
なお、開始値a0、第1目標値a1、及び第2目標値a2は、作業車両１の状況等に応じて変更されてもよい。第1開始値b1、第1終了値b2、及び第2開始値b3は、定数として記憶装置28に記憶されてもよい。
【００６６】
以上のように、目標変位Z_offsetが決定されることで、目標設計地形70の高さZが決定される。
【００６７】
図4に示すステップS108では、コントローラ26は、目標設計地形70に向ってブレード18を制御する。ここでは、コントローラ26は、ステップS107で作成した目標設計地形70に向ってブレード18の刃先位置が移動するように、作業機13への指令信号を生成する。生成された指令信号は、制御弁27に入力される。それにより、作業機13の刃先位置P0が目標設計地形70に沿って移動する。
【００６８】
上述した掘削領域では、現況地形50と目標設計地形70との間の変位距離ΔZが、他の領域と比べて大きい。これにより、掘削領域では、現況地形50の掘削作業が行われる。運土領域では、現況地形50と目標設計地形70との間の変位距離ΔZが他の領域と比べて小さい。これにより、運土領域では、地面の掘削が控えられ、ブレード18に保持されている土砂が運搬される。
【００６９】
ステップS109では、コントローラ26は、作業現場地形データを更新する。コントローラ26は、刃先位置P0の最新の軌跡を示す位置データを、現況地形データとして取得し、取得した現況地形データによって作業現場地形データを更新する。或いは、コントローラ26は、車体位置データと車体寸法データとから履帯16の底面の位置を算出し、履帯16の底面の軌跡を示す位置データを現況地形データとして取得してもよい。この場合、作業地形データの更新は即時に行うことができる。
【００７０】
或いは、現況地形データは、作業車両1の外部の測量装置によって計測された測量データから生成されてもよい。外部の測量装置として、例えば、航空レーザ測量を用いてよい。或いは、カメラによって現況地形50を撮影し、カメラによって得られた画像データから現況地形データが生成されてもよい。例えば、UAV(Unmanned Aerial Vehicle)による空撮測量を用いてよい。外部の測量装置又はカメラの場合、作業現場地形データの更新は、所定周期ごと、あるいは随時に行われてもよい。
【００７１】
なお、上記の処理は、作業車両1が前進しているときに実行される。例えば、走行装置12用の操作装置25aが前進位置であるときに、上記の処理が実行される。ただし、作業車両1が、所定距離以上、後進すると、掘削開始位置、及び、移動量nは、初期化される。また、ブレード18の保有土量も初期化される。コントローラ26は、所定距離、前進するごとに、複数の参照点に対する目標設計地形70を決定し、更新する。ただし、コントローラ26は、前進から後進に切り換えられるまで、当初決定した目標設計地形70を維持してもよい。
【００７２】
そして、再び作業車両1が前進したときに、上記の処理が実行される。コントローラ26は、更新された作業現場地形データを基に現況地形50を更新し、更新された現況地形50に基づいて、目標設計地形70を新たに決定する。そして、コントローラ26は、新たに決定された目標設計地形70に沿って、ブレード18を制御する。このような処理が繰り返されることにより、現況地形50が最終設計地形60に近づくように、掘削が行われる。
【００７３】
以上説明した、本実施形態に係る作業車両1の制御システム3によれば、コントローラ26は、目標変位データを参照して、移動量nに応じた変位距離ΔZを決定する。そして、コントローラ26は、現況地形50から変位距離ΔZ、鉛直方向に変位した目標設計地形70を決定する。このような目標設計地形70に向ってブレード18が制御されることで、大きな凹凸を生成させることなく、スムーズに作業を行うことができる。
【００７４】
掘削作業では、作業車両1の移動量nが小さいときには、ブレード18での保有土量は少ない。従って、作業車両1の移動量nが小さい掘削領域において、大きな変位距離ΔZが設定されることで、効率よく掘削作業を行うことができる。
【００７５】
作業車両1の移動量nが大きいときには、ブレード18での保有土量は多い。そのため、作業車両1の移動量nが大きい運土領域では、小さな変位距離ΔZが設定されることで、保有土量が過剰となることを防止することができる。これにより、ブレード18に過剰な負荷がかかることを防止することができる。或いは、ブレード18から土が漏れることを抑えることができる。
【００７６】
コントローラ26は、現在の保有土量が所定の閾値より大きくなった時点での作業車両1の移動量nを、第1終了値b2として決定する。これにより、保有土量が過剰となることを、さらに精度良く防止することができる。
【００７７】
以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。
【００７８】
作業車両1は、ブルドーザに限らず、ホイールローダ、モータグレーダ等の他の車両であってもよい。
【００７９】
作業車両1は、遠隔操縦可能な車両であってもよい。その場合、制御システム3の一部は、作業車両1の外部に配置されてもよい。例えば、コントローラ26は、作業車両1の外部に配置されてもよい。コントローラ26は、作業現場から離れたコントロールセンタ内に配置されてもよい。
【００８０】
コントローラ26は、互いに別体の複数のコントローラ26を有してもよい。例えば、図8に示すように、コントローラ26は、作業車両1の外部に配置されるリモートコントローラ261と、作業車両1に搭載される車載コントローラ262とを含んでもよい。リモートコントローラ261と車載コントローラ262とは通信装置38,39を介して無線により通信可能であってもよい。そして、上述したコントローラ26の機能の一部がリモートコントローラ261によって実行され、残りの機能が車載コントローラ262によって実行されてもよい。例えば、目標設計地形70を決定する処理がリモートコントローラ261によって実行され、作業機13への指令信号を出力する処理が車載コントローラ262によって実行されてもよい。
【００８１】
操作装置25aは、作業車両1の外部に配置されてもよい。その場合、運転室は、作業車両1から省略されてもよい。或いは、操作装置25aが作業車両1から省略されてもよい。操作装置25aによる操作無しで、コントローラ26による自動制御のみによって作業車両1が操作されてもよい。
【００８２】
現況地形50は、上述した位置検出装置31に限らず、他の装置によって取得されてもよい。例えば、図9に示すように、外部の装置からのデータを受け付けるインターフェ−ス装置37によって現況地形50が取得されてもよい。インターフェ−ス装置37は、外部の計測装置41が計測した現況地形データを無線によって受信してもよい。或いは、インターフェ−ス装置37は、記録媒体の読み取り装置であって、外部の計測装置41が計測した現況地形データを記録媒体を介して受け付けてもよい。
【００８３】
コントローラ26は、平滑化された現況地形50に基づいて、目標設計地形70を決定してもよい。すなわち、コントローラ26は、平滑化された現況地形50から、変位距離ΔZ、変位した目標設計地形70を決定してもよい。平滑化とは、現況地形50の高さ変化をなだらかにする処理を意味する。例えば、コントローラ26は、以下の数2式によって現況地形50の複数の地点での高さZ0~Znを平滑化してもよい。
［数2］
2018142453.tif 000003
Zn_smは、平滑化された現況地形50における各地点の高さを示している。なお、数2式では、5つの地点の高さの平均値により平滑化を行っている。しかし、平滑化に用いる地点の数は５つより少ない、或いは５つより大きくてもよい。平滑化に用いる地点の数が変更可能であり、オペレータは、平滑化に用いる地点の数を変更することで、所望の平滑の度合いに設定可能であってもよい。また、平滑化の対象となる地点、及び、その前後の地点の高さの平均値に限らず、平滑化の対象となる地点、及び、その前方に位置する地点の高さの平均値が算出されてもよい。或いは、平滑化の対象となる地点、及び、その後方に位置する地点の高さの平均値が算出されてもよい。或いは、平均値に限らず、他の平滑化処理が用いられてもよい。
【００８４】
目標負荷パラメータは、作業機13への負荷に関係するパラメータであればよく、上記の実施形態のような目標変位に限らない。例えば、図10は、目標負荷パラメータデータの他の例を示す図である。図10に示すように、目標負荷パラメータは、平坦な地形の各地点ごとの目標土量S_targetであってもよい。すなわち、目標負荷パラメータは、単位距離当たりの目標土量S_targetであってもよい。例えば、コントローラ26は、目標土量S_targetとブレード13の幅とから、変位距離ΔZを算出することができる。或いは、目標負荷パラメータは、単位距離当たりの目標土量S_targetと異なるパラメータであってもよい。例えば、目標負荷パラメータは、各地点での作業機13への負荷の目標値を示すパラメータであってもよい。コントローラ26は、目標負荷パラメータから各地点ごとの変位距離ΔZを算出することができる。その場合、コントローラ26は、目標負荷パラメータの増大に応じて、変位距離ΔZを増大させてもよい。
【００８５】
図11に示すように、コントローラ26は、現況地形50から、変位距離ΔZ、上方に変位した目標設計地形70を決定してもよい。この場合、掘削作業に代えて盛土作業を行うことができる。
【産業上の利用可能性】
【００８６】
本発明によれば、自動制御によって、効率良く、且つ、仕上がりの品質の良い作業を作業車両に行わせることができる。
【符号の説明】
【００８７】
3   制御システム
13  作業機
26  コントローラ
50  現況地形
70  目標設計地形
C   目標変位データ
n   移動量
ΔZ 変位距離
Z_offset 目標変位
【図１】
2018142453.tif 000004
【図２】
2018142453.tif 000005
【図３】
2018142453.tif 000006
【図４】
2018142453.tif 000007
【図５】
2018142453.tif 000008
【図６】
2018142453.tif 000009
【図７】
2018142453.tif 000010
【図８】
2018142453.tif 000011
【図９】
2018142453.tif 000012
【図１０】
2018142453.tif 000013
【図１１】
2018142453.tif 000014
【図１２】
2018142453.tif 000015
【国際調査報告】
2018142453.tif 000016
2018142453.tif 000017
2018142453.tif 000018
2018142453.tif 000019