Dazu brauchst du einen Regelalgorythmus, wie z.B. der PI-Regler. Such mal hier im Frum nach PID-Regler, da dürftest du genüge finden.

Beispiel:
https://www.roboternetz.de/phpBB2/ze...ght=pid+bascom