JP2020194253A - 障害物判定システム及び自律走行システム - Google Patents

Abstract

【課題】作業機の種類に関係なく、作業機が障害物と誤判定されにくくするとともに、作業車両の周囲の障害物の有無を判定することが可能な障害物判定システムを提供する。【解決手段】障害物判定システムは、作業機が取り付けられた作業車両の周囲の障害物の有無を判定する。この障害物判定システムは、障害物センサと、作成部と、判定部と、を備える。障害物センサは、障害物を検出するとともに検出範囲内に作業機が含まれている。作成部は、作業機を動かしながら当該作業機を障害物センサで検出することで、当該作業機の動きを示す動作情報を作成する。判定部は、動作情報と、障害物センサの検出結果と、に基づいて、作業機以外の物体を認識して障害物の有無を判定する。【選択図】図３

Description

本発明は、主として、作業車両の周囲の障害物の判定を行う障害物判定システムに関する。

特許文献１の作業車両には、障害物センサが設けられている。障害物センサは、障害物検出範囲に存在する障害物を検出する。また、この作業車両は、作業機（作業装置）により作業を行うことが可能である。また、障害物センサの障害物検出範囲に、作業機が位置することがある。そのため、この作業車両では、作業機が障害物と判定されることを防止するため、マスキング機能を有する。マスキング機能とは、障害物検出範囲のうちユーザが予め定めたマスキング範囲については、障害物の判定を行わない機能である。作業機が位置し得る範囲をマスキング範囲に設定することで、作業機が障害物と判定されることが抑制される。

特開２０１８−１１３９３７号公報

しかし、マスキング範囲を大きく設定し過ぎると、障害物センサが障害物を検出可能な範囲が狭くなる。一方で、マスキング範囲を小さく設定し過ぎると作業機が障害物として検出される可能性がある。

本発明は以上の事情に鑑みてされたものであり、その主要な目的は、作業機が障害物と誤判定されにくくするとともに、作業車両の周囲の広い範囲について障害物の有無を判定することが可能な障害物判定システムを提供することにある。

課題を解決するための手段及び効果

本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段とその効果を説明する。

本発明の第１の観点によれば、以下の構成の障害物判定システムが提供される。即ち、障害物判定システムは、作業機が取り付けられた作業車両の周囲の障害物の有無を判定する。この障害物判定システムは、障害物センサと、作成部と、判定部と、を備える。前記障害物センサは、障害物を検出するとともに検出範囲内に前記作業機が含まれている。前記作成部は、前記作業機を動かしながら当該作業機を前記障害物センサで検出することで、当該作業機の動きを示す動作情報を作成する。前記判定部は、前記動作情報と、前記障害物センサの検出結果と、に基づいて、前記作業機以外の物体を認識して障害物の有無を判定する。

これにより、作業機が障害物と誤認識される可能性を低くしつつ、かつ、作業車両の周囲の広い範囲について障害物の有無を判定することができる。従って、障害物の検出精度を高くすることができる。また、取り付ける作業機の形状に関係なく、障害物判定システムを機能させることができる。そのため、例えば、新たな作業機に交換されたり、作業機の形状が変更されたり、作業機に作業道具等が取り付けられたりした場合等においても、問題なく障害物判定を行うことができる。

前記の障害物判定システムにおいては、以下の構成とすることが好ましい。即ち、前記障害物センサは、検出対象物までの距離を測定可能である。前記作成部は、測定した距離が閾値未満の前記検出対象物を用いるとともに、測定した距離が閾値以上の前記検出対象物を用いることなく前記動作情報を作成する。

これにより、動作情報の作成時において、作業車両から遠い位置に物体が存在していた場合でも、適切な動作情報を作成できる。

前記の障害物判定システムにおいては、前記作成部は、当該作成部が作成した前記動作情報と、前記作業車両の作業中において前記障害物センサによる前記作業機の検出結果と、が異なると判定した場合、当該検出結果に基づいて、前記動作情報を更新することが好ましい。

これにより、作業機の形状が若干変化したり、作業機に別の物が新たに取り付けられたりした場合においても、それに応じた動作情報を用いて障害物の判定を行うことができる。

本発明の第２の観点によれば、前記の障害物判定システムを備え、以下の特徴を有する自律走行システムが提供される。即ち、前記作業車両は、測位衛星システムを利用して自律走行することが可能である。自律走行の実行中における障害物判定の有効又は無効を設定可能である。障害物判定が有効である場合は、前記動作情報の取得を、自律走行の開始条件として含める。障害物判定が無効である場合は、前記動作情報の取得を、自律走行の開始条件として含めない。

これにより、動作情報を取得した状態で自律走行を行うことをユーザに促すことができる。

