JP5923311B2 - 自走式装置の位置の決定方法 - Google Patents

自走式装置の位置の決定方法 Download PDF

Info

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
Application number
JP2012008568A
Other languages
English (en)
Other versions
JP2012155716A (ja
Inventor
アンドレス・ザワーヴァルト
マリオ・ウォールメイヤー
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Vorwerk and Co Interholding GmbH
Original Assignee
Vorwerk and Co Interholding GmbH
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Vorwerk and Co Interholding GmbH filed Critical Vorwerk and Co Interholding GmbH
Publication of JP2012155716A publication Critical patent/JP2012155716A/ja
Application granted granted Critical
Publication of JP5923311B2 publication Critical patent/JP5923311B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/16Position-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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • G01S17/42Simultaneous measurement of distance and other co-ordinates
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-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/0278Position-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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control 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つが装置の新たな位置として占有される、自走式装置の位置の決定方法に関するものである。
例えば、床を清掃するための自走式吸込/掃除機に関して、さらに他の実施形態において、例えば、自走式運搬機または芝刈機に関して、当該タイプの方法が既知である。このような装置は、例えば走行路内に存在する物体等との衝突を回避するために間隔センサを備えていることが好ましい。これらのセンサは、好ましくは非接触で、さらに好ましくは光センサまたは超音波センサとして作動する。このために、さらに例えば、垂直軸線の周りに回転するプラットフォーム等上に配置されている光学式三角測量システムの形の、周囲の間隔測定手段を有する装置を備えていることが、さらに既知である。このようなシステムを用いて、反射による間隔測定が達成可能であり、この間隔測定は、部屋の調査のために、さらに特に自動作業の間において障害物を検出するために、並びにさらに好ましくは走行されるべき空間のマップの作成のために、したがってそれに対応してマッピングを提供するために利用される。これに関しては、例えば、特許文献1が参照される。間隔測定により検出された部屋の境界は、場合により、部屋内の幾つかの障害物を考慮して、好ましくは特に複数の部屋からなる住居の周辺のマッピングの形で、さらに好ましくは装置の不揮発性メモリ内に記憶され、これにより、清掃過程または運搬過程の間に、位置の確認のためにこのマッピングが参照可能である。さらに、これに関して、このように記憶されているマッピングに基づき、さらに記憶されているアルゴリズムにより、さらに、好ましくは装置の走行路内に存在し且つセンサを介して検出される物体の検出においてもまた、装置の有利な走行計画を決定することが既知である。このために、それぞれ、物体例えば家具または壁の境界までの間隔値のできるだけ正確な決定が必要である。
さらに、特にSLAMの用語による、同時の位置決めおよびマップ作成方法が既知である。これに関しては、非特許文献1が参照される。この場合、SLAMは、マップが存在しない周辺内を運動する可動ロボットの問題を取り扱っている。ロボットは自己の運動とその周辺内の特性との相対観察を行う。SLAMの目的は周辺および通路のマップを作成することであり、このマップは、ロボットないしは自走式装置により設定且つ利用可能である。ここで、実際の位置を検出するために、多数の可能な装置位置および方位が調査される。可能な装置位置および/または方位はSLAMにおいてパーティクル(小部分)と呼ばれ、この場合、これらのパーティクルの各々は可能な装置位置および/または方位を表わす。ここで、確率の高い位置は高い重みづけを有するパーティクルとして表わされる。したがって、確率の低いパーティクルは低い重みづけを有し且つ位置決めのためにほとんど寄与しないかまたは全く寄与しない。装置が移動されるとき、この結果、パーティクルは確率の高い位置および方位の周りに「分散される」。「分散」とは、この場合、パーティクルが、最後の発生からそれに続いて、装置の次の新たな位置を表わす他のパーティクルを発生することを意味する。パーティクルの分散に続いて、このパーティクルは、光学ユニットの測定結果により検定され且つそれに対応して重みづけされる。パーティクルの分散は、この場合、通常固定の数例えば1000に制限される。パーティクルは、次に、ガウス分布により確率の高い実際位置の周りに分散される。
独国特許出願公開第102008014912A1号明細書 独国特許出願公開第10242257A1号明細書
Hugh Durrant-Whyte, Tim Bailey, 同時の位置決めおよびマッピング(SLAM)「Simultaneous Lokalisation and Mapping (SLAM)」, Robotics & Automation Magazine, IEEE, Juni 2006, Part 1
既知の従来技術に関して、本発明の技術的課題は、当該タイプの方法をさらに改善することである。
この課題は、はじめに且つ本質的に、請求項1の対象により解決され、この場合、計算されたパーティクル群の最大広がりに座標系の第1の軸が割り当てられ且つこれから出発して他の第2の座標軸の方向内のパーティクルの偏差が測定されること、さらに、パーティクルが全て第1の座標軸内に投影され且つこのようにして得られたパーティクル分布に度数曲線が割り当てられ、この場合、度数曲線の最大が装置の実際位置の近似として評価されること、が意図されている。提案された方法により、占有される装置位置の位置決めは、特にSLAM法を利用することによって改善される。従来技術から、各分散過程に対してガウス分布を新たに計算することが既知である。それに対応して、より多くのパーティクルが分散されればされるほど、それだけ計算費用(ガウス計算)は上昇する。特に、この場合、含まれている指数関数によりきわめて計算密度の高い多数のガウス計算が発生する。この結果、きわめて大容量のマイクロ・プロセッサが使用されなければならないことになる。例えば、調査空間がきわめて大きい場合および分散が大きいとき、分散された全てのパーティクルの得られた平均値はきわめて不正確な場所を与えることになるので、パーティクルから位置決め位置を求めるために分散された全てのパーティクルを平均化することは、十分に正確ではないことがわかる。さらに例えば部屋内に障害物が存在する場合、パーティクルはこの障害物の周りに分散され得るので、得られた平均値が障害物の範囲内に存在することがあり得る。最も高い重みづけを有するパーティクルの選択を利用して位置決めすることは、この場合、ほぼ同じ高さの確率を有する複数のパーティクルが例えば数cmの範囲にわたり分散され且つこの場合最も高い確率を有するパーティクルのみが選択されることによって、得られる精度が影響されることがあるので、このような位置決めもまた不正確である。実際のパーティクル分散を考察することが、実際の位置決め精度を判定するための重要な情報を提供する。分散された全てのパーティクルから分散が計算された場合、提案された方法により、これから、実際の位置決め精度ないしは決定されるべき装置位置の確実性が推測される。位置精度に関する他の有効な情報を得るために、分散の評価が利用される。したがって、提案された方法により、これによってSLAM位置決めを改善するために、分散された全てのパーティクルの分散が解析される。分散がきわめて小さく、それに対応して全てのパーティクルがほぼ1つの場所に存在する場合、位置の精度はパーティクルの各々を用いて既に比較的良好に再現されている。計算されたパーティクル群の分散およびそれに対応してその最大広がりがきわめて大きい場合、実際の位置決め精度は上記の場合に比較してむしろ不正確であり、したがって、より不確定となる。特に、ここでは、提案された方法は解析的に行われる。パーティクル群の最大広がりの評価が、異なる方向に、好ましくは相互に直交する2つの方向に、さらに好ましくはパーティクル群に座標系を割り当てることにより行われることが好ましい。ここで、パーティクル分散が1つの方向に(例えば1つの座標軸の方向に)むしろ狭い(パーティクル群の広がりが比較的小さい)場合、本方法により、これから、この座標軸方位に関して比較的良好な位置決めが存在することが推測される。これに対して、1つの座標軸の方向における大きな広がりは、位置決定においてこの方向にはより高い不正確性が存在するという情報を提供する。少なくとも所定の分散しきい値を超えているとき、本方法により、他の解析が行われる。この解析が両方の座標軸に対して各々の新たな位置決定において行われることがさらに好ましい。この場合、1つの座標軸に沿って配置されたパーティクルが全て、これに直角に伸長する他の座標軸内に投影されることにより、特にパーティクルの重みづけに関する値が得られる。こののちに、一次元のパーティクル分布が得られ、一次元のパーティクル分布は、一次元で示されたパーティクル分布に度数曲線特にガウス曲線を割り当てることにより、さらに位置精度の改善のために利用される。ここで決定された最大、特に決定されたジャンプ状の最大(「ピーク」)は、パーティクル分布の確率特性により、装置の実際位置に対するきわめて良好な近似として評価されることが好ましい。この評価に、各パーティクルの決定された各確率値が共に取り入れられることが好ましく、これにより、一次元のパーティクル分布の図において、それに対応して、より高い重みづけを有するパーティクルが、より低い重みづけを有するパーティクルよりも集積する。この場合、決定されたピーク位置(度数曲線の最大ないしはジャンプ状の最大)は、平均値の位置とは著しく異なることがある。パーティクルの比較的粗い分散においてもまた、提案された方法により、パーティクルの間の範囲内において装置の位置の決定が可能となる。それに対応して、提案された方法により、既知の従来技術よりも概して少ないパーティクルを分散させることが可能であり、このことは、アルゴリズムを加速させ且つ従来技術よりも出力が小さく且つしたがってコスト的に有利な電子装置の使用を可能にする。
以下に、本発明のその他の特徴が、図面の説明においてもまた、しばしば請求項1の対象またはその他の請求項の特徴との好ましい関係づけにおいて説明される。しかしながら、これらの特徴は、請求項1またはそれぞれのその他の請求項の個々の特徴のみへの関係づけにおいても、またはそれぞれ独立に、重要である。
設けられた、従来技術から既知の、障害物検出のための周辺センサは、測定ビームを放出する。測定ビームは、最も近くの障害物例えば壁または家具に測定ビームが衝突した位置までの間隔を決定する。測定方法として、この場合、光飛行時間法(ToF、Time of Flight)が使用されることが好ましい。これに関して、位相相関法(PKS)もまた可能である。三角測量法が考慮されることがさらに好ましい。測定ビームは線(50mrad(ミリ・ラジアン)よりも小さいきわめて小さなビームの発散角、これは好ましくは典型的に1−22mmの範囲内のビーム直径を導く)としてまたは広がりビームとして形成されていてもよい。この場合、2−4mradの発散を有するビームが使用されることが好ましく、このビームは3mの距離において20−30mmの直径を形成する。センサの受光範囲は同様に発散受光ローブとして形成されていることが好ましく、この場合、公差を補償するために、その発散は送光ビームの直径より大きい(例えば2倍)。
物体までの間隔を測定するための非接触作動センサは、測定ビームを発生する少なくとも1つの光源を備えている。光源は、可視波長範囲または不可視波長範囲内の光、例えば650nmの範囲内の赤または532nmの範囲内の緑を放出する。700nmより大きい波長を有する赤外線範囲内の光が好ましく、例えば785nm、850nmまたは980nmの波長を有する光源(レーザダイオードまたはLED)がさらに好ましい。光源はランプまたはLEDであるが、レーザダイオードが設けられることが好ましい。
さらに、センサは、少なくとも送光素子の選択波長範囲内において感受性を有する少なくとも1つの受光素子を備えていることが好ましく、例えば、少なくとも1つのホトダイオード、ホト抵抗、CCD−ChipまたはCMOS−Chipとして形成されていることがさらに好ましい。受光装置は、個別の入射光信号を受け取るための個別の受光素子として、または複数の入射光信号を同時にまたは逐次に受け取るための多細胞アレーとして、ないしは多細胞列として形成されていてもよい。これに関して、広がりセンサ、例えば線形または平面のPSD素子もまた既知である。
光源に、および感光素子にもまた、選択的に、(好ましくは送光ビーム/送光コーンないしは受光ビーム/受光コーンを形成するための)光学要素が付属されていてもよく、これらに関しては以下には詳細に説明されていない。光学要素は、レンズ(フレネル・レンズとして、非球面または球面として形成されている集光レンズ、発散レンズ)、絞り(円形、スリット形、任意の形状、個別部品として形成されているかまたはセンサのハウジング内に組み込まれている)、プリズム、鏡(平面、凹面、凸面、自由形状)、光ガイドまたは自由形状要素であってもよい。光学装置の機械的保護の働きをする、光ビーム通路内の保護板またはカバー板もまた光学要素と理解される。光源および/または感光素子に付属して、所定の光波長はきわめて良好に透過させるが、その他の光波長はほとんど透過させない光学フィルタが設けられることが好ましい。光学フィルタは、個別要素として設けられていても、または他の光学要素(例えばレンズの着色またはコーティング、保護フレーム等)内に組み込まれていてもよい。さらに、着色、コーティング、蒸着等が可能である。鏡が使用される場合、表面鏡が好ましく、その理由は、表面鏡は光学損失がより少ないからである。この場合、さらに、鏡をプラスチック射出成形部品として形成すること、および本来の鏡面に表面コーティングとして反射層を設けること、が考えられる。ここで、例えば銀、金または銅、さらに好ましくはアルミニウムのメタル層の使用が考えられる。アルミニウムを使用するとき、他のコーティング(不活性化)として防食層が設けられていることがさらに好ましい。
好ましい形態において、提案された範囲内に、より高い滞留確率の範囲およびより低い滞留確率の範囲が定義され、この場合、より高い滞留確率の範囲内に、より低い滞留確率の範囲内よりも多いパーティクルが計算されることが好ましい。それに対応して、確率の高い装置位置の場所にはさらに好ましくは縁範囲内においてよりもより高いパーティクル密度が得られることが好ましい。特に分布のこの縁範囲内に、位置決めにおける走行の間に、(例えば駆動車の滑りによる)装置のより大きい偏差を考慮可能にするために、(低い滞留確率の)パーティクルが設定されていることがさらに好ましい。提案された方法は、意図されたパーティクル分布に従って(好ましくは走行路、走行方向および走行距離の関数として)、パーティクル群ないしは設定された個々の各パーティクルが、装置の新しい位置内においてセンサにより決定され実際間隔値と比較されたときに利用されることが好ましい。間隔測定により発生された周辺図ないしは決定された間隔値は、ほぼ順次に個々のパーティクルの各々に投影され、これらのパーティクルは間隔データの一致した数により重みづけされる。
さらに好ましい形態において、はじめに決定された分散(座標軸に沿ったパーティクル群の広がり)に基づき、1つの座標軸の偏差に関して限界が設けられ、その限界以外においてはパーティクルはもはや評価の対象とされない。それに対応して、分散に基づいてしきい値が設定されることが好ましく、その後に、好ましくは分散の内部のパーティクルのみが、場合により一定の係数を考慮してさらに調査されることがより好ましい。残ったパーティクルに基づき、解析されたパーティクル分布が、残ったパーティクルの重みづけされた度数値を形成するために利用されることが好ましく、この場合、度数曲線内のジャンプ状の最大(「ピーク」)の近くのパーティクルが、パーティクル分布の一次元で示された図内のジャンプ状の最大がその付近に存在しないパーティクルよりもより多く解析に取り入れられる。
さらに好ましい形態において、パーティクルが、さらに、方位角に関して評価されることが好ましい。装置の方位角に対してはアナログ観察が実行されることが好ましい。代替態様として、各パーティクルの方位角は共通の一次元のパーティクル分布内に追加値として取り入れられてもよい。
パーティクルが、偏差の決定を実行する前に、装置の所定の運動に関して、所定の運動に対応するパーティクルが、例えば計算される数が増加されるほどの、より高い評価を得るように評価されるとき、さらに有利であることは明らかである。それに対応して、上記の方法に補足して、予想される装置の運動により、これらの情報が個々の各パーティクルの重みづけに取り入れられ且つそれに対応して度数曲線の図に取り入れられることにより、位置決めが改善可能であることが好ましい。例えば装置がある位置上においてのみ回転すべき場合(例えば転向操作)、最後に決定された装置位置の場所において回転する前にパーティクルがより強く重みづけされた値を得たとき、それが有意義であることは明らかである。さらに、この場合、少なくともほぼ角度分散のみを調査するだけで十分なことがある。さらに、例えば、装置がはじめは直進走行をしている場合、角度変化はより小さくなり、その後に、それに対応して、座標軸に沿った分散が重点的に調査される。
以下に、本発明が、実施例のみを示した添付図面により詳細に説明される。
図1は、床集塵装置の形の自走式装置を斜視図で示す。 図2は、第1および第2の座標軸に沿って分布配置されたパーティクルを含む計算されたパーティクル群を略図で示す。 図3は、第1の座標軸のパーティクルの、第2の座標軸内への投影配置を略図で示す。 図4は、最大を決定するために度数曲線に記録された、図3から得られた一次元のパーティクル分布を示す。 図5は、パーティクルの分散の関数として選択されたしきい値を決定するときのパーティクル分布をさらなる略図で示す。
はじめに、図1により、吸込/掃除機の形の、さらに自走式家庭用吸込ロボットの形の装置1が示され且つ説明されている。装置1は、掃除されるべき床2の方向に下側に向けられたシャシ、電動駆動走行車3、並びに好ましくはシャシ底部の下端縁から突出する、同様に電動駆動されるブラシを有している。シャシは装置フード4により上から被覆され、この場合、装置1は円形平面図を有している。吸込/掃除機としての装置1の形態に関しては、例えば、特許文献2が参照される。
さらに、図示されてはいないが、装置1は、ブラシに追加してまたはこの代わりに吸込開口を有していてもよい。この場合、装置1内に、さらに、電気で運転される吸込ファン・モータが配置されている。
走行車3の電動機のための、ブラシの電気駆動のための、場合により吸込ファンのための、およびさらには装置1内にその制御のために設けられている他の電子装置のための、装置1の個々の電気部品の電気供給は、図示されていない再充電可能な蓄電池を介して行われる。
装置1は、さらに、光ビーム送光装置および光ビーム受光装置を有する、第1の非接触作動センサ5の形の間隔/障害物検出装置Aを備えている。このセンサ5は装置1の装置フード4の上側に配置され、且つ同時に装置1の中心垂直軸線でもある垂直軸線dの周りに回転可能である。センサ5は三角測量システムから構成されていることが好ましく、この三角測量システムにより、周囲の間隔測定が(軸線dの周りの360°にわたり、図1の矢印r参照)実行可能である。
センサ5により、はじめに、好ましくは水平間隔平面、即ち、床2に平行に伸長する平面内において、回転走査による障害物検出が達成可能であり、これにより、装置1は床2上においてないしはその周辺内において衝突することなく移動可能である。さらに、より好ましくは、センサ5を介して、周辺の周囲の間隔測定が可能であり、この場合、このとき決定された周辺内の障害物および壁との間隔値は全領域の間取図の作成のために利用され、この間取図は装置1内に蓄積且つ記憶される。
自動位置決めのために、それに対応して同時の位置決定およびマップ作成のために、SLAM法が利用される。この場合、SLAMにおいて、占有された、予め計算された装置1の最初の位置からの、パーティクル6の形の多数の可能な位置および方位が計算され、および装置のそれに対応した走行運動後に占有される第2の位置に関して、障害物検出装置Aの測定結果に基づき、確率を考慮した所定の選択アルゴリズムに従って、予め発生されたパーティクル6の1つが装置1の新たな位置として占有される。この場合、各パーティクル6が、障害物検出装置Aにより決定された実際間隔値に関して、並びにさらに好ましくは装置の所定の走行方向および/または走行距離および/または走行速度に関して評価されることが好ましい。この場合、例えば装置の所定の走行方向に対応するパーティクル6は、所定の走行路内に存在しないパーティクル6よりもより高い評価を受ける。パーティクル6のより高い評価は、例えば、計算される設定されたパーティクル6が増加されることによって達成可能である。
概して得られたパーティクル群7は、その後に、はじめに、第1の座標軸xおよびそれに対して垂直方向の第2の座標軸yを有する座標系を割り当てることにより、パーティクル群7の広がりに関して解析される。
図2に例として示されているように、分散δが比較的小さく、好ましくは所定のしきい値を下回っている場合、これから、x位置に関して比較的良好な位置決めが存在することが推測される。ここで、さらに、例えば、装置のほぼ正確な位置決定のために、計算によって平均値を形成するだけで十分なことがある。
これに対して、例えば図2に示されているy方向内のパーティクル群7の広がりのような大きな分散が存在する場合、これから、この方向内には位置決定に関してより高い不正確性が存在することが推測可能である(図2内の分散δ参照)。
最も確率の高い、好ましくは正確な装置の位置を決定するために、分散がこのように大きい場合、1つの方位のパーティクル6(実施例においてy方位内のパーティクル6)は全て他方の座標軸内に(実施例において第1の座標軸x内に)投影され、さらに一次元のパーティクル分布内に示すために、図3に示すように、ほぼ共通のy平面E内に投影されることがさらに好ましい。
このようにして得られた一次元のパーティクル分布は、場合により例えば走行路から得られた評価重みづけを考慮して、図4に示すように、ガウス分布曲線の形の度数曲線Hが割り当てられ、この場合、ジャンプ状の最大P(ピーク)が装置1の実際位置の近似として評価される。図から明らかなように、これにより決定された装置1の位置は、一次元のパーティクル分布に関して、2つのパーティクル6の間、ないしは一次元的に平面E内に投影されたパーティクルの間にもまた存在する。これにより、特に計算によって平均値のみが決定された場合よりも改善された装置1の位置の決定が達成される。図4の実施例に示されているように、最大位置Pは計算により決定された平均値の位置Mとは明らかに異なっていることがある。
図4内に目盛られている、平面E内に投影されたパーティクルの高さbは装置位置の確率を表わしている。
装置1の角度による方位(図2の矢印c参照)に対して、アナログ解析が実行されることが好ましく、それに対応して同じ方法が使用される。
装置1の実際位置を決定するための計算費用をさらに低減させるために、本方法の変更態様において、分散(δおよび/またはδ)に基づいてしきい値を決定することが行われ、このしきい値の内部においてのみパーティクル6がさらに上記の方法により調査される。それに対応して、パーティクル群7の内部にパーティクル群のサブ範囲7′が得られ、このパーティクル群のサブ範囲7′以外においてはパーティクル6はもはや評価の対象とされず、これにより、このとき場合によってはよりシャープに設定されたジャンプ状の最大Pに基づいて、さらに改善された装置1の位置決定を達成することが可能である。
開示された全ての特徴は(それ自身)発明の進歩性を有している。したがって、付属の/添付の優先権資料の開示内容(先行出願のコピー)もまた、これらの資料の特徴を本出願の請求の範囲内に組み込むことを目的として、その内容が全て本出願の開示内に含められるものである。従属請求項は、特にこれらの請求項に基づいて部分出願を可能にするために、自由に選択できる併記されたその文章内において、独自に発明力のある、従来技術の変更態様を示している。
1 装置
2 床
3 走行車
4 装置フード
5 センサ
6 パーティクル(小部分)
7 パーティクル群
7′ パーティクル群のサブ範囲
b 確率高さ
c 矢印
d 回転軸線
r 矢印
x 第1の座標軸
y 第2の座標軸
A 障害物検出装置
E 平面
H 度数曲線
K 座標系
M 平均値
P 最大
δ x軸方向の分散
δ y軸方向の分散

Claims (6)

  1. 送/受光ユニットからなる障害物検出装置(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)の位置の決定方法。
  2. 前記第1の座標軸(x、y)のパーティクル(6)の分散に基づいて偏差に関してしきい値が設けられ、当該しきい値を超えるパーティクル(6)はもはや評価の対象とされないことを特徴とする請求項1に記載の方法。
  3. 前記パーティクル(6)が方位角に関して評価されることを特徴とする請求項1または2に記載の方法。
  4. 前記自走式装置(1)の所定の走行方向に対応するパーティクル(6)が、当該所定の走行路内に存在しないパーティクル(6)よりもより高い評価を受けることを特徴とする請求項1ないし3のいずれかに記載の方法。
  5. 前記自走式装置(1)が、電動駆動走行車輪(3)を有することを特徴とする請求項1ないし4のいずれかに記載の方法。
  6. 前記自走式装置(1)が、自走式床集塵装置であることを特徴とする請求項1ないし5のいずれかに記載の方法。
JP2012008568A 2011-01-21 2012-01-19 自走式装置の位置の決定方法 Expired - Fee Related JP5923311B2 (ja)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

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