Читать книгу Position, Navigation, and Timing Technologies in the 21st Century - Группа авторов - Страница 29

One approach to addressing the generalized nonlinear estimation requirement to maintain the full probability density is the so‐called grid particle filter. The grid particle filter maintains a discrete collection of possible system states and associates a probability with each of those states (i.e. particles). This approach is optimal given systems with the following conditions:

1 The state vector is truly discrete or can be accurately approximated using a discretization of the state space.

2 The number of discrete states is computationally tractable.

Given these conditions, the state density function can be expressed as a weighted collection of particles (repeated from Eq. 36.72)

(36.80)

where the particle weights, w^[j], must sum to one. Because the particle locations are assumed to be static, the filtering operation is performed over the collection of weights. This allows the filter to maintain the density function as the collection of propagation and update steps are applied. At this point, it is relatively straightforward to derive the propagation and update relations for the collection of particles.

We begin with the propagation from time k – 1 to k. Assume that the posterior density function at time k – 1 is given by

(36.81)

Substituting Eq. 36.81 into the Chapman–Kolmogorov equation (Eq. 36.12) and simplifying:

(36.82)

(36.83)

(36.84)

(36.85)

The rightmost density in Eq. 36.85 is the transition probability function, which can be rewritten as

(36.86)

Substituting Eq. 36.86 into Eq. 36.85 and simplifying

(36.87)

(36.88)

(36.89)

where the new particle weight is given by

(36.90)

Conceptually, this can be calculated as the sum of all posterior weights at time k – 1 multiplied by the specific transition probability into state l from all possible prior states.

The development of the measurement update function proceeds in a similar fashion. Recalling our definition of the a priori density function (repeated from Eq. 36.89 for clarity):

(36.91)

and substituting into the update equation (Eq. 36.16) yields

(36.92)

which can be simplified by changing the order of integration and using the properties of the delta function

(36.93)

(36.94)

(36.95)

Finally, recalling the grid particle filter form of the posterior density function

(36.96)

and substituting into Eq. 36.95 yields

(36.97)

The bracketed areas show the final particle weight update equations

(36.98)

In the next section, we illustrate a potential application of the grid particle filter in a navigation context.