// Enable debug prints to serial monitor
#define MY_DEBUG

#define MY_GATEWAY_SERIAL
// Enable repeater functionality for this node
#define MY_REPEATER_FEATURE

#include <SPI.h>
#include <MySensors.h>
#include <DallasTemperature.h>
#include <OneWire.h>

const int PINS[] = {4, 5, 6, 7, 8, 9, 10, 11, 12, 13}; // I/O pins 4, 5, 6, 7, 8, A0, A1 for the relays
#define NUMBER_OF_RELAYS 10 // Total number of attached relays
#define RELAY_ON 1  // GPIO value to write to turn on attached relay
#define RELAY_OFF 0 // GPIO value to write to turn off attached relay

#define COMPARE_TEMP 1 // Send temperature only if changed? 1 = Yes 0 = No

#define ONE_WIRE_BUS 2 // Pin where dallase sensor is connected
#define MAX_ATTACHED_DS18B20 16
unsigned long SLEEP_TIME = 10000; // Sleep time between reads (in milliseconds)
// Generally, you should use "unsigned long" for variables that hold time
// The value will quickly become too large for an int to store
unsigned long previousMillis = 0;        // will store last time LED was updated

OneWire oneWire(ONE_WIRE_BUS); // Setup a oneWire instance to communicate with any OneWire devices (not just Maxim/Dallas temperature ICs)
DallasTemperature sensors(&oneWire); // Pass the oneWire reference to Dallas Temperature.


byte D[16][8] = {
  {0x28, 0xFF, 0x67, 0x60, 0x60, 0x17, 0x04, 0xDE}, //101
  {0x28, 0xFF, 0xCB, 0xCA, 0x60, 0x17, 0x04, 0x7E}, //102
  {0x28, 0xFF, 0xFF, 0xA1, 0x60, 0x17, 0x04, 0xE1}, //103
  {0x28, 0xFF, 0x03, 0xBA, 0x60, 0x17, 0x04, 0xCA}, //104
  {0x28, 0xFF, 0x14, 0xA2, 0x60, 0x17, 0x04, 0xC3}, //105
  {0x28, 0xFF, 0x3A, 0x46, 0x60, 0x17, 0x04, 0xDE}, //106
  {0x28, 0xFF, 0xCF, 0xD9, 0x60, 0x17, 0x04, 0xD1}, //107
  {0x28, 0xFF, 0xC0, 0xBE, 0x60, 0x17, 0x04, 0xA8}, //108
  {0x28, 0xFF, 0x80, 0xDC, 0x60, 0x17, 0x04, 0xD6}, //109
  {0x28, 0xFF, 0x77, 0xBA, 0x60, 0x17, 0x04, 0xB8}, //110
  {0x28, 0xFF, 0x17, 0x5A, 0x60, 0x17, 0x04, 0xE0}, //111
  {0x28, 0xFF, 0x06, 0xD0, 0x60, 0x17, 0x04, 0x93}, //112
  {0x28, 0xFF, 0x0E, 0xAF, 0x60, 0x17, 0x04, 0x9F}, //113
  {0x28, 0xFF, 0xFA, 0x49, 0x60, 0x17, 0x04, 0x66}, //114
  {0x28, 0xFF, 0xFA, 0xC0, 0x33, 0x18, 0x01, 0x94}, //115
  {0x28, 0xFF, 0x41, 0x89, 0x60, 0x17, 0x04, 0x60} //116

};


float lastTemperature[MAX_ATTACHED_DS18B20];
int numSensors=0;
bool receivedConfig = false;
bool metric = true;
// Initialize temperature message
MyMessage msg(0,V_TEMP);

void before()
{
    for (int sensor=1; sensor<=NUMBER_OF_RELAYS; sensor++) {
        // Then set relay pins in output mode
        pinMode(PINS[sensor-1], OUTPUT);
        // Set relay to last known state (using eeprom storage)
        digitalWrite(PINS[sensor-1], loadState(sensor)?RELAY_ON:RELAY_OFF);
    }

    // Startup up the OneWire library
    sensors.begin();
}

void setup()
{
  // requestTemperatures() will not block current thread
  sensors.setWaitForConversion(false);
}

void presentation()
{
    // Send the sketch version information to the gateway and Controller
    sendSketchInfo("Relay and Temp", "1.0");

    for (int sensor=1; sensor<=NUMBER_OF_RELAYS+MAX_ATTACHED_DS18B20; sensor++) {
        // Register all sensors to gw (they will be created as child devices)

        if (sensor<=NUMBER_OF_RELAYS){
          present(sensor, S_BINARY);
        }
        else {
          present(sensor, S_TEMP);
        }
    }
}

void loop()
{
  unsigned long currentMillis = millis();

  if (currentMillis - previousMillis >= SLEEP_TIME) {
    // save the last time you blinked the LED
    previousMillis = currentMillis;

    // Fetch temperatures from Dallas sensors
    sensors.requestTemperatures();

    // query conversion time and sleep until conversion completed
    int16_t conversionTime = sensors.millisToWaitForConversion(sensors.getResolution());
    // sleep() call can be replaced by wait() call if node need to process incoming messages (or if node is repeater)
    sleep(conversionTime);

    // Read temperatures and send them to controller
    for (int i=0; i<MAX_ATTACHED_DS18B20; i++) {

      // Fetch and round temperature to one decimal
      // float temperature = static_cast<float>(static_cast<int>((getConfig().isMetric?sensors.getTempCByIndex(i):sensors.getTempFByIndex(i)) * 10.)) / 10.;
      float temperature = sensors.getTempC(D[i]);

      // Only send data if temperature has changed and no error
      if (COMPARE_TEMP == 1) {
        if (lastTemperature[i] != temperature && temperature != -127.00 && temperature != 85.00) {
            // Send in the new temperature
            send(msg.setSensor(i+NUMBER_OF_RELAYS+1).set(temperature,1));
            // Save new temperatures for next compare
            lastTemperature[i]=temperature;
        }
      }
      else {
        if (temperature != -127.00 && temperature != 85.00) {
            // Send in the new temperature
            send(msg.setSensor(i+NUMBER_OF_RELAYS+1).set(temperature,1));
            // Save new temperatures for next compare
            lastTemperature[i]=temperature;
        }
      }
    }
  }
}

void receive(const MyMessage &message)
{
    // We only expect one type of message from controller. But we better check anyway.
    if (message.type==V_STATUS) {
        // Change relay state
        digitalWrite(PINS[message.sensor-1], message.getBool()?RELAY_ON:RELAY_OFF);
        // Store state in eeprom
        saveState(message.sensor, message.getBool());
        // Write some debug info
        Serial.print("Incoming change for sensor:");
        Serial.print(message.sensor);
        Serial.print(", New status: ");
        Serial.println(message.getBool());
    }
}