Sensor fusion for electromagnetic tracking
Head-mounted augmented reality (AR) devices can track pose of a wearer's head or pose of a hand-held user input device to enable wearer interaction in a three-dimensional AR environment. A pose sensor (e.g., an inertial measurement unit) in the user input device can provide data on pose (e.g., position or orientation) of the user input device. An electromagnetic (EM) tracking system can also provide pose data. For example, the handheld user input device can include an EM emitter that generates an EM field, and the head-mounted AR device can include an EM sensor that senses the EM field. The AR device can combine the output of the pose sensor and the EM tracking system to reduce drift in the estimated pose of the user input device or to transform the pose into a world coordinate system used by the AR device. The AR device can utilize a Kalman filter to combine the output of the pose sensor and the EM tracking system.
1. A wearable system comprising:
a head-mounted display;
a handheld totem;
an electromagnetic (EM) tracking system configured to:
determine, based at least on an EM field sensed by the EM tracking system:
a first estimated initial totem pose; and
a second estimated initial totem pose having an opposite orientation from the first estimated initial totem pose;
periodically determine, based at least on a current EM field sensed by the EM tracking system, a first error state associated with the first estimated initial totem pose and a second error state associated with the second estimated initial totem pose; and
in response to determining that the first error state exceeds a threshold, establish the second estimated initial totem pose as an initial totem pose of the handheld totem and disregard the first estimated initial totem pose; or
in response to determining that the second error state exceeds the threshold, establish the first estimated initial totem pose as the initial totem pose of the handheld totem and disregard the second estimated initial totem pose.
2. The wearable system of claim 1 , wherein the EM tracking system is further configured to:
determine a distance between the head-mounted display and the handheld totem; and
identifying a third error state in response to determining that the distance is larger than a threshold distance.
3. The wearable system of claim 1 , wherein the first and second estimated initial totem poses are calculated by a Kalman filter.
4. The wearable system of claim 1 , wherein the first estimated initial totem pose is in a first hemisphere and the second estimated initial totem pose is in a second hemisphere opposite the first hemisphere.
5. The wearable system of any claim 1 , wherein the EM tracking system is further configured to:
present, via the head-mounted display, virtual content to a user of the wearable system; or
enable interaction with an environment of the wearable system based at least partly on movement or rotation of the handheld totem.
6. The wearable system of any claim 1 , wherein the EM tracking system comprising:
one or more EM emitter configured to generate an EM field; and
one or more EM sensors configured to sense the EM field, wherein the EM tracking system is configured to output an EM field matrix associated with an estimated totem pose of the one or more EM sensors relative to the one or more EM emitter.
7. A computerized method, performed by a computing system having one or more hardware computer processors and one or more non-transitory computer readable storage device storing software instructions executable by the computing system to perform the computerized method comprising:
determining, based at least on an electromagnetic (EM) field sensed by an electromagnetic (EM) tracking system:
a first estimated initial totem pose; and
a second estimated initial totem pose having an opposite orientation from the first estimated initial totem pose;
periodically determining, based at least on a current EM field sensed by the EM tracking system, a first error state associated with the first estimated initial totem pose and a second error state associated with the second estimated initial totem pose; and
in response to determining that the first error state exceeds a threshold, establishing the second estimated initial totem pose as an initial totem pose of the handheld totem and disregarding the first estimated initial totem pose; or
in response to determining that the second error state exceeds the threshold, establishing the first estimated initial totem pose as the initial totem pose of the handheld totem and disregarding the second estimated initial totem pose.
8. The computerized method of claim 7 , wherein the first and second estimated initial totem poses are calculated by a Kalman filter.
9. The computerized method of claim 7 , wherein the first estimated initial totem pose is in a first hemisphere and the second estimated initial totem pose is in a second hemisphere opposite the first hemisphere.