Systems and methods for ground plane estimation

Patent metadata

Field	Value
Publication number	US-9259838-B1
Application number	US-201414339860-A
Country	US
Kind code	B1
Filing date	Jul 24, 2014
Priority date	Jul 24, 2014
Publication date	Feb 16, 2016
Grant date	Feb 16, 2016

Abstract

Example systems and methods for estimating a ground plane are provided. An example method may include determining an orientation of a body of a robotic device with respect to a gravity aligned reference frame. The method may also include determining the location of one or more contact points between the robotic device and a ground surface. The method may also include determining a ground plane estimation of the ground surface based on the determined orientation of the robotic device with respect to the gravity aligned reference frame and the determined locations of the one or more contact points. The method may also include determining a distance between the body of the robotic device and the determined ground plane estimation. The method may also include providing instructions to adjust a position and/or orientation of the robotic device based on the determined distance and the determined ground plane estimation.

First claim

What is claimed is:

1. A method operable by a computing device, the method comprising:
determining an orientation of a body of a robotic device with respect to a gravity aligned reference frame;
determining a location of one or more contact points between the robotic device and a ground surface;
determining, by one or more processors of the computing device, a ground plane estimation of the ground surface based on the determined orientation of the robotic device with respect to the gravity aligned reference frame and the determined locations of the one or more contact points between the robotic device and the ground surface, wherein the ground plane estimation includes a flat-plane approximation of a shape of the ground surface that minimizes a distance between the one or more contact points and the determined ground plane estimation;
determining a distance between the body of the robotic device and the determined ground plane estimation; and
providing instructions, by the one or more processors, to adjust a position of the robotic device based on the determined distance and the determined ground plane estimation.

2. The method of claim 1 , wherein the robotic device includes an inertial measurement unit (IMU) including an accelerometer and a gyroscope, and wherein the IMU outputs data for determining the orientation of the robotic device with respect to the gravity aligned reference frame.

3. The method of claim 1 , wherein the location of one or more contact points between the robotic device and the ground surface are determined based on one or more sensors positioned on one or more legs of the robotic device.

4. The method of claim 3 , wherein providing instructions to adjust the position of the robotic device based on the determined ground plane estimation comprises providing instructions to position the one or more legs of the robotic device such that a center of mass of the robotic device is located within a polygon defined by the one or more legs of the robotic device.

5. The method of claim 1 , wherein the location of one or more contact points between the robotic device and the ground surface are determined based on one or more sensors positioned on one or more feet of the robotic device.

6. The method of claim 5 , wherein providing instructions to adjust the position of the robotic device based on the determined distance and the determined ground plane estimation comprises providing instructions to swing one or more feet of the robotic device substantially parallel to the determined ground plane estimation to provide consistent ground clearance.

7. The method of claim 1 , wherein providing instructions to adjust the position of the robotic device based on the determined distance and the determined ground plane estimation comprises providing instructions to orient one or more features of the body of the robotic device substantially parallel to the determined ground plane estimation, or at some orientation relative to the determined ground plane.

8. The method of claim 1 , further comprising:
determining one or more virtual contact points in the vicinity of the robotic device, wherein the one or more virtual contact points represent an estimation of a future, current, or past contact point based on a current position and a current velocity of the robotic device, wherein the virtual contact points are determined via a non-contact sensor system, and wherein the determined ground plane estimation of the ground surface is further based on the determined one or more virtual contact points.

9. The method of claim 8 , wherein the non-contact sensor system comprises a vision system.

10. The method of claim 8 , wherein the non-contact sensor system comprises a laser range finder.

11. The method of claim 1 , wherein two contact points are determined between the robotic device and the ground surface, and wherein determining the ground plane estimation of the ground surface comprises:
determining a normal vector of a previously determined ground plane estimation; and
projecting the normal vector of the previously determined ground plane estimation to be perpendicular to a line connecting the two contact points, such that the projected normal vector is perpendicular to the determined ground plane estimation.

12. The method of claim 1 , wherein three contact points are determined between the robotic device and the ground surface, and wherein determining the ground plane estimation of the ground surface comprises:
determining a plane including the three contact points.

13. The method of claim 1 , wherein determining a distance between the body of the robotic device and the determined ground plane estimation comprises:
determining a first distance between the body of the robotic device and a first point on the determined ground plane estimation;
determining a second distance between the body of the robotic device and a second point on the determined ground plane estimation; and
averaging the first distance and the second distance.

14. The method of claim 1 , further comprising:
determining an orientation difference between the body of the robotic device and the determined ground plane estimation; and
providing instructions, by the one or more processors, to adjust the position of the robotic device based on the determined distance, the determined orientation difference, and the determined ground plane estimation.

15. A robotic device including:
a body;
two or more legs extending from the body;
at least one processor; and
data storage comprising program logic executable by the at least one processor to cause the robotic device to perform functions comprising:
determining an orientation of the body of the robotic device with respect a gravity aligned reference frame;
determining a location of one or more contact points between the robotic device and a ground surface;
determining a ground plane estimation of the ground surface based on the determined orientation of the robotic device with respect to the gravity aligned reference frame and the determined locations of the one or more contact points between the robotic device and the ground surface, wherein the ground plane estimation includes a flat-plane approximation of a shape of the ground surface that minimizes a distance between the one or more contact points and the determined ground plane estimation;
determining a distance between the body of the robotic device and the determined ground plane estimation; and
providing instructions to adjust a position of the robotic device based on the determined distance and the determined ground plane estimation.

16. The robotic device of claim 15 , wherein the robotic device includes an inertial measurement unit (IMU) including an accelerometer and a gyroscope, and wherein the IMU outputs data for determining the orientation of the robotic device with respect to the gravity aligned reference frame.

17. The robotic device of claim 15 , wherein the one or more contact points between the robotic device and the ground surface comprise a location of one or more sensors positioned on two or more legs of the robotic device.

18. The robotic device of claim 15 , further comprising two or more feet coupled to the two or more legs, wherein the one or more contact points between the robotic device and the ground surface, the position of which are determined by one or more sensors on the robotic device.

19. A non-transitory computer-readable storage medium having stored thereon instructions, that when executed by a computing device, cause the c

Assignees

• Google Inc

Inventors

• Blankespoor Kevin
• Nelson Gabriel
• Neville Neil

Classifications

• B62D57/032 Primary

  with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid (B62D57/024 takes precedence) · CPC title

• B25J9/1694

  characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion · CPC title

• B25J9/1615

  characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators · CPC title

• B25J9/1697

  Vision controlled systems · CPC title

• Y10S901/01

  Mobile robot · CPC title