/*- * * This driver and the associated header files support the ISA PC/Xem * Digiboards. Its evolutionary roots are described below. * Jack O'Neill * * Digiboard driver. * * Stage 1. "Better than nothing". * Stage 2. "Gee, it works!". * * Based on sio driver by Bruce Evans and on Linux driver by Troy * De Jongh or * which is under GNU General Public License version 2 so this driver * is forced to be under GPL 2 too. * * Written by Serge Babkin, * Joint Stock Commercial Bank "Chelindbank" * (Chelyabinsk, Russia) * babkin@hq.icb.chel.su * * Assorted hacks to make it more functional and working under 3.0-current. * Fixed broken routines to prevent processes hanging on closed (thanks * to Bruce for his patience and assistance). Thanks also to Maxim Bolotin * for his patches which did most of the work to get this * running under 2.2/3.0-current. * Implemented ioctls: TIOCMSDTRWAIT, TIOCMGDTRWAIT, TIOCTIMESTAMP & * TIOCDCDTIMESTAMP. * Sysctl debug flag is now a bitflag, to filter noise during debugging. * David L. Nugent */ #include "dgm.h" #if NDGM > 0 /* Helg: i.e.25 times per sec board will be polled */ #define POLLSPERSEC 25 /* How many charactes can we write to input tty rawq */ #define DGB_IBUFSIZE (TTYHOG-100) /* the overall number of ports controlled by this driver */ #ifndef NDGMPORTS # define NDGMPORTS (NDGM*64) #endif #include #include #include #include #include #include #include #include #include #include #include #include #include #ifdef DEVFS #include #endif #include #include #include #include #include #include #include #include /* This avoids warnings: we're an isa device only * so it does not matter... */ #undef outb #define outb outbv #define CALLOUT_MASK 0x40000 #define CONTROL_MASK 0xC0 #define CONTROL_INIT_STATE 0x40 #define CONTROL_LOCK_STATE 0x80 #define UNIT_MASK 0x30000 #define PORT_MASK 0x3F #define DEV_TO_UNIT(dev) (MINOR_TO_UNIT(minor(dev))) #define MINOR_MAGIC_MASK (CALLOUT_MASK | CONTROL_MASK) #define MINOR_TO_UNIT(mynor) (((mynor) & UNIT_MASK)>>16) #define MINOR_TO_PORT(mynor) ((mynor) & PORT_MASK) /* types. XXX - should be elsewhere */ typedef u_char bool_t; /* boolean */ /* digiboard port structure */ struct dgm_p { bool_t status; u_char unit; /* board unit number */ u_char pnum; /* port number */ u_char omodem; /* FEP output modem status */ u_char imodem; /* FEP input modem status */ u_char modemfake; /* Modem values to be forced */ u_char modem; /* Force values */ u_char hflow; u_char dsr; u_char dcd; u_char stopc; u_char startc; u_char stopca; u_char startca; u_char fepstopc; u_char fepstartc; u_char fepstopca; u_char fepstartca; u_char txwin; u_char rxwin; ushort fepiflag; ushort fepcflag; ushort fepoflag; ushort txbufhead; ushort txbufsize; ushort rxbufhead; ushort rxbufsize; int close_delay; int count; int blocked_open; int event; int asyncflags; u_long statusflags; u_char *txptr; u_char *rxptr; volatile struct board_chan *brdchan; struct tty *tty; bool_t active_out; /* nonzero if the callout device is open */ u_int wopeners; /* # processes waiting for DCD in open() */ /* Initial state. */ struct termios it_in; /* should be in struct tty */ struct termios it_out; /* Lock state. */ struct termios lt_in; /* should be in struct tty */ struct termios lt_out; bool_t do_timestamp; bool_t do_dcd_timestamp; struct timeval timestamp; struct timeval dcd_timestamp; /* flags of state, are used in sleep() too */ u_char closing; /* port is being closed now */ u_char draining; /* port is being drained now */ u_char used; /* port is being used now */ u_char mustdrain; /* data must be waited to drain in dgmparam() */ #ifdef DEVFS struct { void *tty; void *ttyi; void *ttyl; void *cua; void *cuai; void *cual; } devfs_token; #endif }; /* Digiboard per-board structure */ struct dgm_softc { /* struct board_info */ u_char status; /* status: DISABLED/ENABLED */ u_char unit; /* unit number */ u_char type; /* type of card: PCXE, PCXI, PCXEVE */ u_char altpin; /* do we need alternate pin setting ? */ ushort numports; /* number of ports on card */ ushort port; /* I/O port */ u_char *vmem; /* virtual memory address */ long pmem; /* physical memory address */ int mem_seg; /* internal memory segment */ struct dgm_p *ports; /* pointer to array of port descriptors */ struct tty *ttys; /* pointer to array of TTY structures */ volatile struct global_data *mailbox; }; static struct dgm_softc dgm_softc[NDGM]; static struct dgm_p dgm_ports[NDGMPORTS]; static struct tty dgm_tty[NDGMPORTS]; int fi(void); /* * The public functions in the com module ought to be declared in a com-driver * system header. */ /* Interrupt handling entry points. */ static void dgmpoll __P((void *unit_c)); /*static void dgmintr __P((int unit));*/ /* Device switch entry points. */ #define dgmreset noreset #define dgmmmap nommap #define dgmstrategy nostrategy static int dgmattach __P((struct isa_device *dev)); static int dgmprobe __P((struct isa_device *dev)); static void fepcmd(struct dgm_p *port, unsigned cmd, unsigned op1, unsigned op2, unsigned ncmds, unsigned bytecmd); static void dgmstart __P((struct tty *tp)); static int dgmparam __P((struct tty *tp, struct termios *t)); static void dgmhardclose __P((struct dgm_p *port)); static void dgm_drain_or_flush __P((struct dgm_p *port)); static int dgmdrain __P((struct dgm_p *port)); static void dgm_pause __P((void *chan)); static void wakeflush __P((void *p)); static void disc_optim __P((struct tty *tp, struct termios *t)); struct isa_driver dgmdriver = { dgmprobe, dgmattach, "dgm",0 }; static d_open_t dgmopen; static d_close_t dgmclose; static d_read_t dgmread; static d_write_t dgmwrite; static d_ioctl_t dgmioctl; static d_stop_t dgmstop; static d_devtotty_t dgmdevtotty; #define CDEV_MAJOR 101 static struct cdevsw dgm_cdevsw = { dgmopen, dgmclose, dgmread, dgmwrite, dgmioctl, dgmstop, noreset, dgmdevtotty, /* dgm */ ttpoll, nommap, NULL, "dgm", NULL, -1 }; static speed_t dgmdefaultrate = TTYDEF_SPEED; static struct speedtab dgmspeedtab[] = { 0, FEP_B0, /* old (sysV-like) Bx codes */ 50, FEP_B50, 75, FEP_B75, 110, FEP_B110, 134, FEP_B134, 150, FEP_B150, 200, FEP_B200, 300, FEP_B300, 600, FEP_B600, 1200, FEP_B1200, 1800, FEP_B1800, 2400, FEP_B2400, 4800, FEP_B4800, 9600, FEP_B9600, 19200, FEP_B19200, 38400, FEP_B38400, 57600, (FEP_FASTBAUD|FEP_B50), /* B50 & fast baud table */ 115200, (FEP_FASTBAUD|FEP_B110), /* B100 & fast baud table */ -1, -1 }; static struct dbgflagtbl { tcflag_t in_mask; tcflag_t in_val; tcflag_t out_val; } dgm_cflags[] = { { PARODD, PARODD, FEP_PARODD }, { PARENB, PARENB, FEP_PARENB }, { CSTOPB, CSTOPB, FEP_CSTOPB }, { CSIZE, CS5, FEP_CS6 }, { CSIZE, CS6, FEP_CS6 }, { CSIZE, CS7, FEP_CS7 }, { CSIZE, CS8, FEP_CS8 }, { CLOCAL, CLOCAL, FEP_CLOCAL }, { (tcflag_t)-1 } }, dgm_iflags[] = { { IGNBRK, IGNBRK, FEP_IGNBRK }, { BRKINT, BRKINT, FEP_BRKINT }, { IGNPAR, IGNPAR, FEP_IGNPAR }, { PARMRK, PARMRK, FEP_PARMRK }, { INPCK, INPCK, FEP_INPCK }, { ISTRIP, ISTRIP, FEP_ISTRIP }, { IXON, IXON, FEP_IXON }, { IXOFF, IXOFF, FEP_IXOFF }, { IXANY, IXANY, FEP_IXANY }, { (tcflag_t)-1 } }, dgm_flow[] = { { CRTSCTS, CRTSCTS, CTS|RTS }, { CRTSCTS, CCTS_OFLOW, CTS }, { CRTSCTS, CRTS_IFLOW, RTS }, { (tcflag_t)-1 } }; /* xlat bsd termios flags to dgm sys-v style */ static tcflag_t dgmflags(struct dbgflagtbl *tbl, tcflag_t input) { tcflag_t output = 0; int i; for (i=0; tbl[i].in_mask != (tcflag_t)-1; i++) { if ((input & tbl[i].in_mask) == tbl[i].in_val) output |= tbl[i].out_val; } return output; } static int dgmdebug=0; SYSCTL_INT(_debug, OID_AUTO, dgm_debug, CTLFLAG_RW, &dgmdebug, 0, ""); static int setwin __P((struct dgm_softc *sc, unsigned addr)); static void hidewin __P((struct dgm_softc *sc)); static void towin __P((struct dgm_softc *sc, int win)); /*Helg: to allow recursive dgm...() calls */ typedef struct { /* If we were called and don't want to disturb we need: */ short port, /* write to this port */ data; /* this data on exit */ /* or DATA_WINOFF to close memory window on entry */ } BoardMemWinState; /* so several channels and even boards can coexist */ #define DATA_WINOFF 0 static BoardMemWinState bmws; /* return current memory window state and close window */ static BoardMemWinState bmws_get(void) { BoardMemWinState bmwsRet=bmws; if(bmws.data!=DATA_WINOFF) outb(bmws.port, bmws.data=DATA_WINOFF); return bmwsRet; } /* restore memory window state */ static void bmws_set(BoardMemWinState ws) { if(ws.data != bmws.data || ws.port!=bmws.port ) { if(bmws.data!=DATA_WINOFF) outb(bmws.port,DATA_WINOFF); if(ws.data!=DATA_WINOFF) outb(ws.port, ws.data); bmws=ws; } } static __inline int setwin(sc,addr) struct dgm_softc *sc; unsigned int addr; { outb(bmws.port=sc->port+1,bmws.data=FEPWIN|(addr >> 15)); return (addr & 0x7FFF); } static __inline void hidewin(sc) struct dgm_softc *sc; { bmws.data=0; outb(bmws.port=sc->port+1, bmws.data); } static __inline void towin(sc,win) struct dgm_softc *sc; int win; { outb(bmws.port=sc->port+1, bmws.data=win); } static int dgmprobe(dev) struct isa_device *dev; { struct dgm_softc *sc= &dgm_softc[dev->id_unit]; int i, v, t; u_char *mem; int addr; int unit=dev->id_unit; sc->unit=dev->id_unit; sc->port=dev->id_iobase; if(dev->id_flags & DGBFLAG_ALTPIN) sc->altpin=1; else sc->altpin=0; /* left 24 bits only (ISA address) */ sc->pmem=((long)dev->id_maddr & 0xFFFFFF); DPRINT4(DB_INFO,"dgm%d: port 0x%x mem 0x%x\n",unit,sc->port,sc->pmem); outb(sc->port, FEPRST); sc->status=DISABLED; for(i=0; i< 1000; i++) { DELAY(1); if( (inb(sc->port) & FEPMASK) == FEPRST ) { sc->status=ENABLED; DPRINT3(DB_EXCEPT,"dgm%d: got reset after %d us\n",unit,i); break; } } if(sc->status!=ENABLED) { DPRINT2(DB_EXCEPT,"dgm%d: failed to respond\n",dev->id_unit); return 0; } /* check type of card and get internal memory characteristics */ v=inb(sc->port); printf("dgm%d: PC/Xem\n",dev->id_unit); sc->type=PCXEM; sc->mem_seg=0x8000; /* save size of vizible memory segment */ /* all PCXEMs have a 32k window size */ dev->id_msize=0x8000; /* map memory */ dev->id_maddr=sc->vmem=pmap_mapdev(sc->pmem,dev->id_msize); outb(sc->port, FEPCLR); /* drop RESET */ hidewin(sc); /* Helg: to set initial bmws state */ return 4; /* we need I/O space of 4 ports */ } static int dgmattach(dev) struct isa_device *dev; { int unit=dev->id_unit; struct dgm_softc *sc= &dgm_softc[dev->id_unit]; int i, t; u_char *mem; u_char *ptr; int addr; struct dgm_p *port; volatile struct board_chan *bc; struct global_data *gd; int shrinkmem; int nfails; ushort *pstat; int lowwater; static int nports=0; char ch; int stuff; if(sc->status!=ENABLED) { DPRINT2(DB_EXCEPT,"dbg%d: try to attach a disabled card\n",unit); return 0; } mem=sc->vmem; DPRINT3(DB_INFO,"dgm%d: internal memory segment 0x%x\n",unit,sc->mem_seg); outb(sc->port, FEPRST); DELAY(1); for(i=0; (inb(sc->port) & FEPMASK) != FEPRST ; i++) { if(i>10000) { printf("dgm%d: 1st reset failed\n",dev->id_unit); sc->status=DISABLED; hidewin(sc); return 0; } DELAY(1); } DPRINT3(DB_INFO,"dgm%d: got reset after %d us\n",unit,i); t=(((u_long)sc->pmem>>8)) /* disable windowing */; outb(sc->port+2,t & 0xFF); outb(sc->port+3,t>>8); mem=sc->vmem; /* very short memory test */ addr=setwin(sc,BOTWIN); *(u_long *)(mem+addr) = 0xA55A3CC3; if(*(u_long *)(mem+addr)!=0xA55A3CC3) { printf("dgm%d: 1st memory test failed\n",dev->id_unit); sc->status=DISABLED; hidewin(sc); return 0; } addr=setwin(sc,TOPWIN); *(u_long *)(mem+addr) = 0x5AA5C33C; if(*(u_long *)(mem+addr)!=0x5AA5C33C) { printf("dgm%d: 2nd memory test failed\n",dev->id_unit); sc->status=DISABLED; hidewin(sc); return 0; } addr=setwin(sc,BIOSCODE+((0xF000-sc->mem_seg)<<4)); *(u_long *)(mem+addr) = 0x5AA5C33C; if(*(u_long *)(mem+addr)!=0x5AA5C33C) { printf("dgm%d: 3rd (BIOS) memory test failed\n",dev->id_unit); } addr=setwin(sc,MISCGLOBAL); for(i=0; i<16; i++) { mem[addr+i]=0; } addr=setwin(sc,BIOSOFFSET); ptr=mem+addr; for(i=0; ptrid_msize; i++){ *ptr++ = pcem_bios[i]; } ptr=mem+BIOSOFFSET; for(i=0; ptrid_msize; i++){ if(*ptr++ != pcem_bios[i]){ printf("Low BIOS load failed\n"); sc->status = DISABLED; hidewin(sc); return 0; } } addr=setwin(sc,dev->id_msize); ptr =mem+addr; for(;i < pcem_nbios; i++){ *ptr++ = pcem_bios[i]; } ptr=mem; for(i = dev->id_msize - BIOSOFFSET; i < pcem_nbios; i++){ if(*ptr++ != pcem_bios[i]){ printf("High BIOS load failed\n"); sc->status = DISABLED; hidewin(sc); return 0; } } printf("dgm%d: DigiBIOS loaded, initializing",dev->id_unit); addr=setwin(sc,0); *(u_int *)(mem+addr+0)=0x0bf00401; *(u_int *)(mem+addr+4)=0; *(ushort *)(mem+addr+0xc00)=0; outb(sc->port, 0); for(i = 0;*(u_char *)(mem+addr+ 0xc00) != 0x47;i++){ DELAY(10000); if(i> 3000){ printf("\nBIOS initialize failed(1)\n"); sc->status = DISABLED; hidewin(sc); return 0; } } if(*(u_char *)(mem+addr+ 0xc01) != 0x44){ printf("\nBIOS initialize failed(2)\n"); sc->status = DISABLED; hidewin(sc); return 0; } printf(", DigiBIOS running\n"); DELAY(10000); addr=setwin(sc,BIOSOFFSET); ptr=mem+addr; for(i=0; istatus = DISABLED; hidewin(sc); return 0; } } printf("dgm%d: FEP/OS loaded, initializing",dev->id_unit); addr=setwin(sc,0); *(ushort *)(mem+addr+0xd20)=0; *(u_int *)(mem+addr+0xc34)=0xbfc01004; *(u_int *)(mem+addr+0xc30)=0x3L; outb(sc->port,0); for(i = 0;*(u_char *)(mem+addr+ 0xd20) != 'O';i++){ DELAY(10000); if(i> 3000){ printf("\nFEP/OS initialize failed(1)\n"); sc->status = DISABLED; hidewin(sc); return 0; } } if(*(u_char *)(mem+addr+ 0xd21) != 'S'){ printf("\nFEP/OS initialize failed(2)\n"); sc->status = DISABLED; hidewin(sc); return 0; } printf(", FEP/OS running\n"); sc->numports= *(ushort *)(mem+setwin(sc,NPORT)); printf("dgm%d: %d ports\n",unit,sc->numports); if(sc->numports > MAX_DGM_PORTS) { printf("dgm%d: too many ports\n",unit); sc->status=DISABLED; hidewin(sc); return 0; } if(nports+sc->numports>NDGMPORTS) { printf("dgm%d: only %d ports are usable\n", unit, NDGMPORTS-nports); sc->numports=NDGMPORTS-nports; } /* allocate port and tty structures */ sc->ports=&dgm_ports[nports]; sc->ttys=&dgm_tty[nports]; nports+=sc->numports; for(i=0; inumports; i++) sc->ports[i].status = ENABLED; /* We should now init per-port structures */ setwin(sc,0); bc=(volatile struct board_chan *)(mem + CHANSTRUCT); sc->mailbox=(volatile struct global_data *)(mem + FEP_GLOBAL); if(sc->numports<3) shrinkmem=1; else shrinkmem=0; for(i=0; inumports; i++, bc++) { port= &sc->ports[i]; port->tty=&sc->ttys[i]; port->unit=unit; port->brdchan=bc; port->dcd=CD; port->dsr=DSR; port->pnum=i; if(shrinkmem) { DPRINT2(DB_INFO,"dgm%d: shrinking memory\n",unit); fepcmd(port, SETBUFFER, 32, 0, 0, 0); shrinkmem=0; } /* HERE */ port->txptr=mem+( ((bc->tseg)<<4) & 0x7FFF ); port->rxptr=mem+( ((bc->rseg)<<4) & 0x7FFF ); port->txwin=FEPWIN | ((bc->tseg)>>11); port->rxwin=FEPWIN | ((bc->rseg)>>11); port->txbufhead=0; port->rxbufhead=0; port->txbufsize=bc->tmax+1; port->rxbufsize=bc->rmax+1; lowwater= (port->txbufsize>=2000) ? 1024 : (port->txbufsize/2); setwin(sc,0); fepcmd(port, STXLWATER, lowwater, 0, 10, 0); fepcmd(port, SRXLWATER, port->rxbufsize/4, 0, 10, 0); fepcmd(port, SRXHWATER, 3*port->rxbufsize/4, 0, 10, 0); bc->edelay=100; bc->idata=1; port->startc=bc->startc; port->startca=bc->startca; port->stopc=bc->stopc; port->stopca=bc->stopca; /*port->close_delay=50;*/ port->close_delay=3 * hz; port->do_timestamp=0; port->do_dcd_timestamp=0; /* * We don't use all the flags from since they * are only relevant for logins. It's important to have echo off * initially so that the line doesn't start blathering before the * echo flag can be turned off. */ port->it_in.c_iflag = TTYDEF_IFLAG; port->it_in.c_oflag = TTYDEF_OFLAG; port->it_in.c_cflag = TTYDEF_CFLAG; port->it_in.c_lflag = TTYDEF_LFLAG; termioschars(&port->it_in); port->it_in.c_ispeed = port->it_in.c_ospeed = dgmdefaultrate; port->it_out = port->it_in; #ifdef DEVFS port->devfs_token.tty = devfs_add_devswf(&dgb_cdevsw, (unit*65536)+i, DV_CHR, UID_ROOT, GID_WHEEL, 0600, "ttyM%d%x", unit, i + 0xa0); port->devfs_token.ttyi = devfs_add_devswf(&dgb_cdevsw, (unit*65536)+i+64, DV_CHR, UID_ROOT, GID_WHEEL, 0600, "ttyiM%d%x", unit, i + 0xa0); port->devfs_token.ttyl = devfs_add_devswf(&dgb_cdevsw, (unit*65536)+i+128, DV_CHR, UID_ROOT, GID_WHEEL, 0600, "ttylM%d%x", unit, i + 0xa0); port->devfs_token.cua = devfs_add_devswf(&dgb_cdevsw, (unit*65536)+i+262144, DV_CHR, UID_UUCP, GID_DIALER, 0660, "cuaM%d%x", unit, i + 0xa0); port->devfs_token.cuai = devfs_add_devswf(&dgb_cdevsw, (unit*65536)+i+262208, DV_CHR, UID_UUCP, GID_DIALER, 0660, "cuaiM%d%x", unit, i + 0xa0); port->devfs_token.cual = devfs_add_devswf(&dgb_cdevsw, (unit*65536)+i+262272, DV_CHR, UID_UUCP, GID_DIALER, 0660, "cualM%d%x", unit, i + 0xa0); #endif } hidewin(sc); /* register the polling function */ timeout(dgmpoll, (void *)unit, hz/POLLSPERSEC); return 1; } /* ARGSUSED */ static int dgmopen(dev, flag, mode, p) dev_t dev; int flag; int mode; struct proc *p; { struct dgm_softc *sc; struct tty *tp; int unit; int mynor; int pnum; struct dgm_p *port; int s,cs; int error; volatile struct board_chan *bc; error=0; mynor=minor(dev); unit=MINOR_TO_UNIT(mynor); pnum=MINOR_TO_PORT(mynor); if(unit >= NDGM) { DPRINT2(DB_EXCEPT,"dgm%d: try to open a nonexisting card\n",unit); return ENXIO; } sc=&dgm_softc[unit]; if(sc->status!=ENABLED) { DPRINT2(DB_EXCEPT,"dgm%d: try to open a disabled card\n",unit); return ENXIO; } if(pnum>=sc->numports) { DPRINT3(DB_EXCEPT,"dgm%d: try to open non-existing port %d\n",unit,pnum); return ENXIO; } if(mynor & CONTROL_MASK) return 0; tp=&sc->ttys[pnum]; port=&sc->ports[pnum]; bc=port->brdchan; open_top: s=spltty(); while(port->closing) { error=tsleep(&port->closing, TTOPRI|PCATCH, "dgocl", 0); if(error) { DPRINT4(DB_OPEN,"dgm%d: port%d: tsleep(dgocl) error=%d\n",unit,pnum,error); goto out; } } if (tp->t_state & TS_ISOPEN) { /* * The device is open, so everything has been initialized. * Handle conflicts. */ if (mynor & CALLOUT_MASK) { if (!port->active_out) { error = EBUSY; DPRINT4(DB_OPEN,"dgm%d: port%d: BUSY error=%d\n",unit,pnum,error); goto out; } } else { if (port->active_out) { if (flag & O_NONBLOCK) { error = EBUSY; DPRINT4(DB_OPEN,"dgm%d: port%d: BUSY error=%d\n",unit,pnum,error); goto out; } error = tsleep(&port->active_out, TTIPRI | PCATCH, "dgmi", 0); if (error != 0) { DPRINT4(DB_OPEN,"dgm%d: port%d: tsleep(dgmi) error=%d\n", unit,pnum,error); goto out; } splx(s); goto open_top; } } if (tp->t_state & TS_XCLUDE && p->p_ucred->cr_uid != 0) { error = EBUSY; goto out; } } else { /* * The device isn't open, so there are no conflicts. * Initialize it. Initialization is done twice in many * cases: to preempt sleeping callin opens if we are * callout, and to complete a callin open after DCD rises. */ tp->t_oproc=dgmstart; tp->t_param=dgmparam; tp->t_dev=dev; tp->t_termios= (mynor & CALLOUT_MASK) ? port->it_out : port->it_in; cs=splclock(); setwin(sc,0); port->imodem=bc->mstat; bc->rout=bc->rin; /* clear input queue */ bc->idata=1; #ifdef PRINT_BUFSIZE printf("dgm buffers tx=%x:%x rx=%x:%x\n",bc->tseg,bc->tmax,bc->rseg,bc->rmax); #endif hidewin(sc); splx(cs); port->wopeners++; error=dgmparam(tp, &tp->t_termios); port->wopeners--; if(error!=0) { DPRINT4(DB_OPEN,"dgm%d: port%d: dgmparam error=%d\n",unit,pnum,error); goto out; } ttsetwater(tp); /* handle fake DCD for callout devices */ /* and initial DCD */ if( (port->imodem & port->dcd) || mynor & CALLOUT_MASK ) linesw[tp->t_line].l_modem(tp,1); } /* * Wait for DCD if necessary. */ if (!(tp->t_state & TS_CARR_ON) && !(mynor & CALLOUT_MASK) && !(tp->t_cflag & CLOCAL) && !(flag & O_NONBLOCK)) { ++port->wopeners; error = tsleep(TSA_CARR_ON(tp), TTIPRI | PCATCH, "dgdcd", 0); --port->wopeners; if (error != 0) { DPRINT4(DB_OPEN,"dgm%d: port%d: tsleep(dgdcd) error=%d\n",unit,pnum,error); goto out; } splx(s); goto open_top; } error = linesw[tp->t_line].l_open(dev, tp); disc_optim(tp,&tp->t_termios); DPRINT4(DB_OPEN,"dgm%d: port%d: l_open error=%d\n",unit,pnum,error); if (tp->t_state & TS_ISOPEN && mynor & CALLOUT_MASK) port->active_out = TRUE; port->used=1; /* If any port is open (i.e. the open() call is completed for it) * the device is busy */ out: disc_optim(tp,&tp->t_termios); splx(s); if( !(tp->t_state & TS_ISOPEN) && port->wopeners==0 ) dgmhardclose(port); DPRINT4(DB_OPEN,"dgm%d: port%d: open() returns %d\n",unit,pnum,error); return error; } /*ARGSUSED*/ static int dgmclose(dev, flag, mode, p) dev_t dev; int flag; int mode; struct proc *p; { int mynor; struct tty *tp; int unit, pnum; struct dgm_softc *sc; struct dgm_p *port; int s; int i; mynor=minor(dev); if(mynor & CONTROL_MASK) return 0; unit=MINOR_TO_UNIT(mynor); pnum=MINOR_TO_PORT(mynor); sc=&dgm_softc[unit]; tp=&sc->ttys[pnum]; port=sc->ports+pnum; DPRINT3(DB_CLOSE,"dgm%d: port%d: closing\n",unit,pnum); DPRINT3(DB_CLOSE,"dgm%d: port%d: draining port\n",unit,pnum); dgm_drain_or_flush(port); s=spltty(); port->closing=1; DPRINT3(DB_CLOSE,"dgm%d: port%d: closing line disc\n",unit,pnum); linesw[tp->t_line].l_close(tp,flag); disc_optim(tp,&tp->t_termios); DPRINT3(DB_CLOSE,"dgm%d: port%d: hard closing\n",unit,pnum); dgmhardclose(port); DPRINT3(DB_CLOSE,"dgm%d: port%d: closing tty\n",unit,pnum); ttyclose(tp); port->closing=0; wakeup(&port->closing); port->used=0; /* mark the card idle when all ports are closed */ for(i=0; inumports; i++) if(sc->ports[i].used) break; splx(s); DPRINT3(DB_CLOSE,"dgm%d: port%d: closed\n",unit,pnum); wakeup(TSA_CARR_ON(tp)); wakeup(&port->active_out); port->active_out=0; DPRINT3(DB_CLOSE,"dgm%d: port%d: close exit\n",unit,pnum); return 0; } static void dgmhardclose(port) struct dgm_p *port; { struct dgm_softc *sc=&dgm_softc[port->unit]; volatile struct board_chan *bc=port->brdchan; int cs; cs=splclock(); port->do_timestamp = 0; setwin(sc,0); bc->idata=0; bc->iempty=0; bc->ilow=0; if(port->tty->t_cflag & HUPCL) { port->omodem &= ~(RTS|DTR); fepcmd(port, SETMODEM, 0, DTR|RTS, 0, 1); } hidewin(sc); splx(cs); timeout(dgm_pause, &port->brdchan, hz/2); tsleep(&port->brdchan, TTIPRI | PCATCH, "dgclo", 0); } static void dgm_pause(chan) void *chan; { wakeup((caddr_t)chan); } static int dgmread(dev, uio, flag) dev_t dev; struct uio *uio; int flag; { int mynor; struct tty *tp; int error, unit, pnum; mynor=minor(dev); if (mynor & CONTROL_MASK) return (ENODEV); unit=MINOR_TO_UNIT(mynor); pnum=MINOR_TO_PORT(mynor); tp=&dgm_softc[unit].ttys[pnum]; error=linesw[tp->t_line].l_read(tp, uio, flag); DPRINT4(DB_RD,"dgm%d: port%d: read() returns %d\n",unit,pnum,error); return error; } static int dgmwrite(dev, uio, flag) dev_t dev; struct uio *uio; int flag; { int mynor; struct tty *tp; int error, unit, pnum; mynor=minor(dev); if (mynor & CONTROL_MASK) return (ENODEV); unit=MINOR_TO_UNIT(mynor); pnum=MINOR_TO_PORT(mynor); tp=&dgm_softc[unit].ttys[pnum]; error=linesw[tp->t_line].l_write(tp, uio, flag); DPRINT4(DB_WR,"dgm%d: port%d: write() returns %d\n",unit,pnum,error); return error; } static void dgmpoll(unit_c) void *unit_c; { int unit=(int)unit_c; int pnum; struct dgm_p *port; struct dgm_softc *sc=&dgm_softc[unit]; int head, tail; u_char *eventbuf; int event, mstat, lstat; volatile struct board_chan *bc; struct tty *tp; int rhead, rtail; int whead, wtail; int size; int c=0; u_char *ptr; int ocount; int ibuf_full,obuf_full; BoardMemWinState ws=bmws_get(); if(sc->status==DISABLED) { printf("dgm%d: polling of disabled board stopped\n",unit); return; } setwin(sc,0); head=sc->mailbox->ein; tail=sc->mailbox->eout; while(head!=tail) { if(head >= FEP_IMAX-FEP_ISTART || tail >= FEP_IMAX-FEP_ISTART || (head|tail) & 03 ) { printf("dgm%d: event queue's head or tail is wrong! hd=%d,tl=%d\n", unit,head,tail); break; } eventbuf=sc->vmem+tail+FEP_ISTART; pnum=eventbuf[0]; event=eventbuf[1]; mstat=eventbuf[2]; lstat=eventbuf[3]; port=&sc->ports[pnum]; bc=port->brdchan; tp=&sc->ttys[pnum]; if(pnum>=sc->numports || port->status==DISABLED) { printf("dgm%d: port%d: got event on nonexisting port\n",unit,pnum); } else if(port->used || port->wopeners>0 ) { int wrapmask=port->rxbufsize-1; if( !(event & ALL_IND) ) printf("dgm%d: port%d: ? event 0x%x mstat 0x%x lstat 0x%x\n", unit, pnum, event, mstat, lstat); if(event & DATA_IND) { DPRINT3(DB_DATA,"dgm%d: port%d: DATA_IND\n",unit,pnum); rhead=bc->rin & wrapmask; rtail=bc->rout & wrapmask; if( !(tp->t_cflag & CREAD) || !port->used ) { bc->rout=rhead; goto end_of_data; } if(bc->orun) { printf("dgm%d: port%d: overrun\n", unit, pnum); bc->orun=0; } if(!(tp->t_state & TS_ISOPEN)) goto end_of_data; for(ibuf_full=FALSE;rhead!=rtail && !ibuf_full;) { DPRINT5(DB_RXDATA,"dgm%d: port%d: p rx head=%d tail=%d\n", unit,pnum,rhead,rtail); if(rhead>rtail) size=rhead-rtail; else size=port->rxbufsize-rtail; ptr=port->rxptr+rtail; /* Helg: */ if( tp->t_rawq.c_cc + size > DGB_IBUFSIZE ) { size=DGB_IBUFSIZE-tp->t_rawq.c_cc; DPRINT1(DB_RXDATA,"*"); ibuf_full=TRUE; } if(size) { if (tp->t_state & TS_CAN_BYPASS_L_RINT) { DPRINT1(DB_RXDATA,"!"); towin(sc,port->rxwin); tk_nin += size; tk_rawcc += size; tp->t_rawcc += size; b_to_q(ptr,size,&tp->t_rawq); setwin(sc,0); } else { int i=size; unsigned char chr; do { towin(sc,port->rxwin); chr= *ptr++; hidewin(sc); (*linesw[tp->t_line].l_rint)(chr, tp); } while (--i > 0 ); setwin(sc,0); } } rtail= (rtail + size) & wrapmask; bc->rout=rtail; rhead=bc->rin & wrapmask; hidewin(sc); ttwakeup(tp); setwin(sc,0); } end_of_data: } if(event & MODEMCHG_IND) { DPRINT3(DB_MODEM,"dgm%d: port%d: MODEMCHG_IND\n",unit,pnum); port->imodem=mstat; if(mstat & port->dcd) { hidewin(sc); linesw[tp->t_line].l_modem(tp,1); setwin(sc,0); wakeup(TSA_CARR_ON(tp)); } else { hidewin(sc); linesw[tp->t_line].l_modem(tp,0); setwin(sc,0); if( port->draining) { port->draining=0; wakeup(&port->draining); } } } if(event & BREAK_IND) { if((tp->t_state & TS_ISOPEN) && (tp->t_iflag & IGNBRK)) { DPRINT3(DB_BREAK,"dgm%d: port%d: BREAK_IND\n",unit,pnum); hidewin(sc); linesw[tp->t_line].l_rint(TTY_BI, tp); setwin(sc,0); } } /* Helg: with output flow control */ if(event & (LOWTX_IND | EMPTYTX_IND) ) { DPRINT3(DB_TXDATA,"dgm%d: port%d: LOWTX_IND or EMPTYTX_IND\n",unit,pnum); if( (event & EMPTYTX_IND ) && tp->t_outq.c_cc==0 && port->draining) { port->draining=0; wakeup(&port->draining); bc->ilow=0; bc->iempty=0; } else { int wrapmask=port->txbufsize-1; for(obuf_full=FALSE; tp->t_outq.c_cc!=0 && !obuf_full; ) { int s; /* add "last-minute" data to write buffer */ if(!(tp->t_state & TS_BUSY)) { hidewin(sc); #ifndef TS_ASLEEP /* post 2.0.5 FreeBSD */ ttwwakeup(tp); #else if(tp->t_outq.c_cc <= tp->t_lowat) { if(tp->t_state & TS_ASLEEP) { tp->t_state &= ~TS_ASLEEP; wakeup(TSA_OLOWAT(tp)); } /* selwakeup(&tp->t_wsel); */ } #endif setwin(sc,0); } s=spltty(); whead=bc->tin & wrapmask; wtail=bc->tout & wrapmask; if(wheadtxbufsize-whead; if(wtail==0) size--; } if(size==0) { DPRINT5(DB_WR,"dgm: head=%d tail=%d size=%d full=%d\n", whead,wtail,size,obuf_full); bc->iempty=1; bc->ilow=1; obuf_full=TRUE; splx(s); break; } towin(sc,port->txwin); ocount=q_to_b(&tp->t_outq, port->txptr+whead, size); whead+=ocount; setwin(sc,0); bc->tin=whead; bc->tin=whead & wrapmask; splx(s); } if(obuf_full) { DPRINT1(DB_WR," +BUSY\n"); tp->t_state|=TS_BUSY; } else { DPRINT1(DB_WR," -BUSY\n"); hidewin(sc); #ifndef TS_ASLEEP /* post 2.0.5 FreeBSD */ /* should clear TS_BUSY before ttwwakeup */ if(tp->t_state & TS_BUSY) { tp->t_state &= ~TS_BUSY; linesw[tp->t_line].l_start(tp); ttwwakeup(tp); } #else if(tp->t_state & TS_ASLEEP) { tp->t_state &= ~TS_ASLEEP; wakeup(TSA_OLOWAT(tp)); } tp->t_state &= ~TS_BUSY; #endif setwin(sc,0); } } end_of_buffer: } bc->idata=1; /* require event on incoming data */ } else { bc=port->brdchan; DPRINT4(DB_EXCEPT,"dgm%d: port%d: got event 0x%x on closed port\n", unit,pnum,event); bc->rout=bc->rin; bc->idata=bc->iempty=bc->ilow=0; } tail= (tail+4) & (FEP_IMAX-FEP_ISTART-4); } sc->mailbox->eout=tail; bmws_set(ws); timeout(dgmpoll, unit_c, hz/POLLSPERSEC); } #if 0 static void dgmintr(unit) int unit; { } #endif static int dgmioctl(dev, cmd, data, flag, p) dev_t dev; u_long cmd; caddr_t data; int flag; struct proc *p; { struct dgm_softc *sc; int unit, pnum; struct dgm_p *port; int mynor; struct tty *tp; volatile struct board_chan *bc; int error; int s,cs; int tiocm_xxx; #if defined(COMPAT_43) || defined(COMPAT_SUNOS) u_long oldcmd; struct termios term; #endif BoardMemWinState ws=bmws_get(); mynor=minor(dev); unit=MINOR_TO_UNIT(mynor); pnum=MINOR_TO_PORT(mynor); sc=&dgm_softc[unit]; port=&sc->ports[pnum]; tp=&sc->ttys[pnum]; bc=port->brdchan; if (mynor & CONTROL_MASK) { struct termios *ct; switch (mynor & CONTROL_MASK) { case CONTROL_INIT_STATE: ct = mynor & CALLOUT_MASK ? &port->it_out : &port->it_in; break; case CONTROL_LOCK_STATE: ct = mynor & CALLOUT_MASK ? &port->lt_out : &port->lt_in; break; default: return (ENODEV); /* /dev/nodev */ } switch (cmd) { case TIOCSETA: error = suser(p->p_ucred, &p->p_acflag); if (error != 0) return (error); *ct = *(struct termios *)data; return (0); case TIOCGETA: *(struct termios *)data = *ct; return (0); case TIOCGETD: *(int *)data = TTYDISC; return (0); case TIOCGWINSZ: bzero(data, sizeof(struct winsize)); return (0); default: return (ENOTTY); } } #if defined(COMPAT_43) || defined(COMPAT_SUNOS) term = tp->t_termios; if (cmd == TIOCSETA || cmd == TIOCSETAW || cmd == TIOCSETAF) { DPRINT6(DB_PARAM,"dgm%d: port%d: dgmioctl-ISNOW c=0x%x i=0x%x l=0x%x\n",unit,pnum,term.c_cflag,term.c_iflag,term.c_lflag); } oldcmd = cmd; error = ttsetcompat(tp, &cmd, data, &term); if (error != 0) return (error); if (cmd != oldcmd) data = (caddr_t)&term; #endif if (cmd == TIOCSETA || cmd == TIOCSETAW || cmd == TIOCSETAF) { int cc; struct termios *dt = (struct termios *)data; struct termios *lt = mynor & CALLOUT_MASK ? &port->lt_out : &port->lt_in; DPRINT6(DB_PARAM,"dgm%d: port%d: dgmioctl-TOSET c=0x%x i=0x%x l=0x%x\n",unit,pnum,dt->c_cflag,dt->c_iflag,dt->c_lflag); dt->c_iflag = (tp->t_iflag & lt->c_iflag) | (dt->c_iflag & ~lt->c_iflag); dt->c_oflag = (tp->t_oflag & lt->c_oflag) | (dt->c_oflag & ~lt->c_oflag); dt->c_cflag = (tp->t_cflag & lt->c_cflag) | (dt->c_cflag & ~lt->c_cflag); dt->c_lflag = (tp->t_lflag & lt->c_lflag) | (dt->c_lflag & ~lt->c_lflag); for (cc = 0; cc < NCCS; ++cc) if (lt->c_cc[cc] != 0) dt->c_cc[cc] = tp->t_cc[cc]; if (lt->c_ispeed != 0) dt->c_ispeed = tp->t_ispeed; if (lt->c_ospeed != 0) dt->c_ospeed = tp->t_ospeed; } if(cmd==TIOCSTOP) { cs=splclock(); setwin(sc,0); fepcmd(port, PAUSETX, 0, 0, 0, 0); bmws_set(ws); splx(cs); return 0; } else if(cmd==TIOCSTART) { cs=splclock(); setwin(sc,0); fepcmd(port, RESUMETX, 0, 0, 0, 0); bmws_set(ws); splx(cs); return 0; } if(cmd==TIOCSETAW || cmd==TIOCSETAF) port->mustdrain=1; error = linesw[tp->t_line].l_ioctl(tp, cmd, data, flag, p); if (error >= 0) return error; s = spltty(); error = ttioctl(tp, cmd, data, flag); disc_optim(tp,&tp->t_termios); port->mustdrain=0; if (error >= 0) { splx(s); if (cmd == TIOCSETA || cmd == TIOCSETAW || cmd == TIOCSETAF) { DPRINT6(DB_PARAM,"dgm%d: port%d: dgmioctl-RES c=0x%x i=0x%x l=0x%x\n",unit,pnum,tp->t_cflag,tp->t_iflag,tp->t_lflag); } return error; } switch (cmd) { case TIOCSBRK: /* Helg: commented */ /* error=dgmdrain(port);*/ if(error!=0) { splx(s); return error; } cs=splclock(); setwin(sc,0); /* now it sends 250 millisecond break because I don't know */ /* how to send an infinite break */ fepcmd(port, SENDBREAK, 250, 0, 10, 0); hidewin(sc); splx(cs); break; case TIOCCBRK: /* now it's empty */ break; case TIOCSDTR: DPRINT3(DB_MODEM,"dgm%d: port%d: set DTR\n",unit,pnum); port->omodem |= DTR; cs=splclock(); setwin(sc,0); fepcmd(port, SETMODEM, port->omodem, RTS, 0, 1); if( !(bc->mstat & DTR) ) { DPRINT3(DB_MODEM,"dgm%d: port%d: DTR is off\n",unit,pnum); } hidewin(sc); splx(cs); break; case TIOCCDTR: DPRINT3(DB_MODEM,"dgm%d: port%d: reset DTR\n",unit,pnum); port->omodem &= ~DTR; cs=splclock(); setwin(sc,0); fepcmd(port, SETMODEM, port->omodem, RTS|DTR, 0, 1); if( bc->mstat & DTR ) { DPRINT3(DB_MODEM,"dgm%d: port%d: DTR is on\n",unit,pnum); } hidewin(sc); splx(cs); break; case TIOCMSET: if(*(int *)data & TIOCM_DTR) port->omodem |=DTR; else port->omodem &=~DTR; if(*(int *)data & TIOCM_RTS) port->omodem |=RTS; else port->omodem &=~RTS; cs=splclock(); setwin(sc,0); fepcmd(port, SETMODEM, port->omodem, RTS|DTR, 0, 1); hidewin(sc); splx(cs); break; case TIOCMBIS: if(*(int *)data & TIOCM_DTR) port->omodem |=DTR; if(*(int *)data & TIOCM_RTS) port->omodem |=RTS; cs=splclock(); setwin(sc,0); fepcmd(port, SETMODEM, port->omodem, RTS|DTR, 0, 1); hidewin(sc); splx(cs); break; case TIOCMBIC: if(*(int *)data & TIOCM_DTR) port->omodem &=~DTR; if(*(int *)data & TIOCM_RTS) port->omodem &=~RTS; cs=splclock(); setwin(sc,0); fepcmd(port, SETMODEM, port->omodem, RTS|DTR, 0, 1); hidewin(sc); splx(cs); break; case TIOCMGET: setwin(sc,0); port->imodem=bc->mstat; hidewin(sc); tiocm_xxx = TIOCM_LE; /* XXX - always enabled while open */ DPRINT3(DB_MODEM,"dgm%d: port%d: modem stat -- ",unit,pnum); if (port->imodem & DTR) { DPRINT1(DB_MODEM,"DTR "); tiocm_xxx |= TIOCM_DTR; } if (port->imodem & RTS) { DPRINT1(DB_MODEM,"RTS "); tiocm_xxx |= TIOCM_RTS; } if (port->imodem & CTS) { DPRINT1(DB_MODEM,"CTS "); tiocm_xxx |= TIOCM_CTS; } if (port->imodem & port->dcd) { DPRINT1(DB_MODEM,"DCD "); tiocm_xxx |= TIOCM_CD; } if (port->imodem & port->dsr) { DPRINT1(DB_MODEM,"DSR "); tiocm_xxx |= TIOCM_DSR; } if (port->imodem & RI) { DPRINT1(DB_MODEM,"RI "); tiocm_xxx |= TIOCM_RI; } *(int *)data = tiocm_xxx; DPRINT1(DB_MODEM,"--\n"); break; case TIOCMSDTRWAIT: /* must be root since the wait applies to following logins */ error = suser(p->p_ucred, &p->p_acflag); if (error != 0) { splx(s); return (error); } port->close_delay = *(int *)data * hz / 100; break; case TIOCMGDTRWAIT: *(int *)data = port->close_delay * 100 / hz; break; case TIOCTIMESTAMP: port->do_timestamp = TRUE; *(struct timeval *)data = port->timestamp; break; case TIOCDCDTIMESTAMP: port->do_dcd_timestamp = TRUE; *(struct timeval *)data = port->dcd_timestamp; break; default: bmws_set(ws); splx(s); return ENOTTY; } bmws_set(ws); splx(s); return 0; } static void wakeflush(p) void *p; { struct dgm_p *port=p; wakeup(&port->draining); } /* wait for the output to drain */ static int dgmdrain(port) struct dgm_p *port; { struct dgm_softc *sc=&dgm_softc[port->unit]; volatile struct board_chan *bc=port->brdchan; int error; int head, tail; BoardMemWinState ws=bmws_get(); setwin(sc,0); bc->iempty=1; tail=bc->tout; head=bc->tin; while(tail!=head) { DPRINT5(DB_WR,"dgm%d: port%d: drain: head=%d tail=%d\n", port->unit, port->pnum, head, tail); hidewin(sc); port->draining=1; timeout(wakeflush,port, hz); error=tsleep(&port->draining, TTIPRI | PCATCH, "dgdrn", 0); port->draining=0; setwin(sc,0); if (error != 0) { DPRINT4(DB_WR,"dgm%d: port%d: tsleep(dgdrn) error=%d\n", port->unit,port->pnum,error); bc->iempty=0; bmws_set(ws); return error; } tail=bc->tout; head=bc->tin; } DPRINT5(DB_WR,"dgm%d: port%d: drain: head=%d tail=%d\n", port->unit, port->pnum, head, tail); bmws_set(ws); return 0; } /* wait for the output to drain */ /* or simply clear the buffer it it's stopped */ static void dgm_drain_or_flush(port) struct dgm_p *port; { struct tty *tp=port->tty; struct dgm_softc *sc=&dgm_softc[port->unit]; volatile struct board_chan *bc=port->brdchan; int error; int lasttail; int head, tail; setwin(sc,0); lasttail=-1; bc->iempty=1; tail=bc->tout; head=bc->tin; while(tail!=head /* && tail!=lasttail */ ) { DPRINT5(DB_WR,"dgm%d: port%d: flush: head=%d tail=%d\n", port->unit, port->pnum, head, tail); /* if there is no carrier simply clean the buffer */ if( !(tp->t_state & TS_CARR_ON) ) { bc->tout=bc->tin=0; bc->iempty=0; hidewin(sc); return; } hidewin(sc); port->draining=1; timeout(wakeflush,port, hz); error=tsleep(&port->draining, TTIPRI | PCATCH, "dgfls", 0); port->draining=0; setwin(sc,0); if (error != 0) { DPRINT4(DB_WR,"dgm%d: port%d: tsleep(dgfls) error=%d\n", port->unit,port->pnum,error); /* silently clean the buffer */ bc->tout=bc->tin=0; bc->iempty=0; hidewin(sc); return; } lasttail=tail; tail=bc->tout; head=bc->tin; } hidewin(sc); DPRINT5(DB_WR,"dgm%d: port%d: flush: head=%d tail=%d\n", port->unit, port->pnum, head, tail); } static int dgmparam(tp, t) struct tty *tp; struct termios *t; { int dev=tp->t_dev; int mynor=minor(dev); int unit=MINOR_TO_UNIT(dev); int pnum=MINOR_TO_PORT(dev); struct dgm_softc *sc=&dgm_softc[unit]; struct dgm_p *port=&sc->ports[pnum]; volatile struct board_chan *bc=port->brdchan; int cflag; int head; int mval; int iflag; int hflow; int s,cs; BoardMemWinState ws=bmws_get(); DPRINT6(DB_PARAM,"dgm%d: port%d: dgmparm c=0x%x i=0x%x l=0x%x\n",unit,pnum,t->c_cflag,t->c_iflag,t->c_lflag); if(port->mustdrain) { DPRINT3(DB_PARAM,"dgm%d: port%d: must call dgmdrain()\n",unit,pnum); dgmdrain(port); } cflag=ttspeedtab(t->c_ospeed, dgmspeedtab); if (t->c_ispeed == 0) t->c_ispeed = t->c_ospeed; if (cflag < 0 /* || cflag > 0 && t->c_ispeed != t->c_ospeed */) { DPRINT4(DB_PARAM,"dgm%d: port%d: invalid cflag=0%o\n",unit,pnum,cflag); return (EINVAL); } cs=splclock(); setwin(sc,0); if(cflag==0) { /* hangup */ DPRINT3(DB_PARAM,"dgm%d: port%d: hangup\n",unit,pnum); head=bc->rin; bc->rout=head; head=bc->tin; fepcmd(port, STOUT, (unsigned)head, 0, 0, 0); mval= port->omodem & ~(DTR|RTS); } else { cflag |= dgmflags(dgm_cflags, t->c_cflag); if(cflag!=port->fepcflag) { port->fepcflag=cflag; DPRINT6(DB_PARAM,"dgm%d: port%d: set cflag=0x%x c=0x%x\n", unit,pnum,cflag&(FEP_CBAUD|FEP_FASTBAUD),cflag, t->c_cflag&~CRTSCTS); fepcmd(port, SETCTRLFLAGS, (unsigned)cflag, 0, 0, 0); } mval= port->omodem | (DTR|RTS); } iflag=dgmflags(dgm_iflags, t->c_iflag); if(iflag!=port->fepiflag) { port->fepiflag=iflag; DPRINT5(DB_PARAM,"dgm%d: port%d: set iflag=0x%x c=0x%x\n",unit,pnum,iflag,t->c_iflag); fepcmd(port, SETIFLAGS, (unsigned)iflag, 0, 0, 0); } bc->mint=port->dcd; hflow=dgmflags(dgm_flow, t->c_cflag); if(hflow!=port->hflow) { port->hflow=hflow; DPRINT5(DB_PARAM,"dgm%d: port%d: set hflow=0x%x f=0x%x\n",unit,pnum,hflow,t->c_cflag&CRTSCTS); fepcmd(port, SETHFLOW, (unsigned)hflow, 0xff, 0, 1); } if(port->omodem != mval) { DPRINT5(DB_PARAM,"dgm%d: port%d: setting modem parameters 0x%x was 0x%x\n", unit,pnum,mval,port->omodem); port->omodem=mval; fepcmd(port, SETMODEM, (unsigned)mval, RTS|DTR, 0, 1); } if(port->fepstartc!=t->c_cc[VSTART] || port->fepstopc!=t->c_cc[VSTOP]) { DPRINT5(DB_PARAM,"dgm%d: port%d: set startc=%d, stopc=%d\n",unit,pnum,t->c_cc[VSTART],t->c_cc[VSTOP]); port->fepstartc=t->c_cc[VSTART]; port->fepstopc=t->c_cc[VSTOP]; fepcmd(port, SONOFFC, port->fepstartc, port->fepstopc, 0, 1); } bmws_set(ws); splx(cs); return 0; } static void dgmstart(tp) struct tty *tp; { int unit; int pnum; struct dgm_p *port; struct dgm_softc *sc; volatile struct board_chan *bc; int head, tail; int size, ocount; int s; int wmask; BoardMemWinState ws=bmws_get(); unit=MINOR_TO_UNIT(minor(tp->t_dev)); pnum=MINOR_TO_PORT(minor(tp->t_dev)); sc=&dgm_softc[unit]; port=&sc->ports[pnum]; bc=port->brdchan; wmask=port->txbufsize-1; s=spltty(); while( tp->t_outq.c_cc!=0 ) { int cs; #ifndef TS_ASLEEP /* post 2.0.5 FreeBSD */ ttwwakeup(tp); #else if(tp->t_outq.c_cc <= tp->t_lowat) { if(tp->t_state & TS_ASLEEP) { tp->t_state &= ~TS_ASLEEP; wakeup(TSA_OLOWAT(tp)); } /*selwakeup(&tp->t_wsel);*/ } #endif cs=splclock(); setwin(sc,0); head=bc->tin & wmask; /*HERE*/ do { tail=bc->tout; } while (tail != bc->tout); tail=bc->tout & wmask; DPRINT5(DB_WR,"dgm%d: port%d: s tx head=%d tail=%d\n",unit,pnum,head,tail); #ifdef LEAVE_FREE_CHARS if(tail>head) { size=tail-head-LEAVE_FREE_CHARS; if (size <0) size==0; } else { size=port->txbufsize-head; if(tail+port->txbufsize < head) size==0; } } #else if(tail>head) size=tail-head-1; else { size=port->txbufsize-head/*-1*/; if(tail==0) size--; } #endif if(size==0) { bc->iempty=1; bc->ilow=1; splx(cs); bmws_set(ws); tp->t_state|=TS_BUSY; splx(s); return; } towin(sc,port->txwin); ocount=q_to_b(&tp->t_outq, port->txptr+head, size); head+=ocount; if(head>=port->txbufsize) head-=port->txbufsize; setwin(sc,0); bc->tin=head; DPRINT5(DB_WR,"dgm%d: port%d: tx avail=%d count=%d\n",unit,pnum,size,ocount); hidewin(sc); splx(cs); } bmws_set(ws); splx(s); #ifndef TS_ASLEEP /* post 2.0.5 FreeBSD */ if(tp->t_state & TS_BUSY) { tp->t_state&=~TS_BUSY; linesw[tp->t_line].l_start(tp); ttwwakeup(tp); } #else if(tp->t_state & TS_ASLEEP) { tp->t_state &= ~TS_ASLEEP; wakeup(TSA_OLOWAT(tp)); } tp->t_state&=~TS_BUSY; #endif } void dgmstop(tp, rw) struct tty *tp; int rw; { int unit; int pnum; struct dgm_p *port; struct dgm_softc *sc; volatile struct board_chan *bc; int head; int s; BoardMemWinState ws=bmws_get(); DPRINT3(DB_WR,"dgm%d: port%d: stop\n",port->unit, port->pnum); unit=MINOR_TO_UNIT(minor(tp->t_dev)); pnum=MINOR_TO_PORT(minor(tp->t_dev)); sc=&dgm_softc[unit]; port=&sc->ports[pnum]; bc=port->brdchan; s = spltty(); setwin(sc,0); if (rw & FWRITE) { /* clear output queue */ bc->tout=bc->tin=0; bc->ilow=0;bc->iempty=0; } if (rw & FREAD) { /* clear input queue */ bc->rout=bc->rin; bc->idata=1; } hidewin(sc); bmws_set(ws); splx(s); dgmstart(tp); } struct tty * dgmdevtotty(dev) dev_t dev; { int mynor, pnum, unit; struct dgm_softc *sc; mynor = minor(dev); if (mynor & CONTROL_MASK) return (NULL); unit = MINOR_TO_UNIT(mynor); if ((u_int) unit >= NDGM) return (NULL); pnum = MINOR_TO_PORT(mynor); sc = &dgm_softc[unit]; if (pnum >= sc->numports) return (NULL); return (&sc->ttys[pnum]); } static void fepcmd(port, cmd, op1, op2, ncmds, bytecmd) struct dgm_p *port; unsigned cmd, op1, op2, ncmds, bytecmd; { struct dgm_softc *sc=&dgm_softc[port->unit]; u_char *mem=sc->vmem; unsigned tail, head; int count, n; if(port->status==DISABLED) { printf("dgm%d: port%d: FEP command on disabled port\n", port->unit, port->pnum); return; } /* setwin(sc,0); Require this to be set by caller */ head=sc->mailbox->cin; if(head>=(FEP_CMAX-FEP_CSTART) || (head & 3)) { printf("dgm%d: port%d: wrong pointer head of command queue : 0x%x\n", port->unit, port->pnum, head); return; } mem[head+FEP_CSTART+0]=cmd; mem[head+FEP_CSTART+1]=port->pnum; if(bytecmd) { mem[head+FEP_CSTART+2]=op1; mem[head+FEP_CSTART+3]=op2; } else { mem[head+FEP_CSTART+2]=op1&0xff; mem[head+FEP_CSTART+3]=(op1>>8)&0xff; } DPRINT7(DB_FEP,"dgm%d: port%d: %s cmd=0x%x op1=0x%x op2=0x%x\n", port->unit, port->pnum, (bytecmd)?"byte":"word", cmd, mem[head+FEP_CSTART+2], mem[head+FEP_CSTART+3]); head=(head+4) & (FEP_CMAX-FEP_CSTART-4); sc->mailbox->cin=head; count=FEPTIMEOUT; while (count-- != 0) { head=sc->mailbox->cin; tail=sc->mailbox->cout; n = (head-tail) & (FEP_CMAX-FEP_CSTART-4); if(n <= ncmds * (sizeof(ushort)*4)) return; } printf("dgm%d(%d): timeout on FEP cmd=0x%x\n", port->unit, port->pnum, cmd); } static void disc_optim(tp, t) struct tty *tp; struct termios *t; { /* * XXX can skip a lot more cases if Smarts. Maybe * (IGNCR | ISTRIP | IXON) in c_iflag. But perhaps we * shouldn't skip if (TS_CNTTB | TS_LNCH) is set in t_state. */ if (!(t->c_iflag & (ICRNL | IGNCR | IMAXBEL | INLCR | ISTRIP | IXON)) && (!(t->c_iflag & BRKINT) || (t->c_iflag & IGNBRK)) && (!(t->c_iflag & PARMRK) || (t->c_iflag & (IGNPAR | IGNBRK)) == (IGNPAR | IGNBRK)) && !(t->c_lflag & (ECHO | ICANON | IEXTEN | ISIG | PENDIN)) && linesw[tp->t_line].l_rint == ttyinput) tp->t_state |= TS_CAN_BYPASS_L_RINT; else tp->t_state &= ~TS_CAN_BYPASS_L_RINT; } static dgm_devsw_installed = 0; static void dgm_drvinit(void *unused) { dev_t dev; if( ! dgm_devsw_installed ) { dev = makedev(CDEV_MAJOR, 0); cdevsw_add(&dev,&dgm_cdevsw, NULL); dgm_devsw_installed = 1; } } SYSINIT(dgmdev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE+CDEV_MAJOR,dgm_drvinit,NULL) int fi(){ return 0; } #endif /* NDGM > 0 */