mhh ich wuerd mal das erste if ausklammern, also das hier:

if ((m_Stellwert < 1023)&&(m_Stellwert > 0))
m_Abweichung_Summe += m_Abweichung;

oder warum machst du das rein? der ianteil soll ja immer addiert/subtrahiert werden, und wenn die abweichung 0 ist, passiert ja da eh nix...