Bearings Only Tracking demonstration, 'bot_demo'
In this demonstration we track a moving object with two sensors, which measure only the angles between the object and them, that is, the measurement model is nonlinear. Figure 1 shows the measurements made by the sensors in one simulation run. The dynamics of the object are modelled with Wiener velocity model, which means that the velocity of the object is perturbed with Gaussian noise.
In figures 2, 3 and 4 we have plotted the estimates produced by first and second order EKF and UKF as well as their smoother counterparts. See the documentation for discussion.
Files used in this example:
Measurement model function
Jacobian of the measurement model
Hessian of the measurement model
Bearings Only Tracking demonstration with EKF and UKF
Bearings Only Tracking demonstration with EKF
Bearings Only Tracking demonstration with UKF