Hallo wkrug,
wie dennis bin ich der Meinung, dass sich das Problem mit einem PI-Regler lösen lässt. Hierfür braucht man etwas Mathematik. Es lohnt sich nicht, ein vorhandenes Programm ohne Verständniss anzupassen. Bemüh mal die Suche nach "PID Regler", dort habe ich einen sehr guten (englischen) link gepostet, in dem eine Heizungsregelung diskutiert wird.