Static map datastructure now changed to an array of territory structs including waypoint, mine, and capture points, and heading info for mine and capture points.
Added calibration routine for distance sensors.