[PATCH] Remove #if 0 and other long dead code from rio_tty
Signed-off-by: Alan Cox <alan@redhat.com> Signed-off-by: Linus Torvalds <torvalds@osdl.org>
This commit is contained in:
parent
925d70d64b
commit
a6176eeab0
|
@ -89,16 +89,9 @@ static char *_riotty_c_sccs_ = "@(#)riotty.c 1.3";
|
|||
#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 */
|
||||
|
@ -226,33 +219,6 @@ int riotopen(struct tty_struct *tty, struct file *filp)
|
|||
** 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
|
||||
|
@ -281,21 +247,10 @@ int riotopen(struct tty_struct *tty, struct file *filp)
|
|||
}
|
||||
}
|
||||
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,
|
||||
|
@ -363,11 +318,6 @@ int riotopen(struct tty_struct *tty, struct file *filp)
|
|||
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);
|
||||
|
||||
/*
|
||||
|
@ -439,9 +389,6 @@ int riotopen(struct tty_struct *tty, struct file *filp)
|
|||
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
|
||||
|
@ -505,10 +452,6 @@ int riotopen(struct tty_struct *tty, struct file *filp)
|
|||
*/
|
||||
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 */
|
||||
|
@ -534,13 +477,6 @@ int riotclose(void *ptr)
|
|||
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);
|
||||
|
||||
/*
|
||||
|
@ -703,45 +639,6 @@ int riotclose(void *ptr)
|
|||
}
|
||||
|
||||
|
||||
/*
|
||||
** 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;
|
||||
|
@ -776,11 +673,6 @@ int RIOShortCommand(struct rio_info *p, struct Port *PortP, int command, int len
|
|||
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");
|
||||
|
@ -852,478 +744,3 @@ int RIOShortCommand(struct rio_info *p, struct Port *PortP, int command, int len
|
|||
}
|
||||
|
||||
|
||||
#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) & current, (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
|
||||
|
|
Loading…
Reference in a new issue