Start disturbance with zero phase.
Redesign yaw rate controller with Matlab selected crossover.