OTGateway/lib/Equitherm/Equitherm.h

#include <Arduino.h>

#if defined(EQUITHERM_INTEGER)
// расчёты с целыми числами
typedef int datatype;
#else
// расчёты с float числами
typedef float datatype;
#endif

class Equitherm {
public:
  datatype targetTemp = 0;
  datatype indoorTemp = 0;
  datatype outdoorTemp = 0;
  float Kn = 0.0;
  float Kk = 0.0;
  float Kt = 0.0;
  float Ke = 1.3;

  Equitherm() = default;

  // kn, kk, kt, Ke
  Equitherm(float new_kn, float new_kk, float new_kt, float new_ke) {
    Kn = new_kn;
    Kk = new_kk;
    Kt = new_kt;
    Ke = new_ke;
  }

  // лимит выходной величины
  void setLimits(unsigned short min_output, unsigned short max_output) {
    _minOut = min_output;
    _maxOut = max_output;
  }

  // возвращает новое значение при вызове
  datatype getResult() {
    datatype output = getResultN() + Kk + getResultT();
    output = constrain(output, _minOut, _maxOut);		// ограничиваем выход
    return output;
  }

private:
  unsigned short _minOut = 20, _maxOut = 90;

  // температура контура отопления в зависимости от наружной температуры
  // datatype getResultN() {
  //   Kntemp = Kn*3.3; //Подгонка под типовые кривые
  //   float tempDiff = targetTemp - outdoorTemp;
  //   if (tempDiff < 0) tempDiff = 0;
  //   float T_rad = targetTemp + pow(Kntemp * tempDiff, 1.0 / Ke);
  //   return T_rad;
  // }
  datatype getResultN() {
    float tempDiff = targetTemp - outdoorTemp;
    if (tempDiff < 0) {
        tempDiff = 0;
    }
    float minOutside = targetTemp - (_maxOut - targetTemp) / Kn;
    float c1 = (_maxOut - targetTemp) / pow(targetTemp - minOutside, 1.0 / Ke);
    float T_rad = targetTemp + c1 * pow(tempDiff, 1.0 / Ke) ;
    if (T_rad > _maxOut) {
        T_rad = _maxOut;
    }

    return T_rad;
}

  // Расчет поправки (ошибки) термостата
  datatype getResultT() {
    return constrain((targetTemp - indoorTemp), -3, 3) * Kt;
  }
};