diff options
Diffstat (limited to 'drivers/serial/zs.c')
| -rw-r--r-- | drivers/serial/zs.c | 1287 |
1 files changed, 1287 insertions, 0 deletions
diff --git a/drivers/serial/zs.c b/drivers/serial/zs.c new file mode 100644 index 000000000000..65f1294fd27b --- /dev/null +++ b/drivers/serial/zs.c | |||
| @@ -0,0 +1,1287 @@ | |||
| 1 | /* | ||
| 2 | * zs.c: Serial port driver for IOASIC DECstations. | ||
| 3 | * | ||
| 4 | * Derived from drivers/sbus/char/sunserial.c by Paul Mackerras. | ||
| 5 | * Derived from drivers/macintosh/macserial.c by Harald Koerfgen. | ||
| 6 | * | ||
| 7 | * DECstation changes | ||
| 8 | * Copyright (C) 1998-2000 Harald Koerfgen | ||
| 9 | * Copyright (C) 2000, 2001, 2002, 2003, 2004, 2005, 2007 Maciej W. Rozycki | ||
| 10 | * | ||
| 11 | * For the rest of the code the original Copyright applies: | ||
| 12 | * Copyright (C) 1996 Paul Mackerras (Paul.Mackerras@cs.anu.edu.au) | ||
| 13 | * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu) | ||
| 14 | * | ||
| 15 | * | ||
| 16 | * Note: for IOASIC systems the wiring is as follows: | ||
| 17 | * | ||
| 18 | * mouse/keyboard: | ||
| 19 | * DIN-7 MJ-4 signal SCC | ||
| 20 | * 2 1 TxD <- A.TxD | ||
| 21 | * 3 4 RxD -> A.RxD | ||
| 22 | * | ||
| 23 | * EIA-232/EIA-423: | ||
| 24 | * DB-25 MMJ-6 signal SCC | ||
| 25 | * 2 2 TxD <- B.TxD | ||
| 26 | * 3 5 RxD -> B.RxD | ||
| 27 | * 4 RTS <- ~A.RTS | ||
| 28 | * 5 CTS -> ~B.CTS | ||
| 29 | * 6 6 DSR -> ~A.SYNC | ||
| 30 | * 8 CD -> ~B.DCD | ||
| 31 | * 12 DSRS(DCE) -> ~A.CTS (*) | ||
| 32 | * 15 TxC -> B.TxC | ||
| 33 | * 17 RxC -> B.RxC | ||
| 34 | * 20 1 DTR <- ~A.DTR | ||
| 35 | * 22 RI -> ~A.DCD | ||
| 36 | * 23 DSRS(DTE) <- ~B.RTS | ||
| 37 | * | ||
| 38 | * (*) EIA-232 defines the signal at this pin to be SCD, while DSRS(DCE) | ||
| 39 | * is shared with DSRS(DTE) at pin 23. | ||
| 40 | * | ||
| 41 | * As you can immediately notice the wiring of the RTS, DTR and DSR signals | ||
| 42 | * is a bit odd. This makes the handling of port B unnecessarily | ||
| 43 | * complicated and prevents the use of some automatic modes of operation. | ||
| 44 | */ | ||
| 45 | |||
| 46 | #if defined(CONFIG_SERIAL_ZS_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ) | ||
| 47 | #define SUPPORT_SYSRQ | ||
| 48 | #endif | ||
| 49 | |||
| 50 | #include <linux/bug.h> | ||
| 51 | #include <linux/console.h> | ||
| 52 | #include <linux/delay.h> | ||
| 53 | #include <linux/errno.h> | ||
| 54 | #include <linux/init.h> | ||
| 55 | #include <linux/interrupt.h> | ||
| 56 | #include <linux/io.h> | ||
| 57 | #include <linux/ioport.h> | ||
| 58 | #include <linux/irqflags.h> | ||
| 59 | #include <linux/kernel.h> | ||
| 60 | #include <linux/major.h> | ||
| 61 | #include <linux/serial.h> | ||
| 62 | #include <linux/serial_core.h> | ||
| 63 | #include <linux/spinlock.h> | ||
| 64 | #include <linux/sysrq.h> | ||
| 65 | #include <linux/tty.h> | ||
| 66 | #include <linux/types.h> | ||
| 67 | |||
| 68 | #include <asm/atomic.h> | ||
| 69 | #include <asm/system.h> | ||
| 70 | |||
| 71 | #include <asm/dec/interrupts.h> | ||
| 72 | #include <asm/dec/ioasic_addrs.h> | ||
| 73 | #include <asm/dec/system.h> | ||
| 74 | |||
| 75 | #include "zs.h" | ||
| 76 | |||
| 77 | |||
| 78 | MODULE_AUTHOR("Maciej W. Rozycki <macro@linux-mips.org>"); | ||
| 79 | MODULE_DESCRIPTION("DECstation Z85C30 serial driver"); | ||
| 80 | MODULE_LICENSE("GPL"); | ||
| 81 | |||
| 82 | |||
| 83 | static char zs_name[] __initdata = "DECstation Z85C30 serial driver version "; | ||
| 84 | static char zs_version[] __initdata = "0.10"; | ||
| 85 | |||
| 86 | /* | ||
| 87 | * It would be nice to dynamically allocate everything that | ||
| 88 | * depends on ZS_NUM_SCCS, so we could support any number of | ||
| 89 | * Z85C30s, but for now... | ||
| 90 | */ | ||
| 91 | #define ZS_NUM_SCCS 2 /* Max # of ZS chips supported. */ | ||
| 92 | #define ZS_NUM_CHAN 2 /* 2 channels per chip. */ | ||
| 93 | #define ZS_CHAN_A 0 /* Index of the channel A. */ | ||
| 94 | #define ZS_CHAN_B 1 /* Index of the channel B. */ | ||
| 95 | #define ZS_CHAN_IO_SIZE 8 /* IOMEM space size. */ | ||
| 96 | #define ZS_CHAN_IO_STRIDE 4 /* Register alignment. */ | ||
| 97 | #define ZS_CHAN_IO_OFFSET 1 /* The SCC resides on the high byte | ||
| 98 | of the 16-bit IOBUS. */ | ||
| 99 | #define ZS_CLOCK 7372800 /* Z85C30 PCLK input clock rate. */ | ||
| 100 | |||
| 101 | #define to_zport(uport) container_of(uport, struct zs_port, port) | ||
| 102 | |||
| 103 | struct zs_parms { | ||
| 104 | resource_size_t scc[ZS_NUM_SCCS]; | ||
| 105 | int irq[ZS_NUM_SCCS]; | ||
| 106 | }; | ||
| 107 | |||
| 108 | static struct zs_scc zs_sccs[ZS_NUM_SCCS]; | ||
| 109 | |||
| 110 | static u8 zs_init_regs[ZS_NUM_REGS] __initdata = { | ||
| 111 | 0, /* write 0 */ | ||
| 112 | PAR_SPEC, /* write 1 */ | ||
| 113 | 0, /* write 2 */ | ||
| 114 | 0, /* write 3 */ | ||
| 115 | X16CLK | SB1, /* write 4 */ | ||
| 116 | 0, /* write 5 */ | ||
| 117 | 0, 0, 0, /* write 6, 7, 8 */ | ||
| 118 | MIE | DLC | NV, /* write 9 */ | ||
| 119 | NRZ, /* write 10 */ | ||
| 120 | TCBR | RCBR, /* write 11 */ | ||
| 121 | 0, 0, /* BRG time constant, write 12 + 13 */ | ||
| 122 | BRSRC | BRENABL, /* write 14 */ | ||
| 123 | 0, /* write 15 */ | ||
| 124 | }; | ||
| 125 | |||
| 126 | /* | ||
| 127 | * Debugging. | ||
| 128 | */ | ||
| 129 | #undef ZS_DEBUG_REGS | ||
| 130 | |||
| 131 | |||
| 132 | /* | ||
| 133 | * Reading and writing Z85C30 registers. | ||
| 134 | */ | ||
| 135 | static void recovery_delay(void) | ||
| 136 | { | ||
| 137 | udelay(2); | ||
| 138 | } | ||
| 139 | |||
| 140 | static u8 read_zsreg(struct zs_port *zport, int reg) | ||
| 141 | { | ||
| 142 | void __iomem *control = zport->port.membase + ZS_CHAN_IO_OFFSET; | ||
| 143 | u8 retval; | ||
| 144 | |||
| 145 | if (reg != 0) { | ||
| 146 | writeb(reg & 0xf, control); | ||
| 147 | fast_iob(); | ||
| 148 | recovery_delay(); | ||
| 149 | } | ||
| 150 | retval = readb(control); | ||
| 151 | recovery_delay(); | ||
| 152 | return retval; | ||
| 153 | } | ||
| 154 | |||
| 155 | static void write_zsreg(struct zs_port *zport, int reg, u8 value) | ||
| 156 | { | ||
| 157 | void __iomem *control = zport->port.membase + ZS_CHAN_IO_OFFSET; | ||
| 158 | |||
| 159 | if (reg != 0) { | ||
| 160 | writeb(reg & 0xf, control); | ||
| 161 | fast_iob(); recovery_delay(); | ||
| 162 | } | ||
| 163 | writeb(value, control); | ||
| 164 | fast_iob(); | ||
| 165 | recovery_delay(); | ||
| 166 | return; | ||
| 167 | } | ||
| 168 | |||
| 169 | static u8 read_zsdata(struct zs_port *zport) | ||
| 170 | { | ||
| 171 | void __iomem *data = zport->port.membase + | ||
| 172 | ZS_CHAN_IO_STRIDE + ZS_CHAN_IO_OFFSET; | ||
| 173 | u8 retval; | ||
| 174 | |||
| 175 | retval = readb(data); | ||
| 176 | recovery_delay(); | ||
| 177 | return retval; | ||
| 178 | } | ||
| 179 | |||
| 180 | static void write_zsdata(struct zs_port *zport, u8 value) | ||
| 181 | { | ||
| 182 | void __iomem *data = zport->port.membase + | ||
| 183 | ZS_CHAN_IO_STRIDE + ZS_CHAN_IO_OFFSET; | ||
| 184 | |||
| 185 | writeb(value, data); | ||
| 186 | fast_iob(); | ||
| 187 | recovery_delay(); | ||
| 188 | return; | ||
| 189 | } | ||
| 190 | |||
| 191 | #ifdef ZS_DEBUG_REGS | ||
| 192 | void zs_dump(void) | ||
| 193 | { | ||
| 194 | struct zs_port *zport; | ||
| 195 | int i, j; | ||
| 196 | |||
| 197 | for (i = 0; i < ZS_NUM_SCCS * ZS_NUM_CHAN; i++) { | ||
| 198 | zport = &zs_sccs[i / ZS_NUM_CHAN].zport[i % ZS_NUM_CHAN]; | ||
| 199 | |||
| 200 | if (!zport->scc) | ||
| 201 | continue; | ||
| 202 | |||
| 203 | for (j = 0; j < 16; j++) | ||
| 204 | printk("W%-2d = 0x%02x\t", j, zport->regs[j]); | ||
| 205 | printk("\n"); | ||
| 206 | for (j = 0; j < 16; j++) | ||
| 207 | printk("R%-2d = 0x%02x\t", j, read_zsreg(zport, j)); | ||
| 208 | printk("\n\n"); | ||
| 209 | } | ||
| 210 | } | ||
| 211 | #endif | ||
| 212 | |||
| 213 | |||
| 214 | static void zs_spin_lock_cond_irq(spinlock_t *lock, int irq) | ||
| 215 | { | ||
| 216 | if (irq) | ||
| 217 | spin_lock_irq(lock); | ||
| 218 | else | ||
| 219 | spin_lock(lock); | ||
| 220 | } | ||
| 221 | |||
| 222 | static void zs_spin_unlock_cond_irq(spinlock_t *lock, int irq) | ||
| 223 | { | ||
| 224 | if (irq) | ||
| 225 | spin_unlock_irq(lock); | ||
| 226 | else | ||
| 227 | spin_unlock(lock); | ||
| 228 | } | ||
| 229 | |||
| 230 | static int zs_receive_drain(struct zs_port *zport) | ||
| 231 | { | ||
| 232 | int loops = 10000; | ||
| 233 | |||
| 234 | while ((read_zsreg(zport, R0) & Rx_CH_AV) && loops--) | ||
| 235 | read_zsdata(zport); | ||
| 236 | return loops; | ||
| 237 | } | ||
| 238 | |||
| 239 | static int zs_transmit_drain(struct zs_port *zport, int irq) | ||
| 240 | { | ||
| 241 | struct zs_scc *scc = zport->scc; | ||
| 242 | int loops = 10000; | ||
| 243 | |||
| 244 | while (!(read_zsreg(zport, R0) & Tx_BUF_EMP) && loops--) { | ||
| 245 | zs_spin_unlock_cond_irq(&scc->zlock, irq); | ||
| 246 | udelay(2); | ||
| 247 | zs_spin_lock_cond_irq(&scc->zlock, irq); | ||
| 248 | } | ||
| 249 | return loops; | ||
| 250 | } | ||
| 251 | |||
| 252 | static int zs_line_drain(struct zs_port *zport, int irq) | ||
| 253 | { | ||
| 254 | struct zs_scc *scc = zport->scc; | ||
| 255 | int loops = 10000; | ||
| 256 | |||
| 257 | while (!(read_zsreg(zport, R1) & ALL_SNT) && loops--) { | ||
| 258 | zs_spin_unlock_cond_irq(&scc->zlock, irq); | ||
| 259 | udelay(2); | ||
| 260 | zs_spin_lock_cond_irq(&scc->zlock, irq); | ||
| 261 | } | ||
| 262 | return loops; | ||
| 263 | } | ||
| 264 | |||
| 265 | |||
| 266 | static void load_zsregs(struct zs_port *zport, u8 *regs, int irq) | ||
| 267 | { | ||
| 268 | /* Let the current transmission finish. */ | ||
| 269 | zs_line_drain(zport, irq); | ||
| 270 | /* Load 'em up. */ | ||
| 271 | write_zsreg(zport, R3, regs[3] & ~RxENABLE); | ||
| 272 | write_zsreg(zport, R5, regs[5] & ~TxENAB); | ||
| 273 | write_zsreg(zport, R4, regs[4]); | ||
| 274 | write_zsreg(zport, R9, regs[9]); | ||
| 275 | write_zsreg(zport, R1, regs[1]); | ||
| 276 | write_zsreg(zport, R2, regs[2]); | ||
| 277 | write_zsreg(zport, R10, regs[10]); | ||
| 278 | write_zsreg(zport, R14, regs[14] & ~BRENABL); | ||
| 279 | write_zsreg(zport, R11, regs[11]); | ||
| 280 | write_zsreg(zport, R12, regs[12]); | ||
| 281 | write_zsreg(zport, R13, regs[13]); | ||
| 282 | write_zsreg(zport, R14, regs[14]); | ||
| 283 | write_zsreg(zport, R15, regs[15]); | ||
| 284 | if (regs[3] & RxENABLE) | ||
| 285 | write_zsreg(zport, R3, regs[3]); | ||
| 286 | if (regs[5] & TxENAB) | ||
| 287 | write_zsreg(zport, R5, regs[5]); | ||
| 288 | return; | ||
| 289 | } | ||
| 290 | |||
| 291 | |||
| 292 | /* | ||
| 293 | * Status handling routines. | ||
| 294 | */ | ||
| 295 | |||
| 296 | /* | ||
| 297 | * zs_tx_empty() -- get the transmitter empty status | ||
| 298 | * | ||
| 299 | * Purpose: Let user call ioctl() to get info when the UART physically | ||
| 300 | * is emptied. On bus types like RS485, the transmitter must | ||
| 301 | * release the bus after transmitting. This must be done when | ||
| 302 | * the transmit shift register is empty, not be done when the | ||
| 303 | * transmit holding register is empty. This functionality | ||
| 304 | * allows an RS485 driver to be written in user space. | ||
| 305 | */ | ||
| 306 | static unsigned int zs_tx_empty(struct uart_port *uport) | ||
| 307 | { | ||
| 308 | struct zs_port *zport = to_zport(uport); | ||
| 309 | struct zs_scc *scc = zport->scc; | ||
| 310 | unsigned long flags; | ||
| 311 | u8 status; | ||
| 312 | |||
| 313 | spin_lock_irqsave(&scc->zlock, flags); | ||
| 314 | status = read_zsreg(zport, R1); | ||
| 315 | spin_unlock_irqrestore(&scc->zlock, flags); | ||
| 316 | |||
| 317 | return status & ALL_SNT ? TIOCSER_TEMT : 0; | ||
| 318 | } | ||
| 319 | |||
| 320 | static unsigned int zs_raw_get_ab_mctrl(struct zs_port *zport_a, | ||
| 321 | struct zs_port *zport_b) | ||
| 322 | { | ||
| 323 | u8 status_a, status_b; | ||
| 324 | unsigned int mctrl; | ||
| 325 | |||
| 326 | status_a = read_zsreg(zport_a, R0); | ||
| 327 | status_b = read_zsreg(zport_b, R0); | ||
| 328 | |||
| 329 | mctrl = ((status_b & CTS) ? TIOCM_CTS : 0) | | ||
| 330 | ((status_b & DCD) ? TIOCM_CAR : 0) | | ||
| 331 | ((status_a & DCD) ? TIOCM_RNG : 0) | | ||
| 332 | ((status_a & SYNC_HUNT) ? TIOCM_DSR : 0); | ||
| 333 | |||
| 334 | return mctrl; | ||
| 335 | } | ||
| 336 | |||
| 337 | static unsigned int zs_raw_get_mctrl(struct zs_port *zport) | ||
| 338 | { | ||
| 339 | struct zs_port *zport_a = &zport->scc->zport[ZS_CHAN_A]; | ||
| 340 | |||
| 341 | return zport != zport_a ? zs_raw_get_ab_mctrl(zport_a, zport) : 0; | ||
| 342 | } | ||
| 343 | |||
| 344 | static unsigned int zs_raw_xor_mctrl(struct zs_port *zport) | ||
| 345 | { | ||
| 346 | struct zs_port *zport_a = &zport->scc->zport[ZS_CHAN_A]; | ||
| 347 | unsigned int mmask, mctrl, delta; | ||
| 348 | u8 mask_a, mask_b; | ||
| 349 | |||
| 350 | if (zport == zport_a) | ||
| 351 | return 0; | ||
| 352 | |||
| 353 | mask_a = zport_a->regs[15]; | ||
| 354 | mask_b = zport->regs[15]; | ||
| 355 | |||
| 356 | mmask = ((mask_b & CTSIE) ? TIOCM_CTS : 0) | | ||
| 357 | ((mask_b & DCDIE) ? TIOCM_CAR : 0) | | ||
| 358 | ((mask_a & DCDIE) ? TIOCM_RNG : 0) | | ||
| 359 | ((mask_a & SYNCIE) ? TIOCM_DSR : 0); | ||
| 360 | |||
| 361 | mctrl = zport->mctrl; | ||
| 362 | if (mmask) { | ||
| 363 | mctrl &= ~mmask; | ||
| 364 | mctrl |= zs_raw_get_ab_mctrl(zport_a, zport) & mmask; | ||
| 365 | } | ||
| 366 | |||
| 367 | delta = mctrl ^ zport->mctrl; | ||
| 368 | if (delta) | ||
| 369 | zport->mctrl = mctrl; | ||
| 370 | |||
| 371 | return delta; | ||
| 372 | } | ||
| 373 | |||
| 374 | static unsigned int zs_get_mctrl(struct uart_port *uport) | ||
| 375 | { | ||
| 376 | struct zs_port *zport = to_zport(uport); | ||
| 377 | struct zs_scc *scc = zport->scc; | ||
| 378 | unsigned int mctrl; | ||
| 379 | |||
| 380 | spin_lock(&scc->zlock); | ||
| 381 | mctrl = zs_raw_get_mctrl(zport); | ||
| 382 | spin_unlock(&scc->zlock); | ||
| 383 | |||
| 384 | return mctrl; | ||
| 385 | } | ||
| 386 | |||
| 387 | static void zs_set_mctrl(struct uart_port *uport, unsigned int mctrl) | ||
| 388 | { | ||
| 389 | struct zs_port *zport = to_zport(uport); | ||
| 390 | struct zs_scc *scc = zport->scc; | ||
| 391 | struct zs_port *zport_a = &scc->zport[ZS_CHAN_A]; | ||
| 392 | u8 oldloop, newloop; | ||
| 393 | |||
| 394 | spin_lock(&scc->zlock); | ||
| 395 | if (zport != zport_a) { | ||
| 396 | if (mctrl & TIOCM_DTR) | ||
| 397 | zport_a->regs[5] |= DTR; | ||
| 398 | else | ||
| 399 | zport_a->regs[5] &= ~DTR; | ||
| 400 | if (mctrl & TIOCM_RTS) | ||
| 401 | zport_a->regs[5] |= RTS; | ||
| 402 | else | ||
| 403 | zport_a->regs[5] &= ~RTS; | ||
| 404 | write_zsreg(zport_a, R5, zport_a->regs[5]); | ||
| 405 | } | ||
| 406 | |||
| 407 | /* Rarely modified, so don't poke at hardware unless necessary. */ | ||
| 408 | oldloop = zport->regs[14]; | ||
| 409 | newloop = oldloop; | ||
| 410 | if (mctrl & TIOCM_LOOP) | ||
| 411 | newloop |= LOOPBAK; | ||
| 412 | else | ||
| 413 | newloop &= ~LOOPBAK; | ||
| 414 | if (newloop != oldloop) { | ||
| 415 | zport->regs[14] = newloop; | ||
| 416 | write_zsreg(zport, R14, zport->regs[14]); | ||
| 417 | } | ||
| 418 | spin_unlock(&scc->zlock); | ||
| 419 | } | ||
| 420 | |||
| 421 | static void zs_raw_stop_tx(struct zs_port *zport) | ||
| 422 | { | ||
| 423 | write_zsreg(zport, R0, RES_Tx_P); | ||
| 424 | zport->tx_stopped = 1; | ||
| 425 | } | ||
| 426 | |||
| 427 | static void zs_stop_tx(struct uart_port *uport) | ||
| 428 | { | ||
| 429 | struct zs_port *zport = to_zport(uport); | ||
| 430 | struct zs_scc *scc = zport->scc; | ||
| 431 | |||
| 432 | spin_lock(&scc->zlock); | ||
| 433 | zs_raw_stop_tx(zport); | ||
| 434 | spin_unlock(&scc->zlock); | ||
| 435 | } | ||
| 436 | |||
| 437 | static void zs_raw_transmit_chars(struct zs_port *); | ||
| 438 | |||
| 439 | static void zs_start_tx(struct uart_port *uport) | ||
| 440 | { | ||
| 441 | struct zs_port *zport = to_zport(uport); | ||
| 442 | struct zs_scc *scc = zport->scc; | ||
| 443 | |||
| 444 | spin_lock(&scc->zlock); | ||
| 445 | if (zport->tx_stopped) { | ||
| 446 | zs_transmit_drain(zport, 0); | ||
| 447 | zport->tx_stopped = 0; | ||
| 448 | zs_raw_transmit_chars(zport); | ||
| 449 | } | ||
| 450 | spin_unlock(&scc->zlock); | ||
| 451 | } | ||
| 452 | |||
| 453 | static void zs_stop_rx(struct uart_port *uport) | ||
| 454 | { | ||
| 455 | struct zs_port *zport = to_zport(uport); | ||
| 456 | struct zs_scc *scc = zport->scc; | ||
| 457 | struct zs_port *zport_a = &scc->zport[ZS_CHAN_A]; | ||
| 458 | |||
| 459 | spin_lock(&scc->zlock); | ||
| 460 | zport->regs[15] &= ~BRKIE; | ||
| 461 | zport->regs[1] &= ~(RxINT_MASK | TxINT_ENAB); | ||
| 462 | zport->regs[1] |= RxINT_DISAB; | ||
| 463 | |||
| 464 | if (zport != zport_a) { | ||
| 465 | /* A-side DCD tracks RI and SYNC tracks DSR. */ | ||
| 466 | zport_a->regs[15] &= ~(DCDIE | SYNCIE); | ||
| 467 | write_zsreg(zport_a, R15, zport_a->regs[15]); | ||
| 468 | if (!(zport_a->regs[15] & BRKIE)) { | ||
| 469 | zport_a->regs[1] &= ~EXT_INT_ENAB; | ||
| 470 | write_zsreg(zport_a, R1, zport_a->regs[1]); | ||
| 471 | } | ||
| 472 | |||
| 473 | /* This-side DCD tracks DCD and CTS tracks CTS. */ | ||
| 474 | zport->regs[15] &= ~(DCDIE | CTSIE); | ||
| 475 | zport->regs[1] &= ~EXT_INT_ENAB; | ||
| 476 | } else { | ||
| 477 | /* DCD tracks RI and SYNC tracks DSR for the B side. */ | ||
| 478 | if (!(zport->regs[15] & (DCDIE | SYNCIE))) | ||
| 479 | zport->regs[1] &= ~EXT_INT_ENAB; | ||
| 480 | } | ||
| 481 | |||
| 482 | write_zsreg(zport, R15, zport->regs[15]); | ||
| 483 | write_zsreg(zport, R1, zport->regs[1]); | ||
| 484 | spin_unlock(&scc->zlock); | ||
| 485 | } | ||
| 486 | |||
| 487 | static void zs_enable_ms(struct uart_port *uport) | ||
| 488 | { | ||
| 489 | struct zs_port *zport = to_zport(uport); | ||
| 490 | struct zs_scc *scc = zport->scc; | ||
| 491 | struct zs_port *zport_a = &scc->zport[ZS_CHAN_A]; | ||
| 492 | |||
| 493 | if (zport == zport_a) | ||
| 494 | return; | ||
| 495 | |||
| 496 | spin_lock(&scc->zlock); | ||
| 497 | |||
| 498 | /* Clear Ext interrupts if not being handled already. */ | ||
| 499 | if (!(zport_a->regs[1] & EXT_INT_ENAB)) | ||
| 500 | write_zsreg(zport_a, R0, RES_EXT_INT); | ||
| 501 | |||
| 502 | /* A-side DCD tracks RI and SYNC tracks DSR. */ | ||
| 503 | zport_a->regs[1] |= EXT_INT_ENAB; | ||
| 504 | zport_a->regs[15] |= DCDIE | SYNCIE; | ||
| 505 | |||
| 506 | /* This-side DCD tracks DCD and CTS tracks CTS. */ | ||
| 507 | zport->regs[15] |= DCDIE | CTSIE; | ||
| 508 | |||
| 509 | zs_raw_xor_mctrl(zport); | ||
| 510 | |||
| 511 | write_zsreg(zport_a, R1, zport_a->regs[1]); | ||
| 512 | write_zsreg(zport_a, R15, zport_a->regs[15]); | ||
| 513 | write_zsreg(zport, R15, zport->regs[15]); | ||
| 514 | spin_unlock(&scc->zlock); | ||
| 515 | } | ||
| 516 | |||
| 517 | static void zs_break_ctl(struct uart_port *uport, int break_state) | ||
| 518 | { | ||
| 519 | struct zs_port *zport = to_zport(uport); | ||
| 520 | struct zs_scc *scc = zport->scc; | ||
| 521 | unsigned long flags; | ||
| 522 | |||
| 523 | spin_lock_irqsave(&scc->zlock, flags); | ||
| 524 | if (break_state == -1) | ||
| 525 | zport->regs[5] |= SND_BRK; | ||
| 526 | else | ||
| 527 | zport->regs[5] &= ~SND_BRK; | ||
| 528 | write_zsreg(zport, R5, zport->regs[5]); | ||
| 529 | spin_unlock_irqrestore(&scc->zlock, flags); | ||
| 530 | } | ||
| 531 | |||
| 532 | |||
| 533 | /* | ||
| 534 | * Interrupt handling routines. | ||
| 535 | */ | ||
| 536 | #define Rx_BRK 0x0100 /* BREAK event software flag. */ | ||
| 537 | #define Rx_SYS 0x0200 /* SysRq event software flag. */ | ||
| 538 | |||
| 539 | static void zs_receive_chars(struct zs_port *zport) | ||
| 540 | { | ||
| 541 | struct uart_port *uport = &zport->port; | ||
| 542 | struct zs_scc *scc = zport->scc; | ||
| 543 | struct uart_icount *icount; | ||
| 544 | unsigned int avail, status, ch, flag; | ||
| 545 | int count; | ||
| 546 | |||
| 547 | for (count = 16; count; count--) { | ||
| 548 | spin_lock(&scc->zlock); | ||
| 549 | avail = read_zsreg(zport, R0) & Rx_CH_AV; | ||
| 550 | spin_unlock(&scc->zlock); | ||
| 551 | if (!avail) | ||
| 552 | break; | ||
| 553 | |||
| 554 | spin_lock(&scc->zlock); | ||
| 555 | status = read_zsreg(zport, R1) & (Rx_OVR | FRM_ERR | PAR_ERR); | ||
| 556 | ch = read_zsdata(zport); | ||
| 557 | spin_unlock(&scc->zlock); | ||
| 558 | |||
| 559 | flag = TTY_NORMAL; | ||
| 560 | |||
| 561 | icount = &uport->icount; | ||
| 562 | icount->rx++; | ||
| 563 | |||
| 564 | /* Handle the null char got when BREAK is removed. */ | ||
| 565 | if (!ch) | ||
| 566 | status |= zport->tty_break; | ||
| 567 | if (unlikely(status & | ||
| 568 | (Rx_OVR | FRM_ERR | PAR_ERR | Rx_SYS | Rx_BRK))) { | ||
| 569 | zport->tty_break = 0; | ||
| 570 | |||
| 571 | /* Reset the error indication. */ | ||
| 572 | if (status & (Rx_OVR | FRM_ERR | PAR_ERR)) { | ||
| 573 | spin_lock(&scc->zlock); | ||
| 574 | write_zsreg(zport, R0, ERR_RES); | ||
| 575 | spin_unlock(&scc->zlock); | ||
| 576 | } | ||
| 577 | |||
| 578 | if (status & (Rx_SYS | Rx_BRK)) { | ||
| 579 | icount->brk++; | ||
| 580 | /* SysRq discards the null char. */ | ||
| 581 | if (status & Rx_SYS) | ||
| 582 | continue; | ||
| 583 | } else if (status & FRM_ERR) | ||
| 584 | icount->frame++; | ||
| 585 | else if (status & PAR_ERR) | ||
| 586 | icount->parity++; | ||
| 587 | if (status & Rx_OVR) | ||
| 588 | icount->overrun++; | ||
| 589 | |||
| 590 | status &= uport->read_status_mask; | ||
| 591 | if (status & Rx_BRK) | ||
| 592 | flag = TTY_BREAK; | ||
| 593 | else if (status & FRM_ERR) | ||
| 594 | flag = TTY_FRAME; | ||
| 595 | else if (status & PAR_ERR) | ||
| 596 | flag = TTY_PARITY; | ||
| 597 | } | ||
| 598 | |||
| 599 | if (uart_handle_sysrq_char(uport, ch)) | ||
| 600 | continue; | ||
| 601 | |||
| 602 | uart_insert_char(uport, status, Rx_OVR, ch, flag); | ||
| 603 | } | ||
| 604 | |||
| 605 | tty_flip_buffer_push(uport->info->tty); | ||
| 606 | } | ||
| 607 | |||
| 608 | static void zs_raw_transmit_chars(struct zs_port *zport) | ||
| 609 | { | ||
| 610 | struct circ_buf *xmit = &zport->port.info->xmit; | ||
| 611 | |||
| 612 | /* XON/XOFF chars. */ | ||
| 613 | if (zport->port.x_char) { | ||
| 614 | write_zsdata(zport, zport->port.x_char); | ||
| 615 | zport->port.icount.tx++; | ||
| 616 | zport->port.x_char = 0; | ||
| 617 | return; | ||
| 618 | } | ||
| 619 | |||
| 620 | /* If nothing to do or stopped or hardware stopped. */ | ||
| 621 | if (uart_circ_empty(xmit) || uart_tx_stopped(&zport->port)) { | ||
| 622 | zs_raw_stop_tx(zport); | ||
| 623 | return; | ||
| 624 | } | ||
| 625 | |||
| 626 | /* Send char. */ | ||
| 627 | write_zsdata(zport, xmit->buf[xmit->tail]); | ||
| 628 | xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1); | ||
| 629 | zport->port.icount.tx++; | ||
| 630 | |||
| 631 | if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) | ||
| 632 | uart_write_wakeup(&zport->port); | ||
| 633 | |||
| 634 | /* Are we are done? */ | ||
| 635 | if (uart_circ_empty(xmit)) | ||
| 636 | zs_raw_stop_tx(zport); | ||
| 637 | } | ||
| 638 | |||
| 639 | static void zs_transmit_chars(struct zs_port *zport) | ||
| 640 | { | ||
| 641 | struct zs_scc *scc = zport->scc; | ||
| 642 | |||
| 643 | spin_lock(&scc->zlock); | ||
| 644 | zs_raw_transmit_chars(zport); | ||
| 645 | spin_unlock(&scc->zlock); | ||
| 646 | } | ||
| 647 | |||
| 648 | static void zs_status_handle(struct zs_port *zport, struct zs_port *zport_a) | ||
| 649 | { | ||
| 650 | struct uart_port *uport = &zport->port; | ||
| 651 | struct zs_scc *scc = zport->scc; | ||
| 652 | unsigned int delta; | ||
| 653 | u8 status, brk; | ||
| 654 | |||
| 655 | spin_lock(&scc->zlock); | ||
| 656 | |||
| 657 | /* Get status from Read Register 0. */ | ||
| 658 | status = read_zsreg(zport, R0); | ||
| 659 | |||
| 660 | if (zport->regs[15] & BRKIE) { | ||
| 661 | brk = status & BRK_ABRT; | ||
| 662 | if (brk && !zport->brk) { | ||
| 663 | spin_unlock(&scc->zlock); | ||
| 664 | if (uart_handle_break(uport)) | ||
| 665 | zport->tty_break = Rx_SYS; | ||
| 666 | else | ||
| 667 | zport->tty_break = Rx_BRK; | ||
| 668 | spin_lock(&scc->zlock); | ||
| 669 | } | ||
| 670 | zport->brk = brk; | ||
| 671 | } | ||
| 672 | |||
| 673 | if (zport != zport_a) { | ||
| 674 | delta = zs_raw_xor_mctrl(zport); | ||
| 675 | spin_unlock(&scc->zlock); | ||
| 676 | |||
| 677 | if (delta & TIOCM_CTS) | ||
| 678 | uart_handle_cts_change(uport, | ||
| 679 | zport->mctrl & TIOCM_CTS); | ||
| 680 | if (delta & TIOCM_CAR) | ||
| 681 | uart_handle_dcd_change(uport, | ||
| 682 | zport->mctrl & TIOCM_CAR); | ||
| 683 | if (delta & TIOCM_RNG) | ||
| 684 | uport->icount.dsr++; | ||
| 685 | if (delta & TIOCM_DSR) | ||
| 686 | uport->icount.rng++; | ||
| 687 | |||
| 688 | if (delta) | ||
| 689 | wake_up_interruptible(&uport->info->delta_msr_wait); | ||
| 690 | |||
| 691 | spin_lock(&scc->zlock); | ||
| 692 | } | ||
| 693 | |||
| 694 | /* Clear the status condition... */ | ||
| 695 | write_zsreg(zport, R0, RES_EXT_INT); | ||
| 696 | |||
| 697 | spin_unlock(&scc->zlock); | ||
| 698 | } | ||
| 699 | |||
| 700 | /* | ||
| 701 | * This is the Z85C30 driver's generic interrupt routine. | ||
| 702 | */ | ||
| 703 | static irqreturn_t zs_interrupt(int irq, void *dev_id) | ||
| 704 | { | ||
| 705 | struct zs_scc *scc = dev_id; | ||
| 706 | struct zs_port *zport_a = &scc->zport[ZS_CHAN_A]; | ||
| 707 | struct zs_port *zport_b = &scc->zport[ZS_CHAN_B]; | ||
| 708 | irqreturn_t status = IRQ_NONE; | ||
| 709 | u8 zs_intreg; | ||
| 710 | int count; | ||
| 711 | |||
| 712 | /* | ||
| 713 | * NOTE: The read register 3, which holds the irq status, | ||
| 714 | * does so for both channels on each chip. Although | ||
| 715 | * the status value itself must be read from the A | ||
| 716 | * channel and is only valid when read from channel A. | ||
| 717 | * Yes... broken hardware... | ||
| 718 | */ | ||
| 719 | for (count = 16; count; count--) { | ||
| 720 | spin_lock(&scc->zlock); | ||
| 721 | zs_intreg = read_zsreg(zport_a, R3); | ||
| 722 | spin_unlock(&scc->zlock); | ||
| 723 | if (!zs_intreg) | ||
| 724 | break; | ||
| 725 | |||
| 726 | /* | ||
| 727 | * We do not like losing characters, so we prioritise | ||
| 728 | * interrupt sources a little bit differently than | ||
| 729 | * the SCC would, was it allowed to. | ||
| 730 | */ | ||
| 731 | if (zs_intreg & CHBRxIP) | ||
| 732 | zs_receive_chars(zport_b); | ||
| 733 | if (zs_intreg & CHARxIP) | ||
| 734 | zs_receive_chars(zport_a); | ||
| 735 | if (zs_intreg & CHBEXT) | ||
| 736 | zs_status_handle(zport_b, zport_a); | ||
| 737 | if (zs_intreg & CHAEXT) | ||
| 738 | zs_status_handle(zport_a, zport_a); | ||
| 739 | if (zs_intreg & CHBTxIP) | ||
| 740 | zs_transmit_chars(zport_b); | ||
| 741 | if (zs_intreg & CHATxIP) | ||
| 742 | zs_transmit_chars(zport_a); | ||
| 743 | |||
| 744 | status = IRQ_HANDLED; | ||
| 745 | } | ||
| 746 | |||
| 747 | return status; | ||
| 748 | } | ||
| 749 | |||
| 750 | |||
| 751 | /* | ||
| 752 | * Finally, routines used to initialize the serial port. | ||
| 753 | */ | ||
| 754 | static int zs_startup(struct uart_port *uport) | ||
| 755 | { | ||
| 756 | struct zs_port *zport = to_zport(uport); | ||
| 757 | struct zs_scc *scc = zport->scc; | ||
| 758 | unsigned long flags; | ||
| 759 | int irq_guard; | ||
| 760 | int ret; | ||
| 761 | |||
| 762 | irq_guard = atomic_add_return(1, &scc->irq_guard); | ||
| 763 | if (irq_guard == 1) { | ||
| 764 | ret = request_irq(zport->port.irq, zs_interrupt, | ||
| 765 | IRQF_SHARED, "scc", scc); | ||
| 766 | if (ret) { | ||
| 767 | atomic_add(-1, &scc->irq_guard); | ||
| 768 | printk(KERN_ERR "zs: can't get irq %d\n", | ||
| 769 | zport->port.irq); | ||
| 770 | return ret; | ||
| 771 | } | ||
| 772 | } | ||
| 773 | |||
| 774 | spin_lock_irqsave(&scc->zlock, flags); | ||
| 775 | |||
| 776 | /* Clear the receive FIFO. */ | ||
| 777 | zs_receive_drain(zport); | ||
| 778 | |||
| 779 | /* Clear the interrupt registers. */ | ||
| 780 | write_zsreg(zport, R0, ERR_RES); | ||
| 781 | write_zsreg(zport, R0, RES_Tx_P); | ||
| 782 | /* But Ext only if not being handled already. */ | ||
| 783 | if (!(zport->regs[1] & EXT_INT_ENAB)) | ||
| 784 | write_zsreg(zport, R0, RES_EXT_INT); | ||
| 785 | |||
| 786 | /* Finally, enable sequencing and interrupts. */ | ||
| 787 | zport->regs[1] &= ~RxINT_MASK; | ||
| 788 | zport->regs[1] |= RxINT_ALL | TxINT_ENAB | EXT_INT_ENAB; | ||
| 789 | zport->regs[3] |= RxENABLE; | ||
| 790 | zport->regs[5] |= TxENAB; | ||
| 791 | zport->regs[15] |= BRKIE; | ||
| 792 | write_zsreg(zport, R1, zport->regs[1]); | ||
| 793 | write_zsreg(zport, R3, zport->regs[3]); | ||
| 794 | write_zsreg(zport, R5, zport->regs[5]); | ||
| 795 | write_zsreg(zport, R15, zport->regs[15]); | ||
| 796 | |||
| 797 | /* Record the current state of RR0. */ | ||
| 798 | zport->mctrl = zs_raw_get_mctrl(zport); | ||
| 799 | zport->brk = read_zsreg(zport, R0) & BRK_ABRT; | ||
| 800 | |||
| 801 | zport->tx_stopped = 1; | ||
| 802 | |||
| 803 | spin_unlock_irqrestore(&scc->zlock, flags); | ||
| 804 | |||
| 805 | return 0; | ||
| 806 | } | ||
| 807 | |||
| 808 | static void zs_shutdown(struct uart_port *uport) | ||
| 809 | { | ||
| 810 | struct zs_port *zport = to_zport(uport); | ||
| 811 | struct zs_scc *scc = zport->scc; | ||
| 812 | unsigned long flags; | ||
| 813 | int irq_guard; | ||
| 814 | |||
| 815 | spin_lock_irqsave(&scc->zlock, flags); | ||
| 816 | |||
| 817 | zport->regs[5] &= ~TxENAB; | ||
| 818 | zport->regs[3] &= ~RxENABLE; | ||
| 819 | write_zsreg(zport, R5, zport->regs[5]); | ||
| 820 | write_zsreg(zport, R3, zport->regs[3]); | ||
| 821 | |||
| 822 | spin_unlock_irqrestore(&scc->zlock, flags); | ||
| 823 | |||
| 824 | irq_guard = atomic_add_return(-1, &scc->irq_guard); | ||
| 825 | if (!irq_guard) | ||
| 826 | free_irq(zport->port.irq, scc); | ||
| 827 | } | ||
| 828 | |||
| 829 | |||
| 830 | static void zs_reset(struct zs_port *zport) | ||
| 831 | { | ||
| 832 | struct zs_scc *scc = zport->scc; | ||
| 833 | int irq; | ||
| 834 | unsigned long flags; | ||
| 835 | |||
| 836 | spin_lock_irqsave(&scc->zlock, flags); | ||
| 837 | irq = !irqs_disabled_flags(flags); | ||
| 838 | if (!scc->initialised) { | ||
| 839 | /* Reset the pointer first, just in case... */ | ||
| 840 | read_zsreg(zport, R0); | ||
| 841 | /* And let the current transmission finish. */ | ||
| 842 | zs_line_drain(zport, irq); | ||
| 843 | write_zsreg(zport, R9, FHWRES); | ||
| 844 | udelay(10); | ||
| 845 | write_zsreg(zport, R9, 0); | ||
| 846 | scc->initialised = 1; | ||
| 847 | } | ||
| 848 | load_zsregs(zport, zport->regs, irq); | ||
| 849 | spin_unlock_irqrestore(&scc->zlock, flags); | ||
| 850 | } | ||
| 851 | |||
| 852 | static void zs_set_termios(struct uart_port *uport, struct ktermios *termios, | ||
| 853 | struct ktermios *old_termios) | ||
| 854 | { | ||
| 855 | struct zs_port *zport = to_zport(uport); | ||
| 856 | struct zs_scc *scc = zport->scc; | ||
| 857 | struct zs_port *zport_a = &scc->zport[ZS_CHAN_A]; | ||
| 858 | int irq; | ||
| 859 | unsigned int baud, brg; | ||
| 860 | unsigned long flags; | ||
| 861 | |||
| 862 | spin_lock_irqsave(&scc->zlock, flags); | ||
| 863 | irq = !irqs_disabled_flags(flags); | ||
| 864 | |||
| 865 | /* Byte size. */ | ||
| 866 | zport->regs[3] &= ~RxNBITS_MASK; | ||
| 867 | zport->regs[5] &= ~TxNBITS_MASK; | ||
| 868 | switch (termios->c_cflag & CSIZE) { | ||
| 869 | case CS5: | ||
| 870 | zport->regs[3] |= Rx5; | ||
| 871 | zport->regs[5] |= Tx5; | ||
| 872 | break; | ||
| 873 | case CS6: | ||
| 874 | zport->regs[3] |= Rx6; | ||
| 875 | zport->regs[5] |= Tx6; | ||
| 876 | break; | ||
| 877 | case CS7: | ||
| 878 | zport->regs[3] |= Rx7; | ||
| 879 | zport->regs[5] |= Tx7; | ||
| 880 | break; | ||
| 881 | case CS8: | ||
| 882 | default: | ||
| 883 | zport->regs[3] |= Rx8; | ||
| 884 | zport->regs[5] |= Tx8; | ||
| 885 | break; | ||
| 886 | } | ||
| 887 | |||
| 888 | /* Parity and stop bits. */ | ||
| 889 | zport->regs[4] &= ~(XCLK_MASK | SB_MASK | PAR_ENA | PAR_EVEN); | ||
| 890 | if (termios->c_cflag & CSTOPB) | ||
| 891 | zport->regs[4] |= SB2; | ||
| 892 | else | ||
| 893 | zport->regs[4] |= SB1; | ||
| 894 | if (termios->c_cflag & PARENB) | ||
| 895 | zport->regs[4] |= PAR_ENA; | ||
| 896 | if (!(termios->c_cflag & PARODD)) | ||
| 897 | zport->regs[4] |= PAR_EVEN; | ||
| 898 | switch (zport->clk_mode) { | ||
| 899 | case 64: | ||
| 900 | zport->regs[4] |= X64CLK; | ||
| 901 | break; | ||
| 902 | case 32: | ||
| 903 | zport->regs[4] |= X32CLK; | ||
| 904 | break; | ||
| 905 | case 16: | ||
| 906 | zport->regs[4] |= X16CLK; | ||
| 907 | break; | ||
| 908 | case 1: | ||
| 909 | zport->regs[4] |= X1CLK; | ||
| 910 | break; | ||
| 911 | default: | ||
| 912 | BUG(); | ||
| 913 | } | ||
| 914 | |||
| 915 | baud = uart_get_baud_rate(uport, termios, old_termios, 0, | ||
| 916 | uport->uartclk / zport->clk_mode / 4); | ||
| 917 | |||
| 918 | brg = ZS_BPS_TO_BRG(baud, uport->uartclk / zport->clk_mode); | ||
| 919 | zport->regs[12] = brg & 0xff; | ||
| 920 | zport->regs[13] = (brg >> 8) & 0xff; | ||
| 921 | |||
| 922 | uart_update_timeout(uport, termios->c_cflag, baud); | ||
| 923 | |||
| 924 | uport->read_status_mask = Rx_OVR; | ||
| 925 | if (termios->c_iflag & INPCK) | ||
| 926 | uport->read_status_mask |= FRM_ERR | PAR_ERR; | ||
| 927 | if (termios->c_iflag & (BRKINT | PARMRK)) | ||
| 928 | uport->read_status_mask |= Rx_BRK; | ||
| 929 | |||
| 930 | uport->ignore_status_mask = 0; | ||
| 931 | if (termios->c_iflag & IGNPAR) | ||
| 932 | uport->ignore_status_mask |= FRM_ERR | PAR_ERR; | ||
| 933 | if (termios->c_iflag & IGNBRK) { | ||
| 934 | uport->ignore_status_mask |= Rx_BRK; | ||
| 935 | if (termios->c_iflag & IGNPAR) | ||
| 936 | uport->ignore_status_mask |= Rx_OVR; | ||
| 937 | } | ||
| 938 | |||
| 939 | if (termios->c_cflag & CREAD) | ||
| 940 | zport->regs[3] |= RxENABLE; | ||
| 941 | else | ||
| 942 | zport->regs[3] &= ~RxENABLE; | ||
| 943 | |||
| 944 | if (zport != zport_a) { | ||
| 945 | if (!(termios->c_cflag & CLOCAL)) { | ||
| 946 | zport->regs[15] |= DCDIE; | ||
| 947 | } else | ||
| 948 | zport->regs[15] &= ~DCDIE; | ||
| 949 | if (termios->c_cflag & CRTSCTS) { | ||
| 950 | zport->regs[15] |= CTSIE; | ||
| 951 | } else | ||
| 952 | zport->regs[15] &= ~CTSIE; | ||
| 953 | zs_raw_xor_mctrl(zport); | ||
| 954 | } | ||
| 955 | |||
| 956 | /* Load up the new values. */ | ||
| 957 | load_zsregs(zport, zport->regs, irq); | ||
| 958 | |||
| 959 | spin_unlock_irqrestore(&scc->zlock, flags); | ||
| 960 | } | ||
| 961 | |||
| 962 | |||
| 963 | static const char *zs_type(struct uart_port *uport) | ||
| 964 | { | ||
| 965 | return "Z85C30 SCC"; | ||
| 966 | } | ||
| 967 | |||
| 968 | static void zs_release_port(struct uart_port *uport) | ||
| 969 | { | ||
| 970 | iounmap(uport->membase); | ||
| 971 | uport->membase = 0; | ||
| 972 | release_mem_region(uport->mapbase, ZS_CHAN_IO_SIZE); | ||
| 973 | } | ||
| 974 | |||
| 975 | static int zs_map_port(struct uart_port *uport) | ||
| 976 | { | ||
| 977 | if (!uport->membase) | ||
| 978 | uport->membase = ioremap_nocache(uport->mapbase, | ||
| 979 | ZS_CHAN_IO_SIZE); | ||
| 980 | if (!uport->membase) { | ||
| 981 | printk(KERN_ERR "zs: Cannot map MMIO\n"); | ||
| 982 | return -ENOMEM; | ||
| 983 | } | ||
| 984 | return 0; | ||
| 985 | } | ||
| 986 | |||
| 987 | static int zs_request_port(struct uart_port *uport) | ||
| 988 | { | ||
| 989 | int ret; | ||
| 990 | |||
| 991 | if (!request_mem_region(uport->mapbase, ZS_CHAN_IO_SIZE, "scc")) { | ||
| 992 | printk(KERN_ERR "zs: Unable to reserve MMIO resource\n"); | ||
| 993 | return -EBUSY; | ||
| 994 | } | ||
| 995 | ret = zs_map_port(uport); | ||
| 996 | if (ret) { | ||
| 997 | release_mem_region(uport->mapbase, ZS_CHAN_IO_SIZE); | ||
| 998 | return ret; | ||
| 999 | } | ||
| 1000 | return 0; | ||
| 1001 | } | ||
| 1002 | |||
| 1003 | static void zs_config_port(struct uart_port *uport, int flags) | ||
| 1004 | { | ||
| 1005 | struct zs_port *zport = to_zport(uport); | ||
| 1006 | |||
| 1007 | if (flags & UART_CONFIG_TYPE) { | ||
| 1008 | if (zs_request_port(uport)) | ||
| 1009 | return; | ||
| 1010 | |||
| 1011 | uport->type = PORT_ZS; | ||
| 1012 | |||
| 1013 | zs_reset(zport); | ||
| 1014 | } | ||
| 1015 | } | ||
| 1016 | |||
| 1017 | static int zs_verify_port(struct uart_port *uport, struct serial_struct *ser) | ||
| 1018 | { | ||
| 1019 | struct zs_port *zport = to_zport(uport); | ||
| 1020 | int ret = 0; | ||
| 1021 | |||
| 1022 | if (ser->type != PORT_UNKNOWN && ser->type != PORT_ZS) | ||
| 1023 | ret = -EINVAL; | ||
| 1024 | if (ser->irq != uport->irq) | ||
| 1025 | ret = -EINVAL; | ||
| 1026 | if (ser->baud_base != uport->uartclk / zport->clk_mode / 4) | ||
| 1027 | ret = -EINVAL; | ||
| 1028 | return ret; | ||
| 1029 | } | ||
| 1030 | |||
| 1031 | |||
| 1032 | static struct uart_ops zs_ops = { | ||
| 1033 | .tx_empty = zs_tx_empty, | ||
| 1034 | .set_mctrl = zs_set_mctrl, | ||
| 1035 | .get_mctrl = zs_get_mctrl, | ||
| 1036 | .stop_tx = zs_stop_tx, | ||
| 1037 | .start_tx = zs_start_tx, | ||
| 1038 | .stop_rx = zs_stop_rx, | ||
| 1039 | .enable_ms = zs_enable_ms, | ||
| 1040 | .break_ctl = zs_break_ctl, | ||
| 1041 | .startup = zs_startup, | ||
| 1042 | .shutdown = zs_shutdown, | ||
| 1043 | .set_termios = zs_set_termios, | ||
| 1044 | .type = zs_type, | ||
| 1045 | .release_port = zs_release_port, | ||
| 1046 | .request_port = zs_request_port, | ||
| 1047 | .config_port = zs_config_port, | ||
| 1048 | .verify_port = zs_verify_port, | ||
| 1049 | }; | ||
| 1050 | |||
| 1051 | /* | ||
| 1052 | * Initialize Z85C30 port structures. | ||
| 1053 | */ | ||
| 1054 | static int __init zs_probe_sccs(void) | ||
| 1055 | { | ||
| 1056 | static int probed; | ||
| 1057 | struct zs_parms zs_parms; | ||
| 1058 | int chip, side, irq; | ||
| 1059 | int n_chips = 0; | ||
| 1060 | int i; | ||
| 1061 | |||
| 1062 | if (probed) | ||
| 1063 | return 0; | ||
| 1064 | |||
| 1065 | irq = dec_interrupt[DEC_IRQ_SCC0]; | ||
| 1066 | if (irq >= 0) { | ||
| 1067 | zs_parms.scc[n_chips] = IOASIC_SCC0; | ||
| 1068 | zs_parms.irq[n_chips] = dec_interrupt[DEC_IRQ_SCC0]; | ||
| 1069 | n_chips++; | ||
| 1070 | } | ||
| 1071 | irq = dec_interrupt[DEC_IRQ_SCC1]; | ||
| 1072 | if (irq >= 0) { | ||
| 1073 | zs_parms.scc[n_chips] = IOASIC_SCC1; | ||
| 1074 | zs_parms.irq[n_chips] = dec_interrupt[DEC_IRQ_SCC1]; | ||
| 1075 | n_chips++; | ||
| 1076 | } | ||
| 1077 | if (!n_chips) | ||
| 1078 | return -ENXIO; | ||
| 1079 | |||
| 1080 | probed = 1; | ||
| 1081 | |||
| 1082 | for (chip = 0; chip < n_chips; chip++) { | ||
| 1083 | spin_lock_init(&zs_sccs[chip].zlock); | ||
| 1084 | for (side = 0; side < ZS_NUM_CHAN; side++) { | ||
| 1085 | struct zs_port *zport = &zs_sccs[chip].zport[side]; | ||
| 1086 | struct uart_port *uport = &zport->port; | ||
| 1087 | |||
| 1088 | zport->scc = &zs_sccs[chip]; | ||
| 1089 | zport->clk_mode = 16; | ||
| 1090 | |||
| 1091 | uport->irq = zs_parms.irq[chip]; | ||
| 1092 | uport->uartclk = ZS_CLOCK; | ||
| 1093 | uport->fifosize = 1; | ||
| 1094 | uport->iotype = UPIO_MEM; | ||
| 1095 | uport->flags = UPF_BOOT_AUTOCONF; | ||
| 1096 | uport->ops = &zs_ops; | ||
| 1097 | uport->line = chip * ZS_NUM_CHAN + side; | ||
| 1098 | uport->mapbase = dec_kn_slot_base + | ||
| 1099 | zs_parms.scc[chip] + | ||
| 1100 | (side ^ ZS_CHAN_B) * ZS_CHAN_IO_SIZE; | ||
| 1101 | |||
| 1102 | for (i = 0; i < ZS_NUM_REGS; i++) | ||
| 1103 | zport->regs[i] = zs_init_regs[i]; | ||
| 1104 | } | ||
| 1105 | } | ||
| 1106 | |||
| 1107 | return 0; | ||
| 1108 | } | ||
| 1109 | |||
| 1110 | |||
| 1111 | #ifdef CONFIG_SERIAL_ZS_CONSOLE | ||
| 1112 | static void zs_console_putchar(struct uart_port *uport, int ch) | ||
| 1113 | { | ||
| 1114 | struct zs_port *zport = to_zport(uport); | ||
| 1115 | struct zs_scc *scc = zport->scc; | ||
| 1116 | int irq; | ||
| 1117 | unsigned long flags; | ||
| 1118 | |||
| 1119 | spin_lock_irqsave(&scc->zlock, flags); | ||
| 1120 | irq = !irqs_disabled_flags(flags); | ||
| 1121 | if (zs_transmit_drain(zport, irq)) | ||
| 1122 | write_zsdata(zport, ch); | ||
| 1123 | spin_unlock_irqrestore(&scc->zlock, flags); | ||
| 1124 | } | ||
| 1125 | |||
| 1126 | /* | ||
| 1127 | * Print a string to the serial port trying not to disturb | ||
| 1128 | * any possible real use of the port... | ||
| 1129 | */ | ||
| 1130 | static void zs_console_write(struct console *co, const char *s, | ||
| 1131 | unsigned int count) | ||
| 1132 | { | ||
| 1133 | int chip = co->index / ZS_NUM_CHAN, side = co->index % ZS_NUM_CHAN; | ||
| 1134 | struct zs_port *zport = &zs_sccs[chip].zport[side]; | ||
| 1135 | struct zs_scc *scc = zport->scc; | ||
| 1136 | unsigned long flags; | ||
| 1137 | u8 txint, txenb; | ||
| 1138 | int irq; | ||
| 1139 | |||
| 1140 | /* Disable transmit interrupts and enable the transmitter. */ | ||
| 1141 | spin_lock_irqsave(&scc->zlock, flags); | ||
| 1142 | txint = zport->regs[1]; | ||
| 1143 | txenb = zport->regs[5]; | ||
| 1144 | if (txint & TxINT_ENAB) { | ||
| 1145 | zport->regs[1] = txint & ~TxINT_ENAB; | ||
| 1146 | write_zsreg(zport, R1, zport->regs[1]); | ||
| 1147 | } | ||
| 1148 | if (!(txenb & TxENAB)) { | ||
| 1149 | zport->regs[5] = txenb | TxENAB; | ||
| 1150 | write_zsreg(zport, R5, zport->regs[5]); | ||
| 1151 | } | ||
| 1152 | spin_unlock_irqrestore(&scc->zlock, flags); | ||
| 1153 | |||
| 1154 | uart_console_write(&zport->port, s, count, zs_console_putchar); | ||
| 1155 | |||
| 1156 | /* Restore transmit interrupts and the transmitter enable. */ | ||
| 1157 | spin_lock_irqsave(&scc->zlock, flags); | ||
| 1158 | irq = !irqs_disabled_flags(flags); | ||
| 1159 | zs_line_drain(zport, irq); | ||
| 1160 | if (!(txenb & TxENAB)) { | ||
| 1161 | zport->regs[5] &= ~TxENAB; | ||
| 1162 | write_zsreg(zport, R5, zport->regs[5]); | ||
| 1163 | } | ||
| 1164 | if (txint & TxINT_ENAB) { | ||
| 1165 | zport->regs[1] |= TxINT_ENAB; | ||
| 1166 | write_zsreg(zport, R1, zport->regs[1]); | ||
| 1167 | } | ||
| 1168 | spin_unlock_irqrestore(&scc->zlock, flags); | ||
| 1169 | } | ||
| 1170 | |||
| 1171 | /* | ||
| 1172 | * Setup serial console baud/bits/parity. We do two things here: | ||
| 1173 | * - construct a cflag setting for the first uart_open() | ||
| 1174 | * - initialise the serial port | ||
| 1175 | * Return non-zero if we didn't find a serial port. | ||
| 1176 | */ | ||
| 1177 | static int __init zs_console_setup(struct console *co, char *options) | ||
| 1178 | { | ||
| 1179 | int chip = co->index / ZS_NUM_CHAN, side = co->index % ZS_NUM_CHAN; | ||
| 1180 | struct zs_port *zport = &zs_sccs[chip].zport[side]; | ||
| 1181 | struct uart_port *uport = &zport->port; | ||
| 1182 | int baud = 9600; | ||
| 1183 | int bits = 8; | ||
| 1184 | int parity = 'n'; | ||
| 1185 | int flow = 'n'; | ||
| 1186 | int ret; | ||
| 1187 | |||
| 1188 | ret = zs_map_port(uport); | ||
| 1189 | if (ret) | ||
| 1190 | return ret; | ||
| 1191 | |||
| 1192 | zs_reset(zport); | ||
| 1193 | |||
| 1194 | if (options) | ||
| 1195 | uart_parse_options(options, &baud, &parity, &bits, &flow); | ||
| 1196 | return uart_set_options(uport, co, baud, parity, bits, flow); | ||
| 1197 | } | ||
| 1198 | |||
| 1199 | static struct uart_driver zs_reg; | ||
| 1200 | static struct console zs_console = { | ||
| 1201 | .name = "ttyS", | ||
| 1202 | .write = zs_console_write, | ||
| 1203 | .device = uart_console_device, | ||
| 1204 | .setup = zs_console_setup, | ||
| 1205 | .flags = CON_PRINTBUFFER, | ||
| 1206 | .index = -1, | ||
| 1207 | .data = &zs_reg, | ||
| 1208 | }; | ||
| 1209 | |||
| 1210 | /* | ||
| 1211 | * Register console. | ||
| 1212 | */ | ||
| 1213 | static int __init zs_serial_console_init(void) | ||
| 1214 | { | ||
| 1215 | int ret; | ||
| 1216 | |||
| 1217 | ret = zs_probe_sccs(); | ||
| 1218 | if (ret) | ||
| 1219 | return ret; | ||
| 1220 | register_console(&zs_console); | ||
| 1221 | |||
| 1222 | return 0; | ||
| 1223 | } | ||
| 1224 | |||
| 1225 | console_initcall(zs_serial_console_init); | ||
| 1226 | |||
| 1227 | #define SERIAL_ZS_CONSOLE &zs_console | ||
| 1228 | #else | ||
| 1229 | #define SERIAL_ZS_CONSOLE NULL | ||
| 1230 | #endif /* CONFIG_SERIAL_ZS_CONSOLE */ | ||
| 1231 | |||
| 1232 | static struct uart_driver zs_reg = { | ||
| 1233 | .owner = THIS_MODULE, | ||
| 1234 | .driver_name = "serial", | ||
| 1235 | .dev_name = "ttyS", | ||
| 1236 | .major = TTY_MAJOR, | ||
| 1237 | .minor = 64, | ||
| 1238 | .nr = ZS_NUM_SCCS * ZS_NUM_CHAN, | ||
| 1239 | .cons = SERIAL_ZS_CONSOLE, | ||
| 1240 | }; | ||
| 1241 | |||
| 1242 | /* zs_init inits the driver. */ | ||
| 1243 | static int __init zs_init(void) | ||
| 1244 | { | ||
| 1245 | int i, ret; | ||
| 1246 | |||
| 1247 | pr_info("%s%s\n", zs_name, zs_version); | ||
| 1248 | |||
| 1249 | /* Find out how many Z85C30 SCCs we have. */ | ||
| 1250 | ret = zs_probe_sccs(); | ||
| 1251 | if (ret) | ||
| 1252 | return ret; | ||
| 1253 | |||
| 1254 | ret = uart_register_driver(&zs_reg); | ||
| 1255 | if (ret) | ||
| 1256 | return ret; | ||
| 1257 | |||
| 1258 | for (i = 0; i < ZS_NUM_SCCS * ZS_NUM_CHAN; i++) { | ||
| 1259 | struct zs_scc *scc = &zs_sccs[i / ZS_NUM_CHAN]; | ||
| 1260 | struct zs_port *zport = &scc->zport[i % ZS_NUM_CHAN]; | ||
| 1261 | struct uart_port *uport = &zport->port; | ||
| 1262 | |||
| 1263 | if (zport->scc) | ||
| 1264 | uart_add_one_port(&zs_reg, uport); | ||
| 1265 | } | ||
| 1266 | |||
| 1267 | return 0; | ||
| 1268 | } | ||
| 1269 | |||
| 1270 | static void __exit zs_exit(void) | ||
| 1271 | { | ||
| 1272 | int i; | ||
| 1273 | |||
| 1274 | for (i = ZS_NUM_SCCS * ZS_NUM_CHAN - 1; i >= 0; i--) { | ||
| 1275 | struct zs_scc *scc = &zs_sccs[i / ZS_NUM_CHAN]; | ||
| 1276 | struct zs_port *zport = &scc->zport[i % ZS_NUM_CHAN]; | ||
| 1277 | struct uart_port *uport = &zport->port; | ||
| 1278 | |||
| 1279 | if (zport->scc) | ||
| 1280 | uart_remove_one_port(&zs_reg, uport); | ||
| 1281 | } | ||
| 1282 | |||
| 1283 | uart_unregister_driver(&zs_reg); | ||
| 1284 | } | ||
| 1285 | |||
| 1286 | module_init(zs_init); | ||
| 1287 | module_exit(zs_exit); | ||
