target/linux/ramips/files/arch/mips/ralink/common/gpio.c

   1 /*
   2  * Ralink SoC specific GPIO support
   3  *
   4  * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>
   5  *
   6  * This program is free software; you can redistribute it and/or modify it
   7  * under the terms of the GNU General Public License version 2 as published
   8  * by the Free Software Foundation.
   9  */
  10
  11 #include <linux/init.h>
  12 #include <linux/io.h>
  13
  14 #include <linux/gpio.h>
  15
  16 #include <ralink_soc.h>
  17
  18 #define GPIO0_REG_INT           0x00
  19 #define GPIO0_REG_EDGE          0x04
  20 #define GPIO0_REG_RENA          0x08
  21 #define GPIO0_REG_FENA          0x0c
  22 #define GPIO0_REG_DATA          0x20
  23 #define GPIO0_REG_DIR           0x24
  24 #define GPIO0_REG_POL           0x28
  25 #define GPIO0_REG_SET           0x2c
  26 #define GPIO0_REG_RESET         0x30
  27 #define GPIO0_REG_TOGGLE        0x34
  28
  29 #define GPIO1_REG_INT           0x38
  30 #define GPIO1_REG_EDGE          0x3c
  31 #define GPIO1_REG_RENA          0x40
  32 #define GPIO1_REG_FENA          0x44
  33 #define GPIO1_REG_DATA          0x48
  34 #define GPIO1_REG_DIR           0x4c
  35 #define GPIO1_REG_POL           0x50
  36 #define GPIO1_REG_SET           0x54
  37 #define GPIO1_REG_RESET         0x58
  38 #define GPIO1_REG_TOGGLE        0x5c
  39
  40 #define GPIO2_REG_INT           0x60
  41 #define GPIO2_REG_EDGE          0x64
  42 #define GPIO2_REG_RENA          0x68
  43 #define GPIO2_REG_FENA          0x6c
  44 #define GPIO2_REG_DATA          0x70
  45 #define GPIO2_REG_DIR           0x74
  46 #define GPIO2_REG_POL           0x78
  47 #define GPIO2_REG_SET           0x7c
  48 #define GPIO2_REG_RESET         0x80
  49 #define GPIO2_REG_TOGGLE        0x84
  50
  51 enum ramips_pio_reg {
  52         RAMIPS_GPIO_REG_INT,            /* Interrupt status */
  53         RAMIPS_GPIO_REG_EDGE,
  54         RAMIPS_GPIO_REG_RENA,
  55         RAMIPS_GPIO_REG_FENA,
  56         RAMIPS_GPIO_REG_DATA,
  57         RAMIPS_GPIO_REG_DIR,            /* Direction, 0:in, 1: out */
  58         RAMIPS_GPIO_REG_POL,            /* Polarity, 0: normal, 1: invert */
  59         RAMIPS_GPIO_REG_SET,
  60         RAMIPS_GPIO_REG_RESET,
  61         RAMIPS_GPIO_REG_TOGGLE,
  62         RAMIPS_GPIO_REG_MAX
  63 };
  64
  65 struct ramips_gpio_chip {
  66         struct gpio_chip        chip;
  67         u8                      regs[RAMIPS_GPIO_REG_MAX];
  68 };
  69
  70 static void __iomem *ramips_gpio_base;
  71
  72 static inline struct ramips_gpio_chip *to_ramips_gpio(struct gpio_chip *chip)
  73 {
  74         struct ramips_gpio_chip *rg;
  75
  76         rg = container_of(chip, struct ramips_gpio_chip, chip);
  77         return rg;
  78 }
  79
  80 static inline void ramips_gpio_wr(struct ramips_gpio_chip *rg, u8 reg, u32 val)
  81 {
  82         __raw_writel(val, ramips_gpio_base + rg->regs[reg]);
  83 }
  84
  85 static inline u32 ramips_gpio_rr(struct ramips_gpio_chip *rg, u8 reg)
  86 {
  87         return __raw_readl(ramips_gpio_base + rg->regs[reg]);
  88 }
  89
  90 static int ramips_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
  91 {
  92         struct ramips_gpio_chip *rg = to_ramips_gpio(chip);
  93         u32 t;
  94
  95         t = ramips_gpio_rr(rg, RAMIPS_GPIO_REG_DIR);
  96         t &= ~(1 << offset);
  97         ramips_gpio_wr(rg, RAMIPS_GPIO_REG_DIR, t);
  98
  99         return 0;
 100 }
 101
 102 static int ramips_gpio_direction_output(struct gpio_chip *chip,
 103                                         unsigned offset, int value)
 104 {
 105         struct ramips_gpio_chip *rg = to_ramips_gpio(chip);
 106         u32 reg;
 107         u32 t;
 108
 109         reg = (value) ? RAMIPS_GPIO_REG_SET : RAMIPS_GPIO_REG_RESET;
 110         ramips_gpio_wr(rg, reg, 1 << offset);
 111
 112         t = ramips_gpio_rr(rg, RAMIPS_GPIO_REG_DIR);
 113         t |= 1 << offset;
 114         ramips_gpio_wr(rg, RAMIPS_GPIO_REG_DIR, t);
 115
 116         return 0;
 117 }
 118
 119 static void ramips_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
 120 {
 121         struct ramips_gpio_chip *rg = to_ramips_gpio(chip);
 122         u32 reg;
 123
 124         reg = (value) ? RAMIPS_GPIO_REG_SET : RAMIPS_GPIO_REG_RESET;
 125         ramips_gpio_wr(rg, reg, 1 << offset);
 126 }
 127
 128 static int ramips_gpio_get(struct gpio_chip *chip, unsigned offset)
 129 {
 130         struct ramips_gpio_chip *rg = to_ramips_gpio(chip);
 131         u32 t;
 132
 133         t = ramips_gpio_rr(rg, RAMIPS_GPIO_REG_DATA);
 134         return !!(t & (1 << offset));
 135 }
 136
 137 static struct ramips_gpio_chip ramips_gpio_chip0 = {
 138         .chip = {
 139                 .label                  = "ramips-gpio0",
 140                 .direction_input        = ramips_gpio_direction_input,
 141                 .direction_output       = ramips_gpio_direction_output,
 142                 .get                    = ramips_gpio_get,
 143                 .set                    = ramips_gpio_set,
 144                 .base                   = 0,
 145                 .ngpio                  = RALINK_SOC_GPIO0_COUNT,
 146         },
 147         .regs = {
 148                 [RAMIPS_GPIO_REG_INT]   = GPIO0_REG_INT,
 149                 [RAMIPS_GPIO_REG_EDGE]  = GPIO0_REG_EDGE,
 150                 [RAMIPS_GPIO_REG_RENA]  = GPIO0_REG_RENA,
 151                 [RAMIPS_GPIO_REG_FENA]  = GPIO0_REG_FENA,
 152                 [RAMIPS_GPIO_REG_DATA]  = GPIO0_REG_DATA,
 153                 [RAMIPS_GPIO_REG_DIR]   = GPIO0_REG_DIR,
 154                 [RAMIPS_GPIO_REG_POL]   = GPIO0_REG_POL,
 155                 [RAMIPS_GPIO_REG_SET]   = GPIO0_REG_SET,
 156                 [RAMIPS_GPIO_REG_RESET] = GPIO0_REG_RESET,
 157                 [RAMIPS_GPIO_REG_TOGGLE] = GPIO0_REG_TOGGLE,
 158         },
 159 };
 160
 161 static struct ramips_gpio_chip ramips_gpio_chip1 = {
 162         .chip = {
 163                 .label                  = "ramips-gpio1",
 164                 .direction_input        = ramips_gpio_direction_input,
 165                 .direction_output       = ramips_gpio_direction_output,
 166                 .get                    = ramips_gpio_get,
 167                 .set                    = ramips_gpio_set,
 168                 .base                   = 32,
 169                 .ngpio                  = RALINK_SOC_GPIO1_COUNT,
 170         },
 171         .regs = {
 172                 [RAMIPS_GPIO_REG_INT]   = GPIO1_REG_INT,
 173                 [RAMIPS_GPIO_REG_EDGE]  = GPIO1_REG_EDGE,
 174                 [RAMIPS_GPIO_REG_RENA]  = GPIO1_REG_RENA,
 175                 [RAMIPS_GPIO_REG_FENA]  = GPIO1_REG_FENA,
 176                 [RAMIPS_GPIO_REG_DATA]  = GPIO1_REG_DATA,
 177                 [RAMIPS_GPIO_REG_DIR]   = GPIO1_REG_DIR,
 178                 [RAMIPS_GPIO_REG_POL]   = GPIO1_REG_POL,
 179                 [RAMIPS_GPIO_REG_SET]   = GPIO1_REG_SET,
 180                 [RAMIPS_GPIO_REG_RESET] = GPIO1_REG_RESET,
 181                 [RAMIPS_GPIO_REG_TOGGLE] = GPIO1_REG_TOGGLE,
 182         },
 183 };
 184
 185 static struct ramips_gpio_chip ramips_gpio_chip2 = {
 186         .chip = {
 187                 .label                  = "ramips-gpio2",
 188                 .direction_input        = ramips_gpio_direction_input,
 189                 .direction_output       = ramips_gpio_direction_output,
 190                 .get                    = ramips_gpio_get,
 191                 .set                    = ramips_gpio_set,
 192                 .base                   = 64,
 193                 .ngpio                  = RALINK_SOC_GPIO2_COUNT,
 194         },
 195         .regs = {
 196                 [RAMIPS_GPIO_REG_INT]   = GPIO2_REG_INT,
 197                 [RAMIPS_GPIO_REG_EDGE]  = GPIO2_REG_EDGE,
 198                 [RAMIPS_GPIO_REG_RENA]  = GPIO2_REG_RENA,
 199                 [RAMIPS_GPIO_REG_FENA]  = GPIO2_REG_FENA,
 200                 [RAMIPS_GPIO_REG_DATA]  = GPIO2_REG_DATA,
 201                 [RAMIPS_GPIO_REG_DIR]   = GPIO2_REG_DIR,
 202                 [RAMIPS_GPIO_REG_POL]   = GPIO2_REG_POL,
 203                 [RAMIPS_GPIO_REG_SET]   = GPIO2_REG_SET,
 204                 [RAMIPS_GPIO_REG_RESET] = GPIO2_REG_RESET,
 205                 [RAMIPS_GPIO_REG_TOGGLE] = GPIO2_REG_TOGGLE,
 206         },
 207 };
 208
 209 static __init void ramips_gpio_chip_add(struct ramips_gpio_chip *rg)
 210 {
 211         /* set polarity to low for all lines */
 212         ramips_gpio_wr(rg, RAMIPS_GPIO_REG_POL, 0);
 213
 214         gpiochip_add(&rg->chip);
 215 }
 216
 217 __init int ramips_gpio_init(void)
 218 {
 219         ramips_gpio_base = ioremap_nocache(RALINK_SOC_GPIO_BASE, PAGE_SIZE);
 220
 221         ramips_gpio_chip_add(&ramips_gpio_chip0);
 222         ramips_gpio_chip_add(&ramips_gpio_chip1);
 223         ramips_gpio_chip_add(&ramips_gpio_chip2);
 224
 225         return 0;
 226 }