Observe position from encoder, estimate speed, position with kalman filter