Lot of work on test refactoring

- all test are now derived from the same class
Merge branch 'master' of github.com:AIRLab-POLIMI/C-SLAM

Conflicts:
	c_slam_roamfree/src/FullSlamImu_rectangles.cpp
	c_slam_roamfree/src/RectangleHandler.cpp