Some changes
Merge branch 'station-keeping' of github.com:AberSailbot/SailbotLogic into station-keeping
Satation keeping improved, should work on the boat
Merge branch 'station-keeping' of github.com:AberSailbot/SailbotLogic into station-keeping