Back to results
US 11,760,148 B2Granted
Determining vehicle pose using ride height sensors
AssigneeNuro, Inc.
InventorRussell Smith
Life of this patent
Estimating the term…
Abstract
An autonomous robotic vehicle includes a chassis, wheels movably mounted to the chassis by a suspension system, and a vehicle pose system. The vehicle pose system includes a ride height sensor system, a processor, and memory. The sensor system is configured to measure wheel displacement of the wheels relative to the chassis. The sensor system includes ride height sensors that determine wheel positions of the wheels with respect to the chassis as the vehicle travels along a surface. The memory has instructions stored thereon which, when executed by the processor cause the vehicle pose system to determine a plane of the surface corresponding to the wheel positions so that the pose system can determine a pose of the vehicle based on an angle of the surface with respect to the vehicle.
Claims20
An autonomous robotic vehicle, comprising:
- a chassis;
- a plurality of wheels movably mounted to the chassis by a suspension system;
- and
- a vehicle pose system, the vehicle pose system including:
- a ride height sensor system configured to measure wheel displacement of the plurality of wheels relative to the chassis as the plurality of wheels move relative to the chassis, the ride height sensor system including ride height sensors configured to determine wheel positions of each of the plurality of wheels with respect to the chassis as the autonomous robotic vehicle travels along a surface in a forward direction;
- at least one processor;
- and
- a memory having instructions stored thereon which, when executed by the at least one processor cause the vehicle pose system to:
- determine a plane of the surface corresponding to the wheel positions as the autonomous robotic vehicle travels along the surface in the forward direction;
- determine a rotation matrix indicating an orientation of the autonomous robotic vehicle as the autonomous robotic vehicle travels along the surface in the forward direction;
- determine a three-dimensional (3D) travel vector of the autonomous robotic vehicle based on the plane of the surface and the rotation matrix, wherein an absolute value of the 3D travel vector is proportional to a wheel speed of the plurality of wheels and is relative to the rotation matrix, and wherein a forward direction vector of the rotation matrix and the 3D travel vector are not parallel;
- and
- determine a pose of the autonomous robotic vehicle based on a 3D velocity and a 3D position of the autonomous robotic vehicle associated with the 3D travel vector, and the rotation matrix, which are obtained by associating global positioning data of the autonomous robotic vehicle, wheel speed data of the autonomous robotic vehicle including an average wheel speed of the plurality of wheels as measured by a speed of a motor of the autonomous robotic vehicle, and ride height data obtained from at least three of the plurality of wheels of the autonomous robotic vehicle based on measurements by the ride height sensor system, wherein the pose of the autonomous robotic vehicle is an environmental positioning of the autonomous robotic vehicle or of at least one object stored inside the autonomous robotic vehicle.
10 more elements
A vehicle pose system for an autonomous robotic vehicle, the vehicle pose system including:
- a ride height sensor system configured to measure wheel displacement of a plurality of wheels of the autonomous robotic vehicle relative to a chassis of the autonomous robotic vehicle as the plurality of wheels move relative to the chassis, the ride height sensor system including ride height sensors configured to determine wheel positions of each of the plurality of wheels with respect to the chassis as the autonomous robotic vehicle travels along a surface in a forward direction;
- at least one processor;
- and
- a memory having instructions stored thereon which, when executed by the at least one processor cause the vehicle pose system to:
- determine a plane of the surface corresponding to the wheel positions as the autonomous robotic vehicle travels along the surface in the forward direction;
- determine a rotation matrix indicating an orientation of the autonomous robotic vehicle as the autonomous robotic vehicle travels along the surface in the forward direction;
- determine a three-dimensional (3D) travel vector of the autonomous robotic vehicle based on the plane of the surface and the rotation matrix, wherein an absolute value of the 3D travel vector is proportional to a wheel speed of the plurality of wheels and is relative to the rotation matrix, and wherein a forward direction vector of the rotation matrix and the 3D travel vector are not parallel;
- and
- determine a pose of the autonomous robotic vehicle based on a 3D velocity and a 3D position of the autonomous robotic vehicle associated with the 3D travel vector, and the rotation matrix, which are obtained by associating global positioning data of the autonomous robotic vehicle, wheel speed data of the autonomous robotic vehicle including an average wheel speed of the plurality of wheels as measured by a speed of a motor of the autonomous robotic vehicle, and ride height data obtained from at least three of the plurality of wheels of the autonomous robotic vehicle based on measurements by the ride height sensor system, wherein the pose of the autonomous robotic vehicle is an environmental positioning of the autonomous robotic vehicle or of at least one object stored inside the autonomous robotic vehicle.
6 more elements
A method comprising:
- determining wheel positions of each of plurality of wheels with respect to a chassis of an autonomous robotic vehicle as the autonomous robotic vehicle travels along a surface in a forward direction;
- determining a plane of the surface corresponding to the wheel positions as the autonomous robotic vehicle travels along the surface in the forward direction;
- determining a rotation matrix indicating an orientation of the autonomous robotic vehicle as the autonomous robotic vehicle travels along the surface in the forward direction;
- determining a three-dimensional (3D) travel vector of the autonomous robotic vehicle based on the plane of the surface and the rotation matrix, wherein an absolute value of the 3D travel vector is proportional to a wheel speed of the plurality of wheels and is relative to the rotation matrix, and wherein a forward direction vector of the rotation matrix and the 3D travel vector are not parallel;
- and
- determine a pose of the autonomous robotic vehicle based on a 3D velocity and a 3D position of the autonomous robotic vehicle associated with the 3D travel vector, and the rotation matrix, which are obtained by associating global positioning data of the autonomous robotic vehicle, wheel speed data of the autonomous robotic vehicle including an average wheel speed of the plurality of wheels as measured by a speed of a motor of the autonomous robotic vehicle, and ride height data obtained from at least three of the plurality of wheels of the autonomous robotic vehicle based on measurements of the wheel positions, wherein the pose of the autonomous robotic vehicle is an environmental positioning of the autonomous robotic vehicle or of at least one object stored inside the autonomous robotic vehicle.
3 more elements
Dependencies are inferred from the claim text.