linux/drivers/tty/serial/rp2.c
<<
>>
Prefs
   1/*
   2 * Driver for Comtrol RocketPort EXPRESS/INFINITY cards
   3 *
   4 * Copyright (C) 2012 Kevin Cernekee <cernekee@gmail.com>
   5 *
   6 * Inspired by, and loosely based on:
   7 *
   8 *   ar933x_uart.c
   9 *     Copyright (C) 2011 Gabor Juhos <juhosg@openwrt.org>
  10 *
  11 *   rocketport_infinity_express-linux-1.20.tar.gz
  12 *     Copyright (C) 2004-2011 Comtrol, Inc.
  13 *
  14 * This program is free software; you can redistribute it and/or modify it
  15 * under the terms of the GNU General Public License version 2 as published
  16 * by the Free Software Foundation.
  17 */
  18
  19#include <linux/bitops.h>
  20#include <linux/compiler.h>
  21#include <linux/completion.h>
  22#include <linux/console.h>
  23#include <linux/delay.h>
  24#include <linux/firmware.h>
  25#include <linux/init.h>
  26#include <linux/io.h>
  27#include <linux/ioport.h>
  28#include <linux/irq.h>
  29#include <linux/kernel.h>
  30#include <linux/log2.h>
  31#include <linux/module.h>
  32#include <linux/pci.h>
  33#include <linux/serial.h>
  34#include <linux/serial_core.h>
  35#include <linux/slab.h>
  36#include <linux/sysrq.h>
  37#include <linux/tty.h>
  38#include <linux/tty_flip.h>
  39#include <linux/types.h>
  40
  41#define DRV_NAME                        "rp2"
  42
  43#define RP2_FW_NAME                     "rp2.fw"
  44#define RP2_UCODE_BYTES                 0x3f
  45
  46#define PORTS_PER_ASIC                  16
  47#define ALL_PORTS_MASK                  (BIT(PORTS_PER_ASIC) - 1)
  48
  49#define UART_CLOCK                      44236800
  50#define DEFAULT_BAUD_DIV                (UART_CLOCK / (9600 * 16))
  51#define FIFO_SIZE                       512
  52
  53/* BAR0 registers */
  54#define RP2_FPGA_CTL0                   0x110
  55#define RP2_FPGA_CTL1                   0x11c
  56#define RP2_IRQ_MASK                    0x1ec
  57#define RP2_IRQ_MASK_EN_m               BIT(0)
  58#define RP2_IRQ_STATUS                  0x1f0
  59
  60/* BAR1 registers */
  61#define RP2_ASIC_SPACING                0x1000
  62#define RP2_ASIC_OFFSET(i)              ((i) << ilog2(RP2_ASIC_SPACING))
  63
  64#define RP2_PORT_BASE                   0x000
  65#define RP2_PORT_SPACING                0x040
  66
  67#define RP2_UCODE_BASE                  0x400
  68#define RP2_UCODE_SPACING               0x80
  69
  70#define RP2_CLK_PRESCALER               0xc00
  71#define RP2_CH_IRQ_STAT                 0xc04
  72#define RP2_CH_IRQ_MASK                 0xc08
  73#define RP2_ASIC_IRQ                    0xd00
  74#define RP2_ASIC_IRQ_EN_m               BIT(20)
  75#define RP2_GLOBAL_CMD                  0xd0c
  76#define RP2_ASIC_CFG                    0xd04
  77
  78/* port registers */
  79#define RP2_DATA_DWORD                  0x000
  80
  81#define RP2_DATA_BYTE                   0x008
  82#define RP2_DATA_BYTE_ERR_PARITY_m      BIT(8)
  83#define RP2_DATA_BYTE_ERR_OVERRUN_m     BIT(9)
  84#define RP2_DATA_BYTE_ERR_FRAMING_m     BIT(10)
  85#define RP2_DATA_BYTE_BREAK_m           BIT(11)
  86
  87/* This lets uart_insert_char() drop bytes received on a !CREAD port */
  88#define RP2_DUMMY_READ                  BIT(16)
  89
  90#define RP2_DATA_BYTE_EXCEPTION_MASK    (RP2_DATA_BYTE_ERR_PARITY_m | \
  91                                         RP2_DATA_BYTE_ERR_OVERRUN_m | \
  92                                         RP2_DATA_BYTE_ERR_FRAMING_m | \
  93                                         RP2_DATA_BYTE_BREAK_m)
  94
  95#define RP2_RX_FIFO_COUNT               0x00c
  96#define RP2_TX_FIFO_COUNT               0x00e
  97
  98#define RP2_CHAN_STAT                   0x010
  99#define RP2_CHAN_STAT_RXDATA_m          BIT(0)
 100#define RP2_CHAN_STAT_DCD_m             BIT(3)
 101#define RP2_CHAN_STAT_DSR_m             BIT(4)
 102#define RP2_CHAN_STAT_CTS_m             BIT(5)
 103#define RP2_CHAN_STAT_RI_m              BIT(6)
 104#define RP2_CHAN_STAT_OVERRUN_m         BIT(13)
 105#define RP2_CHAN_STAT_DSR_CHANGED_m     BIT(16)
 106#define RP2_CHAN_STAT_CTS_CHANGED_m     BIT(17)
 107#define RP2_CHAN_STAT_CD_CHANGED_m      BIT(18)
 108#define RP2_CHAN_STAT_RI_CHANGED_m      BIT(22)
 109#define RP2_CHAN_STAT_TXEMPTY_m         BIT(25)
 110
 111#define RP2_CHAN_STAT_MS_CHANGED_MASK   (RP2_CHAN_STAT_DSR_CHANGED_m | \
 112                                         RP2_CHAN_STAT_CTS_CHANGED_m | \
 113                                         RP2_CHAN_STAT_CD_CHANGED_m | \
 114                                         RP2_CHAN_STAT_RI_CHANGED_m)
 115
 116#define RP2_TXRX_CTL                    0x014
 117#define RP2_TXRX_CTL_MSRIRQ_m           BIT(0)
 118#define RP2_TXRX_CTL_RXIRQ_m            BIT(2)
 119#define RP2_TXRX_CTL_RX_TRIG_s          3
 120#define RP2_TXRX_CTL_RX_TRIG_m          (0x3 << RP2_TXRX_CTL_RX_TRIG_s)
 121#define RP2_TXRX_CTL_RX_TRIG_1          (0x1 << RP2_TXRX_CTL_RX_TRIG_s)
 122#define RP2_TXRX_CTL_RX_TRIG_256        (0x2 << RP2_TXRX_CTL_RX_TRIG_s)
 123#define RP2_TXRX_CTL_RX_TRIG_448        (0x3 << RP2_TXRX_CTL_RX_TRIG_s)
 124#define RP2_TXRX_CTL_RX_EN_m            BIT(5)
 125#define RP2_TXRX_CTL_RTSFLOW_m          BIT(6)
 126#define RP2_TXRX_CTL_DTRFLOW_m          BIT(7)
 127#define RP2_TXRX_CTL_TX_TRIG_s          16
 128#define RP2_TXRX_CTL_TX_TRIG_m          (0x3 << RP2_TXRX_CTL_RX_TRIG_s)
 129#define RP2_TXRX_CTL_DSRFLOW_m          BIT(18)
 130#define RP2_TXRX_CTL_TXIRQ_m            BIT(19)
 131#define RP2_TXRX_CTL_CTSFLOW_m          BIT(23)
 132#define RP2_TXRX_CTL_TX_EN_m            BIT(24)
 133#define RP2_TXRX_CTL_RTS_m              BIT(25)
 134#define RP2_TXRX_CTL_DTR_m              BIT(26)
 135#define RP2_TXRX_CTL_LOOP_m             BIT(27)
 136#define RP2_TXRX_CTL_BREAK_m            BIT(28)
 137#define RP2_TXRX_CTL_CMSPAR_m           BIT(29)
 138#define RP2_TXRX_CTL_nPARODD_m          BIT(30)
 139#define RP2_TXRX_CTL_PARENB_m           BIT(31)
 140
 141#define RP2_UART_CTL                    0x018
 142#define RP2_UART_CTL_MODE_s             0
 143#define RP2_UART_CTL_MODE_m             (0x7 << RP2_UART_CTL_MODE_s)
 144#define RP2_UART_CTL_MODE_rs232         (0x1 << RP2_UART_CTL_MODE_s)
 145#define RP2_UART_CTL_FLUSH_RX_m         BIT(3)
 146#define RP2_UART_CTL_FLUSH_TX_m         BIT(4)
 147#define RP2_UART_CTL_RESET_CH_m         BIT(5)
 148#define RP2_UART_CTL_XMIT_EN_m          BIT(6)
 149#define RP2_UART_CTL_DATABITS_s         8
 150#define RP2_UART_CTL_DATABITS_m         (0x3 << RP2_UART_CTL_DATABITS_s)
 151#define RP2_UART_CTL_DATABITS_8         (0x3 << RP2_UART_CTL_DATABITS_s)
 152#define RP2_UART_CTL_DATABITS_7         (0x2 << RP2_UART_CTL_DATABITS_s)
 153#define RP2_UART_CTL_DATABITS_6         (0x1 << RP2_UART_CTL_DATABITS_s)
 154#define RP2_UART_CTL_DATABITS_5         (0x0 << RP2_UART_CTL_DATABITS_s)
 155#define RP2_UART_CTL_STOPBITS_m         BIT(10)
 156
 157#define RP2_BAUD                        0x01c
 158
 159/* ucode registers */
 160#define RP2_TX_SWFLOW                   0x02
 161#define RP2_TX_SWFLOW_ena               0x81
 162#define RP2_TX_SWFLOW_dis               0x9d
 163
 164#define RP2_RX_SWFLOW                   0x0c
 165#define RP2_RX_SWFLOW_ena               0x81
 166#define RP2_RX_SWFLOW_dis               0x8d
 167
 168#define RP2_RX_FIFO                     0x37
 169#define RP2_RX_FIFO_ena                 0x08
 170#define RP2_RX_FIFO_dis                 0x81
 171
 172static struct uart_driver rp2_uart_driver = {
 173        .owner                          = THIS_MODULE,
 174        .driver_name                    = DRV_NAME,
 175        .dev_name                       = "ttyRP",
 176        .nr                             = CONFIG_SERIAL_RP2_NR_UARTS,
 177};
 178
 179struct rp2_card;
 180
 181struct rp2_uart_port {
 182        struct uart_port                port;
 183        int                             idx;
 184        int                             ignore_rx;
 185        struct rp2_card                 *card;
 186        void __iomem                    *asic_base;
 187        void __iomem                    *base;
 188        void __iomem                    *ucode;
 189};
 190
 191struct rp2_card {
 192        struct pci_dev                  *pdev;
 193        struct rp2_uart_port            *ports;
 194        int                             n_ports;
 195        int                             initialized_ports;
 196        int                             minor_start;
 197        int                             smpte;
 198        void __iomem                    *bar0;
 199        void __iomem                    *bar1;
 200        spinlock_t                      card_lock;
 201        struct completion               fw_loaded;
 202};
 203
 204#define RP_ID(prod) PCI_VDEVICE(RP, (prod))
 205#define RP_CAP(ports, smpte) (((ports) << 8) | ((smpte) << 0))
 206
 207static inline void rp2_decode_cap(const struct pci_device_id *id,
 208                                  int *ports, int *smpte)
 209{
 210        *ports = id->driver_data >> 8;
 211        *smpte = id->driver_data & 0xff;
 212}
 213
 214static DEFINE_SPINLOCK(rp2_minor_lock);
 215static int rp2_minor_next;
 216
 217static int rp2_alloc_ports(int n_ports)
 218{
 219        int ret = -ENOSPC;
 220
 221        spin_lock(&rp2_minor_lock);
 222        if (rp2_minor_next + n_ports <= CONFIG_SERIAL_RP2_NR_UARTS) {
 223                /* sorry, no support for hot unplugging individual cards */
 224                ret = rp2_minor_next;
 225                rp2_minor_next += n_ports;
 226        }
 227        spin_unlock(&rp2_minor_lock);
 228
 229        return ret;
 230}
 231
 232static inline struct rp2_uart_port *port_to_up(struct uart_port *port)
 233{
 234        return container_of(port, struct rp2_uart_port, port);
 235}
 236
 237static void rp2_rmw(struct rp2_uart_port *up, int reg,
 238                    u32 clr_bits, u32 set_bits)
 239{
 240        u32 tmp = readl(up->base + reg);
 241        tmp &= ~clr_bits;
 242        tmp |= set_bits;
 243        writel(tmp, up->base + reg);
 244}
 245
 246static void rp2_rmw_clr(struct rp2_uart_port *up, int reg, u32 val)
 247{
 248        rp2_rmw(up, reg, val, 0);
 249}
 250
 251static void rp2_rmw_set(struct rp2_uart_port *up, int reg, u32 val)
 252{
 253        rp2_rmw(up, reg, 0, val);
 254}
 255
 256static void rp2_mask_ch_irq(struct rp2_uart_port *up, int ch_num,
 257                            int is_enabled)
 258{
 259        unsigned long flags, irq_mask;
 260
 261        spin_lock_irqsave(&up->card->card_lock, flags);
 262
 263        irq_mask = readl(up->asic_base + RP2_CH_IRQ_MASK);
 264        if (is_enabled)
 265                irq_mask &= ~BIT(ch_num);
 266        else
 267                irq_mask |= BIT(ch_num);
 268        writel(irq_mask, up->asic_base + RP2_CH_IRQ_MASK);
 269
 270        spin_unlock_irqrestore(&up->card->card_lock, flags);
 271}
 272
 273static unsigned int rp2_uart_tx_empty(struct uart_port *port)
 274{
 275        struct rp2_uart_port *up = port_to_up(port);
 276        unsigned long tx_fifo_bytes, flags;
 277
 278        /*
 279         * This should probably check the transmitter, not the FIFO.
 280         * But the TXEMPTY bit doesn't seem to work unless the TX IRQ is
 281         * enabled.
 282         */
 283        spin_lock_irqsave(&up->port.lock, flags);
 284        tx_fifo_bytes = readw(up->base + RP2_TX_FIFO_COUNT);
 285        spin_unlock_irqrestore(&up->port.lock, flags);
 286
 287        return tx_fifo_bytes ? 0 : TIOCSER_TEMT;
 288}
 289
 290static unsigned int rp2_uart_get_mctrl(struct uart_port *port)
 291{
 292        struct rp2_uart_port *up = port_to_up(port);
 293        u32 status;
 294
 295        status = readl(up->base + RP2_CHAN_STAT);
 296        return ((status & RP2_CHAN_STAT_DCD_m) ? TIOCM_CAR : 0) |
 297               ((status & RP2_CHAN_STAT_DSR_m) ? TIOCM_DSR : 0) |
 298               ((status & RP2_CHAN_STAT_CTS_m) ? TIOCM_CTS : 0) |
 299               ((status & RP2_CHAN_STAT_RI_m) ? TIOCM_RI : 0);
 300}
 301
 302static void rp2_uart_set_mctrl(struct uart_port *port, unsigned int mctrl)
 303{
 304        rp2_rmw(port_to_up(port), RP2_TXRX_CTL,
 305                RP2_TXRX_CTL_DTR_m | RP2_TXRX_CTL_RTS_m | RP2_TXRX_CTL_LOOP_m,
 306                ((mctrl & TIOCM_DTR) ? RP2_TXRX_CTL_DTR_m : 0) |
 307                ((mctrl & TIOCM_RTS) ? RP2_TXRX_CTL_RTS_m : 0) |
 308                ((mctrl & TIOCM_LOOP) ? RP2_TXRX_CTL_LOOP_m : 0));
 309}
 310
 311static void rp2_uart_start_tx(struct uart_port *port)
 312{
 313        rp2_rmw_set(port_to_up(port), RP2_TXRX_CTL, RP2_TXRX_CTL_TXIRQ_m);
 314}
 315
 316static void rp2_uart_stop_tx(struct uart_port *port)
 317{
 318        rp2_rmw_clr(port_to_up(port), RP2_TXRX_CTL, RP2_TXRX_CTL_TXIRQ_m);
 319}
 320
 321static void rp2_uart_stop_rx(struct uart_port *port)
 322{
 323        rp2_rmw_clr(port_to_up(port), RP2_TXRX_CTL, RP2_TXRX_CTL_RXIRQ_m);
 324}
 325
 326static void rp2_uart_break_ctl(struct uart_port *port, int break_state)
 327{
 328        unsigned long flags;
 329
 330        spin_lock_irqsave(&port->lock, flags);
 331        rp2_rmw(port_to_up(port), RP2_TXRX_CTL, RP2_TXRX_CTL_BREAK_m,
 332                break_state ? RP2_TXRX_CTL_BREAK_m : 0);
 333        spin_unlock_irqrestore(&port->lock, flags);
 334}
 335
 336static void rp2_uart_enable_ms(struct uart_port *port)
 337{
 338        rp2_rmw_set(port_to_up(port), RP2_TXRX_CTL, RP2_TXRX_CTL_MSRIRQ_m);
 339}
 340
 341static void __rp2_uart_set_termios(struct rp2_uart_port *up,
 342                                   unsigned long cfl,
 343                                   unsigned long ifl,
 344                                   unsigned int baud_div)
 345{
 346        /* baud rate divisor (calculated elsewhere).  0 = divide-by-1 */
 347        writew(baud_div - 1, up->base + RP2_BAUD);
 348
 349        /* data bits and stop bits */
 350        rp2_rmw(up, RP2_UART_CTL,
 351                RP2_UART_CTL_STOPBITS_m | RP2_UART_CTL_DATABITS_m,
 352                ((cfl & CSTOPB) ? RP2_UART_CTL_STOPBITS_m : 0) |
 353                (((cfl & CSIZE) == CS8) ? RP2_UART_CTL_DATABITS_8 : 0) |
 354                (((cfl & CSIZE) == CS7) ? RP2_UART_CTL_DATABITS_7 : 0) |
 355                (((cfl & CSIZE) == CS6) ? RP2_UART_CTL_DATABITS_6 : 0) |
 356                (((cfl & CSIZE) == CS5) ? RP2_UART_CTL_DATABITS_5 : 0));
 357
 358        /* parity and hardware flow control */
 359        rp2_rmw(up, RP2_TXRX_CTL,
 360                RP2_TXRX_CTL_PARENB_m | RP2_TXRX_CTL_nPARODD_m |
 361                RP2_TXRX_CTL_CMSPAR_m | RP2_TXRX_CTL_DTRFLOW_m |
 362                RP2_TXRX_CTL_DSRFLOW_m | RP2_TXRX_CTL_RTSFLOW_m |
 363                RP2_TXRX_CTL_CTSFLOW_m,
 364                ((cfl & PARENB) ? RP2_TXRX_CTL_PARENB_m : 0) |
 365                ((cfl & PARODD) ? 0 : RP2_TXRX_CTL_nPARODD_m) |
 366                ((cfl & CMSPAR) ? RP2_TXRX_CTL_CMSPAR_m : 0) |
 367                ((cfl & CRTSCTS) ? (RP2_TXRX_CTL_RTSFLOW_m |
 368                                    RP2_TXRX_CTL_CTSFLOW_m) : 0));
 369
 370        /* XON/XOFF software flow control */
 371        writeb((ifl & IXON) ? RP2_TX_SWFLOW_ena : RP2_TX_SWFLOW_dis,
 372               up->ucode + RP2_TX_SWFLOW);
 373        writeb((ifl & IXOFF) ? RP2_RX_SWFLOW_ena : RP2_RX_SWFLOW_dis,
 374               up->ucode + RP2_RX_SWFLOW);
 375}
 376
 377static void rp2_uart_set_termios(struct uart_port *port,
 378                                 struct ktermios *new,
 379                                 struct ktermios *old)
 380{
 381        struct rp2_uart_port *up = port_to_up(port);
 382        unsigned long flags;
 383        unsigned int baud, baud_div;
 384
 385        baud = uart_get_baud_rate(port, new, old, 0, port->uartclk / 16);
 386        baud_div = uart_get_divisor(port, baud);
 387
 388        if (tty_termios_baud_rate(new))
 389                tty_termios_encode_baud_rate(new, baud, baud);
 390
 391        spin_lock_irqsave(&port->lock, flags);
 392
 393        /* ignore all characters if CREAD is not set */
 394        port->ignore_status_mask = (new->c_cflag & CREAD) ? 0 : RP2_DUMMY_READ;
 395
 396        __rp2_uart_set_termios(up, new->c_cflag, new->c_iflag, baud_div);
 397        uart_update_timeout(port, new->c_cflag, baud);
 398
 399        spin_unlock_irqrestore(&port->lock, flags);
 400}
 401
 402static void rp2_rx_chars(struct rp2_uart_port *up)
 403{
 404        u16 bytes = readw(up->base + RP2_RX_FIFO_COUNT);
 405        struct tty_port *port = &up->port.state->port;
 406
 407        for (; bytes != 0; bytes--) {
 408                u32 byte = readw(up->base + RP2_DATA_BYTE) | RP2_DUMMY_READ;
 409                char ch = byte & 0xff;
 410
 411                if (likely(!(byte & RP2_DATA_BYTE_EXCEPTION_MASK))) {
 412                        if (!uart_handle_sysrq_char(&up->port, ch))
 413                                uart_insert_char(&up->port, byte, 0, ch,
 414                                                 TTY_NORMAL);
 415                } else {
 416                        char flag = TTY_NORMAL;
 417
 418                        if (byte & RP2_DATA_BYTE_BREAK_m)
 419                                flag = TTY_BREAK;
 420                        else if (byte & RP2_DATA_BYTE_ERR_FRAMING_m)
 421                                flag = TTY_FRAME;
 422                        else if (byte & RP2_DATA_BYTE_ERR_PARITY_m)
 423                                flag = TTY_PARITY;
 424                        uart_insert_char(&up->port, byte,
 425                                         RP2_DATA_BYTE_ERR_OVERRUN_m, ch, flag);
 426                }
 427                up->port.icount.rx++;
 428        }
 429
 430        spin_unlock(&up->port.lock);
 431        tty_flip_buffer_push(port);
 432        spin_lock(&up->port.lock);
 433}
 434
 435static void rp2_tx_chars(struct rp2_uart_port *up)
 436{
 437        u16 max_tx = FIFO_SIZE - readw(up->base + RP2_TX_FIFO_COUNT);
 438        struct circ_buf *xmit = &up->port.state->xmit;
 439
 440        if (uart_tx_stopped(&up->port)) {
 441                rp2_uart_stop_tx(&up->port);
 442                return;
 443        }
 444
 445        for (; max_tx != 0; max_tx--) {
 446                if (up->port.x_char) {
 447                        writeb(up->port.x_char, up->base + RP2_DATA_BYTE);
 448                        up->port.x_char = 0;
 449                        up->port.icount.tx++;
 450                        continue;
 451                }
 452                if (uart_circ_empty(xmit)) {
 453                        rp2_uart_stop_tx(&up->port);
 454                        break;
 455                }
 456                writeb(xmit->buf[xmit->tail], up->base + RP2_DATA_BYTE);
 457                xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
 458                up->port.icount.tx++;
 459        }
 460
 461        if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
 462                uart_write_wakeup(&up->port);
 463}
 464
 465static void rp2_ch_interrupt(struct rp2_uart_port *up)
 466{
 467        u32 status;
 468
 469        spin_lock(&up->port.lock);
 470
 471        /*
 472         * The IRQ status bits are clear-on-write.  Other status bits in
 473         * this register aren't, so it's harmless to write to them.
 474         */
 475        status = readl(up->base + RP2_CHAN_STAT);
 476        writel(status, up->base + RP2_CHAN_STAT);
 477
 478        if (status & RP2_CHAN_STAT_RXDATA_m)
 479                rp2_rx_chars(up);
 480        if (status & RP2_CHAN_STAT_TXEMPTY_m)
 481                rp2_tx_chars(up);
 482        if (status & RP2_CHAN_STAT_MS_CHANGED_MASK)
 483                wake_up_interruptible(&up->port.state->port.delta_msr_wait);
 484
 485        spin_unlock(&up->port.lock);
 486}
 487
 488static int rp2_asic_interrupt(struct rp2_card *card, unsigned int asic_id)
 489{
 490        void __iomem *base = card->bar1 + RP2_ASIC_OFFSET(asic_id);
 491        int ch, handled = 0;
 492        unsigned long status = readl(base + RP2_CH_IRQ_STAT) &
 493                               ~readl(base + RP2_CH_IRQ_MASK);
 494
 495        for_each_set_bit(ch, &status, PORTS_PER_ASIC) {
 496                rp2_ch_interrupt(&card->ports[ch]);
 497                handled++;
 498        }
 499        return handled;
 500}
 501
 502static irqreturn_t rp2_uart_interrupt(int irq, void *dev_id)
 503{
 504        struct rp2_card *card = dev_id;
 505        int handled;
 506
 507        handled = rp2_asic_interrupt(card, 0);
 508        if (card->n_ports >= PORTS_PER_ASIC)
 509                handled += rp2_asic_interrupt(card, 1);
 510
 511        return handled ? IRQ_HANDLED : IRQ_NONE;
 512}
 513
 514static inline void rp2_flush_fifos(struct rp2_uart_port *up)
 515{
 516        rp2_rmw_set(up, RP2_UART_CTL,
 517                    RP2_UART_CTL_FLUSH_RX_m | RP2_UART_CTL_FLUSH_TX_m);
 518        readl(up->base + RP2_UART_CTL);
 519        udelay(10);
 520        rp2_rmw_clr(up, RP2_UART_CTL,
 521                    RP2_UART_CTL_FLUSH_RX_m | RP2_UART_CTL_FLUSH_TX_m);
 522}
 523
 524static int rp2_uart_startup(struct uart_port *port)
 525{
 526        struct rp2_uart_port *up = port_to_up(port);
 527
 528        rp2_flush_fifos(up);
 529        rp2_rmw(up, RP2_TXRX_CTL, RP2_TXRX_CTL_MSRIRQ_m, RP2_TXRX_CTL_RXIRQ_m);
 530        rp2_rmw(up, RP2_TXRX_CTL, RP2_TXRX_CTL_RX_TRIG_m,
 531                RP2_TXRX_CTL_RX_TRIG_1);
 532        rp2_rmw(up, RP2_CHAN_STAT, 0, 0);
 533        rp2_mask_ch_irq(up, up->idx, 1);
 534
 535        return 0;
 536}
 537
 538static void rp2_uart_shutdown(struct uart_port *port)
 539{
 540        struct rp2_uart_port *up = port_to_up(port);
 541        unsigned long flags;
 542
 543        rp2_uart_break_ctl(port, 0);
 544
 545        spin_lock_irqsave(&port->lock, flags);
 546        rp2_mask_ch_irq(up, up->idx, 0);
 547        rp2_rmw(up, RP2_CHAN_STAT, 0, 0);
 548        spin_unlock_irqrestore(&port->lock, flags);
 549}
 550
 551static const char *rp2_uart_type(struct uart_port *port)
 552{
 553        return (port->type == PORT_RP2) ? "RocketPort 2 UART" : NULL;
 554}
 555
 556static void rp2_uart_release_port(struct uart_port *port)
 557{
 558        /* Nothing to release ... */
 559}
 560
 561static int rp2_uart_request_port(struct uart_port *port)
 562{
 563        /* UARTs always present */
 564        return 0;
 565}
 566
 567static void rp2_uart_config_port(struct uart_port *port, int flags)
 568{
 569        if (flags & UART_CONFIG_TYPE)
 570                port->type = PORT_RP2;
 571}
 572
 573static int rp2_uart_verify_port(struct uart_port *port,
 574                                   struct serial_struct *ser)
 575{
 576        if (ser->type != PORT_UNKNOWN && ser->type != PORT_RP2)
 577                return -EINVAL;
 578
 579        return 0;
 580}
 581
 582static const struct uart_ops rp2_uart_ops = {
 583        .tx_empty       = rp2_uart_tx_empty,
 584        .set_mctrl      = rp2_uart_set_mctrl,
 585        .get_mctrl      = rp2_uart_get_mctrl,
 586        .stop_tx        = rp2_uart_stop_tx,
 587        .start_tx       = rp2_uart_start_tx,
 588        .stop_rx        = rp2_uart_stop_rx,
 589        .enable_ms      = rp2_uart_enable_ms,
 590        .break_ctl      = rp2_uart_break_ctl,
 591        .startup        = rp2_uart_startup,
 592        .shutdown       = rp2_uart_shutdown,
 593        .set_termios    = rp2_uart_set_termios,
 594        .type           = rp2_uart_type,
 595        .release_port   = rp2_uart_release_port,
 596        .request_port   = rp2_uart_request_port,
 597        .config_port    = rp2_uart_config_port,
 598        .verify_port    = rp2_uart_verify_port,
 599};
 600
 601static void rp2_reset_asic(struct rp2_card *card, unsigned int asic_id)
 602{
 603        void __iomem *base = card->bar1 + RP2_ASIC_OFFSET(asic_id);
 604        u32 clk_cfg;
 605
 606        writew(1, base + RP2_GLOBAL_CMD);
 607        readw(base + RP2_GLOBAL_CMD);
 608        msleep(100);
 609        writel(0, base + RP2_CLK_PRESCALER);
 610
 611        /* TDM clock configuration */
 612        clk_cfg = readw(base + RP2_ASIC_CFG);
 613        clk_cfg = (clk_cfg & ~BIT(8)) | BIT(9);
 614        writew(clk_cfg, base + RP2_ASIC_CFG);
 615
 616        /* IRQ routing */
 617        writel(ALL_PORTS_MASK, base + RP2_CH_IRQ_MASK);
 618        writel(RP2_ASIC_IRQ_EN_m, base + RP2_ASIC_IRQ);
 619}
 620
 621static void rp2_init_card(struct rp2_card *card)
 622{
 623        writel(4, card->bar0 + RP2_FPGA_CTL0);
 624        writel(0, card->bar0 + RP2_FPGA_CTL1);
 625
 626        rp2_reset_asic(card, 0);
 627        if (card->n_ports >= PORTS_PER_ASIC)
 628                rp2_reset_asic(card, 1);
 629
 630        writel(RP2_IRQ_MASK_EN_m, card->bar0 + RP2_IRQ_MASK);
 631}
 632
 633static void rp2_init_port(struct rp2_uart_port *up, const struct firmware *fw)
 634{
 635        int i;
 636
 637        writel(RP2_UART_CTL_RESET_CH_m, up->base + RP2_UART_CTL);
 638        readl(up->base + RP2_UART_CTL);
 639        udelay(1);
 640
 641        writel(0, up->base + RP2_TXRX_CTL);
 642        writel(0, up->base + RP2_UART_CTL);
 643        readl(up->base + RP2_UART_CTL);
 644        udelay(1);
 645
 646        rp2_flush_fifos(up);
 647
 648        for (i = 0; i < min_t(int, fw->size, RP2_UCODE_BYTES); i++)
 649                writeb(fw->data[i], up->ucode + i);
 650
 651        __rp2_uart_set_termios(up, CS8 | CREAD | CLOCAL, 0, DEFAULT_BAUD_DIV);
 652        rp2_uart_set_mctrl(&up->port, 0);
 653
 654        writeb(RP2_RX_FIFO_ena, up->ucode + RP2_RX_FIFO);
 655        rp2_rmw(up, RP2_UART_CTL, RP2_UART_CTL_MODE_m,
 656                RP2_UART_CTL_XMIT_EN_m | RP2_UART_CTL_MODE_rs232);
 657        rp2_rmw_set(up, RP2_TXRX_CTL,
 658                    RP2_TXRX_CTL_TX_EN_m | RP2_TXRX_CTL_RX_EN_m);
 659}
 660
 661static void rp2_remove_ports(struct rp2_card *card)
 662{
 663        int i;
 664
 665        for (i = 0; i < card->initialized_ports; i++)
 666                uart_remove_one_port(&rp2_uart_driver, &card->ports[i].port);
 667        card->initialized_ports = 0;
 668}
 669
 670static void rp2_fw_cb(const struct firmware *fw, void *context)
 671{
 672        struct rp2_card *card = context;
 673        resource_size_t phys_base;
 674        int i, rc = -ENOENT;
 675
 676        if (!fw) {
 677                dev_err(&card->pdev->dev, "cannot find '%s' firmware image\n",
 678                        RP2_FW_NAME);
 679                goto no_fw;
 680        }
 681
 682        phys_base = pci_resource_start(card->pdev, 1);
 683
 684        for (i = 0; i < card->n_ports; i++) {
 685                struct rp2_uart_port *rp = &card->ports[i];
 686                struct uart_port *p;
 687                int j = (unsigned)i % PORTS_PER_ASIC;
 688
 689                rp->asic_base = card->bar1;
 690                rp->base = card->bar1 + RP2_PORT_BASE + j*RP2_PORT_SPACING;
 691                rp->ucode = card->bar1 + RP2_UCODE_BASE + j*RP2_UCODE_SPACING;
 692                rp->card = card;
 693                rp->idx = j;
 694
 695                p = &rp->port;
 696                p->line = card->minor_start + i;
 697                p->dev = &card->pdev->dev;
 698                p->type = PORT_RP2;
 699                p->iotype = UPIO_MEM32;
 700                p->uartclk = UART_CLOCK;
 701                p->regshift = 2;
 702                p->fifosize = FIFO_SIZE;
 703                p->ops = &rp2_uart_ops;
 704                p->irq = card->pdev->irq;
 705                p->membase = rp->base;
 706                p->mapbase = phys_base + RP2_PORT_BASE + j*RP2_PORT_SPACING;
 707
 708                if (i >= PORTS_PER_ASIC) {
 709                        rp->asic_base += RP2_ASIC_SPACING;
 710                        rp->base += RP2_ASIC_SPACING;
 711                        rp->ucode += RP2_ASIC_SPACING;
 712                        p->mapbase += RP2_ASIC_SPACING;
 713                }
 714
 715                rp2_init_port(rp, fw);
 716                rc = uart_add_one_port(&rp2_uart_driver, p);
 717                if (rc) {
 718                        dev_err(&card->pdev->dev,
 719                                "error registering port %d: %d\n", i, rc);
 720                        rp2_remove_ports(card);
 721                        break;
 722                }
 723                card->initialized_ports++;
 724        }
 725
 726        release_firmware(fw);
 727no_fw:
 728        /*
 729         * rp2_fw_cb() is called from a workqueue long after rp2_probe()
 730         * has already returned success.  So if something failed here,
 731         * we'll just leave the now-dormant device in place until somebody
 732         * unbinds it.
 733         */
 734        if (rc)
 735                dev_warn(&card->pdev->dev, "driver initialization failed\n");
 736
 737        complete(&card->fw_loaded);
 738}
 739
 740static int rp2_probe(struct pci_dev *pdev,
 741                                   const struct pci_device_id *id)
 742{
 743        struct rp2_card *card;
 744        struct rp2_uart_port *ports;
 745        void __iomem * const *bars;
 746        int rc;
 747
 748        card = devm_kzalloc(&pdev->dev, sizeof(*card), GFP_KERNEL);
 749        if (!card)
 750                return -ENOMEM;
 751        pci_set_drvdata(pdev, card);
 752        spin_lock_init(&card->card_lock);
 753        init_completion(&card->fw_loaded);
 754
 755        rc = pcim_enable_device(pdev);
 756        if (rc)
 757                return rc;
 758
 759        rc = pcim_iomap_regions_request_all(pdev, 0x03, DRV_NAME);
 760        if (rc)
 761                return rc;
 762
 763        bars = pcim_iomap_table(pdev);
 764        card->bar0 = bars[0];
 765        card->bar1 = bars[1];
 766        card->pdev = pdev;
 767
 768        rp2_decode_cap(id, &card->n_ports, &card->smpte);
 769        dev_info(&pdev->dev, "found new card with %d ports\n", card->n_ports);
 770
 771        card->minor_start = rp2_alloc_ports(card->n_ports);
 772        if (card->minor_start < 0) {
 773                dev_err(&pdev->dev,
 774                        "too many ports (try increasing CONFIG_SERIAL_RP2_NR_UARTS)\n");
 775                return -EINVAL;
 776        }
 777
 778        rp2_init_card(card);
 779
 780        ports = devm_kzalloc(&pdev->dev, sizeof(*ports) * card->n_ports,
 781                             GFP_KERNEL);
 782        if (!ports)
 783                return -ENOMEM;
 784        card->ports = ports;
 785
 786        rc = devm_request_irq(&pdev->dev, pdev->irq, rp2_uart_interrupt,
 787                              IRQF_SHARED, DRV_NAME, card);
 788        if (rc)
 789                return rc;
 790
 791        /*
 792         * Only catastrophic errors (e.g. ENOMEM) are reported here.
 793         * If the FW image is missing, we'll find out in rp2_fw_cb()
 794         * and print an error message.
 795         */
 796        rc = request_firmware_nowait(THIS_MODULE, 1, RP2_FW_NAME, &pdev->dev,
 797                                     GFP_KERNEL, card, rp2_fw_cb);
 798        if (rc)
 799                return rc;
 800        dev_dbg(&pdev->dev, "waiting for firmware blob...\n");
 801
 802        return 0;
 803}
 804
 805static void rp2_remove(struct pci_dev *pdev)
 806{
 807        struct rp2_card *card = pci_get_drvdata(pdev);
 808
 809        wait_for_completion(&card->fw_loaded);
 810        rp2_remove_ports(card);
 811}
 812
 813static const struct pci_device_id rp2_pci_tbl[] = {
 814
 815        /* RocketPort INFINITY cards */
 816
 817        { RP_ID(0x0040), RP_CAP(8,  0) }, /* INF Octa, RJ45, selectable */
 818        { RP_ID(0x0041), RP_CAP(32, 0) }, /* INF 32, ext interface */
 819        { RP_ID(0x0042), RP_CAP(8,  0) }, /* INF Octa, ext interface */
 820        { RP_ID(0x0043), RP_CAP(16, 0) }, /* INF 16, ext interface */
 821        { RP_ID(0x0044), RP_CAP(4,  0) }, /* INF Quad, DB, selectable */
 822        { RP_ID(0x0045), RP_CAP(8,  0) }, /* INF Octa, DB, selectable */
 823        { RP_ID(0x0046), RP_CAP(4,  0) }, /* INF Quad, ext interface */
 824        { RP_ID(0x0047), RP_CAP(4,  0) }, /* INF Quad, RJ45 */
 825        { RP_ID(0x004a), RP_CAP(4,  0) }, /* INF Plus, Quad */
 826        { RP_ID(0x004b), RP_CAP(8,  0) }, /* INF Plus, Octa */
 827        { RP_ID(0x004c), RP_CAP(8,  0) }, /* INF III, Octa */
 828        { RP_ID(0x004d), RP_CAP(4,  0) }, /* INF III, Quad */
 829        { RP_ID(0x004e), RP_CAP(2,  0) }, /* INF Plus, 2, RS232 */
 830        { RP_ID(0x004f), RP_CAP(2,  1) }, /* INF Plus, 2, SMPTE */
 831        { RP_ID(0x0050), RP_CAP(4,  0) }, /* INF Plus, Quad, RJ45 */
 832        { RP_ID(0x0051), RP_CAP(8,  0) }, /* INF Plus, Octa, RJ45 */
 833        { RP_ID(0x0052), RP_CAP(8,  1) }, /* INF Octa, SMPTE */
 834
 835        /* RocketPort EXPRESS cards */
 836
 837        { RP_ID(0x0060), RP_CAP(8,  0) }, /* EXP Octa, RJ45, selectable */
 838        { RP_ID(0x0061), RP_CAP(32, 0) }, /* EXP 32, ext interface */
 839        { RP_ID(0x0062), RP_CAP(8,  0) }, /* EXP Octa, ext interface */
 840        { RP_ID(0x0063), RP_CAP(16, 0) }, /* EXP 16, ext interface */
 841        { RP_ID(0x0064), RP_CAP(4,  0) }, /* EXP Quad, DB, selectable */
 842        { RP_ID(0x0065), RP_CAP(8,  0) }, /* EXP Octa, DB, selectable */
 843        { RP_ID(0x0066), RP_CAP(4,  0) }, /* EXP Quad, ext interface */
 844        { RP_ID(0x0067), RP_CAP(4,  0) }, /* EXP Quad, RJ45 */
 845        { RP_ID(0x0068), RP_CAP(8,  0) }, /* EXP Octa, RJ11 */
 846        { RP_ID(0x0072), RP_CAP(8,  1) }, /* EXP Octa, SMPTE */
 847        { }
 848};
 849MODULE_DEVICE_TABLE(pci, rp2_pci_tbl);
 850
 851static struct pci_driver rp2_pci_driver = {
 852        .name           = DRV_NAME,
 853        .id_table       = rp2_pci_tbl,
 854        .probe          = rp2_probe,
 855        .remove         = rp2_remove,
 856};
 857
 858static int __init rp2_uart_init(void)
 859{
 860        int rc;
 861
 862        rc = uart_register_driver(&rp2_uart_driver);
 863        if (rc)
 864                return rc;
 865
 866        rc = pci_register_driver(&rp2_pci_driver);
 867        if (rc) {
 868                uart_unregister_driver(&rp2_uart_driver);
 869                return rc;
 870        }
 871
 872        return 0;
 873}
 874
 875static void __exit rp2_uart_exit(void)
 876{
 877        pci_unregister_driver(&rp2_pci_driver);
 878        uart_unregister_driver(&rp2_uart_driver);
 879}
 880
 881module_init(rp2_uart_init);
 882module_exit(rp2_uart_exit);
 883
 884MODULE_DESCRIPTION("Comtrol RocketPort EXPRESS/INFINITY driver");
 885MODULE_AUTHOR("Kevin Cernekee <cernekee@gmail.com>");
 886MODULE_LICENSE("GPL v2");
 887MODULE_FIRMWARE(RP2_FW_NAME);
 888