Correct the switching from reality to simulation and back
Correct the switching from reality to simulation and back

lis-epfl/MAVRIC_Library,gburri/MAVRIC_Library,lis-epfl/MAVRIC_Library,gburri/MAVRIC_Library,gburri/MAVRIC_Library,lis-epfl/MAVRIC_Library