JP2023508435A - 障害物回避終了の判断方法、障害物回避制御方法、チップ及びロボット - Google Patents
障害物回避終了の判断方法、障害物回避制御方法、チップ及びロボット Download PDFInfo
- Publication number
- JP2023508435A JP2023508435A JP2022539273A JP2022539273A JP2023508435A JP 2023508435 A JP2023508435 A JP 2023508435A JP 2022539273 A JP2022539273 A JP 2022539273A JP 2022539273 A JP2022539273 A JP 2022539273A JP 2023508435 A JP2023508435 A JP 2023508435A
- Authority
- JP
- Japan
- Prior art keywords
- edge
- robot
- along
- point
- obstacle
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 158
- 230000008569 process Effects 0.000 claims description 60
- 230000033001 locomotion Effects 0.000 claims description 38
- 238000004364 calculation method Methods 0.000 claims description 13
- 230000008859 change Effects 0.000 claims description 13
- 230000009471 action Effects 0.000 claims description 11
- 230000001960 triggered effect Effects 0.000 claims description 4
- 238000001514 detection method Methods 0.000 description 5
- 238000007688 edging Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 230000002250 progressing effect Effects 0.000 description 3
- 230000002159 abnormal effect Effects 0.000 description 2
- 230000003213 activating effect Effects 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 239000000470 constituent Substances 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 230000001976 improved effect Effects 0.000 description 1
- 230000000977 initiatory effect Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000001902 propagating effect Effects 0.000 description 1
- 238000010187 selection method Methods 0.000 description 1
- 230000008093 supporting effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- 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/0227—Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Artificial Intelligence (AREA)
- Software Systems (AREA)
- Mathematical Physics (AREA)
- Fuzzy Systems (AREA)
- Evolutionary Computation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
Claims (28)
- ロボットが予め計画された最速縁沿い予測経路に従って縁沿い走行をする場合、予め設定されたナビゲーション経路から案内条件を満たす第2の所定方向転換点集合を選択するステップであって、ナビゲーション経路は、ロボットがナビゲーションを起動する前に設定される経路であり、最速縁沿い予測経路は、ロボットがナビゲーション中に障害物への衝突により計画して選択する経路であるステップと、
案内条件を満たす第2の所定方向転換点集合から1つの最適な方向転換点を取得するステップであって、当該最適な方向転換点は、案内条件を満たす第2の所定方向転換点集合の全ての方向転換点のうちの、ロボットの現在位置との距離が障害物回避判定閾値に最も近い方向転換点であるステップと、
当該最適な方向転換点とロボットの現在位置とを結ぶ線分に障害物がマークされているか否かを判断し、そうであれば、ロボット現在の障害物回避が終了していないと決定し、そうでなければ、ロボット現在の障害物回避が終了したと決定するステップとを含む、ことを特徴とするロボットの障害物回避終了の判断方法。 - 案内条件を満たす第2の所定方向転換点集合から1つの最適な方向転換点を取得し、当該最適な方向転換点は、案内条件を満たす第2の所定方向転換点集合の全ての方向転換点のうちの、ロボットの現在位置との距離が障害物回避判定閾値に最も近い方向転換点である前記方法は、
障害物回避判定閾値を予め設定するステップと、
案内条件を満たす第2の所定方向転換点集合のうちの各方向転換点とロボットの現在位置との距離をそれぞれ算出し、次に、これらの距離から障害物回避判定閾値をそれぞれ減算して、対応する差の絶対値を取得するステップと、
案内条件を満たす第2の所定方向転換点集合のうちの各方向転換点とロボットの現在位置との距離と、障害物回避判定閾値との差の絶対値を比較することにより、差の絶対値が最も小さいものが対応する方向転換点を前記最適な方向転換点として選択するステップであって、当該最適な方向転換点は、案内条件を満たす第2の所定方向転換点集合の全ての方向転換点のうちの、ロボットの現在位置との距離が障害物回避判定閾値に最も近い方向転換点であるステップとを含む、ことを特徴とする請求項1に記載の障害物回避終了の判断方法。 - 当該最適な方向転換点とロボットの現在位置とを結ぶ線分に障害物がマークされているか否かを判断し、そうであれば、ロボット現在の障害物回避が終了していないと決定し、そうでなければ、ロボット現在の障害物回避が終了したと決定する前記方法は、
ロボットの現在位置と前記最適な方向転換点とを結ぶ線分において、当該線分が通過するグリッド座標には、グリッドマップに予めマークされた障害物点の座標と同じグリッド座標があるか否かを1つずつ判断し、そうであれば、ロボットの現在位置と最適な方向転換点とを結ぶ線分に障害物があると決定し、さらにロボット現在の障害物回避が終了していないと決定し、そうでなければ、ロボットの現在位置と最適な方向転換点とを結ぶ線分に障害物がないと決定し、さらにロボット現在の障害物回避が終了したと決定するステップを含む、ことを特徴とする請求項2に記載の障害物回避終了の判断方法。 - ロボットが予め計画された最速縁沿い予測経路に従って縁沿い走行をする過程で、所定縁沿い時間内にロボットの縁沿い回転角度及び縁沿い走行距離が、対応する限定条件を満たすか否かを判断し、そうであれば、ロボットが同じ位置に閉じ込められていないと決定し、さらにロボット現在の障害物回避が終了していないと決定し、そうでなければ、ロボットが同じ位置に閉じ込められたと決定し、さらにロボット現在の障害物回避が終了したと決定するステップをさらに含む、ことを特徴とする請求項1又は3に記載の障害物回避終了の判断方法。
- 所定縁沿い時間内にロボットの縁沿い回転角度及び縁沿い走行距離が、対応する限定条件を満たすか否かを判断し、そうであれば、ロボットが同じ位置に閉じ込められていないと決定し、そうでなければ、ロボットが同じ位置に閉じ込められたと決定する前記方法は、具体的には、
ロボットの縁沿い走行時間を計時して前記所定縁沿い時間に達すると、ロボットの縁沿い回転角度が所定最大回転角度以下であると判断し、ロボットの縁沿い走行距離が所定最大縁沿い距離以下であると判断する場合、ロボットが同じ位置に閉じ込められていないと決定し、さらにロボット現在の障害物回避が終了していないと決定するステップと、
ロボットの縁沿い走行時間を計時して前記所定縁沿い時間以上となると、ロボットの縁沿い回転角度が所定最大回転角より大きいと判断するか、又はロボットの縁沿い走行距離が所定最大縁沿い距離より大きいと判断する場合、ロボットが同じ位置に閉じ込められたと決定し、さらにロボット現在の障害物回避が終了したと決定するステップとを含み、
ロボットの縁沿い回転角度は、ロボットがタイミングで読み取ったジャイロスコープの角度増分を加算した結果である、ことを特徴とする請求項4に記載の障害物回避終了の判断方法。 - 前記最速縁沿い予測経路の計画方法は、
まず、ロボットの障害物回避に用いられる縁沿い予測経路を計画し、予め設定されたナビゲーション経路から案内条件を満たす第1の所定方向転換点集合を選択するステップであって、ロボットには、方向転換点で結ばれたナビゲーション経路が予め設定され、これらの方向転換点は、ロボットが最終的なナビゲーション目標点に移動するように案内し、縁沿い予測経路は、縁沿い方向が逆である2つの縁沿い予測経路を含むステップと、
次に、各縁沿い予測経路上の全ての縁沿い動作点と、同じナビゲーション経路上の案内条件を満たす第1の所定方向転換点集合に含まれる方向転換点との距離情報に基づいて、当該ナビゲーション経路に対する外れ度合いが最も小さい縁沿い予測経路を、前記最速縁沿い予測経路として選択するステップとを含む、ことを特徴とする請求項5に記載の障害物回避終了の判断方法。 - 各縁沿い予測経路上の全ての縁沿い動作点と、同じナビゲーション経路上の案内条件を満たす第1の所定方向転換点集合に含まれる方向転換点との距離情報に基づいて、当該ナビゲーション経路に対する外れ度合いが最も小さい縁沿い予測経路を選択することにより、ロボットが障害物に衝突した後、選択された当該縁沿い予測経路の縁沿い方向に走行して障害物回避を実現する前記方法は、
前記縁沿い予測経路は、左側の縁沿い予測経路及び右側の縁沿い予測経路を含み、左側の縁沿い予測経路の縁沿い方向と右側の縁沿い予測経路の縁沿い方向とは逆であり、
前記ナビゲーション経路上の案内条件を満たす第1の所定方向転換点集合に含まれる方向転換点から左側の縁沿い予測経路上の同じ縁沿い動作点までの距離を算出し、さらに、これらの距離を加算することにより、1つの縁沿い動作点の、案内条件を満たす第1の所定方向転換点集合に対する左側局所距離の和を取得し、次に、前述の算出ステップを繰り返すことにより、左側の縁沿い予測経路上の各縁沿い動作点の、案内条件を満たす第1の所定方向転換点集合に対する左側局所距離の和を取得し、さらに、これらの左側局所距離の和を加算することにより、左側の縁沿い予測経路の、案内条件を満たす第1の所定方向転換点集合に対する左側距離の総和を取得して、左側の縁沿い予測経路の前記ナビゲーション経路に対する外れ度合いを示すステップと、
同時に、前記ナビゲーション経路上の案内条件を満たす第1の所定方向転換点集合に含まれる方向転換点から右側の縁沿い予測経路上の同じ縁沿い動作点までの距離を算出し、さらに、これらの距離を加算することにより、1つの縁沿い動作点の、案内条件を満たす第1の所定方向転換点集合に対する右側局所距離の和を取得し、次に、前述の算出ステップを繰り返すことにより、右側の縁沿い予測経路上の各縁沿い動作点の、案内条件を満たす第1の所定方向転換点集合に対する右側局所距離の和を取得し、さらに、これらの右側局所距離の和を加算することにより、右側の縁沿い予測経路の、案内条件を満たす第1の所定方向転換点集合に対する右側距離の総和を取得して、右側の縁沿い予測経路の前記ナビゲーション経路に対する外れ度合いを示すステップと、
左側距離の総和が右側距離の総和より大きい場合、右側の縁沿い予測経路が前記ナビゲーション経路に対する外れ度合いが最も小さい縁沿い予測経路であると決定し、右側の縁沿い予測経路を前記最速縁沿い予測経路として選択するステップと、
右側距離の総和が左側距離の総和より大きい場合、左側の縁沿い予測経路が前記ナビゲーション経路に対する外れ度合いが最も小さい縁沿い予測経路であると決定し、左側の縁沿い予測経路を前記最速縁沿い予測経路として選択するステップとを含み、
右側距離の総和が小さいほど、右側の縁沿い予測経路の前記ナビゲーション経路に対する外れ度合いが小さくなり、左側距離の総和が小さいほど、左側の縁沿い予測経路の前記ナビゲーション経路に対する外れ度合いが小さくなる、
ことを特徴とする請求項6に記載の障害物回避終了の判断方法。 - 現在計画された前記最速縁沿い予測経路に従って走行する前に、
所定時間内にロボットが位置する座標位置の変化量が距離安定閾値より大きいか否かを判断し、そうであれば、ロボットの障害物回避に用いられる縁沿い方向が逆である2つの縁沿い予測経路を計画するようにロボットを制御し、そうでなければ、ロボットが縁沿い方向を変更して、現在決定された縁沿い方向と逆の方向に沿って走行するように制御するステップをさらに含み、現在決定された縁沿い方向は、ロボットの電源投入時に予め設定された縁沿い方向と、前回選択された前記ナビゲーション経路に対する外れ度合いが最も小さい縁沿い予測経路の縁沿い方向とを含み、
ロボットの障害物回避に用いられる縁沿い方向が逆である2つの縁沿い予測経路を計画できないと判断する場合、現在決定された縁沿い方向と逆の方向に沿って走行するようにロボットを制御し、
距離安定閾値は、ロボットの本体直径の大きさに設定される、ことを特徴とする請求項7に記載の障害物回避終了の判断方法。 - ロボットが計画された前記最速縁沿い予測経路を走行していない場合、予め設定されたナビゲーション経路から案内条件を満たす第1の所定方向転換点集合を選択し、
ロボットが計画された最速縁沿い予測経路で縁沿い走行をする場合、予め設定されたナビゲーション経路から案内条件を満たす第2の所定方向転換点集合を選択し、
第1の所定方向転換点集合と第2の所定方向転換点集合は、いずれも前記ナビゲーション経路上の前記案内条件を満たす方向転換点で構成される、ことを特徴とする請求項6又は8に記載の障害物回避終了の判断方法。 - 前記案内条件は、具体的には、
まず、前記ナビゲーション経路から1つの目標方向転換点を選択し、次に、当該目標方向転換点及び当該目標方向転換点から前記ナビゲーション経路のナビゲーション進行方向に沿って順に設定された1つ又は2つの方向転換点には、前記最終的なナビゲーション目標点があるか否かをそれぞれ判断することにより、案内条件を満たす第1の所定方向転換点集合又は案内条件を満たす第2の所定方向転換点集合を選択することであり、
前記ナビゲーション経路のナビゲーション進行方向は、ロボットが前記最終的なナビゲーション目標点に移動するように案内するロボットナビゲーション方向であり、前記最終的なナビゲーション目標点も前記ナビゲーション経路の終点であり、かつ前記ナビゲーション経路のうちの1つの方向転換点に属する、ことを特徴とする請求項9に記載の障害物回避終了の判断方法。 - 前記目標方向転換点から前記ナビゲーション経路のナビゲーション進行方向に沿って順に設定された2つの方向転換点がいずれも前記最終的なナビゲーション目標点ではないと判断する場合、案内条件を満たす第1の所定方向転換点集合又は案内条件を満たす第2の所定方向転換点集合には、前記目標方向転換点、及び前記ナビゲーション経路において当該目標方向転換点から前記ナビゲーション経路のナビゲーション進行方向に沿って順に設定された2つの方向転換点が含まれると決定し、
前記目標方向転換点から前記ナビゲーション経路のナビゲーション進行方向に沿って順に設定された第1の方向転換点又は第2の方向転換点が前記最終的なナビゲーション目標点であると判断する場合、案内条件を満たす第1の所定方向転換点集合又は案内条件を満たす第2の所定方向転換点集合には、前記ナビゲーション経路において前記目標方向転換点から前記ナビゲーション経路のナビゲーション進行方向に沿って前記最終的なナビゲーション目標点まで配列された全ての方向転換点が含まれると決定し、前記目標方向転換点及び前記最終的なナビゲーション目標点も含まれ、第1の方向転換点は、前記ナビゲーション経路のナビゲーション進行方向において前記目標方向転換点に隣接して設定され、第2の方向転換点は、前記ナビゲーション経路のナビゲーション進行方向において第1の方向転換点に隣接して設定され、
前記ナビゲーション経路から選択された目標方向転換点が前記最終的なナビゲーション目標点であると判断する場合、案内条件を満たす第1の所定方向転換点集合又は案内条件を満たす第2の所定方向転換点集合には、前記最終的なナビゲーション目標点のみが含まれると決定する、ことを特徴とする請求項10に記載の障害物回避終了の判断方法。 - 予め設定されたナビゲーション経路から目標方向転換点を選択する具体的な方法は、
ロボットの現在位置を中心とし、かつロボットの現在位置との最大距離が第1の所定距離閾値であるグリッド座標で構成された方向転換点比較領域を設定するステップであって、予め設定されたナビゲーション経路から案内条件を満たす第1の所定方向転換点集合を選択する場合、ロボットの現在位置が計画された最速縁沿い予測経路に位置せず、予め設定されたナビゲーション経路から案内条件を満たす第2の所定方向転換点集合を選択する場合、ロボットの現在位置が計画された最速縁沿い予測経路に位置するステップと、
当該方向転換点比較領域に1つの前記方向転換点のみがある場合、当該前記方向転換点を前記目標方向転換点として選択するステップと、
当該方向転換点比較領域に2つ以上の前記方向転換点がある場合、ロボットの現在位置との距離が第1の所定距離閾値より小さい方向転換点から、前記ナビゲーション経路のナビゲーション進行方向に前記最終的なナビゲーション目標点に最も近い方向転換点を前記目標方向転換点として選択するステップと、
当該方向転換点比較領域に前記方向転換点がない場合、前記ナビゲーション経路のナビゲーション進行方向に沿って、前記ナビゲーション経路からロボットが新たにマークした目標方向転換点に隣接する方向転換点を、新たな目標方向転換点として選択するステップとを含み、
ロボットの現在位置と、ある前記方向転換点との距離が第2の所定距離閾値より小さい場合、ロボットの現在位置が当該前記方向転換点と重なると決定し、第2の所定距離閾値が第1の所定距離閾値より小さい、ことを特徴とする請求項11に記載の障害物回避終了の判断方法。 - 前記ナビゲーション経路は、規則的に分布する1組の方向転換点で結ばれてなり、前記ナビゲーション経路において、前記ナビゲーション経路のナビゲーション進行方向に沿って設定された方向転換点の計画番号が順次増加し、
前記第1の所定方向転換点集合又は前記第2の所定方向転換点集合に含まれる方向転換点の計画番号が順次増加し、対応する方向転換点集合のうちの前記目標方向転換点の計画番号より小さい方向転換点をロボットがトラバースした方向転換点とし、
前記最終的なナビゲーション目標点の計画番号が最も大きいため、前記ナビゲーション経路のナビゲーション進行方向において前記最終的なナビゲーション目標点に近い方向転換点ほど、対応する計画番号が大きい、ことを特徴とする請求項12に記載の障害物回避終了の判断方法。 - 前記ロボットの障害物回避に用いられる縁沿い予測経路の計画方法は、
ロボットが現在、障害物に衝突した後、障害物情報が予めマークされたグリッドマップに衝突点をマークするステップ1と、
現在マークされた衝突点の隣接領域から縁沿い障害物回避条件を満たすグリッドを選択し、選択されたグリッドを、ロボットが障害物の縁に沿って走行する縁沿い動作点としてマークすることにより、これらの縁沿い動作点が前記ロボットの障害物回避に用いられる縁沿い方向が逆である2つの縁沿い予測経路を構成するステップ2を含む、ことを特徴とする請求項8に記載の障害物回避終了の判断方法。 - 前記ステップ2の具体的な方法は、
現在マークされた衝突点との距離関係が、最近距離条件を満たす障害物点を検索するステップ21と、
ステップ21で検索された障害物点の隣接領域から事前縁沿い条件を満たすグリッドを検索するステップ22と、
事前縁沿い条件を満たすグリッドの数が第2の所定グリッド数に達すると統計する場合、事前縁沿い条件を満たすこれらのグリッドから前記最適な縁沿い条件を満たすグリッドを選択して、同様に前記縁沿い障害物回避条件を満たすグリッドとするステップ23と、
ステップ23で選択された前記最適な縁沿い条件を満たすグリッドを新たな衝突点としてマークし、ロボットが障害物の縁に沿って走行する、対応する縁沿い予測経路に新たに計画された縁沿い動作点として追加し、同時に当該新たな衝突点を現在マークされた衝突点として更新し、さらに、所定障害物回避グリッド数の縁沿い動作点をマークするまで、ステップ21に戻って実行するステップ24とを含み、
ステップ21で最近距離条件を満たす障害物点を検索できない場合、前記縁沿い予測経路を計画できないと決定し、或いは、ステップ22で事前縁沿い条件を満たすグリッドを検索できない場合、前記縁沿い予測経路を計画できないと決定する、ことを特徴とする請求項14に記載の障害物回避終了の判断方法。 - 前記ステップ23では、前記最適な縁沿い条件を満たすグリッドは、
前記事前縁沿い条件を満たすグリッドから選択されたロボットの中心位置との結線が障害物の縁に最も近いグリッドを含み、ロボットの中心位置は、前記縁沿い予測経路を計画する過程で変化しない、ことを特徴とする請求項15に記載の障害物回避終了の判断方法。 - 前記ステップ23は、具体的には、
前記事前縁沿い条件を満たすグリッドの統計数が第2の所定グリッド数に達する場合、前記事前縁沿い条件を満たすこれらのグリッドとロボットの中心位置との相対的な位置関係に基づいて、これらのグリッドからロボットの中心位置との結線が障害物の縁に最も近いグリッドを選択することにより、前記縁沿い障害物回避条件を満たすステップを含む、ことを特徴とする請求項16に記載の障害物回避終了の判断方法。 - 前記事前縁沿い条件を満たすグリッドとロボットの中心位置との相対的な位置関係の算出方法は、
ロボットの中心位置を原点とし、ロボットの本体の右側方向をX軸正方向とし、ロボットの現在の進行方向をY軸正方向とし、ロボット座標系を設定するステップと、
ロボット座標系において、前記最適な縁沿い条件を満たす前記各グリッドの、ロボット座標系の原点に対する座標値及び角度値をそれぞれ算出するステップとを含む、ことを特徴とする請求項17に記載の障害物回避終了の判断方法。 - 前記衝突点は、前衝突点、左衝突点及び右衝突点を含み、
ロボットの本体の左前部には、ロボットの進行方向の左側に衝突した障害物を検出し、ロボットが障害物の縁に沿って反時計回り方向に縁沿い走行をする場合に本体の左側に衝突した障害物を検出し、対応する方向の障害物との衝突点を左衝突点としてマークする左側衝突検出器が設置され、
ロボットの本体の右前部には、ロボットの進行方向の右側に衝突した障害物を検出し、ロボットが障害物の縁に沿って時計回り方向に縁沿い走行をする場合に本体の右側に衝突した障害物を検出し、対応する方向の障害物との衝突点を右衝突点としてマークする右側衝突検出器が設置され、
左側衝突検出器及び右側衝突検出器は、ロボットの本体の左右両側に対称的に設置され、ロボットの正面が障害物に衝突した場合、左側衝突検出器及び右側衝突検出器が同時にトリガされて検出を行い、対応する方向の障害物との衝突点を前衝突点としてマークすることにより、ロボットが同じ位置でマークした前衝突点、左衝突点及び右衝突点は、いずれもロボットの正面に衝突した障害物の輪郭線の接線に位置し、障害物の輪郭線は、グリッドマップにマークして形成される、ことを特徴とする請求項18に記載の障害物回避終了の判断方法。 - 前記事前縁沿い条件を満たすこれらのグリッドとロボットの中心位置との相対的な位置関係に基づいて、これらのグリッドからロボットの中心位置との結線が障害物の縁に最も近いグリッドを選択する前記方法は、
前記ステップ1で現在マークされた衝突点が前記左衝突点である場合、ロボットの現在位置に対して障害物の縁に沿って反時計回りに分布し、かつ前記ロボットの現在位置に対する角度値が最も大きい前記事前縁沿い条件を満たすグリッドを、前記最適な縁沿い条件を満たすグリッドとして選択することにより、前記最適な縁沿い条件を満たすグリッドを前記右側の縁沿い予測経路に結び、さらに、ロボットの基準縁沿い方向が反時計回り方向であると決定するステップと、
前記ステップ1で現在マークされた衝突点が前記右衝突点である場合、ロボットの現在位置に対して障害物の縁に沿って時計回りに分布し、かつ前記ロボットの現在位置に対する角度値が最も小さい前記事前縁沿い条件を満たすグリッドを、前記最適な縁沿い条件を満たすグリッドとして選択することにより、前記最適な縁沿い条件を満たすグリッドを前記左側の縁沿い予測経路に結び、さらに、ロボットの基準縁沿い方向が時計回り方向であると決定するステップとを含む、ことを特徴とする請求項19に記載の障害物回避終了の判断方法。 - 前記ステップ21では、前記最近距離条件を満たす障害物点は、第1の所定検索領域内で検索された、前記ステップ1で現在マークされた衝突点に最も近く、かつ衝突点としてマークされていない障害物点を含み、第1の所定検索領域は、前記ステップ1で現在マークされた衝突点を中心として設定された、前記ステップ1で現在マークされた衝突点との最大距離が第1の所定グリッド数であるグリッド領域であり、
前記ステップ24を実行しない前に、前記ステップ1で現在マークされた衝突点は、ロボットが前記ステップ1を実行することにより、障害物点が予めマークされたグリッドマップにマークされた第1の衝突点であり、
前記ステップ24を実行した後、前記ステップ1で現在マークされた衝突点は、ロボットが新たに実行した前記ステップ24でマークされた新たな衝突点である、ことを特徴とする請求項16又は20に記載の障害物回避終了の判断方法。 - 前記ステップ22と前記ステップ23を実行する間に、
前記事前縁沿い条件を満たすグリッドを統計するたびに、前記事前縁沿い条件を満たす当該グリッドとロボットの中心位置との相対的な位置関係を算出するステップをさらに含む、ことを特徴とする請求項21に記載の障害物回避終了の判断方法。 - 前記ステップ22では、前記事前縁沿い条件を満たすグリッドは、
前記ステップ21で検索された障害物点の隣接領域の8つのグリッドから選択された、前記障害物点及び前記ステップ24で計画された縁沿い動作点以外のロボットがトラバースしてマークしたグリッドを含む、ことを特徴とする請求項22に記載の障害物回避終了の判断方法。 - 請求項1~23のいずれか一項に記載の障害物回避終了の判断方法を実行するようにロボットを制御するステップと、
ロボット現在の障害物回避が終了したと決定する場合、ロボットが予め選択された最速縁沿い予測経路に従って縁沿い走行をすることを停止するように制御して障害物回避を終了するステップと、
ロボット現在の障害物回避が終了していないと決定する場合、ロボットが予め選択された最速縁沿い予測経路に従って縁沿い走行をするように制御し、同時に前記障害物回避終了の判断方法を実行し続けるステップとを含む、ことを特徴とするロボットの障害物回避制御方法。 - ロボットが予め選択された最速縁沿い予測経路に従って縁沿い走行をすることを停止した後、ロボットが予め設定されたナビゲーション経路に従って走行するように制御し、ロボットが障害物に衝突したことを検出した後、前記最速縁沿い予測経路を計画し、次に前記障害物回避終了の判断方法に戻って実行し、ロボットが前記最終的なナビゲーション目標点に移動するまで、これを繰り返すステップをさらに含む、ことを特徴とする請求項24に記載のロボットの障害物回避制御方法。
- ロボットが予め計画された最速縁沿い予測経路に従って縁沿い走行をする過程で、所定縁沿い時間内にロボットの縁沿い回転角度及び縁沿い走行距離が、対応する限定条件を満たすと判断する場合、ロボットが前記最速縁沿い予測経路に従って縁沿い走行をし続けるように制御し、そうでなければ、ロボットが予め選択された最速縁沿い予測経路に従って縁沿い走行をすることを停止するように制御して障害物回避を終了する、ことを特徴とする請求項25に記載のロボットの障害物回避制御方法。
- プログラムコードが記憶されているチップであって、該プログラムコードは、チップにより実行される場合に請求項1~23のいずれか一項に記載の障害物回避終了の判断方法を実現するか、又は請求項24~26のいずれか一項に記載の障害物回避制御方法を実現する、ことを特徴とするチップ。
- ロボットであって、該ロボットの本体の左前部には、ロボットの進行方向の左側に衝突した障害物を検出し、ロボットが障害物の縁に沿って反時計回り方向に縁沿い走行をする場合に本体の左側に衝突した障害物を検出する左側衝突検出器が設置され、
該ロボットの本体の右前部には、ロボットの進行方向の右側に衝突した障害物を検出し、ロボットが障害物の縁に沿って時計回り方向に縁沿い走行をする場合に本体の右側に衝突した障害物を検出する右側衝突検出器が設置され、
請求項27に記載のチップが設置され、前記チップは、それぞれ左側衝突検出器及び右側衝突検出器に接続され、ロボットは、請求項24~26のいずれか一項に記載の障害物回避制御方法を実行するように構成される、ことを特徴とするロボット。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010614372.9 | 2020-06-30 | ||
CN202010614372.9A CN111906779B (zh) | 2020-06-30 | 2020-06-30 | 一种越障结束判断方法、越障控制方法、芯片及机器人 |
PCT/CN2020/131189 WO2022000960A1 (zh) | 2020-06-30 | 2020-11-24 | 一种越障结束判断方法、越障控制方法、芯片及机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2023508435A true JP2023508435A (ja) | 2023-03-02 |
Family
ID=73227009
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2022539273A Pending JP2023508435A (ja) | 2020-06-30 | 2020-11-24 | 障害物回避終了の判断方法、障害物回避制御方法、チップ及びロボット |
Country Status (6)
Country | Link |
---|---|
US (1) | US20230152809A1 (ja) |
EP (1) | EP4068037B1 (ja) |
JP (1) | JP2023508435A (ja) |
KR (1) | KR20220124199A (ja) |
CN (1) | CN111906779B (ja) |
WO (1) | WO2022000960A1 (ja) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111906779B (zh) * | 2020-06-30 | 2022-05-10 | 珠海一微半导体股份有限公司 | 一种越障结束判断方法、越障控制方法、芯片及机器人 |
CN114185356B (zh) * | 2022-02-16 | 2022-05-31 | 莱陆科技(天津)有限公司 | 智能识别障碍物并控制机器人通过障碍物的方法及装置 |
CN114495514A (zh) * | 2022-02-16 | 2022-05-13 | 中南大学 | 一种多源数据协同的车辆违规掉头热点区域识别方法 |
WO2023155159A1 (en) * | 2022-02-18 | 2023-08-24 | Beijing Smorobot Technology Co., Ltd | Wall collision u-turning method and apparatus for swimming pool cleaning robot, and swimming pool edge cleaning method and apparatus |
CN116774686A (zh) * | 2022-03-10 | 2023-09-19 | 苏州科瓴精密机械科技有限公司 | 机器人寻路方法、寻路装置、设备和计算机可读存储介质 |
CN115373406B (zh) * | 2022-10-24 | 2023-01-20 | 深圳市捷牛智能装备有限公司 | 一种爬行机器人越障方法及系统 |
CN115540892B (zh) * | 2022-11-28 | 2023-03-24 | 北京理工大学深圳汽车研究院(电动车辆国家工程实验室深圳研究院) | 一种固定线路车辆绕障终点选择方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004042148A (ja) * | 2002-07-09 | 2004-02-12 | Mitsubishi Heavy Ind Ltd | 移動ロボット |
JP2007179394A (ja) * | 2005-12-28 | 2007-07-12 | Funai Electric Co Ltd | 自走式掃除機 |
JP2007272677A (ja) * | 2006-03-31 | 2007-10-18 | Sharp Corp | 自走装置およびその制御方法 |
JP2011034518A (ja) * | 2009-08-05 | 2011-02-17 | Ihi Corp | 水中航走体の自律制御方法及び自律制御型水中航走体 |
JP2013257743A (ja) * | 2012-06-13 | 2013-12-26 | Sumitomo Heavy Ind Ltd | 移動体 |
US20170120448A1 (en) * | 2015-10-29 | 2017-05-04 | Korea Institute Of Science And Technology | Robot control system and method for planning driving path of robot |
JP2017151687A (ja) * | 2016-02-24 | 2017-08-31 | 本田技研工業株式会社 | 移動体の経路計画生成装置 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106527423B (zh) * | 2015-09-15 | 2020-01-21 | 小米科技有限责任公司 | 清洁机器人及其控制方法 |
CN106324619A (zh) * | 2016-10-28 | 2017-01-11 | 武汉大学 | 一种变电站巡检机器人自动避障方法 |
CN107677285B (zh) * | 2017-04-11 | 2019-05-28 | 平安科技(深圳)有限公司 | 机器人的路径规划系统及方法 |
CN107065872B (zh) * | 2017-04-11 | 2020-06-05 | 珠海市一微半导体有限公司 | 智能机器人的栅格地图创建方法 |
CN107560620B (zh) * | 2017-08-31 | 2019-12-20 | 珠海市一微半导体有限公司 | 一种路径导航方法和芯片及机器人 |
US10606269B2 (en) * | 2017-12-19 | 2020-03-31 | X Development Llc | Semantic obstacle recognition for path planning |
CN109443363B (zh) * | 2018-11-09 | 2020-10-16 | 厦门大学 | 分治确定性路径寻优算法 |
CN111273647A (zh) * | 2018-11-19 | 2020-06-12 | 苏州宝时得电动工具有限公司 | 自动行走设备及其控制方法 |
CN109827592A (zh) * | 2019-03-04 | 2019-05-31 | 广东乐生智能科技有限公司 | 一种扫地机器人被困的检测方法 |
CN109864666A (zh) * | 2019-03-04 | 2019-06-11 | 广东乐生智能科技有限公司 | 清洁机器人被困的判断方法 |
CN109871021B (zh) * | 2019-03-18 | 2022-04-15 | 安徽大学 | 一种基于粒子群优化算法的机器人导航方法 |
CN110487279B (zh) * | 2019-08-27 | 2022-12-13 | 东南大学 | 一种基于改进a*算法的路径规划方法 |
CN110393482A (zh) * | 2019-09-03 | 2019-11-01 | 深圳飞科机器人有限公司 | 地图处理方法以及清洁机器人 |
CN111090282B (zh) * | 2019-12-19 | 2023-10-31 | 安克创新科技股份有限公司 | 机器人的避障方法、机器人以及装置 |
CN111906779B (zh) * | 2020-06-30 | 2022-05-10 | 珠海一微半导体股份有限公司 | 一种越障结束判断方法、越障控制方法、芯片及机器人 |
-
2020
- 2020-06-30 CN CN202010614372.9A patent/CN111906779B/zh active Active
- 2020-11-24 EP EP20943079.2A patent/EP4068037B1/en active Active
- 2020-11-24 KR KR1020227026213A patent/KR20220124199A/ko unknown
- 2020-11-24 US US17/783,660 patent/US20230152809A1/en active Pending
- 2020-11-24 JP JP2022539273A patent/JP2023508435A/ja active Pending
- 2020-11-24 WO PCT/CN2020/131189 patent/WO2022000960A1/zh unknown
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004042148A (ja) * | 2002-07-09 | 2004-02-12 | Mitsubishi Heavy Ind Ltd | 移動ロボット |
JP2007179394A (ja) * | 2005-12-28 | 2007-07-12 | Funai Electric Co Ltd | 自走式掃除機 |
JP2007272677A (ja) * | 2006-03-31 | 2007-10-18 | Sharp Corp | 自走装置およびその制御方法 |
JP2011034518A (ja) * | 2009-08-05 | 2011-02-17 | Ihi Corp | 水中航走体の自律制御方法及び自律制御型水中航走体 |
JP2013257743A (ja) * | 2012-06-13 | 2013-12-26 | Sumitomo Heavy Ind Ltd | 移動体 |
US20170120448A1 (en) * | 2015-10-29 | 2017-05-04 | Korea Institute Of Science And Technology | Robot control system and method for planning driving path of robot |
JP2017151687A (ja) * | 2016-02-24 | 2017-08-31 | 本田技研工業株式会社 | 移動体の経路計画生成装置 |
Also Published As
Publication number | Publication date |
---|---|
WO2022000960A1 (zh) | 2022-01-06 |
KR20220124199A (ko) | 2022-09-13 |
CN111906779A (zh) | 2020-11-10 |
CN111906779B (zh) | 2022-05-10 |
EP4068037A4 (en) | 2023-06-14 |
EP4068037B1 (en) | 2024-04-24 |
US20230152809A1 (en) | 2023-05-18 |
EP4068037A1 (en) | 2022-10-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2023508435A (ja) | 障害物回避終了の判断方法、障害物回避制御方法、チップ及びロボット | |
WO2022000961A1 (zh) | 一种机器人越障的沿边路径选择方法、芯片及机器人 | |
CN111949017B (zh) | 一种机器人越障的沿边路径规划方法、芯片及机器人 | |
JP7352318B2 (ja) | ロボット汎用の充電台帰還充電制御方法、チップ及びロボット | |
CN107390698B (zh) | 扫地机器人的补扫方法及芯片 | |
JP6947826B2 (ja) | インテリジェントロボットの経路計画方法 | |
JP7408072B2 (ja) | 密集した障害物に基づく清掃制御方法 | |
US7079943B2 (en) | Point-to-point path planning | |
JP5086942B2 (ja) | 経路探索装置、経路探索方法、及び経路探索プログラム | |
CN109984689A (zh) | 一种清洁机器人及清洁机器人的路径优化方法 | |
JP2020501282A5 (ja) | ||
CN113156956B (zh) | 机器人的导航方法、芯片及机器人 | |
CN113110497A (zh) | 基于导航路径的沿边绕障路径选择方法、芯片及机器人 | |
JPH05257533A (ja) | 移動ロボットの床面掃引方法及び装置 | |
CN107560620B (zh) | 一种路径导航方法和芯片及机器人 | |
CN113190010A (zh) | 一种沿边绕障路径规划方法、芯片及机器人 | |
CN111158353A (zh) | 用于多个机器人的移动控制方法以及其系统 | |
CN113110499B (zh) | 一种通行区域的判定方法、路线搜索方法、机器人及芯片 | |
Woosley et al. | Multirobot task allocation with real-time path planning | |
CN116149314A (zh) | 机器人全覆盖作业方法、装置及机器人 | |
CN113110473B (zh) | 基于连通性的区域判定方法、芯片及机器人 | |
JPWO2016009585A1 (ja) | 自律移動体とその制御方法 | |
JP6809913B2 (ja) | ロボット、ロボットの制御方法、および地図の生成方法 | |
WO2024037262A1 (zh) | 一种机器人通过窄道的导航方法、芯片及机器人 | |
CN117666547A (zh) | 一种机器人进入窄道的识别方法、芯片及机器人 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220624 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230626 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230704 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230921 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20240109 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240327 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20240423 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240430 |