PID_TESTING v3.0 Shorten loop