Home | History | Annotate | Line # | Download | only in dev
      1  1.4  macallan /* $NetBSD: drivebay.c,v 1.4 2025/08/18 05:29:04 macallan Exp $ */
      2  1.1  macallan 
      3  1.1  macallan /*-
      4  1.3  macallan  * Copyright (c) 2025 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.3  macallan  * a driver for the Xserve G4's drivebays
     31  1.1  macallan  */
     32  1.1  macallan 
     33  1.1  macallan #include <sys/cdefs.h>
     34  1.4  macallan __KERNEL_RCSID(0, "$NetBSD: drivebay.c,v 1.4 2025/08/18 05:29:04 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.3  macallan 	uint32_t	sc_state, sc_input, sc_last_update;
     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.3  macallan 	sc->sc_last_update = 0xffffffff;
    146  1.1  macallan 
    147  1.1  macallan 	aprint_naive("\n");
    148  1.1  macallan 
    149  1.1  macallan 	aprint_normal(": PCA9554\n");
    150  1.1  macallan 
    151  1.1  macallan 	drivebay_writereg(sc, PCAGPIO_CONFIG, 0xf8);
    152  1.1  macallan 	sc->sc_state = drivebay_readreg(sc, PCAGPIO_OUTPUT);
    153  1.1  macallan 
    154  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &me,
    155  1.1  macallan 	    CTLFLAG_READWRITE,
    156  1.1  macallan 	    CTLTYPE_NODE, device_xname(sc->sc_dev), NULL,
    157  1.1  macallan 	    NULL, 0, NULL, 0,
    158  1.4  macallan 	    CTL_HW, CTL_CREATE, CTL_EOL);
    159  1.1  macallan 
    160  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    161  1.1  macallan 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    162  1.1  macallan 	    CTLTYPE_INT, "power", "drive power",
    163  1.1  macallan 	    sysctl_power, 1, (void *)sc, 0,
    164  1.4  macallan 	    CTL_HW, me->sysctl_num, CTL_CREATE, CTL_EOL);
    165  1.1  macallan 
    166  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    167  1.1  macallan 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    168  1.1  macallan 	    CTLTYPE_INT, "fail", "drive fail LED",
    169  1.1  macallan 	    sysctl_fail, 1, (void *)sc, 0,
    170  1.4  macallan 	    CTL_HW, me->sysctl_num, CTL_CREATE, CTL_EOL);
    171  1.1  macallan 
    172  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    173  1.1  macallan 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    174  1.1  macallan 	    CTLTYPE_INT, "inuse", "drive in use LED",
    175  1.1  macallan 	    sysctl_inuse, 1, (void *)sc, 0,
    176  1.4  macallan 	    CTL_HW, me->sysctl_num, CTL_CREATE, CTL_EOL);
    177  1.1  macallan 
    178  1.1  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    179  1.2  macallan 	    CTLFLAG_READONLY | CTLFLAG_OWNDESC,
    180  1.1  macallan 	    CTLTYPE_INT, "present", "drive present",
    181  1.1  macallan 	    sysctl_present, 1, (void *)sc, 0,
    182  1.4  macallan 	    CTL_HW, me->sysctl_num, CTL_CREATE, CTL_EOL);
    183  1.2  macallan 
    184  1.2  macallan 	ret = sysctl_createv(NULL, 0, NULL, &node,
    185  1.2  macallan 	    CTLFLAG_READONLY | CTLFLAG_OWNDESC,
    186  1.2  macallan 	    CTLTYPE_INT, "switch", "drive switch",
    187  1.2  macallan 	    sysctl_switch, 1, (void *)sc, 0,
    188  1.4  macallan 	    CTL_HW, me->sysctl_num, CTL_CREATE, CTL_EOL);
    189  1.1  macallan 	__USE(ret);
    190  1.1  macallan 
    191  1.1  macallan #ifdef DRIVEBAY_DEBUG
    192  1.1  macallan 	uint32_t in, out;
    193  1.1  macallan 	sc->sc_dir = drivebay_readreg(sc, PCAGPIO_CONFIG);
    194  1.1  macallan 	sc->sc_in = drivebay_readreg(sc, PCAGPIO_INPUT);
    195  1.1  macallan 	in = sc->sc_in;
    196  1.1  macallan 	out = sc->sc_state;
    197  1.1  macallan 
    198  1.1  macallan 	out &= ~sc->sc_dir;
    199  1.1  macallan 	in &= sc->sc_dir;
    200  1.1  macallan 
    201  1.1  macallan 	printdir(sc, in, sc->sc_dir, 'I');
    202  1.1  macallan 	printdir(sc, out, ~sc->sc_dir, 'O');
    203  1.1  macallan 
    204  1.1  macallan #endif
    205  1.1  macallan }
    206  1.1  macallan 
    207  1.1  macallan static int
    208  1.1  macallan drivebay_detach(device_t self, int flags)
    209  1.1  macallan {
    210  1.1  macallan 	return 0;
    211  1.1  macallan }
    212  1.1  macallan 
    213  1.1  macallan static void
    214  1.1  macallan drivebay_writereg(struct drivebay_softc *sc, int reg, uint32_t val)
    215  1.1  macallan {
    216  1.1  macallan 	uint8_t cmd;
    217  1.1  macallan 	uint8_t creg;
    218  1.1  macallan 
    219  1.1  macallan 	iic_acquire_bus(sc->sc_i2c, 0);
    220  1.1  macallan 	cmd = reg;
    221  1.1  macallan 	creg = (uint8_t)val;
    222  1.1  macallan 	iic_exec(sc->sc_i2c, I2C_OP_WRITE_WITH_STOP,
    223  1.1  macallan 		    sc->sc_addr, &cmd, 1, &creg, 1, 0);
    224  1.1  macallan 	if (reg == PCAGPIO_OUTPUT) sc->sc_state = val;
    225  1.1  macallan 	iic_release_bus(sc->sc_i2c, 0);
    226  1.1  macallan }
    227  1.1  macallan 
    228  1.1  macallan static uint32_t
    229  1.1  macallan drivebay_readreg(struct drivebay_softc *sc, int reg)
    230  1.1  macallan {
    231  1.1  macallan 	uint8_t cmd;
    232  1.1  macallan 	uint8_t creg;
    233  1.1  macallan 	uint32_t ret;
    234  1.1  macallan 
    235  1.3  macallan 	if (reg == PCAGPIO_INPUT) {
    236  1.3  macallan 		if (time_uptime32 == sc->sc_last_update)
    237  1.3  macallan 			return sc->sc_input;
    238  1.3  macallan 	}
    239  1.3  macallan 
    240  1.1  macallan 	iic_acquire_bus(sc->sc_i2c, 0);
    241  1.1  macallan 	cmd = reg;
    242  1.1  macallan 	iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP,
    243  1.1  macallan 		    sc->sc_addr, &cmd, 1, &creg, 1, 0);
    244  1.1  macallan 	ret = creg;
    245  1.1  macallan 	iic_release_bus(sc->sc_i2c, 0);
    246  1.3  macallan 	if (reg == PCAGPIO_INPUT) {
    247  1.3  macallan 		sc->sc_last_update = time_uptime32;
    248  1.3  macallan 		sc->sc_input = ret;
    249  1.3  macallan 	}
    250  1.1  macallan 	return ret;
    251  1.1  macallan }
    252  1.1  macallan 
    253  1.1  macallan static int
    254  1.1  macallan sysctl_power(SYSCTLFN_ARGS)
    255  1.1  macallan {
    256  1.1  macallan 	struct sysctlnode node = *rnode;
    257  1.1  macallan 	struct drivebay_softc *sc = node.sysctl_data;
    258  1.1  macallan 	int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
    259  1.1  macallan 	int power = (reg & I_POWER) != 0;
    260  1.1  macallan 
    261  1.1  macallan 	if (newp) {
    262  1.1  macallan 		/* we're asked to write */
    263  1.1  macallan 		node.sysctl_data = &power;
    264  1.1  macallan 		if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    265  1.1  macallan 
    266  1.1  macallan 			power = *(int *)node.sysctl_data;
    267  1.1  macallan 			reg = sc->sc_state;
    268  1.1  macallan 			if (power != 0) reg |= O_POWER;
    269  1.1  macallan 			else reg &= ~O_POWER;
    270  1.1  macallan 
    271  1.1  macallan 			if (reg != sc->sc_state) {
    272  1.1  macallan 				drivebay_writereg(sc, PCAGPIO_OUTPUT, reg);
    273  1.1  macallan 				sc->sc_state = reg;
    274  1.1  macallan 			}
    275  1.1  macallan 			return 0;
    276  1.1  macallan 		}
    277  1.1  macallan 		return EINVAL;
    278  1.1  macallan 	} else {
    279  1.1  macallan 
    280  1.1  macallan 		node.sysctl_data = &power;
    281  1.1  macallan 		node.sysctl_size = 4;
    282  1.1  macallan 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    283  1.1  macallan 	}
    284  1.1  macallan 
    285  1.1  macallan 	return 0;
    286  1.1  macallan }
    287  1.1  macallan 
    288  1.1  macallan static int
    289  1.1  macallan sysctl_inuse(SYSCTLFN_ARGS)
    290  1.1  macallan {
    291  1.1  macallan 	struct sysctlnode node = *rnode;
    292  1.1  macallan 	struct drivebay_softc *sc = node.sysctl_data;
    293  1.1  macallan 	int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
    294  1.1  macallan 	int inuse = (reg & I_INUSE) != 0;
    295  1.1  macallan 
    296  1.1  macallan 	if (newp) {
    297  1.1  macallan 		/* we're asked to write */
    298  1.1  macallan 		node.sysctl_data = &inuse;
    299  1.1  macallan 		if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    300  1.1  macallan 
    301  1.1  macallan 			inuse = *(int *)node.sysctl_data;
    302  1.1  macallan 			reg = sc->sc_state;
    303  1.1  macallan 			if (inuse != 0) reg |= O_INUSE;
    304  1.1  macallan 			else reg &= ~O_INUSE;
    305  1.1  macallan 
    306  1.1  macallan 			if (reg != sc->sc_state) {
    307  1.1  macallan 				drivebay_writereg(sc, PCAGPIO_OUTPUT, reg);
    308  1.1  macallan 				sc->sc_state = reg;
    309  1.1  macallan 			}
    310  1.1  macallan 			return 0;
    311  1.1  macallan 		}
    312  1.1  macallan 		return EINVAL;
    313  1.1  macallan 	} else {
    314  1.1  macallan 
    315  1.1  macallan 		node.sysctl_data = &inuse;
    316  1.1  macallan 		node.sysctl_size = 4;
    317  1.1  macallan 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    318  1.1  macallan 	}
    319  1.1  macallan 
    320  1.1  macallan 	return 0;
    321  1.1  macallan }
    322  1.1  macallan 
    323  1.1  macallan static int
    324  1.1  macallan sysctl_fail(SYSCTLFN_ARGS)
    325  1.1  macallan {
    326  1.1  macallan 	struct sysctlnode node = *rnode;
    327  1.1  macallan 	struct drivebay_softc *sc = node.sysctl_data;
    328  1.1  macallan 	int reg = sc->sc_state;
    329  1.1  macallan 	int fail = (reg & O_FAIL) != 0;
    330  1.1  macallan 
    331  1.1  macallan 	if (newp) {
    332  1.1  macallan 		/* we're asked to write */
    333  1.1  macallan 		node.sysctl_data = &fail;
    334  1.1  macallan 		if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    335  1.1  macallan 
    336  1.1  macallan 			fail = *(int *)node.sysctl_data;
    337  1.1  macallan 			reg = sc->sc_state;
    338  1.1  macallan 			if (fail != 0) reg |= O_FAIL;
    339  1.1  macallan 			else reg &= ~O_FAIL;
    340  1.1  macallan 
    341  1.1  macallan 			if (reg != sc->sc_state) {
    342  1.1  macallan 				drivebay_writereg(sc, PCAGPIO_OUTPUT, reg);
    343  1.1  macallan 				sc->sc_state = reg;
    344  1.1  macallan 			}
    345  1.1  macallan 			return 0;
    346  1.1  macallan 		}
    347  1.1  macallan 		return EINVAL;
    348  1.1  macallan 	} else {
    349  1.1  macallan 
    350  1.1  macallan 		node.sysctl_data = &fail;
    351  1.1  macallan 		node.sysctl_size = 4;
    352  1.1  macallan 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    353  1.1  macallan 	}
    354  1.1  macallan 
    355  1.1  macallan 	return 0;
    356  1.1  macallan }
    357  1.1  macallan 
    358  1.1  macallan static int
    359  1.1  macallan sysctl_present(SYSCTLFN_ARGS)
    360  1.1  macallan {
    361  1.1  macallan 	struct sysctlnode node = *rnode;
    362  1.1  macallan 	struct drivebay_softc *sc = node.sysctl_data;
    363  1.1  macallan 	int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
    364  1.1  macallan 	int present = (reg & I_PRESENT) == 0;
    365  1.1  macallan 
    366  1.1  macallan 	if (newp) {
    367  1.1  macallan 		/* we're asked to write */
    368  1.1  macallan 		return EINVAL;
    369  1.1  macallan 	} else {
    370  1.1  macallan 
    371  1.1  macallan 		node.sysctl_data = &present;
    372  1.1  macallan 		node.sysctl_size = 4;
    373  1.1  macallan 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    374  1.1  macallan 	}
    375  1.1  macallan 
    376  1.1  macallan 	return 0;
    377  1.1  macallan }
    378  1.2  macallan 
    379  1.2  macallan static int
    380  1.2  macallan sysctl_switch(SYSCTLFN_ARGS)
    381  1.2  macallan {
    382  1.2  macallan 	struct sysctlnode node = *rnode;
    383  1.2  macallan 	struct drivebay_softc *sc = node.sysctl_data;
    384  1.2  macallan 	int reg = drivebay_readreg(sc, PCAGPIO_INPUT);
    385  1.2  macallan 	int sw = (reg & I_SWITCH) == 0;
    386  1.2  macallan 
    387  1.2  macallan 	if (newp) {
    388  1.2  macallan 		/* we're asked to write */
    389  1.2  macallan 		return EINVAL;
    390  1.2  macallan 	} else {
    391  1.2  macallan 
    392  1.2  macallan 		node.sysctl_data = &sw;
    393  1.2  macallan 		node.sysctl_size = 4;
    394  1.2  macallan 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    395  1.2  macallan 	}
    396  1.2  macallan 
    397  1.2  macallan 	return 0;
    398  1.2  macallan }
    399