Remove raw datapoints from plot.
Fiddle a bit with the kalman filter. Maybe we should really re-write it to filter velocity as well?