JP6693291B2 - Mobile robot movement route planning method - Google Patents
Mobile robot movement route planning method Download PDFInfo
- Publication number
- JP6693291B2 JP6693291B2 JP2016121600A JP2016121600A JP6693291B2 JP 6693291 B2 JP6693291 B2 JP 6693291B2 JP 2016121600 A JP2016121600 A JP 2016121600A JP 2016121600 A JP2016121600 A JP 2016121600A JP 6693291 B2 JP6693291 B2 JP 6693291B2
- Authority
- JP
- Japan
- Prior art keywords
- mobile robot
- route
- circle
- unit
- conveyed object
- 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
Links
- 238000000034 method Methods 0.000 title description 33
- 238000010408 sweeping Methods 0.000 claims description 6
- 238000013507 mapping Methods 0.000 claims 1
- 230000036544 posture Effects 0.000 description 52
- 230000008569 process Effects 0.000 description 22
- 230000008859 change Effects 0.000 description 20
- 238000010586 diagram Methods 0.000 description 12
- 238000011156 evaluation Methods 0.000 description 5
- 238000012545 processing Methods 0.000 description 3
- 238000012795 verification Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本発明は、移動ロボットの移動経路計画方法に関する。 The present invention relates to a moving route planning method for a mobile robot.
目標地点まで自律的に移動する移動ロボットが知られている。移動ロボットは、環境地図を用いて目標地点までの経路を決定し、その経路に沿って移動する。例えば、特許文献1は、移動経路において障害物と衝突する可能性を評価する技術を開示する。 A mobile robot that autonomously moves to a target point is known. The mobile robot determines a route to the target point using the environment map and moves along the route. For example, Patent Literature 1 discloses a technique for evaluating the possibility of colliding with an obstacle on a moving route.
移動ロボットが搬送物を把持して目標地点まで移動しようとする場合に、搬送物も含めた外形形状を厳密に認識した上で障害物と接触しない移動経路を決定する手法は、膨大な演算を要し、円滑な移動を妨げる原因となっている。一方で、搬送物を把持した状態の移動ロボットの射影に外接する円を環境地図上で掃引して、障害物と接触しない移動経路を決定する手法は、演算量は少ないものの、障害物が多い環境下ではそもそも移動経路を見つけられないことがあった。 When a mobile robot grips a conveyed object and tries to move to a target point, the method of deciding the movement path that does not contact the obstacle after recognizing the outer shape including the conveyed object requires a large amount of calculation. In other words, it is a cause of hindering smooth movement. On the other hand, the method of sweeping the circle circumscribing the projection of the mobile robot holding the conveyed object on the environment map to determine the movement route that does not contact the obstacle has a small amount of calculation but many obstacles. In the environment, sometimes it was not possible to find a route to move.
本発明は、このような問題を解決するためになされたものであり、演算量を抑制しつつ、障害物と接触しない移動経路を探索して、自律移動のための移動経路を計画する技術を提供するものである。 The present invention has been made to solve such a problem, and provides a technique for planning a travel route for autonomous movement by searching a travel route that does not come into contact with an obstacle while suppressing the amount of calculation. Is provided.
本発明の一態様における移動経路計画方法は、可動する把持部と、環境地図を記憶した記憶部と、を有する移動ロボットであり、環境地図上を、搬送物を把持しない状態の移動ロボットの射影に外接する基準円を掃引することにより、環境地図上の目標地点までの経路を探索するステップを備え、把持部により搬送物を把持して目標地点までの移動経路を計画する移動経路計画方法であって、搬送物を把持した場合に把持部または搬送物が基準円からはみ出すか否かを判定し、はみ出す場合には、はみ出した把持部または搬送物を含む移動ロボットの射影に外接する判定円を作成するステップと、判定円を経路に沿って掃引した場合に、判定円が障害物に接触する接触地点の有無を判定し、接触地点を同定するステップと、接触地点が存在した場合に、把持部の姿勢および移動ロボットの姿勢の少なくともいずれかを変化させることにより障害物を回避する回避動作を策定するステップとを含む。
この構成により基準円または判定円で移動経路を確定できるのであれば、経路探索のための演算量も少なく、円滑な自律移動を実現できる。この場合は、移動中の姿勢変化も考慮しなくて良いので、走行制御も容易である。一方、判定円の掃引によっても移動経路を確定できない場合は、経路上の接触地点を同定し、搬送物を把持しつつ姿勢を変化させることで障害物との接触を回避するので、狭い幅の経路も通過させることができる。また、接触地点における姿勢変化は、移動ロボットの外形の実際的形状を用いて演算するので演算量は増大するが、実際的形状を用いて移動経路の全体を演算するよりは演算量が少なくすることができる。
A travel route planning method according to an aspect of the present invention is a mobile robot having a movable gripping unit and a storage unit that stores an environment map, and a projection of the mobile robot on the environment map in a state where a conveyed object is not gripped. It is equipped with the step of searching for the route to the target point on the environment map by sweeping the reference circle circumscribing to the Therefore, it is determined whether the gripping part or the conveyed object protrudes from the reference circle when the conveyed object is grasped, and if it protrudes, the judgment circle circumscribing the projection of the mobile robot including the protruding grasping part or the conveyed object. To determine whether there is a contact point where the judgment circle touches an obstacle when the judgment circle is swept along the path, and to identify the contact point. If, and a step of developing the avoidance operation to avoid the obstacle by at least changing one of the orientation of the orientation and mobile robot gripper.
With this configuration, if the movement route can be determined by the reference circle or the determination circle, the amount of calculation for route search is small and smooth autonomous movement can be realized. In this case, since it is not necessary to consider a change in posture during movement, traveling control is easy. On the other hand, if the movement path cannot be determined even by sweeping the judgment circle, the contact point on the path is identified and contact with obstacles is avoided by changing the posture while gripping the conveyed object. The route can also be passed. Further, the posture change at the contact point is calculated by using the actual shape of the outer shape of the mobile robot, so the amount of calculation is increased, but the amount of calculation is smaller than when the entire movement path is calculated using the actual shape. be able to.
本発明により、移動ロボットは、障害物の多い環境下であっても、障害物と接触しない移動経路を短時間で探索し、円滑に自律移動することができる。 According to the present invention, the mobile robot can smoothly search for a moving route that does not come into contact with obstacles in a short time even in an environment with many obstacles and smoothly move.
以下、発明の実施の形態を通じて本発明を説明するが、特許請求の範囲に係る発明を以下の実施形態に限定するものではない。また、実施形態で説明する構成の全てが課題を解決するための手段として必須であるとは限らない。 Hereinafter, the present invention will be described through embodiments of the invention, but the invention according to the claims is not limited to the following embodiments. In addition, not all of the configurations described in the embodiments are essential as means for solving the problem.
図1は、本実施形態にかかる移動ロボット100の外観斜視図である。移動ロボット100は、大きく分けて台車部110と把持部120によって構成される。
FIG. 1 is an external perspective view of a
台車部110は、主に、ベース111と、ベース111に取り付けられた2つの駆動輪112と1つのキャスター113とから構成される。2つの駆動輪112は、ベース111の対向する側方のそれぞれに、回転軸芯が一致するように配設されている。それぞれの駆動輪112は、不図示のモータによって独立して回転駆動される。キャスター113は、従動輪であり、ベース111から鉛直方向に延びる旋回軸が車輪の回転軸から離れて車輪を軸支するように設けられており、台車部110の移動方向に倣うように追従する。移動ロボット100は、例えば、2つの駆動輪112が同じ方向に同じ回転速度で回転されれば直進し、逆方向に同じ回転速度で回転されれば重心を通る鉛直軸周りに旋回する。すなわち、移動ロボット100は、2つの駆動輪112の回転方向、回転速度がそれぞれ制御されることにより、前進、後進、旋回することができる。
The
台車部110は、障害物検知や周辺環境認識のための各種センサが設けられている。カメラ114は、そのセンサ類の一つであり、ベース111の四隅に配置されている。カメラ114は、例えばCMOSイメージセンサを含み、撮影した画像信号を後述の制御部へ送信する。隣接する2つのカメラ114が同一の被写体を捉えれば視差画像を取得でき、当該被写体までの距離を算出することもできる。
The
把持部120は、主に、複数のアーム121、122、123と、ハンド124とから構成される。アーム121は、鉛直軸周りに回転自在に、一端がベース111に軸支されている。アーム122は、水平軸周りに回転自在に、一端がアーム121の他端に軸支されている。アーム123は、アーム122の他端で放射方向に回転自在に、一端がアーム122の他端に軸支されている。ハンド124は、アーム123の伸延方向と平行な中心軸周りに回転自在に、アーム123の他端に軸支されている。また、ハンド124は、搬送物を把持できるように、把持機構を備える。アーム121、122、123とハンド124は、不図示のモータを介して駆動され、所定の姿勢をとったり、搬送物を把持したりする。
The
図2は、移動ロボット100の制御ブロック図である。制御部200は、例えばCPUであり、台車部110に設けられている。駆動輪ユニット210は、駆動輪112を駆動するための駆動回路やモータを含み、台車部110に設けられている。制御部200は、駆動輪ユニット210へ駆動信号を送ることにより、駆動輪112の回転制御を実行する。
FIG. 2 is a control block diagram of the
アームユニット220は、アーム121、122、123およびハンド124を駆動するための駆動回路やモータを含み、把持部120に設けられている。制御部200は、アームユニット220へ駆動信号を送ることにより、把持部120の姿勢制御や把持制御を実行する。
The
センサユニット230は、周辺環境を探索したり把持部120の姿勢を監視したりする各種センサを含み、台車部110および把持部120に分散して配置されている。制御部200は、センサユニット230に制御信号を送ることにより、各種センサを駆動してその出力を取得する。カメラ114は、センサユニット230に含まれ、制御信号に従って撮影動作を実行する。
The
メモリ240は、不揮発性の記憶媒体であり、例えばソリッドステートドライブが用いられる。メモリ240は、移動ロボット100を制御するための制御プログラムの他にも、制御に用いられる様々なパラメータ値、関数、ルックアップテーブル等を記憶している。メモリ240は、移動ロボット100が自律走行する環境を表現する環境地図を格納した環境地図DB241を含む。
The
制御部200は、駆動輪ユニット210、アームユニット220、センサユニット230およびメモリ240との間で情報を送受信することにより、制御に関わる様々な演算を実行する機能演算部としての役割も担う。接触判定部201は、環境地図DB241から読み込んだ環境地図を用いて、移動ロボット100が自律走行した場合に障害物と接触するかを判定する。経路計画部202は、環境地図DB241から読み込んだ環境地図を用いて、移動ロボット100が自律走行するための経路を計画する。搬送物認識部203は、ハンド124が把持した搬送物をカメラ114で撮影し、その画像データを用いて搬送物の大きさや位置を認識する。姿勢計画部204は、移動経路の特定の箇所において、台車部110の向きや把持部120の姿勢をどのように変化させて走行させるかを計画する。それぞれの具体的な演算内容については、順に詳述する。
The
図3は、搬送物を把持しない場合における基準円501を説明する図である。基準円501は、図で網状に示した領域を取り囲む円である。具体的には、基準円501は、搬送物を把持しない状態の移動ロボット100の射影(鉛直方向から走行面に投射した影)に外接する円である。把持部120が射影の一部を形成する場合は、把持部120は、射影の全体ができる限り小さくなるような姿勢を取る。このように定義される基準円501の直径をR0と定める。R0は、移動ロボット100の構造によって定まる定数であるので、その値は予めメモリ240に記憶されている。
FIG. 3 is a diagram illustrating the
図4は、搬送物301を把持した場合の基準円501との関係を説明する図である。移動ロボット100が搬送する対象である搬送物301が比較的小さな場合は、把持部120の姿勢を工夫することにより、搬送物301を把持した状態でも、その射影は基準円501に収まる。このように、搬送物301を把持した状態の移動ロボット100の射影が基準円501に収まるのであれば、経路計画部202は、幅R0を基準に移動経路を探索できる。
FIG. 4 is a diagram illustrating a relationship with the
搬送物301を把持した状態の移動ロボット100の射影が基準円501に収まるか否かは、搬送物認識部203が搬送物の大きさや位置を認識した上で制御部200が判断する。搬送物認識部203が、ある把持状態の搬送物301について、その先端が基準円501によって形成される仮想的な円筒の内部に存在すると認識すれば、基準円501に収まると判断する。仮想的な円筒からはみ出ると認識した場合であっても、把持部120の姿勢を変化させて搬送物301の把持状態を変えれば円筒の内部に存在させることができるかを演算する。具体的には、搬送物301を円筒の内部の様々な位置に様々な姿勢で仮想的に配置し、その位置および姿勢の搬送物301を把持する把持部120の姿勢に解が存在するか逆運動学を用いて演算する。解が存在すれば、制御部200は、把持部120をその解に従った姿勢に変更する。
The
図5は、搬送物303を把持した場合における判定円502を説明する図である。搬送する対象物である搬送物303が比較的大きい場合は、把持部120の姿勢を工夫しても、搬送物303を把持した状態の射影は基準円501に収まらなくなる。この場合は、搬送物303を把持した状態における、搬送物303を含む移動ロボット100の射影に外接する判定円502を定義する。このとき、把持部120は、射影の全体ができる限り小さくなるような姿勢を取ることが好ましい。例えば、制御部200は、把持部120の姿勢を様々に変化させ、搬送物認識部203により搬送物303の先端位置を認識することにより、射影の全体ができる限り小さくなるような姿勢を見つけ出す。このように定義される判定円502の直径をR1と定める。R1は、搬送物認識部203の処理を経て決定される値である。経路計画部202は、幅R1を基準に移動経路を探索する。
FIG. 5 is a diagram illustrating the
次に、移動経路の探索について説明する。図6は、保持する環境地図の一例を示す図である。図示する環境地図601は、環境地図DB241に格納された環境地図の一つである。環境地図601は、実環境を所定の縮尺で平面に投影するように生成された地図であり、具体的には主に固定物の大きさや位置が把握できるように記述されている。図の例は、略正方形の部屋を表し、その周囲は壁621で囲まれている。入り口付近には解放された扉622が存在し、部屋の中央には机624が配置されている。また、机624を挟むように、ソファー625とテレビ台626が配置されている。このような環境において、制御部200は、入り口付近の始動地点611と、自律走行によって到達すべき目標地点612を定める。
Next, the search for the moving route will be described. FIG. 6 is a diagram showing an example of the environment map stored. The illustrated
図7は、基準円501に対する経路探索を説明する図である。図4を用いて説明したように、搬送物を把持しても射影が基準円501に収まると判断された場合には、経路計画部202は、幅R0を以て始動地点611から目標地点612まで移動経路を確立できるかを探索する。具体的には、環境地図601上で、始動地点611から目標地点612まで、直径R0の円を掃引することができるかを試みる。環境地図601の環境では、経路計画部202は、図7(a)に示すように、右側と奥側の2つの壁に沿う第1経路631と、図7(b)に示すように、机624とテレビ台626の間を通過して左側の壁に沿う第2経路632との2つの移動経路を見出すことができる。このように複数の移動経路を見出すことができた場合には、経路計画部202は、予め定められた評価基準に沿って一つを選択し、移動ロボット100の移動経路として決定する。評価基準は、経路と障害物との距離が遠いか、目標地点612までの走行距離が短いか、などが採用され得る。
FIG. 7 is a diagram for explaining the route search for the
図8は、判定円502に対する経路探索を説明する図である。図5を用いて説明したように、搬送物を把持した場合の射影が基準円501には収まらず、基準円501より大きな判定円502であれば収まると判断された場合には、経路計画部202は、幅R1を以て始動地点611から目標地点612まで移動経路を確立できるかを探索する。具体的には、環境地図601上で、始動地点611から目標地点612まで、直径R1の円を掃引することができるかを試みる。環境地図601の環境では、経路計画部202は、図示すように、右側と奥側の2つの壁に沿う第1経路641の移動経路を見出すことができる。経路計画部202は、第1経路641を移動ロボット100の移動経路として決定する。なお、複数の移動経路を見出すことができた場合は、図7の例と同様に、予め定められた評価基準に沿って一つを選択すれば良い。
FIG. 8 is a diagram illustrating a route search for the
図9は、判定円502に対する経路を生成できない環境を説明する図である。図9で示す環境は、机624の側方に壁621から張り出す柱627が存在する点で図6の例と異なる。机624と柱627との間の距離はR’であり、R1より小さく、更にはR0よりも小さい。この環境を示す環境地図602においては、始動地点611から目標地点612まで、直径R1の円を掃引することができない。すなわち、図8における第1経路641を確立できない。このような環境において、搬送物を把持した場合の射影が基準円501には収まらず、基準円501より大きな判定円502であれば収まると判断された移動ロボット100が、始動地点611から目標地点612まで走行する場合について説明する。
FIG. 9 is a diagram illustrating an environment in which a route for the
図10は、姿勢変化を伴う移動経路の探索を説明する図である。図示される環境は、図9の環境と同じであり、環境地図602で表されている。環境地図602においては、基準円501で掃引された図7(b)で示した第2経路632であれば、始動地点611から目標地点612までの経路を確立することができる。しかし、第2経路632の幅はR0であるので、この経路に沿って直径がR1である判定円502を掃引すると、いずれかの地点において障害物と接触することになる。接触判定部201は、判定円502を第2経路632に沿って掃引した場合に、判定円502が障害物に接触する接触地点を同定する。図の例においては、判定円502は、地点PSで机624と接触する。したがって、接触判定部201は、最初の接触地点として地点PSを同定する。
FIG. 10 is a diagram for explaining a search for a moving route involving a change in posture. The illustrated environment is the same as the environment of FIG. 9 and is represented by an
また、接触判定部201は、判定円502を第2経路632に沿って掃引した場合に、判定円502が障害物と接触しなくなる離脱地点を同定する。図の例においては、判定円502は、地点PEまで机624と接触する。したがって、接触判定部201は、離脱地点として地点PEを同定する。すると、接触判定部201は、接触地点PSと離脱地点PEに挟まれた区間D1を、接触区間と同定できる。接触区間が同定されると、まず、接触区間以外の区間において、搬送物303を把持した移動ロボット100が障害物に接触することなく走行できることが保証される。
In addition, the
姿勢計画部204は、接触判定部201から接触区間D1の情報を引き継ぎ、移動ロボット100が、この区間を、台車部110の向きや把持部120の姿勢を変化させれば通過できるか否かを演算する。なお、以下の説明においては、台車部110の向きや把持部120の姿勢を変化させることを、単に姿勢変化という場合がある。
The
図11は、姿勢変化により障害物を回避する動作を説明する図である。図11(a)に示すように、搬送物304が進行方向に直交する向きに突き出ているために基準円501に収まらない状況である場合、移動ロボット100がそのまま直進すると、搬送物304は机624に接触する。姿勢計画部204は、この状況を把握し、姿勢変化により机624との接触を回避できないかを演算する。上述のように、姿勢計画部204は、障害物を回避する姿勢変化として、台車部110の向きの変化、把持部120の姿勢の変化を検討する。図11(a)の状況においては、台車部110の向きを変化させると、走行方向と台車部110の向きが一致しなくなるので、走行制御の観点から不利である。そこで、姿勢計画部204は、台車部110の向きを変化させるより、把持部120の姿勢を変化させることを優先する。
FIG. 11 is a diagram illustrating an operation of avoiding an obstacle by changing the posture. As shown in FIG. 11A, in a situation where the conveyed
図11(a)の状況において、姿勢計画部204は、搬送物304が机624と接触しない把持部120の姿勢変化を見つけ出す。その解の一つが、図11(b)への姿勢変化である。図11(b)で示すように、搬送物304が進行方向の後方に位置するように把持部120の姿勢を変化させれば、移動ロボット100が接触地点PSから微小区間進んでも机624と接触しないことが演算により導ける。ここで、移動ロボット100を微小区間進めた場合に障害物と接触するか否かの接触判定は、図12で示す包摂外形510を移動させたときに、環境地図602に記述された障害物と重なり合うかを、幾何学的に判定する。
In the situation of FIG. 11A, the
図12は、姿勢変化後の接触判定を説明する図である。図示する包摂外形510は、直径R0の基準円501に、直径R0から突出する部分の射影の輪郭を加えたものである。すなわち、突出する部分を実際の幾何形状で表現することにより、障害物との相対位置を厳密に判定できるようにしている。
FIG. 12 is a diagram illustrating the contact determination after the posture change. Subsumption contour illustrated 510, the
姿勢計画部204は、接触区間D1を微小区間ごとに区切って、その区間ごとに包摂外形510が障害物と接触しないかを判定する。ある区間で接触すると判定した場合は、その微小区間の開始地点で再度姿勢変化を行えばその障害物を回避できるかを試みる。この演算を繰り返し、姿勢変化を伴えば接触区間D1を通過できるか否かを判定する。
The
そして、通過できると判定したら、いずれの地点でどのような姿勢変化を実行させるかを確定させ、これを台車の走行制御に伴う、障害物を回避する回避動作として策定する。接触区間においてこのような回避動作が策定できれば、制御部200は、姿勢変化を行わない接触区間以外の区間の走行計画と合わせて、移動ロボット100を目標地点612に到達させることができると判断できる。なお、上記の例では、始動地点611から目標地点612までの経路上に一つの接触区間D1が存在する例を示したが、2つ以上の接触区間が存在しても良い。その場合は、それぞれの区間ごとに回避動作を策定できるかを試みる。
Then, when it is determined that the vehicle can pass, what kind of posture change is to be executed at which point, and this is defined as an avoidance operation for avoiding an obstacle accompanying the traveling control of the bogie. If such an avoiding action can be formulated in the contact section, the
また、上記の例では、接触区間の例として直線区間を紹介したが、接触区間は、もちろん右折箇所、左折箇所、曲線区間などを含んでも良い。進行方向が変化する場合は、把持部120の姿勢を変化させるよりも、台車部110の向きを変化させることにより障害物との接触を避けやすい場合もあり得る。姿勢計画部204は、走行制御を考慮して回避動作を策定しても良い。
Further, in the above example, the straight section is introduced as an example of the contact section, but the contact section may of course include a right turn portion, a left turn portion, a curved section, and the like. When the traveling direction changes, it may be easier to avoid contact with an obstacle by changing the orientation of the
次に、移動ロボット100の移動計画の生成から実行に至る処理について説明する。図13は、移動ロボット100の処理手順を示すフロー図である。フローは、移動ロボット100が、始動地点に停止している状態から開始する。
Next, a process from generation to execution of the movement plan of the
経路計画部202は、ステップS101において、環境地図DB241から環境地図を読み込み、メモリ240から基準円の径R0を読み込んで、幅R0を基準として目標地点に到達する移動経路を確立できるかを探索する。移動経路が確立できないと判断したら、そもそも搬送物を把持していないとしても目標地点に到達できないので、ステップS102へ進み、到達不能である旨の告知を行う。到達不能告知は、例えば、音声で告知したり、ユーザが所持する端末に画像を表示したりする。移動ロボット100は、到達不能告知を行ったら、移動を開始することなく一連の処理を終了させる。
In step S101, the
ステップS101で移動経路を確立できると判断したら、ステップS103へ進み、制御部200は、アームユニット220を介して、搬送物を把持する。そして、搬送物認識部203は、センサユニット230を介して、搬送物の大きさや位置といった外形認識を実行する。
When it is determined that the movement route can be established in step S101, the process proceeds to step S103, and the
ステップS104へ進み、制御部200は、把持部120が搬送物を把持した状態で、その射影が基準円の半径R0内に収まるか否かを判断する。収まると判断した場合は、ステップS105へ進み、幅R0による移動経路を決定する。なお、上述のように、幅R0の移動経路が複数見出された場合は、評価基準に従って一つの経路が決定される。移動経路が決定されたら、ステップS106へ進み、その経路に沿って移動し、目標地点に到達したら一連の処理を終了する。
In step S104, the
ステップS104で半径R0内に収まらないと判断した場合は、ステップS107で、搬送物認識部203は、把持部120の姿勢を変化させつつ判定円とその直径R1を決定する。なお、この処理は、ステップS103の段階で纏めて行っても良い。
When it is determined in step S104 that the radius does not fall within the radius R 0 , the conveyed
ステップS108へ進み、経路計画部202は、環境地図を参照し、幅R1を基準として目標地点に到達する移動経路を確立できるかを探索する。移動経路を確立できたら、ステップS109へ進み、幅R1による移動経路を決定する。なお、幅R1の移動経路が複数見出された場合は、評価基準に従って一つの経路が決定される。移動経路が決定されたら、ステップS106へ進み、その経路に沿って移動し、目標地点に到達したら一連の処理を終了する。
In step S108, the
ステップS108において、幅R1を基準とした移動経路を確立できなかったら、ステップS110へ進み、接触判定部201は、経路計画部202がステップS101で探索した幅R0を基準とした移動経路の一つを検証対象として選択する。一つしか存在しない場合は、その移動経路を検証対象とする。そして、ステップS111において、図10を用いて説明したように、直径R1の判定円を検証対象となる移動経路に沿って掃引させて障害物との接触地点および接触区間を同定する。接触判定部201は、ステップS112へ進み、接触地点、および接触区間を微小区間ごとに区切った各々の地点に対して、姿勢変化によって障害物との衝突を回避できるかを試みる。回避できないと判定したら、ステップS113へ進み、接触判定部201は、経路計画部202がステップS101で探索した幅R0を基準とした移動経路の全てを検証したかを確認する。まだ全てを検証していない場合は、ステップS110へ戻り、ステップS110からS112を繰り返す。一方、全てを検証し終わった場合は、ステップS102へ進み、上記の通り到達不能である旨の告知を行って、一連の処理を終了する。
If the movement route based on the width R 1 cannot be established in step S108, the process proceeds to step S110, and the
ステップS112で障害物との接触を回避できると判定したら、ステップS114へ進み、いずれの地点でどのような姿勢変化を実行させるかを確定させ、障害物を回避する回避動作として策定する。そして、ステップS115へ進み、制御部200は、接触区間では策定した回避動作に従って姿勢変化を実行しつつ、移動経路に沿って移動し、目標地点に到達したら一連の処理を終了する。
When it is determined in step S112 that the contact with the obstacle can be avoided, the process proceeds to step S114 to determine what kind of posture change is to be performed at which point and formulate the avoidance operation for avoiding the obstacle. Then, the process proceeds to step S115, in which the
以上説明したように、移動ロボット100が自律移動して搬送物を目標地点まで運ぶ場合に、移動ロボット100の射影から形成される基準円または判定円で移動経路を確定できるのであれば、経路探索のための演算量も少なく、円滑な自律移動を実現できる。この場合は、移動中の姿勢変化も考慮しなくて良いので、走行制御も容易である。一方、判定円の掃引によっても移動経路を確定できない場合は、経路上の接触地点を同定し、搬送物を把持しつつ姿勢を変化させることで障害物との接触を回避するので、狭い幅の経路も通過させることができる。すなわち、円の掃引では移動経路を探索できない場合でも、目標地点までの経路を確保することができる。また、接触地点における姿勢変化は、移動ロボット100の外形の実際的形状を用いて演算するので演算量は増大するが、実際的形状を用いて移動経路の全体を演算するよりは演算量が少なくなる。演算量を少なくできると、特に連続的に目標地点を設定して長い距離を移動するような場合に、演算のための移動停止を抑制できたり、移動速度を向上できたりする。
As described above, when the
以上説明した実施形態において示した装置、システム、プログラム、および方法における動作、手順、ステップ、および段階等の各処理の実行順序は、特段「より前に」、「先立って」等と明示しておらず、また、前の処理の出力を後の処理で用いるのでない限り、任意の順序で実現し得る。便宜上「まず、」、「次に、」等を用いて説明したとしても、この順で実施することが必須であることを意味するものではない。 The execution order of each process such as the operation, procedure, step, and stage in the devices, systems, programs, and methods shown in the above-described embodiments is explicitly stated as "prior to", "prior to", or the like. It can be realized in any order unless the output of the previous process is used in the subsequent process. Even if “first,” “next,” and the like are used for convenience, it does not mean that it is essential to carry out in this order.
100 移動ロボット、110 台車部、111 ベース、112 駆動輪、113 キャスター、114 カメラ、120 把持部、121、122、123 アーム、124 ハンド、200 制御部、201 接触判定部、202 経路計画部、203 搬送物認識部、204 姿勢計画部、210 駆動輪ユニット、220 アームユニット、230 センサユニット、240 メモリ、241 環境地図DB、301 搬送物、303 搬送物、501 基準円、502 判定円、510 包摂外形、601、602 環境地図、611 始動地点、612 目標地点、621 壁、622 扉、623 床面、624 机、625 ソファー、626 テレビ台、627 柱、631 第1経路、632 第2経路、641 第1経路 100 mobile robot, 110 trolley part, 111 base, 112 drive wheel, 113 caster, 114 camera, 120 gripping part, 121, 122, 123 arm, 124 hand, 200 control part, 201 contact determination part, 202 route planning part, 203 Transport object recognition unit, 204 posture planning unit, 210 drive wheel unit, 220 arm unit, 230 sensor unit, 240 memory, 241 environment map DB, 301 transport object, 303 transport object, 501 reference circle, 502 judgment circle, 510 inclusion contour , 601, 602 Environmental Map, 611 Starting Point, 612 Target Point, 621 Wall, 622 Door, 623 Floor, 624 Desk, 625 Sofa, 626 TV Stand, 627 Pillar, 631 1st Route, 632 2nd Route, 641 4th 1 route
Claims (1)
前記搬送物を把持した場合に前記把持部または前記搬送物が前記基準円からはみ出すか否かを判定し、はみ出す場合には、はみ出した前記把持部または前記搬送物を含む前記移動ロボットの射影に外接する判定円を作成するステップと、
前記判定円を前記経路に沿って掃引した場合に、前記判定円が障害物に接触する接触地点の有無を判定し、前記接触地点を同定するステップと、
前記接触地点が存在した場合に、前記把持部の姿勢および前記移動ロボットの姿勢の少なくともいずれかを変化させることにより前記障害物を回避する回避動作を策定するステップと
を含む移動経路計画方法。 A mobile robot having a movable gripper and a storage that stores an environment map, and sweeping a reference circle circumscribing the projection of the mobile robot that is not gripping the transported object on the environment map. According to the present invention, there is provided a step of searching for a route to a target point on the environment map, wherein the gripper holds a conveyed object to plan a movement route to the target point.
When gripping the conveyed object, it is determined whether the gripping portion or the conveyed object protrudes from the reference circle, and when protruding, the projection of the mobile robot including the protruding gripping portion or the conveyed object. Creating a circumscribing decision circle,
When the determination circle is swept along the path, the determination circle determines whether or not there is a contact point in contact with an obstacle, and the step of identifying the contact point,
When the contact point exists, a step of formulating an avoidance operation for avoiding the obstacle by changing at least one of the attitude of the grip section and the attitude of the mobile robot, is provided.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016121600A JP6693291B2 (en) | 2016-06-20 | 2016-06-20 | Mobile robot movement route planning method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016121600A JP6693291B2 (en) | 2016-06-20 | 2016-06-20 | Mobile robot movement route planning method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017227955A JP2017227955A (en) | 2017-12-28 |
JP6693291B2 true JP6693291B2 (en) | 2020-05-13 |
Family
ID=60889245
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016121600A Active JP6693291B2 (en) | 2016-06-20 | 2016-06-20 | Mobile robot movement route planning method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6693291B2 (en) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7139643B2 (en) * | 2018-03-23 | 2022-09-21 | カシオ計算機株式会社 | Robot, robot control method and program |
CN108762272B (en) * | 2018-06-05 | 2021-01-22 | 北京智行者科技有限公司 | Obstacle identification and avoidance method |
WO2020075621A1 (en) * | 2018-10-09 | 2020-04-16 | ソニー株式会社 | Moving body, moving body control method, and program |
JP7299097B2 (en) * | 2019-08-02 | 2023-06-27 | 国立大学法人信州大学 | Trajectory generator |
CN111283686B (en) * | 2020-03-05 | 2021-11-19 | 亿嘉和科技股份有限公司 | Grabbing pose calculation method for live working robot in grabbing branch line scene |
CN111709965B (en) * | 2020-08-19 | 2020-12-22 | 浙江欣奕华智能科技有限公司 | Map optimization method and device for sweeping robot |
CN113771850A (en) * | 2021-09-08 | 2021-12-10 | 恒大新能源汽车投资控股集团有限公司 | Vehicle road running control method and device and computer readable storage medium |
WO2023135761A1 (en) * | 2022-01-14 | 2023-07-20 | 日本電信電話株式会社 | Utility pole construction system, control method, control device, and program |
CN114712151B (en) * | 2022-03-01 | 2023-09-19 | 南京伟思医疗科技股份有限公司 | Virtual obstacle avoidance method and system for upper limb rehabilitation robot |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4328819B2 (en) * | 2007-11-30 | 2009-09-09 | 本田技研工業株式会社 | Mobile device and control program thereof |
JP5553373B2 (en) * | 2008-03-25 | 2014-07-16 | 株式会社Ihi | Robot apparatus control method and robot apparatus |
JP5993784B2 (en) * | 2013-04-18 | 2016-09-14 | 株式会社豊田中央研究所 | Route correction device |
US9283678B2 (en) * | 2014-07-16 | 2016-03-15 | Google Inc. | Virtual safety cages for robotic devices |
-
2016
- 2016-06-20 JP JP2016121600A patent/JP6693291B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2017227955A (en) | 2017-12-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6693291B2 (en) | Mobile robot movement route planning method | |
JP6645922B2 (en) | Autonomous mobile body and movement control method of autonomous mobile body | |
JP6897376B2 (en) | Movement planning equipment, mobile robots, and movement planning programs | |
US9526390B2 (en) | Robot cleaner | |
US11537135B2 (en) | Moving robot and controlling method for the moving robot | |
CN103099583B (en) | Robot cleaner and its control method | |
JP5337408B2 (en) | Autonomous mobile body and its movement control method | |
JP4735476B2 (en) | Autonomous mobile device | |
US10860033B2 (en) | Movable object and method for controlling the same | |
JP5764795B2 (en) | Mobile robot, mobile robot learning system, and mobile robot behavior learning method | |
EP3234714B1 (en) | Experience-based roadmap for a robotic cleaning device | |
JP4670807B2 (en) | Travel route creation method, autonomous mobile body, and autonomous mobile body control system | |
JP7395877B2 (en) | Robot system and control method | |
JP6074205B2 (en) | Autonomous mobile | |
JP2018185767A (en) | Environment maintenance robot, and control program of the same | |
JP6348971B2 (en) | Moving body | |
CN112631269B (en) | Autonomous mobile robot and control program for autonomous mobile robot | |
JP7329125B2 (en) | Mobile robot and its control method | |
JP6565869B2 (en) | Autonomous mobile body and control program for autonomous mobile body | |
JP2020010982A (en) | Self-propelled cleaner | |
KR20210015126A (en) | Moving Robot | |
WO2022014133A1 (en) | Mobile manipulator, method for controlling same, program | |
JP6863049B2 (en) | Autonomous mobile robot | |
WO2020059292A1 (en) | Autonomous traveling cleaner | |
JP2021112417A (en) | Autonomous travel type cleaner |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20190321 |
|
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: 20200317 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200330 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6693291 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |