Changed singleton to allow removal of robots and sensors.

IMU now implements the removal of the sensor
Implemented removal from singleton in force-torque sensor and robot plugin
Code cleanup:
Changed header guards names to avoid clashes with compilers and libraries naming
Changed CMakeLists.txt
Merge branch 'fixes/crash_on_removal' into development