target/linux/adm8668/patches-3.3/200-amba_pl010_hacks.patch

   1 --- a/drivers/tty/serial/amba-pl010.c
   2 +++ b/drivers/tty/serial/amba-pl010.c
   3 @@ -49,11 +49,10 @@
   4
   5  #include <asm/io.h>
   6
   7 -#define UART_NR                8
   8 -
   9  #define SERIAL_AMBA_MAJOR      204
  10  #define SERIAL_AMBA_MINOR      16
  11 -#define SERIAL_AMBA_NR         UART_NR
  12 +#define SERIAL_AMBA_NR         CONFIG_SERIAL_AMBA_PL010_NUMPORTS
  13 +#define SERIAL_AMBA_NAME       CONFIG_SERIAL_AMBA_PL010_PORTNAME
  14
  15  #define AMBA_ISR_PASS_LIMIT    256
  16
  17 @@ -79,9 +78,9 @@ static void pl010_stop_tx(struct uart_po
  18         struct uart_amba_port *uap = (struct uart_amba_port *)port;
  19         unsigned int cr;
  20
  21 -       cr = readb(uap->port.membase + UART010_CR);
  22 +       cr = __raw_readl(uap->port.membase + UART010_CR);
  23         cr &= ~UART010_CR_TIE;
  24 -       writel(cr, uap->port.membase + UART010_CR);
  25 +       __raw_writel(cr, uap->port.membase + UART010_CR);
  26  }
  27
  28  static void pl010_start_tx(struct uart_port *port)
  29 @@ -89,9 +88,9 @@ static void pl010_start_tx(struct uart_p
  30         struct uart_amba_port *uap = (struct uart_amba_port *)port;
  31         unsigned int cr;
  32
  33 -       cr = readb(uap->port.membase + UART010_CR);
  34 +       cr = __raw_readl(uap->port.membase + UART010_CR);
  35         cr |= UART010_CR_TIE;
  36 -       writel(cr, uap->port.membase + UART010_CR);
  37 +       __raw_writel(cr, uap->port.membase + UART010_CR);
  38  }
  39
  40  static void pl010_stop_rx(struct uart_port *port)
  41 @@ -99,9 +98,9 @@ static void pl010_stop_rx(struct uart_po
  42         struct uart_amba_port *uap = (struct uart_amba_port *)port;
  43         unsigned int cr;
  44
  45 -       cr = readb(uap->port.membase + UART010_CR);
  46 +       cr = __raw_readl(uap->port.membase + UART010_CR);
  47         cr &= ~(UART010_CR_RIE | UART010_CR_RTIE);
  48 -       writel(cr, uap->port.membase + UART010_CR);
  49 +       __raw_writel(cr, uap->port.membase + UART010_CR);
  50  }
  51
  52  static void pl010_enable_ms(struct uart_port *port)
  53 @@ -109,9 +108,9 @@ static void pl010_enable_ms(struct uart_
  54         struct uart_amba_port *uap = (struct uart_amba_port *)port;
  55         unsigned int cr;
  56
  57 -       cr = readb(uap->port.membase + UART010_CR);
  58 +       cr = __raw_readl(uap->port.membase + UART010_CR);
  59         cr |= UART010_CR_MSIE;
  60 -       writel(cr, uap->port.membase + UART010_CR);
  61 +       __raw_writel(cr, uap->port.membase + UART010_CR);
  62  }
  63
  64  static void pl010_rx_chars(struct uart_amba_port *uap)
  65 @@ -119,9 +118,9 @@ static void pl010_rx_chars(struct uart_a
  66         struct tty_struct *tty = uap->port.state->port.tty;
  67         unsigned int status, ch, flag, rsr, max_count = 256;
  68
  69 -       status = readb(uap->port.membase + UART01x_FR);
  70 +       status = __raw_readl(uap->port.membase + UART01x_FR);
  71         while (UART_RX_DATA(status) && max_count--) {
  72 -               ch = readb(uap->port.membase + UART01x_DR);
  73 +               ch = __raw_readl(uap->port.membase + UART01x_DR);
  74                 flag = TTY_NORMAL;
  75
  76                 uap->port.icount.rx++;
  77 @@ -130,9 +129,9 @@ static void pl010_rx_chars(struct uart_a
  78                  * Note that the error handling code is
  79                  * out of the main execution path
  80                  */
  81 -               rsr = readb(uap->port.membase + UART01x_RSR) | UART_DUMMY_RSR_RX;
  82 +               rsr = __raw_readl(uap->port.membase + UART01x_RSR) | UART_DUMMY_RSR_RX;
  83                 if (unlikely(rsr & UART01x_RSR_ANY)) {
  84 -                       writel(0, uap->port.membase + UART01x_ECR);
  85 +                       __raw_writel(0, uap->port.membase + UART01x_ECR);
  86
  87                         if (rsr & UART01x_RSR_BE) {
  88                                 rsr &= ~(UART01x_RSR_FE | UART01x_RSR_PE);
  89 @@ -162,7 +161,7 @@ static void pl010_rx_chars(struct uart_a
  90                 uart_insert_char(&uap->port, rsr, UART01x_RSR_OE, ch, flag);
  91
  92         ignore_char:
  93 -               status = readb(uap->port.membase + UART01x_FR);
  94 +               status = __raw_readl(uap->port.membase + UART01x_FR);
  95         }
  96         spin_unlock(&uap->port.lock);
  97         tty_flip_buffer_push(tty);
  98 @@ -175,7 +174,7 @@ static void pl010_tx_chars(struct uart_a
  99         int count;
 100
 101         if (uap->port.x_char) {
 102 -               writel(uap->port.x_char, uap->port.membase + UART01x_DR);
 103 +               __raw_writel(uap->port.x_char, uap->port.membase + UART01x_DR);
 104                 uap->port.icount.tx++;
 105                 uap->port.x_char = 0;
 106                 return;
 107 @@ -187,7 +186,7 @@ static void pl010_tx_chars(struct uart_a
 108
 109         count = uap->port.fifosize >> 1;
 110         do {
 111 -               writel(xmit->buf[xmit->tail], uap->port.membase + UART01x_DR);
 112 +               __raw_writel(xmit->buf[xmit->tail], uap->port.membase + UART01x_DR);
 113                 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
 114                 uap->port.icount.tx++;
 115                 if (uart_circ_empty(xmit))
 116 @@ -205,9 +204,9 @@ static void pl010_modem_status(struct ua
 117  {
 118         unsigned int status, delta;
 119
 120 -       writel(0, uap->port.membase + UART010_ICR);
 121 +       __raw_writel(0, uap->port.membase + UART010_ICR);
 122
 123 -       status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;
 124 +       status = __raw_readl(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;
 125
 126         delta = status ^ uap->old_status;
 127         uap->old_status = status;
 128 @@ -235,7 +234,7 @@ static irqreturn_t pl010_int(int irq, vo
 129
 130         spin_lock(&uap->port.lock);
 131
 132 -       status = readb(uap->port.membase + UART010_IIR);
 133 +       status = __raw_readl(uap->port.membase + UART010_IIR);
 134         if (status) {
 135                 do {
 136                         if (status & (UART010_IIR_RTIS | UART010_IIR_RIS))
 137 @@ -248,7 +247,7 @@ static irqreturn_t pl010_int(int irq, vo
 138                         if (pass_counter-- == 0)
 139                                 break;
 140
 141 -                       status = readb(uap->port.membase + UART010_IIR);
 142 +                       status = __raw_readl(uap->port.membase + UART010_IIR);
 143                 } while (status & (UART010_IIR_RTIS | UART010_IIR_RIS |
 144                                    UART010_IIR_TIS));
 145                 handled = 1;
 146 @@ -262,7 +261,7 @@ static irqreturn_t pl010_int(int irq, vo
 147  static unsigned int pl010_tx_empty(struct uart_port *port)
 148  {
 149         struct uart_amba_port *uap = (struct uart_amba_port *)port;
 150 -       unsigned int status = readb(uap->port.membase + UART01x_FR);
 151 +       unsigned int status = __raw_readl(uap->port.membase + UART01x_FR);
 152         return status & UART01x_FR_BUSY ? 0 : TIOCSER_TEMT;
 153  }
 154
 155 @@ -272,7 +271,7 @@ static unsigned int pl010_get_mctrl(stru
 156         unsigned int result = 0;
 157         unsigned int status;
 158
 159 -       status = readb(uap->port.membase + UART01x_FR);
 160 +       status = __raw_readl(uap->port.membase + UART01x_FR);
 161         if (status & UART01x_FR_DCD)
 162                 result |= TIOCM_CAR;
 163         if (status & UART01x_FR_DSR)
 164 @@ -298,12 +297,12 @@ static void pl010_break_ctl(struct uart_
 165         unsigned int lcr_h;
 166
 167         spin_lock_irqsave(&uap->port.lock, flags);
 168 -       lcr_h = readb(uap->port.membase + UART010_LCRH);
 169 +       lcr_h = __raw_readl(uap->port.membase + UART010_LCRH);
 170         if (break_state == -1)
 171                 lcr_h |= UART01x_LCRH_BRK;
 172         else
 173                 lcr_h &= ~UART01x_LCRH_BRK;
 174 -       writel(lcr_h, uap->port.membase + UART010_LCRH);
 175 +       __raw_writel(lcr_h, uap->port.membase + UART010_LCRH);
 176         spin_unlock_irqrestore(&uap->port.lock, flags);
 177  }
 178
 179 @@ -335,12 +334,12 @@ static int pl010_startup(struct uart_por
 180         /*
 181          * initialise the old status of the modem signals
 182          */
 183 -       uap->old_status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;
 184 +       uap->old_status = __raw_readl(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;
 185
 186         /*
 187          * Finally, enable interrupts
 188          */
 189 -       writel(UART01x_CR_UARTEN | UART010_CR_RIE | UART010_CR_RTIE,
 190 +       __raw_writel(UART01x_CR_UARTEN | UART010_CR_RIE | UART010_CR_RTIE,
 191                uap->port.membase + UART010_CR);
 192
 193         return 0;
 194 @@ -365,10 +364,10 @@ static void pl010_shutdown(struct uart_p
 195         /*
 196          * disable all interrupts, disable the port
 197          */
 198 -       writel(0, uap->port.membase + UART010_CR);
 199 +       __raw_writel(0, uap->port.membase + UART010_CR);
 200
 201         /* disable break condition and fifos */
 202 -       writel(readb(uap->port.membase + UART010_LCRH) &
 203 +       __raw_writel(__raw_readl(uap->port.membase + UART010_LCRH) &
 204                 ~(UART01x_LCRH_BRK | UART01x_LCRH_FEN),
 205                uap->port.membase + UART010_LCRH);
 206
 207 @@ -391,7 +390,7 @@ pl010_set_termios(struct uart_port *port
 208         /*
 209          * Ask the core to calculate the divisor for us.
 210          */
 211 -       baud = uart_get_baud_rate(port, termios, old, 0, uap->port.uartclk/16);
 212 +       baud = uart_get_baud_rate(port, termios, old, 0, uap->port.uartclk/16);
 213         quot = uart_get_divisor(port, baud);
 214
 215         switch (termios->c_cflag & CSIZE) {
 216 @@ -454,25 +453,25 @@ pl010_set_termios(struct uart_port *port
 217                 uap->port.ignore_status_mask |= UART_DUMMY_RSR_RX;
 218
 219         /* first, disable everything */
 220 -       old_cr = readb(uap->port.membase + UART010_CR) & ~UART010_CR_MSIE;
 221 +       old_cr = __raw_readl(uap->port.membase + UART010_CR) & ~UART010_CR_MSIE;
 222
 223         if (UART_ENABLE_MS(port, termios->c_cflag))
 224                 old_cr |= UART010_CR_MSIE;
 225
 226 -       writel(0, uap->port.membase + UART010_CR);
 227 +       __raw_writel(0, uap->port.membase + UART010_CR);
 228
 229         /* Set baud rate */
 230         quot -= 1;
 231 -       writel((quot & 0xf00) >> 8, uap->port.membase + UART010_LCRM);
 232 -       writel(quot & 0xff, uap->port.membase + UART010_LCRL);
 233 +       __raw_writel((quot & 0xf00) >> 8, uap->port.membase + UART010_LCRM);
 234 +       __raw_writel(quot & 0xff, uap->port.membase + UART010_LCRL);
 235
 236         /*
 237          * ----------v----------v----------v----------v-----
 238          * NOTE: MUST BE WRITTEN AFTER UARTLCR_M & UARTLCR_L
 239          * ----------^----------^----------^----------^-----
 240          */
 241 -       writel(lcr_h, uap->port.membase + UART010_LCRH);
 242 -       writel(old_cr, uap->port.membase + UART010_CR);
 243 +       __raw_writel(lcr_h, uap->port.membase + UART010_LCRH);
 244 +       __raw_writel(old_cr, uap->port.membase + UART010_CR);
 245
 246         spin_unlock_irqrestore(&uap->port.lock, flags);
 247  }
 248 @@ -554,7 +553,7 @@ static struct uart_ops amba_pl010_pops =
 249         .verify_port    = pl010_verify_port,
 250  };
 251
 252 -static struct uart_amba_port *amba_ports[UART_NR];
 253 +static struct uart_amba_port *amba_ports[SERIAL_AMBA_NR];
 254
 255  #ifdef CONFIG_SERIAL_AMBA_PL010_CONSOLE
 256
 257 @@ -564,10 +563,10 @@ static void pl010_console_putchar(struct
 258         unsigned int status;
 259
 260         do {
 261 -               status = readb(uap->port.membase + UART01x_FR);
 262 +               status = __raw_readl(uap->port.membase + UART01x_FR);
 263                 barrier();
 264         } while (!UART_TX_READY(status));
 265 -       writel(ch, uap->port.membase + UART01x_DR);
 266 +       __raw_writel(ch, uap->port.membase + UART01x_DR);
 267  }
 268
 269  static void
 270 @@ -581,8 +580,8 @@ pl010_console_write(struct console *co,
 271         /*
 272          *      First save the CR then disable the interrupts
 273          */
 274 -       old_cr = readb(uap->port.membase + UART010_CR);
 275 -       writel(UART01x_CR_UARTEN, uap->port.membase + UART010_CR);
 276 +       old_cr = __raw_readl(uap->port.membase + UART010_CR);
 277 +       __raw_writel(UART01x_CR_UARTEN, uap->port.membase + UART010_CR);
 278
 279         uart_console_write(&uap->port, s, count, pl010_console_putchar);
 280
 281 @@ -591,10 +590,10 @@ pl010_console_write(struct console *co,
 282          *      and restore the TCR
 283          */
 284         do {
 285 -               status = readb(uap->port.membase + UART01x_FR);
 286 +               status = __raw_readl(uap->port.membase + UART01x_FR);
 287                 barrier();
 288         } while (status & UART01x_FR_BUSY);
 289 -       writel(old_cr, uap->port.membase + UART010_CR);
 290 +       __raw_writel(old_cr, uap->port.membase + UART010_CR);
 291
 292         clk_disable(uap->clk);
 293  }
 294 @@ -603,9 +602,9 @@ static void __init
 295  pl010_console_get_options(struct uart_amba_port *uap, int *baud,
 296                              int *parity, int *bits)
 297  {
 298 -       if (readb(uap->port.membase + UART010_CR) & UART01x_CR_UARTEN) {
 299 +       if (__raw_readl(uap->port.membase + UART010_CR) & UART01x_CR_UARTEN) {
 300                 unsigned int lcr_h, quot;
 301 -               lcr_h = readb(uap->port.membase + UART010_LCRH);
 302 +               lcr_h = __raw_readl(uap->port.membase + UART010_LCRH);
 303
 304                 *parity = 'n';
 305                 if (lcr_h & UART01x_LCRH_PEN) {
 306 @@ -620,8 +619,8 @@ pl010_console_get_options(struct uart_am
 307                 else
 308                         *bits = 8;
 309
 310 -               quot = readb(uap->port.membase + UART010_LCRL) |
 311 -                      readb(uap->port.membase + UART010_LCRM) << 8;
 312 +               quot = __raw_readl(uap->port.membase + UART010_LCRL) |
 313 +                      __raw_readl(uap->port.membase + UART010_LCRM) << 8;
 314                 *baud = uap->port.uartclk / (16 * (quot + 1));
 315         }
 316  }
 317 @@ -640,7 +639,7 @@ static int __init pl010_console_setup(st
 318          * if so, search for the first available port that does have
 319          * console support.
 320          */
 321 -       if (co->index >= UART_NR)
 322 +       if (co->index >= SERIAL_AMBA_NR)
 323                 co->index = 0;
 324         uap = amba_ports[co->index];
 325         if (!uap)
 326 @@ -662,7 +661,7 @@ static int __init pl010_console_setup(st
 327
 328  static struct uart_driver amba_reg;
 329  static struct console amba_console = {
 330 -       .name           = "ttyAM",
 331 +       .name           = SERIAL_AMBA_NAME,
 332         .write          = pl010_console_write,
 333         .device         = uart_console_device,
 334         .setup          = pl010_console_setup,
 335 @@ -678,11 +677,11 @@ static struct console amba_console = {
 336
 337  static struct uart_driver amba_reg = {
 338         .owner                  = THIS_MODULE,
 339 -       .driver_name            = "ttyAM",
 340 -       .dev_name               = "ttyAM",
 341 +       .driver_name            = SERIAL_AMBA_NAME,
 342 +       .dev_name               = SERIAL_AMBA_NAME,
 343         .major                  = SERIAL_AMBA_MAJOR,
 344         .minor                  = SERIAL_AMBA_MINOR,
 345 -       .nr                     = UART_NR,
 346 +       .nr                     = SERIAL_AMBA_NR,
 347         .cons                   = AMBA_CONSOLE,
 348  };
 349
 350 --- a/drivers/tty/serial/Kconfig
 351 +++ b/drivers/tty/serial/Kconfig
 352 @@ -16,10 +16,25 @@ config SERIAL_AMBA_PL010
 353         help
 354           This selects the ARM(R) AMBA(R) PrimeCell PL010 UART.  If you have
 355           an Integrator/AP or Integrator/PP2 platform, or if you have a
 356 -         Cirrus Logic EP93xx CPU, say Y or M here.
 357 +         Cirrus Logic EP93xx CPU or an Infineon ADM5120 SOC, say Y or M here.
 358
 359           If unsure, say N.
 360
 361 +config SERIAL_AMBA_PL010_NUMPORTS
 362 +       int "Maximum number of AMBA PL010 serial ports"
 363 +       depends on SERIAL_AMBA_PL010
 364 +       default "8"
 365 +       ---help---
 366 +         Set this to the number of serial ports you want the AMBA PL010 driver
 367 +         to support.
 368 +
 369 +config SERIAL_AMBA_PL010_PORTNAME
 370 +       string "Name of the AMBA PL010 serial ports"
 371 +       depends on SERIAL_AMBA_PL010
 372 +       default "ttyAM"
 373 +       ---help---
 374 +         ::: To be written :::
 375 +
 376  config SERIAL_AMBA_PL010_CONSOLE
 377         bool "Support for console on AMBA serial port"
 378         depends on SERIAL_AMBA_PL010=y