Upgraded the waypoints program

I've removed that digital filter and put all of the gps equations (nmea
to rads, calculateDistance, etc.) in their own file.  To use, you have
to add them to the make file.