Mobile robot and control program for mobile robot

The route planning system optimizes mobile robot navigation by using certainty-based obstacle exclusion and dynamic map updates, reducing travel distance and ensuring safety through precise detection.

JP7581673B2Active Publication Date: 2024-11-13OMRON CORP
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
JP2020115465
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2020-07-03
Publication Date
2024-11-13
Estimated Expiration
2040-07-03

AI Technical Summary

Technical Problem

Existing route planning systems for mobile robots fail to account for the dynamic nature of obstacles, leading to longer travel distances due to the assumption that all obstacles must be avoided, even if their presence is uncertain.

Method used

A route planning system that acquires an environmental map with obstacle certainty levels, formulates routes excluding obstacles with low certainty, and updates this map based on detection information, allowing for more efficient and safe navigation.

Benefits of technology

This approach reduces travel distance and time by avoiding obstacles that are unlikely to be present, while ensuring safety through precise detection and dynamic map updates.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007581673000001
    Figure 0007581673000001
  • Figure 0007581673000002
    Figure 0007581673000002
  • Figure 0007581673000003
    Figure 0007581673000003
Patent Text Reader

Abstract

To provide a route formulation system for formulating a traveling route of a mobile robot in accordance with an actual situation in an environment, and the mobile robot and the like traveling along the formulated traveling route.SOLUTION: A route formulation system comprises: an obtainment section for obtaining an environment map in which, for each obstacle, existence places and degrees of certainty expressing likelihood in which the obstacles exist at the existence places are described; a formulation section for formulating a traveling route on which a mobile robot travels, through excluding those obstacles unsatisfying a reference in which the degrees of certainty are prior set, from the obstacles described on the environment map; and an outputting section for outputting route information representing information of the formulated traveling route to the mobile robot. Moreover, the mobile robot obtaining the route information from the route formulation system comprises: a traveling control section for traveling based on the route information; and a detection section for detecting the obstacles in a periphery while the traveling control section travels, wherein the detection section executes more accurate detection processing than regular detection processing to the obstacles included in exclusions information.SELECTED DRAWING: Figure 8
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a path planning system, a mobile robot, a path planning program, and a control program for a mobile robot. [Background technology]

[0002] Mobile robots that use map information to determine a route to a destination and move autonomously to the destination are becoming more common. The environment in which the mobile robot moves autonomously also contains obstacles whose positions may change. There is known a technique for updating map information when the position of an obstacle detected by the mobile robot while it is moving differs from the position of the obstacle described in the map information (see, for example, Patent Document 1). [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2014-211775 A Summary of the Invention [Problem to be solved by the invention]

[0004] Depending on their characteristics, some obstacles are more likely to be relocated than others. Even if the obstacles are the same type, they may be more likely to be moved than others depending on the location where they are located, how often they are used, etc. When planning a route to a destination, if a route is planned that avoids all of the obstacles depicted on a map without taking into account the characteristics of the obstacles, the distance traveled by the mobile robot will inevitably be long.

[0005] The present invention has been made to solve such problems, and provides a route planning system that plans a movement route for a mobile robot in accordance with the actual conditions of the environment, and a mobile robot that moves along the planned movement route. [Means for solving the problem]

[0006] The route planning system in a first aspect of the present invention includes an acquisition unit that acquires an environmental map in which the location of each obstacle and a degree of certainty indicating the likelihood of the obstacle being present at the location are described, a planning unit that plans a travel route for the mobile robot to travel by excluding obstacles described in the environmental map whose degree of certainty does not satisfy a preset standard, and an output unit that outputs route information, which is information about the planned travel route, to the mobile robot.

[0007] For obstacles that are described in the environmental map but are unlikely to exist at that location, the system will plan a route assuming that the obstacle does not exist. If the obstacle does not actually exist at that location, the travel distance will be shortened, and travel time will be shortened. Since the mobile robot moves while detecting obstacles, it can take evasive action even if an obstacle that has been treated as non-existent is present.

[0008] The above-mentioned path planning system may include an update unit that updates the certainty factor described in the environmental map based on detection information obtained from a detection sensor that detects an obstacle. If the environmental map can reflect changes in the situation, not only the characteristics of the obstacle itself but also characteristics caused by the environment can be reflected in the certainty factor.

[0009] Furthermore, the update unit of the above-mentioned path planning system may generate tentative obstacle information when it acquires information about an obstacle not described in the environmental map from the detection information, and may further update the tentative obstacle information based on the obtained detection information, and may add the tentative obstacle related to the tentative obstacle information to the environmental map as a confirmed obstacle when the tentative obstacle information satisfies a preset condition. By appropriately updating the environmental map, the path planning system can be stably used as a map used for path planning for a mobile robot while adapting to a dynamically changing environment.

[0010] In addition, the output unit of the above-mentioned route planning system may output excluded object information, which is information on obstacles excluded by the route planning unit, to the mobile robot in association with the route information. If the mobile robot can obtain such excluded object information, it can recognize the possibility of the presence of an obstacle and perform appropriate travel control.

[0011] A mobile robot according to a second aspect of the present invention is a mobile robot that acquires route information from the above-mentioned route planning system, and includes a mobile control unit that moves based on the route information, and a detection unit that detects surrounding obstacles while moving under the control of the mobile control unit, and the detection unit performs a more precise detection process for obstacles included in the excluded object information than a normal detection process. By performing such a detection process, the mobile robot can achieve both a shortened travel route and safe travel.

[0012] The mobile robot may further include a transmitter that transmits the detection result detected by the detector to the route planning system as detection information. If the route planning system can update the certainty factor by using the detection information sent from the mobile robot, it can construct an environmental map that more accurately reflects the actual situation.

[0013] A path planning program according to a third aspect of the present invention causes a computer to execute an acquisition step of acquiring an environmental map in which a location of each obstacle and a degree of certainty indicating the likelihood of the obstacle being present at the location are described, a planning step of planning a path for the mobile robot to move by excluding obstacles described in the environmental map whose degrees of certainty do not satisfy a preset standard, and an output step of outputting path information, which is information on the planned path, to the mobile robot. If an obstacle on the environmental map that was deemed not to exist in planning the path does not actually exist at that location, this leads to a reduction in the distance traveled by the mobile robot, and ultimately a reduction in the travel time.

[0014] A control program for a mobile robot according to a fourth aspect of the present invention is a control program for a mobile robot that acquires route information output by the above-mentioned route planning program and moves, and causes a computer to execute a moving step of moving based on the route information and a detecting step of detecting surrounding obstacles during the movement in the moving step, and the detecting step performs a more precise detection process than a normal detection process for obstacles excluded in the planning step. By performing such a detection process, the mobile robot can achieve both shortening the movement route and safe movement. Effect of the Invention

[0015] According to the present invention, it is possible to provide a route planning system that plans a movement route for a mobile robot in accordance with the actual conditions of the environment, and a mobile robot that moves along the planned movement route. [Brief description of the drawings]

[0016] [Figure 1] 1 is a conceptual diagram showing a situation in which a route planning system and a mobile robot according to an embodiment of the present invention are used. [Diagram 2] FIG. 2 is a perspective view showing the appearance of the mobile robot. [Diagram 3] FIG. 2 is a hardware configuration diagram of a system server. [Figure 4] FIG. 2 is a diagram illustrating a hardware configuration of the mobile robot. [Diagram 5] FIG. 13 is a conceptual diagram showing a highly portable table being present on the movement path. [Figure 6] This is a map that visually shows the environment in which a mobile robot moves autonomously. [Figure 7] FIG. 2 is a conceptual diagram showing a data structure of an environmental map. [Figure 8] 1 is a map showing the planned travel route. [Figure 9] FIG. 2 is a conceptual diagram showing a data structure of route information. [Figure 10] 11 is a flow diagram illustrating a process in which the system server determines a travel route and transmits it to the mobile robot. FIG. [Figure 11] FIG. 2 is a flow diagram illustrating a process for moving a mobile robot from a starting point to a destination point. [Figure 12] FIG. 11 is a flow diagram illustrating a process in which the system server updates the certainty of the environmental map. [Figure 13] 1 is a diagram showing a map of a factory in which a mobile robot moves autonomously and the movement route of the mobile robot; [Figure 14] FIG. 11 is a flow diagram illustrating a process for a virtual obstacle. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0017] The present invention will be described below through embodiments of the invention, but the invention according to the claims is not limited to the following embodiments. Furthermore, not all of the configurations described in the embodiments are necessarily essential as means for solving the problems.

