Home | History | Annotate | Line # | Download | only in samsung
exynos_gpio.c revision 1.11.2.3
      1  1.11.2.3    skrll /*	$NetBSD: exynos_gpio.c,v 1.11.2.3 2016/03/19 11:29:57 skrll 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.11.2.3    skrll __KERNEL_RCSID(1, "$NetBSD: exynos_gpio.c,v 1.11.2.3 2016/03/19 11:29:57 skrll 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.1  reinoud #include <sys/gpio.h>
     46  1.11.2.2    skrll 
     47       1.1  reinoud #include <dev/gpio/gpiovar.h>
     48       1.1  reinoud 
     49  1.11.2.2    skrll #include <arm/samsung/exynos_reg.h>
     50  1.11.2.2    skrll #include <arm/samsung/exynos_var.h>
     51  1.11.2.2    skrll #include <arm/samsung/exynos_intr.h>
     52  1.11.2.2    skrll #include <arm/samsung/exynos_pinctrl.h>
     53       1.1  reinoud 
     54  1.11.2.2    skrll #include <dev/fdt/fdtvar.h>
     55       1.1  reinoud 
     56  1.11.2.2    skrll struct exynos_gpio_bank {
     57  1.11.2.2    skrll 	const char		bank_name[6];
     58  1.11.2.2    skrll 	device_t		bank_dev;
     59  1.11.2.2    skrll 	struct gpio_chipset_tag	bank_gc;
     60  1.11.2.2    skrll 	struct exynos_gpio_softc *bank_sc;
     61  1.11.2.2    skrll 	gpio_pin_t		bank_pins[8];
     62  1.11.2.2    skrll 
     63  1.11.2.2    skrll 	const bus_addr_t	bank_core_offset;
     64  1.11.2.2    skrll 	const uint8_t		bank_bits;
     65  1.11.2.2    skrll 
     66  1.11.2.2    skrll 	uint8_t			bank_pin_mask;
     67  1.11.2.2    skrll 	uint8_t			bank_pin_inuse_mask;
     68  1.11.2.2    skrll 	bus_space_handle_t	bank_bsh;
     69  1.11.2.2    skrll 	struct exynos_gpio_pin_cfg bank_cfg;
     70  1.11.2.2    skrll 	struct exynos_gpio_bank * bank_next;
     71       1.1  reinoud };
     72       1.1  reinoud 
     73  1.11.2.2    skrll struct exynos_gpio_pin {
     74  1.11.2.2    skrll 	struct exynos_gpio_softc *pin_sc;
     75  1.11.2.2    skrll 	int			  pin_no;
     76  1.11.2.2    skrll 	u_int			  pin_flags;
     77  1.11.2.2    skrll 	int			  pin_actlo;
     78  1.11.2.2    skrll 	const struct exynos_gpio_bank   *pin_bank;
     79  1.11.2.2    skrll };
     80  1.11.2.2    skrll 
     81       1.1  reinoud 
     82  1.11.2.2    skrll //#define GPIO_REG(v,s,o) (EXYNOS##v##_GPIO_##s##_OFFSET + (o))
     83  1.11.2.2    skrll #define GPIO_REG(v,s,o) ((o))
     84  1.11.2.2    skrll #define GPIO_GRP(v, s, o, n, b)	\
     85  1.11.2.2    skrll 	{ \
     86  1.11.2.2    skrll 		.bank_name = #n, \
     87  1.11.2.2    skrll 		.bank_core_offset = GPIO_REG(v,s,o), \
     88  1.11.2.2    skrll 		.bank_bits = b, \
     89  1.11.2.2    skrll 	}
     90  1.11.2.2    skrll 
     91  1.11.2.2    skrll static struct exynos_gpio_bank exynos5_banks[] = {
     92  1.11.2.2    skrll 	GPIO_GRP(5, MUXA, 0x0000, gpy7, 8),
     93  1.11.2.2    skrll 	GPIO_GRP(5, MUXA, 0x0C00, gpx0, 8),
     94  1.11.2.2    skrll 	GPIO_GRP(5, MUXA, 0x0C20, gpx1, 8),
     95  1.11.2.2    skrll 	GPIO_GRP(5, MUXA, 0x0C40, gpx2, 8),
     96  1.11.2.2    skrll 	GPIO_GRP(5, MUXA, 0x0C60, gpx3, 8),
     97  1.11.2.2    skrll 
     98  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0000, gpc0, 8),
     99  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0020, gpc1, 8),
    100  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0040, gpc2, 7),
    101  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0060, gpc3, 4),
    102  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0080, gpc4, 2),
    103  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x00A0, gpd1, 8),
    104  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x00C0, gpy0, 6),
    105  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x00E0, gpy1, 4),
    106  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0100, gpy2, 6),
    107  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0120, gpy3, 8),
    108  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0140, gpy4, 8),
    109  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0160, gpy5, 8),
    110  1.11.2.2    skrll 	GPIO_GRP(5, MUXB, 0x0180, gpy6, 8),
    111  1.11.2.2    skrll 
    112  1.11.2.2    skrll 	GPIO_GRP(5, MUXC, 0x0000, gpe0, 8),
    113  1.11.2.2    skrll 	GPIO_GRP(5, MUXC, 0x0020, gpe1, 2),
    114  1.11.2.2    skrll 	GPIO_GRP(5, MUXC, 0x0040, gpf0, 6),
    115  1.11.2.2    skrll 	GPIO_GRP(5, MUXC, 0x0060, gpf1, 8),
    116  1.11.2.2    skrll 	GPIO_GRP(5, MUXC, 0x0080, gpg0, 8),
    117  1.11.2.2    skrll 	GPIO_GRP(5, MUXC, 0x00A0, gpg1, 8),
    118  1.11.2.2    skrll 	GPIO_GRP(5, MUXC, 0x00C0, gpg2, 2),
    119  1.11.2.2    skrll 	GPIO_GRP(5, MUXC, 0x00E0, gpj4, 4),
    120  1.11.2.2    skrll 
    121  1.11.2.2    skrll 	GPIO_GRP(5, MUXD, 0x0000, gpa0, 8),
    122  1.11.2.2    skrll 	GPIO_GRP(5, MUXD, 0x0020, gpa1, 6),
    123  1.11.2.2    skrll 	GPIO_GRP(5, MUXD, 0x0040, gpa2, 8),
    124  1.11.2.2    skrll 	GPIO_GRP(5, MUXD, 0x0060, gpb0, 5),
    125  1.11.2.2    skrll 	GPIO_GRP(5, MUXD, 0x0080, gpb1, 5),
    126  1.11.2.2    skrll 	GPIO_GRP(5, MUXD, 0x00A0, gpb2, 4),
    127  1.11.2.2    skrll 	GPIO_GRP(5, MUXD, 0x00C0, gpb3, 8),
    128  1.11.2.2    skrll 	GPIO_GRP(5, MUXD, 0x00E0, gpb4, 2),
    129  1.11.2.2    skrll 	GPIO_GRP(5, MUXD, 0x0100, gph0, 4),
    130       1.1  reinoud 
    131  1.11.2.3    skrll 	GPIO_GRP(5, MUXE, 0x0000, gpz, 7),
    132       1.1  reinoud 
    133  1.11.2.2    skrll };
    134       1.1  reinoud 
    135  1.11.2.2    skrll struct exynos_gpio_bank *exynos_gpio_banks = exynos5_banks;
    136       1.1  reinoud 
    137  1.11.2.2    skrll static int exynos_gpio_pin_read(void *, int);
    138  1.11.2.2    skrll static void exynos_gpio_pin_write(void *, int, int);
    139  1.11.2.2    skrll static void exynos_gpio_pin_ctl(void *, int, int);
    140  1.11.2.2    skrll static void *exynos_gpio_fdt_acquire(device_t, const void *,
    141  1.11.2.2    skrll 				     size_t, int);
    142  1.11.2.2    skrll static void exynos_gpio_fdt_release(device_t, void *);
    143  1.11.2.2    skrll 
    144  1.11.2.2    skrll static int exynos_gpio_fdt_read(device_t, void *, bool);
    145  1.11.2.2    skrll static void exynos_gpio_fdt_write(device_t, void *, int, bool);
    146  1.11.2.2    skrll static int exynos_gpio_cfprint(void *, const char *);
    147  1.11.2.2    skrll 
    148  1.11.2.2    skrll struct fdtbus_gpio_controller_func exynos_gpio_funcs = {
    149  1.11.2.2    skrll 	.acquire = exynos_gpio_fdt_acquire,
    150  1.11.2.2    skrll 	.release = exynos_gpio_fdt_release,
    151  1.11.2.2    skrll 	.read = exynos_gpio_fdt_read,
    152  1.11.2.2    skrll 	.write = exynos_gpio_fdt_write
    153  1.11.2.2    skrll };
    154  1.11.2.2    skrll #define GPIO_WRITE(bank, reg, val) \
    155  1.11.2.2    skrll 	bus_space_write_4((bank)->bank_sc->sc_bst, \
    156  1.11.2.2    skrll 	    (bank)->bank_sc->sc_bsh, \
    157  1.11.2.2    skrll 	    (bank)->bank_core_offset + (reg), (val))
    158  1.11.2.2    skrll #define GPIO_READ(bank, reg) \
    159  1.11.2.2    skrll 	bus_space_read_4((bank)->bank_sc->sc_bst, \
    160  1.11.2.2    skrll 	    (bank)->bank_sc->sc_bsh, \
    161  1.11.2.2    skrll 	    (bank)->bank_core_offset + (reg))
    162       1.1  reinoud 
    163       1.1  reinoud static int
    164  1.11.2.2    skrll exynos_gpio_cfprint(void *priv, const char *pnp)
    165       1.1  reinoud {
    166  1.11.2.2    skrll 	struct gpiobus_attach_args *gba = priv;
    167  1.11.2.2    skrll 	struct exynos_gpio_bank *bank = gba->gba_gc->gp_cookie;
    168  1.11.2.2    skrll 	const char *bankname = bank->bank_name;
    169       1.1  reinoud 
    170  1.11.2.2    skrll 	if (pnp)
    171  1.11.2.2    skrll 		aprint_normal("gpiobus at %s", pnp);
    172       1.1  reinoud 
    173  1.11.2.2    skrll 	aprint_normal(" (%s)", bankname);
    174       1.1  reinoud 
    175  1.11.2.2    skrll 	return UNCONF;
    176       1.1  reinoud }
    177       1.1  reinoud 
    178       1.1  reinoud static void
    179  1.11.2.2    skrll exynos_gpio_update_cfg_regs(struct exynos_gpio_bank *bank,
    180  1.11.2.2    skrll 	const struct exynos_gpio_pin_cfg *ncfg)
    181       1.1  reinoud {
    182  1.11.2.2    skrll 	if (bank->bank_cfg.cfg != ncfg->cfg) {
    183  1.11.2.2    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_CON, ncfg->cfg);
    184  1.11.2.2    skrll 		bank->bank_cfg.cfg = ncfg->cfg;
    185  1.11.2.2    skrll 	}
    186  1.11.2.2    skrll 	if (bank->bank_cfg.pud != ncfg->pud) {
    187  1.11.2.2    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_PUD, ncfg->pud);
    188  1.11.2.2    skrll 		bank->bank_cfg.pud = ncfg->pud;
    189  1.11.2.2    skrll 	}
    190  1.11.2.2    skrll 
    191  1.11.2.2    skrll 	if (bank->bank_cfg.drv != ncfg->drv) {
    192  1.11.2.2    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_DRV, ncfg->drv);
    193  1.11.2.2    skrll 		bank->bank_cfg.drv = ncfg->drv;
    194  1.11.2.2    skrll 	}
    195  1.11.2.2    skrll 	if (bank->bank_cfg.conpwd != ncfg->conpwd) {
    196  1.11.2.2    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_CONPWD, ncfg->conpwd);
    197  1.11.2.2    skrll 		bank->bank_cfg.conpwd = ncfg->conpwd;
    198  1.11.2.2    skrll 	}
    199  1.11.2.2    skrll 	if (bank->bank_cfg.pudpwd != ncfg->pudpwd) {
    200  1.11.2.2    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_PUDPWD, ncfg->pudpwd);
    201  1.11.2.2    skrll 		bank->bank_cfg.pudpwd = ncfg->pudpwd;
    202       1.4  reinoud 	}
    203       1.1  reinoud }
    204       1.1  reinoud 
    205       1.1  reinoud static int
    206       1.1  reinoud exynos_gpio_pin_read(void *cookie, int pin)
    207       1.1  reinoud {
    208  1.11.2.2    skrll 	struct exynos_gpio_bank * const bank = cookie;
    209       1.1  reinoud 
    210  1.11.2.2    skrll 	KASSERT(pin < bank->bank_bits);
    211  1.11.2.2    skrll 	return (bus_space_read_1(bank->bank_sc->sc_bst,
    212  1.11.2.2    skrll 				 bank->bank_sc->sc_bsh,
    213       1.1  reinoud 		EXYNOS_GPIO_DAT) >> pin) & 1;
    214       1.1  reinoud }
    215       1.1  reinoud 
    216       1.1  reinoud static void
    217       1.1  reinoud exynos_gpio_pin_write(void *cookie, int pin, int value)
    218       1.1  reinoud {
    219  1.11.2.2    skrll 	struct exynos_gpio_bank * const bank = cookie;
    220       1.1  reinoud 	int val;
    221       1.1  reinoud 
    222  1.11.2.2    skrll 	KASSERT(pin < bank->bank_bits);
    223  1.11.2.2    skrll 	val = bus_space_read_1(bank->bank_sc->sc_bst,
    224  1.11.2.2    skrll 			       bank->bank_sc->sc_bsh,
    225  1.11.2.2    skrll 			       EXYNOS_GPIO_DAT);
    226       1.1  reinoud 	val &= ~__BIT(pin);
    227       1.1  reinoud 	if (value)
    228       1.1  reinoud 		val |= __BIT(pin);
    229  1.11.2.2    skrll 	bus_space_write_1(bank->bank_sc->sc_bst,
    230  1.11.2.2    skrll 			  bank->bank_sc->sc_bsh,
    231       1.1  reinoud 		EXYNOS_GPIO_DAT, val);
    232       1.1  reinoud }
    233       1.1  reinoud 
    234       1.1  reinoud static void
    235       1.1  reinoud exynos_gpio_pin_ctl(void *cookie, int pin, int flags)
    236       1.1  reinoud {
    237  1.11.2.2    skrll 	struct exynos_gpio_bank * const bank = cookie;
    238  1.11.2.2    skrll 	struct exynos_gpio_pin_cfg ncfg = bank->bank_cfg;
    239  1.11.2.2    skrll 	u_int shift;
    240       1.1  reinoud 	int pull;
    241       1.1  reinoud 
    242       1.1  reinoud 	/* honour pullup requests */
    243       1.1  reinoud 	pull = EXYNOS_GPIO_PIN_FLOAT;
    244       1.1  reinoud 	if (flags & GPIO_PIN_PULLUP)
    245       1.1  reinoud 		pull = EXYNOS_GPIO_PIN_PULL_UP;
    246       1.1  reinoud 	if (flags & GPIO_PIN_PULLDOWN)
    247       1.1  reinoud 		pull = EXYNOS_GPIO_PIN_PULL_DOWN;
    248  1.11.2.2    skrll 	shift = (pin & 7) << 1;
    249  1.11.2.2    skrll 	ncfg.pud &= ~(0x3 << shift);
    250  1.11.2.2    skrll 	ncfg.pud |= pull << shift;
    251       1.1  reinoud 
    252       1.1  reinoud 	/* honour i/o */
    253  1.11.2.2    skrll 	if (flags & GPIO_PIN_INPUT) {
    254  1.11.2.2    skrll 		ncfg.cfg &= ~(0x0f << shift);
    255  1.11.2.2    skrll 		ncfg.cfg |= EXYNOS_GPIO_FUNC_INPUT << shift;
    256  1.11.2.2    skrll 	} else if (flags & GPIO_PIN_OUTPUT) {
    257  1.11.2.2    skrll 		ncfg.cfg &= ~(0x0f << shift);
    258  1.11.2.2    skrll 		ncfg.cfg |= EXYNOS_GPIO_FUNC_OUTPUT << shift;
    259       1.1  reinoud 	}
    260       1.1  reinoud 
    261  1.11.2.2    skrll 	/* update any config registers that changed */
    262  1.11.2.2    skrll 	exynos_gpio_update_cfg_regs(bank, &ncfg);
    263       1.1  reinoud }
    264       1.1  reinoud 
    265  1.11.2.3    skrll void exynos_gpio_pin_ctl_read(const struct exynos_gpio_bank *bank,
    266  1.11.2.3    skrll 			      struct exynos_gpio_pin_cfg *cfg)
    267  1.11.2.3    skrll {
    268  1.11.2.3    skrll 	cfg->cfg = GPIO_READ(bank, EXYNOS_GPIO_CON);
    269  1.11.2.3    skrll 	cfg->pud = GPIO_READ(bank, EXYNOS_GPIO_PUD);
    270  1.11.2.3    skrll 	cfg->drv = GPIO_READ(bank, EXYNOS_GPIO_DRV);
    271  1.11.2.3    skrll 	cfg->conpwd = GPIO_READ(bank, EXYNOS_GPIO_CONPWD);
    272  1.11.2.3    skrll 	cfg->pudpwd = GPIO_READ(bank, EXYNOS_GPIO_PUDPWD);
    273  1.11.2.3    skrll }
    274  1.11.2.3    skrll 
    275  1.11.2.3    skrll void exynos_gpio_pin_ctl_write(const struct exynos_gpio_bank *bank,
    276  1.11.2.3    skrll 			       const struct exynos_gpio_pin_cfg *cfg)
    277  1.11.2.3    skrll {
    278  1.11.2.3    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_CON, cfg->cfg);
    279  1.11.2.3    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_PUD, cfg->pud);
    280  1.11.2.3    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_DRV, cfg->drv);
    281  1.11.2.3    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_CONPWD, cfg->conpwd);
    282  1.11.2.3    skrll 		GPIO_WRITE(bank, EXYNOS_GPIO_PUDPWD, cfg->pudpwd);
    283  1.11.2.3    skrll }
    284  1.11.2.3    skrll 
    285  1.11.2.3    skrll struct exynos_gpio_softc *
    286  1.11.2.2    skrll exynos_gpio_bank_config(struct exynos_pinctrl_softc * parent,
    287  1.11.2.2    skrll 			const struct fdt_attach_args *faa, int node)
    288       1.1  reinoud {
    289  1.11.2.2    skrll 	struct exynos_gpio_bank *bank = kmem_zalloc(sizeof(*bank), KM_SLEEP);
    290  1.11.2.2    skrll 	struct exynos_gpio_softc *sc = kmem_zalloc(sizeof(*sc), KM_SLEEP);
    291  1.11.2.2    skrll 	struct gpiobus_attach_args gba;
    292  1.11.2.2    skrll 	struct gpio_chipset_tag *gc_tag;
    293  1.11.2.2    skrll 	char result[64];
    294       1.1  reinoud 
    295  1.11.2.2    skrll 	OF_getprop(node, "name", result, sizeof(result));
    296  1.11.2.3    skrll 	bank = exynos_gpio_bank_lookup(result);
    297  1.11.2.3    skrll 	if (bank == NULL) {
    298  1.11.2.3    skrll 		aprint_error_dev(parent->sc_dev, "no bank found for %s\n",
    299  1.11.2.3    skrll 		    result);
    300  1.11.2.3    skrll 		return NULL;
    301  1.11.2.3    skrll 	}
    302  1.11.2.2    skrll 
    303  1.11.2.2    skrll 	sc->sc_dev = parent->sc_dev;
    304  1.11.2.2    skrll 	sc->sc_bst = &armv7_generic_bs_tag;
    305  1.11.2.2    skrll 	sc->sc_bsh = parent->sc_bsh;
    306  1.11.2.3    skrll 	sc->sc_bank = bank;
    307  1.11.2.3    skrll 
    308  1.11.2.2    skrll 	gc_tag = &bank->bank_gc;
    309  1.11.2.2    skrll 	gc_tag->gp_cookie = bank;
    310  1.11.2.2    skrll 	gc_tag->gp_pin_read  = exynos_gpio_pin_read;
    311  1.11.2.2    skrll 	gc_tag->gp_pin_write = exynos_gpio_pin_write;
    312  1.11.2.2    skrll 	gc_tag->gp_pin_ctl   = exynos_gpio_pin_ctl;
    313  1.11.2.2    skrll 	memset(&gba, 0, sizeof(gba));
    314  1.11.2.2    skrll 	gba.gba_gc = &bank->bank_gc;
    315  1.11.2.2    skrll 	gba.gba_pins = bank->bank_pins;
    316  1.11.2.2    skrll 	gba.gba_npins = bank->bank_bits;
    317  1.11.2.2    skrll 	bank->bank_sc = sc;
    318  1.11.2.2    skrll 	bank->bank_dev = config_found_ia(parent->sc_dev, "gpiobus", &gba,
    319  1.11.2.2    skrll 					 exynos_gpio_cfprint);
    320  1.11.2.2    skrll 
    321  1.11.2.2    skrll 	bank->bank_pin_mask = __BIT(bank->bank_bits) - 1;
    322  1.11.2.2    skrll 	bank->bank_pin_inuse_mask = 0;
    323  1.11.2.2    skrll 
    324  1.11.2.2    skrll 
    325  1.11.2.2    skrll 	/* read in our initial settings */
    326  1.11.2.2    skrll 	bank->bank_cfg.cfg = GPIO_READ(bank, EXYNOS_GPIO_CON);
    327  1.11.2.2    skrll 	bank->bank_cfg.pud = GPIO_READ(bank, EXYNOS_GPIO_PUD);
    328  1.11.2.2    skrll 	bank->bank_cfg.drv = GPIO_READ(bank, EXYNOS_GPIO_DRV);
    329  1.11.2.2    skrll 	bank->bank_cfg.conpwd = GPIO_READ(bank, EXYNOS_GPIO_CONPWD);
    330  1.11.2.2    skrll 	bank->bank_cfg.pudpwd = GPIO_READ(bank, EXYNOS_GPIO_PUDPWD);
    331       1.1  reinoud 
    332  1.11.2.3    skrll 	fdtbus_register_gpio_controller(bank->bank_dev, node,
    333  1.11.2.2    skrll 					&exynos_gpio_funcs);
    334  1.11.2.3    skrll 	return sc;
    335       1.1  reinoud }
    336       1.1  reinoud 
    337  1.11.2.2    skrll /*
    338  1.11.2.3    skrll  * This function is a bit funky.  Given a string that may look like
    339  1.11.2.3    skrll  * 'gpAN' or 'gpAN-P' it is meant to find a match to the part before
    340  1.11.2.3    skrll  * the '-', or the four character string if the dash is not present.
    341  1.11.2.2    skrll  */
    342  1.11.2.3    skrll struct exynos_gpio_bank *
    343  1.11.2.3    skrll exynos_gpio_bank_lookup(const char *name)
    344       1.5  reinoud {
    345  1.11.2.2    skrll 	struct exynos_gpio_bank *bank;
    346  1.11.2.2    skrll 
    347  1.11.2.3    skrll 	for (u_int n = 0; n < __arraycount(exynos5_banks); n++) {
    348  1.11.2.2    skrll 		bank = &exynos_gpio_banks[n];
    349  1.11.2.3    skrll 		if (!strncmp(bank->bank_name, name,
    350  1.11.2.3    skrll 			     strlen(bank->bank_name))) {
    351  1.11.2.2    skrll 			return bank;
    352  1.11.2.2    skrll 		}
    353       1.5  reinoud 	}
    354       1.5  reinoud 
    355  1.11.2.2    skrll 	return NULL;
    356       1.5  reinoud }
    357       1.5  reinoud 
    358  1.11.2.3    skrll #if notyet
    359  1.11.2.3    skrll static int
    360  1.11.2.3    skrll exynos_gpio_pin_lookup(const char *name)
    361  1.11.2.3    skrll {
    362  1.11.2.3    skrll 	char *p;
    363  1.11.2.3    skrll 
    364  1.11.2.3    skrll 	p = strchr(name, '-');
    365  1.11.2.3    skrll 	if (p == NULL || p[1] < '0' || p[1] > '9')
    366  1.11.2.3    skrll 		return -1;
    367  1.11.2.3    skrll 
    368  1.11.2.3    skrll 	return p[1] - '0';
    369  1.11.2.3    skrll }
    370  1.11.2.3    skrll #endif
    371  1.11.2.3    skrll 
    372  1.11.2.2    skrll static void *
    373  1.11.2.2    skrll exynos_gpio_fdt_acquire(device_t dev, const void *data, size_t len, int flags)
    374       1.1  reinoud {
    375  1.11.2.3    skrll 	const u_int *cells = data;
    376  1.11.2.3    skrll 	struct exynos_gpio_bank *bank = NULL;
    377  1.11.2.2    skrll 	struct exynos_gpio_pin *gpin;
    378  1.11.2.3    skrll 	int n;
    379  1.11.2.3    skrll 
    380  1.11.2.3    skrll 	if (len != 12)
    381  1.11.2.3    skrll 		return NULL;
    382       1.1  reinoud 
    383  1.11.2.3    skrll 	const int pin = be32toh(cells[1]) & 0x0f;
    384  1.11.2.3    skrll 	const int actlo = be32toh(cells[2]) & 0x01;
    385  1.11.2.3    skrll 
    386  1.11.2.3    skrll 	for (n = 0; n < __arraycount(exynos5_banks); n++) {
    387  1.11.2.3    skrll 		if (exynos_gpio_banks[n].bank_dev == dev) {
    388  1.11.2.3    skrll 			bank = &exynos_gpio_banks[n];
    389  1.11.2.3    skrll 			break;
    390  1.11.2.3    skrll 		}
    391  1.11.2.3    skrll 	}
    392  1.11.2.2    skrll 	if (bank == NULL)
    393  1.11.2.2    skrll 		return NULL;
    394       1.1  reinoud 
    395  1.11.2.2    skrll 	gpin = kmem_alloc(sizeof(*gpin), KM_SLEEP);
    396  1.11.2.2    skrll 	gpin->pin_sc = bank->bank_sc;
    397  1.11.2.2    skrll 	gpin->pin_bank = bank;
    398  1.11.2.2    skrll 	gpin->pin_no = pin;
    399  1.11.2.2    skrll 	gpin->pin_flags = flags;
    400  1.11.2.3    skrll 	gpin->pin_actlo = actlo;
    401       1.1  reinoud 
    402  1.11.2.3    skrll 	exynos_gpio_pin_ctl(bank, gpin->pin_no, gpin->pin_flags);
    403       1.1  reinoud 
    404  1.11.2.2    skrll 	return gpin;
    405  1.11.2.2    skrll }
    406       1.1  reinoud 
    407  1.11.2.2    skrll static void
    408  1.11.2.2    skrll exynos_gpio_fdt_release(device_t dev, void *priv)
    409       1.1  reinoud {
    410  1.11.2.2    skrll 	struct exynos_gpio_pin *gpin = priv;
    411       1.1  reinoud 
    412  1.11.2.2    skrll 	kmem_free(gpin, sizeof(*gpin));
    413  1.11.2.2    skrll }
    414       1.1  reinoud 
    415  1.11.2.2    skrll static int
    416  1.11.2.2    skrll exynos_gpio_fdt_read(device_t dev, void *priv, bool raw)
    417  1.11.2.2    skrll {
    418  1.11.2.2    skrll 	struct exynos_gpio_pin *gpin = priv;
    419  1.11.2.2    skrll 	int val;
    420       1.1  reinoud 
    421  1.11.2.2    skrll 	val = (bus_space_read_1(gpin->pin_sc->sc_bst,
    422  1.11.2.2    skrll 				 gpin->pin_sc->sc_bsh,
    423  1.11.2.2    skrll 				 EXYNOS_GPIO_DAT) >> gpin->pin_no) & 1;
    424       1.1  reinoud 
    425  1.11.2.2    skrll 	if (!raw && gpin->pin_actlo)
    426  1.11.2.2    skrll 		val = !val;
    427       1.1  reinoud 
    428  1.11.2.2    skrll 	return val;
    429       1.1  reinoud }
    430       1.1  reinoud 
    431  1.11.2.2    skrll static void
    432  1.11.2.2    skrll exynos_gpio_fdt_write(device_t dev, void *priv, int val, bool raw)
    433       1.1  reinoud {
    434  1.11.2.2    skrll 	struct exynos_gpio_pin *gpin = priv;
    435       1.1  reinoud 
    436  1.11.2.2    skrll 	if (!raw && gpin->pin_actlo)
    437  1.11.2.2    skrll 		val = !val;
    438       1.1  reinoud 
    439  1.11.2.2    skrll 	val = bus_space_read_1(gpin->pin_sc->sc_bst,
    440  1.11.2.2    skrll 			       gpin->pin_sc->sc_bsh,
    441  1.11.2.2    skrll 			       EXYNOS_GPIO_DAT);
    442  1.11.2.2    skrll 	val &= ~__BIT(gpin->pin_no);
    443  1.11.2.2    skrll 	if (val)
    444  1.11.2.2    skrll 		val |= __BIT(gpin->pin_no);
    445  1.11.2.2    skrll 	bus_space_write_1(gpin->pin_sc->sc_bst,
    446  1.11.2.2    skrll 			  gpin->pin_sc->sc_bsh,
    447  1.11.2.2    skrll 			  EXYNOS_GPIO_DAT, val);
    448       1.1  reinoud 
    449       1.1  reinoud }
    450