#include <DFRobot_MCP23017.h>

#include <SPI.h>
#include "nRF24L01.h"
#include "RF24.h"



DFRobot_MCP23017 mcp(Wire, /*addr =*/0x27);//constructor, change the Level of A2, A1, A0 via DIP switch to revise the I2C address within 0x20~0x27.
#define Led0 mcp.eGPB0
#define Led1 mcp.eGPB1
#define Bp0 mcp.eGPA0
#define Bp1 mcp.eGPA1

int MemLed0 =0;
int MemBp0 =0;
int tempo0 =50;
int MMentier = 0;

int MemLed1 =0;
int MemBp1 =0;
int tempo1 =50;

int compteur = 0;


//definition tunnel de communication
#define tunnel1 "PIPE2"     
#define tunnel2 "PIPE1" 
#define tunnel3 "PIPE3"     
#define tunnel4 "PIPE4"
#define tunnel5 "PIPE5"     
#define tunnel6 "PIPE6" 

RF24 radio(4, 5);
const byte adresses[][6] = {tunnel1, tunnel2, tunnel3, tunnel4, tunnel5, tunnel6}; 
const int taille = 32;
char message[taille + 1];
char messageACK[taille +1];



 
int LectBp0(int ValMessage) {
// Bouton O -- Led0

  //int valeurBp0 = mcp.digitalRead(mcp.eGPA0);
  int valeurBp0 = ValMessage;
   
  
//Temps 0  
  if(valeurBp0== 0 && MemBp0 == 0 && MemLed0 == 0){
     mcp.digitalWrite(mcp.eGPB0, LOW); MemBp0 = 0; MemLed0 =0;
     //delay(tempo0);DebugVar(0,valeurBp0);     
  }
  //Temps  1
  if (valeurBp0 == 1 && MemBp0 ==0 && MemLed0 == 0) {
      mcp.digitalWrite(mcp.eGPB0, HIGH);MemBp0 =1;MemLed0 = 1;  
      //delay(tempo0);DebugVar(1,valeurBp0);   
  }   
  //Temps 2
  if (valeurBp0 == 0 && MemBp0 ==1 && MemLed0 == 1) {
      mcp.digitalWrite(mcp.eGPB0, HIGH);MemBp0 =0;MemLed0 = 1;  
      //delay(tempo0);DebugVar(2,valeurBp0);
  }
  //Temps 3
  if (valeurBp0 == 1 && MemBp0 ==0 && MemLed0 == 1) {
      mcp.digitalWrite(mcp.eGPB0, LOW);MemBp0 =1;MemLed0 = 0;  
      //delay(tempo0);DebugVar(3,valeurBp0);
  }
  //Temps 4
  if (valeurBp0 == 0 && MemBp0 ==1 && MemLed0 == 0) {
      mcp.digitalWrite(mcp.eGPB0, LOW);MemBp0 =0;MemLed0 = 0;  
      //delay(tempo0);DebugVar(4,valeurBp0);
  }

  return(valeurBp0);
  
}

int LectBp1(){
// Bouton 1 -- Led1

  uint8_t valeurBp1 = mcp.digitalRead(mcp.eGPA1);
  //uint8_t valeurBp1 =  );  
  
//Temps 0  
  if(valeurBp1== 0 && MemBp1 == 0 && MemLed1 == 0){
     mcp.digitalWrite(mcp.eGPB1, LOW); MemBp1 = 0; MemLed1 =0;
     //delay(tempo0);DebugVar(0,valeurBp0);     
  }
  //Temps  1
  if (valeurBp1 == 1 && MemBp1 ==0 && MemLed1 == 0) {
      mcp.digitalWrite(mcp.eGPB1, HIGH);MemBp1 =1;MemLed1 = 1;  
      //delay(tempo0);DebugVar(1,valeurBp0);   
  }   
  //Temps 2
  if (valeurBp1 == 0 && MemBp1 ==1 && MemLed1 == 1) {
      mcp.digitalWrite(mcp.eGPB1, HIGH);MemBp1 =0;MemLed1 = 1;  
      //delay(tempo0);DebugVar(2,valeurBp0);
  }
  //Temps 3
  if (valeurBp1 == 1 && MemBp1 ==0 && MemLed1 == 1) {
      mcp.digitalWrite(mcp.eGPB1, LOW);MemBp1 =1;MemLed1 = 0;  
      //delay(tempo0);DebugVar(3,valeurBp0);
  }
  //Temps 4
  if (valeurBp1 == 0 && MemBp1 ==1 && MemLed1 == 0) {
      mcp.digitalWrite(mcp.eGPB1, LOW);MemBp1 =0;MemLed1 = 0;  
      //delay(tempo0);DebugVar(4,valeurBp0);
  }
  return(valeurBp1);
}


void envoiemessage1(){
   radio.stopListening();
   itoa(255,messageACK, 10);
   radio.write(messageACK, taille);
   Serial.print("messageACK1 = ");Serial.println(messageACK);
   delay(20);
   radio.startListening();
}

void envoiemessage2(){
   radio.stopListening();
   itoa(128,messageACK, 10);
   radio.write(messageACK, taille);
   Serial.print("messageACK2 = ");Serial.println(messageACK);
   delay(20);
   radio.startListening();
}


   
void setup() {
  Serial.begin(115200);

  
  Serial.println("Recepteur RF24");
  radio.begin();
  radio.setChannel(125);
  radio.setPALevel(RF24_PA_MIN);
  radio.setDataRate(RF24_250KBPS);
  radio.openWritingPipe(adresses[0]); // Ouverture tunnel1 en ECRITURE
  radio.openReadingPipe(1, adresses[1]); // Ouverture tunnel2 en LECTURE
  radio.openReadingPipe(2, adresses[2]); // Ouverture tunnel3 en LECTURE
  radio.openReadingPipe(3, adresses[3]); // Ouverture tunnel4 en LECTURE
  radio.openReadingPipe(4, adresses[4]); // Ouverture tunnel5 en LECTURE
  radio.openReadingPipe(5, adresses[5]); // Ouverture tunnel6 en LECTURE
  
  
  
  
  
  while(mcp.begin() != 0){
    Serial.println("Initialization of the chip failed, please confirm that the chip connection is correct!");
    delay(1000);
  }
  
  mcp.pinMode(Bp0, INPUT);
  mcp.pinMode(Bp1, INPUT);
  mcp.pinMode(mcp.eGPB0,OUTPUT);
  mcp.pinMode(Led0,OUTPUT);
  mcp.digitalWrite(mcp.eGPB0, LOW);
  mcp.digitalWrite(Led1, LOW);  
  
}

void loop() {




  
//Reception Message
radio.startListening();
if (radio.available()){
while ( radio.available() )
  {
    radio.read( message, taille );
    Serial.print("Message recu : ");
    Serial.println(message);
  }
  delay(20);
}
delay(5);
 
int Mentier = atoi(message); 

if ( Mentier == 0 && MMentier == 0 ) {
  
   message[0] = '\0';  Mentier = 0;
   mcp.digitalWrite(mcp.eGPB0, LOW);
   delay(500);
}
if ( Mentier == 1 && MMentier == 0 ) {
  
   message[0] = '\0';  Mentier = 0;
   mcp.digitalWrite(mcp.eGPB0, HIGH);
   MMentier = 1;
   envoiemessage1();
   delay(500);
}
if ( Mentier == 1 && MMentier == 1 ) {
   message[0] = '\0';  Mentier = 0;
   mcp.digitalWrite(mcp.eGPB0, LOW);
   MMentier = 0;
   envoiemessage2();
   delay(500);
}
}