[0018] FIG. 1 is a conceptual diagram showing a situation in which a system server 100 functioning as a route planning system according to this embodiment and a mobile robot 200 moving autonomously along a moving route planned by the system server 100 are used. The mobile robot 200, for example, transports stored objects to a destination. The environment in which the mobile robot 200 moves is not an environment prepared for a robot, but rather an environment in which people coexist in this embodiment. In an environment in which people coexist, various structures and installations that may become obstacles for the mobile robot to move autonomously are carried or moved. The mobile robot 200 moves autonomously in such an environment toward a set destination.

[0019] The mobile robot 200 is connected to the network 300 via a communication unit 310 installed in the environment. The system server 100 is also connected to the network 300. The system server 100 is a server that manages the mobile robot 200, and as part of the management, it formulates a moving path along which the mobile robot 200 moves autonomously and outputs the path to the mobile robot 200. The system server 100 is not limited to managing one mobile robot 200, but can also manage multiple mobile robots 200 in parallel. In this case, the system server 100 can also formulate individual moving paths for each mobile robot 200. Also, the server that manages the mobile robot 200 and the server that formulates the moving paths may be separated. In this case, the server that formulates the moving path may output the formulated moving path to the mobile robot 200 via the server that manages it.

[0020] In this embodiment, the system server 100 acquires an environmental map in which the location of each obstacle and the degree of certainty indicating the likelihood of the obstacle being present at the location are described, and plans a travel route by excluding obstacles whose degree of certainty does not meet a preset standard. The starting point and the destination point of the travel route may be automatically generated by the system server 100 according to the task to be executed by the mobile robot 200, or may be specified by the user.

[0021] 2 is a perspective view showing the exterior of the mobile robot 200. The mobile robot 200 is provided with a cart section in which the movement function is integrated, and is equipped with two drive wheels 201 and one caster 202, each of which comes into contact with the traveling surface. The two drive wheels 201 are arranged so that their rotation axes coincide with each other. Each drive wheel 201 is independently rotated by a motor (not shown). The caster 202 is a driven wheel that follows the moving direction of the mobile robot 200.

[0022] Mobile robot 200 is equipped with stereo camera 231 on the upper front surface. Stereo camera 231 has a configuration in which two camera units having the same angle of view are arranged at a distance from each other, and outputs image signals captured by each camera unit. Mobile robot 200 can grasp the distance and direction to surrounding obstacles, the type of the obstacles, etc. by analyzing the image signals captured by stereo camera 231.

[0023] The mobile robot 200 is equipped with a laser scanner 232 at the bottom of the front surface. The laser scanner 232 scans a certain range in a horizontal plane at each step angle, and outputs whether or not an obstacle exists in each direction. Furthermore, if an obstacle exists, it outputs the distance to the obstacle. By analyzing the continuous output of the laser scanner 232, the mobile robot 200 can determine whether the obstacle is moving, and if so, the direction and speed of the movement. The communication unit 250 exchanges information with a communication unit 310 installed in the environment by wireless communication.

