Program, mobile object control method, and mobile object control apparatus

The program addresses navigation challenges by virtually setting regulating sections to guide robots along a smooth global route, considering their turning capabilities, enabling successful target reach and attitude adjustment.

JP2024159084APending Publication Date: 2024-11-08SYST ENG CONSULTING CO LTD
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
JP2023074845
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-04-28
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

Existing route searching algorithms for autonomous mobile robots fail to consider the current attitude angle and target attitude angle, leading to difficulties in navigating when super-pivot turns are not possible, especially when the target position is behind the robot or requires adjustment upon arrival.

Method used

A program that virtually sets regulating sections to control the moving direction and approach direction of the robot, using map information to search for a global route that accommodates the robot's capabilities, regardless of its ability to make super-turns.

Benefits of technology

Enables smooth navigation of autonomous robots by finding a global route that accounts for the robot's limitations, ensuring it can reach the target position and adjust its attitude angle without super-turns.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024159084000001_ABST
    Figure 2024159084000001_ABST
Patent Text Reader

Abstract

To provide a program, a mobile object control method, and a mobile object control apparatus capable of retrieving a global path in which the mobile object can move smoothly regardless of a type of the mobile object.SOLUTION: The program is a program that causes a control apparatus 3 to perform control for moving a mobile object 10 from a current first point A to a second point B, which is a target arrival point. The program causes the control apparatus 3 to perform a setting step of virtually setting a first regulating unit 1 for regulating a traveling direction of the mobile object 10 at the first point A and a second regulating unit 2 for regulating an approaching direction of the mobile object 10 with respect to the second point B, and a retrieving step of retrieving a global path GR along which the mobile object 10 moves from the first point A to the second point B based on map information 332 relating to a map including the first point A and the second point B, the first regulating unit 1, and the second regulating unit 2.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a program, a method for controlling a moving object, and a control device for a moving object. [Background technology]

[0002] Algorithms such as Dijkstra's algorithm and A* algorithm are used to find a path for moving in a given environmental map, and are used for controlling the movement of autonomous robots. These algorithms can search for a path that can lead an autonomous robot to an arbitrary target position, which is the goal, from its current position, while avoiding obstacles, for example (see Patent Document 1, for example). [Prior art documents] [Patent documents]

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

[0004] However, in the path search, for example, if the current attitude angle of the autonomous robot or the attitude angle of the autonomous robot at the target position is not taken into consideration, the following problems occur. For example, when the target position is set behind the autonomous robot, a global route that is, for example, the shortest distance from the current position of the autonomous robot to the target position is searched for. At that time, if the autonomous robot is capable of making a pivot turn, it performs a pivot turn at the current position and runs while maintaining the attitude angle toward the target position. This allows the autonomous robot to run along the global route and reach the target position. In contrast, if the autonomous robot is not capable of making a pivot turn, it is difficult to make the autonomous robot run along the global route extending behind the autonomous robot and to obtain the running speed during the running. In addition, if the attitude angle at the target position is a target attitude angle that faces the front side as viewed from the current position, if the autonomous robot is capable of making a pivot turn, it can match the target attitude angle by running along the global route and reaching the target position, and then performing a pivot turn. In contrast, if an autonomous robot cannot perform pivot turns, even if it reaches a target position, it has difficulty thereafter in aligning itself with the target attitude angle.

[0005] The present invention has been made in view of the above problems, and has an object to provide a program, a method for controlling a moving object, and a control device for a moving object, which are capable of searching for a global route along which the moving object can move smoothly, regardless of the type of the moving object. [Means for solving the problem]

[0006] In order to achieve the above-mentioned object, the program of the present invention is a program that causes a computer to execute control to move an autonomously moving body from a current first point to a second point that is a destination point, and is characterized in that the program causes the computer to execute a setting process of virtually setting a first regulating unit that regulates the direction of travel of the moving body at the first point and a second regulating unit that regulates the direction of entry of the moving body into the second point, and a search process of searching for a global route for the moving body to move from the first point to the second point based on map information regarding a map including the first point and the second point, the first regulating unit, and the second regulating unit. Effect of the Invention

