IMU calibration
A method of calibrating an inertial measurement unit, the method comprising: (a) collecting data from the inertial measurement unit while stationary as a first step; (b) collecting data from the inertial measurement unit while repositioning the inertial measurement unit around three orthogonal axes of the inertial measurement unit as a second step; (c) calibrating a plurality of gyroscopes using the data collected during the first step and the second step; (d) calibrating a plurality of magnetometers using the data collected during the first step and the second step; (e) calibrating a plurality of accelerometers using the data collected during the first step and the second step; (f) where calibrating the plurality of magnetometers includes extracting parameters for distortion detection and using the extracted parameters to determine if magnetic distortion is present within a local field of the inertial measurement unit.
1. A method of accounting for magnetic disturbances within range of two or more magnetometers of an inertial measurement unit, the method comprising:
calibrating the two or more magnetometers of the inertial measurement unit to account for local magnetic field distortions and reference misalignments so all magnetometers are aligned to a reference alignment, wherein calibrating the two or more magnetometers of the inertial measurement unit includes performing a first calibration of the inertial measurement unit not mounted to a ferromagnetic object and performing a second calibration of the inertial measurement unit mounted to the ferromagnetic object to produce a reference dataset;
extracting parameters for distortion detection that are established from the calibrating; and
applying the extracted parameters to captured data from the inertial measurement unit to identify transient magnetic distortion.
2. The method of claim 1 , wherein the extracting parameters assumes two or more of the following: (a) motion or lack of motion of the inertial measurement unit is detectable; (b) an angle and a length of the two or more magnetometers have identical values; (c) calibrated magnetometer vectors should be unity in magnitude; (d) an angle between a calibrated magnetometer vector and a calibrated accelerometer vector should not change; (e) a radius of the two or more magnetometers should be one; and, (f) quatemions calculated using different magnetometers should be equal.
3. The method of claim 1 , wherein the extracting parameters assumes motion or lack of motion of the inertial measurement unit is detectable and, using data output from the inertial measurement unit during calibration, calculating a threshold of magnetic anomaly for the inertial measurement unit, where values below the threshold of magnetic anomaly are representative of the inertial measurement unit not being influenced by a magnetic anomaly, and where values above the threshold of magnetic anomaly are representative of the inertial measurement unit being influenced by a magnetic anomaly.
4. The method of claim 1 , wherein the extracting parameters assumes an angle and a length of the two or more magnetometers have identical values and, using data output from the inertial measurement unit during calibration, a threshold of magnetic anomaly is calculated for the inertial measurement unit, where values below the threshold of magnetic anomaly are representative of the inertial measurement unit not being influenced by a magnetic anomaly, and where values above the threshold of magnetic anomaly are representative of the inertial measurement unit being influenced by a magnetic anomaly.
5. The method of claim 1 , wherein the extracting parameters assumes calibrated magnetometer vectors should be unity in magnitude and, using data output from the inertial measurement unit during calibration, calculating a tolerance range of magnetic anomaly for the inertial measurement unit, where values within the tolerance range of magnetic anomaly are representative of the inertial measurement unit not being influenced by a magnetic anomaly, and where values above the tolerance range of magnetic anomaly are representative of the inertial measurement unit being influenced by a magnetic anomaly.
6. The method of claim 1 , wherein the extracting parameters assumes an angle between a calibrated magnetometer vector and a calibrated accelerometer vector should not change within an angle tolerance and, using data output from the inertial measurement unit during calibration, calculating a tolerance angle range of magnetic anomaly for the inertial measurement unit, where values within the tolerance angle range of magnetic anomaly are representative of the inertial measurement unit not being influenced by a magnetic anomaly, and where values outside the tolerance angle range of magnetic anomaly are representative of the inertial measurement unit being influenced by a magnetic anomaly.
7. The method of claim 1 , wherein the extracting parameters assumes a radius of the two or more magnetometers should be the same and, using data output from the inertial measurement unit during calibration, calculating a tolerance radius for the two or more magnetometers, where values within the tolerance radius are representative of the two or more magnetometers not being influenced by a magnetic anomaly, and where values outside the tolerance radius are representative of at least one of the two or more magnetometers being influenced by a magnetic anomaly.
8. The method of claim 1 , wherein the extracting parameters act assumes quaternions calculated using different magnetometers should be equal and, using data output from the inertial measurement unit during calibration, calculating a tolerance orientation range for the two or more magnetometers, where values within the tolerance orientation range are representative of the two or more magnetometers not being influenced by a magnetic anomaly, and where values outside the tolerance orientation range are representative of at least one of the two or more magnetometers being influenced by a magnetic anomaly.
9. An inertial measurement unit calibrated according to the method of claim 1 .
10. An inertial measurement unit incorporated as part of a surgical navigation system calibrated according to the method of claim 1 .
11. An inertial measurement unit configured for use in surgical navigation and calibrated according to the method of claim 1 .
12. The method of claim 1 , wherein: performing the first calibration includes calculating a magnetic distortion representative of a local environment; and, performing the second calibration includes calculating an estimated distortion representative of the ferromagnetic object.
13. The method of claim 12 , wherein calibrating the two or more magnetometers of the inertial measurement unit includes: applying the calculated magnetic distortion to the reference dataset to generate a first distorted dataset; and, applying the calculated estimated distortion to the reference dataset to generate a second distorted dataset.
14. The method of claim 13 , wherein calibrating the two or more magnetometers of the inertial measurement unit further includes: establishing a point-to-point correspondence between the first and second distorted datasets; and, extracting a ferromagnetic distortion correction from the second distorted dataset using a recursive optimization algorithm after establishing point-to-point correspondence between the first and second distorted datasets.
15. The method of claim 14 , wherein performing the second calibration of the inertial measurement unit mounted to the ferromagnetic object to produce the reference dataset includes rotating the ferromagnetic object for at least one revolution along each axis in a standard Cartesian system.
16. The method of claim 15 , wherein performing the second calibration of the inertial measurement unit mounted to the ferromagnetic object to produce the reference dataset includes establishing an initial guess as to the center offset of the reference dataset.
17. The method of claim 16 , wherein performing the second calibration of the inertial measurement unit mounted to the ferromagnetic object to produce the reference dataset includes using a multi-dimensional ellipsoidal fitting function to determine soft and hard iron distortion.
18. The method of claim 17 , wherein performing the second calibration of the inertial measurement unit mounted to the ferromagnetic object to produce the reference dataset includes applying a calibration correction using a point correspondence transformation to the reference dataset.
19. The method of claim 17 , wherein performing the second calibration of the inertial measurement unit mounted to the ferromagnetic object to produce the reference dataset includes applying a calibration correction using geometric scaling and compensation to the reference dataset.
20. The method of claim 1 , further comprising applying a calibration correction to the two or more magnetometers to align the two or more magnetometers and account for magnetic distortions present in the detected data.