特許 7409240 障害物検出装置及び障害物検出方法

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

(12)【公報種別】特許公報(B2)

(11)【特許番号】

(24)【登録日】2023-12-25

(45)【発行日】2024-01-09

(54)【発明の名称】障害物検出装置及び障害物検出方法

(51)【国際特許分類】

   B66F 9/24 20060101AFI20231226BHJP

   G05D 1/43 20240101ALI20231226BHJP

   G08G 1/00 20060101ALI20231226BHJP

   G08G 1/16 20060101ALI20231226BHJP

【ＦＩ】

B66F9/24 L

G05D1/02 R

G08G1/00 X

G08G1/16 C

【請求項の数】 5

(21)【出願番号】P 2020114903

(22)【出願日】2020-07-02

(65)【公開番号】P2022012811

(43)【公開日】2022-01-17

【審査請求日】2022-10-13

(73)【特許権者】

【識別番号】000003218

【氏名又は名称】株式会社豊田自動織機

(74)【代理人】

【識別番号】100105957

【弁理士】

【氏名又は名称】恩田 誠

(74)【代理人】

【識別番号】100068755

【弁理士】

【氏名又は名称】恩田 博宣

(72)【発明者】

【氏名】石▲崎▼ 将崇

【審査官】加藤 三慶

(56)【参考文献】

【文献】特開２０１９－１７４３４７（ＪＰ，Ａ）

【文献】国際公開第２０１６／１７４９７７（ＷＯ，Ａ１）

【文献】特開２０１４－０９７８６７（ＪＰ，Ａ）

(58)【調査した分野】(Int.Cl.，ＤＢ名)

Ｂ６６Ｆ ９／２４

Ｇ０５Ｄ １／０２

Ｂ６６Ｃ ２３／８８

Ｇ０８Ｇ １／００

Ｇ０８Ｇ １／１６

(57)【特許請求の範囲】

【請求項1】

移動体に搭載される障害物検出装置であって、
障害物を検出するためのセンサと、
前記センサの検出結果から、水平方向のうち一方向をＸ軸、水平方向のうち前記Ｘ軸に直交する方向の軸をＹ軸、前記Ｘ軸及び前記Ｙ軸に直交する方向の軸をＺ軸とする実空間上の座標系での特徴点を取得するとともに前記特徴点で表される前記障害物の位置を検出する位置検出部と、を備え、
前記位置検出部は、
前記センサによって前記障害物を検出可能な検出可能領域に予め設定された領域であって前記移動体の一部が存在する領域を非検出領域とすると、前記非検出領域には前記センサの検出結果に関わらず前記障害物が存在しないと判断する非検出部と、
前記検出可能領域のうち前記非検出領域とは異なる領域である検出領域に存在する前記障害物の位置を検出する検出部と、を備え、
前記非検出部は、前記実空間上の座標系での前記特徴点の座標が前記非検出領域に含まれる場合に当該座標で表される前記障害物が存在しないと判断する障害物検出装置。

【請求項2】

前記移動体はフォークリフトであり、
前記非検出領域は、前記フォークリフトのカウンタウェイトが存在する位置に設定されている請求項１に記載の障害物検出装置。

【請求項3】

前記非検出領域は、前記実空間上の座標系で前記一部が存在する領域を示す３次元座標で規定されている請求項１に記載の障害物検出装置。

【請求項4】

前記センサは、ステレオカメラであり、
前記位置検出部は、
前記ステレオカメラから前記検出結果として取得した第１画像と第２画像とを比較することによって視差を算出するとともに、前記視差から前記実空間上の座標系での前記特徴点の座標を取得し、
前記非検出部によって前記非検出領域に含まれると判断された前記特徴点を除いた前記特徴点をクラスタ化することで前記障害物の位置を検出する請求項１に記載の障害物検出装置。

【請求項5】

