Changed the way PID polarity and the timing