Утверждения if (во множественном числе), которые вы разместили на GitHub сильно отличается от того, что вы написали выше. Они содержат много команд print для ЖК-дисплея, поэтому я думаю, что это замедляет работу вашего кода. Это хорошая попытка красиво отформатировать вывод на дисплее, но это довольно запутанно.

Вот упрощенная версия, которая записывает на ЖК-дисплей как можно меньше (2 перемещения курсора и 2 печати). Форматирование строки выполняется в памяти Arduino перед ее отправкой на ЖК-дисплей в виде одной полной строки.

Я не мог понять ваши имена переменных, поэтому переименовал их.

настройка()

Я переместил analogReadResolution(12) из loop() в setup() для небольшого повышения производительности.

void setup()
{
  pinMode(currsensPin , INPUT_ANALOG);
  pinMode(voltsensPin , INPUT_ANALOG);
  pinMode(voltPin, INPUT_ANALOG);
  pinMode(currPin, INPUT_ANALOG);
  Wire.begin();
  lcd0.begin(20, 4);
  lcd0.backlight();

  analogReadResolution(12);  // Перемещено из loop(). Только нужно позвонить один раз.

  Serial.begin(115200);
}

loop()

Я сгруппировал аналоговые показания вместе, чтобы уменьшить окно выборки. Поскольку это цикл управления, эти значения в идеале должны быть выбраны точно в одно и то же время и синхронизированы с часами (например, аппаратными).

float real_current_offset = 0;

void loop()
{
  //
  // Получение выборок данных как можно ближе друг к другу без прерываний.
  //
  cli();  // Отключить прерывания.
  int svolt = analogRead(voltPin);
  int scurr = analogRead(currPin);
  int raw_voltage = analogRead(voltsensPin);
  int raw_current = analogRead(currsensPin);
  sei();  // Включить прерывания.

  // Рассчитать заданное напряжение и ток.
  float set_voltage = (3.3 / 4096) * svolt;
  float set_current =  (3.3 / 4096) * scurr;

  // Рассчитать реальное напряжение и ток.
  float real_voltage = (3.3 / 4096) * raw_voltage;
  float real_current = raw_current * (3.3 / 4096) - real_current_offset;
  float real_current_ma = real_current * 1000.0;
  
  int dac_value = dac_value
              + (real_current <= set_current) * (set_voltage > real_voltage)
              - (real_current < set_current) * (set_voltage < real_voltage)
              - (real_current > set_current);

  buffer[0] = 0b01000000;
  buffer[1] = dac_value >> 4;
  buffer[2] = dac_value << 4;
  Wire.beginTransmission(MCP4725);
  Wire.write(buffer[0]);
  Wire.write(buffer[1]);
  Wire.write(buffer[2]);
  Wire.endTransmission();

  DisplayDataOnLcd(set_voltage, set_current, real_voltage, real_current);
}

DisplayDataOnLcd()

Я создал новую функцию для отображения данных на ЖК-дисплее. Рекомендуется разбивать код на более мелкие функциональные блоки.

void DisplayDataOnLcd(const int set_voltage, const int set_current, const int real_voltage, const int real_current)
{
  Serial.println("\nLCD Data Display");

  // Определить форматы для печати на ЖК-дисплее.
  const char *data_format_set  = "Set : %s V %s mA";
  const char *data_format_real = "Real: %s V %s mA";
  char voltage_str[10];
  char current_str[10];
  char data_str[30];

  // Отформатируйте установленное напряжение и ток и отобразите их на ЖК-дисплее.
  dtostrf(set_voltage, 6, 3, voltage_str);
  dtostrf(set_current, 6, 3, current_str);
  sprintf(data_str, data_format_set, voltage_str, current_str);
  lcd0.setCursor(0, 0);
  lcd0.println(data_str);
  Serial.println(data_str);

  // Форматируем реальное напряжение и ток и отображаем их на ЖК-дисплее.
  dtostrf(real_voltage, 6, 3, voltage_str);
  dtostrf(real_current, 6, 3, current_str);
  sprintf(data_str, data_format_real, voltage_str, current_str);
  lcd0.setCursor(0, 1);
  lcd0.println(data_str);
  Serial.println(data_str);
}