| CPC B25J 9/1664 (2013.01) | 9 Claims |
|
1. A robot control system comprising:
a plurality of mobile robots configured to autonomously move by referring to a map, the plurality of mobile robots including a three-dimensional range sensor and a two-dimensional range sensor configured to acquire a distance to a nearby object, the two-dimensional range sensor being able to measure a distance longer than a distance the three-dimensional range sensor can measure;
at least one memory configured to store instructions; and
at least one central processor configured to execute the instructions to:
estimate a position of each of the plurality of mobile robots by comparing a result of measurement by the two-dimensional distance sensor with the map;
detect the nearby object which is not registered on the map based on the result of measurement by the two-dimensional distance sensor;
acquire a distance and a direction to the nearby object based on a result of measurement by the three-dimensional range sensor;
specify a position of the nearby object on the map according to the distance and the direction from the position of each of the plurality of mobile robots to the nearby object;
estimate a movement vector indicating a moving speed and a moving direction of the nearby object according to a change of the position of the nearby object over time on the map;
add costs for restricting a movement of the plurality of mobile robots on the map based on the movement vector; and
perform control so that the plurality of mobile robots move according to the costs updated according to the result of measurement by the two-dimensional range sensor and the result of measurement by the three-dimensional range sensor, wherein:
a cost area in which the costs are added is set on the map based on the movement vector and a latest position of the nearby object,
the larger the moving speed is, the larger the cost area becomes,
the plurality of mobile robots add the costs on the map, and the plurality of mobile robots share the map,
each of the plurality of the mobile robots calculates the costs based on the movement vector and successively adds the costs on the map,
each of the costs is subtracted by a fixed value at each measurement, and
the costs are updated so that the costs increase in a place located ahead of the nearby object in the moving direction over time and the costs decrease in a place not located ahead of the nearby object in the moving direction over time.
|