Home | History | Annotate | Line # | Download | only in dev
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