Add bool to testing harness loop
Add Waypoint Class and create Queue in Player