移動体に搭載されており、かつ、センサと位置検出部とを備える障害物検出装置によって障害物の位置を検出する障害物検出方法であって、
前記位置検出部が、前記センサの検出結果を取得するステップと、
前記位置検出部が、水平方向のうち一方向をＸ軸、水平方向のうち前記Ｘ軸に直交する方向の軸をＹ軸、前記Ｘ軸及び前記Ｙ軸に直交する方向の軸をＺ軸とする実空間上の座標系での特徴点を取得するとともに前記特徴点で表される前記障害物の位置を検出するステップと、
前記センサによって前記障害物を検出可能な検出可能領域に予め設定された領域であって前記移動体の一部が存在する領域を非検出領域とすると、前記位置検出部が、前記非検出領域には前記センサの検出結果に関わらず前記障害物が存在しないと判断するステップと、
前記位置検出部が、前記検出可能領域のうち前記非検出領域とは異なる領域である検出領域に存在する前記障害物の位置を検出するステップと、を含み、
前記非検出領域には前記センサの検出結果に関わらず前記障害物が存在しないと判断するステップは、前記実空間上の座標系での前記特徴点の座標が前記非検出領域に含まれる場合に当該座標で表される前記障害物が存在しないと判断するステップである障害物検出方法。

【発明の詳細な説明】

【技術分野】

【0001】

本開示は、障害物検出装置及び障害物検出方法に関する。

【背景技術】

【0002】

車両などの移動体には障害物を検出するための障害物検出装置が搭載されている。特許文献１に開示の障害物検出装置は、障害物を検出するためのセンサと、センサの検出結果から障害物の位置を検出する位置検出部と、を備える。位置検出部は、センサの検出可能領域に存在する障害物の位置を検出する。センサとしては、ステレオカメラが用いられている。位置検出部は、ステレオカメラによって撮像された画像から視差画像を導出し、視差画像に基づき、障害物の位置を検出している。

【先行技術文献】

【特許文献】

【0003】

【文献】特開２０１６－２０６８０１号公報

【発明の概要】

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

【0004】

センサの設置位置によっては、センサの検出可能領域に移動体の一部が入り込む。すると、障害物検出装置は、移動体の一部を障害物として検出するおそれがある。
本開示の目的は、移動体の一部が障害物として検出されることを抑制できる障害物検出装置及び障害物検出方法を提供することにある。

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

【0005】

上記課題を解決する障害物検出装置は、移動体に搭載される障害物検出装置であって、障害物を検出するためのセンサと、前記センサの検出結果から前記障害物の位置を検出する位置検出部と、を備え、前記位置検出部は、前記センサによって前記障害物を検出可能な検出可能領域に予め設定された領域であって前記移動体の一部が存在する領域を非検出領域とすると、前記非検出領域には前記センサの検出結果に関わらず前記障害物が存在しないと判断する非検出部と、前記検出可能領域のうち前記非検出領域とは異なる領域である検出領域に存在する前記障害物の位置を検出する検出部と、を備える。

【0006】

検出可能領域には、予め非検出領域が設定されている。非検出部は、非検出領域に障害物が存在している場合であっても、非検出領域には障害物が存在していないと判断する。非検出領域には移動体の一部が存在しているため、非検出領域に障害物が存在していないと判断することで、障害物検出装置により移動体の一部が障害物として検出されることを抑制できる。

【0007】

上記障害物検出装置について、前記移動体はフォークリフトであり、前記非検出領域は、前記フォークリフトのカウンタウェイトが存在する位置に設定されていてもよい。
上記障害物検出装置について、前記位置検出部は、水平方向のうち一方向をＸ軸、水平方向のうち前記Ｘ軸に直交する方向の軸をＹ軸、前記Ｘ軸及び前記Ｙ軸に直交する方向の軸をＺ軸とする実空間上の座標系での前記障害物の座標を導出する座標導出部を備えていてもよい。

【0008】

上記障害物検出装置について、前記非検出領域は、前記実空間上の座標系で前記一部が存在する領域を示す３次元座標で規定されていてもよい。
上記課題を解決する障害物検出方法は、移動体に搭載されており、かつ、センサと位置検出部とを備える障害物検出装置によって障害物の位置を検出する障害物検出方法であって、前記位置検出部が、前記センサの検出結果を取得するステップと、前記センサによって前記障害物を検出可能な検出可能領域に予め設定された領域であって前記移動体の一部が存在する領域を非検出領域とすると、前記位置検出部が、前記非検出領域には前記センサの検出結果に関わらず前記障害物が存在しないと判断するステップと、前記位置検出部が、前記検出可能領域のうち前記非検出領域とは異なる領域である検出領域に存在する前記障害物の位置を検出するステップと、を含んでいてもよい。

