JP2018147079A - Control method of autonomous mobile robot - Google Patents

Control method of autonomous mobile robot Download PDF

Info

Publication number
JP2018147079A
JP2018147079A JP2017039218A JP2017039218A JP2018147079A JP 2018147079 A JP2018147079 A JP 2018147079A JP 2017039218 A JP2017039218 A JP 2017039218A JP 2017039218 A JP2017039218 A JP 2017039218A JP 2018147079 A JP2018147079 A JP 2018147079A
Authority
JP
Japan
Prior art keywords
location
route
place
mobile robot
autonomous mobile
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.)
Granted
Application number
JP2017039218A
Other languages
Japanese (ja)
Other versions
JP6848532B2 (en
Inventor
佳昭 朝原
Yoshiaki Asahara
佳昭 朝原
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 JP2017039218A priority Critical patent/JP6848532B2/en
Publication of JP2018147079A publication Critical patent/JP2018147079A/en
Application granted granted Critical
Publication of JP6848532B2 publication Critical patent/JP6848532B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

PROBLEM TO BE SOLVED: To be able to suppress reduction in work efficiency of a robot.SOLUTION: The control method of the autonomous mobile robot comprises: determining whether or not a second object being an obstacle to the movement exists on a traveling route for moving the first object to a corresponding first settling place (S104 ); upon determination that the second object exists on the route, planning a traveling route for moving from the position of the second object to a second settling place corresponding to the second object, planning a traveling route from a preset predetermined position to a settling place, setting a temporary placement place in a place excluding the planned traveling route to the second settling place and a route passing a predetermined number of times or more in a traveling route to be planned from the predetermined position to the settling place (S105); temporarily placing the first object at the temporary placement place (S106); and settling the second object at the second settling place, and after that, settling the first object from the temporary placement place, at the first settling place.SELECTED DRAWING: Figure 14

Description

本発明は、自律移動ロボットの制御方法に関する。   The present invention relates to a method for controlling an autonomous mobile robot.

経路上に障害物が存在する場合に、障害物の経路外への除去を外部に依頼する技術が知られている(例えば、特許文献1参照)。   A technique for requesting the outside to remove an obstacle outside the route when an obstacle is present on the route is known (see, for example, Patent Document 1).

国際公開第2009/090807号International Publication No. 2009/090807

上記技術においては、経路上に障害物が存在する場合に外部に依頼する必要がある。この依頼の間、ロボットの作業が中断され、ロボットの作業効率が低下する虞がある。   In the above technique, it is necessary to request the outside when there is an obstacle on the route. During this request, the work of the robot is interrupted, and the work efficiency of the robot may be reduced.

本発明は、かかる課題を解決するためになされたものであり、ロボットの作業効率の低下を抑制できる自律移動ロボットの制御方法を提供することを主たる目的とする。   The present invention has been made in order to solve such a problem, and a main object of the present invention is to provide a method for controlling an autonomous mobile robot that can suppress a decrease in work efficiency of the robot.

上記目的を達成するための本発明の一態様は、
対象物と該対象物に対応付けられた片付け場所が設定された地図データを記憶する記憶手段と、該記憶手段の地図データ上で移動経路を計画する経路計画手段と、前記対象物を検出する検出手段と、を備え、該経路計画手段により計画された移動経路に従って移動し、前記検出手段により検出された対象物を前記地図データの片付け場所に移動させる自律移動ロボットの制御方法であって、
第1の前記対象物を対応する第1の前記片付け場所へ移動させる移動経路上に該移動の障害となる第2の前記対象物が存在するか否かを判定するステップと、
前記経路経路上に第2の対象物が存在すると判定した場合、前記第2の対象物の位置から該第2の対象物に対応する第2の片付け場所まで移動させる移動経路を計画するステップと、
前記地図データ上に設定された少なくとも1つの所定位置から前記片付け場所までの移動経路を夫々計画するステップと、
前記地図データ上において、前記計画した第2の片付け場所までの移動経路、および、前記所定位置から片付け場所までの移動経路を計画した場合に所定回数以上通過する経路、を除いた場所に、仮置き場所を設定するステップと、
前記設定した仮置き場所に前記第1の対象物を仮置きし、前記第2の対象物を対応する前記第2の片付け場所へ片付けるステップと、
前記第2の対象物を第2の片付け場所へ片付けた後、前記仮置きした第1の対象物を対応する第1の片付け場所に片付けるステップと、
を含む、自律移動ロボットの制御方法
である。
In order to achieve the above object, one embodiment of the present invention provides:
Storage means for storing map data in which a target object and a tidying location associated with the target object are set, path planning means for planning a movement route on the map data in the storage means, and detecting the target object A method for controlling an autonomous mobile robot, comprising: detecting means; moving according to a moving route planned by the route planning means; and moving an object detected by the detecting means to a place where the map data is cleared.
Determining whether there is a second object that obstructs the movement on a movement path that moves the first object to the corresponding first clean-up location;
Planning a movement path for moving from the position of the second object to a second tidying location corresponding to the second object when it is determined that a second object exists on the path path; ,
Planning each movement route from at least one predetermined position set on the map data to the tidying place;
On the map data, temporary locations other than the planned travel route to the second clean-up location and the route that passes a predetermined number of times when the travel route from the predetermined position to the clean-up location is planned A step to set the location,
Temporarily placing the first object in the set temporary placement location and cleaning the second object to the corresponding second cleanup location;
Clearing the second target object to a second clean-up location, and then cleaning the temporarily placed first target object to the corresponding first clean-up location;
This is a method for controlling an autonomous mobile robot.

本発明によれば、ロボットの作業効率の低下を抑制できる自律移動ロボットの制御方法を提供することができる。   ADVANTAGE OF THE INVENTION According to this invention, the control method of the autonomous mobile robot which can suppress the fall of the working efficiency of a robot can be provided.

本発明の実施形態1に係る自律移動ロボットの構成を示す外観図である。It is an external view which shows the structure of the autonomous mobile robot which concerns on Embodiment 1 of this invention. 本発明の実施形態1に係る自律移動ロボットの概略的なシステム構成を示すブロック図である。1 is a block diagram illustrating a schematic system configuration of an autonomous mobile robot according to a first embodiment of the present invention. 本発明の実施形態1に係る制御装置の概略的なシステム構成を示すブロック図である。It is a block diagram which shows the schematic system configuration | structure of the control apparatus which concerns on Embodiment 1 of this invention. 自律移動ロボットが部屋内を巡回し第1乃至第3の対象物を探索する状態を示す図である。It is a figure which shows the state in which an autonomous mobile robot searches the 1st thru | or 3rd target object in the room. 環境センサが最初に第1の対象物を検出した状態を示す図である。It is a figure which shows the state which the environmental sensor detected the 1st target object initially. 移動経路上に移動の障害となる第2の対象物が存在する状態を示す図である。It is a figure which shows the state in which the 2nd target object which becomes a movement obstruction exists on a movement path | route. (a)現在位置から棚Bまでの移動経路を示す図である。(b)現在位置から棚Bまでの移動経路に対応するグリッドを示す図である。(A) It is a figure which shows the movement path | route from the present position to the shelf B. FIG. (B) It is a figure which shows the grid corresponding to the movement path | route from the present position to the shelf B. FIG. (a)各所定位置から各棚A〜Cまでの移動経路を示す図である。(b)各所定位置から各棚A〜Cまでの移動経路に対応するグリッドを示す図である。(A) It is a figure which shows the movement path | route from each predetermined position to each shelf AC. (B) It is a figure which shows the grid corresponding to the movement path | route from each predetermined position to each shelf AC. 仮置き場所候補領域のグリッドを示す図である。It is a figure which shows the grid of a temporary placement location candidate area | region. 仮置き場所候補領域の中で棚Aの最寄の仮置き場所を示す図である。It is a figure which shows the nearest temporary placement location of the shelf A in a temporary placement location candidate area | region. 仮置き場所へ第1の対象物を配置した状態を示す図である。It is a figure which shows the state which has arrange | positioned the 1st target object to the temporary placement place. 棚Bへ第2の対象物を配置した状態を示す図である。It is a figure which shows the state which has arrange | positioned the 2nd target object to the shelf. 棚Cへ第3の対象物を配置した状態を示す図である。It is a figure which shows the state which has arrange | positioned the 3rd target object to the shelf. 自律移動ロボットの制御方法のフローの一例を示すフローチャートである。It is a flowchart which shows an example of the flow of the control method of an autonomous mobile robot.

本発明の実施形態に係る自律移動ロボットの一例であるロボットの構成について、図1を用いて説明する。図1は、本発明の実施形態1に係る自律移動ロボットの構成を示す外観図である。本実施形態1に係る自律移動ロボットは、例えば、片付けを行う対象物(以下、対象物)を予め設定された片付け場所に移動させ、対象物を片付け場所に片付ける作業を自律的に行う。   A configuration of a robot that is an example of an autonomous mobile robot according to an embodiment of the present invention will be described with reference to FIG. FIG. 1 is an external view showing a configuration of an autonomous mobile robot according to Embodiment 1 of the present invention. For example, the autonomous mobile robot according to the first embodiment autonomously performs an operation of moving a target object to be cleaned (hereinafter referred to as a target object) to a predetermined cleaning position and cleaning the target object to the cleaning position.

図2は、本発明の実施形態1に係る自律移動ロボットの概略的なシステム構成を示すブロック図である。本実施形態に係る自律移動ロボット1は、ロボット本体2と、ロボット本体2を移動させる移動装置3と、物体を把持し移動させる把持操作装置4と、移動装置3及び把持操作装置4を制御する制御装置5と、環境センサ6と、を備えている。   FIG. 2 is a block diagram showing a schematic system configuration of the autonomous mobile robot according to the first embodiment of the present invention. The autonomous mobile robot 1 according to the present embodiment controls a robot body 2, a moving device 3 that moves the robot body 2, a gripping operation device 4 that grips and moves an object, and the moving device 3 and the gripping operation device 4. A control device 5 and an environmental sensor 6 are provided.

移動装置3は、制御装置5からの制御信号に応じて、例えば、モータなどを駆動させることで複数の車輪を回転させ、ロボット本体2を所望の位置に移動させる。   The moving device 3 rotates a plurality of wheels by driving a motor or the like, for example, according to a control signal from the control device 5, and moves the robot body 2 to a desired position.

把持操作装置4は、例えば、対象物を把持する把持部41と、手首関節、肘関節、肩関節などの関節部42を介して連結される複数のリンク43と、各関節部42を駆動するモータなどの複数のアクチュエータと、からなる多関節型アームとして構成されている。   The grip operation device 4 drives, for example, a grip portion 41 that grips an object, a plurality of links 43 that are connected via joint portions 42 such as a wrist joint, an elbow joint, and a shoulder joint, and each joint portion 42. It is configured as an articulated arm comprising a plurality of actuators such as motors.

制御装置5は、例えば、操作端末7を介して入力された操作信号に基づいて移動装置3及び把持操作装置4を制御することで、自律移動ロボット1に作業を実行させる。操作端末7は、例えば、タブレット端末、PC(Personal Computer)、スマートフォンなどの携帯端末7である。操作端末7と制御装置5は、無線あるいは有線で通信接続されており、相互にデータの送受信を行う。   For example, the control device 5 controls the moving device 3 and the gripping operation device 4 based on the operation signal input via the operation terminal 7 to cause the autonomous mobile robot 1 to perform the work. The operation terminal 7 is, for example, a mobile terminal 7 such as a tablet terminal, a PC (Personal Computer), or a smartphone. The operation terminal 7 and the control device 5 are connected by wireless or wired communication, and exchange data with each other.

制御装置5は、例えば、制御処理、演算処理等を行うCPU(Central Processing Unit)5a、CPU5aによって実行される制御プログラム、演算プログラム等が記憶されたROM(Read Only Memory)やRAM(Random Access Memory)からなるメモリ5b、外部と信号の入出力を行うインターフェイス部(I/F)5c、などからなるマイクロコンピュータを中心にして、ハードウェア構成されている。CPU5a、メモリ5b、及びインターフェイス部5cは、データバスなどを介して相互に接続されている。   The control device 5 includes, for example, a CPU (Central Processing Unit) 5a that performs control processing, arithmetic processing, and the like, a ROM (Read Only Memory) or a RAM (Random Access Memory) that stores a control program executed by the CPU 5a, an arithmetic program, and the like. ), And a microcomputer including an interface unit (I / F) 5c for inputting / outputting signals to / from the outside. The CPU 5a, the memory 5b, and the interface unit 5c are connected to each other via a data bus or the like.

