Mechanically-timed footsteps for a robotic device

Information

  • Patent Grant
  • 11654985
  • Patent Number
    11,654,985
  • Date Filed
    Tuesday, January 26, 2021
    3 years ago
  • Date Issued
    Tuesday, May 23, 2023
    11 months ago
Abstract
An example implementation for determining mechanically-timed footsteps may involve a robot having a first foot in contact with a ground surface and a second foot not in contact with the ground surface. The robot may determine a position of its center of mass and center of mass velocity, and based on these, determine a capture point for the robot. The robot may also determine a threshold position for the capture point, where the threshold position is based on a target trajectory for the capture point after the second foot contacts the ground surface. The robot may determine that the capture point has reached this threshold position and based on this determination, and cause the second foot to contact the ground surface.
Description
BACKGROUND

As technology advances, various types of robotic devices are being created for performing a variety of functions that may assist users. Robotic devices may be used for applications involving material handling, transportation, welding, assembly, and dispensing, among others. Over time, the manner in which these robotic systems operate is becoming more intelligent, efficient, and intuitive. As robotic systems become increasingly prevalent in numerous aspects of modern life, the desire for efficient robotic systems becomes apparent. Therefore, a demand for efficient robotic systems has helped open up a field of innovation in actuators, movement, sensing techniques, as well as component design and assembly.


SUMMARY

The present disclosure generally relates to controlling a legged robot. Specifically, implementations described herein may allow for efficient operation of a legged robot by determining mechanically-timed footsteps for the robot. These as well as other aspects, advantages, and alternatives will become apparent to those of ordinary skill in the art by reading the following detailed description, with reference where appropriate to the accompanying drawings.


A first example implementation may include (i) determining, by a robot, a position of a center of mass of the robot, wherein the robot includes a first foot in contact with a ground surface and a second foot not in contact with the ground surface; (ii) determining a velocity of the center of mass of the robot; (iii) based on the determined position of the center of mass and the determined velocity of the center of mass, determining a capture point for the robot, where the capture point indicates a position on the ground surface; (iv) determining a threshold position for the capture point, where the threshold position is based on a target trajectory for the capture point after the second foot contacts the ground surface; (v) determining that the capture point has reached the threshold position; and (vi) based on the determination that the capture point has reached the threshold position, causing, by the robot, the second foot to contact the ground surface.


A second example implementation may include (i) determining, by a robot, a footstep pattern for the robot, where the robot comprises a first foot in contact with a ground surface and a second foot not in contact with the ground surface, and where the footstep pattern includes a target footstep location for the second foot; (ii) determining a position of a center of mass of the robot; (iii) determining a velocity of the center of mass of the robot; (iv) based on the determined position of the center of mass and the determined velocity of the center of mass, determining a capture point for the robot, where the capture point indicates a position on the ground surface; (v) determining a current trajectory for the capture point; (vi) based on the current trajectory of the capture point, updating the target footstep location for the second foot; (vii) determining a threshold position for the capture point, where the threshold position is based on a target trajectory for the capture point after the second foot contacts the ground surface; (viii) determining that the capture point has reached the threshold position; and (ix) based on the determination that the capture point has reached the threshold position, causing, by the robot, the second foot to contact the ground surface at the updated target footstep location for the second foot.


A third example implementation may include a system having means for performing operations in accordance with the first example implementation.


A fourth example implementation may include a system having means for performing operations in accordance with the second example implementation.


A fifth example implementation may include a biped robot having (i) a first foot; (ii) a second foot; (iii) a processor; (iv) a non-transitory computer readable medium, and (v) program instructions stored on the non-transitory computer readable medium that, when executed by the processor, cause the biped robot to perform operations in accordance with the first example implementation.


A sixth example implementation may include a biped robot having (i) a first foot; (ii) a second foot; (iii) a processor; (iv) a non-transitory computer readable medium, and (v) program instructions stored on the non-transitory computer readable medium that, when executed by the processor, cause the biped robot to perform operations in accordance with the second example implementation.





DESCRIPTION OF DRAWINGS


FIG. 1 illustrates a configuration of a robotic system, according to an example implementation.



FIG. 2 illustrates a quadruped robot, according to an example implementation.



FIG. 3 illustrates another quadruped robot, according to an example implementation.



FIG. 4 illustrates a biped robot, according to an example implementation.



FIG. 5 is a flowchart according to an example implementation.



FIG. 6 illustrates a footstep pattern for a robot according to an example implementation.



FIG. 7 is a flowchart according to an example implementation.



FIG. 8 illustrates a footstep pattern for a robot according to an example implementation.





DETAILED DESCRIPTION

Example implementations are described herein. The words “example,” “exemplary,” and “illustrative” are used herein to mean “serving as an example, instance, or illustration.” Any implementation or feature described herein as being an “example,” being “exemplary,” or being “illustrative” is not necessarily to be construed as preferred or advantageous over other implementations or features. The example implementations described herein are not meant to be limiting. Thus, the aspects of the present disclosure, as generally described herein and illustrated in the figures, can be arranged, substituted, combined, separated, and designed in a wide variety of different configurations, all of which are contemplated herein. Further, unless otherwise noted, figures are not drawn to scale and are used for illustrative purposes only. Moreover, the figures are representational only and not all components are shown. For example, additional structural or restraining components might not be shown.


I. OVERVIEW

Example implementations relate to the determination of mechanically-timed footsteps for a robotic device. In some implementations, a robot may determine a footstep pattern. The footstep pattern may define a target path for the robot to follow and the locations of the footsteps the robot will take along the path. The footstep pattern may be based on a given destination, obstacles that that it may be desirable for the robot to avoid, among other examples.


During a given step, the robot may have a stance foot that is in contact with the ground surface and a swing foot that is not in contact with the ground surface. In some prior implementations, a robot might utilize a predetermined, clock-based timing for determining when to cause its swing foot to contact the ground surface, and then cause its stance foot to lift off of the ground surface. For instance, a robot might take footsteps at one second intervals, half-second intervals, among other examples.


Conversely, in the implementations described below, although the position of the robot's footsteps may be predetermined, the timing of when the robot will put down its swing foot and pick up its stance foot (i.e., when to take the next step) might not be predetermined. Rather, the robot may maintain its balance and react to disturbances in its gait by mechanically determining the timing for when to switch to the next step.


For example, the robot may determine a capture point on the ground surface during a given step. The capture point is based on the position and velocity of the robot's center of mass, and approximates the dynamic motion of the robot as if the robot's center of mass were falling as a linear inverted pendulum. Based on this model, the capture point represents the position on the ground surface where the robot may place its swing foot in order to completely arrest the falling, capturing the robot's momentum and bringing the robot to a stop. For instance, as the robot takes a step forward, with its right foot as the stance foot and with its left foot as the swing foot, the robot “falls” forward and to the left, and thus the capture point may generally follow the movement of the robot's center of mass, forward and to the left. If the robot were to cause its left foot to contact the ground surface at the position of the capture point, the robot may come to a stop.


However, if the robot is to continue moving at a particular gait, the robot might not step directly to the capture point. Instead, the robot may determine a threshold position for the capture point during a given step, and then base the timing of when to place its swing foot (e.g., its left foot) down and lift up its stance foot (e.g. its right foot) on a determination that the capture point has reached the threshold position. For instance, the threshold position for the capture point may be medial to the predetermined footstep location where the left foot will touch down. Thus, as the capture point approaches the threshold position, the left foot will touch down laterally outside of the capture point and the robot's center of mass. The shift in weight to the robot's left foot, formerly the swing foot, will cause the capture point to move back to the right, as the robot's center of mass “falls” toward the next footstep location for the right foot.


The threshold position for the capture point may be determined based on a number of variables. For a given footstep, the robot may determine its center of pressure, which represents the point at which the robot's mass acts upon the ground surface. According to the model of the robot falling as a linear inverted pendulum, the center of pressure represents the point about which the pendulum (i.e., the robot's center of mass) moves. Thus, as the robot “falls”, the center of mass and the capture point move on a trajectory away from the center of pressure.


For example, when the left foot is swinging, the threshold position for the capture point may be determined based on a target trajectory for the capture point after the left foot touches down. This target trajectory approximates the line along which the robot will “fall” during the next step, toward its next footstep location. The target trajectory may be established by two points. The first is the center of pressure during the next step, which may be determined based on the known position of the upcoming stance foot (the left foot). The second point is a target position for the capture point at the end of the upcoming step of the right foot. The target position may be determined based on the determined footstep pattern, for example the given stride length and stance width, as well as the duration of the target swing period. The threshold position for the capture point may lie on a line between these two points that define the target trajectory, and may consider other factors as well.


