1 #undef BLOCKMOVE
2 #define Z_WAKE
3 #undef Z_EXT_CHARS_IN_BUFFER
4
5 /*
6 * This file contains the driver for the Cyclades async multiport
7 * serial boards.
8 *
9 * Initially written by Randolph Bentson <bentson@grieg.seaslug.org>.
10 * Modified and maintained by Marcio Saito <marcio@cyclades.com>.
11 *
12 * Copyright (C) 2007-2009 Jiri Slaby <jirislaby@gmail.com>
13 *
14 * Much of the design and some of the code came from serial.c
15 * which was copyright (C) 1991, 1992 Linus Torvalds. It was
16 * extensively rewritten by Theodore Ts'o, 8/16/92 -- 9/14/92,
17 * and then fixed as suggested by Michael K. Johnson 12/12/92.
18 * Converted to pci probing and cleaned up by Jiri Slaby.
19 *
20 */
21
22 #define CY_VERSION "2.6"
23
24 /* If you need to install more boards than NR_CARDS, change the constant
25 in the definition below. No other change is necessary to support up to
26 eight boards. Beyond that you'll have to extend cy_isa_addresses. */
27
28 #define NR_CARDS 4
29
30 /*
31 If the total number of ports is larger than NR_PORTS, change this
32 constant in the definition below. No other change is necessary to
33 support more boards/ports. */
34
35 #define NR_PORTS 256
36
37 #define ZO_V1 0
38 #define ZO_V2 1
39 #define ZE_V1 2
40
41 #define SERIAL_PARANOIA_CHECK
42 #undef CY_DEBUG_OPEN
43 #undef CY_DEBUG_THROTTLE
44 #undef CY_DEBUG_OTHER
45 #undef CY_DEBUG_IO
46 #undef CY_DEBUG_COUNT
47 #undef CY_DEBUG_DTR
48 #undef CY_DEBUG_INTERRUPTS
49 #undef CY_16Y_HACK
50 #undef CY_ENABLE_MONITORING
51 #undef CY_PCI_DEBUG
52
53 /*
54 * Include section
55 */
56 #include <linux/module.h>
57 #include <linux/errno.h>
58 #include <linux/signal.h>
59 #include <linux/sched.h>
60 #include <linux/timer.h>
61 #include <linux/interrupt.h>
62 #include <linux/tty.h>
63 #include <linux/tty_flip.h>
64 #include <linux/serial.h>
65 #include <linux/major.h>
66 #include <linux/string.h>
67 #include <linux/fcntl.h>
68 #include <linux/ptrace.h>
69 #include <linux/cyclades.h>
70 #include <linux/mm.h>
71 #include <linux/ioport.h>
72 #include <linux/init.h>
73 #include <linux/delay.h>
74 #include <linux/spinlock.h>
75 #include <linux/bitops.h>
76 #include <linux/firmware.h>
77 #include <linux/device.h>
78 #include <linux/slab.h>
79
80 #include <linux/io.h>
81 #include <linux/uaccess.h>
82
83 #include <linux/kernel.h>
84 #include <linux/pci.h>
85
86 #include <linux/stat.h>
87 #include <linux/proc_fs.h>
88 #include <linux/seq_file.h>
89
90 static void cy_send_xchar(struct tty_struct *tty, char ch);
91
92 #ifndef SERIAL_XMIT_SIZE
93 #define SERIAL_XMIT_SIZE (min(PAGE_SIZE, 4096))
94 #endif
95
96 #define STD_COM_FLAGS (0)
97
98 /* firmware stuff */
99 #define ZL_MAX_BLOCKS 16
100 #define DRIVER_VERSION 0x02010203
101 #define RAM_SIZE 0x80000
102
103 enum zblock_type {
104 ZBLOCK_PRG = 0,
105 ZBLOCK_FPGA = 1
106 };
107
108 struct zfile_header {
109 char name[64];
110 char date[32];
111 char aux[32];
112 u32 n_config;
113 u32 config_offset;
114 u32 n_blocks;
115 u32 block_offset;
116 u32 reserved[9];
117 } __attribute__ ((packed));
118
119 struct zfile_config {
120 char name[64];
121 u32 mailbox;
122 u32 function;
123 u32 n_blocks;
124 u32 block_list[ZL_MAX_BLOCKS];
125 } __attribute__ ((packed));
126
127 struct zfile_block {
128 u32 type;
129 u32 file_offset;
130 u32 ram_offset;
131 u32 size;
132 } __attribute__ ((packed));
133
134 static struct tty_driver *cy_serial_driver;
135
136 #ifdef CONFIG_ISA
137 /* This is the address lookup table. The driver will probe for
138 Cyclom-Y/ISA boards at all addresses in here. If you want the
139 driver to probe addresses at a different address, add it to
140 this table. If the driver is probing some other board and
141 causing problems, remove the offending address from this table.
142 */
143
144 static unsigned int cy_isa_addresses[] = {
145 0xD0000,
146 0xD2000,
147 0xD4000,
148 0xD6000,
149 0xD8000,
150 0xDA000,
151 0xDC000,
152 0xDE000,
153 0, 0, 0, 0, 0, 0, 0, 0
154 };
155
156 #define NR_ISA_ADDRS ARRAY_SIZE(cy_isa_addresses)
157
158 static long maddr[NR_CARDS];
159 static int irq[NR_CARDS];
160
161 module_param_array(maddr, long, NULL, 0);
162 module_param_array(irq, int, NULL, 0);
163
164 #endif /* CONFIG_ISA */
165
166 /* This is the per-card data structure containing address, irq, number of
167 channels, etc. This driver supports a maximum of NR_CARDS cards.
168 */
169 static struct cyclades_card cy_card[NR_CARDS];
170
171 static int cy_next_channel; /* next minor available */
172
173 /*
174 * This is used to look up the divisor speeds and the timeouts
175 * We're normally limited to 15 distinct baud rates. The extra
176 * are accessed via settings in info->port.flags.
177 * 0, 1, 2, 3, 4, 5, 6, 7, 8, 9,
178 * 10, 11, 12, 13, 14, 15, 16, 17, 18, 19,
179 * HI VHI
180 * 20
181 */
182 static const int baud_table[] = {
183 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200,
184 1800, 2400, 4800, 9600, 19200, 38400, 57600, 76800, 115200, 150000,
185 230400, 0
186 };
187
188 static const char baud_co_25[] = { /* 25 MHz clock option table */
189 /* value => 00 01 02 03 04 */
190 /* divide by 8 32 128 512 2048 */
191 0x00, 0x04, 0x04, 0x04, 0x04, 0x04, 0x03, 0x03, 0x03, 0x02,
192 0x02, 0x02, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
193 };
194
195 static const char baud_bpr_25[] = { /* 25 MHz baud rate period table */
196 0x00, 0xf5, 0xa3, 0x6f, 0x5c, 0x51, 0xf5, 0xa3, 0x51, 0xa3,
197 0x6d, 0x51, 0xa3, 0x51, 0xa3, 0x51, 0x36, 0x29, 0x1b, 0x15
198 };
199
200 static const char baud_co_60[] = { /* 60 MHz clock option table (CD1400 J) */
201 /* value => 00 01 02 03 04 */
202 /* divide by 8 32 128 512 2048 */
203 0x00, 0x00, 0x00, 0x04, 0x04, 0x04, 0x04, 0x04, 0x03, 0x03,
204 0x03, 0x02, 0x02, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
205 0x00
206 };
207
208 static const char baud_bpr_60[] = { /* 60 MHz baud rate period table (CD1400 J) */
209 0x00, 0x82, 0x21, 0xff, 0xdb, 0xc3, 0x92, 0x62, 0xc3, 0x62,
210 0x41, 0xc3, 0x62, 0xc3, 0x62, 0xc3, 0x82, 0x62, 0x41, 0x32,
211 0x21
212 };
213
214 static const char baud_cor3[] = { /* receive threshold */
215 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a,
216 0x0a, 0x0a, 0x0a, 0x09, 0x09, 0x08, 0x08, 0x08, 0x08, 0x07,
217 0x07
218 };
219
220 /*
221 * The Cyclades driver implements HW flow control as any serial driver.
222 * The cyclades_port structure member rflow and the vector rflow_thr
223 * allows us to take advantage of a special feature in the CD1400 to avoid
224 * data loss even when the system interrupt latency is too high. These flags
225 * are to be used only with very special applications. Setting these flags
226 * requires the use of a special cable (DTR and RTS reversed). In the new
227 * CD1400-based boards (rev. 6.00 or later), there is no need for special
228 * cables.
229 */
230
231 static const char rflow_thr[] = { /* rflow threshold */
232 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
233 0x00, 0x00, 0x00, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a,
234 0x0a
235 };
236
237 /* The Cyclom-Ye has placed the sequential chips in non-sequential
238 * address order. This look-up table overcomes that problem.
239 */
240 static const unsigned int cy_chip_offset[] = { 0x0000,
241 0x0400,
242 0x0800,
243 0x0C00,
244 0x0200,
245 0x0600,
246 0x0A00,
247 0x0E00
248 };
249
250 /* PCI related definitions */
251
252 #ifdef CONFIG_PCI
253 static const struct pci_device_id cy_pci_dev_id[] = {
254 /* PCI < 1Mb */
255 { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_Y_Lo) },
256 /* PCI > 1Mb */
257 { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_Y_Hi) },
258 /* 4Y PCI < 1Mb */
259 { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_4Y_Lo) },
260 /* 4Y PCI > 1Mb */
261 { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_4Y_Hi) },
262 /* 8Y PCI < 1Mb */
263 { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_8Y_Lo) },
264 /* 8Y PCI > 1Mb */
265 { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_8Y_Hi) },
266 /* Z PCI < 1Mb */
267 { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_Z_Lo) },
268 /* Z PCI > 1Mb */
269 { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_Z_Hi) },
270 { } /* end of table */
271 };
272 MODULE_DEVICE_TABLE(pci, cy_pci_dev_id);
273 #endif
274
275 static void cy_start(struct tty_struct *);
276 static void cy_set_line_char(struct cyclades_port *, struct tty_struct *);
277 static int cyz_issue_cmd(struct cyclades_card *, __u32, __u8, __u32);
278 #ifdef CONFIG_ISA
279 static unsigned detect_isa_irq(void __iomem *);
280 #endif /* CONFIG_ISA */
281
282 #ifndef CONFIG_CYZ_INTR
283 static void cyz_poll(unsigned long);
284
285 /* The Cyclades-Z polling cycle is defined by this variable */
286 static long cyz_polling_cycle = CZ_DEF_POLL;
287
288 static DEFINE_TIMER(cyz_timerlist, cyz_poll, 0, 0);
289
290 #else /* CONFIG_CYZ_INTR */
291 static void cyz_rx_restart(unsigned long);
292 static struct timer_list cyz_rx_full_timer[NR_PORTS];
293 #endif /* CONFIG_CYZ_INTR */
294
cyy_writeb(struct cyclades_port * port,u32 reg,u8 val)295 static inline void cyy_writeb(struct cyclades_port *port, u32 reg, u8 val)
296 {
297 struct cyclades_card *card = port->card;
298
299 cy_writeb(port->u.cyy.base_addr + (reg << card->bus_index), val);
300 }
301
cyy_readb(struct cyclades_port * port,u32 reg)302 static inline u8 cyy_readb(struct cyclades_port *port, u32 reg)
303 {
304 struct cyclades_card *card = port->card;
305
306 return readb(port->u.cyy.base_addr + (reg << card->bus_index));
307 }
308
cy_is_Z(struct cyclades_card * card)309 static inline bool cy_is_Z(struct cyclades_card *card)
310 {
311 return card->num_chips == (unsigned int)-1;
312 }
313
__cyz_fpga_loaded(struct RUNTIME_9060 __iomem * ctl_addr)314 static inline bool __cyz_fpga_loaded(struct RUNTIME_9060 __iomem *ctl_addr)
315 {
316 return readl(&ctl_addr->init_ctrl) & (1 << 17);
317 }
318
cyz_fpga_loaded(struct cyclades_card * card)319 static inline bool cyz_fpga_loaded(struct cyclades_card *card)
320 {
321 return __cyz_fpga_loaded(card->ctl_addr.p9060);
322 }
323
cyz_is_loaded(struct cyclades_card * card)324 static inline bool cyz_is_loaded(struct cyclades_card *card)
325 {
326 struct FIRM_ID __iomem *fw_id = card->base_addr + ID_ADDRESS;
327
328 return (card->hw_ver == ZO_V1 || cyz_fpga_loaded(card)) &&
329 readl(&fw_id->signature) == ZFIRM_ID;
330 }
331
serial_paranoia_check(struct cyclades_port * info,const char * name,const char * routine)332 static inline int serial_paranoia_check(struct cyclades_port *info,
333 const char *name, const char *routine)
334 {
335 #ifdef SERIAL_PARANOIA_CHECK
336 if (!info) {
337 printk(KERN_WARNING "cyc Warning: null cyclades_port for (%s) "
338 "in %s\n", name, routine);
339 return 1;
340 }
341
342 if (info->magic != CYCLADES_MAGIC) {
343 printk(KERN_WARNING "cyc Warning: bad magic number for serial "
344 "struct (%s) in %s\n", name, routine);
345 return 1;
346 }
347 #endif
348 return 0;
349 }
350
351 /***********************************************************/
352 /********* Start of block of Cyclom-Y specific code ********/
353
354 /* This routine waits up to 1000 micro-seconds for the previous
355 command to the Cirrus chip to complete and then issues the
356 new command. An error is returned if the previous command
357 didn't finish within the time limit.
358
359 This function is only called from inside spinlock-protected code.
360 */
__cyy_issue_cmd(void __iomem * base_addr,u8 cmd,int index)361 static int __cyy_issue_cmd(void __iomem *base_addr, u8 cmd, int index)
362 {
363 void __iomem *ccr = base_addr + (CyCCR << index);
364 unsigned int i;
365
366 /* Check to see that the previous command has completed */
367 for (i = 0; i < 100; i++) {
368 if (readb(ccr) == 0)
369 break;
370 udelay(10L);
371 }
372 /* if the CCR never cleared, the previous command
373 didn't finish within the "reasonable time" */
374 if (i == 100)
375 return -1;
376
377 /* Issue the new command */
378 cy_writeb(ccr, cmd);
379
380 return 0;
381 }
382
cyy_issue_cmd(struct cyclades_port * port,u8 cmd)383 static inline int cyy_issue_cmd(struct cyclades_port *port, u8 cmd)
384 {
385 return __cyy_issue_cmd(port->u.cyy.base_addr, cmd,
386 port->card->bus_index);
387 }
388
389 #ifdef CONFIG_ISA
390 /* ISA interrupt detection code */
detect_isa_irq(void __iomem * address)391 static unsigned detect_isa_irq(void __iomem *address)
392 {
393 int irq;
394 unsigned long irqs, flags;
395 int save_xir, save_car;
396 int index = 0; /* IRQ probing is only for ISA */
397
398 /* forget possible initially masked and pending IRQ */
399 irq = probe_irq_off(probe_irq_on());
400
401 /* Clear interrupts on the board first */
402 cy_writeb(address + (Cy_ClrIntr << index), 0);
403 /* Cy_ClrIntr is 0x1800 */
404
405 irqs = probe_irq_on();
406 /* Wait ... */
407 msleep(5);
408
409 /* Enable the Tx interrupts on the CD1400 */
410 local_irq_save(flags);
411 cy_writeb(address + (CyCAR << index), 0);
412 __cyy_issue_cmd(address, CyCHAN_CTL | CyENB_XMTR, index);
413
414 cy_writeb(address + (CyCAR << index), 0);
415 cy_writeb(address + (CySRER << index),
416 readb(address + (CySRER << index)) | CyTxRdy);
417 local_irq_restore(flags);
418
419 /* Wait ... */
420 msleep(5);
421
422 /* Check which interrupt is in use */
423 irq = probe_irq_off(irqs);
424
425 /* Clean up */
426 save_xir = (u_char) readb(address + (CyTIR << index));
427 save_car = readb(address + (CyCAR << index));
428 cy_writeb(address + (CyCAR << index), (save_xir & 0x3));
429 cy_writeb(address + (CySRER << index),
430 readb(address + (CySRER << index)) & ~CyTxRdy);
431 cy_writeb(address + (CyTIR << index), (save_xir & 0x3f));
432 cy_writeb(address + (CyCAR << index), (save_car));
433 cy_writeb(address + (Cy_ClrIntr << index), 0);
434 /* Cy_ClrIntr is 0x1800 */
435
436 return (irq > 0) ? irq : 0;
437 }
438 #endif /* CONFIG_ISA */
439
cyy_chip_rx(struct cyclades_card * cinfo,int chip,void __iomem * base_addr)440 static void cyy_chip_rx(struct cyclades_card *cinfo, int chip,
441 void __iomem *base_addr)
442 {
443 struct cyclades_port *info;
444 struct tty_port *port;
445 int len, index = cinfo->bus_index;
446 u8 ivr, save_xir, channel, save_car, data, char_count;
447
448 #ifdef CY_DEBUG_INTERRUPTS
449 printk(KERN_DEBUG "cyy_interrupt: rcvd intr, chip %d\n", chip);
450 #endif
451 /* determine the channel & change to that context */
452 save_xir = readb(base_addr + (CyRIR << index));
453 channel = save_xir & CyIRChannel;
454 info = &cinfo->ports[channel + chip * 4];
455 port = &info->port;
456 save_car = cyy_readb(info, CyCAR);
457 cyy_writeb(info, CyCAR, save_xir);
458 ivr = cyy_readb(info, CyRIVR) & CyIVRMask;
459
460 /* there is an open port for this data */
461 if (ivr == CyIVRRxEx) { /* exception */
462 data = cyy_readb(info, CyRDSR);
463
464 /* For statistics only */
465 if (data & CyBREAK)
466 info->icount.brk++;
467 else if (data & CyFRAME)
468 info->icount.frame++;
469 else if (data & CyPARITY)
470 info->icount.parity++;
471 else if (data & CyOVERRUN)
472 info->icount.overrun++;
473
474 if (data & info->ignore_status_mask) {
475 info->icount.rx++;
476 return;
477 }
478 if (tty_buffer_request_room(port, 1)) {
479 if (data & info->read_status_mask) {
480 if (data & CyBREAK) {
481 tty_insert_flip_char(port,
482 cyy_readb(info, CyRDSR),
483 TTY_BREAK);
484 info->icount.rx++;
485 if (port->flags & ASYNC_SAK) {
486 struct tty_struct *tty =
487 tty_port_tty_get(port);
488 if (tty) {
489 do_SAK(tty);
490 tty_kref_put(tty);
491 }
492 }
493 } else if (data & CyFRAME) {
494 tty_insert_flip_char(port,
495 cyy_readb(info, CyRDSR),
496 TTY_FRAME);
497 info->icount.rx++;
498 info->idle_stats.frame_errs++;
499 } else if (data & CyPARITY) {
500 /* Pieces of seven... */
501 tty_insert_flip_char(port,
502 cyy_readb(info, CyRDSR),
503 TTY_PARITY);
504 info->icount.rx++;
505 info->idle_stats.parity_errs++;
506 } else if (data & CyOVERRUN) {
507 tty_insert_flip_char(port, 0,
508 TTY_OVERRUN);
509 info->icount.rx++;
510 /* If the flip buffer itself is
511 overflowing, we still lose
512 the next incoming character.
513 */
514 tty_insert_flip_char(port,
515 cyy_readb(info, CyRDSR),
516 TTY_FRAME);
517 info->icount.rx++;
518 info->idle_stats.overruns++;
519 /* These two conditions may imply */
520 /* a normal read should be done. */
521 /* } else if(data & CyTIMEOUT) { */
522 /* } else if(data & CySPECHAR) { */
523 } else {
524 tty_insert_flip_char(port, 0,
525 TTY_NORMAL);
526 info->icount.rx++;
527 }
528 } else {
529 tty_insert_flip_char(port, 0, TTY_NORMAL);
530 info->icount.rx++;
531 }
532 } else {
533 /* there was a software buffer overrun and nothing
534 * could be done about it!!! */
535 info->icount.buf_overrun++;
536 info->idle_stats.overruns++;
537 }
538 } else { /* normal character reception */
539 /* load # chars available from the chip */
540 char_count = cyy_readb(info, CyRDCR);
541
542 #ifdef CY_ENABLE_MONITORING
543 ++info->mon.int_count;
544 info->mon.char_count += char_count;
545 if (char_count > info->mon.char_max)
546 info->mon.char_max = char_count;
547 info->mon.char_last = char_count;
548 #endif
549 len = tty_buffer_request_room(port, char_count);
550 while (len--) {
551 data = cyy_readb(info, CyRDSR);
552 tty_insert_flip_char(port, data, TTY_NORMAL);
553 info->idle_stats.recv_bytes++;
554 info->icount.rx++;
555 #ifdef CY_16Y_HACK
556 udelay(10L);
557 #endif
558 }
559 info->idle_stats.recv_idle = jiffies;
560 }
561 tty_schedule_flip(port);
562
563 /* end of service */
564 cyy_writeb(info, CyRIR, save_xir & 0x3f);
565 cyy_writeb(info, CyCAR, save_car);
566 }
567
cyy_chip_tx(struct cyclades_card * cinfo,unsigned int chip,void __iomem * base_addr)568 static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip,
569 void __iomem *base_addr)
570 {
571 struct cyclades_port *info;
572 struct tty_struct *tty;
573 int char_count, index = cinfo->bus_index;
574 u8 save_xir, channel, save_car, outch;
575
576 /* Since we only get here when the transmit buffer
577 is empty, we know we can always stuff a dozen
578 characters. */
579 #ifdef CY_DEBUG_INTERRUPTS
580 printk(KERN_DEBUG "cyy_interrupt: xmit intr, chip %d\n", chip);
581 #endif
582
583 /* determine the channel & change to that context */
584 save_xir = readb(base_addr + (CyTIR << index));
585 channel = save_xir & CyIRChannel;
586 save_car = readb(base_addr + (CyCAR << index));
587 cy_writeb(base_addr + (CyCAR << index), save_xir);
588
589 info = &cinfo->ports[channel + chip * 4];
590 tty = tty_port_tty_get(&info->port);
591 if (tty == NULL) {
592 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) & ~CyTxRdy);
593 goto end;
594 }
595
596 /* load the on-chip space for outbound data */
597 char_count = info->xmit_fifo_size;
598
599 if (info->x_char) { /* send special char */
600 outch = info->x_char;
601 cyy_writeb(info, CyTDR, outch);
602 char_count--;
603 info->icount.tx++;
604 info->x_char = 0;
605 }
606
607 if (info->breakon || info->breakoff) {
608 if (info->breakon) {
609 cyy_writeb(info, CyTDR, 0);
610 cyy_writeb(info, CyTDR, 0x81);
611 info->breakon = 0;
612 char_count -= 2;
613 }
614 if (info->breakoff) {
615 cyy_writeb(info, CyTDR, 0);
616 cyy_writeb(info, CyTDR, 0x83);
617 info->breakoff = 0;
618 char_count -= 2;
619 }
620 }
621
622 while (char_count-- > 0) {
623 if (!info->xmit_cnt) {
624 if (cyy_readb(info, CySRER) & CyTxMpty) {
625 cyy_writeb(info, CySRER,
626 cyy_readb(info, CySRER) & ~CyTxMpty);
627 } else {
628 cyy_writeb(info, CySRER, CyTxMpty |
629 (cyy_readb(info, CySRER) & ~CyTxRdy));
630 }
631 goto done;
632 }
633 if (info->port.xmit_buf == NULL) {
634 cyy_writeb(info, CySRER,
635 cyy_readb(info, CySRER) & ~CyTxRdy);
636 goto done;
637 }
638 if (tty->stopped || tty->hw_stopped) {
639 cyy_writeb(info, CySRER,
640 cyy_readb(info, CySRER) & ~CyTxRdy);
641 goto done;
642 }
643 /* Because the Embedded Transmit Commands have been enabled,
644 * we must check to see if the escape character, NULL, is being
645 * sent. If it is, we must ensure that there is room for it to
646 * be doubled in the output stream. Therefore we no longer
647 * advance the pointer when the character is fetched, but
648 * rather wait until after the check for a NULL output
649 * character. This is necessary because there may not be room
650 * for the two chars needed to send a NULL.)
651 */
652 outch = info->port.xmit_buf[info->xmit_tail];
653 if (outch) {
654 info->xmit_cnt--;
655 info->xmit_tail = (info->xmit_tail + 1) &
656 (SERIAL_XMIT_SIZE - 1);
657 cyy_writeb(info, CyTDR, outch);
658 info->icount.tx++;
659 } else {
660 if (char_count > 1) {
661 info->xmit_cnt--;
662 info->xmit_tail = (info->xmit_tail + 1) &
663 (SERIAL_XMIT_SIZE - 1);
664 cyy_writeb(info, CyTDR, outch);
665 cyy_writeb(info, CyTDR, 0);
666 info->icount.tx++;
667 char_count--;
668 }
669 }
670 }
671
672 done:
673 tty_wakeup(tty);
674 tty_kref_put(tty);
675 end:
676 /* end of service */
677 cyy_writeb(info, CyTIR, save_xir & 0x3f);
678 cyy_writeb(info, CyCAR, save_car);
679 }
680
cyy_chip_modem(struct cyclades_card * cinfo,int chip,void __iomem * base_addr)681 static void cyy_chip_modem(struct cyclades_card *cinfo, int chip,
682 void __iomem *base_addr)
683 {
684 struct cyclades_port *info;
685 struct tty_struct *tty;
686 int index = cinfo->bus_index;
687 u8 save_xir, channel, save_car, mdm_change, mdm_status;
688
689 /* determine the channel & change to that context */
690 save_xir = readb(base_addr + (CyMIR << index));
691 channel = save_xir & CyIRChannel;
692 info = &cinfo->ports[channel + chip * 4];
693 save_car = cyy_readb(info, CyCAR);
694 cyy_writeb(info, CyCAR, save_xir);
695
696 mdm_change = cyy_readb(info, CyMISR);
697 mdm_status = cyy_readb(info, CyMSVR1);
698
699 tty = tty_port_tty_get(&info->port);
700 if (!tty)
701 goto end;
702
703 if (mdm_change & CyANY_DELTA) {
704 /* For statistics only */
705 if (mdm_change & CyDCD)
706 info->icount.dcd++;
707 if (mdm_change & CyCTS)
708 info->icount.cts++;
709 if (mdm_change & CyDSR)
710 info->icount.dsr++;
711 if (mdm_change & CyRI)
712 info->icount.rng++;
713
714 wake_up_interruptible(&info->port.delta_msr_wait);
715 }
716
717 if ((mdm_change & CyDCD) && (info->port.flags & ASYNC_CHECK_CD)) {
718 if (mdm_status & CyDCD)
719 wake_up_interruptible(&info->port.open_wait);
720 else
721 tty_hangup(tty);
722 }
723 if ((mdm_change & CyCTS) && tty_port_cts_enabled(&info->port)) {
724 if (tty->hw_stopped) {
725 if (mdm_status & CyCTS) {
726 /* cy_start isn't used
727 because... !!! */
728 tty->hw_stopped = 0;
729 cyy_writeb(info, CySRER,
730 cyy_readb(info, CySRER) | CyTxRdy);
731 tty_wakeup(tty);
732 }
733 } else {
734 if (!(mdm_status & CyCTS)) {
735 /* cy_stop isn't used
736 because ... !!! */
737 tty->hw_stopped = 1;
738 cyy_writeb(info, CySRER,
739 cyy_readb(info, CySRER) & ~CyTxRdy);
740 }
741 }
742 }
743 /* if (mdm_change & CyDSR) {
744 }
745 if (mdm_change & CyRI) {
746 }*/
747 tty_kref_put(tty);
748 end:
749 /* end of service */
750 cyy_writeb(info, CyMIR, save_xir & 0x3f);
751 cyy_writeb(info, CyCAR, save_car);
752 }
753
754 /* The real interrupt service routine is called
755 whenever the card wants its hand held--chars
756 received, out buffer empty, modem change, etc.
757 */
cyy_interrupt(int irq,void * dev_id)758 static irqreturn_t cyy_interrupt(int irq, void *dev_id)
759 {
760 int status;
761 struct cyclades_card *cinfo = dev_id;
762 void __iomem *base_addr, *card_base_addr;
763 unsigned int chip, too_many, had_work;
764 int index;
765
766 if (unlikely(cinfo == NULL)) {
767 #ifdef CY_DEBUG_INTERRUPTS
768 printk(KERN_DEBUG "cyy_interrupt: spurious interrupt %d\n",
769 irq);
770 #endif
771 return IRQ_NONE; /* spurious interrupt */
772 }
773
774 card_base_addr = cinfo->base_addr;
775 index = cinfo->bus_index;
776
777 /* card was not initialized yet (e.g. DEBUG_SHIRQ) */
778 if (unlikely(card_base_addr == NULL))
779 return IRQ_HANDLED;
780
781 /* This loop checks all chips in the card. Make a note whenever
782 _any_ chip had some work to do, as this is considered an
783 indication that there will be more to do. Only when no chip
784 has any work does this outermost loop exit.
785 */
786 do {
787 had_work = 0;
788 for (chip = 0; chip < cinfo->num_chips; chip++) {
789 base_addr = cinfo->base_addr +
790 (cy_chip_offset[chip] << index);
791 too_many = 0;
792 while ((status = readb(base_addr +
793 (CySVRR << index))) != 0x00) {
794 had_work++;
795 /* The purpose of the following test is to ensure that
796 no chip can monopolize the driver. This forces the
797 chips to be checked in a round-robin fashion (after
798 draining each of a bunch (1000) of characters).
799 */
800 if (1000 < too_many++)
801 break;
802 spin_lock(&cinfo->card_lock);
803 if (status & CySRReceive) /* rx intr */
804 cyy_chip_rx(cinfo, chip, base_addr);
805 if (status & CySRTransmit) /* tx intr */
806 cyy_chip_tx(cinfo, chip, base_addr);
807 if (status & CySRModem) /* modem intr */
808 cyy_chip_modem(cinfo, chip, base_addr);
809 spin_unlock(&cinfo->card_lock);
810 }
811 }
812 } while (had_work);
813
814 /* clear interrupts */
815 spin_lock(&cinfo->card_lock);
816 cy_writeb(card_base_addr + (Cy_ClrIntr << index), 0);
817 /* Cy_ClrIntr is 0x1800 */
818 spin_unlock(&cinfo->card_lock);
819 return IRQ_HANDLED;
820 } /* cyy_interrupt */
821
cyy_change_rts_dtr(struct cyclades_port * info,unsigned int set,unsigned int clear)822 static void cyy_change_rts_dtr(struct cyclades_port *info, unsigned int set,
823 unsigned int clear)
824 {
825 struct cyclades_card *card = info->card;
826 int channel = info->line - card->first_line;
827 u32 rts, dtr, msvrr, msvrd;
828
829 channel &= 0x03;
830
831 if (info->rtsdtr_inv) {
832 msvrr = CyMSVR2;
833 msvrd = CyMSVR1;
834 rts = CyDTR;
835 dtr = CyRTS;
836 } else {
837 msvrr = CyMSVR1;
838 msvrd = CyMSVR2;
839 rts = CyRTS;
840 dtr = CyDTR;
841 }
842 if (set & TIOCM_RTS) {
843 cyy_writeb(info, CyCAR, channel);
844 cyy_writeb(info, msvrr, rts);
845 }
846 if (clear & TIOCM_RTS) {
847 cyy_writeb(info, CyCAR, channel);
848 cyy_writeb(info, msvrr, ~rts);
849 }
850 if (set & TIOCM_DTR) {
851 cyy_writeb(info, CyCAR, channel);
852 cyy_writeb(info, msvrd, dtr);
853 #ifdef CY_DEBUG_DTR
854 printk(KERN_DEBUG "cyc:set_modem_info raising DTR\n");
855 printk(KERN_DEBUG " status: 0x%x, 0x%x\n",
856 cyy_readb(info, CyMSVR1),
857 cyy_readb(info, CyMSVR2));
858 #endif
859 }
860 if (clear & TIOCM_DTR) {
861 cyy_writeb(info, CyCAR, channel);
862 cyy_writeb(info, msvrd, ~dtr);
863 #ifdef CY_DEBUG_DTR
864 printk(KERN_DEBUG "cyc:set_modem_info dropping DTR\n");
865 printk(KERN_DEBUG " status: 0x%x, 0x%x\n",
866 cyy_readb(info, CyMSVR1),
867 cyy_readb(info, CyMSVR2));
868 #endif
869 }
870 }
871
872 /***********************************************************/
873 /********* End of block of Cyclom-Y specific code **********/
874 /******** Start of block of Cyclades-Z specific code *******/
875 /***********************************************************/
876
877 static int
cyz_fetch_msg(struct cyclades_card * cinfo,__u32 * channel,__u8 * cmd,__u32 * param)878 cyz_fetch_msg(struct cyclades_card *cinfo,
879 __u32 *channel, __u8 *cmd, __u32 *param)
880 {
881 struct BOARD_CTRL __iomem *board_ctrl = cinfo->board_ctrl;
882 unsigned long loc_doorbell;
883
884 loc_doorbell = readl(&cinfo->ctl_addr.p9060->loc_doorbell);
885 if (loc_doorbell) {
886 *cmd = (char)(0xff & loc_doorbell);
887 *channel = readl(&board_ctrl->fwcmd_channel);
888 *param = (__u32) readl(&board_ctrl->fwcmd_param);
889 cy_writel(&cinfo->ctl_addr.p9060->loc_doorbell, 0xffffffff);
890 return 1;
891 }
892 return 0;
893 } /* cyz_fetch_msg */
894
895 static int
cyz_issue_cmd(struct cyclades_card * cinfo,__u32 channel,__u8 cmd,__u32 param)896 cyz_issue_cmd(struct cyclades_card *cinfo,
897 __u32 channel, __u8 cmd, __u32 param)
898 {
899 struct BOARD_CTRL __iomem *board_ctrl = cinfo->board_ctrl;
900 __u32 __iomem *pci_doorbell;
901 unsigned int index;
902
903 if (!cyz_is_loaded(cinfo))
904 return -1;
905
906 index = 0;
907 pci_doorbell = &cinfo->ctl_addr.p9060->pci_doorbell;
908 while ((readl(pci_doorbell) & 0xff) != 0) {
909 if (index++ == 1000)
910 return (int)(readl(pci_doorbell) & 0xff);
911 udelay(50L);
912 }
913 cy_writel(&board_ctrl->hcmd_channel, channel);
914 cy_writel(&board_ctrl->hcmd_param, param);
915 cy_writel(pci_doorbell, (long)cmd);
916
917 return 0;
918 } /* cyz_issue_cmd */
919
cyz_handle_rx(struct cyclades_port * info)920 static void cyz_handle_rx(struct cyclades_port *info)
921 {
922 struct BUF_CTRL __iomem *buf_ctrl = info->u.cyz.buf_ctrl;
923 struct cyclades_card *cinfo = info->card;
924 struct tty_port *port = &info->port;
925 unsigned int char_count;
926 int len;
927 #ifdef BLOCKMOVE
928 unsigned char *buf;
929 #else
930 char data;
931 #endif
932 __u32 rx_put, rx_get, new_rx_get, rx_bufsize, rx_bufaddr;
933
934 rx_get = new_rx_get = readl(&buf_ctrl->rx_get);
935 rx_put = readl(&buf_ctrl->rx_put);
936 rx_bufsize = readl(&buf_ctrl->rx_bufsize);
937 rx_bufaddr = readl(&buf_ctrl->rx_bufaddr);
938 if (rx_put >= rx_get)
939 char_count = rx_put - rx_get;
940 else
941 char_count = rx_put - rx_get + rx_bufsize;
942
943 if (!char_count)
944 return;
945
946 #ifdef CY_ENABLE_MONITORING
947 info->mon.int_count++;
948 info->mon.char_count += char_count;
949 if (char_count > info->mon.char_max)
950 info->mon.char_max = char_count;
951 info->mon.char_last = char_count;
952 #endif
953
954 #ifdef BLOCKMOVE
955 /* we'd like to use memcpy(t, f, n) and memset(s, c, count)
956 for performance, but because of buffer boundaries, there
957 may be several steps to the operation */
958 while (1) {
959 len = tty_prepare_flip_string(port, &buf,
960 char_count);
961 if (!len)
962 break;
963
964 len = min_t(unsigned int, min(len, char_count),
965 rx_bufsize - new_rx_get);
966
967 memcpy_fromio(buf, cinfo->base_addr +
968 rx_bufaddr + new_rx_get, len);
969
970 new_rx_get = (new_rx_get + len) &
971 (rx_bufsize - 1);
972 char_count -= len;
973 info->icount.rx += len;
974 info->idle_stats.recv_bytes += len;
975 }
976 #else
977 len = tty_buffer_request_room(port, char_count);
978 while (len--) {
979 data = readb(cinfo->base_addr + rx_bufaddr +
980 new_rx_get);
981 new_rx_get = (new_rx_get + 1) &
982 (rx_bufsize - 1);
983 tty_insert_flip_char(port, data, TTY_NORMAL);
984 info->idle_stats.recv_bytes++;
985 info->icount.rx++;
986 }
987 #endif
988 #ifdef CONFIG_CYZ_INTR
989 /* Recalculate the number of chars in the RX buffer and issue
990 a cmd in case it's higher than the RX high water mark */
991 rx_put = readl(&buf_ctrl->rx_put);
992 if (rx_put >= rx_get)
993 char_count = rx_put - rx_get;
994 else
995 char_count = rx_put - rx_get + rx_bufsize;
996 if (char_count >= readl(&buf_ctrl->rx_threshold) &&
997 !timer_pending(&cyz_rx_full_timer[
998 info->line]))
999 mod_timer(&cyz_rx_full_timer[info->line],
1000 jiffies + 1);
1001 #endif
1002 info->idle_stats.recv_idle = jiffies;
1003 tty_schedule_flip(&info->port);
1004
1005 /* Update rx_get */
1006 cy_writel(&buf_ctrl->rx_get, new_rx_get);
1007 }
1008
cyz_handle_tx(struct cyclades_port * info)1009 static void cyz_handle_tx(struct cyclades_port *info)
1010 {
1011 struct BUF_CTRL __iomem *buf_ctrl = info->u.cyz.buf_ctrl;
1012 struct cyclades_card *cinfo = info->card;
1013 struct tty_struct *tty;
1014 u8 data;
1015 unsigned int char_count;
1016 #ifdef BLOCKMOVE
1017 int small_count;
1018 #endif
1019 __u32 tx_put, tx_get, tx_bufsize, tx_bufaddr;
1020
1021 if (info->xmit_cnt <= 0) /* Nothing to transmit */
1022 return;
1023
1024 tx_get = readl(&buf_ctrl->tx_get);
1025 tx_put = readl(&buf_ctrl->tx_put);
1026 tx_bufsize = readl(&buf_ctrl->tx_bufsize);
1027 tx_bufaddr = readl(&buf_ctrl->tx_bufaddr);
1028 if (tx_put >= tx_get)
1029 char_count = tx_get - tx_put - 1 + tx_bufsize;
1030 else
1031 char_count = tx_get - tx_put - 1;
1032
1033 if (!char_count)
1034 return;
1035
1036 tty = tty_port_tty_get(&info->port);
1037 if (tty == NULL)
1038 goto ztxdone;
1039
1040 if (info->x_char) { /* send special char */
1041 data = info->x_char;
1042
1043 cy_writeb(cinfo->base_addr + tx_bufaddr + tx_put, data);
1044 tx_put = (tx_put + 1) & (tx_bufsize - 1);
1045 info->x_char = 0;
1046 char_count--;
1047 info->icount.tx++;
1048 }
1049 #ifdef BLOCKMOVE
1050 while (0 < (small_count = min_t(unsigned int,
1051 tx_bufsize - tx_put, min_t(unsigned int,
1052 (SERIAL_XMIT_SIZE - info->xmit_tail),
1053 min_t(unsigned int, info->xmit_cnt,
1054 char_count))))) {
1055
1056 memcpy_toio((char *)(cinfo->base_addr + tx_bufaddr + tx_put),
1057 &info->port.xmit_buf[info->xmit_tail],
1058 small_count);
1059
1060 tx_put = (tx_put + small_count) & (tx_bufsize - 1);
1061 char_count -= small_count;
1062 info->icount.tx += small_count;
1063 info->xmit_cnt -= small_count;
1064 info->xmit_tail = (info->xmit_tail + small_count) &
1065 (SERIAL_XMIT_SIZE - 1);
1066 }
1067 #else
1068 while (info->xmit_cnt && char_count) {
1069 data = info->port.xmit_buf[info->xmit_tail];
1070 info->xmit_cnt--;
1071 info->xmit_tail = (info->xmit_tail + 1) &
1072 (SERIAL_XMIT_SIZE - 1);
1073
1074 cy_writeb(cinfo->base_addr + tx_bufaddr + tx_put, data);
1075 tx_put = (tx_put + 1) & (tx_bufsize - 1);
1076 char_count--;
1077 info->icount.tx++;
1078 }
1079 #endif
1080 tty_wakeup(tty);
1081 tty_kref_put(tty);
1082 ztxdone:
1083 /* Update tx_put */
1084 cy_writel(&buf_ctrl->tx_put, tx_put);
1085 }
1086
cyz_handle_cmd(struct cyclades_card * cinfo)1087 static void cyz_handle_cmd(struct cyclades_card *cinfo)
1088 {
1089 struct BOARD_CTRL __iomem *board_ctrl = cinfo->board_ctrl;
1090 struct cyclades_port *info;
1091 __u32 channel, param, fw_ver;
1092 __u8 cmd;
1093 int special_count;
1094 int delta_count;
1095
1096 fw_ver = readl(&board_ctrl->fw_version);
1097
1098 while (cyz_fetch_msg(cinfo, &channel, &cmd, ¶m) == 1) {
1099 special_count = 0;
1100 delta_count = 0;
1101 info = &cinfo->ports[channel];
1102
1103 switch (cmd) {
1104 case C_CM_PR_ERROR:
1105 tty_insert_flip_char(&info->port, 0, TTY_PARITY);
1106 info->icount.rx++;
1107 special_count++;
1108 break;
1109 case C_CM_FR_ERROR:
1110 tty_insert_flip_char(&info->port, 0, TTY_FRAME);
1111 info->icount.rx++;
1112 special_count++;
1113 break;
1114 case C_CM_RXBRK:
1115 tty_insert_flip_char(&info->port, 0, TTY_BREAK);
1116 info->icount.rx++;
1117 special_count++;
1118 break;
1119 case C_CM_MDCD:
1120 info->icount.dcd++;
1121 delta_count++;
1122 if (info->port.flags & ASYNC_CHECK_CD) {
1123 u32 dcd = fw_ver > 241 ? param :
1124 readl(&info->u.cyz.ch_ctrl->rs_status);
1125 if (dcd & C_RS_DCD)
1126 wake_up_interruptible(&info->port.open_wait);
1127 else
1128 tty_port_tty_hangup(&info->port, false);
1129 }
1130 break;
1131 case C_CM_MCTS:
1132 info->icount.cts++;
1133 delta_count++;
1134 break;
1135 case C_CM_MRI:
1136 info->icount.rng++;
1137 delta_count++;
1138 break;
1139 case C_CM_MDSR:
1140 info->icount.dsr++;
1141 delta_count++;
1142 break;
1143 #ifdef Z_WAKE
1144 case C_CM_IOCTLW:
1145 complete(&info->shutdown_wait);
1146 break;
1147 #endif
1148 #ifdef CONFIG_CYZ_INTR
1149 case C_CM_RXHIWM:
1150 case C_CM_RXNNDT:
1151 case C_CM_INTBACK2:
1152 /* Reception Interrupt */
1153 #ifdef CY_DEBUG_INTERRUPTS
1154 printk(KERN_DEBUG "cyz_interrupt: rcvd intr, card %d, "
1155 "port %ld\n", info->card, channel);
1156 #endif
1157 cyz_handle_rx(info);
1158 break;
1159 case C_CM_TXBEMPTY:
1160 case C_CM_TXLOWWM:
1161 case C_CM_INTBACK:
1162 /* Transmission Interrupt */
1163 #ifdef CY_DEBUG_INTERRUPTS
1164 printk(KERN_DEBUG "cyz_interrupt: xmit intr, card %d, "
1165 "port %ld\n", info->card, channel);
1166 #endif
1167 cyz_handle_tx(info);
1168 break;
1169 #endif /* CONFIG_CYZ_INTR */
1170 case C_CM_FATAL:
1171 /* should do something with this !!! */
1172 break;
1173 default:
1174 break;
1175 }
1176 if (delta_count)
1177 wake_up_interruptible(&info->port.delta_msr_wait);
1178 if (special_count)
1179 tty_schedule_flip(&info->port);
1180 }
1181 }
1182
1183 #ifdef CONFIG_CYZ_INTR
cyz_interrupt(int irq,void * dev_id)1184 static irqreturn_t cyz_interrupt(int irq, void *dev_id)
1185 {
1186 struct cyclades_card *cinfo = dev_id;
1187
1188 if (unlikely(!cyz_is_loaded(cinfo))) {
1189 #ifdef CY_DEBUG_INTERRUPTS
1190 printk(KERN_DEBUG "cyz_interrupt: board not yet loaded "
1191 "(IRQ%d).\n", irq);
1192 #endif
1193 return IRQ_NONE;
1194 }
1195
1196 /* Handle the interrupts */
1197 cyz_handle_cmd(cinfo);
1198
1199 return IRQ_HANDLED;
1200 } /* cyz_interrupt */
1201
cyz_rx_restart(unsigned long arg)1202 static void cyz_rx_restart(unsigned long arg)
1203 {
1204 struct cyclades_port *info = (struct cyclades_port *)arg;
1205 struct cyclades_card *card = info->card;
1206 int retval;
1207 __u32 channel = info->line - card->first_line;
1208 unsigned long flags;
1209
1210 spin_lock_irqsave(&card->card_lock, flags);
1211 retval = cyz_issue_cmd(card, channel, C_CM_INTBACK2, 0L);
1212 if (retval != 0) {
1213 printk(KERN_ERR "cyc:cyz_rx_restart retval on ttyC%d was %x\n",
1214 info->line, retval);
1215 }
1216 spin_unlock_irqrestore(&card->card_lock, flags);
1217 }
1218
1219 #else /* CONFIG_CYZ_INTR */
1220
cyz_poll(unsigned long arg)1221 static void cyz_poll(unsigned long arg)
1222 {
1223 struct cyclades_card *cinfo;
1224 struct cyclades_port *info;
1225 unsigned long expires = jiffies + HZ;
1226 unsigned int port, card;
1227
1228 for (card = 0; card < NR_CARDS; card++) {
1229 cinfo = &cy_card[card];
1230
1231 if (!cy_is_Z(cinfo))
1232 continue;
1233 if (!cyz_is_loaded(cinfo))
1234 continue;
1235
1236 /* Skip first polling cycle to avoid racing conditions with the FW */
1237 if (!cinfo->intr_enabled) {
1238 cinfo->intr_enabled = 1;
1239 continue;
1240 }
1241
1242 cyz_handle_cmd(cinfo);
1243
1244 for (port = 0; port < cinfo->nports; port++) {
1245 info = &cinfo->ports[port];
1246
1247 if (!info->throttle)
1248 cyz_handle_rx(info);
1249 cyz_handle_tx(info);
1250 }
1251 /* poll every 'cyz_polling_cycle' period */
1252 expires = jiffies + cyz_polling_cycle;
1253 }
1254 mod_timer(&cyz_timerlist, expires);
1255 } /* cyz_poll */
1256
1257 #endif /* CONFIG_CYZ_INTR */
1258
1259 /********** End of block of Cyclades-Z specific code *********/
1260 /***********************************************************/
1261
1262 /* This is called whenever a port becomes active;
1263 interrupts are enabled and DTR & RTS are turned on.
1264 */
cy_startup(struct cyclades_port * info,struct tty_struct * tty)1265 static int cy_startup(struct cyclades_port *info, struct tty_struct *tty)
1266 {
1267 struct cyclades_card *card;
1268 unsigned long flags;
1269 int retval = 0;
1270 int channel;
1271 unsigned long page;
1272
1273 card = info->card;
1274 channel = info->line - card->first_line;
1275
1276 page = get_zeroed_page(GFP_KERNEL);
1277 if (!page)
1278 return -ENOMEM;
1279
1280 spin_lock_irqsave(&card->card_lock, flags);
1281
1282 if (info->port.flags & ASYNC_INITIALIZED)
1283 goto errout;
1284
1285 if (!info->type) {
1286 set_bit(TTY_IO_ERROR, &tty->flags);
1287 goto errout;
1288 }
1289
1290 if (info->port.xmit_buf)
1291 free_page(page);
1292 else
1293 info->port.xmit_buf = (unsigned char *)page;
1294
1295 spin_unlock_irqrestore(&card->card_lock, flags);
1296
1297 cy_set_line_char(info, tty);
1298
1299 if (!cy_is_Z(card)) {
1300 channel &= 0x03;
1301
1302 spin_lock_irqsave(&card->card_lock, flags);
1303
1304 cyy_writeb(info, CyCAR, channel);
1305
1306 cyy_writeb(info, CyRTPR,
1307 (info->default_timeout ? info->default_timeout : 0x02));
1308 /* 10ms rx timeout */
1309
1310 cyy_issue_cmd(info, CyCHAN_CTL | CyENB_RCVR | CyENB_XMTR);
1311
1312 cyy_change_rts_dtr(info, TIOCM_RTS | TIOCM_DTR, 0);
1313
1314 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyRxData);
1315 } else {
1316 struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl;
1317
1318 if (!cyz_is_loaded(card))
1319 return -ENODEV;
1320
1321 #ifdef CY_DEBUG_OPEN
1322 printk(KERN_DEBUG "cyc startup Z card %d, channel %d, "
1323 "base_addr %p\n", card, channel, card->base_addr);
1324 #endif
1325 spin_lock_irqsave(&card->card_lock, flags);
1326
1327 cy_writel(&ch_ctrl->op_mode, C_CH_ENABLE);
1328 #ifdef Z_WAKE
1329 #ifdef CONFIG_CYZ_INTR
1330 cy_writel(&ch_ctrl->intr_enable,
1331 C_IN_TXBEMPTY | C_IN_TXLOWWM | C_IN_RXHIWM |
1332 C_IN_RXNNDT | C_IN_IOCTLW | C_IN_MDCD);
1333 #else
1334 cy_writel(&ch_ctrl->intr_enable,
1335 C_IN_IOCTLW | C_IN_MDCD);
1336 #endif /* CONFIG_CYZ_INTR */
1337 #else
1338 #ifdef CONFIG_CYZ_INTR
1339 cy_writel(&ch_ctrl->intr_enable,
1340 C_IN_TXBEMPTY | C_IN_TXLOWWM | C_IN_RXHIWM |
1341 C_IN_RXNNDT | C_IN_MDCD);
1342 #else
1343 cy_writel(&ch_ctrl->intr_enable, C_IN_MDCD);
1344 #endif /* CONFIG_CYZ_INTR */
1345 #endif /* Z_WAKE */
1346
1347 retval = cyz_issue_cmd(card, channel, C_CM_IOCTL, 0L);
1348 if (retval != 0) {
1349 printk(KERN_ERR "cyc:startup(1) retval on ttyC%d was "
1350 "%x\n", info->line, retval);
1351 }
1352
1353 /* Flush RX buffers before raising DTR and RTS */
1354 retval = cyz_issue_cmd(card, channel, C_CM_FLUSH_RX, 0L);
1355 if (retval != 0) {
1356 printk(KERN_ERR "cyc:startup(2) retval on ttyC%d was "
1357 "%x\n", info->line, retval);
1358 }
1359
1360 /* set timeout !!! */
1361 /* set RTS and DTR !!! */
1362 tty_port_raise_dtr_rts(&info->port);
1363
1364 /* enable send, recv, modem !!! */
1365 }
1366
1367 info->port.flags |= ASYNC_INITIALIZED;
1368
1369 clear_bit(TTY_IO_ERROR, &tty->flags);
1370 info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
1371 info->breakon = info->breakoff = 0;
1372 memset((char *)&info->idle_stats, 0, sizeof(info->idle_stats));
1373 info->idle_stats.in_use =
1374 info->idle_stats.recv_idle =
1375 info->idle_stats.xmit_idle = jiffies;
1376
1377 spin_unlock_irqrestore(&card->card_lock, flags);
1378
1379 #ifdef CY_DEBUG_OPEN
1380 printk(KERN_DEBUG "cyc startup done\n");
1381 #endif
1382 return 0;
1383
1384 errout:
1385 spin_unlock_irqrestore(&card->card_lock, flags);
1386 free_page(page);
1387 return retval;
1388 } /* startup */
1389
start_xmit(struct cyclades_port * info)1390 static void start_xmit(struct cyclades_port *info)
1391 {
1392 struct cyclades_card *card = info->card;
1393 unsigned long flags;
1394 int channel = info->line - card->first_line;
1395
1396 if (!cy_is_Z(card)) {
1397 spin_lock_irqsave(&card->card_lock, flags);
1398 cyy_writeb(info, CyCAR, channel & 0x03);
1399 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyTxRdy);
1400 spin_unlock_irqrestore(&card->card_lock, flags);
1401 } else {
1402 #ifdef CONFIG_CYZ_INTR
1403 int retval;
1404
1405 spin_lock_irqsave(&card->card_lock, flags);
1406 retval = cyz_issue_cmd(card, channel, C_CM_INTBACK, 0L);
1407 if (retval != 0) {
1408 printk(KERN_ERR "cyc:start_xmit retval on ttyC%d was "
1409 "%x\n", info->line, retval);
1410 }
1411 spin_unlock_irqrestore(&card->card_lock, flags);
1412 #else /* CONFIG_CYZ_INTR */
1413 /* Don't have to do anything at this time */
1414 #endif /* CONFIG_CYZ_INTR */
1415 }
1416 } /* start_xmit */
1417
1418 /*
1419 * This routine shuts down a serial port; interrupts are disabled,
1420 * and DTR is dropped if the hangup on close termio flag is on.
1421 */
cy_shutdown(struct cyclades_port * info,struct tty_struct * tty)1422 static void cy_shutdown(struct cyclades_port *info, struct tty_struct *tty)
1423 {
1424 struct cyclades_card *card;
1425 unsigned long flags;
1426
1427 if (!(info->port.flags & ASYNC_INITIALIZED))
1428 return;
1429
1430 card = info->card;
1431 if (!cy_is_Z(card)) {
1432 spin_lock_irqsave(&card->card_lock, flags);
1433
1434 /* Clear delta_msr_wait queue to avoid mem leaks. */
1435 wake_up_interruptible(&info->port.delta_msr_wait);
1436
1437 if (info->port.xmit_buf) {
1438 unsigned char *temp;
1439 temp = info->port.xmit_buf;
1440 info->port.xmit_buf = NULL;
1441 free_page((unsigned long)temp);
1442 }
1443 if (tty->termios.c_cflag & HUPCL)
1444 cyy_change_rts_dtr(info, 0, TIOCM_RTS | TIOCM_DTR);
1445
1446 cyy_issue_cmd(info, CyCHAN_CTL | CyDIS_RCVR);
1447 /* it may be appropriate to clear _XMIT at
1448 some later date (after testing)!!! */
1449
1450 set_bit(TTY_IO_ERROR, &tty->flags);
1451 info->port.flags &= ~ASYNC_INITIALIZED;
1452 spin_unlock_irqrestore(&card->card_lock, flags);
1453 } else {
1454 #ifdef CY_DEBUG_OPEN
1455 int channel = info->line - card->first_line;
1456 printk(KERN_DEBUG "cyc shutdown Z card %d, channel %d, "
1457 "base_addr %p\n", card, channel, card->base_addr);
1458 #endif
1459
1460 if (!cyz_is_loaded(card))
1461 return;
1462
1463 spin_lock_irqsave(&card->card_lock, flags);
1464
1465 if (info->port.xmit_buf) {
1466 unsigned char *temp;
1467 temp = info->port.xmit_buf;
1468 info->port.xmit_buf = NULL;
1469 free_page((unsigned long)temp);
1470 }
1471
1472 if (tty->termios.c_cflag & HUPCL)
1473 tty_port_lower_dtr_rts(&info->port);
1474
1475 set_bit(TTY_IO_ERROR, &tty->flags);
1476 info->port.flags &= ~ASYNC_INITIALIZED;
1477
1478 spin_unlock_irqrestore(&card->card_lock, flags);
1479 }
1480
1481 #ifdef CY_DEBUG_OPEN
1482 printk(KERN_DEBUG "cyc shutdown done\n");
1483 #endif
1484 } /* shutdown */
1485
1486 /*
1487 * ------------------------------------------------------------
1488 * cy_open() and friends
1489 * ------------------------------------------------------------
1490 */
1491
1492 /*
1493 * This routine is called whenever a serial port is opened. It
1494 * performs the serial-specific initialization for the tty structure.
1495 */
cy_open(struct tty_struct * tty,struct file * filp)1496 static int cy_open(struct tty_struct *tty, struct file *filp)
1497 {
1498 struct cyclades_port *info;
1499 unsigned int i, line = tty->index;
1500 int retval;
1501
1502 for (i = 0; i < NR_CARDS; i++)
1503 if (line < cy_card[i].first_line + cy_card[i].nports &&
1504 line >= cy_card[i].first_line)
1505 break;
1506 if (i >= NR_CARDS)
1507 return -ENODEV;
1508 info = &cy_card[i].ports[line - cy_card[i].first_line];
1509 if (info->line < 0)
1510 return -ENODEV;
1511
1512 /* If the card's firmware hasn't been loaded,
1513 treat it as absent from the system. This
1514 will make the user pay attention.
1515 */
1516 if (cy_is_Z(info->card)) {
1517 struct cyclades_card *cinfo = info->card;
1518 struct FIRM_ID __iomem *firm_id = cinfo->base_addr + ID_ADDRESS;
1519
1520 if (!cyz_is_loaded(cinfo)) {
1521 if (cinfo->hw_ver == ZE_V1 && cyz_fpga_loaded(cinfo) &&
1522 readl(&firm_id->signature) ==
1523 ZFIRM_HLT) {
1524 printk(KERN_ERR "cyc:Cyclades-Z Error: you "
1525 "need an external power supply for "
1526 "this number of ports.\nFirmware "
1527 "halted.\n");
1528 } else {
1529 printk(KERN_ERR "cyc:Cyclades-Z firmware not "
1530 "yet loaded\n");
1531 }
1532 return -ENODEV;
1533 }
1534 #ifdef CONFIG_CYZ_INTR
1535 else {
1536 /* In case this Z board is operating in interrupt mode, its
1537 interrupts should be enabled as soon as the first open
1538 happens to one of its ports. */
1539 if (!cinfo->intr_enabled) {
1540 u16 intr;
1541
1542 /* Enable interrupts on the PLX chip */
1543 intr = readw(&cinfo->ctl_addr.p9060->
1544 intr_ctrl_stat) | 0x0900;
1545 cy_writew(&cinfo->ctl_addr.p9060->
1546 intr_ctrl_stat, intr);
1547 /* Enable interrupts on the FW */
1548 retval = cyz_issue_cmd(cinfo, 0,
1549 C_CM_IRQ_ENBL, 0L);
1550 if (retval != 0) {
1551 printk(KERN_ERR "cyc:IRQ enable retval "
1552 "was %x\n", retval);
1553 }
1554 cinfo->intr_enabled = 1;
1555 }
1556 }
1557 #endif /* CONFIG_CYZ_INTR */
1558 /* Make sure this Z port really exists in hardware */
1559 if (info->line > (cinfo->first_line + cinfo->nports - 1))
1560 return -ENODEV;
1561 }
1562 #ifdef CY_DEBUG_OTHER
1563 printk(KERN_DEBUG "cyc:cy_open ttyC%d\n", info->line);
1564 #endif
1565 tty->driver_data = info;
1566 if (serial_paranoia_check(info, tty->name, "cy_open"))
1567 return -ENODEV;
1568
1569 #ifdef CY_DEBUG_OPEN
1570 printk(KERN_DEBUG "cyc:cy_open ttyC%d, count = %d\n", info->line,
1571 info->port.count);
1572 #endif
1573 info->port.count++;
1574 #ifdef CY_DEBUG_COUNT
1575 printk(KERN_DEBUG "cyc:cy_open (%d): incrementing count to %d\n",
1576 current->pid, info->port.count);
1577 #endif
1578
1579 /*
1580 * If the port is the middle of closing, bail out now
1581 */
1582 if (tty_hung_up_p(filp) || (info->port.flags & ASYNC_CLOSING)) {
1583 wait_event_interruptible_tty(tty, info->port.close_wait,
1584 !(info->port.flags & ASYNC_CLOSING));
1585 return (info->port.flags & ASYNC_HUP_NOTIFY) ? -EAGAIN: -ERESTARTSYS;
1586 }
1587
1588 /*
1589 * Start up serial port
1590 */
1591 retval = cy_startup(info, tty);
1592 if (retval)
1593 return retval;
1594
1595 retval = tty_port_block_til_ready(&info->port, tty, filp);
1596 if (retval) {
1597 #ifdef CY_DEBUG_OPEN
1598 printk(KERN_DEBUG "cyc:cy_open returning after block_til_ready "
1599 "with %d\n", retval);
1600 #endif
1601 return retval;
1602 }
1603
1604 info->throttle = 0;
1605 tty_port_tty_set(&info->port, tty);
1606
1607 #ifdef CY_DEBUG_OPEN
1608 printk(KERN_DEBUG "cyc:cy_open done\n");
1609 #endif
1610 return 0;
1611 } /* cy_open */
1612
1613 /*
1614 * cy_wait_until_sent() --- wait until the transmitter is empty
1615 */
cy_wait_until_sent(struct tty_struct * tty,int timeout)1616 static void cy_wait_until_sent(struct tty_struct *tty, int timeout)
1617 {
1618 struct cyclades_card *card;
1619 struct cyclades_port *info = tty->driver_data;
1620 unsigned long orig_jiffies;
1621 int char_time;
1622
1623 if (serial_paranoia_check(info, tty->name, "cy_wait_until_sent"))
1624 return;
1625
1626 if (info->xmit_fifo_size == 0)
1627 return; /* Just in case.... */
1628
1629 orig_jiffies = jiffies;
1630 /*
1631 * Set the check interval to be 1/5 of the estimated time to
1632 * send a single character, and make it at least 1. The check
1633 * interval should also be less than the timeout.
1634 *
1635 * Note: we have to use pretty tight timings here to satisfy
1636 * the NIST-PCTS.
1637 */
1638 char_time = (info->timeout - HZ / 50) / info->xmit_fifo_size;
1639 char_time = char_time / 5;
1640 if (char_time <= 0)
1641 char_time = 1;
1642 if (timeout < 0)
1643 timeout = 0;
1644 if (timeout)
1645 char_time = min(char_time, timeout);
1646 /*
1647 * If the transmitter hasn't cleared in twice the approximate
1648 * amount of time to send the entire FIFO, it probably won't
1649 * ever clear. This assumes the UART isn't doing flow
1650 * control, which is currently the case. Hence, if it ever
1651 * takes longer than info->timeout, this is probably due to a
1652 * UART bug of some kind. So, we clamp the timeout parameter at
1653 * 2*info->timeout.
1654 */
1655 if (!timeout || timeout > 2 * info->timeout)
1656 timeout = 2 * info->timeout;
1657
1658 card = info->card;
1659 if (!cy_is_Z(card)) {
1660 while (cyy_readb(info, CySRER) & CyTxRdy) {
1661 if (msleep_interruptible(jiffies_to_msecs(char_time)))
1662 break;
1663 if (timeout && time_after(jiffies, orig_jiffies +
1664 timeout))
1665 break;
1666 }
1667 }
1668 /* Run one more char cycle */
1669 msleep_interruptible(jiffies_to_msecs(char_time * 5));
1670 }
1671
cy_flush_buffer(struct tty_struct * tty)1672 static void cy_flush_buffer(struct tty_struct *tty)
1673 {
1674 struct cyclades_port *info = tty->driver_data;
1675 struct cyclades_card *card;
1676 int channel, retval;
1677 unsigned long flags;
1678
1679 #ifdef CY_DEBUG_IO
1680 printk(KERN_DEBUG "cyc:cy_flush_buffer ttyC%d\n", info->line);
1681 #endif
1682
1683 if (serial_paranoia_check(info, tty->name, "cy_flush_buffer"))
1684 return;
1685
1686 card = info->card;
1687 channel = info->line - card->first_line;
1688
1689 spin_lock_irqsave(&card->card_lock, flags);
1690 info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
1691 spin_unlock_irqrestore(&card->card_lock, flags);
1692
1693 if (cy_is_Z(card)) { /* If it is a Z card, flush the on-board
1694 buffers as well */
1695 spin_lock_irqsave(&card->card_lock, flags);
1696 retval = cyz_issue_cmd(card, channel, C_CM_FLUSH_TX, 0L);
1697 if (retval != 0) {
1698 printk(KERN_ERR "cyc: flush_buffer retval on ttyC%d "
1699 "was %x\n", info->line, retval);
1700 }
1701 spin_unlock_irqrestore(&card->card_lock, flags);
1702 }
1703 tty_wakeup(tty);
1704 } /* cy_flush_buffer */
1705
1706
cy_do_close(struct tty_port * port)1707 static void cy_do_close(struct tty_port *port)
1708 {
1709 struct cyclades_port *info = container_of(port, struct cyclades_port,
1710 port);
1711 struct cyclades_card *card;
1712 unsigned long flags;
1713 int channel;
1714
1715 card = info->card;
1716 channel = info->line - card->first_line;
1717 spin_lock_irqsave(&card->card_lock, flags);
1718
1719 if (!cy_is_Z(card)) {
1720 /* Stop accepting input */
1721 cyy_writeb(info, CyCAR, channel & 0x03);
1722 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) & ~CyRxData);
1723 if (info->port.flags & ASYNC_INITIALIZED) {
1724 /* Waiting for on-board buffers to be empty before
1725 closing the port */
1726 spin_unlock_irqrestore(&card->card_lock, flags);
1727 cy_wait_until_sent(port->tty, info->timeout);
1728 spin_lock_irqsave(&card->card_lock, flags);
1729 }
1730 } else {
1731 #ifdef Z_WAKE
1732 /* Waiting for on-board buffers to be empty before closing
1733 the port */
1734 struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl;
1735 int retval;
1736
1737 if (readl(&ch_ctrl->flow_status) != C_FS_TXIDLE) {
1738 retval = cyz_issue_cmd(card, channel, C_CM_IOCTLW, 0L);
1739 if (retval != 0) {
1740 printk(KERN_DEBUG "cyc:cy_close retval on "
1741 "ttyC%d was %x\n", info->line, retval);
1742 }
1743 spin_unlock_irqrestore(&card->card_lock, flags);
1744 wait_for_completion_interruptible(&info->shutdown_wait);
1745 spin_lock_irqsave(&card->card_lock, flags);
1746 }
1747 #endif
1748 }
1749 spin_unlock_irqrestore(&card->card_lock, flags);
1750 cy_shutdown(info, port->tty);
1751 }
1752
1753 /*
1754 * This routine is called when a particular tty device is closed.
1755 */
cy_close(struct tty_struct * tty,struct file * filp)1756 static void cy_close(struct tty_struct *tty, struct file *filp)
1757 {
1758 struct cyclades_port *info = tty->driver_data;
1759 if (!info || serial_paranoia_check(info, tty->name, "cy_close"))
1760 return;
1761 tty_port_close(&info->port, tty, filp);
1762 } /* cy_close */
1763
1764 /* This routine gets called when tty_write has put something into
1765 * the write_queue. The characters may come from user space or
1766 * kernel space.
1767 *
1768 * This routine will return the number of characters actually
1769 * accepted for writing.
1770 *
1771 * If the port is not already transmitting stuff, start it off by
1772 * enabling interrupts. The interrupt service routine will then
1773 * ensure that the characters are sent.
1774 * If the port is already active, there is no need to kick it.
1775 *
1776 */
cy_write(struct tty_struct * tty,const unsigned char * buf,int count)1777 static int cy_write(struct tty_struct *tty, const unsigned char *buf, int count)
1778 {
1779 struct cyclades_port *info = tty->driver_data;
1780 unsigned long flags;
1781 int c, ret = 0;
1782
1783 #ifdef CY_DEBUG_IO
1784 printk(KERN_DEBUG "cyc:cy_write ttyC%d\n", info->line);
1785 #endif
1786
1787 if (serial_paranoia_check(info, tty->name, "cy_write"))
1788 return 0;
1789
1790 if (!info->port.xmit_buf)
1791 return 0;
1792
1793 spin_lock_irqsave(&info->card->card_lock, flags);
1794 while (1) {
1795 c = min(count, (int)(SERIAL_XMIT_SIZE - info->xmit_cnt - 1));
1796 c = min(c, (int)(SERIAL_XMIT_SIZE - info->xmit_head));
1797
1798 if (c <= 0)
1799 break;
1800
1801 memcpy(info->port.xmit_buf + info->xmit_head, buf, c);
1802 info->xmit_head = (info->xmit_head + c) &
1803 (SERIAL_XMIT_SIZE - 1);
1804 info->xmit_cnt += c;
1805 buf += c;
1806 count -= c;
1807 ret += c;
1808 }
1809 spin_unlock_irqrestore(&info->card->card_lock, flags);
1810
1811 info->idle_stats.xmit_bytes += ret;
1812 info->idle_stats.xmit_idle = jiffies;
1813
1814 if (info->xmit_cnt && !tty->stopped && !tty->hw_stopped)
1815 start_xmit(info);
1816
1817 return ret;
1818 } /* cy_write */
1819
1820 /*
1821 * This routine is called by the kernel to write a single
1822 * character to the tty device. If the kernel uses this routine,
1823 * it must call the flush_chars() routine (if defined) when it is
1824 * done stuffing characters into the driver. If there is no room
1825 * in the queue, the character is ignored.
1826 */
cy_put_char(struct tty_struct * tty,unsigned char ch)1827 static int cy_put_char(struct tty_struct *tty, unsigned char ch)
1828 {
1829 struct cyclades_port *info = tty->driver_data;
1830 unsigned long flags;
1831
1832 #ifdef CY_DEBUG_IO
1833 printk(KERN_DEBUG "cyc:cy_put_char ttyC%d\n", info->line);
1834 #endif
1835
1836 if (serial_paranoia_check(info, tty->name, "cy_put_char"))
1837 return 0;
1838
1839 if (!info->port.xmit_buf)
1840 return 0;
1841
1842 spin_lock_irqsave(&info->card->card_lock, flags);
1843 if (info->xmit_cnt >= (int)(SERIAL_XMIT_SIZE - 1)) {
1844 spin_unlock_irqrestore(&info->card->card_lock, flags);
1845 return 0;
1846 }
1847
1848 info->port.xmit_buf[info->xmit_head++] = ch;
1849 info->xmit_head &= SERIAL_XMIT_SIZE - 1;
1850 info->xmit_cnt++;
1851 info->idle_stats.xmit_bytes++;
1852 info->idle_stats.xmit_idle = jiffies;
1853 spin_unlock_irqrestore(&info->card->card_lock, flags);
1854 return 1;
1855 } /* cy_put_char */
1856
1857 /*
1858 * This routine is called by the kernel after it has written a
1859 * series of characters to the tty device using put_char().
1860 */
cy_flush_chars(struct tty_struct * tty)1861 static void cy_flush_chars(struct tty_struct *tty)
1862 {
1863 struct cyclades_port *info = tty->driver_data;
1864
1865 #ifdef CY_DEBUG_IO
1866 printk(KERN_DEBUG "cyc:cy_flush_chars ttyC%d\n", info->line);
1867 #endif
1868
1869 if (serial_paranoia_check(info, tty->name, "cy_flush_chars"))
1870 return;
1871
1872 if (info->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped ||
1873 !info->port.xmit_buf)
1874 return;
1875
1876 start_xmit(info);
1877 } /* cy_flush_chars */
1878
1879 /*
1880 * This routine returns the numbers of characters the tty driver
1881 * will accept for queuing to be written. This number is subject
1882 * to change as output buffers get emptied, or if the output flow
1883 * control is activated.
1884 */
cy_write_room(struct tty_struct * tty)1885 static int cy_write_room(struct tty_struct *tty)
1886 {
1887 struct cyclades_port *info = tty->driver_data;
1888 int ret;
1889
1890 #ifdef CY_DEBUG_IO
1891 printk(KERN_DEBUG "cyc:cy_write_room ttyC%d\n", info->line);
1892 #endif
1893
1894 if (serial_paranoia_check(info, tty->name, "cy_write_room"))
1895 return 0;
1896 ret = SERIAL_XMIT_SIZE - info->xmit_cnt - 1;
1897 if (ret < 0)
1898 ret = 0;
1899 return ret;
1900 } /* cy_write_room */
1901
cy_chars_in_buffer(struct tty_struct * tty)1902 static int cy_chars_in_buffer(struct tty_struct *tty)
1903 {
1904 struct cyclades_port *info = tty->driver_data;
1905
1906 if (serial_paranoia_check(info, tty->name, "cy_chars_in_buffer"))
1907 return 0;
1908
1909 #ifdef Z_EXT_CHARS_IN_BUFFER
1910 if (!cy_is_Z(info->card)) {
1911 #endif /* Z_EXT_CHARS_IN_BUFFER */
1912 #ifdef CY_DEBUG_IO
1913 printk(KERN_DEBUG "cyc:cy_chars_in_buffer ttyC%d %d\n",
1914 info->line, info->xmit_cnt);
1915 #endif
1916 return info->xmit_cnt;
1917 #ifdef Z_EXT_CHARS_IN_BUFFER
1918 } else {
1919 struct BUF_CTRL __iomem *buf_ctrl = info->u.cyz.buf_ctrl;
1920 int char_count;
1921 __u32 tx_put, tx_get, tx_bufsize;
1922
1923 tx_get = readl(&buf_ctrl->tx_get);
1924 tx_put = readl(&buf_ctrl->tx_put);
1925 tx_bufsize = readl(&buf_ctrl->tx_bufsize);
1926 if (tx_put >= tx_get)
1927 char_count = tx_put - tx_get;
1928 else
1929 char_count = tx_put - tx_get + tx_bufsize;
1930 #ifdef CY_DEBUG_IO
1931 printk(KERN_DEBUG "cyc:cy_chars_in_buffer ttyC%d %d\n",
1932 info->line, info->xmit_cnt + char_count);
1933 #endif
1934 return info->xmit_cnt + char_count;
1935 }
1936 #endif /* Z_EXT_CHARS_IN_BUFFER */
1937 } /* cy_chars_in_buffer */
1938
1939 /*
1940 * ------------------------------------------------------------
1941 * cy_ioctl() and friends
1942 * ------------------------------------------------------------
1943 */
1944
cyy_baud_calc(struct cyclades_port * info,__u32 baud)1945 static void cyy_baud_calc(struct cyclades_port *info, __u32 baud)
1946 {
1947 int co, co_val, bpr;
1948 __u32 cy_clock = ((info->chip_rev >= CD1400_REV_J) ? 60000000 :
1949 25000000);
1950
1951 if (baud == 0) {
1952 info->tbpr = info->tco = info->rbpr = info->rco = 0;
1953 return;
1954 }
1955
1956 /* determine which prescaler to use */
1957 for (co = 4, co_val = 2048; co; co--, co_val >>= 2) {
1958 if (cy_clock / co_val / baud > 63)
1959 break;
1960 }
1961
1962 bpr = (cy_clock / co_val * 2 / baud + 1) / 2;
1963 if (bpr > 255)
1964 bpr = 255;
1965
1966 info->tbpr = info->rbpr = bpr;
1967 info->tco = info->rco = co;
1968 }
1969
1970 /*
1971 * This routine finds or computes the various line characteristics.
1972 * It used to be called config_setup
1973 */
cy_set_line_char(struct cyclades_port * info,struct tty_struct * tty)1974 static void cy_set_line_char(struct cyclades_port *info, struct tty_struct *tty)
1975 {
1976 struct cyclades_card *card;
1977 unsigned long flags;
1978 int channel;
1979 unsigned cflag, iflag;
1980 int baud, baud_rate = 0;
1981 int i;
1982
1983 if (info->line == -1)
1984 return;
1985
1986 cflag = tty->termios.c_cflag;
1987 iflag = tty->termios.c_iflag;
1988
1989 /*
1990 * Set up the tty->alt_speed kludge
1991 */
1992 if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
1993 tty->alt_speed = 57600;
1994 if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
1995 tty->alt_speed = 115200;
1996 if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI)
1997 tty->alt_speed = 230400;
1998 if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP)
1999 tty->alt_speed = 460800;
2000
2001 card = info->card;
2002 channel = info->line - card->first_line;
2003
2004 if (!cy_is_Z(card)) {
2005 u32 cflags;
2006
2007 /* baud rate */
2008 baud = tty_get_baud_rate(tty);
2009 if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) ==
2010 ASYNC_SPD_CUST) {
2011 if (info->custom_divisor)
2012 baud_rate = info->baud / info->custom_divisor;
2013 else
2014 baud_rate = info->baud;
2015 } else if (baud > CD1400_MAX_SPEED) {
2016 baud = CD1400_MAX_SPEED;
2017 }
2018 /* find the baud index */
2019 for (i = 0; i < 20; i++) {
2020 if (baud == baud_table[i])
2021 break;
2022 }
2023 if (i == 20)
2024 i = 19; /* CD1400_MAX_SPEED */
2025
2026 if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) ==
2027 ASYNC_SPD_CUST) {
2028 cyy_baud_calc(info, baud_rate);
2029 } else {
2030 if (info->chip_rev >= CD1400_REV_J) {
2031 /* It is a CD1400 rev. J or later */
2032 info->tbpr = baud_bpr_60[i]; /* Tx BPR */
2033 info->tco = baud_co_60[i]; /* Tx CO */
2034 info->rbpr = baud_bpr_60[i]; /* Rx BPR */
2035 info->rco = baud_co_60[i]; /* Rx CO */
2036 } else {
2037 info->tbpr = baud_bpr_25[i]; /* Tx BPR */
2038 info->tco = baud_co_25[i]; /* Tx CO */
2039 info->rbpr = baud_bpr_25[i]; /* Rx BPR */
2040 info->rco = baud_co_25[i]; /* Rx CO */
2041 }
2042 }
2043 if (baud_table[i] == 134) {
2044 /* get it right for 134.5 baud */
2045 info->timeout = (info->xmit_fifo_size * HZ * 30 / 269) +
2046 2;
2047 } else if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) ==
2048 ASYNC_SPD_CUST) {
2049 info->timeout = (info->xmit_fifo_size * HZ * 15 /
2050 baud_rate) + 2;
2051 } else if (baud_table[i]) {
2052 info->timeout = (info->xmit_fifo_size * HZ * 15 /
2053 baud_table[i]) + 2;
2054 /* this needs to be propagated into the card info */
2055 } else {
2056 info->timeout = 0;
2057 }
2058 /* By tradition (is it a standard?) a baud rate of zero
2059 implies the line should be/has been closed. A bit
2060 later in this routine such a test is performed. */
2061
2062 /* byte size and parity */
2063 info->cor5 = 0;
2064 info->cor4 = 0;
2065 /* receive threshold */
2066 info->cor3 = (info->default_threshold ?
2067 info->default_threshold : baud_cor3[i]);
2068 info->cor2 = CyETC;
2069 switch (cflag & CSIZE) {
2070 case CS5:
2071 info->cor1 = Cy_5_BITS;
2072 break;
2073 case CS6:
2074 info->cor1 = Cy_6_BITS;
2075 break;
2076 case CS7:
2077 info->cor1 = Cy_7_BITS;
2078 break;
2079 case CS8:
2080 info->cor1 = Cy_8_BITS;
2081 break;
2082 }
2083 if (cflag & CSTOPB)
2084 info->cor1 |= Cy_2_STOP;
2085
2086 if (cflag & PARENB) {
2087 if (cflag & PARODD)
2088 info->cor1 |= CyPARITY_O;
2089 else
2090 info->cor1 |= CyPARITY_E;
2091 } else
2092 info->cor1 |= CyPARITY_NONE;
2093
2094 /* CTS flow control flag */
2095 if (cflag & CRTSCTS) {
2096 info->port.flags |= ASYNC_CTS_FLOW;
2097 info->cor2 |= CyCtsAE;
2098 } else {
2099 info->port.flags &= ~ASYNC_CTS_FLOW;
2100 info->cor2 &= ~CyCtsAE;
2101 }
2102 if (cflag & CLOCAL)
2103 info->port.flags &= ~ASYNC_CHECK_CD;
2104 else
2105 info->port.flags |= ASYNC_CHECK_CD;
2106
2107 /***********************************************
2108 The hardware option, CyRtsAO, presents RTS when
2109 the chip has characters to send. Since most modems
2110 use RTS as reverse (inbound) flow control, this
2111 option is not used. If inbound flow control is
2112 necessary, DTR can be programmed to provide the
2113 appropriate signals for use with a non-standard
2114 cable. Contact Marcio Saito for details.
2115 ***********************************************/
2116
2117 channel &= 0x03;
2118
2119 spin_lock_irqsave(&card->card_lock, flags);
2120 cyy_writeb(info, CyCAR, channel);
2121
2122 /* tx and rx baud rate */
2123
2124 cyy_writeb(info, CyTCOR, info->tco);
2125 cyy_writeb(info, CyTBPR, info->tbpr);
2126 cyy_writeb(info, CyRCOR, info->rco);
2127 cyy_writeb(info, CyRBPR, info->rbpr);
2128
2129 /* set line characteristics according configuration */
2130
2131 cyy_writeb(info, CySCHR1, START_CHAR(tty));
2132 cyy_writeb(info, CySCHR2, STOP_CHAR(tty));
2133 cyy_writeb(info, CyCOR1, info->cor1);
2134 cyy_writeb(info, CyCOR2, info->cor2);
2135 cyy_writeb(info, CyCOR3, info->cor3);
2136 cyy_writeb(info, CyCOR4, info->cor4);
2137 cyy_writeb(info, CyCOR5, info->cor5);
2138
2139 cyy_issue_cmd(info, CyCOR_CHANGE | CyCOR1ch | CyCOR2ch |
2140 CyCOR3ch);
2141
2142 /* !!! Is this needed? */
2143 cyy_writeb(info, CyCAR, channel);
2144 cyy_writeb(info, CyRTPR,
2145 (info->default_timeout ? info->default_timeout : 0x02));
2146 /* 10ms rx timeout */
2147
2148 cflags = CyCTS;
2149 if (!C_CLOCAL(tty))
2150 cflags |= CyDSR | CyRI | CyDCD;
2151 /* without modem intr */
2152 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyMdmCh);
2153 /* act on 1->0 modem transitions */
2154 if ((cflag & CRTSCTS) && info->rflow)
2155 cyy_writeb(info, CyMCOR1, cflags | rflow_thr[i]);
2156 else
2157 cyy_writeb(info, CyMCOR1, cflags);
2158 /* act on 0->1 modem transitions */
2159 cyy_writeb(info, CyMCOR2, cflags);
2160
2161 if (i == 0) /* baud rate is zero, turn off line */
2162 cyy_change_rts_dtr(info, 0, TIOCM_DTR);
2163 else
2164 cyy_change_rts_dtr(info, TIOCM_DTR, 0);
2165
2166 clear_bit(TTY_IO_ERROR, &tty->flags);
2167 spin_unlock_irqrestore(&card->card_lock, flags);
2168
2169 } else {
2170 struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl;
2171 __u32 sw_flow;
2172 int retval;
2173
2174 if (!cyz_is_loaded(card))
2175 return;
2176
2177 /* baud rate */
2178 baud = tty_get_baud_rate(tty);
2179 if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) ==
2180 ASYNC_SPD_CUST) {
2181 if (info->custom_divisor)
2182 baud_rate = info->baud / info->custom_divisor;
2183 else
2184 baud_rate = info->baud;
2185 } else if (baud > CYZ_MAX_SPEED) {
2186 baud = CYZ_MAX_SPEED;
2187 }
2188 cy_writel(&ch_ctrl->comm_baud, baud);
2189
2190 if (baud == 134) {
2191 /* get it right for 134.5 baud */
2192 info->timeout = (info->xmit_fifo_size * HZ * 30 / 269) +
2193 2;
2194 } else if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) ==
2195 ASYNC_SPD_CUST) {
2196 info->timeout = (info->xmit_fifo_size * HZ * 15 /
2197 baud_rate) + 2;
2198 } else if (baud) {
2199 info->timeout = (info->xmit_fifo_size * HZ * 15 /
2200 baud) + 2;
2201 /* this needs to be propagated into the card info */
2202 } else {
2203 info->timeout = 0;
2204 }
2205
2206 /* byte size and parity */
2207 switch (cflag & CSIZE) {
2208 case CS5:
2209 cy_writel(&ch_ctrl->comm_data_l, C_DL_CS5);
2210 break;
2211 case CS6:
2212 cy_writel(&ch_ctrl->comm_data_l, C_DL_CS6);
2213 break;
2214 case CS7:
2215 cy_writel(&ch_ctrl->comm_data_l, C_DL_CS7);
2216 break;
2217 case CS8:
2218 cy_writel(&ch_ctrl->comm_data_l, C_DL_CS8);
2219 break;
2220 }
2221 if (cflag & CSTOPB) {
2222 cy_writel(&ch_ctrl->comm_data_l,
2223 readl(&ch_ctrl->comm_data_l) | C_DL_2STOP);
2224 } else {
2225 cy_writel(&ch_ctrl->comm_data_l,
2226 readl(&ch_ctrl->comm_data_l) | C_DL_1STOP);
2227 }
2228 if (cflag & PARENB) {
2229 if (cflag & PARODD)
2230 cy_writel(&ch_ctrl->comm_parity, C_PR_ODD);
2231 else
2232 cy_writel(&ch_ctrl->comm_parity, C_PR_EVEN);
2233 } else
2234 cy_writel(&ch_ctrl->comm_parity, C_PR_NONE);
2235
2236 /* CTS flow control flag */
2237 if (cflag & CRTSCTS) {
2238 cy_writel(&ch_ctrl->hw_flow,
2239 readl(&ch_ctrl->hw_flow) | C_RS_CTS | C_RS_RTS);
2240 } else {
2241 cy_writel(&ch_ctrl->hw_flow, readl(&ch_ctrl->hw_flow) &
2242 ~(C_RS_CTS | C_RS_RTS));
2243 }
2244 /* As the HW flow control is done in firmware, the driver
2245 doesn't need to care about it */
2246 info->port.flags &= ~ASYNC_CTS_FLOW;
2247
2248 /* XON/XOFF/XANY flow control flags */
2249 sw_flow = 0;
2250 if (iflag & IXON) {
2251 sw_flow |= C_FL_OXX;
2252 if (iflag & IXANY)
2253 sw_flow |= C_FL_OIXANY;
2254 }
2255 cy_writel(&ch_ctrl->sw_flow, sw_flow);
2256
2257 retval = cyz_issue_cmd(card, channel, C_CM_IOCTL, 0L);
2258 if (retval != 0) {
2259 printk(KERN_ERR "cyc:set_line_char retval on ttyC%d "
2260 "was %x\n", info->line, retval);
2261 }
2262
2263 /* CD sensitivity */
2264 if (cflag & CLOCAL)
2265 info->port.flags &= ~ASYNC_CHECK_CD;
2266 else
2267 info->port.flags |= ASYNC_CHECK_CD;
2268
2269 if (baud == 0) { /* baud rate is zero, turn off line */
2270 cy_writel(&ch_ctrl->rs_control,
2271 readl(&ch_ctrl->rs_control) & ~C_RS_DTR);
2272 #ifdef CY_DEBUG_DTR
2273 printk(KERN_DEBUG "cyc:set_line_char dropping Z DTR\n");
2274 #endif
2275 } else {
2276 cy_writel(&ch_ctrl->rs_control,
2277 readl(&ch_ctrl->rs_control) | C_RS_DTR);
2278 #ifdef CY_DEBUG_DTR
2279 printk(KERN_DEBUG "cyc:set_line_char raising Z DTR\n");
2280 #endif
2281 }
2282
2283 retval = cyz_issue_cmd(card, channel, C_CM_IOCTLM, 0L);
2284 if (retval != 0) {
2285 printk(KERN_ERR "cyc:set_line_char(2) retval on ttyC%d "
2286 "was %x\n", info->line, retval);
2287 }
2288
2289 clear_bit(TTY_IO_ERROR, &tty->flags);
2290 }
2291 } /* set_line_char */
2292
cy_get_serial_info(struct cyclades_port * info,struct serial_struct __user * retinfo)2293 static int cy_get_serial_info(struct cyclades_port *info,
2294 struct serial_struct __user *retinfo)
2295 {
2296 struct cyclades_card *cinfo = info->card;
2297 struct serial_struct tmp = {
2298 .type = info->type,
2299 .line = info->line,
2300 .port = (info->card - cy_card) * 0x100 + info->line -
2301 cinfo->first_line,
2302 .irq = cinfo->irq,
2303 .flags = info->port.flags,
2304 .close_delay = info->port.close_delay,
2305 .closing_wait = info->port.closing_wait,
2306 .baud_base = info->baud,
2307 .custom_divisor = info->custom_divisor,
2308 .hub6 = 0, /*!!! */
2309 };
2310 return copy_to_user(retinfo, &tmp, sizeof(*retinfo)) ? -EFAULT : 0;
2311 }
2312
2313 static int
cy_set_serial_info(struct cyclades_port * info,struct tty_struct * tty,struct serial_struct __user * new_info)2314 cy_set_serial_info(struct cyclades_port *info, struct tty_struct *tty,
2315 struct serial_struct __user *new_info)
2316 {
2317 struct serial_struct new_serial;
2318 int ret;
2319
2320 if (copy_from_user(&new_serial, new_info, sizeof(new_serial)))
2321 return -EFAULT;
2322
2323 mutex_lock(&info->port.mutex);
2324 if (!capable(CAP_SYS_ADMIN)) {
2325 if (new_serial.close_delay != info->port.close_delay ||
2326 new_serial.baud_base != info->baud ||
2327 (new_serial.flags & ASYNC_FLAGS &
2328 ~ASYNC_USR_MASK) !=
2329 (info->port.flags & ASYNC_FLAGS & ~ASYNC_USR_MASK))
2330 {
2331 mutex_unlock(&info->port.mutex);
2332 return -EPERM;
2333 }
2334 info->port.flags = (info->port.flags & ~ASYNC_USR_MASK) |
2335 (new_serial.flags & ASYNC_USR_MASK);
2336 info->baud = new_serial.baud_base;
2337 info->custom_divisor = new_serial.custom_divisor;
2338 goto check_and_exit;
2339 }
2340
2341 /*
2342 * OK, past this point, all the error checking has been done.
2343 * At this point, we start making changes.....
2344 */
2345
2346 info->baud = new_serial.baud_base;
2347 info->custom_divisor = new_serial.custom_divisor;
2348 info->port.flags = (info->port.flags & ~ASYNC_FLAGS) |
2349 (new_serial.flags & ASYNC_FLAGS);
2350 info->port.close_delay = new_serial.close_delay * HZ / 100;
2351 info->port.closing_wait = new_serial.closing_wait * HZ / 100;
2352
2353 check_and_exit:
2354 if (info->port.flags & ASYNC_INITIALIZED) {
2355 cy_set_line_char(info, tty);
2356 ret = 0;
2357 } else {
2358 ret = cy_startup(info, tty);
2359 }
2360 mutex_unlock(&info->port.mutex);
2361 return ret;
2362 } /* set_serial_info */
2363
2364 /*
2365 * get_lsr_info - get line status register info
2366 *
2367 * Purpose: Let user call ioctl() to get info when the UART physically
2368 * is emptied. On bus types like RS485, the transmitter must
2369 * release the bus after transmitting. This must be done when
2370 * the transmit shift register is empty, not be done when the
2371 * transmit holding register is empty. This functionality
2372 * allows an RS485 driver to be written in user space.
2373 */
get_lsr_info(struct cyclades_port * info,unsigned int __user * value)2374 static int get_lsr_info(struct cyclades_port *info, unsigned int __user *value)
2375 {
2376 struct cyclades_card *card = info->card;
2377 unsigned int result;
2378 unsigned long flags;
2379 u8 status;
2380
2381 if (!cy_is_Z(card)) {
2382 spin_lock_irqsave(&card->card_lock, flags);
2383 status = cyy_readb(info, CySRER) & (CyTxRdy | CyTxMpty);
2384 spin_unlock_irqrestore(&card->card_lock, flags);
2385 result = (status ? 0 : TIOCSER_TEMT);
2386 } else {
2387 /* Not supported yet */
2388 return -EINVAL;
2389 }
2390 return put_user(result, value);
2391 }
2392
cy_tiocmget(struct tty_struct * tty)2393 static int cy_tiocmget(struct tty_struct *tty)
2394 {
2395 struct cyclades_port *info = tty->driver_data;
2396 struct cyclades_card *card;
2397 int result;
2398
2399 if (serial_paranoia_check(info, tty->name, __func__))
2400 return -ENODEV;
2401
2402 card = info->card;
2403
2404 if (!cy_is_Z(card)) {
2405 unsigned long flags;
2406 int channel = info->line - card->first_line;
2407 u8 status;
2408
2409 spin_lock_irqsave(&card->card_lock, flags);
2410 cyy_writeb(info, CyCAR, channel & 0x03);
2411 status = cyy_readb(info, CyMSVR1);
2412 status |= cyy_readb(info, CyMSVR2);
2413 spin_unlock_irqrestore(&card->card_lock, flags);
2414
2415 if (info->rtsdtr_inv) {
2416 result = ((status & CyRTS) ? TIOCM_DTR : 0) |
2417 ((status & CyDTR) ? TIOCM_RTS : 0);
2418 } else {
2419 result = ((status & CyRTS) ? TIOCM_RTS : 0) |
2420 ((status & CyDTR) ? TIOCM_DTR : 0);
2421 }
2422 result |= ((status & CyDCD) ? TIOCM_CAR : 0) |
2423 ((status & CyRI) ? TIOCM_RNG : 0) |
2424 ((status & CyDSR) ? TIOCM_DSR : 0) |
2425 ((status & CyCTS) ? TIOCM_CTS : 0);
2426 } else {
2427 u32 lstatus;
2428
2429 if (!cyz_is_loaded(card)) {
2430 result = -ENODEV;
2431 goto end;
2432 }
2433
2434 lstatus = readl(&info->u.cyz.ch_ctrl->rs_status);
2435 result = ((lstatus & C_RS_RTS) ? TIOCM_RTS : 0) |
2436 ((lstatus & C_RS_DTR) ? TIOCM_DTR : 0) |
2437 ((lstatus & C_RS_DCD) ? TIOCM_CAR : 0) |
2438 ((lstatus & C_RS_RI) ? TIOCM_RNG : 0) |
2439 ((lstatus & C_RS_DSR) ? TIOCM_DSR : 0) |
2440 ((lstatus & C_RS_CTS) ? TIOCM_CTS : 0);
2441 }
2442 end:
2443 return result;
2444 } /* cy_tiomget */
2445
2446 static int
cy_tiocmset(struct tty_struct * tty,unsigned int set,unsigned int clear)2447 cy_tiocmset(struct tty_struct *tty,
2448 unsigned int set, unsigned int clear)
2449 {
2450 struct cyclades_port *info = tty->driver_data;
2451 struct cyclades_card *card;
2452 unsigned long flags;
2453
2454 if (serial_paranoia_check(info, tty->name, __func__))
2455 return -ENODEV;
2456
2457 card = info->card;
2458 if (!cy_is_Z(card)) {
2459 spin_lock_irqsave(&card->card_lock, flags);
2460 cyy_change_rts_dtr(info, set, clear);
2461 spin_unlock_irqrestore(&card->card_lock, flags);
2462 } else {
2463 struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl;
2464 int retval, channel = info->line - card->first_line;
2465 u32 rs;
2466
2467 if (!cyz_is_loaded(card))
2468 return -ENODEV;
2469
2470 spin_lock_irqsave(&card->card_lock, flags);
2471 rs = readl(&ch_ctrl->rs_control);
2472 if (set & TIOCM_RTS)
2473 rs |= C_RS_RTS;
2474 if (clear & TIOCM_RTS)
2475 rs &= ~C_RS_RTS;
2476 if (set & TIOCM_DTR) {
2477 rs |= C_RS_DTR;
2478 #ifdef CY_DEBUG_DTR
2479 printk(KERN_DEBUG "cyc:set_modem_info raising Z DTR\n");
2480 #endif
2481 }
2482 if (clear & TIOCM_DTR) {
2483 rs &= ~C_RS_DTR;
2484 #ifdef CY_DEBUG_DTR
2485 printk(KERN_DEBUG "cyc:set_modem_info clearing "
2486 "Z DTR\n");
2487 #endif
2488 }
2489 cy_writel(&ch_ctrl->rs_control, rs);
2490 retval = cyz_issue_cmd(card, channel, C_CM_IOCTLM, 0L);
2491 spin_unlock_irqrestore(&card->card_lock, flags);
2492 if (retval != 0) {
2493 printk(KERN_ERR "cyc:set_modem_info retval on ttyC%d "
2494 "was %x\n", info->line, retval);
2495 }
2496 }
2497 return 0;
2498 }
2499
2500 /*
2501 * cy_break() --- routine which turns the break handling on or off
2502 */
cy_break(struct tty_struct * tty,int break_state)2503 static int cy_break(struct tty_struct *tty, int break_state)
2504 {
2505 struct cyclades_port *info = tty->driver_data;
2506 struct cyclades_card *card;
2507 unsigned long flags;
2508 int retval = 0;
2509
2510 if (serial_paranoia_check(info, tty->name, "cy_break"))
2511 return -EINVAL;
2512
2513 card = info->card;
2514
2515 spin_lock_irqsave(&card->card_lock, flags);
2516 if (!cy_is_Z(card)) {
2517 /* Let the transmit ISR take care of this (since it
2518 requires stuffing characters into the output stream).
2519 */
2520 if (break_state == -1) {
2521 if (!info->breakon) {
2522 info->breakon = 1;
2523 if (!info->xmit_cnt) {
2524 spin_unlock_irqrestore(&card->card_lock, flags);
2525 start_xmit(info);
2526 spin_lock_irqsave(&card->card_lock, flags);
2527 }
2528 }
2529 } else {
2530 if (!info->breakoff) {
2531 info->breakoff = 1;
2532 if (!info->xmit_cnt) {
2533 spin_unlock_irqrestore(&card->card_lock, flags);
2534 start_xmit(info);
2535 spin_lock_irqsave(&card->card_lock, flags);
2536 }
2537 }
2538 }
2539 } else {
2540 if (break_state == -1) {
2541 retval = cyz_issue_cmd(card,
2542 info->line - card->first_line,
2543 C_CM_SET_BREAK, 0L);
2544 if (retval != 0) {
2545 printk(KERN_ERR "cyc:cy_break (set) retval on "
2546 "ttyC%d was %x\n", info->line, retval);
2547 }
2548 } else {
2549 retval = cyz_issue_cmd(card,
2550 info->line - card->first_line,
2551 C_CM_CLR_BREAK, 0L);
2552 if (retval != 0) {
2553 printk(KERN_DEBUG "cyc:cy_break (clr) retval "
2554 "on ttyC%d was %x\n", info->line,
2555 retval);
2556 }
2557 }
2558 }
2559 spin_unlock_irqrestore(&card->card_lock, flags);
2560 return retval;
2561 } /* cy_break */
2562
set_threshold(struct cyclades_port * info,unsigned long value)2563 static int set_threshold(struct cyclades_port *info, unsigned long value)
2564 {
2565 struct cyclades_card *card = info->card;
2566 unsigned long flags;
2567
2568 if (!cy_is_Z(card)) {
2569 info->cor3 &= ~CyREC_FIFO;
2570 info->cor3 |= value & CyREC_FIFO;
2571
2572 spin_lock_irqsave(&card->card_lock, flags);
2573 cyy_writeb(info, CyCOR3, info->cor3);
2574 cyy_issue_cmd(info, CyCOR_CHANGE | CyCOR3ch);
2575 spin_unlock_irqrestore(&card->card_lock, flags);
2576 }
2577 return 0;
2578 } /* set_threshold */
2579
get_threshold(struct cyclades_port * info,unsigned long __user * value)2580 static int get_threshold(struct cyclades_port *info,
2581 unsigned long __user *value)
2582 {
2583 struct cyclades_card *card = info->card;
2584
2585 if (!cy_is_Z(card)) {
2586 u8 tmp = cyy_readb(info, CyCOR3) & CyREC_FIFO;
2587 return put_user(tmp, value);
2588 }
2589 return 0;
2590 } /* get_threshold */
2591
set_timeout(struct cyclades_port * info,unsigned long value)2592 static int set_timeout(struct cyclades_port *info, unsigned long value)
2593 {
2594 struct cyclades_card *card = info->card;
2595 unsigned long flags;
2596
2597 if (!cy_is_Z(card)) {
2598 spin_lock_irqsave(&card->card_lock, flags);
2599 cyy_writeb(info, CyRTPR, value & 0xff);
2600 spin_unlock_irqrestore(&card->card_lock, flags);
2601 }
2602 return 0;
2603 } /* set_timeout */
2604
get_timeout(struct cyclades_port * info,unsigned long __user * value)2605 static int get_timeout(struct cyclades_port *info,
2606 unsigned long __user *value)
2607 {
2608 struct cyclades_card *card = info->card;
2609
2610 if (!cy_is_Z(card)) {
2611 u8 tmp = cyy_readb(info, CyRTPR);
2612 return put_user(tmp, value);
2613 }
2614 return 0;
2615 } /* get_timeout */
2616
cy_cflags_changed(struct cyclades_port * info,unsigned long arg,struct cyclades_icount * cprev)2617 static int cy_cflags_changed(struct cyclades_port *info, unsigned long arg,
2618 struct cyclades_icount *cprev)
2619 {
2620 struct cyclades_icount cnow;
2621 unsigned long flags;
2622 int ret;
2623
2624 spin_lock_irqsave(&info->card->card_lock, flags);
2625 cnow = info->icount; /* atomic copy */
2626 spin_unlock_irqrestore(&info->card->card_lock, flags);
2627
2628 ret = ((arg & TIOCM_RNG) && (cnow.rng != cprev->rng)) ||
2629 ((arg & TIOCM_DSR) && (cnow.dsr != cprev->dsr)) ||
2630 ((arg & TIOCM_CD) && (cnow.dcd != cprev->dcd)) ||
2631 ((arg & TIOCM_CTS) && (cnow.cts != cprev->cts));
2632
2633 *cprev = cnow;
2634
2635 return ret;
2636 }
2637
2638 /*
2639 * This routine allows the tty driver to implement device-
2640 * specific ioctl's. If the ioctl number passed in cmd is
2641 * not recognized by the driver, it should return ENOIOCTLCMD.
2642 */
2643 static int
cy_ioctl(struct tty_struct * tty,unsigned int cmd,unsigned long arg)2644 cy_ioctl(struct tty_struct *tty,
2645 unsigned int cmd, unsigned long arg)
2646 {
2647 struct cyclades_port *info = tty->driver_data;
2648 struct cyclades_icount cnow; /* kernel counter temps */
2649 int ret_val = 0;
2650 unsigned long flags;
2651 void __user *argp = (void __user *)arg;
2652
2653 if (serial_paranoia_check(info, tty->name, "cy_ioctl"))
2654 return -ENODEV;
2655
2656 #ifdef CY_DEBUG_OTHER
2657 printk(KERN_DEBUG "cyc:cy_ioctl ttyC%d, cmd = %x arg = %lx\n",
2658 info->line, cmd, arg);
2659 #endif
2660
2661 switch (cmd) {
2662 case CYGETMON:
2663 if (copy_to_user(argp, &info->mon, sizeof(info->mon))) {
2664 ret_val = -EFAULT;
2665 break;
2666 }
2667 memset(&info->mon, 0, sizeof(info->mon));
2668 break;
2669 case CYGETTHRESH:
2670 ret_val = get_threshold(info, argp);
2671 break;
2672 case CYSETTHRESH:
2673 ret_val = set_threshold(info, arg);
2674 break;
2675 case CYGETDEFTHRESH:
2676 ret_val = put_user(info->default_threshold,
2677 (unsigned long __user *)argp);
2678 break;
2679 case CYSETDEFTHRESH:
2680 info->default_threshold = arg & 0x0f;
2681 break;
2682 case CYGETTIMEOUT:
2683 ret_val = get_timeout(info, argp);
2684 break;
2685 case CYSETTIMEOUT:
2686 ret_val = set_timeout(info, arg);
2687 break;
2688 case CYGETDEFTIMEOUT:
2689 ret_val = put_user(info->default_timeout,
2690 (unsigned long __user *)argp);
2691 break;
2692 case CYSETDEFTIMEOUT:
2693 info->default_timeout = arg & 0xff;
2694 break;
2695 case CYSETRFLOW:
2696 info->rflow = (int)arg;
2697 break;
2698 case CYGETRFLOW:
2699 ret_val = info->rflow;
2700 break;
2701 case CYSETRTSDTR_INV:
2702 info->rtsdtr_inv = (int)arg;
2703 break;
2704 case CYGETRTSDTR_INV:
2705 ret_val = info->rtsdtr_inv;
2706 break;
2707 case CYGETCD1400VER:
2708 ret_val = info->chip_rev;
2709 break;
2710 #ifndef CONFIG_CYZ_INTR
2711 case CYZSETPOLLCYCLE:
2712 cyz_polling_cycle = (arg * HZ) / 1000;
2713 break;
2714 case CYZGETPOLLCYCLE:
2715 ret_val = (cyz_polling_cycle * 1000) / HZ;
2716 break;
2717 #endif /* CONFIG_CYZ_INTR */
2718 case CYSETWAIT:
2719 info->port.closing_wait = (unsigned short)arg * HZ / 100;
2720 break;
2721 case CYGETWAIT:
2722 ret_val = info->port.closing_wait / (HZ / 100);
2723 break;
2724 case TIOCGSERIAL:
2725 ret_val = cy_get_serial_info(info, argp);
2726 break;
2727 case TIOCSSERIAL:
2728 ret_val = cy_set_serial_info(info, tty, argp);
2729 break;
2730 case TIOCSERGETLSR: /* Get line status register */
2731 ret_val = get_lsr_info(info, argp);
2732 break;
2733 /*
2734 * Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change
2735 * - mask passed in arg for lines of interest
2736 * (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
2737 * Caller should use TIOCGICOUNT to see which one it was
2738 */
2739 case TIOCMIWAIT:
2740 spin_lock_irqsave(&info->card->card_lock, flags);
2741 /* note the counters on entry */
2742 cnow = info->icount;
2743 spin_unlock_irqrestore(&info->card->card_lock, flags);
2744 ret_val = wait_event_interruptible(info->port.delta_msr_wait,
2745 cy_cflags_changed(info, arg, &cnow));
2746 break;
2747
2748 /*
2749 * Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
2750 * Return: write counters to the user passed counter struct
2751 * NB: both 1->0 and 0->1 transitions are counted except for
2752 * RI where only 0->1 is counted.
2753 */
2754 default:
2755 ret_val = -ENOIOCTLCMD;
2756 }
2757
2758 #ifdef CY_DEBUG_OTHER
2759 printk(KERN_DEBUG "cyc:cy_ioctl done\n");
2760 #endif
2761 return ret_val;
2762 } /* cy_ioctl */
2763
cy_get_icount(struct tty_struct * tty,struct serial_icounter_struct * sic)2764 static int cy_get_icount(struct tty_struct *tty,
2765 struct serial_icounter_struct *sic)
2766 {
2767 struct cyclades_port *info = tty->driver_data;
2768 struct cyclades_icount cnow; /* Used to snapshot */
2769 unsigned long flags;
2770
2771 spin_lock_irqsave(&info->card->card_lock, flags);
2772 cnow = info->icount;
2773 spin_unlock_irqrestore(&info->card->card_lock, flags);
2774
2775 sic->cts = cnow.cts;
2776 sic->dsr = cnow.dsr;
2777 sic->rng = cnow.rng;
2778 sic->dcd = cnow.dcd;
2779 sic->rx = cnow.rx;
2780 sic->tx = cnow.tx;
2781 sic->frame = cnow.frame;
2782 sic->overrun = cnow.overrun;
2783 sic->parity = cnow.parity;
2784 sic->brk = cnow.brk;
2785 sic->buf_overrun = cnow.buf_overrun;
2786 return 0;
2787 }
2788
2789 /*
2790 * This routine allows the tty driver to be notified when
2791 * device's termios settings have changed. Note that a
2792 * well-designed tty driver should be prepared to accept the case
2793 * where old == NULL, and try to do something rational.
2794 */
cy_set_termios(struct tty_struct * tty,struct ktermios * old_termios)2795 static void cy_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
2796 {
2797 struct cyclades_port *info = tty->driver_data;
2798
2799 #ifdef CY_DEBUG_OTHER
2800 printk(KERN_DEBUG "cyc:cy_set_termios ttyC%d\n", info->line);
2801 #endif
2802
2803 cy_set_line_char(info, tty);
2804
2805 if ((old_termios->c_cflag & CRTSCTS) &&
2806 !(tty->termios.c_cflag & CRTSCTS)) {
2807 tty->hw_stopped = 0;
2808 cy_start(tty);
2809 }
2810 #if 0
2811 /*
2812 * No need to wake up processes in open wait, since they
2813 * sample the CLOCAL flag once, and don't recheck it.
2814 * XXX It's not clear whether the current behavior is correct
2815 * or not. Hence, this may change.....
2816 */
2817 if (!(old_termios->c_cflag & CLOCAL) &&
2818 (tty->termios.c_cflag & CLOCAL))
2819 wake_up_interruptible(&info->port.open_wait);
2820 #endif
2821 } /* cy_set_termios */
2822
2823 /* This function is used to send a high-priority XON/XOFF character to
2824 the device.
2825 */
cy_send_xchar(struct tty_struct * tty,char ch)2826 static void cy_send_xchar(struct tty_struct *tty, char ch)
2827 {
2828 struct cyclades_port *info = tty->driver_data;
2829 struct cyclades_card *card;
2830 int channel;
2831
2832 if (serial_paranoia_check(info, tty->name, "cy_send_xchar"))
2833 return;
2834
2835 info->x_char = ch;
2836
2837 if (ch)
2838 cy_start(tty);
2839
2840 card = info->card;
2841 channel = info->line - card->first_line;
2842
2843 if (cy_is_Z(card)) {
2844 if (ch == STOP_CHAR(tty))
2845 cyz_issue_cmd(card, channel, C_CM_SENDXOFF, 0L);
2846 else if (ch == START_CHAR(tty))
2847 cyz_issue_cmd(card, channel, C_CM_SENDXON, 0L);
2848 }
2849 }
2850
2851 /* This routine is called by the upper-layer tty layer to signal
2852 that incoming characters should be throttled because the input
2853 buffers are close to full.
2854 */
cy_throttle(struct tty_struct * tty)2855 static void cy_throttle(struct tty_struct *tty)
2856 {
2857 struct cyclades_port *info = tty->driver_data;
2858 struct cyclades_card *card;
2859 unsigned long flags;
2860
2861 #ifdef CY_DEBUG_THROTTLE
2862 char buf[64];
2863
2864 printk(KERN_DEBUG "cyc:throttle %s: %ld...ttyC%d\n", tty_name(tty, buf),
2865 tty->ldisc.chars_in_buffer(tty), info->line);
2866 #endif
2867
2868 if (serial_paranoia_check(info, tty->name, "cy_throttle"))
2869 return;
2870
2871 card = info->card;
2872
2873 if (I_IXOFF(tty)) {
2874 if (!cy_is_Z(card))
2875 cy_send_xchar(tty, STOP_CHAR(tty));
2876 else
2877 info->throttle = 1;
2878 }
2879
2880 if (tty->termios.c_cflag & CRTSCTS) {
2881 if (!cy_is_Z(card)) {
2882 spin_lock_irqsave(&card->card_lock, flags);
2883 cyy_change_rts_dtr(info, 0, TIOCM_RTS);
2884 spin_unlock_irqrestore(&card->card_lock, flags);
2885 } else {
2886 info->throttle = 1;
2887 }
2888 }
2889 } /* cy_throttle */
2890
2891 /*
2892 * This routine notifies the tty driver that it should signal
2893 * that characters can now be sent to the tty without fear of
2894 * overrunning the input buffers of the line disciplines.
2895 */
cy_unthrottle(struct tty_struct * tty)2896 static void cy_unthrottle(struct tty_struct *tty)
2897 {
2898 struct cyclades_port *info = tty->driver_data;
2899 struct cyclades_card *card;
2900 unsigned long flags;
2901
2902 #ifdef CY_DEBUG_THROTTLE
2903 char buf[64];
2904
2905 printk(KERN_DEBUG "cyc:unthrottle %s: %ld...ttyC%d\n",
2906 tty_name(tty, buf), tty_chars_in_buffer(tty), info->line);
2907 #endif
2908
2909 if (serial_paranoia_check(info, tty->name, "cy_unthrottle"))
2910 return;
2911
2912 if (I_IXOFF(tty)) {
2913 if (info->x_char)
2914 info->x_char = 0;
2915 else
2916 cy_send_xchar(tty, START_CHAR(tty));
2917 }
2918
2919 if (tty->termios.c_cflag & CRTSCTS) {
2920 card = info->card;
2921 if (!cy_is_Z(card)) {
2922 spin_lock_irqsave(&card->card_lock, flags);
2923 cyy_change_rts_dtr(info, TIOCM_RTS, 0);
2924 spin_unlock_irqrestore(&card->card_lock, flags);
2925 } else {
2926 info->throttle = 0;
2927 }
2928 }
2929 } /* cy_unthrottle */
2930
2931 /* cy_start and cy_stop provide software output flow control as a
2932 function of XON/XOFF, software CTS, and other such stuff.
2933 */
cy_stop(struct tty_struct * tty)2934 static void cy_stop(struct tty_struct *tty)
2935 {
2936 struct cyclades_card *cinfo;
2937 struct cyclades_port *info = tty->driver_data;
2938 int channel;
2939 unsigned long flags;
2940
2941 #ifdef CY_DEBUG_OTHER
2942 printk(KERN_DEBUG "cyc:cy_stop ttyC%d\n", info->line);
2943 #endif
2944
2945 if (serial_paranoia_check(info, tty->name, "cy_stop"))
2946 return;
2947
2948 cinfo = info->card;
2949 channel = info->line - cinfo->first_line;
2950 if (!cy_is_Z(cinfo)) {
2951 spin_lock_irqsave(&cinfo->card_lock, flags);
2952 cyy_writeb(info, CyCAR, channel & 0x03);
2953 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) & ~CyTxRdy);
2954 spin_unlock_irqrestore(&cinfo->card_lock, flags);
2955 }
2956 } /* cy_stop */
2957
cy_start(struct tty_struct * tty)2958 static void cy_start(struct tty_struct *tty)
2959 {
2960 struct cyclades_card *cinfo;
2961 struct cyclades_port *info = tty->driver_data;
2962 int channel;
2963 unsigned long flags;
2964
2965 #ifdef CY_DEBUG_OTHER
2966 printk(KERN_DEBUG "cyc:cy_start ttyC%d\n", info->line);
2967 #endif
2968
2969 if (serial_paranoia_check(info, tty->name, "cy_start"))
2970 return;
2971
2972 cinfo = info->card;
2973 channel = info->line - cinfo->first_line;
2974 if (!cy_is_Z(cinfo)) {
2975 spin_lock_irqsave(&cinfo->card_lock, flags);
2976 cyy_writeb(info, CyCAR, channel & 0x03);
2977 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyTxRdy);
2978 spin_unlock_irqrestore(&cinfo->card_lock, flags);
2979 }
2980 } /* cy_start */
2981
2982 /*
2983 * cy_hangup() --- called by tty_hangup() when a hangup is signaled.
2984 */
cy_hangup(struct tty_struct * tty)2985 static void cy_hangup(struct tty_struct *tty)
2986 {
2987 struct cyclades_port *info = tty->driver_data;
2988
2989 #ifdef CY_DEBUG_OTHER
2990 printk(KERN_DEBUG "cyc:cy_hangup ttyC%d\n", info->line);
2991 #endif
2992
2993 if (serial_paranoia_check(info, tty->name, "cy_hangup"))
2994 return;
2995
2996 cy_flush_buffer(tty);
2997 cy_shutdown(info, tty);
2998 tty_port_hangup(&info->port);
2999 } /* cy_hangup */
3000
cyy_carrier_raised(struct tty_port * port)3001 static int cyy_carrier_raised(struct tty_port *port)
3002 {
3003 struct cyclades_port *info = container_of(port, struct cyclades_port,
3004 port);
3005 struct cyclades_card *cinfo = info->card;
3006 unsigned long flags;
3007 int channel = info->line - cinfo->first_line;
3008 u32 cd;
3009
3010 spin_lock_irqsave(&cinfo->card_lock, flags);
3011 cyy_writeb(info, CyCAR, channel & 0x03);
3012 cd = cyy_readb(info, CyMSVR1) & CyDCD;
3013 spin_unlock_irqrestore(&cinfo->card_lock, flags);
3014
3015 return cd;
3016 }
3017
cyy_dtr_rts(struct tty_port * port,int raise)3018 static void cyy_dtr_rts(struct tty_port *port, int raise)
3019 {
3020 struct cyclades_port *info = container_of(port, struct cyclades_port,
3021 port);
3022 struct cyclades_card *cinfo = info->card;
3023 unsigned long flags;
3024
3025 spin_lock_irqsave(&cinfo->card_lock, flags);
3026 cyy_change_rts_dtr(info, raise ? TIOCM_RTS | TIOCM_DTR : 0,
3027 raise ? 0 : TIOCM_RTS | TIOCM_DTR);
3028 spin_unlock_irqrestore(&cinfo->card_lock, flags);
3029 }
3030
cyz_carrier_raised(struct tty_port * port)3031 static int cyz_carrier_raised(struct tty_port *port)
3032 {
3033 struct cyclades_port *info = container_of(port, struct cyclades_port,
3034 port);
3035
3036 return readl(&info->u.cyz.ch_ctrl->rs_status) & C_RS_DCD;
3037 }
3038
cyz_dtr_rts(struct tty_port * port,int raise)3039 static void cyz_dtr_rts(struct tty_port *port, int raise)
3040 {
3041 struct cyclades_port *info = container_of(port, struct cyclades_port,
3042 port);
3043 struct cyclades_card *cinfo = info->card;
3044 struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl;
3045 int ret, channel = info->line - cinfo->first_line;
3046 u32 rs;
3047
3048 rs = readl(&ch_ctrl->rs_control);
3049 if (raise)
3050 rs |= C_RS_RTS | C_RS_DTR;
3051 else
3052 rs &= ~(C_RS_RTS | C_RS_DTR);
3053 cy_writel(&ch_ctrl->rs_control, rs);
3054 ret = cyz_issue_cmd(cinfo, channel, C_CM_IOCTLM, 0L);
3055 if (ret != 0)
3056 printk(KERN_ERR "%s: retval on ttyC%d was %x\n",
3057 __func__, info->line, ret);
3058 #ifdef CY_DEBUG_DTR
3059 printk(KERN_DEBUG "%s: raising Z DTR\n", __func__);
3060 #endif
3061 }
3062
3063 static const struct tty_port_operations cyy_port_ops = {
3064 .carrier_raised = cyy_carrier_raised,
3065 .dtr_rts = cyy_dtr_rts,
3066 .shutdown = cy_do_close,
3067 };
3068
3069 static const struct tty_port_operations cyz_port_ops = {
3070 .carrier_raised = cyz_carrier_raised,
3071 .dtr_rts = cyz_dtr_rts,
3072 .shutdown = cy_do_close,
3073 };
3074
3075 /*
3076 * ---------------------------------------------------------------------
3077 * cy_init() and friends
3078 *
3079 * cy_init() is called at boot-time to initialize the serial driver.
3080 * ---------------------------------------------------------------------
3081 */
3082
cy_init_card(struct cyclades_card * cinfo)3083 static int cy_init_card(struct cyclades_card *cinfo)
3084 {
3085 struct cyclades_port *info;
3086 unsigned int channel, port;
3087
3088 spin_lock_init(&cinfo->card_lock);
3089 cinfo->intr_enabled = 0;
3090
3091 cinfo->ports = kcalloc(cinfo->nports, sizeof(*cinfo->ports),
3092 GFP_KERNEL);
3093 if (cinfo->ports == NULL) {
3094 printk(KERN_ERR "Cyclades: cannot allocate ports\n");
3095 return -ENOMEM;
3096 }
3097
3098 for (channel = 0, port = cinfo->first_line; channel < cinfo->nports;
3099 channel++, port++) {
3100 info = &cinfo->ports[channel];
3101 tty_port_init(&info->port);
3102 info->magic = CYCLADES_MAGIC;
3103 info->card = cinfo;
3104 info->line = port;
3105
3106 info->port.closing_wait = CLOSING_WAIT_DELAY;
3107 info->port.close_delay = 5 * HZ / 10;
3108 info->port.flags = STD_COM_FLAGS;
3109 init_completion(&info->shutdown_wait);
3110
3111 if (cy_is_Z(cinfo)) {
3112 struct FIRM_ID *firm_id = cinfo->base_addr + ID_ADDRESS;
3113 struct ZFW_CTRL *zfw_ctrl;
3114
3115 info->port.ops = &cyz_port_ops;
3116 info->type = PORT_STARTECH;
3117
3118 zfw_ctrl = cinfo->base_addr +
3119 (readl(&firm_id->zfwctrl_addr) & 0xfffff);
3120 info->u.cyz.ch_ctrl = &zfw_ctrl->ch_ctrl[channel];
3121 info->u.cyz.buf_ctrl = &zfw_ctrl->buf_ctrl[channel];
3122
3123 if (cinfo->hw_ver == ZO_V1)
3124 info->xmit_fifo_size = CYZ_FIFO_SIZE;
3125 else
3126 info->xmit_fifo_size = 4 * CYZ_FIFO_SIZE;
3127 #ifdef CONFIG_CYZ_INTR
3128 setup_timer(&cyz_rx_full_timer[port],
3129 cyz_rx_restart, (unsigned long)info);
3130 #endif
3131 } else {
3132 unsigned short chip_number;
3133 int index = cinfo->bus_index;
3134
3135 info->port.ops = &cyy_port_ops;
3136 info->type = PORT_CIRRUS;
3137 info->xmit_fifo_size = CyMAX_CHAR_FIFO;
3138 info->cor1 = CyPARITY_NONE | Cy_1_STOP | Cy_8_BITS;
3139 info->cor2 = CyETC;
3140 info->cor3 = 0x08; /* _very_ small rcv threshold */
3141
3142 chip_number = channel / CyPORTS_PER_CHIP;
3143 info->u.cyy.base_addr = cinfo->base_addr +
3144 (cy_chip_offset[chip_number] << index);
3145 info->chip_rev = cyy_readb(info, CyGFRCR);
3146
3147 if (info->chip_rev >= CD1400_REV_J) {
3148 /* It is a CD1400 rev. J or later */
3149 info->tbpr = baud_bpr_60[13]; /* Tx BPR */
3150 info->tco = baud_co_60[13]; /* Tx CO */
3151 info->rbpr = baud_bpr_60[13]; /* Rx BPR */
3152 info->rco = baud_co_60[13]; /* Rx CO */
3153 info->rtsdtr_inv = 1;
3154 } else {
3155 info->tbpr = baud_bpr_25[13]; /* Tx BPR */
3156 info->tco = baud_co_25[13]; /* Tx CO */
3157 info->rbpr = baud_bpr_25[13]; /* Rx BPR */
3158 info->rco = baud_co_25[13]; /* Rx CO */
3159 info->rtsdtr_inv = 0;
3160 }
3161 info->read_status_mask = CyTIMEOUT | CySPECHAR |
3162 CyBREAK | CyPARITY | CyFRAME | CyOVERRUN;
3163 }
3164
3165 }
3166
3167 #ifndef CONFIG_CYZ_INTR
3168 if (cy_is_Z(cinfo) && !timer_pending(&cyz_timerlist)) {
3169 mod_timer(&cyz_timerlist, jiffies + 1);
3170 #ifdef CY_PCI_DEBUG
3171 printk(KERN_DEBUG "Cyclades-Z polling initialized\n");
3172 #endif
3173 }
3174 #endif
3175 return 0;
3176 }
3177
3178 /* initialize chips on Cyclom-Y card -- return number of valid
3179 chips (which is number of ports/4) */
cyy_init_card(void __iomem * true_base_addr,int index)3180 static unsigned short cyy_init_card(void __iomem *true_base_addr,
3181 int index)
3182 {
3183 unsigned int chip_number;
3184 void __iomem *base_addr;
3185
3186 cy_writeb(true_base_addr + (Cy_HwReset << index), 0);
3187 /* Cy_HwReset is 0x1400 */
3188 cy_writeb(true_base_addr + (Cy_ClrIntr << index), 0);
3189 /* Cy_ClrIntr is 0x1800 */
3190 udelay(500L);
3191
3192 for (chip_number = 0; chip_number < CyMAX_CHIPS_PER_CARD;
3193 chip_number++) {
3194 base_addr =
3195 true_base_addr + (cy_chip_offset[chip_number] << index);
3196 mdelay(1);
3197 if (readb(base_addr + (CyCCR << index)) != 0x00) {
3198 /*************
3199 printk(" chip #%d at %#6lx is never idle (CCR != 0)\n",
3200 chip_number, (unsigned long)base_addr);
3201 *************/
3202 return chip_number;
3203 }
3204
3205 cy_writeb(base_addr + (CyGFRCR << index), 0);
3206 udelay(10L);
3207
3208 /* The Cyclom-16Y does not decode address bit 9 and therefore
3209 cannot distinguish between references to chip 0 and a non-
3210 existent chip 4. If the preceding clearing of the supposed
3211 chip 4 GFRCR register appears at chip 0, there is no chip 4
3212 and this must be a Cyclom-16Y, not a Cyclom-32Ye.
3213 */
3214 if (chip_number == 4 && readb(true_base_addr +
3215 (cy_chip_offset[0] << index) +
3216 (CyGFRCR << index)) == 0) {
3217 return chip_number;
3218 }
3219
3220 cy_writeb(base_addr + (CyCCR << index), CyCHIP_RESET);
3221 mdelay(1);
3222
3223 if (readb(base_addr + (CyGFRCR << index)) == 0x00) {
3224 /*
3225 printk(" chip #%d at %#6lx is not responding ",
3226 chip_number, (unsigned long)base_addr);
3227 printk("(GFRCR stayed 0)\n",
3228 */
3229 return chip_number;
3230 }
3231 if ((0xf0 & (readb(base_addr + (CyGFRCR << index)))) !=
3232 0x40) {
3233 /*
3234 printk(" chip #%d at %#6lx is not valid (GFRCR == "
3235 "%#2x)\n",
3236 chip_number, (unsigned long)base_addr,
3237 base_addr[CyGFRCR<<index]);
3238 */
3239 return chip_number;
3240 }
3241 cy_writeb(base_addr + (CyGCR << index), CyCH0_SERIAL);
3242 if (readb(base_addr + (CyGFRCR << index)) >= CD1400_REV_J) {
3243 /* It is a CD1400 rev. J or later */
3244 /* Impossible to reach 5ms with this chip.
3245 Changed to 2ms instead (f = 500 Hz). */
3246 cy_writeb(base_addr + (CyPPR << index), CyCLOCK_60_2MS);
3247 } else {
3248 /* f = 200 Hz */
3249 cy_writeb(base_addr + (CyPPR << index), CyCLOCK_25_5MS);
3250 }
3251
3252 /*
3253 printk(" chip #%d at %#6lx is rev 0x%2x\n",
3254 chip_number, (unsigned long)base_addr,
3255 readb(base_addr+(CyGFRCR<<index)));
3256 */
3257 }
3258 return chip_number;
3259 } /* cyy_init_card */
3260
3261 /*
3262 * ---------------------------------------------------------------------
3263 * cy_detect_isa() - Probe for Cyclom-Y/ISA boards.
3264 * sets global variables and return the number of ISA boards found.
3265 * ---------------------------------------------------------------------
3266 */
cy_detect_isa(void)3267 static int __init cy_detect_isa(void)
3268 {
3269 #ifdef CONFIG_ISA
3270 struct cyclades_card *card;
3271 unsigned short cy_isa_irq, nboard;
3272 void __iomem *cy_isa_address;
3273 unsigned short i, j, k, cy_isa_nchan;
3274 int isparam = 0;
3275
3276 nboard = 0;
3277
3278 /* Check for module parameters */
3279 for (i = 0; i < NR_CARDS; i++) {
3280 if (maddr[i] || i) {
3281 isparam = 1;
3282 cy_isa_addresses[i] = maddr[i];
3283 }
3284 if (!maddr[i])
3285 break;
3286 }
3287
3288 /* scan the address table probing for Cyclom-Y/ISA boards */
3289 for (i = 0; i < NR_ISA_ADDRS; i++) {
3290 unsigned int isa_address = cy_isa_addresses[i];
3291 if (isa_address == 0x0000)
3292 return nboard;
3293
3294 /* probe for CD1400... */
3295 cy_isa_address = ioremap_nocache(isa_address, CyISA_Ywin);
3296 if (cy_isa_address == NULL) {
3297 printk(KERN_ERR "Cyclom-Y/ISA: can't remap base "
3298 "address\n");
3299 continue;
3300 }
3301 cy_isa_nchan = CyPORTS_PER_CHIP *
3302 cyy_init_card(cy_isa_address, 0);
3303 if (cy_isa_nchan == 0) {
3304 iounmap(cy_isa_address);
3305 continue;
3306 }
3307
3308 if (isparam && i < NR_CARDS && irq[i])
3309 cy_isa_irq = irq[i];
3310 else
3311 /* find out the board's irq by probing */
3312 cy_isa_irq = detect_isa_irq(cy_isa_address);
3313 if (cy_isa_irq == 0) {
3314 printk(KERN_ERR "Cyclom-Y/ISA found at 0x%lx, but the "
3315 "IRQ could not be detected.\n",
3316 (unsigned long)cy_isa_address);
3317 iounmap(cy_isa_address);
3318 continue;
3319 }
3320
3321 if ((cy_next_channel + cy_isa_nchan) > NR_PORTS) {
3322 printk(KERN_ERR "Cyclom-Y/ISA found at 0x%lx, but no "
3323 "more channels are available. Change NR_PORTS "
3324 "in cyclades.c and recompile kernel.\n",
3325 (unsigned long)cy_isa_address);
3326 iounmap(cy_isa_address);
3327 return nboard;
3328 }
3329 /* fill the next cy_card structure available */
3330 for (j = 0; j < NR_CARDS; j++) {
3331 card = &cy_card[j];
3332 if (card->base_addr == NULL)
3333 break;
3334 }
3335 if (j == NR_CARDS) { /* no more cy_cards available */
3336 printk(KERN_ERR "Cyclom-Y/ISA found at 0x%lx, but no "
3337 "more cards can be used. Change NR_CARDS in "
3338 "cyclades.c and recompile kernel.\n",
3339 (unsigned long)cy_isa_address);
3340 iounmap(cy_isa_address);
3341 return nboard;
3342 }
3343
3344 /* allocate IRQ */
3345 if (request_irq(cy_isa_irq, cyy_interrupt,
3346 0, "Cyclom-Y", card)) {
3347 printk(KERN_ERR "Cyclom-Y/ISA found at 0x%lx, but "
3348 "could not allocate IRQ#%d.\n",
3349 (unsigned long)cy_isa_address, cy_isa_irq);
3350 iounmap(cy_isa_address);
3351 return nboard;
3352 }
3353
3354 /* set cy_card */
3355 card->base_addr = cy_isa_address;
3356 card->ctl_addr.p9050 = NULL;
3357 card->irq = (int)cy_isa_irq;
3358 card->bus_index = 0;
3359 card->first_line = cy_next_channel;
3360 card->num_chips = cy_isa_nchan / CyPORTS_PER_CHIP;
3361 card->nports = cy_isa_nchan;
3362 if (cy_init_card(card)) {
3363 card->base_addr = NULL;
3364 free_irq(cy_isa_irq, card);
3365 iounmap(cy_isa_address);
3366 continue;
3367 }
3368 nboard++;
3369
3370 printk(KERN_INFO "Cyclom-Y/ISA #%d: 0x%lx-0x%lx, IRQ%d found: "
3371 "%d channels starting from port %d\n",
3372 j + 1, (unsigned long)cy_isa_address,
3373 (unsigned long)(cy_isa_address + (CyISA_Ywin - 1)),
3374 cy_isa_irq, cy_isa_nchan, cy_next_channel);
3375
3376 for (k = 0, j = cy_next_channel;
3377 j < cy_next_channel + cy_isa_nchan; j++, k++)
3378 tty_port_register_device(&card->ports[k].port,
3379 cy_serial_driver, j, NULL);
3380 cy_next_channel += cy_isa_nchan;
3381 }
3382 return nboard;
3383 #else
3384 return 0;
3385 #endif /* CONFIG_ISA */
3386 } /* cy_detect_isa */
3387
3388 #ifdef CONFIG_PCI
cyc_isfwstr(const char * str,unsigned int size)3389 static inline int cyc_isfwstr(const char *str, unsigned int size)
3390 {
3391 unsigned int a;
3392
3393 for (a = 0; a < size && *str; a++, str++)
3394 if (*str & 0x80)
3395 return -EINVAL;
3396
3397 for (; a < size; a++, str++)
3398 if (*str)
3399 return -EINVAL;
3400
3401 return 0;
3402 }
3403
cyz_fpga_copy(void __iomem * fpga,const u8 * data,unsigned int size)3404 static inline void cyz_fpga_copy(void __iomem *fpga, const u8 *data,
3405 unsigned int size)
3406 {
3407 for (; size > 0; size--) {
3408 cy_writel(fpga, *data++);
3409 udelay(10);
3410 }
3411 }
3412
plx_init(struct pci_dev * pdev,int irq,struct RUNTIME_9060 __iomem * addr)3413 static void plx_init(struct pci_dev *pdev, int irq,
3414 struct RUNTIME_9060 __iomem *addr)
3415 {
3416 /* Reset PLX */
3417 cy_writel(&addr->init_ctrl, readl(&addr->init_ctrl) | 0x40000000);
3418 udelay(100L);
3419 cy_writel(&addr->init_ctrl, readl(&addr->init_ctrl) & ~0x40000000);
3420
3421 /* Reload Config. Registers from EEPROM */
3422 cy_writel(&addr->init_ctrl, readl(&addr->init_ctrl) | 0x20000000);
3423 udelay(100L);
3424 cy_writel(&addr->init_ctrl, readl(&addr->init_ctrl) & ~0x20000000);
3425
3426 /* For some yet unknown reason, once the PLX9060 reloads the EEPROM,
3427 * the IRQ is lost and, thus, we have to re-write it to the PCI config.
3428 * registers. This will remain here until we find a permanent fix.
3429 */
3430 pci_write_config_byte(pdev, PCI_INTERRUPT_LINE, irq);
3431 }
3432
__cyz_load_fw(const struct firmware * fw,const char * name,const u32 mailbox,void __iomem * base,void __iomem * fpga)3433 static int __cyz_load_fw(const struct firmware *fw,
3434 const char *name, const u32 mailbox, void __iomem *base,
3435 void __iomem *fpga)
3436 {
3437 const void *ptr = fw->data;
3438 const struct zfile_header *h = ptr;
3439 const struct zfile_config *c, *cs;
3440 const struct zfile_block *b, *bs;
3441 unsigned int a, tmp, len = fw->size;
3442 #define BAD_FW KERN_ERR "Bad firmware: "
3443 if (len < sizeof(*h)) {
3444 printk(BAD_FW "too short: %u<%zu\n", len, sizeof(*h));
3445 return -EINVAL;
3446 }
3447
3448 cs = ptr + h->config_offset;
3449 bs = ptr + h->block_offset;
3450
3451 if ((void *)(cs + h->n_config) > ptr + len ||
3452 (void *)(bs + h->n_blocks) > ptr + len) {
3453 printk(BAD_FW "too short");
3454 return -EINVAL;
3455 }
3456
3457 if (cyc_isfwstr(h->name, sizeof(h->name)) ||
3458 cyc_isfwstr(h->date, sizeof(h->date))) {
3459 printk(BAD_FW "bad formatted header string\n");
3460 return -EINVAL;
3461 }
3462
3463 if (strncmp(name, h->name, sizeof(h->name))) {
3464 printk(BAD_FW "bad name '%s' (expected '%s')\n", h->name, name);
3465 return -EINVAL;
3466 }
3467
3468 tmp = 0;
3469 for (c = cs; c < cs + h->n_config; c++) {
3470 for (a = 0; a < c->n_blocks; a++)
3471 if (c->block_list[a] > h->n_blocks) {
3472 printk(BAD_FW "bad block ref number in cfgs\n");
3473 return -EINVAL;
3474 }
3475 if (c->mailbox == mailbox && c->function == 0) /* 0 is normal */
3476 tmp++;
3477 }
3478 if (!tmp) {
3479 printk(BAD_FW "nothing appropriate\n");
3480 return -EINVAL;
3481 }
3482
3483 for (b = bs; b < bs + h->n_blocks; b++)
3484 if (b->file_offset + b->size > len) {
3485 printk(BAD_FW "bad block data offset\n");
3486 return -EINVAL;
3487 }
3488
3489 /* everything is OK, let's seek'n'load it */
3490 for (c = cs; c < cs + h->n_config; c++)
3491 if (c->mailbox == mailbox && c->function == 0)
3492 break;
3493
3494 for (a = 0; a < c->n_blocks; a++) {
3495 b = &bs[c->block_list[a]];
3496 if (b->type == ZBLOCK_FPGA) {
3497 if (fpga != NULL)
3498 cyz_fpga_copy(fpga, ptr + b->file_offset,
3499 b->size);
3500 } else {
3501 if (base != NULL)
3502 memcpy_toio(base + b->ram_offset,
3503 ptr + b->file_offset, b->size);
3504 }
3505 }
3506 #undef BAD_FW
3507 return 0;
3508 }
3509
cyz_load_fw(struct pci_dev * pdev,void __iomem * base_addr,struct RUNTIME_9060 __iomem * ctl_addr,int irq)3510 static int cyz_load_fw(struct pci_dev *pdev, void __iomem *base_addr,
3511 struct RUNTIME_9060 __iomem *ctl_addr, int irq)
3512 {
3513 const struct firmware *fw;
3514 struct FIRM_ID __iomem *fid = base_addr + ID_ADDRESS;
3515 struct CUSTOM_REG __iomem *cust = base_addr;
3516 struct ZFW_CTRL __iomem *pt_zfwctrl;
3517 void __iomem *tmp;
3518 u32 mailbox, status, nchan;
3519 unsigned int i;
3520 int retval;
3521
3522 retval = request_firmware(&fw, "cyzfirm.bin", &pdev->dev);
3523 if (retval) {
3524 dev_err(&pdev->dev, "can't get firmware\n");
3525 goto err;
3526 }
3527
3528 /* Check whether the firmware is already loaded and running. If
3529 positive, skip this board */
3530 if (__cyz_fpga_loaded(ctl_addr) && readl(&fid->signature) == ZFIRM_ID) {
3531 u32 cntval = readl(base_addr + 0x190);
3532
3533 udelay(100);
3534 if (cntval != readl(base_addr + 0x190)) {
3535 /* FW counter is working, FW is running */
3536 dev_dbg(&pdev->dev, "Cyclades-Z FW already loaded. "
3537 "Skipping board.\n");
3538 retval = 0;
3539 goto err_rel;
3540 }
3541 }
3542
3543 /* start boot */
3544 cy_writel(&ctl_addr->intr_ctrl_stat, readl(&ctl_addr->intr_ctrl_stat) &
3545 ~0x00030800UL);
3546
3547 mailbox = readl(&ctl_addr->mail_box_0);
3548
3549 if (mailbox == 0 || __cyz_fpga_loaded(ctl_addr)) {
3550 /* stops CPU and set window to beginning of RAM */
3551 cy_writel(&ctl_addr->loc_addr_base, WIN_CREG);
3552 cy_writel(&cust->cpu_stop, 0);
3553 cy_writel(&ctl_addr->loc_addr_base, WIN_RAM);
3554 udelay(100);
3555 }
3556
3557 plx_init(pdev, irq, ctl_addr);
3558
3559 if (mailbox != 0) {
3560 /* load FPGA */
3561 retval = __cyz_load_fw(fw, "Cyclom-Z", mailbox, NULL,
3562 base_addr);
3563 if (retval)
3564 goto err_rel;
3565 if (!__cyz_fpga_loaded(ctl_addr)) {
3566 dev_err(&pdev->dev, "fw upload successful, but fw is "
3567 "not loaded\n");
3568 goto err_rel;
3569 }
3570 }
3571
3572 /* stops CPU and set window to beginning of RAM */
3573 cy_writel(&ctl_addr->loc_addr_base, WIN_CREG);
3574 cy_writel(&cust->cpu_stop, 0);
3575 cy_writel(&ctl_addr->loc_addr_base, WIN_RAM);
3576 udelay(100);
3577
3578 /* clear memory */
3579 for (tmp = base_addr; tmp < base_addr + RAM_SIZE; tmp++)
3580 cy_writeb(tmp, 255);
3581 if (mailbox != 0) {
3582 /* set window to last 512K of RAM */
3583 cy_writel(&ctl_addr->loc_addr_base, WIN_RAM + RAM_SIZE);
3584 for (tmp = base_addr; tmp < base_addr + RAM_SIZE; tmp++)
3585 cy_writeb(tmp, 255);
3586 /* set window to beginning of RAM */
3587 cy_writel(&ctl_addr->loc_addr_base, WIN_RAM);
3588 }
3589
3590 retval = __cyz_load_fw(fw, "Cyclom-Z", mailbox, base_addr, NULL);
3591 release_firmware(fw);
3592 if (retval)
3593 goto err;
3594
3595 /* finish boot and start boards */
3596 cy_writel(&ctl_addr->loc_addr_base, WIN_CREG);
3597 cy_writel(&cust->cpu_start, 0);
3598 cy_writel(&ctl_addr->loc_addr_base, WIN_RAM);
3599 i = 0;
3600 while ((status = readl(&fid->signature)) != ZFIRM_ID && i++ < 40)
3601 msleep(100);
3602 if (status != ZFIRM_ID) {
3603 if (status == ZFIRM_HLT) {
3604 dev_err(&pdev->dev, "you need an external power supply "
3605 "for this number of ports. Firmware halted and "
3606 "board reset.\n");
3607 retval = -EIO;
3608 goto err;
3609 }
3610 dev_warn(&pdev->dev, "fid->signature = 0x%x... Waiting "
3611 "some more time\n", status);
3612 while ((status = readl(&fid->signature)) != ZFIRM_ID &&
3613 i++ < 200)
3614 msleep(100);
3615 if (status != ZFIRM_ID) {
3616 dev_err(&pdev->dev, "Board not started in 20 seconds! "
3617 "Giving up. (fid->signature = 0x%x)\n",
3618 status);
3619 dev_info(&pdev->dev, "*** Warning ***: if you are "
3620 "upgrading the FW, please power cycle the "
3621 "system before loading the new FW to the "
3622 "Cyclades-Z.\n");
3623
3624 if (__cyz_fpga_loaded(ctl_addr))
3625 plx_init(pdev, irq, ctl_addr);
3626
3627 retval = -EIO;
3628 goto err;
3629 }
3630 dev_dbg(&pdev->dev, "Firmware started after %d seconds.\n",
3631 i / 10);
3632 }
3633 pt_zfwctrl = base_addr + readl(&fid->zfwctrl_addr);
3634
3635 dev_dbg(&pdev->dev, "fid=> %p, zfwctrl_addr=> %x, npt_zfwctrl=> %p\n",
3636 base_addr + ID_ADDRESS, readl(&fid->zfwctrl_addr),
3637 base_addr + readl(&fid->zfwctrl_addr));
3638
3639 nchan = readl(&pt_zfwctrl->board_ctrl.n_channel);
3640 dev_info(&pdev->dev, "Cyclades-Z FW loaded: version = %x, ports = %u\n",
3641 readl(&pt_zfwctrl->board_ctrl.fw_version), nchan);
3642
3643 if (nchan == 0) {
3644 dev_warn(&pdev->dev, "no Cyclades-Z ports were found. Please "
3645 "check the connection between the Z host card and the "
3646 "serial expanders.\n");
3647
3648 if (__cyz_fpga_loaded(ctl_addr))
3649 plx_init(pdev, irq, ctl_addr);
3650
3651 dev_info(&pdev->dev, "Null number of ports detected. Board "
3652 "reset.\n");
3653 retval = 0;
3654 goto err;
3655 }
3656
3657 cy_writel(&pt_zfwctrl->board_ctrl.op_system, C_OS_LINUX);
3658 cy_writel(&pt_zfwctrl->board_ctrl.dr_version, DRIVER_VERSION);
3659
3660 /*
3661 Early firmware failed to start looking for commands.
3662 This enables firmware interrupts for those commands.
3663 */
3664 cy_writel(&ctl_addr->intr_ctrl_stat, readl(&ctl_addr->intr_ctrl_stat) |
3665 (1 << 17));
3666 cy_writel(&ctl_addr->intr_ctrl_stat, readl(&ctl_addr->intr_ctrl_stat) |
3667 0x00030800UL);
3668
3669 return nchan;
3670 err_rel:
3671 release_firmware(fw);
3672 err:
3673 return retval;
3674 }
3675
cy_pci_probe(struct pci_dev * pdev,const struct pci_device_id * ent)3676 static int cy_pci_probe(struct pci_dev *pdev,
3677 const struct pci_device_id *ent)
3678 {
3679 struct cyclades_card *card;
3680 void __iomem *addr0 = NULL, *addr2 = NULL;
3681 char *card_name = NULL;
3682 u32 uninitialized_var(mailbox);
3683 unsigned int device_id, nchan = 0, card_no, i, j;
3684 unsigned char plx_ver;
3685 int retval, irq;
3686
3687 retval = pci_enable_device(pdev);
3688 if (retval) {
3689 dev_err(&pdev->dev, "cannot enable device\n");
3690 goto err;
3691 }
3692
3693 /* read PCI configuration area */
3694 irq = pdev->irq;
3695 device_id = pdev->device & ~PCI_DEVICE_ID_MASK;
3696
3697 #if defined(__alpha__)
3698 if (device_id == PCI_DEVICE_ID_CYCLOM_Y_Lo) { /* below 1M? */
3699 dev_err(&pdev->dev, "Cyclom-Y/PCI not supported for low "
3700 "addresses on Alpha systems.\n");
3701 retval = -EIO;
3702 goto err_dis;
3703 }
3704 #endif
3705 if (device_id == PCI_DEVICE_ID_CYCLOM_Z_Lo) {
3706 dev_err(&pdev->dev, "Cyclades-Z/PCI not supported for low "
3707 "addresses\n");
3708 retval = -EIO;
3709 goto err_dis;
3710 }
3711
3712 if (pci_resource_flags(pdev, 2) & IORESOURCE_IO) {
3713 dev_warn(&pdev->dev, "PCI I/O bit incorrectly set. Ignoring "
3714 "it...\n");
3715 pdev->resource[2].flags &= ~IORESOURCE_IO;
3716 }
3717
3718 retval = pci_request_regions(pdev, "cyclades");
3719 if (retval) {
3720 dev_err(&pdev->dev, "failed to reserve resources\n");
3721 goto err_dis;
3722 }
3723
3724 retval = -EIO;
3725 if (device_id == PCI_DEVICE_ID_CYCLOM_Y_Lo ||
3726 device_id == PCI_DEVICE_ID_CYCLOM_Y_Hi) {
3727 card_name = "Cyclom-Y";
3728
3729 addr0 = ioremap_nocache(pci_resource_start(pdev, 0),
3730 CyPCI_Yctl);
3731 if (addr0 == NULL) {
3732 dev_err(&pdev->dev, "can't remap ctl region\n");
3733 goto err_reg;
3734 }
3735 addr2 = ioremap_nocache(pci_resource_start(pdev, 2),
3736 CyPCI_Ywin);
3737 if (addr2 == NULL) {
3738 dev_err(&pdev->dev, "can't remap base region\n");
3739 goto err_unmap;
3740 }
3741
3742 nchan = CyPORTS_PER_CHIP * cyy_init_card(addr2, 1);
3743 if (nchan == 0) {
3744 dev_err(&pdev->dev, "Cyclom-Y PCI host card with no "
3745 "Serial-Modules\n");
3746 goto err_unmap;
3747 }
3748 } else if (device_id == PCI_DEVICE_ID_CYCLOM_Z_Hi) {
3749 struct RUNTIME_9060 __iomem *ctl_addr;
3750
3751 ctl_addr = addr0 = ioremap_nocache(pci_resource_start(pdev, 0),
3752 CyPCI_Zctl);
3753 if (addr0 == NULL) {
3754 dev_err(&pdev->dev, "can't remap ctl region\n");
3755 goto err_reg;
3756 }
3757
3758 /* Disable interrupts on the PLX before resetting it */
3759 cy_writew(&ctl_addr->intr_ctrl_stat,
3760 readw(&ctl_addr->intr_ctrl_stat) & ~0x0900);
3761
3762 plx_init(pdev, irq, addr0);
3763
3764 mailbox = readl(&ctl_addr->mail_box_0);
3765
3766 addr2 = ioremap_nocache(pci_resource_start(pdev, 2),
3767 mailbox == ZE_V1 ? CyPCI_Ze_win : CyPCI_Zwin);
3768 if (addr2 == NULL) {
3769 dev_err(&pdev->dev, "can't remap base region\n");
3770 goto err_unmap;
3771 }
3772
3773 if (mailbox == ZE_V1) {
3774 card_name = "Cyclades-Ze";
3775 } else {
3776 card_name = "Cyclades-8Zo";
3777 #ifdef CY_PCI_DEBUG
3778 if (mailbox == ZO_V1) {
3779 cy_writel(&ctl_addr->loc_addr_base, WIN_CREG);
3780 dev_info(&pdev->dev, "Cyclades-8Zo/PCI: FPGA "
3781 "id %lx, ver %lx\n", (ulong)(0xff &
3782 readl(&((struct CUSTOM_REG *)addr2)->
3783 fpga_id)), (ulong)(0xff &
3784 readl(&((struct CUSTOM_REG *)addr2)->
3785 fpga_version)));
3786 cy_writel(&ctl_addr->loc_addr_base, WIN_RAM);
3787 } else {
3788 dev_info(&pdev->dev, "Cyclades-Z/PCI: New "
3789 "Cyclades-Z board. FPGA not loaded\n");
3790 }
3791 #endif
3792 /* The following clears the firmware id word. This
3793 ensures that the driver will not attempt to talk to
3794 the board until it has been properly initialized.
3795 */
3796 if ((mailbox == ZO_V1) || (mailbox == ZO_V2))
3797 cy_writel(addr2 + ID_ADDRESS, 0L);
3798 }
3799
3800 retval = cyz_load_fw(pdev, addr2, addr0, irq);
3801 if (retval <= 0)
3802 goto err_unmap;
3803 nchan = retval;
3804 }
3805
3806 if ((cy_next_channel + nchan) > NR_PORTS) {
3807 dev_err(&pdev->dev, "Cyclades-8Zo/PCI found, but no "
3808 "channels are available. Change NR_PORTS in "
3809 "cyclades.c and recompile kernel.\n");
3810 goto err_unmap;
3811 }
3812 /* fill the next cy_card structure available */
3813 for (card_no = 0; card_no < NR_CARDS; card_no++) {
3814 card = &cy_card[card_no];
3815 if (card->base_addr == NULL)
3816 break;
3817 }
3818 if (card_no == NR_CARDS) { /* no more cy_cards available */
3819 dev_err(&pdev->dev, "Cyclades-8Zo/PCI found, but no "
3820 "more cards can be used. Change NR_CARDS in "
3821 "cyclades.c and recompile kernel.\n");
3822 goto err_unmap;
3823 }
3824
3825 if (device_id == PCI_DEVICE_ID_CYCLOM_Y_Lo ||
3826 device_id == PCI_DEVICE_ID_CYCLOM_Y_Hi) {
3827 /* allocate IRQ */
3828 retval = request_irq(irq, cyy_interrupt,
3829 IRQF_SHARED, "Cyclom-Y", card);
3830 if (retval) {
3831 dev_err(&pdev->dev, "could not allocate IRQ\n");
3832 goto err_unmap;
3833 }
3834 card->num_chips = nchan / CyPORTS_PER_CHIP;
3835 } else {
3836 struct FIRM_ID __iomem *firm_id = addr2 + ID_ADDRESS;
3837 struct ZFW_CTRL __iomem *zfw_ctrl;
3838
3839 zfw_ctrl = addr2 + (readl(&firm_id->zfwctrl_addr) & 0xfffff);
3840
3841 card->hw_ver = mailbox;
3842 card->num_chips = (unsigned int)-1;
3843 card->board_ctrl = &zfw_ctrl->board_ctrl;
3844 #ifdef CONFIG_CYZ_INTR
3845 /* allocate IRQ only if board has an IRQ */
3846 if (irq != 0 && irq != 255) {
3847 retval = request_irq(irq, cyz_interrupt,
3848 IRQF_SHARED, "Cyclades-Z", card);
3849 if (retval) {
3850 dev_err(&pdev->dev, "could not allocate IRQ\n");
3851 goto err_unmap;
3852 }
3853 }
3854 #endif /* CONFIG_CYZ_INTR */
3855 }
3856
3857 /* set cy_card */
3858 card->base_addr = addr2;
3859 card->ctl_addr.p9050 = addr0;
3860 card->irq = irq;
3861 card->bus_index = 1;
3862 card->first_line = cy_next_channel;
3863 card->nports = nchan;
3864 retval = cy_init_card(card);
3865 if (retval)
3866 goto err_null;
3867
3868 pci_set_drvdata(pdev, card);
3869
3870 if (device_id == PCI_DEVICE_ID_CYCLOM_Y_Lo ||
3871 device_id == PCI_DEVICE_ID_CYCLOM_Y_Hi) {
3872 /* enable interrupts in the PCI interface */
3873 plx_ver = readb(addr2 + CyPLX_VER) & 0x0f;
3874 switch (plx_ver) {
3875 case PLX_9050:
3876 cy_writeb(addr0 + 0x4c, 0x43);
3877 break;
3878
3879 case PLX_9060:
3880 case PLX_9080:
3881 default: /* Old boards, use PLX_9060 */
3882 {
3883 struct RUNTIME_9060 __iomem *ctl_addr = addr0;
3884 plx_init(pdev, irq, ctl_addr);
3885 cy_writew(&ctl_addr->intr_ctrl_stat,
3886 readw(&ctl_addr->intr_ctrl_stat) | 0x0900);
3887 break;
3888 }
3889 }
3890 }
3891
3892 dev_info(&pdev->dev, "%s/PCI #%d found: %d channels starting from "
3893 "port %d.\n", card_name, card_no + 1, nchan, cy_next_channel);
3894 for (j = 0, i = cy_next_channel; i < cy_next_channel + nchan; i++, j++)
3895 tty_port_register_device(&card->ports[j].port,
3896 cy_serial_driver, i, &pdev->dev);
3897 cy_next_channel += nchan;
3898
3899 return 0;
3900 err_null:
3901 card->base_addr = NULL;
3902 free_irq(irq, card);
3903 err_unmap:
3904 iounmap(addr0);
3905 if (addr2)
3906 iounmap(addr2);
3907 err_reg:
3908 pci_release_regions(pdev);
3909 err_dis:
3910 pci_disable_device(pdev);
3911 err:
3912 return retval;
3913 }
3914
cy_pci_remove(struct pci_dev * pdev)3915 static void cy_pci_remove(struct pci_dev *pdev)
3916 {
3917 struct cyclades_card *cinfo = pci_get_drvdata(pdev);
3918 unsigned int i, channel;
3919
3920 /* non-Z with old PLX */
3921 if (!cy_is_Z(cinfo) && (readb(cinfo->base_addr + CyPLX_VER) & 0x0f) ==
3922 PLX_9050)
3923 cy_writeb(cinfo->ctl_addr.p9050 + 0x4c, 0);
3924 else
3925 #ifndef CONFIG_CYZ_INTR
3926 if (!cy_is_Z(cinfo))
3927 #endif
3928 cy_writew(&cinfo->ctl_addr.p9060->intr_ctrl_stat,
3929 readw(&cinfo->ctl_addr.p9060->intr_ctrl_stat) &
3930 ~0x0900);
3931
3932 iounmap(cinfo->base_addr);
3933 if (cinfo->ctl_addr.p9050)
3934 iounmap(cinfo->ctl_addr.p9050);
3935 if (cinfo->irq
3936 #ifndef CONFIG_CYZ_INTR
3937 && !cy_is_Z(cinfo)
3938 #endif /* CONFIG_CYZ_INTR */
3939 )
3940 free_irq(cinfo->irq, cinfo);
3941 pci_release_regions(pdev);
3942
3943 cinfo->base_addr = NULL;
3944 for (channel = 0, i = cinfo->first_line; i < cinfo->first_line +
3945 cinfo->nports; i++, channel++) {
3946 tty_unregister_device(cy_serial_driver, i);
3947 tty_port_destroy(&cinfo->ports[channel].port);
3948 }
3949 cinfo->nports = 0;
3950 kfree(cinfo->ports);
3951 }
3952
3953 static struct pci_driver cy_pci_driver = {
3954 .name = "cyclades",
3955 .id_table = cy_pci_dev_id,
3956 .probe = cy_pci_probe,
3957 .remove = cy_pci_remove
3958 };
3959 #endif
3960
cyclades_proc_show(struct seq_file * m,void * v)3961 static int cyclades_proc_show(struct seq_file *m, void *v)
3962 {
3963 struct cyclades_port *info;
3964 unsigned int i, j;
3965 __u32 cur_jifs = jiffies;
3966
3967 seq_puts(m, "Dev TimeOpen BytesOut IdleOut BytesIn "
3968 "IdleIn Overruns Ldisc\n");
3969
3970 /* Output one line for each known port */
3971 for (i = 0; i < NR_CARDS; i++)
3972 for (j = 0; j < cy_card[i].nports; j++) {
3973 info = &cy_card[i].ports[j];
3974
3975 if (info->port.count) {
3976 /* XXX is the ldisc num worth this? */
3977 struct tty_struct *tty;
3978 struct tty_ldisc *ld;
3979 int num = 0;
3980 tty = tty_port_tty_get(&info->port);
3981 if (tty) {
3982 ld = tty_ldisc_ref(tty);
3983 if (ld) {
3984 num = ld->ops->num;
3985 tty_ldisc_deref(ld);
3986 }
3987 tty_kref_put(tty);
3988 }
3989 seq_printf(m, "%3d %8lu %10lu %8lu "
3990 "%10lu %8lu %9lu %6d\n", info->line,
3991 (cur_jifs - info->idle_stats.in_use) /
3992 HZ, info->idle_stats.xmit_bytes,
3993 (cur_jifs - info->idle_stats.xmit_idle)/
3994 HZ, info->idle_stats.recv_bytes,
3995 (cur_jifs - info->idle_stats.recv_idle)/
3996 HZ, info->idle_stats.overruns,
3997 num);
3998 } else
3999 seq_printf(m, "%3d %8lu %10lu %8lu "
4000 "%10lu %8lu %9lu %6ld\n",
4001 info->line, 0L, 0L, 0L, 0L, 0L, 0L, 0L);
4002 }
4003 return 0;
4004 }
4005
cyclades_proc_open(struct inode * inode,struct file * file)4006 static int cyclades_proc_open(struct inode *inode, struct file *file)
4007 {
4008 return single_open(file, cyclades_proc_show, NULL);
4009 }
4010
4011 static const struct file_operations cyclades_proc_fops = {
4012 .owner = THIS_MODULE,
4013 .open = cyclades_proc_open,
4014 .read = seq_read,
4015 .llseek = seq_lseek,
4016 .release = single_release,
4017 };
4018
4019 /* The serial driver boot-time initialization code!
4020 Hardware I/O ports are mapped to character special devices on a
4021 first found, first allocated manner. That is, this code searches
4022 for Cyclom cards in the system. As each is found, it is probed
4023 to discover how many chips (and thus how many ports) are present.
4024 These ports are mapped to the tty ports 32 and upward in monotonic
4025 fashion. If an 8-port card is replaced with a 16-port card, the
4026 port mapping on a following card will shift.
4027
4028 This approach is different from what is used in the other serial
4029 device driver because the Cyclom is more properly a multiplexer,
4030 not just an aggregation of serial ports on one card.
4031
4032 If there are more cards with more ports than have been
4033 statically allocated above, a warning is printed and the
4034 extra ports are ignored.
4035 */
4036
4037 static const struct tty_operations cy_ops = {
4038 .open = cy_open,
4039 .close = cy_close,
4040 .write = cy_write,
4041 .put_char = cy_put_char,
4042 .flush_chars = cy_flush_chars,
4043 .write_room = cy_write_room,
4044 .chars_in_buffer = cy_chars_in_buffer,
4045 .flush_buffer = cy_flush_buffer,
4046 .ioctl = cy_ioctl,
4047 .throttle = cy_throttle,
4048 .unthrottle = cy_unthrottle,
4049 .set_termios = cy_set_termios,
4050 .stop = cy_stop,
4051 .start = cy_start,
4052 .hangup = cy_hangup,
4053 .break_ctl = cy_break,
4054 .wait_until_sent = cy_wait_until_sent,
4055 .tiocmget = cy_tiocmget,
4056 .tiocmset = cy_tiocmset,
4057 .get_icount = cy_get_icount,
4058 .proc_fops = &cyclades_proc_fops,
4059 };
4060
cy_init(void)4061 static int __init cy_init(void)
4062 {
4063 unsigned int nboards;
4064 int retval = -ENOMEM;
4065
4066 cy_serial_driver = alloc_tty_driver(NR_PORTS);
4067 if (!cy_serial_driver)
4068 goto err;
4069
4070 printk(KERN_INFO "Cyclades driver " CY_VERSION "\n");
4071
4072 /* Initialize the tty_driver structure */
4073
4074 cy_serial_driver->driver_name = "cyclades";
4075 cy_serial_driver->name = "ttyC";
4076 cy_serial_driver->major = CYCLADES_MAJOR;
4077 cy_serial_driver->minor_start = 0;
4078 cy_serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
4079 cy_serial_driver->subtype = SERIAL_TYPE_NORMAL;
4080 cy_serial_driver->init_termios = tty_std_termios;
4081 cy_serial_driver->init_termios.c_cflag =
4082 B9600 | CS8 | CREAD | HUPCL | CLOCAL;
4083 cy_serial_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
4084 tty_set_operations(cy_serial_driver, &cy_ops);
4085
4086 retval = tty_register_driver(cy_serial_driver);
4087 if (retval) {
4088 printk(KERN_ERR "Couldn't register Cyclades serial driver\n");
4089 goto err_frtty;
4090 }
4091
4092 /* the code below is responsible to find the boards. Each different
4093 type of board has its own detection routine. If a board is found,
4094 the next cy_card structure available is set by the detection
4095 routine. These functions are responsible for checking the
4096 availability of cy_card and cy_port data structures and updating
4097 the cy_next_channel. */
4098
4099 /* look for isa boards */
4100 nboards = cy_detect_isa();
4101
4102 #ifdef CONFIG_PCI
4103 /* look for pci boards */
4104 retval = pci_register_driver(&cy_pci_driver);
4105 if (retval && !nboards) {
4106 tty_unregister_driver(cy_serial_driver);
4107 goto err_frtty;
4108 }
4109 #endif
4110
4111 return 0;
4112 err_frtty:
4113 put_tty_driver(cy_serial_driver);
4114 err:
4115 return retval;
4116 } /* cy_init */
4117
cy_cleanup_module(void)4118 static void __exit cy_cleanup_module(void)
4119 {
4120 struct cyclades_card *card;
4121 unsigned int i, e1;
4122
4123 #ifndef CONFIG_CYZ_INTR
4124 del_timer_sync(&cyz_timerlist);
4125 #endif /* CONFIG_CYZ_INTR */
4126
4127 e1 = tty_unregister_driver(cy_serial_driver);
4128 if (e1)
4129 printk(KERN_ERR "failed to unregister Cyclades serial "
4130 "driver(%d)\n", e1);
4131
4132 #ifdef CONFIG_PCI
4133 pci_unregister_driver(&cy_pci_driver);
4134 #endif
4135
4136 for (i = 0; i < NR_CARDS; i++) {
4137 card = &cy_card[i];
4138 if (card->base_addr) {
4139 /* clear interrupt */
4140 cy_writeb(card->base_addr + Cy_ClrIntr, 0);
4141 iounmap(card->base_addr);
4142 if (card->ctl_addr.p9050)
4143 iounmap(card->ctl_addr.p9050);
4144 if (card->irq
4145 #ifndef CONFIG_CYZ_INTR
4146 && !cy_is_Z(card)
4147 #endif /* CONFIG_CYZ_INTR */
4148 )
4149 free_irq(card->irq, card);
4150 for (e1 = card->first_line; e1 < card->first_line +
4151 card->nports; e1++)
4152 tty_unregister_device(cy_serial_driver, e1);
4153 kfree(card->ports);
4154 }
4155 }
4156
4157 put_tty_driver(cy_serial_driver);
4158 } /* cy_cleanup_module */
4159
4160 module_init(cy_init);
4161 module_exit(cy_cleanup_module);
4162
4163 MODULE_LICENSE("GPL");
4164 MODULE_VERSION(CY_VERSION);
4165 MODULE_ALIAS_CHARDEV_MAJOR(CYCLADES_MAJOR);
4166 MODULE_FIRMWARE("cyzfirm.bin");
4167