target/linux/adm5120/files-2.6.26/arch/mips/adm5120/common/gpio.c

   1 /*
   2  *  ADM5120 generic GPIO API support
   3  *
   4  *  Copyright (C) 2007-2008 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
  12 #include <linux/autoconf.h>
  13 #include <linux/init.h>
  14 #include <linux/types.h>
  15 #include <linux/module.h>
  16 #include <linux/delay.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/io.h>
  19
  20 #include <asm/addrspace.h>
  21 #include <linux/gpio.h>
  22
  23 #include <asm/mach-adm5120/adm5120_defs.h>
  24 #include <asm/mach-adm5120/adm5120_info.h>
  25 #include <asm/mach-adm5120/adm5120_switch.h>
  26 #include <asm/mach-adm5120/adm5120_irq.h>
  27
  28 #define GPIO_READ(r)            __raw_readl((r))
  29 #define GPIO_WRITE(v, r)        __raw_writel((v), (r))
  30 #define GPIO_REG(r)     (void __iomem *)(KSEG1ADDR(ADM5120_SWITCH_BASE)+r)
  31
  32 struct adm5120_gpio_line {
  33         u32 flags;
  34         const char *label;
  35         int irq;
  36 };
  37
  38 #define GPIO_FLAG_VALID         0x01
  39 #define GPIO_FLAG_USED          0x02
  40
  41 struct led_desc {
  42         void __iomem *reg;      /* LED register address */
  43         u8 iv_shift;            /* shift amount for input bit */
  44         u8 mode_shift;          /* shift amount for mode bits */
  45 };
  46
  47 #define LED_DESC(p, l) { \
  48                 .reg = GPIO_REG(SWITCH_REG_PORT0_LED+((p) * 4)), \
  49                 .iv_shift = LED0_IV_SHIFT + (l), \
  50                 .mode_shift = (l) * 4 \
  51         }
  52
  53 static struct led_desc led_table[15] = {
  54         LED_DESC(0, 0), LED_DESC(0, 1), LED_DESC(0, 2),
  55         LED_DESC(1, 0), LED_DESC(1, 1), LED_DESC(1, 2),
  56         LED_DESC(2, 0), LED_DESC(2, 1), LED_DESC(2, 2),
  57         LED_DESC(3, 0), LED_DESC(3, 1), LED_DESC(3, 2),
  58         LED_DESC(4, 0), LED_DESC(4, 1), LED_DESC(4, 2)
  59 };
  60
  61 static struct adm5120_gpio_line adm5120_gpio_map[ADM5120_GPIO_COUNT];
  62
  63 static u32 gpio_conf2;
  64
  65 /*-------------------------------------------------------------------------*/
  66
  67 static inline int gpio_is_invalid(unsigned gpio)
  68 {
  69         if ((gpio > ADM5120_GPIO_MAX) ||
  70                 (adm5120_gpio_map[gpio].flags & GPIO_FLAG_VALID) == 0)
  71                 return 1;
  72
  73         return 0;
  74 }
  75
  76 static inline int gpio_is_used(unsigned gpio)
  77 {
  78         return ((adm5120_gpio_map[gpio].flags & GPIO_FLAG_USED) != 0);
  79 }
  80
  81 /*-------------------------------------------------------------------------*/
  82
  83 /*
  84  * Helpers for GPIO lines in GPIO_CONF0 register
  85  */
  86 #define PIN_IM(p)       ((1 << GPIO_CONF0_IM_SHIFT) << p)
  87 #define PIN_IV(p)       ((1 << GPIO_CONF0_IV_SHIFT) << p)
  88 #define PIN_OE(p)       ((1 << GPIO_CONF0_OE_SHIFT) << p)
  89 #define PIN_OV(p)       ((1 << GPIO_CONF0_OV_SHIFT) << p)
  90
  91 static inline int pins_direction_input(unsigned pin)
  92 {
  93         void __iomem **reg;
  94         u32 t;
  95
  96         reg = GPIO_REG(SWITCH_REG_GPIO_CONF0);
  97
  98         t = GPIO_READ(reg);
  99         t &= ~(PIN_OE(pin));
 100         t |= PIN_IM(pin);
 101         GPIO_WRITE(t, reg);
 102
 103         return 0;
 104 }
 105
 106 static inline int pins_direction_output(unsigned pin, int value)
 107 {
 108         void __iomem **reg;
 109         u32 t;
 110
 111         reg = GPIO_REG(SWITCH_REG_GPIO_CONF0);
 112
 113         t = GPIO_READ(reg);
 114         t &= ~(PIN_IM(pin) | PIN_OV(pin));
 115         t |= PIN_OE(pin);
 116
 117         if (value)
 118                 t |= PIN_OV(pin);
 119
 120         GPIO_WRITE(t, reg);
 121
 122         return 0;
 123 }
 124
 125 static inline int pins_get_value(unsigned pin)
 126 {
 127         void __iomem **reg;
 128         u32 t;
 129
 130         reg = GPIO_REG(SWITCH_REG_GPIO_CONF0);
 131
 132         t = GPIO_READ(reg);
 133         if ((t & PIN_IM(pin)) != 0)
 134                 t &= PIN_IV(pin);
 135         else
 136                 t &= PIN_OV(pin);
 137
 138         return (t) ? 1 : 0;
 139 }
 140
 141 static inline void pins_set_value(unsigned pin, int value)
 142 {
 143         void __iomem **reg;
 144         u32 t;
 145
 146         reg = GPIO_REG(SWITCH_REG_GPIO_CONF0);
 147
 148         t = GPIO_READ(reg);
 149         if (value == 0)
 150                 t &= ~(PIN_OV(pin));
 151         else
 152                 t |= PIN_OV(pin);
 153
 154         GPIO_WRITE(t, reg);
 155 }
 156
 157 /*
 158  * Helpers for GPIO lines in PORTx_LED registers
 159  */
 160 static inline int leds_direction_input(unsigned led)
 161 {
 162         void __iomem **reg;
 163         u32 t;
 164
 165         reg = led_table[led].reg;
 166         t = GPIO_READ(reg);
 167         t &= ~(LED_MODE_MASK << led_table[led].mode_shift);
 168         GPIO_WRITE(t, reg);
 169
 170         return 0;
 171 }
 172
 173 static inline int leds_direction_output(unsigned led, int value)
 174 {
 175         void __iomem **reg;
 176         u32 t, s;
 177
 178         reg = led_table[led].reg;
 179         s = led_table[led].mode_shift;
 180
 181         t = GPIO_READ(reg);
 182         t &= ~(LED_MODE_MASK << s);
 183
 184         switch (value) {
 185         case ADM5120_GPIO_LOW:
 186                 t |= (LED_MODE_OUT_LOW << s);
 187                 break;
 188         case ADM5120_GPIO_FLASH:
 189         case ADM5120_GPIO_LINK:
 190         case ADM5120_GPIO_SPEED:
 191         case ADM5120_GPIO_DUPLEX:
 192         case ADM5120_GPIO_ACT:
 193         case ADM5120_GPIO_COLL:
 194         case ADM5120_GPIO_LINK_ACT:
 195         case ADM5120_GPIO_DUPLEX_COLL:
 196         case ADM5120_GPIO_10M_ACT:
 197         case ADM5120_GPIO_100M_ACT:
 198                 t |= ((value & LED_MODE_MASK) << s);
 199                 break;
 200         default:
 201                 t |= (LED_MODE_OUT_HIGH << s);
 202                 break;
 203         }
 204
 205         GPIO_WRITE(t, reg);
 206
 207         return 0;
 208 }
 209
 210 static inline int leds_get_value(unsigned led)
 211 {
 212         void __iomem **reg;
 213         u32 t, m;
 214
 215         reg = led_table[led].reg;
 216
 217         t = GPIO_READ(reg);
 218         m = (t >> led_table[led].mode_shift) & LED_MODE_MASK;
 219         if (m == LED_MODE_INPUT)
 220                 return (t >> led_table[led].iv_shift) & 1;
 221
 222         if (m == LED_MODE_OUT_LOW)
 223                 return 0;
 224
 225         return 1;
 226 }
 227
 228 /*-------------------------------------------------------------------------*/
 229
 230 /*
 231  * Main GPIO support routines
 232  */
 233 int adm5120_gpio_direction_input(unsigned gpio)
 234 {
 235         if (gpio_is_invalid(gpio))
 236                 return -EINVAL;
 237
 238         if (gpio < ADM5120_GPIO_P0L0)
 239                 return pins_direction_input(gpio);
 240
 241         gpio -= ADM5120_GPIO_P0L0;
 242         return leds_direction_input(gpio);
 243 }
 244 EXPORT_SYMBOL(adm5120_gpio_direction_input);
 245
 246 int adm5120_gpio_direction_output(unsigned gpio, int value)
 247 {
 248         if (gpio_is_invalid(gpio))
 249                 return -EINVAL;
 250
 251         if (gpio < ADM5120_GPIO_P0L0)
 252                 return pins_direction_output(gpio, value);
 253
 254         gpio -= ADM5120_GPIO_P0L0;
 255         return leds_direction_output(gpio, value);
 256 }
 257 EXPORT_SYMBOL(adm5120_gpio_direction_output);
 258
 259 int adm5120_gpio_get_value(unsigned gpio)
 260 {
 261         if (gpio < ADM5120_GPIO_P0L0)
 262                 return pins_get_value(gpio);
 263
 264         gpio -= ADM5120_GPIO_P0L0;
 265         return leds_get_value(gpio);
 266 }
 267 EXPORT_SYMBOL(adm5120_gpio_get_value);
 268
 269 void adm5120_gpio_set_value(unsigned gpio, int value)
 270 {
 271         if (gpio < ADM5120_GPIO_P0L0) {
 272                 pins_set_value(gpio, value);
 273                 return;
 274         }
 275
 276         gpio -= ADM5120_GPIO_P0L0;
 277         leds_direction_output(gpio, value);
 278 }
 279 EXPORT_SYMBOL(adm5120_gpio_set_value);
 280
 281 int adm5120_gpio_request(unsigned gpio, const char *label)
 282 {
 283         if (gpio_is_invalid(gpio))
 284                 return -EINVAL;
 285
 286         if (gpio_is_used(gpio))
 287                 return -EBUSY;
 288
 289         adm5120_gpio_map[gpio].flags |= GPIO_FLAG_USED;
 290         adm5120_gpio_map[gpio].label = label;
 291
 292         return 0;
 293 }
 294 EXPORT_SYMBOL(adm5120_gpio_request);
 295
 296 void adm5120_gpio_free(unsigned gpio)
 297 {
 298         if (gpio_is_invalid(gpio))
 299                 return;
 300
 301         adm5120_gpio_map[gpio].flags &= ~GPIO_FLAG_USED;
 302         adm5120_gpio_map[gpio].label = NULL;
 303 }
 304 EXPORT_SYMBOL(adm5120_gpio_free);
 305
 306 int adm5120_gpio_to_irq(unsigned gpio)
 307 {
 308         if (gpio > ADM5120_GPIO_MAX)
 309                 return -EINVAL;
 310
 311         return adm5120_gpio_map[gpio].irq;
 312 }
 313 EXPORT_SYMBOL(adm5120_gpio_to_irq);
 314
 315 int adm5120_irq_to_gpio(unsigned irq)
 316 {
 317         int i;
 318
 319         for (i = 0; i < ADM5120_GPIO_COUNT; i++)
 320                 if (adm5120_gpio_map[i].irq == irq)
 321                         return i;
 322
 323         return -EINVAL;
 324 }
 325 EXPORT_SYMBOL(adm5120_irq_to_gpio);
 326
 327 /*-------------------------------------------------------------------------*/
 328
 329 void __init adm5120_gpio_csx0_enable(void)
 330 {
 331         gpio_conf2 |= GPIO_CONF2_CSX0;
 332         SW_WRITE_REG(SWITCH_REG_GPIO_CONF2, gpio_conf2);
 333
 334         adm5120_gpio_map[ADM5120_GPIO_PIN1].flags &= ~GPIO_FLAG_VALID;
 335         adm5120_gpio_map[ADM5120_GPIO_PIN2].irq = ADM5120_IRQ_GPIO2;
 336 }
 337
 338 void __init adm5120_gpio_csx1_enable(void)
 339 {
 340         gpio_conf2 |= GPIO_CONF2_CSX1;
 341         SW_WRITE_REG(SWITCH_REG_GPIO_CONF2, gpio_conf2);
 342
 343         adm5120_gpio_map[ADM5120_GPIO_PIN3].flags &= ~GPIO_FLAG_VALID;
 344         if (adm5120_package_bga())
 345                 adm5120_gpio_map[ADM5120_GPIO_PIN4].irq = ADM5120_IRQ_GPIO4;
 346 }
 347
 348 void __init adm5120_gpio_ew_enable(void)
 349 {
 350         gpio_conf2 |= GPIO_CONF2_EW;
 351         SW_WRITE_REG(SWITCH_REG_GPIO_CONF2, gpio_conf2);
 352
 353         adm5120_gpio_map[ADM5120_GPIO_PIN0].flags &= ~GPIO_FLAG_VALID;
 354 }
 355
 356 void __init adm5120_gpio_init(void)
 357 {
 358         int i;
 359
 360         gpio_conf2 = 0;
 361         SW_WRITE_REG(SWITCH_REG_GPIO_CONF2, gpio_conf2);
 362
 363         for (i = 0; i < ADM5120_GPIO_COUNT; i++)
 364                 adm5120_gpio_map[i].flags = GPIO_FLAG_VALID;
 365
 366         if (adm5120_package_pqfp()) {
 367                 adm5120_gpio_map[ADM5120_GPIO_PIN4].flags &= ~GPIO_FLAG_VALID;
 368                 adm5120_gpio_map[ADM5120_GPIO_PIN5].flags &= ~GPIO_FLAG_VALID;
 369                 adm5120_gpio_map[ADM5120_GPIO_PIN6].flags &= ~GPIO_FLAG_VALID;
 370                 adm5120_gpio_map[ADM5120_GPIO_PIN7].flags &= ~GPIO_FLAG_VALID;
 371         }
 372 }