When the capture point reaches the threshold position, the robot places the left foot down and picks the right foot up. This may cause the robot to “fall”, and thereby cause the capture point to move, along the target trajectory established by the robot's center of pressure and the target position for the capture point. Further, the target position for the capture point may also represent the next threshold position for the capture point. Therefore, once the capture point approaches this next threshold, the robot may place its right foot (now the swing foot) down and pick up its left foot, and so on.


In some cases, the robot may experience a disturbance to its gait that may alter the current trajectory of the capture point. The robot may react to the gait disturbance by updating the threshold position for the capture point, adjusting the location of the center of pressure, adjusting its center of gravity in order to affect the trajectory of the capture point, among other examples.


However, in some cases, a gait disturbance may be such that the robot might not be able to correct it while still maintaining the determined footstep pattern. In these situations, the robot may determine an updated target footstep location for the swing foot that may place the capture point on a trajectory back toward the target trajectory, and return the robot to the determined footstep pattern.


II. EXAMPLE ROBOTIC SYSTEMS

Referring now to the figures, FIG. 1 illustrates an example configuration of a robotic system. The robotic system 100 represents an example robotic system configured to perform the implementations described herein. Additionally, the robotic system 100 may be configured to operate autonomously, semi-autonomously, and/or using directions provided by user(s), and may exist in various forms, such as a biped robot or a quadruped robot, among other examples. Furthermore, the robotic system 100 may also be referred to as a robotic device, mobile robot, or robot, among others.


As shown in FIG. 1, the robotic system 100 may include processor(s) 102, data storage 104, program instructions 106, and controller(s) 108, which together may be part of a control system 118. The robotic system 100 may also include sensor(s) 112, power source(s) 114, mechanical components 110, and electrical components 116. Note that the robotic system 100 is shown for illustration purposes as robotic system 100 and may include more or less components within various examples. The components of robotic system 100 may be connected in any manner, including wired or wireless connections, etc. Further, in some examples, components of the robotic system 100 may be positioned on multiple entities rather than a single entity. Other example illustrations of robotic system 100 may exist.


Processor(s) 102 may operate as one or more general-purpose processors or special purpose processors (e.g., digital signal processors, application specific integrated circuits, etc.). The processor(s) 102 may be configured to execute computer-readable program instructions 106 that are stored in the data storage 104 and are executable to provide the operations of the robotic system 100 described herein. For instance, the program instructions 106 may be executable to provide functionality of controller(s) 108, where the controller(s) 108 may be configured to cause activation and deactivation of the mechanical components 110 and the electrical components 116.


The data storage 104 may exist as various types of storage configured to hold memory. For example, the data storage 104 may include or take the form of one or more computer-readable storage media that can be read or accessed by processor(s) 102. The one or more computer-readable storage media can include volatile and/or non-volatile storage components, such as optical, magnetic, organic or other memory or disc storage, which can be integrated in whole or in part with processor(s) 102. In some implementations, the data storage 104 can be implemented using a single physical device (e.g., one optical, magnetic, organic or other memory or disc storage unit), while in other implementations, the data storage 104 can be implemented using two or more physical devices, which may communicate via wired or wireless communication. Further, in addition to the computer-readable program instructions 106, the data storage 104 may include additional data such as diagnostic data, among other possibilities.


The robotic system 100 may include at least one controller 108, which may interface with the robotic system 100. The controller 108 may serve as a link between portions of the robotic system 100, such as a link between mechanical components 110 and/or electrical components 116. In some instances, the controller 108 may serve as an interface between the robotic system 100 and another computing device. Further, the controller 108 may serve as an interface between the robotic system 100 and a user(s). The controller 108 may include various components for communicating with the robotic system 100, including a joystick(s), buttons, among others. The example interfaces and communications noted above may be implemented via a wired or wireless connection, or both. The controller 108 may perform other functions for the robotic system 100 as well. Other examples of controllers may exist.


Mechanical components 110 represent possible hardware of the robotic system 100 that may enable the robotic system 100 to operate and perform physical operations. As a few examples, the robotic system 100 may include actuator(s), extendable leg(s) (“legs”), arm(s), wheel(s), one or more structured bodies for housing the computing system or other components, and other mechanical components. The mechanical components 110 may depend on the design of the robotic system 100 and may also be based on the functions and/or tasks the robotic system 100 may be configured to perform. As such, depending on the operation and functions of the robotic system 100, different mechanical components 110 may be available for the robotic system 100 to utilize. In some examples, the robotic system 100 may be configured to add and/or remove mechanical components 110, which may involve assistance from a user and/or other robot. For example, the robotic system 100 may be initially configured with four legs, but may be altered by a user or the robotic system 100 to remove two of the four legs to operate as a biped. Other examples of mechanical components 110 may be included within some implementations.


Additionally, the robotic system 100 may include one or more sensor(s) 112 arranged to sense aspects of the robotic system 100. The sensor(s) 112 may include one or more force sensors arranged to measure load on various components of the robotic system 100. In an example, the sensor(s) 112 may include one or more force sensors on each leg. Such force sensors on the legs may measure the load on the actuators that move one or more members of the legs.


The sensor(s) 112 may further include one or more position sensors. Position sensors may sense the position of the actuators of the robotic system. In one implementation, position sensors may sense the extension, retraction, or rotation of the actuators on the legs of the robot. The sensor(s) 112 may further include one or more velocity and/or acceleration sensors. For instance, the sensor(s) 112 may include an inertial measurement unit (IMU). The IMU may sense velocity and acceleration in the world frame, with respect to the gravity vector. The velocity and acceleration of the IMU may then be translated to the robotic system, based on the location of the IMU in the robotic system and the kinematics of the robotic system. Other sensor(s) 112 are also possible, including proximity sensors, motion sensors, load sensors, touch sensors, depth sensors, ultrasonic range sensors, and infrared sensors, among other possibilities.


The sensor(s) 112 may provide sensor data to the processor(s) 102 to allow for appropriate interaction of the robotic system 100 with the environment as well as monitoring of operation of the systems of the robotic system 100. The sensor data may be used in evaluation of various factors for activation and deactivation of mechanical components 110 and electrical components 116 by controller 108 and/or a computing system of the robotic system 100.


The sensor(s) 112 may provide information indicative of the environment of the robot for the controller 108 and/or computing system to use to determine operations for the robotic system 100. For example, the sensor(s) 112 may capture data corresponding to the terrain of the environment or location of nearby objects, which may assist with environment recognition and navigation, etc. In an example configuration, the robotic system 100 may include a sensor system that includes RADAR, LIDAR, SONAR, VICON®, one or more cameras, a global positioning system (GPS) transceiver, and/or other sensors for capturing information of the environment of the robotic system 100. The sensor(s) 112 may monitor the environment in real-time and detect obstacles, elements of the terrain, weather conditions, temperature, and/or other parameters of the environment for the robotic system 100.


Further, the robotic system 100 may include other sensor(s) 112 configured to receive information indicative of the state of the robotic system 100, including sensor(s) 112 that may monitor the state of the various components of the robotic system 100. The sensor(s) 112 may measure activity of systems of the robotic system 100 and receive information based on the operation of the various features of the robotic system 100, such the operation of extendable legs, arms, or other mechanical and/or electrical features of the robotic system 100. The sensor data provided by the sensors may enable the computing system of the robotic system 100 to determine errors in operation as well as monitor overall functioning of components of the robotic system 100. For example, the computing system may use sensor data to determine a stability of the robotic system 100 during operations as well as measurements related to power levels, communication activities, components that require repair, among other information. As an example configuration, the robotic system 100 may include gyroscope(s), accelerometer(s), and/or other possible sensors to provide sensor data relating to the state of operation of the robot. Further, sensor(s) 112 may also monitor the current state of a function, such as a gait, that the robotic system 100 may currently be operating. Other example uses for the sensor(s) 112 may exist as well.


Additionally, the robotic system 100 may also include one or more power source(s) 114 configured to supply power to various components of the robotic system 100. Among possible power systems, the robotic system 100 may include a hydraulic system, electrical system, batteries, and/or other types of power systems. As an example illustration, the robotic system 100 may include one or more batteries configured to provide charge to components that may receive charge via a wired and/or wireless connection. Within examples, components of the mechanical components 110 and electrical components 116 may each connect to a different power source or may be powered by the same power source. Components of the robotic system 100 may connect to multiple power sources 114 as well.


Within example configurations, any type of power source may be used to power the robotic system 100, such as a gasoline engine. Further, the power source(s) 114 may charge using various types of charging, such as wired connections to an outside power source, wireless charging, combustion, or other examples. Additionally, the robotic system 100 may include a hydraulic system configured to provide power to the mechanical components 110 using fluid power. Components of the robotic system 100 may operate based on hydraulic fluid being transmitted throughout the hydraulic system to various hydraulic motors and hydraulic cylinders, for example. The hydraulic system of the robotic system 100 may transfer a large amount of power through small tubes, flexible hoses, or other links between components of the robotic system 100. Other power sources may be included within the robotic system 100 within examples.