【0009】

非検出領域には移動体の一部が存在しているため、非検出領域に障害物が存在していないと判断することで、移動体の一部が障害物として検出されることを抑制できる。

【発明の効果】

【0010】

本発明によれば、移動体の一部が障害物として検出されることを抑制できる。

【図面の簡単な説明】

【0011】

【図1】第１実施形態におけるフォークリフトの側面図。

【図2】第１実施形態におけるフォークリフトの平面図。

【図3】第１実施形態におけるフォークリフト及び障害物検出装置の概略構成図。

【図4】ステレオカメラによって撮像された第１画像の一例を示す図。

【図5】位置検出装置が行う障害物検出処理を示すフローチャート。

【図6】検出可能領域、非検出領域及び検出領域を説明するための図。

【図7】ワールド座標系のＸＹ平面における障害物の位置を示す模式図。

【図8】第２実施形態におけるフォークリフトの側面図。

【図9】ステレオカメラによって撮像された第１画像の一例を示す図。

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

【0012】

（第１実施形態）
以下、障害物検出装置及び障害物検出方法の第１実施形態について説明する。
図１及び図２に示すように、移動体としてのフォークリフト１０は、車体１１と、車体１１の前下部に配置された駆動輪１２と、車体１１の後下部に配置された操舵輪１３と、荷役装置１７と、を備える。車体１１は、運転席の上部に設けられたヘッドガード１４と、荷役装置１７に積載される荷と釣り合いを取るためのカウンタウェイト１５と、を備える。カウンタウェイト１５は、車体１１の後部に設けられている。フォークリフト１０は、搭乗者による操作によって動作するものであってもよいし、自動で動作するものであってもよいし、手動での動作と自動での動作を切り替えられるものであってもよい。以下の説明において、左右とは、フォークリフト１０の前進方向を基準とした場合の左右である。

【0013】

図３に示すように、フォークリフト１０は、主制御装置２０と、走行用モータＭ１と、走行用モータＭ１を制御する走行制御装置２３と、回転数センサ２４と、を備える。主制御装置２０は、走行動作及び荷役動作に関する制御を行う。主制御装置２０は、プロセッサ２１と、記憶部２２と、を備える。プロセッサ２１としては、例えば、CPU：Central Processing Unit、GPU：Graphics Processing Unit、DSP：Digital Signal Processorが用いられる。記憶部２２は、RAM：Random access memory及びROM：Read Only Memoryを含む。記憶部２２には、フォークリフト１０を動作させるためのプログラムが記憶されている。記憶部２２は、処理をプロセッサ２１に実行させるように構成されたプログラムコードまたは指令を格納しているといえる。記憶部２２、即ち、コンピュータ可読媒体は、汎用または専用のコンピュータでアクセスできるあらゆる利用可能な媒体を含む。主制御装置２０は、ASIC：Application Specific Integrated CircuitやFPGA：Field Programmable Gate Array等のハードウェア回路によって構成されていてもよい。処理回路である主制御装置２０は、コンピュータプログラムに従って動作する１つ以上のプロセッサ、ASICやFPGA等の１つ以上のハードウェア回路、或いは、それらの組み合わせを含み得る。

【0014】

主制御装置２０は、フォークリフト１０の車速が目標車速となるように走行制御装置２３に走行用モータＭ１の回転数の指令を与える。本実施形態の走行制御装置２３は、モータドライバである。回転数センサ２４は、走行用モータＭ１の回転数を走行制御装置２３に出力する。走行制御装置２３は、主制御装置２０からの指令に基づき、走行用モータＭ１の回転数が指令と一致するように走行用モータＭ１を制御する。

【0015】

フォークリフト１０には、障害物検出装置３０が搭載されている。障害物検出装置３０は、センサとしてのステレオカメラ３１と、ステレオカメラ３１によって撮像された画像から障害物の位置を検出する位置検出装置４１と、を備える。ステレオカメラ３１は、フォークリフト１０の上方からフォークリフト１０の走行する路面を鳥瞰できるように設置されている。本実施形態のステレオカメラ３１は、フォークリフト１０の後方を撮像する。従って、位置検出装置４１で検出される障害物は、フォークリフト１０の後方の障害物となる。

