| /* |
| ** ----------------------------------------------------------------------------- |
| ** |
| ** Perle Specialix driver for Linux |
| ** Ported from existing RIO Driver for SCO sources. |
| * |
| * (C) 1990 - 2000 Specialix International Ltd., Byfleet, Surrey, UK. |
| * |
| * 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. |
| ** |
| ** Module : riotty.c |
| ** SID : 1.3 |
| ** Last Modified : 11/6/98 10:33:47 |
| ** Retrieved : 11/6/98 10:33:50 |
| ** |
| ** ident @(#)riotty.c 1.3 |
| ** |
| ** ----------------------------------------------------------------------------- |
| */ |
| #ifdef SCCS_LABELS |
| static char *_riotty_c_sccs_ = "@(#)riotty.c 1.3"; |
| #endif |
| |
| |
| #define __EXPLICIT_DEF_H__ |
| |
| #include <linux/module.h> |
| #include <linux/slab.h> |
| #include <linux/errno.h> |
| #include <linux/tty.h> |
| #include <linux/string.h> |
| #include <asm/io.h> |
| #include <asm/system.h> |
| #include <asm/string.h> |
| #include <asm/uaccess.h> |
| |
| #include <linux/termios.h> |
| |
| #include <linux/serial.h> |
| |
| #include <linux/generic_serial.h> |
| |
| |
| #include "linux_compat.h" |
| #include "rio_linux.h" |
| #include "pkt.h" |
| #include "daemon.h" |
| #include "rio.h" |
| #include "riospace.h" |
| #include "cmdpkt.h" |
| #include "map.h" |
| #include "rup.h" |
| #include "port.h" |
| #include "riodrvr.h" |
| #include "rioinfo.h" |
| #include "func.h" |
| #include "errors.h" |
| #include "pci.h" |
| |
| #include "parmmap.h" |
| #include "unixrup.h" |
| #include "board.h" |
| #include "host.h" |
| #include "phb.h" |
| #include "link.h" |
| #include "cmdblk.h" |
| #include "route.h" |
| #include "cirrus.h" |
| #include "rioioctl.h" |
| #include "param.h" |
| |
| static void RIOClearUp(struct Port *PortP); |
| |
| /* Below belongs in func.h */ |
| int RIOShortCommand(struct rio_info *p, struct Port *PortP, int command, int len, int arg); |
| |
| |
| extern struct rio_info *p; |
| |
| |
| int riotopen(struct tty_struct *tty, struct file *filp) |
| { |
| unsigned int SysPort; |
| int repeat_this = 250; |
| struct Port *PortP; /* pointer to the port structure */ |
| unsigned long flags; |
| int retval = 0; |
| |
| func_enter(); |
| |
| /* Make sure driver_data is NULL in case the rio isn't booted jet. Else gs_close |
| is going to oops. |
| */ |
| tty->driver_data = NULL; |
| |
| SysPort = rio_minor(tty); |
| |
| if (p->RIOFailed) { |
| rio_dprintk(RIO_DEBUG_TTY, "System initialisation failed\n"); |
| func_exit(); |
| return -ENXIO; |
| } |
| |
| rio_dprintk(RIO_DEBUG_TTY, "port open SysPort %d (mapped:%d)\n", SysPort, p->RIOPortp[SysPort]->Mapped); |
| |
| /* |
| ** Validate that we have received a legitimate request. |
| ** Currently, just check that we are opening a port on |
| ** a host card that actually exists, and that the port |
| ** has been mapped onto a host. |
| */ |
| if (SysPort >= RIO_PORTS) { /* out of range ? */ |
| rio_dprintk(RIO_DEBUG_TTY, "Illegal port number %d\n", SysPort); |
| func_exit(); |
| return -ENXIO; |
| } |
| |
| /* |
| ** Grab pointer to the port stucture |
| */ |
| PortP = p->RIOPortp[SysPort]; /* Get control struc */ |
| rio_dprintk(RIO_DEBUG_TTY, "PortP: %p\n", PortP); |
| if (!PortP->Mapped) { /* we aren't mapped yet! */ |
| /* |
| ** The system doesn't know which RTA this port |
| ** corresponds to. |
| */ |
| rio_dprintk(RIO_DEBUG_TTY, "port not mapped into system\n"); |
| func_exit(); |
| return -ENXIO; |
| } |
| |
| tty->driver_data = PortP; |
| |
| PortP->gs.tty = tty; |
| PortP->gs.count++; |
| |
| rio_dprintk(RIO_DEBUG_TTY, "%d bytes in tx buffer\n", PortP->gs.xmit_cnt); |
| |
| retval = gs_init_port(&PortP->gs); |
| if (retval) { |
| PortP->gs.count--; |
| return -ENXIO; |
| } |
| /* |
| ** If the host hasn't been booted yet, then |
| ** fail |
| */ |
| if ((PortP->HostP->Flags & RUN_STATE) != RC_RUNNING) { |
| rio_dprintk(RIO_DEBUG_TTY, "Host not running\n"); |
| func_exit(); |
| return -ENXIO; |
| } |
| |
| /* |
| ** If the RTA has not booted yet and the user has choosen to block |
| ** until the RTA is present then we must spin here waiting for |
| ** the RTA to boot. |
| */ |
| /* I find the above code a bit hairy. I find the below code |
| easier to read and shorter. Now, if it works too that would |
| be great... -- REW |
| */ |
| rio_dprintk(RIO_DEBUG_TTY, "Checking if RTA has booted... \n"); |
| while (!(PortP->HostP->Mapping[PortP->RupNum].Flags & RTA_BOOTED)) { |
| if (!PortP->WaitUntilBooted) { |
| rio_dprintk(RIO_DEBUG_TTY, "RTA never booted\n"); |
| func_exit(); |
| return -ENXIO; |
| } |
| |
| /* Under Linux you'd normally use a wait instead of this |
| busy-waiting. I'll stick with the old implementation for |
| now. --REW |
| */ |
| if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) { |
| rio_dprintk(RIO_DEBUG_TTY, "RTA_wait_for_boot: EINTR in delay \n"); |
| func_exit(); |
| return -EINTR; |
| } |
| if (repeat_this-- <= 0) { |
| rio_dprintk(RIO_DEBUG_TTY, "Waiting for RTA to boot timeout\n"); |
| func_exit(); |
| return -EIO; |
| } |
| } |
| rio_dprintk(RIO_DEBUG_TTY, "RTA has been booted\n"); |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| if (p->RIOHalted) { |
| goto bombout; |
| } |
| |
| /* |
| ** If the port is in the final throws of being closed, |
| ** we should wait here (politely), waiting |
| ** for it to finish, so that it doesn't close us! |
| */ |
| while ((PortP->State & RIO_CLOSING) && !p->RIOHalted) { |
| rio_dprintk(RIO_DEBUG_TTY, "Waiting for RIO_CLOSING to go away\n"); |
| if (repeat_this-- <= 0) { |
| rio_dprintk(RIO_DEBUG_TTY, "Waiting for not idle closed broken by signal\n"); |
| RIOPreemptiveCmd(p, PortP, RIOC_FCLOSE); |
| retval = -EINTR; |
| goto bombout; |
| } |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) { |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| retval = -EINTR; |
| goto bombout; |
| } |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| } |
| |
| if (!PortP->Mapped) { |
| rio_dprintk(RIO_DEBUG_TTY, "Port unmapped while closing!\n"); |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| retval = -ENXIO; |
| func_exit(); |
| return retval; |
| } |
| |
| if (p->RIOHalted) { |
| goto bombout; |
| } |
| |
| /* |
| ** 15.10.1998 ARG - ESIL 0761 part fix |
| ** RIO has it's own CTSFLOW and RTSFLOW flags in 'Config' in the port structure, |
| ** we need to make sure that the flags are clear when the port is opened. |
| */ |
| /* Uh? Suppose I turn these on and then another process opens |
| the port again? The flags get cleared! Not good. -- REW */ |
| if (!(PortP->State & (RIO_LOPEN | RIO_MOPEN))) { |
| PortP->Config &= ~(RIO_CTSFLOW | RIO_RTSFLOW); |
| } |
| |
| if (!(PortP->firstOpen)) { /* First time ? */ |
| rio_dprintk(RIO_DEBUG_TTY, "First open for this port\n"); |
| |
| |
| PortP->firstOpen++; |
| PortP->CookMode = 0; /* XXX RIOCookMode(tp); */ |
| PortP->InUse = NOT_INUSE; |
| |
| /* Tentative fix for bug PR27. Didn't work. */ |
| /* PortP->gs.xmit_cnt = 0; */ |
| |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| |
| /* Someone explain to me why this delay/config is |
| here. If I read the docs correctly the "open" |
| command piggybacks the parameters immediately. |
| -- REW */ |
| RIOParam(PortP, RIOC_OPEN, 1, OK_TO_SLEEP); /* Open the port */ |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| |
| /* |
| ** wait for the port to be not closed. |
| */ |
| while (!(PortP->PortState & PORT_ISOPEN) && !p->RIOHalted) { |
| rio_dprintk(RIO_DEBUG_TTY, "Waiting for PORT_ISOPEN-currently %x\n", PortP->PortState); |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) { |
| rio_dprintk(RIO_DEBUG_TTY, "Waiting for open to finish broken by signal\n"); |
| RIOPreemptiveCmd(p, PortP, RIOC_FCLOSE); |
| func_exit(); |
| return -EINTR; |
| } |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| } |
| |
| if (p->RIOHalted) { |
| retval = -EIO; |
| bombout: |
| /* RIOClearUp( PortP ); */ |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| return retval; |
| } |
| rio_dprintk(RIO_DEBUG_TTY, "PORT_ISOPEN found\n"); |
| } |
| rio_dprintk(RIO_DEBUG_TTY, "Modem - test for carrier\n"); |
| /* |
| ** ACTION |
| ** insert test for carrier here. -- ??? |
| ** I already see that test here. What's the deal? -- REW |
| */ |
| if ((PortP->gs.tty->termios->c_cflag & CLOCAL) || |
| (PortP->ModemState & RIOC_MSVR1_CD)) { |
| rio_dprintk(RIO_DEBUG_TTY, "open(%d) Modem carr on\n", SysPort); |
| /* |
| tp->tm.c_state |= CARR_ON; |
| wakeup((caddr_t) &tp->tm.c_canq); |
| */ |
| PortP->State |= RIO_CARR_ON; |
| wake_up_interruptible(&PortP->gs.open_wait); |
| } else { /* no carrier - wait for DCD */ |
| /* |
| while (!(PortP->gs.tty->termios->c_state & CARR_ON) && |
| !(filp->f_flags & O_NONBLOCK) && !p->RIOHalted ) |
| */ |
| while (!(PortP->State & RIO_CARR_ON) && !(filp->f_flags & O_NONBLOCK) && !p->RIOHalted) { |
| rio_dprintk(RIO_DEBUG_TTY, "open(%d) sleeping for carr on\n", SysPort); |
| /* |
| PortP->gs.tty->termios->c_state |= WOPEN; |
| */ |
| PortP->State |= RIO_WOPEN; |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) { |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| /* |
| ** ACTION: verify that this is a good thing |
| ** to do here. -- ??? |
| ** I think it's OK. -- REW |
| */ |
| rio_dprintk(RIO_DEBUG_TTY, "open(%d) sleeping for carr broken by signal\n", SysPort); |
| RIOPreemptiveCmd(p, PortP, RIOC_FCLOSE); |
| /* |
| tp->tm.c_state &= ~WOPEN; |
| */ |
| PortP->State &= ~RIO_WOPEN; |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| func_exit(); |
| return -EINTR; |
| } |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| } |
| PortP->State &= ~RIO_WOPEN; |
| } |
| if (p->RIOHalted) |
| goto bombout; |
| rio_dprintk(RIO_DEBUG_TTY, "Setting RIO_MOPEN\n"); |
| PortP->State |= RIO_MOPEN; |
| |
| if (p->RIOHalted) |
| goto bombout; |
| |
| rio_dprintk(RIO_DEBUG_TTY, "high level open done\n"); |
| |
| /* |
| ** Count opens for port statistics reporting |
| */ |
| if (PortP->statsGather) |
| PortP->opens++; |
| |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| rio_dprintk(RIO_DEBUG_TTY, "Returning from open\n"); |
| func_exit(); |
| return 0; |
| } |
| |
| /* |
| ** RIOClose the port. |
| ** The operating system thinks that this is last close for the device. |
| ** As there are two interfaces to the port (Modem and tty), we need to |
| ** check that both are closed before we close the device. |
| */ |
| int riotclose(void *ptr) |
| { |
| struct Port *PortP = ptr; /* pointer to the port structure */ |
| int deleted = 0; |
| int try = -1; /* Disable the timeouts by setting them to -1 */ |
| int repeat_this = -1; /* Congrats to those having 15 years of |
| uptime! (You get to break the driver.) */ |
| unsigned long end_time; |
| struct tty_struct *tty; |
| unsigned long flags; |
| int rv = 0; |
| |
| rio_dprintk(RIO_DEBUG_TTY, "port close SysPort %d\n", PortP->PortNum); |
| |
| /* PortP = p->RIOPortp[SysPort]; */ |
| rio_dprintk(RIO_DEBUG_TTY, "Port is at address %p\n", PortP); |
| /* tp = PortP->TtyP; *//* Get tty */ |
| tty = PortP->gs.tty; |
| rio_dprintk(RIO_DEBUG_TTY, "TTY is at address %p\n", tty); |
| |
| if (PortP->gs.closing_wait) |
| end_time = jiffies + PortP->gs.closing_wait; |
| else |
| end_time = jiffies + MAX_SCHEDULE_TIMEOUT; |
| |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| |
| /* |
| ** Setting this flag will make any process trying to open |
| ** this port block until we are complete closing it. |
| */ |
| PortP->State |= RIO_CLOSING; |
| |
| if ((PortP->State & RIO_DELETED)) { |
| rio_dprintk(RIO_DEBUG_TTY, "Close on deleted RTA\n"); |
| deleted = 1; |
| } |
| |
| if (p->RIOHalted) { |
| RIOClearUp(PortP); |
| rv = -EIO; |
| goto close_end; |
| } |
| |
| rio_dprintk(RIO_DEBUG_TTY, "Clear bits\n"); |
| /* |
| ** clear the open bits for this device |
| */ |
| PortP->State &= ~RIO_MOPEN; |
| PortP->State &= ~RIO_CARR_ON; |
| PortP->ModemState &= ~RIOC_MSVR1_CD; |
| /* |
| ** If the device was open as both a Modem and a tty line |
| ** then we need to wimp out here, as the port has not really |
| ** been finally closed (gee, whizz!) The test here uses the |
| ** bit for the OTHER mode of operation, to see if THAT is |
| ** still active! |
| */ |
| if ((PortP->State & (RIO_LOPEN | RIO_MOPEN))) { |
| /* |
| ** The port is still open for the other task - |
| ** return, pretending that we are still active. |
| */ |
| rio_dprintk(RIO_DEBUG_TTY, "Channel %d still open !\n", PortP->PortNum); |
| PortP->State &= ~RIO_CLOSING; |
| if (PortP->firstOpen) |
| PortP->firstOpen--; |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| return -EIO; |
| } |
| |
| rio_dprintk(RIO_DEBUG_TTY, "Closing down - everything must go!\n"); |
| |
| PortP->State &= ~RIO_DYNOROD; |
| |
| /* |
| ** This is where we wait for the port |
| ** to drain down before closing. Bye-bye.... |
| ** (We never meant to do this) |
| */ |
| rio_dprintk(RIO_DEBUG_TTY, "Timeout 1 starts\n"); |
| |
| if (!deleted) |
| while ((PortP->InUse != NOT_INUSE) && !p->RIOHalted && (PortP->TxBufferIn != PortP->TxBufferOut)) { |
| if (repeat_this-- <= 0) { |
| rv = -EINTR; |
| rio_dprintk(RIO_DEBUG_TTY, "Waiting for not idle closed broken by signal\n"); |
| RIOPreemptiveCmd(p, PortP, RIOC_FCLOSE); |
| goto close_end; |
| } |
| rio_dprintk(RIO_DEBUG_TTY, "Calling timeout to flush in closing\n"); |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| if (RIODelay_ni(PortP, HUNDRED_MS * 10) == RIO_FAIL) { |
| rio_dprintk(RIO_DEBUG_TTY, "RTA EINTR in delay \n"); |
| rv = -EINTR; |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| goto close_end; |
| } |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| } |
| |
| PortP->TxBufferIn = PortP->TxBufferOut = 0; |
| repeat_this = 0xff; |
| |
| PortP->InUse = 0; |
| if ((PortP->State & (RIO_LOPEN | RIO_MOPEN))) { |
| /* |
| ** The port has been re-opened for the other task - |
| ** return, pretending that we are still active. |
| */ |
| rio_dprintk(RIO_DEBUG_TTY, "Channel %d re-open!\n", PortP->PortNum); |
| PortP->State &= ~RIO_CLOSING; |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| if (PortP->firstOpen) |
| PortP->firstOpen--; |
| return -EIO; |
| } |
| |
| if (p->RIOHalted) { |
| RIOClearUp(PortP); |
| goto close_end; |
| } |
| |
| /* Can't call RIOShortCommand with the port locked. */ |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| |
| if (RIOShortCommand(p, PortP, RIOC_CLOSE, 1, 0) == RIO_FAIL) { |
| RIOPreemptiveCmd(p, PortP, RIOC_FCLOSE); |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| goto close_end; |
| } |
| |
| if (!deleted) |
| while (try && (PortP->PortState & PORT_ISOPEN)) { |
| try--; |
| if (time_after(jiffies, end_time)) { |
| rio_dprintk(RIO_DEBUG_TTY, "Run out of tries - force the bugger shut!\n"); |
| RIOPreemptiveCmd(p, PortP, RIOC_FCLOSE); |
| break; |
| } |
| rio_dprintk(RIO_DEBUG_TTY, "Close: PortState:ISOPEN is %d\n", PortP->PortState & PORT_ISOPEN); |
| |
| if (p->RIOHalted) { |
| RIOClearUp(PortP); |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| goto close_end; |
| } |
| if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) { |
| rio_dprintk(RIO_DEBUG_TTY, "RTA EINTR in delay \n"); |
| RIOPreemptiveCmd(p, PortP, RIOC_FCLOSE); |
| break; |
| } |
| } |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| rio_dprintk(RIO_DEBUG_TTY, "Close: try was %d on completion\n", try); |
| |
| /* RIOPreemptiveCmd(p, PortP, RIOC_FCLOSE); */ |
| |
| /* |
| ** 15.10.1998 ARG - ESIL 0761 part fix |
| ** RIO has it's own CTSFLOW and RTSFLOW flags in 'Config' in the port structure,** we need to make sure that the flags are clear when the port is opened. |
| */ |
| PortP->Config &= ~(RIO_CTSFLOW | RIO_RTSFLOW); |
| |
| /* |
| ** Count opens for port statistics reporting |
| */ |
| if (PortP->statsGather) |
| PortP->closes++; |
| |
| close_end: |
| /* XXX: Why would a "DELETED" flag be reset here? I'd have |
| thought that a "deleted" flag means that the port was |
| permanently gone, but here we can make it reappear by it |
| being in close during the "deletion". |
| */ |
| PortP->State &= ~(RIO_CLOSING | RIO_DELETED); |
| if (PortP->firstOpen) |
| PortP->firstOpen--; |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| rio_dprintk(RIO_DEBUG_TTY, "Return from close\n"); |
| return rv; |
| } |
| |
| |
| |
| static void RIOClearUp(struct Port *PortP) |
| { |
| rio_dprintk(RIO_DEBUG_TTY, "RIOHalted set\n"); |
| PortP->Config = 0; /* Direct semaphore */ |
| PortP->PortState = 0; |
| PortP->firstOpen = 0; |
| PortP->FlushCmdBodge = 0; |
| PortP->ModemState = PortP->CookMode = 0; |
| PortP->Mapped = 0; |
| PortP->WflushFlag = 0; |
| PortP->MagicFlags = 0; |
| PortP->RxDataStart = 0; |
| PortP->TxBufferIn = 0; |
| PortP->TxBufferOut = 0; |
| } |
| |
| /* |
| ** Put a command onto a port. |
| ** The PortPointer, command, length and arg are passed. |
| ** The len is the length *inclusive* of the command byte, |
| ** and so for a command that takes no data, len==1. |
| ** The arg is a single byte, and is only used if len==2. |
| ** Other values of len aren't allowed, and will cause |
| ** a panic. |
| */ |
| int RIOShortCommand(struct rio_info *p, struct Port *PortP, int command, int len, int arg) |
| { |
| struct PKT __iomem *PacketP; |
| int retries = 20; /* at 10 per second -> 2 seconds */ |
| unsigned long flags; |
| |
| rio_dprintk(RIO_DEBUG_TTY, "entering shortcommand.\n"); |
| |
| if (PortP->State & RIO_DELETED) { |
| rio_dprintk(RIO_DEBUG_TTY, "Short command to deleted RTA ignored\n"); |
| return RIO_FAIL; |
| } |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| |
| /* |
| ** If the port is in use for pre-emptive command, then wait for it to |
| ** be free again. |
| */ |
| while ((PortP->InUse != NOT_INUSE) && !p->RIOHalted) { |
| rio_dprintk(RIO_DEBUG_TTY, "Waiting for not in use (%d)\n", retries); |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| if (retries-- <= 0) { |
| return RIO_FAIL; |
| } |
| if (RIODelay_ni(PortP, HUNDRED_MS) == RIO_FAIL) { |
| return RIO_FAIL; |
| } |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| } |
| if (PortP->State & RIO_DELETED) { |
| rio_dprintk(RIO_DEBUG_TTY, "Short command to deleted RTA ignored\n"); |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| return RIO_FAIL; |
| } |
| |
| while (!can_add_transmit(&PacketP, PortP) && !p->RIOHalted) { |
| rio_dprintk(RIO_DEBUG_TTY, "Waiting to add short command to queue (%d)\n", retries); |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| if (retries-- <= 0) { |
| rio_dprintk(RIO_DEBUG_TTY, "out of tries. Failing\n"); |
| return RIO_FAIL; |
| } |
| if (RIODelay_ni(PortP, HUNDRED_MS) == RIO_FAIL) { |
| return RIO_FAIL; |
| } |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| } |
| |
| if (p->RIOHalted) { |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| return RIO_FAIL; |
| } |
| |
| /* |
| ** set the command byte and the argument byte |
| */ |
| writeb(command, &PacketP->data[0]); |
| |
| if (len == 2) |
| writeb(arg, &PacketP->data[1]); |
| |
| /* |
| ** set the length of the packet and set the command bit. |
| */ |
| writeb(PKT_CMD_BIT | len, &PacketP->len); |
| |
| add_transmit(PortP); |
| /* |
| ** Count characters transmitted for port statistics reporting |
| */ |
| if (PortP->statsGather) |
| PortP->txchars += len; |
| |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| return p->RIOHalted ? RIO_FAIL : ~RIO_FAIL; |
| } |
| |
| |