Changes to CMake
Changes to Map.cpp
Merge branch 'devel_week5' of https://github.com/fernandomdo/roomba_pp into devel_week5
Merge branch 'devel_week5' of https://github.com/fernandomdo/roomba_pp into devel_week5
Fixed a few minor details