JP2011203224A - 移動体位置検出システムおよび方法 - Google Patents
移動体位置検出システムおよび方法 Download PDFInfo
- Publication number
- JP2011203224A JP2011203224A JP2010073606A JP2010073606A JP2011203224A JP 2011203224 A JP2011203224 A JP 2011203224A JP 2010073606 A JP2010073606 A JP 2010073606A JP 2010073606 A JP2010073606 A JP 2010073606A JP 2011203224 A JP2011203224 A JP 2011203224A
- Authority
- JP
- Japan
- Prior art keywords
- moving body
- feature amount
- plane
- position detection
- dot
- 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.)
- Granted
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 58
- 238000000034 method Methods 0.000 title abstract description 15
- 238000003384 imaging method Methods 0.000 claims abstract description 29
- 238000012795 verification Methods 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 13
- 238000006073 displacement reaction Methods 0.000 description 11
- 238000007726 management method Methods 0.000 description 10
- 239000011159 matrix material Substances 0.000 description 9
- 238000012384 transportation and delivery Methods 0.000 description 9
- 238000004364 calculation method Methods 0.000 description 4
- 239000000428 dust Substances 0.000 description 4
- 238000010276 construction Methods 0.000 description 2
- 238000005286 illumination Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 235000019892 Stellar Nutrition 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012856 packing Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000007639 printing Methods 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
【解決手段】平面12上を移動する移動体16の位置を検出する移動体位置検出システム10であって、平面12上に配置された複数のドットからなるドットパターン14と、移動体16に備えられ、移動体16が位置する平面12上の領域を撮像する撮像手段20と、撮像手段20が時間的に連続して取得した2画像中に共通して含まれるドットパターンの位置関係に基づいて、2画像間の位置および方向関係を求め、移動体16の現在位置および方向を推定する推定手段28と、を備えるようにする。
【選択図】図1
Description
ここで、位置の推定のアルゴリズムとしてはポールスターアルゴリズムを用いている。
宇宙空間で宇宙機の姿勢同定に使われる機器としてスターセンサーがある。これは、宇宙機に搭載されたカメラで天空を撮像し、撮像領域の恒星点の配列を既知の恒星配置図(スターマップ)と照合することによりカメラの向いている姿勢を特定するセンサーである。ポールスターアルゴリズムは、このセンサーで使われる撮像恒星点群のスターマップへの照合アルゴリズムとして用いられている。恒星の配置は自然発生的であり必ずしも均一に点は分布していないが、ポールスターアルゴリズムは、このような対象に対しても有効に照合が実現できる。ポールスターアルゴリズムに関する参考文献としては、「E. SILANI, M. LOVERA : Ploitecnico di Milano Italy, “Star Identification Algorithms : Novel Approach & Comparison Study”, IEEE Transactions on Aerospace and Electronic Systems, Vol.42, No.4 October 2006」がある。
図5に示すように、画像点群Aと画像点群Bが時間的に連続してこの順に取得されたものとする。まず、画像点群Aおよび画像点群Bについて、それぞれポールスタービットを求める。
ポールスター特徴量とは、図6に例示してあるように、ある点(Pn)を中心として規定の範囲Rに存在する周辺点までの直線の長さ(以下、アーム長という。)を求め、アーム長を単位長さDで分割してインデックス化したものである(以下、アーム長インデックスという。)。
amax=fix(R/D)+1
ここで、ri:アーム長、ai:アーム長インデックス、D:インデックス単位長さ、R:分布半径、amax:最大アーム長インデックスである。また、fixは小数点以下を切り捨てて整数値を返す演算子である。
Mch=PSBb×PSBaT
並進変位=[x,y]
回転変位θ=tan−1((−c1×c2/s1×s2)1/2)
まず、本発明の応用例1として、ロボットを用いた病院デリバリーサービスに応用する場合について説明する。
次に、本発明の応用例2として、平倉庫フリーロケーション管理に応用する場合について説明する。
(3)上記の(2)と同様であるが、図13に示すように、超音波発信器62でなく床にパッシブ式RFID66を埋め込み、フォークリフト70に設置したリーダー68でIDを読み取る。
12 床面(平面)
14 ドットパターン
16 移動体
18 移動体位置検出装置
20 撮像手段
22 基準特徴量格納手段
24 検出特徴量算出手段
26 特徴量照合手段
28 推定手段
30 照明
32 ドット
34 基準特徴量データベース
Claims (3)
- 平面上を移動する移動体の位置を検出する移動体位置検出システムであって、
前記平面上に配置された複数のドットからなるドットパターンと、
前記移動体に備えられ、前記移動体が位置する平面上の領域を撮像する撮像手段と、
前記撮像手段が時間的に連続して取得した2画像中に共通して含まれるドットパターンの位置関係に基づいて、前記2画像間の位置および方向関係を求め、前記移動体の現在位置および方向を推定する推定手段と、
を備えることを特徴とする移動体位置検出システム。 - 前記ドットパターンにおける個々のドットと前記個々のドットの周辺に位置する複数のドットとの位置関係を算出し、前記位置関係と前記個々のドットの前記平面上における座標値とを対応付けて基準特徴量とし、これを基準特徴量データベースに格納する基準特徴量格納手段と、
前記撮像手段が取得した画像中の複数のドットから所定のドットを選択し、選択したドットと、このドットの周辺に位置する複数のドットとの位置関係を、選択したドットの検出特徴量として算出する検出特徴量算出手段と、
前記検出特徴量を前記基準特徴量データベースと照合することにより、前記基準特徴量データベースから前記検出特徴量と最も一致度の高い基準特徴量を選択し、選択した基準特徴量の座標値を、前記平面上における移動体の現在位置として検出する特徴量照合手段と、
をさらに備えることを特徴とする請求項1に記載の移動体位置検出システム。 - 平面上を移動する移動体の位置を検出する移動体位置検出方法であって、
前記平面上には複数のドットからなるドットパターンが配置され、
前記移動体には前記移動体が位置する平面上の領域を撮像する撮像手段が備えられ、
前記撮像手段が時間的に連続して取得した2画像中に共通して含まれるドットパターンの位置関係に基づいて、前記2画像間の位置および方向関係を求め、前記移動体の現在位置および方向を推定することを特徴とする移動体位置検出方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010073606A JP5637355B2 (ja) | 2010-03-26 | 2010-03-26 | 移動体位置検出システムおよび方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010073606A JP5637355B2 (ja) | 2010-03-26 | 2010-03-26 | 移動体位置検出システムおよび方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2011203224A true JP2011203224A (ja) | 2011-10-13 |
JP5637355B2 JP5637355B2 (ja) | 2014-12-10 |
Family
ID=44880007
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010073606A Active JP5637355B2 (ja) | 2010-03-26 | 2010-03-26 | 移動体位置検出システムおよび方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5637355B2 (ja) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015060336A (ja) * | 2013-09-18 | 2015-03-30 | 清水建設株式会社 | 床位置検出方法を用いた無人搬送車及び無人搬送システム |
JP2015138010A (ja) * | 2014-01-24 | 2015-07-30 | 清水建設株式会社 | 撮影カメラの位置検出システムおよび方法 |
WO2016035324A1 (en) * | 2014-09-03 | 2016-03-10 | Sharp Kabushiki Kaisha | Method for estimating motion, mobile agent and non-transitory computer-readable medium encoded with a computer program code for causing a processor to execute a method for estimating motion |
JP2016143260A (ja) * | 2015-02-03 | 2016-08-08 | 株式会社岡村製作所 | 移動方向測定装置及び自走式移動体 |
JP2017162425A (ja) * | 2016-03-11 | 2017-09-14 | 和成 松本 | ブック・ケアサービス |
JP2020095368A (ja) * | 2018-12-11 | 2020-06-18 | 矢崎エナジーシステム株式会社 | 搬送車の挙動計測システム |
JP2022037843A (ja) * | 2020-08-25 | 2022-03-09 | パナソニックIpマネジメント株式会社 | 移動ロボット |
CN114748099A (zh) * | 2022-06-15 | 2022-07-15 | 深圳瀚维智能医疗科技有限公司 | 偏移检测方法、装置、设备以及计算机可读存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0767019A (ja) * | 1993-08-28 | 1995-03-10 | Sony Corp | 相対位置検出装置 |
JPH1183530A (ja) * | 1997-09-11 | 1999-03-26 | Fuji Heavy Ind Ltd | 画像のオプティカルフロー検出装置及び移動体の自己位置認識システム |
JP2003180586A (ja) * | 2001-12-14 | 2003-07-02 | Hitachi Ltd | 自走式掃除機 |
JP2005233872A (ja) * | 2004-02-23 | 2005-09-02 | Matsushita Electric Ind Co Ltd | 移動装置 |
JP2007127525A (ja) * | 2005-11-04 | 2007-05-24 | Aisin Aw Co Ltd | 移動量演算装置 |
JP2007257226A (ja) * | 2006-03-23 | 2007-10-04 | Honda Motor Co Ltd | 移動体の自己位置検出装置および位置検出システム |
JP2009271608A (ja) * | 2008-04-30 | 2009-11-19 | Murata Mach Ltd | 走行車及び走行車システム |
-
2010
- 2010-03-26 JP JP2010073606A patent/JP5637355B2/ja active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0767019A (ja) * | 1993-08-28 | 1995-03-10 | Sony Corp | 相対位置検出装置 |
JPH1183530A (ja) * | 1997-09-11 | 1999-03-26 | Fuji Heavy Ind Ltd | 画像のオプティカルフロー検出装置及び移動体の自己位置認識システム |
JP2003180586A (ja) * | 2001-12-14 | 2003-07-02 | Hitachi Ltd | 自走式掃除機 |
JP2005233872A (ja) * | 2004-02-23 | 2005-09-02 | Matsushita Electric Ind Co Ltd | 移動装置 |
JP2007127525A (ja) * | 2005-11-04 | 2007-05-24 | Aisin Aw Co Ltd | 移動量演算装置 |
JP2007257226A (ja) * | 2006-03-23 | 2007-10-04 | Honda Motor Co Ltd | 移動体の自己位置検出装置および位置検出システム |
JP2009271608A (ja) * | 2008-04-30 | 2009-11-19 | Murata Mach Ltd | 走行車及び走行車システム |
Non-Patent Citations (1)
Title |
---|
村澤 一樹(外3名): "床パターンを利用した自己位置同定手法に関する検討(その2)", 第27回日本ロボット学会学術講演会, JPN6013025229, 15 September 2009 (2009-09-15), JP, pages 2009 - 1, ISSN: 0002539258 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015060336A (ja) * | 2013-09-18 | 2015-03-30 | 清水建設株式会社 | 床位置検出方法を用いた無人搬送車及び無人搬送システム |
JP2015138010A (ja) * | 2014-01-24 | 2015-07-30 | 清水建設株式会社 | 撮影カメラの位置検出システムおよび方法 |
WO2016035324A1 (en) * | 2014-09-03 | 2016-03-10 | Sharp Kabushiki Kaisha | Method for estimating motion, mobile agent and non-transitory computer-readable medium encoded with a computer program code for causing a processor to execute a method for estimating motion |
JP2016143260A (ja) * | 2015-02-03 | 2016-08-08 | 株式会社岡村製作所 | 移動方向測定装置及び自走式移動体 |
JP2017162425A (ja) * | 2016-03-11 | 2017-09-14 | 和成 松本 | ブック・ケアサービス |
JP2020095368A (ja) * | 2018-12-11 | 2020-06-18 | 矢崎エナジーシステム株式会社 | 搬送車の挙動計測システム |
JP2022037843A (ja) * | 2020-08-25 | 2022-03-09 | パナソニックIpマネジメント株式会社 | 移動ロボット |
JP7429868B2 (ja) | 2020-08-25 | 2024-02-09 | パナソニックIpマネジメント株式会社 | 移動ロボット |
CN114748099A (zh) * | 2022-06-15 | 2022-07-15 | 深圳瀚维智能医疗科技有限公司 | 偏移检测方法、装置、设备以及计算机可读存储介质 |
CN114748099B (zh) * | 2022-06-15 | 2022-11-01 | 深圳瀚维智能医疗科技有限公司 | 偏移检测方法、装置、设备以及计算机可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
JP5637355B2 (ja) | 2014-12-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5637355B2 (ja) | 移動体位置検出システムおよび方法 | |
JP6731423B2 (ja) | ナビゲーション制御のための装置および方法 | |
US9928438B2 (en) | High accuracy localization system and method for retail store profiling via product image recognition and its corresponding dimension database | |
US8561897B2 (en) | Load tracking utilizing load identifying indicia and spatial discrimination | |
CN109154826A (zh) | 协作库存监测 | |
US10025886B1 (en) | Methods and systems for using projected patterns to facilitate mapping of an environment | |
US12103774B2 (en) | Article transport vehicle | |
WO2017163709A1 (ja) | 投影指示装置、荷物仕分けシステムおよび投影指示方法 | |
WO2017163711A1 (ja) | 投影指示装置、荷物仕分けシステムおよび投影指示方法 | |
US20190094873A1 (en) | Mobile unit, inventory management system and the method for mobile unit localization | |
JP5483090B2 (ja) | 移動体位置検出システムおよび方法 | |
KR20170131958A (ko) | 모바일 파워 카트 | |
JP7416072B2 (ja) | 搬送システム、制御装置、及び搬送方法 | |
US11182739B2 (en) | Carrier tracking system and method thereof | |
CN107918840A (zh) | 一种移动单元、库存物品管理系统以及定位移动单元的方法 | |
CN112016725A (zh) | 任务处理方法、装置、设备和存储介质 | |
EP4307231A1 (en) | System and method for localizing articles in an intralogistics environment | |
KR20240003604A (ko) | 실시간위치추적과 3d 이미지와 거리측정과 인공지능에 의한 스마트 물류 안전 관리 시스템 | |
WO2023119388A1 (ja) | 作業管理システム、作業管理装置、作業管理方法、及び非一時的なコンピュータ可読媒体 | |
JP2022137633A (ja) | 搬送制御システム、搬送制御方法、プログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120713 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20130516 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130528 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130725 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140107 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20140307 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20140924 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20141008 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5637355 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |