JP7336118B2 - ロボットがエッジに沿って走行する領域清掃計画方法、チップおよびロボット - Google Patents

ロボットがエッジに沿って走行する領域清掃計画方法、チップおよびロボット Download PDF

Info

Publication number
JP7336118B2
JP7336118B2 JP2022527687A JP2022527687A JP7336118B2 JP 7336118 B2 JP7336118 B2 JP 7336118B2 JP 2022527687 A JP2022527687 A JP 2022527687A JP 2022527687 A JP2022527687 A JP 2022527687A JP 7336118 B2 JP7336118 B2 JP 7336118B2
Authority
JP
Japan
Prior art keywords
area
cleaning
robot
edge
room
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
Application number
JP2022527687A
Other languages
English (en)
Other versions
JP2023501569A (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.)
Zhuhai Amicro Semiconductor Co Ltd
Original Assignee
Zhuhai Amicro Semiconductor Co Ltd
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 Zhuhai Amicro Semiconductor Co Ltd filed Critical Zhuhai Amicro Semiconductor Co Ltd
Publication of JP2023501569A publication Critical patent/JP2023501569A/ja
Application granted granted Critical
Publication of JP7336118B2 publication Critical patent/JP7336118B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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/0234Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
    • G05D1/0236Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G05D1/0253Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Optics & Photonics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Electric Vacuum Cleaner (AREA)

Description

本発明は、ロボットレーザデータの経路計画の技術分野に関し、特にロボットがエッジに沿って走行する領域清掃計画方法、チップおよびロボットに関する。
現在、市販されているレーザSLAM清掃機の被覆清掃作業モードは、以下の2種類を含む。
そのうちの1つの作業モードとして、清掃機は、格子サイズがMxNの矩形枠領域(一般的に、格子サイズが4x4である)に従って清掃作業を行い、現在に画定されたMxNの格子領域を清掃した後、全ての作業領域が被覆されるまで、さらに拡張して別のMxNの格子領域を画定して、新たに拡張した領域内で続いて清掃することである。このような作業モードは、事前にマップを検査する必要がないという利点があるが、画定した領域の輪郭が実際の地形と大きく異なることにより、ナビゲーション経路が多くなり、小さな領域が多すぎて、清掃機の清掃が遅すぎるなどの問題を引き起こすという欠点がある。
もう1つの作業モードとして、事前にマップ(一般的には、予め構築された環境全体のマップである)を検査し、環境領域の全体を複数の部屋に分割して、全ての部屋領域が清掃されるまで部屋ごとに清掃することである。このような作業モードは、分割した領域が実際の地形と類似するので、ナビゲーション経路が少なくなり、清掃速度が早くなるという利点があるが、事前にマップを検査する必要があるという欠点がある。
上記の技術課題を解決するためのロボットがエッジに沿って走行する領域清掃計画方法は、ロボットがリアルタイムに走査して構築したレーザマップにおいて、ロボットがエッジに沿って走行する過程中現在の計画起点位置で画定された所定の清掃領域を超えないように、現在の計画起点位置で画定された所定の清掃領域内でエッジに沿って走行するようにロボットを制御するステップと、同時に前記所定の清掃領域における予め設定された壁環境条件に合致する部屋清掃分割領域の分割状況に応じて、マッチング領域内でエッジに沿って走行するようにロボットを制御し、ロボットが当該マッチング領域内でエッジに沿って走行して前記計画起点位置に戻ると、当該マッチング領域内で計画的清掃を実行するようにロボットを制御するステップであって、ここで、前記マッチング領域は、実際の部屋領域の境界にマッチングする清掃対象領域であって、ロボットが前記所定の清掃領域内で現在の計画起点位置から既にエッジに沿って走行した経路を含む、ステップと、ロボットが当該マッチング領域内で計画的清掃を完了すると、未清掃領域の次の計画起点位置に移動するようにロボットを制御した後、未清掃領域を検出できないまで前記のステップを繰り返すステップと、を含む。本技術方案は、従来の技術に比べて、完全なグローバルマップを予め記憶する必要がなく、エッジ走行過程でリアルタイムに生成された一部のマップに基づいてマッチングする清掃領域を分割することにより、ロボットは、自動的に分割された実際の部屋領域を清掃単位とし、部屋領域ごとに計画的清掃を完了し、さらに全ての清掃対象領域の全面的な被覆清掃を実現する。ロボットは、エッジに沿って走行しながら実際の部屋環境にマッチングする清掃分割領域を分割するため、ロボットがエッジに沿って走行する過程中停止してマップに予め設定された壁環境条件に合致する部屋清掃分割領域の分割を生成するのを待つことなく、ナビゲーション経路が少なく、ロボットの作業効率を向上させることを保証する。
さらに、ロボットがリアルタイムに走査して構築したレーザマップにおいて、前記計画起点位置を中心として1つの前記所定の清掃領域を画定した後、現在に画定された前記所定の清掃領域内で距離が最も近い1つの物理的境界のエッジ起点位置を選択して、ロボットが当該物理的境界に沿ってエッジ走行を行うように構成されるまで、当該エッジ起点位置から直線的に計画された経路に沿って当該物理的境界へ前進するようにロボットを制御するステップをさらに含み、ここで、当該物理的境界は、所定の清掃領域内の障害物の境界または壁を含み、前記計画起点位置は、現在に画定された前記所定の清掃領域内でのロボットの起動位置である。当該技術方案によれば、ロボットがエッジ走行を起動する速度を速くさせ、ナビゲーション経路を減少させる。
さらに、同時に前記所定の清掃領域における予め設定された壁環境条件に合致する部屋清掃分割領域の分割状況に応じて、マッチング領域内でエッジに沿って走行するようにロボットを制御し、ロボットが当該マッチング領域内でエッジに沿って一周走行して前記計画起点位置に戻ると、当該マッチング領域内で計画的清掃を実行するようにロボットを制御する方法は、ロボットが現在に画定された所定の清掃領域内でエッジに沿って走行するように制御するとともに、エッジに沿って走行する過程中、ロボットが現在に画定された所定の清掃領域から前記予め設定された壁環境条件に合致する部屋清掃分割領域を分割したか否かを判断し、そうであればステップ2に進み、そうでなければステップ3に進むステップ1と、ロボットがステップ1における前記予め設定された壁環境条件に合致する部屋清掃分割領域内で継続してエッジに沿って走行するように制御し、ロボットが当該部屋清掃分割領域内でエッジに沿って一周走行して前記計画起点位置に戻った場合、当該部屋清掃分割領域に対して計画的清掃を行うようにロボットを制御するステップであって、ここで、当該部屋清掃分割領域は、前記計画起点位置、前記計画起点位置からエッジ走行の起動までのロボットの走行経路、およびロボットが既に走行したエッジ経路を含むステップ2と、ロボットが現在に画定された所定の清掃領域内で継続してエッジに沿って走行するように制御し、ロボットがエッジに沿って走行して前記計画起点位置に戻った場合、ロボットが現在にエッジに沿って走行した経路に囲まれた実際のエッジ領域に対して計画的清掃を開始するように制御するステップ3と、を含む。
本技術方案は、従来の技術に比べて、エッジ走行の過程中要求に合致する部屋清掃分割領域をリアルタイムに分割することにより、実際の部屋環境の境界にマッチングする清掃領域を選択してエッジ走行を行った後に清掃作業を行うので、長時間にわたって清掃を行わずにエッジに沿って走行するのを回避しつつ、領域全体におけるエッジ走行および清掃計画経路の円滑性を保証することができ、機器停止の可能性が少なく、余分なナビゲーション経路および余分なマップ領域の構築の計算時間を減少させることができる。
さらに、ロボットがエッジに沿って走行する過程中、ロボットが前記予め設定された壁環境条件に合致する部屋清掃分割領域を1個分割した場合、ロボットが当該部屋清掃分割領域からエッジに沿って走行して離れたと判断されると、ロボットが継続して前記予め設定された壁環境条件に合致する新たな部屋清掃分割領域を分割して、当該2つの前記予め設定された壁環境条件に合致する部屋清掃分割領域を現在に画定された所定の清掃領域内における1つの前記マッチング領域として合併するように制御し、その後、ロボットが前記マッチング領域内で継続してエッジに沿って走行するように制御し、ロボットがエッジに沿って一周走行して前記計画起点位置に戻った場合、前記マッチング領域に対して計画的清掃を開始するようにロボットを制御し、ここで、前記マッチング領域は、前記計画起点位置、前記計画起点位置からエッジ走行の起動までのロボットの走行経路、およびロボットが既に走行したエッジ経路を含む。ロボットのエッジ走行および清掃計画経路の円滑性が向上され、機器停止の可能性を少なくする。
さらに、前記ステップ2において、前記予め設定された壁環境条件に合致する部屋清掃分割領域の座標位置の全てが計画的清掃経路により覆われるまで、ロボットが計画的清掃を実行する過程中前記予め設定された壁環境条件に合致する部屋清掃分割領域を超えないように制御し、前記ステップ3において、当該実際のエッジ領域の座標位置の全てが計画的清掃経路により覆われるまで、ロボットが計画的清掃を実行する過程中現在のエッジ走行経路に囲まれた実際のエッジ領域を超えないように制御し、ここで、ロボットによる清掃で被覆された領域を清掃済み領域と標記するとともに、ロボットによる清掃で被覆された領域以外の走査済み領域を未清掃領域と標記する。当該技術方案によれば、清掃済み領域と非清掃領域との正確な区別を実現し、清掃対象領域の全面的な被覆の実現に寄与する。
さらに、ロボットが現在に確定された前記予め設定された壁環境条件に合致する部屋清掃分割領域または前記実際のエッジ領域の計画的清掃を完了すると、ロボットが標記した位置情報に基づいて前記清掃済み領域と前記未清掃領域とを区別した後、ロボットが前記未清掃領域に属する次の計画起点位置に移動して、請求項2に記載の方法に基づいて次の計画起点位置で1つの新たな予定の清掃領域を画定するように制御し、ここで、次の計画起点位置は、前記未清掃領域のうち、ロボットが現在に計画的清掃を完了した位置との距離が最も近い位置であり、ロボットが当該新たな所定の清掃領域内でエッジに沿って走行する場合、前記ステップ1~前記ステップ3を実行し、ここで、ロボットが計画的清掃およびエッジ走行を実行する過程中前記清掃済み領域を迂回するように制御する。当該技術方案は、従来の技術と比べて、次の計画起点位置を利用して新たな所定の清掃領域を画定することにより、後続のエッジ走行の過程中十分に多くの未知のマップ領域が走査され、より多くの部屋清掃分割領域または実際のエッジ領域を画定し、かつ清掃済み領域を迂回してエッジ走行を行うので、不必要なナビゲーション経路を減少させる。
さらに、前記所定の清掃領域は、前記計画起点位置を対角線の交点とする1つの正方形の枠領域であって、ロボットがエッジに沿って走行する範囲を制限するためのものであり、さらに、現在に確定した前記予め設定された壁環境条件に合致する部屋清掃分割領域、同一の前記所定の清掃領域内で合併された前記予め設定された壁環境条件に合致する部屋清掃分割領域、または前記実際のエッジ領域を囲み、ここで、前記所定の清掃領域の被覆領域は、正方形の実際の物理的領域に等価し、前記所定の清掃領域の被覆領域の位置は、ロボットの計画起点位置の変化に応じて変化し、当該正方形の実際の物理的領域の辺長は、室内の清掃対象領域のサイズと関係がある。当該技術方案によれば、計画起点位置ごとに1つのエッジ走行範囲を制限する矩形領域を対応して設置することによって、ロボットの最大のエッジ走行範囲を事前に画定し、ロボットが無制限にエッジに沿って走行することを防止できる。
さらに、現在の計画起点位置で画定された所定の清掃領域と前記次の計画起点位置で画定された所定の清掃領域とは重なり領域が存在しており、当該重なり領域は、前記清掃済み領域を含む。これにより、前後に分割された部屋清掃分割領域または実際のエッジ領域は隣接関係が存在し、清掃領域の被覆率を向上させるのに寄与する。
さらに、現在に画定された所定の清掃領域から予め設定された壁環境条件に合致する1つの部屋清掃分割領域を分割する方法は、前記エッジ起点位置から、前記レーザマップの各座標軸方向で走査されたレーザ画像の画素点の統計情報に基づいて、現在に画定された所定の清掃領域内で前記レーザマップの座標軸方向に沿って輪郭境界線分を位置決めするステップ11と、各座標軸方向において予め設定された位置に最も近い輪郭境界線分を選択して、1つの矩形の初期部屋清掃分割領域を囲むステップ12と、初期部屋清掃分割領域が前記予め設定された壁環境条件に合致しない部屋清掃分割領域である場合、1つの優先的に拡張する座標軸方向を選択し、初期部屋清掃分割領域における、優先的に拡張する座標軸方向に垂直に位置決めされた非壁障害物線分を削除して、同一の座標軸方向に沿って初期部屋清掃分割領域を拡張し、その後、ステップ14に進むステップ13と、ステップ13における前記優先的に拡張する座標軸方向に位置決めされた、ステップ13において削除した非壁障害物線分に隣接する輪郭境界線分が現在に画定された所定の清掃領域内の前記未清掃領域に位置しているか否かを判断するとともに、当該座標軸方向に位置決めされた輪郭境界線分が前記初期部屋清掃分割領域の残りの輪郭境界線分と交差して、前記予め設定された壁環境条件に合致する部屋清掃分割領域を形成していないか否かを判断し、両者を共に満足すると、ステップ13に戻って、現在に選択した座標軸方向における拡張を継続して実行するステップ14と、ステップ13における前記優先的に拡張された座標軸方向に位置決めされた、ステップ13において削除された非壁体障害物線分に隣接する輪郭境界線分が現在に画定された所定の清掃領域内に位置する前記未清掃領域ではない場合、前記ステップ13において現在に選択した座標軸方向における拡張を停止して、前記ステップ13に戻って拡張優先度が1段低い座標軸方向を選択して拡張することにより、前記所定の清掃領域から対応する輪郭境界線分で前記予め設定された壁体環境条件に合致する部屋清掃分割領域を分割するステップと、含み、ここで、非壁障害物線分は、輪郭境界線分に属するが壁を示しないものであり、前記予め設定された壁環境条件に合致する部屋清掃分割領域を囲む輪郭境界線分と実際の部屋境界とは、予め設定された誤差許容範囲内で重なり合い、ここで、実際の部屋境界は、前記予め設定された壁環境条件に合致する部屋清掃分割領域の内部の障害物の境界および/または前記実際のエッジ領域の内部の障害物の境界を含む。
本技術方案は、従来の技術に比べて、レーザ走査によって取得されたマップ画像の画素情報を利用して、前記所定の清掃領域でロボットの初期部屋清掃分割領域をリアルタイムに分割し、かつ、同一の前記所定の清掃領域で、清掃対象領域の壁の境界を繰り返して反復処理することによりロボットの初期部屋清掃分割領域を拡張することによって、同一の前記所定の清掃領域に最終的に形成された、前記予め設定された壁環境条件に合致する部屋清掃分割領域の輪郭境界が室内の家居部屋の壁境界と類似することを確保し、前記予め設定された壁環境条件に合致する部屋清掃分割領域のエッジに沿ったロボットのナビゲーション効率を向上させる。
さらに、前記予め設定された壁環境条件に合致する部屋清掃分割領域の具体的な判断方法は、前記初期部屋清掃分割領域を囲む輪郭境界線分がいずれも非壁障害物線分ではなく、かつ前記初期部屋清掃分割領域内の孤立した障害物線分の長さが、壁適合数量値の画素点の個数に対応する線分の長さおよび前記初期部屋清掃分割領域の任意の1辺の長さの予め設定された比の値のうち相対的に小さい数値より小さい場合、前記初期部屋清掃分割領域が前記予め設定された壁環境条件に合致する部屋清掃分割領域であると確定するステップと、前記初期部屋清掃分割領域を囲む1本の前記輪郭境界線分が非壁障害物線分であり、または、前記初期部屋清掃分割領域内の孤立した障害物線分の長さが壁適合数量値の画素点数に対応する線分の長さ以上であり、または、前記初期部屋清掃分割領域内の孤立した障害物線分の長さが前記初期部屋清掃分割領域の1辺の長さの予め設定された比の値以上である場合、前記初期部屋清掃分割領域が前記予め設定された壁環境条件に合致する部屋清掃分割領域ではないと確定するステップと、を含み、ここで、前記輪郭境界線分は、白画素点の個数に基づいて非壁障害物線分と壁障害物線分とに分けられ、非壁障害物線分における白画素点の個数は、予め設定された閾値以上であり、壁障害物線分における白画素点の個数は、予め設定された閾値より小さく、ここで、レーザマップには、走査された孤立した障害物線分も存在し、前記孤立した障害物線分の長さが前記初期部屋清掃分割領域の1辺の長さの予め設定されたエラー比の値と壁適合数量値の画素点の個数に対応する線分の長さとの2種類の線分の長さのうちの1つの以上であれば、前記孤立障害物線分が前記壁障害物線分と標記される。当該技術方案によれば、前記初期部屋清掃分割領域を画定する輪郭境界線分の線分長さの性質および前記初期部屋清掃分割領域内の孤立した障害物線分の長さによって前記予め設定された壁環境条件に合致する部屋清掃分割領域を確定し、他の領域の障害物の直線による干渉作用を排除し、かつ無視できない長さの孤立した障害物線分を物理的壁に適合させ、輪郭境界線分が壁と誤判断される可能性を低減させ、ロボットによる壁と非壁障害物との区別の正確性および知能化レベルを向上させる。
さらに、前記ステップ11の具体的な方法は、前記所定の清掃領域内で、前記計画起点位置から現在に構築されたレーザマップの画像画素点を統計するステップと、X軸方向に沿って統計した縦座標が同じである黒画素点の数が予め設定された境界閾値を超えたたびに、これらの縦座標が同じである黒画素点の接続によって形成された前記輪郭境界線分を標記することにより、前記所定の清掃領域内でX軸方向に沿って延伸する領域が対応する輪郭境界線分で分割されるステップと、Y軸方向に沿って統計した横座標が同じである黒画素点の数が予め設定された境界閾値を超えたたびに、これらの横座標が同じである黒画素点の接続によって形成された前記輪郭境界線分を標記することにより、前記所定の清掃領域内でY軸方向に沿って延伸する領域が対応する輪郭境界線分で分割されるステップと、を含む。当該技術方案は、同一の座標軸方向に分布される黒画素点の数に基づいて、前記所定の清掃領域内からある程度の通行可能性を有する領域を選択して輪郭境界線分を標記し、前記予め設定された壁環境条件に合致する部屋清掃領域を囲む輪郭境界線分は、部屋領域の分割がより規則的で合理的になるように互いに揃えてもよく、標記された輪郭境界線分により、ロボットが連続的にエッジに沿って走行するための矩形の作業領域を画定することができることを確保する。
本発明は、制御プログラムが内蔵されたチップであって、前記プログラムは、前記領域清掃計画方法を実行するようにモバイルロボットを制御するためのものであるチップをさらに開示する。
本発明は、レーザセンサが搭載されるロボットであって、上記のチップが内蔵され、エッジに沿って走行する過程中現在の計画起点位置で画定された所定の清掃領域を超えないように、リアルタイムに走査して構築したレーザマップにおける現在の計画起点位置で画定された所定の清掃領域内でエッジに沿って走行するようにロボットが構成され、同時に前記所定の清掃領域における予め設定された壁環境条件に合致する部屋清掃分割領域の分割状況に応じて、マッチング領域内でエッジに沿って走行し、当該マッチング領域内でエッジに沿って走行して前記計画起点位置に戻ると、当該マッチング領域で計画的清掃を実行するようにロボットが構成され、ここで、前記マッチング領域は、実際の部屋領域の境界にマッチングする清掃対象領域であって、ロボットが前記所定の清掃領域内で現在の計画起点位置から既にエッジに沿って走行した経路を含み、当該マッチング領域内で計画的清掃を完了すると、未清掃領域の次の計画起点位置に移動し、未清掃領域を検出できないまで、前記の機能を繰り返して実行するようにロボットが構成されるロボットを開示する。
ロボットが計画起点位置Oに移動した時、走査して構築した階調化されたレーザマップにおいて所定の清掃領域P1を画定する効果図である。 ロボットがエッジ走行する過程中所定の清掃領域P1内から部屋清掃分割領域#1を分割する効果図である。 ロボットが計画起点位置O1に移動した時、走査して構築した階調化されたレーザマップにおいて所定の清掃領域P2を画定する効果図である。 ロボットがエッジ走行する過程中所定の清掃領域P2内から部屋清掃分割領域#2を分割する効果図であり、ここで、部屋清掃分割領域#1と部屋清掃分割領域#2とはレーザマップにおいて隣接している。 本発明の実施例に開示したロボットがエッジに沿って走行する領域清掃計画方法のフローチャートである。
以下、本発明の実施例における技術方案について本発明の実施例における図面を参照しながら詳細に説明する。各実施例をさらに説明するために、本発明は、図面を提供している。これらの図面は、本発明に開示した内容の一部であって、主に実施例を説明するために用いられ、かつ、明細書における関連説明と組み合わせて実施例の作業原理を説明することができる。これらの内容を参照すると、当業者は、他の可能な実施形態および本発明の利点を理解できるべきである。図中におけるレーザマップの画像サイズは、比例して描かれていない。本発明の実施例に係る方法プログラムの実行主体は、レーザナビゲーションロボットであり、このレーザナビゲーションロボットにレーザセンサを設置することができ、当該レーザセンサは、障害物を検出することができ、一般的なシーンでは、レーザナビゲーションロボットは、室内を移動する過程中、当該レーザナビゲーションロボットに設置されたレーザセンサによって周囲に障害物が存在しているか否かを検出し、かつ、レーザマップにリアルタイムに標記することができる。
本発明の実施例に開示したロボットがエッジに沿って走行する領域清掃計画方法は、以下のステップを含む。ロボットがリアルタイムに走査して構築したレーザマップにおいて、ロボットがエッジに沿って走行する過程中現在に画定された所定の清掃領域を超えないように、現在の計画起点位置で画定された所定の清掃領域内でエッジに沿って走行するようにロボットを制御する。ロボットがエッジに沿って走行すると同時に、現在の計画起点位置で画定された所定の清掃領域における予め設定された壁環境条件に合致する部屋清掃分割領域の分割状況に応じて、ロボットがマッチング領域内でエッジに沿って走行するように制御する。ここでいうマッチング領域は、実際の部屋の領域境界にマッチングする清掃対象領域であり、ロボットがエッジに沿って走行して起点位置に戻る場合、すなわち当該マッチング領域の全周に亘ってエッジに沿って走行して現在の計画起点位置に戻る場合、ロボットが当該マッチング領域内で計画的清掃を実行するように制御する。ここで、前記マッチング領域は、実際の部屋の領域境界にマッチングする清掃対象領域であって、ロボットが前記所定の清掃領域内で現在の計画起点位置から既にエッジに沿って走行した経路を含む。一般的に、前記マッチング領域は、予め設定された壁環境条件に合致する部屋清掃分割領域であってもよく、1つまたは複数の予め設定された壁環境条件に合致する部屋清掃分割領域を含んでもよい。本実施例は、部屋を分割するタイミングをエッジ走行の起動段階に選択することにより、マップの生成または部屋の計算などを待つことなく、エッジに沿って走行すると同時に部屋領域を分割することを実現し、例えば、ロボットのエッジ走行速度が速すぎるため、短時間内で元の位置で分割された部屋領域から離れることがあるが、ロボットは、依然としてエッジに沿って走行すると同時に新たな部屋領域を分割し、その後、この新たな部屋領域と元の位置で分割された部屋領域とを合わせて前記マッチング領域を形成することにより、ロボットが領域全体で清掃計画を中断せずに円滑に実行することができるようにする。ロボットが当該マッチング領域内で計画的清掃を完了すると、未清掃領域の次の計画起点位置に移動するようにロボットを制御した後、未清掃領域を検出できないまで前記のステップを繰り返し、ここで、計画的清掃は、一般的に弓字形の計画的清掃を指す。本実施例は、従来の技術に比べて、完全なグローバルマップを予め記憶する必要がなく、エッジ走行過程でリアルタイムに生成された一部のマップに基づいてマッチングする清掃領域を分割することにより、ロボットは、自動的に分割された実際の部屋領域を清掃単位とし、部屋領域ごとに計画的清掃を完了し、さらに全ての清掃対象領域の全面的な被覆清掃を実現する。ロボットは、エッジに沿って走行しながら実際の部屋環境にマッチングする清掃分割領域を分割するため、ロボットがエッジに沿って走行する過程中停止してマップに予め設定された壁環境条件に合致する部屋清掃分割領域の分割を生成するのを待つことなく、ナビゲーション経路が少なく、ロボットの作業効率を向上させることを保証する。
1つの具体的な実施例として、図5に示すように、以下のステップを含む。
ロボットを起動させて領域の計画を開始し、エッジに沿って走行した後に清掃するといった清掃計画ロジックを実行し始め、その後、ステップS1に進む。
ステップS1において、ロボットがリアルタイムに走査して構築したレーザマップにおいて、ロボットの計画起点位置を中心として1つの所定の清掃領域を画定し、その後、ステップS2に進む。ここで、計画起点位置は、ロボットが現在に画定された所定の清掃領域内での起動位置である。図1に示すように、現在に画定された所定の清掃領域は、ロボットが起動位置O(現在の計画起点位置)で起動位置Oを対角線の交点とする正方形の枠領域を規定し、当該正方形の枠領域は、ロボットがエッジに沿って走行する範囲を制限するためのものであって、実際の辺長が12mの正方形の枠である。注意すべきことは、所定の清掃領域は、閉鎖領域であるが、当該所定の清掃領域は全部がロボットのレーザセンサによって検出走査されるものではない。ロボットは、現在に画定された所定の清掃領域内でエッジに沿って走行する過程中、現在に画定された所定の清掃領域を超えないように保持され、辺長が12mの正方形の実際の物理的領域を超えないことに相当する。この後に計画起点位置が変化すると、例えば図1の計画起点位置Oから図3の位置O1に変化すると、前記所定の清掃領域の被覆領域の位置も変化し、図3における位置O1を対角線の交点とする正方形の枠領域に示すとおりである。本実施例は、ロボットの最大のエッジ走行範囲を事前に画定するために、計画起点位置ごとに1つのエッジ走行範囲を制限する矩形領域を対応して設置することによって、後続のエッジ走行過程中十分に多くのマップ領域を走査し、十分に大きい部屋清掃分割領域または実際のエッジ領域を画定すると同時に、ロボットが無制限にエッジに沿って走行することを防止する。
ステップS2において、現在の計画起点位置で画定された所定の清掃領域から距離が最も近い物理的境界のエッジ起点位置を選択して、ロボットが当該物理的境界に沿ってエッジ走行を行うように構成されるまで、ロボットが前記計画起点位置から直線的に計画された経路に沿って当該物理的境界へ前進するように制御する。その後、ステップS3に進む。当該ステップにおいて、前記ロボットが当該物理的境界に沿ってエッジ走行を行うように構成される運動状態は、ロボットが現在に画定される所定の清掃領域内で、ステップS1における前記計画起点位置に最も近いエッジ起点位置から、当該エッジ起点位置が位置する物理的境界に沿ってエッジ走行し始めるように制御するものであるが、エッジ走行の方向が限定されず、ここで、当該物理的境界は、現在に画定される所定の清掃領域内の障害物の境界または壁を含み、ロボットが直線的に計画された経路に沿って前進する過程中、障害物の境界または壁が検出されると、エッジ走行モードを起動することができる。前記計画起点位置は、現在に画定された所定の清掃領域内でのロボットの起動位置である。ステップS2においてロボットがエッジ走行を起動する速度を速くさせ、ナビゲーション経路を減少させる。
ステップS3において、ロボットがリアルタイムに走査して構築したレーザマップに基づいて、ロボットがエッジに沿って走行する過程中現在に画定された所定の清掃領域を超えないように、ロボットが現在に画定された所定の清掃領域内でエッジに沿って走行するように制御し、その後、ステップS4に進む。ロボットが現在に画定された所定の清掃領域内でエッジ走行を実行する過程中、障害物または壁が検出されると、現在に検出された障害物の境界または壁に沿って継続して走行すると同時に、ロボットがエッジに沿って走行した際の障害物または壁の位置および形状を標記するが、ロボットが停止してマップの生成や部屋領域の分割を待つことがない。
なお、ロボットがエッジ走行を実行するか否かにもかかわらず、走行過程中障害物または壁が検出されると、現在に検出した障害物の境界または壁に沿って継続して走行すると同時に、ロボットがエッジに沿って走行した際の障害物または壁の位置を標記する。エッジに沿って部屋の実際の境界を確定することにより、現在のエッジ走行の境界と後続きに分割される予め設定された壁環境条件に合致する部屋清掃分割領域の境界とが一致になるようにし、後の同一の領域内の清掃過程中、標記された障害物を回避することに寄与する。
ステップS4において、ロボットが現在に画定された所定の清掃領域から予め設定された壁環境条件に合致する部屋清掃分割領域を分割したか否かを判断し、そうであればステップS5に進み、そうでなければステップS6に進む。当該判断ステップは、ロボットが現在に画定された所定の清掃領域内でエッジ走行を開始する時に実行し始め、前記予め設定された壁環境条件に合致する部屋清掃分割領域を分割するタイミングをロボットによるエッジ走行の起動段階に設定することにより、現在に画定された所定の清掃領域内でエッジに沿って走行すると同時に、前記予め設定された壁環境条件に基づいて対応する部屋清掃分割領域を分割することを実現し、ロボットがエッジに沿った経路を円滑に走行することができ、マップの生成および部屋領域計画の計算のために停止する必要がない。ここで、予め設定された壁環境条件に合致する前記部屋清掃分割領域を囲む輪郭境界線分は、実際の部屋境界と予め設定された誤差許容範囲内で重なり合う。ここで、予め設定された壁環境条件に合致する部屋清掃分割領域は、実際の部屋境界が予め設定された壁環境条件に合致する前記部屋清掃分割領域の内部の障害物の境界および/または前記実際のエッジ領域の内部の障害物の境界を含み、実際の部屋が、所定の清掃領域が位置する実際の物理的領域である。
ステップS5において、ロボットがステップS3におけるエッジ走行経路において前記予め設定された壁環境条件に合致する部屋清掃分割領域を分割した場合、ロボットが位置している位置から、ロボットがステップS4における予め設定された壁環境条件に合致する部屋清掃分割領域内で継続してエッジ走行を実行することを制限し、すなわち、ロボットがステップS4における前記マッチング領域に含まれる予め設定された壁環境条件に合致する部屋清掃分割領域内で継続してエッジ走行を実行するように制御する。当該部屋清掃分割領域でエッジに沿って一周走行して現在に画定された所定の清掃領域内の前記計画起点位置に戻った後、当該部屋清掃分割領域に対して計画的清掃を行い、その後、ステップS7に進み、ここで、ステップS4における予め設定された壁環境条件に合致する部屋清掃分割領域の内部には、現在の計画起点位置、現在の計画起点位置からエッジ走行の起動までのロボットの走行経路、およびロボットが既に走行したエッジ経路が含まれ、これにより、ロボットが前記計画起点位置に戻った時にも依然として分割された予め設定された壁環境条件に合致する部屋清掃分割領域内に位置するようにする。
図1および図2から分かるように、ロボットは、図1に示す所定の清掃領域P1内の前記計画起点位置Oで図2に示すような予め設定された壁環境条件に合致する部屋清掃分割領域#1を分割し、前記計画起点位置Oも部屋清掃分割領域#1の内部に位置し、ここで、前記所定の清掃領域P1は、前記計画起点位置Oを対角線の交点とする正方形の枠領域であって、部屋清掃分割領域#1を囲んでロボットのエッジ走行範囲を制限するためのものである。本実施例は、現在に画定された所定の清掃領域内から予め設定された壁環境条件に合致する部屋清掃分割領域を分割した後、ロボットがマッチング領域内でエッジに沿って走行するように制御し、ロボットが当該マッチング領域内でエッジに沿って一周走行して前記計画起点位置に戻った場合、ロボットが当該マッチング領域内で計画的清掃を実行するように制御する。
ステップS5に示す実施例では、ロボットは、現在に画定された所定の清掃領域内でエッジに沿って一周走行して前記計画起点位置に戻った後、現在に画定された所定の清掃領域内の実際のエッジ領域に対して計画的清掃を開始する。
ここで、ロボットが計画的清掃を実行する過程中前記予め設定された壁環境条件に合致する部屋清掃分割領域を超えないように制御し、前記予め設定された壁環境条件に合致する部屋清掃分割領域の座標位置がいずれも計画的清掃経路により覆われると、ロボットが現在に分割された、予め設定された壁環境条件に合致する部屋清掃分割領域の清掃を完了したと見なし、その後、ステップS7に進み、現在に分割領域された、予め設定された壁環境条件に合致する部屋清掃分割領域から未清掃領域への進入を実現する。なお、ロボットがエッジ走行を実行すると同時に予め設定された壁環境条件に合致する部屋清掃分割領域の分割計算を実行することにより、ロボットが現在に画定された所定の清掃領域内でエッジ走行および清掃を比較的に円滑に実行することができ、機械停止の可能性を少なくし、ロボットがエッジに沿って走行した境界と現在に画定された所定の清掃領域に対応する実際の環境境界とは一致する。
ステップS6において、ロボットが現在に画定された所定の清掃領域内で継続してエッジに沿って走行するように制御し、ロボットがエッジに沿って走行して前記計画起点位置に戻ると、現在にエッジに沿って走行した経路に囲まれた実際のエッジ領域に対して計画的清掃を開始するようにロボットを制御し、その後、ステップS7に進む。本実施例は、現在に画定された所定の清掃領域内から予め設定された壁環境条件に合致する部屋清掃分割領域を分割していないが、依然としてロボットが実際の環境にマッチングする領域内でエッジに沿って走行するように制御し、ロボットが当該マッチング領域内で前記計画起点位置に戻ると、ロボットが当該マッチング領域内で計画的清掃を実行するように制御する。好ましくは、ロボットが計画的清掃を実行する過程中現在のエッジ走行経路に囲まれた実際のエッジ領域を超えないように制御し、当該実際のエッジ領域の座標位置がいずれも計画的清掃経路に覆われると、ロボットが現在のエッジ走行経路に囲まれた実際のエッジ領域の清掃を完了したと見なし、その後、ステップS7に進み、現在のエッジ走行経路に囲まれた実際のエッジ領域から未清掃領域へ進入することを実現する。なお、ロボットが前記ステップS5または前記ステップS6を実行したたびに、ロボットの清掃による被覆された領域の位置を清掃済み領域と標記し、走査したレーザマップ領域において、ロボットの清掃による被覆された領域の位置以外の既知の領域を前記未清掃領域と標記することにより、清掃済み領域と非清掃領域との正確な区別を実現し、清掃対象領域の全面的な被覆の実現に寄与する。
従来の技術に比べて、前記のステップは、エッジ走行の過程中前記予め設定された壁環境条件に合致する部屋清掃分割領域をリアルタイムに分割することにより、実際の部屋の環境境界にマッチングする清掃領域を選択してエッジ走行を行った後に清掃作業を行うので、長時間にわたって清掃を行わずに無目的にエッジに沿って走行するのを回避しつつ、領域全体におけるエッジ走行および清掃計画経路の円滑性を保証することができ、余分なナビゲーション経路および余分なマップ領域の構築の計算時間を減少させることができる。
好ましくは、ロボットがエッジに沿って走行する過程中、ロボットが元の位置で前記予め設定された壁環境条件に合致する部屋清掃分割領域を1個分割した場合、ロボットがエッジに沿って走行する過程中停止して清掃分割領域の分割およびマップの生成を待つことがないので、ロボットのエッジ走行速度が速いと、ロボットが元の位置で分割された前記予め設定された壁環境条件に合致する部屋清掃分割領域からエッジに沿って走行して離れたと判断し、ロボットが新たな位置で継続して前記予め設定された壁環境条件に応じて予め設定された壁環境条件に合致する新たな部屋清掃分割領域を分割して、当該2つの予め設定された壁環境条件に合致する部屋清掃分割領域を現在に画定された所定の清掃領域内における1つの前記マッチング領域として合併するように制御し、ロボットがエッジに沿って走行して前記計画起点位置に戻ることを支持し、特に、ロボットが現在に分割された前記予め設定された壁環境条件に合致する部屋清掃分割領域の欠けからエッジ走行して離れ、現在に分割された予め設定された壁環境条件に合致する部屋清掃分割領域内で継続してエッジに沿って走行していなく、予め設定された壁環境条件に合致する部屋清掃分割領域が分割されていない領域内に入る。その後、ロボットが前記マッチング領域内で継続してエッジに沿って走行するように制御し、すなわち、前記合併された部屋清掃分割領域内でエッジに沿って走行し、ロボットがエッジに沿って一周走行して前記計画起点位置に戻った場合、前記マッチング領域に対して計画的清掃を開始するようにロボットを制御する。本実施例では、前記マッチング領域は、ロボットが分割した予め設定された壁環境条件に合致する部屋清掃分割領域と現在にエッジに沿って走行した領域とを含むので、前記計画起点位置、前記計画起点位置からエッジ走行を起動するまでのロボットの走行経路、およびロボットが既に走行したエッジ走行経路を含み、これにより、本実施例による領域清掃計画方法は、ロボットのエッジ走行および清掃計画経路の円滑性の向上に寄与し、機械停止の可能性を少なくし、実際の環境境界にマッチングさせる。なお、当該好適例は、前記所定の清掃領域内における予め設定された壁環境条件に合致する部屋清掃分割領域の分割状況に基づいて、マッチング領域内でエッジに沿って走行するようにロボットを制御することも実現し、ここで、本実施例における元の位置は、前記ステップS1におけるエッジ起点位置であってもよく、ロボットが予め設定された壁環境条件に合致する前記新たな部屋清掃分割領域にエッジに沿って走行した場合、継続してエッジに沿って走行して前記計画起点位置に戻ることを実現する。
ステップS7において、ロボットが前記ステップS5においてエッジに沿って走行した前記予め設定された壁環境条件に合致する部屋清掃分割領域または前記ステップS6においてエッジ経路に囲まれた実際のエッジ領域の清掃作業を完了すると、または、エッジに沿って走行した前記合併された予め設定された壁環境条件に合致する部屋清掃分割領域の清掃作業を完了すると、前記未清掃領域が存在するか否かを判断し、そうであればステップS8に進み、そうでなければステップS9に進む。具体的には、ロボットが現在に確定された前記予め設定された壁環境条件に合致する部屋清掃分割領域または前記実際のエッジ領域の計画的清掃を完了すると、ロボットにより標記された位置情報に基づいて前記清掃済み領域と前記未清掃領域とを区別し、すなわち、ロボットが計画的清掃経路で被覆された前記予め設定された壁環境条件に合致する部屋清掃分割領域または前記実際のエッジ領域を全部前記清掃済み領域として検出し、他の既知の領域(既に走査して標記された未清掃領域を含む)を前記未清掃領域として検出する。ロボットが前記予め設定された壁環境条件に合致する部屋清掃分割領域を弓字形で計画的に清掃する過程中、前記予め設定された壁環境条件に合致する部屋清掃分割領域を走査してマップを構築して、清掃済み領域と標記する。
ステップS9において、計画的清掃作業を停止して、エッジに沿って走行するために継続して新たな所定の清掃領域を画定することを停止するようにロボットを制御する。
ステップS8において、ロボットが前記未清掃領域に属する次の計画起点位置に移動するように制御し、その後、ステップS1に戻り、すなわち、ロボットがリアルタイムに走査して構築したレーザマップにおいて、次の計画起点位置を中心として新たな所定の清掃領域を画定し、さらに当該新たな所定の清掃領域内から距離が最も近い1つの物理的境界のエッジ起点位置を選択して、ロボットが当該物理的境界に沿ってエッジ走行を行うように構成されるまで、当該エッジ起点位置から直線的に計画された経路に沿って当該物理的境界へ前進するようにロボットを制御する。ここで、当該物理的境界は、当該新たな所定の清掃領域内の障害物の境界または壁を含む。次の計画起点位置は、当該新たな所定の清掃領域内でのロボットの起動位置である。ロボットが当該新たな所定の清掃領域内でエッジに沿って走行する場合、前記ステップS3~前記ステップS9を実行し、ここで、ロボットが計画的清掃およびエッジ走行を実行する過程中、既に区別された、前回のエッジ走行過程中標記した清掃済み領域を含む前記清掃済み領域を迂回するように制御する。
ここで、前記次の計画起点位置は、前記未清掃領域におけるロボットが現在に計画的清掃を終了した位置との距離が最も近い位置であり、ロボットにより現在に計画的清掃を終了した位置から前記次の計画起点位置に直線的にナビゲーションする必要があり、ロボットが走行する過程中障害物または壁が検出されると、前記次の計画起点位置にナビゲーションされるまで現在に検出された障害物の境界または壁に沿って継続して走行する。本実施例は、次の計画起点位置を利用して新たな所定の清掃領域を画定することにより、後続のエッジ走行過程中十分に多くの未知のマップ領域を走査し、より多くの予め設定された壁環境条件に合致する部屋清掃分割領域または実際のエッジ領域を画定し、かつ清掃済み領域を迂回してエッジ走行を行い、不必要なナビゲーション経路を減少させる。
具体的には、図2および図3を比較して分かるように、ロボットは、図1における所定の清掃領域P1内から分割された,前記予め設定された壁環境条件に合致する部屋清掃分割領域#1の弓字形の計画的清掃を完了した後、図2における部屋清掃分割領域#1が清掃済み領域と標記され、図2および図3における部屋清掃分割領域#1の枠以外のマップ領域が未清掃領域と標記され、図2における部屋清掃分割領域#1に標記される情報は、図1における同一領域に標記される情報よりも多い。その後、図3に示す未清掃領域に属する計画起点位置O1(上記実施例の次の計画起点位置に相当)に移動するようにロボットを制御して、図3における正方形の枠P2に示すように、計画起点位置O1を対角線の交点として新たな所定の清掃領域を画定する。
図1、図2および図3における走査されたレーザマップを比較して分かるように、図3における計画起点位置O1は、図1における計画起点位置Oの左上に位置し、図3における計画起点位置O1は、依然として走査された既知のレーザマップの領域内に位置し、かつ、図3に示す実施例では前記未清掃領域に属し、計画起点位置O1は、図3における部屋清掃分割領域#1の清掃終了位置に最も近い。図3における所定の清掃領域P2は、同じ大きさの図1における所定の清掃領域P1に対して左上方へオフセットし、図3における所定の清掃領域P2において、図1における所定の清掃領域P1において走査されていない環境領域を走査することができ、その後、ロボットは、所定の清掃領域P2において分割された予め設定された壁環境条件に合致する部屋清掃領域内で清掃しつつマップを構築し、図4における部屋清掃分割領域#4を取得して、リアルタイムに構築されたレーザマップに対してより多くの既知のレーザマップの領域を増加させるが、所定の清掃領域P2と所定の清掃領域P1との2つの異なる領域被覆範囲に分布される所定の清掃領域は、いずれもロボットのエッジ走行範囲を制限するために用いられる。同時に、図3における所定の清掃領域P2は、図3における清掃済み領域と標記される部屋清掃分割領域#1を囲むので、所定の清掃領域P2と図1における所定の清掃領域P1とは重なり領域が存在し、この重なり領域は、部屋清掃分割領域#1を含む。後続の所定の清掃領域P2内で分割された、予め設定された壁環境条件に合致する部屋清掃分割領域は、清掃済み領域と標記された部屋清掃分割領域#1と重なり合う領域を有しない。
図3と図4を比較して分かるように、ロボットは、図3に示す前記計画起点位置O1で、図4に示すような予め設定された壁環境条件に合致する部屋清掃分割領域#2を分割し、図4における部屋清掃分割領域#2内に標記されたマップ情報は、図3における同一領域に標記されたマップ情報よりも多い。前記計画起点位置O1も部屋清掃分割領域#2の内部に位置し、前記所定の清掃領域P2は、部屋清掃分割領域#2を囲んでロボットのエッジ走行範囲を制限し、さらに部屋清掃分割領域#2、または部屋清掃分割領域#2を分割できない場合の実際のエッジ経路に囲まれる実際エッジ領域を囲む。ここで、図4における部屋清掃分割領域#2は、図4における部屋清掃分割領域#1とちょうど隣接し、この2つの部屋領域は、重なり領域が存在しないと見なすことができ、これにより、ロボットは、部屋清掃分割領域#2内においてエッジ走行および弓字形の計画的清掃を実行する時に部屋清掃分割領域#1を迂回することができ、清掃済み領域を繰り返して清掃することを回避し、清掃時間を減少させ、ロボットの清掃作業効率を向上させることができる。同時に、前後に分割された部屋清掃分割領域#1および#2は隣接関係が存在しており、すなわち、前後に分割された、予め設定された壁環境条件に合致する部屋清掃分割領域は隣接関係が存在するため、清掃領域の被覆率を向上させるのに寄与する。
なお、前記所定の清掃領域の被覆領域は、辺長が12mの正方形の実際の物理的領域に等価し、この正方形の実際の物理的領域の辺長は、室内の清掃対象領域のサイズとは関係がある。前記所定の清掃領域の被覆領域の位置は、ロボットの計画起点位置の変化に応じて変化する。前記の実施例は、計画起点位置ごとに1つのエッジ走行範囲を制限する矩形領域を対応して設置することによって、ロボットの最大のエッジ走行範囲を事前に画定し、ロボットが無制限にエッジ走行を実行するのも防止する。さらに、現在に確定した前記予め設定された壁環境条件に合致する部屋清掃分割領域、または同一の前記所定の清掃領域内で合併される前記予め設定された壁環境条件に合致する部屋清掃分割領域を囲む。
前記の実施例に基づいて、前記ステップS4において、現在に画定された所定の清掃領域から予め設定された壁環境条件に合致する1つの部屋清掃領域を分割する方法は、以下のステップを含む。ステップ11において、前記エッジ起点位置から、前記レーザマップの各座標軸方向で走査されたレーザ画像の画素点の統計情報に基づいて、現在に画定された所定の清掃領域内で座標軸方向に沿って輪郭境界線分を位置決めし、前記各座標軸方向は、図示するX軸方向およびY軸方向を含む。ステップ12において、各座標軸方向において予め設定された位置に最も近い輪郭境界線分を選択して、図2に示す部屋清掃分割領域#1に属する一部の矩形領域である矩形の初期部屋清掃分割領域を囲む。ステップ13において、初期部屋清掃分割領域が前記予め設定された壁環境条件に合致しない部屋清掃分割領域である場合、例えばY軸負方向のような優先的に拡張する座標軸方向を選択し、初期部屋清掃分割領域における、優先的に拡張する座標軸方向に垂直に位置決めされた非壁障害物線分を削除して、同一の座標軸方向に沿って初期部屋清掃分割領域を拡張し、その後、ステップ14に進む。ステップ14において、ステップ13における前記優先的に拡張する座標軸方向に位置決めされた、ステップ13において削除した非壁障害物線分に隣接する輪郭境界線分が現在に画定された所定の清掃領域内の前記未清掃領域にまだ位置しているか否かを判断し、かつ、当該座標軸方向に位置決めされた輪郭境界線分が前記初期部屋清掃分割領域の残りの輪郭境界線分と交差して、前記予め設定された壁環境条件に合致する部屋清掃分割領域を形成していないか否かを判断し、両者を共に満足すると、すなわち、ステップ13における前記優先的に拡張する座標軸方向に位置決めされた、ステップ13において削除した非壁障害物線分に隣接する輪郭境界線分が現在に画定された所定の清掃領域内の前記未清掃領域に位置しており、かつ、同一の座標軸方向に位置決めされた輪郭境界線分が前記初期部屋清掃分割領域の残りの輪郭境界線分と交差して、前記予め設定された壁環境条件に合致する部屋清掃分割領域を形成していないと、ステップ13に戻って、現在に選択した座標軸方向における拡張を継続して実行する。ステップ13における前記優先的に拡張された座標軸方向に位置決めされた、ステップ13において削除された非壁障害物線分に隣接する輪郭境界線分が現在に画定された所定の清掃領域内の前記未清掃領域に位置していないと、前記ステップ13における現在に選択した座標軸方向における拡張を停止し、すなわち、ステップ13における前記優先的に拡張する座標軸方向に位置決めされた、ステップ13において削除した非壁障害物線分に隣接する輪郭境界線分が現在に画定された所定の清掃領域内の前記清掃済み領域に位置しており、または同一の座標軸方向に位置決めされた輪郭境界線分が前記初期部屋清掃分割領域の残りの輪郭境界線分と交差して予め設定された壁環境条件に合致する部屋清掃分割領域を形成すると、前記ステップ13における現在に選択した座標軸方向における拡張を停止し、前記ステップ13に戻って拡張優先度が1段低い座標軸方向(例えば、X軸負方向)を選択して拡張することにより、前記所定の清掃領域から対応する輪郭境界線分で予め設定された壁環境条件に合致する部屋清掃分割領域を分割する。
図2における部屋清掃分割領域#1の枠境界は、実際の環境の壁境界に接近し、すなわち、前記所定の清掃領域P1内で分割された部屋清掃分割領域#1と前記所定の清掃領域P2内で分割された部屋清掃分割領域#2はいずれも実際の部屋の地形に接近する。ここで、非壁障害物線分は、壁に属しない輪郭境界線分であり、前記予め設定された壁環境条件に合致する部屋清掃分割領域を囲む輪郭境界線分と実際の部屋境界とは、予め設定された誤差許容範囲内で重なり合う。ここで、実際の部屋境界は、予め設定された壁環境条件に合致する前記部屋清掃分割領域の内部の障害物の境界および/または前記実際のエッジ領域の内部の障害物の境界を含み、実際の部屋は、所定の清掃領域が位置する実際の物理的領域である。本実施例は、従来の技術と比べて、レーザ走査によって取得されたマップ画像の画素情報を利用して、前記所定の清掃領域にロボットの初期部屋清掃分割領域をリアルタイムに分割し、かつ、同一の前記所定の清掃領域に、清掃対象領域の壁の境界を繰り返して反復処理することによりロボットの初期部屋清掃分割領域を拡張することによって、同一の前記所定の清掃領域に最終的に形成された、前記予め設定された壁環境条件に合致する部屋清掃分割領域の輪郭境界が実際の部屋の境界と類似することを確保する。本実施例は、前記初期作業領域を面積がより大きくかつ被覆面積がより広い密閉された枠領域#1および#2に拡張することにより、絶え間なく修正しつつ拡張された輪郭境界線分に沿ってロボットを実際の環境の壁における目標位置までにナビゲーションし、前記予め設定された壁環境条件に合致する部屋清掃分割領域の境界に沿ったロボットのナビゲーション効率を向上させることができる。
上記実施例では、前記予め設定された壁環境条件に合致する部屋清掃分割領域の具体的な判断方法は、以下のステップを含む。前記初期部屋清掃分割領域を囲む輪郭境界線分がいずれも非壁障害物線分ではなく、かつ前記初期部屋清掃分割領域内の孤立した障害物線分の長さが、壁適合数量値の画素点の個数に対応する線分の長さおよび前記初期部屋清掃分割領域の任意の1辺の長さの予め設定された比の値のうち相対的に小さい数値より小さい場合、画定された密閉領域内の孤立した障害物のサイズが壁を構成するのに不十分であるので、前記初期部屋清掃分割領域が前記予め設定された壁環境条件に合致する部屋清掃分割領域であると確定する。前記初期部屋清掃分割領域を囲む1本の前記輪郭境界線分が非壁障害物線分であり、または、前記初期部屋清掃分割領域内の孤立した障害物線分の長さが壁適合数量値の画素点数に対応する線分の長さ以上であり、または、前記初期部屋清掃分割領域内の孤立した障害物線分の長さが前記初期部屋清掃分割領域の1辺の長さの予め設定された比の値以上である場合、前記初期部屋清掃分割領域が前記予め設定された壁環境条件に合致しないと確定する。ここで、前記輪郭境界線分は、白画素点の個数に基づいて非壁障害物線分と壁障害物線分とに分けられ、非壁障害物線分における白画素点の個数は、予め設定された閾値以上であり、壁障害物線分における白画素点の個数は、予め設定された閾値より小さい。ここで、レーザマップには、走査された孤立した障害物線分も存在し、前記孤立した障害物線分の長さが前記初期部屋清掃分割領域の1辺の長さの予め設定されたエラー比の値と壁適合数量値の画素点の個数に対応する線分の長さとの2種類の線分の長さのうちの1つの以上であれば、前記孤立障害物線分が前記壁障害物線分と標記される。本実施例は、前記初期部屋清掃分割領域を画定する輪郭境界線分の線分長さの性質および前記初期部屋清掃分割領域内の孤立した障害物線分の長さによって前記予め設定された壁環境条件に合致する部屋清掃分割領域の環境特徴を確定し、他の領域の障害物の直線による干渉作用を排除し、かつ無視できない長さの孤立した障害物線分を物理的壁に適合させ、輪郭境界線分が壁と誤判断される影響を低減させ、室内で構築される予め設定された壁環境条件に合致する部屋清掃分割領域の輪郭境界位置がいずれも壁に接近することを確保することにより、分割される予め設定された壁環境条件に合致する部屋清掃分割領域が実際の家居環境における部屋領域を構成することができる。同時に、前記予め設定された壁環境条件の部屋清掃分割領域の具体的な判断方法を実行することによって、ロボットによる壁と非壁障害物の区別の正確性および知能化レベルを向上させる。
上記実施例では、前記ステップ11の具体的な方法は、以下のステップを含む。前記所定の清掃領域内で、前記計画起点位置から現在に構築されたレーザマップの画像画素点を統計する。本実施例は、障害物のヒストグラムを利用して前記計画起点位置との距離が異なる前記検出区間内の様々なグレースケールの画素点の出現個数を統計することにより、対応するグレースケールの画素点で形成された障害物線分のレーザマップでの位置決めも実現する。X軸方向に沿って統計した縦座標が同じである黒画素点の数が予め設定された境界閾値を超えたたびに、これらの縦座標が同じである黒画素点の接続によって形成された前記輪郭境界線分を標記することにより、前記所定の清掃領域内でX軸方向に沿って延伸する領域が対応する輪郭境界線分で分割される。実際に、後では、前記輪郭境界線分を壁ではないと判断して削除し、さらに対応する分割領域を合併し、領域を過度に分割するのを回避して、X軸方向における局所領域の輪郭特徴を記述することができる。X軸方向に沿って統計した縦座標が同じである黒画素点の数が予め設定された境界閾値を超えないと、現在の方向に沿って前記輪郭境界線分を標記しない。Y軸方向に沿って統計した横座標が同じである黒画素点の数が予め設定された境界閾値を超えたたびに、これらの横座標が同じである黒画素点の接続によって形成された前記輪郭境界線分を標記することにより、前記所定の清掃領域内でY軸方向に沿って延伸する領域が対応する輪郭境界線分で分割され、そうでなければ現在の方向に沿って前記輪郭境界線分を標記しなく、Y軸方向における局所領域の輪郭特徴を記述することができ、後続のステップでは、当該方向において確定された輪郭境界線分が壁ではなく領域を分割する機能を果たすことができないと判断する可能性があり、次の輪郭境界線分を続いて検索して壁のエッジに近接するサイズで前記所定の清掃領域内において予め設定された壁環境条件に合致する前記部屋清掃領域を画定する必要がある。なお、輪郭境界線分は、ロボットの機体サイズの大きさおよび所定の清掃領域の辺長の大きさと関係があり、実際の必要に応じて調整することができる。本実施形態は、同一の座標軸方向に分布される黒画素点の数に基づいて、前記所定の清掃領域内からある程度の通行可能性を有する領域を選択して輪郭境界線分を標記し、前記予め設定された壁環境条件に合致する部屋清掃領域を囲む輪郭境界線分は、部屋領域の分割がより規則的で合理的になるように互いに揃えてもよく、標記された輪郭境界線分は、ロボットが連続的にエッジに沿って走行するための矩形の作業領域を画定できることを確保する。
なお、フローチャートに示されまたはここで他の方式で記載される論理および/またはステップは、例えば、論理機能を実現するための実行可能な指令のシーケンスリストであると考えられるものであり、具体的には、指令実行システム、装置または機器(例えば、コンピュータに基づくシステム、プロセッサを含むシステムまたは指令実行システム、装置または機器から指令を取得して指実行可能なシステム)が使用し、またはこれらの指令実行システム、装置または機器と組み合わせて使用するように、任意のコンピュータ読取可能な媒体に実現されてもよい。なお、本明細書において、「コンピュータ読取可能な媒体」は、指令実行システム、装置または機器が使用し、またはこれらの指令実行システム、装置または機器と組み合わせて使用するように、プログラムを包含、記憶、通信、伝播または伝送可能な任意の装置であってもよい。また、コンピュータ読取可能な媒体のより具体的な例(非網羅的リスト)は、1つまたは複数の配線を有する電気接続部(電子機器)、携帯式のコンピュータ・ディスクカートリッジ(磁気デバイス)、RAM(Random Access Memory)、ROM(Read Only Memory)、EPR0M(Erasable Programmable Read Only Memory)またはフラッシュメモリ、光ファイバ装置、およびCD-ROM(Compact Disc Read Only Memory)を含む。また、コンピュータ読み取り可能な媒体は、前記プログラムを印刷可能な紙やその他の適宜な媒体であってもよい。なぜならば、例えば紙やその他の媒体を光学的に走査して編集、解釈したり、必要に応じて他の適切な方式で処理したりすることにより、前記プログラムを電子的に取得してコンピュータのメモリに記憶させることができるためである。
本発明は、モバイルロボットが前記の実施例に記載される領域清掃計画方法を実行するように制御するための制御プログラムを内蔵したチップをさらに開示する。前記チップ搭載ロボットは、エッジに沿って走行する過程中前記予め設定された壁環境条件に合致する部屋清掃分割領域をリアルタイムに分割することにより、実際の部屋の環境境界にマッチングする清掃領域を選択してエッジ走行した後に清掃作業を行うことによって、長時間にわたって清掃を行わずに無目的にエッジに沿って走行するのを回避しつつ、領域全体におけるエッジ走行および清掃計画経路の円滑性を保証し、余分なナビゲーション経路および余分なマップ領域の構築計算時間を減少させることができる。本明細書に記載される領域清掃計画方法の実施例は、ハードウェア、ソフトウェア、ファームウェア、ミドルウェア、マイクロコードまたはそれらの任意の組み合わせにより実現することができると理解すべきである。ハードウェア実現方式に対して、処理ユニットは、1つまたは複数のASIC(Application Specific Integrated Circuit)、DSP(Digital Signal Processing)、DSPD(Digital Signal Processing Device)、PLD(Programmable Logic Device)、FPGA(Field-Programmable Gate Array)、プロセッサ、コントローラ、マイクロコントローラ、マイクロプロセッサ、本明細書に記載される機能を実行するように設計された他の電子ユニット、またはそれらの組み合わせ内で実現することができる。ソフトウェア、ファームウェア、ミドルウェアまたはマイクロコード、プログラムコードまたはコードセグメントで実施例を実現する場合、それらをストレージコンポーネントのような機械可読媒体に記憶することができる。
本発明は、ロボットをさらに開示し、当該ロボットには、レーザセンサが装着され、リアルタイムに走査してレーザマップを構築して、ロボットが内蔵する前記チップに記憶することができ、前記チップは、ロボットがエッジに沿って走行する過程中現在に画定された所定の清掃領域を超えないように、リアルタイムに走査して構築したレーザマップにおける現在の計画起点位置で画定された所定の清掃領域内でエッジに沿って走行するように前記ロボットを制御するためのものである。同時に、前記所定の清掃領域における予め設定された壁環境条件に合致する部屋清掃分割領域の分割状況に応じて、マッチングする領域内でエッジに沿って走行し、当該マッチング領域内でエッジに沿って走行して前記計画起点位置に戻ると、当該マッチング領域に計画的清掃を実行するように前記ロボットを制御し、ここで、前記マッチング領域は、実際の部屋領域の境界にマッチングする清掃対象領域であって、ロボットが前記所定の清掃領域内で現在の計画起点位置から既にエッジに沿って走行した経路を含む。当該マッチング領域内で計画的清掃を完了すると、未清掃領域の次の計画起点位置に移動し、未清掃領域を検出できないまで、前記の機能を繰り返して実行するようにする。
上記実施例は、本発明の技術的思想および特徴を説明するためのものに過ぎず、その目的として、当業者が本発明の内容を理解しかつこれに基づいて実施することであり、これにより本発明の保護範囲を制限することができない。本発明の精神実質に基づいて行われた同等変換または修飾は、いずれも本発明の保護範囲内に含まれるべきである。


Claims (13)

  1. ロボットがリアルタイムに走査して構築したレーザマップにおいて、ロボットがエッジに沿って走行する過程中現在の計画起点位置で画定された所定の清掃領域を超えないように、現在の計画起点位置で画定された所定の清掃領域内でエッジに沿って走行するようにロボットを制御し、前記所定の清掃領域は、前記ロボットが起動位置で前記起動位置を対角線の交点とする正方形の枠領域を規定し、前記ロボットがエッジに沿って走行する範囲を制限するためのものであるステップと、
    同時に前記所定の清掃領域における予め設定された壁環境条件に合致する部屋清掃分割領域の分割状況に応じて、マッチング領域内でエッジに沿って走行するようにロボットを制御し、ロボットが当該マッチング領域内でエッジに沿って走行して前記計画起点位置に戻ると、当該マッチング領域内で計画的清掃を実行するようにロボットを制御するステップであって、ここで、前記マッチング領域は、実際の部屋領域の境界にマッチングする清掃対象領域であって、ロボットが前記所定の清掃領域内で現在の計画起点位置から既にエッジに沿って走行した経路を含む、ステップと、
    ロボットが当該マッチング領域内で計画的清掃を完了すると、未清掃領域の次の計画起点位置に移動するようにロボットを制御した後、未清掃領域を検出できないまで前記のステップを繰り返すステップと、を含むことを特徴とする、ロボットがエッジに沿って走行する領域清掃計画方法。
  2. ロボットがリアルタイムに走査して構築したレーザマップにおいて、前記計画起点位置を中心として1つの前記所定の清掃領域を画定した後、現在に画定された前記所定の清掃領域内で距離が最も近い1つの物理的境界のエッジ起点位置を選択して、ロボットが当該物理的境界に沿ってエッジ走行を行うように構成されるまで、当該エッジ起点位置から直線的に計画された経路に沿って当該物理的境界へ前進するようにロボットを制御するステップをさらに含み、
    ここで、当該物理的境界は、所定の清掃領域内の障害物の境界または壁を含み、
    前記計画起点位置は、現在に画定された前記所定の清掃領域内でのロボットの起動位置である、ことを特徴とする請求項1に記載の領域清掃計画方法。
  3. 同時に前記所定の清掃領域における予め設定された壁環境条件に合致する部屋清掃分割領域の分割状況に応じて、マッチング領域内でエッジに沿って走行するようにロボットを制御し、ロボットが当該マッチング領域内でエッジに沿って一周走行して前記計画起点位置に戻ると、当該マッチング領域内で計画的清掃を実行するようにロボットを制御する方法は、
    ロボットが現在に画定された所定の清掃領域内でエッジに沿って走行するように制御するとともに、エッジに沿って走行する過程中、ロボットが現在に画定された所定の清掃領域から前記予め設定された壁環境条件に合致する部屋清掃分割領域を分割したか否かを判断し、そうであればステップ2に進み、そうでなければステップ3に進むステップ1と、
    ロボットがステップ1における前記予め設定された壁環境条件に合致する部屋清掃分割領域内で継続してエッジに沿って走行するように制御し、ロボットが当該部屋清掃分割領域内でエッジに沿って一周走行して前記計画起点位置に戻った場合、当該部屋清掃分割領域に対して計画的清掃を行うようにロボットを制御するステップであって、ここで、当該部屋清掃分割領域は、前記計画起点位置、前記計画起点位置からエッジ走行の起動までのロボットの走行経路、およびロボットが既に走行したエッジ経路を含むステップ2と、
    ロボットが現在に画定された所定の清掃領域内で継続してエッジに沿って走行するように制御し、ロボットがエッジに沿って走行して前記計画起点位置に戻った場合、ロボットが現在にエッジに沿って走行した経路に囲まれた実際のエッジ領域に対して計画的清掃を開始するように制御するステップ3と、を含む、ことを特徴とする請求項2に記載の領域清掃計画方法。
  4. ロボットがエッジに沿って走行する過程中、ロボットが前記予め設定された壁環境条件に合致する部屋清掃分割領域を1個分割した場合、ロボットが当該部屋清掃分割領域からエッジに沿って走行して離れたと判断されると、ロボットが継続して前記予め設定された壁環境条件に合致する新たな部屋清掃分割領域を分割して、当該2つの前記予め設定された壁環境条件に合致する部屋清掃分割領域を現在に画定された所定の清掃領域内における1つの前記マッチング領域として合併するように制御し、
    その後、ロボットが前記マッチング領域内で継続してエッジに沿って走行するように制御し、ロボットがエッジに沿って一周走行して前記計画起点位置に戻った場合、前記マッチング領域に対して計画的清掃を開始するようにロボットを制御し、ここで、前記マッチング領域は、前記計画起点位置、前記計画起点位置からエッジ走行の起動までのロボットの走行経路、およびロボットが既に走行したエッジ経路を含む、ことを特徴とする請求項3に記載の領域清掃計画方法。
  5. 前記ステップ2において、前記予め設定された壁環境条件に合致する部屋清掃分割領域の座標位置の全てが計画的清掃経路により覆われるまで、ロボットが計画的清掃を実行する過程中前記予め設定された壁環境条件に合致する部屋清掃分割領域を超えないように制御し、
    前記ステップ3において、当該実際のエッジ領域の座標位置の全てが計画的清掃経路により覆われるまで、ロボットが計画的清掃を実行する過程中現在のエッジ走行経路に囲まれた実際のエッジ領域を超えないように制御し、
    ここで、ロボットによる清掃で被覆された領域を清掃済み領域と標記するとともに、ロボットによる清掃で被覆された領域以外の走査済み領域を未清掃領域と標記する、ことを特徴とする請求項3または4に記載の領域清掃計画方法。
  6. ロボットが現在に確定された前記予め設定された壁環境条件に合致する部屋清掃分割領域または前記実際のエッジ領域の計画的清掃を完了すると、ロボットが標記した位置情報に基づいて前記清掃済み領域と前記未清掃領域とを区別した後、ロボットが前記未清掃領域に属する次の計画起点位置に移動して、請求項2に記載の方法に基づいて次の計画起点位置で1つの新たな予定の清掃領域を画定するように制御し、ここで、次の計画起点位置は、前記未清掃領域のうち、ロボットが現在に計画的清掃を完了した位置との距離が最も近い位置であり、
    ロボットが当該新たな所定の清掃領域内でエッジに沿って走行する場合、前記ステップ1~前記ステップ3を実行し、ここで、ロボットが計画的清掃およびエッジ走行を実行する過程中前記清掃済み領域を迂回するように制御する、ことを特徴とする請求項5に記載の領域清掃計画方法。
  7. 前記所定の清掃領域は、前記計画起点位置を対角線の交点とする1つの正方形の枠領域であって、ロボットがエッジに沿って走行する範囲を制限するためのものであり、さらに、現在に確定した前記予め設定された壁環境条件に合致する部屋清掃分割領域、同一の前記所定の清掃領域内で合併された前記予め設定された壁環境条件に合致する部屋清掃分割領域、または前記実際のエッジ領域を囲み、
    ここで、前記所定の清掃領域の被覆領域は、正方形の実際の物理的領域に等価し、前記所定の清掃領域の被覆領域の位置は、ロボットの計画起点位置の変化に応じて変化し、当該正方形の実際の物理的領域の辺長は、室内の清掃対象領域のサイズと関係がある、ことを特徴とする請求項6に記載の領域清掃計画方法。
  8. 現在の計画起点位置で画定された所定の清掃領域と前記次の計画起点位置で画定された所定の清掃領域とは重なり領域が存在しており、当該重なり領域は、前記清掃済み領域を含む、ことを特徴とする請求項7に記載の領域清掃計画方法。
  9. 現在に画定された所定の清掃領域から予め設定された壁環境条件に合致する1つの部屋清掃分割領域を分割する方法は、
    前記エッジ起点位置から、前記レーザマップの各座標軸方向で走査されたレーザ画像の画素点の統計情報に基づいて、現在に画定された所定の清掃領域内で前記レーザマップの座標軸方向に沿って輪郭境界線分を位置決めするステップ11と、
    各座標軸方向において予め設定された位置に最も近い輪郭境界線分を選択して、1つの矩形の初期部屋清掃分割領域を囲むステップ12と、
    初期部屋清掃分割領域が前記予め設定された壁環境条件に合致しない部屋清掃分割領域である場合、1つの優先的に拡張する座標軸方向を選択し、初期部屋清掃分割領域における、優先的に拡張する座標軸方向に垂直に位置決めされた非壁障害物線分を削除して、同一の座標軸方向に沿って初期部屋清掃分割領域を拡張し、その後、ステップ14に進むステップ13と、
    ステップ13における前記優先的に拡張する座標軸方向に位置決めされた、ステップ13において削除した非壁障害物線分に隣接する輪郭境界線分が現在に画定された所定の清掃領域内の前記未清掃領域に位置しているか否かを判断するとともに、当該座標軸方向に位置決めされた輪郭境界線分が前記初期部屋清掃分割領域の残りの輪郭境界線分と交差して、前記予め設定された壁環境条件に合致する部屋清掃分割領域を形成していないか否かを判断し、両者を共に満足すると、ステップ13に戻って、現在に選択した座標軸方向における拡張を継続して実行するステップ14と、
    ステップ13における前記優先的に拡張された座標軸方向に位置決めされた、ステップ13において削除された非壁体障害物線分に隣接する輪郭境界線分が現在に画定された所定の清掃領域内に位置する前記未清掃領域ではない場合、前記ステップ13において現在に選択した座標軸方向における拡張を停止して、前記ステップ13に戻って拡張優先度が1段低い座標軸方向を選択して拡張することにより、前記所定の清掃領域から対応する輪郭境界線分で前記予め設定された壁体環境条件に合致する部屋清掃分割領域を分割するステップと、含み、
    ここで、非壁障害物線分は、輪郭境界線分に属するが壁を示しないものであり、前記予め設定された壁環境条件に合致する部屋清掃分割領域を囲む輪郭境界線分と実際の部屋境界とは、予め設定された誤差許容範囲内で重なり合い、
    ここで、実際の部屋境界は、前記予め設定された壁環境条件に合致する部屋清掃分割領域の内部の障害物の境界および/または前記実際のエッジ領域の内部の障害物の境界を含む、ことを特徴とする請求項5に記載の領域清掃計画方法。
  10. 前記予め設定された壁環境条件に合致する部屋清掃分割領域の具体的な判断方法は、
    前記初期部屋清掃分割領域を囲む輪郭境界線分がいずれも非壁障害物線分ではなく、かつ前記初期部屋清掃分割領域内の孤立した障害物線分の長さが、壁適合数量値の画素点の個数に対応する線分の長さおよび前記初期部屋清掃分割領域の任意の1辺の長さの予め設定された比の値のうち相対的に小さい数値より小さい場合、前記初期部屋清掃分割領域が前記予め設定された壁環境条件に合致する部屋清掃分割領域であると確定するステップと、
    前記初期部屋清掃分割領域を囲む1本の前記輪郭境界線分が非壁障害物線分であり、または、前記初期部屋清掃分割領域内の孤立した障害物線分の長さが壁適合数量値の画素点数に対応する線分の長さ以上であり、または、前記初期部屋清掃分割領域内の孤立した障害物線分の長さが前記初期部屋清掃分割領域の1辺の長さの予め設定された比の値以上である場合、前記初期部屋清掃分割領域が前記予め設定された壁環境条件に合致する部屋清掃分割領域ではないと確定するステップと、を含み、
    ここで、前記輪郭境界線分は、白画素点の個数に基づいて非壁障害物線分と壁障害物線分とに分けられ、非壁障害物線分における白画素点の個数は、予め設定された閾値以上であり、壁障害物線分における白画素点の個数は、予め設定された閾値より小さく、
    ここで、レーザマップには、走査された孤立した障害物線分も存在し、前記孤立した障害物線分の長さが前記初期部屋清掃分割領域の1辺の長さの予め設定されたエラー比の値と壁適合数量値の画素点の個数に対応する線分の長さとの2種類の線分の長さのうちの1つの以上であれば、前記孤立障害物線分が前記壁障害物線分と標記される、ことを特徴とする請求項9に記載の領域清掃計画方法。
  11. 前記ステップ11の具体的な方法は、
    前記所定の清掃領域内で、前記計画起点位置から現在に構築されたレーザマップの画像画素点を統計するステップと、
    X軸方向に沿って統計した縦座標が同じである黒画素点の数が予め設定された境界閾値を超えたたびに、これらの縦座標が同じである黒画素点の接続によって形成された前記輪郭境界線分を標記することにより、前記所定の清掃領域内でX軸方向に沿って延伸する領域が対応する輪郭境界線分で分割されるステップと、
    Y軸方向に沿って統計した横座標が同じである黒画素点の数が予め設定された境界閾値を超えたたびに、これらの横座標が同じである黒画素点の接続によって形成された前記輪郭境界線分を標記することにより、前記所定の清掃領域内でY軸方向に沿って延伸する領域が対応する輪郭境界線分で分割されるステップと、を含む、ことを特徴とする請求項10に記載の領域清掃計画方法。
  12. 制御プログラムが内蔵されるチップであって、
    前記制御プログラムは、請求項1乃至11のいずれか1項に記載の領域清掃計画方法を実行するようにモバイルロボットを制御するためのものである、ことを特徴とするチップ。
  13. レーザセンサが搭載されるロボットであって、
    請求項12に記載のチップが内蔵され、
    エッジに沿って走行する過程中現在の計画起点位置で画定された所定の清掃領域を超えないように、リアルタイムに走査して構築したレーザマップにおける現在の計画起点位置で画定された所定の清掃領域内でエッジに沿って走行するようにロボットが構成され、
    同時に前記所定の清掃領域における予め設定された壁環境条件に合致する部屋清掃分割領域の分割状況に応じて、マッチング領域内でエッジに沿って走行し、当該マッチング領域内でエッジに沿って走行して前記計画起点位置に戻ると、当該マッチング領域で計画的清掃を実行するようにロボットが構成され、ここで、前記マッチング領域は、実際の部屋領域の境界にマッチングする清掃対象領域であって、ロボットが前記所定の清掃領域内で現在の計画起点位置から既にエッジに沿って走行した経路を含み、
    当該マッチング領域内で計画的清掃を完了すると、未清掃領域の次の計画起点位置に移動し、未清掃領域を検出できないまで、前記の機能を繰り返して実行するようにロボットが構成される、ことを特徴とするロボット。
