Home | History | Annotate | Line # | Download | only in pci
elan520.c revision 1.9
      1  1.9       riz /*	$NetBSD: elan520.c,v 1.9 2005/10/07 15:59:50 riz Exp $	*/
      2  1.1   thorpej 
      3  1.1   thorpej /*-
      4  1.1   thorpej  * Copyright (c) 2002 The NetBSD Foundation, Inc.
      5  1.1   thorpej  * All rights reserved.
      6  1.1   thorpej  *
      7  1.1   thorpej  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1   thorpej  * by Jason R. Thorpe.
      9  1.1   thorpej  *
     10  1.1   thorpej  * Redistribution and use in source and binary forms, with or without
     11  1.1   thorpej  * modification, are permitted provided that the following conditions
     12  1.1   thorpej  * are met:
     13  1.1   thorpej  * 1. Redistributions of source code must retain the above copyright
     14  1.1   thorpej  *    notice, this list of conditions and the following disclaimer.
     15  1.1   thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1   thorpej  *    notice, this list of conditions and the following disclaimer in the
     17  1.1   thorpej  *    documentation and/or other materials provided with the distribution.
     18  1.1   thorpej  * 3. All advertising materials mentioning features or use of this software
     19  1.1   thorpej  *    must display the following acknowledgement:
     20  1.1   thorpej  *	This product includes software developed by the NetBSD
     21  1.1   thorpej  *	Foundation, Inc. and its contributors.
     22  1.1   thorpej  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.1   thorpej  *    contributors may be used to endorse or promote products derived
     24  1.1   thorpej  *    from this software without specific prior written permission.
     25  1.1   thorpej  *
     26  1.1   thorpej  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.1   thorpej  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.1   thorpej  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.1   thorpej  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.1   thorpej  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.1   thorpej  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.1   thorpej  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.1   thorpej  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.1   thorpej  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.1   thorpej  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.1   thorpej  * POSSIBILITY OF SUCH DAMAGE.
     37  1.1   thorpej  */
     38  1.1   thorpej 
     39  1.1   thorpej /*
     40  1.1   thorpej  * Device driver for the AMD Elan SC520 System Controller.  This attaches
     41  1.1   thorpej  * where the "pchb" driver might normally attach, and provides support for
     42  1.1   thorpej  * extra features on the SC520, such as the watchdog timer and GPIO.
     43  1.1   thorpej  *
     44  1.1   thorpej  * Information about the GP bus echo bug work-around is from code posted
     45  1.1   thorpej  * to the "soekris-tech" mailing list by Jasper Wallace.
     46  1.1   thorpej  */
     47  1.1   thorpej 
     48  1.1   thorpej #include <sys/cdefs.h>
     49  1.1   thorpej 
     50  1.9       riz __KERNEL_RCSID(0, "$NetBSD: elan520.c,v 1.9 2005/10/07 15:59:50 riz Exp $");
     51  1.1   thorpej 
     52  1.1   thorpej #include <sys/param.h>
     53  1.1   thorpej #include <sys/systm.h>
     54  1.1   thorpej #include <sys/device.h>
     55  1.1   thorpej #include <sys/wdog.h>
     56  1.9       riz #include <sys/gpio.h>
     57  1.1   thorpej 
     58  1.5   thorpej #include <uvm/uvm_extern.h>
     59  1.5   thorpej 
     60  1.1   thorpej #include <machine/bus.h>
     61  1.1   thorpej 
     62  1.1   thorpej #include <dev/pci/pcivar.h>
     63  1.1   thorpej 
     64  1.1   thorpej #include <dev/pci/pcidevs.h>
     65  1.1   thorpej 
     66  1.9       riz #include <dev/gpio/gpiovar.h>
     67  1.9       riz 
     68  1.1   thorpej #include <arch/i386/pci/elan520reg.h>
     69  1.1   thorpej 
     70  1.1   thorpej #include <dev/sysmon/sysmonvar.h>
     71  1.1   thorpej 
     72  1.1   thorpej struct elansc_softc {
     73  1.1   thorpej 	struct device sc_dev;
     74  1.1   thorpej 	bus_space_tag_t sc_memt;
     75  1.1   thorpej 	bus_space_handle_t sc_memh;
     76  1.1   thorpej 	int sc_echobug;
     77  1.1   thorpej 
     78  1.1   thorpej 	struct sysmon_wdog sc_smw;
     79  1.9       riz 	/* GPIO interface */
     80  1.9       riz 	struct gpio_chipset_tag sc_gpio_gc;
     81  1.9       riz 	gpio_pin_t sc_gpio_pins[ELANSC_PIO_NPINS];
     82  1.1   thorpej };
     83  1.1   thorpej 
     84  1.9       riz static int	elansc_gpio_pin_read(void *, int);
     85  1.9       riz static void	elansc_gpio_pin_write(void *, int, int);
     86  1.9       riz static void	elansc_gpio_pin_ctl(void *, int, int);
     87  1.9       riz 
     88  1.1   thorpej static void
     89  1.1   thorpej elansc_wdogctl_write(struct elansc_softc *sc, uint16_t val)
     90  1.1   thorpej {
     91  1.1   thorpej 	int s;
     92  1.6  christos 	uint8_t echo_mode = 0; /* XXX: gcc */
     93  1.1   thorpej 
     94  1.1   thorpej 	s = splhigh();
     95  1.1   thorpej 
     96  1.1   thorpej 	/* Switch off GP bus echo mode if we need to. */
     97  1.1   thorpej 	if (sc->sc_echobug) {
     98  1.1   thorpej 		echo_mode = bus_space_read_1(sc->sc_memt, sc->sc_memh,
     99  1.1   thorpej 		    MMCR_GPECHO);
    100  1.1   thorpej 		bus_space_write_1(sc->sc_memt, sc->sc_memh,
    101  1.1   thorpej 		    MMCR_GPECHO, echo_mode & ~GPECHO_GP_ECHO_ENB);
    102  1.1   thorpej 	}
    103  1.1   thorpej 
    104  1.1   thorpej 	/* Unlock the register. */
    105  1.1   thorpej 	bus_space_write_2(sc->sc_memt, sc->sc_memh, MMCR_WDTMRCTL,
    106  1.1   thorpej 	    WDTMRCTL_UNLOCK1);
    107  1.1   thorpej 	bus_space_write_2(sc->sc_memt, sc->sc_memh, MMCR_WDTMRCTL,
    108  1.1   thorpej 	    WDTMRCTL_UNLOCK2);
    109  1.1   thorpej 
    110  1.1   thorpej 	/* Write the value. */
    111  1.1   thorpej 	bus_space_write_2(sc->sc_memt, sc->sc_memh, MMCR_WDTMRCTL, val);
    112  1.1   thorpej 
    113  1.1   thorpej 	/* Switch GP bus echo mode back. */
    114  1.1   thorpej 	if (sc->sc_echobug)
    115  1.1   thorpej 		bus_space_write_1(sc->sc_memt, sc->sc_memh, MMCR_GPECHO,
    116  1.1   thorpej 		    echo_mode);
    117  1.1   thorpej 
    118  1.1   thorpej 	splx(s);
    119  1.1   thorpej }
    120  1.1   thorpej 
    121  1.1   thorpej static void
    122  1.1   thorpej elansc_wdogctl_reset(struct elansc_softc *sc)
    123  1.1   thorpej {
    124  1.1   thorpej 	int s;
    125  1.7  christos 	uint8_t echo_mode = 0/* XXX: gcc */;
    126  1.1   thorpej 
    127  1.1   thorpej 	s = splhigh();
    128  1.1   thorpej 
    129  1.1   thorpej 	/* Switch off GP bus echo mode if we need to. */
    130  1.1   thorpej 	if (sc->sc_echobug) {
    131  1.1   thorpej 		echo_mode = bus_space_read_1(sc->sc_memt, sc->sc_memh,
    132  1.1   thorpej 		    MMCR_GPECHO);
    133  1.1   thorpej 		bus_space_write_1(sc->sc_memt, sc->sc_memh,
    134  1.1   thorpej 		    MMCR_GPECHO, echo_mode & ~GPECHO_GP_ECHO_ENB);
    135  1.1   thorpej 	}
    136  1.1   thorpej 
    137  1.1   thorpej 	/* Reset the watchdog. */
    138  1.1   thorpej 	bus_space_write_2(sc->sc_memt, sc->sc_memh, MMCR_WDTMRCTL,
    139  1.1   thorpej 	    WDTMRCTL_RESET1);
    140  1.1   thorpej 	bus_space_write_2(sc->sc_memt, sc->sc_memh, MMCR_WDTMRCTL,
    141  1.1   thorpej 	    WDTMRCTL_RESET2);
    142  1.1   thorpej 
    143  1.1   thorpej 	/* Switch GP bus echo mode back. */
    144  1.1   thorpej 	if (sc->sc_echobug)
    145  1.1   thorpej 		bus_space_write_1(sc->sc_memt, sc->sc_memh, MMCR_GPECHO,
    146  1.1   thorpej 		    echo_mode);
    147  1.1   thorpej 
    148  1.1   thorpej 	splx(s);
    149  1.1   thorpej }
    150  1.1   thorpej 
    151  1.1   thorpej static const struct {
    152  1.1   thorpej 	int	period;		/* whole seconds */
    153  1.1   thorpej 	uint16_t exp;		/* exponent select */
    154  1.1   thorpej } elansc_wdog_periods[] = {
    155  1.1   thorpej 	{ 1,	WDTMRCTL_EXP_SEL25 },
    156  1.1   thorpej 	{ 2,	WDTMRCTL_EXP_SEL26 },
    157  1.1   thorpej 	{ 4,	WDTMRCTL_EXP_SEL27 },
    158  1.1   thorpej 	{ 8,	WDTMRCTL_EXP_SEL28 },
    159  1.1   thorpej 	{ 16,	WDTMRCTL_EXP_SEL29 },
    160  1.1   thorpej 	{ 32,	WDTMRCTL_EXP_SEL30 },
    161  1.1   thorpej 	{ 0,	0 },
    162  1.1   thorpej };
    163  1.1   thorpej 
    164  1.1   thorpej static int
    165  1.1   thorpej elansc_wdog_setmode(struct sysmon_wdog *smw)
    166  1.1   thorpej {
    167  1.1   thorpej 	struct elansc_softc *sc = smw->smw_cookie;
    168  1.1   thorpej 	int i;
    169  1.7  christos 	uint16_t exp_sel = 0; /* XXX: gcc */
    170  1.1   thorpej 
    171  1.1   thorpej 	if ((smw->smw_mode & WDOG_MODE_MASK) == WDOG_MODE_DISARMED) {
    172  1.1   thorpej 		elansc_wdogctl_write(sc,
    173  1.1   thorpej 		    WDTMRCTL_WRST_ENB | WDTMRCTL_EXP_SEL30);
    174  1.1   thorpej 	} else {
    175  1.1   thorpej 		if (smw->smw_period == WDOG_PERIOD_DEFAULT) {
    176  1.1   thorpej 			smw->smw_period = 32;
    177  1.1   thorpej 			exp_sel = WDTMRCTL_EXP_SEL30;
    178  1.1   thorpej 		} else {
    179  1.1   thorpej 			for (i = 0; elansc_wdog_periods[i].period != 0; i++) {
    180  1.1   thorpej 				if (elansc_wdog_periods[i].period ==
    181  1.1   thorpej 				    smw->smw_period) {
    182  1.1   thorpej 					exp_sel = elansc_wdog_periods[i].exp;
    183  1.1   thorpej 					break;
    184  1.1   thorpej 				}
    185  1.1   thorpej 			}
    186  1.1   thorpej 			if (elansc_wdog_periods[i].period == 0)
    187  1.1   thorpej 				return (EINVAL);
    188  1.1   thorpej 		}
    189  1.1   thorpej 		elansc_wdogctl_write(sc, WDTMRCTL_ENB |
    190  1.1   thorpej 		    WDTMRCTL_WRST_ENB | exp_sel);
    191  1.1   thorpej 		elansc_wdogctl_reset(sc);
    192  1.1   thorpej 	}
    193  1.1   thorpej 	return (0);
    194  1.1   thorpej }
    195  1.1   thorpej 
    196  1.1   thorpej static int
    197  1.1   thorpej elansc_wdog_tickle(struct sysmon_wdog *smw)
    198  1.1   thorpej {
    199  1.1   thorpej 	struct elansc_softc *sc = smw->smw_cookie;
    200  1.1   thorpej 
    201  1.1   thorpej 	elansc_wdogctl_reset(sc);
    202  1.1   thorpej 	return (0);
    203  1.1   thorpej }
    204  1.1   thorpej 
    205  1.1   thorpej static int
    206  1.1   thorpej elansc_match(struct device *parent, struct cfdata *match, void *aux)
    207  1.1   thorpej {
    208  1.1   thorpej 	struct pci_attach_args *pa = aux;
    209  1.1   thorpej 
    210  1.1   thorpej 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_AMD &&
    211  1.1   thorpej 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_AMD_SC520_SC)
    212  1.1   thorpej 		return (10);	/* beat pchb */
    213  1.1   thorpej 
    214  1.1   thorpej 	return (0);
    215  1.1   thorpej }
    216  1.1   thorpej 
    217  1.1   thorpej static const char *elansc_speeds[] = {
    218  1.1   thorpej 	"(reserved 00)",
    219  1.1   thorpej 	"100MHz",
    220  1.1   thorpej 	"133MHz",
    221  1.1   thorpej 	"(reserved 11)",
    222  1.1   thorpej };
    223  1.1   thorpej 
    224  1.1   thorpej static void
    225  1.1   thorpej elansc_attach(struct device *parent, struct device *self, void *aux)
    226  1.1   thorpej {
    227  1.1   thorpej 	struct elansc_softc *sc = (void *) self;
    228  1.1   thorpej 	struct pci_attach_args *pa = aux;
    229  1.9       riz 	struct gpiobus_attach_args gba;
    230  1.1   thorpej 	uint16_t rev;
    231  1.1   thorpej 	uint8_t ressta, cpuctl;
    232  1.9       riz 	int pin;
    233  1.9       riz 	int reg, shift;
    234  1.9       riz 	uint16_t data;
    235  1.1   thorpej 
    236  1.1   thorpej 	printf(": AMD Elan SC520 System Controller\n");
    237  1.1   thorpej 
    238  1.1   thorpej 	sc->sc_memt = pa->pa_memt;
    239  1.5   thorpej 	if (bus_space_map(sc->sc_memt, MMCR_BASE_ADDR, PAGE_SIZE, 0,
    240  1.1   thorpej 	    &sc->sc_memh) != 0) {
    241  1.1   thorpej 		printf("%s: unable to map registers\n", sc->sc_dev.dv_xname);
    242  1.1   thorpej 		return;
    243  1.1   thorpej 	}
    244  1.1   thorpej 
    245  1.1   thorpej 	rev = bus_space_read_2(sc->sc_memt, sc->sc_memh, MMCR_REVID);
    246  1.1   thorpej 	cpuctl = bus_space_read_1(sc->sc_memt, sc->sc_memh, MMCR_CPUCTL);
    247  1.1   thorpej 
    248  1.1   thorpej 	printf("%s: product %d stepping %d.%d, CPU clock %s\n",
    249  1.1   thorpej 	    sc->sc_dev.dv_xname,
    250  1.1   thorpej 	    (rev & REVID_PRODID) >> REVID_PRODID_SHIFT,
    251  1.1   thorpej 	    (rev & REVID_MAJSTEP) >> REVID_MAJSTEP_SHIFT,
    252  1.1   thorpej 	    (rev & REVID_MINSTEP),
    253  1.1   thorpej 	    elansc_speeds[cpuctl & CPUCTL_CPU_CLK_SPD_MASK]);
    254  1.1   thorpej 
    255  1.1   thorpej 	/*
    256  1.1   thorpej 	 * SC520 rev A1 has a bug that affects the watchdog timer.  If
    257  1.1   thorpej 	 * the GP bus echo mode is enabled, writing to the watchdog control
    258  1.1   thorpej 	 * register is blocked.
    259  1.1   thorpej 	 *
    260  1.1   thorpej 	 * The BIOS in some systems (e.g. the Soekris net4501) enables
    261  1.1   thorpej 	 * GP bus echo for various reasons, so we need to switch it off
    262  1.1   thorpej 	 * when we talk to the watchdog timer.
    263  1.1   thorpej 	 *
    264  1.1   thorpej 	 * XXX The step 1.1 (B1?) in my Soekris net4501 also has this
    265  1.1   thorpej 	 * XXX problem, so we'll just enable it for all Elan SC520s
    266  1.8    keihan 	 * XXX for now.  --thorpej (at) NetBSD.org
    267  1.1   thorpej 	 */
    268  1.1   thorpej 	if (1 || rev == ((PRODID_ELAN_SC520 << REVID_PRODID_SHIFT) |
    269  1.1   thorpej 		    (0 << REVID_MAJSTEP_SHIFT) | (1)))
    270  1.1   thorpej 		sc->sc_echobug = 1;
    271  1.1   thorpej 
    272  1.1   thorpej 	/*
    273  1.1   thorpej 	 * Determine cause of the last reset, and issue a warning if it
    274  1.1   thorpej 	 * was due to watchdog expiry.
    275  1.1   thorpej 	 */
    276  1.1   thorpej 	ressta = bus_space_read_1(sc->sc_memt, sc->sc_memh, MMCR_RESSTA);
    277  1.1   thorpej 	if (ressta & RESSTA_WDT_RST_DET)
    278  1.1   thorpej 		printf("%s: WARNING: LAST RESET DUE TO WATCHDOG EXPIRATION!\n",
    279  1.1   thorpej 		    sc->sc_dev.dv_xname);
    280  1.1   thorpej 	bus_space_write_1(sc->sc_memt, sc->sc_memh, MMCR_RESSTA, ressta);
    281  1.1   thorpej 
    282  1.1   thorpej 	/*
    283  1.1   thorpej 	 * Hook up the watchdog timer.
    284  1.1   thorpej 	 */
    285  1.1   thorpej 	sc->sc_smw.smw_name = sc->sc_dev.dv_xname;
    286  1.1   thorpej 	sc->sc_smw.smw_cookie = sc;
    287  1.1   thorpej 	sc->sc_smw.smw_setmode = elansc_wdog_setmode;
    288  1.1   thorpej 	sc->sc_smw.smw_tickle = elansc_wdog_tickle;
    289  1.1   thorpej 	sc->sc_smw.smw_period = 32;	/* actually 32.54 */
    290  1.1   thorpej 	if (sysmon_wdog_register(&sc->sc_smw) != 0)
    291  1.1   thorpej 		printf("%s: unable to register watchdog with sysmon\n",
    292  1.1   thorpej 		    sc->sc_dev.dv_xname);
    293  1.1   thorpej 
    294  1.1   thorpej 	/* Set up the watchdog registers with some defaults. */
    295  1.1   thorpej 	elansc_wdogctl_write(sc, WDTMRCTL_WRST_ENB | WDTMRCTL_EXP_SEL30);
    296  1.1   thorpej 
    297  1.1   thorpej 	/* ...and clear it. */
    298  1.1   thorpej 	elansc_wdogctl_reset(sc);
    299  1.9       riz 
    300  1.9       riz 	/* Initialize GPIO pins array */
    301  1.9       riz 	for (pin = 0; pin < ELANSC_PIO_NPINS; pin++) {
    302  1.9       riz 		sc->sc_gpio_pins[pin].pin_num = pin;
    303  1.9       riz 		sc->sc_gpio_pins[pin].pin_caps = GPIO_PIN_INPUT |
    304  1.9       riz 		    GPIO_PIN_OUTPUT;
    305  1.9       riz 
    306  1.9       riz 		/* Read initial state */
    307  1.9       riz 		reg = (pin < 16 ? MMCR_PIODIR15_0 : MMCR_PIODIR31_16);
    308  1.9       riz 		shift = pin % 16;
    309  1.9       riz 		data = bus_space_read_2(sc->sc_memt, sc->sc_memh, reg);
    310  1.9       riz 		if ((data & (1 << shift)) == 0)
    311  1.9       riz 			sc->sc_gpio_pins[pin].pin_flags = GPIO_PIN_INPUT;
    312  1.9       riz 		else
    313  1.9       riz 			sc->sc_gpio_pins[pin].pin_flags = GPIO_PIN_OUTPUT;
    314  1.9       riz 		if (elansc_gpio_pin_read(sc, pin) == 0)
    315  1.9       riz 			sc->sc_gpio_pins[pin].pin_state = GPIO_PIN_LOW;
    316  1.9       riz 		else
    317  1.9       riz 			sc->sc_gpio_pins[pin].pin_state = GPIO_PIN_HIGH;
    318  1.9       riz 	}
    319  1.9       riz 
    320  1.9       riz 	/* Create controller tag */
    321  1.9       riz 	sc->sc_gpio_gc.gp_cookie = sc;
    322  1.9       riz 	sc->sc_gpio_gc.gp_pin_read = elansc_gpio_pin_read;
    323  1.9       riz 	sc->sc_gpio_gc.gp_pin_write = elansc_gpio_pin_write;
    324  1.9       riz 	sc->sc_gpio_gc.gp_pin_ctl = elansc_gpio_pin_ctl;
    325  1.9       riz 
    326  1.9       riz 	gba.gba_name = "gpio";
    327  1.9       riz 	gba.gba_gc = &sc->sc_gpio_gc;
    328  1.9       riz 	gba.gba_pins = sc->sc_gpio_pins;
    329  1.9       riz 	gba.gba_npins = ELANSC_PIO_NPINS;
    330  1.9       riz 
    331  1.9       riz 	/* Attach GPIO framework */
    332  1.9       riz 	config_found(&sc->sc_dev, &gba, gpiobus_print);
    333  1.1   thorpej }
    334  1.1   thorpej 
    335  1.4   thorpej CFATTACH_DECL(elansc, sizeof(struct elansc_softc),
    336  1.4   thorpej     elansc_match, elansc_attach, NULL, NULL);
    337  1.9       riz 
    338  1.9       riz static int
    339  1.9       riz elansc_gpio_pin_read(void *arg, int pin)
    340  1.9       riz {
    341  1.9       riz 	struct elansc_softc *sc = arg;
    342  1.9       riz 	int reg, shift;
    343  1.9       riz 	u_int16_t data;
    344  1.9       riz 
    345  1.9       riz 	reg = (pin < 16 ? MMCR_PIODATA15_0 : MMCR_PIODATA31_16);
    346  1.9       riz 	shift = pin % 16;
    347  1.9       riz 	data = bus_space_read_2(sc->sc_memt, sc->sc_memh, reg);
    348  1.9       riz 
    349  1.9       riz 	return ((data >> shift) & 0x1);
    350  1.9       riz }
    351  1.9       riz 
    352  1.9       riz static void
    353  1.9       riz elansc_gpio_pin_write(void *arg, int pin, int value)
    354  1.9       riz {
    355  1.9       riz 	struct elansc_softc *sc = arg;
    356  1.9       riz 	int reg, shift;
    357  1.9       riz 	u_int16_t data;
    358  1.9       riz 
    359  1.9       riz 	reg = (pin < 16 ? MMCR_PIODATA15_0 : MMCR_PIODATA31_16);
    360  1.9       riz 	shift = pin % 16;
    361  1.9       riz 	data = bus_space_read_2(sc->sc_memt, sc->sc_memh, reg);
    362  1.9       riz 	if (value == 0)
    363  1.9       riz 		data &= ~(1 << shift);
    364  1.9       riz 	else if (value == 1)
    365  1.9       riz 		data |= (1 << shift);
    366  1.9       riz 
    367  1.9       riz 	bus_space_write_2(sc->sc_memt, sc->sc_memh, reg, data);
    368  1.9       riz }
    369  1.9       riz 
    370  1.9       riz static void
    371  1.9       riz elansc_gpio_pin_ctl(void *arg, int pin, int flags)
    372  1.9       riz {
    373  1.9       riz 	struct elansc_softc *sc = arg;
    374  1.9       riz 	int reg, shift;
    375  1.9       riz 	u_int16_t data;
    376  1.9       riz 
    377  1.9       riz 	reg = (pin < 16 ? MMCR_PIODIR15_0 : MMCR_PIODIR31_16);
    378  1.9       riz 	shift = pin % 16;
    379  1.9       riz 	data = bus_space_read_2(sc->sc_memt, sc->sc_memh, reg);
    380  1.9       riz 	if (flags & GPIO_PIN_INPUT)
    381  1.9       riz 		data &= ~(1 << shift);
    382  1.9       riz 	if (flags & GPIO_PIN_OUTPUT)
    383  1.9       riz 		data |= (1 << shift);
    384  1.9       riz 
    385  1.9       riz 	bus_space_write_2(sc->sc_memt, sc->sc_memh, reg, data);
    386  1.9       riz }
    387