Ich würde wie "wkrug" auch experimentell an die Sache herangehen.
if (druck_a > druck_b)
timer_servo++;
if (druck_a< druck_b)
timer_servo--;
So etwa würde ich mal starten, hysterese noch etwas vergrößern und Servogeschwindigkeit erhöhen wäre dann das nächste.

Hubert