JP2022527687A 2020-06-12 2020-11-24 ロボットがエッジに沿って走行する領域清掃計画方法、チップおよびロボット Active JP7336118B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN202010537593.0A CN111830970B (zh) 2020-06-12 2020-06-12 一种机器人沿边行走的区域清扫规划方法、芯片及机器人
CN202010537593.0 2020-06-12
PCT/CN2020/131195 WO2021248846A1 (zh) 2020-06-12 2020-11-24 一种机器人沿边行走的区域清扫规划方法、芯片及机器人

Publications (2)

Publication Number Publication Date
JP2023501569A JP2023501569A (ja) 2023-01-18
JP7336118B2 true JP7336118B2 (ja) 2023-08-31

Family

ID=72899091

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2022527687A Active JP7336118B2 (ja) 2020-06-12 2020-11-24 ロボットがエッジに沿って走行する領域清掃計画方法、チップおよびロボット

Country Status (5)

Country Link
EP (1) EP4043988A4 (ja)
JP (1) JP7336118B2 (ja)
KR (1) KR20220075410A (ja)
CN (1) CN111830970B (ja)
WO (1) WO2021248846A1 (ja)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111830970B (zh) * 2020-06-12 2022-03-04 珠海一微半导体股份有限公司 一种机器人沿边行走的区域清扫规划方法、芯片及机器人
CN112426095B (zh) * 2020-11-24 2022-09-09 尚科宁家(中国)科技有限公司 清洁机器人的分区清洁方法及清洁机器人
CN113503877A (zh) * 2021-06-22 2021-10-15 深圳拓邦股份有限公司 机器人分区地图建立方法、装置及机器人
CN113467482A (zh) * 2021-08-12 2021-10-01 深圳市伽利略机器人有限公司 一种自清洁的清洁机器人清扫路径规划方法及清洁机器人
CN114442638B (zh) * 2022-02-14 2023-07-07 北京大学 一种基于大数据路径规划的清淤机器人
CN114427310A (zh) * 2022-02-18 2022-05-03 智橙动力(北京)科技有限公司 泳池边缘清洗方法、装置、电子设备及计算机存储介质
CN114454216B (zh) * 2022-03-07 2023-10-10 云鲸智能(深圳)有限公司 机器人的精度检测方法、装置、机器人及存储介质
CN114967687A (zh) * 2022-05-23 2022-08-30 纯米科技(上海)股份有限公司 障碍物检测方法、系统、电子装置及计算机可读存储介质
CN117193277A (zh) * 2022-05-30 2023-12-08 珠海一微半导体股份有限公司 基于地图区域轮廓的设置方法与机器人沿边结束控制方法
CN115251765A (zh) * 2022-07-04 2022-11-01 麦岩智能科技(北京)有限公司 一种基于多传感器的清洁机器人沿边清扫控制方法
CN115211765A (zh) * 2022-07-19 2022-10-21 深圳胡杨智能创新有限公司 清洁机器人控制方法、清洁机器人及存储介质
CN115444325A (zh) * 2022-07-21 2022-12-09 深圳银星智能集团股份有限公司 二次清洁方法、装置、清洁机器人及存储介质
CN115268468B (zh) * 2022-09-27 2023-01-24 深圳市云鼠科技开发有限公司 清洁机器人的沿墙坐标修正方法、装置、设备以及介质
CN115500737B (zh) * 2022-09-28 2023-10-17 云鲸智能(深圳)有限公司 一种地面介质探测方法、装置及清洁设备
CN115328172B (zh) * 2022-10-13 2023-02-17 科大讯飞股份有限公司 清洁机器人及其控制方法、装置、设备及存储介质
CN115316887B (zh) * 2022-10-17 2023-02-28 杭州华橙软件技术有限公司 机器人控制方法、机器人及计算机可读存储介质

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019053062A1 (de) 2017-09-12 2019-03-21 RobArt GmbH Exploration einer unbekannten umgebung durch einen autonomen mobilen roboter
CN110412619A (zh) 2019-08-12 2019-11-05 珠海市一微半导体有限公司 激光机器人的区域遍历方法和激光主控芯片

