base waypoint cache off of smoothed path, not straight-up tree output