[0024] 3 is a hardware configuration diagram of the system server 100. The system server 100 is mainly composed of a system control unit 110, a storage unit 140, and a communication unit 150. In this embodiment, the system server 100 also includes a display monitor 120 and an input device 130 so that a user can directly input information to the system server 100, update a program, and the like.

[0025] The system control unit 110 is a processor (CPU: Central Processing Unit) that controls the system server 100 and executes programs. The processor may be configured to cooperate with a computation chip such as an ASIC (Application Specific Integrated Circuit) or a GPU (Graphics Processing Unit). The system control unit 110 reads out a route planning program stored in the storage unit 140 and executes various processes related to planning a travel route. The display monitor 120 is, for example, a monitor equipped with a liquid crystal panel, and visually displays the arrangement of obstacles described in the environmental map and the degree of certainty associated with each obstacle. The input device 130 is, for example, a keyboard or a mouse, and is used by the user to create environmental map information and set the destination of the mobile robot 200.

[0026] The storage unit 140 is a non-volatile storage medium, and is configured, for example, by an HDD (Hard Disk Drive). The storage unit 140 stores various parameter values, functions, trained models, lookup tables, and the like used for control and calculation, in addition to programs for executing control and processing of the system server 100. The storage unit 140 particularly stores an environmental map 141. The environmental map 141 will be described in detail later. Note that the storage unit 140 does not need to be configured by a single piece of hardware, and for example, a storage medium for storing the program and a storage medium for accumulating the environmental map 141 may be configured by separate hardware.

[0027] The communication unit 150 is responsible for connecting to the network 300 and sending and receiving data with the mobile robot 200, and is composed of, for example, a LAN unit. The communication unit 150 functions as an input / output unit that inputs and outputs various information and commands in cooperation with the system control unit 110. When outputting route information, which is information on the determined travel route, to the mobile robot 200, it functions as an output unit.

[0028] The system control unit 110 also serves as a functional calculation unit that executes various calculations in response to processing instructed by the route planning program. The system control unit 110 can function as an acquisition unit 111, a planning unit 112, and an update unit 113. The specific calculation processing of these functional calculation units will be described later.

[0029] 4 is a diagram showing the hardware configuration of the mobile robot 200. The mobile robot 200 is mainly composed of a movement control unit 210, a cart driving unit 220, a sensor unit 230, a storage unit 240, and a communication unit 250.

[0030] The movement control unit 210 is a processor (CPU) that controls the moving robot 200 and executes programs. The processor may be configured to cooperate with a processing chip such as an ASIC or a GPU. The movement control unit 210 reads out a control program stored in the storage unit 240 and executes various processes related to autonomous movement.

[0031] The cart drive unit 220 includes the drive wheels 201 and a drive circuit and a motor for driving the drive wheels 201. The movement control unit 210 executes rotation control of the drive wheels 201 by sending a drive signal to the cart drive unit 220. The movement control unit 210 also receives a feedback signal from an encoder or the like from the cart drive unit 220 to grasp the moving direction and moving speed of the mobile robot 200.

[0032] The sensor unit 230 includes various sensors that detect people and obstacles in the surroundings. The stereo camera 231 and the laser scanner 232 are components that make up the sensor unit 230. The stereo camera 231 captures images of the surrounding environment in response to a request from the movement control unit 210, and transfers the image signal to the movement control unit 210. The movement control unit 210 executes an analysis process for recognizing an obstacle using the image signal. For example, the obstacle is identified using a trained model, and the position and orientation of the obstacle are detected using the parallax of the stereo image.

[0033] The laser scanner 232 detects whether or not an obstacle exists in the moving direction according to a request from the moving control unit 210, and transfers the resultant detection signal to the moving control unit 210. The sensor unit 230 may include other sensors that detect surrounding obstacles during movement in addition to or instead of the stereo camera 231 and the laser scanner 232. The sensor unit 230 functions as a detector that detects surrounding obstacles. The sensor unit 230 may include other sensors, such as a sensor that monitors the state of the mobile robot 200, in addition to the sensor that detects surrounding obstacles.

[0034] The storage unit 240 is a non-volatile storage medium, and is configured, for example, by a solid state drive. The storage unit 240 stores various parameter values, functions, learned models, lookup tables, and the like used for control and calculation, in addition to programs for controlling and processing the mobile robot 200. In particular, the storage unit 240 stores an environmental map 141 of the environment in which the robot moves autonomously, and route information 241 received from the system server 100. The route information will be described in detail later. Note that the storage unit 240 does not need to be configured as a single piece of hardware, and for example, a storage medium for storing the program and a storage medium for storing the environmental map 141 and the route information 241 may be configured as separate hardware.

[0035] The communication unit 250 is, for example, a wireless LAN unit. The mobile control unit 210 transmits and receives various information to and from the system server 100 connected to the network 300 via the communication unit 250. The communication unit 250 cooperates with the mobile control unit 210 to function as a transmitter that transmits the detection result detected by the sensor unit 230 to the system server 100 as detection information.

[0036] When a mobile robot moves autonomously in an environment where people coexist, there are various structures and installations in the environment that hinder the autonomous movement, and some of these are easily moved and some are not. Even if the obstacle is the same type, it may be easily moved or not depending on the location where it is placed, the frequency of use, etc.

[0037] FIG. 5 is a conceptual diagram showing a highly portable table 410 existing on a movement path. A pillar 420, which is a structural member of a building, is an obstacle to the mobile robot 200, but the position of the pillar 420 is unlikely to be changed. On the other hand, the table 410 is unlikely to be moved if it is placed in a corner of a room or if a heavy object is placed on it, but if it is placed near a person's movement line with nothing placed on it, it will be easily moved. In other words, it can be said that the likelihood that the obstacles described in the environmental map actually exist in the described location varies depending on their unique properties, conditions, frequency of use, etc.

[0038] 6 is a map visually showing the environment in which the mobile robot 200 moves autonomously, and is an example of a planar representation of obstacles described in the environmental map. The illustrated example shows the A123 conference room in which the mobile robot 200 can move autonomously.