本発明の一実施形態に係る障害物判定システムが適用されるトラクタの全体的な構成を示す側面図。 障害物判定システムを含む自律走行システムの主要な構成を示すブロック図。 障害物判定で用いる動作情報を作成する処理を示すフローチャート。 作業機が最も高い位置にある状態でリアカメラが検出した画像を示す図。 作業機が中途位置にある状態でリアカメラが検出した画像を示す図。 作業機が最も低い位置にある状態でリアカメラが検出した画像を示す図。 動作情報の準備が完了した後に自律走行を許可する処理を示すフローチャート。 障害物判定を示すフローチャート。 障害物判定時において、作業機以外の部分にある障害物を検出した際にリアカメラが検出した画像を示す図。

次に、本発明の実施形態について説明する。本実施形態の障害物判定システムは、自律走行を行う作業車両に適用されており、作業車両の周囲の障害物の有無を判定する。また、以下の説明では、作業車両を自律走行させるシステムを自律走行システムと称する。自律走行システムは、圃場（走行領域）で１台又は複数台の作業車両を自律的に走行させて、作業の全部又は一部を実行させるものである。本明細書において自律走行とは、作業車両が備える走行に関する構成がＥＣＵ等の制御部により制御されることで、予め定められた経路に沿うように少なくとも操舵が自律的に行われることを意味する。また、操舵に加え、車速又は作業機による作業等が自律的に行われる構成であってもよい。自律走行には、作業車両に人が乗っている場合と、作業車両に人が乗っていない場合が含まれる。

本実施形態では、作業車両としてトラクタを例にして説明する。なお、トラクタ以外に、田植機、コンバイン、土木・建設車両、除雪車等にも本実施形態の障害物判定システムを適用可能である。例えば田植機の場合は苗を植え付ける植付部が作業機に相当し、コンバインの場合は穀稈を刈り取る刈取部が作業機に相当する。

次に、図１及び図２を参照して自律走行システム１００について具体的に説明する。図１は、トラクタ１の全体的な構成を示す側面図である。図２は、障害物判定システム２００を含む自律走行システム１００の主要な構成を示すブロック図である。

図１に示すトラクタ１は、自律走行システム１００で用いられる。トラクタ１は、無線通信端末７０から受信した指示に基づいて動作可能に構成されている。トラクタ１は、圃場内を自律走行することが可能な走行機体（車体部）２を備える。走行機体２には、例えば農作業を行うための作業機３が着脱可能に取り付けられている。

この作業機３としては、例えば、耕耘機、プラウ、施肥機、草刈機、播種機等の種々の作業機があり、これらの中から選択された作業機３が走行機体２に装着される。図１には、作業機３として耕耘機が取り付けられた例が示されている。耕耘機はカバー３ａの内側に耕耘爪３ｂが配置されており、この耕耘爪３ｂが車幅方向を回転中心として回転することによって圃場を耕耘する。

トラクタ１の構成について、図１を参照してより詳細に説明する。トラクタ１の走行機体２は、図１に示すように、その前部が左右１対の前輪（車輪）７，７で支持され、その後部が左右１対の後輪８，８で支持されている。

走行機体２の前部にはボンネット９が配置されている。このボンネット９内には、トラクタ１の駆動源であるエンジン１０及び燃料タンク（図略）が収容されている。このエンジン１０は、例えばディーゼルエンジンにより構成することができるが、これに限るものではなく、例えばガソリンエンジンにより構成してもよい。また、駆動源としては、エンジンに加えて、又はこれに代えて、電気モータを使用してもよい。

ボンネット９の後方には、ユーザが搭乗するためのキャビン１１が配置されている。このキャビン１１の内部には、ステアリングハンドル（操舵具）１２と、座席１３と、メータパネル１４と、サブディスプレイ１５と、その他の操作を行うための様々な操作具と、が主として設けられている。トラクタ１は、キャビン１１を備えていてもよいし、キャビン１１を備えていなくてもよい。

ステアリングハンドル１２は、ユーザが操舵を行うための操作具である。座席１３は、トラクタ１を操作したり自律走行を監視したりするユーザが着座する箇所である。メータパネル１４は、走行速度、エンジン回転速度、作業機の状態、警告灯等を表示可能である。サブディスプレイ１５は、自律走行に関する情報、トラクタ１又は作業機３の状態に関する情報等を表示可能である。

図１に示すように、走行機体２の下部には、トラクタ１のシャーシ２０が設けられている。当該シャーシ２０は、機体フレーム２１、トランスミッション２２、フロントアクスル２３、及びリアアクスル２４等から構成されている。

機体フレーム２１は、トラクタ１の前部における支持部材であって、直接、又は防振部材等を介してエンジン１０を支持している。トランスミッション２２は、エンジン１０からの動力を変化させてフロントアクスル２３及びリアアクスル２４に伝達する。フロントアクスル２３は、トランスミッション２２から入力された動力を前輪７に伝達するように構成されている。リアアクスル２４は、トランスミッション２２から入力された動力を後輪８に伝達するように構成されている。

