Home | History | Annotate | Line # | Download | only in samsung
exynos_gpio.c revision 1.16
      1  1.16    marty /*	$NetBSD: exynos_gpio.c,v 1.16 2015/12/22 03:36:01 marty Exp $ */
      2   1.9    skrll 
      3   1.1  reinoud /*-
      4   1.1  reinoud * Copyright (c) 2014 The NetBSD Foundation, Inc.
      5   1.1  reinoud * All rights reserved.
      6   1.1  reinoud *
      7   1.1  reinoud * This code is derived from software contributed to The NetBSD Foundation
      8   1.1  reinoud * by Reinoud Zandijk
      9   1.1  reinoud *
     10   1.1  reinoud * Redistribution and use in source and binary forms, with or without
     11   1.1  reinoud * modification, are permitted provided that the following conditions
     12   1.1  reinoud * are met:
     13   1.1  reinoud * 1. Redistributions of source code must retain the above copyright
     14   1.1  reinoud *    notice, this list of conditions and the following disclaimer.
     15   1.1  reinoud * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1  reinoud *    notice, this list of conditions and the following disclaimer in the
     17   1.1  reinoud *    documentation and/or other materials provided with the distribution.
     18   1.1  reinoud *
     19   1.1  reinoud * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1  reinoud * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1  reinoud * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1  reinoud * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1  reinoud * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1  reinoud * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1  reinoud * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1  reinoud * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1  reinoud * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1  reinoud * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1  reinoud * POSSIBILITY OF SUCH DAMAGE.
     30   1.1  reinoud */
     31   1.1  reinoud 
     32   1.1  reinoud #include "opt_exynos.h"
     33   1.1  reinoud #include "opt_arm_debug.h"
     34   1.1  reinoud #include "gpio.h"
     35   1.1  reinoud 
     36   1.1  reinoud #include <sys/cdefs.h>
     37  1.16    marty __KERNEL_RCSID(1, "$NetBSD: exynos_gpio.c,v 1.16 2015/12/22 03:36:01 marty Exp $");
     38   1.1  reinoud 
     39   1.1  reinoud #include <sys/param.h>
     40   1.1  reinoud #include <sys/bus.h>
     41   1.1  reinoud #include <sys/device.h>
     42   1.1  reinoud #include <sys/intr.h>
     43   1.1  reinoud #include <sys/systm.h>
     44   1.1  reinoud #include <sys/kmem.h>
     45  1.13    marty #include <sys/gpio.h>
     46  1.13    marty 
     47  1.13    marty #include <dev/gpio/gpiovar.h>
     48   1.1  reinoud 
     49   1.1  reinoud #include <arm/samsung/exynos_reg.h>
     50  1.15    marty #include <arm/samsung/exynos_var.h>
     51   1.1  reinoud #include <arm/samsung/exynos_intr.h>
     52  1.14    marty #include <arm/samsung/exynos_pinctrl.h>
     53  1.14    marty 
     54  1.14    marty #include <dev/fdt/fdtvar.h>
     55   1.1  reinoud 
     56   1.1  reinoud struct exynos_gpio_pin_cfg {
     57   1.1  reinoud 	uint32_t cfg;
     58   1.1  reinoud 	uint32_t pud;
     59   1.1  reinoud 	uint32_t drv;
     60   1.1  reinoud 	uint32_t conpwd;
     61   1.1  reinoud 	uint32_t pudpwd;
     62   1.1  reinoud };
     63   1.1  reinoud 
     64  1.13    marty struct exynos_gpio_softc;
     65  1.13    marty 
     66  1.13    marty struct exynos_gpio_bank {
     67  1.13    marty 	const char		bank_name[6];
     68  1.13    marty 	device_t		bank_dev;
     69  1.13    marty 	struct gpio_chipset_tag	bank_gc;
     70  1.16    marty 	struct exynos_gpio_softc *bank_sc;
     71  1.13    marty 	gpio_pin_t		bank_pins[8];
     72  1.13    marty 
     73  1.13    marty 	const bus_addr_t	bank_core_offset;
     74  1.13    marty 	const uint8_t		bank_bits;
     75  1.13    marty 
     76  1.13    marty 	uint8_t			bank_pin_mask;
     77  1.13    marty 	uint8_t			bank_pin_inuse_mask;
     78  1.13    marty 	bus_space_handle_t	bank_bsh;
     79  1.13    marty 	struct exynos_gpio_pin_cfg bank_cfg;
     80  1.14    marty 	struct exynos_gpio_bank * bank_next;
     81   1.1  reinoud };
     82   1.1  reinoud 
     83  1.13    marty struct exynos_gpio_softc {
     84  1.13    marty 	device_t		sc_dev;
     85  1.13    marty 	bus_space_tag_t		sc_bst;
     86  1.13    marty 	bus_space_handle_t	sc_bsh;
     87  1.13    marty };
     88   1.1  reinoud 
     89  1.13    marty struct exynos_gpio_pin {
     90  1.13    marty 	struct exynos_gpio_softc *pin_sc;
     91  1.13    marty 	int			  pin_no;
     92  1.13    marty 	u_int			  pin_flags;
     93  1.14    marty 	int			  pin_actlo;
     94  1.14    marty 	const struct exynos_gpio_bank   *pin_bank;
     95   1.1  reinoud };
     96   1.1  reinoud 
     97   1.1  reinoud 
     98  1.16    marty //#define GPIO_REG(v,s,o) (EXYNOS##v##_GPIO_##s##_OFFSET + (o))
     99  1.16    marty #define GPIO_REG(v,s,o) ((o))
    100  1.16    marty #define GPIO_GRP(v, s, o, n, b)	\
    101  1.16    marty 	{ \
    102  1.16    marty 		.bank_name = #n, \
    103  1.16    marty 		.bank_core_offset = GPIO_REG(v,s,o), \
    104  1.16    marty 		.bank_bits = b, \
    105  1.16    marty 	}
    106  1.16    marty 
    107  1.16    marty static struct exynos_gpio_bank exynos5_banks[] = {
    108  1.16    marty 	GPIO_GRP(5, MUXA, 0x0000, gpy7, 8),
    109  1.16    marty 	GPIO_GRP(5, MUXA, 0x0C00, gpx0, 8),
    110  1.16    marty 	GPIO_GRP(5, MUXA, 0x0C20, gpx1, 8),
    111  1.16    marty 	GPIO_GRP(5, MUXA, 0x0C40, gpx2, 8),
    112  1.16    marty 	GPIO_GRP(5, MUXA, 0x0C60, gpx3, 8),
    113  1.16    marty 
    114  1.16    marty 	GPIO_GRP(5, MUXB, 0x0000, gpc0, 8),
    115  1.16    marty 	GPIO_GRP(5, MUXB, 0x0020, gpc1, 8),
    116  1.16    marty 	GPIO_GRP(5, MUXB, 0x0040, gpc2, 7),
    117  1.16    marty 	GPIO_GRP(5, MUXB, 0x0060, gpc3, 4),
    118  1.16    marty 	GPIO_GRP(5, MUXB, 0x0080, gpc4, 2),
    119  1.16    marty 	GPIO_GRP(5, MUXB, 0x00A0, gpd1, 8),
    120  1.16    marty 	GPIO_GRP(5, MUXB, 0x00C0, gpy0, 6),
    121  1.16    marty 	GPIO_GRP(5, MUXB, 0x00E0, gpy1, 4),
    122  1.16    marty 	GPIO_GRP(5, MUXB, 0x0100, gpy2, 6),
    123  1.16    marty 	GPIO_GRP(5, MUXB, 0x0120, gpy3, 8),
    124  1.16    marty 	GPIO_GRP(5, MUXB, 0x0140, gpy4, 8),
    125  1.16    marty 	GPIO_GRP(5, MUXB, 0x0160, gpy5, 8),
    126  1.16    marty 	GPIO_GRP(5, MUXB, 0x0180, gpy6, 8),
    127  1.16    marty 
    128  1.16    marty 	GPIO_GRP(5, MUXC, 0x0000, gpe0, 8),
    129  1.16    marty 	GPIO_GRP(5, MUXC, 0x0020, gpe1, 2),
    130  1.16    marty 	GPIO_GRP(5, MUXC, 0x0040, gpf0, 6),
    131  1.16    marty 	GPIO_GRP(5, MUXC, 0x0060, gpf1, 8),
    132  1.16    marty 	GPIO_GRP(5, MUXC, 0x0080, gpg0, 8),
    133  1.16    marty 	GPIO_GRP(5, MUXC, 0x00A0, gpg1, 8),
    134  1.16    marty 	GPIO_GRP(5, MUXC, 0x00C0, gpg2, 2),
    135  1.16    marty 	GPIO_GRP(5, MUXC, 0x00E0, gpj4, 4),
    136  1.16    marty 
    137  1.16    marty 	GPIO_GRP(5, MUXD, 0x0000, gpa0, 8),
    138  1.16    marty 	GPIO_GRP(5, MUXD, 0x0020, gpa1, 6),
    139  1.16    marty 	GPIO_GRP(5, MUXD, 0x0040, gpa2, 8),
    140  1.16    marty 	GPIO_GRP(5, MUXD, 0x0060, gpb0, 5),
    141  1.16    marty 	GPIO_GRP(5, MUXD, 0x0080, gpb1, 5),
    142  1.16    marty 	GPIO_GRP(5, MUXD, 0x00A0, gpb2, 4),
    143  1.16    marty 	GPIO_GRP(5, MUXD, 0x00C0, gpb3, 8),
    144  1.16    marty 	GPIO_GRP(5, MUXD, 0x00E0, gpb4, 2),
    145  1.16    marty 	GPIO_GRP(5, MUXD, 0x0100, gph0, 4),
    146  1.16    marty 
    147  1.16    marty 	GPIO_GRP(5, MUXE, 0x0000, gpz0, 7),
    148  1.16    marty 
    149  1.16    marty };
    150  1.16    marty 
    151  1.16    marty struct exynos_gpio_bank *exynos_gpio_banks = exynos5_banks;
    152  1.16    marty 
    153  1.16    marty static int exynos_gpio_pin_read(void *, int);
    154  1.16    marty static void exynos_gpio_pin_write(void *, int, int);
    155  1.16    marty static void exynos_gpio_pin_ctl(void *, int, int);
    156  1.14    marty static void *exynos_gpio_fdt_acquire(device_t, const void *,
    157  1.14    marty 				     size_t, int);
    158  1.14    marty static void exynos_gpio_fdt_release(device_t, void *);
    159  1.14    marty 
    160  1.14    marty static int exynos_gpio_fdt_read(device_t, void *);
    161  1.14    marty static void exynos_gpio_fdt_write(device_t, void *, int);
    162  1.16    marty static struct exynos_gpio_bank *
    163  1.16    marty exynos_gpio_pin_lookup(const char *pinname, int *ppin);
    164  1.16    marty static int exynos_gpio_cfprint(void *, const char *);
    165  1.14    marty 
    166  1.14    marty struct fdtbus_gpio_controller_func exynos_gpio_funcs = {
    167  1.14    marty 	.acquire = exynos_gpio_fdt_acquire,
    168  1.14    marty 	.release = exynos_gpio_fdt_release,
    169  1.14    marty 	.read = exynos_gpio_fdt_read,
    170  1.14    marty 	.write = exynos_gpio_fdt_write
    171   1.1  reinoud };
    172  1.16    marty #define GPIO_WRITE(bank, reg, val) \
    173  1.16    marty 	bus_space_write_4((bank)->bank_sc->sc_bst, \
    174  1.16    marty 	    (bank)->bank_sc->sc_bsh, \
    175  1.16    marty 	    (bank)->bank_core_offset + (reg), (val))
    176  1.16    marty #define GPIO_READ(bank, reg) \
    177  1.16    marty 	bus_space_read_4((bank)->bank_sc->sc_bst, \
    178  1.16    marty 	    (bank)->bank_sc->sc_bsh, \
    179  1.16    marty 	    (bank)->bank_core_offset + (reg))
    180   1.1  reinoud 
    181  1.13    marty static int
    182  1.13    marty exynos_gpio_cfprint(void *priv, const char *pnp)
    183  1.13    marty {
    184  1.13    marty 	struct gpiobus_attach_args *gba = priv;
    185  1.13    marty 	struct exynos_gpio_bank *bank = gba->gba_gc->gp_cookie;
    186  1.13    marty 	const char *bankname = bank->bank_name;
    187  1.13    marty 
    188  1.13    marty 	if (pnp)
    189  1.13    marty 		aprint_normal("gpiobus at %s", pnp);
    190  1.13    marty 
    191  1.13    marty 	aprint_normal(" (%s)", bankname);
    192  1.13    marty 
    193  1.13    marty 	return UNCONF;
    194  1.13    marty }
    195   1.1  reinoud 
    196   1.1  reinoud static void
    197  1.13    marty exynos_gpio_update_cfg_regs(struct exynos_gpio_bank *bank,
    198   1.1  reinoud 	const struct exynos_gpio_pin_cfg *ncfg)
    199   1.1  reinoud {
    200  1.13    marty 	if (bank->bank_cfg.cfg != ncfg->cfg) {
    201  1.16    marty 		GPIO_WRITE(bank, EXYNOS_GPIO_CON, ncfg->cfg);
    202  1.13    marty 		bank->bank_cfg.cfg = ncfg->cfg;
    203   1.1  reinoud 	}
    204  1.13    marty 	if (bank->bank_cfg.pud != ncfg->pud) {
    205  1.16    marty 		GPIO_WRITE(bank, EXYNOS_GPIO_PUD, ncfg->pud);
    206  1.13    marty 		bank->bank_cfg.pud = ncfg->pud;
    207   1.1  reinoud 	}
    208   1.1  reinoud 
    209  1.13    marty 	if (bank->bank_cfg.drv != ncfg->drv) {
    210  1.16    marty 		GPIO_WRITE(bank, EXYNOS_GPIO_DRV, ncfg->drv);
    211  1.13    marty 		bank->bank_cfg.drv = ncfg->drv;
    212   1.1  reinoud 	}
    213  1.13    marty 	if (bank->bank_cfg.conpwd != ncfg->conpwd) {
    214  1.16    marty 		GPIO_WRITE(bank, EXYNOS_GPIO_CONPWD, ncfg->conpwd);
    215  1.13    marty 		bank->bank_cfg.conpwd = ncfg->conpwd;
    216   1.1  reinoud 	}
    217  1.13    marty 	if (bank->bank_cfg.pudpwd != ncfg->pudpwd) {
    218  1.16    marty 		GPIO_WRITE(bank, EXYNOS_GPIO_PUDPWD, ncfg->pudpwd);
    219  1.13    marty 		bank->bank_cfg.pudpwd = ncfg->pudpwd;
    220   1.1  reinoud 	}
    221   1.1  reinoud }
    222   1.1  reinoud 
    223  1.16    marty static int
    224  1.16    marty exynos_gpio_pin_read(void *cookie, int pin)
    225  1.16    marty {
    226  1.16    marty 	struct exynos_gpio_bank * const bank = cookie;
    227  1.16    marty 
    228  1.16    marty 	KASSERT(pin < bank->bank_bits);
    229  1.16    marty 	return (bus_space_read_1(bank->bank_sc->sc_bst,
    230  1.16    marty 				 bank->bank_sc->sc_bsh,
    231  1.16    marty 		EXYNOS_GPIO_DAT) >> pin) & 1;
    232  1.16    marty }
    233  1.16    marty 
    234  1.16    marty static void
    235  1.16    marty exynos_gpio_pin_write(void *cookie, int pin, int value)
    236  1.16    marty {
    237  1.16    marty 	struct exynos_gpio_bank * const bank = cookie;
    238  1.16    marty 	int val;
    239  1.16    marty 
    240  1.16    marty 	KASSERT(pin < bank->bank_bits);
    241  1.16    marty 	val = bus_space_read_1(bank->bank_sc->sc_bst,
    242  1.16    marty 			       bank->bank_sc->sc_bsh,
    243  1.16    marty 			       EXYNOS_GPIO_DAT);
    244  1.16    marty 	val &= ~__BIT(pin);
    245  1.16    marty 	if (value)
    246  1.16    marty 		val |= __BIT(pin);
    247  1.16    marty 	bus_space_write_1(bank->bank_sc->sc_bst,
    248  1.16    marty 			  bank->bank_sc->sc_bsh,
    249  1.16    marty 		EXYNOS_GPIO_DAT, val);
    250  1.16    marty }
    251   1.1  reinoud 
    252   1.1  reinoud static void
    253   1.1  reinoud exynos_gpio_pin_ctl(void *cookie, int pin, int flags)
    254   1.1  reinoud {
    255  1.13    marty 	struct exynos_gpio_bank * const bank = cookie;
    256  1.13    marty 	struct exynos_gpio_pin_cfg ncfg = bank->bank_cfg;
    257  1.14    marty 	u_int shift;
    258   1.1  reinoud 	int pull;
    259   1.1  reinoud 
    260   1.1  reinoud 	/* honour pullup requests */
    261   1.1  reinoud 	pull = EXYNOS_GPIO_PIN_FLOAT;
    262   1.1  reinoud 	if (flags & GPIO_PIN_PULLUP)
    263   1.1  reinoud 		pull = EXYNOS_GPIO_PIN_PULL_UP;
    264   1.1  reinoud 	if (flags & GPIO_PIN_PULLDOWN)
    265   1.1  reinoud 		pull = EXYNOS_GPIO_PIN_PULL_DOWN;
    266  1.14    marty 	shift = (pin & 7) << 1;
    267  1.14    marty 	ncfg.pud &= ~(0x3 << shift);
    268  1.14    marty 	ncfg.pud |= pull << shift;
    269   1.1  reinoud 
    270   1.1  reinoud 	/* honour i/o */
    271  1.14    marty 	if (flags & GPIO_PIN_INPUT) {
    272  1.14    marty 		ncfg.cfg &= ~(0x0f << shift);
    273  1.14    marty 		ncfg.cfg |= EXYNOS_GPIO_FUNC_INPUT << shift;
    274  1.14    marty 	} else if (flags & GPIO_PIN_OUTPUT) {
    275  1.14    marty 		ncfg.cfg &= ~(0x0f << shift);
    276  1.14    marty 		ncfg.cfg |= EXYNOS_GPIO_FUNC_OUTPUT << shift;
    277  1.14    marty 	}
    278   1.1  reinoud 
    279   1.1  reinoud 	/* update any config registers that changed */
    280  1.13    marty 	exynos_gpio_update_cfg_regs(bank, &ncfg);
    281   1.1  reinoud }
    282   1.1  reinoud 
    283   1.1  reinoud void
    284  1.14    marty exynos_gpio_bank_config(struct exynos_pinctrl_softc * parent, int node)
    285   1.1  reinoud {
    286  1.14    marty 	struct exynos_gpio_bank *bank = kmem_zalloc(sizeof(*bank), KM_SLEEP);
    287  1.16    marty 	struct exynos_gpio_softc *sc = kmem_zalloc(sizeof(*sc), KM_SLEEP);
    288  1.16    marty 	struct gpiobus_attach_args gba;
    289  1.16    marty 	struct gpio_chipset_tag *gc_tag;
    290  1.14    marty 	char result[64];
    291  1.13    marty 
    292  1.16    marty 	OF_getprop(node, "name", result, sizeof(result));
    293  1.16    marty 	bank = exynos_gpio_pin_lookup(result, 0);
    294  1.16    marty 	KASSERT(bank);
    295  1.16    marty 
    296  1.14    marty 	sc->sc_dev = parent->sc_dev;
    297  1.16    marty 	sc->sc_bst = &armv7_generic_bs_tag;
    298  1.16    marty 	sc->sc_bsh = parent->sc_bsh;
    299  1.14    marty 
    300  1.16    marty 	gc_tag = &bank->bank_gc;
    301  1.16    marty 	gc_tag->gp_cookie = bank;
    302  1.16    marty 	gc_tag->gp_pin_read  = exynos_gpio_pin_read;
    303  1.16    marty 	gc_tag->gp_pin_write = exynos_gpio_pin_write;
    304  1.16    marty 	gc_tag->gp_pin_ctl   = exynos_gpio_pin_ctl;
    305  1.14    marty 	memset(&gba, 0, sizeof(gba));
    306  1.14    marty 	gba.gba_gc = &bank->bank_gc;
    307  1.14    marty 	gba.gba_pins = bank->bank_pins;
    308  1.16    marty 	gba.gba_npins = bank->bank_bits;
    309  1.16    marty 	bank->bank_sc = sc;
    310  1.14    marty 	bank->bank_dev = config_found_ia(parent->sc_dev, "gpiobus", &gba,
    311  1.14    marty 					 exynos_gpio_cfprint);
    312  1.14    marty 
    313  1.14    marty 	bank->bank_pin_mask = __BIT(bank->bank_bits) - 1;
    314  1.14    marty 	bank->bank_pin_inuse_mask = 0;
    315  1.14    marty 
    316  1.14    marty 
    317  1.14    marty 	/* read in our initial settings */
    318  1.16    marty 	bank->bank_cfg.cfg = GPIO_READ(bank, EXYNOS_GPIO_CON);
    319  1.16    marty 	bank->bank_cfg.pud = GPIO_READ(bank, EXYNOS_GPIO_PUD);
    320  1.16    marty 	bank->bank_cfg.drv = GPIO_READ(bank, EXYNOS_GPIO_DRV);
    321  1.16    marty 	bank->bank_cfg.conpwd = GPIO_READ(bank, EXYNOS_GPIO_CONPWD);
    322  1.16    marty 	bank->bank_cfg.pudpwd = GPIO_READ(bank, EXYNOS_GPIO_PUDPWD);
    323  1.13    marty }
    324   1.1  reinoud 
    325  1.13    marty /*
    326  1.13    marty  * pinmame = gpLD-N
    327  1.13    marty  *     L = 'a' - 'z' -+
    328  1.13    marty  *     D = '0' - '8' -+ ===== bank name
    329  1.13    marty  *     N = '0' - '8'    ===== pin number
    330  1.13    marty  */
    331  1.13    marty 
    332  1.16    marty static struct exynos_gpio_bank *
    333  1.13    marty exynos_gpio_pin_lookup(const char *pinname, int *ppin)
    334  1.13    marty {
    335  1.13    marty 	char bankname[5];
    336  1.13    marty 	int pin;
    337  1.16    marty 	int n;
    338  1.14    marty 	struct exynos_gpio_bank *bank;
    339  1.13    marty 
    340  1.13    marty 	memset(bankname, 0, sizeof(bankname));
    341  1.13    marty 	bankname[0] = pinname[0]; /* 'g' */
    342  1.13    marty 	bankname[1] = pinname[1]; /* 'p' */
    343  1.13    marty 	bankname[2] = pinname[2]; /*  L  */
    344  1.13    marty 	bankname[3] = pinname[3]; /*  D  */
    345  1.16    marty 	bankname[4] = 0;
    346  1.16    marty 	if (ppin)
    347  1.16    marty 		pin = pinname[5] - '0';	  /* skip the '-' */
    348  1.13    marty 
    349  1.16    marty 	for (n = 0; n < __arraycount(exynos5_banks); n++) {
    350  1.16    marty 		bank = &exynos_gpio_banks[n];
    351  1.14    marty 		if (strcmp(bank->bank_name, bankname) == 0) {
    352  1.16    marty 			if (ppin)
    353  1.16    marty 				*ppin = pin;
    354  1.14    marty 			return bank;
    355   1.1  reinoud 		}
    356  1.16    marty 	}
    357  1.13    marty 
    358  1.13    marty 	return NULL;
    359   1.1  reinoud }
    360   1.1  reinoud 
    361  1.14    marty static void *
    362  1.14    marty exynos_gpio_fdt_acquire(device_t dev, const void *data, size_t len, int flags)
    363  1.13    marty {
    364  1.14    marty 	/* MJF:  This is wrong.  data is a u_int but I need a name */
    365  1.14    marty //	const u_int *gpio = data;
    366  1.14    marty 	const char *pinname = data;
    367  1.13    marty 	const struct exynos_gpio_bank *bank;
    368  1.13    marty 	struct exynos_gpio_pin *gpin;
    369  1.13    marty 	int pin;
    370  1.13    marty 
    371  1.13    marty 	bank = exynos_gpio_pin_lookup(pinname, &pin);
    372  1.13    marty 	if (bank == NULL)
    373  1.13    marty 		return NULL;
    374  1.13    marty 
    375  1.13    marty 	gpin = kmem_alloc(sizeof(*gpin), KM_SLEEP);
    376  1.16    marty 	gpin->pin_sc = bank->bank_sc;
    377  1.13    marty 	gpin->pin_bank = bank;
    378  1.13    marty 	gpin->pin_no = pin;
    379  1.13    marty 	gpin->pin_flags = flags;
    380  1.14    marty 	gpin->pin_actlo = 0;
    381  1.13    marty 
    382  1.13    marty 	exynos_gpio_pin_ctl(&gpin->pin_bank, gpin->pin_no, gpin->pin_flags);
    383  1.13    marty 
    384  1.13    marty 	return gpin;
    385  1.13    marty }
    386  1.14    marty 
    387  1.14    marty static void
    388  1.14    marty exynos_gpio_fdt_release(device_t dev, void *priv)
    389  1.14    marty {
    390  1.14    marty 	struct exynos_gpio_pin *gpin = priv;
    391  1.14    marty 
    392  1.14    marty 	kmem_free(gpin, sizeof(*gpin));
    393  1.14    marty }
    394  1.14    marty 
    395  1.14    marty static int
    396  1.14    marty exynos_gpio_fdt_read(device_t dev, void *priv)
    397  1.14    marty {
    398  1.14    marty 	struct exynos_gpio_pin *gpin = priv;
    399  1.14    marty 	int val;
    400  1.14    marty 
    401  1.14    marty 	val = (bus_space_read_1(gpin->pin_sc->sc_bst,
    402  1.14    marty 				 gpin->pin_sc->sc_bsh,
    403  1.14    marty 				 EXYNOS_GPIO_DAT) >> gpin->pin_no) & 1;
    404  1.14    marty 
    405  1.14    marty 	if (gpin->pin_actlo)
    406  1.14    marty 		val = !val;
    407  1.14    marty 
    408  1.14    marty 	return val;
    409  1.14    marty }
    410  1.14    marty 
    411  1.14    marty static void
    412  1.14    marty exynos_gpio_fdt_write(device_t dev, void *priv, int val)
    413  1.14    marty {
    414  1.14    marty 	struct exynos_gpio_pin *gpin = priv;
    415  1.14    marty 
    416  1.14    marty 	if (gpin->pin_actlo)
    417  1.14    marty 		val = !val;
    418  1.14    marty 
    419  1.14    marty 	val = bus_space_read_1(gpin->pin_sc->sc_bst,
    420  1.14    marty 			       gpin->pin_sc->sc_bsh,
    421  1.14    marty 			       EXYNOS_GPIO_DAT);
    422  1.14    marty 	val &= ~__BIT(gpin->pin_no);
    423  1.14    marty 	if (val)
    424  1.14    marty 		val |= __BIT(gpin->pin_no);
    425  1.14    marty 	bus_space_write_1(gpin->pin_sc->sc_bst,
    426  1.14    marty 			  gpin->pin_sc->sc_bsh,
    427  1.14    marty 			  EXYNOS_GPIO_DAT, val);
    428  1.14    marty 
    429  1.14    marty }
    430