Family Cites Families (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100874259B1 (ko) * 2007-05-07 2008-12-16 에이스로봇 주식회사 청소로봇 유닛 및 그 청소로봇 유닛을 이용한 청소방법
KR20090077547A (ko) * 2008-01-11 2009-07-15 삼성전자주식회사 이동 로봇의 경로 계획 방법 및 장치
CN102138769B (zh) * 2010-01-28 2014-12-24 深圳先进技术研究院 清洁机器人及其清扫方法
KR101887055B1 (ko) * 2011-11-14 2018-09-11 삼성전자주식회사 로봇 청소기 및 그 제어 방법
DE102015119865B4 (de) * 2015-11-17 2023-12-21 RobArt GmbH Robotergestützte Bearbeitung einer Oberfläche mittels eines Roboters
TW201833701A (zh) * 2017-03-14 2018-09-16 聯潤科技股份有限公司 自走式清潔裝置及其建立室內地圖之方法
TW201832710A (zh) * 2017-03-14 2018-09-16 聯潤科技股份有限公司 自走式清潔裝置分區清潔方法及使用該方法的自走式清潔裝置
EP3611590B1 (en) * 2017-04-11 2023-03-15 Amicro Semiconductor Co., Ltd. Method for creating grid map of intelligent robot
CN107773164B (zh) * 2017-11-17 2020-11-03 北京奇虎科技有限公司 用于清洁机器人的清洁方法、装置及机器人
CN108143364B (zh) * 2017-12-28 2021-02-19 湖南格兰博智能科技有限责任公司 一种自移动清洁机器人清洁地图区域划分的方法
JP7123430B2 (ja) * 2018-07-30 2022-08-23 学校法人千葉工業大学 地図生成システムおよび移動体
WO2020027515A1 (ko) * 2018-08-02 2020-02-06 (주)유진로봇 속성 블록을 설정하는 이동 로봇
CN109240312B (zh) * 2018-11-23 2020-09-15 珠海市一微半导体有限公司 一种机器人的清扫控制方法和芯片以及清洁机器人
CN110315538B (zh) * 2019-06-27 2021-05-07 深圳乐动机器人有限公司 一种在电子地图上显示障碍物的方法、装置及机器人
CN110456789A (zh) * 2019-07-23 2019-11-15 中国矿业大学 一种清洁机器人的全覆盖路径规划方法
CN111830970B (zh) * 2020-06-12 2022-03-04 珠海一微半导体股份有限公司 一种机器人沿边行走的区域清扫规划方法、芯片及机器人

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019053062A1 (de) 2017-09-12 2019-03-21 RobArt GmbH Exploration einer unbekannten umgebung durch einen autonomen mobilen roboter
CN110412619A (zh) 2019-08-12 2019-11-05 珠海市一微半导体有限公司 激光机器人的区域遍历方法和激光主控芯片

Also Published As

Publication number Publication date
KR20220075410A (ko) 2022-06-08
JP2023501569A (ja) 2023-01-18
CN111830970A (zh) 2020-10-27
WO2021248846A1 (zh) 2021-12-16
EP4043988A1 (en) 2022-08-17
EP4043988A4 (en) 2023-05-31
CN111830970B (zh) 2022-03-04

Similar Documents

Publication Publication Date Title
JP7336118B2 (ja) ロボットがエッジに沿って走行する領域清掃計画方法、チップおよびロボット
CN111857127B (zh) 一种机器人沿边行走的清洁分区规划方法、芯片及机器人
CN106527423B (zh) 清洁机器人及其控制方法
JP7429933B2 (ja) レーザー地図に基づく作業領域の拡張方法、チップおよびロボット
CN111949017B (zh) 一种机器人越障的沿边路径规划方法、芯片及机器人
CN113190010B (zh) 一种沿边绕障路径规划方法、芯片及机器人
CN111158353A (zh) 用于多个机器人的移动控制方法以及其系统
CN113156956A (zh) 机器人的导航方法、芯片及机器人
JP4093261B2 (ja) 自律移動装置
CN113110497A (zh) 基于导航路径的沿边绕障路径选择方法、芯片及机器人
CN114995458A (zh) 清洁机器人全覆盖实时路径规划方法及装置
CN111240322B (zh) 机器人移动限制框的工作起点确定方法及运动控制方法
CN114652217B (zh) 控制方法、清洁机器人和存储介质
CN116149314A (zh) 机器人全覆盖作业方法、装置及机器人
CN113110473B (zh) 基于连通性的区域判定方法、芯片及机器人
CN117193277A (zh) 基于地图区域轮廓的设置方法与机器人沿边结束控制方法
US20240160227A1 (en) Area cleaning planning method for robot walking along boundary, chip and robot
CN112815945A (zh) 增大角落清洁面积的无人洗地机路径规划方法及系统
WO2024037262A1 (zh) 一种机器人通过窄道的导航方法、芯片及机器人
CN116466695A (zh) 一种最优障碍物碰撞点搜索方法
CN116465404A (zh) 基于预设探测距离范围内的最优碰撞点搜索方法
CN116466694A (zh) 基于激光点的最优碰撞点搜索方法、芯片及机器人
CN116449816A (zh) 一种搜寻充电座信号的运动控制方法、芯片及机器人
CN116540689A (zh) 一种机器人的沿边控制方法、芯片及机器人
CN115444326A (zh) 地面介质探索方法、清洁机器人及存储介质

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220512

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230214

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230419

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: 20230725

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230810

R150 Certificate of patent or registration of utility model

Ref document number: 7336118

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150