図２に示すように、トラクタ１は、制御部４を備える。制御部４は公知のコンピュータとして構成されており、図示しないＣＰＵ等の演算装置、不揮発性メモリ等の記憶装置、及び入出力部等を備える。記憶装置には、各種のプログラム及びトラクタ１の制御に関するデータ等が記憶されている。演算装置は、各種のプログラムを記憶装置から読み出して実行することができる。上記のハードウェアとソフトウェアの協働により、制御部４を走行制御部４ａ、作業機制御部４ｂ、作成部４ｃ、判定部４ｄ、登録部４ｅとして動作させることができる。

走行制御部４ａは、走行機体２の走行（前進、後進、停止及び旋回等）を制御する。作業機制御部４ｂは、作業機３の動作（昇降、駆動及び停止等）を制御する。なお、制御部４は、これら以外の制御（例えば撮影した画像の解析等）を行うこともできる。また、制御部４は、１つのコンピュータから構成されていてもよいし、複数のコンピュータから構成されていてもよい。

走行制御部４ａは、トラクタ１の車速を制御する車速制御と、トラクタ１を操舵する操舵制御と、を行う。制御部４は、車速制御を行う場合、エンジン１０の回転速度及びトランスミッション２２の変速比の少なくとも一方を制御する。

具体的には、エンジン１０には、当該エンジン１０の回転速度を変更させる図略のアクチュエータを備えたガバナ装置４１が設けられている。走行制御部４ａは、ガバナ装置４１を制御することで、エンジン１０の回転速度を制御することができる。また、エンジン１０には、エンジン１０の燃焼室内に噴射（供給）するための燃料の噴射時期・噴射量を調整する燃料噴射装置４２が付設されている。走行制御部４ａは、燃料噴射装置４２を制御することで、例えばエンジン１０への燃料の供給を停止させ、エンジン１０の駆動を停止させることができる。

また、トランスミッション２２には、例えば可動斜板式の油圧式無段変速装置である変速装置４３が設けられている。走行制御部４ａは、変速装置４３の斜板の角度を図略のアクチュエータによって変更することで、トランスミッション２２の変速比を変更する。以上の処理を行うことにより、トラクタ１が目標の車速に変更される。

走行制御部４ａは、操舵制御を行う場合、ステアリングハンドル１２の回動角度を制御する。具体的には、ステアリングハンドル１２の回転軸（ステアリングシャフト）の中途部には、操舵アクチュエータ４４が設けられている。この構成で、予め定められた経路をトラクタ１が走行する場合、制御部４は、当該経路に沿ってトラクタ１が走行するようにステアリングハンドル１２の適切な回動角度を計算し、得られた回動角度となるように操舵アクチュエータ４４を駆動し、ステアリングハンドル１２の回動角度を制御する。

作業機制御部４ｂは、作業実行条件を満たすか否かに基づいて、ＰＴＯスイッチを制御することで、作業機３の駆動と停止を切り替える。また、作業機制御部４ｂは、作業機３の昇降を制御する。具体的には、トラクタ１は、作業機３を走行機体２に連結している３点リンク機構の近傍に、油圧シリンダ等からなる昇降アクチュエータ４５を備えている。作業機制御部４ｂが昇降アクチュエータ４５を駆動して作業機３を適宜に昇降動作させることにより、所望の高さで作業機３による作業を行うことができる。

作成部４ｃ、判定部４ｄ、登録部４ｅは、後述の障害物判定に関する処理を行う。

上述のような制御部４を備えるトラクタ１は、ユーザがキャビン１１内に搭乗して各種操作をしなくとも、当該制御部４によりトラクタ１の各部（走行機体２、作業機３等）を制御して、圃場内を自律走行しながら自律作業を行うことができる。

次に、自律走行を行うために必要な情報を取得する構成について説明する。具体的には、本実施形態のトラクタ１は、図２等に示すように、測位用アンテナ６１、無線通信用アンテナ６３、慣性計測装置５１、車速センサ５２、及び舵角センサ５３等を備える。

測位用アンテナ６１は、例えば衛星測位システム（ＧＮＳＳ）等の測位システムを構成する測位衛星からの信号を受信するものである。測位用アンテナ６１で受信された測位信号は、図２に示す位置検出部としての位置情報取得部６２に入力される。位置情報取得部６２は、トラクタ１の走行機体２（厳密には、測位用アンテナ６１）の位置情報を、例えば緯度・経度情報として算出し、取得する。当該位置情報取得部６２で取得された位置情報は、制御部４に入力されて、自律走行に利用される。

なお、本実施形態ではＧＮＳＳ−ＲＴＫ法を利用した高精度の衛星測位システムが用いられているが、これに限るものではなく、高精度の位置座標が得られる限りにおいて他の測位システムを用いてもよい。例えば、相対測位方式（ＤＧＰＳ）、又は静止衛星型衛星航法補強システム（ＳＢＡＳ）を使用することが考えられる。