環境センサ6は、検出手段の一具体例である。環境センサ6は、ロボット1周囲の対象物などの環境情報(距離情報、画像情報など)を検出する。環境センサ6は、例えば、ロボット1の頭部などに搭載されているが、これに限られない。環境センサ6は、ロボット1が動作する動作環境内に設置されていてもよい。さらに、環境センサ6は、ロボット1及び動作環境内に複数設けられていてもよい。環境センサ6は、例えば、カメラ(RGB−Dカメラ、ステレオカメラ)、レーザレンジファインダ、超音波センサなどの距離センサである。   The environment sensor 6 is a specific example of a detection unit. The environmental sensor 6 detects environmental information (distance information, image information, etc.) such as objects around the robot 1. The environment sensor 6 is mounted on the head of the robot 1 or the like, for example, but is not limited thereto. The environment sensor 6 may be installed in an operating environment in which the robot 1 operates. Further, a plurality of environment sensors 6 may be provided in the robot 1 and the operating environment. The environment sensor 6 is a distance sensor such as a camera (RGB-D camera, stereo camera), a laser range finder, an ultrasonic sensor, or the like.

環境センサ6は、自律移動ロボット1が移動経路を移動する際の移動経路上の対象物などの障害物を検出する。環境センサ6は、検出した障害物などの環境情報を制御装置5に出力する。   The environment sensor 6 detects an obstacle such as an object on the movement path when the autonomous mobile robot 1 moves along the movement path. The environmental sensor 6 outputs environmental information such as the detected obstacle to the control device 5.

