drone flying outdoors in natural landscape

State Estimation – Topic

Idea

State estimation is the art of making confident analyses from noisy data. There are several techniques to achieve this. Some more simple, some more complex. The current industry standard is a variation of Kalman filtering, but other options like least squares, MSE, and particle filtering are also options.

State estimation plays a key role in aerospace and robotics applications, both of which involve noisy sensing (obviously from rocket engines and dynamic environments). Some popular applications include tracking and navigation methods like Simultaneously Localize and Map (SLAM) algorithms in robotics.

This type of sensing requires us to acknowledge noisy and random processes (stochastic), and provides tools to cut through that randomness for a “true” reading which our system can deterministically use.

Governing Equation

Equation

State estimation relies on a governing equation:

xn+1=f(xn,un)+dnx_{n+1} = f(x_{n}, u_{n}) + d_{n}
yn=h(xn)+wny_n = h(x_n) + w_n
f(xn,un)dynamicsh(xn)observationdnprocessnoisewnmeasurementnoise\begin{matrix} f(x_n,u_n) & dynamics \\ h(x_n) & observation \\ d_n & process\; noise \\ w_n & measurement \; noise\end{matrix}

This standard form does not require linearity in the dynamics function or the observation function. Instead, either of these functions could be nonlinear. If we continue to discretize and linearize the system, we in general have:

f(x,u)=x+δuf(x,u) = x + \delta u

Derivation

which we get the discretized form solving this exact form

x[(n+1)δ]=x[δn]+δn(n+1)δu(t)dtx[(n+1)\delta] = x[\delta n] + \int_{\delta n} ^{(n+1)\delta} u(t) dt

through this approxiation

δu[δn]nδ(n+1)δu(t)dt\delta \cdot u[\delta n] \approx \int_{n\delta}^{(n+1)\delta} u(t) dt

after we drop the delta notation:

xn+1=xn+δunx_{n+1} = x_n + \delta u_n

Process

Reasoning

In general, x is an unknown set of state variables. This is what we estimate based on our observations recorded in the set of y. This can be tricky to manage, since there is no embedded knowledge of “data richness” to ensure that you’ve succesfully captured all the variation possible in the state.

There are several methods to find the relationship between x and y. These methods embody the work in state estimation! These methods also embed an idea of error estimation, which gives you as the engineer a level of confidence in the measurements themselves from a mathematical framework!

How to Estimate

In general the process follows the following steps:

  1. Create a dynamic model of the system
  2. Create an observation model for the system
  3. Use one of the following methods to estimate the state of the system based on dynamic and observation models.

Methods

  • Classical Methods
    • Least Squares Approximation
    • Least Mean Squared Error Linear
    • Least Mean Squared Error Nonlinear
  • Filtering Methods
    • Vanilla Kalman Filtering
    • Extended Kalman Filtering
    • Unscented Kalman Filtering
  • Particle Methods
    • Optimal Transport Applications


Comments

Leave a Reply

Discover more from Andrew Adie

Subscribe now to keep reading and get access to the full archive.

Continue reading