olvass utánna a PID szabályozás témának. Amit leírsz, az a D belóle. neked egy PD is elég. 

az is jó lehet, ha keresel egy arduino PID példaprogramot, és játszol kicsit a paraméterekkel.

Vajk