[0007] According to the present invention, it is possible to search for a global route along which a mobile object can move smoothly, regardless of the type of the mobile object. [Brief description of the drawings]

[0008] [Figure 1] FIG. 2 is a plan view showing a moving state of a moving body. [Diagram 2] FIG. 2 is a block diagram of the moving body shown in FIG. [Diagram 3] 4 is a flowchart showing a control program for moving a moving object. [Figure 4] 13A and 13B are diagrams illustrating a first modified example of the first restricting portion. [Diagram 5] 13A and 13B are diagrams illustrating a second modified example of the first restricting portion. [Figure 6] 13A and 13B are diagrams illustrating a modified example of the second restricting portion. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0009] Hereinafter, the embodiments and modifications of the present invention will be described in detail with reference to the drawings. However, the configurations described in the following embodiments and modifications are merely examples, and the scope of the present invention is not limited by the configurations described in the embodiments and modifications. For example, each part constituting the present invention can be replaced with any configuration that can exert the same function. In addition, any configuration may be added. In addition, any two or more configurations (features) of the embodiments and modifications can be combined.

[0010] First Embodiment Hereinafter, the first embodiment will be described with reference to FIG. 1 to FIG. 3. FIG. 1 is a plan view showing a moving state of a moving body. FIG. 2 is a block diagram of the moving body shown in FIG. 1. As shown in FIG. 1, a moving body 10 is a moving body that can move autonomously (run autonomously) from a current first point A to a second point B, which is a target arrival point, on an XY plane. The moving body 10 is, for example, an AGV (Automated Guided Vehicle) and is used as a transport cart in a logistics warehouse. In FIG. 1, the first point A changes over time as the moving body 10 moves until the moving body 10 reaches the second point B. The current first point A at any time is illustrated in the order of the first point A1, the first point A2, the first point A3, the first point A4, and the first point A5. The postures of the moving body 10 at the first points A1 to A5 are also illustrated. At the first points A1 to A5, as an example, an arbitrary center of the moving object 10 is determined, and the center overlaps with each of the first points A.

[0011] As shown in FIG. 2, the moving body 10 includes a control device (a control device of the moving body) 3 that controls the moving body 10, a movement mechanism unit 4 that moves the moving body 10, and a detection unit 5 that detects obstacles. The control device 3 is a computer as an information processing device, and includes a global route search unit 31, a narrow area route search unit 32, and a storage unit 33. The global route search unit 31 calculates, i.e., searches for, a global route (travel route) GR along which the moving body 10 moves from the first point A to the second point B, based on map information 332 relating to a map including the first point A and the second point B, and a first regulating unit 1 and a second regulating unit 2 described later (searching step). The method of searching for the global route GR is not particularly limited, and examples thereof include a method using an algorithm such as the Dijkstra algorithm or the A* algorithm. The narrow area route search unit 32 calculates the speed of the moving body 10 when the moving body 10 moves along the wide area route GR, and calculates the operating conditions of the moving mechanism unit 4 for running the moving body 10 along the wide area route GR searched by the wide area route search unit 31 (calculation process). The "operating conditions of the moving mechanism unit 4" refer to, for example, a speed condition that is a combination of a translation speed and a rotation speed of each wheel of the moving mechanism unit 4 described later. In addition, in the control device 3, for example, a CPU functions as the wide area route search unit 31 and also functions as the narrow area route search unit 32. In addition, the execution period of the search of the wide area route GR and the execution period of the speed calculation of the moving body 10 may be the same or different. When the execution period of the search of the wide area route GR and the execution period of the speed calculation of the moving body 10 are different, for example, the search of the wide area route GR can be executed once per second, and the speed calculation of the moving body 10 can be executed five times per second.