制御装置5は、自律移動ロボット1が移動する移動経路を計画し、その移動経路に沿って自律移動ロボット1が移動するよう、移動装置3を制御する。もちろん、自律移動ロボット1は車輪型の移動ロボットに限らず、歩行型やその他の移動ロボットでもよい。制御装置5は、例えば、環境センサ6により検出された環境情報に基づいて、自律移動ロボット1の自己位置推定を行い、計画した移動経路に従って自律移動ロボット1を移動させる。   The control device 5 plans a moving route along which the autonomous mobile robot 1 moves, and controls the moving device 3 so that the autonomous mobile robot 1 moves along the moving route. Of course, the autonomous mobile robot 1 is not limited to a wheel-type mobile robot, and may be a walking type or other mobile robot. For example, the control device 5 estimates the self-location of the autonomous mobile robot 1 based on the environment information detected by the environment sensor 6, and moves the autonomous mobile robot 1 according to the planned travel route.

ところで、従来の自律移動ロボットは、対象物を設定された片付け場所に移動させ、片付け場所に片付ける際、別の対象物が障害となる場合もある。その場合、その対象物を片付け場所に片付けられず、自律移動ロボットの作業が中断され、作業効率が低下する虞がある。   By the way, when a conventional autonomous mobile robot moves an object to a set-up place and puts it away at the set-up place, another object may become an obstacle. In that case, the object cannot be cleaned up at the clean-up location, the work of the autonomous mobile robot is interrupted, and the work efficiency may be reduced.

これに対し、本実施形態1に係る制御装置5は、図3に示す如く、対象物と該対象物に対応付けられた片付け場所が設定された地図データを記憶する記憶部51と、第1の対象物を対応する第1の片付け場所へ移動させる移動経路上に該移動の障害となる第2の対象物が存在するか否かを判定する障害判定部52と、障害判定部52により経路経路上に第2の対象物が存在すると判定された場合、第2の対象物の位置(自律移動ロボット1が第2の対象物を把持した位置)から第2の対象物に対応する第2の片付け場所まで移動させる自律移動ロボット1の移動経路を計画し、地図データ上に設定された少なくとも1つの所定位置から片付け場所までの移動経路を夫々計画する経路計画部53と、記憶部51の地図データ上において、計画した第2の片付け場所までの移動経路、および、所定位置から片付け場所までの移動経路を計画した場合に予め定めておいた所定回数以上通過することとなる経路、を除いた場所に、仮置き場所を設定する仮置き場所設定部54と、設定した仮置き場所に第1の対象物を仮置きし、第2の対象物を対応する第2の片付け場所へ片付け、第2の対象物を第2の片付け場所へ片付けた後、仮置きした第1の対象物を対応する第1の片付け場所に片付けるように自律移動ロボット1を制御する制御部55と、を備えている。   On the other hand, as shown in FIG. 3, the control device 5 according to the first embodiment includes a storage unit 51 that stores map data in which a target object and a tidying location associated with the target object are set, and a first A fault determination unit 52 that determines whether or not there is a second target that is an obstacle to the movement on the movement path for moving the target object to the corresponding first clean-up location, and the path by the fault determination unit 52 When it is determined that the second object is present on the route, the second object corresponding to the second object from the position of the second object (position where the autonomous mobile robot 1 grips the second object). A route planning unit 53 for planning a movement route of the autonomous mobile robot 1 to be moved to a clean-up location, and planning a travel route from at least one predetermined position set on the map data to the clean-up location, and a storage unit 51 Plan on the map data Temporary storage location except for the route to the second clean-up location and the route that will pass a predetermined number of times when the travel route from the predetermined position to the clean-up location is planned A temporary placement location setting unit 54 for setting the first target object, temporarily placing the first object in the set temporary placement location, cleaning the second target object to the corresponding second cleanup location, And a control unit 55 that controls the autonomous mobile robot 1 so that the temporarily placed first target object is cleaned up at the corresponding first cleaning-up place after cleaning up to the two cleaning-up positions.

これにより、経路経路上に第2の対象物が存在し、障害となる場合でも、仮置き場所を設定し、設定した仮置き場所に第1の対象物を仮置きし、先に、第2の対象物を対応する第2の片付け場所へ片付け、第2の対象物を第2の片付け場所へ片付けた後、仮置きした第1の対象物を対応する第1の片付け場所に片付ける。したがって、第1の対象物を第1片付け場所に片付けられず、自律移動ロボット1の作業が中断されるということがないため、作業効率の低下を抑制できる。   As a result, even when the second object exists on the route path and becomes an obstacle, the temporary place is set, the first object is temporarily placed in the set temporary place, The target object is cleaned up at the corresponding second clean-up location, the second target object is cleaned up at the second clean-up location, and then the temporarily placed first target object is cleaned up at the corresponding first clean-up location. Accordingly, since the first object is not cleaned up at the first cleaning place and the work of the autonomous mobile robot 1 is not interrupted, it is possible to suppress a decrease in work efficiency.

記憶部51は、記憶手段の一具体例である。記憶部51は、例えば、上記ROMやRAMなどで構成されている。地図データは、例えば、複数の格子状のグリッドにより構成されており、各対象物に対応付けられた各片付け場所が設定されている。   The storage unit 51 is a specific example of a storage unit. The storage unit 51 is configured by, for example, the ROM or RAM. The map data is composed of, for example, a plurality of grids, and each tidying location associated with each object is set.

例えば、地図データにおいて、第1の対象物aは、第1の片付け場所である棚Aに対応付けられており、第2の対象物bは、第2の片付け場所である棚Bに対応付けられており、第3の対象物cは、第3の片付け場所である棚Cに対応付けられている。   For example, in the map data, the first object a is associated with the shelf A that is the first tidying place, and the second object b is associated with the shelf B that is the second tidying place. The third object c is associated with a shelf C that is a third tidying place.

経路計画部53は、経路計画手段の一具体例である。経路計画部53は、記憶部51の地図データ上で自律移動ロボット1の移動経路を計画する。経路計画部53は、記憶部51の地図データに基づいて、例えば、周知の経路探索アルゴリズムを用いて、障害物などを回避した最短距離となる、自律移動ロボット1の移動経路を計画する。   The route planning unit 53 is a specific example of route planning means. The route planning unit 53 plans the movement route of the autonomous mobile robot 1 on the map data in the storage unit 51. Based on the map data stored in the storage unit 51, the route plan unit 53 plans a travel route of the autonomous mobile robot 1 that is the shortest distance avoiding an obstacle or the like using, for example, a well-known route search algorithm.

制御部55は、経路計画部53により計画された移動経路に従って自律移動ロボット1が移動するように、移動装置3を制御することで、対象物を地図データの片付け場所である棚A〜Cに移動させる。   The control unit 55 controls the moving device 3 so that the autonomous mobile robot 1 moves according to the movement route planned by the route planning unit 53, so that the objects are placed on the shelves A to C, which are the places where the map data is cleared. Move.

