created WAYPOINTS.cpp to house all of the waypoint functions for the code.
there is one additoinal function ("update_waypoint") that is in the .ino file, but it is used by navigation and would probably better fit in that file.

Signed-off-by: rkburnside <richard@burnsides.org>