1st water test

-adjust kp, f_cutoff, for rudder controller