【0016】

図１に示すように、ステレオカメラ３１は、例えば、ヘッドガード１４に設置されている。図２に示すように、ステレオカメラ３１は、フォークリフト１０の車幅方向の中心位置ＣＰからずれて設置されている。本実施形態において、ステレオカメラ３１は、フォークリフト１０の車幅方向の中心位置ＣＰから左方にずれて設置されている。

【0017】

ステレオカメラ３１は、水平画角及び垂直画角によって定まる撮像範囲を撮像する。垂直画角の範囲内には、カウンタウェイト１５が含まれている。従って、ステレオカメラ３１に撮像される画像には、フォークリフト１０の一部であるカウンタウェイト１５の一部が常に入り込むことになる。

【0018】

図３に示すように、ステレオカメラ３１は、第１カメラ３２と、第２カメラ３３と、を備える。第１カメラ３２及び第２カメラ３３としては、例えば、ＣＣＤイメージセンサや、ＣＭＯＳイメージセンサを用いたものが挙げられる。第１カメラ３２及び第２カメラ３３は、互いの光軸が平行となるように配置されている。本実施形態において、第１カメラ３２及び第２カメラ３３は、互いに水平方向に並んで配置されている。第１カメラ３２によって撮像された画像を第１画像、第２カメラ３３によって撮像された画像を第２画像とすると、第１画像と第２画像では同一障害物が横方向にずれて写ることになる。詳細にいえば、同一障害物を撮像した場合、第１画像に写る障害物と、第２画像に写る障害物では、横方向の画素［ｐｘ］に第１カメラ３２と第２カメラ３３との間の距離に応じたずれが生じることになる。第１画像及び第２画像は、画素数が同じであり、例えば、６４０×４８０［ｐｘ］＝ＶＧＡの画像が用いられる。第１画像及び第２画像は、例えば、ＲＧＢ信号で表される画像である。

【0019】

位置検出装置４１は、プロセッサ４２と、記憶部４３と、を備える。プロセッサ４２としては、例えば、CPU、GPU、DSPが用いられる。記憶部４３は、RAM及びROMを含む。記憶部４３には、ステレオカメラ３１によって撮像された画像から障害物を検出するための種々のプログラムが記憶されている。記憶部４３は、処理をプロセッサ４２に実行させるように構成されたプログラムコードまたは指令を格納しているといえる。記憶部４３、即ち、コンピュータ可読媒体は、汎用または専用のコンピュータでアクセスできるあらゆる利用可能な媒体を含む。位置検出装置４１は、ASICやFPGA等のハードウェア回路によって構成されていてもよい。処理回路である位置検出装置４１は、コンピュータプログラムに従って動作する１つ以上のプロセッサ、ASICやFPGA等の１つ以上のハードウェア回路、或いは、それらの組み合わせを含み得る。

【0020】

以下、位置検出装置４１により行われる障害物検出処理について障害物検出方法とともに説明する。記憶部４３に記憶されたプログラムをプロセッサ４２が実行することで障害物検出処理は行われる。障害物検出処理は、所定の制御周期で繰り返し行われる。

【0021】

以下の説明では、一例として、図４に示す環境をステレオカメラ３１によって撮像した場合の障害物検出処理について説明する。図４は、フォークリフト１０の後方を撮像することで得られた第１画像Ｉ１である。第１画像Ｉ１から把握できるように、フォークリフト１０の後方には、人や、人以外の障害物が存在している。第１画像Ｉ１には、カウンタウェイト１５の一部が写り込んでいる。なお、説明の便宜上、障害物が存在する第１画像Ｉ１上の座標を枠Ａ１，Ａ２，Ａ３，Ａ４で示しているが、実際の第１画像Ｉ１には枠Ａ１，Ａ２，Ａ３，Ａ４は存在しない。

【0022】

図５に示すように、ステップＳ１において、位置検出装置４１は、ステレオカメラ３１によって撮像されている映像から同一フレームの第１画像Ｉ１及び第２画像を取得する。第１画像Ｉ１及び第２画像は、ステレオカメラ３１の検出結果である。

【0023】

