#include "WS_Relay.h"

bool Failure_Flag = 0;
/*************************************************************  Relay I/O  *************************************************************/
bool Relay_Open(uint8_t CHx)
{
  if(!Set_EXIO(CHx, true)){
    printf("Failed to Open CH%d!!!\r\n", CHx);
    Failure_Flag = 1;
    return 0;
  }
  return 1;
}
bool Relay_Close(uint8_t CHx)
{
  if(!Set_EXIO(CHx, false)){
    printf("Failed to Closs CH%d!!!\r\n", CHx);
    Failure_Flag = 1;
    return 0;
  }
  return 1;
}
bool Relay_CHx_Toggle(uint8_t CHx)
{
   if(!Set_Toggle(CHx)){
    printf("Failed to Toggle CH%d!!!\r\n", CHx);
    Failure_Flag = 1;
    return 0;
  }
  return 1;
}
bool Relay_CHx(uint8_t CHx, bool State)
{
  bool result = 0;
  if(State)
    result = Relay_Open(CHx);
  else
    result = Relay_Close(CHx);
  if(!result)
    Failure_Flag = 1;
  return result;
}
bool Relay_CHxs_PinState(uint8_t PinState)
{
  if(!Set_EXIOS(PinState)){
    printf("Failed to set the relay status!!!\r\n");
    Failure_Flag = 1;
    return 0;
  }
  return 1;
}

void RelayFailTask(void *parameter) {
  while(1){
    if(Failure_Flag)
    {
      Failure_Flag = 0;
      printf("Error: Relay control failed!!!\r\n");
      RGB_Open_Time(60,0,0,5000,500);
      Buzzer_Open_Time(5000, 500);
    }
    vTaskDelay(pdMS_TO_TICKS(50));
  }
  vTaskDelete(NULL);
}
void Relay_Init(void)
{
  TCA9554PWR_Init(0x00);
  xTaskCreatePinnedToCore(
    RelayFailTask,    
    "RelayFailTask",   
    4096,                
    NULL,                 
    3,                   
    NULL,                 
    0                   
  );
}

/********************************************************  Data Analysis  ********************************************************/
bool Relay_Flag[8] = {0};       // Relay current status flag
void Relay_Analysis(uint8_t *buf,uint8_t Mode_Flag)
{
  uint8_t ret = 0;
  if(Mode_Flag == Bluetooth_Mode)
    printf("Bluetooth Data :\r\n");
  else if(Mode_Flag == WIFI_Mode)
    printf("WIFI Data :\r\n");
  else if(Mode_Flag == MQTT_Mode)
    printf("MQTT Data :\r\n");
  else if(Mode_Flag == RS485_Mode)
    printf("RS485 Data :\r\n");  
  switch(buf[0])
  {
    case CH1: 
      ret = Relay_CHx_Toggle(GPIO_PIN_CH1);                                              //Toggle the level status of the GPIO_PIN_CH1 pin
      if(ret){
        Relay_Flag[0] =! Relay_Flag[0];
        Buzzer_Open_Time(200, 0);
        if(Relay_Flag[0])
          printf("|***  Relay CH1 on  ***|\r\n");
        else
          printf("|***  Relay CH1 off ***|\r\n");
      }
      break;
    case CH2: 
      ret = Relay_CHx_Toggle(GPIO_PIN_CH2);                                             //Toggle the level status of the GPIO_PIN_CH2 pin
      if(ret){
        Relay_Flag[1] =! Relay_Flag[1];
        Buzzer_Open_Time(200, 0);
        if(Relay_Flag[1])
          printf("|***  Relay CH2 on  ***|\r\n");
        else
          printf("|***  Relay CH2 off ***|\r\n");
      }
      break;
    case CH3:
      ret = Relay_CHx_Toggle(GPIO_PIN_CH3);                                             //Toggle the level status of the GPIO_PIN_CH3 pin
      if(ret){
        Relay_Flag[2] =! Relay_Flag[2];
        Buzzer_Open_Time(200, 0);
        if(Relay_Flag[2])
          printf("|***  Relay CH3 on  ***|\r\n");
        else
          printf("|***  Relay CH3 off ***|\r\n");
      }
      break;
    case CH4:
      ret = Relay_CHx_Toggle(GPIO_PIN_CH4);                                             //Toggle the level status of the GPIO_PIN_CH4 pin
      if(ret){
        Relay_Flag[3] =! Relay_Flag[3];
        Buzzer_Open_Time(200, 0);
        if(Relay_Flag[3])
          printf("|***  Relay CH4 on  ***|\r\n");
        else
          printf("|***  Relay CH4 off ***|\r\n");
      }
      break;
    case CH5:
      ret = Relay_CHx_Toggle(GPIO_PIN_CH5);                                             //Toggle the level status of the GPIO_PIN_CH5 pin
      if(ret){  
        Relay_Flag[4] =! Relay_Flag[4];
        Buzzer_Open_Time(200, 0);
        if(Relay_Flag[4])
          printf("|***  Relay CH5 on  ***|\r\n");
        else
          printf("|***  Relay CH5 off ***|\r\n");
      }
      break;
    case CH6:
      ret = Relay_CHx_Toggle(GPIO_PIN_CH6);                                             //Toggle the level status of the GPIO_PIN_CH6 pin
      if(ret){
        Relay_Flag[5] =! Relay_Flag[5];
        Buzzer_Open_Time(200, 0);
        if(Relay_Flag[5])
          printf("|***  Relay CH6 on  ***|\r\n");
        else
          printf("|***  Relay CH6 off ***|\r\n");
      }
      break;
    case CH7:
      ret = Relay_CHx_Toggle(GPIO_PIN_CH7);                                             //Toggle the level status of the GPIO_PIN_CH6 pin
      if(ret){
        Relay_Flag[6] =! Relay_Flag[6];
        Buzzer_Open_Time(200, 0);
        if(Relay_Flag[6])
          printf("|***  Relay CH7 on  ***|\r\n");
        else
          printf("|***  Relay CH7 off ***|\r\n");
      }
      break;
    case CH8:
      ret = Relay_CHx_Toggle(GPIO_PIN_CH8);                                             //Toggle the level status of the GPIO_PIN_CH6 pin
      if(ret){
        Relay_Flag[7] =! Relay_Flag[7];
        Buzzer_Open_Time(200, 0);
        if(Relay_Flag[7])
          printf("|***  Relay CH8 on  ***|\r\n");
        else
          printf("|***  Relay CH8 off ***|\r\n");
      }
      break;
    case ALL_ON:
      ret = Relay_CHxs_PinState(0xFF);                                              // Turn on all relay
      if(ret){
        memset(Relay_Flag,1, sizeof(Relay_Flag));
        printf("|***  Relay ALL on  ***|\r\n");
        Buzzer_Open_Time(500, 0);
      }

      break;
    case ALL_OFF:
      ret = Relay_CHxs_PinState(0x00);                                                // Turn off all relay
      if(ret){
        memset(Relay_Flag,0, sizeof(Relay_Flag));
        printf("|***  Relay ALL off ***|\r\n");
        Buzzer_Open_Time(500, 150); 
      }
      break;
    default:
      printf("Note : Non-instruction data was received !  -  %c\r\n", buf[0]);
  }
}

