Added a method for keeping the boat aligned to a set heading