The present invention deals generally with measurements of the roll rate and roll angle of spinning platforms, including spinning projectiles, spin stabilized spacecraft, and other such vehicles, using a single receiver antenna for receiving signals transmitted by the satellites of the Global Positioning System (GPS).
In the context of the invention herein, the terms “roll” and “spin” are used interchangeably and understood to mean the platform's rotation about its “roll” or “spin” axis at angular rates that exceed the zero roll rate and may be large. The words “platform,” “vehicle,” and “projectile” too are used interchangeably in this specification and must be interpreted as inclusive, so that the mention of one also means the mention of the others and similar like terms. The term GPS also is to be construed broadly, and includes not only GPS but all Global Navigation Satellite Systems (GNSS) using CDMA (Code Division Multiple Access) technology.
The focus on roll results from the fact that many projectiles aimed at a distant target do not require a full attitude reference system. If the projectile is stable under all flight conditions encountered, it may not require any stability augmentation about its two cross axes, pitch and yaw. Every guided platform, however, requires a measurement of its roll angle or roll rate, since this information helps relate the guidance commands, which are executed in the platform's body coordinates, to its location in space, which is identified in geographic coordinates.
The requirement for roll information on a guided projectile differs with the projectile configuration and its guidance concept. A fully controlled projectile is one that can correct its trajectory in both the downrange and cross-range directions. To do so, it must be able to generate lift in both the upward and lateral directions. This requires knowledge of which way is up and which way, for example, is to the right. The guidance corrections are relatively insensitive to the vehicle's elevation and azimuth Euler angles, but very sensitive to its roll angle. Reasonably accurate roll angle information is required. Since the command to lift the spinning projectile in a particular geographic direction is transformed into the projectile's body coordinates for execution by its control actuators, such as aerodynamic fins, this means that a fully controlled projectile—or at least that section of it that houses the control system—cannot be spinning faster than the bandwidth of its actuators. Other methods of making downrange corrections to the platform's trajectory include adjusting the drag on the projectile.
Limited corrections of cross-range may be achieved by adjusting the projectile spin rate, which leverages the spinning projectile's natural tendency to drift in the lateral direction. This configuration requires a relatively high spin rate, typical of gun-launched projectiles. But these corrections do not require roll angle information only roll rate is needed. So the usual roll information requirement of the roll estimation system is either for roll angle (at relatively low spin rate) or for roll rate (at relatively high spin rate).
Traditional methods of measuring roll rate and roll angle are expensive, and can generally be justified only for very high value platforms. Inertial rate indicators, including MEMS (MEMS=Micro Electro Mechanical Systems) gyroscopes, are relatively expensive on this scale of costs. More importantly, they require calibration prior to use, which adds to the operational cost. Magnetometers, likewise, are expensive, besides also being susceptible to interferences from local magnetic fields, such as from on-board electromagnetic actuators and other components.
For cost-effectiveness, GPS-based measurements are preferred for determining roll and attitude of rotating platforms. GPS carrier phase and signal strength measurements are the two main techniques used for attitude determination.
Prior art roll measurement techniques have largely employed phase differencing of GPS signals received at a plurality of receiver antennas mounted on the spinning platform. The different phases of the signals at the different antennas arise from the different distances of those antennas from the signal source, i.e. the satellite. Most of the prior art baselines (i.e. the distances separating the individual antennas from each other), however, have typically been long compared to the GPS signal wavelength. This has required keeping accurate count of the number of integer wavelengths in each of the received signal paths (in addition to the fractional wavelength determinations) for calculating the true path lengths (and hence phases) of the signals reaching the respective antennas. In the commonly owned U.S. Pat. No. 7,994,971, Vander Velde et al have disclosed a system and method for measurement of roll rate and roll angle that dispenses with this requirement by using a plurality of receiver antennas with baselines shorter than the GPS signal wavelength. Separately, in another co-pending and commonly owned U.S. patent application Ser. No. 12/454,306, Vander Velde et al have disclosed a system and method to measure roll rate and roll angle by such plurality of receiver antennas in the presence of interfering signals.
Roll determination using a single receiver antenna has the potential for even greater simplicity and cost effectiveness. For example, U.S. Pat. No. 6,520,448 B1 2/2003 issued to Doty et al discloses a single antenna based method and apparatus for roll measurement using amplitude and phase detection of the received GPS signals. When the platform rotates, the GPS signal received at the single antenna shows time varying characteristics, which provides information for roll determination. The power or carrier phase of the signal received at the single antenna from the GPS satellite shows a modulation over the antenna's spin cycle, whose period is a measure, of the vehicle spin rate. The power of the received signal is maximum at the roll angle which orients the antenna boresight nearest to the Line of Sight (LOS) to the satellite. Since the direction to the satellite is known in Earth-fixed coordinates, this determines the roll angle of the platform. Modulation tracking, as used in Doty et al, however, is very sensitive to noise, and small amplitude and/or phase measurement fluctuations cause large variations in the measured roll angle and roll rate values. Another limitation of tracking amplitude or phase modulation, as in Doty et al, is that the tracking loop bandwidth is difficult to tune for an accurate roll estimate over a large variation of roll rate (e.g., up to 300 Hz or more for fast spinning projectiles).
To operate over large ranges of roll rate and its time derivatives, U.S. Patent Application Pub. No. 2010/0052981 of Alexander et al uses a fourth (4th) order Phase Lock Loop (PLL) in the power (i.e. amplitude) modulation tracking filter. The PLL locks on to the phase of the amplitude modulation resulting from the projectile's spin. A roll compensator is used to compensate the PLL output for roll angle-dependent changes in antenna pattern gain and phase, which can lead to phase mismatch between the actual antenna pattern phase and its PLL estimate. A Kalman filter is used to smooth the un-modeled errors in the estimates of the “up” direction for each satellite tracked by the single antenna. These extensive signal processing methods for addressing model mismatch and un-modeled errors are required because the approach disclosed by Alexander et al is non-optimal.
An easily implemented and cost-effective optimal solution of low complexity is desired for accurately determining in real time the roll rate and roll angle of low cost spinning projectiles, with several spinning at rates of up to 300 Hz or more. For projectile roll rate and roll angle measurements using multiple receiver antennas, such solutions based on phase and/or amplitude differencing were disclosed recently in the commonly owned U.S. Pat. No. 7,994,971 and U.S. patent application Ser. No. 12/454,306 (published as US 2010-0289687). The present invention builds upon these earlier developments, while using the output of a single antenna in a manner that avoids the limitations of the prior art and provides an accurate real time measurement of the projectile's roll rate and roll angle at projectile spin rates of up to 300 Hz, and likely higher.
An important property of the system and method employing the roll filter based roll processor described herein is that it needs to track only one satellite for providing the roll rate and roll angle information. However, the present invention is able to accept amplitude and/or phase measurements from additional satellites, if available, for improved accuracy.
Although the instant roll processing methodology can function using only a single satellite, the roll information is usually used in conjunction with the vehicle's navigation (position and velocity) information in order to execute a task, such as guiding the vehicle to a target. Where such position and velocity are to be provided by a GPS receiver, a minimum of four satellites must be tracked for that purpose.
One embodiment of the present invention nominally uses standard GPS receiver hardware and special purpose processing of the received GPS signals to measure the roll rate and roll angle of a spinning vehicle. The customary non-GPS attitude measurement sources, such as inertial instruments (gyroscopes and accelerometers) and magnetometers, are optionally provided within this approach to improve upon the navigation and roll solutions obtained purely through the processing and analysis of only the GPS signal data. The several aspects of the present invention allow its applicability to a wide range of rotating platforms, while also offering a cost-effective single receiver antenna solution for accurately measuring the roll rate and roll angle of small projectiles spinning at high roll rates.
The solution for roll angle requires knowledge of the platform's position and velocity, which in one embodiment are provided by the usual function of a GPS receiver. Use of a single antenna at the receiver is sufficient for this purpose provided that it can “see” the satellites often enough to keep the platform's frequency and delay tracking loops functioning. This requirement is met with typical antenna placement on projectiles spinning at roll rates greater than about 10 Hz. At low spin rates, a failure to indicate roll angle with a single antenna may not be due to the failure of the roll indicating methodology, but a failure of the normal GPS receiver function necessary to support its determination.
The present roll rate and roll angle indication system offers the flexibility of processing the received signal amplitude or signal phase individually, or together, to derive the roll information. The received signal strength (i.e. signal amplitude) is modulated over the spin cycle due to spatial variations in the antenna's reception pattern. The phase of this reception pattern also shows variations with antenna, and hence vehicle, orientation. At the price of additional computational burden, one can use phase as well as amplitude information for improved accuracy.
The present invention offers distinct advantages compared to the prior art for accurately determining roll rate and roll angle using the GPS signals received at a single antenna mounted on the spinning projectile. For instance, U.S. Pat. No. 6,520,448 uses the standard logic of advanced and delayed measurements to track the maximum of the received signal over the roll cycle with no reference to the roll dynamics. The present invention, instead, uses the dynamic state model of the Extended Kalman Filter (EKF) in one embodiment to closely represent the dynamic behavior of roll motion in a given application. This dynamic model is linear, and under the assumption of linear measurements, which is true for small excursions of the measurements around the true values, this is the optimal estimator for the filter's state variables, which include roll rate and roll angle.
Whether configured for signal amplitude processing or phase processing, or both, the measurements that drive the EKF are the I and Q power measurements derived directly from the correlators with no intermediate (i.e. post correlation) processing. In contrast, the prior art uses measurements that have been additionally processed after correlation. The requirement for compensating the measurements for antenna reception pattern variations with orientation is thus integrated into the formulation of the EKF. This provides a logical basis for recognizing not only the relation between the antenna characteristics and roll attitude but also the relation between their required first derivatives.
Because of the physically realistic modeling of the relationship between roll angle and its derivatives, the EKF estimator provides accurate roll angle and roll rate measurements over a wide range of roll rate. Simulations and experimental results, obtained for single antenna amplitude measurements over the roll rate range of 20 Hz to 300 Hz, confirm that the quality of roll rate and roll angle determination is minimally affected, if that, by the actual value of the roll rate. The high end of this roll rate dynamic range is set primarily by the sampling rate of I and Q correlator output power data, while the low end is set by the limitation of the GPS receiver to produce useful I and Q power measurements due to degraded visibility of the satellites.
For robust roll estimation, proper fusion of the data obtained using the single antenna from all of the tracked satellites is important. While, Doty et al (U.S. Pat. No. 6,520,448) do not disclose any means for combining the data from multiple satellites, Alexander et al (U.S. Patent Application Pub. No. 2010/0052981 A1) disclose a sub-optimal weighted average approach that weighs each satellite's roll angle estimate based on the signal-to-noise ratio for the data from each such satellite.
In contrast, one embodiment of the present invention uses the Probabilistic Data Association (PDA) method, which provides the optimal solution under the condition that the measurement residuals from the EKF comprise Gaussian noise. See, e.g., Y. Bar-shalom, T. Kirubarajan, X. Lin, “Probabilistic Data Association Techniques for Target Tracking with Applications to Sonar, Radar and EO Sensors,” IEEE Aerospace and Electronics Systems Magazine, Vol. 20, No. 8, pp. 37-56, 2003.
The PDA filter (PDAF), i.e. EKF enhanced by the PDA, intelligently screens the measurements to remove any outliers, which may be due to poor satellite visibility or some other cause. In addition, the PDAF assigns individual weights to the roll estimates derived from each satellite based on the posterior error probability distribution, which is continuously updated for the mean value and the covariance matrix by the PDAF. (For posterior error probability distribution, See e.g., Andrew Gelman et al., Bayesian Data Analysis, Second Edition, Chapman & Hall/CRC Texts in Statistical Science, 2003). The better the history of roll estimation, the higher are the assigned weights. Any measurement that does not appear to be a true sample from the current distribution of estimate errors is incorporated by the PDAF with a low weighting. In this way, the PDAF approach successfully handles satellite signal fluctuations.
Where the signal from only one satellite is used for roll processing, the PDA logic assigns a weight to be used in updating the state of the Roll filter with the estimate derived from that satellite signal. Since, in any case, the set of weights used at any update point is normalized, the PDAF automatically reduces to the standard EKF in the case of a single satellite signal.
The seamless integration of EKF and PDA (i.e. as a PDAF) in one embodiment of the present invention makes roll estimation more robust to noise, more computationally efficient, and more accurate than the prior art methodologies. One embodiment of the present invention based on using amplitude information has been experimentally demonstrated to have an accuracy of better than ±0.2 Hz for roll rates up to 95 Hz. For a roll rate of 300 Hz, simulation based on amplitude projects an one-sigma Root Mean Square (RMS) error of 0.02 Hz, which is improved to <0.01 Hz when both amplitude and phase are used. Similar improvements at 300 Hz are noted for roll angle, which shows an one-sigma RMS error of 1.8 degrees using amplitude and <1 degree using both amplitude and phase.
The present invention provides a low cost means of measuring the roll rate and roll angle of spinning platforms with a single GPS receiver antenna. The GPS antenna is typically installed on the platform in the usual manner, and its output signal is processed through the usual RF front end of a GPS receiver. The signal received from the RF front end consists of thermal noise and GPS signals received from one or more tracked satellites.
The GPS signal from the antenna channel serves two purposes. One permits the standard function of a GPS receiver, i.e. to track the frequency or phase of the carrier and the phase of the transmitted code for indications of pseudorange and Doppler. Similar measurements from multiple satellites help determine the instantaneous position and velocity of the vehicle.
The other purpose for which the channel signal is used is indicating the amplitude and/or phase of the GPS signals received from each of the tracked satellites. This second function enables the measurement of platform roll rate and roll angle in a roll processor. The received signal strength and phase are modulated over the projectile's spin cycle due to the characteristics of the antenna reception pattern and the fact that the satellite is seen at different directions relative to the antenna as the vehicle spins. Each satellite signal is identified in a separate correlator of the roll processor, where each such correlator is slaved to the correlator in the navigation channel.
An object of the present invention is to provide a GPS signal based measurement of the roll rate and roll angle of a platform with a single GPS receiver antenna, using a single GPS receiver augmented with special purpose signal processing.
A second object of the present invention is to provide GPS signal based measurements of the roll rate and roll angle of a platform rotating at high rates with a single GPS receiver antenna.
Another object of the present invention is to provide a GPS measurement of the roll rate and roll angle of a platform using a single GPS receiver antenna without the aid of inertial instruments.
Still another object of the present invention is to provide a GPS signal based measurement of the roll rate and roll angle of a platform without directly tracking the amplitude or phase modulation and instead using a roll filter, such as an Extended Kalman Filter (EKF), which includes a model of the vehicle's roll dynamics. The term “Extended Kalman Filter” is commonly understood to mean a dynamic filter of Kalman form, which is a linear operator, extended to apply to a nonlinear problem. In the present context, the linear form of the Kalman filter is extended to accept correlator output power and phase measurements that are nonlinearly related to the platform roll angle.
Another object of the present invention is to provide a rational and effective method of combining the information on roll rate and/or roll angle derived from tracking multiple satellites. For this purpose, one embodiment of the disclosed system employs a statistically derived weighting of the estimates, which provides the optimal solution in the limit of small errors.
Yet another object of the present invention is to provide a GPS signal based measurement of the roll rate and/or roll angle of a platform with the roll rate and roll angle estimator formulated as an EKF, having as inputs the measured I and Q power and/or phase of the GPS satellite signals received at a single GPS receiver antenna.
A further object of one embodiment of the present invention is to provide a GPS signal based measurement of the roll rate and/or roll angle of a platform that allows for the introduction of navigation or attitude data from a non-GPS measurement source, such as from an inertial sensor, magnetometer, star tracker, sun sensor, or earth sensor, for improved performance.
The preceding objects of the invention appear, without limitation, as alternatives, where no particular object needs to be partly or entirely satisfied. However, at least one of these objects is met, in whole or in part, by the present invention whose one embodiment is described using the drawings herein. The drawings are primarily for illustration and must not be construed as limiting. Other embodiments apparent to those of skill in the art are within its scope. The scope of the invention is to be limited only by the claims, and not by the drawings or description herein.
The objects, features, and advantages of the present invention are more fully understood when considered in conjunction with the following accompanying drawings:
One embodiment of the single antenna GPS signal processing architecture 200 of the present invention is shown in
Also not shown in
While the instant invention can measure roll rate and/or roll angle using signals from only one satellite, the determination of the projectile's position and velocity 280 requires the standard GPS receiver signal processing of signals from four satellites, as is well known in the art. Consequently, while for the roll determination function the single antenna signals 261 can comprise signals from one or more satellites, for the GPS receiver function, the single antenna signals 261 comprise signals from preferably four or more satellites.
As shown in
The GPS signal 261 from each tracked satellite is input to the GPS receiver correlator 270. The usual navigation operations then follow, including code correlation 270, acquisition as well as frequency and code tracking 272, and filtering 274 of the pseudorange and Doppler measurements to produce the navigation solution 280 describing the projectile's position and velocity. For optionally updating the GPS navigation solution 280, the filter 274 may be aided using navigation data 276, if available, from a non-GPS measurement source, such as an inertial measurement unit (IMU), magnetometer, altimeter, or a reference vehicle trajectory computed from the known parameters of the projectile aerodynamics and atmospheric data.
As discussed above, the roll measurement function is implemented in the upper track 210, which is labeled in its entirety as the “Roll Processor.” The GPS signal 261 is input to correlator 222, with the correlator 222 carrier and code driven synchronously by the GPS receiver 250 at the same frequency that is tracked by the receiver channel in its tracking filter 272 or navigation filter 274 and used to drive its correlator 270. Just as non-GPS measurement data, if available, can be used optionally in the navigation filter 274, so too can non-GPS measurement data sensitive to attitude be used optionally in the Roll filter 290.
If the single antenna reception gain pattern, e.g. 310, is symmetric about the antenna's boresight line 315, a satellite signal arriving along the direction of the boresight line 315 will be received on the antenna with maximum amplitude (because it has the maximum gain). If the projectile roll angle is varied within some range about that reference value, the amplitude of the signal for this satellite will decrease based on the relative angle between the antenna LOS to the satellite and the antenna boresight line. The detected signal amplitude will be minimum when the LOS to the satellite is 180 degrees opposed to the direction in which the antenna is pointing. The amplitude (m) variations with projectile roll for each tracked satellite will be as shown in
Table 1 displays one embodiment of the discrete time Extended Kalman (Roll) Filter formulation for determining the roll rate and roll angle of a spinning platform using the measured I and Q amplitudes 244 of the received GPS signals 261. This table shows amplitude only processing for roll estimation. If amplitude as well as phase processing is used, the measurement vector {tilde over (m)} in Table 1 is augmented with the measured carrier phase angles. The Roll Filter 290 operates by cycling between Time Propagation and Measurement Update steps. The filter state vector x contains the roll angle φR (in cycles), roll rate {dot over (φ)}R (in Hz), and roll acceleration {umlaut over (φ)}R (in Hz/s) as state variables.
In this third order model, the derivative of roll acceleration is modeled as a continuous-time zero mean white noise:
{dot over ({umlaut over (φ)}R={tilde over (v)}(t)
Since the derivative of the acceleration is jerk, the instant model can be described as the white noise jerk model. The state vector for this third-order model is
x=[φ
R{dot over (φ)}R{umlaut over (φ)}R]′
Its continuous-time state equation is
{dot over (x)}
(t)=Ax(t)+D{tilde over (v)}(t)
where
The discrete-time state equation with sampling period T is:
x
(k+1)=Φx(k)+v(k)
where
and the discrete-time process noise relates to the continuous time one as:
v(k)=∫0TeA(T−τ)D{tilde over (v)}(kT+τ)dτ
The covariance of the discrete-time process noise v(k), is:
Inclusion of the roll acceleration as a filter state variable enhances the ability to track a changing roll rate. If the vehicle control system issues a command which affects the vehicle's roll rate, the roll acceleration term in the third order EKF assists the Roll filter 290 by recognizing the acceleration and then driving the rate.
The meanings of the parameters in the equations in Table 1 are as follows:
Φ is the state transition matrix relating state vector {circumflex over (x)}k+ at time step k after measurement update to state vector {circumflex over (x)}k+1− at time step k+1 before measurement update;
Nq is the power density of white noise {tilde over (v)}(t). It is used as a design parameter to tune the filter operation to the expected level of roll acceleration activity;
T is the time between filter updates;
{circumflex over (x)}− and P− are the state estimate vector and error covariance matrix resulting from the preceding Time Propagation step, prior to incorporating the present measurement;
{circumflex over (x)}+ and P+ are the state estimate vector and error covariance matrix after incorporating the present measurement, and comprise the initial condition for the next Time Propagation step;
H is the linearized measurement sensitivity matrix (or Jacobian Matrix)
it is a function of x, and is evaluated at {circumflex over (x)}−;
K is the Kalman gain matrix;
R is the measurement noise covariance matrix;
{tilde over (m)} is the vector of actual satellite signal power measurements;
Ai is the amplitude of the signal from satellite i;
m({circumflex over (x)}−) is the predicted measurement function based on the prior estimate of x; and
I is the identity matrix.
K = P−HT (H P−HT + R)−1
P
+ = (I − K H) · P−
R = NR
Table 2 shows the discrete time Extended Kalman Filter scalar measurement formulation, which provides the flexibility of using any number of available measurements. The term “scalar” describes the measurement because in this formulation the satellite signals are processed one at a time. The number of measurements to be processed is equal to the number of satellites used for roll processing. The parameters used in this scalar formulation are as follows:
is the linearized measurement sensitivity vector;
k is the Kalman gain vector; and
r is the measurement noise variance (a scalar).
f = P− · h
P
+ = P− − k · fT
Table 2 is based on a two-dimensional roll filter state (roll angle, roll rate). The three-dimensional filter state (roll angle, roll rate, and roll acceleration) of Table 1 can also have the measurement update step performed as a sequence of scalar updates for each of the satellites in track, if desired.
In the roll determination system, due to the linear state dynamics, the state propagation vector {circumflex over (x)}k+1−=Φ·{circumflex over (x)}k+ is linear. The unit for the roll angle is number of cycles and that for the roll rate is Hz. The unit for jerk is Hz/sec. The state prediction covariance matrix Pk+1− is the same as in the standard Kalman filter.
The measurement prediction m({circumflex over (x)}−) in the Extended Kalman filter (EKF) is much more involved than the state prediction, since the nonlinearity resides in the measurement equation. To obtain the predicted measurement, the nonlinear measurement function is expanded in a Taylor series around the state estimate vector {circumflex over (x)}k+1−. The predicted measurement for the first-order Taylor series is
m
i({circumflex over (x)}−)=hi({circumflex over (x)}−),i=1, . . . ,N
where N is the number of satellites, and
hi({circumflex over (x)}−) is as defined below.
The procedure for incorporating new measurements in the Roll Filter is detailed in the following for amplitude (i.e. signal power) measurements. The process for treating phase measurements is directly analogous. The measurement function hi({circumflex over (x)}−) is defined as
h
i({circumflex over (x)}−)={circumflex over (P)}i,i=1, . . . ,N
where the power {circumflex over (P)}i is computed as
{circumflex over (P)}
i=({circumflex over (Q)}i*{circumflex over (Q)}i+Îi*Îi),i=1, . . . ,N
where and Îi and {circumflex over (Q)}i are the predicted in-phase and quadrature amplitude components of the signals from satellite i.
Based on the first state of the EKF, i.e. roll angle, the predicted and Îi and {circumflex over (Q)}i amplitudes of the received signals are obtained using an antenna pattern look-up table. To minimize the mismatch with actual measurement, the predicted IQ power is calculated using the estimated roll angle predicted ahead over ½ T, which is at the center of the time interval over which the correlator power is accumulated. This prediction is based on the higher order state variables: roll rate and jerk.
The IQ measurement prediction is based on the antenna pattern at the LOS angle, Δ{circumflex over (φ)} in
The look-up table should preferably be two-dimensional (2D), adding the satellite angle off the projectile longitudinal axis. This angle can be used to select different conic cuts of the antenna patterns. A typical 2D lookup table for the projectile antenna would have dimensions of 180×360. The first dimension corresponds to the satellite Azimuth angle off the nose of the vehicle, ranging from −90 to +90 degrees at one degree intervals. The second dimension corresponds to the angle around the projectile axis of the LOS projection on the normal plane, ranging from zero to 360 degrees, also at one degree intervals. The selection of one degree spacing is arbitrary, and other, smaller or larger, intervals could be chosen as appropriate.
If one assumes that the estimated roll angle in degrees is {circumflex over (φ)}R(k+1) at EKF update time step k+1, then the angle of the LOS of the satellite to the antenna is Δ{circumflex over (φ)}(k+1)={circumflex over (φ)}R(k+1)−{circumflex over (φ)}S, where {circumflex over (φ)}S is the angle of the satellite LOS from the zero reference for roll angle, not shown in
For simulation, the roll rate is treated as positive, on the basis that the antenna pattern is symmetric around the boresight line. While actual receivers use very high sampling rates to compute the complex correlation between the received satellite signal code and the locally generated code, far fewer sample points in each update interval are typically used during simulation for computational economy. One example is shown in
For computing the Jacobian H of the IQ measurement function at Δ{circumflex over (φ)}, we use the second order approximation
where Hi(k+1) is the Jacobian for the ith satellite measurement at time step k+1, and we choose ΔR=1 degree.
Similar to the computation of the predicted IQ at Δ{circumflex over (φ)} shown in
where “l” is a set of integers, and if Îid(Δ{circumflex over (φ)}+ΔR−l) is the predicted in-phase amplitude component for the signals from satellite i (reading from antenna pattern) at roll angle Δ{circumflex over (φ)}+ΔR−l. {circumflex over (Q)}id(Δ{circumflex over (φ)}+ΔR−l) is the predicted quadrature amplitude component for the signals from satellite i (reading from antenna pattern) at roll angle Δ{circumflex over (φ)}+ΔR−l. Îia
As before, if Îia
The computations for the predicted IQ for roll angle at Δ{circumflex over (φ)}−ΔR are the same as those for roll angle at Δ{circumflex over (φ)}+ΔR except for the roll angle values at which the antenna pattern look-up table is read.
The expression for the filter gain and the update equation for the state and its covariance matrix are all identical to those of the linear Kalman filter (See, Table 1). At any update time, there are N updates from N satellite measurements.
In the simulations and experiments discussed here, the roll angle estimate was initialized as a uniformly distributed random number in the 0˜1 cycle range. According to the Bayesian model (See, e.g., Thiagalingam Kirubabajan, Yaakov Bar-shalom, “Probabilistic Data Association Techniques for Target Tracking in Clutter,” Proceedings of the IEEE, Vol. 92, No. 3, March 2004), the true initial state is a random variable that is assumed to be normally distributed with a known mean and covariance matrix:
x
(0)˜N└{circumflex over (x)}(0|0),P(0|0)┘
In the results discussed below, the initial covariance matrix of the EKF model was set to
The “1σ” (“one sigma”) errors for roll angle and roll rate based on the above initial covariance matrix translate to sixty, 60 (=360×√{square root over (0.0278)}), degrees and 0.5 Hz, respectively. The high indicated error for roll angle results from the initialization of the roll angle uniformly to a random number from 0˜1 (cycle).
In the Roll filter, the state variables are roll angle, roll rate and roll acceleration of the projectile. At each time step, the filter computes N sets of measurements, where N is the number of tracked satellites. The standard EKF algorithm performs N updates based on the N sets of measurements from the N different satellites. For roll determination, however, these N measurements must not be treated equally, as those satellites with the stronger detected signals provide more accurate amplitude and phase measurement data than those having weaker detected signals. The standard EKF algorithm recognizes this; thus the filter gain used to incorporate the measurement into the state estimate depends inversely on the variance of the measurement noise—the matrix R in Table 1. These measurements are produced by nonlinear operations on signals from satellites which are observed in various directions and received on an antenna which may be poorly calibrated. Thus, it is often not possible to assign correct values to the entries in matrix R.
Roll determination using a single antenna and tracking one or more satellites with standard EKF processing is included in the present invention. When two or more satellites are tracked, the results can be quite sensitive to the relative weighting of the measurements from each satellite. The preferred approach in this case uses a single value for R, based on a standard set of conditions, and instead combines the state estimates produced by the EKF method for each satellite with weights that are proportional to the probability that the measurement is valid. This methodology is known as “Probabilistic Data Association” (PDA). See, e.g., Thiagalingam Kirubabajan, Yaakov Bar-shalom, “Probabilistic Data Association Techniques for Target Tracking in Clutter,” Proceedings of the IEEE, Vol. 92, No. 3, March 2004.
In the present context, this method computes an approximation to the probability that the updated estimate of roll angle, based on the measurements from each satellite, lies in a specified interval around the propagated estimate from the prior measurement update point. This probability is calculated under the assumption of a Gaussian error distribution, which is characterized by its mean and variance derived by propagation of the posterior error probability distribution computed at the last measurement update point—also assumed to be Gaussian. The final estimate of the Roll filter state at the current update point is then taken to be the probability-weighted combination of the updated state estimates based on each of the satellite measurements.
Although both the prior and posterior error distributions of the roll filter state variable are not exactly Gaussian, simulation shows this methodology to be very effective. An important characteristic is that the weights assigned to large errors are very small—which effectively screen out the effects of outlier measurements.
In the case where the signal from only one satellite is used for roll processing, the estimate weighting logic described above assigns the weight according to the standard EKF formulation in Table 1. Thus, in the case of a single satellite signal, the PDAF formulation automatically reduces to the standard EKF. The totality of this logic, for any number of satellites greater than or equal to one, is included in the definition of “probabilistic data association” in this disclosure.
The drawings and embodiments of the invention described herein have been presented as examples, and not as limitations. Other embodiments apparent to those of ordinary skill in the art are within the scope of what has been claimed.
This application is related to the commonly owned U.S. Pat. No. 7,994,971, issued on Aug. 9, 2011 and titled “GPS-Based Measurement of Roll Rate and Roll Angle of Spinning Platforms,” and the commonly owned U.S. patent application Ser. No. 12/454,306, filed May 15, 2009 and titled “Antijam Protected GPS-Based Measurement of Roll Rate and Roll Angle of Spinning Platforms” as well as continuation U.S. Application thereof, Ser. No. 13/373,494 filed Nov. 16, 2011 and titled “GPS-Based Roll Rate and Roll Angle Measurement in the Absence of Jamming.”