[0012] The storage unit 33 stores a program 331 and map information 332. The program 331 is a control program that causes the CPU of the control device 3 to execute control (a method of controlling a moving body) for moving the moving body 10 from a first point A to a second point B. In the control device 3, for example, the storage unit 33 has a main storage device and an auxiliary storage device, and when executing control for moving the moving body 10 from the first point A to the second point B, the program 331 stored in the auxiliary storage device is loaded into the main storage device and executed by the CPU. When the moving body 10 is, for example, an AGV and is used as a transport cart in a logistics warehouse, the map information 332 is map information related to an environmental map such as the arrangement of objects in the logistics warehouse and where walls are located. In addition, the map information 332 also includes the first point A and the second point B. Also, the map information 332 may be, for example, prestored and incorporated in a ROM or the like, may be acquired (downloaded) from an external device such as a server, or may be generated by the control device 3 using SLAM (Simultaneous Localization and Mapping) or the like. Thus, the method of acquiring the map information 332 is not particularly limited. Furthermore, the control device 3 can estimate the self-position of the moving body 10. The self-position estimation may be performed, for example, based on information from a GPS or based on the map information 332. Thus, the method of estimating the self-position is not particularly limited. Furthermore, the control device 3 is built into the moving body 10 in the configuration shown in FIG. 2, but is not limited thereto, and may be, for example, an external device such as a server connected to the moving body 10 so as to be able to communicate with it.

[0013] The control device 3 controls the operation of the moving mechanism unit 4 and the detection unit 5. The moving mechanism unit 4 moves the moving body 10. The configuration of the moving mechanism unit 4 is not particularly limited, and may be, for example, a configuration having a plurality of wheels provided on the lower part of the main body of the moving body 10 and a plurality of motors that rotate and drive each wheel. The moving body 10 can move at any speed and in any direction by the plurality of motors controlling the rotation speed of each wheel. The detection unit 5 detects obstacles and the like, and is composed of, for example, a distance sensor, a contact sensor, and the like. The global route search unit 31 can search for a global route GR based on the map information 332, the first regulating unit 1, the second regulating unit 2, and further add the detection result of the detection unit 5. This makes it possible to search for a global route GR that avoids obstacles.

[0014] As described above, the moving body 10 can move by rotating each wheel of the moving mechanism unit 4, but depending on the configuration of the moving mechanism unit 4, it may or may not be possible to make a pivot turn. On the other hand, regardless of whether the moving body 10 can make a pivot turn, the global route search unit 31 searches for a global route GR' that is the shortest route for the moving body 10 to move from the first point A (first point A1) to the second point B based on the map information 332. However, if the moving body 10 cannot make a pivot turn and is in the attitude shown in FIG. 1 at the first point A1, it cannot move along the global route GR'.

[0015] Therefore, the moving body 10 (program 331) is configured to be able to search for a global route GR along which the moving body 10 can move smoothly, regardless of whether the moving body 10 is capable of making a pivot turn, that is, regardless of the type of the moving body 10. The configuration and operation will be described below. Here, as an example, as shown in FIG. 1, the moving body 10 moves from a first point A1, which is a start point, to a second point B, which is a goal point (target point). Note that the moving body 10 is not capable of making a pivot turn. As described above, in FIG. 1, the first point A changes over time from the first point A1 to the first point A5 as the moving body 10 moves until the moving body 10 reaches the second point B. The posture of the moving body 10 at the first point A1, which is the start point, is such that the front of the moving body 10 faces diagonally downward to the left in FIG. 1. The posture of the moving body 10 at the second point B, which is the goal point, is also such that the front of the moving body 10 faces diagonally downward to the left in FIG. 1.