次に、ステップＳ２において、位置検出装置４１は、ステレオ処理を行うことで、視差画像を取得する。視差画像は、画素に対して視差［ｐｘ］を対応付けた画像である。視差は、第１画像Ｉ１と、第２画像とを比較し、各画像に写る同一特徴点について第１画像Ｉ１と第２画像の画素数の差を算出することで得られる。なお、特徴点とは、障害物のエッジなど、境目として認識可能な部分である。特徴点は、輝度情報などから検出することができる。

【0024】

位置検出装置４１は、各画像を一時的に格納するＲＡＭを用いて、ＲＧＢからＹＣｒＣｂへの変換を行う。なお、位置検出装置４１は、歪み補正、エッジ強調処理などを行ってもよい。位置検出装置４１は、第１画像Ｉ１の各画素と第２画像の各画素との類似度を比較して視差を算出するステレオ処理を行う。なお、ステレオ処理としては、画素毎に視差を算出する手法を用いてもよいし、各画像を複数の画素を含むブロックに分割してブロック毎の視差を算出するブロックマッチング法を用いてもよい。位置検出装置４１は、第１画像Ｉ１を基準画像、第２画像を比較画像として視差画像を取得する。位置検出装置４１は、第１画像Ｉ１の画素毎に、最も類似する第２画像の画素を抽出し、第１画像Ｉ１の画素と、当該画素に最も類似する画素の横方向の画素数の差を視差として算出する。これにより、基準画像である第１画像Ｉ１の各画素に視差が対応付けられた視差画像を取得することができる。視差画像とは、必ずしも表示を要するものではなく、視差画像における各画素に視差が対応付けられたデータのことを示す。なお、位置検出装置４１は、視差画像から路面の視差を除去する処理を行ってもよい。

【0025】

次に、ステップＳ３において、位置検出装置４１は、ワールド座標系における特徴点の座標を導出する。まず、位置検出装置４１は、カメラ座標系における特徴点の座標を導出する。カメラ座標系は、ステレオカメラ３１を原点とする座標系である。カメラ座標系は、光軸をＺ軸とし、光軸に直交する２つの軸のそれぞれをＸ軸、Ｙ軸とする３軸直交座標系である。カメラ座標系における特徴点の座標は、カメラ座標系におけるＺ座標Ｚｃ、Ｘ座標Ｘｃ及びＹ座標Ｙｃで表わすことができる。Ｚ座標Ｚｃ、Ｘ座標Ｘｃ及びＹ座標Ｙｃは、それぞれ、以下の（１）式～（３）式を用いて導出することができる。

【0026】

【数1】

【0027】

【数2】

【0028】

【数3】

（１）式～（３）式におけるＢは基線長［ｍｍ］、ｆは焦点距離［ｍｍ］、ｄは視差［ｐｘ］である。ｘｐは視差画像中の任意のＸ座標であり、ｘ’は視差画像の中心座標のＸ座標である。ｙｐは視差画像中の任意のＹ座標であり、ｙ’は視差画像の中心座標のＹ座標である。

【0029】

ｘｐを視差画像中の特徴点のＸ座標とし、ｙｐを視差画像中の特徴点のＹ座標とし、ｄを特徴点の座標に対応付けられた視差とすることで、カメラ座標系における特徴点の座標が導出される。

【0030】

ここで、フォークリフト１０が水平面に位置している状態で、水平方向のうちフォークリフト１０の車幅方向に延びる軸をＸ軸、水平方向のうちＸ軸に直交する方向に延びる軸をＹ軸、Ｘ軸及びＹ軸に直交する軸をＺ軸とする３軸直交座標系を実空間上での座標系であるワールド座標系とする。ワールド座標系のＹ軸は、フォークリフト１０の進行方向であるフォークリフト１０の前後方向に延びる軸ともいえる。ワールド座標系のＺ軸は、鉛直方向に延びる軸ともいえる。ワールド座標系での特徴点の座標は、ワールド座標系におけるＸ座標Ｘｗ、Ｙ座標Ｙｗ及びＺ座標Ｚｗで表わすことができる。

【0031】

位置検出装置４１は、以下の（４）式を用いてカメラ座標をワールド座標に変換するワールド座標変換を行う。ワールド座標とは、ワールド座標系における座標である。

【0032】

【数4】

