Mobile robot control device
First Claim
1. A control device for a mobile robot in which a direction of turn and an angle of turn are determined by directions of rotation and speeds of rotation of both left and right wheels of the robot, comprising:
- a right side obstacle sensor mounted on the right front of a main body of the robot;
a left side obstacle sensor mounted on the left front of the main body;
means for generating at least two set of run parameters, each set of parameters including at least the direction of the turn, a speed of an intra-side wheel, and a speed of an opposite side wheel, in accordance with a distance to an obstacle detected by each obstacle sensor; and
means for determining the direction of rotation and the speed of rotation for each of the left and right wheels on the basis of a run parameter selected from said at least two sets of the run parameters for preventing collision against the obstacle according to a predetermined priority rule,wherein when both the left and right side sensors detect obstacles at an interval of time which is shorter than a reference valve, their measurements of distance to the obstacles are compared with each other to determine the speeds of rotation of the left and right wheels for turning towards the obstacle to which the distance is longer and when a current turn which is to be conducted upon detecting obstacles by the left and right side sensors at the short interval of time is opposite in the direction to the previous turn, a turning angle of the current turn is set smaller than that of the previous turn.
1 Assignment
0 Petitions
Accused Products
Abstract
When a difference between sums of distance measurements detected by the left and right side sensors of a robot 1 is greater than a reference value, the turn is performed to avoid an obstacle ahead. If the direction of the current turn is opposite to that of the previous turn, since the angle of turning in the current turn is decreased, the robot 1 prevents redundant turn and can thus run through between obstacles. If the (swivel) turn has been repeated a given number of times in a zigzag movement, an escape motion from the deadlock state is commenced which includes a backward running of a predetermined distance and a (swivel) turn following the backward running.
-
Citations
17 Claims
-
1. A control device for a mobile robot in which a direction of turn and an angle of turn are determined by directions of rotation and speeds of rotation of both left and right wheels of the robot, comprising:
-
a right side obstacle sensor mounted on the right front of a main body of the robot; a left side obstacle sensor mounted on the left front of the main body; means for generating at least two set of run parameters, each set of parameters including at least the direction of the turn, a speed of an intra-side wheel, and a speed of an opposite side wheel, in accordance with a distance to an obstacle detected by each obstacle sensor; and means for determining the direction of rotation and the speed of rotation for each of the left and right wheels on the basis of a run parameter selected from said at least two sets of the run parameters for preventing collision against the obstacle according to a predetermined priority rule, wherein when both the left and right side sensors detect obstacles at an interval of time which is shorter than a reference valve, their measurements of distance to the obstacles are compared with each other to determine the speeds of rotation of the left and right wheels for turning towards the obstacle to which the distance is longer and when a current turn which is to be conducted upon detecting obstacles by the left and right side sensors at the short interval of time is opposite in the direction to the previous turn, a turning angle of the current turn is set smaller than that of the previous turn. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A control device for a mobile robot in which a direction of turn and an angle of turn are determined by directions of rotation and speeds of rotation of both left and right wheels of the robot, comprising:
-
a right side obstacle sensor mounted on the right front of a main body of the robot; a left side obstacle sensor mounted on the left front of the main body; means for generating at least two set of run parameters, each set of parameters including at least the direction of the turn, a speed of an intra-side wheel, and a speed of an opposite side wheel, in accordance with a distance to an obstacle detected by each obstacle sensor; and means for determining the direction of rotation and the speed of rotation for each of the left and right wheels on the basis of a run parameter selected from said at least two sets of the run parameters for preventing collision against the obstacle according to a predetermined priority rule, means for inhibiting the turn when a difference between the distances measured by the left and right side obstacle sensors is smaller than a predetermined reference value, wherein when both the left and right side sensors detect obstacles at an interval of time which is shorter than a reference valve, their measurements of distance to the obstacles are compared with each other to determine the speeds of rotation of the left and right wheels for turning towards the obstacle to which the distance is longer. - View Dependent Claims (9, 10, 11, 12, 13)
-
-
14. A control device for a mobile robot in which a direction of turn and an angle of turn are determined by directions of rotation and speeds of rotation of both left and right wheels of the robot, comprising:
-
a right side obstacle sensor mounted on the right front of a main body of the robot; a left side obstacle sensor mounted on the left front of the main body; means for generating at least two set of runn parameters, each set of parameters including at least the direction of the turn, a speed of an intra-side wheel, and a speed of an opposite side wheel, in accordance with a distance to an obstacle detected by each obstacle sensor; and means for determining the direction of rotation and the speed of rotation for each of the left and right wheels on the basis of a run parameter selected from said at least two sets of the run parameters for preventing collision against the obstacle according to a predetermined priority rule, means for judging a deadlock state of the robot when a current turn which is different in the direction from the preceding turn has been repeated a predetermined number of times, wherein the robot is caused, in response to the judgement of the deadlock state, to perform a backward running by a predetermined distance and then a turn to escape its deadlock state. - View Dependent Claims (15, 16, 17)
-
Specification