void Relay_Immediate(uint8_t CHx, bool State, uint8_t Mode_Flag)
{
  if(!CHx || CHx > 8){
    printf("Relay_Immediate(function): Incoming parameter error!!!!\r\n");
    Failure_Flag = 1;
  }
  else{
    uint8_t ret = 0;
    if(Mode_Flag == DIN_Mode)
      printf("DIN Data :\r\n"); 
    else if(Mode_Flag == RTC_Mode)
      printf("RTC Data :\r\n");
    ret = Relay_CHx(CHx,State);                                               
    if(ret){
      Relay_Flag[CHx-1] = State;
      Buzzer_Open_Time(200, 0);
      if(Relay_Flag[0])
        printf("|***  Relay CH%d on  ***|\r\n",CHx);
      else
        printf("|***  Relay CH%d off ***|\r\n",CHx);
    }
  }
}
void Relay_Immediate_CHxn(Status_adjustment * Relay_n, uint8_t Mode_Flag)
{
  uint8_t ret = 0;
  if(Mode_Flag == DIN_Mode)
    printf("DIN Data :\r\n"); 
  else if(Mode_Flag == RTC_Mode)
    printf("RTC Data :\r\n");            
  for (int i = 0; i < 8; i++) {
    if(Relay_n[i] == STATE_Open || Relay_n[i] == STATE_Close){
      Relay_Flag[i] = (bool)Relay_n[i];
      ret = Relay_CHx(i+1,Relay_n[i]);  
      if(Relay_n[i] == STATE_Open)
        printf("|***  Relay CH%d on  ***|\r\n",i+1);
      else if(Relay_n[i] == STATE_Close)
        printf("|***  Relay CH%d off ***|\r\n",i+1);
    }
  }
  Buzzer_Open_Time(200, 0);
}

void Relay_Immediate_CHxs(uint8_t PinState, uint8_t Mode_Flag)
{
  uint8_t ret = 0;
  if(Mode_Flag == DIN_Mode)
    printf("DIN Data :\r\n"); 
  else if(Mode_Flag == RTC_Mode)
    printf("RTC Data :\r\n");
  for (int i = 0; i < 8; i++) {
    Relay_Flag[i] = (PinState >> i) & 0x01; // 提取每一位并赋值
  }
  ret = Relay_CHxs_PinState(PinState);                                               
  if(ret){
    for (int j = 0; j < 8; j++) {
      if(Relay_Flag[j])
        printf("|***  Relay CH%d on  ***|\r\n",j+1);
      else
        printf("|***  Relay CH%d off ***|\r\n",j+1);
    }
    Buzzer_Open_Time(200, 0);
  }
  else
  {
    printf("Relay_Immediate_CHxs(function): Relay control failure!!!!\r\n");
    Failure_Flag = 1;
  }
}