AdaptiveControl: changed reference angular velocity to frequency (Hz). Added dynamics to reference signal to avoid discontinuities