pcagpio.c revision 1.3 1 1.3 macallan /* $NetBSD: pcagpio.c,v 1.3 2020/02/02 06:43:14 macallan Exp $ */
2 1.1 macallan
3 1.1 macallan /*-
4 1.2 macallan * Copyright (c) 2020 Michael Lorenz
5 1.1 macallan * All rights reserved.
6 1.1 macallan *
7 1.1 macallan * Redistribution and use in source and binary forms, with or without
8 1.1 macallan * modification, are permitted provided that the following conditions
9 1.1 macallan * are met:
10 1.1 macallan * 1. Redistributions of source code must retain the above copyright
11 1.1 macallan * notice, this list of conditions and the following disclaimer.
12 1.1 macallan * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 macallan * notice, this list of conditions and the following disclaimer in the
14 1.1 macallan * documentation and/or other materials provided with the distribution.
15 1.1 macallan *
16 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.1 macallan * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.1 macallan * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.1 macallan * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.1 macallan * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.1 macallan * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.1 macallan * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.1 macallan * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.1 macallan * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.1 macallan * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.1 macallan * POSSIBILITY OF SUCH DAMAGE.
27 1.1 macallan */
28 1.1 macallan
29 1.1 macallan /*
30 1.1 macallan * a driver for Philips Semiconductor PCA9555 GPIO controllers
31 1.1 macallan */
32 1.1 macallan
33 1.1 macallan #include <sys/cdefs.h>
34 1.3 macallan __KERNEL_RCSID(0, "$NetBSD: pcagpio.c,v 1.3 2020/02/02 06:43:14 macallan Exp $");
35 1.1 macallan
36 1.1 macallan #include <sys/param.h>
37 1.1 macallan #include <sys/systm.h>
38 1.1 macallan #include <sys/device.h>
39 1.1 macallan #include <sys/conf.h>
40 1.1 macallan #include <sys/bus.h>
41 1.1 macallan
42 1.1 macallan #include <dev/i2c/i2cvar.h>
43 1.2 macallan #include <dev/led.h>
44 1.2 macallan
45 1.2 macallan #ifdef PCAGPIO_DEBUG
46 1.2 macallan #define DPRINTF printf
47 1.2 macallan #else
48 1.2 macallan #define DPRINTF if (0) printf
49 1.2 macallan #endif
50 1.1 macallan
51 1.1 macallan /* commands */
52 1.1 macallan #define PCAGPIO_INPUT 0x00 /* line status */
53 1.1 macallan #define PCAGPIO_OUTPUT 0x01 /* output status */
54 1.1 macallan #define PCAGPIO_REVERT 0x02 /* revert input if set */
55 1.1 macallan #define PCAGPIO_CONFIG 0x03 /* input if set, output if not */
56 1.1 macallan
57 1.1 macallan static int pcagpio_match(device_t, cfdata_t, void *);
58 1.1 macallan static void pcagpio_attach(device_t, device_t, void *);
59 1.1 macallan
60 1.2 macallan /* we can only pass one cookie to led_attach() but we need several values... */
61 1.2 macallan struct pcagpio_led {
62 1.2 macallan void *cookie;
63 1.2 macallan uint32_t mask, v_on, v_off;
64 1.2 macallan };
65 1.2 macallan
66 1.1 macallan struct pcagpio_softc {
67 1.1 macallan device_t sc_dev;
68 1.1 macallan i2c_tag_t sc_i2c;
69 1.1 macallan i2c_addr_t sc_addr;
70 1.1 macallan
71 1.1 macallan int sc_is_16bit;
72 1.2 macallan uint32_t sc_state;
73 1.2 macallan struct pcagpio_led sc_leds[16];
74 1.2 macallan int sc_nleds;
75 1.1 macallan };
76 1.1 macallan
77 1.1 macallan
78 1.1 macallan static void pcagpio_writereg(struct pcagpio_softc *, int, uint32_t);
79 1.1 macallan static uint32_t pcagpio_readreg(struct pcagpio_softc *, int);
80 1.3 macallan static void pcagpio_attach_led(
81 1.3 macallan struct pcagpio_softc *, char *, int, int, int);
82 1.2 macallan static int pcagpio_get(void *);
83 1.2 macallan static void pcagpio_set(void *, int);
84 1.1 macallan
85 1.1 macallan CFATTACH_DECL_NEW(pcagpio, sizeof(struct pcagpio_softc),
86 1.1 macallan pcagpio_match, pcagpio_attach, NULL, NULL);
87 1.1 macallan
88 1.1 macallan static const struct device_compatible_entry compat_data[] = {
89 1.1 macallan { "i2c-pca9555", 1 },
90 1.1 macallan { "pca9555", 1 },
91 1.1 macallan { "i2c-pca9556", 0 },
92 1.1 macallan { "pca9556", 0 },
93 1.1 macallan { NULL, 0 }
94 1.1 macallan };
95 1.1 macallan
96 1.1 macallan static int
97 1.1 macallan pcagpio_match(device_t parent, cfdata_t match, void *aux)
98 1.1 macallan {
99 1.1 macallan struct i2c_attach_args *ia = aux;
100 1.1 macallan int match_result;
101 1.1 macallan
102 1.1 macallan if (iic_use_direct_match(ia, match, compat_data, &match_result))
103 1.1 macallan return match_result;
104 1.1 macallan
105 1.1 macallan return 0;
106 1.1 macallan }
107 1.1 macallan
108 1.2 macallan #ifdef PCAGPIO_DEBUG
109 1.1 macallan static void
110 1.1 macallan printdir(uint32_t val, uint32_t mask, char letter)
111 1.1 macallan {
112 1.1 macallan char flags[17], bits[17];
113 1.1 macallan uint32_t bit = 0x8000;
114 1.1 macallan int i;
115 1.1 macallan
116 1.1 macallan val &= mask;
117 1.1 macallan for (i = 0; i < 16; i++) {
118 1.1 macallan flags[i] = (mask & bit) ? letter : '-';
119 1.1 macallan bits[i] = (val & bit) ? 'X' : ' ';
120 1.1 macallan bit = bit >> 1;
121 1.1 macallan }
122 1.1 macallan flags[16] = 0;
123 1.1 macallan bits[16] = 0;
124 1.1 macallan printf("dir: %s\n", flags);
125 1.1 macallan printf("lvl: %s\n", bits);
126 1.1 macallan }
127 1.2 macallan #endif
128 1.1 macallan
129 1.1 macallan static void
130 1.1 macallan pcagpio_attach(device_t parent, device_t self, void *aux)
131 1.1 macallan {
132 1.1 macallan struct pcagpio_softc *sc = device_private(self);
133 1.1 macallan struct i2c_attach_args *ia = aux;
134 1.1 macallan const struct device_compatible_entry *dce;
135 1.2 macallan prop_dictionary_t dict = device_properties(self);
136 1.2 macallan prop_array_t pins;
137 1.2 macallan prop_dictionary_t pin;
138 1.1 macallan
139 1.1 macallan sc->sc_dev = self;
140 1.1 macallan sc->sc_i2c = ia->ia_tag;
141 1.1 macallan sc->sc_addr = ia->ia_addr;
142 1.2 macallan sc->sc_nleds = 0;
143 1.1 macallan
144 1.1 macallan aprint_naive("\n");
145 1.1 macallan sc->sc_is_16bit = 0;
146 1.1 macallan if (iic_compatible_match(ia, compat_data, &dce))
147 1.1 macallan sc->sc_is_16bit = dce->data;
148 1.1 macallan
149 1.1 macallan aprint_normal(": %s\n", sc->sc_is_16bit ? "PCA9555" : "PCA9556");
150 1.1 macallan
151 1.2 macallan sc->sc_state = pcagpio_readreg(sc, PCAGPIO_OUTPUT);
152 1.2 macallan
153 1.2 macallan #ifdef PCAGPIO_DEBUG
154 1.2 macallan uint32_t dir, in, out;
155 1.2 macallan dir = pcagpio_readreg(sc, PCAGPIO_CONFIG);
156 1.2 macallan in = pcagpio_readreg(sc, PCAGPIO_INPUT);
157 1.2 macallan out = sc->sc_state;
158 1.1 macallan
159 1.1 macallan out &= ~dir;
160 1.1 macallan in &= dir;
161 1.1 macallan
162 1.1 macallan printdir(in, dir, 'I');
163 1.1 macallan printdir(out, ~dir, 'O');
164 1.2 macallan #endif
165 1.2 macallan
166 1.2 macallan pins = prop_dictionary_get(dict, "pins");
167 1.2 macallan if (pins != NULL) {
168 1.2 macallan int i, num, def;
169 1.2 macallan char name[32];
170 1.2 macallan const char *nptr;
171 1.2 macallan bool ok = TRUE, act;
172 1.2 macallan
173 1.2 macallan for (i = 0; i < prop_array_count(pins); i++) {
174 1.2 macallan nptr = NULL;
175 1.2 macallan pin = prop_array_get(pins, i);
176 1.3 macallan ok &= prop_dictionary_get_cstring_nocopy(pin, "name",
177 1.3 macallan &nptr);
178 1.2 macallan strncpy(name, nptr, 31);
179 1.2 macallan ok &= prop_dictionary_get_uint32(pin, "pin", &num);
180 1.3 macallan ok &= prop_dictionary_get_bool(
181 1.3 macallan pin, "active_high", &act);
182 1.2 macallan /* optional default state */
183 1.2 macallan def = -1;
184 1.2 macallan prop_dictionary_get_int32(pin, "default_state", &def);
185 1.2 macallan if (ok) {
186 1.2 macallan pcagpio_attach_led(sc, name, num, act, def);
187 1.2 macallan }
188 1.2 macallan }
189 1.2 macallan }
190 1.1 macallan }
191 1.1 macallan
192 1.1 macallan static void
193 1.1 macallan pcagpio_writereg(struct pcagpio_softc *sc, int reg, uint32_t val)
194 1.1 macallan {
195 1.1 macallan uint8_t cmd;
196 1.1 macallan
197 1.1 macallan iic_acquire_bus(sc->sc_i2c, 0);
198 1.1 macallan if (sc->sc_is_16bit) {
199 1.1 macallan uint16_t creg;
200 1.1 macallan cmd = reg << 1;
201 1.1 macallan creg = htole16(val);
202 1.1 macallan iic_exec(sc->sc_i2c, I2C_OP_WRITE_WITH_STOP,
203 1.1 macallan sc->sc_addr, &cmd, 1, &creg, 2, 0);
204 1.1 macallan } else {
205 1.1 macallan uint8_t creg;
206 1.1 macallan cmd = reg;
207 1.1 macallan creg = (uint8_t)val;
208 1.1 macallan iic_exec(sc->sc_i2c, I2C_OP_WRITE_WITH_STOP,
209 1.1 macallan sc->sc_addr, &cmd, 1, &creg, 1, 0);
210 1.1 macallan }
211 1.2 macallan if (reg == PCAGPIO_OUTPUT) sc->sc_state = val;
212 1.1 macallan iic_release_bus(sc->sc_i2c, 0);
213 1.1 macallan }
214 1.1 macallan
215 1.1 macallan static uint32_t pcagpio_readreg(struct pcagpio_softc *sc, int reg)
216 1.1 macallan {
217 1.1 macallan uint8_t cmd;
218 1.1 macallan uint32_t ret;
219 1.1 macallan
220 1.1 macallan iic_acquire_bus(sc->sc_i2c, 0);
221 1.1 macallan if (sc->sc_is_16bit) {
222 1.1 macallan uint16_t creg;
223 1.1 macallan cmd = reg << 1;
224 1.1 macallan iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP,
225 1.1 macallan sc->sc_addr, &cmd, 1, &creg, 2, 0);
226 1.1 macallan ret = le16toh(creg);
227 1.1 macallan } else {
228 1.1 macallan uint8_t creg;
229 1.1 macallan cmd = reg;
230 1.1 macallan iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP,
231 1.1 macallan sc->sc_addr, &cmd, 1, &creg, 1, 0);
232 1.1 macallan ret = creg;
233 1.1 macallan }
234 1.1 macallan iic_release_bus(sc->sc_i2c, 0);
235 1.1 macallan return ret;
236 1.1 macallan }
237 1.2 macallan
238 1.2 macallan static void
239 1.2 macallan pcagpio_attach_led(struct pcagpio_softc *sc, char *n, int pin, int act, int def)
240 1.2 macallan {
241 1.2 macallan struct pcagpio_led *l;
242 1.2 macallan
243 1.2 macallan l = &sc->sc_leds[sc->sc_nleds];
244 1.2 macallan l->cookie = sc;
245 1.2 macallan l->mask = 1 << pin;
246 1.2 macallan l->v_on = act ? l->mask : 0;
247 1.2 macallan l->v_off = act ? 0 : l->mask;
248 1.2 macallan led_attach(n, l, pcagpio_get, pcagpio_set);
249 1.2 macallan if (def != -1) pcagpio_set(l, def);
250 1.3 macallan DPRINTF("%s: %04x %04x %04x def %d\n",
251 1.3 macallan __func__, l->mask, l->v_on, l->v_off, def);
252 1.2 macallan sc->sc_nleds++;
253 1.2 macallan }
254 1.2 macallan
255 1.2 macallan static int
256 1.2 macallan pcagpio_get(void *cookie)
257 1.2 macallan {
258 1.2 macallan struct pcagpio_led *l = cookie;
259 1.2 macallan struct pcagpio_softc *sc = l->cookie;
260 1.2 macallan
261 1.2 macallan return ((sc->sc_state & l->mask) == l->v_on);
262 1.2 macallan }
263 1.2 macallan
264 1.2 macallan static void
265 1.2 macallan pcagpio_set(void *cookie, int val)
266 1.2 macallan {
267 1.2 macallan struct pcagpio_led *l = cookie;
268 1.2 macallan struct pcagpio_softc *sc = l->cookie;
269 1.2 macallan uint32_t newstate;
270 1.2 macallan
271 1.2 macallan newstate = sc->sc_state & ~l->mask;
272 1.2 macallan newstate |= val ? l->v_on : l->v_off;
273 1.2 macallan DPRINTF("%s: %04x -> %04x, %04x %04x %04x\n", __func__,
274 1.2 macallan sc->sc_state, newstate, l->mask, l->v_on, l->v_off);
275 1.2 macallan if (newstate != sc->sc_state)
276 1.2 macallan pcagpio_writereg(sc, PCAGPIO_OUTPUT, newstate);
277 1.2 macallan }
278