例えば、図4に示す如く、自律移動ロボット1が、対象物の片付け作業を開始すると、制御部55は、環境センサ6により検出された障害物などの情報に基づいて、部屋内等を巡回し第1乃至第3の対象物a〜cを探索するように自律移動ロボット1の移動装置3を制御する。   For example, as shown in FIG. 4, when the autonomous mobile robot 1 starts the object cleaning work, the control unit 55 circulates in the room or the like based on information such as an obstacle detected by the environment sensor 6. The moving device 3 of the autonomous mobile robot 1 is controlled so as to search for the first to third objects a to c.

図5に示す如く、環境センサ6が、最初に第1の対象物aを検出すると、制御部55は環境センサ6により検出された第1の対象物aを把持するように把持操作装置4を制御する。経路計画部53は、その環境センサ6により検出された第1の対象物aの情報と、記憶部51の地図データと、に基づいて、現在位置から第1の対象物aに対応付けられた第1の片付け場所までの移動経路を計画する。制御部55は、経路計画部53により計画された移動経路に従って自律移動ロボット1が移動するように、移動装置3を制御する。   As shown in FIG. 5, when the environment sensor 6 first detects the first object a, the control unit 55 moves the grasping operation device 4 so as to grasp the first object a detected by the environment sensor 6. Control. The route planning unit 53 is associated with the first object a from the current position based on the information on the first object a detected by the environment sensor 6 and the map data in the storage unit 51. Plan a travel route to the first clean-up location. The control unit 55 controls the moving device 3 so that the autonomous mobile robot 1 moves according to the moving route planned by the route planning unit 53.

この移動過程で、障害判定部52は、例えば、環境センサ6により検出された対象物の情報に基づいて、第1の対象物aを対応する棚(第1の片付け場所)Aへ移動させる移動経路上に該移動の障害となる第2の対象物b(又は第3の対象物c)が存在するか否かを判定する。図6に示す如く、棚Aの前に第2の対象物bが存在するため、障害判定部52は、環境センサ6により検出された対象物bの情報に基づいて、第1の対象物aを棚Aへ移動させる移動経路上に該移動の障害となる第2の対象物bが存在すると判定する。   In this movement process, the failure determination unit 52 moves, for example, the first object a to the corresponding shelf (first tidying place) A based on the object information detected by the environment sensor 6. It is determined whether or not the second object b (or the third object c) that obstructs the movement exists on the route. As shown in FIG. 6, since the second object b exists in front of the shelf A, the failure determination unit 52 determines the first object a based on the information on the object b detected by the environment sensor 6. It is determined that there is a second object b that is an obstacle to the movement on the movement path for moving the object to the shelf A.

障害判定部52は、棚Aへの経路経路上に第2の対象物bが存在すると判定された場合、経路計画部53は、図7(a)に示す如く、自律移動ロボット1が第2対象物bを把持した現在位置から第2の対象物bに対応する棚(第2の片付け場所)Bまで移動させる移動経路を計画する。   When the failure determination unit 52 determines that the second object b exists on the route route to the shelf A, the route planning unit 53 determines that the autonomous mobile robot 1 is the second one as shown in FIG. A movement path for moving from the current position where the object b is gripped to the shelf (second tidying place) B corresponding to the second object b is planned.

さらに、経路計画部53は、障害判定部52により棚Aへの経路経路上に第2の対象物bが存在すると判定された場合、図8(a)に示す如く、地図データ上に設定された複数の所定位置P1〜P6から各棚(片付け場所)A〜Cまでの移動経路を夫々計画する。なお、図8(a)において、設定された所定位置は6点であるが、これに限定されず、例えば、数十点〜数百点の所定位置が設定されてもよい。なお、設定される所定位置の数が増加するほど、対象物を対応する片付け場所に片付ける際に邪魔になり難い仮置き場所を精度よく設定できるが、経路計画時の計算量が増加する。したがって、精度と計算量が両立できる所定位置の数を実験的に求め設定されている。   Further, when the failure determination unit 52 determines that the second object b exists on the route route to the shelf A, the route plan unit 53 is set on the map data as shown in FIG. Further, the movement paths from the plurality of predetermined positions P1 to P6 to the respective shelves (cleaning places) A to C are planned. In FIG. 8A, the set predetermined positions are six points, but the present invention is not limited to this, and for example, predetermined positions of several tens to several hundred points may be set. In addition, as the number of predetermined positions to be set increases, a temporary storage place that is less likely to become an obstacle when the object is placed in a corresponding clean-up place can be set with high accuracy, but the amount of calculation at the time of route planning increases. Therefore, the number of predetermined positions at which both accuracy and calculation amount are compatible is experimentally determined and set.

経路計画部53は、地図データ上に設定された各所定位置P1〜P6から、任意に選択した各棚A〜Cまでの移動経路を夫々計画する。   The route planning unit 53 plans a moving route from each predetermined position P1 to P6 set on the map data to each arbitrarily selected shelf AC.

仮置き場所設定部54は、記憶部51の地図データ上において、経路計画部53により計画された現在位置から棚Bまでの移動経路、および、各所定位置P1〜P6から各棚A〜Cまでの移動経路を計画した場合に所定回数以上通過する経路、を除いた場所に、仮置き場所を設定する。   On the map data in the storage unit 51, the temporary storage location setting unit 54 moves from the current position planned by the route planning unit 53 to the shelf B, and from each predetermined position P1 to P6 to each shelf A to C. When a moving route is planned, a temporary storage location is set in a location excluding a route that passes a predetermined number of times.

例えば、初期状態において、地図データの自律移動ロボット1が移動可能な各グリッドには0(白抜き部)が設定され、障害物等が存在し自律移動ロボット1が移動不可能な各グリッドに1(斜線部)が設定されている。仮置き場所設定部54は、図7(b)に示す如く、記憶部51の地図データ上において、経路計画部53により計画された現在位置から棚Bまでの移動経路に対応する、グリッドに1(斜線部)を設定する。同様に、仮置き場所設定部54は、図8(b)に示す如く、各所定位置P1〜P6から各棚A〜Cまでの移動経路を計画した場合に所定回数以上通過する経路に対応するグリッドに、1(斜線部)を設定する。なお、所定回数は、例えば、自律移動ロボット1の経路となる可能性が高くなると思われる通過回数を予め実験的に求め、記憶部51などに予め記憶されている。   For example, in the initial state, 0 (outlined portion) is set for each grid in which the autonomous mobile robot 1 of the map data can move, and 1 for each grid in which the autonomous mobile robot 1 cannot move due to an obstacle or the like. (Hatched area) is set. As shown in FIG. 7B, the temporary placement location setting unit 54 has a grid corresponding to the moving route from the current position to the shelf B planned by the route planning unit 53 on the map data in the storage unit 51. Set the shaded area. Similarly, as shown in FIG. 8B, the temporary placement location setting unit 54 corresponds to a route that passes a predetermined number of times or more when a moving route from each predetermined position P1 to P6 to each shelf A to C is planned. Set 1 (shaded area) to the grid. Note that the predetermined number of times, for example, is obtained in advance by experimentally obtaining the number of times of passage that is likely to be a route of the autonomous mobile robot 1, and is stored in advance in the storage unit 51 or the like.

