improved performance of EKF
added reset to KF and EKF and activate it for using with bag file tests-3/data/einparken/2014-01-31-17-02-31.bag
added distance to CV motion model
added manual set of already filtered sensor data