Wind Vane Controller/ PI Rudder controller

- lab tested wind vane controller
- PI gains for rudder controller
Merge master program