Galileo project - Draw a map of an unknown room with Lego Mindstorms EV3