Moreover all merge conflicts resolved and Kalman Filter was testet and implemented as well.

Merge branch 'master' of https://gitlab.informatik.hu-berlin.de/badenhop/hochautomatisiertes-fahren