-Tested waypoint code and GPS
- Tidied up the repo more
- JSpringett && David Capper