Kalman Filter 1 Early Planar IMU 14x28 mm

Kalman Filter 2 3DOF IMU - Measures Two States

Kalman Filter 3 Tractor Overturn h r s  OP PP PP PP  OP +   P m, J P

Kalman Filter 4 Prevent Rear Overturn

Kalman Filter 5 s = measured signal b = zero drift or bias (function of temp) f = scale factor (function of temp) w = Gaussian white noise  2 = variance Sensor Uncertainty

Kalman Filter 6 f = 300 degps/V, 0.05 %/C° b = 1.23 V, 0.05 degps/C° Nonlinearity ±1%  = degps/sqrt(Hz) pink noise LSY530 gyro ±300 degps

Kalman Filter 7 Uses state space model Position Velocity Adaptive time domain filter Combines states Tracks variance-covariance Helps reject zero drift Kalman Filter

8 Kalman Filter - 2D IMU

Kalman Filter 9 Kalman Filter - Simplified

Kalman Filter 10 Kalman Filter – Prediction  latitude probability Novice navigator

Kalman Filter 11 Kalman Filter - Measurement  latitude probability Novice navigator Experienced navigator

Kalman Filter 12 Kalman Filter - Correction  latitude probability Novice navigator Experienced navigator Combination

Kalman Filter 13 Kalman Filter - Prediction  latitude probability constant speed fixed time

Kalman Filter 14 Kalman Filter – 2D IMU  angle probability

Kalman Filter 15 Kalman Filter

16 Kalman Filter