Bounded PID_yaw_rate, defined max/min, cascaded control to heading