The electrical components 116 may include various components capable of processing, transferring, providing electrical charge or electric signals, for example. Among possible examples, the electrical components 116 may include electrical wires, circuitry, and/or wireless communication transmitters and receivers to enable operations of the robotic system 100. The electrical components 116 may interwork with the mechanical components 110 to enable the robotic system 100 to perform various functions. The electrical components 116 may be configured to provide power from the power source(s) 114 to the various mechanical components 110, for example. Further, the robotic system 100 may include electric motors. Other examples of electrical components 116 may exist as well.



FIG. 2 illustrates an example quadruped robot 200, according to an example implementation. Among other possible functions, the robot 200 may be configured to perform some of the methods described herein during operation. The robot 200 includes a control system 202, and legs 204a, 204b, 204c, 204d connected to a body 208. Each leg may include a respective foot 206a, 206b, 206c, 206d that may contact the ground surface. The robot 200 may also include sensors (e.g., sensor 210) configured to provide sensor data to the control system 202 of the robot 200. Further, the robot 200 is illustrated carrying a load 212 on the body 208. Within other example implementations, the robot 200 may include more or less components and may additionally include components not shown in FIG. 2.


The robot 200 may be a physical representation of the robotic system 100 shown in FIG. 1 or may be based on other configurations. To operate, the robot 200 includes a computing system that may be made up of one or more computing devices configured to assist in various operations of the robot 200, which may include processing data and providing outputs based on the data. The computing system may process information provided by various systems of the robot 200 (e.g., a sensor system) or from other sources (e.g., a user, another robot, a server) and may provide instructions to the systems to operate in response.


Additionally, the computing system may monitor systems of the robot 200 during operation, to determine errors and/or monitor regular operation, for example. In some example configurations, the computing system may serve as a connection between the various systems of the robot 200 that coordinates the operations of the systems together to enable the robot 200 to perform functions. Further, although the operations described herein correspond to a computing system of a robot performing tasks, the computing system may be made of multiple devices, processors, controllers, and/or other entities configured to assist in the operation of the robot. Additionally, the computing system may operate using various types of memory and/or other components.


Although the robot 200 includes four legs 204a-204d in the illustration shown in FIG. 2, the robot 200 may include more or less legs within other examples. Further, the configuration, position, and/or structure of the legs 204a-204d may vary in example implementations. The legs 204a-204d enable the robot 200 to move and may be configured to operate in multiple degrees of freedom to enable different techniques of travel to be performed. In particular, the legs 204a-204d may enable the robot 200 to travel at various speeds through mechanically controlling the legs 204a-204d according to the mechanics set forth within different gaits. A gait is a pattern of movement of the limbs of an animal, robot, or other mechanical structure. As such, the robot 200 may navigate by operating the legs 204a-204d to perform various gaits. The robot 200 may use one or more gaits to travel within an environment, which may involve selecting a gait based on speed, terrain, the need to maneuver, and/or energy efficiency.


Further, different types of robots may use different gaits due to differences in design that may prevent use of certain gaits. Although some gaits may have specific names (e.g., walk, trot, run, bound, gallop, etc.), the distinctions between gaits may overlap. The gaits may be classified based on footfall patterns—the locations on the ground surface for the placement the feet 206a-206d. Similarly, gaits may also be classified based on mechanics.


One or more systems of the robot 200, such as the control system 118, may be configured to operate the legs 204a-204d to cause the robotic 200 to move. Additionally, the robot 200 may include other mechanical components, which may be attached to the robot 200 at various positions. The robot 200 may include mechanical arms, grippers, or other features. In some examples, the legs 204a-204d may have other types of mechanical features that enable control upon various types of surfaces that the robot may encounter, such as wheels, etc. Other possibilities also exist.


As part of the design of the example robot 200, the body 208 of the robot 200 connects to the legs 204a-204d and may house various components of the robot 200. As such, the structure of the body 208 may vary within examples and may further depend on particular operations that a given robot may have been designed to perform. For example, a robot developed to carry heavy loads may have a wide body that enables placement of the load. Similarly, a robot designed to reach high speeds may have a narrow, small body that does not have substantial weight. Further, the body 208 as well as the legs 204 may be developed using various types of materials, such as various metals or plastics. Within other examples, a robot may have a body with a different structure or made of other types of materials.


The sensor(s) 210 of the robot 200 may include various types of sensors, such as the camera or sensing system shown in FIG. 2. The sensor(s) 210 is positioned on the front of the body 208, but may be placed at other positions of the robot as well. As described for the robotic system 100, the robot 200 may include a sensory system that includes force sensors, position sensors, IMUs, RADAR, LIDAR, SONAR, VICON®, GPS, accelerometer(s), gyroscope(s), and/or other types of sensors. The sensor(s) 210 may be configured to measure parameters of the environment of the robot 200 as well as monitor internal operations of systems of the robot 200. As an example illustration, the robot 200 may include sensors that monitor the accuracy of its systems to enable the computing system to detect a system within the robot 100 that may be operating incorrectly. Other uses of the sensor(s) 210 may be included within examples.


The load 212 carried by the robot 200 may represent various types of cargo that the robot 200 may transport. The load 212 may also represent external batteries or other types of power sources (e.g., solar panels) that the robot 200 may utilize. The load 212 represents one example use for which the robot 200 may be configured. The robot 200 may be configured to perform other operations as well.


Additionally, as shown with the robotic system 100, the robot 200 may also include various electrical components that may enable operation and communication between the mechanical features of the robot 200. Also, the robot 200 may include one or more computing systems that include one or more processors configured to perform various operations, including processing inputs to provide control over the operation of the robot 200. The computing system may include additional components, such as various types of storage and a power source, etc.


During operation, the computing system may communicate with other systems of the robot 200 via wired or wireless connections and may further be configured to communicate with one or more users of the robot. As one possible illustration, the computing system may receive an input from a user indicating that the user wants the robot to perform a particular gait in a given direction. The computing system may process the input and may perform an operation that may cause the systems of the robot to perform the requested gait. Additionally, the robot's electrical components may include interfaces, wires, busses, and/or other communication links configured to enable systems of the robot to communicate.


Furthermore, the robot 200 may communicate with one or more users and/or other robots via various types of interfaces. In an example implementation, the robot 200 may receive input from a user via a joystick or similar type of interface. The computing system may be configured to measure the amount of force and other possible information from inputs received from a joystick interface. Similarly, the robot 200 may receive inputs and communicate with a user via other types of interfaces, such as a mobile device or a microphone. The computing system of the robot 200 may be configured to process various types of inputs.



FIG. 3 illustrates another quadruped robot 300 according to an example implementation. Similar to robot 200 shown in FIG. 2, the robot 300 may correspond to the robotic system 100 shown in FIG. 1. The robot 300 serves as another possible example of a robot that may be configured to perform some of the implementations described herein.



FIG. 4 illustrates a biped robot 400 according to another example implementation. Similar to robots 200 and 300 shown in FIGS. 2 and 3, the robot 400 may correspond to the robotic system 100 shown in FIG. 1, and may be configured to perform some of the implementations described herein. The robot 400 may include more or less components than those shown in FIG. 2 and discussed with respect to the robot 200. For example, the robot 400 may include a control system 401 and legs 402, 403 connected to a body 404. Each leg may include a respective foot 405, 406, that may contact the ground surface. The robot 400 may also include sensors (e.g., sensor 407) configured to provide sensor data to the control system 401 of the robot 400.


III. EXAMPLE IMPLEMENTATIONS FOR DETERMINING MECHANICALLY-TIMED FOOTSTEPS

Example implementations are discussed below for determining mechanically-timed footsteps for a legged robot. Flow charts 500 and 700, shown in FIGS. 5 and 7 respectively, present example operations that may be implemented by a biped robot, such as the example robot 400 shown in FIG. 4. Flow charts 500 and 700 may include one or more operations or actions as illustrated by one or more of the blocks shown in each figure. Although the blocks are illustrated in sequential order, these blocks may also be performed in parallel, and/or in a different order than those described herein. Also, the various blocks may be combined into fewer blocks, divided into additional blocks, and/or removed based upon the desired implementation.


In addition, the flow charts 500 and 700 and other operations disclosed herein provide the operation of possible implementations. In this regard, each block may represent a module, a segment, or a portion of program code, which includes one or more instructions executable by a processor for implementing specific logical operations. The program code may be stored on any type of computer readable medium, for example, such as a storage device including a disk or hard drive. In addition, each block may represent circuitry that is wired to perform the specific logical operations.


