Heading determination using sensors mounted on rotatable assembly
First Claim
1. A computer-implemented method for estimating heading of a vehicle, comprising:
- receiving first angular rate measurements from a plurality of rate sensors mounted on a rotatable assembly at a first time, the rotatable assembly rotated to a first rotation angle and the vehicle having first heading at the first time;
receiving second angular rate measurements from the plurality of rate sensors at a second time subsequent to the first time, the rotatable assembly rotated to a second rotation angle, the vehicle having second heading that is substantially the same as the first heading at the second time;
computing the first heading relative to a reference vector representing rotation of the Earth based on the first angular rate measurements and the second angular rate measurements; and
computing a third heading of the vehicle at a third time subsequent to the second time based on the first heading responsive to receiving third angular rate measurements from the plurality of rate sensors;
wherein computing the first heading comprises;
projecting the first and second rate measurements to a tangent plane of the Earth to obtain tangent plane data;
fitting the tangent plane data to a conic;
constraining the conic to a circle to obtain a circle transform;
projecting the tangent plane data through the circle transform to obtain transformed data;
fitting the transformed data to a polynomial in the tangent plane;
computing tangent plane angles of the vehicle with respect to a reference direction; and
detecting zero-crossing of the tangent plane angles by interpolating a rotation angle of the rotatable assembly to obtain the first heading.
3 Assignments
0 Petitions
Accused Products
Abstract
A system and method for more accurately and robustly determining the heading of a vehicle by taking measurements of angle rates using rate sensors mounted on a movable mechanical assembly. In a quasi-static state of the vehicle, the mechanical assembly is rotated around axes perpendicular to the tangent plane of the Earth, and angle rates are measured by the rate sensors at different rotational angles of the mechanical assembly. The measurements of the angle rates are then computed to determine the initial heading of the vehicle relative to the true north of the Earth in the quasi-static state of the vehicle. After determining the initial heading, navigation state propagation is performed to determine the heading of the vehicle in non-quasi-static state of the vehicle. By taking measurements of the rate sensors at different rotation angles and performing computation, the heading of the vehicle relative to the Earth'"'"'s true north can be determined using less accurate angle sensors.
81 Citations
17 Claims
-
1. A computer-implemented method for estimating heading of a vehicle, comprising:
-
receiving first angular rate measurements from a plurality of rate sensors mounted on a rotatable assembly at a first time, the rotatable assembly rotated to a first rotation angle and the vehicle having first heading at the first time; receiving second angular rate measurements from the plurality of rate sensors at a second time subsequent to the first time, the rotatable assembly rotated to a second rotation angle, the vehicle having second heading that is substantially the same as the first heading at the second time; computing the first heading relative to a reference vector representing rotation of the Earth based on the first angular rate measurements and the second angular rate measurements; and computing a third heading of the vehicle at a third time subsequent to the second time based on the first heading responsive to receiving third angular rate measurements from the plurality of rate sensors; wherein computing the first heading comprises; projecting the first and second rate measurements to a tangent plane of the Earth to obtain tangent plane data; fitting the tangent plane data to a conic; constraining the conic to a circle to obtain a circle transform; projecting the tangent plane data through the circle transform to obtain transformed data; fitting the transformed data to a polynomial in the tangent plane; computing tangent plane angles of the vehicle with respect to a reference direction; and detecting zero-crossing of the tangent plane angles by interpolating a rotation angle of the rotatable assembly to obtain the first heading. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A navigation system for estimating heading of a vehicle, comprising:
-
an initial static heading determination module configured to; receive first angular rate measurements from a plurality of rate sensors mounted on a rotatable assembly at a first time, the rotatable assembly rotated to a first rotation angle and the vehicle having first heading at the first time; receive second angular rate measurements from the plurality of rate sensors at a second time subsequent to the first time, the rotatable assembly rotated to a second rotation angle and the vehicle having second heading that is substantially the same as the first heading at the second time; and compute the first heading relative to a reference vector representing rotation of the Earth based on the first angular rate measurements and the second angular rate measurements; and a dynamic heading tracking module configured to compute third heading of the vehicle at a third time subsequent to the second time based on the first heading responsive to receiving third angular rate measurements from the plurality of rate sensors; wherein the initial static heading determination module is configured to compute the first heading by; projecting the first and second rate measurements to a tangent plane of the Earth to obtain tangent plane data; fitting the tangent plane data to a conic; constraining the conic to a circle to obtain a circle transform; projecting the tangent plane data through the circle transform to obtain transformed data; fitting the transformed data to a polynomial in the tangent plane; computing tangent plane angles of the vehicle with respect to a reference direction; and detecting zero-crossing of the tangent plane angles by interpolating a rotation angle of the rotatable assembly to obtain the first heading. - View Dependent Claims (9, 10, 11, 12, 13, 14)
-
-
15. A computer readable storage medium storing instructions thereon, the instructions when executed by a processor in a navigation system for determining heading of a vehicle cause the processor to:
-
receive first angular rate measurements from a plurality of rate sensors mounted on a rotatable assembly at a first time, the rotatable assembly rotated to a first rotation angle and the vehicle having first heading at the first time; receive second angular rate measurements from the plurality of rate sensors at a second time subsequent to the first time, the rotatable assembly rotated to a second rotation angle and the vehicle having second heading that is substantially the same as the first heading at the second time; compute the first heading relative to a reference vector representing rotation of the Earth based on the first angular rate measurements and the second angular rate measurements; and compute third heading of the vehicle at a third time subsequent to the second time based on the first heading responsive to receiving third angular rate measurements from the plurality of rate sensors; and further comprising instructions that cause the processor to; project the first and second rate measurements to a tangent plane of the Earth to obtain tangent plane data; fitting the tangent plane data to a conic; constraining the conic to a circle to obtain a circle transform; projecting the tangent plane data through the circle transform to obtain transformed data; fitting the transformed data to a polynomial in the tangent plane; computing tangent plane angles of the vehicle with respect to a reference direction; and detecting zero-crossing of the tangent plane angles by interpolating a rotation angle of the rotatable assembly to obtain the first heading. - View Dependent Claims (16, 17)
-
Specification