仮置き場所設定部54は、図9に示す如く、地図データにおいて0が設定されている各グリッドを仮置き場所になり得る仮置き場所候補領域(斜線部)に設定する。   As shown in FIG. 9, the temporary placement location setting unit 54 sets each grid for which 0 is set in the map data as temporary placement location candidate areas (shaded portions) that can be temporary placement locations.

仮置き場所設定部54は、設定した仮置き場所候補領域の中から、例えば、図10に示す如く、第1の対象物aの現在位置から最寄りの位置を、第1の対象物aの仮置き場所(斜線部)に設定する。仮置き場所設定部54は、設定した仮置き場所候補領域の中から、第1の対象物aを把持するアームの現在位置から最寄りの位置を、第1の対象物aの仮置き場所に設定してもよい。これにより、迅速に、第1の対象物aを仮置き場所に配置することができる。   For example, as shown in FIG. 10, the temporary placement location setting unit 54 sets the nearest location from the current location of the first target a to the temporary location of the first target a. Set the location (shaded area). The temporary placement location setting unit 54 sets the nearest position from the current position of the arm that holds the first object a to the temporary placement location of the first object a from the set temporary placement location candidate areas. May be. Thereby, the 1st target object a can be arrange | positioned to a temporary placement place rapidly.

仮置き場所設定部54は、設定した仮置き場所候補領域の中から、第1の対象物aに対応する棚(第1の片付け場所)Aに最寄の位置を、第1の対象物aの仮置き場所に設定してもよい。これにより、第1の対象物aを仮置き場所から棚Aに最短距離で片付けることができる。   The temporary placement location setting unit 54 determines the position closest to the shelf (first clean-up location) A corresponding to the first target object a from the set temporary placement location candidate areas. It may be set as a temporary storage location. Thereby, the 1st target object a can be cleared to shelf A from the temporary placement place in the shortest distance.

制御部55は、図11に示す如く、環境センサ6により検出された障害物の情報に基づいて、仮置き場所設定部54に設定された仮置き場所へ、第1の対象物aを配置するように、自律移動ロボット1を制御する。   As shown in FIG. 11, the control unit 55 arranges the first object “a” at the temporary placement location set in the temporary placement location setting unit 54 based on the obstacle information detected by the environmental sensor 6. Thus, the autonomous mobile robot 1 is controlled.

制御部55は、環境センサ6により検出された第2の対象物bを把持するように把持操作装置4を制御する。経路計画部53は、その環境センサ6により検出された第2の対象物bの情報と、記憶部51の地図データと、に基づいて、第2の対象物bを把持した現在位置から第2の対象物bに対応付けられた棚Bまでの移動経路を計画する。制御部55は、経路計画部53により計画された移動経路に従って自律移動ロボット1が移動するように、移動装置3を制御する。   The control unit 55 controls the gripping operation device 4 so as to grip the second object b detected by the environment sensor 6. Based on the information on the second object b detected by the environment sensor 6 and the map data in the storage unit 51, the route planning unit 53 starts from the current position where the second object b is grasped. The movement route to the shelf B associated with the object b is planned. The control unit 55 controls the moving device 3 so that the autonomous mobile robot 1 moves according to the moving route planned by the route planning unit 53.

この移動過程で、障害判定部52は、例えば、環境センサ6により検出された対象物の情報に基づいて、第2の対象物bを対応する棚Bへ移動させる移動経路上に該移動の障害となる第3の対象物cが存在するか否かを判定する。図12に示す如く、棚Bの前に第3の対象物cが存在しないため、障害判定部52は、環境センサ6により検出された情報に基づいて、第2の対象物bを棚Bへ移動させる移動経路上に該移動の障害となる第3の対象物cが存在しないと判定する。したがって、制御部55は、環境センサ6により検出された障害物の情報に基づいて、棚Bへ、第2の対象物bを配置するように、把持操作装置4を制御する。   In this movement process, the obstacle determination unit 52, for example, based on the information on the object detected by the environment sensor 6, moves the second object b on the movement path to move to the corresponding shelf B. It is determined whether or not the third target object c exists. As shown in FIG. 12, since the third object c does not exist in front of the shelf B, the failure determination unit 52 moves the second object b to the shelf B based on the information detected by the environmental sensor 6. It is determined that there is no third object c that is an obstacle to the movement on the movement path to be moved. Therefore, the control unit 55 controls the grip operation device 4 so as to place the second object b on the shelf B based on the obstacle information detected by the environment sensor 6.

制御部55は環境センサ6により検出された第3の対象物cを把持するように把持操作装置4を制御する。経路計画部53は、記憶部51の地図データに基づいて、現在位置から第3の対象物cに対応付けられた棚Cまでの移動経路を計画する。制御部55は、経路計画部53により計画された移動経路に従って自律移動ロボット1が移動するように、移動装置3を制御する。   The control unit 55 controls the grip operation device 4 so as to grip the third object c detected by the environment sensor 6. The route plan unit 53 plans a travel route from the current position to the shelf C associated with the third object c based on the map data in the storage unit 51. The control unit 55 controls the moving device 3 so that the autonomous mobile robot 1 moves according to the moving route planned by the route planning unit 53.

この移動過程で、障害判定部52は、例えば、環境センサ6により検出された対象物の情報に基づいて、第3の対象物cを対応する棚Cへ移動させる移動経路上に該移動の障害となる対象物が存在するか否かを判定する。   In this movement process, the obstacle determination unit 52, for example, based on the information on the object detected by the environment sensor 6, moves the third object c to the corresponding shelf C on the movement route. It is determined whether or not a target object exists.

ここで、第2対象物bは、対応する棚Bに配置されているため、障害となる対象物になることはない。一方で第1の対象物aは、仮置き場所に配置されているが、仮置き場所は、上述の如く、現在位置から棚Cまでの移動経路、および、複数の所定位置から各棚A〜Cまでの移動経路を計画した場合に、通過頻度の高い経路、を除いた場所に設定されている。したがって、棚Cまでの移動経路上に、仮置き場所が設定される可能性は非常に低いため、第1の対象物aが障害となる可能性は非常に低い。   Here, since the 2nd target object b is arrange | positioned on the corresponding shelf B, it does not become a target object which becomes an obstacle. On the other hand, the first object “a” is arranged at the temporary placement location. As described above, the temporary placement location is the movement path from the current position to the shelf C and each shelf A to the plurality of predetermined positions. When the travel route to C is planned, it is set at a place excluding a route with a high passing frequency. Therefore, since the possibility that a temporary placement location is set on the moving route to the shelf C is very low, the possibility that the first object a becomes an obstacle is very low.

