MOTION PLANNING WITH CASTER CONSTRAINTS
Methods and apparatus for motion planning include receiving a path for movement of a body of a wheeled robot having first and second drive wheels and at least one non-driven caster wheel, the path defined by a series of points; determining, based at least in part on a constant difference in angular velocities between the first and second drive wheels, a set of control torques for the first and second drive wheels to control the robot to move between a first point of the series of points and a second point of the series of points; and applying the set of control torques to the first and second drive wheels.
1 . A method for motion planning comprising:
receiving a path for movement of a body of a wheeled robot having first and second drive wheels and at least one non-driven caster wheel, the path defined by a series of points;
determining, based at least in part on a constant difference in angular velocities between the first and second drive wheels, a set of control torques for the first and second drive wheels to control the robot to move between a first point of the series of points and a second point of the series of points; and
applying the set of control torques to the first and second drive wheels.
2 . The method of claim 1 , wherein determining the set of control torques comprises:
determining a first trajectory to cause the robot to move from the first point to a third point; and
determining a second trajectory to cause the robot to move from the third point to the second point,
wherein the first and second trajectory are used to constrain at least one of a translational change between the first and second points, a directional change between the first and second points, or a velocity of the robot at the first point.
3 . The method of claim 1 , wherein a magnitude of the difference in angular velocity between the first and second drive wheels is greater than 0.
4 . The method of claim 1 , wherein a difference in heading between the first point and the second point is not a multiple of 2π.
5 . The method of claim 1 , further comprising:
receiving additional paths at a frequency; and
repeating, for an additional path, the determining the set of control torques, wherein the set of control torques are determined at a frequency greater than the frequency of receiving additional paths.
6 . The method of claim 1 , wherein determining the set of control torques comprises solving a system of equations to determine constants of a temporally linear function, and wherein an angular velocity of the first drive wheel is based at least in part on the temporally linear function plus a difference and an angular velocity of the second drive wheel is based at least in part on the temporally linear function minus the difference.
7 . The method of claim 6 , wherein the difference is an angular velocity of the body of the wheeled robot throughout a trajectory from the first point to the second point.
8 . A system configured to generate a motion plan, the system comprising:
one or more processors; and
one or more non-transitory computer readable media having instructions stored thereon which, when executed by the one or more processors, cause the one or more processors to perform operations comprising:
receiving a path for movement of a body of a wheeled robot having first and second drive wheels and at least one non-driven caster wheel, the path defined by a series of points comprising a first point and a second point;
determining, based at least in part on a constant difference in angular velocities between the first and second drive wheels, a set of control torques for the first and second drive wheels to control the robot to move between the first point and the second point; and
applying the set of control torques to the first and second drive wheels.
9 . The system of claim 8 , wherein determining the set of control torques comprises:
determining a third point;
determining a first trajectory to cause the robot to move from the first point to the third point; and
determining a second trajectory to cause the robot to move from the third point to the second point,
wherein the first and second trajectory are used to constrain at least one of a translational change between the first and second points, a directional change between the first and second points, or a velocity of the robot at the first point.
10 . The system of claim 8 , wherein a magnitude of the difference in angular velocity between the first and second drive wheels is greater than 0.
11 . The system of claim 8 , wherein a difference in heading between the first point and the second point is not a multiple of 2π.
12 . The system of claim 8 , further comprising:
receiving additional paths at a frequency; and
repeating, for each additional path, the determining the set of control torques, wherein the set of control torques are determined at a frequency greater than the frequency of receiving additional paths.
13 . The system of claim 8 , wherein determining the set of control torques comprises solving a system of equations to determine constants of a temporally linear function, and wherein an angular velocity of the first drive wheel is based at least in part on the temporally linear function plus a difference and an angular velocity of the second drive wheel is based at least in part on the temporally linear function minus the difference.
14 . One or more non-transitory computer readable media having instructions stored thereon which, when executed by one or more processors, cause the one or more processors to perform operations comprising:
receiving a path for movement of a body of a wheeled robot having first and second drive wheels and at least one non-driven caster wheel, the path defined by a series of points;
determining, based at least in part on a constant difference in angular velocities between the first and second drive wheels, a set of control torques for the first and second drive wheels to control the robot to move between a first point of the series of points and a second point of the series of points; and
applying the set of control torques to the first and second drive wheels.
15 . The non-transitory computer readable media of claim 14 , wherein determining the set of control torques comprises:
determining a first trajectory to cause the robot to move from the first point to a third point; and
determining a second trajectory to cause the robot to move from the third point to the second point,
wherein the first and second trajectory are used to constrain at least one of a translational change between the first and second points, a directional change between the first and second points, or a velocity of the robot at the first point.
16 . The non-transitory computer readable media of claim 14 , wherein a magnitude of the difference in angular velocity between the first and second drive wheels is greater than 0.
17 . The non-transitory computer readable media of claim 14 , wherein a difference in heading between the first point and the second point is not a multiple of 2π.
18 . The non-transitory computer readable media of claim 14 , further comprising:
receiving additional paths at a frequency; and
repeating, for each additional path, the determining the set of control torques, wherein the set of control torques are determined at a frequency greater than the frequency of receiving additional paths.
19 . The non-transitory computer readable media of claim 14 , wherein determining the set of control torques comprises solving a system of equations to determine constants of a temporally linear function, and wherein an angular velocity of the first drive wheel is based at least in part on the temporally linear function plus a difference and an angular velocity of the second drive wheel is based at least in part on the temporally linear function minus the difference.
20 . The non-transitory computer readable media of claim 19 , wherein the difference is an angular velocity of the body of the wheeled robot throughout a trajectory from the first point to the second point.