-Fixed a number of typos and bug
-Added a navigation namespace with a function for getting the desired sailing direction
-Added a simple testing program, very limited as of now
Added basic waypoint following