drivebay.c revision 1.2 1 1.2 macallan /* $NetBSD: drivebay.c,v 1.2 2025/08/12 06:07:37 macallan Exp $ */
2 1.1 macallan
3 1.1 macallan /*-
4 1.1 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.2 macallan __KERNEL_RCSID(0, "$NetBSD: drivebay.c,v 1.2 2025/08/12 06:07:37 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 #include <sys/sysctl.h>
42 1.1 macallan
43 1.1 macallan #include <dev/ofw/openfirm.h>
44 1.1 macallan #include <dev/i2c/i2cvar.h>
45 1.1 macallan
46 1.1 macallan #ifdef DRIVEBAY_DEBUG
47 1.1 macallan #define DPRINTF printf
48 1.1 macallan #else
49 1.1 macallan #define DPRINTF if (0) printf
50 1.1 macallan #endif
51 1.1 macallan
52 1.1 macallan /* commands */
53 1.1 macallan #define PCAGPIO_INPUT 0x00 /* line status */
54 1.1 macallan #define PCAGPIO_OUTPUT 0x01 /* output status */
55 1.1 macallan #define PCAGPIO_REVERT 0x02 /* revert input if set */
56 1.1 macallan #define PCAGPIO_CONFIG 0x03 /* input if set, output if not */
57 1.1 macallan
58 1.1 macallan #define O_POWER 0x01
59 1.1 macallan #define O_FAIL 0x02
60 1.1 macallan #define O_INUSE 0x04
61 1.1 macallan #define I_PRESENT 0x08
62 1.1 macallan #define I_SWITCH 0x10
63 1.1 macallan #define I_RESET 0x20
64 1.1 macallan #define I_POWER 0x40
65 1.1 macallan #define I_INUSE 0x80
66 1.1 macallan
67 1.1 macallan static int drivebay_match(device_t, cfdata_t, void *);
68 1.1 macallan static void drivebay_attach(device_t, device_t, void *);
69 1.1 macallan static int drivebay_detach(device_t, int);
70 1.1 macallan
71 1.1 macallan struct drivebay_softc {
72 1.1 macallan device_t sc_dev;
73 1.1 macallan i2c_tag_t sc_i2c;
74 1.1 macallan i2c_addr_t sc_addr;
75 1.1 macallan
76 1.1 macallan uint32_t sc_state;
77 1.1 macallan
78 1.1 macallan #ifdef DRIVEBAY_DEBUG
79 1.1 macallan uint32_t sc_dir, sc_in;
80 1.1 macallan #endif
81 1.1 macallan };
82 1.1 macallan
83 1.1 macallan
84 1.1 macallan static void drivebay_writereg(struct drivebay_softc *, int, uint32_t);
85 1.1 macallan static uint32_t drivebay_readreg(struct drivebay_softc *, int);
86 1.1 macallan
87 1.1 macallan static int sysctl_power(SYSCTLFN_ARGS);
88 1.1 macallan static int sysctl_fail(SYSCTLFN_ARGS);
89 1.1 macallan static int sysctl_inuse(SYSCTLFN_ARGS);
90 1.1 macallan static int sysctl_present(SYSCTLFN_ARGS);
91 1.2 macallan static int sysctl_switch(SYSCTLFN_ARGS);
92 1.1 macallan
93 1.1 macallan CFATTACH_DECL_NEW(drivebay, sizeof(struct drivebay_softc),
94 1.1 macallan drivebay_match, drivebay_attach, drivebay_detach, NULL);
95 1.1 macallan
96 1.1 macallan static const struct device_compatible_entry compat_data[] = {
97 1.1 macallan { .compat = "drivebay-i2c-gpio", .value = 0 },
98 1.1 macallan DEVICE_COMPAT_EOL
99 1.1 macallan };
100 1.1 macallan
101 1.1 macallan static int
102 1.1 macallan drivebay_match(device_t parent, cfdata_t match, void *aux)
103 1.1 macallan {
104 1.1 macallan struct i2c_attach_args *ia = aux;
105 1.1 macallan int match_result;
106 1.1 macallan
107 1.1 macallan if (iic_use_direct_match(ia, match, compat_data, &match_result))
108 1.1 macallan return 2 * match_result;
109 1.1 macallan
110 1.1 macallan return 0;
111 1.1 macallan }
112 1.1 macallan
113 1.1 macallan #ifdef DRIVEBAY_DEBUG
114 1.1 macallan static void
115 1.1 macallan printdir(struct drivebay_softc *sc, uint32_t val, uint32_t mask, char letter)
116 1.1 macallan {
117 1.1 macallan char flags[17], bits[17];
118 1.1 macallan uint32_t bit = 0x80;
119 1.1 macallan int i, cnt = 8;
120 1.1 macallan
121 1.1 macallan val &= mask;
122 1.1 macallan for (i = 0; i < cnt; i++) {
123 1.1 macallan flags[i] = (mask & bit) ? letter : '-';
124 1.1 macallan bits[i] = (val & bit) ? 'X' : ' ';
125 1.1 macallan bit = bit >> 1;
126 1.1 macallan }
127 1.1 macallan flags[cnt] = 0;
128 1.1 macallan bits[cnt] = 0;
129 1.1 macallan printf("%s: dir: %s\n", device_xname(sc->sc_dev), flags);
130 1.1 macallan printf("%s: lvl: %s\n", device_xname(sc->sc_dev), bits);
131 1.1 macallan }
132 1.1 macallan #endif
133 1.1 macallan
134 1.1 macallan static void
135 1.1 macallan drivebay_attach(device_t parent, device_t self, void *aux)
136 1.1 macallan {
137 1.1 macallan struct drivebay_softc *sc = device_private(self);
138 1.1 macallan struct i2c_attach_args *ia = aux;
139 1.1 macallan const struct sysctlnode *me = NULL, *node = NULL;
140 1.1 macallan int ret;
141 1.1 macallan
142 1.1 macallan sc->sc_dev = self;
143 1.1 macallan sc->sc_i2c = ia->ia_tag;
144 1.1 macallan sc->sc_addr = ia->ia_addr;
145 1.1 macallan
146 1.1 macallan aprint_naive("\n");
147 1.1 macallan
148 1.1 macallan aprint_normal(": PCA9554\n");
149 1.1 macallan
150 1.1 macallan drivebay_writereg(sc, PCAGPIO_CONFIG, 0xf8);
151 1.1 macallan sc->sc_state = drivebay_readreg(sc, PCAGPIO_OUTPUT);
152 1.1 macallan
153 1.1 macallan ret = sysctl_createv(NULL, 0, NULL, &me,
154 1.1 macallan CTLFLAG_READWRITE,
155 1.1 macallan CTLTYPE_NODE, device_xname(sc->sc_dev), NULL,
156 1.1 macallan NULL, 0, NULL, 0,
157 1.1 macallan CTL_MACHDEP, CTL_CREATE, CTL_EOL);
158 1.1 macallan
159 1.1 macallan ret = sysctl_createv(NULL, 0, NULL, &node,
160 1.1 macallan CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
161 1.1 macallan CTLTYPE_INT, "power", "drive power",
162 1.1 macallan sysctl_power, 1, (void *)sc, 0,
163 1.1 macallan CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
164 1.1 macallan
165 1.1 macallan ret = sysctl_createv(NULL, 0, NULL, &node,
166 1.1 macallan CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
167 1.1 macallan CTLTYPE_INT, "fail", "drive fail LED",
168 1.1 macallan sysctl_fail, 1, (void *)sc, 0,
169 1.1 macallan CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
170 1.1 macallan
171 1.1 macallan ret = sysctl_createv(NULL, 0, NULL, &node,
172 1.1 macallan CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
173 1.1 macallan CTLTYPE_INT, "inuse", "drive in use LED",
174 1.1 macallan sysctl_inuse, 1, (void *)sc, 0,
175 1.1 macallan CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
176 1.1 macallan
177 1.1 macallan ret = sysctl_createv(NULL, 0, NULL, &node,
178 1.2 macallan CTLFLAG_READONLY | CTLFLAG_OWNDESC,
179 1.1 macallan CTLTYPE_INT, "present", "drive present",
180 1.1 macallan sysctl_present, 1, (void *)sc, 0,
181 1.1 macallan CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
182 1.2 macallan
183 1.2 macallan ret = sysctl_createv(NULL, 0, NULL, &node,
184 1.2 macallan CTLFLAG_READONLY | CTLFLAG_OWNDESC,
185 1.2 macallan CTLTYPE_INT, "switch", "drive switch",
186 1.2 macallan sysctl_switch, 1, (void *)sc, 0,
187 1.2 macallan CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
188 1.1 macallan __USE(ret);
189 1.1 macallan
190 1.1 macallan #ifdef DRIVEBAY_DEBUG
191 1.1 macallan uint32_t in, out;
192 1.1 macallan sc->sc_dir = drivebay_readreg(sc, PCAGPIO_CONFIG);
193 1.1 macallan sc->sc_in = drivebay_readreg(sc, PCAGPIO_INPUT);
194 1.1 macallan in = sc->sc_in;
195 1.1 macallan out = sc->sc_state;
196 1.1 macallan
197 1.1 macallan out &= ~sc->sc_dir;
198 1.1 macallan in &= sc->sc_dir;
199 1.1 macallan
200 1.1 macallan printdir(sc, in, sc->sc_dir, 'I');
201 1.1 macallan printdir(sc, out, ~sc->sc_dir, 'O');
202 1.1 macallan
203 1.1 macallan #endif
204 1.1 macallan }
205 1.1 macallan
206 1.1 macallan static int
207 1.1 macallan drivebay_detach(device_t self, int flags)
208 1.1 macallan {
209 1.1 macallan return 0;
210 1.1 macallan }
211 1.1 macallan
212 1.1 macallan static void
213 1.1 macallan drivebay_writereg(struct drivebay_softc *sc, int reg, uint32_t val)
214 1.1 macallan {
215 1.1 macallan uint8_t cmd;
216 1.1 macallan uint8_t creg;
217 1.1 macallan
218 1.1 macallan iic_acquire_bus(sc->sc_i2c, 0);
219 1.1 macallan cmd = reg;
220 1.1 macallan creg = (uint8_t)val;
221 1.1 macallan iic_exec(sc->sc_i2c, I2C_OP_WRITE_WITH_STOP,
222 1.1 macallan sc->sc_addr, &cmd, 1, &creg, 1, 0);
223 1.1 macallan if (reg == PCAGPIO_OUTPUT) sc->sc_state = val;
224 1.1 macallan iic_release_bus(sc->sc_i2c, 0);
225 1.1 macallan }
226 1.1 macallan
227 1.1 macallan static uint32_t
228 1.1 macallan drivebay_readreg(struct drivebay_softc *sc, int reg)
229 1.1 macallan {
230 1.1 macallan uint8_t cmd;
231 1.1 macallan uint8_t creg;
232 1.1 macallan uint32_t ret;
233 1.1 macallan
234 1.1 macallan iic_acquire_bus(sc->sc_i2c, 0);
235 1.1 macallan cmd = reg;
236 1.1 macallan iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP,
237 1.1 macallan sc->sc_addr, &cmd, 1, &creg, 1, 0);
238 1.1 macallan ret = creg;
239 1.1 macallan iic_release_bus(sc->sc_i2c, 0);
240 1.1 macallan return ret;
241 1.1 macallan }
242 1.1 macallan
243 1.1 macallan static int
244 1.1 macallan sysctl_power(SYSCTLFN_ARGS)
245 1.1 macallan {
246 1.1 macallan struct sysctlnode node = *rnode;
247 1.1 macallan struct drivebay_softc *sc = node.sysctl_data;
248 1.1 macallan int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
249 1.1 macallan int power = (reg & I_POWER) != 0;
250 1.1 macallan
251 1.1 macallan if (newp) {
252 1.1 macallan /* we're asked to write */
253 1.1 macallan node.sysctl_data = &power;
254 1.1 macallan if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
255 1.1 macallan
256 1.1 macallan power = *(int *)node.sysctl_data;
257 1.1 macallan reg = sc->sc_state;
258 1.1 macallan if (power != 0) reg |= O_POWER;
259 1.1 macallan else reg &= ~O_POWER;
260 1.1 macallan
261 1.1 macallan if (reg != sc->sc_state) {
262 1.1 macallan drivebay_writereg(sc, PCAGPIO_OUTPUT, reg);
263 1.1 macallan sc->sc_state = reg;
264 1.1 macallan }
265 1.1 macallan return 0;
266 1.1 macallan }
267 1.1 macallan return EINVAL;
268 1.1 macallan } else {
269 1.1 macallan
270 1.1 macallan node.sysctl_data = &power;
271 1.1 macallan node.sysctl_size = 4;
272 1.1 macallan return (sysctl_lookup(SYSCTLFN_CALL(&node)));
273 1.1 macallan }
274 1.1 macallan
275 1.1 macallan return 0;
276 1.1 macallan }
277 1.1 macallan
278 1.1 macallan static int
279 1.1 macallan sysctl_inuse(SYSCTLFN_ARGS)
280 1.1 macallan {
281 1.1 macallan struct sysctlnode node = *rnode;
282 1.1 macallan struct drivebay_softc *sc = node.sysctl_data;
283 1.1 macallan int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
284 1.1 macallan int inuse = (reg & I_INUSE) != 0;
285 1.1 macallan
286 1.1 macallan if (newp) {
287 1.1 macallan /* we're asked to write */
288 1.1 macallan node.sysctl_data = &inuse;
289 1.1 macallan if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
290 1.1 macallan
291 1.1 macallan inuse = *(int *)node.sysctl_data;
292 1.1 macallan reg = sc->sc_state;
293 1.1 macallan if (inuse != 0) reg |= O_INUSE;
294 1.1 macallan else reg &= ~O_INUSE;
295 1.1 macallan
296 1.1 macallan if (reg != sc->sc_state) {
297 1.1 macallan drivebay_writereg(sc, PCAGPIO_OUTPUT, reg);
298 1.1 macallan sc->sc_state = reg;
299 1.1 macallan }
300 1.1 macallan return 0;
301 1.1 macallan }
302 1.1 macallan return EINVAL;
303 1.1 macallan } else {
304 1.1 macallan
305 1.1 macallan node.sysctl_data = &inuse;
306 1.1 macallan node.sysctl_size = 4;
307 1.1 macallan return (sysctl_lookup(SYSCTLFN_CALL(&node)));
308 1.1 macallan }
309 1.1 macallan
310 1.1 macallan return 0;
311 1.1 macallan }
312 1.1 macallan
313 1.1 macallan static int
314 1.1 macallan sysctl_fail(SYSCTLFN_ARGS)
315 1.1 macallan {
316 1.1 macallan struct sysctlnode node = *rnode;
317 1.1 macallan struct drivebay_softc *sc = node.sysctl_data;
318 1.1 macallan int reg = sc->sc_state;
319 1.1 macallan int fail = (reg & O_FAIL) != 0;
320 1.1 macallan
321 1.1 macallan if (newp) {
322 1.1 macallan /* we're asked to write */
323 1.1 macallan node.sysctl_data = &fail;
324 1.1 macallan if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
325 1.1 macallan
326 1.1 macallan fail = *(int *)node.sysctl_data;
327 1.1 macallan reg = sc->sc_state;
328 1.1 macallan if (fail != 0) reg |= O_FAIL;
329 1.1 macallan else reg &= ~O_FAIL;
330 1.1 macallan
331 1.1 macallan if (reg != sc->sc_state) {
332 1.1 macallan drivebay_writereg(sc, PCAGPIO_OUTPUT, reg);
333 1.1 macallan sc->sc_state = reg;
334 1.1 macallan }
335 1.1 macallan return 0;
336 1.1 macallan }
337 1.1 macallan return EINVAL;
338 1.1 macallan } else {
339 1.1 macallan
340 1.1 macallan node.sysctl_data = &fail;
341 1.1 macallan node.sysctl_size = 4;
342 1.1 macallan return (sysctl_lookup(SYSCTLFN_CALL(&node)));
343 1.1 macallan }
344 1.1 macallan
345 1.1 macallan return 0;
346 1.1 macallan }
347 1.1 macallan
348 1.1 macallan static int
349 1.1 macallan sysctl_present(SYSCTLFN_ARGS)
350 1.1 macallan {
351 1.1 macallan struct sysctlnode node = *rnode;
352 1.1 macallan struct drivebay_softc *sc = node.sysctl_data;
353 1.1 macallan int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
354 1.1 macallan int present = (reg & I_PRESENT) == 0;
355 1.1 macallan
356 1.1 macallan if (newp) {
357 1.1 macallan /* we're asked to write */
358 1.1 macallan return EINVAL;
359 1.1 macallan } else {
360 1.1 macallan
361 1.1 macallan node.sysctl_data = &present;
362 1.1 macallan node.sysctl_size = 4;
363 1.1 macallan return (sysctl_lookup(SYSCTLFN_CALL(&node)));
364 1.1 macallan }
365 1.1 macallan
366 1.1 macallan return 0;
367 1.1 macallan }
368 1.2 macallan
369 1.2 macallan static int
370 1.2 macallan sysctl_switch(SYSCTLFN_ARGS)
371 1.2 macallan {
372 1.2 macallan struct sysctlnode node = *rnode;
373 1.2 macallan struct drivebay_softc *sc = node.sysctl_data;
374 1.2 macallan int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
375 1.2 macallan int sw = (reg & I_SWITCH) == 0;
376 1.2 macallan
377 1.2 macallan if (newp) {
378 1.2 macallan /* we're asked to write */
379 1.2 macallan return EINVAL;
380 1.2 macallan } else {
381 1.2 macallan
382 1.2 macallan node.sysctl_data = &sw;
383 1.2 macallan node.sysctl_size = 4;
384 1.2 macallan return (sysctl_lookup(SYSCTLFN_CALL(&node)));
385 1.2 macallan }
386 1.2 macallan
387 1.2 macallan return 0;
388 1.2 macallan }
389