test

test
IGS with new Localization

Added a new Branch to implement the extension of the Bachelor Thesis of
A. Hoppe.
Changed some files to remove compile errors.

Needs to be tested in LivingLab with Kinect 2.0