[0016] FIG. 3 is a flowchart showing a control program for moving a moving body. As shown in FIG. 3, in step S301, the control device 3 virtually sets a first regulating unit 1 that regulates the moving direction (attitude angle) of the moving body 10 at the first point A1, and a second regulating unit 2 that regulates the approach direction (attitude angle) of the moving body 10 to the second point B (setting process). Note that information on the first regulating unit 1 and the second regulating unit 2 is stored in advance in the storage unit 33 or incorporated in the program 331. Then, this information is called up when executing step S301, and is temporarily added to the map information 332. As described above, the attitude of the moving body 10 at the first point A1 is such that the front of the moving body 10 faces diagonally downward to the left in FIG. 1. In addition, the moving body 10 cannot make a pivot turn. Therefore, the first regulating unit 1 directs the moving direction of the moving body 10 at the first point A1 toward the diagonally downward to the left in FIG. 1. The first regulating portion 1 is not particularly limited, but for example, in this embodiment, a first wall portion 11 surrounding the moving body 10 is set. The first wall portion 11 is formed with a first opening portion 12 that opens toward the front direction of the moving body 10. The first wall portion 11 has two side wall portions 13 facing the side surfaces of the moving body 10 and one back wall portion 14 facing the back surface of the moving body 10. The first opening portion 12 is formed between the two side wall portions 13. The total length L13 of the side wall portions 13, the width W12 of the first opening portion 12 (the distance between the two side wall portions 13), and the like are determined based on the total length and width of the moving body 10, the minimum turning radius of the moving body 10, and the like. The first regulating portion 1 is set to follow the moving body 10 even when the moving body 10 moves.

[0017] As described above, the posture of the moving body 10 at the second point B is such that the front of the moving body 10 faces the diagonally lower left side in FIG. 1. Therefore, the second regulating unit 2 directs the approach direction of the moving body 10 to the second point B toward the diagonally lower left side in FIG. 1. The second regulating unit 2 is not particularly limited, but for example, in this embodiment, a second wall portion 21 surrounding the second point B is set. The second wall portion 21 is formed with a second opening portion 22 that opens in the opposite direction to the direction in which the moving body 10 can approach the second point B, that is, toward the diagonally upper right side in FIG. 1. In addition, the second wall portion 21 has two side wall portions 23 that face the side surfaces of the moving body 10 when the moving body 10 approaches the second point B, and one back wall portion 24 that faces the back surface of the moving body 10. The second opening portion 22 is formed between the two side wall portions 23. The total length L23 of the side wall portion 23, the width W22 of the second opening 22 (the distance between the two side wall portions 23), etc. are determined based on the total length and width of the moving body 10, the minimum turning radius of the moving body 10, etc. The second regulating portion 2 continues to be set until the moving body 10 reaches the second point B, regardless of whether the moving body 10 is moving or not.

[0018] As shown in Fig. 3, in step S302, the control device 3 (wide area route search unit 31) searches for a wide area route GR along which the moving body 10 moves from the first point A1 to the second point B, based on the map information 332 and the first regulating unit 1 and the second regulating unit 2 at the first point A1 (search step). In addition, in conjunction with this search, the control device 3 (narrow area route search unit 32) calculates the speed of the moving body 10 when the moving body 10 moves along the wide area route GR (calculation step). Note that, in this embodiment, the search step and the calculation step are executed in one step, but are not limited to this, and may be executed in different steps.

[0019] In step S303, the control device 3 controls the movement mechanism unit 4 to move the moving body 10 on the global route GR found in the search step at the speed of the moving body 10 calculated in the calculation step.

[0020] In step S304, the control device 3 judges whether the moving body 10 has reached the second point B, which is the goal point (target point). For example, in step S304, an arbitrary center of the moving body 10 is determined, and when the center overlaps with the second point B, it is judged that the moving body 10 has reached the second point B. Then, if it is judged as a result of the judgment in step S304 that the moving body 10 has reached the second point B, the processing ends. On the other hand, if it is judged as a result of the judgment in step S304 that the moving body 10 has not reached the second point B, the processing returns to step S301, and the subsequent processing is executed sequentially.

[0021] For example, when the process returns to step S301, in step S301, the control device 3 virtually sets the first regulating unit 1 that regulates the traveling direction of the moving body 10 at the first point A2. The second regulating unit 2 is set in the same manner as in the previous step S301. As shown in FIG. 1, the posture of the moving body 10 at the first point A2 is such that the front of the moving body 10 faces the diagonally upper right side in FIG. 1. Therefore, the first regulating unit 1 at the first point A2 directs the traveling direction of the moving body 10 at the first point A2 to the diagonally upper right side in FIG. 1. The first regulating unit 1 at the first point A2 has the same configuration as the first regulating unit 1 at the first point A1, except that the posture of the first regulating unit 1 at the first point A2 is different from the posture of the first regulating unit 1 at the first point A1.

