added waypoint, nicer map, and offroad detection