release/src-rt-6.x.4708/linux/linux-2.6.36/arch/blackfin/kernel/bfin_gpio.c

   1 /*
   2  * GPIO Abstraction Layer
   3  *
   4  * Copyright 2006-2009 Analog Devices Inc.
   5  *
   6  * Licensed under the GPL-2 or later
   7  */
   8
   9 #include <linux/delay.h>
  10 #include <linux/module.h>
  11 #include <linux/err.h>
  12 #include <linux/proc_fs.h>
  13 #include <asm/blackfin.h>
  14 #include <asm/gpio.h>
  15 #include <asm/portmux.h>
  16 #include <linux/irq.h>
  17
  18 #if ANOMALY_05000311 || ANOMALY_05000323
  19 enum {
  20         AWA_data = SYSCR,
  21         AWA_data_clear = SYSCR,
  22         AWA_data_set = SYSCR,
  23         AWA_toggle = SYSCR,
  24         AWA_maska = BFIN_UART_SCR,
  25         AWA_maska_clear = BFIN_UART_SCR,
  26         AWA_maska_set = BFIN_UART_SCR,
  27         AWA_maska_toggle = BFIN_UART_SCR,
  28         AWA_maskb = BFIN_UART_GCTL,
  29         AWA_maskb_clear = BFIN_UART_GCTL,
  30         AWA_maskb_set = BFIN_UART_GCTL,
  31         AWA_maskb_toggle = BFIN_UART_GCTL,
  32         AWA_dir = SPORT1_STAT,
  33         AWA_polar = SPORT1_STAT,
  34         AWA_edge = SPORT1_STAT,
  35         AWA_both = SPORT1_STAT,
  36 #if ANOMALY_05000311
  37         AWA_inen = TIMER_ENABLE,
  38 #elif ANOMALY_05000323
  39         AWA_inen = DMA1_1_CONFIG,
  40 #endif
  41 };
  42 #define AWA_DUMMY_READ(name) bfin_read16(AWA_ ## name)
  43 #else
  44 #define AWA_DUMMY_READ(...)  do { } while (0)
  45 #endif
  46
  47 static struct gpio_port_t * const gpio_array[] = {
  48 #if defined(BF533_FAMILY) || defined(BF538_FAMILY)
  49         (struct gpio_port_t *) FIO_FLAG_D,
  50 #elif defined(CONFIG_BF52x) || defined(BF537_FAMILY) || defined(CONFIG_BF51x)
  51         (struct gpio_port_t *) PORTFIO,
  52         (struct gpio_port_t *) PORTGIO,
  53         (struct gpio_port_t *) PORTHIO,
  54 #elif defined(BF561_FAMILY)
  55         (struct gpio_port_t *) FIO0_FLAG_D,
  56         (struct gpio_port_t *) FIO1_FLAG_D,
  57         (struct gpio_port_t *) FIO2_FLAG_D,
  58 #elif defined(CONFIG_BF54x)
  59         (struct gpio_port_t *)PORTA_FER,
  60         (struct gpio_port_t *)PORTB_FER,
  61         (struct gpio_port_t *)PORTC_FER,
  62         (struct gpio_port_t *)PORTD_FER,
  63         (struct gpio_port_t *)PORTE_FER,
  64         (struct gpio_port_t *)PORTF_FER,
  65         (struct gpio_port_t *)PORTG_FER,
  66         (struct gpio_port_t *)PORTH_FER,
  67         (struct gpio_port_t *)PORTI_FER,
  68         (struct gpio_port_t *)PORTJ_FER,
  69 #else
  70 # error no gpio arrays defined
  71 #endif
  72 };
  73
  74 #if defined(CONFIG_BF52x) || defined(BF537_FAMILY) || defined(CONFIG_BF51x)
  75 static unsigned short * const port_fer[] = {
  76         (unsigned short *) PORTF_FER,
  77         (unsigned short *) PORTG_FER,
  78         (unsigned short *) PORTH_FER,
  79 };
  80
  81 # if !defined(BF537_FAMILY)
  82 static unsigned short * const port_mux[] = {
  83         (unsigned short *) PORTF_MUX,
  84         (unsigned short *) PORTG_MUX,
  85         (unsigned short *) PORTH_MUX,
  86 };
  87
  88 static const
  89 u8 pmux_offset[][16] = {
  90 #  if defined(CONFIG_BF52x)
  91         { 0, 0, 0, 0, 0, 0, 0, 0, 2, 2, 4, 6, 8, 8, 10, 10 }, /* PORTF */
  92         { 0, 0, 0, 0, 0, 2, 2, 4, 4, 6, 8, 10, 10, 10, 12, 12 }, /* PORTG */
  93         { 0, 0, 0, 0, 0, 0, 0, 0, 2, 4, 4, 4, 4, 4, 4, 4 }, /* PORTH */
  94 #  elif defined(CONFIG_BF51x)
  95         { 0, 2, 2, 2, 2, 2, 2, 4, 6, 6, 6, 8, 8, 8, 8, 10 }, /* PORTF */
  96         { 0, 0, 0, 2, 4, 6, 6, 6, 8, 10, 10, 12, 14, 14, 14, 14 }, /* PORTG */
  97         { 0, 0, 0, 0, 2, 2, 4, 6, 10, 10, 10, 10, 10, 10, 10, 10 }, /* PORTH */
  98 #  endif
  99 };
 100 # endif
 101
 102 #elif defined(BF538_FAMILY)
 103 static unsigned short * const port_fer[] = {
 104         (unsigned short *) PORTCIO_FER,
 105         (unsigned short *) PORTDIO_FER,
 106         (unsigned short *) PORTEIO_FER,
 107 };
 108 #endif
 109
 110 #define RESOURCE_LABEL_SIZE     16
 111
 112 static struct str_ident {
 113         char name[RESOURCE_LABEL_SIZE];
 114 } str_ident[MAX_RESOURCES];
 115
 116 #if defined(CONFIG_PM)
 117 static struct gpio_port_s gpio_bank_saved[GPIO_BANK_NUM];
 118 #endif
 119
 120 static void gpio_error(unsigned gpio)
 121 {
 122         printk(KERN_ERR "bfin-gpio: GPIO %d wasn't requested!\n", gpio);
 123 }
 124
 125 static void set_label(unsigned short ident, const char *label)
 126 {
 127         if (label) {
 128                 strncpy(str_ident[ident].name, label,
 129                          RESOURCE_LABEL_SIZE);
 130                 str_ident[ident].name[RESOURCE_LABEL_SIZE - 1] = 0;
 131         }
 132 }
 133
 134 static char *get_label(unsigned short ident)
 135 {
 136         return (*str_ident[ident].name ? str_ident[ident].name : "UNKNOWN");
 137 }
 138
 139 static int cmp_label(unsigned short ident, const char *label)
 140 {
 141         if (label == NULL) {
 142                 dump_stack();
 143                 printk(KERN_ERR "Please provide none-null label\n");
 144         }
 145
 146         if (label)
 147                 return strcmp(str_ident[ident].name, label);
 148         else
 149                 return -EINVAL;
 150 }
 151
 152 #define map_entry(m, i)      reserved_##m##_map[gpio_bank(i)]
 153 #define is_reserved(m, i, e) (map_entry(m, i) & gpio_bit(i))
 154 #define reserve(m, i)        (map_entry(m, i) |= gpio_bit(i))
 155 #define unreserve(m, i)      (map_entry(m, i) &= ~gpio_bit(i))
 156 #define DECLARE_RESERVED_MAP(m, c) static unsigned short reserved_##m##_map[c]
 157
 158 DECLARE_RESERVED_MAP(gpio, GPIO_BANK_NUM);
 159 DECLARE_RESERVED_MAP(peri, DIV_ROUND_UP(MAX_RESOURCES, GPIO_BANKSIZE));
 160 DECLARE_RESERVED_MAP(gpio_irq, GPIO_BANK_NUM);
 161
 162 inline int check_gpio(unsigned gpio)
 163 {
 164 #if defined(CONFIG_BF54x)
 165         if (gpio == GPIO_PB15 || gpio == GPIO_PC14 || gpio == GPIO_PC15
 166             || gpio == GPIO_PH14 || gpio == GPIO_PH15
 167             || gpio == GPIO_PJ14 || gpio == GPIO_PJ15)
 168                 return -EINVAL;
 169 #endif
 170         if (gpio >= MAX_BLACKFIN_GPIOS)
 171                 return -EINVAL;
 172         return 0;
 173 }
 174
 175 static void port_setup(unsigned gpio, unsigned short usage)
 176 {
 177 #if defined(BF538_FAMILY)
 178         /*
 179          * BF538/9 Port C,D and E are special.
 180          * Inverted PORT_FER polarity on CDE and no PORF_FER on F
 181          * Regular PORT F GPIOs are handled here, CDE are exclusively
 182          * managed by GPIOLIB
 183          */
 184
 185         if (gpio < MAX_BLACKFIN_GPIOS || gpio >= MAX_RESOURCES)
 186                 return;
 187
 188         gpio -= MAX_BLACKFIN_GPIOS;
 189
 190         if (usage == GPIO_USAGE)
 191                 *port_fer[gpio_bank(gpio)] |= gpio_bit(gpio);
 192         else
 193                 *port_fer[gpio_bank(gpio)] &= ~gpio_bit(gpio);
 194         SSYNC();
 195         return;
 196 #endif
 197
 198         if (check_gpio(gpio))
 199                 return;
 200
 201 #if defined(CONFIG_BF52x) || defined(BF537_FAMILY) || defined(CONFIG_BF51x)
 202         if (usage == GPIO_USAGE)
 203                 *port_fer[gpio_bank(gpio)] &= ~gpio_bit(gpio);
 204         else
 205                 *port_fer[gpio_bank(gpio)] |= gpio_bit(gpio);
 206         SSYNC();
 207 #elif defined(CONFIG_BF54x)
 208         if (usage == GPIO_USAGE)
 209                 gpio_array[gpio_bank(gpio)]->port_fer &= ~gpio_bit(gpio);
 210         else
 211                 gpio_array[gpio_bank(gpio)]->port_fer |= gpio_bit(gpio);
 212         SSYNC();
 213 #endif
 214 }
 215
 216 #ifdef BF537_FAMILY
 217 static struct {
 218         unsigned short res;
 219         unsigned short offset;
 220 } port_mux_lut[] = {
 221         {.res = P_PPI0_D13, .offset = 11},
 222         {.res = P_PPI0_D14, .offset = 11},
 223         {.res = P_PPI0_D15, .offset = 11},
 224         {.res = P_SPORT1_TFS, .offset = 11},
 225         {.res = P_SPORT1_TSCLK, .offset = 11},
 226         {.res = P_SPORT1_DTPRI, .offset = 11},
 227         {.res = P_PPI0_D10, .offset = 10},
 228         {.res = P_PPI0_D11, .offset = 10},
 229         {.res = P_PPI0_D12, .offset = 10},
 230         {.res = P_SPORT1_RSCLK, .offset = 10},
 231         {.res = P_SPORT1_RFS, .offset = 10},
 232         {.res = P_SPORT1_DRPRI, .offset = 10},
 233         {.res = P_PPI0_D8, .offset = 9},
 234         {.res = P_PPI0_D9, .offset = 9},
 235         {.res = P_SPORT1_DRSEC, .offset = 9},
 236         {.res = P_SPORT1_DTSEC, .offset = 9},
 237         {.res = P_TMR2, .offset = 8},
 238         {.res = P_PPI0_FS3, .offset = 8},
 239         {.res = P_TMR3, .offset = 7},
 240         {.res = P_SPI0_SSEL4, .offset = 7},
 241         {.res = P_TMR4, .offset = 6},
 242         {.res = P_SPI0_SSEL5, .offset = 6},
 243         {.res = P_TMR5, .offset = 5},
 244         {.res = P_SPI0_SSEL6, .offset = 5},
 245         {.res = P_UART1_RX, .offset = 4},
 246         {.res = P_UART1_TX, .offset = 4},
 247         {.res = P_TMR6, .offset = 4},
 248         {.res = P_TMR7, .offset = 4},
 249         {.res = P_UART0_RX, .offset = 3},
 250         {.res = P_UART0_TX, .offset = 3},
 251         {.res = P_DMAR0, .offset = 3},
 252         {.res = P_DMAR1, .offset = 3},
 253         {.res = P_SPORT0_DTSEC, .offset = 1},
 254         {.res = P_SPORT0_DRSEC, .offset = 1},
 255         {.res = P_CAN0_RX, .offset = 1},
 256         {.res = P_CAN0_TX, .offset = 1},
 257         {.res = P_SPI0_SSEL7, .offset = 1},
 258         {.res = P_SPORT0_TFS, .offset = 0},
 259         {.res = P_SPORT0_DTPRI, .offset = 0},
 260         {.res = P_SPI0_SSEL2, .offset = 0},
 261         {.res = P_SPI0_SSEL3, .offset = 0},
 262 };
 263
 264 static void portmux_setup(unsigned short per)
 265 {
 266         u16 y, offset, muxreg;
 267         u16 function = P_FUNCT2MUX(per);
 268
 269         for (y = 0; y < ARRAY_SIZE(port_mux_lut); y++) {
 270                 if (port_mux_lut[y].res == per) {
 271
 272                         /* SET PORTMUX REG */
 273
 274                         offset = port_mux_lut[y].offset;
 275                         muxreg = bfin_read_PORT_MUX();
 276
 277                         if (offset != 1)
 278                                 muxreg &= ~(1 << offset);
 279                         else
 280                                 muxreg &= ~(3 << 1);
 281
 282                         muxreg |= (function << offset);
 283                         bfin_write_PORT_MUX(muxreg);
 284                 }
 285         }
 286 }
 287 #elif defined(CONFIG_BF54x)
 288 inline void portmux_setup(unsigned short per)
 289 {
 290         u32 pmux;
 291         u16 ident = P_IDENT(per);
 292         u16 function = P_FUNCT2MUX(per);
 293
 294         pmux = gpio_array[gpio_bank(ident)]->port_mux;
 295
 296         pmux &= ~(0x3 << (2 * gpio_sub_n(ident)));
 297         pmux |= (function & 0x3) << (2 * gpio_sub_n(ident));
 298
 299         gpio_array[gpio_bank(ident)]->port_mux = pmux;
 300 }
 301
 302 inline u16 get_portmux(unsigned short per)
 303 {
 304         u32 pmux;
 305         u16 ident = P_IDENT(per);
 306
 307         pmux = gpio_array[gpio_bank(ident)]->port_mux;
 308
 309         return (pmux >> (2 * gpio_sub_n(ident)) & 0x3);
 310 }
 311 #elif defined(CONFIG_BF52x) || defined(CONFIG_BF51x)
 312 inline void portmux_setup(unsigned short per)
 313 {
 314         u16 pmux, ident = P_IDENT(per), function = P_FUNCT2MUX(per);
 315         u8 offset = pmux_offset[gpio_bank(ident)][gpio_sub_n(ident)];
 316
 317         pmux = *port_mux[gpio_bank(ident)];
 318         pmux &= ~(3 << offset);
 319         pmux |= (function & 3) << offset;
 320         *port_mux[gpio_bank(ident)] = pmux;
 321         SSYNC();
 322 }
 323 #else
 324 # define portmux_setup(...)  do { } while (0)
 325 #endif
 326
 327 #ifndef CONFIG_BF54x
 328 /***********************************************************
 329 *
 330 * FUNCTIONS: Blackfin General Purpose Ports Access Functions
 331 *
 332 * INPUTS/OUTPUTS:
 333 * gpio - GPIO Number between 0 and MAX_BLACKFIN_GPIOS
 334 *
 335 *
 336 * DESCRIPTION: These functions abstract direct register access
 337 *              to Blackfin processor General Purpose
 338 *              Ports Regsiters
 339 *
 340 * CAUTION: These functions do not belong to the GPIO Driver API
 341 *************************************************************
 342 * MODIFICATION HISTORY :
 343 **************************************************************/
 344
 345 /* Set a specific bit */
 346
 347 #define SET_GPIO(name) \
 348 void set_gpio_ ## name(unsigned gpio, unsigned short arg) \
 349 { \
 350         unsigned long flags; \
 351         local_irq_save_hw(flags); \
 352         if (arg) \
 353                 gpio_array[gpio_bank(gpio)]->name |= gpio_bit(gpio); \
 354         else \
 355                 gpio_array[gpio_bank(gpio)]->name &= ~gpio_bit(gpio); \
 356         AWA_DUMMY_READ(name); \
 357         local_irq_restore_hw(flags); \
 358 } \
 359 EXPORT_SYMBOL(set_gpio_ ## name);
 360
 361 SET_GPIO(dir)   /* set_gpio_dir() */
 362 SET_GPIO(inen)  /* set_gpio_inen() */
 363 SET_GPIO(polar) /* set_gpio_polar() */
 364 SET_GPIO(edge)  /* set_gpio_edge() */
 365 SET_GPIO(both)  /* set_gpio_both() */
 366
 367
 368 #define SET_GPIO_SC(name) \
 369 void set_gpio_ ## name(unsigned gpio, unsigned short arg) \
 370 { \
 371         unsigned long flags; \
 372         if (ANOMALY_05000311 || ANOMALY_05000323) \
 373                 local_irq_save_hw(flags); \
 374         if (arg) \
 375                 gpio_array[gpio_bank(gpio)]->name ## _set = gpio_bit(gpio); \
 376         else \
 377                 gpio_array[gpio_bank(gpio)]->name ## _clear = gpio_bit(gpio); \
 378         if (ANOMALY_05000311 || ANOMALY_05000323) { \
 379                 AWA_DUMMY_READ(name); \
 380                 local_irq_restore_hw(flags); \
 381         } \
 382 } \
 383 EXPORT_SYMBOL(set_gpio_ ## name);
 384
 385 SET_GPIO_SC(maska)
 386 SET_GPIO_SC(maskb)
 387 SET_GPIO_SC(data)
 388
 389 void set_gpio_toggle(unsigned gpio)
 390 {
 391         unsigned long flags;
 392         if (ANOMALY_05000311 || ANOMALY_05000323)
 393                 local_irq_save_hw(flags);
 394         gpio_array[gpio_bank(gpio)]->toggle = gpio_bit(gpio);
 395         if (ANOMALY_05000311 || ANOMALY_05000323) {
 396                 AWA_DUMMY_READ(toggle);
 397                 local_irq_restore_hw(flags);
 398         }
 399 }
 400 EXPORT_SYMBOL(set_gpio_toggle);
 401
 402
 403 /*Set current PORT date (16-bit word)*/
 404
 405 #define SET_GPIO_P(name) \
 406 void set_gpiop_ ## name(unsigned gpio, unsigned short arg) \
 407 { \
 408         unsigned long flags; \
 409         if (ANOMALY_05000311 || ANOMALY_05000323) \
 410                 local_irq_save_hw(flags); \
 411         gpio_array[gpio_bank(gpio)]->name = arg; \
 412         if (ANOMALY_05000311 || ANOMALY_05000323) { \
 413                 AWA_DUMMY_READ(name); \
 414                 local_irq_restore_hw(flags); \
 415         } \
 416 } \
 417 EXPORT_SYMBOL(set_gpiop_ ## name);
 418
 419 SET_GPIO_P(data)
 420 SET_GPIO_P(dir)
 421 SET_GPIO_P(inen)
 422 SET_GPIO_P(polar)
 423 SET_GPIO_P(edge)
 424 SET_GPIO_P(both)
 425 SET_GPIO_P(maska)
 426 SET_GPIO_P(maskb)
 427
 428 /* Get a specific bit */
 429 #define GET_GPIO(name) \
 430 unsigned short get_gpio_ ## name(unsigned gpio) \
 431 { \
 432         unsigned long flags; \
 433         unsigned short ret; \
 434         if (ANOMALY_05000311 || ANOMALY_05000323) \
 435                 local_irq_save_hw(flags); \
 436         ret = 0x01 & (gpio_array[gpio_bank(gpio)]->name >> gpio_sub_n(gpio)); \
 437         if (ANOMALY_05000311 || ANOMALY_05000323) { \
 438                 AWA_DUMMY_READ(name); \
 439                 local_irq_restore_hw(flags); \
 440         } \
 441         return ret; \
 442 } \
 443 EXPORT_SYMBOL(get_gpio_ ## name);
 444
 445 GET_GPIO(data)
 446 GET_GPIO(dir)
 447 GET_GPIO(inen)
 448 GET_GPIO(polar)
 449 GET_GPIO(edge)
 450 GET_GPIO(both)
 451 GET_GPIO(maska)
 452 GET_GPIO(maskb)
 453
 454 /*Get current PORT date (16-bit word)*/
 455
 456 #define GET_GPIO_P(name) \
 457 unsigned short get_gpiop_ ## name(unsigned gpio) \
 458 { \
 459         unsigned long flags; \
 460         unsigned short ret; \
 461         if (ANOMALY_05000311 || ANOMALY_05000323) \
 462                 local_irq_save_hw(flags); \
 463         ret = (gpio_array[gpio_bank(gpio)]->name); \
 464         if (ANOMALY_05000311 || ANOMALY_05000323) { \
 465                 AWA_DUMMY_READ(name); \
 466                 local_irq_restore_hw(flags); \
 467         } \
 468         return ret; \
 469 } \
 470 EXPORT_SYMBOL(get_gpiop_ ## name);
 471
 472 GET_GPIO_P(data)
 473 GET_GPIO_P(dir)
 474 GET_GPIO_P(inen)
 475 GET_GPIO_P(polar)
 476 GET_GPIO_P(edge)
 477 GET_GPIO_P(both)
 478 GET_GPIO_P(maska)
 479 GET_GPIO_P(maskb)
 480
 481
 482 #ifdef CONFIG_PM
 483 DECLARE_RESERVED_MAP(wakeup, GPIO_BANK_NUM);
 484
 485 static const unsigned int sic_iwr_irqs[] = {
 486 #if defined(BF533_FAMILY)
 487         IRQ_PROG_INTB
 488 #elif defined(BF537_FAMILY)
 489         IRQ_PROG_INTB, IRQ_PORTG_INTB, IRQ_MAC_TX
 490 #elif defined(BF538_FAMILY)
 491         IRQ_PORTF_INTB
 492 #elif defined(CONFIG_BF52x) || defined(CONFIG_BF51x)
 493         IRQ_PORTF_INTB, IRQ_PORTG_INTB, IRQ_PORTH_INTB
 494 #elif defined(BF561_FAMILY)
 495         IRQ_PROG0_INTB, IRQ_PROG1_INTB, IRQ_PROG2_INTB
 496 #else
 497 # error no SIC_IWR defined
 498 #endif
 499 };
 500
 501 /***********************************************************
 502 *
 503 * FUNCTIONS: Blackfin PM Setup API
 504 *
 505 * INPUTS/OUTPUTS:
 506 * gpio - GPIO Number between 0 and MAX_BLACKFIN_GPIOS
 507 * type -
 508 *       PM_WAKE_RISING
 509 *       PM_WAKE_FALLING
 510 *       PM_WAKE_HIGH
 511 *       PM_WAKE_LOW
 512 *       PM_WAKE_BOTH_EDGES
 513 *
 514 * DESCRIPTION: Blackfin PM Driver API
 515 *
 516 * CAUTION:
 517 *************************************************************
 518 * MODIFICATION HISTORY :
 519 **************************************************************/
 520 int gpio_pm_wakeup_ctrl(unsigned gpio, unsigned ctrl)
 521 {
 522         unsigned long flags;
 523
 524         if (check_gpio(gpio) < 0)
 525                 return -EINVAL;
 526
 527         local_irq_save_hw(flags);
 528         if (ctrl)
 529                 reserve(wakeup, gpio);
 530         else
 531                 unreserve(wakeup, gpio);
 532
 533         set_gpio_maskb(gpio, ctrl);
 534         local_irq_restore_hw(flags);
 535
 536         return 0;
 537 }
 538
 539 int bfin_pm_standby_ctrl(unsigned ctrl)
 540 {
 541         u16 bank, mask, i;
 542
 543         for (i = 0; i < MAX_BLACKFIN_GPIOS; i += GPIO_BANKSIZE) {
 544                 mask = map_entry(wakeup, i);
 545                 bank = gpio_bank(i);
 546
 547                 if (mask)
 548                         bfin_internal_set_wake(sic_iwr_irqs[bank], ctrl);
 549         }
 550         return 0;
 551 }
 552
 553 void bfin_gpio_pm_hibernate_suspend(void)
 554 {
 555         int i, bank;
 556
 557         for (i = 0; i < MAX_BLACKFIN_GPIOS; i += GPIO_BANKSIZE) {
 558                 bank = gpio_bank(i);
 559
 560 #if defined(CONFIG_BF52x) || defined(BF537_FAMILY) || defined(CONFIG_BF51x)
 561                 gpio_bank_saved[bank].fer = *port_fer[bank];
 562 #if defined(CONFIG_BF52x) || defined(CONFIG_BF51x)
 563                 gpio_bank_saved[bank].mux = *port_mux[bank];
 564 #else
 565                 if (bank == 0)
 566                         gpio_bank_saved[bank].mux = bfin_read_PORT_MUX();
 567 #endif
 568 #endif
 569                 gpio_bank_saved[bank].data  = gpio_array[bank]->data;
 570                 gpio_bank_saved[bank].inen  = gpio_array[bank]->inen;
 571                 gpio_bank_saved[bank].polar = gpio_array[bank]->polar;
 572                 gpio_bank_saved[bank].dir   = gpio_array[bank]->dir;
 573                 gpio_bank_saved[bank].edge  = gpio_array[bank]->edge;
 574                 gpio_bank_saved[bank].both  = gpio_array[bank]->both;
 575                 gpio_bank_saved[bank].maska = gpio_array[bank]->maska;
 576         }
 577
 578         AWA_DUMMY_READ(maska);
 579 }
 580
 581 void bfin_gpio_pm_hibernate_restore(void)
 582 {
 583         int i, bank;
 584
 585         for (i = 0; i < MAX_BLACKFIN_GPIOS; i += GPIO_BANKSIZE) {
 586                 bank = gpio_bank(i);
 587
 588 #if defined(CONFIG_BF52x) || defined(BF537_FAMILY) || defined(CONFIG_BF51x)
 589 #if defined(CONFIG_BF52x) || defined(CONFIG_BF51x)
 590                 *port_mux[bank] = gpio_bank_saved[bank].mux;
 591 #else
 592                 if (bank == 0)
 593                         bfin_write_PORT_MUX(gpio_bank_saved[bank].mux);
 594 #endif
 595                 *port_fer[bank] = gpio_bank_saved[bank].fer;
 596 #endif
 597                 gpio_array[bank]->inen  = gpio_bank_saved[bank].inen;
 598                 gpio_array[bank]->data_set = gpio_bank_saved[bank].data
 599                                                 & gpio_bank_saved[bank].dir;
 600                 gpio_array[bank]->dir   = gpio_bank_saved[bank].dir;
 601                 gpio_array[bank]->polar = gpio_bank_saved[bank].polar;
 602                 gpio_array[bank]->edge  = gpio_bank_saved[bank].edge;
 603                 gpio_array[bank]->both  = gpio_bank_saved[bank].both;
 604                 gpio_array[bank]->maska = gpio_bank_saved[bank].maska;
 605         }
 606         AWA_DUMMY_READ(maska);
 607 }
 608
 609
 610 #endif
 611 #else /* CONFIG_BF54x */
 612 #ifdef CONFIG_PM
 613
 614 int bfin_pm_standby_ctrl(unsigned ctrl)
 615 {
 616         return 0;
 617 }
 618
 619 void bfin_gpio_pm_hibernate_suspend(void)
 620 {
 621         int i, bank;
 622
 623         for (i = 0; i < MAX_BLACKFIN_GPIOS; i += GPIO_BANKSIZE) {
 624                 bank = gpio_bank(i);
 625
 626                 gpio_bank_saved[bank].fer = gpio_array[bank]->port_fer;
 627                 gpio_bank_saved[bank].mux = gpio_array[bank]->port_mux;
 628                 gpio_bank_saved[bank].data = gpio_array[bank]->data;
 629                 gpio_bank_saved[bank].inen = gpio_array[bank]->inen;
 630                 gpio_bank_saved[bank].dir = gpio_array[bank]->dir_set;
 631         }
 632 }
 633
 634 void bfin_gpio_pm_hibernate_restore(void)
 635 {
 636         int i, bank;
 637
 638         for (i = 0; i < MAX_BLACKFIN_GPIOS; i += GPIO_BANKSIZE) {
 639                 bank = gpio_bank(i);
 640
 641                 gpio_array[bank]->port_mux = gpio_bank_saved[bank].mux;
 642                 gpio_array[bank]->port_fer = gpio_bank_saved[bank].fer;
 643                 gpio_array[bank]->inen = gpio_bank_saved[bank].inen;
 644                 gpio_array[bank]->dir_set = gpio_bank_saved[bank].dir;
 645                 gpio_array[bank]->data_set = gpio_bank_saved[bank].data
 646                                                 | gpio_bank_saved[bank].dir;
 647         }
 648 }
 649 #endif
 650
 651 unsigned short get_gpio_dir(unsigned gpio)
 652 {
 653         return (0x01 & (gpio_array[gpio_bank(gpio)]->dir_clear >> gpio_sub_n(gpio)));
 654 }
 655 EXPORT_SYMBOL(get_gpio_dir);
 656
 657 #endif /* CONFIG_BF54x */
 658
 659 /***********************************************************
 660 *
 661 * FUNCTIONS:    Blackfin Peripheral Resource Allocation
 662 *               and PortMux Setup
 663 *
 664 * INPUTS/OUTPUTS:
 665 * per   Peripheral Identifier
 666 * label String
 667 *
 668 * DESCRIPTION: Blackfin Peripheral Resource Allocation and Setup API
 669 *
 670 * CAUTION:
 671 *************************************************************
 672 * MODIFICATION HISTORY :
 673 **************************************************************/
 674
 675 int peripheral_request(unsigned short per, const char *label)
 676 {
 677         unsigned long flags;
 678         unsigned short ident = P_IDENT(per);
 679
 680         /*
 681          * Don't cares are pins with only one dedicated function
 682          */
 683
 684         if (per & P_DONTCARE)
 685                 return 0;
 686
 687         if (!(per & P_DEFINED))
 688                 return -ENODEV;
 689
 690         BUG_ON(ident >= MAX_RESOURCES);
 691
 692         local_irq_save_hw(flags);
 693
 694         /* If a pin can be muxed as either GPIO or peripheral, make
 695          * sure it is not already a GPIO pin when we request it.
 696          */
 697         if (unlikely(!check_gpio(ident) && is_reserved(gpio, ident, 1))) {
 698                 if (system_state == SYSTEM_BOOTING)
 699                         dump_stack();
 700                 printk(KERN_ERR
 701                        "%s: Peripheral %d is already reserved as GPIO by %s !\n",
 702                        __func__, ident, get_label(ident));
 703                 local_irq_restore_hw(flags);
 704                 return -EBUSY;
 705         }
 706
 707         if (unlikely(is_reserved(peri, ident, 1))) {
 708
 709                 /*
 710                  * Pin functions like AMC address strobes my
 711                  * be requested and used by several drivers
 712                  */
 713
 714 #ifdef CONFIG_BF54x
 715                 if (!((per & P_MAYSHARE) && get_portmux(per) == P_FUNCT2MUX(per))) {
 716 #else
 717                 if (!(per & P_MAYSHARE)) {
 718 #endif
 719                         /*
 720                          * Allow that the identical pin function can
 721                          * be requested from the same driver twice
 722                          */
 723
 724                         if (cmp_label(ident, label) == 0)
 725                                 goto anyway;
 726
 727                         if (system_state == SYSTEM_BOOTING)
 728                                 dump_stack();
 729                         printk(KERN_ERR
 730                                "%s: Peripheral %d function %d is already reserved by %s !\n",
 731                                __func__, ident, P_FUNCT2MUX(per), get_label(ident));
 732                         local_irq_restore_hw(flags);
 733                         return -EBUSY;
 734                 }
 735         }
 736
 737  anyway:
 738         reserve(peri, ident);
 739
 740         portmux_setup(per);
 741         port_setup(ident, PERIPHERAL_USAGE);
 742
 743         local_irq_restore_hw(flags);
 744         set_label(ident, label);
 745
 746         return 0;
 747 }
 748 EXPORT_SYMBOL(peripheral_request);
 749
 750 int peripheral_request_list(const unsigned short per[], const char *label)
 751 {
 752         u16 cnt;
 753         int ret;
 754
 755         for (cnt = 0; per[cnt] != 0; cnt++) {
 756
 757                 ret = peripheral_request(per[cnt], label);
 758
 759                 if (ret < 0) {
 760                         for ( ; cnt > 0; cnt--)
 761                                 peripheral_free(per[cnt - 1]);
 762
 763                         return ret;
 764                 }
 765         }
 766
 767         return 0;
 768 }
 769 EXPORT_SYMBOL(peripheral_request_list);
 770
 771 void peripheral_free(unsigned short per)
 772 {
 773         unsigned long flags;
 774         unsigned short ident = P_IDENT(per);
 775
 776         if (per & P_DONTCARE)
 777                 return;
 778
 779         if (!(per & P_DEFINED))
 780                 return;
 781
 782         local_irq_save_hw(flags);
 783
 784         if (unlikely(!is_reserved(peri, ident, 0))) {
 785                 local_irq_restore_hw(flags);
 786                 return;
 787         }
 788
 789         if (!(per & P_MAYSHARE))
 790                 port_setup(ident, GPIO_USAGE);
 791
 792         unreserve(peri, ident);
 793
 794         set_label(ident, "free");
 795
 796         local_irq_restore_hw(flags);
 797 }
 798 EXPORT_SYMBOL(peripheral_free);
 799
 800 void peripheral_free_list(const unsigned short per[])
 801 {
 802         u16 cnt;
 803         for (cnt = 0; per[cnt] != 0; cnt++)
 804                 peripheral_free(per[cnt]);
 805 }
 806 EXPORT_SYMBOL(peripheral_free_list);
 807
 808 /***********************************************************
 809 *
 810 * FUNCTIONS: Blackfin GPIO Driver
 811 *
 812 * INPUTS/OUTPUTS:
 813 * gpio  PIO Number between 0 and MAX_BLACKFIN_GPIOS
 814 * label String
 815 *
 816 * DESCRIPTION: Blackfin GPIO Driver API
 817 *
 818 * CAUTION:
 819 *************************************************************
 820 * MODIFICATION HISTORY :
 821 **************************************************************/
 822
 823 int bfin_gpio_request(unsigned gpio, const char *label)
 824 {
 825         unsigned long flags;
 826
 827         if (check_gpio(gpio) < 0)
 828                 return -EINVAL;
 829
 830         local_irq_save_hw(flags);
 831
 832         /*
 833          * Allow that the identical GPIO can
 834          * be requested from the same driver twice
 835          * Do nothing and return -
 836          */
 837
 838         if (cmp_label(gpio, label) == 0) {
 839                 local_irq_restore_hw(flags);
 840                 return 0;
 841         }
 842
 843         if (unlikely(is_reserved(gpio, gpio, 1))) {
 844                 if (system_state == SYSTEM_BOOTING)
 845                         dump_stack();
 846                 printk(KERN_ERR "bfin-gpio: GPIO %d is already reserved by %s !\n",
 847                        gpio, get_label(gpio));
 848                 local_irq_restore_hw(flags);
 849                 return -EBUSY;
 850         }
 851         if (unlikely(is_reserved(peri, gpio, 1))) {
 852                 if (system_state == SYSTEM_BOOTING)
 853                         dump_stack();
 854                 printk(KERN_ERR
 855                        "bfin-gpio: GPIO %d is already reserved as Peripheral by %s !\n",
 856                        gpio, get_label(gpio));
 857                 local_irq_restore_hw(flags);
 858                 return -EBUSY;
 859         }
 860         if (unlikely(is_reserved(gpio_irq, gpio, 1))) {
 861                 printk(KERN_NOTICE "bfin-gpio: GPIO %d is already reserved as gpio-irq!"
 862                        " (Documentation/blackfin/bfin-gpio-notes.txt)\n", gpio);
 863         }
 864 #ifndef CONFIG_BF54x
 865         else {  /* Reset POLAR setting when acquiring a gpio for the first time */
 866                 set_gpio_polar(gpio, 0);
 867         }
 868 #endif
 869
 870         reserve(gpio, gpio);
 871         set_label(gpio, label);
 872
 873         local_irq_restore_hw(flags);
 874
 875         port_setup(gpio, GPIO_USAGE);
 876
 877         return 0;
 878 }
 879 EXPORT_SYMBOL(bfin_gpio_request);
 880
 881 void bfin_gpio_free(unsigned gpio)
 882 {
 883         unsigned long flags;
 884
 885         if (check_gpio(gpio) < 0)
 886                 return;
 887
 888         might_sleep();
 889
 890         local_irq_save_hw(flags);
 891
 892         if (unlikely(!is_reserved(gpio, gpio, 0))) {
 893                 if (system_state == SYSTEM_BOOTING)
 894                         dump_stack();
 895                 gpio_error(gpio);
 896                 local_irq_restore_hw(flags);
 897                 return;
 898         }
 899
 900         unreserve(gpio, gpio);
 901
 902         set_label(gpio, "free");
 903
 904         local_irq_restore_hw(flags);
 905 }
 906 EXPORT_SYMBOL(bfin_gpio_free);
 907
 908 #ifdef BFIN_SPECIAL_GPIO_BANKS
 909 DECLARE_RESERVED_MAP(special_gpio, gpio_bank(MAX_RESOURCES));
 910
 911 int bfin_special_gpio_request(unsigned gpio, const char *label)
 912 {
 913         unsigned long flags;
 914
 915         local_irq_save_hw(flags);
 916
 917         /*
 918          * Allow that the identical GPIO can
 919          * be requested from the same driver twice
 920          * Do nothing and return -
 921          */
 922
 923         if (cmp_label(gpio, label) == 0) {
 924                 local_irq_restore_hw(flags);
 925                 return 0;
 926         }
 927
 928         if (unlikely(is_reserved(special_gpio, gpio, 1))) {
 929                 local_irq_restore_hw(flags);
 930                 printk(KERN_ERR "bfin-gpio: GPIO %d is already reserved by %s !\n",
 931                        gpio, get_label(gpio));
 932
 933                 return -EBUSY;
 934         }
 935         if (unlikely(is_reserved(peri, gpio, 1))) {
 936                 local_irq_restore_hw(flags);
 937                 printk(KERN_ERR
 938                        "bfin-gpio: GPIO %d is already reserved as Peripheral by %s !\n",
 939                        gpio, get_label(gpio));
 940
 941                 return -EBUSY;
 942         }
 943
 944         reserve(special_gpio, gpio);
 945         reserve(peri, gpio);
 946
 947         set_label(gpio, label);
 948         local_irq_restore_hw(flags);
 949         port_setup(gpio, GPIO_USAGE);
 950
 951         return 0;
 952 }
 953 EXPORT_SYMBOL(bfin_special_gpio_request);
 954
 955 void bfin_special_gpio_free(unsigned gpio)
 956 {
 957         unsigned long flags;
 958
 959         might_sleep();
 960
 961         local_irq_save_hw(flags);
 962
 963         if (unlikely(!is_reserved(special_gpio, gpio, 0))) {
 964                 gpio_error(gpio);
 965                 local_irq_restore_hw(flags);
 966                 return;
 967         }
 968
 969         unreserve(special_gpio, gpio);
 970         unreserve(peri, gpio);
 971         set_label(gpio, "free");
 972         local_irq_restore_hw(flags);
 973 }
 974 EXPORT_SYMBOL(bfin_special_gpio_free);
 975 #endif
 976
 977
 978 int bfin_gpio_irq_request(unsigned gpio, const char *label)
 979 {
 980         unsigned long flags;
 981
 982         if (check_gpio(gpio) < 0)
 983                 return -EINVAL;
 984
 985         local_irq_save_hw(flags);
 986
 987         if (unlikely(is_reserved(peri, gpio, 1))) {
 988                 if (system_state == SYSTEM_BOOTING)
 989                         dump_stack();
 990                 printk(KERN_ERR
 991                        "bfin-gpio: GPIO %d is already reserved as Peripheral by %s !\n",
 992                        gpio, get_label(gpio));
 993                 local_irq_restore_hw(flags);
 994                 return -EBUSY;
 995         }
 996         if (unlikely(is_reserved(gpio, gpio, 1)))
 997                 printk(KERN_NOTICE "bfin-gpio: GPIO %d is already reserved by %s! "
 998                        "(Documentation/blackfin/bfin-gpio-notes.txt)\n",
 999                        gpio, get_label(gpio));
1000
1001         reserve(gpio_irq, gpio);
1002         set_label(gpio, label);
1003
1004         local_irq_restore_hw(flags);
1005
1006         port_setup(gpio, GPIO_USAGE);
1007
1008         return 0;
1009 }
1010
1011 void bfin_gpio_irq_free(unsigned gpio)
1012 {
1013         unsigned long flags;
1014
1015         if (check_gpio(gpio) < 0)
1016                 return;
1017
1018         local_irq_save_hw(flags);
1019
1020         if (unlikely(!is_reserved(gpio_irq, gpio, 0))) {
1021                 if (system_state == SYSTEM_BOOTING)
1022                         dump_stack();
1023                 gpio_error(gpio);
1024                 local_irq_restore_hw(flags);
1025                 return;
1026         }
1027
1028         unreserve(gpio_irq, gpio);
1029
1030         set_label(gpio, "free");
1031
1032         local_irq_restore_hw(flags);
1033 }
1034
1035 static inline void __bfin_gpio_direction_input(unsigned gpio)
1036 {
1037 #ifdef CONFIG_BF54x
1038         gpio_array[gpio_bank(gpio)]->dir_clear = gpio_bit(gpio);
1039 #else
1040         gpio_array[gpio_bank(gpio)]->dir &= ~gpio_bit(gpio);
1041 #endif
1042         gpio_array[gpio_bank(gpio)]->inen |= gpio_bit(gpio);
1043 }
1044
1045 int bfin_gpio_direction_input(unsigned gpio)
1046 {
1047         unsigned long flags;
1048
1049         if (unlikely(!is_reserved(gpio, gpio, 0))) {
1050                 gpio_error(gpio);
1051                 return -EINVAL;
1052         }
1053
1054         local_irq_save_hw(flags);
1055         __bfin_gpio_direction_input(gpio);
1056         AWA_DUMMY_READ(inen);
1057         local_irq_restore_hw(flags);
1058
1059         return 0;
1060 }
1061 EXPORT_SYMBOL(bfin_gpio_direction_input);
1062
1063 void bfin_gpio_irq_prepare(unsigned gpio)
1064 {
1065 #ifdef CONFIG_BF54x
1066         unsigned long flags;
1067 #endif
1068
1069         port_setup(gpio, GPIO_USAGE);
1070
1071 #ifdef CONFIG_BF54x
1072         local_irq_save_hw(flags);
1073         __bfin_gpio_direction_input(gpio);
1074         local_irq_restore_hw(flags);
1075 #endif
1076 }
1077
1078 void bfin_gpio_set_value(unsigned gpio, int arg)
1079 {
1080         if (arg)
1081                 gpio_array[gpio_bank(gpio)]->data_set = gpio_bit(gpio);
1082         else
1083                 gpio_array[gpio_bank(gpio)]->data_clear = gpio_bit(gpio);
1084 }
1085 EXPORT_SYMBOL(bfin_gpio_set_value);
1086
1087 int bfin_gpio_direction_output(unsigned gpio, int value)
1088 {
1089         unsigned long flags;
1090
1091         if (unlikely(!is_reserved(gpio, gpio, 0))) {
1092                 gpio_error(gpio);
1093                 return -EINVAL;
1094         }
1095
1096         local_irq_save_hw(flags);
1097
1098         gpio_array[gpio_bank(gpio)]->inen &= ~gpio_bit(gpio);
1099         gpio_set_value(gpio, value);
1100 #ifdef CONFIG_BF54x
1101         gpio_array[gpio_bank(gpio)]->dir_set = gpio_bit(gpio);
1102 #else
1103         gpio_array[gpio_bank(gpio)]->dir |= gpio_bit(gpio);
1104 #endif
1105
1106         AWA_DUMMY_READ(dir);
1107         local_irq_restore_hw(flags);
1108
1109         return 0;
1110 }
1111 EXPORT_SYMBOL(bfin_gpio_direction_output);
1112
1113 int bfin_gpio_get_value(unsigned gpio)
1114 {
1115 #ifdef CONFIG_BF54x
1116         return (1 & (gpio_array[gpio_bank(gpio)]->data >> gpio_sub_n(gpio)));
1117 #else
1118         unsigned long flags;
1119
1120         if (unlikely(get_gpio_edge(gpio))) {
1121                 int ret;
1122                 local_irq_save_hw(flags);
1123                 set_gpio_edge(gpio, 0);
1124                 ret = get_gpio_data(gpio);
1125                 set_gpio_edge(gpio, 1);
1126                 local_irq_restore_hw(flags);
1127                 return ret;
1128         } else
1129                 return get_gpio_data(gpio);
1130 #endif
1131 }
1132 EXPORT_SYMBOL(bfin_gpio_get_value);
1133
1134 void bfin_reset_boot_spi_cs(unsigned short pin)
1135 {
1136         unsigned short gpio = P_IDENT(pin);
1137         port_setup(gpio, GPIO_USAGE);
1138         gpio_array[gpio_bank(gpio)]->data_set = gpio_bit(gpio);
1139         AWA_DUMMY_READ(data_set);
1140         udelay(1);
1141 }
1142
1143 #if defined(CONFIG_PROC_FS)
1144 static int gpio_proc_read(char *buf, char **start, off_t offset,
1145                           int len, int *unused_i, void *unused_v)
1146 {
1147         int c, irq, gpio, outlen = 0;
1148
1149         for (c = 0; c < MAX_RESOURCES; c++) {
1150                 irq = is_reserved(gpio_irq, c, 1);
1151                 gpio = is_reserved(gpio, c, 1);
1152                 if (!check_gpio(c) && (gpio || irq))
1153                         len = sprintf(buf, "GPIO_%d: \t%s%s \t\tGPIO %s\n", c,
1154                                  get_label(c), (gpio && irq) ? " *" : "",
1155                                  get_gpio_dir(c) ? "OUTPUT" : "INPUT");
1156                 else if (is_reserved(peri, c, 1))
1157                         len = sprintf(buf, "GPIO_%d: \t%s \t\tPeripheral\n", c, get_label(c));
1158                 else
1159                         continue;
1160                 buf += len;
1161                 outlen += len;
1162         }
1163         return outlen;
1164 }
1165
1166 static __init int gpio_register_proc(void)
1167 {
1168         struct proc_dir_entry *proc_gpio;
1169
1170         proc_gpio = create_proc_entry("gpio", S_IRUGO, NULL);
1171         if (proc_gpio)
1172                 proc_gpio->read_proc = gpio_proc_read;
1173         return proc_gpio != NULL;
1174 }
1175 __initcall(gpio_register_proc);
1176 #endif
1177
1178 #ifdef CONFIG_GPIOLIB
1179 static int bfin_gpiolib_direction_input(struct gpio_chip *chip, unsigned gpio)
1180 {
1181         return bfin_gpio_direction_input(gpio);
1182 }
1183
1184 static int bfin_gpiolib_direction_output(struct gpio_chip *chip, unsigned gpio, int level)
1185 {
1186         return bfin_gpio_direction_output(gpio, level);
1187 }
1188
1189 static int bfin_gpiolib_get_value(struct gpio_chip *chip, unsigned gpio)
1190 {
1191         return bfin_gpio_get_value(gpio);
1192 }
1193
1194 static void bfin_gpiolib_set_value(struct gpio_chip *chip, unsigned gpio, int value)
1195 {
1196         return bfin_gpio_set_value(gpio, value);
1197 }
1198
1199 static int bfin_gpiolib_gpio_request(struct gpio_chip *chip, unsigned gpio)
1200 {
1201         return bfin_gpio_request(gpio, chip->label);
1202 }
1203
1204 static void bfin_gpiolib_gpio_free(struct gpio_chip *chip, unsigned gpio)
1205 {
1206         return bfin_gpio_free(gpio);
1207 }
1208
1209 static int bfin_gpiolib_gpio_to_irq(struct gpio_chip *chip, unsigned gpio)
1210 {
1211         return gpio + GPIO_IRQ_BASE;
1212 }
1213
1214 static struct gpio_chip bfin_chip = {
1215         .label                  = "BFIN-GPIO",
1216         .direction_input        = bfin_gpiolib_direction_input,
1217         .get                    = bfin_gpiolib_get_value,
1218         .direction_output       = bfin_gpiolib_direction_output,
1219         .set                    = bfin_gpiolib_set_value,
1220         .request                = bfin_gpiolib_gpio_request,
1221         .free                   = bfin_gpiolib_gpio_free,
1222         .to_irq                 = bfin_gpiolib_gpio_to_irq,
1223         .base                   = 0,
1224         .ngpio                  = MAX_BLACKFIN_GPIOS,
1225 };
1226
1227 static int __init bfin_gpiolib_setup(void)
1228 {
1229         return gpiochip_add(&bfin_chip);
1230 }
1231 arch_initcall(bfin_gpiolib_setup);
1232 #endif