Hello team!
I don't know how the current autopilot works but id imagine it would be a pain to change too far down the line. So please make sure the base code is laid out for change. I urge you to consider making it PID controlled for easy and accurate handling. Please look up PID if you are not already using such a system.
Fundamentally the Autopilot should follow not only the points set, but also the line between them. It should correct course and take into account drift, tide, wind and any such variable. Even control the cruise speed that is set. Here is a manual for a typical autopilot for boats. If you could mimic that it would be perfect in my opinion. https://www.teamsanika.dk/wp-content/uploads/2015/11/st5000-.pdf
Thank you for reading and for all the hard work you are putting into this game.
Best,