無線通信用アンテナ６３は、ユーザが操作する無線通信端末７０との間でデータをやり取りするためのアンテナである。無線通信用アンテナ６３で受信した無線通信端末７０からの信号は、図２に示す通信処理部６４で信号処理された後、制御部４に入力される。また、制御部４等から無線通信端末７０に送信する信号は、通信処理部６４で信号処理された後、無線通信用アンテナ６３から送信されて無線通信端末７０で受信される。

慣性計測装置５１は、トラクタ１（走行機体２）の姿勢や加速度等を特定することが可能なセンサユニットである。具体的には、慣性計測装置５１は、互いに直交する第１軸、第２軸、及び第３軸のそれぞれに対して、角速度センサと加速度センサとを取り付けたセンサ群を備える。なお、トラクタ１の姿勢とは、例えば、トラクタ１のロール角、ピッチ角、及びヨー角である。

また、測位用アンテナ６１、位置情報取得部６２、無線通信用アンテナ６３、通信処理部６４、及び慣性計測装置５１は、図１に示すアンテナユニット６を構成している。また、アンテナユニット６には、携帯通信回線を介して外部のサーバ等と通信するためのアンテナが更に含まれていてもよい。

上記の車速センサ５２は、トラクタ１の車速を検出するものであり、例えば前輪７，７の間の車軸に設けられる。車速センサ５２で得られた検出結果のデータは、制御部４へ出力される。なお、トラクタ１の車速は車速センサ５２で検出せずに、測位用アンテナ６１に基づいて所定距離におけるトラクタ１の移動時間に基づいて算出してもよい。

舵角センサ５３は、前輪７，７の舵角を検出するセンサである。本実施形態において、舵角センサ５３は前輪７，７に設けられた図示しないキングピンに備えられている。舵角センサ５３で得られた検出結果のデータは、制御部４へ出力される。なお、舵角センサ５３をステアリングシャフトに備える構成としてもよい。

また、トラクタ１は、障害物センサとして、フロントカメラ５４、リアカメラ５５、フロントＬｉＤＡＲ５６、及びリアＬｉＤＡＲ５７を備える。

フロントカメラ５４はトラクタ１の前方を撮影して、画像（又は動画）を取得する。リアカメラ５５はトラクタ１の後方を撮影して、画像（又は動画）を取得する。ここで取得される画像は、画素毎に色情報（色相、彩度、及び明度）の情報が設定されたものである。フロントカメラ５４及びリアカメラ５５は、例えばトラクタ１のルーフ５に取り付けられている。フロントカメラ５４及びリアカメラ５５が取得した画像は、通信処理部６４により、無線通信用アンテナ６３から無線通信端末７０に送信される。この画像を受信した無線通信端末７０は、その内容を画面に表示する。また、フロントカメラ５４及びリアカメラ５５が取得した画像は、障害物判定にも用いられる（詳細は後述）。

フロントＬｉＤＡＲ５６は、トラクタ１の前方を検出する。リアＬｉＤＡＲ５７は、トラクタ１の後方を検出する。ＬｉＤＡＲとは、パルス光を照射することで、周囲の物体の有無を反射光により検出する装置である。物体がある場合は、ＬｉＤＡＲは、反射光を受光したときのパルス光の向きと、受光までの時間と、に基づいて、当該物体の方位と距離を検出する。ＬｉＤＡＲは、この検出結果に基づいて、周囲に存在する物体を表す周囲データを作成する。また、フロントＬｉＤＡＲ５６及びリアＬｉＤＡＲ５７は、例えばトラクタ１のルーフ５に取り付けられている。フロントＬｉＤＡＲ５６及びリアＬｉＤＡＲ５７が検出した周囲データは、障害物判定に用いられる（詳細は後述）。周囲データの形式は様々であるが、距離画像の形式とすることができる。距離画像とは、画素毎に、ＬｉＤＡＲから検出対象物までの距離の情報を設定した画像である。

図２に示す無線通信端末７０は、ディスプレイ及びタッチパネルを備える。無線通信端末７０は、タブレット端末であるが、スマートフォン又はノートＰＣ等であってもよい。なお、トラクタ１にユーザが搭乗した状態でトラクタ１に自律走行を行わせる場合は、トラクタ１側（例えば制御部４）に無線通信端末７０と同じ機能を持たせてもよい。ユーザは、無線通信端末７０のディスプレイに表示された情報を参照して確認することができる。また、ユーザは、タッチパネル又はハードウェアキー等を操作して、トラクタ１の制御部４に、トラクタ１を制御するための制御信号（例えば、一時停止信号等）を送信することができる。また、無線通信端末７０は、ユーザの操作に基づいて、トラクタ１を自律走行させるための経路を作成することもできる。

