JP6693291B2 - Mobile robot movement route planning method - Google Patents

Mobile robot movement route planning method Download PDF

Info

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
Application number
JP2016121600A
Other languages
Japanese (ja)
Other versions
JP2017227955A (en
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.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
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 Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2016121600A priority Critical patent/JP6693291B2/en
Publication of JP2017227955A publication Critical patent/JP2017227955A/en
Application granted granted Critical
Publication of JP6693291B2 publication Critical patent/JP6693291B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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.

特開2009−291540号公報JP, 2009-291540, A

移動ロボットが搬送物を把持して目標地点まで移動しようとする場合に、搬送物も含めた外形形状を厳密に認識した上で障害物と接触しない移動経路を決定する手法は、膨大な演算を要し、円滑な移動を妨げる原因となっている。一方で、搬送物を把持した状態の移動ロボットの射影に外接する円を環境地図上で掃引して、障害物と接触しない移動経路を決定する手法は、演算量は少ないものの、障害物が多い環境下ではそもそも移動経路を見つけられないことがあった。   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.

本実施形態にかかる移動ロボットの外観斜視図である。FIG. 3 is an external perspective view of a mobile robot according to this embodiment. 移動ロボットの制御ブロック図である。It is a control block diagram of a mobile robot. 搬送物を把持しない場合における基準円を説明する図である。It is a figure explaining the reference circle in the case where a conveyed article is not gripped. 搬送物を把持した場合の基準円との関係を説明する図である。It is a figure explaining the relationship with a reference circle when a conveyed article is grasped. 搬送物を把持した場合における判定円を説明する図である。It is a figure explaining the judgment circle at the time of grasping the conveyed thing. 保持する環境地図の例を示す図である。It is a figure which shows the example of the environment map to hold | maintain. 基準円に対する経路探索を説明する図である。It is a figure explaining the route search to a reference circle. 判定円に対する経路探索を説明する図である。It is a figure explaining the route search to a judgment circle. 判定円に対する経路を生成できない環境を説明する図である。It is a figure explaining the environment in which the route for the judgment circle cannot be generated. 姿勢変化を伴う移動経路の探索を説明する図である。It is a figure explaining the search of the movement course accompanying a posture change. 姿勢変化により障害物を回避する動作を説明する図である。It is a figure explaining operation which avoids an obstacle by posture change. 姿勢変化後の接触判定を説明する図である。It is a figure explaining contact determination after a posture change. 移動ロボットの処理手順を示すフロー図である。It is a flow figure showing a processing procedure of a mobile robot.

以下、発明の実施の形態を通じて本発明を説明するが、特許請求の範囲に係る発明を以下の実施形態に限定するものではない。また、実施形態で説明する構成の全てが課題を解決するための手段として必須であるとは限らない。   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 mobile robot 100 according to this embodiment. The mobile robot 100 is roughly divided into a carriage 110 and a grip 120.

台車部110は、主に、ベース111と、ベース111に取り付けられた2つの駆動輪112と1つのキャスター113とから構成される。2つの駆動輪112は、ベース111の対向する側方のそれぞれに、回転軸芯が一致するように配設されている。それぞれの駆動輪112は、不図示のモータによって独立して回転駆動される。キャスター113は、従動輪であり、ベース111から鉛直方向に延びる旋回軸が車輪の回転軸から離れて車輪を軸支するように設けられており、台車部110の移動方向に倣うように追従する。移動ロボット100は、例えば、2つの駆動輪112が同じ方向に同じ回転速度で回転されれば直進し、逆方向に同じ回転速度で回転されれば重心を通る鉛直軸周りに旋回する。すなわち、移動ロボット100は、2つの駆動輪112の回転方向、回転速度がそれぞれ制御されることにより、前進、後進、旋回することができる。   The dolly unit 110 mainly includes a base 111, two drive wheels 112 attached to the base 111, and one caster 113. The two drive wheels 112 are arranged on opposite sides of the base 111 such that the axes of rotation are aligned. Each drive wheel 112 is independently rotationally driven by a motor (not shown). The caster 113 is a driven wheel, and a turning shaft extending in the vertical direction from the base 111 is provided so as to pivotally support the wheel apart from the rotation axis of the wheel, and follows the moving direction of the carriage 110. .. The mobile robot 100 goes straight if, for example, the two drive wheels 112 are rotated in the same direction at the same rotation speed, and turns around the vertical axis passing through the center of gravity if they are rotated in the opposite direction at the same rotation speed. That is, the mobile robot 100 can move forward, reverse, or turn by controlling the rotation direction and rotation speed of the two drive wheels 112, respectively.

台車部110は、障害物検知や周辺環境認識のための各種センサが設けられている。カメラ114は、そのセンサ類の一つであり、ベース111の四隅に配置されている。カメラ114は、例えばCMOSイメージセンサを含み、撮影した画像信号を後述の制御部へ送信する。隣接する2つのカメラ114が同一の被写体を捉えれば視差画像を取得でき、当該被写体までの距離を算出することもできる。   The trolley unit 110 is provided with various sensors for detecting obstacles and recognizing the surrounding environment. The camera 114 is one of the sensors and is arranged at the four corners of the base 111. The camera 114 includes, for example, a CMOS image sensor, and transmits a captured image signal to a control unit described later. If two adjacent cameras 114 capture the same subject, a parallax image can be acquired and the distance to the subject can also be calculated.

把持部120は、主に、複数のアーム121、122、123と、ハンド124とから構成される。アーム121は、鉛直軸周りに回転自在に、一端がベース111に軸支されている。アーム122は、水平軸周りに回転自在に、一端がアーム121の他端に軸支されている。アーム123は、アーム122の他端で放射方向に回転自在に、一端がアーム122の他端に軸支されている。ハンド124は、アーム123の伸延方向と平行な中心軸周りに回転自在に、アーム123の他端に軸支されている。また、ハンド124は、搬送物を把持できるように、把持機構を備える。アーム121、122、123とハンド124は、不図示のモータを介して駆動され、所定の姿勢をとったり、搬送物を把持したりする。   The grip 120 is mainly composed of a plurality of arms 121, 122, 123 and a hand 124. The arm 121 has one end pivotally supported by the base 111 so as to be rotatable around a vertical axis. The arm 122 has one end pivotally supported by the other end of the arm 121 so as to be rotatable around a horizontal axis. The arm 123 is rotatably in the radial direction at the other end of the arm 122, and has one end pivotally supported by the other end of the arm 122. The hand 124 is rotatably supported on the other end of the arm 123 so as to be rotatable about a central axis parallel to the extending direction of the arm 123. Further, the hand 124 is provided with a gripping mechanism so that the conveyed object can be gripped. The arms 121, 122, 123 and the hand 124 are driven by a motor (not shown) to take a predetermined posture or hold a conveyed object.

図2は、移動ロボット100の制御ブロック図である。制御部200は、例えばCPUであり、台車部110に設けられている。駆動輪ユニット210は、駆動輪112を駆動するための駆動回路やモータを含み、台車部110に設けられている。制御部200は、駆動輪ユニット210へ駆動信号を送ることにより、駆動輪112の回転制御を実行する。   FIG. 2 is a control block diagram of the mobile robot 100. The control unit 200 is, for example, a CPU, and is provided in the carriage unit 110. The drive wheel unit 210 includes a drive circuit and a motor for driving the drive wheels 112, and is provided in the carriage unit 110. The control unit 200 controls the rotation of the drive wheels 112 by sending a drive signal to the drive wheel unit 210.

アームユニット220は、アーム121、122、123およびハンド124を駆動するための駆動回路やモータを含み、把持部120に設けられている。制御部200は、アームユニット220へ駆動信号を送ることにより、把持部120の姿勢制御や把持制御を実行する。   The arm unit 220 includes a drive circuit and a motor for driving the arms 121, 122, 123 and the hand 124, and is provided in the grip section 120. The control unit 200 sends a drive signal to the arm unit 220 to execute posture control and grip control of the grip unit 120.

センサユニット230は、周辺環境を探索したり把持部120の姿勢を監視したりする各種センサを含み、台車部110および把持部120に分散して配置されている。制御部200は、センサユニット230に制御信号を送ることにより、各種センサを駆動してその出力を取得する。カメラ114は、センサユニット230に含まれ、制御信号に従って撮影動作を実行する。   The sensor unit 230 includes various sensors for searching the surrounding environment and monitoring the posture of the grip 120, and is arranged in a distributed manner in the carriage 110 and the grip 120. The control unit 200 sends a control signal to the sensor unit 230 to drive various sensors and obtain their outputs. The camera 114 is included in the sensor unit 230 and executes a shooting operation according to a control signal.

メモリ240は、不揮発性の記憶媒体であり、例えばソリッドステートドライブが用いられる。メモリ240は、移動ロボット100を制御するための制御プログラムの他にも、制御に用いられる様々なパラメータ値、関数、ルックアップテーブル等を記憶している。メモリ240は、移動ロボット100が自律走行する環境を表現する環境地図を格納した環境地図DB241を含む。   The memory 240 is a non-volatile storage medium, and for example, a solid state drive is used. The memory 240 stores not only a control program for controlling the mobile robot 100, but also various parameter values, functions, lookup tables, and the like used for control. The memory 240 includes an environment map DB 241 that stores an environment map expressing the environment in which the mobile robot 100 autonomously travels.

制御部200は、駆動輪ユニット210、アームユニット220、センサユニット230およびメモリ240との間で情報を送受信することにより、制御に関わる様々な演算を実行する機能演算部としての役割も担う。接触判定部201は、環境地図DB241から読み込んだ環境地図を用いて、移動ロボット100が自律走行した場合に障害物と接触するかを判定する。経路計画部202は、環境地図DB241から読み込んだ環境地図を用いて、移動ロボット100が自律走行するための経路を計画する。搬送物認識部203は、ハンド124が把持した搬送物をカメラ114で撮影し、その画像データを用いて搬送物の大きさや位置を認識する。姿勢計画部204は、移動経路の特定の箇所において、台車部110の向きや把持部120の姿勢をどのように変化させて走行させるかを計画する。それぞれの具体的な演算内容については、順に詳述する。   The control unit 200 also plays a role as a function calculation unit that executes various calculations related to control by transmitting and receiving information to and from the drive wheel unit 210, the arm unit 220, the sensor unit 230, and the memory 240. The contact determination unit 201 uses the environment map read from the environment map DB 241 to determine whether the mobile robot 100 contacts an obstacle when the mobile robot 100 autonomously travels. The route planning unit 202 uses the environment map read from the environment map DB 241 to plan a route for the mobile robot 100 to autonomously travel. The conveyed object recognition unit 203 photographs the conveyed object held by the hand 124 with the camera 114, and recognizes the size and position of the conveyed object using the image data. The posture planning unit 204 plans how to change the orientation of the carriage unit 110 and the posture of the gripping unit 120 to travel at a specific position on the movement route. The specific contents of each calculation will be described in detail in order.

図3は、搬送物を把持しない場合における基準円501を説明する図である。基準円501は、図で網状に示した領域を取り囲む円である。具体的には、基準円501は、搬送物を把持しない状態の移動ロボット100の射影(鉛直方向から走行面に投射した影)に外接する円である。把持部120が射影の一部を形成する場合は、把持部120は、射影の全体ができる限り小さくなるような姿勢を取る。このように定義される基準円501の直径をRと定める。Rは、移動ロボット100の構造によって定まる定数であるので、その値は予めメモリ240に記憶されている。 FIG. 3 is a diagram illustrating the reference circle 501 when the conveyed object is not gripped. The reference circle 501 is a circle that surrounds the meshed area in the figure. Specifically, the reference circle 501 is a circle circumscribing the projection (shadow projected on the traveling surface from the vertical direction) of the mobile robot 100 in a state where the conveyed object is not gripped. When the gripping part 120 forms a part of the projection, the gripping part 120 takes a posture so that the entire projection is as small as possible. The diameter of the reference circle 501 defined in this way is defined as R 0 . Since R 0 is a constant determined by the structure of the mobile robot 100, its value is stored in the memory 240 in advance.

図4は、搬送物301を把持した場合の基準円501との関係を説明する図である。移動ロボット100が搬送する対象である搬送物301が比較的小さな場合は、把持部120の姿勢を工夫することにより、搬送物301を把持した状態でも、その射影は基準円501に収まる。このように、搬送物301を把持した状態の移動ロボット100の射影が基準円501に収まるのであれば、経路計画部202は、幅Rを基準に移動経路を探索できる。 FIG. 4 is a diagram illustrating a relationship with the reference circle 501 when the conveyed object 301 is gripped. When the transport object 301 to be transported by the mobile robot 100 is relatively small, the projection of the transport object 301 falls within the reference circle 501 by devising the posture of the grip portion 120 even when the transport object 301 is gripped. In this way, if the projection of the mobile robot 100 holding the conveyed object 301 falls within the reference circle 501, the route planning unit 202 can search for the movement route based on the width R 0 .

搬送物301を把持した状態の移動ロボット100の射影が基準円501に収まるか否かは、搬送物認識部203が搬送物の大きさや位置を認識した上で制御部200が判断する。搬送物認識部203が、ある把持状態の搬送物301について、その先端が基準円501によって形成される仮想的な円筒の内部に存在すると認識すれば、基準円501に収まると判断する。仮想的な円筒からはみ出ると認識した場合であっても、把持部120の姿勢を変化させて搬送物301の把持状態を変えれば円筒の内部に存在させることができるかを演算する。具体的には、搬送物301を円筒の内部の様々な位置に様々な姿勢で仮想的に配置し、その位置および姿勢の搬送物301を把持する把持部120の姿勢に解が存在するか逆運動学を用いて演算する。解が存在すれば、制御部200は、把持部120をその解に従った姿勢に変更する。   The control unit 200 determines whether or not the projection of the mobile robot 100 holding the conveyed object 301 falls within the reference circle 501 after the conveyed object recognition unit 203 recognizes the size and position of the conveyed object. When the conveyed object recognition unit 203 recognizes that the tip of the conveyed object 301 in a certain gripping state is inside the virtual cylinder formed by the reference circle 501, it determines that the conveyed object 301 is within the reference circle 501. Even when it is recognized that it is projected from the virtual cylinder, it is calculated whether the posture of the gripping portion 120 is changed to change the gripped state of the conveyed object 301 so that the conveyed object 301 can be present inside the cylinder. Specifically, the conveyed object 301 is virtually arranged at various positions inside the cylinder in various postures, and whether or not there is a solution in the posture of the gripping portion 120 that grasps the conveyed substance 301 at the position and the posture. Calculate using kinematics. If a solution exists, the control unit 200 changes the gripping unit 120 to the posture according to the solution.

図5は、搬送物303を把持した場合における判定円502を説明する図である。搬送する対象物である搬送物303が比較的大きい場合は、把持部120の姿勢を工夫しても、搬送物303を把持した状態の射影は基準円501に収まらなくなる。この場合は、搬送物303を把持した状態における、搬送物303を含む移動ロボット100の射影に外接する判定円502を定義する。このとき、把持部120は、射影の全体ができる限り小さくなるような姿勢を取ることが好ましい。例えば、制御部200は、把持部120の姿勢を様々に変化させ、搬送物認識部203により搬送物303の先端位置を認識することにより、射影の全体ができる限り小さくなるような姿勢を見つけ出す。このように定義される判定円502の直径をRと定める。Rは、搬送物認識部203の処理を経て決定される値である。経路計画部202は、幅Rを基準に移動経路を探索する。 FIG. 5 is a diagram illustrating the determination circle 502 when the conveyed object 303 is gripped. When the conveyed object 303, which is an object to be conveyed, is relatively large, the projection of the state in which the conveyed object 303 is grasped does not fall within the reference circle 501, even if the posture of the grip portion 120 is devised. In this case, a determination circle 502 circumscribing the projection of the mobile robot 100 including the conveyed object 303 in a state where the conveyed object 303 is held is defined. At this time, it is preferable that the gripping part 120 has a posture such that the entire projection is as small as possible. For example, the control unit 200 variously changes the posture of the gripping unit 120 and recognizes the front end position of the conveyed product 303 by the conveyed product recognition unit 203 to find a posture in which the entire projection is as small as possible. The diameter of the judgment circle 502 defined in this way is defined as R 1 . R 1 is a value determined through the processing of the conveyed object recognition unit 203. The route planning unit 202 searches for a movement route based on the width R 1 .

次に、移動経路の探索について説明する。図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 environment map 601 is one of the environment maps stored in the environment map DB 241. The environment map 601 is a map generated so as to project the actual environment on a plane at a predetermined scale, and specifically, is described so that the size and position of the fixed object can be mainly grasped. The example in the figure represents a substantially square room, which is surrounded by a wall 621. An open door 622 exists near the entrance, and a desk 624 is arranged in the center of the room. A sofa 625 and a television stand 626 are arranged so as to sandwich the desk 624. In such an environment, the control unit 200 defines a starting point 611 near the entrance and a target point 612 that should be reached by autonomous traveling.

図7は、基準円501に対する経路探索を説明する図である。図4を用いて説明したように、搬送物を把持しても射影が基準円501に収まると判断された場合には、経路計画部202は、幅Rを以て始動地点611から目標地点612まで移動経路を確立できるかを探索する。具体的には、環境地図601上で、始動地点611から目標地点612まで、直径Rの円を掃引することができるかを試みる。環境地図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 reference circle 501. As described with reference to FIG. 4, when it is determined that the projection falls within the reference circle 501 even if the conveyed object is grasped, the route planning unit 202 sets the width R 0 from the starting point 611 to the target point 612. Search for a route that can be established. Specifically, on the environment map 601, it is tried whether the circle having the diameter R 0 can be swept from the starting point 611 to the target point 612. In the environment of the environment map 601, the route planning unit 202, as shown in FIG. 7A, the first route 631 along the two walls on the right side and the back side, and as shown in FIG. Two paths of travel can be found, passing between 624 and the television stand 626 and a second path 632 along the left wall. When a plurality of movement routes can be found in this way, the route planning unit 202 selects one according to a predetermined evaluation standard and determines the movement route of the mobile robot 100. As the evaluation standard, whether the distance between the route and the obstacle is long, the traveling distance to the target point 612 is short, or the like can be adopted.

図8は、判定円502に対する経路探索を説明する図である。図5を用いて説明したように、搬送物を把持した場合の射影が基準円501には収まらず、基準円501より大きな判定円502であれば収まると判断された場合には、経路計画部202は、幅Rを以て始動地点611から目標地点612まで移動経路を確立できるかを探索する。具体的には、環境地図601上で、始動地点611から目標地点612まで、直径Rの円を掃引することができるかを試みる。環境地図601の環境では、経路計画部202は、図示すように、右側と奥側の2つの壁に沿う第1経路641の移動経路を見出すことができる。経路計画部202は、第1経路641を移動ロボット100の移動経路として決定する。なお、複数の移動経路を見出すことができた場合は、図7の例と同様に、予め定められた評価基準に沿って一つを選択すれば良い。 FIG. 8 is a diagram illustrating a route search for the determination circle 502. As described with reference to FIG. 5, when it is determined that the projection when the conveyed object is gripped does not fit in the reference circle 501 and the determination circle 502 larger than the reference circle 501 fits, the route planning unit 202 searches for it can establish a travel route from the starting point 611 with a width R 1 to the target point 612. Specifically, on the environment map 601, it is tried whether the circle of the diameter R 1 can be swept from the starting point 611 to the target point 612. In the environment of the environment map 601, the route planning unit 202 can find the movement route of the first route 641 along the two walls on the right side and the back side as illustrated. The route planning unit 202 determines the first route 641 as the moving route of the mobile robot 100. When a plurality of movement routes can be found, one may be selected according to a predetermined evaluation standard, as in the example of FIG. 7.

図9は、判定円502に対する経路を生成できない環境を説明する図である。図9で示す環境は、机624の側方に壁621から張り出す柱627が存在する点で図6の例と異なる。机624と柱627との間の距離はR’であり、Rより小さく、更にはRよりも小さい。この環境を示す環境地図602においては、始動地点611から目標地点612まで、直径Rの円を掃引することができない。すなわち、図8における第1経路641を確立できない。このような環境において、搬送物を把持した場合の射影が基準円501には収まらず、基準円501より大きな判定円502であれば収まると判断された移動ロボット100が、始動地点611から目標地点612まで走行する場合について説明する。 FIG. 9 is a diagram illustrating an environment in which a route for the determination circle 502 cannot be generated. The environment shown in FIG. 9 differs from the example in FIG. 6 in that there is a pillar 627 protruding from the wall 621 to the side of the desk 624. The distance between the desk 624 and the pillar 627 is R ′, which is smaller than R 1 and further smaller than R 0 . In the environment map 602 showing this environment, it is not possible to sweep the circle having the diameter R 1 from the starting point 611 to the target point 612. That is, the first route 641 in FIG. 8 cannot be established. In such an environment, the mobile robot 100 that is determined that the projection when the conveyed object is gripped does not fall within the reference circle 501 and falls within the reference circle 501 if the decision circle 502 is larger than the reference point 501 is changed from the starting point 611 to the target point. The case of traveling up to 612 will be described.

図10は、姿勢変化を伴う移動経路の探索を説明する図である。図示される環境は、図9の環境と同じであり、環境地図602で表されている。環境地図602においては、基準円501で掃引された図7(b)で示した第2経路632であれば、始動地点611から目標地点612までの経路を確立することができる。しかし、第2経路632の幅はRであるので、この経路に沿って直径がRである判定円502を掃引すると、いずれかの地点において障害物と接触することになる。接触判定部201は、判定円502を第2経路632に沿って掃引した場合に、判定円502が障害物に接触する接触地点を同定する。図の例においては、判定円502は、地点Pで机624と接触する。したがって、接触判定部201は、最初の接触地点として地点Pを同定する。 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 environment map 602. In the environment map 602, the second route 632 shown in FIG. 7B swept by the reference circle 501 can establish the route from the starting point 611 to the target point 612. However, since the width of the second path 632 is R 0 , when the determination circle 502 having a diameter of R 1 is swept along this path, it comes into contact with the obstacle at any point. The contact determination unit 201 identifies a contact point where the determination circle 502 contacts an obstacle when the determination circle 502 is swept along the second path 632. In the illustrated example, the decision circle 502 contacts the desk 624 at point P S. Therefore, the contact determination unit 201 identifies the point P S as the first contact point.

また、接触判定部201は、判定円502を第2経路632に沿って掃引した場合に、判定円502が障害物と接触しなくなる離脱地点を同定する。図の例においては、判定円502は、地点Pまで机624と接触する。したがって、接触判定部201は、離脱地点として地点Pを同定する。すると、接触判定部201は、接触地点Pと離脱地点Pに挟まれた区間Dを、接触区間と同定できる。接触区間が同定されると、まず、接触区間以外の区間において、搬送物303を把持した移動ロボット100が障害物に接触することなく走行できることが保証される。 In addition, the contact determination unit 201 identifies a departure point at which the determination circle 502 does not come into contact with an obstacle when the determination circle 502 is swept along the second path 632. In the illustrated example, the judgment circle 502 contacts the desk 624 up to the point P E. Therefore, the contact determination unit 201 identifies the point P E as the departure point. Then, the contact determination unit 201 can identify the section D 1 sandwiched between the contact point P S and the departure point P E as the contact section. When the contact section is identified, first, in the section other than the contact section, it is guaranteed that the mobile robot 100 holding the conveyed object 303 can travel without contacting the obstacle.

姿勢計画部204は、接触判定部201から接触区間Dの情報を引き継ぎ、移動ロボット100が、この区間を、台車部110の向きや把持部120の姿勢を変化させれば通過できるか否かを演算する。なお、以下の説明においては、台車部110の向きや把持部120の姿勢を変化させることを、単に姿勢変化という場合がある。 The posture planning unit 204 takes over the information of the contact section D 1 from the contact determination unit 201, and whether or not the mobile robot 100 can pass through this section by changing the orientation of the trolley unit 110 and the attitude of the gripping unit 120. Is calculated. In the following description, changing the orientation of the carriage 110 and the attitude of the grip 120 may be simply referred to as attitude change.

図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 object 304 does not fit within the reference circle 501 because it protrudes in a direction orthogonal to the traveling direction, if the mobile robot 100 goes straight ahead, the conveyed object 304 will be a desk. Contact 624. The posture planning unit 204 grasps this situation and calculates whether or not contact with the desk 624 can be avoided due to a change in posture. As described above, the posture planning unit 204 considers a change in the orientation of the carriage unit 110 and a change in the posture of the gripping unit 120 as the posture change for avoiding an obstacle. In the situation of FIG. 11A, if the direction of the carriage 110 is changed, the traveling direction and the direction of the carriage 110 do not match, which is disadvantageous from the viewpoint of traveling control. Therefore, the posture planning unit 204 gives priority to changing the posture of the gripping unit 120 rather than changing the orientation of the carriage unit 110.

図11(a)の状況において、姿勢計画部204は、搬送物304が机624と接触しない把持部120の姿勢変化を見つけ出す。その解の一つが、図11(b)への姿勢変化である。図11(b)で示すように、搬送物304が進行方向の後方に位置するように把持部120の姿勢を変化させれば、移動ロボット100が接触地点Pから微小区間進んでも机624と接触しないことが演算により導ける。ここで、移動ロボット100を微小区間進めた場合に障害物と接触するか否かの接触判定は、図12で示す包摂外形510を移動させたときに、環境地図602に記述された障害物と重なり合うかを、幾何学的に判定する。 In the situation of FIG. 11A, the posture planning unit 204 finds a posture change of the gripping unit 120 in which the conveyed object 304 does not contact the desk 624. One of the solutions is a posture change to FIG. 11 (b). As shown in FIG. 11B, if the posture of the gripping part 120 is changed so that the conveyed object 304 is located rearward in the traveling direction, even if the mobile robot 100 advances from the contact point P S in a minute section, the mobile robot 100 can move to the desk 624. It can be calculated that they do not touch. Here, the contact determination as to whether or not the mobile robot 100 contacts the obstacle when the mobile robot 100 is advanced in a minute section is determined as the obstacle described in the environment map 602 when the inclusion contour 510 shown in FIG. 12 is moved. It is geometrically determined whether they overlap.

図12は、姿勢変化後の接触判定を説明する図である。図示する包摂外形510は、直径Rの基準円501に、直径Rから突出する部分の射影の輪郭を加えたものである。すなわち、突出する部分を実際の幾何形状で表現することにより、障害物との相対位置を厳密に判定できるようにしている。 FIG. 12 is a diagram illustrating the contact determination after the posture change. Subsumption contour illustrated 510, the reference circle 501 having a diameter of R 0, is obtained by adding the projection of the contour of the portion projecting from the diameter R 0. That is, by expressing the protruding portion with an actual geometrical shape, the relative position with respect to the obstacle can be strictly determined.

姿勢計画部204は、接触区間Dを微小区間ごとに区切って、その区間ごとに包摂外形510が障害物と接触しないかを判定する。ある区間で接触すると判定した場合は、その微小区間の開始地点で再度姿勢変化を行えばその障害物を回避できるかを試みる。この演算を繰り返し、姿勢変化を伴えば接触区間Dを通過できるか否かを判定する。 The posture planning unit 204 divides the contact section D 1 into minute sections, and determines for each section whether the inclusion contour 510 does not contact the obstacle. When it is determined that the obstacle is contacted in a certain section, it is tried to avoid the obstacle by changing the posture again at the start point of the minute section. By repeating this calculation, it is determined whether or not the contact section D 1 can be passed if the posture is changed.

そして、通過できると判定したら、いずれの地点でどのような姿勢変化を実行させるかを確定させ、これを台車の走行制御に伴う、障害物を回避する回避動作として策定する。接触区間においてこのような回避動作が策定できれば、制御部200は、姿勢変化を行わない接触区間以外の区間の走行計画と合わせて、移動ロボット100を目標地点612に到達させることができると判断できる。なお、上記の例では、始動地点611から目標地点612までの経路上に一つの接触区間Dが存在する例を示したが、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 control unit 200 can determine that the mobile robot 100 can reach the target point 612 in combination with the travel plan of the section other than the contact section in which the posture is not changed. .. In the above example, one contact section D 1 exists on the route from the starting point 611 to the target point 612, but two or more contact sections may exist. In that case, try to determine whether the avoidance action can be formulated for each section.

また、上記の例では、接触区間の例として直線区間を紹介したが、接触区間は、もちろん右折箇所、左折箇所、曲線区間などを含んでも良い。進行方向が変化する場合は、把持部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 trolley unit 110 rather than changing the posture of the grip unit 120. The posture planning unit 204 may formulate the avoidance motion in consideration of the traveling control.

次に、移動ロボット100の移動計画の生成から実行に至る処理について説明する。図13は、移動ロボット100の処理手順を示すフロー図である。フローは、移動ロボット100が、始動地点に停止している状態から開始する。   Next, a process from generation to execution of the movement plan of the mobile robot 100 will be described. FIG. 13 is a flowchart showing the processing procedure of the mobile robot 100. The flow starts when the mobile robot 100 is stopped at the starting point.

経路計画部202は、ステップS101において、環境地図DB241から環境地図を読み込み、メモリ240から基準円の径Rを読み込んで、幅Rを基準として目標地点に到達する移動経路を確立できるかを探索する。移動経路が確立できないと判断したら、そもそも搬送物を把持していないとしても目標地点に到達できないので、ステップS102へ進み、到達不能である旨の告知を行う。到達不能告知は、例えば、音声で告知したり、ユーザが所持する端末に画像を表示したりする。移動ロボット100は、到達不能告知を行ったら、移動を開始することなく一連の処理を終了させる。 In step S101, the route planning unit 202 reads the environment map from the environment map DB 241, reads the diameter R 0 of the reference circle from the memory 240, and determines whether a movement route to reach the target point can be established with the width R 0 as a reference. Explore. If it is determined that the movement route cannot be established, the target point cannot be reached even if the transported object is not gripped in the first place, so the process proceeds to step S102 and a notification that the destination cannot be reached is issued. The unreachability notification may be, for example, a voice notification or an image displayed on the terminal owned by the user. The mobile robot 100 ends the series of processes without starting the movement when the unreachability notification is made.

ステップ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 control unit 200 holds the conveyed object via the arm unit 220. Then, the conveyed product recognition unit 203 executes outer shape recognition such as the size and position of the conveyed product via the sensor unit 230.

ステップS104へ進み、制御部200は、把持部120が搬送物を把持した状態で、その射影が基準円の半径R内に収まるか否かを判断する。収まると判断した場合は、ステップS105へ進み、幅Rによる移動経路を決定する。なお、上述のように、幅Rの移動経路が複数見出された場合は、評価基準に従って一つの経路が決定される。移動経路が決定されたら、ステップS106へ進み、その経路に沿って移動し、目標地点に到達したら一連の処理を終了する。 In step S104, the control unit 200 determines whether or not the projection is within the radius R 0 of the reference circle with the gripping unit 120 gripping the conveyed object. When it is determined that the width is within the range, the process proceeds to step S105, and the movement route with the width R 0 is determined. In addition, as described above, when a plurality of movement routes having the width R 0 are found, one route is determined according to the evaluation standard. When the moving route is determined, the process proceeds to step S106, the vehicle moves along the route, and when the target point is reached, the series of processes is ended.

ステップS104で半径R内に収まらないと判断した場合は、ステップS107で、搬送物認識部203は、把持部120の姿勢を変化させつつ判定円とその直径Rを決定する。なお、この処理は、ステップS103の段階で纏めて行っても良い。 When it is determined in step S104 that the radius does not fall within the radius R 0 , the conveyed object recognition unit 203 determines the determination circle and its diameter R 1 while changing the posture of the gripping unit 120 in step S107. It should be noted that this process may be collectively performed at the stage of step S103.

ステップS108へ進み、経路計画部202は、環境地図を参照し、幅Rを基準として目標地点に到達する移動経路を確立できるかを探索する。移動経路を確立できたら、ステップS109へ進み、幅Rによる移動経路を決定する。なお、幅Rの移動経路が複数見出された場合は、評価基準に従って一つの経路が決定される。移動経路が決定されたら、ステップS106へ進み、その経路に沿って移動し、目標地点に到達したら一連の処理を終了する。 In step S108, the route planning unit 202 refers to the environment map and searches for a movement route that reaches the target point based on the width R 1 as a reference. When the movement route can be established, the process proceeds to step S109, and the movement route with the width R 1 is determined. In addition, when a plurality of movement routes having the width R 1 are found, one route is determined according to the evaluation standard. When the moving route is determined, the process proceeds to step S106, the vehicle moves along the route, and when the target point is reached, the series of processes is ended.

ステップS108において、幅Rを基準とした移動経路を確立できなかったら、ステップS110へ進み、接触判定部201は、経路計画部202がステップS101で探索した幅Rを基準とした移動経路の一つを検証対象として選択する。一つしか存在しない場合は、その移動経路を検証対象とする。そして、ステップS111において、図10を用いて説明したように、直径Rの判定円を検証対象となる移動経路に沿って掃引させて障害物との接触地点および接触区間を同定する。接触判定部201は、ステップS112へ進み、接触地点、および接触区間を微小区間ごとに区切った各々の地点に対して、姿勢変化によって障害物との衝突を回避できるかを試みる。回避できないと判定したら、ステップS113へ進み、接触判定部201は、経路計画部202がステップS101で探索した幅Rを基準とした移動経路の全てを検証したかを確認する。まだ全てを検証していない場合は、ステップ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 contact determination unit 201 determines the movement route based on the width R 0 searched by the route planning unit 202 in step S101. Select one for verification. If there is only one, the movement route is subject to verification. Then, in step S111, as described with reference to FIG. 10, the determination circle having the diameter R 1 is swept along the movement path to be verified to identify the contact point and the contact section with the obstacle. The contact determination unit 201 proceeds to step S112, and tries whether or not the contact point and each point obtained by dividing the contact section into minute sections can avoid a collision with an obstacle due to a change in posture. When it is determined that it cannot be avoided, the process proceeds to step S113, and the contact determination unit 201 confirms whether the route planning unit 202 has verified all the moving routes based on the width R 0 searched in step S101. If all have not been verified yet, the process returns to step S110 and steps S110 to S112 are repeated. On the other hand, when all the verifications have been completed, the process proceeds to step S102, the notification of unreachability is given as described above, and the series of processes is ended.

ステップ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 control unit 200 moves along the movement route while changing the posture according to the avoidance motion determined in the contact section, and ends the series of processes when reaching the target point.

以上説明したように、移動ロボット100が自律移動して搬送物を目標地点まで運ぶ場合に、移動ロボット100の射影から形成される基準円または判定円で移動経路を確定できるのであれば、経路探索のための演算量も少なく、円滑な自律移動を実現できる。この場合は、移動中の姿勢変化も考慮しなくて良いので、走行制御も容易である。一方、判定円の掃引によっても移動経路を確定できない場合は、経路上の接触地点を同定し、搬送物を把持しつつ姿勢を変化させることで障害物との接触を回避するので、狭い幅の経路も通過させることができる。すなわち、円の掃引では移動経路を探索できない場合でも、目標地点までの経路を確保することができる。また、接触地点における姿勢変化は、移動ロボット100の外形の実際的形状を用いて演算するので演算量は増大するが、実際的形状を用いて移動経路の全体を演算するよりは演算量が少なくなる。演算量を少なくできると、特に連続的に目標地点を設定して長い距離を移動するような場合に、演算のための移動停止を抑制できたり、移動速度を向上できたりする。   As described above, when the mobile robot 100 autonomously moves to carry a conveyed object to a target point, if the movement route can be determined by the reference circle or the determination circle formed from the projection of the mobile robot 100, the route search is performed. There is little calculation amount for, 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. That is, even if the movement route cannot be searched for by sweeping the circle, the route to the target point can be secured. Further, since the posture change at the contact point is calculated by using the actual shape of the outer shape of the mobile robot 100, the amount of calculation is increased, but the amount of calculation is smaller than that when the entire movement path is calculated using the actual shape. Become. If the amount of calculation can be reduced, movement stop for calculation can be suppressed or the moving speed can be improved, especially when a target point is continuously set and moving a long distance.

以上説明した実施形態において示した装置、システム、プログラム、および方法における動作、手順、ステップ、および段階等の各処理の実行順序は、特段「より前に」、「先立って」等と明示しておらず、また、前の処理の出力を後の処理で用いるのでない限り、任意の順序で実現し得る。便宜上「まず、」、「次に、」等を用いて説明したとしても、この順で実施することが必須であることを意味するものではない。   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.
JP2016121600A 2016-06-20 2016-06-20 Mobile robot movement route planning method Active JP6693291B2 (en)

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)

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

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

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