Further, the term ground surface as used herein is meant to encompass any possible surface or terrain that the robot may encounter, and is not meant to be limiting. For instance, the ground surface may be indoors or outdoors, may be rigid or loose, such as sand or gravel, and may include discontinuities or irregularities such as stairs, rocks, fallen trees, debris, and the like. Numerous other examples exist.


First Example Implementation for Determining Mechanically-Timed Footsteps


FIG. 5 is a flowchart 500 illustrating operations for determining mechanically-timed footsteps for an example robot based on the robot's capture point. The following paragraphs generally discuss examples involving a biped robot with two feet, however the operations may also be applicable to robots with a different number of feet, such as a quadruped robot with four feet, among other examples. Further, the operations discussed below may be performed by a robot that is walking, trotting, or running. Other gaits are also possible.


In some example implementations, a robot may determine a footstep pattern. The robot may be, for example, the robot 400 shown in FIG. 4. The footstep pattern may define a number of target footstep locations for the both the first foot 405 and the second foot 406. The robot 400 may then move at a given gait (e.g., walking, running, etc.) by placing its footstep at, or approximately at, the target footstep locations. The footstep pattern may be based on a given destination, the location of known obstacles for the robot to avoid, among other examples.


At block 502, the robot 400 may determine a position of a center of mass of the robot 400. In some cases, the robot 400 may determine its center of mass based on a point within the body 404 of the robot 400, which may approximate the robot's center of mass when the robot 400 is standing still.


Alternatively, the robot 400 may determine a center of mass that is specific to the current posture of the robot. For example, the robot 400 may have a first foot 405 (a right foot) in contact with the ground surface and a second foot 406 (a left foot) not in contact with the ground surface. These feet may also be referred to as the “stance” foot and the “swing” foot, respectively, although these designations will alternate as the robot 400 walks, runs, etc. Based on kinematic data from position and movement sensors in the robot's joints, the robot 400 may determine the relative position of one or more links in its arms, legs, etc., with respect to the body 404, and then calculate a center of mass based on this information in conjunction with the known mass of each link. Other examples are also possible.


At block 504, the robot 400 may determine a velocity of the center of mass. For example, the robot 400 may determine the velocity of the center of mass based on data received from one or more IMU sensors within the robot's body 404, kinematic data from joint sensors, an onboard LIDAR system, or a combination of these or other sensors.


At block 506, the robot 400 may determine a capture point based on the position of the center of mass and the velocity of the center of mass. The determination of the capture point approximates the dynamic motion of the robot 400 as if the robot's center of mass were falling according to a linear inverted pendulum. Further, the capture point itself represents a position on the ground surface where the robot 400 may place its swing foot 406 in order to completely arrest the falling, capturing the robot's momentum and bringing the robot 400 to a stop.


The capture point may be illustrated by reference to FIG. 6, which shows an example footstep pattern 600 for the robot 400. Moving from left to right in FIG. 6, the footstep pattern 600 includes target footstep locations 601, 602, 603, 604, 605, and 606. In FIG. 6, the stance foot 405 (the right foot) is in contact with the ground surface 607 while the swing foot 406 (the left foot, not pictured) swings toward the target footstep location 601. During the step, according to the linear inverted pendulum model, the robot 400 “falls” forward and to its left, toward its next footstep location. Accordingly, the capture point 608 may move along a trajectory 609, forward and to the left, during the step.


In some cases, the robot 400 may determine a footstep pattern assuming point feet—that is, target footstep locations that are represented by a single point at which the forces exerted by the robot's foot act upon the ground surface. In other cases, such as the example shown in FIG. 6, the robot 400 may determine the footstep pattern based on target footstep locations that consider an approximate surface area of the robot's foot that will contact the ground surface. In this case, the robot 400 may also determine a target position for the center of pressure for each target footstep location, which represents the point at which the forces exerted by the robot's foot act upon the ground surface.


In FIG. 6, the center of pressure 405′ for the current step of foot 405 is shown, as well as the target positions for the center of pressure 601′, 602′, 603′, 604′, 605′, and 606′ for each respective target footstep location. According to the linear inverted pendulum model, the robot's current center of pressure 405′ represents the point about which the pendulum (i.e., the robot's center of mass) moves. Thus, as the robot 400 “falls” forward and to the left, the center of mass and, therefore, the capture point 608, move on a trajectory 609 away from the center of pressure 405′.


The timing for when the robot 400 will cause the swing foot 406 to contact the ground surface 607 may be determined mechanically by the robot 400. For instance, the robot 400 may repeat the operation of determining the capture point 608 at a frequency within the range of 100-1000 Hz, and thereby update the position of the capture point 608 at it moves along trajectory 609. For instance, the robot 400 may determine the position of the capture point 608 at a rate of 333 Hz.


Further, at block 508, the robot 400 may determine a threshold position 610 for the capture point 608. The robot 400 may also determine, at block 510, that the capture point 608 has reached the threshold position 610.


At block 512, based on the determination that the capture point 608 has reached the threshold position 610, the robot 400 may cause the swing foot 406 to contact the ground surface 607. For example, the threshold position 610 may be located such that the swing foot 406 will contact the ground surface laterally outside the capture point 608, just before it reaches the threshold position 610. As the robot 400 lifts the stance foot 405 off the ground surface 607, the stance foot becomes the swing foot and the center of pressure will move from 405′ to 601′. This, in turn, will cause the robot 400 to “fall” (and the capture point 608 to move) along a new trajectory 611, away from the center of pressure 601′, and toward the next target footstep location 602.


Accordingly, the threshold position 610 may be based on the target trajectory 611 for the capture point 608. As discussed, the target trajectory 611 corresponds to the movement of the capture point 608 after the swing foot 406 contacts the ground surface 607. In other words, the robot 400 may determine when to place its swing foot 406 on the ground surface 607 based on the target trajectory 611 for the capture point 608.


The target trajectory 611 for the capture point 608 may be determined based on several variables. For example, the target trajectory is defined by two points. The first point is the center of pressure 601′ for the upcoming step, which is known based on the determined footstep pattern 600, and the known footstep location 601.


The second point is a target position 612 for the capture point 608 at the end of the next step, when the right foot 405 (now the swing foot) contacts the ground surface 607 at target footstep location 602. For example, the right foot 405 may have a nominal swing period with a beginning and an end. The target position 612 corresponds to the position of the capture point 608 at the end of the nominal swing period for the right foot 405. The threshold position 610 may lie on a line between these two points defining the target trajectory 611, and may consider other factors as well. For example, the threshold position 610 may be based on the size and configuration of the robot 400, the footstep pattern 600, the robot's forward velocity, the current posture of the robot 400, among other examples.


As can be seen in FIG. 6, the target position 612 may also correspond to the next threshold position for the capture point 608. Thus, the geometric pattern for the threshold position is repetitive for a constant footstep pattern 600. Each threshold position is determined such that the next footstep will “push” the capture point 608 along the next target trajectory, toward the next threshold position, and so on.


Each threshold position, including the threshold position 610, may be determined based on the intersection of a lateral threshold and a forward threshold, as shown in FIG. 6. The lateral and forward thresholds may be determined based on the geometry of the footstep pattern 600, including the stance width wd and the stride length Δx. Further, because the threshold position 610 is based on the target position 612 for the capture point 608 at the end of the upcoming step, the threshold position 610 is also based on the nominal swing period T for the upcoming step. The nominal swing period T may be related to the stride length Δx by the following equation:

Δx={dot over (x)}dT


where {dot over (x)}d is the target forward velocity for the gait of the robot 400. For example, if the target velocity {dot over (x)}d for a given stride length increases, the nominal swing period T for the swing leg will decrease proportionally. The target gait velocity {dot over (x)}d may be input by a user, determined by the robot 400 based on its navigation and control systems, among other examples.


Further, the forward and lateral thresholds may be based on the dynamic motion of the robot 400 according to the linear inverted pendulum model. For example, the robot 400 may include a height, z, from the swing foot 406 to the robot's center of mass. Accordingly, the height z may correspond to the length of the pendulum, and may yield a time constant, λ, that represents the natural frequency of the robot 400 when modeled as a falling pendulum according to the following equation:






λ
=


z
g






where g is the acceleration due to gravity. The time constant λ is based on the configuration of the robot 400, specifically its height. For example, a robot 400 with relatively longer legs 402, 403 will “fall” according to the pendulum model at a different rate than a robot 400 that has relatively shorter legs 402, 403.


