Techniques for accurate pose estimation
First Claim
Patent Images
1. A pose estimation system for use with a display, the system comprising:
- a. a plurality of sensors,b. a database comprising geodetic coordinates of a location of interest, andc. a processing module communicatively coupled with the database and the sensors, the processing module receiving over time data from the sensors comprising delayed data measurements, and data representing the spatial position and orientation of the display relative to the spatial position of the sensors, and applies an Extended Kalman Filter (EKF) to the received data to estimate the position and orientation of the display, and calculate a position of the location of interest relative to the position and orientation of the display, based on a retroactive update to a previously rendered estimates of the position of the orientation of the display stored in a rewind buffer, wherein the position of the location of interest is the vector rdsd, calculated using the formula;
rdsd=(C neCbnCdb)T[rese−
(repe+CneCbnrpdb)]wherein rpdb is the position of the origin of the display coordinate system d with respect to the point of origin of the body coordinate system p, expressed in body system coordinates b;
rese is the position vector of the location of interest s in the environment with respect to the origin of the earth centered, earth fixed coordinate system e, expressed in e coordinates, derived from the geodetic coordinates of the location of interest in the database; and
repe is the position of location p with respect to the origin of e, expressed in e coordinates, wherein Cne is an orientation of a North-East-Down (n) coordinate system with respect to e, wherein Cbn is an orientation of b with respect to the North-East-Down (n) coordinate system, and wherein Cdb is the orientation of the display relative to the body system coordinates b.
1 Assignment
0 Petitions
Accused Products
Abstract
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 a retroactive update to a previously rendered estimate of the position of the orientation of the display stored in a rewind buffer. 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.
-
Citations
17 Claims
-
1. A pose estimation system for use with a display, the system comprising:
-
a. a plurality of sensors, b. a database comprising geodetic coordinates of a location of interest, and c. a processing module communicatively coupled with the database and the sensors, the processing module receiving over time data from the sensors comprising delayed data measurements, and data representing the spatial position and orientation of the display relative to the spatial position of the sensors, and applies an Extended Kalman Filter (EKF) to the received data to estimate the position and orientation of the display, and calculate a position of the location of interest relative to the position and orientation of the display, based on a retroactive update to a previously rendered estimates of the position of the orientation of the display stored in a rewind buffer, wherein the position of the location of interest is the vector rdsd, calculated using the formula;
rdsd=(C neCbnCdb)T[rese−
(repe+CneCbnrpdb)]wherein rpdb is the position of the origin of the display coordinate system d with respect to the point of origin of the body coordinate system p, expressed in body system coordinates b;
rese is the position vector of the location of interest s in the environment with respect to the origin of the earth centered, earth fixed coordinate system e, expressed in e coordinates, derived from the geodetic coordinates of the location of interest in the database; and
repe is the position of location p with respect to the origin of e, expressed in e coordinates, wherein Cne is an orientation of a North-East-Down (n) coordinate system with respect to e, wherein Cbn is an orientation of b with respect to the North-East-Down (n) coordinate system, and wherein Cdb is the orientation of the display relative to the body system coordinates b. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11)
-
-
12. A method for providing an estimate of position for a location of interest relative to a display, the method comprising the steps of:
-
a. receiving sensor data from a plurality of sensors comprising delayed data measurements and data representing the spatial position and orientation of a display, b. applying an Extended Kalman Filter (EKF) to the received data and geodetic coordinates of a location of interest, to estimate a position of the location of interest relative to the position and orientation of the display, based on a retroactive update to a previously rendered position estimate stored in a rewind buffer, wherein the position of the location of interest is the vector rdsd, calculated using the formula;
rdsd=(CneCbnCdb)T[rese−
(repe+CneCbnrpdb)]wherein rpdb is the position of the origin of the display coordinate system d with respect to the point of origin of the body coordinate system p, expressed in body system coordinates b;
rese is the position vector of the location of interest s in the environment with respect to the origin of the earth centered, earth fixed coordinate system e, expressed in e coordinates, derived from the geodetic coordinates of the location of interest in a database; and
repe is the position of location p with respect to the origin of e, expressed in e coordinates, wherein Cne is an orientation of a North-East-Down (n) coordinate system with respect to e, wherein Cbn is an orientation of b with respect to the North-East-Down (n) coordinate system, and wherein Cdb is the orientation of the display relative to the body system coordinates b. - View Dependent Claims (13, 14)
-
-
15. A pose estimation system for use with a display, the system comprising
a. means for receiving sensor data from a plurality of sensors comprising delayed data measurements and data representing the spatial position of a display, b. means for applying an Extended Kalman Filter (EKF) to the received data and geodetic coordinates of a location of interest, to estimate a position and orientation of the display, based on a retroactive update to a previously rendered position estimate stored in a rewind buffer, and calculate the position of a location of interest relative to the position and orientation of the display, wherein the position of the location of interest is the vector rdsd, calculated using the formula: -
rdsd=(CneCbnCdb)T [rese−
(repe+CneCbnrpdb)]wherein rpdb is the position of the origin of the display coordinate system d with respect to the point of origin of the body coordinate system p, expressed in body system coordinates b;
rese is the position vector of the location of interest s in the environment with respect to the origin of the earth centered, earth fixed coordinate system e, expressed in e coordinates, derived from the geodetic coordinates of the location of interest in a database; and
repe is the position of location p with respect to the origin of e, expressed in e coordinates, wherein Cne is an orientation of a North-East-Down (n) coordinate system with respect to e, wherein Cbn is an orientation of b with respect to the North-East-Down (n) coordinate system, and wherein Cdb the orientation of the display relative to the body system coordinates b. - View Dependent Claims (16, 17)
-
Specification