diff options
-rw-r--r-- | drivers/char/rio/riotty.c | 583 |
1 files changed, 0 insertions, 583 deletions
diff --git a/drivers/char/rio/riotty.c b/drivers/char/rio/riotty.c index 5894a25b0113..6379816ed173 100644 --- a/drivers/char/rio/riotty.c +++ b/drivers/char/rio/riotty.c | |||
@@ -89,16 +89,9 @@ static char *_riotty_c_sccs_ = "@(#)riotty.c 1.3"; | |||
89 | #include "list.h" | 89 | #include "list.h" |
90 | #include "sam.h" | 90 | #include "sam.h" |
91 | 91 | ||
92 | #if 0 | ||
93 | static void ttyseth_pv(struct Port *, struct ttystatics *, struct termios *sg, int); | ||
94 | #endif | ||
95 | |||
96 | static void RIOClearUp(struct Port *PortP); | 92 | static void RIOClearUp(struct Port *PortP); |
97 | int RIOShortCommand(struct rio_info *p, struct Port *PortP, int command, int len, int arg); | 93 | int RIOShortCommand(struct rio_info *p, struct Port *PortP, int command, int len, int arg); |
98 | 94 | ||
99 | #if 0 | ||
100 | static int RIOCookMode(struct ttystatics *); | ||
101 | #endif | ||
102 | 95 | ||
103 | extern int conv_vb[]; /* now defined in ttymgr.c */ | 96 | extern int conv_vb[]; /* now defined in ttymgr.c */ |
104 | extern int conv_bv[]; /* now defined in ttymgr.c */ | 97 | extern int conv_bv[]; /* now defined in ttymgr.c */ |
@@ -226,33 +219,6 @@ int riotopen(struct tty_struct *tty, struct file *filp) | |||
226 | ** until the RTA is present then we must spin here waiting for | 219 | ** until the RTA is present then we must spin here waiting for |
227 | ** the RTA to boot. | 220 | ** the RTA to boot. |
228 | */ | 221 | */ |
229 | #if 0 | ||
230 | if (!(PortP->HostP->Mapping[PortP->RupNum].Flags & RTA_BOOTED)) { | ||
231 | if (PortP->WaitUntilBooted) { | ||
232 | rio_dprintk(RIO_DEBUG_TTY, "Waiting for RTA to boot\n"); | ||
233 | do { | ||
234 | if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) { | ||
235 | rio_dprintk(RIO_DEBUG_TTY, "RTA EINTR in delay \n"); | ||
236 | func_exit(); | ||
237 | return -EINTR; | ||
238 | } | ||
239 | if (repeat_this-- <= 0) { | ||
240 | rio_dprintk(RIO_DEBUG_TTY, "Waiting for RTA to boot timeout\n"); | ||
241 | RIOPreemptiveCmd(p, PortP, FCLOSE); | ||
242 | pseterr(EINTR); | ||
243 | func_exit(); | ||
244 | return -EIO; | ||
245 | } | ||
246 | } while (!(PortP->HostP->Mapping[PortP->RupNum].Flags & RTA_BOOTED)); | ||
247 | rio_dprintk(RIO_DEBUG_TTY, "RTA has been booted\n"); | ||
248 | } else { | ||
249 | rio_dprintk(RIO_DEBUG_TTY, "RTA never booted\n"); | ||
250 | pseterr(ENXIO); | ||
251 | func_exit(); | ||
252 | return 0; | ||
253 | } | ||
254 | } | ||
255 | #else | ||
256 | /* I find the above code a bit hairy. I find the below code | 222 | /* I find the above code a bit hairy. I find the below code |
257 | easier to read and shorter. Now, if it works too that would | 223 | easier to read and shorter. Now, if it works too that would |
258 | be great... -- REW | 224 | be great... -- REW |
@@ -281,21 +247,10 @@ int riotopen(struct tty_struct *tty, struct file *filp) | |||
281 | } | 247 | } |
282 | } | 248 | } |
283 | rio_dprintk(RIO_DEBUG_TTY, "RTA has been booted\n"); | 249 | rio_dprintk(RIO_DEBUG_TTY, "RTA has been booted\n"); |
284 | #endif | ||
285 | #if 0 | ||
286 | tp = PortP->TtyP; /* get tty struct */ | ||
287 | #endif | ||
288 | rio_spin_lock_irqsave(&PortP->portSem, flags); | 250 | rio_spin_lock_irqsave(&PortP->portSem, flags); |
289 | if (p->RIOHalted) { | 251 | if (p->RIOHalted) { |
290 | goto bombout; | 252 | goto bombout; |
291 | } | 253 | } |
292 | #if 0 | ||
293 | retval = gs_init_port(&PortP->gs); | ||
294 | if (retval) { | ||
295 | func_exit(); | ||
296 | return retval; | ||
297 | } | ||
298 | #endif | ||
299 | 254 | ||
300 | /* | 255 | /* |
301 | ** If the port is in the final throws of being closed, | 256 | ** If the port is in the final throws of being closed, |
@@ -363,11 +318,6 @@ int riotopen(struct tty_struct *tty, struct file *filp) | |||
363 | command piggybacks the parameters immediately. | 318 | command piggybacks the parameters immediately. |
364 | -- REW */ | 319 | -- REW */ |
365 | RIOParam(PortP, OPEN, Modem, OK_TO_SLEEP); /* Open the port */ | 320 | RIOParam(PortP, OPEN, Modem, OK_TO_SLEEP); /* Open the port */ |
366 | #if 0 | ||
367 | /* This delay of 1 second was annoying. I removed it. -- REW */ | ||
368 | RIODelay(PortP, HUNDRED_MS * 10); | ||
369 | RIOParam(PortP, CONFIG, Modem, OK_TO_SLEEP); /* Config the port */ | ||
370 | #endif | ||
371 | rio_spin_lock_irqsave(&PortP->portSem, flags); | 321 | rio_spin_lock_irqsave(&PortP->portSem, flags); |
372 | 322 | ||
373 | /* | 323 | /* |
@@ -439,9 +389,6 @@ int riotopen(struct tty_struct *tty, struct file *filp) | |||
439 | PortP->State |= RIO_WOPEN; | 389 | PortP->State |= RIO_WOPEN; |
440 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | 390 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
441 | if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) | 391 | if (RIODelay(PortP, HUNDRED_MS) == RIO_FAIL) |
442 | #if 0 | ||
443 | if (sleep((caddr_t) & tp->tm.c_canqo, TTIPRI | PCATCH)) | ||
444 | #endif | ||
445 | { | 392 | { |
446 | /* | 393 | /* |
447 | ** ACTION: verify that this is a good thing | 394 | ** ACTION: verify that this is a good thing |
@@ -505,10 +452,6 @@ int riotopen(struct tty_struct *tty, struct file *filp) | |||
505 | */ | 452 | */ |
506 | int riotclose(void *ptr) | 453 | int riotclose(void *ptr) |
507 | { | 454 | { |
508 | #if 0 | ||
509 | register uint SysPort = dev; | ||
510 | struct ttystatics *tp; /* pointer to our ttystruct */ | ||
511 | #endif | ||
512 | struct Port *PortP = ptr; /* pointer to the port structure */ | 455 | struct Port *PortP = ptr; /* pointer to the port structure */ |
513 | int deleted = 0; | 456 | int deleted = 0; |
514 | int try = -1; /* Disable the timeouts by setting them to -1 */ | 457 | int try = -1; /* Disable the timeouts by setting them to -1 */ |
@@ -534,13 +477,6 @@ int riotclose(void *ptr) | |||
534 | end_time = jiffies + MAX_SCHEDULE_TIMEOUT; | 477 | end_time = jiffies + MAX_SCHEDULE_TIMEOUT; |
535 | 478 | ||
536 | Modem = rio_ismodem(tty); | 479 | Modem = rio_ismodem(tty); |
537 | #if 0 | ||
538 | /* What F.CKING cache? Even then, a higly idle multiprocessor, | ||
539 | system with large caches this won't work . Better find out when | ||
540 | this doesn't work asap, and fix the cause. -- REW */ | ||
541 | |||
542 | RIODelay(PortP, HUNDRED_MS * 10); /* To flush the cache */ | ||
543 | #endif | ||
544 | rio_spin_lock_irqsave(&PortP->portSem, flags); | 480 | rio_spin_lock_irqsave(&PortP->portSem, flags); |
545 | 481 | ||
546 | /* | 482 | /* |
@@ -703,45 +639,6 @@ int riotclose(void *ptr) | |||
703 | } | 639 | } |
704 | 640 | ||
705 | 641 | ||
706 | /* | ||
707 | ** decide if we need to use the line discipline. | ||
708 | ** This routine can return one of three values: | ||
709 | ** COOK_RAW if no processing has to be done by the line discipline or the card | ||
710 | ** COOK_WELL if the line discipline must be used to do the processing | ||
711 | ** COOK_MEDIUM if the card can do all the processing necessary. | ||
712 | */ | ||
713 | #if 0 | ||
714 | static int RIOCookMode(struct ttystatics *tp) | ||
715 | { | ||
716 | /* | ||
717 | ** We can't handle tm.c_mstate != 0 on SCO | ||
718 | ** We can't handle mapping | ||
719 | ** We can't handle non-ttwrite line disc. | ||
720 | ** We can't handle lflag XCASE | ||
721 | ** We can handle oflag OPOST & (OCRNL, ONLCR, TAB3) | ||
722 | */ | ||
723 | |||
724 | #ifdef CHECK | ||
725 | CheckTtyP(tp); | ||
726 | #endif | ||
727 | if (!(tp->tm.c_oflag & OPOST)) /* No post processing */ | ||
728 | return COOK_RAW; /* Raw mode o/p */ | ||
729 | |||
730 | if (tp->tm.c_lflag & XCASE) | ||
731 | return COOK_WELL; /* Use line disc */ | ||
732 | |||
733 | if (tp->tm.c_oflag & ~(OPOST | ONLCR | OCRNL | TAB3)) | ||
734 | return COOK_WELL; /* Use line disc for strange modes */ | ||
735 | |||
736 | if (tp->tm.c_oflag == OPOST) /* If only OPOST is set, do RAW */ | ||
737 | return COOK_RAW; | ||
738 | |||
739 | /* | ||
740 | ** So, we need to output process! | ||
741 | */ | ||
742 | return COOK_MEDIUM; | ||
743 | } | ||
744 | #endif | ||
745 | 642 | ||
746 | static void RIOClearUp(PortP) | 643 | static void RIOClearUp(PortP) |
747 | struct Port *PortP; | 644 | struct Port *PortP; |
@@ -776,11 +673,6 @@ int RIOShortCommand(struct rio_info *p, struct Port *PortP, int command, int len | |||
776 | unsigned long flags; | 673 | unsigned long flags; |
777 | 674 | ||
778 | rio_dprintk(RIO_DEBUG_TTY, "entering shortcommand.\n"); | 675 | rio_dprintk(RIO_DEBUG_TTY, "entering shortcommand.\n"); |
779 | #ifdef CHECK | ||
780 | CheckPortP(PortP); | ||
781 | if (len < 1 || len > 2) | ||
782 | cprintf(("STUPID LENGTH %d\n", len)); | ||
783 | #endif | ||
784 | 676 | ||
785 | if (PortP->State & RIO_DELETED) { | 677 | if (PortP->State & RIO_DELETED) { |
786 | rio_dprintk(RIO_DEBUG_TTY, "Short command to deleted RTA ignored\n"); | 678 | 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 | |||
852 | } | 744 | } |
853 | 745 | ||
854 | 746 | ||
855 | #if 0 | ||
856 | /* | ||
857 | ** This is an ioctl interface. This is the twentieth century. You know what | ||
858 | ** its all about. | ||
859 | */ | ||
860 | int riotioctl(struct rio_info *p, struct tty_struct *tty, int cmd, caddr_t arg) | ||
861 | { | ||
862 | register struct Port *PortP; | ||
863 | register struct ttystatics *tp; | ||
864 | int current; | ||
865 | int ParamSemIncremented = 0; | ||
866 | int old_oflag, old_cflag, old_iflag, changed, oldcook; | ||
867 | int i; | ||
868 | unsigned char sio_regs[5]; /* Here be magic */ | ||
869 | short vpix_cflag; | ||
870 | short divisor; | ||
871 | int baud; | ||
872 | uint SysPort = rio_minor(tty); | ||
873 | int Modem = rio_ismodem(tty); | ||
874 | int ioctl_processed; | ||
875 | |||
876 | rio_dprintk(RIO_DEBUG_TTY, "port ioctl SysPort %d command 0x%x argument 0x%x %s\n", SysPort, cmd, arg, Modem ? "Modem" : "tty"); | ||
877 | |||
878 | if (SysPort >= RIO_PORTS) { | ||
879 | rio_dprintk(RIO_DEBUG_TTY, "Bad port number %d\n", SysPort); | ||
880 | return -ENXIO; | ||
881 | } | ||
882 | |||
883 | PortP = p->RIOPortp[SysPort]; | ||
884 | tp = PortP->TtyP; | ||
885 | |||
886 | rio_spin_lock_irqsave(&PortP->portSem, flags); | ||
887 | |||
888 | #ifdef STATS | ||
889 | PortP->Stat.IoctlCnt++; | ||
890 | #endif | ||
891 | |||
892 | if (PortP->State & RIO_DELETED) { | ||
893 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
894 | return -EIO; | ||
895 | } | ||
896 | |||
897 | |||
898 | if (p->RIOHalted) { | ||
899 | RIOClearUp(PortP); | ||
900 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
901 | return -EIO; | ||
902 | } | ||
903 | |||
904 | /* | ||
905 | ** Count ioctls for port statistics reporting | ||
906 | */ | ||
907 | if (PortP->statsGather) | ||
908 | PortP->ioctls++; | ||
909 | |||
910 | /* | ||
911 | ** Specialix RIO Ioctl calls | ||
912 | */ | ||
913 | switch (cmd) { | ||
914 | |||
915 | case TCRIOTRIAD: | ||
916 | if (arg) | ||
917 | PortP->State |= RIO_TRIAD_MODE; | ||
918 | else | ||
919 | PortP->State &= ~RIO_TRIAD_MODE; | ||
920 | /* | ||
921 | ** Normally, when istrip is set on a port, a config is | ||
922 | ** sent to the RTA instructing the CD1400 to do the | ||
923 | ** stripping. In TRIAD mode, the interrupt receive routine | ||
924 | ** must do the stripping instead, since it has to detect | ||
925 | ** an 8 bit function key sequence. If istrip is set with | ||
926 | ** TRIAD mode on(off), and 8 bit data is being read by | ||
927 | ** the port, the user then turns TRIAD mode off(on), the RTA | ||
928 | ** must be reconfigured (not) to do the stripping. | ||
929 | ** Hence we call RIOParam here. | ||
930 | */ | ||
931 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
932 | RIOParam(PortP, CONFIG, Modem, OK_TO_SLEEP); | ||
933 | return 0; | ||
934 | |||
935 | case TCRIOTSTATE: | ||
936 | rio_dprintk(RIO_DEBUG_TTY, "tbusy/tstop monitoring %sabled\n", arg ? "en" : "dis"); | ||
937 | /* MonitorTstate = 0 ; */ | ||
938 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
939 | RIOParam(PortP, CONFIG, Modem, OK_TO_SLEEP); | ||
940 | return 0; | ||
941 | |||
942 | case TCRIOSTATE: /* current state of Modem input pins */ | ||
943 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOSTATE\n"); | ||
944 | if (RIOPreemptiveCmd(p, PortP, MGET) == RIO_FAIL) | ||
945 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOSTATE command failed\n"); | ||
946 | PortP->State |= RIO_BUSY; | ||
947 | current = PortP->ModemState; | ||
948 | if (copyout((caddr_t) & current, (int) arg, sizeof(current)) == COPYFAIL) { | ||
949 | rio_dprintk(RIO_DEBUG_TTY, "Copyout failed\n"); | ||
950 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
951 | pseterr(EFAULT); | ||
952 | } | ||
953 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
954 | return 0; | ||
955 | |||
956 | case TCRIOMBIS: /* Set modem lines */ | ||
957 | case TCRIOMBIC: /* Clear modem lines */ | ||
958 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOMBIS/TCRIOMBIC\n"); | ||
959 | if (cmd == TCRIOMBIS) { | ||
960 | uint state; | ||
961 | state = (uint) arg; | ||
962 | PortP->ModemState |= (ushort) state; | ||
963 | PortP->ModemLines = (ulong) arg; | ||
964 | if (RIOPreemptiveCmd(p, PortP, MBIS) == RIO_FAIL) | ||
965 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOMBIS command failed\n"); | ||
966 | } else { | ||
967 | uint state; | ||
968 | |||
969 | state = (uint) arg; | ||
970 | PortP->ModemState &= ~(ushort) state; | ||
971 | PortP->ModemLines = (ulong) arg; | ||
972 | if (RIOPreemptiveCmd(p, PortP, MBIC) == RIO_FAIL) | ||
973 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOMBIC command failed\n"); | ||
974 | } | ||
975 | PortP->State |= RIO_BUSY; | ||
976 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
977 | return 0; | ||
978 | |||
979 | case TCRIOXPON: /* set Xprint ON string */ | ||
980 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOXPON\n"); | ||
981 | if (copyin((int) arg, (caddr_t) PortP->Xprint.XpOn, MAX_XP_CTRL_LEN) == COPYFAIL) { | ||
982 | rio_dprintk(RIO_DEBUG_TTY, "Copyin failed\n"); | ||
983 | PortP->Xprint.XpOn[0] = '\0'; | ||
984 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
985 | pseterr(EFAULT); | ||
986 | } | ||
987 | PortP->Xprint.XpOn[MAX_XP_CTRL_LEN - 1] = '\0'; | ||
988 | PortP->Xprint.XpLen = strlen(PortP->Xprint.XpOn) + strlen(PortP->Xprint.XpOff); | ||
989 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
990 | return 0; | ||
991 | |||
992 | case TCRIOXPOFF: /* set Xprint OFF string */ | ||
993 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOXPOFF\n"); | ||
994 | if (copyin((int) arg, (caddr_t) PortP->Xprint.XpOff, MAX_XP_CTRL_LEN) == COPYFAIL) { | ||
995 | rio_dprintk(RIO_DEBUG_TTY, "Copyin failed\n"); | ||
996 | PortP->Xprint.XpOff[0] = '\0'; | ||
997 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
998 | pseterr(EFAULT); | ||
999 | } | ||
1000 | PortP->Xprint.XpOff[MAX_XP_CTRL_LEN - 1] = '\0'; | ||
1001 | PortP->Xprint.XpLen = strlen(PortP->Xprint.XpOn) + strlen(PortP->Xprint.XpOff); | ||
1002 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1003 | return 0; | ||
1004 | |||
1005 | case TCRIOXPCPS: /* set Xprint CPS string */ | ||
1006 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOXPCPS\n"); | ||
1007 | if ((uint) arg > p->RIOConf.MaxXpCps || (uint) arg < p->RIOConf.MinXpCps) { | ||
1008 | rio_dprintk(RIO_DEBUG_TTY, "%d CPS out of range\n", arg); | ||
1009 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1010 | pseterr(EINVAL); | ||
1011 | return 0; | ||
1012 | } | ||
1013 | PortP->Xprint.XpCps = (uint) arg; | ||
1014 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1015 | return 0; | ||
1016 | |||
1017 | case TCRIOXPRINT: | ||
1018 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOXPRINT\n"); | ||
1019 | if (copyout((caddr_t) & PortP->Xprint, (int) arg, sizeof(struct Xprint)) == COPYFAIL) { | ||
1020 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1021 | pseterr(EFAULT); | ||
1022 | } | ||
1023 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1024 | return 0; | ||
1025 | |||
1026 | case TCRIOIXANYON: | ||
1027 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOIXANYON\n"); | ||
1028 | PortP->Config |= RIO_IXANY; | ||
1029 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1030 | return 0; | ||
1031 | |||
1032 | case TCRIOIXANYOFF: | ||
1033 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOIXANYOFF\n"); | ||
1034 | PortP->Config &= ~RIO_IXANY; | ||
1035 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1036 | return 0; | ||
1037 | |||
1038 | case TCRIOIXONON: | ||
1039 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOIXONON\n"); | ||
1040 | PortP->Config |= RIO_IXON; | ||
1041 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1042 | return 0; | ||
1043 | |||
1044 | case TCRIOIXONOFF: | ||
1045 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOIXONOFF\n"); | ||
1046 | PortP->Config &= ~RIO_IXON; | ||
1047 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1048 | return 0; | ||
1049 | |||
1050 | /* | ||
1051 | ** 15.10.1998 ARG - ESIL 0761 part fix | ||
1052 | ** Added support for CTS and RTS flow control ioctls : | ||
1053 | */ | ||
1054 | case TCRIOCTSFLOWEN: | ||
1055 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOCTSFLOWEN\n"); | ||
1056 | PortP->Config |= RIO_CTSFLOW; | ||
1057 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1058 | RIOParam(PortP, CONFIG, Modem, OK_TO_SLEEP); | ||
1059 | return 0; | ||
1060 | |||
1061 | case TCRIOCTSFLOWDIS: | ||
1062 | rio_dprintk(RIO_DEBUG_TTY, "TCRIOCTSFLOWDIS\n"); | ||
1063 | PortP->Config &= ~RIO_CTSFLOW; | ||
1064 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1065 | RIOParam(PortP, CONFIG, Modem, OK_TO_SLEEP); | ||
1066 | return 0; | ||
1067 | |||
1068 | case TCRIORTSFLOWEN: | ||
1069 | rio_dprintk(RIO_DEBUG_TTY, "TCRIORTSFLOWEN\n"); | ||
1070 | PortP->Config |= RIO_RTSFLOW; | ||
1071 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1072 | RIOParam(PortP, CONFIG, Modem, OK_TO_SLEEP); | ||
1073 | return 0; | ||
1074 | |||
1075 | case TCRIORTSFLOWDIS: | ||
1076 | rio_dprintk(RIO_DEBUG_TTY, "TCRIORTSFLOWDIS\n"); | ||
1077 | PortP->Config &= ~RIO_RTSFLOW; | ||
1078 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1079 | RIOParam(PortP, CONFIG, Modem, OK_TO_SLEEP); | ||
1080 | return 0; | ||
1081 | |||
1082 | /* end ESIL 0761 part fix */ | ||
1083 | |||
1084 | } | ||
1085 | |||
1086 | |||
1087 | /* Lynx IOCTLS */ | ||
1088 | switch (cmd) { | ||
1089 | case TIOCSETP: | ||
1090 | case TIOCSETN: | ||
1091 | case OTIOCSETP: | ||
1092 | case OTIOCSETN: | ||
1093 | ioctl_processed++; | ||
1094 | ttyseth(PortP, tp, (struct old_sgttyb *) arg); | ||
1095 | break; | ||
1096 | case TCSETA: | ||
1097 | case TCSETAW: | ||
1098 | case TCSETAF: | ||
1099 | ioctl_processed++; | ||
1100 | rio_dprintk(RIO_DEBUG_TTY, "NON POSIX ioctl\n"); | ||
1101 | ttyseth_pv(PortP, tp, (struct termios *) arg, 0); | ||
1102 | break; | ||
1103 | case TCSETAP: /* posix tcsetattr() */ | ||
1104 | case TCSETAWP: /* posix tcsetattr() */ | ||
1105 | case TCSETAFP: /* posix tcsetattr() */ | ||
1106 | rio_dprintk(RIO_DEBUG_TTY, "NON POSIX SYSV ioctl\n"); | ||
1107 | ttyseth_pv(PortP, tp, (struct termios *) arg, 1); | ||
1108 | ioctl_processed++; | ||
1109 | break; | ||
1110 | } | ||
1111 | |||
1112 | /* | ||
1113 | ** If its any of the commands that require the port to be in the | ||
1114 | ** non-busy state wait until all output has drained | ||
1115 | */ | ||
1116 | if (!ioctl_processed) | ||
1117 | switch (cmd) { | ||
1118 | case TCSETAW: | ||
1119 | case TCSETAF: | ||
1120 | case TCSETA: | ||
1121 | case TCSBRK: | ||
1122 | #define OLD_POSIX ('x' << 8) | ||
1123 | #define OLD_POSIX_SETA (OLD_POSIX | 2) | ||
1124 | #define OLD_POSIX_SETAW (OLD_POSIX | 3) | ||
1125 | #define OLD_POSIX_SETAF (OLD_POSIX | 4) | ||
1126 | #define NEW_POSIX (('i' << 24) | ('X' << 16)) | ||
1127 | #define NEW_POSIX_SETA (NEW_POSIX | 2) | ||
1128 | #define NEW_POSIX_SETAW (NEW_POSIX | 3) | ||
1129 | #define NEW_POSIX_SETAF (NEW_POSIX | 4) | ||
1130 | case OLD_POSIX_SETA: | ||
1131 | case OLD_POSIX_SETAW: | ||
1132 | case OLD_POSIX_SETAF: | ||
1133 | case NEW_POSIX_SETA: | ||
1134 | case NEW_POSIX_SETAW: | ||
1135 | case NEW_POSIX_SETAF: | ||
1136 | #ifdef TIOCSETP | ||
1137 | case TIOCSETP: | ||
1138 | #endif | ||
1139 | case TIOCSETD: | ||
1140 | case TIOCSETN: | ||
1141 | rio_dprintk(RIO_DEBUG_TTY, "wait for non-BUSY, semaphore set\n"); | ||
1142 | /* | ||
1143 | ** Wait for drain here, at least as far as the double buffer | ||
1144 | ** being empty. | ||
1145 | */ | ||
1146 | /* XXX Does the above comment mean that this has | ||
1147 | still to be implemented? -- REW */ | ||
1148 | /* XXX Is the locking OK together with locking | ||
1149 | in txenable? (Deadlock?) -- REW */ | ||
1150 | |||
1151 | RIOTxEnable((char *) PortP); | ||
1152 | break; | ||
1153 | default: | ||
1154 | break; | ||
1155 | } | ||
1156 | |||
1157 | old_cflag = tp->tm.c_cflag; | ||
1158 | old_iflag = tp->tm.c_iflag; | ||
1159 | old_oflag = tp->tm.c_oflag; | ||
1160 | oldcook = PortP->CookMode; | ||
1161 | |||
1162 | if (p->RIOHalted) { | ||
1163 | RIOClearUp(PortP); | ||
1164 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1165 | pseterr(EIO); | ||
1166 | return 0; | ||
1167 | } | ||
1168 | |||
1169 | PortP->FlushCmdBodge = 0; | ||
1170 | |||
1171 | /* | ||
1172 | ** If the port is locked, and it is reconfigured, we want | ||
1173 | ** to restore the state of the tty structure so the change is NOT | ||
1174 | ** made. | ||
1175 | */ | ||
1176 | if (PortP->Lock) { | ||
1177 | tp->tm.c_iflag = PortP->StoredTty.iflag; | ||
1178 | tp->tm.c_oflag = PortP->StoredTty.oflag; | ||
1179 | tp->tm.c_cflag = PortP->StoredTty.cflag; | ||
1180 | tp->tm.c_lflag = PortP->StoredTty.lflag; | ||
1181 | tp->tm.c_line = PortP->StoredTty.line; | ||
1182 | for (i = 0; i < NCC + 1; i++) | ||
1183 | tp->tm.c_cc[i] = PortP->StoredTty.cc[i]; | ||
1184 | } else { | ||
1185 | /* | ||
1186 | ** If the port is set to store the parameters, and it is | ||
1187 | ** reconfigured, we want to save the current tty struct so it | ||
1188 | ** may be restored on the next open. | ||
1189 | */ | ||
1190 | if (PortP->Store) { | ||
1191 | PortP->StoredTty.iflag = tp->tm.c_iflag; | ||
1192 | PortP->StoredTty.oflag = tp->tm.c_oflag; | ||
1193 | PortP->StoredTty.cflag = tp->tm.c_cflag; | ||
1194 | PortP->StoredTty.lflag = tp->tm.c_lflag; | ||
1195 | PortP->StoredTty.line = tp->tm.c_line; | ||
1196 | for (i = 0; i < NCC + 1; i++) | ||
1197 | PortP->StoredTty.cc[i] = tp->tm.c_cc[i]; | ||
1198 | } | ||
1199 | } | ||
1200 | |||
1201 | changed = (tp->tm.c_cflag != old_cflag) || (tp->tm.c_iflag != old_iflag) || (tp->tm.c_oflag != old_oflag); | ||
1202 | |||
1203 | PortP->CookMode = RIOCookMode(tp); /* Set new cooking mode */ | ||
1204 | |||
1205 | rio_dprintk(RIO_DEBUG_TTY, "RIOIoctl changed %d newcook %d oldcook %d\n", changed, PortP->CookMode, oldcook); | ||
1206 | |||
1207 | #ifdef MODEM_SUPPORT | ||
1208 | /* | ||
1209 | ** kludge to force CARR_ON if CLOCAL set | ||
1210 | */ | ||
1211 | if ((tp->tm.c_cflag & CLOCAL) || (PortP->ModemState & MSVR1_CD)) { | ||
1212 | tp->tm.c_state |= CARR_ON; | ||
1213 | wakeup((caddr_t) & tp->tm.c_canq); | ||
1214 | } | ||
1215 | #endif | ||
1216 | |||
1217 | if (p->RIOHalted) { | ||
1218 | RIOClearUp(PortP); | ||
1219 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1220 | pseterr(EIO); | ||
1221 | return 0; | ||
1222 | } | ||
1223 | /* | ||
1224 | ** Re-configure if modes or cooking have changed | ||
1225 | */ | ||
1226 | if (changed || oldcook != PortP->CookMode || (ioctl_processed)) { | ||
1227 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1228 | rio_dprintk(RIO_DEBUG_TTY, "Ioctl changing the PORT settings\n"); | ||
1229 | RIOParam(PortP, CONFIG, Modem, OK_TO_SLEEP); | ||
1230 | rio_spin_lock_irqsave(&PortP->portSem, flags); | ||
1231 | } | ||
1232 | |||
1233 | if (p->RIOHalted) { | ||
1234 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1235 | RIOClearUp(PortP); | ||
1236 | pseterr(EIO); | ||
1237 | return 0; | ||
1238 | } | ||
1239 | rio_spin_unlock_irqrestore(&PortP->portSem, flags); | ||
1240 | return 0; | ||
1241 | } | ||
1242 | |||
1243 | /* | ||
1244 | ttyseth -- set hardware dependent tty settings | ||
1245 | */ | ||
1246 | void ttyseth(PortP, s, sg) | ||
1247 | struct Port *PortP; | ||
1248 | struct ttystatics *s; | ||
1249 | struct old_sgttyb *sg; | ||
1250 | { | ||
1251 | struct old_sgttyb *tsg; | ||
1252 | struct termios *tp = &s->tm; | ||
1253 | |||
1254 | tsg = &s->sg; | ||
1255 | |||
1256 | if (sg->sg_flags & (EVENP | ODDP)) { | ||
1257 | tp->c_cflag &= PARENB; | ||
1258 | if (sg->sg_flags & EVENP) { | ||
1259 | if (sg->sg_flags & ODDP) { | ||
1260 | tp->c_cflag &= V_CS7; | ||
1261 | tp->c_cflag &= ~PARENB; | ||
1262 | } else { | ||
1263 | tp->c_cflag &= V_CS7; | ||
1264 | tp->c_cflag &= PARENB; | ||
1265 | tp->c_cflag &= PARODD; | ||
1266 | } | ||
1267 | } else if (sg->sg_flags & ODDP) { | ||
1268 | tp->c_cflag &= V_CS7; | ||
1269 | tp->c_cflag &= PARENB; | ||
1270 | tp->c_cflag &= PARODD; | ||
1271 | } else { | ||
1272 | tp->c_cflag &= V_CS7; | ||
1273 | tp->c_cflag &= PARENB; | ||
1274 | } | ||
1275 | } | ||
1276 | /* | ||
1277 | * Use ispeed as the desired speed. Most implementations don't handle | ||
1278 | * separate input and output speeds very well. If the RIO handles this, | ||
1279 | * I will have to use separate sets of flags to store them in the | ||
1280 | * Port structure. | ||
1281 | */ | ||
1282 | if (!sg->sg_ospeed) | ||
1283 | sg->sg_ospeed = sg->sg_ispeed; | ||
1284 | else | ||
1285 | sg->sg_ispeed = sg->sg_ospeed; | ||
1286 | if (sg->sg_ispeed > V_EXTB) | ||
1287 | sg->sg_ispeed = V_EXTB; | ||
1288 | if (sg->sg_ispeed < V_B0) | ||
1289 | sg->sg_ispeed = V_B0; | ||
1290 | *tsg = *sg; | ||
1291 | tp->c_cflag = (tp->c_cflag & ~V_CBAUD) | conv_bv[(int) sg->sg_ispeed]; | ||
1292 | } | ||
1293 | |||
1294 | /* | ||
1295 | ttyseth_pv -- set hardware dependent tty settings using either the | ||
1296 | POSIX termios structure or the System V termio structure. | ||
1297 | sysv = 0 => (POSIX): struct termios *sg | ||
1298 | sysv != 0 => (System V): struct termio *sg | ||
1299 | */ | ||
1300 | static void ttyseth_pv(PortP, s, sg, sysv) | ||
1301 | struct Port *PortP; | ||
1302 | struct ttystatics *s; | ||
1303 | struct termios *sg; | ||
1304 | int sysv; | ||
1305 | { | ||
1306 | int speed; | ||
1307 | unsigned char csize; | ||
1308 | unsigned char cread; | ||
1309 | unsigned int lcr_flags; | ||
1310 | int ps; | ||
1311 | |||
1312 | if (sysv) { | ||
1313 | /* sg points to a System V termio structure */ | ||
1314 | csize = ((struct termio *) sg)->c_cflag & CSIZE; | ||
1315 | cread = ((struct termio *) sg)->c_cflag & CREAD; | ||
1316 | speed = conv_vb[((struct termio *) sg)->c_cflag & V_CBAUD]; | ||
1317 | } else { | ||
1318 | /* sg points to a POSIX termios structure */ | ||
1319 | csize = sg->c_cflag & CSIZE; | ||
1320 | cread = sg->c_cflag & CREAD; | ||
1321 | speed = conv_vb[sg->c_cflag & V_CBAUD]; | ||
1322 | } | ||
1323 | if (s->sg.sg_ispeed != speed || s->sg.sg_ospeed != speed) { | ||
1324 | s->sg.sg_ispeed = speed; | ||
1325 | s->sg.sg_ospeed = speed; | ||
1326 | s->tm.c_cflag = (s->tm.c_cflag & ~V_CBAUD) | conv_bv[(int) s->sg.sg_ispeed]; | ||
1327 | } | ||
1328 | } | ||
1329 | #endif | ||