次に、図３から図９を参照して、障害物判定について説明する。障害物判定は、障害物判定システム２００によって行われる。障害物判定システム２００は、障害物センサ（フロントカメラ５４、リアカメラ５５、フロントＬｉＤＡＲ５６、リアＬｉＤＡＲ５７）と、制御部４（特に、作成部４ｃ、判定部４ｄ、登録部４ｅ）と、によって行われる。本実施形態では、トラクタ１側の制御部４が障害物判定に関する演算処理を行うが、少なくとも一部の処理を無線通信端末７０が行ってもよい。

初めに、図３から図６を参照して、障害物判定を行うための事前処理について説明する。以下では、トラクタ１の後方の障害物判定について説明するが、後述するように、トラクタ１の前方においても同様の障害物判定を行うことが可能である。

本実施形態では、作業機３がトラクタ１の後方に取り付けられている。また、リアカメラ５５及びリアＬｉＤＡＲ５７の検出範囲に作業機３が含まれている。そのため、本実施形態では、障害物センサの検出結果から作業機３を除くための情報（以下、動作情報）が作業機３毎に作成されて登録される。以下、動作情報の作成に関する流れについて説明する。

制御部４は、例えば作業機３の交換後、自律走行の準備中、トラクタ１の起動後等において、現在装着中の作業機３について、動作情報が登録済みか否かを判定する（Ｓ１０１）。制御部４は、例えばオペレータが入力した情報に基づいて、現在装着されている作業機３を認識できる。あるいは、制御部４は、作業機３と通信を行うことにより、現在装着されている作業機３を認識してもよい。制御部４は、現在装着中の作業機３に動作情報が登録済みである場合、新たな動作情報の作成は不要であるため、処理を終了する。

制御部４は、現在装着中の作業機３に動作情報が登録されていない場合、例えばサブディスプレイ１５等にその旨を表示して、動作情報の登録を促す画面を表示する。そして、動作情報の登録を行う旨のユーザからの指示を受信したと判定した場合（Ｓ１０２）、動作情報の登録を行う。具体的には、制御部４は、ユーザの操作に基づいて又は自動で作業機３を動作させる（Ｓ１０３）。なお、動作情報の登録には、作業機３を実際に動作させる必要があるため、ステップＳ１０２のユーザの指示があった後に動作情報の登録を行うこととしている。

また、ステップＳ１０３で作業機３を動作させている間において、動作中の作業機３を障害物センサ（本実施形態ではリアカメラ５５及びリアＬｉＤＡＲ５７）で検出する（Ｓ１０４）。障害物センサによる検出は所定の時間間隔で行われ、作業機３の１つの動作につき、複数の色画像又は複数の距離画像（周囲データ）が取得される。

ここで、ステップＳ１０３において作業機３に行わせる動作は、作業機３によって異なる。例えば耕耘機のように昇降可能な作業機３の場合、作業機３を昇降させる。また、作業機３が開閉可能であったり、回転可能であったりする場合、作業機３を開閉又は回転させる。一方で、障害物センサの検出範囲において作業機３が占める領域が変化しない動作（例えば耕耘爪３ｂの回転）については、ステップＳ１０３において必ずしも行う必要がない。言い換えれば、障害物センサの検出範囲において作業機３が占める領域が変化する動作を行って、障害物センサで検出すれば十分である。なお、複数種類の動作を行う作業機３については、全ての種類の動作を障害物センサで検出することが好ましい。

図４から図６には、耕耘機としての作業機３を昇降させた際に、リアカメラ５５が検出した画像が示されている。図４は、作業機３が最も高い位置にある状態でリアカメラ５５が検出した画像である。図５は、作業機３が中途位置にある状態でリアカメラ５５が検出した画像である。図６は、作業機３が最も低い位置にある状態でリアカメラ５５が検出した画像である。本実施形態では、作業機３の昇降について、３枚の画像のみが示されているが、より多くの画像が取得されることが好ましい。

また、これらの図には、作業道具８５が取り付けられた作業機３が示されている。作業道具８５は、トラクタ１又は作業機３をメンテナンスするための道具、又は、圃場で作業を行うための道具等である。作業道具８５は、作業機３の付属品ではなく、ユーザの判断で取り付けた物である。作業道具８５は厳密には作業機３ではないが、作業機３に取り付けられており、作業機３と一体的に動作するため、障害物判定システム２００の障害物判定では、作業機３の一部として取り扱われる。

次に、制御部４（作成部４ｃ）は、ステップＳ１０４で得られた検出結果に基づいて、動作情報を作成する（Ｓ１０５）。動作情報は、作業機３が動作した際に、当該作業機３が障害物センサによってどのように検出されているかを示す情報である。障害物センサがカメラの場合、例えば、カメラが取得した色画像から作業機３を抽出した抽出画像が動作情報に該当する。また、障害物センサがＬｉＤＡＲの場合も、例えば、ＬｉＤＡＲが取得した距離画像から作業機３を抽出した抽出画像が動作情報に該当する。カメラ又はＬｉＤＡＲは、様々な状態の作業機３を撮影しているため、動作情報に含まれる抽出画像も基本的には複数である。

