added auto waypoints, collisions, and benchmarking