It should be a first-order filter for a robot moving in 2D not a second. 