Based on the variables discussed above, the robot 400 may determine a first forward threshold 613a as a distance 614 from the center of pressure 405′. The first forward threshold 613a may correspond to the nominal forward position of the capture point 608 at the beginning of the swing period for the swing foot 406, i.e., at nominal swing time (0), when the stance foot 405 first contacts the ground surface 607. The robot 400 may calculate the first forward threshold 613a based on the following equation:









x

cap
,
nom




(
0
)


-


x
stnc



(
0
)



=



-


x
.

d



T


1
-

exp


(

λ





T

)








where xcap,nom(0) represents the x-position of the capture point 608 at nominal time zero, and xstnc(0) represents the x-position of the stance foot 405 at nominal time zero. Thus, the difference between the two represents the distance 614, in the x-direction, between the stance foot 405 and the capture point 608 at the beginning of the step.


The robot 400 may also determine a second forward threshold 613b as a distance 615 from the center of pressure 405′ of the stance foot 405. The second forward threshold 613b may correspond to the nominal forward position of the capture point 608 at the end of the swing period for the swing foot 406, i.e., at nominal swing time (T), when the swing foot 406 first contacts the ground surface 607 at target footstep location 601. The robot 400 may calculate the second forward threshold 613b based on the following equation:









x

cap
,
nom




(
T
)


-


x
stnc



(
0
)



=



-


x
.

d



T






exp


(

λ





T

)




1
-

exp


(

λ





T

)








where xcap,nom(T) represents the x-position of the capture point 608 at nominal time T, at the end of the swing period, and xstnc(0) represents the x-position of the stance foot 405 at nominal time zero during the step. Thus, the difference between the two represents the distance 615, in the x-direction, between the stance foot 405 and the capture point 608 at the end of the step.


As noted above, these equations are applicable at each target location of the stance foot of the robot 400.


Similarly, the robot 400 may determine a first lateral threshold 616a as a distance 617 from the center of pressure 405′ of the stance foot 405. The first lateral threshold 616a may correspond to the nominal lateral position of the capture point 608 at the beginning of the swing period for the swing foot 406, i.e., at nominal swing time (0), when the when the stance foot 405 first contacts the ground surface 607. The robot 400 may calculate the first lateral threshold 616a based on the following equation:









y

cap
,
nom




(
0
)


-


y
stnc



(
0
)



=


±

w
d



1
+

exp


(

λ





T

)








where, similar to the equations above, ycap,nom(0) represents the y-position of the capture point 608 at nominal time 0, at the beginning of the swing period, and ystnc(0) represents the y-position of the stance foot 405 at nominal time zero during the step. Thus, the difference between the two represents the distance 617, in the y-direction, between the stance foot 405 and the capture point 608 at the beginning of the step.


The robot 400 may also determine a second lateral threshold 616b as a distance 618 from the center of pressure 405′ of the stance foot 405. The second lateral threshold 616b may correspond to the nominal lateral position of the capture point 608 at the end of the swing period for the swing foot 406, i.e., at nominal swing time (T), when the swing foot 406 first contacts the ground surface 607 at target footstep location 601. The robot 400 may calculate the second lateral threshold 616b based on the following equation:









y

cap
,
nom




(
T
)


-


y
stnc



(
0
)



=



±

w
d








exp


(

λ





T

)




1
+

exp


(

λ





T

)








where ycap,nom(T) represents the y-position of the capture point 608 at nominal time T, at the end of the swing period, and ystnc(0) represents the y-position of the stance foot 405 at nominal time zero during the step. Thus, the difference between the two represents the distance 618, in the y-direction, between the stance foot 405 and the capture point 608 at the end of the step.


Further, the y-direction equations above each have two solutions, one positive and one negative. The two solutions may be used for the alternating right and left stance feet, respectively. For instance, when the right foot 405 is the stance foot, the two lateral thresholds 616a, 616b are located in the positive y-direction from the right foot 405 (i.e., “up” in FIG. 6). Alternatively, when the left foot 406 is the stance foot, the two lateral thresholds 616a, 616b are located in the negative y-direction from the left foot 406 (i.e., “down” in FIG. 6).


As noted above, the robot 400 may cause the swing foot 406 to contact the ground surface 607 based on a determination that the capture point 608 has reached the threshold 610. For example, the robot 400 may update the position of the capture point 608 as it moves along trajectory 609. The robot 400 may determine the distance between the capture point 608 and the threshold position 610, and similarly update the determined distance between the two. As the capture point 608 approaches the threshold 610, the robot may begin to cause the swing foot 406 to contact the ground surface 607.


In some cases, the robot may cause the swing foot 406 to contact the ground surface 607 slightly before the capture point 608 reaches the threshold position 610. For example, based on the trajectory 609 of the capture point 608, the robot 400 may determine an approximate time until the capture point 608 reaches the threshold position 610. The approximate time may be expressed as a range, such as 0-100 milliseconds, a percentage of the nominal step duration, among other examples. The robot 400 may then cause the swing foot 406 to contact the ground surface 607 within the range of, for instance, 0-100 milliseconds before the capture point 608 reaches the threshold position 610. In some situations, this may allow the robot 400 to more readily shift its weight from the stance foot 405, and then pick up the stance foot 405.


In the examples discussed above, each step of the robot 400 is mechanically-timed. That is, the robot 400 determines when to put down its swing foot based on the current dynamics of its gait, namely the position and trajectory of the capture point 608. And although the threshold position 610 is based in part on a nominal swing period for the foot 405, the actual footstep timing might not correspond to the nominal swing period.


For instance, the robot 400 may encounter an obstacle or experience a disturbance that alters the forward velocity of the robot 400. For example, the robot 400 may be pushed forward. For a robot with a gait that is strictly timer-based, this may be problematic because the timed footstep may occur too late to capture robot's “falling”, which has been accelerated forward. In other words, the robot's capture point may be too far ahead of the robot when the swing foot touches the ground. As a result, the robot might not be able to maintain its balance.


However, based on the examples of a mechanically-timed gait discussed above, the robot 400 in the same situation may determine that the position of the capture point 608 will approach the threshold 610 sooner than it would under nominal conditions. Accordingly, the robot 400 will cause the swing foot 406 to touch down at the target footstep location 601 more quickly than a nominal step, in order the “push” the capture point 608 toward the next footstep location.


Other examples are also possible, including examples where a disturbance may alter the trajectory 609 of the capture point 608. In this situation, the robot 400 may determine a number of responses. For instance, if the disturbance to trajectory 609 is not severe, the capture point 608 may still intersect with the target trajectory 611. Thus, the robot 400 may estimate an intersection between the current trajectory of the capture and the target trajectory 611, and then use this intersection as the threshold position to determine the touch down timing of the swing foot 406.


Additionally or alternatively, the robot 400 may manipulate the actuators in its stance leg 402 so as to adjust the contact between the stance foot 405 and the ground surface 607. In this way, the robot 400 may shift the location of the center of pressure point 405′, which may adjust and possibly correct the trajectory of the capture point 608. For example, the robot 400 may rotate the stance foot 405 and in doing so, shift the center of pressure 405′ more toward the outside edge of the foot 405. Other examples are also possible.


As another example, the robot 400 may determine a posture adjustment that may alter the relative position of the robot's center of mass. For instance, if the robot 400 experiences a disturbance that causes the trajectory of the capture point 608 to stray to the left, the robot 400 may respond by extending its right arm laterally, so as to shift the robot's overall center of mass to the right. This, in turn, may cause the trajectory of the capture point 608 to move back to the right. Numerous other disturbances and posture adjustments are also possible.


In some cases, a disturbance to the robot's gait may be such that the robot 400 cannot adequately control the trajectory of the capture point while still maintaining the determined footstep pattern 600. Such examples are discussed further below.


Further, although the footstep pattern shown in FIG. 600 represents a relatively straight line, the robot 400 may perform substantially the same operations as those described above for footstep patterns having different configurations. For example, the robot 400 may determine a capture point and thresholds for the capture point by applying the same principles to a footstep pattern that turns in multiple directions, changes its stride length, etc.


Second Example Implementation for Determining Mechanically-Timed Footstep


FIG. 7 is another flowchart 700 illustrating operations for determining mechanically-timed footsteps for an example robot based on the robot's capture point. The following paragraphs generally discuss examples involving a biped robot with two feet, however the operations may also be applicable to robots with a different number of feet, such as a quadruped robot with four feet, among other examples. Further, the operations discussed below may be performed by a robot that is walking, trotting, or running. Other gaits are also possible.


At block 702, a robot may determine a footstep pattern. The robot may be, for example, the robot 400 shown in FIG. 4. The robot 400 may include a first, stance foot 405 in contact with the ground surface and second, swing foot 406 not in contact with the ground surface. The footstep pattern may be determined as generally discussed above with respect to flowchart 500, and may include a target footstep location for the swing foot.


