Beginning of a program for a lego robot mapper, capable of mapping out the shadow-floorplan of a room without getting itself killed.