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