図13に示す如く、棚Cの前に対象物が存在しないため、障害判定部52は、環境センサ6により検出された情報に基づいて、第3の対象物cを棚Cへ移動させる移動経路上に該移動の障害となる対象物が存在しないと判定する。したがって、制御部55は、環境センサ6により検出された障害物の情報に基づいて、棚Cへ、第3の対象物cを配置するように、移動装置3及び把持操作装置4を制御する。   As shown in FIG. 13, since there is no object in front of the shelf C, the failure determination unit 52 moves the third object c to the shelf C based on the information detected by the environment sensor 6. It is determined that there is no target object that obstructs the movement. Therefore, the control unit 55 controls the moving device 3 and the grip operation device 4 so as to place the third object c on the shelf C based on the obstacle information detected by the environment sensor 6.

図14は、上述した自律移動ロボットの制御方法のフローの一例を示すフローチャートである。
自律移動ロボット1は、片付け作業を開始すると(ステップS101)、移動環境内の全領域を探索し、かつ、環境センサ6により検出された全対象物を対応する片付け場所に片付けたか否かを判断する(ステップS102)。
FIG. 14 is a flowchart illustrating an example of a flow of the above-described autonomous mobile robot control method.
When the autonomous mobile robot 1 starts a tidying operation (step S101), the autonomous mobile robot 1 searches all areas in the moving environment and determines whether all objects detected by the environment sensor 6 have been tidied up at a corresponding tidying place. (Step S102).

自律移動ロボット1は、移動環境内の全領域を探索し、かつ、環境センサ6により検出された全対象物を対応する片付け場所に片付けたと判断した場合(ステップS102のYES)、本制御処理を終了する。一方、自律移動ロボット1は、移動環境内の全領域を探索し、かつ、環境センサ6により検出された全対象物を対応する片付け場所に片付けていないと判断した場合(ステップS102のNO)、環境センサ6が対象物を検出したか否かを判断する(ステップS103)。   If the autonomous mobile robot 1 searches all areas in the mobile environment and determines that all objects detected by the environment sensor 6 have been cleaned up at the corresponding cleaning-up location (YES in step S102), the control process is performed. finish. On the other hand, when the autonomous mobile robot 1 searches all areas in the mobile environment and determines that all objects detected by the environment sensor 6 are not cleaned up at the corresponding cleaning-up place (NO in step S102), It is determined whether or not the environmental sensor 6 has detected an object (step S103).

環境センサ6が第1の対象物を検出した場合、(ステップS103のYES)、障害判定部52は、第1の対象物を対応する第1の片付け場所へ移動させる移動経路上に該移動の障害となる第2の対象物が存在するか否かを判定する(ステップS104)。環境センサ6が第1の対象物を検出しない場合、(ステップS103のNO)、上記(ステップS102)に戻る。   When the environmental sensor 6 detects the first object (YES in step S103), the failure determination unit 52 moves the first object on the movement path for moving the first object to the corresponding first clean-up location. It is determined whether or not there is a second object that becomes an obstacle (step S104). When the environmental sensor 6 does not detect the first object (NO in step S103), the process returns to the above (step S102).

障害判定部52は、移動経路上に該移動の障害となる第2の対象物が存在すると判定した場合(ステップS104のYES)、仮置き場所設定部54は、記憶部51の地図データ上において、経路計画部53により計画された現在位置から第2の片付け場所までの移動経路、および、予め設定された各所定位置から各片付け場所までの移動経路を計画した場合に所定回数以上通過する経路、を除いた場所に、仮置き場所を設定する(ステップS105)。   When the failure determination unit 52 determines that there is a second object that is an obstacle to the movement on the movement route (YES in step S104), the temporary storage location setting unit 54 displays the map data in the storage unit 51. , A route that passes a predetermined number of times when planning a moving route from the current position planned by the route planning unit 53 to the second tidying location, and a moving route from each preset predetermined position to each tidying location Temporary placement locations are set in places other than, (step S105).

制御部55は、環境センサ6により検出された障害物の情報に基づいて、仮置き場所設定部54に設定された仮置き場所へ、第1の対象物を配置するように、自律移動ロボット1を制御し(ステップS106)、上記(ステップS102)に戻る。   Based on the obstacle information detected by the environment sensor 6, the control unit 55 arranges the first target object at the temporary placement location set in the temporary placement location setting unit 54. (Step S106), and the process returns to the above (step S102).

障害判定部52は、移動経路上に該移動の障害となる第2の対象物が存在しないと判定した場合(ステップS104のNO)、第1の対象物を対応する第1の片付け場所に片付け、上記(ステップS102)に戻る。   When the failure determination unit 52 determines that there is no second object that is an obstacle to the movement on the movement route (NO in step S104), the failure determination unit 52 clears the first object to the corresponding first clean-up location. Return to the above (step S102).

以上、本実施形態に係る自律移動ロボット1の制御方法において、第1の対象物を対応する第1の片付け場所へ移動させる移動経路上に該移動の障害となる第2の対象物が存在するか否かを判定し、経路経路上に第2の対象物が存在すると判定した場合、自律移動ロボット1が第2の対象物を把持した現在位置から第2の対象物に対応する第2の片付け場所まで移動させる移動経路を計画し、地図データ上に設定された少なくとも1つの所定位置から片付け場所までの移動経路を夫々計画し、地図データ上において、計画した第2の片付け場所までの移動経路、および、所定位置から片付け場所までの移動経路を計画した場合に所定回数以上通過する経路、を除いた場所に、仮置き場所を設定し、設定した仮置き場所に第1の対象物を仮置きし、第2の対象物を対応する第2の片付け場所へ片付け、第2の対象物を第2の片付け場所へ片付けた後、仮置きした第1の対象物を対応する第1の片付け場所に片付ける。   As described above, in the control method of the autonomous mobile robot 1 according to the present embodiment, the second object that is an obstacle to the movement exists on the movement route that moves the first object to the corresponding first tidying place. And determining that there is a second object on the route route, the second position corresponding to the second object from the current position at which the autonomous mobile robot 1 grips the second object. Plan the movement route to move to the tidying location, plan the moving route from at least one predetermined position set on the map data to the tidying location, and move to the planned second tidying location on the map data A temporary placement location is set in a place other than the route and a route that passes a predetermined number of times when a movement route from a predetermined position to a clean-up location is planned, and the first object is placed in the set temporary placement location. Temporary placement The second object is cleaned up to the corresponding second clean-up location, the second target object is cleaned up to the second clean-up location, and then the temporarily placed first target object is placed in the corresponding first clean-up location. put away.

これにより、経路経路上に第2の対象物が存在し、障害となる場合でも、仮置き場所を設定し、設定した仮置き場所に第1の対象物を仮置きし、先に、第2の対象物を対応する第2の片付け場所へ片付け、第2の対象物を第2の片付け場所へ片付けた後、仮置きした第1の対象物を対応する第1の片付け場所に片付ける。したがって、第1の対象物を第1片付け場所に片付けられず、自律移動ロボット1の作業が中断されるということがないため、作業効率の低下を抑制できる。   As a result, even when the second object exists on the route path and becomes an obstacle, the temporary place is set, the first object is temporarily placed in the set temporary place, The target object is cleaned up at the corresponding second clean-up location, the second target object is cleaned up at the second clean-up location, and then the temporarily placed first target object is cleaned up at the corresponding first clean-up location. Accordingly, since the first object is not cleaned up at the first cleaning place and the work of the autonomous mobile robot 1 is not interrupted, it is possible to suppress a decrease in work efficiency.

