Only updates/resamples when robot is moving

As per suggestion by Prof. Clark