JP5923311B2 - 自走式装置の位置の決定方法 - Google Patents
自走式装置の位置の決定方法 Download PDFInfo
- Publication number
- JP5923311B2 JP5923311B2 JP2012008568A JP2012008568A JP5923311B2 JP 5923311 B2 JP5923311 B2 JP 5923311B2 JP 2012008568 A JP2012008568 A JP 2012008568A JP 2012008568 A JP2012008568 A JP 2012008568A JP 5923311 B2 JP5923311 B2 JP 5923311B2
- Authority
- JP
- Japan
- Prior art keywords
- particles
- self
- propelled device
- particle
- propelled
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims description 32
- 239000002245 particle Substances 0.000 claims description 117
- 238000009826 distribution Methods 0.000 claims description 21
- 239000006185 dispersion Substances 0.000 claims description 17
- 238000005259 measurement Methods 0.000 claims description 14
- 238000001514 detection method Methods 0.000 claims description 9
- 238000011156 evaluation Methods 0.000 claims description 9
- 239000000428 dust Substances 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims description 2
- 230000003287 optical effect Effects 0.000 description 12
- 238000013507 mapping Methods 0.000 description 8
- 238000004364 calculation method Methods 0.000 description 6
- 230000033001 locomotion Effects 0.000 description 5
- 238000004458 analytical method Methods 0.000 description 4
- 239000011248 coating agent Substances 0.000 description 4
- 238000000576 coating method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 229910052782 aluminium Inorganic materials 0.000 description 2
- XAGFODPZIPBFFR-UHFFFAOYSA-N aluminium Chemical compound [Al] XAGFODPZIPBFFR-UHFFFAOYSA-N 0.000 description 2
- 238000004140 cleaning Methods 0.000 description 2
- 238000004040 coloring Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000001681 protective effect Effects 0.000 description 2
- 238000012935 Averaging Methods 0.000 description 1
- RYGMFSIKBFXOCR-UHFFFAOYSA-N Copper Chemical compound [Cu] RYGMFSIKBFXOCR-UHFFFAOYSA-N 0.000 description 1
- BQCADISMDOOEFD-UHFFFAOYSA-N Silver Chemical compound [Ag] BQCADISMDOOEFD-UHFFFAOYSA-N 0.000 description 1
- 230000004913 activation Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 229910052802 copper Inorganic materials 0.000 description 1
- 239000010949 copper Substances 0.000 description 1
- 238000005260 corrosion Methods 0.000 description 1
- 230000007797 corrosion Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- PCHJSUWPFVWCPO-UHFFFAOYSA-N gold Chemical compound [Au] PCHJSUWPFVWCPO-UHFFFAOYSA-N 0.000 description 1
- 229910052737 gold Inorganic materials 0.000 description 1
- 239000010931 gold Substances 0.000 description 1
- 230000002779 inactivation Effects 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 229910052751 metal Inorganic materials 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- VIKNJXKGJWUCNN-XGXHKTLJSA-N norethisterone Chemical compound O=C1CC[C@@H]2[C@H]3CC[C@](C)([C@](CC4)(O)C#C)[C@@H]4[C@@H]3CCC2=C1 VIKNJXKGJWUCNN-XGXHKTLJSA-N 0.000 description 1
- 229910052709 silver Inorganic materials 0.000 description 1
- 239000004332 silver Substances 0.000 description 1
- 238000003892 spreading Methods 0.000 description 1
- 230000007480 spreading Effects 0.000 description 1
- 238000003860 storage Methods 0.000 description 1
- 230000001502 supplementing effect Effects 0.000 description 1
- 238000002366 time-of-flight method Methods 0.000 description 1
- 238000007740 vapor deposition Methods 0.000 description 1
- 238000012795 verification Methods 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/16—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
-
- 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/42—Simultaneous measurement of distance and other co-ordinates
-
- 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/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0278—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves involving statistical or probabilistic considerations
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Probability & Statistics with Applications (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Electric Vacuum Cleaner (AREA)
- Length Measuring Devices By Optical Means (AREA)
Description
装置が、送/受光ユニットからなる障害物検出装置を備え、
さらに、占有された、予め計算された装置の最初の位置からの、多数の可能な位置および方位(パーティクル(小部分))(これらの「位置および方位」を以下「パーティクル(小部分)」と称することとする)が計算され、および装置のそれに対応した走行後に次に占有される第2の位置に関して、光学ユニットの測定結果に基づき、確率を考慮した所定の選択アルゴリズムに従って、予め発生されたパーティクルの1つが装置の新たな位置として占有される、自走式装置の位置の決定方法に関するものである。
2 床
3 走行車
4 装置フード
5 センサ
6 パーティクル(小部分)
7 パーティクル群
7′ パーティクル群のサブ範囲
b 確率高さ
c 矢印
d 回転軸線
r 矢印
x 第1の座標軸
y 第2の座標軸
A 障害物検出装置
E 平面
H 度数曲線
K 座標系
M 平均値
P 最大
δx x軸方向の分散
δy y軸方向の分散
Claims (6)
- 送/受光ユニットからなる障害物検出装置(A)を備える自走式装置(1)の位置の決定方法であって、
予め計算された前記自走式装置(1)の最初の位置からの、多数の可能な位置および方位が計算され、当該自走式装置(1)の計算された位置および方位がパーティクルとして示され、そして、前記自走式装置(1)の走行後に占有される第2の位置に関して、前記障害物検出装置(A)の測定結果に基づき、確率を考慮した所定の選択アルゴリズムに従って、前記自走式装置(1)の新たな位置を決定する、自走式装置(1)の位置の決定方法において、
計算されたパーティクル群(7)の最大の広がりに座標系(K)の第1の座標軸(x、y)が割り当てられるように、パーティクル(6)が評価されること、
そして、前記第1の座標軸(x、y)に対して垂直の方向に第2の座標軸(y、x)を割り当てること、
さらに、パーティクル(6)が全て前記第1の座標軸(x、y)内に投影され且つこのようにして得られたパーティクル分布に度数曲線(H)が割り当てられ、当該度数曲線(H)の最大値をとる位置(P)が前記自走式装置(1)の実際の位置の近似として決定されること、
を特徴とする自走式装置(1)の位置の決定方法。 - 前記第1の座標軸(x、y)のパーティクル(6)の分散に基づいて偏差に関してしきい値が設けられ、当該しきい値を超えるパーティクル(6)はもはや評価の対象とされないことを特徴とする請求項1に記載の方法。
- 前記パーティクル(6)が方位角に関して評価されることを特徴とする請求項1または2に記載の方法。
- 前記自走式装置(1)の所定の走行方向に対応するパーティクル(6)が、当該所定の走行路内に存在しないパーティクル(6)よりもより高い評価を受けることを特徴とする請求項1ないし3のいずれかに記載の方法。
- 前記自走式装置(1)が、電動駆動走行車輪(3)を有することを特徴とする請求項1ないし4のいずれかに記載の方法。
- 前記自走式装置(1)が、自走式床集塵装置であることを特徴とする請求項1ないし5のいずれかに記載の方法。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102011000250A DE102011000250A1 (de) | 2011-01-21 | 2011-01-21 | Verfahren zur Bestimmung der Position eines selbsttätig verfahrbaren Geräts |
DE102011000250.2 | 2011-01-21 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2012155716A JP2012155716A (ja) | 2012-08-16 |
JP5923311B2 true JP5923311B2 (ja) | 2016-05-24 |
Family
ID=45497846
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2012008568A Expired - Fee Related JP5923311B2 (ja) | 2011-01-21 | 2012-01-19 | 自走式装置の位置の決定方法 |
Country Status (5)
Country | Link |
---|---|
EP (1) | EP2479584B1 (ja) |
JP (1) | JP5923311B2 (ja) |
CN (1) | CN102621554B (ja) |
DE (1) | DE102011000250A1 (ja) |
ES (1) | ES2536517T3 (ja) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102012108802A1 (de) | 2012-09-19 | 2014-03-20 | Vorwerk & Co. Interholding Gmbh | Selbsttätig verfahrbares Bodenreinigungsgerät und Verfahren zum Betreiben eines Bodenreinigungsgerätes |
JP6218445B2 (ja) * | 2013-06-14 | 2017-10-25 | 三菱電機株式会社 | 測位補強装置及び測位補強システム及び測位補強方法 |
CN103728978B (zh) * | 2013-12-23 | 2017-02-15 | 江苏清弘物联网股份有限公司 | 一种沙盘车模控制装置 |
DE102015100706A1 (de) * | 2014-12-15 | 2016-06-16 | Vorwerk & Co. Interholding Gmbh | Selbsttätig verfahrbares Reinigungsgerät |
AT517225B1 (de) * | 2015-06-12 | 2016-12-15 | Smartbow Gmbh | Verfahren für die Ortung von Tieren mit Hilfe von Funkwellen |
JP6642026B2 (ja) * | 2016-01-20 | 2020-02-05 | 株式会社豊田自動織機 | 自律移動体制御装置 |
DE102016101552A1 (de) | 2016-01-28 | 2017-08-03 | Vorwerk & Co. Interholding Gmbh | Verfahren zum Erstellen einer Umgebungskarte für ein selbsttätig verfahrbares Bearbeitungsgerät |
DE102016224764A1 (de) * | 2016-12-13 | 2018-06-14 | Robert Bosch Gmbh | Verfahren und Vorrichtung zum Betreiben eines Laserscanners und Laserscanner |
DE102016125319A1 (de) | 2016-12-22 | 2018-06-28 | Vorwerk & Co. Interholding Gmbh | Verfahren zum Betrieb eines sich selbsttätig fortbewegenden Fahrzeugs |
DE102017108194A1 (de) | 2017-04-18 | 2018-10-18 | Vorwerk & Co. Interholding Gmbh | Verfahren zum Betrieb eines sich selbsttätig fortbewegenden Fahrzeugs |
CN113532472A (zh) * | 2020-04-15 | 2021-10-22 | 北京智行者科技有限公司 | 一种检测激光建图里程计与组合导航定位偏差的方法及系统 |
CN112631306B (zh) * | 2020-12-28 | 2021-12-14 | 深圳市普渡科技有限公司 | 机器人移动路径规划方法、装置及机器人 |
US20220261008A1 (en) * | 2021-02-16 | 2022-08-18 | Sony Group Corporation | Circuitry and method |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10242257C5 (de) | 2001-09-14 | 2017-05-11 | Vorwerk & Co. Interholding Gmbh | Selbsttätig verfahrbares Bodenstaub-Aufsammelgerät, sowie Kombination eines derartigen Aufsammelgerätes und einer Basisstation |
KR100855469B1 (ko) * | 2006-09-13 | 2008-09-01 | 삼성전자주식회사 | 이동 로봇의 자세 추정 장치 및 방법 |
KR100809352B1 (ko) * | 2006-11-16 | 2008-03-05 | 삼성전자주식회사 | 파티클 필터 기반의 이동 로봇의 자세 추정 방법 및 장치 |
DE102008014912B4 (de) | 2008-03-19 | 2023-01-19 | Vorwerk & Co. Interholding Gmbh | Selbsttätig verfahrbares Bodenstaub-Aufsammelgerät |
CN102083352B (zh) * | 2008-04-24 | 2014-10-15 | 艾罗伯特公司 | 用于机器人使能的移动产品的定位、位置控制和导航系统的应用 |
JP2010224755A (ja) * | 2009-03-23 | 2010-10-07 | Toyota Motor Corp | 移動体及び移動体の位置推定方法 |
DE102011000009A1 (de) * | 2011-01-03 | 2012-07-05 | Vorwerk & Co. Interholding Gmbh | Verfahren zur gleichzeitigen Bestimmung und Kartenbildung |
-
2011
- 2011-01-21 DE DE102011000250A patent/DE102011000250A1/de not_active Withdrawn
-
2012
- 2012-01-11 ES ES12150695.0T patent/ES2536517T3/es active Active
- 2012-01-11 EP EP12150695.0A patent/EP2479584B1/de active Active
- 2012-01-19 JP JP2012008568A patent/JP5923311B2/ja not_active Expired - Fee Related
- 2012-01-21 CN CN201210084097.XA patent/CN102621554B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN102621554B (zh) | 2015-07-08 |
CN102621554A (zh) | 2012-08-01 |
ES2536517T3 (es) | 2015-05-26 |
EP2479584B1 (de) | 2015-04-01 |
EP2479584A2 (de) | 2012-07-25 |
EP2479584A3 (de) | 2013-07-31 |
DE102011000250A1 (de) | 2012-07-26 |
JP2012155716A (ja) | 2012-08-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5923311B2 (ja) | 自走式装置の位置の決定方法 | |
JP5827891B2 (ja) | 同時の位置決定およびマップ作成方法 | |
EP3104194B1 (en) | Robot positioning system | |
CN112654473B (zh) | 机器人清洁器及其控制方法 | |
AU2017402126B2 (en) | Vacuum cleaner and control method thereof | |
CN112399813B (zh) | 多个自主移动机器人及其控制方法 | |
US20180218216A1 (en) | Robot cleaner and method for controlling the same | |
KR102015498B1 (ko) | 복수의 자율주행 청소기 및 그 제어방법 | |
CN113631334B (zh) | 移动机器人和控制多个移动机器人的方法 | |
AU2017424181B2 (en) | Cleaner and control method thereof | |
EP2776216A1 (en) | Scaling vector field slam to large environments | |
KR102070283B1 (ko) | 청소기 및 그 제어방법 | |
US9739874B2 (en) | Apparatus for detecting distances in two directions | |
US20220175210A1 (en) | Moving robot and controlling method for the moving robot | |
US20210338031A1 (en) | Robot cleaner and method for controlling same | |
US20210259498A1 (en) | Plurality of autonomous cleaner and controlling method for the same | |
US20220061617A1 (en) | Mobile robot | |
US20220211236A1 (en) | Mobile robot and control method of mobile robots | |
JP2023011556A (ja) | 劣化したlidar範囲測定精度を検出するための方法およびシステム | |
KR102535719B1 (ko) | 이동 로봇 및 이동 로봇의 제어방법 | |
EP3911479B1 (en) | Mobile robot and method of controlling mobile robot | |
CN113194802B (zh) | 机器人清洁器及其操作方法 | |
US20230225580A1 (en) | Robot cleaner and robot cleaner control method | |
KR102115193B1 (ko) | 로봇 청소기 및 그 동작방법 | |
KR20220121483A (ko) | 지능적 맵 생성 방법 및 그 이동 로봇 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20140924 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20150819 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20150825 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20151111 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20160301 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160302 |
|
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: 20160329 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160418 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5923311 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |