Nearly have a working wp/var setting module.
Arduino simple waypoint code