Initial stab at waypoint simple tranmission.
Waypoint code for arduino