WaypointNav old code uploaded to arduino; test and hopefully will work as before (otherwise most likely hardware problem :/)