特許 7491238 障害物検知システム

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

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

(11)【特許番号】

(24)【登録日】2024-05-20

(45)【発行日】2024-05-28

(54)【発明の名称】障害物検知システム

(51)【国際特許分類】

   B66F 9/24 20060101AFI20240521BHJP

   B66F 9/12 20060101ALI20240521BHJP

【ＦＩ】

B66F9/24 L

B66F9/12 D

【請求項の数】 6

(21)【出願番号】P 2021023225

(22)【出願日】2021-02-17

(65)【公開番号】P2022125568

(43)【公開日】2022-08-29

【審査請求日】2023-05-16

(73)【特許権者】

【識別番号】000003218

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

(74)【代理人】

【識別番号】100088155

【弁理士】

【氏名又は名称】長谷川 芳樹

(74)【代理人】

【識別番号】100113435

【弁理士】

【氏名又は名称】黒木 義樹

(74)【代理人】

【識別番号】100124062

【弁理士】

【氏名又は名称】三上 敬史

(74)【代理人】

【識別番号】100148013

【弁理士】

【氏名又は名称】中山 浩光

(72)【発明者】

【氏名】岸田 匡弘

【審査官】須山 直紀

(56)【参考文献】

【文献】特表２０１２－５０２８６１（ＪＰ，Ａ）

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

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

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

【文献】米国特許出願公開第２０１９／０２８７４０５（ＵＳ，Ａ１）

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

Ｂ６６Ｆ ９／２４

Ｂ６６Ｆ ９／１２

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

【請求項1】

産業車両の周囲に存在する障害物を検知する障害物検知システムにおいて、
前記産業車両の作業支援に使用されるオプションユニットが前記産業車両に取り付けられたかどうかを判定するオプション有無判定部と、
前記オプション有無判定部により前記オプションユニットが前記産業車両に取り付けられたと判定されたときに、前記障害物として検知することを許可しない障害物検知マスク範囲を設定する検知マスク範囲設定部と、
前記検知マスク範囲設定部により設定された前記障害物検知マスク範囲に基づいて、前記障害物として検知することを許可する障害物検知エリアを決定する検知エリア決定部と、
前記検知エリア決定部により決定された前記障害物検知エリアにおいて前記障害物を検知する障害物検知部とを備え、
前記検知マスク範囲設定部は、前記オプションユニットを含む領域を前記障害物検知マスク範囲として設定する障害物検知システム。

【請求項2】

前記産業車両に対する前記オプションユニットの位置を検出するオプション位置検出部を更に備え、
前記検知マスク範囲設定部は、前記オプション位置検出部により検出された前記産業車両に対する前記オプションユニットの位置に応じて、前記障害物検知マスク範囲を変更する請求項１記載の障害物検知システム。

【請求項3】

前記オプションユニットには、検出信号を出力するセンサが固定されており、
前記オプション有無判定部は、前記センサの検出信号に基づいて、前記オプションユニットが前記産業車両に取り付けられたかどうかを判定する請求項１または２記載の障害物検知システム。

【請求項4】

前記オプション有無判定部による判定結果に応じた通知を行う通知部を更に備え、
前記通知部は、前記オプション有無判定部において前記センサの検出信号を取得しないときは、前記オプションユニットが前記産業車両に取り付けられていない旨の通知を行う請求項３記載の障害物検知システム。

【請求項5】

前記オプション有無判定部は、前記オプションユニットを使用する作業に関する情報に基づいて、前記オプションユニットが前記産業車両に取り付けられたかどうかを判定する請求項１～４の何れか一項記載の障害物検知システム。

【請求項6】

前記オプション有無判定部により前記オプションユニットが前記産業車両に取り付けられたと判定されると、前記オプションユニットの種類を識別するオプション識別部を更に備え、
前記検知マスク範囲設定部は、前記オプション識別部により識別された前記オプションユニットの種類に基づいて、前記オプションユニットを含む領域を前記障害物検知マスク範囲として設定する請求項１～５の何れか一項記載の障害物検知システム。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、障害物検知システムに関する。

【背景技術】

【0002】

例えば特許文献１には、環境マップを記憶する環境マップ記憶部と、環境マップに示された走行の妨げとなる障害物の中から時間の経過に伴って位置または有無が変化し得る一時障害物を抽出する一時障害物抽出部と、一時障害物に関するデータに基づいて、環境マップ記憶部に記憶された環境マップを更新する環境マップ更新部とを備えた無人作業システムが記載されている。