As also discussed above, the robot 400 may determine, at block 704, a position of a center of mass for the robot 400, and determine, at block 706, a velocity of the center of mass. Based on both of these determinations the robot 400 may, at block 708, determine a capture point for the robot 400, which corresponds to a point on the ground surface and approximates the dynamic motion of the robot 400 as a linear inverted pendulum, as discussed with respect to flowchart 500.


At block 710, the robot 400 may determine a current trajectory for the capture point. For example, the robot 400 may determine the capture point at a given frequency, as described above, and determine a current trajectory based on a series of recently determined capture points. Other examples are also possible.



FIG. 8 shows an example footstep pattern 800 for the robot 400, including target footstep locations 801, 802, 803, and 804. In FIG. 8, the stance foot 405 is in contact with the ground surface 805 while the swing foot 406 (not pictured) swings toward the target footstep location 801 for the swing foot 406. Based on the geometry of the footstep pattern 800, the capture point 806 may follow the target trajectory 807 throughout the footstep pattern 800, as discussed and calculated above with respect FIG. 6 and flowchart 500.


However, as shown in FIG. 8, the robot 400 may experience a disturbance to its gait that alters the trajectory of the capture point 806. Thus, the robot 400 may determine a current trajectory 808 for the capture point 806 that deviates substantially from the target trajectory 807. Based on the current trajectory, the robot 400 may determine that the target footstep location 801 for the swing foot 406 is not adequate to maintain control the robot's balance, posture, etc.


The determination that the target footstep location 801 is no longer adequate may be based on a number of factors. For instance, the robot 400 may determine that the current trajectory 808 for the capture point 806 is laterally outside the target center of pressure 801′ for the upcoming step of the swing foot 406, as shown in FIG. 8. In this situation, causing the swing foot 406 to touch down at the target footstep location 801 may be counterproductive, as it may cause the capture point 806 to stray even further to the left. Additionally or alternatively, the robot 400 may determine that other control priorities prevent it from correcting the current trajectory 808 in the ways discussed above. Further, the robot 400 may determine that an obstacle prevents it from placing the swing foot 406 at the target footstep location 801. Other examples are also possible.


Accordingly, at block 712, the robot 400 may update the target footstep location for the swing foot 406. For example, the robot 400 may determine an updated target footstep location that puts the capture point 806 on a trajectory back toward its target position 809 at the end of the following step of the right foot 405. As noted above, the target position 809 may represent the next threshold position for the following step of the robot 400, and may be determined as discussed above.


The potential positions for the updated target footstep location may be constrained. For instance, the robot 400 may determine a range of positions 810 for the target footstep location that is based on the mechanical limits of how far the robot 400 can reach with its swing leg 403. The range of positions 810 may be based on other factors as well, such as obstacles, other control priorities of the robot 400, among other examples.


However, not every location within the range of positions 810 is a feasible touchdown location for the swing foot 406, if the capture point 806 is to return to the target capture point position 809 in a single step. Thus, the robot 400 may further determine a step constraint region 811 that is based on the range of positions 810 as well as the current trajectory 808. As shown in FIG. 8, the step constraint region represents a region where the robot 400 may place the swing foot 406 that may result in a trajectory for the capture point 806 that returns to the target position 809.


For example, FIG. 8 shows a series of potential footstep locations which, for clarity, are only shown by way of their center of pressure 812a, 812b, 812c, 812d, 812e, and 812f Each of these potential touchdown locations may result in a target trajectory, such as the target trajectory 813, for the capture point 806 that may direct the capture point 806 back to the target position 809. However, only the potential positions 812a, 812b, and 812c are feasible, as they are within the step constraint region 811. Thus, the target trajectory for the capture point may be based on the step constraint region 811.


At block 714, the robot 400 may determine a threshold position for the capture point 806. In some cases, where the step constraint region 811 represents a set of possible footstep locations, the robot 400 may determine a corresponding set of threshold positions. For instance, the robot 400 may determine set of threshold positions that comprises the line from 814a to 814b. The robot 400 may determine, based on its other control priorities or other factors, the updated target footstep location 812a from all of the potential locations within the step constraint region 811. Accordingly, the robot 400 may then determine the threshold position 814a for the capture point 806 that corresponds to the footstep location 812a. Other examples are also possible.


At block 716, the robot 400 may determine that the capture point 806 has reached the threshold position 814a, as discussed above. Based on this determination, the robot 400 may, at block 718, cause the swing foot 406 to contact the ground surface 805 at the updated target footstep location 812a for the swing foot 406. This may cause the capture point 806 to move on the trajectory 813 back toward the target position 809, which is the next threshold position according to the footstep pattern 800, as described above. The robot 400 may then cause the right foot 405 (now the swing foot) to contact the ground surface 805 as the capture point 806 approaches the next threshold position, and so on.


IV. CONCLUSION

While various implementations and aspects have been disclosed herein, other aspects and implementations will be apparent to those skilled in the art. The various implementations and aspects disclosed herein are for purposes of illustration and are not intended to be limiting, with the scope being indicated by the following claims.

Claims
  • 1. A computer-implemented method when executing by data processing hardware of a legged robot causes the data processing hardware to perform operations comprising: determining that a gait disturbance dynamically shifts a center of mass for the legged robot toward a first lateral side of the legged robot;instructing a first swing leg of the legged robot located on the first lateral side of the legged robot to move to a first touchdown position laterally outside of the center of mass of the legged robot;controlling the first swing leg to exert a first ground contact force that pushes the center of mass of the legged robot toward a second lateral side of the legged robot opposite the first lateral side; andinstructing a second swing leg of the legged robot located on the second lateral side to move to a second touchdown position laterally outside the center of mass of the legged robot.
  • 2. The method of claim 1, wherein the operations further comprise controlling the second swing leg to exert a second ground contact force that pushes the center of mass towards an upright posture for the legged robot.
  • 3. The method of claim 2, wherein the upright posture corresponds to a balanced posture for the legged robot.
  • 4. The method of claim 1, wherein the gait disturbance occurs while the legged robot is performing a first motion gait, the first motion gait comprising at least one of a walking gait, a trotting gait, or a running gait.
  • 5. The method of claim 1, wherein the operations further comprise controlling an actuator associated with the first swing leg to generate the first ground contact force.
  • 6. The method of claim 1, wherein the operations further comprise controlling an actuator associated with the first swing leg to shift a center of pressure for touchdown of the first swing leg toward an outside edge of a foot associated with the first swing leg.
  • 7. The method of claim 6, wherein controlling the actuator comprises instructing the actuator to rotate the first swing leg during touchdown.
  • 8. The method of claim 1, wherein the legged robot comprises a body and four legs coupled to the body, and wherein two legs are coupled to the first lateral side of the body and two legs are coupled to the second lateral side of the body.
  • 9. The method of claim 1, wherein the operations further comprise adjusting a posture of the legged robot to shift the center of mass towards a balanced position.
  • 10. The method of claim 1, wherein the operations further comprise: receiving a user input indicating a forward velocity for a gait of the legged robot; andcontrolling the legged robot to execute the gait at the forward velocity input by the user.
  • 11. A robot comprising: a body;four legs coupled to the body, the four legs comprising a first swing leg on a first lateral side of the body and a second swing leg on a second lateral side of the body opposite the first lateral side;a control system in communication with the four legs of the robot, the control system comprising at least one processor and configured to perform operations comprising: determining that a gait disturbance dynamically shifts a center of mass for the robot toward the first lateral side of the robot;instructing the first swing leg to move to a first touchdown position laterally outside of the center of mass of the robot;controlling the first swing leg to exert a first ground contact force that pushes the center of mass of the robot toward the second lateral side; andinstructing the second swing leg to move to a second touchdown position laterally outside the center of mass of the robot.
  • 12. The robot of claim 11, wherein the operations further comprise controlling the second swing leg to exert a second ground contact force that pushes the center of mass towards an upright posture for the robot.
  • 13. The robot of claim 12, wherein the upright posture corresponds to a balanced pose for the robot.
  • 14. The robot of claim 11, wherein the gait disturbance is received while the robot is performing a particular motion gait, the particular motion gait comprising at least one of a walking gait, a trotting gait, or a running gait.
  • 15. The robot of claim 11, wherein the operations further comprise controlling an actuator associated with the first swing leg to generate the first ground contact force.
  • 16. The robot of claim 11, wherein the operations further comprise controlling an actuator associated with the first swing leg to shift a center of pressure for touchdown of the first swing leg toward an outside edge of a foot associated with the first swing leg.
  • 17. The robot of claim 16, wherein controlling the actuator comprises instructing the actuator to rotate the first swing leg during touchdown.
  • 18. The robot of claim 11, wherein the operations further comprise adjusting a posture of the robot to shift the center of mass towards a balanced position.
  • 19. The robot of claim 11, wherein the operations further comprise: receiving a user input indicating a forward velocity for a gait of the robot; andcontrolling the robot to execute the gait at the forward velocity input by the user.
  • 20. The robot of claim 19, wherein determining that the gait disturbance dynamically shifts the center of mass for the legged robot comprises determining that the robot is travelling at a velocity greater than the forward velocity input by the user.
