#include "tca9555_driver.h"
#include "bsp_board.h"


esp_io_expander_handle_t io_expander = NULL;


void tca9555_driver_init(void)
{

    i2c_master_bus_handle_t i2c_bus = esp_ret_i2c_handle();
    esp_err_t ret = esp_io_expander_new_i2c_tca95xx_16bit(i2c_bus, ESP_IO_EXPANDER_I2C_TCA9555_ADDRESS_000, &io_expander);

   /* Test output level function */
   ret = esp_io_expander_set_dir(io_expander, (IO_EXPANDER_PIN_NUM_0 | IO_EXPANDER_PIN_NUM_1 | IO_EXPANDER_PIN_NUM_5 | IO_EXPANDER_PIN_NUM_6 | IO_EXPANDER_PIN_NUM_8), IO_EXPANDER_OUTPUT);
   if(ret != ESP_OK){
    printf("EXIO Mode setting failure!!\r\n");
   }
   
   ret = esp_io_expander_set_dir(io_expander, (IO_EXPANDER_PIN_NUM_2 | IO_EXPANDER_PIN_NUM_9 | IO_EXPANDER_PIN_NUM_10 | IO_EXPANDER_PIN_NUM_11), IO_EXPANDER_INPUT);   
   if(ret != ESP_OK){
    printf("EXIO Mode setting failure!!\r\n");
   }
}