Changed the PID controller

Went out testing the boat and adapted the controller for better
performance.