FunKey-GPIO-Mapping/driver_pcal6416a.c at master · FunKey-Project/FunKey-GPIO-Mapping · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
#include <stdio.h>
#include <stdint.h>
#include <stdbool.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <fcntl.h>
#include <errno.h>
#include <sys/select.h>
#include <linux/input.h>
#include "read_conf_file.h"
#include <assert.h>
#include <linux/i2c.h>
#include <linux/i2c-dev.h>
#include "smbus.h"
#include "driver_pcal6416a.h"

/****************************************************************
 * Defines
 ****************************************************************/
#define DEBUG_PCAL6416A_PRINTF 			(0)

#if (DEBUG_PCAL6416A_PRINTF)
	#define DEBUG_PRINTF(...) printf(__VA_ARGS__);
#else
	#define DEBUG_PRINTF(...)
#endif

/****************************************************************
 * Structures
 ****************************************************************/

typedef struct {
    unsigned int address;
    char *name;
} i2c_expander_t;

/****************************************************************
 * Static variables
 ****************************************************************/
static int fd_i2c_expander;
static unsigned int i2c_expander_addr;
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
 ****************************************************************/

/****************************************************************
 * Public functions
 ****************************************************************/
bool pcal6416a_init(void) {
    int i;

    if ((fd_i2c_expander = open(i2c0_sysfs_filename,O_RDWR)) < 0) {
        printf("Failed to open the I2C bus %s", i2c0_sysfs_filename);
        // ERROR HANDLING; you can check errno to see what went wrong
        return false;
    }

    /// Probing known I2C GPIO expander chips
    for (i = 0, i2c_expander_addr = 0; i2c_chip[i].address; i++) {

        if (ioctl(fd_i2c_expander, I2C_SLAVE_FORCE, i2c_chip[i]) < 0 ||
	    pcal6416a_read_mask_interrupts() < 0) {
            DEBUG_PRINTF("In %s - Failed to acquire bus access and/or talk to slave %s at address 0x%02X.\n",
		   __func__, i2c_chip[i].name, i2c_chip[i].address);
    	} else {
    	    DEBUG_PRINTF("Found I2C gpio expander chip %s at address 0x%02X\n",
    	        i2c_chip[i].name, i2c_chip[i].address);
    	    i2c_expander_addr = i2c_chip[i].address;
            break;
    	}
    }

    /// GPIO expander chip found?
    if(!i2c_expander_addr){
        printf("In %s - Failed to acquire bus access and/or talk to slave, exit\n", __func__);
        return false;
    }

    uint16_t val_enable_direction = 0xffff;
    i2c_smbus_write_word_data ( fd_i2c_expander , PCAL6416A_CONFIG , val_enable_direction );

    uint16_t val_enable_latch = 0x0000;
    i2c_smbus_write_word_data ( fd_i2c_expander , PCAL6416A_INPUT_LATCH , val_enable_latch );

    uint16_t val_enable_pullups = 0xffff;
    i2c_smbus_write_word_data ( fd_i2c_expander , PCAL6416A_EN_PULLUPDOWN , val_enable_pullups );

    uint16_t val_sel_pullups = 0xffff;
    i2c_smbus_write_word_data ( fd_i2c_expander , PCAL6416A_SEL_PULLUPDOWN , val_sel_pullups );

    //uint16_t val_enable_interrupts = 0x0000;
    uint16_t val_enable_interrupts = 0x0320;
 	i2c_smbus_write_word_data ( fd_i2c_expander , PCAL6416A_INT_MASK , val_enable_interrupts );

 	return true;
}

bool pcal6416a_deinit(void) {
    // Close I2C open interface
	close(fd_i2c_expander);
 	return true;
}

int pcal6416a_read_mask_interrupts(void){
	int val_int = i2c_smbus_read_word_data ( fd_i2c_expander , PCAL6416A_INT_STATUS );
    if(val_int < 0){
        return val_int;
    }
    uint16_t val = val_int & 0xFFFF;
 	DEBUG_PRINTF("READ PCAL6416A_INT_STATUS :  0x%04X\n",val);
 	return (int) val;
}

int pcal6416a_read_mask_active_GPIOs(void){
	int val_int = i2c_smbus_read_word_data ( fd_i2c_expander , PCAL6416A_INPUT );
    if(val_int < 0){
        return val_int;
    }
    uint16_t val = val_int & 0xFFFF;
	val = 0xFFFF-val;
 	DEBUG_PRINTF("READ PCAL6416A_INPUT (active GPIOs) :  0x%04X\n",val);
 	return (int) val;
}