【先行技術文献】

【特許文献】

【0003】

【文献】特開２０２０－１４０５９４号公報

【発明の概要】

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

【0004】

ところで、自律走行用の産業車両においては、レーザセンサを用いて、産業車両の周囲に存在する障害物を検知することがある。しかし、産業車両の作業支援を行うためのオプションユニットが産業車両に取り付けられた状態では、オプションユニットにレーザセンサのレーザ点が当たると、オプションユニットが障害物であると検知される。例えばフォークリフトのフォークにオプションユニットの１つであるサヤフォークが装着された場合には、サヤフォークの高さによってはレーザセンサのレーザ点が当たるため、サヤフォークが障害物であると検知されてしまう。

【0005】

本発明の目的は、産業車両に取り付けられたオプションユニットを障害物として誤検知することを防止できる障害物検知システムを提供することである。

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

【0006】

本発明の一態様は、産業車両の周囲に存在する障害物を検知する障害物検知システムにおいて、産業車両の作業支援に使用されるオプションユニットが産業車両に取り付けられたかどうかを判定するオプション有無判定部と、オプション有無判定部によりオプションユニットが産業車両に取り付けられたと判定されたときに、障害物として検知することを許可しない障害物検知マスク範囲を設定する検知マスク範囲設定部と、検知マスク範囲設定部により設定された障害物検知マスク範囲に基づいて、障害物として検知することを許可する障害物検知エリアを決定する検知エリア決定部と、検知エリア決定部により決定された障害物検知エリアにおいて障害物を検知する障害物検知部とを備え、検知マスク範囲設定部は、オプションユニットを含む領域を障害物検知マスク範囲として設定する。

【0007】

このような障害物検知システムにおいては、オプションユニットが産業車両に取り付けられたと判定されると、障害物として検知することを許可しない障害物検知マスク範囲が設定される。そして、障害物検知マスク範囲に基づいて、障害物として検知することを許可する障害物検知エリアが決定され、その障害物検知エリアにおいて障害物の検知が行われる。ここで、オプションユニットを含む領域が障害物検知マスク範囲として設定される。これにより、産業車両に取り付けられたオプションユニットが障害物として誤検知されることが防止される。

【0008】

障害物検知システムは、産業車両に対するオプションユニットの位置を検出するオプション位置検出部を更に備え、検知マスク範囲設定部は、オプション位置検出部により検出された産業車両に対するオプションユニットの位置に応じて、障害物検知マスク範囲を変更してもよい。このような構成では、産業車両に対するオプションユニットの位置が変わると、そのオプションユニットの位置に応じて障害物検知マスク範囲が変更される。従って、現状のオプションユニットの位置に適した障害物検知マスク範囲が得られる。

【0009】

オプションユニットには、検出信号を出力するセンサが固定されており、オプション有無判定部は、センサの検出信号に基づいて、オプションユニットが産業車両に取り付けられたかどうかを判定してもよい。このような構成では、オプションユニットが産業車両に取り付けられた状態で、産業車両を始動させると、オプションユニットに固定されたセンサから検出信号が出力される。従って、センサの検出信号によって、オプションユニットが産業車両に取り付けられたか否かを容易に且つ確実に判定することができる。

【0010】

障害物検知システムは、オプション有無判定部による判定結果に応じた通知を行う通知部を更に備え、通知部は、オプション有無判定部においてセンサの検出信号を取得しないときは、オプションユニットが産業車両に取り付けられていない旨の通知を行ってもよい。このような構成では、産業車両を始動させても、センサの検出信号が取得されないときは、オプションユニットが産業車両に取り付けられていないと判定され、その旨の通知が行われる。従って、担当者は、オプションユニットの付け忘れを知ることができる。

【0011】

オプション有無判定部は、オプションユニットを使用する作業に関する情報に基づいて、オプションユニットが産業車両に取り付けられたかどうかを判定してもよい。このような構成では、産業車両が始動されると、オプションユニットを使用する作業に関する情報が産業車両に送られる。従って、オプションユニットに固定されたセンサが故障している場合、或いはオプションユニットにセンサが固定されていない場合でも、オプションユニットを使用する作業に関する情報によって、オプションユニットが産業車両に取り付けられたか否かを判定することができる。

【0012】

