SYSTEM AND METHOD OF DETERMINING AN UNAMBIGUOUS HEADING DIRECTION OF A VEHICLE
First Claim
1. A method of determining an unambiguous heading direction of a vehicle, the method including:
- determining a heading alignment error being the difference between a Global Navigation Satellite System (GNSS) direction of motion of the vehicle and an unresolved Inertial Measurement Unit (IMU) heading of the vehicle;
adjusting the heading alignment error by 180 degrees to be within a predetermined range if the error is outside the predetermined range;
adjusting the unresolved IMU heading of the vehicle using the heading alignment error;
determining whether the unresolved IMU heading, after heading alignment error adjustment, is substantially in the true direction of the nose of the vehicle or substantially opposite to the true direction of the nose of the vehicle; and
calculating an unambiguous heading direction by offsetting the unresolved IMU heading, after heading alignment error adjustment, by 180 degrees if the unresolved IMU heading is substantially opposite to the true direction of the nose of the vehicle.
2 Assignments
0 Petitions
Accused Products
Abstract
An unambiguous heading direction is calculated to determine the forward/reverse state of a vehicle. A heading alignment error is determined at step 100, being the difference between a GNSS direction of motion and the unresolved IMU heading of the vehicle. The heading alignment error is adjusted by 180° to be within a predetermined range at step 200. The unresolved IMU heading of the vehicle 10 is adjusted using the heading alignment error to determine an ambiguous error corrected IMU heading at step 300. Step 400 determines whether the ambiguous error corrected IMU heading is substantially in the true direction of the nose of the vehicle. The unambiguous heading direction is calculated at step 500 by offsetting the ambiguous error corrected IMU heading by 180 degrees if the ambiguous error corrected IMU heading is substantially opposite the true direction of the nose the vehicle of the vehicle. The forward/reverse state is determined by comparing the unambiguous heading direction with the GNSS direction of motion of the vehicle.
-
Citations
17 Claims
-
1. A method of determining an unambiguous heading direction of a vehicle, the method including:
-
determining a heading alignment error being the difference between a Global Navigation Satellite System (GNSS) direction of motion of the vehicle and an unresolved Inertial Measurement Unit (IMU) heading of the vehicle; adjusting the heading alignment error by 180 degrees to be within a predetermined range if the error is outside the predetermined range; adjusting the unresolved IMU heading of the vehicle using the heading alignment error; determining whether the unresolved IMU heading, after heading alignment error adjustment, is substantially in the true direction of the nose of the vehicle or substantially opposite to the true direction of the nose of the vehicle; and calculating an unambiguous heading direction by offsetting the unresolved IMU heading, after heading alignment error adjustment, by 180 degrees if the unresolved IMU heading is substantially opposite to the true direction of the nose of the vehicle. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A method of determining if a vehicle is travelling forward or in reverse, the method including:
-
receiving a Global Navigation Satellite System (GNSS) direction of motion for the vehicle from a GNSS unit of the vehicle; receiving an unresolved Inertial Measurement Unit (IMU) heading of the vehicle from an IMU of the vehicle; determining a heading alignment error being the difference between the GNSS direction of motion and the unresolved IMU heading; adjusting the heading alignment error by 180 degrees to be within a predetermined range if the heading alignment error is outside the predetermined range; calculating an ambiguous error corrected IMU heading using the heading alignment error; determining whether the ambiguous error corrected IMU heading is substantially in the true direction of the nose of the vehicle or substantially opposite to the true direction of the nose of the vehicle; calculating an unambiguous heading direction being either; the ambiguous error corrected IMU heading;
orthe ambiguous error corrected IMU heading offset by 180 degrees, if the ambiguous error corrected IMU heading was determined to be substantially opposite to the true direction of the nose of the vehicle; and comparing the unambiguous heading direction with the GNSS direction of motion of the vehicle, thereby to determine if the vehicle is travelling forward or in reverse. - View Dependent Claims (9, 10, 11)
-
-
12. A method of clamping a heading alignment error, the method including:
-
determining a heading alignment error being the difference between a GNSS direction of motion of the vehicle and an unresolved IMU heading of the vehicle; adjusting the heading alignment error by 180 degrees to be within a predetermined range if the heading alignment error is outside the predetermined range. - View Dependent Claims (13)
-
-
14. A system for use in determining an unambiguous heading direction of a vehicle, the system including:
-
a GNSS unit mounted to the vehicle, the GNSS unit operable to calculate the direction of motion of the vehicle; an IMU unit mounted to the vehicle, the IMU unit operable to calculate an unresolved IMU heading of the vehicle; a processing module including a processor programmed to; determine a heading alignment error being the difference between the GNSS direction of motion and the unresolved IMU heading; adjust the heading alignment error by 180 degrees to be within a predetermined range if the error is outside the predetermined range; adjust the unresolved IMU heading using the heading alignment error, determining whether the unresolved IMU heading is substantially in the true direction of the nose of the vehicle or substantially opposite to the true direction of the nose of the vehicle; calculate an unambiguous heading by offsetting the unresolved IMU heading by 180 degrees if the unresolved IMU heading is substantially opposite to the true direction of the nose of the vehicle. - View Dependent Claims (15, 16, 17)
-
Specification