Techniques for accurate pose estimation
The described technology regards an augmented reality system and method for estimating a position of a location of interest relative to the position and orientation of a display, including receiving and selectively filtering a plurality of measurement vectors from a rate-gyroscope. Systems of the described technology include including a plurality of sensors, a processing module or other computation means, and a database. Methods of the described technology use data from the sensor package useful to accurately render graphical user interface information on a display.
1. A method of enhancing the accuracy of pose estimation of a display, comprising the steps of:
receiving, from a three-axis rate gyroscope, rotation data for the display;
calculating, based at least in part on the rotation data for the display, a magnitude associated with a rotation rate for the display;
adjusting, by a processor, a bandwidth associated with a low-pass filter based on the calculated rotation rate for the display,
wherein the low-pass filter is an exponentially weighted moving average with a parameter based on the calculated rotation rate;
applying, by the processor, the low-pass filter to orientation update data for the display to obtain filtered orientation update data for the display;
updating, by the processor and based on the filtered orientation data, an Extended Kalman Filter-based estimation of an orientation of the display;
predicting, by the processor and based on the Extended Kalman Filter-based estimation of the orientation of the display, a future orientation for the display;
determining, based at least in part on the future orientation for the display, a relative bearing to a point of interest;
displaying, on the display, indicia of the relative bearing to the point of interest.
2. The method of claim 1 , wherein the Extended Kalman Filter-based estimation of the orientation of the display is an Extended Kalman Filter-based estimation of a position and the orientation of the display.
3. The method of claim 2 , further comprising the steps of:
receiving, from a position sensor, position data for the display;
updating, by the processor and based on the position data, the Extended Kalman Filter-based estimation of the position and orientation of the display;
predicting, by the processor and based on the Extended Kalman Filter-based estimation of the position and orientation of the display, a future position for the display;
determining, based at least in part on the future position for the display, a relative location of a point of interest;
displaying, on the display, indicia of the relative location of the point of interest.
4. The method of claim 3 , wherein the indicia of the relative bearing to the point of interest and the indicia of the relative location of the point of interest are overlaid on the point of interest in the display.
5. The method of claim 1 , wherein the three-axis gyroscope and the display are integrated into a head-mounted display.
6. The method of claim 1 , wherein the indicia of the relative bearing to the point of interest is displayed an icon on a situational awareness ring in the display.
7. A head-mounted display with enhanced orientation estimation, comprising:
a three-axis rate gyroscope;
a display;
a processor; and
one or more non-transitory computer-readable media storing computer-executable instructions which, when executed by the processor perform a method of estimating a pose of the display, the method comprising the steps of:
receiving, from the three-axis rate gyroscope, rotation data for the display;
calculating, based at least in part on the rotation data for the display, a magnitude associated with a rotation rate for the display;
adjusting a bandwidth associated with a low-pass filter based on the calculated rotation rate for the display,
wherein the low-pass filter is an exponentially weighted moving average with a parameter based on the calculated rotation rate;
applying the low-pass filter to orientation update data for the display to obtain filtered orientation update data for the display;
updating, based on the filtered orientation data, an Extended Kalman Filter-based estimation of an orientation of the display;
predicting, based on the Extended Kalman Filter-based estimation of the orientation of the display, a future orientation for the display;
determining, based at least in part on the future orientation for the display, a relative bearing to a point of interest;
displaying, on the display, indicia of the relative bearing to the point of interest.
8. The head-mounted display of claim 7 , further comprising a position sensor,
wherein the Extended Kalman Filter-based estimation of the orientation of the display is an Extended Kalman Filter-based estimation of a position and the orientation of the display, and
wherein the method further comprises the steps of:
receiving, from the position sensor, position data for the display;
updating, based on the position data, the Extended Kalman Filter-based estimation of a position and the orientation of the display;
predicting, based on the Extended Kalman Filter-based estimation of the position and orientation of the display, a future position for the display;
determining, based at least in part on the future position for the display, a relative location of a point of interest;
displaying, on the display, indicia of the relative location of the point of interest.
9. The head-mounted display of claim 8 , wherein the indicia of the relative bearing to the point of interest and the indicia of the relative location of the point of interest are overlaid on the point of interest in the line of view of a wearer of the head-mounted display.
10. The head-mounted display of claim 7 , further comprising:
a relative position sensor;
an absolute position sensor; and
an absolute orientation sensor.
11. The head-mounted display of claim 10 , wherein:
the relative position sensor is a three-axis accelerometer;
the absolute position sensor is a Global Positioning System receiver; and
the absolute orientation sensor is a three-axis magnetometer.
12. The head-mounted display of claim 7 , wherein the indicia of the relative bearing to the point of interest is displayed as an icon on a situational awareness ring in the display.
13. One or more non-transitory computer-readable media storing computer-executable instructions which, when executed by a processor, perform a method of estimating the orientation of a display, the method comprising the steps of:
receiving, from a three-axis rate gyroscope, rotation data for the display;
calculating, based at least in part on the rotation data for the display, a magnitude associated with a rotation rate for the display;
adjusting, by the processor, a bandwidth associated with a low-pass filter based on the calculated rotation rate for the display,
wherein the bandwidth associated with the low-pass filter is adjusted based on a smooth increasing function of the magnitude of the calculated rotation rate for the display;
applying, by the processor, the low-pass filter to orientation update data for the display to obtain filtered orientation update data for the display;
updating, by the processor and based on the filtered orientation data, a state-based estimation of an orientation of the display;
predicting, by the processor and based on the state-based estimation of the orientation of the display, a future orientation for the display;
determining, based at least in part on the future orientation for the display, a relative bearing to a point of interest;
displaying, on the display, indicia of the relative bearing to the point of interest.
14. The media of claim 13 , wherein the state-based estimation of the orientation of the orientation of the display is an Extended Kalman Filter-based estimation of the orientation of the display.
15. The media of claim 13 , wherein the state-based estimation of the orientation of the display is a state-based estimation of a position and the orientation of the display, and wherein the method further comprises the steps of:
receiving, from a position sensor, position data for the display;
updating, by the processor and based on the position data, the state-based estimation of the position and orientation of the display;
predicting, by the processor and based on the state-based estimation of the position and orientation of the display, a future position for the display;
determining, based at least in part on the future position for the display, a relative location of a point of interest;
displaying, on the display, indicia of the relative location of the point of interest.
16. The media of claim 15 , wherein the indicia of the relative bearing to the point of interest and the indicia of the relative location of the point of interest are overlaid on the point of interest in the display.
17. The media of claim 13 , wherein the indicia of the relative bearing to the point of interest is displayed as an icon on a situational awareness ring in the display.