[0022] In step S302, the control device 3 searches for a global route GR along which the moving object 10 moves from the first point A2 to the second point B, based on the map information 332 and the first regulating unit 1 and the second regulating unit 2 at the first point A2, and calculates the speed of the moving object 10. In this way, the global route GR and the speed of the moving object 10 are updated every time step S302 is executed.

[0023] In step S303, the control device 3 controls the movement mechanism unit 4 to move the moving body 10 based on the global route GR and the speed of the moving body 10 acquired in step S302.

[0024] In step S304, the control device 3 judges whether the moving object 10 has reached the second point B. If it is judged in step S304 that the moving object 10 has not reached the second point B, the process returns to step S301, and the subsequent processes are executed in sequence. In this case, the same processes as those at the first point A1 and the second point A2 are executed at the first points A3 to A5. In this manner, the control device 3 repeatedly executes steps S301 to S304 each time the first point A changes until the moving object 10 reaches the second point B. Note that the process of repeating steps S301 to S303 is not limited to being executed each time the first point A changes, and may be executed every time a predetermined time has elapsed (for example, every 1 to 5 seconds).

[0025] By such control, even if the moving body 10 is not capable of a quick turn, it is possible to search for a global route GR along which the moving body 10 can move smoothly. In this embodiment, the moving body 10 controlled by the program 331 is not capable of a quick turn, but is not limited thereto and may be capable of a quick turn. As described above, regardless of whether the moving body 10 is capable of a quick turn, that is, regardless of the type of the moving body 10, a global route GR to the second point B can be smoothly searched for with a simple configuration in which the first regulating unit 1 and the second regulating unit 2 are virtually set. In addition, it is possible to omit adding information such as a waypoint of the moving body 10. In addition, depending on the positional relationship between the first point A and the second point B and the size relationship between the first regulating unit 1 and the second regulating unit 2, the first regulating unit 1 and the second regulating unit 2 may interfere with each other. In addition, the first regulating unit 1 and the second regulating unit 2 may disappear after the moving body 10 reaches the second point B.

[0026] <First Modification of First Restriction Portion> Hereinafter, a first modified example of the first regulating unit will be described with reference to FIG. 4. The description will be focused on the differences from the above-described embodiment, and the description of the similar matters will be omitted. FIG. 4 is a diagram showing a first modified example of the first regulating unit. As shown in FIG. 4, for the first regulating unit 1, at least one of the shape and size of the first wall portion 11 can be changed, and the size of the first opening portion 12 can also be changed. Specifically, the total length L13 of the side wall portion 13 and the width W12 of the first opening portion 12 can be changed according to the total length and width of the moving body 10, the minimum turning radius of the moving body 10, and the like. For example, in the case of a moving body 10 with a relatively large minimum turning radius, that is, a moving body 10 with poor turning ability, the total length L13 can be set longer and the width W12 can be set smaller. The total length L13 and the width W12 may be changed in advance on the program 331 before the program 331 is executed, or may be changed on a change operation screen.

[0027] <Second Modification of First Restriction Portion> Hereinafter, a second modified example of the first restricting portion will be described with reference to Fig. 5, but the differences from the above-mentioned embodiment will be mainly described, and the description of the similar matters will be omitted. Fig. 5 is a diagram showing a second modified example of the first restricting portion. As shown in Fig. 5, the moving body 10 is composed of a towing vehicle 101 and a towed vehicle 102 towed by the towing vehicle 101. In the case of such a moving body 10, it is preferable to change the total length L13 of the side wall portion 13 in particular according to the total length of the moving body 10, the minimum turning radius of the moving body 10, etc.