CROSS REFERENCE TO RELATED APPLICATIONS

This U.S. patent application is a continuation of, and claims priority under 35 U.S.C. § 120 from, U.S. patent application Ser. No. 16/281,204, filed on Feb. 21, 2019, now U.S. Pat. No. 10,246,151 B1, which is a continuation of U.S. patent application Ser. No. 15/331,167, filed on Oct. 21, 2016, now U.S. Pat. No. 10,246,151 B1, which is a continuation of U.S. patent application Ser. No. 14/585,542, filed on Dec. 30, 2014, now U.S. Pat. No. 9,499,218 B1. The disclosures of these prior applications are considered part of the disclosure of this application and are hereby incorporated by reference in their entireties.

US Referenced Citations (215)
Number Name Date Kind
4834200 Kajita May 1989 A
5151859 Yoshino et al. Sep 1992 A
5355064 Yoshino et al. Oct 1994 A
5416393 Gomi et al. May 1995 A
5432417 Takenaka et al. Jul 1995 A
5459659 Takenaka Oct 1995 A
5644204 Nagle Jul 1997 A
5737217 Nishikawa et al. Apr 1998 A
5802382 Greenberger et al. Sep 1998 A
5808433 Tagami et al. Sep 1998 A
5838130 Ozawa Nov 1998 A
5842533 Takeuchi Dec 1998 A
5974366 Kawai et al. Oct 1999 A
6064167 Takenaka et al. May 2000 A
6243623 Takenaka et al. Jun 2001 B1
6289265 Takenaka et al. Sep 2001 B1
6374157 Takamura Apr 2002 B1
6463356 Hattori et al. Oct 2002 B1
6484068 Yamamoto et al. Nov 2002 B1
6493607 Bourne et al. Dec 2002 B1
6802382 Hattori et al. Oct 2004 B2
6920374 Takenaka et al. Jul 2005 B2
6943520 Furuta et al. Sep 2005 B2
6992455 Kato et al. Jan 2006 B2
6992457 Furuta et al. Jan 2006 B2
6999851 Kato et al. Feb 2006 B2
7013201 Hattori et al. Mar 2006 B2
7076331 Nagatsuka et al. Jul 2006 B1
7120518 Takenaka et al. Oct 2006 B2
7236852 Moridaira et al. Jun 2007 B2
7386364 Mikami et al. Jun 2008 B2
7603234 Takenaka et al. Oct 2009 B2
7606634 Takenaka et al. Oct 2009 B2
7657345 Endo et al. Feb 2010 B2
7734377 Hasegawa Jun 2010 B2
7734378 Takenaka et al. Jun 2010 B2
7881824 Nagasaka et al. Feb 2011 B2
7949430 Pratt et al. May 2011 B2
8060253 Goswami et al. Nov 2011 B2
8108070 Tajima Jan 2012 B2
8172013 Shimada May 2012 B2
8195332 Pratt et al. Jun 2012 B2
8239084 Yamamoto et al. Aug 2012 B2
8306657 Yoshiike et al. Nov 2012 B2
8311131 Woyzichovski Nov 2012 B2
8311731 Sugiura et al. Nov 2012 B2
8332068 Goswami et al. Dec 2012 B2
8386076 Honda et al. Feb 2013 B2
8396593 Orita Mar 2013 B2
8457830 Goulding Jun 2013 B2
8532824 Orita Sep 2013 B2
8565921 Doi Oct 2013 B2
8583283 Takenaka et al. Nov 2013 B2
8630763 Goulding Jan 2014 B2
8688307 Sekiya Apr 2014 B2
8738178 Choi et al. May 2014 B2
8814949 Gramnaes Aug 2014 B2
8825391 Urmson et al. Sep 2014 B1
8849454 Yun et al. Sep 2014 B2
8855820 Watabe Oct 2014 B2
8855821 Seo et al. Oct 2014 B2
8864846 Herr et al. Oct 2014 B2
8924021 Dariush et al. Dec 2014 B2
8938319 Park et al. Jan 2015 B2
8942848 Pratt Jan 2015 B2
8948956 Takahashi et al. Feb 2015 B2
8958915 Takagi Feb 2015 B2
8965573 Maisonnier et al. Feb 2015 B2
9044862 Kim et al. Jun 2015 B2
9102055 Konolige et al. Aug 2015 B1
9207678 Kim Dec 2015 B2
9259838 Blankespoor et al. Feb 2016 B1
9266233 Kornbluh et al. Feb 2016 B2
9283949 Saunders et al. Mar 2016 B2
9308648 Perkins et al. Apr 2016 B2
9317743 Datta et al. Apr 2016 B2
9352470 da Silva et al. May 2016 B1
9387588 Blankespoor et al. Jul 2016 B1
9387896 Blankespoor et al. Jul 2016 B1
9446518 Blankespoor Sep 2016 B1
9499218 Stephens Nov 2016 B1
9561592 da Silva et al. Feb 2017 B1
9594377 Perkins et al. Mar 2017 B1
9618937 Blankespoor et al. Apr 2017 B1
9663165 Blankespoor et al. May 2017 B1
9731416 Saunders et al. Aug 2017 B1
9789611 Blankespoor et al. Oct 2017 B1
10081098 Nelson et al. Sep 2018 B1
10220518 Jackowski et al. Mar 2019 B2
10300969 Blankespoor et al. May 2019 B1
10406690 Blankespoor et al. Sep 2019 B1
10668624 Blankespoor et al. Jun 2020 B2
10888999 Blankespoor et al. Jan 2021 B2
11203385 Blankespoor et al. Dec 2021 B1
20020183897 Kuroki et al. Dec 2002 A1
20030009259 Hattori et al. Jan 2003 A1
20030114960 Takenaka et al. Jun 2003 A1
20030125839 Takenaka et al. Jul 2003 A1
20030154201 Berestov Aug 2003 A1
20040044440 Takenaka Mar 2004 A1
20040099450 Kwok et al. May 2004 A1
20040167641 Kawai et al. Aug 2004 A1
20040172165 Iribe et al. Sep 2004 A1
20040193323 Higaki et al. Sep 2004 A1
20040205417 Moridaira et al. Oct 2004 A1
20040206164 Kawai et al. Oct 2004 A1
20040230340 Fukuchi et al. Nov 2004 A1
20040236467 Sano Nov 2004 A1
20050021176 Takenaka et al. Jan 2005 A1
20050065650 Lewis Mar 2005 A1
20050067993 Kato et al. Mar 2005 A1
20050075755 Takenaka et al. Apr 2005 A1
20050077856 Takenaka et al. Apr 2005 A1
20050110448 Takenaka et al. May 2005 A1
20050113973 Endo et al. May 2005 A1
20050120820 Takenaka et al. Jun 2005 A1
20050125099 Mikami et al. Jun 2005 A1
20050126833 Takenaka et al. Jun 2005 A1
20050156551 Takenaka et al. Jul 2005 A1
20050216097 Rifkin Sep 2005 A1
20050228539 Takenaka et al. Oct 2005 A1
20050240307 Kuroki et al. Oct 2005 A1
20060064203 Goto et al. Mar 2006 A1
20060076167 Setrakian et al. Apr 2006 A1
20060090938 Tanielian May 2006 A1
20060173578 Takenaka et al. Aug 2006 A1
20060247800 Takenaka et al. Nov 2006 A1
20070003915 Templeman Jan 2007 A1
20070013506 Takenaka et al. Jan 2007 A1
20070016329 Herr et al. Jan 2007 A1
20070126387 Takenaka et al. Jun 2007 A1
20070150095 Zaier Jun 2007 A1
20070152620 Takenaka et al. Jul 2007 A1
20070156283 Takenaka Jul 2007 A1
20070168080 Takenaka et al. Jul 2007 A1
20070193789 Takenaka et al. Aug 2007 A1
20070220637 Endo et al. Sep 2007 A1
20070227786 Hillis et al. Oct 2007 A1
20070241713 Yamamoto et al. Oct 2007 A1
20080065269 Hasegawa Mar 2008 A1
20080133055 Hasegawa Jun 2008 A1
20080160873 Yoneda Jul 2008 A1
20080208391 Hasegawa et al. Aug 2008 A1
20090005906 Tajima Jan 2009 A1
20090030530 Martin Jan 2009 A1
20090171503 Takenaka et al. Jul 2009 A1
20090306821 Park et al. Dec 2009 A1
20090312867 Hasegawa et al. Dec 2009 A1
20090325699 Delgiannidis Dec 2009 A1
20100017028 Suga et al. Jan 2010 A1
20100057253 Kwon et al. Mar 2010 A1
20100113980 Herr et al. May 2010 A1
20100114329 Casler et al. May 2010 A1
20100126785 Shimada May 2010 A1
20100161120 Goswami et al. Jun 2010 A1
20100161126 Goswami et al. Jun 2010 A1
20100174409 Park et al. Jul 2010 A1
20100243344 Wyrobek et al. Sep 2010 A1
20100252395 Lehtonen et al. Oct 2010 A1
20100277483 Lee et al. Nov 2010 A1
20100292838 Goswami et al. Nov 2010 A1
20110009241 Lane et al. Jan 2011 A1
20110022232 Yoshiike et al. Jan 2011 A1
20110098856 Yoshiike et al. Apr 2011 A1
20110098857 Yoshiike et al. Apr 2011 A1
20110098860 Yoshiike et al. Apr 2011 A1
20110172825 Lee et al. Jul 2011 A1
20110178637 Lee et al. Jul 2011 A1
20110224827 Andoh Sep 2011 A1
20110231050 Goulding Sep 2011 A1
20110257764 Herr et al. Oct 2011 A1
20110264264 Shirakura et al. Oct 2011 A1
20110301756 Yoshiike et al. Dec 2011 A1
20120072026 Takagi Mar 2012 A1
20120143376 Seo Jun 2012 A1
20120158175 Lee et al. Jun 2012 A1
20120158182 Lee et al. Jun 2012 A1
20120203359 Schimmels et al. Aug 2012 A1
20120245734 Yun et al. Sep 2012 A1
20120259463 Orita Oct 2012 A1
20120277907 Kim et al. Nov 2012 A1
20120303162 Orita Nov 2012 A1
20120310412 Seo et al. Dec 2012 A1
20120316662 Huh et al. Dec 2012 A1
20120316682 Seo et al. Dec 2012 A1
20120316683 Seo et al. Dec 2012 A1
20120316684 Lee et al. Dec 2012 A1
20130079929 Lim et al. Mar 2013 A1
20130123669 Kinoshita et al. May 2013 A1
20130144439 Lee et al. Jun 2013 A1
20130144441 Kanazawa et al. Jun 2013 A1
20130158712 Lee et al. Jun 2013 A1
20130178983 Watabe Jul 2013 A1
20130184861 Pratt et al. Jul 2013 A1
20130206488 Horinouchi Aug 2013 A1
20130238122 Hodgins et al. Sep 2013 A1
20130238183 Goulding Sep 2013 A1
20140019082 Lan et al. Jan 2014 A1
20140081424 Herr et al. Mar 2014 A1
20140081461 Williamson et al. Mar 2014 A1
20140320489 Chizeck et al. Oct 2014 A1
20150051734 Zheng et al. Feb 2015 A1
20150073592 Kaneko et al. Mar 2015 A1
20150120044 Cory Apr 2015 A1
20150134080 Roh May 2015 A1
20150202768 Moridaira Jul 2015 A1
20150202775 Inazumi Jul 2015 A1
20150217447 Kamioka Aug 2015 A1
20150286221 Goulding Oct 2015 A1
20150297934 Agrawal et al. Oct 2015 A1
20150302777 Campolo et al. Oct 2015 A1
20160016308 Kanazawa et al. Jan 2016 A1
20210146548 Blankespoor et al. May 2021 A1
20210171135 Blankespoor et al. Jun 2021 A1
20220143828 Blankespoor et al. May 2022 A1
Foreign Referenced Citations (2)
Number Date Country
100815247 Mar 2008 KR
WO 2016119068 Aug 2016 WO
Non-Patent Literature Citations (25)
Entry
Bajracharya, et al., “High fidelity day/night stereo mapping with vegetation and negative obstacle detection for Vision-in-the-loop walking,” 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Nov. 2013, pp. 3663-3670, IEEE, Tokyo, Japan, 8 pages.
Doshi et al., “Collision Detection in Legged Locomotion using Supervised Learning”, 2007, 6 pages, MIT Cambridge, US.
Non-Final Office Action dated Apr. 29, 2016, issued in connection with U.S. Appl. No. 14/709,830, filed May 12, 2015, 39 pages.
Pratt et al, “Capture Point: A Step Toward Humanoid Push Recovery” Symposium, Dec. 2-6, 2006, pp. 1-8, Genoa, Italy.
Koolen et al, “Caturability-based Analysis and Control of Legged Locomotion, Part 1: Theory and Application to Three Simple Gait Models,” Nov. 2011, pp. 1-28.
Pratt et al, “Capturability-Based Analysis and Control of Legged Locomotion, Part 2: Application to M2V2, a Lower body Humanoid,” Apr. 2011, pp. 1-25.
Abe et al., “Multiobjective Control with Frictional Contacts,” Eurographics/ACM SIGGRAPH Symposium on Computer Animation, Aug. 4-5, 2007, San Diego, California, 10 pages.
Hash Lamon et al., “Simple Virtual Slip Force Sensor for Walking Biped Robots,” IEEE, 2013, pp. 1-5.
Kim et al., “Landing Force Controller for a Humanoid Robot: Time-Domain Passivity Approach,” 2006 IEEE Conference on Systems, Man, and Cybernetics, Oct. 8-11, 2006, Taipei, Taiwan, pp. 4237-4242, 5 pages.
Silva et al., “Goal-Oriented Biped Walking Based on Force Interaction Control,” Proceedings of the 2001 IEEE International Conference on Robotics & Automation, Seoul, Korea, May 21-26, 2001, pp. 4122-3127, 6 pages.
Silva et al., “Towards Force Interaction Control of Biped Walking Robots,” Proceedings of 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems, Sendai, Japan, Sep. 28-Oct. 2, 2004, pp. 2568-2573, 6 pages.
Non-Final Office Action dated Aug. 19, 2015, issued in connection with U.S. Appl. No. 14/468,118, filed Aug. 25, 2014, 14 pages.
Notice of Allowance dated Mar. 14, 2016, issued in connection with U.S. Appl. No. 14/468,118, filed Aug. 25, 2014, 10 pages.
Non-Final Office Action dated Sep. 2, 2015, issued in connection with U.S. Appl. No. 14/468,031, filed Aug. 25, 2014, 31 pages.
Non-Final Office Action dated Jun. 3, 2016, issued in connection with U.S. Appl. No. 14/538,777, filed Nov. 11, 2014, 16 pages.
Notice of Allowance dated Mar. 2, 2016, issued in connection with U.S. Appl. No. 14/468,031, filed Aug. 25, 2014, 7 pages.
Notice of Allowance dated Jun. 24, 2016, issued in connection with U.S. Appl. No. 14/538,777, filed Nov. 11, 2014, 20 pages.
Notice of Allowance dated Jul. 21, 2016, issued in connection with U.S. Appl. No. 14/585,542, filed Dec. 30, 2014, 5 pages.
Non-Final Office Action dated Apr. 15, 2016, issued in connection with U.S. Appl. No. 14/585,542, filed Dec. 30, 2014, 12 pages.
Boone et al., Slipping and Tripping Reflexes for Bipedal Robots, Autonomous Robots, College of Computing, Georgia Institute of Technology, Dec. 1996, vol. 4, No. 3, 11 pages.
Brandao et al., “Footstep planning for slippery and slanted terrain using human-inspired models,” IEEE, 2016, pp. 868-879.
Focchi et al., “Slip recovery for quadruped robots,” Instituto Italiano d: Technologies, 2005, 3 pages.
Hyon et al., “Simultaneous adaptation to rough terrain and unknown external forces for biped humanoids,” IEEE, 2007, pp. 19-26.
Joo et al., Balancing of legged mechanism with multiple segments, 2013 IEEE International Conference on Robotics and Automation (ICRA), Karlsruhe, Germany, May 6-10, 2013, IEEE, 2013, pp. 5683-5688.
Kawamura et al., “Maintaining floor-foot contact of a biped robot by force constraint position control,” Proceedings of the 2011 IEEE International Conference on Mechatronics, Apr. 13-15, 2011, Istanbul, Turkey, IEEE, 2011, pp. 857-862.
Related Publications (1)
Number Date Country
20210147016 A1 May 2021 US
Continuations (3)
Number Date Country
Parent 16281204 Feb 2019 US
Child 17158086 US
Parent 15331167 Oct 2016 US
Child 16281204 US
Parent 14585542 Dec 2014 US
Child 15331167 US