Method of automatic continuous calibration for an electric compass
First Claim
1. An autocalibration method for use with an electronic compass in a vehicle, said method including the steps of:
- initializing variables;
retrieving sensor readings from at least two axis;
updating calibration based on said sensor readings;
calculating a raw azimuth wit calibration adjusted sensor readings;
adjusting said raw azimuth by a declination angle;
filtering said raw azimuth with a previously filtered azimuth to obtain a filtered azimuth;
updating a first heading from said filtered azimuth; and
determining if a display needs said updated first heading transferred thereto.
1 Assignment
0 Petitions
Accused Products
Abstract
An autocalibration method for use within an electronic compass in a vehicle is disclosed. The method includes steps of initializing variables and then retrieving sensor readings from at least two axis. The method then compares the compass tilt to a predetermined threshold. Next the method will determine if the sensor reading is a minimum or maximum for the current calibration cycle. Next the method will determine if the maximum value of the sensor readings is greater than the predetermined minimum spread. Then the method will calculate an offset value for each axis and calculate a sensor value for each axis. Then the method will calculate an azimuth value with the new sensor values and determine the heading using the azimuth.
80 Citations
18 Claims
-
1. An autocalibration method for use with an electronic compass in a vehicle, said method including the steps of:
-
initializing variables;
retrieving sensor readings from at least two axis;
updating calibration based on said sensor readings;
calculating a raw azimuth wit calibration adjusted sensor readings;
adjusting said raw azimuth by a declination angle;
filtering said raw azimuth with a previously filtered azimuth to obtain a filtered azimuth;
updating a first heading from said filtered azimuth; and
determining if a display needs said updated first heading transferred thereto. - View Dependent Claims (2, 3, 4, 5)
comparing compass tilt to a predetermined threshold to verify the compass is within a predetermined range from horizontal;
determining if said sensor readings are valid;
determining if said sensor reading is a minimum or maximum for the current calibration cycle;
determining if a spread of each axis is greater than a predetermined minimum spread;
calculating an offset value for each axis;
calculating a sensor value by adjusting said sensor readings with said offset value for each axis;
calculating a rough azimuth with said sensor values;
determining a second heading using said rough azimuth; and
determining if eight consecutive cardinal headings have been sensed.
-
-
3. The method of claim 2 further including the step of comparing a cycle of axis data with a predetermined value and updating a calibration counter based on said comparison of a cycle of data with said predetermined value and on a number of said cycle data processed.
-
4. The method of claim 3 further including the step of updating calibration values for the compass.
-
5. The method of claim 1 wherein said step of calculating a raw azimuth has the form of the Arctan of the axis readings.
-
6. An autocalibration method for use in an electronic compass in a vehicle, said method including the steps of:
-
initializing variables used to calibrate a heading;
retrieving sensor readings from at least two axis;
updating calibration and azimuth values with said sensor readings;
calculating an offset value for each axis, said offsets are calculated with each new valid sensor reading for the current cycle as a function of the maximum and minimum values of the axis in the cycle;
adjusting each axis value with said axis offset value for each axis, respectively;
determining if said heading needs updating; and
determining if display needs said updated heading transferred thereto. - View Dependent Claims (7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18)
testing said sensor readings to validate as true sensor readings;
determining if an X-axis reading is a maximum value for a current calibration cycle of the compass;
determining if said X-axis reading is a minimum value for a current calibration cycle of the compass;
determining if a Y-axis reading is a maximum value for a current calibration cycle of the compass;
determining if said Y-axis reading is a minimum value for a current calibration cycle of the compass;
determining if said X-axis maximum value minus said X-axis minimum is greater than a predetermined minimum spread; and
determining if said Y-axis maximum minus said Y-axis minimum is greater than a predetermined minimum spread.
-
-
10. The autocalibration method of claim 6 further including thc steps of:
-
calculating a rough azimuth value from said adjusted sensor readings; and
determining a second heading from said rough azimuth value.
-
-
11. The autocalibration method of claim 10 further including the steps of:
-
determining with said second heading if eight consecutive cardinal headings have been sensed;
comparing a filtered set of axis calibration values to said set of current calibration cycle'"'"'s axis values;
updating a calibration counter based on said comparing of said axis values; and
updating said calibration axis values with said calibration counter.
-
-
12. The autocalibration method of claim 10 wherein said rough azimuth is calculated with every new said offset and without any influence of past readings other than the current cycle.
-
13. The autocalibration method of claim 6 wherein offset values have the form
-
14. The autocalibration method of claim 6 further including the steps of:
-
calculating current calibration values;
adjusting an X-axis sensor reading by current X-offset and X-scale values; and
adjusting a Y-axis sensor reading by current Y-offset and Y-scale values.
-
-
15. The autocalibration method of claim 14 wherein said x-scale values and said Y-scale values having a form max−
- min.
-
16. The autocalibration method of claim 14 wherein said x-offset and said Y-offset having a form
-
17. The autocalibration method of claim 14
further including the steps of: -
calculating a raw azimuth value from said adjusted sensor readings;
adjusting said raw azimuth value by a predetermined declination angle; and
calculating a filtered azimuth value by filtering with said raw azimuth value.
-
-
18. The autocalibration method of claim 17 wherein said filtered azimuth value has thc form filtered azimuth+(filtered azimuth−
- raw azimuth)/K, said filtered azimuth value having a predetermined initial value.
Specification