fix merge relicts
Merge branch 'system-controller'
adding accelerations to sensor model
adding kalman-filter for dx and dy