[0039] The environmental map describes pillars P1-P4, walls W1-W6, shelves S1, S2, board B1, conference desk D1, chairs C1-C4, table T1, and plants G1, G2 as structures and installations that may be obstacles to the autonomous movement of the mobile robot 200. At the same time, it describes which area of ​​the conference room each structure and installation occupies.

[0040] Wall W1 is adjacent to the entrance of conference room A123. Walls W3 and W6 are partitions between adjacent conference rooms and are removable. Shelves S1 and S2 are large shelves and are fixed at the innermost position relative to the entrance. Conference desk D1 is large and has a power cable attached. Table T1 is small, like table 410 shown in FIG. 5, and is used as a place to put luggage for conference participants. There is a relatively large space around table T1. Chairs C1 to C4 are small and have casters. Plants G1 and G2 are ornamental plants, but are placed close to wall W2. As described above, each obstacle has the properties of the obstacle itself and the properties resulting from the location of the obstacle.

[0041] The environmental map 141 handled by the system server 100 and the mobile robot 200 has a data structure in which each obstacle is described as data. Fig. 7 is a conceptual diagram showing the data structure of the environmental map describing the structures and installations shown in Fig. 6.

[0042] The environmental map is created for each space divided according to its purpose, such as a conference room, a storeroom, a corridor, a hall, etc. In the example shown, along with the tag for conference room A123, the name, ID, certainty, and occupancy area of ​​each obstacle present in conference room A123 are described.

[0043] The obstacle name is the name of the obstacle, and the ID is a unique symbol to distinguish each obstacle. The occupied area indicates which area of ​​the target space each obstacle occupies by the projection shape of the obstacle onto the floor and the floor coordinates. For example, the occupied area of ​​table T1 has a rectangular projection shape, and the coordinates of the upper left vertex are (X1 t1 ,Y1 t1 ), and the coordinates of the bottom right vertex are (X2 t1 ,Y2 t1 ), the rotation angle of the diagonal is θ t1 The area occupied by the plant G1 is projected as a circle, and its center coordinates are (X1 g1 ,Y1 g1 ), with radius R g1 It is expressed as:

[0044] The certainty indicates the likelihood that the obstacle actually exists in the location described as the occupied area. Here, an integer between 1 and 10 is assigned, with 10 being the most certain and 1 being the least certain. For example, wall W4 has a certainty of 10, and it can be said that it definitely exists in the location indicated by the occupied area. On the other hand, wall W3 is a partition, and so is assigned a certainty of 8, indicating that it is somewhat less likely to exist in the location indicated by the occupied area than wall W4. Table T1 is assigned a certainty of 3, and it can be said that it is significantly less likely to exist in the location indicated by the occupied area.

[0045] The degree of certainty is assigned by the map creator when creating the environment map, taking into account the characteristics of each obstacle, or it is assigned automatically by the map creation program, taking into account the obstacle name, occupied area, relative position to other obstacles, etc.

[0046] In this embodiment, while the created environmental map is being used, the update unit 113 of the system server 100 updates the certainty as needed. Specifically, in the target space for which the environmental map is created, detection sensors for detecting the state of obstacles, such as surveillance cameras, are installed, and the update unit 113 uses detection information from such detection sensors to increase or decrease the certainty of the target obstacle. In addition, the update unit 113 acquires, as detection information, the detection results detected by the mobile robot 200 provided with the route information 241 or other mobile robots during their autonomous movement, and increases or decreases the certainty of the target obstacle.

[0047] The update unit 113 increases the degree of certainty by 1 if the obstacle to be observed meets an evaluation condition for increasing the degree of certainty, and decreases the degree of certainty by 1 if the obstacle to be observed meets an evaluation condition for decreasing the degree of certainty. However, as described above, the maximum value is 10 and the minimum value is 1. An evaluation condition for increasing the degree of certainty is, for example, a case where a motionless state is continuously detected for a predetermined time. Conversely, an evaluation condition for decreasing the degree of certainty is, for example, a case where a movement is detected a predetermined number of times within a predetermined time. The predetermined time and the predetermined number may be set according to the nature of the obstacle. For example, if the obstacle to be observed is a wall, the degree of certainty may be set so that it does not decrease much, and if the obstacle to be observed is a chair, the degree of certainty may be set so that it decreases quickly. In addition, weighting may be given according to the type of detection sensor that detects the obstacle. For example, if it is possible to identify what the obstacle is from the image signal captured by the stereo camera 231, it is preferable to increase the weighting of the detection information derived from the stereo camera 231.

[0048] In this embodiment, the planning unit 112 plans a travel route by referring to the degree of certainty of the environmental map. Specifically, the planning unit 112 plans a route by excluding obstacles with a degree of certainty of 3 or less as obstacles that are described in the environmental map but do not actually exist at the described location. That is, the criteria for whether or not to exclude are set in advance as follows: if the degree of certainty is 3 or less, the obstacle is excluded, and if the degree of certainty is 4 or more, the obstacle is not excluded.

[0049] Fig. 8 is a map showing a movement route formulated by the formulation unit 112 in the environment shown in Fig. 6. The starting point of the mobile robot 200 is set to the entrance of the conference room, and the destination point is set to a part of the shelf S1.

[0050] When the starting point and the destination point are set, the acquisition unit 111 acquires an environmental map 141 including these points from the storage unit 140. If these points are not present in the storage unit 140, the acquisition unit 111 acquires the environmental map 141 from an environmental map database connected to the network 300 via the communication unit 150.

[0051] The planning unit 112 refers to the environmental map 141 acquired by the acquisition unit 111, excludes the table T1 and the chairs C1 to C4, which have a certainty degree of 3 or less, and then plans a movement route from the starting point to the destination point using a known algorithm. As the known algorithm, for example, an algorithm is used in which costs are set for the total movement distance of the mobile robot 200, the turning angle, the distance between an obstacle and the path, etc., and an algorithm is used to select a movement route with the minimum integrated cost.

