Control of robotic devices with non-constant body pitch
An example implementation involves controlling robots with non-constant body pitch and height. The implementation involves obtaining a model of the robot that represents the robot as a first point mass rigidly coupled with a second point mass along a longitudinal axis. The implementation also involves determining a state of a first pair of legs, and determining a height of the first point mass based on the model and the state of the first pair of legs. The implementation further involves determining a first amount of vertical force for at least one leg of the first pair of legs to apply along a vertical axis against a surface while the at least one leg is in contact with the surface. Additionally, the implementation involves causing the at least one leg of the first pair of legs to begin applying the amount of vertical force against the surface.
1. A robot comprising:
a body having a front portion and a rear portion, the front portion of the body comprising front legs, and the rear portion of the body comprising rear legs;
a timing and force controller in communication with the body, the timing and force controller configured to perform operations comprising:
receiving a state of the front legs and a template footstep sequence, the state of the front legs comprising kinematic information about the front legs, and the template footstep sequence defined by a gait being executed by the robot and comprising footstep force values predetermined for each footstep of the gait being executed by the robot;
receiving a current height for the front portion of the body and a target height for the front portion of the body;
modifying the footstep force values to generate a modified footstep sequence based on the template footstep sequence when the current height for the front portion of the body fails to satisfy the target height for the front portion of the body, the modified footstep force values maintaining a threshold height of the rear portion of the robot; and
communicating the modified footstep sequence; and
a displacement controller in communication with the timing and force controller and the body, the displacement controller configured to perform operations comprising:
receiving the modified footstep sequence from the timing and force controller; and
moving at least one of the front legs or the rear legs of the body based on the modified footstep sequence.
2. The robot of claim 1 , wherein the operations of the timing and force controller further comprise:
receiving a state of the rear legs, the state of the rear legs comprising kinematic information about the rear legs;
receiving a current height for the rear portion of the body and a target height for the rear portion of the body; and
modifying the footstep force values to generate the modified footstep sequence when the current height for the rear portion of the body fails to satisfy the target height for the rear portion of the body, the modified footstep force values maintaining a threshold height of the front portion of the body.
3. The robot of claim 2 , wherein the displacement controller comprises a longitudinal displacement controller, the longitudinal displacement controller configured to perform operations comprising:
determining a longitudinal displacement for the front legs and the rear legs of the body based on the modified footstep sequence; and
moving both the front legs and the rear legs of the body according to the determined longitudinal displacement.
4. The robot of claim 1 , wherein the displacement controller comprises a lateral displacement controller, the lateral displacement controller configured to perform operations comprising:
determining lateral step-out displacement values for at least one of the front legs or the rear legs of the body based on the modified footstep sequence; and
moving the at least one of the front legs or the rear legs of the body according to the determined lateral step-out displacement values.
5. The robot of claim 1 , wherein the operations of the timing and force controller further comprise:
receiving a timing for at least one of the front legs or the rear legs of the body corresponding to the template footstep sequence; and
modifying the timing for the at least one of the front legs or the rear legs of the body based on an elevation of a leg contact surface; and
communicating the modified timing as part of the modified footstep sequence.
6. The robot of claim 1 , wherein modifying the footstep force values to generate the modified footstep sequence when the current height for the front portion of the body fails to satisfy the target height for the front portion of the body further comprises:
when the current height for the front portion of the body is less than the target height for the front portion of the body, modifying the footstep force values by increasing vertical forces for the front legs in the footstep sequence; and
when the current height for the front portion of the body is greater than the target height for the front portion of the body, modifying the footstep force values by decreasing vertical forces for the front legs in the footstep sequence.
7. The robot of claim 1 , wherein the timing and force controller is configured as a vertical force controller.
8. The robot of claim 1 , wherein the template footstep sequence defines footstep locations, each footstep location corresponding to a planar coordinate comprising a lateral displacement and a longitudinal displacement with respect to the body, the longitudinal displacement corresponding to a longitudinal axis defined along the body from the front portion to the rear portion, the lateral displacement corresponding to a lateral axis perpendicular to the longitudinal axis and associated with side to side motion of the body.
9. The robot of claim 1 , wherein the kinematic information about the front legs comprises at least one of information about movement of the front legs, a pose of the front legs, forces acting on the front legs, joint angles of the front legs, or kinematic information corresponding to the body with respect to the front legs.
10. The robot of claim 9 , wherein the kinematic information corresponding to the body comprises at least one of position, velocity, acceleration, angular position, angular velocity, or angular acceleration.
11. A method comprising:
receiving, at data processing hardware, a state of front legs of a robot and a template footstep sequence for the robot, the robot comprising a body having a front portion and a rear portion, the front portion of the body comprising the front legs, the rear portion of the body comprising rear legs, the state of the front legs comprising kinematic information about the front legs, and the template footstep sequence defined by a gait being executed by the robot and comprising footstep force values predetermined for each footstep of the gait being executed by the robot;
receiving, at the data processing hardware, a current height for the front portion of the body and a target height for the front portion of the body;
modifying, by the data processing hardware, the footstep force values to generate a modified footstep sequence based on the template footstep sequence when the current height for the front portion of the body fails to satisfy the target height for the front portion of the body, the modified footstep force values maintaining a threshold height of the rear portion of the robot; and
instructing, by the data processing hardware, movement of at least one of the front legs or the rear legs of the robot based on the modified footstep sequence.
12. The method of claim 11 , further comprising:
receiving, at the data processing hardware, a state of the rear legs, the state of the rear legs comprising kinematic information about the rear legs;
receiving, at the data processing hardware, a current height for the rear portion of the body and a target height for the rear portion of the body; and
modifying, by the data processing hardware, the footstep force values to generate the modified footstep sequence when the current height for the rear portion of the body fails to satisfy the target height for the rear portion of the body, the modified footstep force values maintaining a threshold height of the front portion of the robot.
13. The method of claim 12 , further comprising:
determining, by the data processing hardware, a longitudinal displacement for the front legs and the rear legs based on the modified footstep sequence; and
instructing, by the data processing hardware, movement of both the front legs and the rear legs of the robot according to the determined longitudinal displacement.
14. The method of claim 11 , further comprising:
determining, by the data processing hardware, lateral step-out displacement values for at least one of the front legs or the rear legs based on the modified footstep sequence; and
instructing, by the data processing hardware, movement of the at least one of the front legs or the rear legs of the robot according to the determined lateral step-out displacement values.
15. The method of claim 11 , further comprising:
receiving, at the data processing hardware, a timing for at least one of the front legs or the rear legs corresponding to the template footstep sequence; and
modifying, by the data processing hardware, the timing for the at least one of the front legs or the rear legs based on an elevation of a leg contact surface; and
associating, by the data processing hardware, the modified timing with the modified footstep sequence.
16. The method of claim 11 , wherein modifying the footstep force values to generate the modified footstep sequence when the current height for the front portion of the body fails to satisfy the target height for the front portion of the body further comprises:
when the current height for the front portion of the body is less than the target height for the front portion of the body, modifying the footstep force values by increasing vertical forces for the front legs in the footstep sequence; and
when the current height for the front portion of the body is greater than the target height for the front portion of the body, modifying the footstep force values by decreasing vertical forces for the front legs in the footstep sequence.
17. The method of claim 11 , wherein the data processing hardware is associated with a timing and force controller configured to generate the modified footstep sequence and a displacement controller configured to move at least one of the front legs or the rear legs of the robot based on the modified footstep sequence.
18. The method of claim 11 , wherein the template footstep sequence defines footstep locations, each footstep location corresponding to a planar coordinate comprising a lateral displacement and a longitudinal displacement with respect to the body of the robot, the longitudinal displacement corresponding to a longitudinal axis along the body of the robot from the front portion to the rear portion, the lateral displacement corresponding to a lateral axis perpendicular to the longitudinal axis and associated with side to side motion of the robot.
19. The method of claim 11 , wherein the kinematic information about the front legs comprises at least one of information about movement of the front legs, a pose of the front legs, forces acting on the front legs, joint angles of the front legs, or kinematic information corresponding to the body of the robot with respect to the front legs.
20. The method of claim 19 , wherein the kinematic information corresponding to the body comprises at least one of position, velocity, acceleration, angular position, angular velocity, or angular acceleration.