なお、仮に、カメラ又はＬｉＤＡＲが作業機３だけでなく、トラクタ１（前輪７、後輪８、ボンネット９等）を検出している場合は、当該トラクタ１を動作情報に含めてもよい。特に、前方の障害物センサが前輪７を検出している場合、例えばステアリングハンドル１２を動作させることで、舵角が異なる前輪７を動作情報として登録してもよい。従って、以下の動作情報の説明において、「作業機３」と記載されている箇所を「作業機３及びトラクタ１」等と読み替えることもできる。

動作情報の作成時において、障害物センサの検出結果（色画像又は距離画像）から、作業機３以外の情報を取り除く処理が行われる。作業機３以外の情報を取り除く方法としては、例えば距離に応じて選別を行う方法がある。近年では、単一のカメラで取得した画像であっても、画像内の対象物の距離を推定する方法が提案されている。また、ＬｉＤＡＲであれば、距離画像の各画素の情報に基づいて、対象物までの距離を検出できる。作業機３は、他の対象物よりも障害物センサに近いと考えられるので、距離が閾値未満の対象物を用いて、かつ、距離が閾値以上の対象物を用いずに、動作情報を作成できる。これにより、障害物センサからの距離が閾値以上の遠い位置にある対象物（例えば図４に示すトラック８１や、図略の建物等）を動作情報から除外することができる。なお、上述した作業道具８５については、障害物センサまでの距離が作業機３と同じであるため、作業道具８５を含めた作業機３について、動作情報を作成できる。

また、障害物センサがカメラの場合、画像認識によって作業機３を特定してもよい。即ち、様々な作業機３の様々な状態の画像を予め学習しておき、障害物センサとしてのカメラが検出した画像とのマッチング等を行うことで、当該画像に含まれる作業機３を特定できる。また、画像認識により、人を認識可能である場合、仮に障害物センサから人までの距離が近い場合でも、人が表れている範囲を抽出画像から除外することが好ましい。また、人以外についても、明らかに作業機３又は作業道具８５等とは異なる物を認識可能であれば、これらの物を抽出画像から除外してもよい。

制御部４は、作成した動作情報を、作業機３を特定するための情報（識別情報）と対応付けて、登録部４ｅに登録する（Ｓ１０５）。

なお、動作情報の登録前に、動作情報をユーザに提示して確認を要求してもよい。つまり、動作情報は、色画像又は距離画像から作業機３を抽出した抽出画像の集合であるため、これらの抽出画像をサブディスプレイ１５等に表示する。ユーザは、これらの抽出画像を見ることで、動作情報を確認できる。なお、障害物等が抽出画像に表れている場合や、作業機３の全体が抽出画像に表れていない場合、動作情報を修正することが好ましい。具体的には、ユーザは、修正が必要な範囲を選択すること等により、動作情報を修正可能である。

次に、図７を参照して、動作情報の登録の有無に基づいて、自律走行の開始を許可するか否か判定する処理について説明する。

障害物判定システム２００による障害物判定は、主として自律走行中に行われる。また、例えばユーザがトラクタ１に乗車して自ら障害物の有無を判断する場合等は、障害物判定システム２００による障害物判定がなくとも、自律走行が可能である。従って、障害物判定システム２００による障害物判定は、有効又は無効を切替可能となっている。本実施形態では、障害物判定システム２００による障害物判定が有効である場合は、動作情報が登録されている場合にのみ、自律走行が許可される。以下、具体的に説明する。

制御部４又は無線通信端末７０は、自律走行の準備中等において、自律走行中の障害物判定が有効か否かを判定する（Ｓ２０１）。障害物判定が有効である場合、制御部４又は無線通信端末７０は、現在装着中の作業機３の動作情報が登録済みか否かを判定する（Ｓ２０２）。動作情報が登録されていない場合は、障害物判定を適切に行うことができない。従って、制御部４又は無線通信端末７０は、動作情報の登録をユーザに要請する（Ｓ２０３）。ユーザへの要請は、例えば、動作情報を登録しないと自律走行が開始できないことを無線通信端末７０又はサブディスプレイ１５等に表示することで行われる。

動作情報が登録された場合、又は、ステップＳ２０１で障害物判定が無効である場合、制御部４又は無線通信端末７０は、他の自律走行の開始条件（例えば、トラクタ１がスタート地点に位置していること）を満たすか否かを判定する（Ｓ２０４）。他の自律走行条件を満たす場合、制御部４又は無線通信端末７０は、自律走行を許可する（Ｓ２０５）。

次に、図８を参照して、障害物判定システム２００による障害物判定について説明する。

制御部４は、障害物判定が有効か否かを判定し（Ｓ３０１）、有効である場合に、以下の処理を行う。初めに、制御部４の判定部４ｄは、障害物センサの検出結果を取得する（Ｓ３０２）。ここで取得する検出結果（色画像、距離画像）には、作業機３が含まれている。次に、判定部４ｄは、現在装着中の作業機３の動作情報に基づいて、検出結果の画像のうち作業機３を示す範囲を特定する。具体的には、判定部４ｄは、動作情報として登録されている複数の作業機３の画像と、検出結果の画像と、のマッチングを行うことにより、検出結果の画像に表れている作業機３を特定できる。

