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