Systems and methods for use of optical odometry sensors in a mobile robot
Systems and methods for use of optical odometry sensor systems in a mobile robot. The optical odometry sensor system is positioned within a recessed structure on an underside of the mobile robot body and configured to output optical odometry data. The optical odometry sensor system includes an optical odometry camera that includes a telecentric lens configured to capture images of a tracking surface beneath the body and having a depth of field that provides a range of viewing distances at which a tracking surface is captured in focus from a first distance within the recessed structure to a second distance below the underside of the mobile robot body.
1. A mobile robot configured to navigate an operating environment, comprising:
a body containing:
a drive configured to translate the mobile robot in a direction of motion;
at least one processor;
memory containing a navigation application;
an optical odometry sensor system positioned within a recessed structure on an underside of the body and configured to output optical odometry data, where the optical odometry sensor system comprises an optical odometry camera positioned at a height between 40 to 60 mm from a floor surface, the optical odometry camera including a telecentric lens configured to capture images of a tracking surface beneath the body and having a depth of field in which objects are in focus at distances including distances between negative 5 to 20 mm from a bottom surface of the body; and
a gyroscope configured to output gyroscope measurement data.
2. The mobile robot of claim 1 , wherein the navigation application directs the at least one processor to:
actuate the drive and capture:
the optical odometry data from the optical odometry sensor system; and
the gyroscope measurement data from the gyroscope;
estimate a distance travelled using the captured optical odometry data;
estimate a direction travelled using the gyroscope measurement data; and
update a pose estimate using the estimated distance travelled and direction travelled.
3. The mobile robot of claim 2 , wherein the navigation application directs the at least one processor to estimate the distance travelled using captured wheel odometry data.
4. The mobile robot of claim 2 , wherein the navigation application directs the at least one processor to compare the pose estimate against a pose determination calculated using imaged features detected by a camera mounted under a top surface of the mobile robot.
5. The mobile robot of claim 4 , wherein the navigation application directs the at least one processor to reset the pose estimate if the pose determination indicates the mobile robot has drifted from a heading.
6. The mobile robot of claim 1 , further comprising a plurality of lighting elements disposed about the telecentric lens and comprising a plurality of LEDs for illuminating the tracking surface.
7. The mobile robot of claim 6 , wherein each of the plurality of LEDs are positioned at an acute angle relative to an optical axis of the optical odometry camera.
8. The mobile robot of claim 6 , wherein the plurality of LEDs comprises at least four LEDs positioned at different positions around the optical odometry camera.
9. The mobile robot of claim 8 , wherein pairs of LEDs are positioned on opposite sides relative to the optical odometry camera.
10. The mobile robot of claim 8 , wherein the plurality of LEDs are positioned in a spiral pattern offset from an optical axis of the optical odometry camera.
11. The mobile robot of claim 1 , wherein the drive comprises a plurality of wheels and the mobile robot further comprises a wheel odometry sensor system that outputs wheel odometry data based upon rotation of each of the plurality of wheels.
12. The mobile robot of claim 3 , wherein:
the optical odometry sensor system also outputs a quality measure, where the quality measure indicates a reliability of optical odometry data; and
the navigation application directs the at least one processor to estimate the distance travelled using the captured optical odometry data, when a quality measure satisfies a threshold.
13. The mobile robot of claim 12 , wherein the quality measure is based on a number of valid features detected in an image.
14. The mobile robot of claim 1 , wherein the recessed structure has an opening with a diameter between 10 mm and 40 mm.
15. The mobile robot of claim 1 , wherein the body comprises a top surface that is at most 110 mm from the floor surface.
16. The mobile robot of claim 1 , wherein the depth of field of the optical odometry camera is proportional to a focal length of the optical odometry camera.
17. The mobile robot of claim 16 , wherein the focal length of the optical odometry camera is between 15 to 25 mm.
18. The mobile robot of claim 1 , further comprising four LEDs disposed about the telecentric lens for illuminating the tracking surface.