Having that in the code made the PID fail, which is why I removed it. It seems to work fine without having all of the multiplication by signs.