This application is based upon and claims the benefit of priority from Japanese patent application No. 2020-086172, filed on May 15, 2020, the disclosure of which is incorporated herein in its entirety by reference.
The present disclosure relates to an autonomous mobile apparatus control system, a control method thereof, and a control program thereof.
Advances in the development of autonomous mobile apparatuses which autonomously move inside predetermined buildings and facilities has been made. Such an autonomous mobile apparatus may be an automatic delivery apparatus including a carrier or pulling a truck to automatically deliver a package. The automatic delivery apparatus can deliver, for example, a package loaded at a departure place to a destination by autonomously moving from the departure place to the destination.
For example, the automatic delivery apparatus described in U.S. Pat. No. 9,026,301 includes a tug and a cart that can autonomously move. A computer included in the automatic delivery apparatus stores an electronic map of a floor plan of a building and a path to be followed when the automatic delivery apparatus moves from one location to the next. The automatic delivery apparatus transports various articles using different types of loading platform parts according to the purpose.
However, in a transport robot, for example, an emergency stop operation is performed by pressing an emergency stop button for forcibly stopping the operation, or an emergency stop operation is performed to avoid contact with a person or an obstacle, and the autonomous drive state is canceled. When such an emergency stop operation is performed, there is no disclosure in U.S. Pat. No. 9,026,301 about how to recover the autonomous drive state of the transport robot.
The present disclosure has been made to solve such a problem. An object of the present disclosure is to safely recover a robot to the autonomous drive state from an emergency stop state.
An example aspect of the present disclosure is an autonomous mobile apparatus control system including: an autonomous mobile robot; a higher-level management apparatus configured to manage the autonomous mobile robot; and a plurality of environment cameras configured to photograph a moving range of the autonomous mobile robot and transmit a photographed image to the higher-level management apparatus. The autonomous mobile robot is configured to: acquire a movement target position from the higher-level management apparatus; and autonomously move toward the movement target position; when the autonomous mobile robot enters a stuck state in which the autonomous mobile robot cannot autonomosly move, transmit an autonomous cancel notification for notifying the higher-level management apparatus that the autonomous mobile robot cannot autonomosly move; and wait for an operation instruction from the higher-level management apparatus after the transmission of the autonomous cancel notification. The higher-level management apparatus is configured to give an operation instruction to the autonomous mobile robot in response to receiving the autonomous cancel notification based on information acquired from at least one of the plurality of environment cameras, and the autonomous mobile robot is configured to resume autonomous driving in response to safety confirmation based on a proximity sensor provided in the autonomous mobile robot after operating in accordance with the operation instruction.
Another example aspect of the present disclosure is a method of controlling an autonomous mobile apparatus control system including: an autonomous mobile robot; a higher-level management apparatus configured to manage the autonomous mobile robot; and a plurality of environment cameras configured to photograph a moving range of the autonomous mobile robot and transmit a photographed image to the higher-level management apparatus. The method includes: controlling the autonomous mobile robot to acquire a movement target position from the higher-level management apparatus, and autonomously move toward the movement target position; when the autonomous mobile robot enters a stuck state in which the autonomous mobile robot cannot autonomosly move, controlling the autonomous mobile robot to transmit an autonomous cancel notification for notifying the higher-level management apparatus that the autonomous mobile robot cannot autonomosly move; controlling the autonomous mobile robot to wait for an operation instruction from the higher-level management apparatus after the transmission of the autonomous cancel notification; controlling the higher-level management apparatus to give an operation instruction to the autonomous mobile robot in response to receiving the autonomous cancel notification based on information acquired from at least one of the plurality of environment cameras; and controlling the autonomous mobile robot to resume autonomous driving in response to safety confirmation based on a proximity sensor provided in the autonomous mobile robot after controlling the autonomous mobile robot to operate in accordance with the operation instruction.
Another example aspect of the present disclosure is a control program of an autonomous mobile robot executed by a higher-level management apparatus in an autonomous mobile apparatus control system including: an autonomous mobile robot; a higher-level management apparatus configured to manage the autonomous mobile robot; and a plurality of environment cameras configured to photograph a moving range of the autonomous mobile robot and transmit a photographed image to the higher-level management apparatus. The control program: causes the autonomous mobile robot to acquire a movement target position from the higher-level management apparatus, and autonomously move toward the movement target position; when the autonomous mobile robot enters a stuck state in which the autonomous mobile robot cannot autonomosly move, causes the higher-level management apparatus to receive an autonomous cancel notification for notifying the higher-level management apparatus that the autonomous mobile robot cannot autonomosly move; gives an operation instruction to the autonomous mobile robot in response to receiving the autonomous cancel notification based on information acquired from at least one of the plurality of environment cameras; and controls the autonomous mobile robot to resume autonomous driving in response to safety confirmation based on a proximity sensor provided in the autonomous mobile robot after controlling the autonomous mobile robot to operate in accordance with the operation instruction.
In the autonomous mobile apparatus control system, the control method thereof, and the control program thereof according to the present disclosure, after the stuck state occurs, the higher-level management apparatus gives an initial operation instruction based on the surrounding environment of the autonomous mobile robot, and after confirming that no safety error occurs, the autonomous mobile robot can be recovered to the autonomous drive mode.
According to the present disclosure, it is possible to provide an autonomous mobile apparatus control system, a control method thereof, and a control program thereof that can safely recover an autonomous mobile robot to an autonomous drive state from a stuck state.
The above and other objects, features and advantages of the present disclosure will become more fully understood from the detailed description given hereinbelow and the accompanying drawings which are given by way of illustration only, and thus are not to be considered as limiting the present disclosure.
For clarity of explanation, the following descriptions and drawings have been omitted and simplified as appropriate. Further, each element described in the drawing as a functional block for performing various processes can be composed of a CPU (Central Processing Unit), a memory, or other circuit in terms of hardware, and is implemented by a program loaded into the memory in terms of software. It will thus be understood by those skilled in the art that these functional blocks may be implemented in a variety of ways, either hardware only, software only, or a combination thereof. In the drawings, the same elements are denoted by the same reference signs, and repeated description is omitted if necessary.
The above program can be stored and provided to a computer using any type of non-transitory computer readable media. Non-transitory computer readable media include any type of tangible storage media. Examples of non-transitory computer readable media include magnetic storage media (such as floppy disks, magnetic tapes, hard disk drives, etc.), optical magnetic storage media (e.g. magneto-optical disks), CD-ROM (Read Only Memory), CD-R, CD-R/W, and semiconductor memories (such as mask ROM, PROM (Programmable ROM), EPROM (Erasable PROM), flash ROM, RAM (Random Access Memory), etc.). The program may be provided to a computer using any type of transitory computer readable media. Examples of transitory computer readable media include electric signals, optical signals, and electromagnetic waves. Transitory computer readable media can provide the program to a computer via a wired communication line (e.g. electric wires, and optical fibers) or a wireless communication line.
In the autonomous mobile apparatus control system 1 according to the first embodiment, the higher-level management apparatus 10 instructs the autonomous transport robot 20 to move to a destination, and the autonomous transport robot 20 then moves autonomously toward the destination designated by the higher-level management apparatus 10. At this time, in the autonomous mobile apparatus control system 1 according to the first embodiment, the autonomous transport robot 20 autonomously moves toward the destination using sensors provided in the autonomous mobile robot 20, a floor map, position information, and the like. The higher-level management apparatus 10 uses the environment cameras 30 to perform safety management of the operations of the autonomous transport robots 20 and stuck avoidance processing when the autonomous transport robot 20 is in the stuck state.
The higher-level management apparatus 10 includes an arithmetic processing unit 11, a storage unit 12, a buffer memory 13, and a communication unit 14. The arithmetic processing unit 11 performs arithmetic operations for controlling and managing the autonomous transport robots 20. Although
The robot control unit 111 performs calculation for remotely operating the autonomous transport robots 20, and generates specific operation instructions for the autonomous transport robots 20. The stuck avoidance processing procedure generation unit 112 generates a stuck avoidance procedure for recovering the autonomous transport robot 20 from the stuck state based on the images acquired from the environment cameras 30 when the autonomous transport robot 20 is in the stuck state. This stuck avoidance procedure indicates the order, direction, and amount of movement of the autonomous transport robot 20 in the stuck state.
The storage unit 12 stores information necessary for the management and control of the robots. In the example of
The floor map 121 is map information of a facility in which the autonomous transport robots 20 move. The floor map 121 may be created in advance, may be generated from information acquired from the autonomous transport robot 20, or may be a basic map created in advance added with map correction information generated from the information acquired from the autonomous transport robot 20.
The robot information 122 describes the model number and specifications of the autonomous transport robot 10 managed by the higher-level management apparatus 20. The robot control parameter 123 describes a control parameter such as distance threshold information about a distance between each of the autonomous transport robots 10 managed by the higher-level management apparatus 20 and an obstacle.
The buffer memory 13 stores intermediate information generated in processing in the arithmetic processing unit 11. The communication unit 14 is a communication interface for communicating with the plurality of environment cameras 30 and at least one autonomous transport robot 20 provided in the facility where the autonomous mobile apparatus control system 1 is used. The communication unit 14 can perform both wired communication and wireless communication.
The autonomous transport robot 20 includes an arithmetic processing unit 21, a storage unit 22, a communication unit 23, a proximity sensor (e.g., a distance sensor group 24), a camera 25, a drive unit 26, a display unit 27, and an operation reception unit 28. In
The communication unit 23 is a communication interface for communicating with the communication unit 10 of the higher-level management apparatus 14. The communication unit 23 communicates with the communication unit 14 using, for example, radio signals. The distance sensor group 24 is, for example, a proximity sensor, and outputs proximity distance information indicating a distance to an object or a person present around the autonomous transport robot 20. The camera 25, for example, photographs images for recognizing the surrounding situation of the autonomous transport robot 20. The camera 25 can also photograph, for example, a position marker provided on the ceiling of the facility or the like. In the autonomous mobile apparatus control system 1 according to the first embodiment, the position marker is used to make the autonomous transport robot 20 recognize the position of itself. The drive unit 26 drives driving wheels provided in the autonomous transport robot 20. The display unit 27 displays a user interface screen to be an operation reception unit 28. The display unit 27 may display information indicating the destination of the autonomous transport robot 20 and the state of the autonomous transport robot 20. The operation reception unit 28 includes, in addition to the user interface screen displayed on the display unit 27, various switches provided in the autonomous transport robot 20. The various switches include, for example, an emergency stop button.
The arithmetic processing unit 21 performs arithmetic operations used for controlling the autonomous transport robot 20. More specifically, the arithmetic processing unit 21 includes a movement instruction extraction unit 211, a drive control unit 212, and a peripheral abnormality detection unit 213. In
The movement instruction extraction unit 211 extracts a moving instruction from a control signal supplied from the higher-level management apparatus 10 and supplies it to the drive control unit 212. The drive control unit 212 controls the drive unit 211 so as to move the autonomous transport robot 20 at the speed and direction indicated by the movement instruction given from the movement instruction extraction unit 26. When the drive control unit 212 receives an emergency stop signal from the emergency stop button included in the operation reception unit 28, the drive control unit 212 stops the operation of the autonomous transport robot 20 and gives an instruction to the drive unit 26 not to generate a drive force. The peripheral abnormality detection unit 213 detects an abnormality generated in the periphery of the autonomous transport robot 24 based on information acquired from the distance sensor group 20 or the like, and gives a stop signal for stopping the autonomous transport robot 20 to the drive control unit 212. The drive control unit 212, which has received the stop signal, gives an instruction to the drive unit 26 not to generate the drive force.
The storage unit 22 stores a floor map 221 and a robot control parameter 222.
The drive control unit 212 refers to the robot control parameter 222 and stops the operation or limits the operation speed when the distance indicated by the distance information acquired from the distance sensor group 24 falls below the operation limit threshold.
The external appearance of the autonomous transport robot 20 will now be described.
An example shown in
As shown in
In the autonomous transport robot 20 according to the first embodiment, a drive unit 26 is provided below the storage 291. The drive unit 26 is provided with driving wheels 261 and casters 262. The driving wheels 261 move the autonomous transport robot 20 back and forth, left and right. The casters 262 are driven wheels to which no drive force is applied and which follow the driving wheels 261 by rolling.
In the autonomous transport robot 20, a display unit 27, an operation interface 281, and a camera 25 are provided on the upper surface of the storage 291. The display unit 27 displays the operation reception unit 28 and the operation interface 281. An emergency stop button 282 is provided on the upper surface of the display unit 27.
Next, the operation of the autonomous mobile apparatus control system 1 according to the first embodiment will be described. One of the features of the autonomous mobile apparatus control system 1 according to the first embodiment is an operation thereof when the autonomous transport robot 20 is in a stuck state in which the autonomous transport robot 20 cannot autonomously move. Therefore, in the following description, as an operation example of the autonomous transport robot 20, an operation example of the autonomous mobile apparatus control system 1 in which the stuck state of the autonomous transport robot 20 occurs will be described.
As one operation example of the autonomous transport robot 20,
In the example shown in
When the autonomous transport robot 20 moves along the path P1 shown in
For example, when the emergency stop button 282 of the autonomous transport robot 20 is pressed during the movement to cause the autonomous transport robot 20 to enter the stuck state (YES branch of Step S3), the autonomous transport robot 20 transmits an autonomous cancel notification to notify the higher-level management apparatus 10 that the autonomous transport robot 20 has transitioned to an autonomous cancel mode (Step S5).
Upon receiving the autonomous cancel notification, the higher-level management apparatus 10 uses the environment cameras 30 to acquire images of the surrounding environment of the autonomous transport robot 20 in the stuck state. Based on the acquired images, the stuck avoidance processing procedure generation unit 112 of the higher-level management apparatus 10 confirms whether or not the surrounding environment of the autonomous transport robot 20 is safe (Step S6). In Step S6, it is determined whether or not there is an obstacle or a person within a predetermined range around the autonomous transport robot 20 in the stuck state. If it is confirmed in Step S6 that a safe state in which there are no obstacles or persons is not ensured in the predetermined range around the autonomous transport robot 20, the higher-level management apparatus 10 waits until the safe state is ensured before giving an instruction to the autonomous transport robot 20 (NO branch of Step S6). On the other hand, if it is confirmed in Step S6 that the safe state of the predetermined range around the autonomous transport robot 20 is ensured (YES branch of Step S6), the higher-level management apparatus 10 determines the direction in which the autonomous transport robot 30 can move based on the images acquired from the environment cameras 20 (Step S7). The higher-level management apparatus 10 transmits an operation instruction for instructing the autonomous transport robot 20 to move in the determined direction based on the determination in Step S7 (Step S8). Note that the processing of Step S7 is performed by the stuck avoidance processing procedure generation unit 112, and the processing of Step S8 is performed by the robot control unit 111 based on the determination result of the stuck avoidance processing procedure generation unit 112.
Then, in Step S8, the autonomous transport robot 20, which has received the operation instruction from the higher-level management apparatus 10, confirms the safety of its surroundings using the distance sensor group 24 (Step S9). In Step S9, if the safety is not confirmed (NO branch of Step S9), the autonomous transport robot 20 again requests the higher-level management apparatus 10 to confirm the safety and to instruct the moving direction. On the other hand, if the safety is confirmed in Step S9 (YES branch of Step S9), the autonomous transport robot 20 starts moving in the moving direction given in Step S8, and recovers the autonomous transport robot 20 to the autonomous drive mode to move by autonomous driving (Step S10). After recovering to the autonomous drive mode, the autonomous transport robot 20 repeates the operations of Steps S2 to S4 to reach the destination.
From the above description, in the autonomous mobile apparatus control system 1 according to the first embodiment, when the autonomous transport robot 20 transitions from the autonomous drive mode to the autonomous cancel mode for some reason, the autonomous transport robot 20 is recovered to the autonomous drive mode based on the instruction from the higher-level management apparatus 10. Thus, in the autonomous mobile apparatus control system 1 according to the first embodiment, the autonomous transport robot 20 can be safely recovered from the autonomous cancel mode to the autonomous drive mode.
For example, it can be considered that persons and the autonomous transport robots 20 coexist in a facility. In such a case, when an emergency occurs, a person(s) around the autonomous transport robot 20 may press the emergency stop button 282, and the autonomous transport robot 20 may be set to the autonomous cancel mode. In such a case, the safety may be insufficient if only the safety within the detectable range is confirmed by the distance sensor group 20 of the autonomous transport robot 24. Even in such a case, in the autonomous mobile apparatus control system 1, the safety in a range wider than the detectable range of the distance sensor group 24 of the autonomous transport robot 20 is confirmed using the environment cameras 30, and the initial moving direction in the autonomous operation mode is given. By doing so, it is possible to more safely recover the autonomous transport robot 20 to the autonomous drive mode.
In a second embodiment, another form of the method for recovering from the autonomous cancel mode to the autonomous drive mode will be described. In the description of the second embodiment, components described in the first embodiment are denoted by the same reference signs as those in the first embodiment, and description of those components is omitted.
In the second embodiment, the autonomous transport robot 20 determines a recover procedure for recovering the autonomous transport robot 20 from the stuck state to the autonomous drive state. At this time, in the second embodiment, the autonomous transport robot 20 determines the recover procedure based on environmental information including the images of the surrounding envrionment of the autonomous transport robot 20 acquired from the higher-level management apparatus 10.
In the second embodiment, it is assumed that the autonomous transport robot 20 alone cannot recover from the stuck state to the autonomous drive state when the safety function of the autonomous transport robot 20 using the distance sensor group 24 is effective in the stuck state.
Therefore, in the autonomous mobile apparatus control system according to the second embodiment, the assumed stuck state will be described with reference to
The first example shown in
In the second example shown in
In the second embodiment, the operation of the autonomous mobile apparatus control system according to the second embodiment including the process for recovering from the stuck state to the autonomous drive mode as shown in
As shown in
In the second embodiment, the higher-level management apparatus 10, which has received the autonomous cancel notification in Step S5, uses the environment cameras 30 to recognize the situation around the autonomous transport robot 20 in the stuck state, and determines whether the autonomous transport robot 20 can avoid an obstacle that caused the stuck state (Step S11). In the determination in Step S11, for example, when the obstacle is a mobile body, a determination may be made to wait for the mobile body to pass and then recover the autonomous transport robot 20 to the autonomous drive mode. Further, in the determination in Step S11, for example, if it is determined that it is impossible to avoid the obstacle, for example, when a path that the autonomous transport robot 20 can move cannot be found around the autonomous transport robot 20 (NO branch of Step S11), the higher-level management apparatus 10 notifies an operator of this determination (Step S12), and ends the control of the autonomous transport robot 20 in the stuck state.
On the other hand, if it is determined in Step S11 that the autonomous transport robot 20 can avoid the obstacle (YES branch of Step S11), the higher-level management apparatus 10 notifies the autonomous transport robot 20 of the determination, and the autonomous transport robot 20 requests the environmental information around the autonomous transport robot 20 to the higher-level management apparatus 10 in response to the notification (Step S13). The environmental information includes image information which is photographed by the environment cameras 30 and enables recognition of the situation around the autonomous transport robot 20.
The autonomous transport robot 20 determines the direction in which the autonomous transport robot 20 can move based on the acquired environmental information (Step S14). The autonomous transport robot 20 starts moving in the direction determined in Step S14 (Step S16), and invalidates the distance sensor group 24 or relaxes an operation limit threshold condition for the detection result acquired from the distance sensor group 24 until there is no obstacle in the safety range set based on the distance D1. In the example shown in
From the above description, in the second embodiment, the autonomous transport robot 20 determines the moving direction of the autonomous transport robot 20 for recovering to the autonomous drive mode from the stuck state and controls the movement based on the information acquired from the higher-level management apparatus 10. As described above, the determination of the moving direction and the movement control of the autonomous transport robot 20 for recovering from the stuck state to the autonomous drive mode can be performed by the higher-level management apparatus 10 or by the autonomous transport robot 20. At this time, the autonomous transport robot 20 determines the moving direction and the movement control of the autonomous transport robot 20 based on the environmental information acquired by the higher-level management apparatus 10 using the environment cameras 30. By doing so, it is possible to recover the autonomous transport robot 20 to the safe autonomous drive mode in a manner similar to the first embodiment.
In a third embodiment, another form of the method for recovering from the autonomous cancel mode to the autonomous drive mode will be described. In the description of the third embodiment, components described in the first and second embodiments are denoted by the same reference signs as those of the first and second embodiments, and description of those components is omitted.
In the third embodiment, the recovery from the stuck state shown in
The details of Step S21 will now be described.
Then, the higher-level management apparatus 10, which has acquired the device state information, uses the environment cameras 30 to recognize the surrounding environment of the autonomous transport robot 20 in the stuck state (Step S31). Next, the higher-level management apparatus 10, in the stuck avoidance processing procedure generation unit 112 creates the stuck avoidance procedure for preventing the autonomous transport robot 20 from being stuck based on the information acquired in Steps S30 and S31 (Step S32). The higher-level management apparatus 10 repeats the processing of Steps S31 and S32 until the safety around the autonomous transport robot 20 can be confirmed based on the information acquired from the environment cameras 30 (Step S33). Then, in Step S33, in response to the confirmation of the safety around the autonomous transport robot 20, the higher-level management apparatus 10 starts the processing from Step S33 onwards. In Step S34, the robot control unit 111 of the higher-level management apparatus 10 invalidates the determination of the distance information acquired from the distance sensor group 24 of the autonomous transport robot 20 or relaxes the determination condition (Step S34). In the state of Step S34, the operation of the autonomous transport robot 20 is under the control of the higher-level management apparatus 10, and the autonomous transport robot 20 does not limit the operation based on the information independently acquired from the distance sensor group 24.
Next, the higher-level management apparatus 10 gives an operation instruction to the autonomous transport robot 20 in accordance with the stuck avoidance processing procedure created in Step S32, and moves the autonomous transport robot 20 (Step S35). The higher-level management apparatus 10 performs the processing of Step S35 until the safety of the autonomous transport robot 20 within the safety range is confirmed based on the distance information acquired from the distance sensor group 24 of the autonomous transport robot 20 (Step S36). In response to the confirmation in Step S36 of the safety in the safety range of the autonomous transport robot 20, the higher-level management apparatus 10 cancels the invalidation or condition relaxation of the autonomous transport robot 20 for the distance sensor group 24 (Step S37), and controls the autonomous transport robot 20 to transition to the autonomous drive mode (Step S38).
As described above, in the third embodiment, the autonomous transport robot 20 in the stuck state is controlled by the higher-level management apparatus 10 until the safety within the safety range is confirmed. Thus, in the autonomous mobile apparatus control system according to the third embodiment, the processing load of the autonomous transport robot 20 can be reduced as compared with that according to the other embodiments.
From the disclosure thus described, it will be obvious that the embodiments of the disclosure may be varied in many ways. Such variations are not to be regarded as a departure from the spirit and scope of the disclosure, and all such modifications as would be obvious to one skilled in the art are intended for inclusion within the scope of the following claims.
Number | Date | Country | Kind |
---|---|---|---|
2020-086172 | May 2020 | JP | national |