障害物検知システムは、オプション有無判定部によりオプションユニットが産業車両に取り付けられたと判定されると、オプションユニットの種類を識別するオプション識別部を更に備え、検知マスク範囲設定部は、オプション識別部により識別されたオプションユニットの種類に基づいて、オプションユニットを含む領域を障害物検知マスク範囲として設定してもよい。このような構成では、オプションユニットが産業車両に取り付けられると、オプションユニットの種類が識別され、オプションユニットの種類に応じた障害物検知マスク範囲が設定される。従って、オプションユニットの種類が複数あっても、オプションユニットの種類に適した障害物検知マスク範囲が得られる。

【発明の効果】

【0013】

本発明によれば、産業車両に取り付けられたオプションユニットを障害物として誤検知することを防止できる。

【図面の簡単な説明】

【0014】

【図1】本発明の一実施形態に係る障害物検知システムの一部を具備したフォークリフトを示す側面図である。

【図2】本発明の一実施形態に係る障害物検知システムを含む荷役制御システムを示す概略構成図である。

【図3】図１に示されたフォークリフトがトラックの荷台に対して入荷を行う様子を、障害物検知マスク範囲及び障害物検知エリアと共に示す平面図である。

【図4】図２に示されたコントローラにより実行されるオプション有無判定処理から障害物検知エリア決定処理までの手順の詳細を示すフローチャートである。

【図5】図１に示されたサヤフォークの高さ位置に応じて障害物検知マスク範囲が変わる様子を示す側面図である。

【図6】図４に示されたオプション有無判定処理から障害物検知エリア決定処理までの手順の変形例を示すフローチャートである。

【図7】本発明の他の実施形態に係る障害物検知システムを含む荷役制御システムを示す概略構成図である。

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

【0015】

以下、本発明の実施形態について図面を参照して詳細に説明する。なお、図面において、同一または同等の要素には同じ符号を付し、重複する説明を省略する。

【0016】

図１は、本発明の一実施形態に係る障害物検知システムの一部を具備したフォークリフトを示す側面図である。図１において、本実施形態に係るフォークリフト１は、例えばバッテリー式の自律走行用フォークリフトである。フォークリフト１は、車体２と、この車体２の前側に配置された荷役装置３とを備えている。

【0017】

荷役装置３は、車体２の前部に傾動可能に支持されたアウターマスト４と、このアウターマスト４の車幅方向内側に配置されると共に、アウターマスト４に昇降可能に支持されたインナーマスト５と、このインナーマスト５に昇降可能に支持されたリフトブラケット６と、このリフトブラケット６に取り付けられた１対のＬ字型のフォーク７と、このフォーク７を昇降させるリフトシリンダ８と、フォーク７を傾動させるティルトシリンダ９とを備えている。

【0018】

１対のフォーク７は、フォークリフト１の左右方向に間隔を持って並んで配置されている。これらのフォーク７には、荷物（図示せず）が積載される。荷物は、パレット１２（図３参照）の上に置かれる。パレット１２には、各フォーク７が差し込まれる２つのフォーク穴（図示せず）が設けられている。フォークリフト１は、各フォーク７によりパレット１２を持ち上げた状態で、パレット１２を運搬する。

【0019】

図２は、本発明の一実施形態に係る障害物検知システムを含む荷役制御システムを示す概略構成図である。荷役制御システム１０は、例えば図３に示されるように、トラック１１の荷台１１ａに対して荷役を実施するようにフォークリフト１を自動制御する装置である。具体的には、荷役制御システム１０は、入荷時に荷物が置かれたパレット１２をトラック１１の荷台１１ａから降ろしたり、出荷時に荷物が置かれたパレット１２をトラック１１の荷台１１ａに積み込む。

【0020】

パレット１２は、トラック１１の荷台１１ａに２列で積まれる。フォークリフト１は、図１及び図３に示されるように、トラック１１の荷台１１ａの手前側及び奥側に配置された２つのパレット１２を同時に保持するための１対のサヤフォーク１３を備えている。サヤフォーク１３は、フォークリフト１に着脱可能に取り付けられるアタッチメントである。アタッチメントは、荷物及び作業内容等に合わせてフォークリフト１の作業支援を行うために使用されるオプションユニットの一つである。

【0021】

サヤフォーク１３は、フォークリフト１の各フォーク７に装着される。サヤフォーク１３は、フォーク７の前後長よりも長い。サヤフォーク１３は、フォーク７の先端側部分に被せられた状態で固定される。１対のサヤフォーク１３は、１対のフォーク７に対応して、フォークリフト１の左右方向に間隔を持って並んで配置されている。

【0022】

