I'm going up to the boat this weekend to test the model pilot in the marina. At this point the model has only been in the swimming pool.
I'll probably do some coding and will put some thought into your idea here.
Since this is an Arduino project and I used code and help from others I'm compelled to put the whole thing up on-line. When I get that done I'll post a link here.