Commits made onboard the Pursuit during the Santa Monica Canyon Test, Day 1. Fixes for waypoint radius and misc.