Two robots following waypoints!

The did it! Anton, Graham, Mark and Marko got a first version of the waypoint following algorithm implemented on the setup. Now extending the view of the camera, so the robots don't have to be nudged gently into it's view!