なお、本発明は上記実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。   Note that the present invention is not limited to the above-described embodiment, and can be changed as appropriate without departing from the spirit of the present invention.

上記実施形態において、仮置き場所設定部54は、設定した仮置き場所候補領域の中から、第1の対象物aを把持している把持操作装置4の姿勢に基づいて、該把持操作装置4が第1の対象物aを最も配置し易い位置を、第1の対象物aの仮置き場所に設定してもよい。これにより、第1の対象物aを仮置き場所に、効率的に配置することができる。   In the above-described embodiment, the temporary placement location setting unit 54 determines the gripping operation device 4 based on the posture of the gripping operation device 4 that is gripping the first object a from the set temporary placement location candidate areas. However, the position where the first object a is most easily arranged may be set as a temporary placement place of the first object a. Thereby, the 1st target object a can be efficiently arranged in a temporary placement place.

なお、記憶部51の地図データにおいて、対象物の仮置き場所が予め設定されていてもよい。仮置き場所設定部54は、記憶部51に設定された地図データの仮置き場所の情報に基づいて、対象物の仮置き場所に設定してもよい。これにより、ユーザが意図した仮置き場所を設定できる。   In addition, in the map data of the memory | storage part 51, the temporary storage place of the target object may be preset. The temporary placement location setting unit 54 may set the temporary placement location of the object based on the information on the temporary placement location of the map data set in the storage unit 51. Thereby, the temporary storage place intended by the user can be set.

仮置き場所設定部54が、設定した仮置き場所候補領域内に仮置き場所を設定する際に、優先的に、予め設定された所定位置に仮置き場所を設定するように、所定位置に重み付けなどが設定されていてもよい。仮置き場所設定部54が、設定した仮置き場所候補領域内に対象物の仮置き場所を設定し、設定した仮置き場所に他の対象物が配置されていた場合、記憶部51などに予め設定された位置を、対象物の仮置き場所に設定してもよい。これにより、仮置き場所をより確実に設定できる。   When the temporary placement location setting unit 54 sets a temporary placement location in the set temporary placement location candidate area, the predetermined location is weighted so as to set the temporary placement location preferentially at a predetermined location. Etc. may be set. The temporary placement location setting unit 54 sets the temporary placement location of the object in the set temporary placement location candidate area, and when another target is placed in the set temporary placement location, the temporary storage location setting unit 54 stores the temporary placement location in advance in the storage unit 51 or the like. The set position may be set as a temporary place for the object. Thereby, a temporary storage place can be set more reliably.

上記実施形態において、制御部55は、第1の対象物を仮置き場所に配置した後、第2の対象物を対応する第2の片付け場所に配置し、最寄の第3の対象物を対応する第3の片付け場所に配置し、最後に、第1の対象物aを第1の片付き場所に配置するように自律移動ロボット1を制御しているが、これに限定されない。例えば、制御部55は、第1の対象物aを仮置き場所に配置した後、第2の対象物を対応する第2の片付け場所に配置し、第1の対象物aを第1の片付き場所に配置し、最後に、第3の対象物を対応する第3の片付け場所に配置するように自律移動ロボット1を制御してもよい。制御部55は、自律移動ロボット1の移動経路の和が最小となるように、第1及び第3の対象物のうちいずれを先に、対応する片付け場所に配置するかを決定してもよい。これにより、自律移動ロボット1は、対象物を最短の移動で片付けることができ、作業効率をより向上させることができる。   In the said embodiment, after arrange | positioning a 1st target object in a temporary placement place, the control part 55 arrange | positions a 2nd target object in the corresponding 2nd tidying place, and places the nearest 3rd target object. Although the autonomous mobile robot 1 is controlled so as to be disposed at the corresponding third clean-up location and finally the first object a is disposed at the first clean-up location, the present invention is not limited to this. For example, the control unit 55 arranges the first object a in the temporary placement place, then places the second object in the corresponding second tidying place, and places the first object a in the first piece. The autonomous mobile robot 1 may be controlled so as to be arranged at a place and finally to place the third object at a corresponding third tidying place. The control unit 55 may determine which of the first and third objects is first arranged at the corresponding tidying location so that the sum of the movement paths of the autonomous mobile robot 1 is minimized. . Thereby, the autonomous mobile robot 1 can clean up the object with the shortest movement, and can further improve the work efficiency.

自律移動ロボット1が事前に環境内を移動し、各対象物の探索を行い、各対象物の位置を検出した後、検出した各対象物の位置に基づいて、各対象物を片付ける順番を決定してもよい。   The autonomous mobile robot 1 moves in the environment in advance, searches for each object, detects the position of each object, and then determines the order in which each object is cleared based on the detected position of each object. May be.

本発明は、例えば、図14に示す処理を、CPUにコンピュータプログラムを実行させることにより実現することも可能である。   In the present invention, for example, the processing shown in FIG. 14 can be realized by causing a CPU to execute a computer program.

プログラムは、様々なタイプの非一時的なコンピュータ可読媒体(non-transitory computer readable medium)を用いて格納され、コンピュータに供給することができる。非一時的なコンピュータ可読媒体は、様々なタイプの実体のある記録媒体(tangible storage medium)を含む。非一時的なコンピュータ可読媒体の例は、磁気記録媒体(例えばフレキシブルディスク、磁気テープ、ハードディスクドライブ)、光磁気記録媒体(例えば光磁気ディスク)、CD−ROM(Read Only Memory)、CD−R、CD−R/W、半導体メモリ(例えば、マスクROM、PROM(Programmable ROM)、EPROM(Erasable PROM)、フラッシュROM、RAM(random access memory))を含む。   The program may be stored using various types of non-transitory computer readable media and supplied to a computer. Non-transitory computer readable media include various types of tangible storage media. Examples of non-transitory computer-readable media include magnetic recording media (for example, flexible disks, magnetic tapes, hard disk drives), magneto-optical recording media (for example, magneto-optical disks), CD-ROMs (Read Only Memory), CD-Rs, CD-R / W and semiconductor memory (for example, mask ROM, PROM (Programmable ROM), EPROM (Erasable PROM), flash ROM, RAM (random access memory)) are included.

プログラムは、様々なタイプの一時的なコンピュータ可読媒体(transitory computer readable medium)によってコンピュータに供給されてもよい。一時的なコンピュータ可読媒体の例は、電気信号、光信号、及び電磁波を含む。一時的なコンピュータ可読媒体は、電線及び光ファイバ等の有線通信路、又は無線通信路を介して、プログラムをコンピュータに供給できる。   The program may be supplied to the computer by various types of transitory computer readable media. Examples of transitory computer readable media include electrical signals, optical signals, and electromagnetic waves. The temporary computer-readable medium can supply the program to the computer via a wired communication path such as an electric wire and an optical fiber, or a wireless communication path.

