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