#include "commands.h"

namespace esphome {
namespace panasonic_heatpump {
const uint8_t PanasonicCommand::InitialRequest[INIT_REQUEST_SIZE] = {0x31, 0x05, 0x10, 0x01, 0x00, 0x00, 0x00, 0xB9};
const uint8_t PanasonicCommand::InitialResponse[INIT_RESPONSE_SIZE] = {
    0x31, 0x30, 0x01, 0x10, 0x1E, 0x6C, 0xC8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3C};
const uint8_t PanasonicCommand::PollingMessage[DATA_MESSAGE_SIZE] = {
    0x71, 0x6C, 0x01, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x12};
const uint8_t PanasonicCommand::PollingExtraMessage[DATA_MESSAGE_SIZE] = {
    0x71, 0x6C, 0x01, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01};
const uint8_t PanasonicCommand::CommandMessage[DATA_MESSAGE_SIZE] = {
    0xF1, 0x6C, 0x01, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
    0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x92};

uint8_t PanasonicCommand::calcChecksum(std::vector<uint8_t>& data, int length) {
  uint8_t checksum = 0;
  for (int i = 0; i < length; i++) {
    checksum += data[i];
  }
  checksum = (checksum ^ 0xFF) + 01;
  return checksum;
}

uint8_t PanasonicCommand::setMultiply2(int input) {
  return input * 2;
}

uint8_t PanasonicCommand::setMultiply4(int input) {
  return input * 4;
}

uint8_t PanasonicCommand::setPlus1Multiply4(int input) {
  return (input + 1) * 4;
}

uint8_t PanasonicCommand::setPlus1Multiply8(int input) {
  return (input + 1) * 8;
}

uint8_t PanasonicCommand::setPlus1Multiply16(int input) {
  return (input + 1) * 16;
}

uint8_t PanasonicCommand::setPlus1Multiply64(int input) {
  return (input + 1) * 64;
}

uint8_t PanasonicCommand::setPlus1(int input) {
  return input + 1;
}

uint8_t PanasonicCommand::setPlus128(int input) {
  return input + 128;
}

uint8_t PanasonicCommand::setOperationMode(int input) {
  switch (input) {
  case 0:
    return 0b100001;  // 0x21 = tank
  case 1:
    return 0b010010;  // 0x12 = heat
  case 2:
    return 0b100010;  // 0x22 = heat+tank
  case 3:
    return 0b010011;  // 0x13 = cool
  case 4:
    return 0b100011;  // 0x23 = cool+tank
  case 5:
    return 0b011000;  // 0x18 = auto
  case 6:
    return 0b101000;  // 0x28 = auto+tank
  case 7:
    return 0b011001;  // 0x19 = auto-heat
  case 8:
    return 0b101001;  // 0x29 = auto-heat+tank
  case 9:
    return 0b011010;  // 0x1A = auto-cool
  case 10:
    return 0b101010;  // 0x2A = auto-cool+tank
  default:
    return 0;  // do nothing
  }
}

// --- start of optional pcb commands ---

uint8_t PanasonicCommand::temp2hex(float temp) {
  int hextemp = 0;
  if (temp > 120) {
    hextemp = 0;
  } else if (temp < -78) {
    hextemp = 255;
  } else {
    uint8_t Uref = 255;
    int constant = 3695;
    int R25 = 6340;
    uint8_t T25 = 25;
    int Rf = 6480;
    float K = 273.15;
    float RT = R25 * exp(constant * (1 / (temp + K) - 1 / (T25 + K)));
    hextemp = Uref * (RT / (Rf + RT));
  }

  return hextemp;
}

uint8_t PanasonicCommand::setByte6(uint8_t byte6, int val, int base, int bit) {
  return (byte6 & ~(base << bit)) | (val << bit);
}

uint8_t PanasonicCommand::setDemandControl(size_t input) {
  switch (input) {
  case 0:
    return 0xEB;
  case 1:
    return 0xB8;
  case 2:
    return 0x85;
  case 3:
    return 0x52;
  case 4:
    return 0x2B;
  default:
    return 0;  // do nothing
  }
}
}  // namespace panasonic_heatpump
}  // namespace esphome