#include "PCF8575.h"

// Set i2c address
PCF8575 pcf8575_20(0x20);
PCF8575 PCF_Hall_s(0x21);   //HALL_S
PCF8575 PCF_Hall_l(0x22);   //HALL_L
PCF8575 PCF_dir_s(0x23);    //DIR_S
PCF8575 PCF_dir_l(0x24);    //DIR_L
PCF8575 PCF_OCCUP(0x25);    //OCCUP

uint16_t  hall_s;
uint16_t  hall_l;
uint16_t  dir_s;
uint16_t  dir_l;

uint16_t  o_hall_s;
uint16_t  o_hall_l;

uint16_t  fl_s;
uint16_t  fl_l;
uint16_t  o_occup;

uint16_t  OCCUP = 0xFFFF;         // on RESET init
uint16_t  O_OCC;

void setup()
{
  Serial.begin(9600);
  Wire.begin();

  Serial.println("\nHALL Test\n");
  
  int nDevices;
  int address;
  int error;

  Serial.println("I2C Scanning...");
  nDevices = 0;
  for(address = 1; address < 127; address++ ) {
    Wire.beginTransmission(address);
    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);
    }    
  }
  if (nDevices == 0) {
    Serial.println("No I2C devices found\n");
  }
  else {
    Serial.print("I2C scan done\n");

  pcf8575_20.begin();
  PCF_Hall_s.begin();
  PCF_Hall_l.begin();
  PCF_dir_s.begin();
  PCF_dir_l.begin();
  PCF_OCCUP.begin();
  }

  PCF_OCCUP.write16(~OCCUP);    // on RESET init
  Serial.println("Setup completed");

//delay(5000);
  Serial.println("\n... main loop continued ...\n");
}

void loop()
{
delay(50);
// Serial.println(millis());
////  o_occup = ~pcf8575_20.read16();
/*
  hall_s = ~PCF_Hall_s.read16();
  hall_l = ~PCF_Hall_l.read16();
  dir_s = ~PCF_dir_s.read16();
  dir_l = ~PCF_dir_l.read16();
*/
  o_occup = ~pcf8575_read(0x21);
  Serial.println("PCF8575_20 : ");
  Serial.println(o_occup,BIN);
/*
  Serial.println("hall_s / o_hall_s");
  Serial.println(hall_s,BIN);
  Serial.println(o_hall_s,BIN);
  Serial.println("hall_l / o_hall_l");
  Serial.println(hall_l,BIN);
  Serial.println(o_hall_l,BIN);
*/
  Serial.println("...............");

  delay(2000);
}


uint16_t pcf8575_read(uint8_t address){
  Wire.beginTransmission(address);
  uint8_t error = Wire.endTransmission();
    Wire.requestFrom(address,2); 
    if(Wire.available()){
      uint8_t lo = Wire.read();
      uint8_t hi = Wire.read();
      return(word(hi,lo)); //joing bytes 
    }
    else{//error
      //do something here if you like  
    }
}