summit_xl_waypoints: tested on willow garage map