ここで、（４）式におけるＨはワールド座標系におけるステレオカメラ３１の設置高さ［ｍｍ］であり、θは第１カメラ３２及び第２カメラ３３の光軸と、水平面とがなす角＋９０°の角度である。

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

○各実施形態において、障害物検出装置３０は、センサとして、ワールド座標系における３次元座標を取得できるセンサであってステレオカメラ３１以外のもの用いてもよい。この種のセンサとしては、例えば、LIDAR：Laser Imaging Detection and Ranging、ミリ波レーダー、ToF:Time of Flightカメラを挙げることができる。LIDARは、照射角度を変更しながらレーザーを照射し、レーザーが当たった部分から反射された反射光を受光することで周辺環境を認識可能な距離計である。ミリ波レーダーとは、所定の周波数帯域の電波を周囲に照射することで周辺環境を認識可能なものである。TOFカメラは、カメラと、光を照射する光源と、を備え、光源から照射された光の反射光を受光するまでの時間からカメラによって撮像された画像の画素毎に奥行き方向の距離を導出するものである。センサとしては、上記したセンサの組み合わせであってもよい。

【0074】

○各実施形態において、障害物検出装置３０は、センサとして、水平方向への照射角度を変更しながらレーザーを照射する二次元のLIDARを備えていてもよい。LIDARは、照射可能角度の範囲内で、照射角度を変更しながらレーザーを照射する。照射可能角度は、例えば、水平方向に対して２７０度である。２次元のLIDARの検出可能領域ＣＡとは、照射可能角度と測定可能距離によって規定される範囲である。レーザーが当たった部分を照射点とすると、２次元のLIDARは照射点までの距離を照射角度に対応付けて測定可能である。２次元のLIDARは、２次元のLIDARを原点とした場合の照射点の２次元座標を測定可能であるといえる。２次元のLIDARにより測定される２次元座標は、水平方向のうち一方向をＸ軸、水平方向のうちＸ軸に直交する方向をＹ軸とするワールド座標系の座標である。この場合、非検出領域は、２次元座標で規定される。

【0075】

○各実施形態において、ステレオカメラ３１の設置位置は適宜変更してもよい。ステレオカメラ３１は、例えば、中心位置ＣＰに設置されていてもよい。この場合、ワールド座標系のＸ軸の原点と中心位置ＣＰとが一致するため、第１条件は、以下のように変更することができる。

【0076】

第１条件…－Ｗ１／２≦Ｘｗ≦Ｗ１／２
このように、ステレオカメラ３１の設置位置の変更などによりワールド座標系の座標軸が実施形態から変更された場合、各条件はこれに合わせて変更される。

【0077】

○各実施形態において、非検出領域は、ステレオカメラ３１によって撮像される画像に設定されていてもよい。第１画像Ｉ１を例に挙げて説明すると、ステレオカメラ３１の設置位置、設置角度から、第１画像Ｉ１のうちカウンタウェイト１５が写る座標は予め把握することができる。第１画像Ｉ１のうちカウンタウェイト１５が写る座標を非検出領域として設定し、非検出領域については視差が算出されないようにする。非検出領域は、第１画像Ｉ１及び第２画像のうち少なくとも一方に設定されていればよい。カウンタウェイト１５が写る位置については、特徴点が得られなくなるため、各実施形態と同様の効果を得ることができる。同様に、ミラー１８及び支持部１９についても画像に写る座標を非検出領域として設定することができる。画像に非検出領域を設定する場合、検出可能領域ＣＡは、ステレオカメラ３１によって撮像される画像に入り込む範囲となる。詳細にいえば、ステレオカメラ３１によって撮像される画像のうち視差画像を取得できる範囲である。

【0078】

○各実施形態において、非検出領域ＮＡ１，ＮＡ２は、フォークリフト１０の一部が存在している領域を含んでいればよく、フォークリフト１０の一部が存在している領域よりも大きな領域であってもよい。即ち、非検出領域ＮＡ１，ＮＡ２はマージンを含んだ領域であってもよい。

【0079】

