1374 lines
37 KiB
C
1374 lines
37 KiB
C
/*
|
|
** -----------------------------------------------------------------------------
|
|
**
|
|
** 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/semaphore.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 "typdef.h"
|
|
#include "pkt.h"
|
|
#include "daemon.h"
|
|
#include "rio.h"
|
|
#include "riospace.h"
|
|
#include "top.h"
|
|
#include "cmdpkt.h"
|
|
#include "map.h"
|
|
#include "riotypes.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 "error.h"
|
|
#include "phb.h"
|
|
#include "link.h"
|
|
#include "cmdblk.h"
|
|
#include "route.h"
|
|
#include "control.h"
|
|
#include "cirrus.h"
|
|
#include "rioioctl.h"
|
|
#include "param.h"
|
|
#include "list.h"
|
|
#include "sam.h"
|
|
|
|
#if 0
|
|
static void ttyseth_pv(struct Port *, struct ttystatics *,
|
|
struct termios *sg, int);
|
|
#endif
|
|
|
|
static void RIOClearUp(struct Port *PortP);
|
|
int RIOShortCommand(struct rio_info *p, struct Port *PortP,
|
|
int command, int len, int arg);
|
|
|
|
#if 0
|
|
static int RIOCookMode(struct ttystatics *);
|
|
#endif
|
|
|
|
extern int conv_vb[]; /* now defined in ttymgr.c */
|
|
extern int conv_bv[]; /* now defined in ttymgr.c */
|
|
|
|
/*
|
|
** 16.09.1998 ARG - Fix to build riotty.k.o for Modular Kernel Support
|
|
**
|
|
** ep.def.h is necessary for Modular Kernel Support
|
|
** DO NOT place any kernel 'extern's after this line
|
|
** or this source file will not build riotty.k.o
|
|
*/
|
|
#ifdef uLYNX
|
|
#include <ep.def.h>
|
|
#endif
|
|
|
|
#ifdef NEED_THIS2
|
|
static struct old_sgttyb
|
|
default_sg =
|
|
{
|
|
B19200, B19200, /* input and output speed */
|
|
'H' - '@', /* erase char */
|
|
-1, /* 2nd erase char */
|
|
'U' - '@', /* kill char */
|
|
ECHO | CRMOD, /* mode */
|
|
'C' - '@', /* interrupt character */
|
|
'\\' - '@', /* quit char */
|
|
'Q' - '@', /* start char */
|
|
'S' - '@', /* stop char */
|
|
'D' - '@', /* EOF */
|
|
-1, /* brk */
|
|
(LCRTBS | LCRTERA | LCRTKIL | LCTLECH), /* local mode word */
|
|
'Z' - '@', /* process stop */
|
|
'Y' - '@', /* delayed stop */
|
|
'R' - '@', /* reprint line */
|
|
'O' - '@', /* flush output */
|
|
'W' - '@', /* word erase */
|
|
'V' - '@' /* literal next char */
|
|
};
|
|
#endif
|
|
|
|
|
|
extern struct rio_info *p;
|
|
|
|
|
|
int
|
|
riotopen(struct tty_struct * tty, struct file * filp)
|
|
{
|
|
register uint SysPort;
|
|
int Modem;
|
|
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);
|
|
Modem = rio_ismodem(tty);
|
|
|
|
if ( p->RIOFailed ) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "System initialisation failed\n");
|
|
pseterr(ENXIO);
|
|
func_exit ();
|
|
return -ENXIO;
|
|
}
|
|
|
|
rio_dprintk (RIO_DEBUG_TTY, "port open SysPort %d (%s) (mapped:%d)\n",
|
|
SysPort, Modem ? "Modem" : "tty",
|
|
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);
|
|
pseterr(ENXIO);
|
|
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 ();
|
|
pseterr(ENXIO);
|
|
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");
|
|
pseterr(ENXIO);
|
|
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.
|
|
*/
|
|
#if 0
|
|
if (!(PortP->HostP->Mapping[PortP->RupNum].Flags & RTA_BOOTED)) {
|
|
if (PortP->WaitUntilBooted) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "Waiting for RTA to boot\n");
|
|
do {
|
|
if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "RTA EINTR in delay \n");
|
|
func_exit ();
|
|
return -EINTR;
|
|
}
|
|
if (repeat_this -- <= 0) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "Waiting for RTA to boot timeout\n");
|
|
RIOPreemptiveCmd(p, PortP, FCLOSE );
|
|
pseterr(EINTR);
|
|
func_exit ();
|
|
return -EIO;
|
|
}
|
|
} while(!(PortP->HostP->Mapping[PortP->RupNum].Flags & RTA_BOOTED));
|
|
rio_dprintk (RIO_DEBUG_TTY, "RTA has been booted\n");
|
|
} else {
|
|
rio_dprintk (RIO_DEBUG_TTY, "RTA never booted\n");
|
|
pseterr(ENXIO);
|
|
func_exit ();
|
|
return 0;
|
|
}
|
|
}
|
|
#else
|
|
/* 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");
|
|
#endif
|
|
#if 0
|
|
tp = PortP->TtyP; /* get tty struct */
|
|
#endif
|
|
rio_spin_lock_irqsave(&PortP->portSem, flags);
|
|
if ( p->RIOHalted ) {
|
|
goto bombout;
|
|
}
|
|
#if 0
|
|
retval = gs_init_port(&PortP->gs);
|
|
if (retval){
|
|
func_exit ();
|
|
return retval;
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
** 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, 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);
|
|
#ifdef NEED_THIS
|
|
ttyseth(PortP, tp, (struct old_sgttyb *)&default_sg);
|
|
#endif
|
|
|
|
/* 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,OPEN,Modem,OK_TO_SLEEP); /* Open the port */
|
|
#if 0
|
|
/* This delay of 1 second was annoying. I removed it. -- REW */
|
|
RIODelay(PortP, HUNDRED_MS*10);
|
|
RIOParam(PortP,CONFIG,Modem,OK_TO_SLEEP); /* Config the port */
|
|
#endif
|
|
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);
|
|
/*
|
|
** 15.10.1998 ARG - ESIL 0759
|
|
** (Part) fix for port being trashed when opened whilst RTA "disconnected"
|
|
** Take out the limited wait - now wait for ever or until user
|
|
** bangs us out.
|
|
**
|
|
if (repeat_this -- <= 0) {
|
|
rio_dprint(RIO_DEBUG_TTY, ("Waiting for open to finish timed out.\n"));
|
|
RIOPreemptiveCmd(p, PortP, FCLOSE );
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return -EINTR;
|
|
}
|
|
**
|
|
*/
|
|
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, 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");
|
|
}
|
|
|
|
#ifdef MODEM_SUPPORT
|
|
if (Modem) {
|
|
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 & 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)
|
|
#if 0
|
|
if ( sleep((caddr_t)&tp->tm.c_canqo, TTIPRI|PCATCH))
|
|
#endif
|
|
{
|
|
/*
|
|
** 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, FCLOSE );
|
|
/*
|
|
tp->tm.c_state &= ~WOPEN;
|
|
*/
|
|
PortP->State &= ~RIO_WOPEN;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
func_exit ();
|
|
return -EINTR;
|
|
}
|
|
}
|
|
PortP->State &= ~RIO_WOPEN;
|
|
}
|
|
if ( p->RIOHalted )
|
|
goto bombout;
|
|
rio_dprintk (RIO_DEBUG_TTY, "Setting RIO_MOPEN\n");
|
|
PortP->State |= RIO_MOPEN;
|
|
}
|
|
else
|
|
#endif
|
|
{
|
|
/*
|
|
** ACTION
|
|
** Direct line open - force carrier (will probably mean
|
|
** that sleeping Modem line fubar)
|
|
*/
|
|
PortP->State |= RIO_LOPEN;
|
|
}
|
|
|
|
if ( p->RIOHalted ) {
|
|
goto bombout;
|
|
}
|
|
|
|
rio_dprintk (RIO_DEBUG_TTY, "high level open done\n");
|
|
|
|
#ifdef STATS
|
|
PortP->Stat.OpenCnt++;
|
|
#endif
|
|
/*
|
|
** 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)
|
|
{
|
|
#if 0
|
|
register uint SysPort = dev;
|
|
struct ttystatics *tp; /* pointer to our ttystruct */
|
|
#endif
|
|
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 Modem;
|
|
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 0x%x\n",(int)PortP);
|
|
/* tp = PortP->TtyP;*/ /* Get tty */
|
|
tty = PortP->gs.tty;
|
|
rio_dprintk (RIO_DEBUG_TTY, "TTY is at address 0x%x\n",(int)tty);
|
|
|
|
if (PortP->gs.closing_wait)
|
|
end_time = jiffies + PortP->gs.closing_wait;
|
|
else
|
|
end_time = jiffies + MAX_SCHEDULE_TIMEOUT;
|
|
|
|
Modem = rio_ismodem(tty);
|
|
#if 0
|
|
/* What F.CKING cache? Even then, a higly idle multiprocessor,
|
|
system with large caches this won't work . Better find out when
|
|
this doesn't work asap, and fix the cause. -- REW */
|
|
|
|
RIODelay(PortP, HUNDRED_MS*10); /* To flush the cache */
|
|
#endif
|
|
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 &= (Modem ? ~RIO_MOPEN : ~RIO_LOPEN);
|
|
PortP->State &= ~RIO_CARR_ON;
|
|
PortP->ModemState &= ~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) ) {
|
|
cprintf("Need to flush the ttyport\n");
|
|
if (repeat_this -- <= 0) {
|
|
rv = -EINTR;
|
|
rio_dprintk (RIO_DEBUG_TTY, "Waiting for not idle closed broken by signal\n");
|
|
RIOPreemptiveCmd(p, PortP, 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, CLOSE, 1, 0) == RIO_FAIL) {
|
|
RIOPreemptiveCmd(p, PortP, FCLOSE);
|
|
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,FCLOSE);
|
|
break;
|
|
}
|
|
rio_dprintk (RIO_DEBUG_TTY, "Close: PortState:ISOPEN is %d\n",
|
|
PortP->PortState & PORT_ISOPEN);
|
|
|
|
if ( p->RIOHalted ) {
|
|
RIOClearUp( PortP );
|
|
goto close_end;
|
|
}
|
|
if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "RTA EINTR in delay \n");
|
|
RIOPreemptiveCmd(p, PortP,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, 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);
|
|
|
|
#ifdef STATS
|
|
PortP->Stat.CloseCnt++;
|
|
#endif
|
|
/*
|
|
** 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;
|
|
}
|
|
|
|
|
|
/*
|
|
** decide if we need to use the line discipline.
|
|
** This routine can return one of three values:
|
|
** COOK_RAW if no processing has to be done by the line discipline or the card
|
|
** COOK_WELL if the line discipline must be used to do the processing
|
|
** COOK_MEDIUM if the card can do all the processing necessary.
|
|
*/
|
|
#if 0
|
|
static int
|
|
RIOCookMode(struct ttystatics *tp)
|
|
{
|
|
/*
|
|
** We can't handle tm.c_mstate != 0 on SCO
|
|
** We can't handle mapping
|
|
** We can't handle non-ttwrite line disc.
|
|
** We can't handle lflag XCASE
|
|
** We can handle oflag OPOST & (OCRNL, ONLCR, TAB3)
|
|
*/
|
|
|
|
#ifdef CHECK
|
|
CheckTtyP( tp );
|
|
#endif
|
|
if (!(tp->tm.c_oflag & OPOST)) /* No post processing */
|
|
return COOK_RAW; /* Raw mode o/p */
|
|
|
|
if ( tp->tm.c_lflag & XCASE )
|
|
return COOK_WELL; /* Use line disc */
|
|
|
|
if (tp->tm.c_oflag & ~(OPOST | ONLCR | OCRNL | TAB3 ) )
|
|
return COOK_WELL; /* Use line disc for strange modes */
|
|
|
|
if ( tp->tm.c_oflag == OPOST ) /* If only OPOST is set, do RAW */
|
|
return COOK_RAW;
|
|
|
|
/*
|
|
** So, we need to output process!
|
|
*/
|
|
return COOK_MEDIUM;
|
|
}
|
|
#endif
|
|
|
|
static void
|
|
RIOClearUp(PortP)
|
|
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)
|
|
{
|
|
PKT *PacketP;
|
|
int retries = 20; /* at 10 per second -> 2 seconds */
|
|
unsigned long flags;
|
|
|
|
rio_dprintk (RIO_DEBUG_TTY, "entering shortcommand.\n");
|
|
#ifdef CHECK
|
|
CheckPortP( PortP );
|
|
if ( len < 1 || len > 2 )
|
|
cprintf(("STUPID LENGTH %d\n",len));
|
|
#endif
|
|
|
|
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
|
|
*/
|
|
WBYTE(PacketP->data[0] , command);
|
|
|
|
if ( len==2 )
|
|
WBYTE(PacketP->data[1] , arg);
|
|
|
|
/*
|
|
** set the length of the packet and set the command bit.
|
|
*/
|
|
WBYTE(PacketP->len , PKT_CMD_BIT | 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;
|
|
}
|
|
|
|
|
|
#if 0
|
|
/*
|
|
** This is an ioctl interface. This is the twentieth century. You know what
|
|
** its all about.
|
|
*/
|
|
int
|
|
riotioctl(struct rio_info *p, struct tty_struct *tty, int cmd, caddr_t arg)
|
|
{
|
|
register struct Port *PortP;
|
|
register struct ttystatics *tp;
|
|
int current;
|
|
int ParamSemIncremented = 0;
|
|
int old_oflag, old_cflag, old_iflag, changed, oldcook;
|
|
int i;
|
|
unsigned char sio_regs[5]; /* Here be magic */
|
|
short vpix_cflag;
|
|
short divisor;
|
|
int baud;
|
|
uint SysPort = rio_minor(tty);
|
|
int Modem = rio_ismodem(tty);
|
|
int ioctl_processed;
|
|
|
|
rio_dprintk (RIO_DEBUG_TTY, "port ioctl SysPort %d command 0x%x argument 0x%x %s\n",
|
|
SysPort, cmd, arg, Modem?"Modem":"tty") ;
|
|
|
|
if ( SysPort >= RIO_PORTS ) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "Bad port number %d\n", SysPort);
|
|
return -ENXIO;
|
|
}
|
|
|
|
PortP = p->RIOPortp[SysPort];
|
|
tp = PortP->TtyP;
|
|
|
|
rio_spin_lock_irqsave(&PortP->portSem, flags);
|
|
|
|
#ifdef STATS
|
|
PortP->Stat.IoctlCnt++;
|
|
#endif
|
|
|
|
if ( PortP->State & RIO_DELETED ) {
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return -EIO;
|
|
}
|
|
|
|
|
|
if ( p->RIOHalted ) {
|
|
RIOClearUp( PortP );
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return -EIO;
|
|
}
|
|
|
|
/*
|
|
** Count ioctls for port statistics reporting
|
|
*/
|
|
if (PortP->statsGather)
|
|
PortP->ioctls++;
|
|
|
|
/*
|
|
** Specialix RIO Ioctl calls
|
|
*/
|
|
switch (cmd) {
|
|
|
|
case TCRIOTRIAD:
|
|
if ( arg )
|
|
PortP->State |= RIO_TRIAD_MODE;
|
|
else
|
|
PortP->State &= ~RIO_TRIAD_MODE;
|
|
/*
|
|
** Normally, when istrip is set on a port, a config is
|
|
** sent to the RTA instructing the CD1400 to do the
|
|
** stripping. In TRIAD mode, the interrupt receive routine
|
|
** must do the stripping instead, since it has to detect
|
|
** an 8 bit function key sequence. If istrip is set with
|
|
** TRIAD mode on(off), and 8 bit data is being read by
|
|
** the port, the user then turns TRIAD mode off(on), the RTA
|
|
** must be reconfigured (not) to do the stripping.
|
|
** Hence we call RIOParam here.
|
|
*/
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
RIOParam(PortP,CONFIG,Modem,OK_TO_SLEEP);
|
|
return 0;
|
|
|
|
case TCRIOTSTATE:
|
|
rio_dprintk (RIO_DEBUG_TTY, "tbusy/tstop monitoring %sabled\n",
|
|
arg ? "en" : "dis");
|
|
/* MonitorTstate = 0 ;*/
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
RIOParam(PortP, CONFIG, Modem, OK_TO_SLEEP);
|
|
return 0;
|
|
|
|
case TCRIOSTATE: /* current state of Modem input pins */
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOSTATE\n");
|
|
if (RIOPreemptiveCmd(p, PortP, MGET) == RIO_FAIL)
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOSTATE command failed\n");
|
|
PortP->State |= RIO_BUSY;
|
|
current = PortP->ModemState;
|
|
if ( copyout((caddr_t)¤t, (int)arg,
|
|
sizeof(current))==COPYFAIL ) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "Copyout failed\n");
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
pseterr(EFAULT);
|
|
}
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
case TCRIOMBIS: /* Set modem lines */
|
|
case TCRIOMBIC: /* Clear modem lines */
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOMBIS/TCRIOMBIC\n");
|
|
if (cmd == TCRIOMBIS) {
|
|
uint state;
|
|
state = (uint)arg;
|
|
PortP->ModemState |= (ushort)state;
|
|
PortP->ModemLines = (ulong) arg;
|
|
if (RIOPreemptiveCmd(p, PortP, MBIS) == RIO_FAIL)
|
|
rio_dprintk (RIO_DEBUG_TTY,
|
|
"TCRIOMBIS command failed\n");
|
|
}
|
|
else {
|
|
uint state;
|
|
|
|
state = (uint)arg;
|
|
PortP->ModemState &= ~(ushort)state;
|
|
PortP->ModemLines = (ulong) arg;
|
|
if (RIOPreemptiveCmd(p, PortP, MBIC) == RIO_FAIL)
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOMBIC command failed\n");
|
|
}
|
|
PortP->State |= RIO_BUSY;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
case TCRIOXPON: /* set Xprint ON string */
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOXPON\n");
|
|
if ( copyin((int)arg, (caddr_t)PortP->Xprint.XpOn,
|
|
MAX_XP_CTRL_LEN)==COPYFAIL ) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "Copyin failed\n");
|
|
PortP->Xprint.XpOn[0] = '\0';
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
pseterr(EFAULT);
|
|
}
|
|
PortP->Xprint.XpOn[MAX_XP_CTRL_LEN-1] = '\0';
|
|
PortP->Xprint.XpLen = strlen(PortP->Xprint.XpOn)+
|
|
strlen(PortP->Xprint.XpOff);
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
case TCRIOXPOFF: /* set Xprint OFF string */
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOXPOFF\n");
|
|
if ( copyin( (int)arg, (caddr_t)PortP->Xprint.XpOff,
|
|
MAX_XP_CTRL_LEN)==COPYFAIL ) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "Copyin failed\n");
|
|
PortP->Xprint.XpOff[0] = '\0';
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
pseterr(EFAULT);
|
|
}
|
|
PortP->Xprint.XpOff[MAX_XP_CTRL_LEN-1] = '\0';
|
|
PortP->Xprint.XpLen = strlen(PortP->Xprint.XpOn)+
|
|
strlen(PortP->Xprint.XpOff);
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
case TCRIOXPCPS: /* set Xprint CPS string */
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOXPCPS\n");
|
|
if ( (uint)arg > p->RIOConf.MaxXpCps ||
|
|
(uint)arg < p->RIOConf.MinXpCps ) {
|
|
rio_dprintk (RIO_DEBUG_TTY, "%d CPS out of range\n",arg);
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
pseterr(EINVAL);
|
|
return 0;
|
|
}
|
|
PortP->Xprint.XpCps = (uint)arg;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
case TCRIOXPRINT:
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOXPRINT\n");
|
|
if ( copyout((caddr_t)&PortP->Xprint, (int)arg,
|
|
sizeof(struct Xprint))==COPYFAIL ) {
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
pseterr(EFAULT);
|
|
}
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
case TCRIOIXANYON:
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOIXANYON\n");
|
|
PortP->Config |= RIO_IXANY;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
case TCRIOIXANYOFF:
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOIXANYOFF\n");
|
|
PortP->Config &= ~RIO_IXANY;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
case TCRIOIXONON:
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOIXONON\n");
|
|
PortP->Config |= RIO_IXON;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
case TCRIOIXONOFF:
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOIXONOFF\n");
|
|
PortP->Config &= ~RIO_IXON;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
|
|
/*
|
|
** 15.10.1998 ARG - ESIL 0761 part fix
|
|
** Added support for CTS and RTS flow control ioctls :
|
|
*/
|
|
case TCRIOCTSFLOWEN:
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOCTSFLOWEN\n");
|
|
PortP->Config |= RIO_CTSFLOW;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
RIOParam(PortP,CONFIG,Modem,OK_TO_SLEEP);
|
|
return 0;
|
|
|
|
case TCRIOCTSFLOWDIS:
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIOCTSFLOWDIS\n");
|
|
PortP->Config &= ~RIO_CTSFLOW;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
RIOParam(PortP,CONFIG,Modem,OK_TO_SLEEP);
|
|
return 0;
|
|
|
|
case TCRIORTSFLOWEN:
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIORTSFLOWEN\n");
|
|
PortP->Config |= RIO_RTSFLOW;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
RIOParam(PortP,CONFIG,Modem,OK_TO_SLEEP);
|
|
return 0;
|
|
|
|
case TCRIORTSFLOWDIS:
|
|
rio_dprintk (RIO_DEBUG_TTY, "TCRIORTSFLOWDIS\n");
|
|
PortP->Config &= ~RIO_RTSFLOW;
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
RIOParam(PortP,CONFIG,Modem,OK_TO_SLEEP);
|
|
return 0;
|
|
|
|
/* end ESIL 0761 part fix */
|
|
|
|
}
|
|
|
|
|
|
/* Lynx IOCTLS */
|
|
switch (cmd) {
|
|
case TIOCSETP:
|
|
case TIOCSETN:
|
|
case OTIOCSETP:
|
|
case OTIOCSETN:
|
|
ioctl_processed++;
|
|
ttyseth(PortP, tp, (struct old_sgttyb *)arg);
|
|
break;
|
|
case TCSETA:
|
|
case TCSETAW:
|
|
case TCSETAF:
|
|
ioctl_processed++;
|
|
rio_dprintk (RIO_DEBUG_TTY, "NON POSIX ioctl\n");
|
|
ttyseth_pv(PortP, tp, (struct termios *)arg, 0);
|
|
break;
|
|
case TCSETAP: /* posix tcsetattr() */
|
|
case TCSETAWP: /* posix tcsetattr() */
|
|
case TCSETAFP: /* posix tcsetattr() */
|
|
rio_dprintk (RIO_DEBUG_TTY, "NON POSIX SYSV ioctl\n");
|
|
ttyseth_pv(PortP, tp, (struct termios *)arg, 1);
|
|
ioctl_processed++;
|
|
break;
|
|
}
|
|
|
|
/*
|
|
** If its any of the commands that require the port to be in the
|
|
** non-busy state wait until all output has drained
|
|
*/
|
|
if (!ioctl_processed)
|
|
switch(cmd) {
|
|
case TCSETAW:
|
|
case TCSETAF:
|
|
case TCSETA:
|
|
case TCSBRK:
|
|
#define OLD_POSIX ('x' << 8)
|
|
#define OLD_POSIX_SETA (OLD_POSIX | 2)
|
|
#define OLD_POSIX_SETAW (OLD_POSIX | 3)
|
|
#define OLD_POSIX_SETAF (OLD_POSIX | 4)
|
|
#define NEW_POSIX (('i' << 24) | ('X' << 16))
|
|
#define NEW_POSIX_SETA (NEW_POSIX | 2)
|
|
#define NEW_POSIX_SETAW (NEW_POSIX | 3)
|
|
#define NEW_POSIX_SETAF (NEW_POSIX | 4)
|
|
case OLD_POSIX_SETA:
|
|
case OLD_POSIX_SETAW:
|
|
case OLD_POSIX_SETAF:
|
|
case NEW_POSIX_SETA:
|
|
case NEW_POSIX_SETAW:
|
|
case NEW_POSIX_SETAF:
|
|
#ifdef TIOCSETP
|
|
case TIOCSETP:
|
|
#endif
|
|
case TIOCSETD:
|
|
case TIOCSETN:
|
|
rio_dprintk (RIO_DEBUG_TTY, "wait for non-BUSY, semaphore set\n");
|
|
/*
|
|
** Wait for drain here, at least as far as the double buffer
|
|
** being empty.
|
|
*/
|
|
/* XXX Does the above comment mean that this has
|
|
still to be implemented? -- REW */
|
|
/* XXX Is the locking OK together with locking
|
|
in txenable? (Deadlock?) -- REW */
|
|
|
|
RIOTxEnable((char *)PortP);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
old_cflag = tp->tm.c_cflag;
|
|
old_iflag = tp->tm.c_iflag;
|
|
old_oflag = tp->tm.c_oflag;
|
|
oldcook = PortP->CookMode;
|
|
|
|
if ( p->RIOHalted ) {
|
|
RIOClearUp( PortP );
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
pseterr(EIO);
|
|
return 0;
|
|
}
|
|
|
|
PortP->FlushCmdBodge = 0;
|
|
|
|
/*
|
|
** If the port is locked, and it is reconfigured, we want
|
|
** to restore the state of the tty structure so the change is NOT
|
|
** made.
|
|
*/
|
|
if (PortP->Lock) {
|
|
tp->tm.c_iflag = PortP->StoredTty.iflag;
|
|
tp->tm.c_oflag = PortP->StoredTty.oflag;
|
|
tp->tm.c_cflag = PortP->StoredTty.cflag;
|
|
tp->tm.c_lflag = PortP->StoredTty.lflag;
|
|
tp->tm.c_line = PortP->StoredTty.line;
|
|
for (i = 0; i < NCC + 1; i++)
|
|
tp->tm.c_cc[i] = PortP->StoredTty.cc[i];
|
|
}
|
|
else {
|
|
/*
|
|
** If the port is set to store the parameters, and it is
|
|
** reconfigured, we want to save the current tty struct so it
|
|
** may be restored on the next open.
|
|
*/
|
|
if (PortP->Store) {
|
|
PortP->StoredTty.iflag = tp->tm.c_iflag;
|
|
PortP->StoredTty.oflag = tp->tm.c_oflag;
|
|
PortP->StoredTty.cflag = tp->tm.c_cflag;
|
|
PortP->StoredTty.lflag = tp->tm.c_lflag;
|
|
PortP->StoredTty.line = tp->tm.c_line;
|
|
for (i = 0; i < NCC + 1; i++)
|
|
PortP->StoredTty.cc[i] = tp->tm.c_cc[i];
|
|
}
|
|
}
|
|
|
|
changed = (tp->tm.c_cflag != old_cflag) ||
|
|
(tp->tm.c_iflag != old_iflag) ||
|
|
(tp->tm.c_oflag != old_oflag);
|
|
|
|
PortP->CookMode = RIOCookMode(tp); /* Set new cooking mode */
|
|
|
|
rio_dprintk (RIO_DEBUG_TTY, "RIOIoctl changed %d newcook %d oldcook %d\n",
|
|
changed,PortP->CookMode,oldcook);
|
|
|
|
#ifdef MODEM_SUPPORT
|
|
/*
|
|
** kludge to force CARR_ON if CLOCAL set
|
|
*/
|
|
if ((tp->tm.c_cflag & CLOCAL) || (PortP->ModemState & MSVR1_CD)) {
|
|
tp->tm.c_state |= CARR_ON;
|
|
wakeup ((caddr_t)&tp->tm.c_canq);
|
|
}
|
|
#endif
|
|
|
|
if ( p->RIOHalted ) {
|
|
RIOClearUp( PortP );
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
pseterr(EIO);
|
|
return 0;
|
|
}
|
|
/*
|
|
** Re-configure if modes or cooking have changed
|
|
*/
|
|
if (changed || oldcook != PortP->CookMode || (ioctl_processed)) {
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
rio_dprintk (RIO_DEBUG_TTY, "Ioctl changing the PORT settings\n");
|
|
RIOParam(PortP,CONFIG,Modem,OK_TO_SLEEP);
|
|
rio_spin_lock_irqsave(&PortP->portSem, flags);
|
|
}
|
|
|
|
if (p->RIOHalted) {
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
RIOClearUp( PortP );
|
|
pseterr(EIO);
|
|
return 0;
|
|
}
|
|
rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
ttyseth -- set hardware dependent tty settings
|
|
*/
|
|
void
|
|
ttyseth(PortP, s, sg)
|
|
struct Port * PortP;
|
|
struct ttystatics * s;
|
|
struct old_sgttyb *sg;
|
|
{
|
|
struct old_sgttyb * tsg;
|
|
struct termios *tp = &s->tm;
|
|
|
|
tsg = &s->sg;
|
|
|
|
if (sg->sg_flags & (EVENP|ODDP)) {
|
|
tp->c_cflag &= PARENB;
|
|
if (sg->sg_flags & EVENP) {
|
|
if (sg->sg_flags & ODDP) {
|
|
tp->c_cflag &= V_CS7;
|
|
tp->c_cflag &= ~PARENB;
|
|
}
|
|
else {
|
|
tp->c_cflag &= V_CS7;
|
|
tp->c_cflag &= PARENB;
|
|
tp->c_cflag &= PARODD;
|
|
}
|
|
}
|
|
else if (sg->sg_flags & ODDP) {
|
|
tp->c_cflag &= V_CS7;
|
|
tp->c_cflag &= PARENB;
|
|
tp->c_cflag &= PARODD;
|
|
}
|
|
else {
|
|
tp->c_cflag &= V_CS7;
|
|
tp->c_cflag &= PARENB;
|
|
}
|
|
}
|
|
/*
|
|
* Use ispeed as the desired speed. Most implementations don't handle
|
|
* separate input and output speeds very well. If the RIO handles this,
|
|
* I will have to use separate sets of flags to store them in the
|
|
* Port structure.
|
|
*/
|
|
if ( !sg->sg_ospeed )
|
|
sg->sg_ospeed = sg->sg_ispeed;
|
|
else
|
|
sg->sg_ispeed = sg->sg_ospeed;
|
|
if (sg->sg_ispeed > V_EXTB )
|
|
sg->sg_ispeed = V_EXTB;
|
|
if (sg->sg_ispeed < V_B0)
|
|
sg->sg_ispeed = V_B0;
|
|
*tsg = *sg;
|
|
tp->c_cflag = (tp->c_cflag & ~V_CBAUD) | conv_bv[(int)sg->sg_ispeed];
|
|
}
|
|
|
|
/*
|
|
ttyseth_pv -- set hardware dependent tty settings using either the
|
|
POSIX termios structure or the System V termio structure.
|
|
sysv = 0 => (POSIX): struct termios *sg
|
|
sysv != 0 => (System V): struct termio *sg
|
|
*/
|
|
static void
|
|
ttyseth_pv(PortP, s, sg, sysv)
|
|
struct Port *PortP;
|
|
struct ttystatics *s;
|
|
struct termios *sg;
|
|
int sysv;
|
|
{
|
|
int speed;
|
|
unsigned char csize;
|
|
unsigned char cread;
|
|
unsigned int lcr_flags;
|
|
int ps;
|
|
|
|
if (sysv) {
|
|
/* sg points to a System V termio structure */
|
|
csize = ((struct termio *)sg)->c_cflag & CSIZE;
|
|
cread = ((struct termio *)sg)->c_cflag & CREAD;
|
|
speed = conv_vb[((struct termio *)sg)->c_cflag & V_CBAUD];
|
|
}
|
|
else {
|
|
/* sg points to a POSIX termios structure */
|
|
csize = sg->c_cflag & CSIZE;
|
|
cread = sg->c_cflag & CREAD;
|
|
speed = conv_vb[sg->c_cflag & V_CBAUD];
|
|
}
|
|
if (s->sg.sg_ispeed != speed || s->sg.sg_ospeed != speed) {
|
|
s->sg.sg_ispeed = speed;
|
|
s->sg.sg_ospeed = speed;
|
|
s->tm.c_cflag = (s->tm.c_cflag & ~V_CBAUD) |
|
|
conv_bv[(int)s->sg.sg_ispeed];
|
|
}
|
|
}
|
|
#endif
|