1 自律移動ロボット、2 ロボット本体、3 移動装置、4 把持操作装置、5 制御装置、7 操作端末、41 把持部、42 関節部、43 リンク、51 記憶部、52 障害判定部、53 経路計画部、54 仮置き場所設定部、55 制御部 DESCRIPTION OF SYMBOLS 1 Autonomous mobile robot, 2 Robot main body, 3 Moving apparatus, 4 Grasp operation apparatus, 5 Control apparatus, 7 Operation terminal, 41 Grasp part, 42 Joint part, 43 Link, 51 Memory | storage part, 52 Fault determination part, 53 Path planning part , 54 Temporary storage location setting unit, 55 Control unit

Claims (1)

対象物と該対象物に対応付けられた片付け場所が設定された地図データを記憶する記憶手段と、該記憶手段の地図データ上で移動経路を計画する経路計画手段と、前記対象物を検出する検出手段と、を備え、該経路計画手段により計画された移動経路に従って移動し、前記検出手段により検出された対象物を前記地図データの片付け場所に移動させる自律移動ロボットの制御方法であって、
第1の前記対象物を対応する第1の前記片付け場所へ移動させる移動経路上に該移動の障害となる第2の前記対象物が存在するか否かを判定するステップと、
前記経路経路上に第2の対象物が存在すると判定した場合、前記第2の対象物の位置から該第2の対象物に対応する第2の片付け場所まで移動させる移動経路を計画するステップと、
前記地図データ上に設定された少なくとも1つの所定位置から前記片付け場所までの移動経路を夫々計画するステップと、
前記地図データ上において、前記計画した第2の片付け場所までの移動経路、および、前記所定位置から片付け場所までの移動経路を計画した場合に所定回数以上通過する経路、を除いた場所に、仮置き場所を設定するステップと、
前記設定した仮置き場所に前記第1の対象物を仮置きし、前記第2の対象物を対応する前記第2の片付け場所へ片付けるステップと、
前記第2の対象物を第2の片付け場所へ片付けた後、前記仮置きした第1の対象物を対応する第1の片付け場所に片付けるステップと、
を含む、自律移動ロボットの制御方法。
Storage means for storing map data in which a target object and a tidying location associated with the target object are set, path planning means for planning a movement route on the map data in the storage means, and detecting the target object A method for controlling an autonomous mobile robot, comprising: detecting means; moving according to a moving route planned by the route planning means; and moving an object detected by the detecting means to a place where the map data is cleared.
Determining whether there is a second object that obstructs the movement on a movement path that moves the first object to the corresponding first clean-up location;
Planning a movement path for moving from the position of the second object to a second tidying location corresponding to the second object when it is determined that a second object exists on the path path; ,
Planning each movement route from at least one predetermined position set on the map data to the tidying place;
On the map data, temporary locations other than the planned travel route to the second clean-up location and the route that passes a predetermined number of times when the travel route from the predetermined position to the clean-up location is planned A step to set the location,
Temporarily placing the first object in the set temporary placement location and cleaning the second object to the corresponding second cleanup location;
Clearing the second target object to a second clean-up location, and then cleaning the temporarily placed first target object to the corresponding first clean-up location;
A method for controlling an autonomous mobile robot.
JP2017039218A 2017-03-02 2017-03-02 Control method of autonomous mobile robot Active JP6848532B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017039218A JP6848532B2 (en) 2017-03-02 2017-03-02 Control method of autonomous mobile robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017039218A JP6848532B2 (en) 2017-03-02 2017-03-02 Control method of autonomous mobile robot

Publications (2)

Publication Number Publication Date
JP2018147079A true JP2018147079A (en) 2018-09-20
JP6848532B2 JP6848532B2 (en) 2021-03-24

Family

ID=63592059

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017039218A Active JP6848532B2 (en) 2017-03-02 2017-03-02 Control method of autonomous mobile robot

Country Status (1)

Country Link
JP (1) JP6848532B2 (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63276610A (en) * 1987-05-08 1988-11-14 Toyota Autom Loom Works Ltd Running course generating device
US20090234499A1 (en) * 2008-03-13 2009-09-17 Battelle Energy Alliance, Llc System and method for seamless task-directed autonomy for robots
JP2016101612A (en) * 2014-11-27 2016-06-02 トヨタ自動車株式会社 Robot for article conveyance

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63276610A (en) * 1987-05-08 1988-11-14 Toyota Autom Loom Works Ltd Running course generating device
US20090234499A1 (en) * 2008-03-13 2009-09-17 Battelle Energy Alliance, Llc System and method for seamless task-directed autonomy for robots
JP2016101612A (en) * 2014-11-27 2016-06-02 トヨタ自動車株式会社 Robot for article conveyance

Also Published As

Publication number Publication date
JP6848532B2 (en) 2021-03-24

Similar Documents

Publication Publication Date Title
US20220050468A1 (en) Robot-assisted processing of a surface using a robot
JP4674043B2 (en) Control method and programming device for autonomous mobile unit with programmed computer that moves according to a predetermined route
JP5886502B2 (en) MOBILE BODY CONTROL DEVICE, MOBILE BODY CONTROL METHOD, AND CONTROL PROGRAM
JP6359756B2 (en) Manipulator, manipulator operation planning method, and manipulator control system
US10162364B2 (en) Robot and control method thereof
US20110213497A1 (en) Robot arm and method of controlling robot arm to avoid collisions
US11203120B1 (en) Mobile robotics frame system
CN109227533A (en) Mobile device for planning, mobile robot and mobile planning procedure
KR20120073616A (en) Path planning apparatus of robot and method thereof
KR102595187B1 (en) route planning
KR100962593B1 (en) Method and apparatus for area based control of vacuum cleaner, and recording medium thereof
JP2006350776A (en) Traveling object route generating device
JP2022511359A (en) Autonomous map traversal with waypoint matching
JP2008023630A (en) Arm-guiding moving body and method for guiding arm
KR101146942B1 (en) Device for generating path of moving robot, moving robot having the same and method for generating path of moving robot
KR20180015774A (en) Method and apparatus for controlling robot
KR20190088824A (en) Robotic vacuum cleaner and method for controlling thereof
JP2018001348A (en) Information processor, information processing method, and program
JP2019084641A (en) Autonomous mobile robot, and control device and operation control program of the same
JP6332128B2 (en) Object recognition apparatus and object recognition method
CN113062697B (en) Drill rod loading and unloading control method and device and drill rod loading and unloading equipment
JP7091733B2 (en) Position estimation system, position detection method, and program
JP2018147079A (en) Control method of autonomous mobile robot
JP2012076196A (en) Robot and method for controlling the same
JP7480975B2 (en) Travel route generation device, travel device, travel route generation method, and program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20191011

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200826

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200901

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201030

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210215

R151 Written notification of patent or utility model registration

Ref document number: 6848532

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151