SSY345 Sensor fusion and nonlinear filtering VT21