Strapdown inertial navigation system using high order
First Claim
Patent Images
1. Apparatus for converting signals from vehicle-referenced coordinates into stabilized navigation coordinates, comprising:
- angle measuring means for producing first angle signals, sampled at a first sampling frequency, in a first set of movable coordinates;
attitude integration means, connected to receive said first sampled angle signals and to transform them into second sampled angle signals in a second set of stabilized navigation coordinates;
accelerometer means for producing first acceleration signals, sampled at said first frequency, that are measures of changes in velocity in said first set of coordinates;
sculling correction means of order higher than the first, receiving said first acceleration signals and creating incremental velocity correction signals;
means for subtracting said incremental velocity correction signals from said first acceleration signals to produce first compensated incremental velocity signals that are measures of changes in velocity, corrected for sculling errors, in said first set of coordinates; and
coordinate transformation means, connected to receive said second sampled angle signals and said compensated incremental velocity signals for transforming said compensated incremental velocity signals into second incremental velocity signals that are measures of changes in velocity, corrected for sculling errors, in said second set of coordinates.
2 Assignments
0 Petitions
Accused Products
Abstract
Sculling error correction means, using third or higher order correction to correct for sculling errors in apparatus for converting angle measuring and acceleration measuring signals from a vehicle set of coordinates into a stabilized set of navigation coordinates.
-
Citations
6 Claims
-
1. Apparatus for converting signals from vehicle-referenced coordinates into stabilized navigation coordinates, comprising:
-
angle measuring means for producing first angle signals, sampled at a first sampling frequency, in a first set of movable coordinates; attitude integration means, connected to receive said first sampled angle signals and to transform them into second sampled angle signals in a second set of stabilized navigation coordinates; accelerometer means for producing first acceleration signals, sampled at said first frequency, that are measures of changes in velocity in said first set of coordinates; sculling correction means of order higher than the first, receiving said first acceleration signals and creating incremental velocity correction signals; means for subtracting said incremental velocity correction signals from said first acceleration signals to produce first compensated incremental velocity signals that are measures of changes in velocity, corrected for sculling errors, in said first set of coordinates; and coordinate transformation means, connected to receive said second sampled angle signals and said compensated incremental velocity signals for transforming said compensated incremental velocity signals into second incremental velocity signals that are measures of changes in velocity, corrected for sculling errors, in said second set of coordinates. - View Dependent Claims (2, 3)
- 3. Apparatus as recited in claim 1 in which said sculling correction means is of the (2j+1)th order, and in which the (2j+1)th order compensated incremental velocity signals are
- space="preserve" listing-type="equation">Δ
V.sub.nc =Δ
V.sub.n -K.sub.1 C.sub.1 (n)-K.sub.2 C.sub.2 (n) . . . -K.sub.j C.sub.j (n)- . . . ,
where
space="preserve" listing-type="equation">C.sub.1 (n)=Δ
V.sub.(n+.spsb.1.sub.) -2Δ
V.sub.n +Δ
V.sub.(n-.spsb.1.sub.),
space="preserve" listing-type="equation">C.sub.2 (n)=C.sub.1 (n+1)-2C.sub.1 (n)+C.sub.1 (n-1),and
space="preserve" listing-type="equation">C.sub.j (n)=C.sub.(j-1) (n+1)-2C.sub.(j-1) (n)+C.sub.(j-1) (n-1),and where K is chosen to cancel the 2j term of Δ
Vnc. - space="preserve" listing-type="equation">Δ
-
-
4. Apparatus for converting signals from vehicle-referenced coordinates into stabilized navigation coordinates, comprising:
-
angle measuring means for producing first angle signals, sampled at a first sampling frequency, in a first set of movable coordinates; attitude integration means, connected to receive said first sampled angle signals and to transform them, at a second lower frequency, into second sampled angle signals in a second set of stabilized navigation coordinates; accelerometer means for producing first acceleration signals, sampled at said first frequency, that are measures of changes in velocity in said first set of coordinates; sculling correction means of order higher than the first, receiving said first acceleration signals and creating first incremental velocity correction signals; means for subtracting said first incremental velocity signals from said first acceleration signals to produce first compensated incremental velocity signals that are measures of changes in velocity in said first set of coordinates; combiner means for combining a number of consecutive samples of said sampled angle signals to produce a modified angle change signal, said number being equal to the ratio of said first sampling frequency to said second sampling frequency; sculling cross product apparatus, connected to create cross product signals which are the cross product of said first compensated incremental velocity signals and said modified angle change signal; first and second accumulator means to accumulate, respectively, said cross product signals and said first compensated incremental velocity signals to said lower second frequency; means for subtracting said accumulated cross product signals from said first accumulated compensated incremental velocity signals to produce second compensated incremental velocity signals; and coordinate transformation means, connected to receive said second sampled angle signals and said second compensated incremental velocity signals for transforming said second compensated incremental velocity signals into third compensated incremental velocity signals that are measures of changes in velocity, corrected for sculling errors, in said second set of coordinates. - View Dependent Claims (5, 6)
- 6. Apparatus as recited in claim 4 in which said sculling correction means is of the (2j+1)th order, and in which the (2j+1)th order compensated incremental velocity signals are
- space="preserve" listing-type="equation">Δ
V.sub.nc =Δ
V.sub.n -K.sub.1 C.sub.1 (n)-K.sub.2 C.sub.2 (n) . . . -K.sub.j C.sub.j (n)- . . . ,
where
space="preserve" listing-type="equation">C.sub.1 (n)=Δ
V.sub.(n+.spsb.1.sub.) -2Δ
V.sub.n +Δ
V.sub.(n-.spsb.1.sub.),
space="preserve" listing-type="equation">C.sub.2 (n)=C.sub.1 (n+1)-2C.sub.1 (n)+C.sub.1 (n-1),and
space="preserve" listing-type="equation">C.sub.j (n)=C.sub.(j-1) (n+1)-2C.sub.(j-1) (n)+C.sub.(j-1) (n-1),and where K is chosen to cancel the 2j term of Δ
Vnc. - space="preserve" listing-type="equation">Δ
-
Specification