[0052] The travel route thus determined is a route that the mobile robot 200 travels to the destination by turning at two turning points IG1 and IG2 as shown in the figure. Since the table T1 is excluded, the straight line route from IG2 to the destination crosses the occupied area of ​​the table T1 described in the environmental map 141.

[0053] 9 is a conceptual diagram showing a data structure of route information 241, which is information on a planned moving route. After being generated by the planner 112, the route information 241 is output to the mobile robot 200 via the communication unit 150.

[0054] The route information 241 includes a planned travel route and excluded object information. The planned travel route represents a planned travel route, and the starting point, the destination point, and intermediate target points set therebetween are entered with their respective coordinate values. The intermediate target points are turning points around which the mobile robot 200 turns. The mobile robot 200 turns from, for example, the first target point (X ig1 ,Y ig1 When you reach the second target point (X ig2 ,Y ig2 ) and then continue straight toward the second target point.

[0055] The excluded object information is information on obstacles excluded by the planning unit 112 when planning a moving path. Here, since table T1 has been excluded, the ID and occupied area information of table T1 are described. When the excluded object information is associated with the path information 241 in this manner, the mobile robot 200 can refer to the excluded object information and execute a more precise detection process than a normal detection process to confirm whether the obstacle actually exists. The more precise detection process is realized, for example, by performing sensing with a slower moving speed, by increasing the acquisition rate of the image signal acquired by the stereo camera 231, or by reducing the detection step angle by the laser scanner 232.

[0056] By planning a travel route in this way, if the excluded obstacle does not actually exist at that location, the travel distance and therefore the travel time can be shortened. Since the mobile robot moves while detecting obstacles, it can perform avoidance operations even if the obstacle that was treated as non-existent actually exists. By performing detection processing that is more precise than normal detection processing on the area occupied by the excluded obstacle, it is possible to achieve both a shorter travel route and safer travel at a higher level.

[0057] Next, a process for planning a moving route will be described using a flow chart. Fig. 10 is a flow chart explaining the process in which the system server 100 plans a moving route and transmits it to the mobile robot 200. The flow chart starts, for example, before the mobile robot 200 starts moving or before a task is executed.

[0058] In step S101, the acquisition unit 111 acquires information on the departure point and destination point. Specifically, the information may be input by the user via the input device 130, or if a task has already been set, the information may be acquired from the description information of the task. The acquisition unit 111 proceeds to step S102 and acquires an environmental map 141. Specifically, as described above, for example, the environmental map 141 including the acquired departure point and destination point is selected and acquired from the group of environmental maps stored in the storage unit 140.

[0059] In step S103, the planning unit 112 receives the environmental map acquired by the acquisition unit 111, and extracts and removes obstacles whose certainty level is set to 3 or less. Then, the process proceeds to step S104, where the planning unit 112 plans a travel route from the departure point to the destination point so as to avoid the remaining obstacles.

[0060] In step S105, the planner 112 checks for interference between the planned travel path and the excluded obstacles. Specifically, the planner 112 determines whether the planned travel path passes through the area occupied by the excluded obstacles. Then, the planner 112 extracts the obstacles that are determined to pass through and adds them to the excluded object information.

[0061] In step S106, the planner 112 generates route information 241 by associating the excluded object information with the planned travel route. The system controller 110 cooperates with the communication unit 150 to output the route information 241 to the mobile robot 200. If the mobile robot 200 does not have the environmental map 141, the system controller 110 also outputs the environmental map 141 to the mobile robot 200, and ends the series of processes. Note that the route information 241 does not have to be output to the mobile robot 200 immediately after generation, and may be output when requested by the mobile robot 200. In addition, the system server 100 may not directly output the route information to the mobile robot 200, but may output the route information via a management server that commands the mobile robot 200 to perform a task, for example.

[0062] Next, a process procedure for the movement of the mobile robot 200 will be described using a flow chart. Fig. 11 is a flow chart explaining the process for the mobile robot 200 to move from a starting point to a destination point. The flow chart starts, for example, when the mobile robot 200 reaches the starting point.

[0063] In step S201, the movement control unit 210 acquires the route information 241 and the environmental map 141 from the system server 100. If at least one of them is already stored in the storage unit 240, it reads them out from the storage unit 240. Then, in step S202, movement is started. The movement control unit 210 controls the cart driving unit 220 so as to move along the planned movement route described in the route information 241. In addition, the movement control unit 210 controls the sensor unit 230 to start detecting obstacles in the surroundings.

[0064] In step S203, the movement control unit 210 compares the detection result obtained from the output of the sensor unit 230 with the occupied area of ​​each obstacle described in the environmental map 141, and determines whether there is a difference between the two. If there is a difference, the process proceeds to step S204, and the detection result is transmitted to the system server 100 as detection information. The detection information may be associated with the ID of the obstacle in which the difference was found. When the transmission process in step S204 is completed, or if there is no difference in step S203, the process proceeds to step S205.

[0065] In step S205, the movement control unit 210 judges whether or not the obstacle has reached the vicinity of the area occupied by the obstacle described as the excluded obstacle. For example, if the obstacle has reached within 2 m of the edge of the area, the movement control unit 210 judges that the obstacle has reached the vicinity and proceeds to step S206. After proceeding to step S206, the movement control unit 210 starts a fine detection process, which is a detection process that is finer than the detection process up to that point. After starting the fine detection process in step S206, or if the movement control unit 210 judges that the obstacle has not reached the vicinity of the area occupied by the obstacle in step S205, the movement control unit 210 proceeds to step S207.

[0066] In step S207, the movement control unit 210 analyzes the detection result obtained from the output of the sensor unit 230 and determines whether or not an obstacle exists within 1 m in the traveling direction of the mobile robot 200. If it is determined that an obstacle exists, the process proceeds to step S208. After proceeding to step S208, the movement control unit 210 executes a local avoidance operation to avoid the obstacle. Specifically, the movement control unit 210 goes around the obstacle, or if the obstacle is a moving object, it retreats from the traveling direction. Once the local avoidance operation is completed, or if the presence of an obstacle is not recognized in step S207, the process proceeds to step S209.

[0067] In step S209, the movement control unit 210 judges whether or not the destination point has been reached. If it is judged that the destination point has not been reached, the process returns to step S203 and continues the series of processes. If it is judged that the destination point has been reached, the series of processes ends.

[0068] Next, a process procedure for updating the certainty level will be described using a flow chart. Fig. 12 is a flow chart explaining the process in which the update unit 113 of the system server 100 updates the certainty level of the environmental map. The flow chart starts from the point in time when detection information is received. As described above, the detection information is not limited to the case where it is sent from the mobile robot 200, but may also be sent from a detection sensor installed in the target space of the environmental map.

[0069] When the update unit 113 acquires the detection information, in step S301, the update unit 113 selects and acquires an environmental map corresponding to the target space in which the detection information was generated from the group of environmental maps stored in the storage unit 140. Next, in step S302, it checks which obstacle detection result is included in the detection information, and reads information on the obstacle from the acquired environmental map.

[0070] In step S303, the update unit 113 compares the detection result of the detection information with the obstacle information of the environmental map and determines whether or not there is a difference. If there is no difference, the process proceeds to step S304, and if there is a difference, the process proceeds to step S306.

[0071] When the process proceeds to step S304, the update unit 113 judges whether the obstacle to be observed matches the evaluation condition for increasing the degree of certainty. If the obstacle matches, the process proceeds to step S305, where the degree of certainty of the obstacle is increased by 1, and the series of processes is terminated. If the obstacle does not match, the series of processes is terminated without updating the degree of certainty.

[0072] In step S306, the update unit 113 judges whether the obstacle to be observed matches the evaluation condition for decreasing the degree of certainty. If it matches, the process proceeds to step S307, where the degree of certainty of the obstacle is decreased by 1, and the series of processes is terminated. If it does not match, the series of processes is terminated without updating the degree of certainty.

[0073] In the above embodiment, an example in which the mobile robot 200 moves autonomously in a conference room has been described, but the environments in which the mobile robot 200 moves autonomously are diverse. Here, a case in which the mobile robot 200 moves autonomously in a factory in which production equipment is installed will be described. Fig. 13 is a diagram showing a map of the factory in which the mobile robot 200 moves autonomously and the movement route of the mobile robot 200.

[0074] In the factory, a workbench T1 is provided with a line for performing primary processing of manufactured products, workbenches T2 and T3 are provided with lines for performing secondary processing, and a workbench T4 is provided for inspecting the secondary processed manufactured products. Between the workbenches T1 and T3, between T2 and T3, and between T3 and T4, there are passages wide enough for the mobile robot 200 to pass through. In addition, between the workbenches T2, T3, and T4 and the wall W1 facing them, there is also a passage wide enough for the mobile robot 200 to pass through. The workbenches T1 to T4 and the wall W1 are described in an environmental map 141 representing the factory, and the certainty level of each is set to 4 or more.

[0075] Here, a transport task is assumed in which a finished product that has been secondary processed on workbench T2 is transported to workbench T4 for inspection. Specifically, a point on workbench T2 facing wall W1 is set as a starting point, and a point on workbench T4 facing workbench T3 is set as a destination point. For example, when a worker on a secondary processing line places a finished product on mobile robot 200 and presses a movement start button, mobile robot 200 moves autonomously to the destination point, and an inspection worker takes out the finished product from mobile robot 200 that has stopped at the destination point.

[0076] The planning unit 112 of the system server 100 refers to the environmental map 141 and plans the movement route indicated by the dotted line according to the above-mentioned processing procedure. Meanwhile, many things and people pass through a factory, and for example, cardboard boxes and measuring instruments may be left on the aisles. These are not described in the environmental map 141, and may be moved again in a short period of time or may be left as is for a long period of time. In either case, these may become obstacles that hinder the autonomous movement of the mobile robot 200.

[0077] The measuring instrument X1 placed between the workbench T3 and the wall W1 is such an obstacle. When the mobile robot 200 moves autonomously along the movement path formulated by the planner 112, the sensor unit 230 detects the measuring instrument X1 as an obstacle when the mobile robot 200 reaches the vicinity of the measuring instrument X1. As a result, the mobile robot 200 executes a local avoidance operation. In this case, the mobile robot 200 cannot pass by the side of the measuring instrument X1, so it aims for the destination point by following a detour along the outer edge of the workbench T3. That is, the mobile robot 200 moves along the movement path indicated by the solid line and reaches the destination point.

[0078] Although the measuring device X1 is not described in the environmental map 141, if it is repeatedly detected as an obstacle over a certain period of time, it is preferable to describe it in the environmental map with a degree of certainty of 4 or more so that it will not be excluded in route planning. If X1 is described in the environmental map 141 as an obstacle with a degree of certainty of 4 or more, the planning unit 112 plans a travel route shown by a dashed line. In other words, it is possible to plan a travel route that is shorter than the travel route shown by the solid line.

[0079] However, in an environment where many things and people come and go, it is not preferable to immediately add a detected obstacle to the environmental map 141 due to the nature of the map used to plan a travel route. Therefore, when the update unit 113 receives detection information of an obstacle not described in the environmental map 141 from a detection sensor installed in the mobile robot 200 or the target space of the environmental map, the update unit 113 stores the obstacle as a tentative obstacle in the storage unit 120. Then, when a certain condition is satisfied thereafter, the update unit 113 adds information about the obstacle to the environmental map 141 to update the environmental map 141.

[0080] Fig. 14 is a flow diagram for explaining the processing for a virtual obstacle. The flow starts when it is determined in step S302 of the processing flow in Fig. 12 that the obstacle included in the detection information does not correspond to any of the obstacles described in the environmental map 141. Note that when the obstacle included in the detection information is estimated to correspond to any of the obstacles described in the environmental map 141, for example, only with a slightly different orientation, the processing flow in Fig. 12 continues as is.

[0081] In step S401, the update unit 113 checks whether the obstacle included in the received detection information already exists as temporary obstacle information in the storage unit 140. If it does not exist, the process proceeds to step S402, where a temporary obstacle is set and stored in the storage unit 120 as temporary obstacle information. Specifically, the update unit 113 issues a temporary ID to the temporary obstacle, determines an occupied area within a range that can be read from the detected sensing information, and generates temporary obstacle information by assigning a degree of certainty of "1". For example, if it is possible to recognize what the target object is from the acquired image included in the detection information, the obstacle name may be added to the temporary obstacle information. Once the temporary obstacle information is stored in the storage unit 120, the series of processes is terminated.

[0082] If it is determined in step S401 that the temporary obstacle information already exists in the storage unit 120, the update unit 113 proceeds to step S403, where it compares the detection result of the detection information with the temporary obstacle information, and determines whether there is a difference such as a deviation in position or orientation, etc. If there is no difference, it proceeds to step S404, and if there is a difference, it proceeds to step S408.

[0083] When the process proceeds from step S403 to step S404, the update unit 113 judges whether or not the virtual obstacle to be observed matches an evaluation condition for increasing the certainty. If it matches, the process proceeds to step S405. If it does not match, the process ends a series of processes without updating the certainty. Here, the evaluation condition for increasing the certainty may be the same as the evaluation condition for increasing the certainty of the obstacle described in the environmental map 141, or may be an evaluation condition defined for the virtual obstacle.

[0084] When the process proceeds to step S405, the update unit 113 increases the degree of certainty of the obstacle by 1. Then, in step S406, it is determined whether the increased degree of certainty has reached a reference degree of certainty. The reference degree of certainty is set in advance to a value of 4 or more that is not excluded in route planning. More preferably, a value greater than 4 is set to prevent the environmental map from being frequently rewritten. Here, "5" is set as the reference degree of certainty.

[0085] If the update unit 113 determines that the standard degree of certainty has not been reached, the series of processes is terminated. If the update unit 113 determines that the standard degree of certainty has been reached, the process proceeds to step S407, and the temporary obstacle is added to the environmental map 141 as a confirmed obstacle. Specifically, the temporary obstacle information of the temporary obstacle that has been collected and updated up to that point is added as one item in the data structure of the environmental map 141 described with reference to FIG. 7, thereby updating the environmental map 141. Then, the series of processes is terminated.

[0086] When the process proceeds from step S403 to step S408, the update unit 113 judges whether the obstacle to be observed matches an evaluation condition that reduces the degree of certainty. If it matches, the process proceeds to step S409. If it does not match, the process ends a series of processes without updating the degree of certainty. Here, the evaluation condition that reduces the degree of certainty may be the same as the evaluation condition that reduces the degree of certainty of the obstacle described in the environmental map 141, or may be an evaluation condition defined for the virtual obstacle.

[0087] In step S409, the update unit 113 decreases the degree of certainty of the obstacle by 1. Then, in step S410, it is determined whether the decreased degree of certainty has become 0. If the update unit 113 determines that the degree of certainty has not become 0, the series of processes is terminated. If it determines that the degree of certainty has become 0, the update unit 113 proceeds to step S411, where it is determined that the temporary obstacle no longer exists, the temporary obstacle information stored in the storage unit 120 is deleted, and the series of processes is terminated.

[0088] By appropriately updating the environmental map 141 through such processing, the system server 100 can stably use the map to plan a route for the mobile robot 200 while responding to a dynamically changing environment. In other words, it is possible to plan an optimal travel route in accordance with the changing environment, and to prevent frequent addition and deletion of information about obstacles whose continued existence is uncertain from the environmental map.

[0089] In the present embodiment described above, the degree of certainty is expressed by an integer from 1 to 10, but may be expressed by a decimal from 0 to 1, for example. The expression of the degree of certainty is not limited to a numerical value, and may be expressed by, for example, a plurality of groups. The update of the degree of certainty may be set in stages according to each expression. In the present embodiment described above, the degree of certainty is increased or decreased by 1 regardless of the type of object, but an increase or decrease value may be set for each object. In the present embodiment described above, the criterion for exclusion is set to a degree of certainty of 3 or less regardless of the type of object, but a criterion for exclusion may be set for each object.

[0090] The above-described description formats of the environmental map and the description formats of the route information are merely examples, and other description formats may be used. In addition, when the starting point and the destination point are included in different environmental maps, the environmental maps may be combined into one environmental map including the environmental map that connects those environmental maps.

[0091] The configuration of the mobile robot 200 is not limited to the above. The drive mechanism is not limited to one that employs two drive wheels, and may be an omniwheel or crawler, or may employ a mechanism for walking on two legs or four legs. The algorithm and evaluation criteria for planning the travel route from the starting point to the destination point may be selected in accordance with the drive mechanism of the mobile robot 200.

[0092] In the above embodiment, the system server 100 functions as a route planning system, but elements for functioning as a route planning system may be distributed between the mobile robot 200 and the system server 100. In this case, the route planning system is composed of the mobile robot 200 and the system server 100. Alternatively, the mobile robot 200 may include all the elements for functioning as a route planning system. In this case, the mobile robot 200 itself functions as a route planning system.

[0093] Here, the main configurations of the above-described route planning system, mobile robot, route planning program, and mobile robot control program will be summarized. [Appendix 1] an acquisition unit (111) for acquiring an environmental map (141) in which a location of each obstacle and a degree of certainty indicating the likelihood that the obstacle exists at the location are described; a planning unit (112) that plans a path along which the mobile robot (200) will move by excluding obstacles described in the environmental map (141) whose certainty does not satisfy a preset standard; an output unit (150) for outputting route information (241) which is information on the determined moving route to the moving robot (200); A route planning system (100) comprising: [Appendix 2] A route planning system (100) as described in appendix 1, comprising an update unit (113) that updates the certainty level described in the environmental map (141) based on detection information obtained from a detection sensor (230) that detects the obstacle. [Appendix 3] The update unit (113) generates tentative obstacle information when information regarding an obstacle not described in the environmental map (141) is acquired from the detection information, and further updates the tentative obstacle information based on the obtained detection information. When the tentative obstacle information satisfies a preset condition, the update unit (113) generates tentative obstacle information when information regarding an obstacle not described in the environmental map (141) is acquired from the detection information, and further updates the tentative obstacle information based on the obtained detection information. When the tentative obstacle information satisfies a preset condition, the update unit (113) adds the tentative obstacle related to the tentative obstacle information to the environmental map (141) as a confirmed obstacle. [Appendix 4] A path planning system (100) according to any one of Appendices 1 to 3, wherein the output unit (150) associates excluded object information, which is information about the obstacles excluded by the planning unit (112), with the path information (241) and outputs the information to the mobile robot (200). [Appendix 5] A mobile robot (200) that acquires the route information (241) from a route planning system (100) according to appendix 4, A movement control unit (210) that moves based on the route information (241); a detection unit (230) that detects surrounding obstacles during movement by the movement control unit (210); Equipped with The detection unit (230) of the mobile robot (200) executes a more precise detection process for the obstacle included in the excluded object information than a normal detection process. [Appendix 6] The mobile robot (200) according to claim 5, further comprising a transmission unit (250) that transmits the detection result detected by the detection unit (230) to the path planning system (100) as detection information. [Appendix 7] an acquisition step of acquiring an environmental map (141) in which a location of each obstacle and a degree of certainty indicating the likelihood that the obstacle exists at the location are described; a planning step of planning a moving path for the mobile robot (200) to move by excluding obstacles described in the environmental map (141) whose certainty does not satisfy a preset criterion; an output step of outputting route information (241) which is information on the determined moving route to the moving robot (200); A route planning program that causes a computer to execute the above. [Appendix 8] A control program for a mobile robot (200) that acquires the route information (241) output by the route planning program according to claim 7 and moves, A moving step of moving based on the route information (241); a detection step of detecting surrounding obstacles during the movement in the moving step; on the computer, The detection step is a control program that executes a detection process for the obstacles excluded in the planning step that is more precise than a normal detection process. [Explanation of symbols]

[0094] 100...system server, 110...system control unit, 111...acquisition unit, 112...formulation unit, 113...update unit, 120...display monitor, 130...input device, 140...memory unit, 141...environmental map, 150...communication unit, 200...mobile robot, 201...drive wheel, 202...caster, 210...mobile control unit, 220...cart drive unit, 230...sensor unit, 231...stereo camera, 232...laser scanner, 240...memory unit, 241...route information, 250...communication unit, 300...network, 310...communication unit, 410...table, 420...pillar

Claims

1. an acquisition unit that acquires an environmental map in which a location of an obstacle and a degree of certainty that indicates the likelihood of the obstacle being present at the location are described for each obstacle; a planning unit that plans a path for the mobile robot to move by excluding obstacles described in the environmental map whose certainty does not satisfy a preset criterion; an output unit that outputs route information, which is information about the determined moving route, to the mobile robot; A mobile robot that acquires the route information from a route planning system comprising: A movement control unit that moves based on the route information; a detection unit that detects surrounding obstacles during movement by the movement control unit; Equipped with The detection unit of the mobile robot performs a detection process that is more precise than a normal detection process on the obstacles included in excluded object information, which is information on the obstacles excluded by the formulation unit.

2. 2. The mobile robot according to claim 1, wherein the path planning system includes an update unit that updates the certainty factor described in the environmental map based on detection information obtained from a detection sensor that detects the obstacle.

3. 3. The mobile robot according to claim 2, wherein the update unit of the path planning system generates tentative obstacle information when information regarding an obstacle not described in the environmental map is acquired from the detection information, further updates the tentative obstacle information based on the obtained detection information, and adds the tentative obstacle related to the tentative obstacle information to the environmental map as a confirmed obstacle when the tentative obstacle information satisfies a preset condition.

4. The mobile robot according to claim 1 , wherein the output unit of the route planning system outputs the excluded object information, which is information about the obstacles excluded by the route planning unit, to the mobile robot in association with the route information.

5. The mobile robot according to claim 1 , further comprising a transmission unit that transmits a result of detection by the detection unit to the route planning system as detection information.

6. an acquisition step of acquiring an environmental map in which a location of each obstacle and a degree of certainty indicating the likelihood of the obstacle being present at the location are described; a planning step of planning a moving path for the mobile robot to move by excluding obstacles described in the environmental map whose certainty does not satisfy a preset criterion; an output step of outputting route information, which is information on the determined moving route, to the moving robot; A control program for a mobile robot that acquires the route information output by a route planning program and moves according to the acquired route information, a moving step of moving based on the route information; a detection step of detecting surrounding obstacles during the movement in the moving step; on the computer, The detection step is a control program that executes a detection process for the obstacles excluded in the planning step that is more precise than a normal detection process.

Citation Information

Patent Citations

  • Arrangement information creating method and mobile robot

    JP2014211775A

  • Autonomous mobile body

    JP2014219722A

  • Detection device and mobile entity

    JP2017122634A

  • Autonomous moving device, autonomous moving method and program

    JP2019012504A