図２において、荷役制御システム１０は、自律走行管理装置１５と、送受信機１６と、複数の超音波センサ１７（図１参照）と、揚高センサ１８と、レーザセンサ１９と、コントローラ２０と、走行駆動部２１と、荷役駆動部２２とを備えている。送受信機１６、超音波センサ１７、揚高センサ１８、レーザセンサ１９、コントローラ２０、走行駆動部２１及び荷役駆動部２２は、フォークリフト１に搭載されている。

【0023】

自律走行管理装置１５は、例えば建屋内に設置されている。自律走行管理装置１５は、フォークリフト１の自律走行に関する管理全般を行う。自律走行管理装置１５は、特に図示はしないが、制御ユニット、入力器及び警報器等を備えている。

【0024】

入力器は、入荷スイッチ及び出荷スイッチ等を有している。入荷スイッチが操作されると、制御ユニットにおいて入荷作業モードが設定される。すると、制御ユニットによって、入荷作業に関する制御処理が実行されると共に、入荷作業モード情報がフォークリフト１に送信される。出荷スイッチが操作されると、制御ユニットにおいて出荷作業モードが設定される。すると、制御ユニットによって、出荷作業に関する制御処理が実行されると共に、出荷作業モード情報がフォークリフト１に送信される。

【0025】

入荷作業モード及び出荷作業モードは、フォークリフト１のフォーク７に装着されるオプションユニットであるサヤフォーク１３を使用する作業モードである。このため、入荷作業モード情報及び出荷作業モード情報は、オプションユニットを使用する作業に関する情報に相当する。なお、入荷作業モード情報及び出荷作業モード情報を、総称して作業モード情報という。

【0026】

送受信機１６は、自律走行管理装置１５との間で無線通信による送受信を行う。超音波センサ１７は、各サヤフォーク１３に複数ずつ固定されている（図１参照）。超音波センサ１７は、サヤフォーク１３からトラック１１の荷台１１ａまでの距離を検出するセンサである。

【0027】

揚高センサ１８は、フォークリフト１の車体２に対するフォーク７またはサヤフォーク１３の高さ位置を検出するセンサである。揚高センサ１８は、フォークリフト１に対するサヤフォーク１３の位置を検出するオプション位置検出部を構成する。

【0028】

レーザセンサ１９は、フォークリフト１の周囲にレーザを照射し、そのレーザの反射光を受光することで、フォークリフト１の周囲に存在する物体を検出する。フォークリフト１の周囲に存在する物体としては、例えば壁や柱等のように地図として登録される物体と、他車両等の移動体、荷物またはコンテナ等のように地図として登録されない物体とがある。レーザセンサ１９としては、例えば２次元のレーザを照射する２Ｄタイプまたは３次元のレーザを照射する３Ｄタイプのレーザレンジファインダが用いられる。

【0029】

超音波センサ１７、揚高センサ１８及びレーザセンサ１９は、フォークリフト１の電源が投入されることでフォークリフト１が始動されると、検出信号としての電気信号を出力する。

【0030】

コントローラ２０は、ＣＰＵ、ＲＡＭ、ＲＯＭ及び入出力インターフェース等により構成されている。コントローラ２０は、オプション有無判定部３１と、検知マスク範囲設定部３２と、検知エリア決定部３３と、通知部３４と、障害物認識部３５と、荷台姿勢算出部３６と、走行制御部３７と、荷役制御部３８とを有している。

【0031】

ここで、自律走行管理装置１５、送受信機１６、超音波センサ１７、揚高センサ１８、レーザセンサ１９、コントローラ２０のオプション有無判定部３１、検知マスク範囲設定部３２、検知エリア決定部３３、通知部３４及び障害物認識部３５は、本実施形態の障害物検知システム３０を構成している。

【0032】

障害物検知システム３０は、フォークリフト１により荷役を実施する際に、フォークリフト１の周囲に存在する障害物を検知する。フォークリフト１の周囲に存在する障害物は、他車両、荷物またはコンテナ等といった地図として登録されない物体（前述）である。そのような障害物は、位置及び有無が変化する。

【0033】

オプション有無判定部３１は、自律走行管理装置１５から送信された作業モード情報と超音波センサ１７の検出信号とに基づいて、オプションユニットであるサヤフォーク１３がフォークリフト１に取り付けられたかどうかを判定する。

【0034】

