small 4 state kalman filter for the UGV