| /* $Id: aurora.c,v 1.19 2002/01/08 16:00:16 davem Exp $ | |
| * linux/drivers/sbus/char/aurora.c -- Aurora multiport driver | |
| * | |
| * Copyright (c) 1999 by Oliver Aldulea (oli at bv dot ro) | |
| * | |
| * This code is based on the RISCom/8 multiport serial driver written | |
| * by Dmitry Gorodchanin (pgmdsg@ibi.com), based on the Linux serial | |
| * driver, written by Linus Torvalds, Theodore T'so and others. | |
| * The Aurora multiport programming info was obtained mainly from the | |
| * Cirrus Logic CD180 documentation (available on the web), and by | |
| * doing heavy tests on the board. Many thanks to Eddie C. Dost for the | |
| * help on the sbus interface. | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of the GNU General Public License as published by | |
| * the Free Software Foundation; either version 2 of the License, or | |
| * (at your option) any later version. | |
| * | |
| * This program is distributed in the hope that it will be useful, | |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| * GNU General Public License for more details. | |
| * | |
| * You should have received a copy of the GNU General Public License | |
| * along with this program; if not, write to the Free Software | |
| * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
| * | |
| * Revision 1.0 | |
| * | |
| * This is the first public release. | |
| * | |
| * Most of the information you need is in the aurora.h file. Please | |
| * read that file before reading this one. | |
| * | |
| * Several parts of the code do not have comments yet. | |
| * | |
| * n.b. The board can support 115.2 bit rates, but only on a few | |
| * ports. The total badwidth of one chip (ports 0-7 or 8-15) is equal | |
| * to OSC_FREQ div 16. In case of my board, each chip can take 6 | |
| * channels of 115.2 kbaud. This information is not well-tested. | |
| * | |
| * Fixed to use tty_get_baud_rate(). | |
| * Theodore Ts'o <tytso@mit.edu>, 2001-Oct-12 | |
| */ | |
| #include <linux/module.h> | |
| #include <linux/errno.h> | |
| #include <linux/sched.h> | |
| #ifdef AURORA_INT_DEBUG | |
| #include <linux/timer.h> | |
| #endif | |
| #include <linux/interrupt.h> | |
| #include <linux/tty.h> | |
| #include <linux/tty_flip.h> | |
| #include <linux/major.h> | |
| #include <linux/string.h> | |
| #include <linux/fcntl.h> | |
| #include <linux/mm.h> | |
| #include <linux/kernel.h> | |
| #include <linux/init.h> | |
| #include <linux/delay.h> | |
| #include <linux/bitops.h> | |
| #include <asm/io.h> | |
| #include <asm/irq.h> | |
| #include <asm/oplib.h> | |
| #include <asm/system.h> | |
| #include <asm/kdebug.h> | |
| #include <asm/sbus.h> | |
| #include <asm/uaccess.h> | |
| #include "aurora.h" | |
| #include "cd180.h" | |
| unsigned char irqs[4] = { | |
| 0, 0, 0, 0 | |
| }; | |
| #ifdef AURORA_INT_DEBUG | |
| int irqhit=0; | |
| #endif | |
| static struct tty_driver *aurora_driver; | |
| static struct Aurora_board aurora_board[AURORA_NBOARD] = { | |
| {0,}, | |
| }; | |
| static struct Aurora_port aurora_port[AURORA_TNPORTS] = { | |
| { 0, }, | |
| }; | |
| /* no longer used. static struct Aurora_board * IRQ_to_board[16] = { NULL, } ;*/ | |
| static unsigned char * tmp_buf = NULL; | |
| DECLARE_TASK_QUEUE(tq_aurora); | |
| static inline int aurora_paranoia_check(struct Aurora_port const * port, | |
| char *name, const char *routine) | |
| { | |
| #ifdef AURORA_PARANOIA_CHECK | |
| static const char *badmagic = | |
| KERN_DEBUG "aurora: Warning: bad aurora port magic number for device %s in %s\n"; | |
| static const char *badinfo = | |
| KERN_DEBUG "aurora: Warning: null aurora port for device %s in %s\n"; | |
| if (!port) { | |
| printk(badinfo, name, routine); | |
| return 1; | |
| } | |
| if (port->magic != AURORA_MAGIC) { | |
| printk(badmagic, name, routine); | |
| return 1; | |
| } | |
| #endif | |
| return 0; | |
| } | |
| /* | |
| * | |
| * Service functions for aurora driver. | |
| * | |
| */ | |
| /* Get board number from pointer */ | |
| static inline int board_No (struct Aurora_board const * bp) | |
| { | |
| return bp - aurora_board; | |
| } | |
| /* Get port number from pointer */ | |
| static inline int port_No (struct Aurora_port const * port) | |
| { | |
| return AURORA_PORT(port - aurora_port); | |
| } | |
| /* Get pointer to board from pointer to port */ | |
| static inline struct Aurora_board * port_Board(struct Aurora_port const * port) | |
| { | |
| return &aurora_board[AURORA_BOARD(port - aurora_port)]; | |
| } | |
| /* Wait for Channel Command Register ready */ | |
| static inline void aurora_wait_CCR(struct aurora_reg128 * r) | |
| { | |
| unsigned long delay; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_wait_CCR\n"); | |
| #endif | |
| /* FIXME: need something more descriptive than 100000 :) */ | |
| for (delay = 100000; delay; delay--) | |
| if (!sbus_readb(&r->r[CD180_CCR])) | |
| return; | |
| printk(KERN_DEBUG "aurora: Timeout waiting for CCR.\n"); | |
| } | |
| /* | |
| * aurora probe functions. | |
| */ | |
| /* Must be called with enabled interrupts */ | |
| static inline void aurora_long_delay(unsigned long delay) | |
| { | |
| unsigned long i; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_long_delay: start\n"); | |
| #endif | |
| for (i = jiffies + delay; time_before(jiffies, i); ) ; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_long_delay: end\n"); | |
| #endif | |
| } | |
| /* Reset and setup CD180 chip */ | |
| static int aurora_init_CD180(struct Aurora_board * bp, int chip) | |
| { | |
| unsigned long flags; | |
| int id; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_init_CD180: start %d:%d\n", | |
| board_No(bp), chip); | |
| #endif | |
| save_flags(flags); cli(); | |
| sbus_writeb(0, &bp->r[chip]->r[CD180_CAR]); | |
| sbus_writeb(0, &bp->r[chip]->r[CD180_GSVR]); | |
| /* Wait for CCR ready */ | |
| aurora_wait_CCR(bp->r[chip]); | |
| /* Reset CD180 chip */ | |
| sbus_writeb(CCR_HARDRESET, &bp->r[chip]->r[CD180_CCR]); | |
| udelay(1); | |
| sti(); | |
| id=1000; | |
| while((--id) && | |
| (sbus_readb(&bp->r[chip]->r[CD180_GSVR])!=0xff))udelay(100); | |
| if(!id) { | |
| printk(KERN_ERR "aurora%d: Chip %d failed init.\n", | |
| board_No(bp), chip); | |
| restore_flags(flags); | |
| return(-1); | |
| } | |
| cli(); | |
| sbus_writeb((board_No(bp)<<5)|((chip+1)<<3), | |
| &bp->r[chip]->r[CD180_GSVR]); /* Set ID for this chip */ | |
| sbus_writeb(0x80|bp->ACK_MINT, | |
| &bp->r[chip]->r[CD180_MSMR]); /* Prio for modem intr */ | |
| sbus_writeb(0x80|bp->ACK_TINT, | |
| &bp->r[chip]->r[CD180_TSMR]); /* Prio for transmitter intr */ | |
| sbus_writeb(0x80|bp->ACK_RINT, | |
| &bp->r[chip]->r[CD180_RSMR]); /* Prio for receiver intr */ | |
| /* Setting up prescaler. We need 4 tick per 1 ms */ | |
| sbus_writeb((bp->oscfreq/(1000000/AURORA_TPS)) >> 8, | |
| &bp->r[chip]->r[CD180_PPRH]); | |
| sbus_writeb((bp->oscfreq/(1000000/AURORA_TPS)) & 0xff, | |
| &bp->r[chip]->r[CD180_PPRL]); | |
| sbus_writeb(SRCR_AUTOPRI|SRCR_GLOBPRI, | |
| &bp->r[chip]->r[CD180_SRCR]); | |
| id = sbus_readb(&bp->r[chip]->r[CD180_GFRCR]); | |
| printk(KERN_INFO "aurora%d: Chip %d id %02x: ", | |
| board_No(bp), chip,id); | |
| if(sbus_readb(&bp->r[chip]->r[CD180_SRCR]) & 128) { | |
| switch (id) { | |
| case 0x82:printk("CL-CD1864 rev A\n");break; | |
| case 0x83:printk("CL-CD1865 rev A\n");break; | |
| case 0x84:printk("CL-CD1865 rev B\n");break; | |
| case 0x85:printk("CL-CD1865 rev C\n");break; | |
| default:printk("Unknown.\n"); | |
| }; | |
| } else { | |
| switch (id) { | |
| case 0x81:printk("CL-CD180 rev B\n");break; | |
| case 0x82:printk("CL-CD180 rev C\n");break; | |
| default:printk("Unknown.\n"); | |
| }; | |
| } | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_init_CD180: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| static int valid_irq(unsigned char irq) | |
| { | |
| int i; | |
| for(i=0;i<TYPE_1_IRQS;i++) | |
| if (type_1_irq[i]==irq) return 1; | |
| return 0; | |
| } | |
| static irqreturn_t aurora_interrupt(int irq, void * dev_id); | |
| /* Main probing routine, also sets irq. */ | |
| static int aurora_probe(void) | |
| { | |
| struct sbus_bus *sbus; | |
| struct sbus_dev *sdev; | |
| int grrr; | |
| char buf[30]; | |
| int bn = 0; | |
| struct Aurora_board *bp; | |
| for_each_sbus(sbus) { | |
| for_each_sbusdev(sdev, sbus) { | |
| /* printk("Try: %x %s\n",sdev,sdev->prom_name);*/ | |
| if (!strcmp(sdev->prom_name, "sio16")) { | |
| #ifdef AURORA_DEBUG | |
| printk(KERN_INFO "aurora: sio16 at %p\n",sdev); | |
| #endif | |
| if((sdev->reg_addrs[0].reg_size!=1) && | |
| (sdev->reg_addrs[1].reg_size!=128) && | |
| (sdev->reg_addrs[2].reg_size!=128) && | |
| (sdev->reg_addrs[3].reg_size!=4)) { | |
| printk(KERN_ERR "aurora%d: registers' sizes " | |
| "do not match.\n", bn); | |
| break; | |
| } | |
| bp = &aurora_board[bn]; | |
| bp->r0 = (struct aurora_reg1 *) | |
| sbus_ioremap(&sdev->resource[0], 0, | |
| sdev->reg_addrs[0].reg_size, | |
| "sio16"); | |
| if (bp->r0 == NULL) { | |
| printk(KERN_ERR "aurora%d: can't map " | |
| "reg_addrs[0]\n", bn); | |
| break; | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("Map reg 0: %p\n", bp->r0); | |
| #endif | |
| bp->r[0] = (struct aurora_reg128 *) | |
| sbus_ioremap(&sdev->resource[1], 0, | |
| sdev->reg_addrs[1].reg_size, | |
| "sio16"); | |
| if (bp->r[0] == NULL) { | |
| printk(KERN_ERR "aurora%d: can't map " | |
| "reg_addrs[1]\n", bn); | |
| break; | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("Map reg 1: %p\n", bp->r[0]); | |
| #endif | |
| bp->r[1] = (struct aurora_reg128 *) | |
| sbus_ioremap(&sdev->resource[2], 0, | |
| sdev->reg_addrs[2].reg_size, | |
| "sio16"); | |
| if (bp->r[1] == NULL) { | |
| printk(KERN_ERR "aurora%d: can't map " | |
| "reg_addrs[2]\n", bn); | |
| break; | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("Map reg 2: %p\n", bp->r[1]); | |
| #endif | |
| bp->r3 = (struct aurora_reg4 *) | |
| sbus_ioremap(&sdev->resource[3], 0, | |
| sdev->reg_addrs[3].reg_size, | |
| "sio16"); | |
| if (bp->r3 == NULL) { | |
| printk(KERN_ERR "aurora%d: can't map " | |
| "reg_addrs[3]\n", bn); | |
| break; | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("Map reg 3: %p\n", bp->r3); | |
| #endif | |
| /* Variables setup */ | |
| bp->flags = 0; | |
| #ifdef AURORA_DEBUG | |
| grrr=prom_getint(sdev->prom_node,"intr"); | |
| printk("intr pri %d\n", grrr); | |
| #endif | |
| if ((bp->irq=irqs[bn]) && valid_irq(bp->irq) && | |
| !request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED, "sio16", bp)) { | |
| free_irq(bp->irq|0x30, bp); | |
| } else | |
| if ((bp->irq=prom_getint(sdev->prom_node, "bintr")) && valid_irq(bp->irq) && | |
| !request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED, "sio16", bp)) { | |
| free_irq(bp->irq|0x30, bp); | |
| } else | |
| if ((bp->irq=prom_getint(sdev->prom_node, "intr")) && valid_irq(bp->irq) && | |
| !request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED, "sio16", bp)) { | |
| free_irq(bp->irq|0x30, bp); | |
| } else | |
| for(grrr=0;grrr<TYPE_1_IRQS;grrr++) { | |
| if ((bp->irq=type_1_irq[grrr])&&!request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED, "sio16", bp)) { | |
| free_irq(bp->irq|0x30, bp); | |
| break; | |
| } else { | |
| printk(KERN_ERR "aurora%d: Could not get an irq for this board !!!\n",bn); | |
| bp->flags=0xff; | |
| } | |
| } | |
| if(bp->flags==0xff)break; | |
| printk(KERN_INFO "aurora%d: irq %d\n",bn,bp->irq&0x0f); | |
| buf[0]=0; | |
| grrr=prom_getproperty(sdev->prom_node,"dtr_rts",buf,sizeof(buf)); | |
| if(!strcmp(buf,"swapped")){ | |
| printk(KERN_INFO "aurora%d: Swapped DTR and RTS\n",bn); | |
| bp->DTR=MSVR_RTS; | |
| bp->RTS=MSVR_DTR; | |
| bp->MSVDTR=CD180_MSVRTS; | |
| bp->MSVRTS=CD180_MSVDTR; | |
| bp->flags|=AURORA_BOARD_DTR_FLOW_OK; | |
| }else{ | |
| #ifdef AURORA_FORCE_DTR_FLOW | |
| printk(KERN_INFO "aurora%d: Forcing swapped DTR-RTS\n",bn); | |
| bp->DTR=MSVR_RTS; | |
| bp->RTS=MSVR_DTR; | |
| bp->MSVDTR=CD180_MSVRTS; | |
| bp->MSVRTS=CD180_MSVDTR; | |
| bp->flags|=AURORA_BOARD_DTR_FLOW_OK; | |
| #else | |
| printk(KERN_INFO "aurora%d: Normal DTR and RTS\n",bn); | |
| bp->DTR=MSVR_DTR; | |
| bp->RTS=MSVR_RTS; | |
| bp->MSVDTR=CD180_MSVDTR; | |
| bp->MSVRTS=CD180_MSVRTS; | |
| #endif | |
| } | |
| bp->oscfreq=prom_getint(sdev->prom_node,"clk")*100; | |
| printk(KERN_INFO "aurora%d: Oscillator: %d Hz\n",bn,bp->oscfreq); | |
| grrr=prom_getproperty(sdev->prom_node,"chip",buf,sizeof(buf)); | |
| printk(KERN_INFO "aurora%d: Chips: %s\n",bn,buf); | |
| grrr=prom_getproperty(sdev->prom_node,"manu",buf,sizeof(buf)); | |
| printk(KERN_INFO "aurora%d: Manufacturer: %s\n",bn,buf); | |
| grrr=prom_getproperty(sdev->prom_node,"model",buf,sizeof(buf)); | |
| printk(KERN_INFO "aurora%d: Model: %s\n",bn,buf); | |
| grrr=prom_getproperty(sdev->prom_node,"rev",buf,sizeof(buf)); | |
| printk(KERN_INFO "aurora%d: Revision: %s\n",bn,buf); | |
| grrr=prom_getproperty(sdev->prom_node,"mode",buf,sizeof(buf)); | |
| printk(KERN_INFO "aurora%d: Mode: %s\n",bn,buf); | |
| #ifdef MODULE | |
| bp->count=0; | |
| #endif | |
| bp->flags = AURORA_BOARD_PRESENT; | |
| /* hardware ack */ | |
| bp->ACK_MINT=1; | |
| bp->ACK_TINT=2; | |
| bp->ACK_RINT=3; | |
| bn++; | |
| } | |
| } | |
| } | |
| return bn; | |
| } | |
| static void aurora_release_io_range(struct Aurora_board *bp) | |
| { | |
| sbus_iounmap((unsigned long)bp->r0, 1); | |
| sbus_iounmap((unsigned long)bp->r[0], 128); | |
| sbus_iounmap((unsigned long)bp->r[1], 128); | |
| sbus_iounmap((unsigned long)bp->r3, 4); | |
| } | |
| static inline void aurora_mark_event(struct Aurora_port * port, int event) | |
| { | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_mark_event: start\n"); | |
| #endif | |
| set_bit(event, &port->event); | |
| queue_task(&port->tqueue, &tq_aurora); | |
| mark_bh(AURORA_BH); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_mark_event: end\n"); | |
| #endif | |
| } | |
| static __inline__ struct Aurora_port * aurora_get_port(struct Aurora_board const * bp, | |
| int chip, | |
| unsigned char const *what) | |
| { | |
| unsigned char channel; | |
| struct Aurora_port * port; | |
| channel = ((chip << 3) | | |
| ((sbus_readb(&bp->r[chip]->r[CD180_GSCR]) & GSCR_CHAN) >> GSCR_CHAN_OFF)); | |
| port = &aurora_port[board_No(bp) * AURORA_NPORT * AURORA_NCD180 + channel]; | |
| if (port->flags & ASYNC_INITIALIZED) | |
| return port; | |
| printk(KERN_DEBUG "aurora%d: %s interrupt from invalid port %d\n", | |
| board_No(bp), what, channel); | |
| return NULL; | |
| } | |
| static void aurora_receive_exc(struct Aurora_board const * bp, int chip) | |
| { | |
| struct Aurora_port *port; | |
| struct tty_struct *tty; | |
| unsigned char status; | |
| unsigned char ch; | |
| if (!(port = aurora_get_port(bp, chip, "Receive_x"))) | |
| return; | |
| tty = port->tty; | |
| if (tty->flip.count >= TTY_FLIPBUF_SIZE) { | |
| #ifdef AURORA_INTNORM | |
| printk("aurora%d: port %d: Working around flip buffer overflow.\n", | |
| board_No(bp), port_No(port)); | |
| #endif | |
| return; | |
| } | |
| #ifdef AURORA_REPORT_OVERRUN | |
| status = sbus_readb(&bp->r[chip]->r[CD180_RCSR]); | |
| if (status & RCSR_OE) { | |
| port->overrun++; | |
| #if 1 | |
| printk("aurora%d: port %d: Overrun. Total %ld overruns.\n", | |
| board_No(bp), port_No(port), port->overrun); | |
| #endif | |
| } | |
| status &= port->mark_mask; | |
| #else | |
| status = sbus_readb(&bp->r[chip]->r[CD180_RCSR]) & port->mark_mask; | |
| #endif | |
| ch = sbus_readb(&bp->r[chip]->r[CD180_RDR]); | |
| if (!status) | |
| return; | |
| if (status & RCSR_TOUT) { | |
| /* printk("aurora%d: port %d: Receiver timeout. Hardware problems ?\n", | |
| board_No(bp), port_No(port));*/ | |
| return; | |
| } else if (status & RCSR_BREAK) { | |
| printk(KERN_DEBUG "aurora%d: port %d: Handling break...\n", | |
| board_No(bp), port_No(port)); | |
| *tty->flip.flag_buf_ptr++ = TTY_BREAK; | |
| if (port->flags & ASYNC_SAK) | |
| do_SAK(tty); | |
| } else if (status & RCSR_PE) | |
| *tty->flip.flag_buf_ptr++ = TTY_PARITY; | |
| else if (status & RCSR_FE) | |
| *tty->flip.flag_buf_ptr++ = TTY_FRAME; | |
| else if (status & RCSR_OE) | |
| *tty->flip.flag_buf_ptr++ = TTY_OVERRUN; | |
| else | |
| *tty->flip.flag_buf_ptr++ = 0; | |
| *tty->flip.char_buf_ptr++ = ch; | |
| tty->flip.count++; | |
| queue_task(&tty->flip.tqueue, &tq_timer); | |
| } | |
| static void aurora_receive(struct Aurora_board const * bp, int chip) | |
| { | |
| struct Aurora_port *port; | |
| struct tty_struct *tty; | |
| unsigned char count,cnt; | |
| if (!(port = aurora_get_port(bp, chip, "Receive"))) | |
| return; | |
| tty = port->tty; | |
| count = sbus_readb(&bp->r[chip]->r[CD180_RDCR]); | |
| #ifdef AURORA_REPORT_FIFO | |
| port->hits[count > 8 ? 9 : count]++; | |
| #endif | |
| while (count--) { | |
| if (tty->flip.count >= TTY_FLIPBUF_SIZE) { | |
| #ifdef AURORA_INTNORM | |
| printk("aurora%d: port %d: Working around flip buffer overflow.\n", | |
| board_No(bp), port_No(port)); | |
| #endif | |
| break; | |
| } | |
| cnt = sbus_readb(&bp->r[chip]->r[CD180_RDR]); | |
| *tty->flip.char_buf_ptr++ = cnt; | |
| *tty->flip.flag_buf_ptr++ = 0; | |
| tty->flip.count++; | |
| } | |
| queue_task(&tty->flip.tqueue, &tq_timer); | |
| } | |
| static void aurora_transmit(struct Aurora_board const * bp, int chip) | |
| { | |
| struct Aurora_port *port; | |
| struct tty_struct *tty; | |
| unsigned char count; | |
| if (!(port = aurora_get_port(bp, chip, "Transmit"))) | |
| return; | |
| tty = port->tty; | |
| if (port->SRER & SRER_TXEMPTY) { | |
| /* FIFO drained */ | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| port->SRER &= ~SRER_TXEMPTY; | |
| sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]); | |
| return; | |
| } | |
| if ((port->xmit_cnt <= 0 && !port->break_length) | |
| || tty->stopped || tty->hw_stopped) { | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| port->SRER &= ~SRER_TXRDY; | |
| sbus_writeb(port->SRER, | |
| &bp->r[chip]->r[CD180_SRER]); | |
| return; | |
| } | |
| if (port->break_length) { | |
| if (port->break_length > 0) { | |
| if (port->COR2 & COR2_ETC) { | |
| sbus_writeb(CD180_C_ESC, | |
| &bp->r[chip]->r[CD180_TDR]); | |
| sbus_writeb(CD180_C_SBRK, | |
| &bp->r[chip]->r[CD180_TDR]); | |
| port->COR2 &= ~COR2_ETC; | |
| } | |
| count = min(port->break_length, 0xff); | |
| sbus_writeb(CD180_C_ESC, | |
| &bp->r[chip]->r[CD180_TDR]); | |
| sbus_writeb(CD180_C_DELAY, | |
| &bp->r[chip]->r[CD180_TDR]); | |
| sbus_writeb(count, | |
| &bp->r[chip]->r[CD180_TDR]); | |
| if (!(port->break_length -= count)) | |
| port->break_length--; | |
| } else { | |
| sbus_writeb(CD180_C_ESC, | |
| &bp->r[chip]->r[CD180_TDR]); | |
| sbus_writeb(CD180_C_EBRK, | |
| &bp->r[chip]->r[CD180_TDR]); | |
| sbus_writeb(port->COR2, | |
| &bp->r[chip]->r[CD180_COR2]); | |
| aurora_wait_CCR(bp->r[chip]); | |
| sbus_writeb(CCR_CORCHG2, | |
| &bp->r[chip]->r[CD180_CCR]); | |
| port->break_length = 0; | |
| } | |
| return; | |
| } | |
| count = CD180_NFIFO; | |
| do { | |
| u8 byte = port->xmit_buf[port->xmit_tail++]; | |
| sbus_writeb(byte, &bp->r[chip]->r[CD180_TDR]); | |
| port->xmit_tail = port->xmit_tail & (SERIAL_XMIT_SIZE-1); | |
| if (--port->xmit_cnt <= 0) | |
| break; | |
| } while (--count > 0); | |
| if (port->xmit_cnt <= 0) { | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| port->SRER &= ~SRER_TXRDY; | |
| sbus_writeb(port->SRER, | |
| &bp->r[chip]->r[CD180_SRER]); | |
| } | |
| if (port->xmit_cnt <= port->wakeup_chars) | |
| aurora_mark_event(port, RS_EVENT_WRITE_WAKEUP); | |
| } | |
| static void aurora_check_modem(struct Aurora_board const * bp, int chip) | |
| { | |
| struct Aurora_port *port; | |
| struct tty_struct *tty; | |
| unsigned char mcr; | |
| if (!(port = aurora_get_port(bp, chip, "Modem"))) | |
| return; | |
| tty = port->tty; | |
| mcr = sbus_readb(&bp->r[chip]->r[CD180_MCR]); | |
| if (mcr & MCR_CDCHG) { | |
| if (sbus_readb(&bp->r[chip]->r[CD180_MSVR]) & MSVR_CD) | |
| wake_up_interruptible(&port->open_wait); | |
| else | |
| schedule_task(&port->tqueue_hangup); | |
| } | |
| /* We don't have such things yet. My aurora board has DTR and RTS swapped, but that doesn't count in this driver. Let's hope | |
| * Aurora didn't made any boards with CTS or DSR broken... | |
| */ | |
| /* #ifdef AURORA_BRAIN_DAMAGED_CTS | |
| if (mcr & MCR_CTSCHG) { | |
| if (aurora_in(bp, CD180_MSVR) & MSVR_CTS) { | |
| tty->hw_stopped = 0; | |
| port->SRER |= SRER_TXRDY; | |
| if (port->xmit_cnt <= port->wakeup_chars) | |
| aurora_mark_event(port, RS_EVENT_WRITE_WAKEUP); | |
| } else { | |
| tty->hw_stopped = 1; | |
| port->SRER &= ~SRER_TXRDY; | |
| } | |
| sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]); | |
| } | |
| if (mcr & MCR_DSRCHG) { | |
| if (aurora_in(bp, CD180_MSVR) & MSVR_DSR) { | |
| tty->hw_stopped = 0; | |
| port->SRER |= SRER_TXRDY; | |
| if (port->xmit_cnt <= port->wakeup_chars) | |
| aurora_mark_event(port, RS_EVENT_WRITE_WAKEUP); | |
| } else { | |
| tty->hw_stopped = 1; | |
| port->SRER &= ~SRER_TXRDY; | |
| } | |
| sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]); | |
| } | |
| #endif AURORA_BRAIN_DAMAGED_CTS */ | |
| /* Clear change bits */ | |
| sbus_writeb(0, &bp->r[chip]->r[CD180_MCR]); | |
| } | |
| /* The main interrupt processing routine */ | |
| static irqreturn_t aurora_interrupt(int irq, void * dev_id) | |
| { | |
| unsigned char status; | |
| unsigned char ack,chip/*,chip_id*/; | |
| struct Aurora_board * bp = (struct Aurora_board *) dev_id; | |
| unsigned long loop = 0; | |
| #ifdef AURORA_INT_DEBUG | |
| printk("IRQ%d %d\n",irq,++irqhit); | |
| #ifdef AURORA_FLOODPRO | |
| if (irqhit>=AURORA_FLOODPRO) | |
| sbus_writeb(8, &bp->r0->r); | |
| #endif | |
| #endif | |
| /* old bp = IRQ_to_board[irq&0x0f];*/ | |
| if (!bp || !(bp->flags & AURORA_BOARD_ACTIVE)) | |
| return IRQ_NONE; | |
| /* The while() below takes care of this. | |
| status = sbus_readb(&bp->r[0]->r[CD180_SRSR]); | |
| #ifdef AURORA_INT_DEBUG | |
| printk("mumu: %02x\n", status); | |
| #endif | |
| if (!(status&SRSR_ANYINT)) | |
| return IRQ_NONE; * Nobody has anything to say, so exit * | |
| */ | |
| while ((loop++ < 48) && | |
| (status = sbus_readb(&bp->r[0]->r[CD180_SRSR]) & SRSR_ANYINT)){ | |
| #ifdef AURORA_INT_DEBUG | |
| printk("SRSR: %02x\n", status); | |
| #endif | |
| if (status & SRSR_REXT) { | |
| ack = sbus_readb(&bp->r3->r[bp->ACK_RINT]); | |
| #ifdef AURORA_INT_DEBUG | |
| printk("R-ACK %02x\n", ack); | |
| #endif | |
| if ((ack >> 5) == board_No(bp)) { | |
| if ((chip=((ack>>3)&3)-1) < AURORA_NCD180) { | |
| if ((ack&GSVR_ITMASK)==GSVR_IT_RGD) { | |
| aurora_receive(bp,chip); | |
| sbus_writeb(0, | |
| &bp->r[chip]->r[CD180_EOSRR]); | |
| } else if ((ack & GSVR_ITMASK) == GSVR_IT_REXC) { | |
| aurora_receive_exc(bp,chip); | |
| sbus_writeb(0, | |
| &bp->r[chip]->r[CD180_EOSRR]); | |
| } | |
| } | |
| } | |
| } else if (status & SRSR_TEXT) { | |
| ack = sbus_readb(&bp->r3->r[bp->ACK_TINT]); | |
| #ifdef AURORA_INT_DEBUG | |
| printk("T-ACK %02x\n", ack); | |
| #endif | |
| if ((ack >> 5) == board_No(bp)) { | |
| if ((chip=((ack>>3)&3)-1) < AURORA_NCD180) { | |
| if ((ack&GSVR_ITMASK)==GSVR_IT_TX) { | |
| aurora_transmit(bp,chip); | |
| sbus_writeb(0, | |
| &bp->r[chip]->r[CD180_EOSRR]); | |
| } | |
| } | |
| } | |
| } else if (status & SRSR_MEXT) { | |
| ack = sbus_readb(&bp->r3->r[bp->ACK_MINT]); | |
| #ifdef AURORA_INT_DEBUG | |
| printk("M-ACK %02x\n", ack); | |
| #endif | |
| if ((ack >> 5) == board_No(bp)) { | |
| if ((chip = ((ack>>3)&3)-1) < AURORA_NCD180) { | |
| if ((ack&GSVR_ITMASK)==GSVR_IT_MDM) { | |
| aurora_check_modem(bp,chip); | |
| sbus_writeb(0, | |
| &bp->r[chip]->r[CD180_EOSRR]); | |
| } | |
| } | |
| } | |
| } | |
| } | |
| /* I guess this faster code can be used with CD1865, using AUROPRI and GLOBPRI. */ | |
| #if 0 | |
| while ((loop++ < 48)&&(status=bp->r[0]->r[CD180_SRSR]&SRSR_ANYINT)){ | |
| #ifdef AURORA_INT_DEBUG | |
| printk("SRSR: %02x\n",status); | |
| #endif | |
| ack = sbus_readb(&bp->r3->r[0]); | |
| #ifdef AURORA_INT_DEBUG | |
| printk("ACK: %02x\n",ack); | |
| #endif | |
| if ((ack>>5)==board_No(bp)) { | |
| if ((chip=((ack>>3)&3)-1) < AURORA_NCD180) { | |
| ack&=GSVR_ITMASK; | |
| if (ack==GSVR_IT_RGD) { | |
| aurora_receive(bp,chip); | |
| sbus_writeb(0, | |
| &bp->r[chip]->r[CD180_EOSRR]); | |
| } else if (ack==GSVR_IT_REXC) { | |
| aurora_receive_exc(bp,chip); | |
| sbus_writeb(0, | |
| &bp->r[chip]->r[CD180_EOSRR]); | |
| } else if (ack==GSVR_IT_TX) { | |
| aurora_transmit(bp,chip); | |
| sbus_writeb(0, | |
| &bp->r[chip]->r[CD180_EOSRR]); | |
| } else if (ack==GSVR_IT_MDM) { | |
| aurora_check_modem(bp,chip); | |
| sbus_writeb(0, | |
| &bp->r[chip]->r[CD180_EOSRR]); | |
| } | |
| } | |
| } | |
| } | |
| #endif | |
| /* This is the old handling routine, used in riscom8 for only one CD180. I keep it here for reference. */ | |
| #if 0 | |
| for(chip=0;chip<AURORA_NCD180;chip++){ | |
| chip_id=(board_No(bp)<<5)|((chip+1)<<3); | |
| loop=0; | |
| while ((loop++ < 1) && | |
| ((status = sbus_readb(&bp->r[chip]->r[CD180_SRSR])) & | |
| (SRSR_TEXT | SRSR_MEXT | SRSR_REXT))) { | |
| if (status & SRSR_REXT) { | |
| ack = sbus_readb(&bp->r3->r[bp->ACK_RINT]); | |
| if (ack == (chip_id | GSVR_IT_RGD)) { | |
| #ifdef AURORA_INTMSG | |
| printk("RX ACK\n"); | |
| #endif | |
| aurora_receive(bp,chip); | |
| } else if (ack == (chip_id | GSVR_IT_REXC)) { | |
| #ifdef AURORA_INTMSG | |
| printk("RXC ACK\n"); | |
| #endif | |
| aurora_receive_exc(bp,chip); | |
| } else { | |
| #ifdef AURORA_INTNORM | |
| printk("aurora%d-%d: Bad receive ack 0x%02x.\n", | |
| board_No(bp), chip, ack); | |
| #endif | |
| } | |
| } else if (status & SRSR_TEXT) { | |
| ack = sbus_readb(&bp->r3->r[bp->ACK_TINT]); | |
| if (ack == (chip_id | GSVR_IT_TX)){ | |
| #ifdef AURORA_INTMSG | |
| printk("TX ACK\n"); | |
| #endif | |
| aurora_transmit(bp,chip); | |
| } else { | |
| #ifdef AURORA_INTNORM | |
| printk("aurora%d-%d: Bad transmit ack 0x%02x.\n", | |
| board_No(bp), chip, ack); | |
| #endif | |
| } | |
| } else if (status & SRSR_MEXT) { | |
| ack = sbus_readb(&bp->r3->r[bp->ACK_MINT]); | |
| if (ack == (chip_id | GSVR_IT_MDM)){ | |
| #ifdef AURORA_INTMSG | |
| printk("MDM ACK\n"); | |
| #endif | |
| aurora_check_modem(bp,chip); | |
| } else { | |
| #ifdef AURORA_INTNORM | |
| printk("aurora%d-%d: Bad modem ack 0x%02x.\n", | |
| board_No(bp), chip, ack); | |
| #endif | |
| } | |
| } | |
| sbus_writeb(0, &bp->r[chip]->r[CD180_EOSRR]); | |
| } | |
| } | |
| #endif | |
| return IRQ_HANDLED; | |
| } | |
| #ifdef AURORA_INT_DEBUG | |
| static void aurora_timer (unsigned long ignored); | |
| static DEFINE_TIMER(aurora_poll_timer, aurora_timer, 0, 0); | |
| static void | |
| aurora_timer (unsigned long ignored) | |
| { | |
| unsigned long flags; | |
| int i; | |
| save_flags(flags); cli(); | |
| printk("SRSR: %02x,%02x - ", | |
| sbus_readb(&aurora_board[0].r[0]->r[CD180_SRSR]), | |
| sbus_readb(&aurora_board[0].r[1]->r[CD180_SRSR])); | |
| for (i = 0; i < 4; i++) { | |
| udelay(1); | |
| printk("%02x ", | |
| sbus_readb(&aurora_board[0].r3->r[i])); | |
| } | |
| printk("\n"); | |
| aurora_poll_timer.expires = jiffies + 300; | |
| add_timer (&aurora_poll_timer); | |
| restore_flags(flags); | |
| } | |
| #endif | |
| /* | |
| * Routines for open & close processing. | |
| */ | |
| /* Called with disabled interrupts */ | |
| static int aurora_setup_board(struct Aurora_board * bp) | |
| { | |
| int error; | |
| #ifdef AURORA_ALLIRQ | |
| int i; | |
| for (i = 0; i < AURORA_ALLIRQ; i++) { | |
| error = request_irq(allirq[i]|0x30, aurora_interrupt, IRQF_SHARED, | |
| "sio16", bp); | |
| if (error) | |
| printk(KERN_ERR "IRQ%d request error %d\n", | |
| allirq[i], error); | |
| } | |
| #else | |
| error = request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED, | |
| "sio16", bp); | |
| if (error) { | |
| printk(KERN_ERR "IRQ request error %d\n", error); | |
| return error; | |
| } | |
| #endif | |
| /* Board reset */ | |
| sbus_writeb(0, &bp->r0->r); | |
| udelay(1); | |
| if (bp->flags & AURORA_BOARD_TYPE_2) { | |
| /* unknown yet */ | |
| } else { | |
| sbus_writeb((AURORA_CFG_ENABLE_IO | AURORA_CFG_ENABLE_IRQ | | |
| (((bp->irq)&0x0f)>>2)), | |
| &bp->r0->r); | |
| } | |
| udelay(10000); | |
| if (aurora_init_CD180(bp,0))error=1;error=0; | |
| if (aurora_init_CD180(bp,1))error++; | |
| if (error == AURORA_NCD180) { | |
| printk(KERN_ERR "Both chips failed initialisation.\n"); | |
| return -EIO; | |
| } | |
| #ifdef AURORA_INT_DEBUG | |
| aurora_poll_timer.expires= jiffies + 1; | |
| add_timer(&aurora_poll_timer); | |
| #endif | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_setup_board: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| /* Called with disabled interrupts */ | |
| static void aurora_shutdown_board(struct Aurora_board *bp) | |
| { | |
| int i; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_shutdown_board: start\n"); | |
| #endif | |
| #ifdef AURORA_INT_DEBUG | |
| del_timer(&aurora_poll_timer); | |
| #endif | |
| #ifdef AURORA_ALLIRQ | |
| for(i=0;i<AURORA_ALLIRQ;i++){ | |
| free_irq(allirq[i]|0x30, bp); | |
| /* IRQ_to_board[allirq[i]&0xf] = NULL;*/ | |
| } | |
| #else | |
| free_irq(bp->irq|0x30, bp); | |
| /* IRQ_to_board[bp->irq&0xf] = NULL;*/ | |
| #endif | |
| /* Drop all DTR's */ | |
| for(i=0;i<16;i++){ | |
| sbus_writeb(i & 7, &bp->r[i>>3]->r[CD180_CAR]); | |
| udelay(1); | |
| sbus_writeb(0, &bp->r[i>>3]->r[CD180_MSVR]); | |
| udelay(1); | |
| } | |
| /* Board shutdown */ | |
| sbus_writeb(0, &bp->r0->r); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_shutdown_board: end\n"); | |
| #endif | |
| } | |
| /* Setting up port characteristics. | |
| * Must be called with disabled interrupts | |
| */ | |
| static void aurora_change_speed(struct Aurora_board *bp, struct Aurora_port *port) | |
| { | |
| struct tty_struct *tty; | |
| unsigned long baud; | |
| long tmp; | |
| unsigned char cor1 = 0, cor3 = 0; | |
| unsigned char mcor1 = 0, mcor2 = 0,chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_change_speed: start\n"); | |
| #endif | |
| if (!(tty = port->tty) || !tty->termios) | |
| return; | |
| chip = AURORA_CD180(port_No(port)); | |
| port->SRER = 0; | |
| port->COR2 = 0; | |
| port->MSVR = MSVR_RTS|MSVR_DTR; | |
| baud = tty_get_baud_rate(tty); | |
| /* Select port on the board */ | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| if (!baud) { | |
| /* Drop DTR & exit */ | |
| port->MSVR &= ~(bp->DTR|bp->RTS); | |
| sbus_writeb(port->MSVR, | |
| &bp->r[chip]->r[CD180_MSVR]); | |
| return; | |
| } else { | |
| /* Set DTR on */ | |
| port->MSVR |= bp->DTR; | |
| sbus_writeb(port->MSVR, | |
| &bp->r[chip]->r[CD180_MSVR]); | |
| } | |
| /* Now we must calculate some speed dependent things. */ | |
| /* Set baud rate for port. */ | |
| tmp = (((bp->oscfreq + baud/2) / baud + | |
| CD180_TPC/2) / CD180_TPC); | |
| /* tmp = (bp->oscfreq/7)/baud; | |
| if((tmp%10)>4)tmp=tmp/10+1;else tmp=tmp/10;*/ | |
| /* printk("Prescaler period: %d\n",tmp);*/ | |
| sbus_writeb((tmp >> 8) & 0xff, | |
| &bp->r[chip]->r[CD180_RBPRH]); | |
| sbus_writeb((tmp >> 8) & 0xff, | |
| &bp->r[chip]->r[CD180_TBPRH]); | |
| sbus_writeb(tmp & 0xff, &bp->r[chip]->r[CD180_RBPRL]); | |
| sbus_writeb(tmp & 0xff, &bp->r[chip]->r[CD180_TBPRL]); | |
| baud = (baud + 5) / 10; /* Estimated CPS */ | |
| /* Two timer ticks seems enough to wakeup something like SLIP driver */ | |
| tmp = ((baud + HZ/2) / HZ) * 2 - CD180_NFIFO; | |
| port->wakeup_chars = (tmp < 0) ? 0 : ((tmp >= SERIAL_XMIT_SIZE) ? | |
| SERIAL_XMIT_SIZE - 1 : tmp); | |
| /* Receiver timeout will be transmission time for 1.5 chars */ | |
| tmp = (AURORA_TPS + AURORA_TPS/2 + baud/2) / baud; | |
| tmp = (tmp > 0xff) ? 0xff : tmp; | |
| sbus_writeb(tmp, &bp->r[chip]->r[CD180_RTPR]); | |
| switch (C_CSIZE(tty)) { | |
| case CS5: | |
| cor1 |= COR1_5BITS; | |
| break; | |
| case CS6: | |
| cor1 |= COR1_6BITS; | |
| break; | |
| case CS7: | |
| cor1 |= COR1_7BITS; | |
| break; | |
| case CS8: | |
| cor1 |= COR1_8BITS; | |
| break; | |
| } | |
| if (C_CSTOPB(tty)) | |
| cor1 |= COR1_2SB; | |
| cor1 |= COR1_IGNORE; | |
| if (C_PARENB(tty)) { | |
| cor1 |= COR1_NORMPAR; | |
| if (C_PARODD(tty)) | |
| cor1 |= COR1_ODDP; | |
| if (I_INPCK(tty)) | |
| cor1 &= ~COR1_IGNORE; | |
| } | |
| /* Set marking of some errors */ | |
| port->mark_mask = RCSR_OE | RCSR_TOUT; | |
| if (I_INPCK(tty)) | |
| port->mark_mask |= RCSR_FE | RCSR_PE; | |
| if (I_BRKINT(tty) || I_PARMRK(tty)) | |
| port->mark_mask |= RCSR_BREAK; | |
| if (I_IGNPAR(tty)) | |
| port->mark_mask &= ~(RCSR_FE | RCSR_PE); | |
| if (I_IGNBRK(tty)) { | |
| port->mark_mask &= ~RCSR_BREAK; | |
| if (I_IGNPAR(tty)) | |
| /* Real raw mode. Ignore all */ | |
| port->mark_mask &= ~RCSR_OE; | |
| } | |
| /* Enable Hardware Flow Control */ | |
| if (C_CRTSCTS(tty)) { | |
| /*#ifdef AURORA_BRAIN_DAMAGED_CTS | |
| port->SRER |= SRER_DSR | SRER_CTS; | |
| mcor1 |= MCOR1_DSRZD | MCOR1_CTSZD; | |
| mcor2 |= MCOR2_DSROD | MCOR2_CTSOD; | |
| tty->hw_stopped = !(aurora_in(bp, CD180_MSVR) & (MSVR_CTS|MSVR_DSR)); | |
| #else*/ | |
| port->COR2 |= COR2_CTSAE; | |
| /*#endif*/ | |
| if (bp->flags&AURORA_BOARD_DTR_FLOW_OK) { | |
| mcor1 |= AURORA_RXTH; | |
| } | |
| } | |
| /* Enable Software Flow Control. FIXME: I'm not sure about this */ | |
| /* Some people reported that it works, but I still doubt */ | |
| if (I_IXON(tty)) { | |
| port->COR2 |= COR2_TXIBE; | |
| cor3 |= (COR3_FCT | COR3_SCDE); | |
| if (I_IXANY(tty)) | |
| port->COR2 |= COR2_IXM; | |
| sbus_writeb(START_CHAR(tty), | |
| &bp->r[chip]->r[CD180_SCHR1]); | |
| sbus_writeb(STOP_CHAR(tty), | |
| &bp->r[chip]->r[CD180_SCHR2]); | |
| sbus_writeb(START_CHAR(tty), | |
| &bp->r[chip]->r[CD180_SCHR3]); | |
| sbus_writeb(STOP_CHAR(tty), | |
| &bp->r[chip]->r[CD180_SCHR4]); | |
| } | |
| if (!C_CLOCAL(tty)) { | |
| /* Enable CD check */ | |
| port->SRER |= SRER_CD; | |
| mcor1 |= MCOR1_CDZD; | |
| mcor2 |= MCOR2_CDOD; | |
| } | |
| if (C_CREAD(tty)) | |
| /* Enable receiver */ | |
| port->SRER |= SRER_RXD; | |
| /* Set input FIFO size (1-8 bytes) */ | |
| cor3 |= AURORA_RXFIFO; | |
| /* Setting up CD180 channel registers */ | |
| sbus_writeb(cor1, &bp->r[chip]->r[CD180_COR1]); | |
| sbus_writeb(port->COR2, &bp->r[chip]->r[CD180_COR2]); | |
| sbus_writeb(cor3, &bp->r[chip]->r[CD180_COR3]); | |
| /* Make CD180 know about registers change */ | |
| aurora_wait_CCR(bp->r[chip]); | |
| sbus_writeb(CCR_CORCHG1 | CCR_CORCHG2 | CCR_CORCHG3, | |
| &bp->r[chip]->r[CD180_CCR]); | |
| /* Setting up modem option registers */ | |
| sbus_writeb(mcor1, &bp->r[chip]->r[CD180_MCOR1]); | |
| sbus_writeb(mcor2, &bp->r[chip]->r[CD180_MCOR2]); | |
| /* Enable CD180 transmitter & receiver */ | |
| aurora_wait_CCR(bp->r[chip]); | |
| sbus_writeb(CCR_TXEN | CCR_RXEN, &bp->r[chip]->r[CD180_CCR]); | |
| /* Enable interrupts */ | |
| sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]); | |
| /* And finally set RTS on */ | |
| sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_change_speed: end\n"); | |
| #endif | |
| } | |
| /* Must be called with interrupts enabled */ | |
| static int aurora_setup_port(struct Aurora_board *bp, struct Aurora_port *port) | |
| { | |
| unsigned long flags; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_setup_port: start %d\n",port_No(port)); | |
| #endif | |
| if (port->flags & ASYNC_INITIALIZED) | |
| return 0; | |
| if (!port->xmit_buf) { | |
| /* We may sleep in get_zeroed_page() */ | |
| unsigned long tmp; | |
| if (!(tmp = get_zeroed_page(GFP_KERNEL))) | |
| return -ENOMEM; | |
| if (port->xmit_buf) { | |
| free_page(tmp); | |
| return -ERESTARTSYS; | |
| } | |
| port->xmit_buf = (unsigned char *) tmp; | |
| } | |
| save_flags(flags); cli(); | |
| if (port->tty) | |
| clear_bit(TTY_IO_ERROR, &port->tty->flags); | |
| #ifdef MODULE | |
| if ((port->count == 1) && ((++bp->count) == 1)) | |
| bp->flags |= AURORA_BOARD_ACTIVE; | |
| #endif | |
| port->xmit_cnt = port->xmit_head = port->xmit_tail = 0; | |
| aurora_change_speed(bp, port); | |
| port->flags |= ASYNC_INITIALIZED; | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_setup_port: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| /* Must be called with interrupts disabled */ | |
| static void aurora_shutdown_port(struct Aurora_board *bp, struct Aurora_port *port) | |
| { | |
| struct tty_struct *tty; | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_shutdown_port: start\n"); | |
| #endif | |
| if (!(port->flags & ASYNC_INITIALIZED)) | |
| return; | |
| chip = AURORA_CD180(port_No(port)); | |
| #ifdef AURORA_REPORT_OVERRUN | |
| printk("aurora%d: port %d: Total %ld overruns were detected.\n", | |
| board_No(bp), port_No(port), port->overrun); | |
| #endif | |
| #ifdef AURORA_REPORT_FIFO | |
| { | |
| int i; | |
| printk("aurora%d: port %d: FIFO hits [ ", | |
| board_No(bp), port_No(port)); | |
| for (i = 0; i < 10; i++) { | |
| printk("%ld ", port->hits[i]); | |
| } | |
| printk("].\n"); | |
| } | |
| #endif | |
| if (port->xmit_buf) { | |
| free_page((unsigned long) port->xmit_buf); | |
| port->xmit_buf = NULL; | |
| } | |
| if (!(tty = port->tty) || C_HUPCL(tty)) { | |
| /* Drop DTR */ | |
| port->MSVR &= ~(bp->DTR|bp->RTS); | |
| sbus_writeb(port->MSVR, | |
| &bp->r[chip]->r[CD180_MSVR]); | |
| } | |
| /* Select port */ | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| /* Reset port */ | |
| aurora_wait_CCR(bp->r[chip]); | |
| sbus_writeb(CCR_SOFTRESET, &bp->r[chip]->r[CD180_CCR]); | |
| /* Disable all interrupts from this port */ | |
| port->SRER = 0; | |
| sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]); | |
| if (tty) | |
| set_bit(TTY_IO_ERROR, &tty->flags); | |
| port->flags &= ~ASYNC_INITIALIZED; | |
| #ifdef MODULE | |
| if (--bp->count < 0) { | |
| printk(KERN_DEBUG "aurora%d: aurora_shutdown_port: " | |
| "bad board count: %d\n", | |
| board_No(bp), bp->count); | |
| bp->count = 0; | |
| } | |
| if (!bp->count) | |
| bp->flags &= ~AURORA_BOARD_ACTIVE; | |
| #endif | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_shutdown_port: end\n"); | |
| #endif | |
| } | |
| static int block_til_ready(struct tty_struct *tty, struct file * filp, | |
| struct Aurora_port *port) | |
| { | |
| DECLARE_WAITQUEUE(wait, current); | |
| struct Aurora_board *bp = port_Board(port); | |
| int retval; | |
| int do_clocal = 0; | |
| int CD; | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("block_til_ready: start\n"); | |
| #endif | |
| chip = AURORA_CD180(port_No(port)); | |
| /* If the device is in the middle of being closed, then block | |
| * until it's done, and then try again. | |
| */ | |
| if (tty_hung_up_p(filp) || port->flags & ASYNC_CLOSING) { | |
| interruptible_sleep_on(&port->close_wait); | |
| if (port->flags & ASYNC_HUP_NOTIFY) | |
| return -EAGAIN; | |
| else | |
| return -ERESTARTSYS; | |
| } | |
| /* If non-blocking mode is set, or the port is not enabled, | |
| * then make the check up front and then exit. | |
| */ | |
| if ((filp->f_flags & O_NONBLOCK) || | |
| (tty->flags & (1 << TTY_IO_ERROR))) { | |
| port->flags |= ASYNC_NORMAL_ACTIVE; | |
| return 0; | |
| } | |
| if (C_CLOCAL(tty)) | |
| do_clocal = 1; | |
| /* Block waiting for the carrier detect and the line to become | |
| * free (i.e., not in use by the callout). While we are in | |
| * this loop, info->count is dropped by one, so that | |
| * rs_close() knows when to free things. We restore it upon | |
| * exit, either normal or abnormal. | |
| */ | |
| retval = 0; | |
| add_wait_queue(&port->open_wait, &wait); | |
| cli(); | |
| if (!tty_hung_up_p(filp)) | |
| port->count--; | |
| sti(); | |
| port->blocked_open++; | |
| while (1) { | |
| cli(); | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| CD = sbus_readb(&bp->r[chip]->r[CD180_MSVR]) & MSVR_CD; | |
| port->MSVR=bp->RTS; | |
| /* auto drops DTR */ | |
| sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]); | |
| sti(); | |
| set_current_state(TASK_INTERRUPTIBLE); | |
| if (tty_hung_up_p(filp) || | |
| !(port->flags & ASYNC_INITIALIZED)) { | |
| if (port->flags & ASYNC_HUP_NOTIFY) | |
| retval = -EAGAIN; | |
| else | |
| retval = -ERESTARTSYS; | |
| break; | |
| } | |
| if (!(port->flags & ASYNC_CLOSING) && | |
| (do_clocal || CD)) | |
| break; | |
| if (signal_pending(current)) { | |
| retval = -ERESTARTSYS; | |
| break; | |
| } | |
| schedule(); | |
| } | |
| current->state = TASK_RUNNING; | |
| remove_wait_queue(&port->open_wait, &wait); | |
| if (!tty_hung_up_p(filp)) | |
| port->count++; | |
| port->blocked_open--; | |
| if (retval) | |
| return retval; | |
| port->flags |= ASYNC_NORMAL_ACTIVE; | |
| #ifdef AURORA_DEBUG | |
| printk("block_til_ready: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| static int aurora_open(struct tty_struct * tty, struct file * filp) | |
| { | |
| int board; | |
| int error; | |
| struct Aurora_port * port; | |
| struct Aurora_board * bp; | |
| unsigned long flags; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_open: start\n"); | |
| #endif | |
| board = AURORA_BOARD(tty->index); | |
| if (board > AURORA_NBOARD || | |
| !(aurora_board[board].flags & AURORA_BOARD_PRESENT)) { | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_open: error board %d present %d\n", | |
| board, aurora_board[board].flags & AURORA_BOARD_PRESENT); | |
| #endif | |
| return -ENODEV; | |
| } | |
| bp = &aurora_board[board]; | |
| port = aurora_port + board * AURORA_NPORT * AURORA_NCD180 + AURORA_PORT(tty->index); | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_open")) { | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_open: error paranoia check\n"); | |
| #endif | |
| return -ENODEV; | |
| } | |
| port->count++; | |
| tty->driver_data = port; | |
| port->tty = tty; | |
| if ((error = aurora_setup_port(bp, port))) { | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_open: error aurora_setup_port ret %d\n",error); | |
| #endif | |
| return error; | |
| } | |
| if ((error = block_til_ready(tty, filp, port))) { | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_open: error block_til_ready ret %d\n",error); | |
| #endif | |
| return error; | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_open: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| static void aurora_close(struct tty_struct * tty, struct file * filp) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| struct Aurora_board *bp; | |
| unsigned long flags; | |
| unsigned long timeout; | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_close: start\n"); | |
| #endif | |
| if (!port || (aurora_paranoia_check(port, tty->name, "close")) | |
| return; | |
| chip = AURORA_CD180(port_No(port)); | |
| save_flags(flags); cli(); | |
| if (tty_hung_up_p(filp)) { | |
| restore_flags(flags); | |
| return; | |
| } | |
| bp = port_Board(port); | |
| if ((tty->count == 1) && (port->count != 1)) { | |
| printk(KERN_DEBUG "aurora%d: aurora_close: bad port count; " | |
| "tty->count is 1, port count is %d\n", | |
| board_No(bp), port->count); | |
| port->count = 1; | |
| } | |
| if (--port->count < 0) { | |
| printk(KERN_DEBUG "aurora%d: aurora_close: bad port " | |
| "count for tty%d: %d\n", | |
| board_No(bp), port_No(port), port->count); | |
| port->count = 0; | |
| } | |
| if (port->count) { | |
| restore_flags(flags); | |
| return; | |
| } | |
| port->flags |= ASYNC_CLOSING; | |
| /* Now we wait for the transmit buffer to clear; and we notify | |
| * the line discipline to only process XON/XOFF characters. | |
| */ | |
| tty->closing = 1; | |
| if (port->closing_wait != ASYNC_CLOSING_WAIT_NONE){ | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_close: waiting to flush...\n"); | |
| #endif | |
| tty_wait_until_sent(tty, port->closing_wait); | |
| } | |
| /* At this point we stop accepting input. To do this, we | |
| * disable the receive line status interrupts, and tell the | |
| * interrupt driver to stop checking the data ready bit in the | |
| * line status register. | |
| */ | |
| port->SRER &= ~SRER_RXD; | |
| if (port->flags & ASYNC_INITIALIZED) { | |
| port->SRER &= ~SRER_TXRDY; | |
| port->SRER |= SRER_TXEMPTY; | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]); | |
| /* | |
| * Before we drop DTR, make sure the UART transmitter | |
| * has completely drained; this is especially | |
| * important if there is a transmit FIFO! | |
| */ | |
| timeout = jiffies+HZ; | |
| while(port->SRER & SRER_TXEMPTY) { | |
| msleep_interruptible(jiffies_to_msecs(port->timeout)); | |
| if (time_after(jiffies, timeout)) | |
| break; | |
| } | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_close: shutdown_port\n"); | |
| #endif | |
| aurora_shutdown_port(bp, port); | |
| if (tty->driver->flush_buffer) | |
| tty->driver->flush_buffer(tty); | |
| tty_ldisc_flush(tty); | |
| tty->closing = 0; | |
| port->event = 0; | |
| port->tty = 0; | |
| if (port->blocked_open) { | |
| if (port->close_delay) { | |
| msleep_interruptible(jiffies_to_msecs(port->close_delay)); | |
| } | |
| wake_up_interruptible(&port->open_wait); | |
| } | |
| port->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING); | |
| wake_up_interruptible(&port->close_wait); | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_close: end\n"); | |
| #endif | |
| } | |
| static int aurora_write(struct tty_struct * tty, | |
| const unsigned char *buf, int count) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| struct Aurora_board *bp; | |
| int c, total = 0; | |
| unsigned long flags; | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_write: start %d\n",count); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_write")) | |
| return 0; | |
| chip = AURORA_CD180(port_No(port)); | |
| bp = port_Board(port); | |
| if (!tty || !port->xmit_buf || !tmp_buf) | |
| return 0; | |
| save_flags(flags); | |
| while (1) { | |
| cli(); | |
| c = min(count, min(SERIAL_XMIT_SIZE - port->xmit_cnt - 1, | |
| SERIAL_XMIT_SIZE - port->xmit_head)); | |
| if (c <= 0) { | |
| restore_flags(flags); | |
| break; | |
| } | |
| memcpy(port->xmit_buf + port->xmit_head, buf, c); | |
| port->xmit_head = (port->xmit_head + c) & (SERIAL_XMIT_SIZE-1); | |
| port->xmit_cnt += c; | |
| restore_flags(flags); | |
| buf += c; | |
| count -= c; | |
| total += c; | |
| } | |
| cli(); | |
| if (port->xmit_cnt && !tty->stopped && !tty->hw_stopped && | |
| !(port->SRER & SRER_TXRDY)) { | |
| port->SRER |= SRER_TXRDY; | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]); | |
| } | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_write: end %d\n",total); | |
| #endif | |
| return total; | |
| } | |
| static void aurora_put_char(struct tty_struct * tty, unsigned char ch) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| unsigned long flags; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_put_char: start %c\n",ch); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_put_char")) | |
| return; | |
| if (!tty || !port->xmit_buf) | |
| return; | |
| save_flags(flags); cli(); | |
| if (port->xmit_cnt >= SERIAL_XMIT_SIZE - 1) { | |
| restore_flags(flags); | |
| return; | |
| } | |
| port->xmit_buf[port->xmit_head++] = ch; | |
| port->xmit_head &= SERIAL_XMIT_SIZE - 1; | |
| port->xmit_cnt++; | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_put_char: end\n"); | |
| #endif | |
| } | |
| static void aurora_flush_chars(struct tty_struct * tty) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| unsigned long flags; | |
| unsigned char chip; | |
| /*#ifdef AURORA_DEBUG | |
| printk("aurora_flush_chars: start\n"); | |
| #endif*/ | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_flush_chars")) | |
| return; | |
| chip = AURORA_CD180(port_No(port)); | |
| if (port->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped || | |
| !port->xmit_buf) | |
| return; | |
| save_flags(flags); cli(); | |
| port->SRER |= SRER_TXRDY; | |
| sbus_writeb(port_No(port) & 7, | |
| &port_Board(port)->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| sbus_writeb(port->SRER, | |
| &port_Board(port)->r[chip]->r[CD180_SRER]); | |
| restore_flags(flags); | |
| /*#ifdef AURORA_DEBUG | |
| printk("aurora_flush_chars: end\n"); | |
| #endif*/ | |
| } | |
| static int aurora_write_room(struct tty_struct * tty) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| int ret; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_write_room: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_write_room")) | |
| return 0; | |
| ret = SERIAL_XMIT_SIZE - port->xmit_cnt - 1; | |
| if (ret < 0) | |
| ret = 0; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_write_room: end\n"); | |
| #endif | |
| return ret; | |
| } | |
| static int aurora_chars_in_buffer(struct tty_struct *tty) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_chars_in_buffer")) | |
| return 0; | |
| return port->xmit_cnt; | |
| } | |
| static void aurora_flush_buffer(struct tty_struct *tty) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| unsigned long flags; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_flush_buffer: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_flush_buffer")) | |
| return; | |
| save_flags(flags); cli(); | |
| port->xmit_cnt = port->xmit_head = port->xmit_tail = 0; | |
| restore_flags(flags); | |
| tty_wakeup(tty); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_flush_buffer: end\n"); | |
| #endif | |
| } | |
| static int aurora_tiocmget(struct tty_struct *tty, struct file *file) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| struct Aurora_board * bp; | |
| unsigned char status,chip; | |
| unsigned int result; | |
| unsigned long flags; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_get_modem_info: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, __FUNCTION__)) | |
| return -ENODEV; | |
| chip = AURORA_CD180(port_No(port)); | |
| bp = port_Board(port); | |
| save_flags(flags); cli(); | |
| sbus_writeb(port_No(port) & 7, &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| status = sbus_readb(&bp->r[chip]->r[CD180_MSVR]); | |
| result = 0/*bp->r[chip]->r[AURORA_RI] & (1u << port_No(port)) ? 0 : TIOCM_RNG*/; | |
| restore_flags(flags); | |
| result |= ((status & bp->RTS) ? TIOCM_RTS : 0) | |
| | ((status & bp->DTR) ? TIOCM_DTR : 0) | |
| | ((status & MSVR_CD) ? TIOCM_CAR : 0) | |
| | ((status & MSVR_DSR) ? TIOCM_DSR : 0) | |
| | ((status & MSVR_CTS) ? TIOCM_CTS : 0); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_get_modem_info: end\n"); | |
| #endif | |
| return result; | |
| } | |
| static int aurora_tiocmset(struct tty_struct *tty, struct file *file, | |
| unsigned int set, unsigned int clear) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| unsigned int arg; | |
| unsigned long flags; | |
| struct Aurora_board *bp = port_Board(port); | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_set_modem_info: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, __FUNCTION__)) | |
| return -ENODEV; | |
| chip = AURORA_CD180(port_No(port)); | |
| save_flags(flags); cli(); | |
| if (set & TIOCM_RTS) | |
| port->MSVR |= bp->RTS; | |
| if (set & TIOCM_DTR) | |
| port->MSVR |= bp->DTR; | |
| if (clear & TIOCM_RTS) | |
| port->MSVR &= ~bp->RTS; | |
| if (clear & TIOCM_DTR) | |
| port->MSVR &= ~bp->DTR; | |
| sbus_writeb(port_No(port) & 7, &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]); | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_set_modem_info: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| static void aurora_send_break(struct Aurora_port * port, unsigned long length) | |
| { | |
| struct Aurora_board *bp = port_Board(port); | |
| unsigned long flags; | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_send_break: start\n"); | |
| #endif | |
| chip = AURORA_CD180(port_No(port)); | |
| save_flags(flags); cli(); | |
| port->break_length = AURORA_TPS / HZ * length; | |
| port->COR2 |= COR2_ETC; | |
| port->SRER |= SRER_TXRDY; | |
| sbus_writeb(port_No(port) & 7, &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| sbus_writeb(port->COR2, &bp->r[chip]->r[CD180_COR2]); | |
| sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]); | |
| aurora_wait_CCR(bp->r[chip]); | |
| sbus_writeb(CCR_CORCHG2, &bp->r[chip]->r[CD180_CCR]); | |
| aurora_wait_CCR(bp->r[chip]); | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_send_break: end\n"); | |
| #endif | |
| } | |
| static int aurora_set_serial_info(struct Aurora_port * port, | |
| struct serial_struct * newinfo) | |
| { | |
| struct serial_struct tmp; | |
| struct Aurora_board *bp = port_Board(port); | |
| int change_speed; | |
| unsigned long flags; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_set_serial_info: start\n"); | |
| #endif | |
| if (copy_from_user(&tmp, newinfo, sizeof(tmp))) | |
| return -EFAULT; | |
| #if 0 | |
| if ((tmp.irq != bp->irq) || | |
| (tmp.port != bp->base) || | |
| (tmp.type != PORT_CIRRUS) || | |
| (tmp.baud_base != (bp->oscfreq + CD180_TPC/2) / CD180_TPC) || | |
| (tmp.custom_divisor != 0) || | |
| (tmp.xmit_fifo_size != CD180_NFIFO) || | |
| (tmp.flags & ~AURORA_LEGAL_FLAGS)) | |
| return -EINVAL; | |
| #endif | |
| change_speed = ((port->flags & ASYNC_SPD_MASK) != | |
| (tmp.flags & ASYNC_SPD_MASK)); | |
| if (!capable(CAP_SYS_ADMIN)) { | |
| if ((tmp.close_delay != port->close_delay) || | |
| (tmp.closing_wait != port->closing_wait) || | |
| ((tmp.flags & ~ASYNC_USR_MASK) != | |
| (port->flags & ~ASYNC_USR_MASK))) | |
| return -EPERM; | |
| port->flags = ((port->flags & ~ASYNC_USR_MASK) | | |
| (tmp.flags & ASYNC_USR_MASK)); | |
| } else { | |
| port->flags = ((port->flags & ~ASYNC_FLAGS) | | |
| (tmp.flags & ASYNC_FLAGS)); | |
| port->close_delay = tmp.close_delay; | |
| port->closing_wait = tmp.closing_wait; | |
| } | |
| if (change_speed) { | |
| save_flags(flags); cli(); | |
| aurora_change_speed(bp, port); | |
| restore_flags(flags); | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_set_serial_info: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| extern int aurora_get_serial_info(struct Aurora_port * port, | |
| struct serial_struct * retinfo) | |
| { | |
| struct serial_struct tmp; | |
| struct Aurora_board *bp = port_Board(port); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_get_serial_info: start\n"); | |
| #endif | |
| if (!access_ok(VERIFY_WRITE, (void *) retinfo, sizeof(tmp))) | |
| return -EFAULT; | |
| memset(&tmp, 0, sizeof(tmp)); | |
| tmp.type = PORT_CIRRUS; | |
| tmp.line = port - aurora_port; | |
| tmp.port = 0; | |
| tmp.irq = bp->irq; | |
| tmp.flags = port->flags; | |
| tmp.baud_base = (bp->oscfreq + CD180_TPC/2) / CD180_TPC; | |
| tmp.close_delay = port->close_delay * HZ/100; | |
| tmp.closing_wait = port->closing_wait * HZ/100; | |
| tmp.xmit_fifo_size = CD180_NFIFO; | |
| copy_to_user(retinfo, &tmp, sizeof(tmp)); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_get_serial_info: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| static int aurora_ioctl(struct tty_struct * tty, struct file * filp, | |
| unsigned int cmd, unsigned long arg) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| int retval; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_ioctl: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_ioctl")) | |
| return -ENODEV; | |
| switch (cmd) { | |
| case TCSBRK: /* SVID version: non-zero arg --> no break */ | |
| retval = tty_check_change(tty); | |
| if (retval) | |
| return retval; | |
| tty_wait_until_sent(tty, 0); | |
| if (!arg) | |
| aurora_send_break(port, HZ/4); /* 1/4 second */ | |
| return 0; | |
| case TCSBRKP: /* support for POSIX tcsendbreak() */ | |
| retval = tty_check_change(tty); | |
| if (retval) | |
| return retval; | |
| tty_wait_until_sent(tty, 0); | |
| aurora_send_break(port, arg ? arg*(HZ/10) : HZ/4); | |
| return 0; | |
| case TIOCGSOFTCAR: | |
| return put_user(C_CLOCAL(tty) ? 1 : 0, (unsigned long *)arg); | |
| case TIOCSSOFTCAR: | |
| if (get_user(arg,(unsigned long *)arg)) | |
| return -EFAULT; | |
| tty->termios->c_cflag = | |
| ((tty->termios->c_cflag & ~CLOCAL) | | |
| (arg ? CLOCAL : 0)); | |
| return 0; | |
| case TIOCGSERIAL: | |
| return aurora_get_serial_info(port, (struct serial_struct *) arg); | |
| case TIOCSSERIAL: | |
| return aurora_set_serial_info(port, (struct serial_struct *) arg); | |
| default: | |
| return -ENOIOCTLCMD; | |
| }; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_ioctl: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| static void aurora_throttle(struct tty_struct * tty) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| struct Aurora_board *bp; | |
| unsigned long flags; | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_throttle: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_throttle")) | |
| return; | |
| bp = port_Board(port); | |
| chip = AURORA_CD180(port_No(port)); | |
| save_flags(flags); cli(); | |
| port->MSVR &= ~bp->RTS; | |
| sbus_writeb(port_No(port) & 7, &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| if (I_IXOFF(tty)) { | |
| aurora_wait_CCR(bp->r[chip]); | |
| sbus_writeb(CCR_SSCH2, &bp->r[chip]->r[CD180_CCR]); | |
| aurora_wait_CCR(bp->r[chip]); | |
| } | |
| sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]); | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_throttle: end\n"); | |
| #endif | |
| } | |
| static void aurora_unthrottle(struct tty_struct * tty) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| struct Aurora_board *bp; | |
| unsigned long flags; | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_unthrottle: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_unthrottle")) | |
| return; | |
| bp = port_Board(port); | |
| chip = AURORA_CD180(port_No(port)); | |
| save_flags(flags); cli(); | |
| port->MSVR |= bp->RTS; | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| if (I_IXOFF(tty)) { | |
| aurora_wait_CCR(bp->r[chip]); | |
| sbus_writeb(CCR_SSCH1, | |
| &bp->r[chip]->r[CD180_CCR]); | |
| aurora_wait_CCR(bp->r[chip]); | |
| } | |
| sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]); | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_unthrottle: end\n"); | |
| #endif | |
| } | |
| static void aurora_stop(struct tty_struct * tty) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| struct Aurora_board *bp; | |
| unsigned long flags; | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_stop: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_stop")) | |
| return; | |
| bp = port_Board(port); | |
| chip = AURORA_CD180(port_No(port)); | |
| save_flags(flags); cli(); | |
| port->SRER &= ~SRER_TXRDY; | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| sbus_writeb(port->SRER, | |
| &bp->r[chip]->r[CD180_SRER]); | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_stop: end\n"); | |
| #endif | |
| } | |
| static void aurora_start(struct tty_struct * tty) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| struct Aurora_board *bp; | |
| unsigned long flags; | |
| unsigned char chip; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_start: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_start")) | |
| return; | |
| bp = port_Board(port); | |
| chip = AURORA_CD180(port_No(port)); | |
| save_flags(flags); cli(); | |
| if (port->xmit_cnt && port->xmit_buf && !(port->SRER & SRER_TXRDY)) { | |
| port->SRER |= SRER_TXRDY; | |
| sbus_writeb(port_No(port) & 7, | |
| &bp->r[chip]->r[CD180_CAR]); | |
| udelay(1); | |
| sbus_writeb(port->SRER, | |
| &bp->r[chip]->r[CD180_SRER]); | |
| } | |
| restore_flags(flags); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_start: end\n"); | |
| #endif | |
| } | |
| /* | |
| * This routine is called from the scheduler tqueue when the interrupt | |
| * routine has signalled that a hangup has occurred. The path of | |
| * hangup processing is: | |
| * | |
| * serial interrupt routine -> (scheduler tqueue) -> | |
| * do_aurora_hangup() -> tty->hangup() -> aurora_hangup() | |
| * | |
| */ | |
| static void do_aurora_hangup(void *private_) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) private_; | |
| struct tty_struct *tty; | |
| #ifdef AURORA_DEBUG | |
| printk("do_aurora_hangup: start\n"); | |
| #endif | |
| tty = port->tty; | |
| if (tty != NULL) { | |
| tty_hangup(tty); /* FIXME: module removal race - AKPM */ | |
| #ifdef AURORA_DEBUG | |
| printk("do_aurora_hangup: end\n"); | |
| #endif | |
| } | |
| } | |
| static void aurora_hangup(struct tty_struct * tty) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| struct Aurora_board *bp; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_hangup: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_hangup")) | |
| return; | |
| bp = port_Board(port); | |
| aurora_shutdown_port(bp, port); | |
| port->event = 0; | |
| port->count = 0; | |
| port->flags &= ~ASYNC_NORMAL_ACTIVE; | |
| port->tty = 0; | |
| wake_up_interruptible(&port->open_wait); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_hangup: end\n"); | |
| #endif | |
| } | |
| static void aurora_set_termios(struct tty_struct * tty, struct termios * old_termios) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) tty->driver_data; | |
| unsigned long flags; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_set_termios: start\n"); | |
| #endif | |
| if ((aurora_paranoia_check(port, tty->name, "aurora_set_termios")) | |
| return; | |
| if (tty->termios->c_cflag == old_termios->c_cflag && | |
| tty->termios->c_iflag == old_termios->c_iflag) | |
| return; | |
| save_flags(flags); cli(); | |
| aurora_change_speed(port_Board(port), port); | |
| restore_flags(flags); | |
| if ((old_termios->c_cflag & CRTSCTS) && | |
| !(tty->termios->c_cflag & CRTSCTS)) { | |
| tty->hw_stopped = 0; | |
| aurora_start(tty); | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_set_termios: end\n"); | |
| #endif | |
| } | |
| static void do_aurora_bh(void) | |
| { | |
| run_task_queue(&tq_aurora); | |
| } | |
| static void do_softint(void *private_) | |
| { | |
| struct Aurora_port *port = (struct Aurora_port *) private_; | |
| struct tty_struct *tty; | |
| #ifdef AURORA_DEBUG | |
| printk("do_softint: start\n"); | |
| #endif | |
| tty = port->tty; | |
| if (tty == NULL) | |
| return; | |
| if (test_and_clear_bit(RS_EVENT_WRITE_WAKEUP, &port->event)) { | |
| tty_wakeup(tty); | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("do_softint: end\n"); | |
| #endif | |
| } | |
| static const struct tty_operations aurora_ops = { | |
| .open = aurora_open, | |
| .close = aurora_close, | |
| .write = aurora_write, | |
| .put_char = aurora_put_char, | |
| .flush_chars = aurora_flush_chars, | |
| .write_room = aurora_write_room, | |
| .chars_in_buffer = aurora_chars_in_buffer, | |
| .flush_buffer = aurora_flush_buffer, | |
| .ioctl = aurora_ioctl, | |
| .throttle = aurora_throttle, | |
| .unthrottle = aurora_unthrottle, | |
| .set_termios = aurora_set_termios, | |
| .stop = aurora_stop, | |
| .start = aurora_start, | |
| .hangup = aurora_hangup, | |
| .tiocmget = aurora_tiocmget, | |
| .tiocmset = aurora_tiocmset, | |
| }; | |
| static int aurora_init_drivers(void) | |
| { | |
| int error; | |
| int i; | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_init_drivers: start\n"); | |
| #endif | |
| tmp_buf = (unsigned char *) get_zeroed_page(GFP_KERNEL); | |
| if (tmp_buf == NULL) { | |
| printk(KERN_ERR "aurora: Couldn't get free page.\n"); | |
| return 1; | |
| } | |
| init_bh(AURORA_BH, do_aurora_bh); | |
| aurora_driver = alloc_tty_driver(AURORA_INPORTS); | |
| if (!aurora_driver) { | |
| printk(KERN_ERR "aurora: Couldn't allocate tty driver.\n"); | |
| free_page((unsigned long) tmp_buf); | |
| return 1; | |
| } | |
| aurora_driver->owner = THIS_MODULE; | |
| aurora_driver->name = "ttyA"; | |
| aurora_driver->major = AURORA_MAJOR; | |
| aurora_driver->type = TTY_DRIVER_TYPE_SERIAL; | |
| aurora_driver->subtype = SERIAL_TYPE_NORMAL; | |
| aurora_driver->init_termios = tty_std_termios; | |
| aurora_driver->init_termios.c_cflag = | |
| B9600 | CS8 | CREAD | HUPCL | CLOCAL; | |
| aurora_driver->flags = TTY_DRIVER_REAL_RAW; | |
| tty_set_operations(aurora_driver, &aurora_ops); | |
| error = tty_register_driver(aurora_driver); | |
| if (error) { | |
| put_tty_driver(aurora_driver); | |
| free_page((unsigned long) tmp_buf); | |
| printk(KERN_ERR "aurora: Couldn't register aurora driver, error = %d\n", | |
| error); | |
| return 1; | |
| } | |
| memset(aurora_port, 0, sizeof(aurora_port)); | |
| for (i = 0; i < AURORA_TNPORTS; i++) { | |
| aurora_port[i].magic = AURORA_MAGIC; | |
| aurora_port[i].tqueue.routine = do_softint; | |
| aurora_port[i].tqueue.data = &aurora_port[i]; | |
| aurora_port[i].tqueue_hangup.routine = do_aurora_hangup; | |
| aurora_port[i].tqueue_hangup.data = &aurora_port[i]; | |
| aurora_port[i].close_delay = 50 * HZ/100; | |
| aurora_port[i].closing_wait = 3000 * HZ/100; | |
| init_waitqueue_head(&aurora_port[i].open_wait); | |
| init_waitqueue_head(&aurora_port[i].close_wait); | |
| } | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_init_drivers: end\n"); | |
| #endif | |
| return 0; | |
| } | |
| static void aurora_release_drivers(void) | |
| { | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_release_drivers: start\n"); | |
| #endif | |
| free_page((unsigned long)tmp_buf); | |
| tty_unregister_driver(aurora_driver); | |
| put_tty_driver(aurora_driver); | |
| #ifdef AURORA_DEBUG | |
| printk("aurora_release_drivers: end\n"); | |
| #endif | |
| } | |
| /* | |
| * Called at boot time. | |
| * | |
| * You can specify IO base for up to RC_NBOARD cards, | |
| * using line "riscom8=0xiobase1,0xiobase2,.." at LILO prompt. | |
| * Note that there will be no probing at default | |
| * addresses in this case. | |
| * | |
| */ | |
| void __init aurora_setup(char *str, int *ints) | |
| { | |
| int i; | |
| for(i=0;(i<ints[0])&&(i<4);i++) { | |
| if (ints[i+1]) irqs[i]=ints[i+1]; | |
| } | |
| } | |
| static int __init aurora_real_init(void) | |
| { | |
| int found; | |
| int i; | |
| printk(KERN_INFO "aurora: Driver starting.\n"); | |
| if(aurora_init_drivers()) | |
| return -EIO; | |
| found = aurora_probe(); | |
| if(!found) { | |
| aurora_release_drivers(); | |
| printk(KERN_INFO "aurora: No Aurora Multiport boards detected.\n"); | |
| return -EIO; | |
| } else { | |
| printk(KERN_INFO "aurora: %d boards found.\n", found); | |
| } | |
| for (i = 0; i < found; i++) { | |
| int ret = aurora_setup_board(&aurora_board[i]); | |
| if (ret) { | |
| #ifdef AURORA_DEBUG | |
| printk(KERN_ERR "aurora_init: error aurora_setup_board ret %d\n", | |
| ret); | |
| #endif | |
| return ret; | |
| } | |
| } | |
| return 0; | |
| } | |
| int irq = 0; | |
| int irq1 = 0; | |
| int irq2 = 0; | |
| int irq3 = 0; | |
| module_param(irq , int, 0); | |
| module_param(irq1, int, 0); | |
| module_param(irq2, int, 0); | |
| module_param(irq3, int, 0); | |
| static int __init aurora_init(void) | |
| { | |
| if (irq ) irqs[0]=irq ; | |
| if (irq1) irqs[1]=irq1; | |
| if (irq2) irqs[2]=irq2; | |
| if (irq3) irqs[3]=irq3; | |
| return aurora_real_init(); | |
| } | |
| static void __exit aurora_cleanup(void) | |
| { | |
| int i; | |
| #ifdef AURORA_DEBUG | |
| printk("cleanup_module: aurora_release_drivers\n"); | |
| #endif | |
| aurora_release_drivers(); | |
| for (i = 0; i < AURORA_NBOARD; i++) | |
| if (aurora_board[i].flags & AURORA_BOARD_PRESENT) { | |
| aurora_shutdown_board(&aurora_board[i]); | |
| aurora_release_io_range(&aurora_board[i]); | |
| } | |
| } | |
| module_init(aurora_init); | |
| module_exit(aurora_cleanup); | |
| MODULE_LICENSE("GPL"); |