[0028] <Modification of the second restriction portion> Hereinafter, a modified example of the second restricting portion will be described with reference to FIG. 6, but the description will be focused on the differences from the above-described embodiment, and the description of the similar matters will be omitted. FIG. 6 is a diagram showing a modified example of the second restricting portion. As shown in FIG. 6, for the second restricting portion 2, at least one of the shape and size of the second wall portion 21 can be changed, and the size of the second opening 22 can also be changed. Specifically, the total length L23 of the side wall portion 23 and the width W22 of the second opening 22 can be changed according to the total length and width of the moving body 10, the minimum turning radius of the moving body 10, and the like. For example, in the case of a moving body 10 with a relatively large minimum turning radius, that is, a moving body 10 with poor turning ability, the total length L23 can be set longer and the width W22 can be set smaller. The change of the total length L23 and the width W22 may be performed in advance on the program 331 before the program 331 is executed, or may be performed on a change operation screen.

[0029] Although the preferred embodiment of the present invention has been described above, the present invention is not limited to the above-mentioned embodiment and modifications, and various modifications and changes are possible within the scope of the gist of the present invention. The present invention can also be realized by supplying a program that realizes one or more functions of the above-mentioned embodiment to a system or device via a network or storage medium, and having one or more processors of a computer in the system or device read and execute the program. The present invention can also be realized by a circuit (e.g., ASIC) that realizes one or more functions. [Explanation of symbols]

[0030] 1. First Regulatory Section 2. Second Regulatory Department 3 Control device (control device for mobile object) 10 Mobile 331 Programs 332 Map Information A 1st point B 2nd point GR Global route (driving route) S301~S304 Steps

Claims

1. A program for causing a computer to execute control for moving an autonomously moving object from a current first point to a second point that is a destination point, a setting step of virtually setting a first regulating section that regulates a traveling direction of the moving object at the first point and a second regulating section that regulates an approach direction of the moving object to the second point; A program for causing a computer to execute a search process for searching for a global route for the moving body to move from the first point to the second point based on map information regarding a map including the first point and the second point, the first regulating unit, and the second regulating unit.

2. The program according to claim 1, characterized in that the program causes the computer to repeatedly execute the setting process and the search process each time the first location changes or each time a predetermined time elapses until the moving body reaches the second location.

3. The program according to claim 1, characterized in that in the setting process, a first wall portion that surrounds the moving body and has a first opening that opens toward the front direction of the moving body is set as the first regulating portion.

4. 4. The program according to claim 3, wherein at least one of a shape and a size of the first wall portion is changeable.

5. 4. The program according to claim 3, wherein the size of the first opening is changeable.

6. The program described in claim 1, characterized in that in the setting process, a second wall portion is set as the second regulating portion, surrounding the second point and having a second opening that opens in a direction opposite to the direction in which the moving body can enter the second point.

7. 7. The program according to claim 6, wherein at least one of a shape and a size of the second wall portion is changeable.

8. 7. The program according to claim 6, wherein the size of the second opening is changeable.

9. 2. The program according to claim 1, further comprising a calculation step of calculating a speed of the moving object when the moving object moves along the global route.

10. The moving object includes a detection unit that detects an obstacle, 2. The program according to claim 1, wherein in the searching step, the global route is searched for based on the detection result by the detection unit, the map information, the first restriction unit, and the second restriction unit.

11. A method for controlling an autonomously moving object to move from a current first point to a second point that is a target arrival point, a setting step of virtually setting a first regulating section that regulates a traveling direction of the moving object at the first point and a second regulating section that regulates an approach direction of the moving object to the second point; A method for controlling a moving body, comprising: a search process for searching for a global route for the moving body to move from the first point to the second point based on map information regarding a map including the first point and the second point, the first regulating unit, and the second regulating unit.

12. A device for controlling an autonomously moving object to move from a current first point to a second point that is a target arrival point, a setting step of virtually setting a first regulating section that regulates a traveling direction of the moving object at the first point and a second regulating section that regulates an approach direction of the moving object to the second point; a search process for searching for a global route along which the moving body will move from the first point to the second point based on map information regarding a map including the first point and the second point, the first regulating unit, and the second regulating unit.

Citation Information

Patent Citations

  • Method for generating autonomic traveling path of traveling object

    JP2003029833A

  • Parking assisting system, parking assisting method and program

    JP2017124659A

  • Automatic conveyance system

    JP2020123357A