検知マスク範囲設定部３２は、オプション有無判定部３１によりサヤフォーク１３がフォークリフト１に取り付けられたと判定されたときに、揚高センサ１８により検出されたサヤフォーク１３の高さ位置に基づいて、障害物として検知することを許可しない障害物検知マスク範囲を設定する。このとき、検知マスク範囲設定部３２は、１対のサヤフォーク１３を含む領域を障害物検知マスク範囲として設定する。また、検知マスク範囲設定部３２は、サヤフォーク１３の高さ位置に応じて、障害物検知マスク範囲を変更する。検知マスク範囲設定部３２の機能については、後で詳述する。

【0035】

検知エリア決定部３３は、検知マスク範囲設定部３２により設定された検知マスク範囲に基づいて、障害物として検知することを許可する障害物検知エリアを決定する。検知エリア決定部３３の機能については、後で詳述する。

【0036】

通知部３４は、送受信機１６と協働して、オプション有無判定部３１による判定結果に応じた通知を自律走行管理装置１５に対して行う。具体的には、通知部３４は、オプション有無判定部３１において超音波センサ１７の検出信号を取得しないときは、サヤフォーク１３がフォークリフト１に取り付けられていない旨の通知を自律走行管理装置１５に対して行う。

【0037】

障害物認識部３５は、レーザセンサ１９の検出データに基づいて、検知エリア決定部３３により決定された障害物検知エリアにおいて障害物を認識する。障害物認識部３５は、レーザセンサ１９と協働して、障害物検知エリアにおいて障害物を検知する障害物検知部を構成している。

【0038】

荷台姿勢算出部３６は、サヤフォーク１３をパレット１２のフォーク穴（図示せず）に差し込む際に実行される。荷台姿勢算出部３６は、複数の超音波センサ１７の検出値に基づいて、トラック１１の荷台１１ａの傾き（姿勢）を算出する。

【0039】

走行制御部３７は、トラック１１と荷物置き場（図示せず）との間でフォークリフト１を走行させるように走行駆動部２１を制御する。走行駆動部２１は、例えば走行モータ及び操舵モータを有している。走行制御部３７は、障害物認識部３５によりフォークリフト１が走行する経路上に障害物が存在することが検知されると、例えばフォークリフト１を緊急停止させるように走行駆動部２１を制御してもよい。

【0040】

荷役制御部３８は、荷役装置３により荷役を行うように荷役駆動部２２を制御する。荷役駆動部２２は、例えばリフトシリンダ８及びティルトシリンダ９を駆動する電磁コントロールバルブユニットである。荷役制御部３８は、荷台姿勢算出部３６により算出されたトラック１１の荷台１１ａの傾きに基づいて、サヤフォーク１３が荷台１１ａを擦らないように荷役駆動部２２を制御する。また、荷役制御部３８は、障害物認識部３５によりサヤフォーク１３が通過する箇所に障害物が存在することが検知されると、例えばサヤフォーク１３を緊急停止させるように荷役駆動部２２を制御してもよい。

【0041】

図４は、コントローラ２０により実行されるオプション有無判定処理から障害物検知エリア決定処理までの手順の詳細を示すフローチャートである。本処理は、フォークリフト１の電源が投入されると、実行される。

【0042】

図４において、コントローラ２０は、まず自律走行管理装置１５から送信された作業モード情報を送受信機１６を介して取得したかどうかを判断する（手順Ｓ１０１）。コントローラ２０は、作業モード情報を取得したと判断したときは、超音波センサ１７の検出信号を取得したかどうかを判断する（手順Ｓ１０２）。

【0043】

コントローラ２０は、超音波センサ１７の検出信号を取得したと判断したときは、フォークリフト１のフォーク７にサヤフォーク１３が装着されていると認識する（手順Ｓ１０３）。このとき、コントローラ２０は、超音波センサ１７の出力電流値に基づいて、フォーク７にサヤフォーク１３が装着されているかどうかを認識してもよいし、或いは超音波センサ１７の出力信号に含まれるTopicまたはMac Address等に基づいて、フォーク７にサヤフォーク１３が装着されているかどうかを認識してもよい。

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

１…フォークリフト（産業車両）、１３…サヤフォーク（オプションユニット）、１６…送受信機（通知部）、１７…超音波センサ（センサ）、１８…揚高センサ（オプション位置検出部）、１９…レーザセンサ（障害物検知部）、３０…障害物検知システム、３１…オプション有無判定部、３２…検知マスク範囲設定部、３３…検知エリア決定部、３４…通知部、３５…障害物認識部（障害物検知部）、３９…オプション識別部、Ａ…障害物検知エリア、Ｂ…障害物検知マスク範囲。

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】