А что если WaitTime привязать к значению рассогласования, т.е. ввести П-составляющую.