○各実施形態において、位置検出装置４１は、ステップＳ５で特徴点をクラスタ化して障害物を抽出した後に、各障害物が非検出領域ＮＡ１に存在しているか否かを判定してもよい。位置検出装置４１は、非検出領域ＮＡ１に存在している障害物は存在していないとみなす。位置検出装置４１は、非検出領域ＮＡ１の内外に跨がっている障害物については、非検出領域ＮＡ１に存在しているとみなすようにしてもよいし、非検出領域ＮＡ１外に存在しているとみなすようにしてもよい。位置検出装置４１は、非検出領域ＮＡ１の内外に跨がって障害物が存在している場合、非検出領域ＮＡ１外に存在している部分のみを障害物とみなしてもよい。

【0080】

○各実施形態において、検出可能領域ＣＡのうち非検出領域ＮＡ１，ＮＡ２以外の全体を検出領域ＤＡとしてもよいし、検出可能領域ＣＡのうち非検出領域ＮＡ１，ＮＡ２以外の一部を検出領域ＤＡとしてもよい。

【0081】

○各実施形態において、位置検出装置４１は、ステップＳ６の処理を行った後に、検出した障害物が人か人以外の物体かを判定する処理を行ってもよい。障害物が人か否かの判定は、種々の方法で行うことができる。例えば、位置検出装置４１は、ステレオカメラ３１の２つのカメラ３２，３３のうちいずれかで撮像された画像に対して、人検出処理を行うことで、障害物が人か否かの判定を行う。位置検出装置４１は、ステップＳ６で得られたワールド座標系における障害物の座標をカメラ座標に変換し、当該カメラ座標をカメラ３２，３３によって撮像された画像の座標に変換する。例えば、位置検出装置４１は、ワールド座標系における障害物の座標を第１画像Ｉ１の座標に変換する。位置検出装置４１は、第１画像Ｉ１における障害物の座標に対して、人検出処理を行う。人検出処理は、例えば、特徴量抽出と、事前に機械学習を行った人判定器と、を用いて行われる。特徴量抽出としては、例えば、HOG：Histogram of Oriented Gradients特徴量、Haar-Like特徴量などの画像における局所領域の特徴量を抽出する手法が挙げられる。人判定器としては、例えば、教師有り学習モデルによる機械学習を行ったものが用いられる。教師有り学習モデルとしては、例えば、サポートベクタマシン、ニューラルネットワーク、ナイーブベイズ、ディープラーニング、決定木等を採用することが可能である。機械学習に用いる教師データとしては、画像から抽出された人の形状要素や、外観要素などの画像固有成分が用いられる。形状要素として、例えば、人の大きさや輪郭などが挙げられる。外観要素としては、例えば、光源情報、テクスチャ情報、カメラ情報などが挙げられる。光源情報には、反射率や、陰影等に関する情報が含まれる。テクスチャ情報には、カラー情報等が含まれる。カメラ情報には、画質、解像度、画角等に関する情報が含まれる。

【0082】

人検出処理に要する時間は長いため、画像から人を検出する場合、障害物が存在する座標を特定し、その座標に対して人検出処理を行う。座標を指定して人検出処理を行うことで、画像の全域に対して人検出処理を行う場合に比べて、人検出処理に要する時間を短くできる。カウンタウェイト１５等のフォークリフト１０の一部が障害物と判断されないことで、画像のうちフォークリフト１０の一部が写る座標には、人検出処理が行われない。従って、フォークリフト１０の一部が障害物として検出され、この障害物が写る座標に対して人検出処理が行われる場合に比べて、処理時間の短縮を図ることができる。

【0083】

○各実施形態では、ステレオカメラ３１よりも後方に位置するカウンタウェイト１５の全体を非検出領域ＮＡ１としたが、ステレオカメラ３１によって撮像される範囲を考慮して非検出領域ＮＡ１を設定してもよい。図１及び図２から把握できるように、ステレオカメラ３１の設置位置やステレオカメラ３１の垂直画角によっては、ステレオカメラ３１よりも後方に位置するカウンタウェイト１５であっても、ステレオカメラ３１の撮像範囲に入り込まない部分が存在する。従って、ステレオカメラ３１の撮像範囲に入り込まない部分については非検出領域ＮＡ１に含めなくてもよい。例えば、実施形態のように第２条件が設定されている場合、第２条件のＹ座標Ｙｗの下限を０よりも大きな値としてもよい。

【0084】

