Moving robot, moving robot control method and program therefor

A control method for a mobile robot that moves from a predetermined initial position to a predetermined target position, the mobile robot including a plurality of robot units, each of the robot units including a plurality of robots, a robot structure of one block including each of the robot units adjacent to another robot unit referred to as connectivity of the robot structure, a common portion between the initial position and the target position set to be a common position, and the common position including a set of one or more partial common positions, and the control method comprising:

• transmitting, by a position distance calculation command transmission unit of a robot i_root located at a predetermined root position, a position distance calculation command including a relative position from the predetermined root position and the number of times of transmission and transfer of a position distance calculation command, which are respectively set to predetermined initial values, to an adjacent robot;
• incrementing, by a position distance calculation command transferer of the robot receiving the position distance calculation command, the number of times of transmission and transfer included in the position distance calculation command, updating a relative position included in the position distance calculation command in accordance with a direction in which the position distance calculation command is received, and transferring a position distance calculation command including the incremented number of times of transmission and transfer and the updated relative position to an adjacent robot, other than the robot transmitting the position distance calculation command, only once;
• transmitting, by a return position distance calculation command transmitter of the robot first receiving the position distance calculation command, a return position distance calculation command including the incremented number of times of transmission and transfer and the updated relative position to the robot transmitting the position distance calculation command;
• storing, by a direction storage of the robot first receiving the position distance calculation command, a direction of the robot transmitting the position distance calculation command as a root direction;
• transferring, by a return position distance calculation command transferer of the robot receiving the return position distance calculation command, the received return position distance calculation command in the root direction read from the direction storage unit;
• selecting, by a first head robot determination command transmitter unit of the robot i_root receiving the return position distance calculation command, selecting any one partial common position set as a set Up based on the positions of the robots based on the initial position, the target position, and the relative position included in the return position distance calculation command, selecting a robot unit, as a head robot unit Head, which is located at a position belonging to the set Up and adjacent to a position where there is no robot unit within the target position (hereinafter, referred to as an objective position D), and transmitting a head robot determination command including the positions of the robots and information on the set Up to a predetermined robot h included in the selected head robot unit Head;
• determining, by a void generation order determiner of the robot h receiving the head robot determination command, the objective position D, a tail robot unit Tail which is a robot unit located at a position not belonging to the set Up and positioned within the initial position and which is a robot unit capable of maintaining connectivity of the robot structure even when moved, a path from the head robot unit Head to the tail robot unit Tail, and a void generation order for the robots within the head robot unit Head, based on the positions of the robots and the information on the set Up;
• transmitting, by a void generation command transmitter of the robot h receiving the void generation command, a void generation command addressed to a robot v1 at a position based on the determined void generation order within the head robot unit Head to an adjacent robot unit;
• transferring, by a void generation command transferer of the robot receiving the void generation command, the void generation command to an adjacent robot until the void generation command reaches the robot v1;
• transmitting, by a push command transmitter of the robot v1 receiving the void generation command, in a case where the robot is the robot v1 and the void generation command is received, a push command to an adjacent robot in an ah direction with a direction in which the head robot unit Head moves as the ah direction;
• transferring, by a return push command transmitter of the robot receiving the push command, in a case where there is an adjacent robot in the ah direction, the push command to the adjacent robot in the ah direction, and transmitting, in a case where he push command is received and there is no adjacent robot in the ah direction, a return push command to an adjacent robot in a direction opposite to the ah direction;
• transferring, by a return push command transferer of the robot receiving the return push command, the return push command to an adjacent robot in the direction opposite to the ah direction until the return push command reaches the robot v1;
• transmitting, by a void operation command transmitter of the robot v1 receiving the return push command, a void operation command to a robot located on the path and adjacent to the robot v1;
• transmitting, by a first mover of the robot v1 receiving the return push command, the void operation command and then moving the robot v1 in the ah direction;
• transferring, by a void operation command transferer of the robot receiving the void operation command, the void operation command to a robot located on the path and located in a direction approaching the tail robot unit Tail by one box from the robot itself within the path;
• transmitting, by a movement command transmitter of the robot receiving the void operation command, a movement command to a robot transmitting the void operation command in a case where the number of times of transmission and transfer of the void operation command is a predetermined number of times;
• transmitting, by a return movement command transmitter of the robot receiving the movement command, a return movement command to a robot transmitting the movement command;
• moving, by a second mover of the robot receiving the return movement command, the robot in a direction of a robot transmitting the void operation command together with the robot transmitting the void operation command;
• transmitting, by a pull command transmitter of the robot included in a robot unit T′ one robot unit before the tail robot unit Tail and receiving the void operation command, a pull command to the robot which is included in a robot unit T′ one robot unit before the head robot unit Tail and located at a position within T′ being the same as a position within a robot unit of the robot v1 with a moving direction of the tail robot unit Tail as an at direction and which is an adjacent robot in a direction opposite to the at direction;
• transferring, by a return pull command transmitter of the robot receiving the pull command, in a case where there is an adjacent robot in the direction opposite to the at direction within the tail robot unit Tail, the pull command to the adjacent robot in the direction opposite to the at direction, and transmitting, in a case where the pull command is received and there is no robot adjacent thereto in the direction opposite to the at direction within the tail robot unit Tail, a return pull command to the adjacent robot in the at direction;
• moving, by a third mover receiving the return pull command, the robot in the at direction together with the robot transmitting the return pull command;
• performing, by a control unit of the robot h, control so as to repeat processing of each of the void generation order determiner, the void generation command transfer, the push command transmitter, the return push command transmitter, the return push command transferer, the void operation command transmitter, the first mover, the void operation command transferer, the movement command transmitter, the return movement command transmitter, the second mover, the pull command transmitter, the return pull command transmitter, and the third mover until all of the robots included in the head robot unit Head are moved to the objective position D;
• updating, by a set updater of the robot h, the set Up by adding the objective position D to the set Up and then, in a case where there is a robot unit which is in contact with the set Up and positioned within the target position instead of within the set Up, adding the position of the robot unit and a position of a robot unit in a connected state through only the position of the target position from the robot unit to the set Up;
• and
• updating, by a second head robot determination command transmitter of the robot h, the position of the tail robot unit Tail and positions of robots located at the objective position D, newly selecting, in a case where there is a robot unit located at a position belonging to the set Up and adjacent to a position where there is no robot unit within the target position, the robot unit as a head robot unit Head based on the updated positions of the robots, and transmitting a head robot determination command including the updated positions of the robots and information on the updated set Up to a new predetermined robot h included in the newly selected head robot unit Head.

