funkey/FunKey-GPIO-Mapping
1
0
Fork 0
mirror of https://github.com/FunKey-Project/FunKey-GPIO-Mapping.git synced 2025-12-12 17:58:54 +01:00
Code Issues Actions Packages Projects Releases Wiki Activity

clean up multi I2C GPIO expander detection

Browse Source 
Signed-off-by: Michel-FK <michel.stempin@funkey-project.com>
This commit is contained in:
Michel-FK 2021-03-16 08:28:05 +01:00
parent 44035d48c2
commit 87d400a345
1 changed files with 24 additions and 17 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

41
driver_pcal6416a.c
View File

@ -26,12 +26,26 @@
#define DEBUG_PRINTF(...) #define DEBUG_PRINTF(...)
#endif #endif
/****************************************************************
* Structures
****************************************************************/
typedef struct {
unsigned int address;
char *name;
} i2c_expander_t;
/**************************************************************** /****************************************************************
* Static variables * Static variables
****************************************************************/ ****************************************************************/
static int fd_i2c_expander; static int fd_i2c_expander;
static unsigned int i2c_expander_addr; static unsigned int i2c_expander_addr;
static char i2c0_sysfs_filename[] = "/dev/i2c-0"; static char i2c0_sysfs_filename[] = "/dev/i2c-0";
static i2c_expander_t i2c_chip[] = {
{PCAL9539A_I2C_ADDR, "PCAL9539A"},
{PCAL6416A_I2C_ADDR, "PCAL6416A"},
{0, NULL}
};
/**************************************************************** /****************************************************************
* Static functions * Static functions
@ -41,32 +55,25 @@ static char i2c0_sysfs_filename[] = "/dev/i2c-0";
* Public functions * Public functions
****************************************************************/ ****************************************************************/
bool pcal6416a_init(void) { bool pcal6416a_init(void) {
int i;
if ((fd_i2c_expander = open(i2c0_sysfs_filename,O_RDWR)) < 0) { if ((fd_i2c_expander = open(i2c0_sysfs_filename,O_RDWR)) < 0) {
printf("Failed to open the I2C bus %s", i2c0_sysfs_filename); printf("Failed to open the I2C bus %s", i2c0_sysfs_filename);
// ERROR HANDLING; you can check errno to see what went wrong // ERROR HANDLING; you can check errno to see what went wrong
return false; return false;
} }
for (i = 0, i2c_expander_addr = 0; i2c_chip[i].address; i++) {
i2c_expander_addr = 0; /// Probing I2C GPIO expander chip
if (ioctl(fd_i2c_expander, I2C_SLAVE_FORCE, i2c_chip[i]) < 0 ||
/// Probing PCAL9539A chip
if (ioctl(fd_i2c_expander, I2C_SLAVE_FORCE, PCAL9539A_I2C_ADDR) < 0 ||
pcal6416a_read_mask_interrupts() < 0) { pcal6416a_read_mask_interrupts() < 0) {
printf("In %s - Failed to acquire bus access and/or talk to slave PCAL9539A_I2C_ADDR 0x%02X.\n", printf("In %s - Failed to acquire bus access and/or talk to slave %s at address 0x%02X.\n",
__func__, PCAL9539A_I2C_ADDR); __func__, i2c_chip[i].name, i2c_chip[i].address);
/// Probing PCAL6416A chip
if (ioctl(fd_i2c_expander, I2C_SLAVE_FORCE, PCAL6416A_I2C_ADDR) < 0 ||
pcal6416a_read_mask_interrupts() < 0) {
printf("In %s - Failed to acquire bus access and/or talk to slave PCAL6416A_I2C_ADDR 0x%02X.\n",
__func__, PCAL6416A_I2C_ADDR);
} else { } else {
DEBUG_PRINTF("Found I2C gpio expander chip: PCAL6416A\n"); DEBUG_PRINTF("Found I2C gpio expander chip %s at address 0x%02X\n",
i2c_expander_addr = PCAL6416A_I2C_ADDR; i2c_chip[i].name, i2c_chip[i].address);
i2c_expander_addr = i2c_chip[i].address;
} }
} else{
DEBUG_PRINTF("Found I2C gpio expander chip: PCAL9539A\n");
i2c_expander_addr = PCAL9539A_I2C_ADDR;
} }
/// GPIO expander chip found? /// GPIO expander chip found?