Handling gait disturbances with asynchronous timing
An example method may include i) detecting a disturbance to a gait of a robot, where the gait includes a swing state and a step down state, the swing state including a target swing trajectory for a foot of the robot, and where the target swing trajectory includes a beginning and an end; and ii) based on the detected disturbance, causing the foot of the robot to enter the step down state before the foot reaches the end of the target swing trajectory.
1. A method comprising:
receiving, at a control system of a robot while the robot is executing a gait pattern, an indication that a first foot of the robot and a second foot of the robot are in contact with a ground surface; and
while the first foot and the second foot remain in contact with the ground surface:
determining, by the control system, a position of the first foot relative to the second foot at a first time;
at a second time subsequent to the first time, determining, by the control system, whether the position of the first foot relative to the second foot has changed from the first time by a threshold difference; and
when the position of the first foot relative to the second foot has changed from the first time by the threshold difference, causing, by the control system, a third foot currently in a swing state to make early contact with the ground surface.
2. The method of claim 1 , wherein the first time occurs at least a threshold period of time after receiving the indication.
3. The method of claim 2 , wherein the threshold period of time comprises a period of time within a range of 10-50 milliseconds after receiving the indication.
4. The method of claim 1 , further comprising, when the position of the first foot relative to the second foot has not changed from the first time by the threshold difference, continuing, by the control system, execution of the gait pattern.
5. The method of claim 4 , further comprising, while the first foot and the second foot remain in contact with the ground surface:
at a third time subsequent to the second time, determining, by the control system, whether the position of the first foot relative to the second foot at the third time has changed from the first time by the threshold difference; and
when the position of the first foot relative to the second foot at the third time has changed from the first time by the threshold difference, causing, by the control system, the third foot currently in the swing state to make early contact with the ground surface.
6. The method of claim 5 , wherein a first duration of time between the first time and the second time is equal to a second duration of time between the second time and the third time.
7. The method of claim 5 , wherein a first duration of time between the first time and the second time is different than a second duration of time between the second time and the third time.
8. The method of claim 1 , further comprising, while the first foot and the second foot remain in contact with the ground surface:
receiving, at the control system, position data from a set of sensors disposed on the robot; and
determining, by the control system, the position of the first foot relative to the second foot based on the received position data.
9. The method of claim 1 , wherein the gait pattern comprises a trotting gait.
10. The method of claim 1 , wherein the first foot comprises one of a front foot or a rear foot and the second foot comprises the other one of the front foot or the rear foot disposed on an opposite side of a body of the robot than the first foot.
11. A robot comprising:
a first foot;
a second foot;
a third foot; and
a control system comprising a processor and memory in communication with the processor, the memory storing program instructions that, when executed by the processor, cause the processor to perform operations comprising:
executing a gait pattern;
receiving an indication that the first foot and the second foot are in contact with a ground surface; and
while the first foot and the second foot remain in contact with the ground surface:
determining a position of the first foot relative to the second foot at a first time;
at a second time subsequent to the first time, determining whether the position of the first foot relative to the second foot has changed from the first time by a threshold difference; and
when the position of the first foot relative to the second foot has changed from the first time by the threshold difference, causing the third foot currently in a swing state to make early contact with the ground surface.
12. The robot of claim 11 , wherein the first time occurs at least a threshold period of time after receiving the indication.
13. The robot of claim 12 , wherein the threshold period of time comprises a period of time within a range 10-50 milliseconds after receiving the indication.
14. The robot of claim 11 , wherein the operations further comprise, when the position of the first foot relative to the second foot has not changed from the first time by the threshold difference, continuing execution of the gait pattern.
15. The robot of claim 14 , wherein the operations further comprise, while the first foot and the second foot remain in contact with the ground surface:
at a third time subsequent to the second time, determining whether the position of the first foot relative to the second foot at the third time has changed from the first time by the threshold difference; and
when the position of the first foot relative to the second foot at the third time has changed from the first time by the threshold difference, causing the third foot currently in the swing state to make early contact with the ground surface.
16. The robot of claim 15 , wherein a first duration of time between the first time and the second time is equal to a second duration of time between the second time and the third time.
17. The robot of claim 15 , wherein a first duration of time between the first time and the second time is different than a second duration of time between the second time and the third time.
18. The robot of claim 11 , wherein the operations further comprise, while the first foot and the second foot remain in contact with the ground surface:
receiving position data from a set of sensors disposed on the robot; and
determining the position of the first foot relative to the second foot based on the received position data.
19. The robot of claim 11 , wherein the gait pattern comprises a trotting gait.
20. The robot of claim 11 , wherein the first foot comprises one of a front foot or a rear foot and the second foot comprises the other one of the front foot or the rear foot disposed on an opposite side of a body of the robot than the first foot.