Home | History | Annotate | Line # | Download | only in dev
drivebay.c revision 1.1
      1  1.1  macallan /* $NetBSD: drivebay.c,v 1.1 2025/08/12 05:47:36 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.1  macallan __KERNEL_RCSID(0, "$NetBSD: drivebay.c,v 1.1 2025/08/12 05:47:36 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.1  macallan 
     92  1.1  macallan CFATTACH_DECL_NEW(drivebay, sizeof(struct drivebay_softc),
     93  1.1  macallan     drivebay_match, drivebay_attach, drivebay_detach, NULL);
     94  1.1  macallan 
     95  1.1  macallan static const struct device_compatible_entry compat_data[] = {
     96  1.1  macallan 	{ .compat = "drivebay-i2c-gpio",	.value = 0 },
     97  1.1  macallan 	DEVICE_COMPAT_EOL
     98  1.1  macallan };
     99  1.1  macallan 
    100  1.1  macallan static int
    101  1.1  macallan drivebay_match(device_t parent, cfdata_t match, void *aux)
    102  1.1  macallan {
    103  1.1  macallan 	struct i2c_attach_args *ia = aux;
    104  1.1  macallan 	int match_result;
    105  1.1  macallan 
    106  1.1  macallan 	if (iic_use_direct_match(ia, match, compat_data, &match_result))
    107  1.1  macallan 		return 2 * match_result;
    108  1.1  macallan 
    109  1.1  macallan 	return 0;
    110  1.1  macallan }
    111  1.1  macallan 
    112  1.1  macallan #ifdef DRIVEBAY_DEBUG
    113  1.1  macallan static void
    114  1.1  macallan printdir(struct drivebay_softc *sc, uint32_t val, uint32_t mask, char letter)
    115  1.1  macallan {
    116  1.1  macallan 	char flags[17], bits[17];
    117  1.1  macallan 	uint32_t bit = 0x80;
    118  1.1  macallan 	int i, cnt = 8;
    119  1.1  macallan 
    120  1.1  macallan 	val &= mask;
    121  1.1  macallan 	for (i = 0; i < cnt; i++) {
    122  1.1  macallan 		flags[i] = (mask & bit) ? letter : '-';
    123  1.1  macallan 		bits[i] = (val & bit) ? 'X' : ' ';
    124  1.1  macallan 		bit = bit >> 1;
    125  1.1  macallan 	}
    126  1.1  macallan 	flags[cnt] = 0;
    127  1.1  macallan 	bits[cnt] = 0;
    128  1.1  macallan 	printf("%s: dir: %s\n", device_xname(sc->sc_dev), flags);
    129  1.1  macallan 	printf("%s: lvl: %s\n", device_xname(sc->sc_dev), bits);
    130  1.1  macallan }
    131  1.1  macallan #endif
    132  1.1  macallan 
    133  1.1  macallan static void
    134  1.1  macallan drivebay_attach(device_t parent, device_t self, void *aux)
    135  1.1  macallan {
    136  1.1  macallan 	struct drivebay_softc *sc = device_private(self);
    137  1.1  macallan 	struct i2c_attach_args *ia = aux;
    138  1.1  macallan 	const struct sysctlnode *me = NULL, *node = NULL;
    139  1.1  macallan 	int ret;
    140  1.1  macallan 
    141  1.1  macallan 	sc->sc_dev = self;
    142  1.1  macallan 	sc->sc_i2c = ia->ia_tag;
    143  1.1  macallan 	sc->sc_addr = ia->ia_addr;
    144  1.1  macallan 
    145  1.1  macallan 	aprint_naive("\n");
    146  1.1  macallan 
    147  1.1  macallan 	aprint_normal(": PCA9554\n");
    148  1.1  macallan 
    149  1.1  macallan 	drivebay_writereg(sc, PCAGPIO_CONFIG, 0xf8);
    150  1.1  macallan 	sc->sc_state = drivebay_readreg(sc, PCAGPIO_OUTPUT);
    151  1.1  macallan 
    152  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &me,
    153  1.1  macallan 	    CTLFLAG_READWRITE,
    154  1.1  macallan 	    CTLTYPE_NODE, device_xname(sc->sc_dev), NULL,
    155  1.1  macallan 	    NULL, 0, NULL, 0,
    156  1.1  macallan 	    CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    157  1.1  macallan 
    158  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    159  1.1  macallan 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    160  1.1  macallan 	    CTLTYPE_INT, "power", "drive power",
    161  1.1  macallan 	    sysctl_power, 1, (void *)sc, 0,
    162  1.1  macallan 	    CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
    163  1.1  macallan 
    164  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    165  1.1  macallan 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    166  1.1  macallan 	    CTLTYPE_INT, "fail", "drive fail LED",
    167  1.1  macallan 	    sysctl_fail, 1, (void *)sc, 0,
    168  1.1  macallan 	    CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
    169  1.1  macallan 
    170  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    171  1.1  macallan 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    172  1.1  macallan 	    CTLTYPE_INT, "inuse", "drive in use LED",
    173  1.1  macallan 	    sysctl_inuse, 1, (void *)sc, 0,
    174  1.1  macallan 	    CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
    175  1.1  macallan 
    176  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    177  1.1  macallan 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    178  1.1  macallan 	    CTLTYPE_INT, "present", "drive present",
    179  1.1  macallan 	    sysctl_present, 1, (void *)sc, 0,
    180  1.1  macallan 	    CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
    181  1.1  macallan 	__USE(ret);
    182  1.1  macallan 
    183  1.1  macallan #ifdef DRIVEBAY_DEBUG
    184  1.1  macallan 	uint32_t in, out;
    185  1.1  macallan 	sc->sc_dir = drivebay_readreg(sc, PCAGPIO_CONFIG);
    186  1.1  macallan 	sc->sc_in = drivebay_readreg(sc, PCAGPIO_INPUT);
    187  1.1  macallan 	in = sc->sc_in;
    188  1.1  macallan 	out = sc->sc_state;
    189  1.1  macallan 
    190  1.1  macallan 	out &= ~sc->sc_dir;
    191  1.1  macallan 	in &= sc->sc_dir;
    192  1.1  macallan 
    193  1.1  macallan 	printdir(sc, in, sc->sc_dir, 'I');
    194  1.1  macallan 	printdir(sc, out, ~sc->sc_dir, 'O');
    195  1.1  macallan 
    196  1.1  macallan #endif
    197  1.1  macallan }
    198  1.1  macallan 
    199  1.1  macallan static int
    200  1.1  macallan drivebay_detach(device_t self, int flags)
    201  1.1  macallan {
    202  1.1  macallan 	return 0;
    203  1.1  macallan }
    204  1.1  macallan 
    205  1.1  macallan static void
    206  1.1  macallan drivebay_writereg(struct drivebay_softc *sc, int reg, uint32_t val)
    207  1.1  macallan {
    208  1.1  macallan 	uint8_t cmd;
    209  1.1  macallan 	uint8_t creg;
    210  1.1  macallan 
    211  1.1  macallan 	iic_acquire_bus(sc->sc_i2c, 0);
    212  1.1  macallan 	cmd = reg;
    213  1.1  macallan 	creg = (uint8_t)val;
    214  1.1  macallan 	iic_exec(sc->sc_i2c, I2C_OP_WRITE_WITH_STOP,
    215  1.1  macallan 		    sc->sc_addr, &cmd, 1, &creg, 1, 0);
    216  1.1  macallan 	if (reg == PCAGPIO_OUTPUT) sc->sc_state = val;
    217  1.1  macallan 	iic_release_bus(sc->sc_i2c, 0);
    218  1.1  macallan }
    219  1.1  macallan 
    220  1.1  macallan static uint32_t
    221  1.1  macallan drivebay_readreg(struct drivebay_softc *sc, int reg)
    222  1.1  macallan {
    223  1.1  macallan 	uint8_t cmd;
    224  1.1  macallan 	uint8_t creg;
    225  1.1  macallan 	uint32_t ret;
    226  1.1  macallan 
    227  1.1  macallan 	iic_acquire_bus(sc->sc_i2c, 0);
    228  1.1  macallan 	cmd = reg;
    229  1.1  macallan 	iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP,
    230  1.1  macallan 		    sc->sc_addr, &cmd, 1, &creg, 1, 0);
    231  1.1  macallan 	ret = creg;
    232  1.1  macallan 	iic_release_bus(sc->sc_i2c, 0);
    233  1.1  macallan 	return ret;
    234  1.1  macallan }
    235  1.1  macallan 
    236  1.1  macallan static int
    237  1.1  macallan sysctl_power(SYSCTLFN_ARGS)
    238  1.1  macallan {
    239  1.1  macallan 	struct sysctlnode node = *rnode;
    240  1.1  macallan 	struct drivebay_softc *sc = node.sysctl_data;
    241  1.1  macallan 	int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
    242  1.1  macallan 	int power = (reg & I_POWER) != 0;
    243  1.1  macallan 
    244  1.1  macallan 	if (newp) {
    245  1.1  macallan 		/* we're asked to write */
    246  1.1  macallan 		node.sysctl_data = &power;
    247  1.1  macallan 		if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    248  1.1  macallan 
    249  1.1  macallan 			power = *(int *)node.sysctl_data;
    250  1.1  macallan 			reg = sc->sc_state;
    251  1.1  macallan 			if (power != 0) reg |= O_POWER;
    252  1.1  macallan 			else reg &= ~O_POWER;
    253  1.1  macallan 
    254  1.1  macallan 			if (reg != sc->sc_state) {
    255  1.1  macallan 				drivebay_writereg(sc, PCAGPIO_OUTPUT, reg);
    256  1.1  macallan 				sc->sc_state = reg;
    257  1.1  macallan 			}
    258  1.1  macallan 			return 0;
    259  1.1  macallan 		}
    260  1.1  macallan 		return EINVAL;
    261  1.1  macallan 	} else {
    262  1.1  macallan 
    263  1.1  macallan 		node.sysctl_data = &power;
    264  1.1  macallan 		node.sysctl_size = 4;
    265  1.1  macallan 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    266  1.1  macallan 	}
    267  1.1  macallan 
    268  1.1  macallan 	return 0;
    269  1.1  macallan }
    270  1.1  macallan 
    271  1.1  macallan static int
    272  1.1  macallan sysctl_inuse(SYSCTLFN_ARGS)
    273  1.1  macallan {
    274  1.1  macallan 	struct sysctlnode node = *rnode;
    275  1.1  macallan 	struct drivebay_softc *sc = node.sysctl_data;
    276  1.1  macallan 	int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
    277  1.1  macallan 	int inuse = (reg & I_INUSE) != 0;
    278  1.1  macallan 
    279  1.1  macallan 	if (newp) {
    280  1.1  macallan 		/* we're asked to write */
    281  1.1  macallan 		node.sysctl_data = &inuse;
    282  1.1  macallan 		if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    283  1.1  macallan 
    284  1.1  macallan 			inuse = *(int *)node.sysctl_data;
    285  1.1  macallan 			reg = sc->sc_state;
    286  1.1  macallan 			if (inuse != 0) reg |= O_INUSE;
    287  1.1  macallan 			else reg &= ~O_INUSE;
    288  1.1  macallan 
    289  1.1  macallan 			if (reg != sc->sc_state) {
    290  1.1  macallan 				drivebay_writereg(sc, PCAGPIO_OUTPUT, reg);
    291  1.1  macallan 				sc->sc_state = reg;
    292  1.1  macallan 			}
    293  1.1  macallan 			return 0;
    294  1.1  macallan 		}
    295  1.1  macallan 		return EINVAL;
    296  1.1  macallan 	} else {
    297  1.1  macallan 
    298  1.1  macallan 		node.sysctl_data = &inuse;
    299  1.1  macallan 		node.sysctl_size = 4;
    300  1.1  macallan 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    301  1.1  macallan 	}
    302  1.1  macallan 
    303  1.1  macallan 	return 0;
    304  1.1  macallan }
    305  1.1  macallan 
    306  1.1  macallan static int
    307  1.1  macallan sysctl_fail(SYSCTLFN_ARGS)
    308  1.1  macallan {
    309  1.1  macallan 	struct sysctlnode node = *rnode;
    310  1.1  macallan 	struct drivebay_softc *sc = node.sysctl_data;
    311  1.1  macallan 	int reg = sc->sc_state;
    312  1.1  macallan 	int fail = (reg & O_FAIL) != 0;
    313  1.1  macallan 
    314  1.1  macallan 	if (newp) {
    315  1.1  macallan 		/* we're asked to write */
    316  1.1  macallan 		node.sysctl_data = &fail;
    317  1.1  macallan 		if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    318  1.1  macallan 
    319  1.1  macallan 			fail = *(int *)node.sysctl_data;
    320  1.1  macallan 			reg = sc->sc_state;
    321  1.1  macallan 			if (fail != 0) reg |= O_FAIL;
    322  1.1  macallan 			else reg &= ~O_FAIL;
    323  1.1  macallan 
    324  1.1  macallan 			if (reg != sc->sc_state) {
    325  1.1  macallan 				drivebay_writereg(sc, PCAGPIO_OUTPUT, reg);
    326  1.1  macallan 				sc->sc_state = reg;
    327  1.1  macallan 			}
    328  1.1  macallan 			return 0;
    329  1.1  macallan 		}
    330  1.1  macallan 		return EINVAL;
    331  1.1  macallan 	} else {
    332  1.1  macallan 
    333  1.1  macallan 		node.sysctl_data = &fail;
    334  1.1  macallan 		node.sysctl_size = 4;
    335  1.1  macallan 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    336  1.1  macallan 	}
    337  1.1  macallan 
    338  1.1  macallan 	return 0;
    339  1.1  macallan }
    340  1.1  macallan 
    341  1.1  macallan static int
    342  1.1  macallan sysctl_present(SYSCTLFN_ARGS)
    343  1.1  macallan {
    344  1.1  macallan 	struct sysctlnode node = *rnode;
    345  1.1  macallan 	struct drivebay_softc *sc = node.sysctl_data;
    346  1.1  macallan 	int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
    347  1.1  macallan 	int present = (reg & I_PRESENT) == 0;
    348  1.1  macallan 
    349  1.1  macallan 	if (newp) {
    350  1.1  macallan 		/* we're asked to write */
    351  1.1  macallan 		return EINVAL;
    352  1.1  macallan 	} else {
    353  1.1  macallan 
    354  1.1  macallan 		node.sysctl_data = &present;
    355  1.1  macallan 		node.sysctl_size = 4;
    356  1.1  macallan 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    357  1.1  macallan 	}
    358  1.1  macallan 
    359  1.1  macallan 	return 0;
    360  1.1  macallan }
    361