JP7392962B2 - 空間認識装置、空間認識方法、プログラム - Google Patents
空間認識装置、空間認識方法、プログラム Download PDFInfo
- Publication number
- JP7392962B2 JP7392962B2 JP2017170376A JP2017170376A JP7392962B2 JP 7392962 B2 JP7392962 B2 JP 7392962B2 JP 2017170376 A JP2017170376 A JP 2017170376A JP 2017170376 A JP2017170376 A JP 2017170376A JP 7392962 B2 JP7392962 B2 JP 7392962B2
- Authority
- JP
- Japan
- Prior art keywords
- reflected light
- reflector
- intensity
- range
- detection range
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 18
- 238000004458 analytical method Methods 0.000 claims description 46
- 238000001514 detection method Methods 0.000 claims description 36
- 230000003287 optical effect Effects 0.000 claims description 8
- 230000006870 function Effects 0.000 claims description 4
- 230000008447 perception Effects 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 16
- 238000004891 communication Methods 0.000 description 6
- 238000007796 conventional method Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000003909 pattern recognition Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000032258 transport Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/74—Systems using reradiation of electromagnetic waves other than radio waves, e.g. IFF, i.e. identification of friend or foe
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/46—Indirect determination of position data
- G01S17/48—Active triangulation systems, i.e. using the transmission and reflection of electromagnetic waves other than radio waves
Landscapes
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Forklifts And Lifting Vehicles (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Warehouses Or Storage Devices (AREA)
Description
本発明は、空間認識装置、空間認識方法、プログラムに関する。
ある空間内を移動する移動体の位置を認識するために、照射した光の反射光を解析する技術が特許文献１、特許文献２に開示されている。
静止構造物が同じパターンで数多く並んでいるような空間内に多様な物体が載置される際に、移動体の位置を容易に低コストに認識できる技術が必要となっている。
そこでこの発明は、上述の課題を解決することのできる空間認識装置、空間認識方法、プログラムを提供することを目的としている。
本発明の第１の態様によれば、空間認識装置は、検出範囲に位置する複数の静止構造物それぞれの高さ方向に異なる位置に設けられた反射板に光を照射しその反射光を受光する移動体に取り付けられた光学装置から前記光の照射方向に応じた反射光から得られる情報を取得し、前記検出範囲の各座標における前記反射光から得られる情報の分布に基づいて前記反射板が設けられた複数の前記静止構造物と移動体との位置関係を少なくとも判定する解析部、を備え、前記反射光から得られる情報の分布は前記反射光の強度が強度閾値を超える範囲の分布であり、前記解析部は、前記検出範囲の像面において縦方向と横方向に分割された各ピクセルのうち前記反射光の強度が強度閾値を超えるピクセル群の高強度範囲に含まれるピクセルの数に基づいて解析対象となる前記反射板を判別し、解析対象とした前記反射板の高さを算出し、算出された前記反射板の高さに応じて反射板を特定し、解析対象とした前記反射板が設けられた前記静止構造物と前記移動体との位置関係を少なくとも判定することを特徴とする。
本発明の第２の態様によれば、空間認識方法は、空間認識装置が、検出範囲に位置する複数の静止構造物それぞれの高さ方向に異なる位置に設けられた反射板に光を照射しその反射光を受光する移動体に取り付けられた光学装置から前記光の照射方向に応じた反射光から得られる情報を取得し、前記反射光から得られる情報の分布は前記反射光の強度が強度閾値を超える範囲の分布であり、前記検出範囲の各座標における前記反射光から得られる情報の分布に基づいて前記反射板が設けられた複数の前記静止構造物と移動体との位置関係を少なくとも判定する処理において、前記検出範囲の像面において縦方向と横方向に分割された各ピクセルのうち前記反射光の強度が強度閾値を超えるピクセル群の高強度範囲に含まれるピクセルの数に基づいて解析対象となる前記反射板を判別し、解析対象とした前記反射板の高さを算出し、算出された前記反射板の高さに応じて反射板を特定し、解析対象とした前記反射板が設けられた前記静止構造物と前記移動体との位置関係を少なくとも判定することを特徴とする。
本発明の第３の態様によれば、プログラムは、空間認識装置のコンピュータを、検出範囲に位置する複数の静止構造物それぞれの高さ方向に異なる位置に設けられた反射板に光を照射しその反射光を受光する移動体に取り付けられた光学装置から前記光の照射方向に応じた反射光から得られる情報を取得し、前記検出範囲の各座標における前記反射光から得られる情報の分布に基づいて前記反射板が設けられた複数の前記静止構造物と移動体との位置関係を少なくとも判定する解析手段、として機能させ、前記反射光から得られる情報の分布は前記反射光の強度が強度閾値を超える範囲の分布であり、前記解析手段は、前記検出範囲の像面において縦方向と横方向に分割された各ピクセルのうち前記反射光の強度が強度閾値を超えるピクセル群の高強度範囲に含まれるピクセルの数に基づいて解析対象となる前記反射板を判別し、解析対象とした前記反射板の高さを算出し、算出された前記反射板の高さに応じて反射板を特定し、解析対象とした前記反射板が設けられた前記静止構造物と前記移動体との位置関係を少なくとも判定することを特徴とする。
本発明によれば、静止構造物が同じパターンで数多く並び多様な物体が載置される空間において、空間認識装置が移動体の現在位置を容易に認識することができる。
以下、本発明の一実施形態による空間認識装置を図面を参照して説明する。
図１は同実施形態による空間認識装置を備えたフォークリフトを含む空間認識システムの概要を示す図である。
図１で示すフォークリフト１０は、多様な荷物が載置され静止構造物が同じパターンで数多く並んでいるような空間内を移動する移動体の一例である。フォークリフト１０はフォークリフト１０の移動できる空間に載置されるコンテナ等の荷物を運搬する。フォークリフト１０は一例として、空間認識装置１、レーダ装置１１、地上通信アンテナ１２、衛星アンテナ１３などを備える。
図１は同実施形態による空間認識装置を備えたフォークリフトを含む空間認識システムの概要を示す図である。
図１で示すフォークリフト１０は、多様な荷物が載置され静止構造物が同じパターンで数多く並んでいるような空間内を移動する移動体の一例である。フォークリフト１０はフォークリフト１０の移動できる空間に載置されるコンテナ等の荷物を運搬する。フォークリフト１０は一例として、空間認識装置１、レーダ装置１１、地上通信アンテナ１２、衛星アンテナ１３などを備える。
空間内に配置される静止構造物は例えば柱や壁などである。図１は角柱状や円柱状の柱に反射板Ｒ１、Ｒ２、Ｒ３が取り付けられている様子を示している。反射板Ｒ１、Ｒ２、Ｒ３を総称して反射板Ｒと呼ぶこととする。フォークリフト１０に取り付けられた光学装置の一つであるレーダ装置１１は、空間認識装置１の制御に基づいて空間内の検出範囲に光を照射し、その光の反射光を受光する。反射板Ｒにおいて反射しレーダ装置１１で受光した反射光の受光強度は、反射板Ｒ以外の位置で反射してレーダ装置１１で受光した反射光の受光強度に比べて強い。レーダ装置１１は反射光から得られる受光強度などの情報を空間認識装置１へ出力する。レーダ装置１１は反射光に基づいて算出した各反射位置までの距離の情報も空間認識装置１へ出力する。
レーダ装置１１は検出範囲の像面を細かく分割した各ピクセルに対応する各反射位置それぞれに対して光を照射し、その反射位置から反射した反射光から得られる受光強度や距離の情報を空間認識装置１へ出力する。空間認識装置１は、光の反射位置に応じた反射光から得られる受光強度や距離等の情報をレーダ装置１１から取得し、その情報の分布に基づいて反射板Ｒが設けられた静止構造物や移動体の位置を少なくとも判定する。空間認識装置１は、反射板Ｒと推定される範囲における反射光の情報の分布に基づいて、反射板Ｒが設けられた静止構造物の識別情報を解析してもよい。また、空間認識装置１は、反射板Ｒに設けられた凹凸の分布を解析して、反射板Ｒが設けられた静止構造物の識別情報を解析してもよい。空間認識装置１は、静止構造物の位置に基づいて移動体の位置を解析してもよい。
図２は同実施形態による空間認識装置のハードウェア構成を示す図である。
空間認識装置１は、ＣＰＵ（Central Processing Unit）２０１、ＩＦ（Interface）２０２、通信モジュール２０３、ＲＯＭ（Read Only Memory）２０４、ＲＡＭ（Random Access Memory）２０５、ＨＤＤ（Hard Disk Drive）２０６などの構成を備えている。通信モジュール２０３は地上通信アンテナ１２や衛星アンテナ１３を介した信号の送受信を行う。ＩＦ２０２は、例えば空間認識装置１に設けられたタッチパネルディスプレイ等に接続されている。
空間認識装置１は、ＣＰＵ（Central Processing Unit）２０１、ＩＦ（Interface）２０２、通信モジュール２０３、ＲＯＭ（Read Only Memory）２０４、ＲＡＭ（Random Access Memory）２０５、ＨＤＤ（Hard Disk Drive）２０６などの構成を備えている。通信モジュール２０３は地上通信アンテナ１２や衛星アンテナ１３を介した信号の送受信を行う。ＩＦ２０２は、例えば空間認識装置１に設けられたタッチパネルディスプレイ等に接続されている。
図３は同実施形態による空間認識装置の機能ブロックを示す図である。
空間認識装置１は制御部１０１、解析部１０２、車両情報取得部１０３、表示部１０４、記録部１０５の各機能部を備える。
制御部１０１は、空間認識装置１に備わる各機能を制御する。
解析部１０２は、検出範囲に位置する静止構造物に設けられた反射板Ｒに光を照射しその反射光を受光するレーダ装置１１から光の照射方向に応じた反射光から得られる情報を取得する。解析部１０２は、レーダ装置１１の検出範囲の各座標における反射光から得られる情報の分布に基づいて反射板Ｒが設けられた静止構造物と移動体との位置関係を少なくとも判定する。
車両情報取得部１０３は空間認識装置１が備わるフォークリフト１０のＩＤ等を取得する。
表示部１０４は空間認識装置１に設けられたモニタ等に警告情報や位置情報などの表示情報を出力する。
記録部１０５は解析部１０２の解析結果等の情報をＲＯＭ２０４やＲＡＭ２０５等の記憶部に記録する。
空間認識装置１は制御部１０１、解析部１０２、車両情報取得部１０３、表示部１０４、記録部１０５の各機能部を備える。
制御部１０１は、空間認識装置１に備わる各機能を制御する。
解析部１０２は、検出範囲に位置する静止構造物に設けられた反射板Ｒに光を照射しその反射光を受光するレーダ装置１１から光の照射方向に応じた反射光から得られる情報を取得する。解析部１０２は、レーダ装置１１の検出範囲の各座標における反射光から得られる情報の分布に基づいて反射板Ｒが設けられた静止構造物と移動体との位置関係を少なくとも判定する。
車両情報取得部１０３は空間認識装置１が備わるフォークリフト１０のＩＤ等を取得する。
表示部１０４は空間認識装置１に設けられたモニタ等に警告情報や位置情報などの表示情報を出力する。
記録部１０５は解析部１０２の解析結果等の情報をＲＯＭ２０４やＲＡＭ２０５等の記憶部に記録する。
図４は空間認識装置の処理フローを示す図である。
次に空間認識装置の処理フローについて順を追って説明する。
フォークリフト１０を操作するユーザは空間認識装置１を制御して、一例としてはフォークリフト１０の現在位置と近傍に載置されるコンテナ等の物体の種別を検出するものである。ユーザは処理開始の指示を空間認識装置１に与える。すると空間認識装置１の制御部１０１はレーダ装置１１に処理開始を指示する。レーダ装置１１は自装置の検出範囲の各方向に光を照射し、反射位置からの反射光を受光する。レーダ装置１１は一例としては検出範囲に含まれる各物体から反射した反射光の強度を、その光の照射方向毎に検出するものであってよい。レーダ装置１１は１秒や数ミリ秒など所定の間隔毎に、検出範囲の各方向に照射した光の反射光の強度を空間認識装置１へ出力する。フォークリフト１０が移動することによりレーダ装置１１の検出範囲も変動する。制御部１０１は所定の間隔毎に、レーダ装置１１から受信した検出範囲内の各光照射方向に対応する反射光の受光強度や、その反射光の反射位置までの距離を含むセンシング情報を生成する（ステップＳ１０１）。制御部１０１はセンシング情報を解析部１０２へ出力する。センシング情報には検出範囲の像面を細かく分割した各ピクセルを示す情報と、それら各ピクセルに対応する各反射位置からの反射光の受光強度と、各ピクセルに対応する反射位置までの距離とが少なくとも含まれる。
次に空間認識装置の処理フローについて順を追って説明する。
フォークリフト１０を操作するユーザは空間認識装置１を制御して、一例としてはフォークリフト１０の現在位置と近傍に載置されるコンテナ等の物体の種別を検出するものである。ユーザは処理開始の指示を空間認識装置１に与える。すると空間認識装置１の制御部１０１はレーダ装置１１に処理開始を指示する。レーダ装置１１は自装置の検出範囲の各方向に光を照射し、反射位置からの反射光を受光する。レーダ装置１１は一例としては検出範囲に含まれる各物体から反射した反射光の強度を、その光の照射方向毎に検出するものであってよい。レーダ装置１１は１秒や数ミリ秒など所定の間隔毎に、検出範囲の各方向に照射した光の反射光の強度を空間認識装置１へ出力する。フォークリフト１０が移動することによりレーダ装置１１の検出範囲も変動する。制御部１０１は所定の間隔毎に、レーダ装置１１から受信した検出範囲内の各光照射方向に対応する反射光の受光強度や、その反射光の反射位置までの距離を含むセンシング情報を生成する（ステップＳ１０１）。制御部１０１はセンシング情報を解析部１０２へ出力する。センシング情報には検出範囲の像面を細かく分割した各ピクセルを示す情報と、それら各ピクセルに対応する各反射位置からの反射光の受光強度と、各ピクセルに対応する反射位置までの距離とが少なくとも含まれる。
図５はセンシング情報の具体例を示す図である。
解析部１０２は検出範囲のセンシング情報を受信すると、センシング情報から受光量などの反射光強度が所定の値以上となる高強度範囲Ａ２のデータ群を取り出す。高強度範囲Ａ２のデータ群は、一例としては図５で示すような検出範囲Ａ１内において反射光の強度（受光量）が高い高強度範囲Ａ２に対応する反射位置からの反射光の受光強度を示す。図５で示す高強度範囲Ａ２のデータ群は、当該範囲Ａ２において縦方向１３行、横方向１７列の分割された各ピクセルの光の照射方向に対応する反射光の強度を一例として示している。解析部１０２は高強度範囲Ａ２の各ピクセルの行方向に順次、反射光強度が閾値以上かを判定し、反射高強度が閾値以上のピクセルを特定する。解析部１０２はその反射光強度が閾値以上のピクセルの特定処理を、高強度範囲Ａ２の各行について行う。解析部１０２は反射光強度が閾値以上のピクセル群の範囲を、解析対象の反射板Ｒの範囲と判定する（ステップＳ１０２）。
解析部１０２は検出範囲のセンシング情報を受信すると、センシング情報から受光量などの反射光強度が所定の値以上となる高強度範囲Ａ２のデータ群を取り出す。高強度範囲Ａ２のデータ群は、一例としては図５で示すような検出範囲Ａ１内において反射光の強度（受光量）が高い高強度範囲Ａ２に対応する反射位置からの反射光の受光強度を示す。図５で示す高強度範囲Ａ２のデータ群は、当該範囲Ａ２において縦方向１３行、横方向１７列の分割された各ピクセルの光の照射方向に対応する反射光の強度を一例として示している。解析部１０２は高強度範囲Ａ２の各ピクセルの行方向に順次、反射光強度が閾値以上かを判定し、反射高強度が閾値以上のピクセルを特定する。解析部１０２はその反射光強度が閾値以上のピクセルの特定処理を、高強度範囲Ａ２の各行について行う。解析部１０２は反射光強度が閾値以上のピクセル群の範囲を、解析対象の反射板Ｒの範囲と判定する（ステップＳ１０２）。
解析部１０２が検出した反射板Ｒと推定される高強度範囲Ａ２のピクセルの列方向や行方向の範囲が所定のピクセル数未満である場合には、ほぼ反射板Ｒの範囲が点として認識されるような反射板Ｒから遠い位置にレーダ装置１１を備えたフォークリフト１０が位置すると判定できる。また解析部１０２が検出した反射板Ｒと推定される高強度範囲Ａ２のピクセルの列方向や行方向の範囲が検出範囲Ａ１全体を覆うようなあるピクセル数以上である場合には、反射板Ｒにかなり近い位置にフォークリフト１０が位置すると判定できる。解析部１０２は一例としては、反射板Ｒが点として認識されるような反射板Ｒから遠い位置にフォークリフト１０が位置する場合、その反射板Ｒを解析対象から除くようにしてよい。解析部１０２は解析対象の反射板Ｒの範囲と判定した高強度範囲Ａ２内の各ピクセル番号やそれぞれのピクセルの反射光強度を含む反射板データを生成する（ステップＳ１０３）。
解析部１０２は反射板データをセンシング情報内から生成した場合、その反射板データが示す反射板Ｒの範囲の中央部分の高さを算出する（ステップＳ１０４）。例えば解析部１０２はレーダ装置１１の取り付けられている高さＨ１と、反射板Ｒの中央部分の反射光を受信した場合の光照射方向の角度θと、その光の照射時刻から受光時刻までの時間に基づいて算出した反射板Ｒの中央部分までの距離Ｘとに基づいて、反射板Ｒの中央部分の高さＨ２を、Ｈ２＝Ｈ１＋Ｘｓｉｎθにより算出することができる。
反射板Ｒは例えば静止構造物である柱や壁それぞれにおいて高さＨ２の異なる位置に設けられている。解析部１０２はレーダ装置１１の光の照射方向を制御して各方向の検出範囲に映る反射板の高さに応じた反射板ＩＤをＨＤＤ２０６等の記憶部から読み取る（ステップＳ１０５）。なお静止構造物である柱や壁それぞれに設けられた反射板Ｒは異なる形状をしており、解析部１０２は反射板Ｒの形状をパターン認識などにより解析し、その形状に対応する反射板ＩＤを記憶部から読み取るようにしてもよい。
ＨＤＤ２０６には反射板ＩＤに応じた空間内の位置（座標）が記録されている。解析部１０２は反射板ＩＤに対応する空間内の位置を読み取る（ステップＳ１０６）。解析部１０２はセンシング情報から複数の解析対象の反射板Ｒが検出できる場合には、それぞれの反射板Ｒに対応する反射板ＩＤと位置を検出する。また解析部１０２は解析対象の反射板Ｒの範囲の中央部分のピクセルを示す反射位置までの距離をセンシング情報から特定する（ステップＳ１０７）。解析部１０２は３つ以上の反射板Ｒまでの距離を算出したかを判定する（ステップＳ１０８）。解析部１０２は３つ以上の反射板Ｒまでの距離を算出していない場合にはステップＳ１０１の処理に戻り、レーダ装置１１から受信した信号に基づいて次のセンシング情報の生成からの処理を繰り返す。
図６はフォークリフトの位置する座標の算出概要を示す図である。
解析部１０２は複数の反射板ＩＤとその反射板Ｒの絶対位置と反射板Ｒの中央部分までの距離とを取得すると、それらの情報に基づいて自装置の位置を算出する。例えば解析部１０２は、反射板Ｒ１の座標（ｘ１，ｙ１）を中心としその反射板Ｒ１の中央部分からレーダ装置１１までの距離Ｌ１を半径とする第一の円と、反射板Ｒ２の座標（ｘ２，ｙ２）を中心としその反射板Ｒ２の中央部分からレーダ装置１１までの距離Ｌ２を半径とする第二の円、反射板Ｒ３の座標（ｘ３，ｙ３）を中心としその反射板Ｒ３の中央部分からレーダ装置１１までの距離Ｌ３を半径とする第三の円との交点を算出する。解析部１０２はその交点を自装置が備わるフォークリフト１０の座標であると特定する（ステップＳ１０９）。表示部１０４は解析部１０２の算出したフォークリフト１０の位置を空間認識装置１に備わるモニタに表示された空間地図上に出力する（ステップＳ１１０）。これによりユーザはフォークリフト１０が走行する空間における位置情報を認識することができる。また表示部１０４はフォークリフト１０の位置に基づいて、その位置の近傍に載置されるコンテナ等の荷物ＩＤ、荷物の種類、荷物の量などの情報をＨＤＤ１０６から取得し、モニタに表示されている空間地図上に重ねて出力してもよい。制御部１０１は処理を終了するかを判定する（ステップＳ１１１）。制御部１０１は処理を終了しない場合にはステップＳ１０１からの処理を繰り返すよう制御する。
解析部１０２は複数の反射板ＩＤとその反射板Ｒの絶対位置と反射板Ｒの中央部分までの距離とを取得すると、それらの情報に基づいて自装置の位置を算出する。例えば解析部１０２は、反射板Ｒ１の座標（ｘ１，ｙ１）を中心としその反射板Ｒ１の中央部分からレーダ装置１１までの距離Ｌ１を半径とする第一の円と、反射板Ｒ２の座標（ｘ２，ｙ２）を中心としその反射板Ｒ２の中央部分からレーダ装置１１までの距離Ｌ２を半径とする第二の円、反射板Ｒ３の座標（ｘ３，ｙ３）を中心としその反射板Ｒ３の中央部分からレーダ装置１１までの距離Ｌ３を半径とする第三の円との交点を算出する。解析部１０２はその交点を自装置が備わるフォークリフト１０の座標であると特定する（ステップＳ１０９）。表示部１０４は解析部１０２の算出したフォークリフト１０の位置を空間認識装置１に備わるモニタに表示された空間地図上に出力する（ステップＳ１１０）。これによりユーザはフォークリフト１０が走行する空間における位置情報を認識することができる。また表示部１０４はフォークリフト１０の位置に基づいて、その位置の近傍に載置されるコンテナ等の荷物ＩＤ、荷物の種類、荷物の量などの情報をＨＤＤ１０６から取得し、モニタに表示されている空間地図上に重ねて出力してもよい。制御部１０１は処理を終了するかを判定する（ステップＳ１１１）。制御部１０１は処理を終了しない場合にはステップＳ１０１からの処理を繰り返すよう制御する。
上述の処理によれば、フォークリフト１０に備えられた空間認識装置１は、静止構造物が同じパターンで数多く並び多様な物体が載置される空間において、フォークリフト１０の現在位置やその位置の近傍に載置される物体を容易に認識することができる。また空間認識装置１０は位置情報発信タグから発信された信号を解析して自装置の位置を特定する装置や、ＧＮＳＳなどによる位置を解析して自装置の位置を特定する装置を備えなくてよく、静止構造物に反射板Ｒを備え付ければよいため、システムを構成する装置のコストを軽減することができる。また空間認識装置１は電子回路に影響を及ぼす電波を用いずに光により自装置の取り付けられた移動体の位置を測定する為、電波信号の発信を抑制されるエリアにおける自装置の位置の認識に有用である。
なお上述の処理において解析部１０２は反射光強度が閾値以上となる範囲に基づいて反射板Ｒの範囲であるかどうかを判定している。しかしながら解析部１０２はさらに反射光強度が閾値以上となったピクセル範囲に隣接する、反射光強度が閾値未満となったピクセルやそのピクセル範囲の反射光強度との差が所定の閾値以上となる場合にのみ、反射光強度が閾値以上となったピクセル範囲を解析対象の反射板Ｒの範囲と特定してもよい。
図７は反射板の第一の他の例を示す図である。
反射板ＲにはＱＲコード（登録商標）などの２次元コード情報Ｄが印刷されていてもよい。この場合、解析部１０２は反射板Ｒの範囲と判定した高強度範囲Ａ２において反射光強度が閾値未満となるピクセルと、反射光強度が閾値以上となるピクセルを２値に分けて、その２値画像が２次元コード情報Ｄであると判定する。解析部１０２は高強度範囲Ａ２内の２値画像に基づいて、２次元コード情報Ｄを解析する従来の手法により、その反射板Ｒの座標や柱番号などの情報を読み取るようにしてもよい。
反射板ＲにはＱＲコード（登録商標）などの２次元コード情報Ｄが印刷されていてもよい。この場合、解析部１０２は反射板Ｒの範囲と判定した高強度範囲Ａ２において反射光強度が閾値未満となるピクセルと、反射光強度が閾値以上となるピクセルを２値に分けて、その２値画像が２次元コード情報Ｄであると判定する。解析部１０２は高強度範囲Ａ２内の２値画像に基づいて、２次元コード情報Ｄを解析する従来の手法により、その反射板Ｒの座標や柱番号などの情報を読み取るようにしてもよい。
図８は反射板の第二の他の例を示す図である。
反射板Ｒは図７で示すように凹凸がもうけられていてもよい。この場合、解析部１０２は反射板Ｒの範囲と判定した高強度範囲Ａ２の各ピクセルに対応する反射位置までの距離を算出し、その距離に基づいて隣接するピクセル間の距離の差が大きいピクセルと、隣接するピクセル間の距離が小さいピクセルとを検出する。解析部１０２は隣接するピクセルとの距離の大小に基づいて各ピクセルを２値化して、その２値画像が２次元コード情報Ｄであると判定する。解析部１０２は高強度範囲Ａ２内の２値画像に基づいて、２次元コード情報Ｄを解析する従来の手法により、その反射板Ｒの座標や柱番号などの情報を読み取るようにしてもよい。
反射板Ｒは図７で示すように凹凸がもうけられていてもよい。この場合、解析部１０２は反射板Ｒの範囲と判定した高強度範囲Ａ２の各ピクセルに対応する反射位置までの距離を算出し、その距離に基づいて隣接するピクセル間の距離の差が大きいピクセルと、隣接するピクセル間の距離が小さいピクセルとを検出する。解析部１０２は隣接するピクセルとの距離の大小に基づいて各ピクセルを２値化して、その２値画像が２次元コード情報Ｄであると判定する。解析部１０２は高強度範囲Ａ２内の２値画像に基づいて、２次元コード情報Ｄを解析する従来の手法により、その反射板Ｒの座標や柱番号などの情報を読み取るようにしてもよい。
図９は空間認識装置の最小構成を示す図である。
空間認識装置１は少なくとも解析部を備えればよい。
解析部１０２は、検出範囲に位置する静止構造物に設けられた反射板に光を照射しその反射光を受光する光学装置から前記光の照射方向に応じた反射光から得られる情報を取得する。解析部１０２は、検出範囲の各座標における反射光から得られる情報の分布に基づいて反射板が設けられた静止構造物と移動体との位置関係を少なくとも判定する。
空間認識装置１は少なくとも解析部を備えればよい。
解析部１０２は、検出範囲に位置する静止構造物に設けられた反射板に光を照射しその反射光を受光する光学装置から前記光の照射方向に応じた反射光から得られる情報を取得する。解析部１０２は、検出範囲の各座標における反射光から得られる情報の分布に基づいて反射板が設けられた静止構造物と移動体との位置関係を少なくとも判定する。
上述の空間認識装置は内部に、コンピュータシステムを有している。そして、上述した各処理の過程は、プログラムの形式でコンピュータ読み取り可能な記録媒体に記憶されており、このプログラムをコンピュータが読み出して実行することによって、上記処理が行われる。ここでコンピュータ読み取り可能な記録媒体とは、磁気ディスク、光磁気ディスク、ＣＤ－ＲＯＭ、ＤＶＤ－ＲＯＭ、半導体メモリ等をいう。また、このコンピュータプログラムを通信回線によってコンピュータに配信し、この配信を受けたコンピュータが当該プログラムを実行するようにしても良い。
また、上記プログラムは、前述した機能の一部を実現するためのものであっても良い。さらに、前述した機能をコンピュータシステムにすでに記録されているプログラムとの組み合わせで実現できるもの、いわゆる差分ファイル（差分プログラム）であっても良い。
１・・・空間認識装置
１０・・・フォークリフト
１１・・・レーダ装置
１２・・・地上通信アンテナ
１３・・・衛星アンテナ
１０１・・・制御部
１０２・・・解析部
１０３・・・車両情報取得部
１０４・・・表示部
１０５・・・記録部
１０・・・フォークリフト
１１・・・レーダ装置
１２・・・地上通信アンテナ
１３・・・衛星アンテナ
１０１・・・制御部
１０２・・・解析部
１０３・・・車両情報取得部
１０４・・・表示部
１０５・・・記録部
Claims (5)
- 検出範囲に位置する複数の静止構造物それぞれの高さ方向に異なる位置に設けられた反射板に光を照射しその反射光を受光する移動体に取り付けられた光学装置から前記光の照射方向に応じた反射光から得られる情報を取得し、前記検出範囲の各座標における前記反射光から得られる情報の分布に基づいて前記反射板が設けられた複数の前記静止構造物と移動体との位置関係を少なくとも判定する解析部、
を備え、
前記反射光から得られる情報の分布は前記反射光の強度が強度閾値を超える範囲の分布であり、前記解析部は、前記検出範囲の像面において縦方向と横方向に分割された各ピクセルのうち前記反射光の強度が強度閾値を超えるピクセル群の高強度範囲に含まれるピクセルの数に基づいて解析対象となる前記反射板を判別し、解析対象とした前記反射板の高さを算出し、算出された前記反射板の高さに応じて反射板を特定し、解析対象とした前記反射板が設けられた前記静止構造物と前記移動体との位置関係を少なくとも判定する
空間認識装置。 - 前記解析部は、前記反射板に設けられた反射領域の分布に基づいて、前記反射板が設けられた静止構造物の識別情報を解析する
請求項１に記載の空間認識装置。 - 前記解析部は、前記静止構造物の絶対位置に基づいて前記移動体の絶対位置を解析する
請求項１または請求項２に記載の空間認識装置。 - 空間認識装置が、
検出範囲に位置する複数の静止構造物それぞれの高さ方向に異なる位置に設けられた反射板に光を照射しその反射光を受光する移動体に取り付けられた光学装置から前記光の照射方向に応じた反射光から得られる情報を取得し、前記反射光から得られる情報の分布は前記反射光の強度が強度閾値を超える範囲の分布であり、前記検出範囲の各座標における前記反射光から得られる情報の分布に基づいて前記反射板が設けられた複数の前記静止構造物と移動体との位置関係を少なくとも判定する処理において、前記検出範囲の像面において縦方向と横方向に分割された各ピクセルのうち前記反射光の強度が強度閾値を超えるピクセル群の高強度範囲に含まれるピクセルの数に基づいて解析対象となる前記反射板を判別し、解析対象とした前記反射板の高さを算出し、算出された前記反射板の高さに応じて反射板を特定し、解析対象とした前記反射板が設けられた前記静止構造物と前記移動体との位置関係を少なくとも判定する
空間認識方法。 - 空間認識装置のコンピュータを、
検出範囲に位置する複数の静止構造物それぞれの高さ方向に異なる位置に設けられた反射板に光を照射しその反射光を受光する移動体に取り付けられた光学装置から前記光の照射方向に応じた反射光から得られる情報を取得し、前記検出範囲の各座標における前記反射光から得られる情報の分布に基づいて前記反射板が設けられた複数の前記静止構造物と移動体との位置関係を少なくとも判定する解析手段、
として機能させ、
前記反射光から得られる情報の分布は前記反射光の強度が強度閾値を超える範囲の分布であり、前記解析手段は、前記検出範囲の像面において縦方向と横方向に分割された各ピクセルのうち前記反射光の強度が強度閾値を超えるピクセル群の高強度範囲に含まれるピクセルの数に基づいて解析対象となる前記反射板を判別し、解析対象とした前記反射板の高さを算出し、算出された前記反射板の高さに応じて反射板を特定し、解析対象とした前記反射板が設けられた前記静止構造物と前記移動体との位置関係を少なくとも判定する
プログラム。
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017170376A JP7392962B2 (ja) | 2017-09-05 | 2017-09-05 | 空間認識装置、空間認識方法、プログラム |
| PCT/JP2018/030413 WO2019049627A1 (ja) | 2017-09-05 | 2018-08-16 | 空間認識装置、空間認識方法、プログラム |
| US16/643,971 US11585924B2 (en) | 2017-09-05 | 2018-08-16 | Spatial recognition device, spatial recognition method, and program |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017170376A JP7392962B2 (ja) | 2017-09-05 | 2017-09-05 | 空間認識装置、空間認識方法、プログラム |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2019045381A JP2019045381A (ja) | 2019-03-22 |
| JP7392962B2 true JP7392962B2 (ja) | 2023-12-06 |
Family
ID=65634011
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2017170376A Active JP7392962B2 (ja) | 2017-09-05 | 2017-09-05 | 空間認識装置、空間認識方法、プログラム |
Country Status (3)
| Country | Link |
|---|---|
| US (1) | US11585924B2 (ja) |
| JP (1) | JP7392962B2 (ja) |
| WO (1) | WO2019049627A1 (ja) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP7259685B2 (ja) * | 2019-09-30 | 2023-04-18 | トヨタ自動車株式会社 | 自動運転車両用の運転制御装置、停車用物標、運転制御システム |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005274232A (ja) | 2004-03-23 | 2005-10-06 | Sharp Corp | 位置検出装置、被検出器および位置検出システム |
| JP2007257226A (ja) | 2006-03-23 | 2007-10-04 | Honda Motor Co Ltd | 移動体の自己位置検出装置および位置検出システム |
| JP7152434B2 (ja) | 2019-02-27 | 2022-10-12 | キッコーマン株式会社 | サーバー装置、相性判定方法および相性判定プログラム |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS61117409A (ja) * | 1984-11-14 | 1986-06-04 | Komatsu Zoki Kk | 建設機械の現在地検出方法 |
| US5215423A (en) * | 1990-09-21 | 1993-06-01 | Edelhoff Polytechnik Gmbh & Co. | System for determining the spatial position of an object by means of a video optical sensor |
| JPH07152434A (ja) * | 1993-12-01 | 1995-06-16 | Fuji Heavy Ind Ltd | 自律走行作業車の自己位置検出方法 |
| JPH11166831A (ja) * | 1997-12-04 | 1999-06-22 | Nikon Corp | レーザ測量システム |
| JP4051883B2 (ja) | 2000-12-20 | 2008-02-27 | 株式会社明電舎 | 無人車位置計測方式 |
| JP4978099B2 (ja) * | 2006-08-03 | 2012-07-18 | トヨタ自動車株式会社 | 自己位置推定装置 |
| JP6596889B2 (ja) * | 2015-04-03 | 2019-10-30 | 日産自動車株式会社 | 物体検出装置 |
| JP2017039188A (ja) * | 2015-08-20 | 2017-02-23 | 株式会社東芝 | 移動ロボットおよび施工位置確認方法 |
| JP6629055B2 (ja) * | 2015-11-30 | 2020-01-15 | 株式会社ソニー・インタラクティブエンタテインメント | 情報処理装置および情報処理方法 |
-
2017
- 2017-09-05 JP JP2017170376A patent/JP7392962B2/ja active Active
-
2018
- 2018-08-16 WO PCT/JP2018/030413 patent/WO2019049627A1/ja active Application Filing
- 2018-08-16 US US16/643,971 patent/US11585924B2/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005274232A (ja) | 2004-03-23 | 2005-10-06 | Sharp Corp | 位置検出装置、被検出器および位置検出システム |
| JP2007257226A (ja) | 2006-03-23 | 2007-10-04 | Honda Motor Co Ltd | 移動体の自己位置検出装置および位置検出システム |
| JP7152434B2 (ja) | 2019-02-27 | 2022-10-12 | キッコーマン株式会社 | サーバー装置、相性判定方法および相性判定プログラム |
Also Published As
| Publication number | Publication date |
|---|---|
| US11585924B2 (en) | 2023-02-21 |
| JP2019045381A (ja) | 2019-03-22 |
| WO2019049627A1 (ja) | 2019-03-14 |
| US20210063572A1 (en) | 2021-03-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP3349041B1 (en) | Object detection system | |
| CN109506664B (zh) | 利用人行横道识别结果的引导信息提供装置及方法 | |
| US10996338B2 (en) | Systems and methods for detection by autonomous vehicles | |
| EP1942313B1 (en) | Apparatus and method of measuring distance using structured light | |
| EP2453253B1 (en) | A multi-directional active sensor system and a method for sensing electromagnetic radiation | |
| US7528721B2 (en) | Identification and location of RF tagged articles | |
| US20070273530A1 (en) | Tag communication device, tag moving direction detecting system and tag moving direction detecting method | |
| JP2011150633A (ja) | 対象物検出装置及びプログラム | |
| EP2674778A2 (en) | Monitoring device, monitoring method, and program | |
| JP7392962B2 (ja) | 空間認識装置、空間認識方法、プログラム | |
| CN110703770A (zh) | 一种轨道检测车自动行驶控制的方法及装置 | |
| CN111413989B (zh) | 基于agv的激光定位系统和方法 | |
| EP3834186B1 (en) | Pedestal with embedded camera(s) for beam steering | |
| US20200104555A1 (en) | Wireless tag reading apparatus | |
| CN111352111A (zh) | 对象的定位和/或分类 | |
| KR101449288B1 (ko) | 레이더를 이용한 감지 시스템 | |
| JP7392963B2 (ja) | 空間認識装置、空間認識方法、プログラム | |
| US20180238995A1 (en) | Method for performing imaging polarimetry, transponder, and system for performing imaging polarimetry | |
| KR20190056775A (ko) | 차량의 객체 인식 장치 및 방법 | |
| CN110857859B (zh) | 障碍物检测方法及装置 | |
| KR101617540B1 (ko) | 상황정보 기반 콘텐츠 생성을 위한 구간영역 내 이동체 인식 방법 및 시스템 | |
| US11585656B2 (en) | Sensor control device | |
| CN113093719A (zh) | 自动导引车定位系统及其操作方法 | |
| AU2011264358B2 (en) | Method and control unit for controlling a display | |
| CN110308460B (zh) | 传感器的参数确定方法及系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200814 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210302 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210428 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20211026 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20211224 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20220524 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220824 |
|
| C60 | Trial request (containing other claim documents, opposition documents) |
Free format text: JAPANESE INTERMEDIATE CODE: C60 Effective date: 20220824 |
|
| A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20220831 |
|
| C21 | Notice of transfer of a case for reconsideration by examiners before appeal proceedings |
Free format text: JAPANESE INTERMEDIATE CODE: C21 Effective date: 20220906 |
|
| A912 | Re-examination (zenchi) completed and case transferred to appeal board |
Free format text: JAPANESE INTERMEDIATE CODE: A912 Effective date: 20221104 |
|
| C211 | Notice of termination of reconsideration by examiners before appeal proceedings |
Free format text: JAPANESE INTERMEDIATE CODE: C211 Effective date: 20221108 |
|
| C22 | Notice of designation (change) of administrative judge |
Free format text: JAPANESE INTERMEDIATE CODE: C22 Effective date: 20230221 |
|
| C22 | Notice of designation (change) of administrative judge |
Free format text: JAPANESE INTERMEDIATE CODE: C22 Effective date: 20230425 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230906 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20231116 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7392962 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |