aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/char
diff options
context:
space:
mode:
authorJiri Slaby <jirislaby@gmail.com>2009-09-19 16:13:16 -0400
committerLive-CD User <linux@linux.site>2009-09-19 16:13:16 -0400
commit3aeea5b92210083c7cffd4f08a0bb141d3f2d574 (patch)
tree43c1572a397b902513e75ad08f8bdbd51b06d41e /drivers/char
parent0d3487294e4e175eb6371c8df8ef44b45964e0f6 (diff)
cyclades: introduce cyy_readb/writeb
Add helpers for io operations, so that we can eliminate huge amount of supporting code. It is now centralized in those helpers and used values are precomputed in the init phase. Signed-off-by: Jiri Slaby <jirislaby@gmail.com> Signed-off-by: Alan Cox <alan@linux.intel.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
Diffstat (limited to 'drivers/char')
-rw-r--r--drivers/char/cyclades.c448
1 files changed, 164 insertions, 284 deletions
diff --git a/drivers/char/cyclades.c b/drivers/char/cyclades.c
index ed66c3ab230d..cf2874a89c8c 100644
--- a/drivers/char/cyclades.c
+++ b/drivers/char/cyclades.c
@@ -90,7 +90,6 @@
90#include <linux/proc_fs.h> 90#include <linux/proc_fs.h>
91#include <linux/seq_file.h> 91#include <linux/seq_file.h>
92 92
93static void cy_throttle(struct tty_struct *tty);
94static void cy_send_xchar(struct tty_struct *tty, char ch); 93static void cy_send_xchar(struct tty_struct *tty, char ch);
95 94
96#ifndef SERIAL_XMIT_SIZE 95#ifndef SERIAL_XMIT_SIZE
@@ -298,6 +297,20 @@ static void cyz_rx_restart(unsigned long);
298static struct timer_list cyz_rx_full_timer[NR_PORTS]; 297static struct timer_list cyz_rx_full_timer[NR_PORTS];
299#endif /* CONFIG_CYZ_INTR */ 298#endif /* CONFIG_CYZ_INTR */
300 299
300static inline void cyy_writeb(struct cyclades_port *port, u32 reg, u8 val)
301{
302 struct cyclades_card *card = port->card;
303
304 cy_writeb(port->u.cyy.base_addr + (reg << card->bus_index), val);
305}
306
307static inline u8 cyy_readb(struct cyclades_port *port, u32 reg)
308{
309 struct cyclades_card *card = port->card;
310
311 return readb(port->u.cyy.base_addr + (reg << card->bus_index));
312}
313
301static inline bool cy_is_Z(struct cyclades_card *card) 314static inline bool cy_is_Z(struct cyclades_card *card)
302{ 315{
303 return card->num_chips == (unsigned int)-1; 316 return card->num_chips == (unsigned int)-1;
@@ -350,13 +363,14 @@ static inline int serial_paranoia_check(struct cyclades_port *info,
350 363
351 This function is only called from inside spinlock-protected code. 364 This function is only called from inside spinlock-protected code.
352 */ 365 */
353static int cyy_issue_cmd(void __iomem *base_addr, u_char cmd, int index) 366static int __cyy_issue_cmd(void __iomem *base_addr, u8 cmd, int index)
354{ 367{
368 void __iomem *ccr = base_addr + (CyCCR << index);
355 unsigned int i; 369 unsigned int i;
356 370
357 /* Check to see that the previous command has completed */ 371 /* Check to see that the previous command has completed */
358 for (i = 0; i < 100; i++) { 372 for (i = 0; i < 100; i++) {
359 if (readb(base_addr + (CyCCR << index)) == 0) 373 if (readb(ccr) == 0)
360 break; 374 break;
361 udelay(10L); 375 udelay(10L);
362 } 376 }
@@ -366,10 +380,16 @@ static int cyy_issue_cmd(void __iomem *base_addr, u_char cmd, int index)
366 return -1; 380 return -1;
367 381
368 /* Issue the new command */ 382 /* Issue the new command */
369 cy_writeb(base_addr + (CyCCR << index), cmd); 383 cy_writeb(ccr, cmd);
370 384
371 return 0; 385 return 0;
372} /* cyy_issue_cmd */ 386}
387
388static inline int cyy_issue_cmd(struct cyclades_port *port, u8 cmd)
389{
390 return __cyy_issue_cmd(port->u.cyy.base_addr, cmd,
391 port->card->bus_index);
392}
373 393
374#ifdef CONFIG_ISA 394#ifdef CONFIG_ISA
375/* ISA interrupt detection code */ 395/* ISA interrupt detection code */
@@ -394,7 +414,7 @@ static unsigned detect_isa_irq(void __iomem *address)
394 /* Enable the Tx interrupts on the CD1400 */ 414 /* Enable the Tx interrupts on the CD1400 */
395 local_irq_save(flags); 415 local_irq_save(flags);
396 cy_writeb(address + (CyCAR << index), 0); 416 cy_writeb(address + (CyCAR << index), 0);
397 cyy_issue_cmd(address, CyCHAN_CTL | CyENB_XMTR, index); 417 __cyy_issue_cmd(address, CyCHAN_CTL | CyENB_XMTR, index);
398 418
399 cy_writeb(address + (CyCAR << index), 0); 419 cy_writeb(address + (CyCAR << index), 0);
400 cy_writeb(address + (CySRER << index), 420 cy_writeb(address + (CySRER << index),
@@ -428,7 +448,7 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip,
428 struct cyclades_port *info; 448 struct cyclades_port *info;
429 struct tty_struct *tty; 449 struct tty_struct *tty;
430 int len, index = cinfo->bus_index; 450 int len, index = cinfo->bus_index;
431 u8 save_xir, channel, save_car, data, char_count; 451 u8 ivr, save_xir, channel, save_car, data, char_count;
432 452
433#ifdef CY_DEBUG_INTERRUPTS 453#ifdef CY_DEBUG_INTERRUPTS
434 printk(KERN_DEBUG "cyy_interrupt: rcvd intr, chip %d\n", chip); 454 printk(KERN_DEBUG "cyy_interrupt: rcvd intr, chip %d\n", chip);
@@ -437,26 +457,25 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip,
437 save_xir = readb(base_addr + (CyRIR << index)); 457 save_xir = readb(base_addr + (CyRIR << index));
438 channel = save_xir & CyIRChannel; 458 channel = save_xir & CyIRChannel;
439 info = &cinfo->ports[channel + chip * 4]; 459 info = &cinfo->ports[channel + chip * 4];
440 save_car = readb(base_addr + (CyCAR << index)); 460 save_car = cyy_readb(info, CyCAR);
441 cy_writeb(base_addr + (CyCAR << index), save_xir); 461 cyy_writeb(info, CyCAR, save_xir);
462 ivr = cyy_readb(info, CyRIVR) & CyIVRMask;
442 463
443 tty = tty_port_tty_get(&info->port); 464 tty = tty_port_tty_get(&info->port);
444 /* if there is nowhere to put the data, discard it */ 465 /* if there is nowhere to put the data, discard it */
445 if (tty == NULL) { 466 if (tty == NULL) {
446 if ((readb(base_addr + (CyRIVR << index)) & CyIVRMask) == 467 if (ivr == CyIVRRxEx) { /* exception */
447 CyIVRRxEx) { /* exception */ 468 data = cyy_readb(info, CyRDSR);
448 data = readb(base_addr + (CyRDSR << index));
449 } else { /* normal character reception */ 469 } else { /* normal character reception */
450 char_count = readb(base_addr + (CyRDCR << index)); 470 char_count = cyy_readb(info, CyRDCR);
451 while (char_count--) 471 while (char_count--)
452 data = readb(base_addr + (CyRDSR << index)); 472 data = cyy_readb(info, CyRDSR);
453 } 473 }
454 goto end; 474 goto end;
455 } 475 }
456 /* there is an open port for this data */ 476 /* there is an open port for this data */
457 if ((readb(base_addr + (CyRIVR << index)) & CyIVRMask) == 477 if (ivr == CyIVRRxEx) { /* exception */
458 CyIVRRxEx) { /* exception */ 478 data = cyy_readb(info, CyRDSR);
459 data = readb(base_addr + (CyRDSR << index));
460 479
461 /* For statistics only */ 480 /* For statistics only */
462 if (data & CyBREAK) 481 if (data & CyBREAK)
@@ -477,22 +496,22 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip,
477 if (data & info->read_status_mask) { 496 if (data & info->read_status_mask) {
478 if (data & CyBREAK) { 497 if (data & CyBREAK) {
479 tty_insert_flip_char(tty, 498 tty_insert_flip_char(tty,
480 readb(base_addr + (CyRDSR << 499 cyy_readb(info, CyRDSR),
481 index)), TTY_BREAK); 500 TTY_BREAK);
482 info->icount.rx++; 501 info->icount.rx++;
483 if (info->port.flags & ASYNC_SAK) 502 if (info->port.flags & ASYNC_SAK)
484 do_SAK(tty); 503 do_SAK(tty);
485 } else if (data & CyFRAME) { 504 } else if (data & CyFRAME) {
486 tty_insert_flip_char(tty, 505 tty_insert_flip_char(tty,
487 readb(base_addr + (CyRDSR << 506 cyy_readb(info, CyRDSR),
488 index)), TTY_FRAME); 507 TTY_FRAME);
489 info->icount.rx++; 508 info->icount.rx++;
490 info->idle_stats.frame_errs++; 509 info->idle_stats.frame_errs++;
491 } else if (data & CyPARITY) { 510 } else if (data & CyPARITY) {
492 /* Pieces of seven... */ 511 /* Pieces of seven... */
493 tty_insert_flip_char(tty, 512 tty_insert_flip_char(tty,
494 readb(base_addr + (CyRDSR << 513 cyy_readb(info, CyRDSR),
495 index)), TTY_PARITY); 514 TTY_PARITY);
496 info->icount.rx++; 515 info->icount.rx++;
497 info->idle_stats.parity_errs++; 516 info->idle_stats.parity_errs++;
498 } else if (data & CyOVERRUN) { 517 } else if (data & CyOVERRUN) {
@@ -504,8 +523,8 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip,
504 the next incoming character. 523 the next incoming character.
505 */ 524 */
506 tty_insert_flip_char(tty, 525 tty_insert_flip_char(tty,
507 readb(base_addr + (CyRDSR << 526 cyy_readb(info, CyRDSR),
508 index)), TTY_FRAME); 527 TTY_FRAME);
509 info->icount.rx++; 528 info->icount.rx++;
510 info->idle_stats.overruns++; 529 info->idle_stats.overruns++;
511 /* These two conditions may imply */ 530 /* These two conditions may imply */
@@ -529,7 +548,7 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip,
529 } 548 }
530 } else { /* normal character reception */ 549 } else { /* normal character reception */
531 /* load # chars available from the chip */ 550 /* load # chars available from the chip */
532 char_count = readb(base_addr + (CyRDCR << index)); 551 char_count = cyy_readb(info, CyRDCR);
533 552
534#ifdef CY_ENABLE_MONITORING 553#ifdef CY_ENABLE_MONITORING
535 ++info->mon.int_count; 554 ++info->mon.int_count;
@@ -540,7 +559,7 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip,
540#endif 559#endif
541 len = tty_buffer_request_room(tty, char_count); 560 len = tty_buffer_request_room(tty, char_count);
542 while (len--) { 561 while (len--) {
543 data = readb(base_addr + (CyRDSR << index)); 562 data = cyy_readb(info, CyRDSR);
544 tty_insert_flip_char(tty, data, TTY_NORMAL); 563 tty_insert_flip_char(tty, data, TTY_NORMAL);
545 info->idle_stats.recv_bytes++; 564 info->idle_stats.recv_bytes++;
546 info->icount.rx++; 565 info->icount.rx++;
@@ -554,8 +573,8 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip,
554 tty_kref_put(tty); 573 tty_kref_put(tty);
555end: 574end:
556 /* end of service */ 575 /* end of service */
557 cy_writeb(base_addr + (CyRIR << index), save_xir & 0x3f); 576 cyy_writeb(info, CyRIR, save_xir & 0x3f);
558 cy_writeb(base_addr + (CyCAR << index), save_car); 577 cyy_writeb(info, CyCAR, save_car);
559} 578}
560 579
561static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip, 580static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip,
@@ -588,8 +607,7 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip,
588 info = &cinfo->ports[channel + chip * 4]; 607 info = &cinfo->ports[channel + chip * 4];
589 tty = tty_port_tty_get(&info->port); 608 tty = tty_port_tty_get(&info->port);
590 if (tty == NULL) { 609 if (tty == NULL) {
591 cy_writeb(base_addr + (CySRER << index), 610 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) & ~CyTxRdy);
592 readb(base_addr + (CySRER << index)) & ~CyTxRdy);
593 goto end; 611 goto end;
594 } 612 }
595 613
@@ -598,7 +616,7 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip,
598 616
599 if (info->x_char) { /* send special char */ 617 if (info->x_char) { /* send special char */
600 outch = info->x_char; 618 outch = info->x_char;
601 cy_writeb(base_addr + (CyTDR << index), outch); 619 cyy_writeb(info, CyTDR, outch);
602 char_count--; 620 char_count--;
603 info->icount.tx++; 621 info->icount.tx++;
604 info->x_char = 0; 622 info->x_char = 0;
@@ -606,14 +624,14 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip,
606 624
607 if (info->breakon || info->breakoff) { 625 if (info->breakon || info->breakoff) {
608 if (info->breakon) { 626 if (info->breakon) {
609 cy_writeb(base_addr + (CyTDR << index), 0); 627 cyy_writeb(info, CyTDR, 0);
610 cy_writeb(base_addr + (CyTDR << index), 0x81); 628 cyy_writeb(info, CyTDR, 0x81);
611 info->breakon = 0; 629 info->breakon = 0;
612 char_count -= 2; 630 char_count -= 2;
613 } 631 }
614 if (info->breakoff) { 632 if (info->breakoff) {
615 cy_writeb(base_addr + (CyTDR << index), 0); 633 cyy_writeb(info, CyTDR, 0);
616 cy_writeb(base_addr + (CyTDR << index), 0x83); 634 cyy_writeb(info, CyTDR, 0x83);
617 info->breakoff = 0; 635 info->breakoff = 0;
618 char_count -= 2; 636 char_count -= 2;
619 } 637 }
@@ -621,27 +639,23 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip,
621 639
622 while (char_count-- > 0) { 640 while (char_count-- > 0) {
623 if (!info->xmit_cnt) { 641 if (!info->xmit_cnt) {
624 if (readb(base_addr + (CySRER << index)) & CyTxMpty) { 642 if (cyy_readb(info, CySRER) & CyTxMpty) {
625 cy_writeb(base_addr + (CySRER << index), 643 cyy_writeb(info, CySRER,
626 readb(base_addr + (CySRER << index)) & 644 cyy_readb(info, CySRER) & ~CyTxMpty);
627 ~CyTxMpty);
628 } else { 645 } else {
629 cy_writeb(base_addr + (CySRER << index), 646 cyy_writeb(info, CySRER, CyTxMpty |
630 (readb(base_addr + (CySRER << index)) & 647 (cyy_readb(info, CySRER) & ~CyTxRdy));
631 ~CyTxRdy) | CyTxMpty);
632 } 648 }
633 goto done; 649 goto done;
634 } 650 }
635 if (info->port.xmit_buf == NULL) { 651 if (info->port.xmit_buf == NULL) {
636 cy_writeb(base_addr + (CySRER << index), 652 cyy_writeb(info, CySRER,
637 readb(base_addr + (CySRER << index)) & 653 cyy_readb(info, CySRER) & ~CyTxRdy);
638 ~CyTxRdy);
639 goto done; 654 goto done;
640 } 655 }
641 if (tty->stopped || tty->hw_stopped) { 656 if (tty->stopped || tty->hw_stopped) {
642 cy_writeb(base_addr + (CySRER << index), 657 cyy_writeb(info, CySRER,
643 readb(base_addr + (CySRER << index)) & 658 cyy_readb(info, CySRER) & ~CyTxRdy);
644 ~CyTxRdy);
645 goto done; 659 goto done;
646 } 660 }
647 /* Because the Embedded Transmit Commands have been enabled, 661 /* Because the Embedded Transmit Commands have been enabled,
@@ -658,15 +672,15 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip,
658 info->xmit_cnt--; 672 info->xmit_cnt--;
659 info->xmit_tail = (info->xmit_tail + 1) & 673 info->xmit_tail = (info->xmit_tail + 1) &
660 (SERIAL_XMIT_SIZE - 1); 674 (SERIAL_XMIT_SIZE - 1);
661 cy_writeb(base_addr + (CyTDR << index), outch); 675 cyy_writeb(info, CyTDR, outch);
662 info->icount.tx++; 676 info->icount.tx++;
663 } else { 677 } else {
664 if (char_count > 1) { 678 if (char_count > 1) {
665 info->xmit_cnt--; 679 info->xmit_cnt--;
666 info->xmit_tail = (info->xmit_tail + 1) & 680 info->xmit_tail = (info->xmit_tail + 1) &
667 (SERIAL_XMIT_SIZE - 1); 681 (SERIAL_XMIT_SIZE - 1);
668 cy_writeb(base_addr + (CyTDR << index), outch); 682 cyy_writeb(info, CyTDR, outch);
669 cy_writeb(base_addr + (CyTDR << index), 0); 683 cyy_writeb(info, CyTDR, 0);
670 info->icount.tx++; 684 info->icount.tx++;
671 char_count--; 685 char_count--;
672 } 686 }
@@ -678,8 +692,8 @@ done:
678 tty_kref_put(tty); 692 tty_kref_put(tty);
679end: 693end:
680 /* end of service */ 694 /* end of service */
681 cy_writeb(base_addr + (CyTIR << index), save_xir & 0x3f); 695 cyy_writeb(info, CyTIR, save_xir & 0x3f);
682 cy_writeb(base_addr + (CyCAR << index), save_car); 696 cyy_writeb(info, CyCAR, save_car);
683} 697}
684 698
685static void cyy_chip_modem(struct cyclades_card *cinfo, int chip, 699static void cyy_chip_modem(struct cyclades_card *cinfo, int chip,
@@ -694,11 +708,11 @@ static void cyy_chip_modem(struct cyclades_card *cinfo, int chip,
694 save_xir = readb(base_addr + (CyMIR << index)); 708 save_xir = readb(base_addr + (CyMIR << index));
695 channel = save_xir & CyIRChannel; 709 channel = save_xir & CyIRChannel;
696 info = &cinfo->ports[channel + chip * 4]; 710 info = &cinfo->ports[channel + chip * 4];
697 save_car = readb(base_addr + (CyCAR << index)); 711 save_car = cyy_readb(info, CyCAR);
698 cy_writeb(base_addr + (CyCAR << index), save_xir); 712 cyy_writeb(info, CyCAR, save_xir);
699 713
700 mdm_change = readb(base_addr + (CyMISR << index)); 714 mdm_change = cyy_readb(info, CyMISR);
701 mdm_status = readb(base_addr + (CyMSVR1 << index)); 715 mdm_status = cyy_readb(info, CyMSVR1);
702 716
703 tty = tty_port_tty_get(&info->port); 717 tty = tty_port_tty_get(&info->port);
704 if (!tty) 718 if (!tty)
@@ -730,9 +744,8 @@ static void cyy_chip_modem(struct cyclades_card *cinfo, int chip,
730 /* cy_start isn't used 744 /* cy_start isn't used
731 because... !!! */ 745 because... !!! */
732 tty->hw_stopped = 0; 746 tty->hw_stopped = 0;
733 cy_writeb(base_addr + (CySRER << index), 747 cyy_writeb(info, CySRER,
734 readb(base_addr + (CySRER << index)) | 748 cyy_readb(info, CySRER) | CyTxRdy);
735 CyTxRdy);
736 tty_wakeup(tty); 749 tty_wakeup(tty);
737 } 750 }
738 } else { 751 } else {
@@ -740,9 +753,8 @@ static void cyy_chip_modem(struct cyclades_card *cinfo, int chip,
740 /* cy_stop isn't used 753 /* cy_stop isn't used
741 because ... !!! */ 754 because ... !!! */
742 tty->hw_stopped = 1; 755 tty->hw_stopped = 1;
743 cy_writeb(base_addr + (CySRER << index), 756 cyy_writeb(info, CySRER,
744 readb(base_addr + (CySRER << index)) & 757 cyy_readb(info, CySRER) & ~CyTxRdy);
745 ~CyTxRdy);
746 } 758 }
747 } 759 }
748 } 760 }
@@ -753,8 +765,8 @@ static void cyy_chip_modem(struct cyclades_card *cinfo, int chip,
753 tty_kref_put(tty); 765 tty_kref_put(tty);
754end: 766end:
755 /* end of service */ 767 /* end of service */
756 cy_writeb(base_addr + (CyMIR << index), save_xir & 0x3f); 768 cyy_writeb(info, CyMIR, save_xir & 0x3f);
757 cy_writeb(base_addr + (CyCAR << index), save_car); 769 cyy_writeb(info, CyCAR, save_car);
758} 770}
759 771
760/* The real interrupt service routine is called 772/* The real interrupt service routine is called
@@ -829,15 +841,10 @@ static void cyy_change_rts_dtr(struct cyclades_port *info, unsigned int set,
829 unsigned int clear) 841 unsigned int clear)
830{ 842{
831 struct cyclades_card *card = info->card; 843 struct cyclades_card *card = info->card;
832 void __iomem *base_addr; 844 int channel = info->line - card->first_line;
833 int chip, channel, index;
834 u32 rts, dtr, msvrr, msvrd; 845 u32 rts, dtr, msvrr, msvrd;
835 846
836 channel = info->line - card->first_line;
837 chip = channel >> 2;
838 channel &= 0x03; 847 channel &= 0x03;
839 index = card->bus_index;
840 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
841 848
842 if (info->rtsdtr_inv) { 849 if (info->rtsdtr_inv) {
843 msvrr = CyMSVR2; 850 msvrr = CyMSVR2;
@@ -851,31 +858,31 @@ static void cyy_change_rts_dtr(struct cyclades_port *info, unsigned int set,
851 dtr = CyDTR; 858 dtr = CyDTR;
852 } 859 }
853 if (set & TIOCM_RTS) { 860 if (set & TIOCM_RTS) {
854 cy_writeb(base_addr + (CyCAR << index), (u8)channel); 861 cyy_writeb(info, CyCAR, channel);
855 cy_writeb(base_addr + (msvrr << index), rts); 862 cyy_writeb(info, msvrr, rts);
856 } 863 }
857 if (clear & TIOCM_RTS) { 864 if (clear & TIOCM_RTS) {
858 cy_writeb(base_addr + (CyCAR << index), (u8)channel); 865 cyy_writeb(info, CyCAR, channel);
859 cy_writeb(base_addr + (msvrr << index), ~rts); 866 cyy_writeb(info, msvrr, ~rts);
860 } 867 }
861 if (set & TIOCM_DTR) { 868 if (set & TIOCM_DTR) {
862 cy_writeb(base_addr + (CyCAR << index), (u8)channel); 869 cyy_writeb(info, CyCAR, channel);
863 cy_writeb(base_addr + (msvrd << index), dtr); 870 cyy_writeb(info, msvrd, dtr);
864#ifdef CY_DEBUG_DTR 871#ifdef CY_DEBUG_DTR
865 printk(KERN_DEBUG "cyc:set_modem_info raising DTR\n"); 872 printk(KERN_DEBUG "cyc:set_modem_info raising DTR\n");
866 printk(KERN_DEBUG " status: 0x%x, 0x%x\n", 873 printk(KERN_DEBUG " status: 0x%x, 0x%x\n",
867 readb(base_addr + (CyMSVR1 << index)), 874 cyy_readb(info, CyMSVR1),
868 readb(base_addr + (CyMSVR2 << index))); 875 cyy_readb(info, CyMSVR2));
869#endif 876#endif
870 } 877 }
871 if (clear & TIOCM_DTR) { 878 if (clear & TIOCM_DTR) {
872 cy_writeb(base_addr + (CyCAR << index), (u8)channel); 879 cyy_writeb(info, CyCAR, channel);
873 cy_writeb(base_addr + (msvrd << index), ~dtr); 880 cyy_writeb(info, msvrd, ~dtr);
874#ifdef CY_DEBUG_DTR 881#ifdef CY_DEBUG_DTR
875 printk(KERN_DEBUG "cyc:set_modem_info dropping DTR\n"); 882 printk(KERN_DEBUG "cyc:set_modem_info dropping DTR\n");
876 printk(KERN_DEBUG " status: 0x%x, 0x%x\n", 883 printk(KERN_DEBUG " status: 0x%x, 0x%x\n",
877 readb(base_addr + (CyMSVR1 << index)), 884 cyy_readb(info, CyMSVR1),
878 readb(base_addr + (CyMSVR2 << index))); 885 cyy_readb(info, CyMSVR2));
879#endif 886#endif
880 } 887 }
881} 888}
@@ -1290,7 +1297,6 @@ static int cy_startup(struct cyclades_port *info, struct tty_struct *tty)
1290 struct cyclades_card *card; 1297 struct cyclades_card *card;
1291 unsigned long flags; 1298 unsigned long flags;
1292 int retval = 0; 1299 int retval = 0;
1293 void __iomem *base_addr;
1294 int channel; 1300 int channel;
1295 unsigned long page; 1301 unsigned long page;
1296 1302
@@ -1321,31 +1327,21 @@ static int cy_startup(struct cyclades_port *info, struct tty_struct *tty)
1321 cy_set_line_char(info, tty); 1327 cy_set_line_char(info, tty);
1322 1328
1323 if (!cy_is_Z(card)) { 1329 if (!cy_is_Z(card)) {
1324 int chip = channel >> 2;
1325 int index = card->bus_index;
1326 channel &= 0x03; 1330 channel &= 0x03;
1327 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
1328 1331
1329#ifdef CY_DEBUG_OPEN
1330 printk(KERN_DEBUG "cyc startup card %d, chip %d, channel %d, "
1331 "base_addr %p\n",
1332 card, chip, channel, base_addr);
1333#endif
1334 spin_lock_irqsave(&card->card_lock, flags); 1332 spin_lock_irqsave(&card->card_lock, flags);
1335 1333
1336 cy_writeb(base_addr + (CyCAR << index), (u_char) channel); 1334 cyy_writeb(info, CyCAR, channel);
1337 1335
1338 cy_writeb(base_addr + (CyRTPR << index), 1336 cyy_writeb(info, CyRTPR,
1339 (info->default_timeout ? info->default_timeout : 0x02)); 1337 (info->default_timeout ? info->default_timeout : 0x02));
1340 /* 10ms rx timeout */ 1338 /* 10ms rx timeout */
1341 1339
1342 cyy_issue_cmd(base_addr, CyCHAN_CTL | CyENB_RCVR | CyENB_XMTR, 1340 cyy_issue_cmd(info, CyCHAN_CTL | CyENB_RCVR | CyENB_XMTR);
1343 index);
1344 1341
1345 cyy_change_rts_dtr(info, TIOCM_RTS | TIOCM_DTR, 0); 1342 cyy_change_rts_dtr(info, TIOCM_RTS | TIOCM_DTR, 0);
1346 1343
1347 cy_writeb(base_addr + (CySRER << index), 1344 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyRxData);
1348 readb(base_addr + (CySRER << index)) | CyRxData);
1349 } else { 1345 } else {
1350 struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl; 1346 struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl;
1351 1347
@@ -1423,23 +1419,14 @@ errout:
1423 1419
1424static void start_xmit(struct cyclades_port *info) 1420static void start_xmit(struct cyclades_port *info)
1425{ 1421{
1426 struct cyclades_card *card; 1422 struct cyclades_card *card = info->card;
1427 unsigned long flags; 1423 unsigned long flags;
1428 void __iomem *base_addr; 1424 int channel = info->line - card->first_line;
1429 int chip, channel, index;
1430 1425
1431 card = info->card;
1432 channel = info->line - card->first_line;
1433 if (!cy_is_Z(card)) { 1426 if (!cy_is_Z(card)) {
1434 chip = channel >> 2;
1435 channel &= 0x03;
1436 index = card->bus_index;
1437 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
1438
1439 spin_lock_irqsave(&card->card_lock, flags); 1427 spin_lock_irqsave(&card->card_lock, flags);
1440 cy_writeb(base_addr + (CyCAR << index), channel); 1428 cyy_writeb(info, CyCAR, channel & 0x03);
1441 cy_writeb(base_addr + (CySRER << index), 1429 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyTxRdy);
1442 readb(base_addr + (CySRER << index)) | CyTxRdy);
1443 spin_unlock_irqrestore(&card->card_lock, flags); 1430 spin_unlock_irqrestore(&card->card_lock, flags);
1444 } else { 1431 } else {
1445#ifdef CONFIG_CYZ_INTR 1432#ifdef CONFIG_CYZ_INTR
@@ -1466,8 +1453,7 @@ static void cy_shutdown(struct cyclades_port *info, struct tty_struct *tty)
1466{ 1453{
1467 struct cyclades_card *card; 1454 struct cyclades_card *card;
1468 unsigned long flags; 1455 unsigned long flags;
1469 void __iomem *base_addr; 1456 int channel;
1470 int chip, channel, index;
1471 1457
1472 if (!(info->port.flags & ASYNC_INITIALIZED)) 1458 if (!(info->port.flags & ASYNC_INITIALIZED))
1473 return; 1459 return;
@@ -1475,17 +1461,6 @@ static void cy_shutdown(struct cyclades_port *info, struct tty_struct *tty)
1475 card = info->card; 1461 card = info->card;
1476 channel = info->line - card->first_line; 1462 channel = info->line - card->first_line;
1477 if (!cy_is_Z(card)) { 1463 if (!cy_is_Z(card)) {
1478 chip = channel >> 2;
1479 channel &= 0x03;
1480 index = card->bus_index;
1481 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
1482
1483#ifdef CY_DEBUG_OPEN
1484 printk(KERN_DEBUG "cyc shutdown Y card %d, chip %d, "
1485 "channel %d, base_addr %p\n",
1486 card, chip, channel, base_addr);
1487#endif
1488
1489 spin_lock_irqsave(&card->card_lock, flags); 1464 spin_lock_irqsave(&card->card_lock, flags);
1490 1465
1491 /* Clear delta_msr_wait queue to avoid mem leaks. */ 1466 /* Clear delta_msr_wait queue to avoid mem leaks. */
@@ -1500,7 +1475,7 @@ static void cy_shutdown(struct cyclades_port *info, struct tty_struct *tty)
1500 if (tty->termios->c_cflag & HUPCL) 1475 if (tty->termios->c_cflag & HUPCL)
1501 cyy_change_rts_dtr(info, 0, TIOCM_RTS | TIOCM_DTR); 1476 cyy_change_rts_dtr(info, 0, TIOCM_RTS | TIOCM_DTR);
1502 1477
1503 cyy_issue_cmd(base_addr, CyCHAN_CTL | CyDIS_RCVR, index); 1478 cyy_issue_cmd(info, CyCHAN_CTL | CyDIS_RCVR);
1504 /* it may be appropriate to clear _XMIT at 1479 /* it may be appropriate to clear _XMIT at
1505 some later date (after testing)!!! */ 1480 some later date (after testing)!!! */
1506 1481
@@ -1677,8 +1652,6 @@ static void cy_wait_until_sent(struct tty_struct *tty, int timeout)
1677{ 1652{
1678 struct cyclades_card *card; 1653 struct cyclades_card *card;
1679 struct cyclades_port *info = tty->driver_data; 1654 struct cyclades_port *info = tty->driver_data;
1680 void __iomem *base_addr;
1681 int chip, channel, index;
1682 unsigned long orig_jiffies; 1655 unsigned long orig_jiffies;
1683 int char_time; 1656 int char_time;
1684 1657
@@ -1722,13 +1695,8 @@ static void cy_wait_until_sent(struct tty_struct *tty, int timeout)
1722 timeout, char_time, jiffies); 1695 timeout, char_time, jiffies);
1723#endif 1696#endif
1724 card = info->card; 1697 card = info->card;
1725 channel = (info->line) - (card->first_line);
1726 if (!cy_is_Z(card)) { 1698 if (!cy_is_Z(card)) {
1727 chip = channel >> 2; 1699 while (cyy_readb(info, CySRER) & CyTxRdy) {
1728 channel &= 0x03;
1729 index = card->bus_index;
1730 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
1731 while (readb(base_addr + (CySRER << index)) & CyTxRdy) {
1732#ifdef CY_DEBUG_WAIT_UNTIL_SENT 1700#ifdef CY_DEBUG_WAIT_UNTIL_SENT
1733 printk(KERN_DEBUG "Not clean (jiff=%lu)...", jiffies); 1701 printk(KERN_DEBUG "Not clean (jiff=%lu)...", jiffies);
1734#endif 1702#endif
@@ -1790,6 +1758,7 @@ static void cy_close(struct tty_struct *tty, struct file *filp)
1790 struct cyclades_port *info = tty->driver_data; 1758 struct cyclades_port *info = tty->driver_data;
1791 struct cyclades_card *card; 1759 struct cyclades_card *card;
1792 unsigned long flags; 1760 unsigned long flags;
1761 int channel;
1793 1762
1794 if (!info || serial_paranoia_check(info, tty->name, "cy_close")) 1763 if (!info || serial_paranoia_check(info, tty->name, "cy_close"))
1795 return; 1764 return;
@@ -1799,18 +1768,13 @@ static void cy_close(struct tty_struct *tty, struct file *filp)
1799 if (!tty_port_close_start(&info->port, tty, filp)) 1768 if (!tty_port_close_start(&info->port, tty, filp))
1800 return; 1769 return;
1801 1770
1771 channel = info->line - card->first_line;
1802 spin_lock_irqsave(&card->card_lock, flags); 1772 spin_lock_irqsave(&card->card_lock, flags);
1803 1773
1804 if (!cy_is_Z(card)) { 1774 if (!cy_is_Z(card)) {
1805 int channel = info->line - card->first_line;
1806 int index = card->bus_index;
1807 void __iomem *base_addr = card->base_addr +
1808 (cy_chip_offset[channel >> 2] << index);
1809 /* Stop accepting input */ 1775 /* Stop accepting input */
1810 channel &= 0x03; 1776 cyy_writeb(info, CyCAR, channel & 0x03);
1811 cy_writeb(base_addr + (CyCAR << index), (u_char) channel); 1777 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) & ~CyRxData);
1812 cy_writeb(base_addr + (CySRER << index),
1813 readb(base_addr + (CySRER << index)) & ~CyRxData);
1814 if (info->port.flags & ASYNC_INITIALIZED) { 1778 if (info->port.flags & ASYNC_INITIALIZED) {
1815 /* Waiting for on-board buffers to be empty before 1779 /* Waiting for on-board buffers to be empty before
1816 closing the port */ 1780 closing the port */
@@ -1823,7 +1787,6 @@ static void cy_close(struct tty_struct *tty, struct file *filp)
1823 /* Waiting for on-board buffers to be empty before closing 1787 /* Waiting for on-board buffers to be empty before closing
1824 the port */ 1788 the port */
1825 struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl; 1789 struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl;
1826 int channel = info->line - card->first_line;
1827 int retval; 1790 int retval;
1828 1791
1829 if (readl(&ch_ctrl->flow_status) != C_FS_TXIDLE) { 1792 if (readl(&ch_ctrl->flow_status) != C_FS_TXIDLE) {
@@ -2064,8 +2027,7 @@ static void cy_set_line_char(struct cyclades_port *info, struct tty_struct *tty)
2064{ 2027{
2065 struct cyclades_card *card; 2028 struct cyclades_card *card;
2066 unsigned long flags; 2029 unsigned long flags;
2067 void __iomem *base_addr; 2030 int channel;
2068 int chip, channel, index;
2069 unsigned cflag, iflag; 2031 unsigned cflag, iflag;
2070 int baud, baud_rate = 0; 2032 int baud, baud_rate = 0;
2071 int i; 2033 int i;
@@ -2095,9 +2057,6 @@ static void cy_set_line_char(struct cyclades_port *info, struct tty_struct *tty)
2095 channel = info->line - card->first_line; 2057 channel = info->line - card->first_line;
2096 2058
2097 if (!cy_is_Z(card)) { 2059 if (!cy_is_Z(card)) {
2098
2099 index = card->bus_index;
2100
2101 /* baud rate */ 2060 /* baud rate */
2102 baud = tty_get_baud_rate(tty); 2061 baud = tty_get_baud_rate(tty);
2103 if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) == 2062 if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) ==
@@ -2208,70 +2167,67 @@ static void cy_set_line_char(struct cyclades_port *info, struct tty_struct *tty)
2208 cable. Contact Marcio Saito for details. 2167 cable. Contact Marcio Saito for details.
2209 ***********************************************/ 2168 ***********************************************/
2210 2169
2211 chip = channel >> 2;
2212 channel &= 0x03; 2170 channel &= 0x03;
2213 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
2214 2171
2215 spin_lock_irqsave(&card->card_lock, flags); 2172 spin_lock_irqsave(&card->card_lock, flags);
2216 cy_writeb(base_addr + (CyCAR << index), (u_char) channel); 2173 cyy_writeb(info, CyCAR, channel);
2217 2174
2218 /* tx and rx baud rate */ 2175 /* tx and rx baud rate */
2219 2176
2220 cy_writeb(base_addr + (CyTCOR << index), info->tco); 2177 cyy_writeb(info, CyTCOR, info->tco);
2221 cy_writeb(base_addr + (CyTBPR << index), info->tbpr); 2178 cyy_writeb(info, CyTBPR, info->tbpr);
2222 cy_writeb(base_addr + (CyRCOR << index), info->rco); 2179 cyy_writeb(info, CyRCOR, info->rco);
2223 cy_writeb(base_addr + (CyRBPR << index), info->rbpr); 2180 cyy_writeb(info, CyRBPR, info->rbpr);
2224 2181
2225 /* set line characteristics according configuration */ 2182 /* set line characteristics according configuration */
2226 2183
2227 cy_writeb(base_addr + (CySCHR1 << index), START_CHAR(tty)); 2184 cyy_writeb(info, CySCHR1, START_CHAR(tty));
2228 cy_writeb(base_addr + (CySCHR2 << index), STOP_CHAR(tty)); 2185 cyy_writeb(info, CySCHR2, STOP_CHAR(tty));
2229 cy_writeb(base_addr + (CyCOR1 << index), info->cor1); 2186 cyy_writeb(info, CyCOR1, info->cor1);
2230 cy_writeb(base_addr + (CyCOR2 << index), info->cor2); 2187 cyy_writeb(info, CyCOR2, info->cor2);
2231 cy_writeb(base_addr + (CyCOR3 << index), info->cor3); 2188 cyy_writeb(info, CyCOR3, info->cor3);
2232 cy_writeb(base_addr + (CyCOR4 << index), info->cor4); 2189 cyy_writeb(info, CyCOR4, info->cor4);
2233 cy_writeb(base_addr + (CyCOR5 << index), info->cor5); 2190 cyy_writeb(info, CyCOR5, info->cor5);
2234 2191
2235 cyy_issue_cmd(base_addr, CyCOR_CHANGE | CyCOR1ch | CyCOR2ch | 2192 cyy_issue_cmd(info, CyCOR_CHANGE | CyCOR1ch | CyCOR2ch |
2236 CyCOR3ch, index); 2193 CyCOR3ch);
2237 2194
2238 /* !!! Is this needed? */ 2195 /* !!! Is this needed? */
2239 cy_writeb(base_addr + (CyCAR << index), (u_char) channel); 2196 cyy_writeb(info, CyCAR, channel);
2240 cy_writeb(base_addr + (CyRTPR << index), 2197 cyy_writeb(info, CyRTPR,
2241 (info->default_timeout ? info->default_timeout : 0x02)); 2198 (info->default_timeout ? info->default_timeout : 0x02));
2242 /* 10ms rx timeout */ 2199 /* 10ms rx timeout */
2243 2200
2244 if (C_CLOCAL(tty)) { 2201 if (C_CLOCAL(tty)) {
2245 /* without modem intr */ 2202 /* without modem intr */
2246 cy_writeb(base_addr + (CySRER << index), 2203 cyy_writeb(info, CySRER,
2247 readb(base_addr + (CySRER << index)) | CyMdmCh); 2204 cyy_readb(info, CySRER) | CyMdmCh);
2248 /* act on 1->0 modem transitions */ 2205 /* act on 1->0 modem transitions */
2249 if ((cflag & CRTSCTS) && info->rflow) { 2206 if ((cflag & CRTSCTS) && info->rflow) {
2250 cy_writeb(base_addr + (CyMCOR1 << index), 2207 cyy_writeb(info, CyMCOR1,
2251 (CyCTS | rflow_thr[i])); 2208 (CyCTS | rflow_thr[i]));
2252 } else { 2209 } else {
2253 cy_writeb(base_addr + (CyMCOR1 << index), 2210 cyy_writeb(info, CyMCOR1,
2254 CyCTS); 2211 CyCTS);
2255 } 2212 }
2256 /* act on 0->1 modem transitions */ 2213 /* act on 0->1 modem transitions */
2257 cy_writeb(base_addr + (CyMCOR2 << index), CyCTS); 2214 cyy_writeb(info, CyMCOR2, CyCTS);
2258 } else { 2215 } else {
2259 /* without modem intr */ 2216 /* without modem intr */
2260 cy_writeb(base_addr + (CySRER << index), 2217 cyy_writeb(info, CySRER,
2261 readb(base_addr + 2218 cyy_readb(info, CySRER) | CyMdmCh);
2262 (CySRER << index)) | CyMdmCh);
2263 /* act on 1->0 modem transitions */ 2219 /* act on 1->0 modem transitions */
2264 if ((cflag & CRTSCTS) && info->rflow) { 2220 if ((cflag & CRTSCTS) && info->rflow) {
2265 cy_writeb(base_addr + (CyMCOR1 << index), 2221 cyy_writeb(info, CyMCOR1,
2266 (CyDSR | CyCTS | CyRI | CyDCD | 2222 (CyDSR | CyCTS | CyRI | CyDCD |
2267 rflow_thr[i])); 2223 rflow_thr[i]));
2268 } else { 2224 } else {
2269 cy_writeb(base_addr + (CyMCOR1 << index), 2225 cyy_writeb(info, CyMCOR1,
2270 CyDSR | CyCTS | CyRI | CyDCD); 2226 CyDSR | CyCTS | CyRI | CyDCD);
2271 } 2227 }
2272 /* act on 0->1 modem transitions */ 2228 /* act on 0->1 modem transitions */
2273 cy_writeb(base_addr + (CyMCOR2 << index), 2229 cyy_writeb(info, CyMCOR2,
2274 CyDSR | CyCTS | CyRI | CyDCD); 2230 CyDSR | CyCTS | CyRI | CyDCD);
2275 } 2231 }
2276 2232
2277 if (i == 0) /* baud rate is zero, turn off line */ 2233 if (i == 0) /* baud rate is zero, turn off line */
@@ -2482,24 +2438,14 @@ check_and_exit:
2482 */ 2438 */
2483static int get_lsr_info(struct cyclades_port *info, unsigned int __user *value) 2439static int get_lsr_info(struct cyclades_port *info, unsigned int __user *value)
2484{ 2440{
2485 struct cyclades_card *card; 2441 struct cyclades_card *card = info->card;
2486 int chip, channel, index;
2487 unsigned char status;
2488 unsigned int result; 2442 unsigned int result;
2489 unsigned long flags; 2443 unsigned long flags;
2490 void __iomem *base_addr; 2444 u8 status;
2491 2445
2492 card = info->card;
2493 channel = (info->line) - (card->first_line);
2494 if (!cy_is_Z(card)) { 2446 if (!cy_is_Z(card)) {
2495 chip = channel >> 2;
2496 channel &= 0x03;
2497 index = card->bus_index;
2498 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
2499
2500 spin_lock_irqsave(&card->card_lock, flags); 2447 spin_lock_irqsave(&card->card_lock, flags);
2501 status = readb(base_addr + (CySRER << index)) & 2448 status = cyy_readb(info, CySRER) & (CyTxRdy | CyTxMpty);
2502 (CyTxRdy | CyTxMpty);
2503 spin_unlock_irqrestore(&card->card_lock, flags); 2449 spin_unlock_irqrestore(&card->card_lock, flags);
2504 result = (status ? 0 : TIOCSER_TEMT); 2450 result = (status ? 0 : TIOCSER_TEMT);
2505 } else { 2451 } else {
@@ -2513,29 +2459,23 @@ static int cy_tiocmget(struct tty_struct *tty, struct file *file)
2513{ 2459{
2514 struct cyclades_port *info = tty->driver_data; 2460 struct cyclades_port *info = tty->driver_data;
2515 struct cyclades_card *card; 2461 struct cyclades_card *card;
2516 void __iomem *base_addr; 2462 int result;
2517 int result, channel;
2518 2463
2519 if (serial_paranoia_check(info, tty->name, __func__)) 2464 if (serial_paranoia_check(info, tty->name, __func__))
2520 return -ENODEV; 2465 return -ENODEV;
2521 2466
2522 card = info->card; 2467 card = info->card;
2523 channel = info->line - card->first_line;
2524 2468
2525 lock_kernel(); 2469 lock_kernel();
2526 if (!cy_is_Z(card)) { 2470 if (!cy_is_Z(card)) {
2527 unsigned long flags; 2471 unsigned long flags;
2528 unsigned char status; 2472 int channel = info->line - card->first_line;
2529 int chip = channel >> 2; 2473 u8 status;
2530 int index = card->bus_index;
2531
2532 channel &= 0x03;
2533 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
2534 2474
2535 spin_lock_irqsave(&card->card_lock, flags); 2475 spin_lock_irqsave(&card->card_lock, flags);
2536 cy_writeb(base_addr + (CyCAR << index), (u8)channel); 2476 cyy_writeb(info, CyCAR, channel & 0x03);
2537 status = readb(base_addr + (CyMSVR1 << index)); 2477 status = cyy_readb(info, CyMSVR1);
2538 status |= readb(base_addr + (CyMSVR2 << index)); 2478 status |= cyy_readb(info, CyMSVR2);
2539 spin_unlock_irqrestore(&card->card_lock, flags); 2479 spin_unlock_irqrestore(&card->card_lock, flags);
2540 2480
2541 if (info->rtsdtr_inv) { 2481 if (info->rtsdtr_inv) {
@@ -2689,26 +2629,16 @@ static int cy_break(struct tty_struct *tty, int break_state)
2689 2629
2690static int set_threshold(struct cyclades_port *info, unsigned long value) 2630static int set_threshold(struct cyclades_port *info, unsigned long value)
2691{ 2631{
2692 struct cyclades_card *card; 2632 struct cyclades_card *card = info->card;
2693 void __iomem *base_addr;
2694 int channel, chip, index;
2695 unsigned long flags; 2633 unsigned long flags;
2696 2634
2697 card = info->card;
2698 channel = info->line - card->first_line;
2699 if (!cy_is_Z(card)) { 2635 if (!cy_is_Z(card)) {
2700 chip = channel >> 2;
2701 channel &= 0x03;
2702 index = card->bus_index;
2703 base_addr =
2704 card->base_addr + (cy_chip_offset[chip] << index);
2705
2706 info->cor3 &= ~CyREC_FIFO; 2636 info->cor3 &= ~CyREC_FIFO;
2707 info->cor3 |= value & CyREC_FIFO; 2637 info->cor3 |= value & CyREC_FIFO;
2708 2638
2709 spin_lock_irqsave(&card->card_lock, flags); 2639 spin_lock_irqsave(&card->card_lock, flags);
2710 cy_writeb(base_addr + (CyCOR3 << index), info->cor3); 2640 cyy_writeb(info, CyCOR3, info->cor3);
2711 cyy_issue_cmd(base_addr, CyCOR_CHANGE | CyCOR3ch, index); 2641 cyy_issue_cmd(info, CyCOR_CHANGE | CyCOR3ch);
2712 spin_unlock_irqrestore(&card->card_lock, flags); 2642 spin_unlock_irqrestore(&card->card_lock, flags);
2713 } 2643 }
2714 return 0; 2644 return 0;
@@ -2717,20 +2647,10 @@ static int set_threshold(struct cyclades_port *info, unsigned long value)
2717static int get_threshold(struct cyclades_port *info, 2647static int get_threshold(struct cyclades_port *info,
2718 unsigned long __user *value) 2648 unsigned long __user *value)
2719{ 2649{
2720 struct cyclades_card *card; 2650 struct cyclades_card *card = info->card;
2721 void __iomem *base_addr;
2722 int channel, chip, index;
2723 unsigned long tmp;
2724 2651
2725 card = info->card;
2726 channel = info->line - card->first_line;
2727 if (!cy_is_Z(card)) { 2652 if (!cy_is_Z(card)) {
2728 chip = channel >> 2; 2653 u8 tmp = cyy_readb(info, CyCOR3) & CyREC_FIFO;
2729 channel &= 0x03;
2730 index = card->bus_index;
2731 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
2732
2733 tmp = readb(base_addr + (CyCOR3 << index)) & CyREC_FIFO;
2734 return put_user(tmp, value); 2654 return put_user(tmp, value);
2735 } 2655 }
2736 return 0; 2656 return 0;
@@ -2738,21 +2658,12 @@ static int get_threshold(struct cyclades_port *info,
2738 2658
2739static int set_timeout(struct cyclades_port *info, unsigned long value) 2659static int set_timeout(struct cyclades_port *info, unsigned long value)
2740{ 2660{
2741 struct cyclades_card *card; 2661 struct cyclades_card *card = info->card;
2742 void __iomem *base_addr;
2743 int channel, chip, index;
2744 unsigned long flags; 2662 unsigned long flags;
2745 2663
2746 card = info->card;
2747 channel = info->line - card->first_line;
2748 if (!cy_is_Z(card)) { 2664 if (!cy_is_Z(card)) {
2749 chip = channel >> 2;
2750 channel &= 0x03;
2751 index = card->bus_index;
2752 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
2753
2754 spin_lock_irqsave(&card->card_lock, flags); 2665 spin_lock_irqsave(&card->card_lock, flags);
2755 cy_writeb(base_addr + (CyRTPR << index), value & 0xff); 2666 cyy_writeb(info, CyRTPR, value & 0xff);
2756 spin_unlock_irqrestore(&card->card_lock, flags); 2667 spin_unlock_irqrestore(&card->card_lock, flags);
2757 } 2668 }
2758 return 0; 2669 return 0;
@@ -2761,20 +2672,10 @@ static int set_timeout(struct cyclades_port *info, unsigned long value)
2761static int get_timeout(struct cyclades_port *info, 2672static int get_timeout(struct cyclades_port *info,
2762 unsigned long __user *value) 2673 unsigned long __user *value)
2763{ 2674{
2764 struct cyclades_card *card; 2675 struct cyclades_card *card = info->card;
2765 void __iomem *base_addr;
2766 int channel, chip, index;
2767 unsigned long tmp;
2768 2676
2769 card = info->card;
2770 channel = info->line - card->first_line;
2771 if (!cy_is_Z(card)) { 2677 if (!cy_is_Z(card)) {
2772 chip = channel >> 2; 2678 u8 tmp = cyy_readb(info, CyRTPR);
2773 channel &= 0x03;
2774 index = card->bus_index;
2775 base_addr = card->base_addr + (cy_chip_offset[chip] << index);
2776
2777 tmp = readb(base_addr + (CyRTPR << index));
2778 return put_user(tmp, value); 2679 return put_user(tmp, value);
2779 } 2680 }
2780 return 0; 2681 return 0;
@@ -3101,8 +3002,7 @@ static void cy_stop(struct tty_struct *tty)
3101{ 3002{
3102 struct cyclades_card *cinfo; 3003 struct cyclades_card *cinfo;
3103 struct cyclades_port *info = tty->driver_data; 3004 struct cyclades_port *info = tty->driver_data;
3104 void __iomem *base_addr; 3005 int channel;
3105 int chip, channel, index;
3106 unsigned long flags; 3006 unsigned long flags;
3107 3007
3108#ifdef CY_DEBUG_OTHER 3008#ifdef CY_DEBUG_OTHER
@@ -3115,16 +3015,9 @@ static void cy_stop(struct tty_struct *tty)
3115 cinfo = info->card; 3015 cinfo = info->card;
3116 channel = info->line - cinfo->first_line; 3016 channel = info->line - cinfo->first_line;
3117 if (!cy_is_Z(cinfo)) { 3017 if (!cy_is_Z(cinfo)) {
3118 index = cinfo->bus_index;
3119 chip = channel >> 2;
3120 channel &= 0x03;
3121 base_addr = cinfo->base_addr + (cy_chip_offset[chip] << index);
3122
3123 spin_lock_irqsave(&cinfo->card_lock, flags); 3018 spin_lock_irqsave(&cinfo->card_lock, flags);
3124 cy_writeb(base_addr + (CyCAR << index), 3019 cyy_writeb(info, CyCAR, channel & 0x03);
3125 (u_char)(channel & 0x0003)); /* index channel */ 3020 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) & ~CyTxRdy);
3126 cy_writeb(base_addr + (CySRER << index),
3127 readb(base_addr + (CySRER << index)) & ~CyTxRdy);
3128 spin_unlock_irqrestore(&cinfo->card_lock, flags); 3021 spin_unlock_irqrestore(&cinfo->card_lock, flags);
3129 } 3022 }
3130} /* cy_stop */ 3023} /* cy_stop */
@@ -3133,8 +3026,7 @@ static void cy_start(struct tty_struct *tty)
3133{ 3026{
3134 struct cyclades_card *cinfo; 3027 struct cyclades_card *cinfo;
3135 struct cyclades_port *info = tty->driver_data; 3028 struct cyclades_port *info = tty->driver_data;
3136 void __iomem *base_addr; 3029 int channel;
3137 int chip, channel, index;
3138 unsigned long flags; 3030 unsigned long flags;
3139 3031
3140#ifdef CY_DEBUG_OTHER 3032#ifdef CY_DEBUG_OTHER
@@ -3146,17 +3038,10 @@ static void cy_start(struct tty_struct *tty)
3146 3038
3147 cinfo = info->card; 3039 cinfo = info->card;
3148 channel = info->line - cinfo->first_line; 3040 channel = info->line - cinfo->first_line;
3149 index = cinfo->bus_index;
3150 if (!cy_is_Z(cinfo)) { 3041 if (!cy_is_Z(cinfo)) {
3151 chip = channel >> 2;
3152 channel &= 0x03;
3153 base_addr = cinfo->base_addr + (cy_chip_offset[chip] << index);
3154
3155 spin_lock_irqsave(&cinfo->card_lock, flags); 3042 spin_lock_irqsave(&cinfo->card_lock, flags);
3156 cy_writeb(base_addr + (CyCAR << index), 3043 cyy_writeb(info, CyCAR, channel & 0x03);
3157 (u_char) (channel & 0x0003)); /* index channel */ 3044 cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyTxRdy);
3158 cy_writeb(base_addr + (CySRER << index),
3159 readb(base_addr + (CySRER << index)) | CyTxRdy);
3160 spin_unlock_irqrestore(&cinfo->card_lock, flags); 3045 spin_unlock_irqrestore(&cinfo->card_lock, flags);
3161 } 3046 }
3162} /* cy_start */ 3047} /* cy_start */
@@ -3185,18 +3070,13 @@ static int cyy_carrier_raised(struct tty_port *port)
3185 struct cyclades_port *info = container_of(port, struct cyclades_port, 3070 struct cyclades_port *info = container_of(port, struct cyclades_port,
3186 port); 3071 port);
3187 struct cyclades_card *cinfo = info->card; 3072 struct cyclades_card *cinfo = info->card;
3188 void __iomem *base = cinfo->base_addr;
3189 unsigned long flags; 3073 unsigned long flags;
3190 int channel = info->line - cinfo->first_line; 3074 int channel = info->line - cinfo->first_line;
3191 int chip = channel >> 2, index = cinfo->bus_index;
3192 u32 cd; 3075 u32 cd;
3193 3076
3194 channel &= 0x03;
3195 base += cy_chip_offset[chip] << index;
3196
3197 spin_lock_irqsave(&cinfo->card_lock, flags); 3077 spin_lock_irqsave(&cinfo->card_lock, flags);
3198 cy_writeb(base + (CyCAR << index), (u8)channel); 3078 cyy_writeb(info, CyCAR, channel & 0x03);
3199 cd = readb(base + (CyMSVR1 << index)) & CyDCD; 3079 cd = cyy_readb(info, CyMSVR1) & CyDCD;
3200 spin_unlock_irqrestore(&cinfo->card_lock, flags); 3080 spin_unlock_irqrestore(&cinfo->card_lock, flags);
3201 3081
3202 return cd; 3082 return cd;
@@ -3326,9 +3206,9 @@ static int __devinit cy_init_card(struct cyclades_card *cinfo)
3326 info->cor3 = 0x08; /* _very_ small rcv threshold */ 3206 info->cor3 = 0x08; /* _very_ small rcv threshold */
3327 3207
3328 chip_number = channel / CyPORTS_PER_CHIP; 3208 chip_number = channel / CyPORTS_PER_CHIP;
3329 info->chip_rev = readb(cinfo->base_addr + 3209 info->u.cyy.base_addr = cinfo->base_addr +
3330 (cy_chip_offset[chip_number] << index) + 3210 (cy_chip_offset[chip_number] << index);
3331 (CyGFRCR << index)); 3211 info->chip_rev = cyy_readb(info, CyGFRCR);
3332 3212
3333 if (info->chip_rev >= CD1400_REV_J) { 3213 if (info->chip_rev >= CD1400_REV_J) {
3334 /* It is a CD1400 rev. J or later */ 3214 /* It is a CD1400 rev. J or later */