// Simulace TCA9548 I2C multiplexeru
// prostrednictvím  PCF8575 na adrese 0x20, AND členů a doplnění v "tcaselect"
// POZOR vše co je na I2C před multiplexerem je stále viditelné ze strany procesoru
// tedy by tam mělo být TCA9548, LCD, a v teto simulaci i PCF8575 adr 0x20 (000)
// a jejich adresa se nesmí vyskytovat/opakovat na žádném z kanálů


#include <Wire.h>                   // I2C included in ARDU ?
#include <Adafruit_PWMServoDriver.h>  // PWMservo library
#include <I2cDiscreteIoExpander.h>    // PCF85xx library
#include <LiquidCrystal_I2C.h>        // LCD I2C library

#define PCA9685_ADDRESS_1  0x40         // I2C PCA9685
#define PCA9685_ADDRESS_2  0x41         // I2C PCA9685
#define PCA9685_ADDRESS_3  0x42         // I2C PCA9685
#define PCA9685_ADDRESS_4  0x43         // I2C PCA9685
#define TCAADDR 0x70                  // TCA9548A I2C Multiplexer

#define Add0 32     // PCF chip1 INToutput read

//#define RXPIN 32
#define LEDPIN 25
#define DEBOUNCE_DELAY 100      // puvodni 200

volatile bool interrupt = false;    // true on interrupt
volatile bool ledState = false;
volatile uint32_t lastInterruptTime = 0;

// I2C LCD display addresses    - musí být nastavena podle .json 
const int lcdAddress1 = 0x30; // Replace with the actual I2C address of LCD 1

LiquidCrystal_I2C lcd(lcdAddress1, 16, 2);   // LCD on Address 0x27 puvodní


// create I2cDiscreteIoExpander objects
I2cDiscreteIoExpander device[8] = {0,1,2,3,4,5,6,7};  //  [8=total number]

void setup() {
pinMode(Add0, INPUT_PULLUP);
pinMode(34, INPUT_PULLUP);


  // initialize i2c interface
  Wire.begin();  // bez toho to samozrejme blblo !!!

  // initialize serial interface
  Serial.begin(115200);

    device[0].digitalWrite(0x0000);
    delay(1000);

  tcaselect(0);   // Select the PCF channel
  delay(1000);
  Serial.println("setup i2c test :");
  I2C_scan();

  Serial.println("setup i2c test done");
  Serial.println("");
  delay(1000);

}

void loop() {
//  tcaselect(0);   // Select the PCF channel
  Serial.println("setup i2c test :");
  I2C_scan();

  Serial.println("setup i2c test done");
  Serial.println("");
  vTaskDelay(pdMS_TO_TICKS(2000));

  
}
/******************************************************************************************/
void tcaselect(uint8_t i) {
  if (i > 7) return;
 
  Wire.beginTransmission(TCAADDR);
  Wire.write(1 << i);
  Wire.endTransmission();

  device[0].digitalWrite(~(1 << i));      // PCF inveruje výstupy
}

void I2C_scan(){

  Serial.println("\nI2C Scanner");

  lcd.init();
  lcd.backlight();
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("    I2C scan    ");
  lcd.setCursor(0, 1);
  lcd.print("  > scanning >  ");

  int nDevices;
  Serial.println("Scanning...");
  nDevices = 0;

  for(uint8_t channel = 0; channel < 8; channel++ ) {
  tcaselect(channel);
  Serial.print("I2C channel :");
  Serial.println(channel);
 
     for(uint8_t address = 1; address < 127; address++ ) {
      Wire.beginTransmission(address);
      uint8_t error = Wire.endTransmission();
      if (error == 0) {
        Serial.print("I2C device found at address 0x");
        if (address<16) {
          Serial.print("0");
        }
        Serial.println(address,HEX);
        nDevices++;
      }
      else if (error==4) {
        Serial.print("Unknow error at address 0x");
        if (address<16) {
          Serial.print("0");
        }
        Serial.println(address,HEX);
      }    
    }
  }
  tcaselect(0);
  if (nDevices == 0) {
    Serial.println("No I2C devices found\n");
  }
  else {
    Serial.println("done\n");

//  LCD_displ("    I2C scan    ", "  > finished >  ");
      lcd.setCursor(0, 1);
      lcd.print("    finished    ");
  }
}