A computer-readable non-transitory recording medium storing computer-executable program instructions for a mobile robot that moves from a predetermined initial position to a predetermined target position, the mobile robot including a plurality of robot units, each of the robot units including a plurality of robots, a robot structure of one block including each of the robot units adjacent to another robot unit referred to as connectivity of the robot structure, a common portion between the initial position and the target position set to be a common position, and the common position including a set of one or more partial common positions, that when executed by a processor cause a computer to:

• transmit, by a position distance calculation command transmission unit of a robot i root located at a predetermined root position, a position distance calculation command including a relative position from the predetermined root position and the number of times of transmission and transfer of a position distance calculation command, which are respectively set to predetermined initial values, to an adjacent robot;
• increment, by a position distance calculation command transferer of the robot receiving the position distance calculation command, the number of times of transmission and transfer included in the position distance calculation command, updating a relative position included in the position distance calculation command in accordance with a direction in which the position distance calculation command is received, and transferring a position distance calculation command including the incremented number of times of transmission and transfer and the updated relative position to an adjacent robot, other than the robot transmitting the position distance calculation command, only once;
• transmit, by a return position distance calculation command transmitter of the robot first receiving the position distance calculation command, a return position distance calculation command including the incremented number of times of transmission and transfer and the updated relative position to the robot transmitting the position distance calculation command;
• store, by a direction storage of the robot first receiving the position distance calculation command, a direction of the robot transmitting the position distance calculation command as a root direction;
• transfer, by a return position distance calculation command transferer of the robot receiving the return position distance calculation command, the received return position distance calculation command in the root direction read from the direction storage unit;
• select, by a first head robot determination command transmitter of the robot i_root receiving the return position distance calculation command, selecting any one partial common position set as a set Up based on the positions of the robots based on the initial position, the target position, and the relative position included in the return position distance calculation command, selecting a robot unit, as a head robot unit Head, which is located at a position belonging to the set Up and adjacent to a position where there is no robot unit within the target position (hereinafter, referred to as an objective position D), and transmitting a head robot determination command including the positions of the robots and information on the set Up to a predetermined robot h included in the selected head robot unit Head;
• determine, by a void generation order determiner of the robot h receiving the head robot determination command, the objective position D, a tail robot unit Tail which is a robot unit located at a position not belonging to the set Up and positioned within the initial position and which is a robot unit capable of maintaining connectivity of the robot structure even when moved, a path from the head robot unit Head to the tail robot unit Tail, and a void generation order for the robots within the head robot unit Head, based on the positions of the robots and the information on the set Up;
• transmit, by a void generation command transmitter of the robot h receiving the void generation command, a void generation command addressed to a robot v1 at a position based on the determined void generation order within the head robot unit Head to an adjacent robot unit;
• transfer, by a void generation command transferer of the robot receiving the void generation command, transferring the void generation command to an adjacent robot until the void generation command reaches the robot v1;
• transmit, by a push command transmitter of the robot v1 receiving the void generation command, in a case where the robot is the robot v1 and the void generation command is received, a push command to an adjacent robot in an ah direction with a direction in which the head robot unit Head moves as the ah direction;
• transfer, by a return push command transmitter of the robot receiving the push command, in a case where there is an adjacent robot in the ah direction, the push command to the adjacent robot in the ah direction, and transmitting, in a case where he push command is received and there is no adjacent robot in the ah direction, a return push command to an adjacent robot in a direction opposite to the ah direction;
• transfer, by a return push command transferer of the robot receiving the return push command, the return push command to an adjacent robot in the direction opposite to the ah direction until the return push command reaches the robot v1;
• transmit, by a void operation command transmitter of the robot v1 receiving the return push command, a void operation command to a robot located on the path and adjacent to the robot v1;
• transmit, by a first mover of the robot v1 receiving the return push command, the void operation command and then moving the robot v1 in the ah direction;
• transfer, by a void operation command transferer of the robot receiving the void operation command, the void operation command to a robot located on the path and located in a direction approaching the tail robot unit Tail by one box from the robot itself within the path;
• transmit, by a movement command transmitter of the robot receiving the void operation command, a movement command to a robot transmitting the void operation command in a case where the number of times of transmission and transfer of the void operation command is a predetermined number of times;
• transmit, by a return movement command transmitter of the robot receiving the movement command, a return movement command to a robot transmitting the movement command;
• move, by a second mover of the robot receiving the return movement command, moving the robot in a direction of a robot transmitting the void operation command together with the robot transmitting the void operation command;
• transmit, by a pull command transmitter of the robot included in a robot unit T′ one robot unit before the tail robot unit Tail and receiving the void operation command, a pull command to the robot which is included in a robot unit T′ one robot unit before the head robot unit Tail and located at a position within T′ being the same as a position within a robot unit of the robot v1 with a moving direction of the tail robot unit Tail as an at direction and which is an adjacent robot in a direction opposite to the at direction;
• transfer, by a return pull command transmitter of the robot receiving the pull command, in a case where there is an adjacent robot in the direction opposite to the at direction within the tail robot unit Tail, the pull command to the adjacent robot in the direction opposite to the at direction, and transmitting, in a case where the pull command is received and there is no robot adjacent thereto in the direction opposite to the at direction within the tail robot unit Tail, a return pull command to the adjacent robot in the at direction;
• move, by a third mover receiving the return pull command, the robot in the at direction together with the robot transmitting the return pull command;
• perform, by a control unit of the robot h, control so as to repeat processing of each of the void generation order determiner, the void generation command transfer, the push command transmitter, the return push command transmitter, the return push command transferer, the void operation command transmitter, the first mover, the void operation command transferer, the movement command transmitter, the return movement command transmitter, the second mover, the pull command transmitter, the return pull command transmitter, and the third mover until all of the robots included in the head robot unit Head are moved to the objective position D;
• update, by a set updater of the robot h, the set Up by adding the objective position D to the set Up and then, in a case where there is a robot unit which is in contact with the set Up and positioned within the target position instead of within the set Up, adding the position of the robot unit and a position of a robot unit in a connected state through only the position of the target position from the robot unit to the set Up;
• and
• update, by a second head robot determination command transmitter of the robot h, the position of the tail robot unit Tail and positions of robots located at the objective position D, newly selecting, in a case where there is a robot unit located at a position belonging to the set Up and adjacent to a position where there is no robot unit within the target position, the robot unit as a head robot unit Head based on the updated positions of the robots, and transmitting a head robot determination command including the updated positions of the robots and information on the updated set Up to a new predetermined robot h included in the newly selected head robot unit Head.