JPH07295634A - 自走式移動ユニットのセル構造化された周辺マップの作成方法 - Google Patents
自走式移動ユニットのセル構造化された周辺マップの作成方法Info
- Publication number
- JPH07295634A JPH07295634A JP7051518A JP5151895A JPH07295634A JP H07295634 A JPH07295634 A JP H07295634A JP 7051518 A JP7051518 A JP 7051518A JP 5151895 A JP5151895 A JP 5151895A JP H07295634 A JPH07295634 A JP H07295634A
- Authority
- JP
- Japan
- Prior art keywords
- self
- map
- mobile unit
- cell
- peripheral
- 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.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims description 12
- 230000033001 locomotion Effects 0.000 title claims description 11
- 230000002093 peripheral effect Effects 0.000 claims abstract description 57
- 238000005259 measurement Methods 0.000 claims description 4
- 230000015572 biosynthetic process Effects 0.000 claims description 2
- 238000011156 evaluation Methods 0.000 claims description 2
- 230000004807 localization Effects 0.000 abstract description 5
- 238000010586 diagram Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000012854 evaluation process Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
Classifications
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4061—Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
-
- 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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/89—Radar or analogous systems specially adapted for specific applications for mapping or imaging
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
- A47L2201/04—Automatic control of the travelling movement; Automatic obstacle detection
-
- 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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/06—Systems determining position data of a target
- G01S13/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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Instructional Devices (AREA)
Abstract
(57)【要約】
【目的】 周辺マップ内の自走式移動ユニットの局所化
の改善によって、さらに改善されたセル構造の周辺マッ
プを作成すること。 【構成】 センサを用いてセンサから周辺対象物までの
距離を求め、測定時点に対する自走式移動ユニットの固
有位置として周辺マップにおける原点セル内部の座標基
準点の正確な位置を用い、前記周辺マップにおける周辺
対象物の位置の確定のために、少なくとも各セル毎に占
有度を割当て、前記セルは前記固有位置と間隔距離とセ
ンサの配設位置の考慮下で座標基準点に対して相対的に
求められるように構成する。
の改善によって、さらに改善されたセル構造の周辺マッ
プを作成すること。 【構成】 センサを用いてセンサから周辺対象物までの
距離を求め、測定時点に対する自走式移動ユニットの固
有位置として周辺マップにおける原点セル内部の座標基
準点の正確な位置を用い、前記周辺マップにおける周辺
対象物の位置の確定のために、少なくとも各セル毎に占
有度を割当て、前記セルは前記固有位置と間隔距離とセ
ンサの配設位置の考慮下で座標基準点に対して相対的に
求められるように構成する。
Description
【0001】
【産業上の利用分野】本発明は、少なくとも波動反射に
基づくセンサを用いて周辺領域におけるオリエンテーシ
ョンを行う自走式移動ユニットのセル構造化された周辺
マップの作成方法に関する。
基づくセンサを用いて周辺領域におけるオリエンテーシ
ョンを行う自走式移動ユニットのセル構造化された周辺
マップの作成方法に関する。
【0002】
【従来の技術】今日においては自律的に作業する移動ユ
ニットの使用分野には多種多様なものがある。その関連
の中では例えば遠隔偵察ゾンデ、危険領域にて作業する
移動ユニット、工場用自走式掃除機、組立工場内の搬送
車両や、当然ながら自走式ロボット等が考えられる。し
かしながら先験的には未知の周辺環境において有意義な
役割を果たし得るためには、自律的移動ロボットはステ
ップ毎にその作業周辺領域での信頼できるマップを作成
するのはもとより、さらにこのマップに基づいていずれ
の所与の時点でも自動的に局所化し得ることが必要であ
る。前記自走式ユニットのおそらく稼働させられであろ
う周辺領域は非常に複雑で秩序のない状態であるが故に
ユニットの使用範囲はしばしば事務所や家事回り等の特
殊な環境に制限され続ける。一般的には先験的なマップ
は可用ではないので、そのような自走式ユニットにおい
ては融通性を以ってその周辺領域と相互的に作用するこ
とを可能にする複数のセンサを装備しなければならな
い。そのようなセンサのいくつかには例えばレーザ間隔
距離走査器、ビデオカメラ、超音波センサ等がある。
ニットの使用分野には多種多様なものがある。その関連
の中では例えば遠隔偵察ゾンデ、危険領域にて作業する
移動ユニット、工場用自走式掃除機、組立工場内の搬送
車両や、当然ながら自走式ロボット等が考えられる。し
かしながら先験的には未知の周辺環境において有意義な
役割を果たし得るためには、自律的移動ロボットはステ
ップ毎にその作業周辺領域での信頼できるマップを作成
するのはもとより、さらにこのマップに基づいていずれ
の所与の時点でも自動的に局所化し得ることが必要であ
る。前記自走式ユニットのおそらく稼働させられであろ
う周辺領域は非常に複雑で秩序のない状態であるが故に
ユニットの使用範囲はしばしば事務所や家事回り等の特
殊な環境に制限され続ける。一般的には先験的なマップ
は可用ではないので、そのような自走式ユニットにおい
ては融通性を以ってその周辺領域と相互的に作用するこ
とを可能にする複数のセンサを装備しなければならな
い。そのようなセンサのいくつかには例えばレーザ間隔
距離走査器、ビデオカメラ、超音波センサ等がある。
【0003】このような移動ユニットの抱える大きな問
題は、周辺マップの作成と移動ユニットの局所化が相互
に依存していることである。この場合種々異なるエラー
が生ぜしめられる。例えば、一方でそのような移動ユニ
ットが初期位置から進んだ距離を誤って測定し、他方で
前記移動ユニットが距離センサによって遭遇した障害物
までの間隔距離を誤って測定し、そしてこれらをランド
マークとして周辺マップにプロットすること等である。
これらのエラーは累積されて比較的長い区間に亘って加
算されるので、所定の限界を超えると移動ユニットの合
目的的な操縦性はもはや発揮できなくなる。
題は、周辺マップの作成と移動ユニットの局所化が相互
に依存していることである。この場合種々異なるエラー
が生ぜしめられる。例えば、一方でそのような移動ユニ
ットが初期位置から進んだ距離を誤って測定し、他方で
前記移動ユニットが距離センサによって遭遇した障害物
までの間隔距離を誤って測定し、そしてこれらをランド
マークとして周辺マップにプロットすること等である。
これらのエラーは累積されて比較的長い区間に亘って加
算されるので、所定の限界を超えると移動ユニットの合
目的的な操縦性はもはや発揮できなくなる。
【0004】未知の周辺環境における自走式移動ユニッ
トのオリエンテーションのための手法は次のようなこと
からなる。すなわちまずユニットが2次元の格子状マッ
プを作成しこの格子状マップの個々のセルに占有値を与
えることからなる。各格子状セル毎に与えられる占有値
は周辺領域における障害物の生起状態を表わすものであ
る。
トのオリエンテーションのための手法は次のようなこと
からなる。すなわちまずユニットが2次元の格子状マッ
プを作成しこの格子状マップの個々のセルに占有値を与
えることからなる。各格子状セル毎に与えられる占有値
は周辺領域における障害物の生起状態を表わすものであ
る。
【0005】格子状マップにおける自走式ユニットのオ
リエンテーションのための方法は例えば公知文献“Hi
stogrammic in Motion Mapp
ing for Mobile Robot Obst
acle Avoidence,IEEE Trans
actions on Robotics Autom
ation,Vol.7,No.4,Aug.199
1,von J.Borenstein and Yo
ram Koren”から公知である。この文献には自
走式ユニットにおいて超音波センサを用いて周辺マップ
がどのように作成されるかが記載されている。
リエンテーションのための方法は例えば公知文献“Hi
stogrammic in Motion Mapp
ing for Mobile Robot Obst
acle Avoidence,IEEE Trans
actions on Robotics Autom
ation,Vol.7,No.4,Aug.199
1,von J.Borenstein and Yo
ram Koren”から公知である。この文献には自
走式ユニットにおいて超音波センサを用いて周辺マップ
がどのように作成されるかが記載されている。
【0006】
【発明が解決しようとする課題】本発明の課題は、セル
構造化された周辺マップの作成が、周辺マップ内部にお
ける自走式移動ユニットの局所化の改善によりさらに改
善される方法を提供することである。
構造化された周辺マップの作成が、周辺マップ内部にお
ける自走式移動ユニットの局所化の改善によりさらに改
善される方法を提供することである。
【0007】
【課題を解決するための手段】本発明によれば上記課題
は、センサを用いてセンサから周辺対象物までの距離を
求め、測定時点に対する自走式移動ユニットの固有位置
として周辺マップにおける原点セル内部の座標基準点の
正確な位置を用い、前記周辺マップにおける周辺対象物
の位置の確定のために、少なくとも各セル毎に占有度を
割当て、前記セルは前記固有位置と間隔距離とセンサの
配設位置の考慮下で座標基準点に対して相対的に求めら
れるようにして解決される。
は、センサを用いてセンサから周辺対象物までの距離を
求め、測定時点に対する自走式移動ユニットの固有位置
として周辺マップにおける原点セル内部の座標基準点の
正確な位置を用い、前記周辺マップにおける周辺対象物
の位置の確定のために、少なくとも各セル毎に占有度を
割当て、前記セルは前記固有位置と間隔距離とセンサの
配設位置の考慮下で座標基準点に対して相対的に求めら
れるようにして解決される。
【0008】本発明による別の有利な実施例は従属請求
項に記載される。
項に記載される。
【0009】本発明の方法によれば有利には、周辺領域
における障害物からの間隔距離の決定の際に、周辺マッ
プにおける原点セル内部で自走式移動ユニットの局所化
が考慮される。これにより選択されたセルサイズに依存
して周辺マップがさらに改善されより正確なものにな
る。なぜなら周辺マップの割当てるべきセルへの個別化
が限定され、ことさら自走式移動ユニットの位置を個別
に示す必要がなくなるからである。
における障害物からの間隔距離の決定の際に、周辺マッ
プにおける原点セル内部で自走式移動ユニットの局所化
が考慮される。これにより選択されたセルサイズに依存
して周辺マップがさらに改善されより正確なものにな
る。なぜなら周辺マップの割当てるべきセルへの個別化
が限定され、ことさら自走式移動ユニットの位置を個別
に示す必要がなくなるからである。
【0010】自走式移動ユニットのより良好な機動性を
補償するために本発明の方法によれば、自走式移動ユニ
ット近傍において比較的小さい格子状セルが用いられ
る。なぜならこの小さな格子状セルによっては、それに
より得られる高解像度により、相互に密に隣接する障害
物の間でもその間を縫って機動させることが可能となる
からである。この場合有利には、比較的離れて存在する
セルは比較的大きな寸法を有し得る。それにより値の割
当ての際に要求される制御計算機に関するコストもさら
に低く抑えられる。
補償するために本発明の方法によれば、自走式移動ユニ
ット近傍において比較的小さい格子状セルが用いられ
る。なぜならこの小さな格子状セルによっては、それに
より得られる高解像度により、相互に密に隣接する障害
物の間でもその間を縫って機動させることが可能となる
からである。この場合有利には、比較的離れて存在する
セルは比較的大きな寸法を有し得る。それにより値の割
当ての際に要求される制御計算機に関するコストもさら
に低く抑えられる。
【0011】セル構造の格子内における運動の個別化に
より生ぜしめられるオリエンテーションエラーの累積を
避けるために本発明の方法によれば有利には、局所的周
辺マップとグローバルな周辺マップが用いられる。自走
式移動ユニットの制御と実用的なプラン形成に対しては
グローバルな周辺マップのみが用いられる。しかしなが
ら局所的周辺マップの利用には次のような利点がある。
すなわち全てのセルが自走式移動ユニットに対する固定
的な位置関係を有し、複数のセルで同時に行われる値の
割当てが僅かな計算機コストで実施できる利点がある。
より生ぜしめられるオリエンテーションエラーの累積を
避けるために本発明の方法によれば有利には、局所的周
辺マップとグローバルな周辺マップが用いられる。自走
式移動ユニットの制御と実用的なプラン形成に対しては
グローバルな周辺マップのみが用いられる。しかしなが
ら局所的周辺マップの利用には次のような利点がある。
すなわち全てのセルが自走式移動ユニットに対する固定
的な位置関係を有し、複数のセルで同時に行われる値の
割当てが僅かな計算機コストで実施できる利点がある。
【0012】
【実施例】次に本発明の実施例を図面に基づき詳細に説
明する。
明する。
【0013】図1には自走式移動ユニットSEが周辺マ
ップUKの中で示されている。この周辺マップはセル状
に構造化され、座標系x,yによって構成されている。
この図では周辺マップの原点セルUZが拡大して示され
ている。但し自走式移動ユニットのサイズは維持されて
いない。周辺マップ内での自走式移動ユニットSEの局
所化をさらに改善するために、自走式移動ユニットSE
の瞬時の位置が原点セルZ内の測定過程の際に座標値y
_pos_centerとx_pos_centertos
itedeとして固定的に保持される。この2つの座標
値は座標基準点の位置KRPを示す。周辺マップ内の1
つのセルへの周辺対象物(これは大抵の場合障害物を表
している)の割当てはこのようにして正確に行われ得
る。一方では自走式移動ユニットの寸法は既知であり、
他方では自走式移動ユニット上のセンサの位置も既知で
ある。1つのセンサが障害物までの距離を検出した場合
には自走式移動ユニットの幾何構造と座標基準点KRP
の座標指示に基づいて障害物の位置が周辺マップ内で設
定され得る。これは1つの割当てグレードで割当てられ
るセルの決定の際に比較的高い精度が得られ、マップの
結像品質が向上することを意味する。
ップUKの中で示されている。この周辺マップはセル状
に構造化され、座標系x,yによって構成されている。
この図では周辺マップの原点セルUZが拡大して示され
ている。但し自走式移動ユニットのサイズは維持されて
いない。周辺マップ内での自走式移動ユニットSEの局
所化をさらに改善するために、自走式移動ユニットSE
の瞬時の位置が原点セルZ内の測定過程の際に座標値y
_pos_centerとx_pos_centertos
itedeとして固定的に保持される。この2つの座標
値は座標基準点の位置KRPを示す。周辺マップ内の1
つのセルへの周辺対象物(これは大抵の場合障害物を表
している)の割当てはこのようにして正確に行われ得
る。一方では自走式移動ユニットの寸法は既知であり、
他方では自走式移動ユニット上のセンサの位置も既知で
ある。1つのセンサが障害物までの距離を検出した場合
には自走式移動ユニットの幾何構造と座標基準点KRP
の座標指示に基づいて障害物の位置が周辺マップ内で設
定され得る。これは1つの割当てグレードで割当てられ
るセルの決定の際に比較的高い精度が得られ、マップの
結像品質が向上することを意味する。
【0014】図2には1つの自走式移動ユニットSEが
周辺マップUKに示されている。この周辺マップの実施
例では2つの異なるセルサイズZ1,Z2が選択されて
いる。相互に近隣する障害物の間においても自走式移動
ユニットSEの機動性をさらに向上させるために、自走
式移動ユニットSEの近傍では比較的小さいセルサイズ
が設定される。このようにして周辺領域の識別の際には
比較的高い解像度が得られ、より正確な自走式移動ユニ
ットの運動シーケンス制御が行われ得る。自走式移動ユ
ニットからさらに隔たった個所に比較的大きなセルを用
いれば、評価に関するコストを比較的僅かに抑えること
ができる。つまり測定過程とそれに結び付く割当てグレ
ードでのセルの割当てに対しては僅かな計算機コストし
か必要なくなる。
周辺マップUKに示されている。この周辺マップの実施
例では2つの異なるセルサイズZ1,Z2が選択されて
いる。相互に近隣する障害物の間においても自走式移動
ユニットSEの機動性をさらに向上させるために、自走
式移動ユニットSEの近傍では比較的小さいセルサイズ
が設定される。このようにして周辺領域の識別の際には
比較的高い解像度が得られ、より正確な自走式移動ユニ
ットの運動シーケンス制御が行われ得る。自走式移動ユ
ニットからさらに隔たった個所に比較的大きなセルを用
いれば、評価に関するコストを比較的僅かに抑えること
ができる。つまり測定過程とそれに結び付く割当てグレ
ードでのセルの割当てに対しては僅かな計算機コストし
か必要なくなる。
【0015】図3には局所的周辺マップLUKとグロー
バル周辺マップGUKを用いた実施例が示されている。
この図では自走式移動ユニットがグローバル周辺マップ
GUKに示されている。このグローバル周辺マップGU
Kは座標系x,yによって構成されている。その中には
周辺マップの様々な割当てられたセル1〜6が含まれて
いる。これらのセル1〜6は異なる濃さで示された種々
異なる占有度を有している。自走式移動ユニットSE
は、グローバル周辺マップ内では1つの回転角度Θ
(k)によって表わされる回転式オリエンテーリングを
行う。
バル周辺マップGUKを用いた実施例が示されている。
この図では自走式移動ユニットがグローバル周辺マップ
GUKに示されている。このグローバル周辺マップGU
Kは座標系x,yによって構成されている。その中には
周辺マップの様々な割当てられたセル1〜6が含まれて
いる。これらのセル1〜6は異なる濃さで示された種々
異なる占有度を有している。自走式移動ユニットSE
は、グローバル周辺マップ内では1つの回転角度Θ
(k)によって表わされる回転式オリエンテーリングを
行う。
【0016】自走式移動ユニットSEがその周辺で移動
している間は自走式移動ユニットSEに関する個々の格
子状セルの並進運動のみが行われる。この1つ又は複数
のセルの並進運動の種類と大きさはグローバル周辺マッ
プGUK内の自走式移動ユニットの速度とオリエンテー
ションに依存する。
している間は自走式移動ユニットSEに関する個々の格
子状セルの並進運動のみが行われる。この1つ又は複数
のセルの並進運動の種類と大きさはグローバル周辺マッ
プGUK内の自走式移動ユニットの速度とオリエンテー
ションに依存する。
【0017】周辺マップにおける種々異なるセルのデー
タ値の簡単な補正を実施し得るために、グローバル周辺
マップから局所的周辺マップが導出される。このマップ
では自走式移動ユニットSEは回転オリエンテーション
を有さない。しかしながら個々のセル1,3,4が角度
Θの値分だけ回転されてプロットされていることが認め
られる。局所的周辺マップLUKは座標系x′,y′に
よって形成される。この場合例えば所定の距離MAX_
DIST圏外にある全ての各セルがマップから消去され
る。これに対して例えば局所的周辺マップLUKに関す
る全てのセルのオリエンテーションを固定的に自走式移
動ユニットの制御計算機内に記憶させてもよい。また割
当てされたセルに対する記憶内容を記憶座標配置データ
と比較し、自走式移動ユニットまでの距離が単位MAX
_DISTを上回るかどうかが検出されなければならな
い。この評価過程によって割当てられたセル2,5,6
が省かれていることが識別可能となる。この場合重要な
のは自走式移動ユニットがグローバル周辺マップGUK
内部でのみオリエンテーションされ、この自走式移動ユ
ニットSEの移動プラン形成がグローバル周辺マップか
らの記憶された値にだけ基づいて行われるていることが
考慮されることである。グローバル周辺マップから局所
的周辺マップへの換算の際に発生する、セル位置を表わ
す値の個別化によって生じるエラーは累積され得ない。
タ値の簡単な補正を実施し得るために、グローバル周辺
マップから局所的周辺マップが導出される。このマップ
では自走式移動ユニットSEは回転オリエンテーション
を有さない。しかしながら個々のセル1,3,4が角度
Θの値分だけ回転されてプロットされていることが認め
られる。局所的周辺マップLUKは座標系x′,y′に
よって形成される。この場合例えば所定の距離MAX_
DIST圏外にある全ての各セルがマップから消去され
る。これに対して例えば局所的周辺マップLUKに関す
る全てのセルのオリエンテーションを固定的に自走式移
動ユニットの制御計算機内に記憶させてもよい。また割
当てされたセルに対する記憶内容を記憶座標配置データ
と比較し、自走式移動ユニットまでの距離が単位MAX
_DISTを上回るかどうかが検出されなければならな
い。この評価過程によって割当てられたセル2,5,6
が省かれていることが識別可能となる。この場合重要な
のは自走式移動ユニットがグローバル周辺マップGUK
内部でのみオリエンテーションされ、この自走式移動ユ
ニットSEの移動プラン形成がグローバル周辺マップか
らの記憶された値にだけ基づいて行われるていることが
考慮されることである。グローバル周辺マップから局所
的周辺マップへの換算の際に発生する、セル位置を表わ
す値の個別化によって生じるエラーは累積され得ない。
【図1】図1にはセル構造の周辺マップに自走式移動ユ
ニットを示した図である。
ニットを示した図である。
【図2】周辺マップにおける2つのセルサイズの例を示
した図である。
した図である。
【図3】グローバルな局所的周辺マップ。
SE 自走式移動ユニット UK 周辺マップ GUK グローバル周辺マップ LUK 局所的周辺マップ
Claims (4)
- 【請求項1】 少なくとも波動反射に基づくセンサを用
いて周辺領域におけるオリエンテーションを行う自走式
移動ユニットのセル構造化された周辺マップの作成方法
において、 a)センサを用いてセンサから周辺対象物までの距離を
求め、 b)測定時点に対する自走式移動ユニット(SE)の固
有位置(x_pos_center,y_pos_center)として周辺マップ
(UK)における原点セル(UZ)内部の座標基準点
(KRP)の正確な位置を用い、 c)前記周辺マップ(UK)における周辺対象物の位置
の確定のために、少なくとも各セル毎に占有度を割当
て、前記セルは前記固有位置と間隔距離とセンサの配設
位置の考慮下で座標基準点(KRP)に対して相対的に
求められることを特徴とする、自走式移動ユニットのセ
ル構造化された周辺マップの作成方法。 - 【請求項2】 前記周辺マップ(UK)の作成に対して
種々異なるサイズのセル(Z1,Z2)が用いられる、
請求項1記載の自走式移動ユニットのセル構造化された
周辺マップの作成方法。 - 【請求項3】 前記自走式移動ユニットの近傍に比較的
小さいセルサイズが細分化されたセルとして用いられて
いる、請求項2記載の自走式移動ユニットのセル構造化
された周辺マップの作成方法。 - 【請求項4】 a)自走式移動ユニットによって局所的
周辺マップ(LUK)とグローバルな周辺マップ(GU
K)を作成し、前記局所的周辺マップ(LUK)におい
て全てのセルが自走式移動ユニットに対する固定的位置
関係を有し、これに対して前記グローバル周辺マップ
(GUK)内のセルは、自走式移動ユニットの運動に起
因した自走式移動ユニットに対する可変の回転特性量を
有し、該回転特性量は回転角度(Θ)によって定めら
れ、 b)自走式移動ユニットの運動期間中は、グローバルな
格子状セルに並進運動のみを行わせ、運動に依存して別
の回転角度(Θ)をセッティングし、 c)周辺マップの複数のセルに該当する評価に対して、
グローバルな周辺マップ(GUK)から回転角度を用い
た三角関数の適用により局所的周辺マップ(LUK)を
導出し、 d)自走式移動ユニット(SE)の経路プラン形成に対
してグローバル周辺マップ(GUK)のみを利用する、
請求項1〜3いずれか1項記載の自走式移動ユニットの
セル構造化された周辺マップの作成方法。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE4408328.9 | 1994-03-11 | ||
DE4408328A DE4408328C2 (de) | 1994-03-11 | 1994-03-11 | Verfahren zum Aufbau einer zellular strukturierten Umgebungskarte von einer selbstbeweglichen mobilen Einheit, welche sich mit Hilfe von auf Wellenreflexion basierenden Sensoren orientiert |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH07295634A true JPH07295634A (ja) | 1995-11-10 |
Family
ID=6512565
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP7051518A Withdrawn JPH07295634A (ja) | 1994-03-11 | 1995-03-10 | 自走式移動ユニットのセル構造化された周辺マップの作成方法 |
Country Status (3)
Country | Link |
---|---|
US (1) | US5677836A (ja) |
JP (1) | JPH07295634A (ja) |
DE (1) | DE4408328C2 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997031301A1 (fr) * | 1996-02-21 | 1997-08-28 | Komatsu Ltd. | Procede cartographique de detection d'obstacles pour vehicule sans pilote et dispositif de detection d'obstacles |
KR100776944B1 (ko) * | 2006-05-01 | 2007-11-21 | 주식회사 한울로보틱스 | 이동로봇의 맵 빌딩방법 |
CN104655007A (zh) * | 2013-11-22 | 2015-05-27 | 中国科学院深圳先进技术研究院 | 一种创建环境场景全局坐标方法及系统 |
WO2021172163A1 (ja) * | 2020-02-28 | 2021-09-02 | ソニーグループ株式会社 | 情報処理装置、情報処理方法、情報処理プログラムおよび移動体 |
Families Citing this family (55)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0779998B1 (de) * | 1994-09-06 | 1998-03-25 | Siemens Aktiengesellschaft | Verfahren zur bestimmung der position einer landmarke in der umgebungskarte einer selbstbeweglichen einheit, deren abstand zur einheit dynamisch von dieser ermittelt wird |
WO1998000767A1 (de) * | 1996-07-02 | 1998-01-08 | Siemens Aktiengesellschaft | Verfahren zur erstellung einer zellular strukturierten umgebungskarte von einer selbstbeweglichen mobilen einheit, welche sich mit hilfe mit auf wellenreflexion basierenden sensoren in der umgebung orientiert |
DE19641261C1 (de) * | 1996-10-07 | 1998-02-12 | Siemens Ag | Verfahren zur Bewertung der Meßqualität eines Entfernungsmeßsensors an einem autonomen mobilen System |
IL124413A (en) * | 1998-05-11 | 2001-05-20 | Friendly Robotics Ltd | System and method for area coverage with an autonomous robot |
EP1098587A1 (de) | 1998-07-31 | 2001-05-16 | Volker Sommer | Haushaltsroboter zum automatischen staubsaugen von bodenflächen |
SE0100924D0 (sv) * | 2001-03-15 | 2001-03-15 | Electrolux Ab | Energy-efficient navigation of an autonomous surface treatment apparatus |
US6842692B2 (en) | 2002-07-02 | 2005-01-11 | The United States Of America As Represented By The Department Of Veterans Affairs | Computer-controlled power wheelchair navigation system |
US20080300777A1 (en) * | 2002-07-02 | 2008-12-04 | Linda Fehr | Computer-controlled power wheelchair navigation system |
US7177737B2 (en) * | 2002-12-17 | 2007-02-13 | Evolution Robotics, Inc. | Systems and methods for correction of drift via global localization with a visual landmark |
AU2003900861A0 (en) * | 2003-02-26 | 2003-03-13 | Silverbrook Research Pty Ltd | Methods,systems and apparatus (NPS042) |
US7801645B2 (en) * | 2003-03-14 | 2010-09-21 | Sharper Image Acquisition Llc | Robotic vacuum cleaner with edge and object detection system |
US20050010331A1 (en) * | 2003-03-14 | 2005-01-13 | Taylor Charles E. | Robot vacuum with floor type modes |
US20040244138A1 (en) * | 2003-03-14 | 2004-12-09 | Taylor Charles E. | Robot vacuum |
US7805220B2 (en) * | 2003-03-14 | 2010-09-28 | Sharper Image Acquisition Llc | Robot vacuum with internal mapping system |
US20040200505A1 (en) * | 2003-03-14 | 2004-10-14 | Taylor Charles E. | Robot vac with retractable power cord |
KR100506097B1 (ko) * | 2004-02-04 | 2005-08-03 | 삼성전자주식회사 | 자기장 지도 생성 방법 및 장치와 이를 활용한 이동체의포즈 확인 방법 및 장치 |
ATE536577T1 (de) | 2004-06-24 | 2011-12-15 | Irobot Corp | Fernbediente ablaufsteuerung und verfahren für eine autonome robotervorrichtung |
US7706917B1 (en) | 2004-07-07 | 2010-04-27 | Irobot Corporation | Celestial navigation system for an autonomous robot |
US11209833B2 (en) | 2004-07-07 | 2021-12-28 | Irobot Corporation | Celestial navigation system for an autonomous vehicle |
US8972052B2 (en) * | 2004-07-07 | 2015-03-03 | Irobot Corporation | Celestial navigation system for an autonomous vehicle |
JP2006085369A (ja) * | 2004-09-15 | 2006-03-30 | Sony Corp | 移動体装置及びその制御方法 |
US8930023B2 (en) | 2009-11-06 | 2015-01-06 | Irobot Corporation | Localization by learning of wave-signal distributions |
WO2007047510A2 (en) * | 2005-10-14 | 2007-04-26 | Aethon, Inc. | Robotic inventory management |
DE102006061390B4 (de) | 2006-12-23 | 2019-05-16 | Volkswagen Ag | Umfelderfassungssystem und Umfelderfassungsverfahren eines Kraftfahrzeugs |
US20080228384A1 (en) * | 2007-03-17 | 2008-09-18 | Erickson Clinton W | Navigational system for a personal mobility device |
KR20090077547A (ko) * | 2008-01-11 | 2009-07-15 | 삼성전자주식회사 | 이동 로봇의 경로 계획 방법 및 장치 |
JP4788722B2 (ja) | 2008-02-26 | 2011-10-05 | トヨタ自動車株式会社 | 自律移動ロボット、自己位置推定方法、環境地図の生成方法、環境地図の生成装置、及び環境地図のデータ構造 |
US8364309B1 (en) * | 2009-07-14 | 2013-01-29 | Bailey Bendrix L | User-assisted robot navigation system |
US9026302B2 (en) * | 2009-11-06 | 2015-05-05 | Irobot Corporation | Methods and systems for complete coverage of a surface by an autonomous robot |
EP2619742B1 (en) | 2010-09-24 | 2018-02-28 | iRobot Corporation | Systems and methods for vslam optimization |
TW201239643A (en) * | 2011-03-30 | 2012-10-01 | Micro Star Int Co Ltd | Clean path guiding method with dirt detection |
US8565958B1 (en) * | 2011-06-02 | 2013-10-22 | Google Inc. | Removing extraneous objects from maps |
DE102011108468A1 (de) * | 2011-07-23 | 2013-01-24 | Volkswagen Aktiengesellschaft | Verfahren und Vorrichtung zur Generierung von dreidimensionalen Umfeldinformationen |
US8798840B2 (en) | 2011-09-30 | 2014-08-05 | Irobot Corporation | Adaptive mapping with spatial summaries of sensor data |
TWM451103U (zh) * | 2012-10-30 | 2013-04-21 | Agait Technology Corp | 行走裝置 |
US9020637B2 (en) | 2012-11-02 | 2015-04-28 | Irobot Corporation | Simultaneous localization and mapping for a mobile robot |
DE102013207904A1 (de) * | 2013-04-30 | 2014-10-30 | Bayerische Motoren Werke Aktiengesellschaft | Bereitstellen einer effizienten Umfeldkarte für ein Fahrzeug |
US9037396B2 (en) | 2013-05-23 | 2015-05-19 | Irobot Corporation | Simultaneous localization and mapping for a mobile robot |
DE102014223363B4 (de) * | 2014-11-17 | 2021-04-29 | Volkswagen Aktiengesellschaft | Verfahren und Vorrichtung zur Lokalisation eines Kraftfahrzeugs in einer ortsfesten Referenzkarte |
WO2016138529A1 (en) | 2015-02-27 | 2016-09-01 | Abb Technology Ag | Localization, mapping and haptic feedback for inspection of a confined space in machinery |
IL250762B (en) | 2017-02-23 | 2020-09-30 | Appelman Dina | Method and system for unmanned vehicle navigation |
US10921816B2 (en) * | 2017-04-21 | 2021-02-16 | Korea Advanced Institute Of Science And Technology | Method and apparatus for producing map based on hierarchical structure using 2D laser scanner |
WO2018220048A1 (en) * | 2017-06-02 | 2018-12-06 | Sony Corporation | Apparatus, method and computer program for computer vision |
IL252769B (en) * | 2017-06-08 | 2021-10-31 | Israel Aerospace Ind Ltd | Method and system for autonomous vehicle navigation |
ES2935618T3 (es) * | 2018-08-30 | 2023-03-08 | Elta Systems Ltd | Método de navegación de un vehículo y sistema del mismo |
US10611028B1 (en) * | 2018-11-30 | 2020-04-07 | NextVPU (Shanghai) Co., Ltd. | Map building and positioning of robot |
CN109557927B (zh) * | 2019-01-10 | 2021-11-26 | 深圳先进储能技术有限公司 | 用于机器人返回吊篮的路径规划方法、装置、设备及介质 |
EP3949817B1 (en) * | 2019-03-28 | 2024-05-01 | LG Electronics Inc. | Artificial intelligence cleaner and operation method thereof |
KR102224637B1 (ko) | 2019-07-05 | 2021-03-08 | 엘지전자 주식회사 | 이동 로봇 및 그 제어방법 |
KR102275300B1 (ko) | 2019-07-05 | 2021-07-08 | 엘지전자 주식회사 | 이동 로봇 및 그 제어방법 |
KR102297496B1 (ko) * | 2019-07-11 | 2021-09-02 | 엘지전자 주식회사 | 인공지능을 이용한 이동 로봇 및 이동 로봇의 제어방법 |
KR102361130B1 (ko) | 2019-07-11 | 2022-02-09 | 엘지전자 주식회사 | 이동 로봇 및 그 제어방법 |
CN110888443A (zh) * | 2019-12-04 | 2020-03-17 | 上海大学 | 一种移动机器人旋转避障方法及系统 |
CN111267107B (zh) * | 2020-03-23 | 2021-07-02 | 上海高仙自动化科技发展有限公司 | 控制方法、机器人、电子设备和可读存储介质 |
CN111238854B (zh) * | 2020-04-28 | 2020-08-04 | 浙江欣奕华智能科技有限公司 | 一种扫地机器人覆盖率的确定方法、装置、设备及介质 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58190713A (ja) * | 1982-05-01 | 1983-11-07 | Honda Motor Co Ltd | 移動体の現在位置表示装置 |
US4821206A (en) * | 1984-11-27 | 1989-04-11 | Photo Acoustic Technology, Inc. | Ultrasonic apparatus for positioning a robot hand |
US4718023A (en) * | 1984-11-27 | 1988-01-05 | Photo Acoustic Technology, Inc. | Ultrasonic apparatus for positioning a robot hand |
US4751658A (en) * | 1986-05-16 | 1988-06-14 | Denning Mobile Robotics, Inc. | Obstacle avoidance system |
GB2222047A (en) * | 1988-07-25 | 1990-02-21 | Unisearch Ltd | Optical mapping of field of view and information storage |
US4954962A (en) * | 1988-09-06 | 1990-09-04 | Transitions Research Corporation | Visual navigation and obstacle avoidance structured light system |
US5006988A (en) * | 1989-04-28 | 1991-04-09 | University Of Michigan | Obstacle-avoiding navigation system |
US5111402A (en) * | 1990-01-19 | 1992-05-05 | Boeing Company | Integrated aircraft test system |
JPH04227507A (ja) * | 1990-07-02 | 1992-08-17 | Nec Corp | 移動ロボット用のマップを作成し保持する方法 |
US5204814A (en) * | 1990-11-13 | 1993-04-20 | Mobot, Inc. | Autonomous lawn mower |
EP0488828B1 (en) * | 1990-11-30 | 1996-08-14 | Honda Giken Kogyo Kabushiki Kaisha | Control device of an autonomously moving body and evaluation method for data thereof |
US5502638A (en) * | 1992-02-10 | 1996-03-26 | Honda Giken Kogyo Kabushiki Kaisha | System for obstacle avoidance path planning for multiple-degree-of-freedom mechanism |
JPH0680203A (ja) * | 1992-03-24 | 1994-03-22 | East Japan Railway Co | 床面洗浄ロボットの制御方法 |
-
1994
- 1994-03-11 DE DE4408328A patent/DE4408328C2/de not_active Expired - Fee Related
-
1995
- 1995-02-24 US US08/393,820 patent/US5677836A/en not_active Expired - Fee Related
- 1995-03-10 JP JP7051518A patent/JPH07295634A/ja not_active Withdrawn
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997031301A1 (fr) * | 1996-02-21 | 1997-08-28 | Komatsu Ltd. | Procede cartographique de detection d'obstacles pour vehicule sans pilote et dispositif de detection d'obstacles |
KR100776944B1 (ko) * | 2006-05-01 | 2007-11-21 | 주식회사 한울로보틱스 | 이동로봇의 맵 빌딩방법 |
CN104655007A (zh) * | 2013-11-22 | 2015-05-27 | 中国科学院深圳先进技术研究院 | 一种创建环境场景全局坐标方法及系统 |
WO2021172163A1 (ja) * | 2020-02-28 | 2021-09-02 | ソニーグループ株式会社 | 情報処理装置、情報処理方法、情報処理プログラムおよび移動体 |
Also Published As
Publication number | Publication date |
---|---|
DE4408328C2 (de) | 2002-09-26 |
US5677836A (en) | 1997-10-14 |
DE4408328A1 (de) | 1995-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPH07295634A (ja) | 自走式移動ユニットのセル構造化された周辺マップの作成方法 | |
EP3764186B1 (en) | Method for controlling autonomous mobile robot to travel along edge | |
US20200301443A1 (en) | Discovery and monitoring of an environment using a plurality of robots | |
CN106969768B (zh) | 一种无轨导航agv的精确定位及停车方法 | |
Elfes | A sonar-based mapping and navigation system | |
US20220236735A1 (en) | Method of navigating a vehicle and system thereof | |
CN108663681A (zh) | 基于双目摄像头与二维激光雷达的移动机器人导航方法 | |
Crowley | Dynamic world modeling for an intelligent mobile robot using a rotating ultra-sonic ranging device | |
Hong et al. | Image-based homing | |
US9116523B2 (en) | Apparatus and method of cell-based path planning for mobile body | |
CN111881239B (zh) | 构建方法、构建装置、智能机器人及可读存储介质 | |
US5999866A (en) | Infrastructure independent position determining system | |
JPH10501908A (ja) | 自律可動式装置のオリエンテーション、ルート選定及び制御のための方法 | |
JP6649743B2 (ja) | 一致性評価装置および一致性評価方法 | |
CN110211228A (zh) | 用于建图的数据处理方法及装置 | |
CN110411435B (zh) | 机器人定位方法、装置以及机器人 | |
Bischoff et al. | Fusing vision and odometry for accurate indoor robot localization | |
Cho et al. | Autonomous positioning of the unloading auger of a combine harvester by a laser sensor and GNSS | |
CN113934225A (zh) | 一种基于全覆盖路径的植保无人机航线规划方法 | |
CN116429121A (zh) | 基于多传感器的定位方法、装置、自移动设备及存储介质 | |
US20220339786A1 (en) | Image-based trajectory planning method and movement control method and mobile machine using the same | |
Kolu et al. | A mapping method tolerant to calibration and localization errors based on tilting 2D laser scanner | |
Thompson et al. | Stereo vision terrain modeling for non-planar mobile robot mapping and navigation | |
CN113048978A (zh) | 移动机器人重定位方法及移动机器人 | |
Lecking et al. | Localization in a wide range of industrial environments using relative 3D ceiling features |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Application deemed to be withdrawn because no request for examination was validly filed |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20020604 |