次に、判定部４ｄは、検出結果の画像のうち、作業機３以外の範囲に障害物（木、岩、建物、人等）が存在するか否かを判定する（Ｓ３０４）。判定部４ｄは、作業機３以外の範囲に障害物があると判定した場合、障害物対応処理を行う（Ｓ３０５）。障害物対応処理とは、ユーザに警告したり、トラクタ１を減速又は停止させたり、トラクタ１を旋回させて障害物を回避したりする処理である。障害物対応処理は、障害物までの距離及び障害物が位置する方向に応じて異なっていてもよい。

ここで、作業機の形状及び動きに基づいて、上述のマスキング範囲を作成することでも、作業機を除いた範囲における障害物の検出は可能である。しかし、マスキング範囲を作成する場合、作業機がどのような姿勢であってもマスキング範囲から逸脱しないように、大きなマスキング範囲を設定する必要がある。従って、障害物の検出精度が低くなる。また、特にトラクタでは様々な種類の作業機を取付可能であるため、それらの全てについて予めマスキング範囲を作成することは現実的でない。更に、作業機に作業道具等を取り付けた場合、作業道具を障害物として認識してしまうことがある。

これに対し、本実施形態では、作業機３を動作させて動作情報を作成するため、あらゆる作業機３に対して、作業機３を除いた範囲に対してのみ障害物の有無を判定できる。更に、作業道具８５等が作業機３に取り付けられていても、作業道具８５等が障害物として判定されることがない。

また、ステップＳ３０３において、動作情報に基づいて、作業機３の範囲を特定できない事態も考えられる。この場合、図９に示す処理を行ってもよい。以下、詳細に説明する。

初めに、制御部４は、障害物センサの検出結果に表れる作業機３と、動作情報に含まれる作業機３と、の一致度を算出する（Ｓ４０１）。この一致度が高いほど、障害物センサの検出結果に表れる作業機を確実に特定できていることとなる。

制御部４は、この一致度が第１閾値以上と判定した場合（Ｓ４０２）、障害物センサの検出結果に表れる作業機３を特定する精度が十分高いため、図８の障害物判定を続行する（Ｓ４０３）。一方、一致度が第１閾値未満である場合、制御部４は、一致度が第２閾値（＜第１閾値）以下であるか否かを判定する（Ｓ４０４）。一致度が第２閾値以下である場合、障害物センサの検出結果に表れる作業機３を特定する精度が低過ぎるため、動作情報の再登録をユーザに要請する（Ｓ４０５）。ユーザへの要請は、例えば、取り付けた作業機３と、動作情報の作業機３と、が異なるため、動作情報の再登録が必要であることを無線通信端末７０又はサブディスプレイ１５等に表示することで行われる。

一方、一致度が第２閾値より大きく第１閾値未満である場合、障害物センサの検出結果に表れる作業機３と、動作情報に含まれる作業機３と、の違いは僅かである。例えば、作業道具８５の位置が変わったり、作業機３のガタツキ等で僅かに位置が変わったりした程度の違いである。この場合、障害物センサの検出結果に基づいて、動作情報を修正できる。そのため、制御部４は、動作情報の修正の要否をユーザに問い合わせる（Ｓ４０６）。

制御部４は、ユーザから修正の指示があったと判定した場合（Ｓ４０７）、障害物センサの検出結果に基づいて、動作情報を修正する（Ｓ４０８）。制御部４は、ユーザから修正しない旨の指示があった場合、動作情報の再登録をユーザに要請する（Ｓ４０５）。

図９に示す処理を行うことにより、障害物センサの検出結果に表れる作業機３と、動作情報に含まれる作業機３と、の一致度が低い場合においても、適切な処理を行うことができる。

以上に説明したように、本実施形態の障害物判定システム２００は、作業機３が取り付けられたトラクタ１の周囲の障害物の有無を判定する。この障害物判定システム２００は、障害物センサ（フロントカメラ５４、リアカメラ５５、フロントＬｉＤＡＲ５６、リアＬｉＤＡＲ５７）と、作成部４ｃと、判定部４ｄと、を備える。障害物センサは、障害物を検出するとともに検出範囲内に作業機３が含まれている。作成部４ｃは、作業機３を動かしながら当該作業機３を障害物センサで検出することで、当該作業機３の動きを示す動作情報を作成する。判定部４ｄは、動作情報と、障害物センサの検出結果と、に基づいて、作業機３以外の物体を認識して障害物の有無を判定する。

これにより、作業機３が障害物と誤認識される可能性を低くしつつ、かつ、トラクタ１の周囲の広い範囲について障害物の有無を判定することができる。従って、障害物の検出精度を高くすることができる。また、取り付ける作業機３の形状に関係なく、障害物判定システム２００を機能させることができる。そのため、例えば、新たな作業機３に交換されたり、作業機３の形状が変更されたり、作業機３に作業道具８５等が取り付けられたりした場合等においても、問題なく障害物判定を行うことができる。

また、本実施形態の障害物判定システム２００において、障害物センサは、検出対象物までの距離を測定可能である。作成部４ｃは、測定した距離が閾値未満の検出対象物を用いるとともに、測定した距離が閾値以上の検出対象物を用いることなく動作情報を作成する。

これにより、動作情報の作成時において、トラクタ１から遠い位置に物体が存在していた場合でも、適切な動作情報を作成できる。

また、本実施形態の障害物判定システム２００において、作成部４ｃが作成した動作情報と、トラクタ１の作業中における障害物センサによる作業機３の検出結果と、が異なる場合、当該検出結果に基づいて、動作情報を更新する。

これにより、作業機３の形状が若干変化したり、作業機３に別の物が新たに取り付けられたりした場合においても、それに応じた動作情報を用いて障害物の判定を行うことができる。

また、本実施形態の自律走行システム１００は、障害物判定システム２００を備える。また、自律走行システム１００により、トラクタ１は、測位衛星システムを利用して自律走行することが可能である。自律走行システム１００では、自律走行の実行中における障害物判定の有効又は無効を設定可能である。障害物判定が有効である場合は、動作情報の取得を、自律走行の開始条件として含める。障害物判定が無効である場合は、動作情報の取得を、自律走行の開始条件として含めない。

これにより、動作情報を取得した状態で自律走行を行うことをユーザに促すことができる。

以上に本発明の好適な実施の形態を説明したが、上記の構成は例えば以下のように変更することができる。

上記実施形態では、トラクタ１の後方に作業機３が取り付けられており、この作業機３が障害物と判定されないように動作情報を作成する構成である。なお、トラクタ１は、前方にも作業機３（例えば、フロントローダ）を取付可能である。この場合においても、同様の処理を行うことで、前方の作業機３が障害物と判定されないようにすることができる。

上記実施形態で示したフローチャートは一例であり、一部の処理を省略したり、一部の処理の内容を変更したり、新たな処理を追加したりしてもよい。例えば、ステップＳ１０１において、動作情報が登録済みの場合は特に処理を行わないが、動作情報を再登録するかをユーザに問い合わせてもよい。

上記実施形態では、障害物センサとして、カメラ及びＬｉＤＡＲを備える構成を例として挙げて説明したが、カメラとＬｉＤＡＲの一方を省略してもよい。また、カメラとＬｉＤＡＲ以外のセンサ（例えば、赤外線センサ又はソナー）を障害物センサとして用いることもできる。

１ トラクタ（作業車両）
４ 制御部
４ｃ 作成部
４ｄ 判定部
４ｅ 登録部
５４ フロントカメラ（障害物センサ）
５５ リアカメラ（障害物センサ）
５６ フロントＬｉＤＡＲ（障害物センサ）
５７ リアＬｉＤＡＲ（障害物センサ）
１００ 自律走行システム
２００ 障害物判定システム

Claims (4)

1. 作業機が取り付けられた作業車両の周囲の障害物の有無を判定する障害物判定システムにおいて、
   障害物を検出するとともに検出範囲内に前記作業機が含まれている障害物センサと、
   前記作業機を動かしながら当該作業機を前記障害物センサで検出することで、当該作業機の動きを示す動作情報を作成する作成部と、
   前記動作情報と、前記障害物センサの検出結果と、に基づいて、前記作業機以外の物体を認識して障害物の有無を判定する判定部と、
   を備えることを特徴とする障害物判定システム。
2. 請求項１に記載の障害物判定システムであって、
   前記障害物センサは、検出対象物までの距離を測定可能であり、
   前記作成部は、測定した距離が閾値未満の前記検出対象物を用いるとともに、測定した距離が閾値以上の前記検出対象物を用いることなく前記動作情報を作成することを特徴とする障害物判定システム。
3. 請求項１又は２に記載の障害物判定システムであって、
   前記作成部は、当該作成部が作成した前記動作情報と、前記作業車両の作業中における前記障害物センサによる前記作業機の検出結果と、が異なると判定した場合、当該検出結果に基づいて、前記動作情報を更新することを特徴とする障害物判定システム。
4. 請求項１から３までの何れか一項に記載の障害物判定システムを備える自律走行システムであって、
   前記作業車両は、測位衛星システムを利用して自律走行することが可能であり、
   自律走行の実行中における障害物判定の有効又は無効を設定可能であり、
   障害物判定が有効である場合は、前記動作情報の取得を、自律走行の開始条件として含め、
   障害物判定が無効である場合は、前記動作情報の取得を、自律走行の開始条件として含めないことを特徴とする自律走行システム。

Images