Reading data from sensors before PID iteration
DEBUG_NO_TX_ARDUINO
PID: I component enabled