Odometry is published in meters, changed mapping to reflect that. Increased the heading threshold in motion.
Made changes so that mapping adds a wall to the side where wall following is being made.