○各実施形態において、車両諸元を記憶するのに代えて、非検出領域を規定する座標を位置検出装置４１の記憶部４３に記憶してもよい。非検出領域ＮＡ１であれば、座標Ｐ１～Ｐ８を記憶しておけばよい。

【0085】

○各実施形態において、障害物検出装置３０は、フォークリフト１０の前方に位置する障害物を検出するものであってもよい。この場合、ステレオカメラ３１は、フォークリフト１０の前方を撮像するように設置される。ステレオカメラ３１がフォークリフト１０の前方を撮像する場合であっても、ステレオカメラ３１の設置位置によっては、フォークリフト１０の一部がステレオカメラ３１の検出可能領域ＣＡに入り込む。非検出領域は、検出可能領域ＣＡに入り込むフォークリフト１０の一部に合わせて設定される。また、障害物検出装置３０は、フォークリフト１０の前方及び後方の両側の障害物を検出するものであってもよい。この場合、ステレオカメラ３１は、フォークリフト１０の前方を撮像するものと、フォークリフト１０の後方を撮像するものの両方が設けられる。

【0086】

○各実施形態において、ワールド座標系は、直交座標系に限られず、極座標系としてもよい。
○各実施形態において、位置検出部は、複数の装置によって構成されていてもよい。例えば、位置検出部は、非検出部として機能する装置と、検出部として機能する装置と、座標導出部として機能する装置と、を個別に備えていてもよい。

【0087】

○各実施形態において、カメラ座標からワールド座標への変換はテーブルデータによって行われてもよい。テーブルデータは、Ｙ座標ＹｃとＺ座標Ｚｃの組み合わせにＹ座標Ｙｗを対応させたテーブルデータと、Ｙ座標ＹｃとＺ座標Ｚｃとの組み合わせにＺ座標Ｚｗを対応させたテーブルデータである。これらのテーブルデータを位置検出装置４１の記憶部４３などに記憶しておくことで、カメラ座標系におけるＹ座標ＹｃとＺ座標Ｚｃから、ワールド座標系におけるＹ座標Ｙｗ及びＺ座標Ｚｗを求めることができる。なお、実施形態では、カメラ座標系におけるＸ座標Ｘｃと、ワールド座標系におけるＸ座標Ｘｗとは一致するため、Ｘ座標Ｘｗを求めるためのテーブルデータは記憶されない。

【0088】

○各実施形態において、第１カメラ３２と第２カメラ３３は、鉛直方向に並んで配置されていてもよい。
○各実施形態において、障害物検出装置３０は、位置検出装置４１の記憶部４３に記憶されている情報など、種々の情報を記憶するように構成された補助記憶装置を備えていてもよい。補助記憶装置としては、例えば、ハードディスクドライブ、ソリッドステートドライブ、EEPROM：Electrically Erasable Programmable Read Only Memory等の、データを書き換え可能な不揮発性記憶装置が用いられる。

【0089】

○各実施形態において、ステレオカメラ３１は、３つ以上のカメラを備えていてもよい。
○各実施形態において、ステレオカメラ３１は、荷役装置１７等、どのような位置に取り付けられていてもよい。

【0090】

○各実施形態において、フォークリフト１０は、エンジンの駆動によって走行するものでもよい。この場合、走行制御装置は、エンジンへの燃料噴射量などを制御する装置となる。

【0091】

○各実施形態において、フォークリフト１０の一部は、カウンタウェイト１５、ミラー１８及び支持部１９以外であってもよく、フォークリフト１０の一部であって検出可能領域ＣＡに入り込むものであれば、どのようなものであってもよい。

【0092】

○各実施形態において、障害物検出装置３０は、建設機械、自動搬送車、トラックなどのフォークリフト１０以外の産業車両、乗用車、及び飛行体など、種々の移動体に搭載することができる。

【符号の説明】

【0093】

ＣＡ…検出可能領域、ＤＡ…検出領域、ＮＡ１，ＮＡ２…非検出領域、１０…移動体としてのフォークリフト、１５…フォークリフトの一部であるカウンタウェイト、１８…フォークリフトの一部であるミラー、１９…フォークリフトの一部である支持部、３０…障害物検出装置、３１…センサとしてのステレオカメラ、４１…位置検出部、非検出部、検出部及び座標導出部としての位置検出装置。

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】