#include "TemperatureSensorInserter.h"

#include <objects/systemObjectList.h>

#include <cmath>
#include <cstdlib>

TemperatureSensorInserter::TemperatureSensorInserter(
    object_id_t objectId, std::map<object_id_t, Max31865Dummy> tempSensorDummies_,
    std::map<object_id_t, Tmp1075Dummy> tempTmpSensorDummies_)
    : SystemObject(objects::THERMAL_TEMP_INSERTER),
      tempSensorDummies(tempSensorDummies_),
      tempTmpSensorDummies(tempTmpSensorDummies_) {}

ReturnValue_t TemperatureSensorInserter::initialize() {
  if (performTest) {
    if (testCase == TestCase::OVERCOOL_SYRLINKS) {
    }
  }
  return returnvalue::OK;
}

ReturnValue_t TemperatureSensorInserter::performOperation(uint8_t opCode) {
  iteration++;
  value = sin(iteration / 80. * M_PI) * 10;

  /*
  ReturnValue_t result = max31865PlocHeatspreaderSet.read();
  if (result != returnvalue::OK) {
    sif::warning << "Failed to read temperature from MAX31865 dataset" << std::endl;
  }
  max31865PlocHeatspreaderSet.rtdValue = value - 5;
  max31865PlocHeatspreaderSet.temperatureCelcius = value;
  if ((iteration % 100) < 20) {
    max31865PlocHeatspreaderSet.setValidity(false, true);
  } else {
    max31865PlocHeatspreaderSet.setValidity(true, true);
  }
  max31865PlocHeatspreaderSet.commit();
  */
  return returnvalue::OK;
}