diff options
-rw-r--r-- | sys/dev/dgb/dgm.c | 1956 |
1 files changed, 1061 insertions, 895 deletions
diff --git a/sys/dev/dgb/dgm.c b/sys/dev/dgb/dgm.c index 2951e96..45152ac 100644 --- a/sys/dev/dgb/dgm.c +++ b/sys/dev/dgb/dgm.c @@ -49,52 +49,47 @@ * Sysctl debug flag is now a bitflag, to filter noise during debugging. * David L. Nugent <davidn@blaze.net.au> * + * New-busification by Brian Somers <brian@Awfulhak.org> + * * There was a copyright confusion: I thought that having read the * GLPed drivers makes me mentally contaminated but in fact it does - * not. Since the Linux driver by Troy De Jongh <troyd@digibd.com> or - * <troyd@skypoint.com> was used unly to learn the Digi's interface, + * not. Since the Linux driver by Troy De Jongh <troyd@digibd.com> or + * <troyd@skypoint.com> was used only to learn the Digi's interface, * I've returned this driver to a BSD-style license. I tried to contact * all the contributors and those who replied agreed with license - * change. If you did any contribution when the driver was GPLed and do + * change. If you did any contribution when the driver was GPLed and do * not agree with the BSD-style re-licensing please contact me. * -SB */ -#include "opt_compat.h" - -#include "dgm.h" - -/* Helg: i.e.25 times per sec board will be polled */ +/* How often to run dgmpoll */ #define POLLSPERSEC 25 + /* How many charactes can we write to input tty rawq */ -#define DGB_IBUFSIZE (TTYHOG-100) +#define DGB_IBUFSIZE (TTYHOG - 100) /* the overall number of ports controlled by this driver */ -#ifndef NDGMPORTS -# define NDGMPORTS (NDGM*64) -#endif - #include <sys/param.h> + #include <sys/systm.h> -#include <sys/tty.h> #include <sys/conf.h> #include <sys/dkstat.h> #include <sys/fcntl.h> #include <sys/kernel.h> +#include <sys/malloc.h> #include <sys/sysctl.h> +#include <sys/tty.h> #include <sys/bus.h> - +#include <sys/kobj.h> +#include <sys/bus.h> +#include <machine/bus.h> +#include <sys/rman.h> +#include <machine/resource.h> #include <vm/vm.h> #include <vm/pmap.h> -#include <i386/isa/isa_device.h> - -#ifndef COMPAT_OLDISA -#error "The dgm device requires the old isa compatibility shims" -#endif - #include <dev/dgb/dgmfep.h> #include <dev/dgb/dgmbios.h> #include <dev/dgb/dgmreg.h> @@ -103,21 +98,22 @@ #define CONTROL_MASK 0xC0 #define CONTROL_INIT_STATE 0x40 #define CONTROL_LOCK_STATE 0x80 -#define UNIT_MASK 0x30000 -#define PORT_MASK 0x3F +#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_UNIT(mynor) (((mynor) & UNIT_MASK) >> 16) #define MINOR_TO_PORT(mynor) ((mynor) & PORT_MASK) +#define IO_SIZE 0x04 +#define MEM_SIZE 0x8000 -/* types. XXX - should be elsewhere */ -typedef u_char bool_t; /* boolean */ +struct dgm_softc; /* digiboard port structure */ struct dgm_p { - bool_t status; + unsigned enabled : 1; - u_char unit; /* board unit number */ + struct dgm_softc *sc; /* parent softc */ u_char pnum; /* port number */ u_char omodem; /* FEP output modem status */ u_char imodem; /* FEP input modem status */ @@ -144,17 +140,12 @@ struct dgm_p { 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_char active_out; /* nonzero if the callout device is open */ u_int wopeners; /* # processes waiting for DCD in open() */ /* Initial state. */ @@ -165,8 +156,8 @@ struct dgm_p { struct termios lt_in; /* should be in struct tty */ struct termios lt_out; - bool_t do_timestamp; - bool_t do_dcd_timestamp; + unsigned do_timestamp : 1; + unsigned do_dcd_timestamp : 1; struct timeval timestamp; struct timeval dcd_timestamp; @@ -180,69 +171,62 @@ struct dgm_p { /* 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 ? */ - int numports; /* number of ports on card */ - int 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 */ + unsigned enabled : 1; + u_char unit; /* unit number */ + u_char type; /* type of card: PCXE, PCXI, PCXEVE */ + u_char altpin; /* do we need alternate pin setting ? */ + int numports; /* number of ports on card */ + u_long port; /* I/O port */ + u_char *vmem; /* virtual memory address */ + u_long pmem; /* physical memory address */ + int mem_seg; /* internal memory segment */ + struct dgm_p *ports; /* ptr to array of port descriptors */ + struct tty *ttys; /* ptr 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)); - -/* 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)); + struct resource *io_res; + struct resource *mem_res; + int iorid; + int mrid; + struct callout_handle toh; /* poll timeout handle */ +}; -static void fepcmd(struct dgm_p *port, unsigned cmd, unsigned op1, unsigned op2, - unsigned ncmds, unsigned bytecmd); +static void dgmpoll(void *); +static int dgmprobe(device_t); +static int dgmattach(device_t); +static int dgmdetach(device_t); +static int dgmshutdown(device_t); +static void fepcmd(struct dgm_p *, unsigned, unsigned, unsigned, unsigned, + unsigned); +static void dgmstart(struct tty *); +static void dgmstop(struct tty *, int); +static int dgmparam(struct tty *, struct termios *); +static void dgmhardclose(struct dgm_p *); +static void dgm_drain_or_flush(struct dgm_p *); +static int dgmdrain(struct dgm_p *); +static void dgm_pause(void *); +static void wakeflush(void *); +static void disc_optim(struct tty *, struct termios *); -static void dgmstart __P((struct tty *tp)); -static void dgmstop __P((struct tty *tp, int rw)); -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)); +static d_open_t dgmopen; +static d_close_t dgmclose; +static d_ioctl_t dgmioctl; +static device_method_t dgmmethods[] = { + /* Device interface */ + DEVMETHOD(device_probe, dgmprobe), + DEVMETHOD(device_attach, dgmattach), + DEVMETHOD(device_detach, dgmdetach), + DEVMETHOD(device_shutdown, dgmshutdown), + { 0, 0 } +}; -struct isa_driver dgmdriver = { - INTR_TYPE_TTY, - dgmprobe, - dgmattach, +static driver_t dgmdriver = { "dgm", - 0 + dgmmethods, + sizeof (struct dgm_softc), }; -COMPAT_ISA_DRIVER(dgm, dgmdriver); -static d_open_t dgmopen; -static d_close_t dgmclose; -static d_ioctl_t dgmioctl; +static devclass_t dgmdevclass; #define CDEV_MAJOR 101 static struct cdevsw dgm_cdevsw = { @@ -262,6 +246,26 @@ static struct cdevsw dgm_cdevsw = { /* kqfilter */ ttykqfilter, }; +static int +dgmmodhandler(module_t mod, int event, void *arg) +{ + int res = 0; + + switch (event) { + case MOD_LOAD: + cdevsw_add(&dgm_cdevsw); + break; + + case MOD_UNLOAD: + cdevsw_remove(&dgm_cdevsw); + break; + } + + return res; +} + +DRIVER_MODULE(dgm, isa, dgmdriver, dgmdevclass, dgmmodhandler, 0); + static speed_t dgmdefaultrate = TTYDEF_SPEED; static struct speedtab dgmspeedtab[] = { @@ -286,81 +290,87 @@ static struct speedtab dgmspeedtab[] = { { -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 } +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; + 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; +static int dgmdebug = 0; SYSCTL_INT(_debug, OID_AUTO, dgm_debug, CTLFLAG_RW, &dgmdebug, 0, ""); -static __inline int setwin __P((struct dgm_softc *sc, unsigned addr)); -static __inline void hidewin __P((struct dgm_softc *sc)); -static __inline void towin __P((struct dgm_softc *sc, int win)); +static __inline int setwin(struct dgm_softc *, unsigned); +static __inline void hidewin(struct dgm_softc *); +static __inline void towin(struct dgm_softc *, int); /*Helg: to allow recursive dgm...() calls */ -typedef struct - { /* If we were called and don't want to disturb we need: */ - int port; /* write to this port */ - u_char data; /* this data on exit */ - /* or DATA_WINOFF to close memory window on entry */ - } BoardMemWinState; /* so several channels and even boards can coexist */ +typedef struct { + /* If we were called and don't want to disturb we need: */ + int port; /* write to this port */ + u_char 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; +static u_long validio[] = { 0x104, 0x114, 0x124, 0x204, 0x224, 0x304, 0x324 }; +static u_long validmem[] = { + 0x80000, 0x88000, 0x90000, 0x98000, 0xa0000, 0xa8000, 0xb0000, 0xb8000, + 0xc0000, 0xc8000, 0xd0000, 0xd8000, 0xe0000, 0xe8000, 0xf0000, 0xf8000, + 0xf0000000, 0xf1000000, 0xf2000000, 0xf3000000, 0xf4000000, 0xf5000000, + 0xf6000000, 0xf7000000, 0xf8000000, 0xf9000000, 0xfa000000, 0xfb000000, + 0xfc000000, 0xfd000000, 0xfe000000, 0xff000000 +}; + /* 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); + BoardMemWinState bmwsRet = bmws; + + if (bmws.data != DATA_WINOFF) + outb(bmws.port, bmws.data = DATA_WINOFF); return bmwsRet; } @@ -368,80 +378,98 @@ bmws_get(void) 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) + 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; + bmws = ws; } } -static __inline int -setwin(sc,addr) - struct dgm_softc *sc; - unsigned int addr; +static __inline int +setwin(struct dgm_softc *sc, unsigned int addr) { - outb(bmws.port=sc->port+1,bmws.data=FEPWIN|(addr >> 15)); + outb(bmws.port = sc->port + 1, bmws.data = FEPWIN|(addr >> 15)); return (addr & 0x7FFF); } static __inline void -hidewin(sc) - struct dgm_softc *sc; +hidewin(struct dgm_softc *sc) { - bmws.data=0; - outb(bmws.port=sc->port+1, bmws.data); + bmws.data = 0; + outb(bmws.port = sc->port + 1, bmws.data); } static __inline void -towin(sc,win) - struct dgm_softc *sc; - int win; +towin(struct dgm_softc *sc, int win) { - outb(bmws.port=sc->port+1, bmws.data=win); + outb(bmws.port = sc->port + 1, bmws.data = win); } static int -dgmprobe(dev) - struct isa_device *dev; +dgmprobe(device_t dev) { - struct dgm_softc *sc= &dgm_softc[dev->id_unit]; + struct dgm_softc *sc = device_get_softc(dev); int i, v; - int unit=dev->id_unit; - static int once; - if (!once++) - cdevsw_add(&dgm_cdevsw); + sc->unit = device_get_unit(dev); - sc->unit=dev->id_unit; - sc->port=dev->id_iobase; + /* Check that we've got a valid i/o address */ + if ((sc->port = bus_get_resource_start(dev, SYS_RES_IOPORT, 0)) == 0) + return (ENXIO); + for (i = sizeof (validio) / sizeof (validio[0]) - 1; i >= 0; i--) + if (sc->port == validio[i]) + break; + if (i == -1) { + device_printf(dev, "0x%03lx: Invalid i/o address\n", sc->port); + return (ENXIO); + } - if(dev->id_flags & DGBFLAG_ALTPIN) - sc->altpin=1; - else - sc->altpin=0; + /* Ditto for our memory address */ + if ((sc->pmem = bus_get_resource_start(dev, SYS_RES_MEMORY, 0)) == 0) + return (ENXIO); + for (i = sizeof (validmem) / sizeof (validmem[0]) - 1; i >= 0; i--) + if (sc->pmem == validmem[i]) + break; + if (i == -1) { + device_printf(dev, "0x%lx: Invalid memory address\n", sc->pmem); + return (ENXIO); + } + if ((sc->pmem & 0xFFFFFFul) != sc->pmem) { + device_printf(dev, "0x%lx: Memory address not supported\n", + sc->pmem); + return (ENXIO); + } + sc->vmem = (u_char *)sc->pmem; - /* left 24 bits only (ISA address) */ - sc->pmem=((intptr_t)(void *)dev->id_maddr & 0xFFFFFF); - - DPRINT4(DB_INFO,"dgm%d: port 0x%x mem 0x%lx\n",unit,sc->port,sc->pmem); + DPRINT4(DB_INFO, "dgm%d: port 0x%lx mem 0x%lx\n", sc->unit, + sc->port, sc->pmem); + + /* Temporarily map our io ports */ + sc->iorid = 0; + sc->io_res = bus_alloc_resource(dev, SYS_RES_IOPORT, &sc->iorid, + 0ul, ~0ul, IO_SIZE, RF_ACTIVE); + if (sc->io_res == NULL) + return (ENXIO); outb(sc->port, FEPRST); - sc->status=DISABLED; + sc->enabled = 0; - for(i=0; i< 1000; i++) { + 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); + if ((inb(sc->port) & FEPMASK) == FEPRST) { + sc->enabled = 1; + DPRINT3(DB_EXCEPT, "dgm%d: got reset after %d us\n", + sc->unit, i); break; } } - if(sc->status!=ENABLED) { - DPRINT2(DB_EXCEPT,"dgm%d: failed to respond\n",dev->id_unit); - return 0; + if (!sc->enabled) { + DPRINT2(DB_EXCEPT, "dgm%d: failed to respond\n", sc->unit); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } /* check type of card and get internal memory characteristics */ @@ -453,31 +481,41 @@ dgmprobe(dev) outb(sc->port, 1); second = inb(sc->port); - printf("dgm%d: PC/Xem (type %d, %d)\n", dev->id_unit, v, second); + printf("dgm%d: PC/Xem (type %d, %d)\n", sc->unit, v, second); } else - printf("dgm%d: PC/Xem (type %d)\n", dev->id_unit, v); - sc->type=PCXEM; - sc->mem_seg=0x8000; + printf("dgm%d: PC/Xem (type %d)\n", sc->unit, v); + + sc->type = PCXEM; + sc->mem_seg = 0x8000; + + /* Temporarily map our memory too */ + sc->mrid = 0; + sc->mem_res = bus_alloc_resource(dev, SYS_RES_MEMORY, &sc->mrid, + 0ul, ~0ul, MEM_SIZE, RF_ALLOCATED); + if (sc->mem_res == NULL) { + device_printf(dev, "0x%lx: Memory range is in use\n", sc->pmem); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); + } - /* save size of vizible memory segment */ - /* all PCXEMs have a 32k window size */ - dev->id_msize=0x8000; + outb(sc->port, FEPCLR); /* drop RESET */ + hidewin(sc); /* Helg: to set initial bmws state */ - /* map memory */ - dev->id_maddr=sc->vmem=pmap_mapdev(sc->pmem,dev->id_msize); + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + + bus_set_resource(dev, SYS_RES_IOPORT, 0, sc->port, IO_SIZE); + bus_set_resource(dev, SYS_RES_MEMORY, 0, sc->pmem, MEM_SIZE); - outb(sc->port, FEPCLR); /* drop RESET */ - hidewin(sc); /* Helg: to set initial bmws state */ + DPRINT2(DB_INFO, "dgm%d: Probe returns 0\n", sc->unit); - return 4; /* we need I/O space of 4 ports */ + return (0); } static int -dgmattach(dev) - struct isa_device *dev; +dgmattach(device_t dev) { - int unit=dev->id_unit; - struct dgm_softc *sc= &dgm_softc[dev->id_unit]; + struct dgm_softc *sc = device_get_softc(dev); int i, t; u_char *mem; u_char *ptr; @@ -486,250 +524,313 @@ dgmattach(dev) volatile struct board_chan *bc; int shrinkmem; int lowwater; - static int nports=0; - - if(sc->status!=ENABLED) { - DPRINT2(DB_EXCEPT,"dbg%d: try to attach a disabled card\n",unit); - return 0; - } + u_long msize, iosize; + + DPRINT2(DB_INFO, "dbg%d: attaching\n", device_get_unit(dev)); + + sc->unit = device_get_unit(dev); + bus_get_resource(dev, SYS_RES_IOPORT, 0, &sc->port, &iosize); + bus_get_resource(dev, SYS_RES_MEMORY, 0, &sc->pmem, &msize); + sc->altpin = !!(device_get_flags(dev) & DGBFLAG_ALTPIN); + sc->type = PCXEM; + sc->mem_seg = 0x8000; + sc->enabled = 1; + sc->type = PCXEM; + sc->mem_seg = 0x8000; + + /* Allocate resources (should have been verified in dgmprobe()) */ + sc->iorid = 0; + sc->io_res = bus_alloc_resource(dev, SYS_RES_IOPORT, &sc->iorid, + 0ul, ~0ul, iosize, RF_ACTIVE); + if (sc->io_res == NULL) + return (ENXIO); + sc->mrid = 0; + sc->mem_res = bus_alloc_resource(dev, SYS_RES_MEMORY, &sc->mrid, + 0ul, ~0ul, msize, RF_ACTIVE); + if (sc->mem_res == NULL) { + device_printf(dev, "0x%lx: Memory range is in use\n", sc->pmem); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); + } - mem=sc->vmem; + /* map memory */ + mem = sc->vmem = pmap_mapdev(sc->pmem, msize); - DPRINT3(DB_INFO,"dgm%d: internal memory segment 0x%x\n",unit,sc->mem_seg); + DPRINT3(DB_INFO, "dgm%d: internal memory segment 0x%x\n", sc->unit, + sc->mem_seg); - outb(sc->port, FEPRST); DELAY(1); + 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; + for (i = 0; (inb(sc->port) & FEPMASK) != FEPRST; i++) { + if (i > 10000) { + device_printf(dev, "1st reset failed\n"); + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } DELAY(1); } - DPRINT3(DB_INFO,"dgm%d: got reset after %d us\n",unit,i); + DPRINT3(DB_INFO, "dgm%d: got reset after %d us\n", sc->unit, i); - t=(((u_long)sc->pmem>>8)) /* disable windowing */; - outb(sc->port+2,t & 0xFF); - outb(sc->port+3,t>>8); + t = sc->pmem >> 8; /* disable windowing */ + outb(sc->port + 2, t & 0xFF); + outb(sc->port + 3, t >> 8); - - mem=sc->vmem; + mem = sc->vmem; /* very short memory test */ + DPRINT2(DB_INFO, "dbg%d: short memory test\n", sc->unit); - 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; + addr = setwin(sc, BOTWIN); + *(u_long *)(mem + addr) = 0xA55A3CC3; + if (*(u_long *)(mem + addr) != 0xA55A3CC3) { + device_printf(dev, "1st memory test failed\n"); + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } - 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; + + DPRINT2(DB_INFO, "dbg%d: 1st memory test ok\n", sc->unit); + + addr = setwin(sc, TOPWIN); + *(u_long *)(mem + addr) = 0x5AA5C33C; + if (*(u_long *)(mem + addr) != 0x5AA5C33C) { + device_printf(dev, "2nd memory test failed\n"); + sc->enabled = 0; 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); + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } - addr=setwin(sc,MISCGLOBAL); - for(i=0; i<16; i++) { - mem[addr+i]=0; - } + DPRINT2(DB_INFO, "dbg%d: 2nd memory test ok\n", sc->unit); - addr=setwin(sc,BIOSOFFSET); - ptr=mem+addr; - for(i=0; ptr<mem+dev->id_msize; i++){ + addr = setwin(sc, BIOSCODE + ((0xF000 - sc->mem_seg) << 4)); + *(u_long *)(mem + addr) = 0x5AA5C33C; + if (*(u_long *)(mem + addr) != 0x5AA5C33C) + device_printf(dev, "3rd (BIOS) memory test failed\n"); + + DPRINT2(DB_INFO, "dbg%d: 3rd memory test ok\n", sc->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; ptr < mem + msize; i++) *ptr++ = pcem_bios[i]; - } - ptr=mem+BIOSOFFSET; - for(i=0; ptr<mem+dev->id_msize; i++){ - if(*ptr++ != pcem_bios[i]){ + + ptr = mem + BIOSOFFSET; + for (i = 0; ptr < mem + msize; i++) { + if (*ptr++ != pcem_bios[i]) { printf("Low BIOS load failed\n"); - sc->status = DISABLED; + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } } - addr=setwin(sc,dev->id_msize); - ptr =mem+addr; - for(;i < pcem_nbios; i++){ + DPRINT2(DB_INFO, "dbg%d: pcem_bios seg 1 loaded\n", sc->unit); + + addr = setwin(sc, 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]){ + + ptr = mem; + for (i = msize - BIOSOFFSET; i < pcem_nbios; i++) { + if (*ptr++ != pcem_bios[i]) { printf("High BIOS load failed\n"); - sc->status = DISABLED; + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } } - printf("dgm%d: DigiBIOS loaded, initializing",dev->id_unit); + DPRINT2(DB_INFO, "dbg%d: pcem_bios seg 2 loaded\n", sc->unit); + device_printf(dev, "DigiBIOS loaded, initializing"); - addr=setwin(sc,0); + addr = setwin(sc, 0); - *(u_int *)(mem+addr+0)=0x0bf00401; - *(u_int *)(mem+addr+4)=0; - *(ushort *)(mem+addr+0xc00)=0; + *(u_int *)(mem + addr) = 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++){ + for (i = 0; *(u_char *)(mem + addr + 0xc00) != 0x47; i++) { DELAY(10000); - if(i> 3000){ + if (i > 3000) { printf("\nBIOS initialize failed(1)\n"); - sc->status = DISABLED; + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } } - - if(*(u_char *)(mem+addr+ 0xc01) != 0x44){ + + if (*(u_char *)(mem + addr + 0xc01) != 0x44) { printf("\nBIOS initialize failed(2)\n"); - sc->status = DISABLED; + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } printf(", DigiBIOS running\n"); DELAY(10000); - - addr=setwin(sc,BIOSOFFSET); - ptr=mem+addr; - for(i=0; i<pcem_ncook; i++){ + + addr = setwin(sc, BIOSOFFSET); + ptr = mem + addr; + for (i = 0; i < pcem_ncook; i++) *ptr++ = pcem_cook[i]; - } - ptr=mem+BIOSOFFSET; - for(i=0; i<pcem_ncook; i++){ - if(*ptr++ != pcem_cook[i]){ + + ptr = mem + BIOSOFFSET; + for (i = 0; i < pcem_ncook; i++) { + if (*ptr++ != pcem_cook[i]) { printf("FEP/OS load failed\n"); - sc->status = DISABLED; + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } } - 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++){ + device_printf(dev, "FEP/OS loaded, initializing"); + + 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){ + if (i > 3000) { printf("\nFEP/OS initialize failed(1)\n"); - sc->status = DISABLED; + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } } - - if(*(u_char *)(mem+addr+ 0xd21) != 'S'){ + + if (*(u_char *)(mem + addr + 0xd21) != 'S') { printf("\nFEP/OS initialize failed(2)\n"); - sc->status = DISABLED; + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } printf(", FEP/OS running\n"); - sc->numports= *(ushort *)(mem+setwin(sc,NPORT)); - printf("dgm%d: %d ports\n",unit,sc->numports); + sc->numports = *(ushort *)(mem + setwin(sc, NPORT)); + device_printf(dev, "%d ports attached\n", sc->numports); - if(sc->numports > MAX_DGM_PORTS) { - printf("dgm%d: too many ports\n",unit); - sc->status=DISABLED; + if (sc->numports > MAX_DGM_PORTS) { + printf("dgm%d: too many ports\n", sc->unit); + sc->enabled = 0; hidewin(sc); - return 0; + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + return (ENXIO); } - 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; + MALLOC(sc->ports, struct dgm_p *, sizeof (*sc->ports) * sc->numports, + M_TTYS, M_WAITOK|M_ZERO); + MALLOC(sc->ttys, struct tty *, sizeof (*sc->ttys) * sc->numports, + M_TTYS, M_WAITOK|M_ZERO); - for(i=0; i<sc->numports; i++) - sc->ports[i].status = ENABLED; + DPRINT3(DB_INFO, "dgm%d: enable %d ports\n", sc->unit, sc->numports); + for (i = 0; i < sc->numports; i++) + sc->ports[i].enabled = 1; /* 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); + 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; + if (sc->numports < 3) + shrinkmem = 1; else - shrinkmem=0; + shrinkmem = 0; - for(i=0; i<sc->numports; i++, bc++) { - port= &sc->ports[i]; + for (i = 0; i < sc->numports; i++, bc++) { + DPRINT3(DB_INFO, "dgm%d: Set up port %d\n", sc->unit, i); + port = &sc->ports[i]; + port->sc = sc; - port->tty=&sc->ttys[i]; - port->unit=unit; + port->tty = &sc->ttys[i]; - port->brdchan=bc; + port->brdchan = bc; - port->dcd=CD; - port->dsr=DSR; - port->pnum=i; + port->dcd = CD; + port->dsr = DSR; + port->pnum = i; - if(shrinkmem) { - DPRINT2(DB_INFO,"dgm%d: shrinking memory\n",unit); + DPRINT3(DB_INFO, "dgm%d port %d: shrinkmem ?\n", sc->unit, i); + if (shrinkmem) { + DPRINT2(DB_INFO, "dgm%d: shrinking memory\n", sc->unit); fepcmd(port, SETBUFFER, 32, 0, 0, 0); - shrinkmem=0; - } + shrinkmem = 0; + } - 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); + DPRINT3(DB_INFO, "dgm%d port %d: assign ptrs\n", sc->unit, i); + 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; + 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; + lowwater = (port->txbufsize >= 2000) ? + 1024 : (port->txbufsize / 2); + setwin(sc, 0); + DPRINT4(DB_INFO, "dgm%d port %d: fepcmd STXLWATER %d\n", + sc->unit, i, lowwater); + fepcmd(port, STXLWATER, lowwater, 0, 10, 0); + DPRINT4(DB_INFO, "dgm%d port %d: fepcmd SRXLWATER %d\n", + sc->unit, i, port->rxbufsize / 4); + fepcmd(port, SRXLWATER, port->rxbufsize / 4, 0, 10, 0); + DPRINT4(DB_INFO, "dgm%d port %d: fepcmd SRXHWATER %d\n", + sc->unit, i, 3 * port->rxbufsize / 4); + 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; + + DPRINT3(DB_INFO, "dgm%d port %d: setup flags\n", sc->unit, i); /* - * We don't use all the flags from <sys/ttydefaults.h> 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. + * We don't use all the flags from <sys/ttydefaults.h> 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; @@ -738,35 +839,82 @@ dgmattach(dev) termioschars(&port->it_in); port->it_in.c_ispeed = port->it_in.c_ospeed = dgmdefaultrate; port->it_out = port->it_in; - make_dev(&dgm_cdevsw, (unit*65536)+i, - UID_ROOT, GID_WHEEL, 0600, "ttyM%d%x", unit, i + 0xa0); - make_dev(&dgm_cdevsw, (unit*65536)+i+64, - UID_ROOT, GID_WHEEL, 0600, "ttyiM%d%x", unit, i + 0xa0); - make_dev(&dgm_cdevsw, (unit*65536)+i+128, - UID_ROOT, GID_WHEEL, 0600, "ttylM%d%x", unit, i + 0xa0); - make_dev(&dgm_cdevsw, (unit*65536)+i+262144, - UID_UUCP, GID_DIALER, 0660, "cuaM%d%x", unit, i + 0xa0); - make_dev(&dgm_cdevsw, (unit*65536)+i+262208, - UID_UUCP, GID_DIALER, 0660, "cuaiM%d%x", unit, i + 0xa0); - make_dev(&dgm_cdevsw, (unit*65536)+i+262272, - UID_UUCP, GID_DIALER, 0660, "cualM%d%x", unit, i + 0xa0); + + DPRINT3(DB_INFO, "dgm%d port %d: make devices\n", sc->unit, i); + make_dev(&dgm_cdevsw, (sc->unit*65536) + i, UID_ROOT, + GID_WHEEL, 0600, "ttyM%d%x", sc->unit, i + 0xa0); + make_dev(&dgm_cdevsw, sc->unit * 65536 + i + 64, UID_ROOT, + GID_WHEEL, 0600, "ttyiM%d%x", sc->unit, i + 0xa0); + make_dev(&dgm_cdevsw, sc->unit * 65536 + i + 128, UID_ROOT, + GID_WHEEL, 0600, "ttylM%d%x", sc->unit, i + 0xa0); + make_dev(&dgm_cdevsw, sc->unit * 65536 + i + 262144, UID_UUCP, + GID_DIALER, 0660, "cuaM%d%x", sc->unit, i + 0xa0); + make_dev(&dgm_cdevsw, sc->unit * 65536 + i + 262208, UID_UUCP, + GID_DIALER, 0660, "cuaiM%d%x", sc->unit, i + 0xa0); + make_dev(&dgm_cdevsw, sc->unit * 65536 + i + 262272, UID_UUCP, + GID_DIALER, 0660, "cualM%d%x", sc->unit, i + 0xa0); } + DPRINT3(DB_INFO, "dgm%d: %d device nodes created\n", sc->unit, sc->numports); + hidewin(sc); - /* register the polling function */ - timeout(dgmpoll, (void *)unit, hz/POLLSPERSEC); + /* start the polling function */ + sc->toh = timeout(dgmpoll, (void *)(int)sc->unit, hz / POLLSPERSEC); - return 1; + DPRINT2(DB_INFO, "dgm%d: poll thread started\n", sc->unit); + + return (0); +} + +static int +dgmdetach(device_t dev) +{ + struct dgm_softc *sc = device_get_softc(dev); + int i; + + for (i = 0; i < sc->numports; i++) + if (sc->ttys[i].t_state & TS_ISOPEN) + return (EBUSY); + + DPRINT2(DB_INFO, "dgm%d: detach\n", sc->unit); + + for (i = 0; i < sc->numports; i++) { + destroy_dev(makedev(CDEV_MAJOR, sc->unit * 65536 + i)); + destroy_dev(makedev(CDEV_MAJOR, sc->unit * 65536 + i + 64)); + destroy_dev(makedev(CDEV_MAJOR, sc->unit * 65536 + i + 128)); + destroy_dev(makedev(CDEV_MAJOR, sc->unit * 65536 + i + 262144)); + destroy_dev(makedev(CDEV_MAJOR, sc->unit * 65536 + i + 262208)); + destroy_dev(makedev(CDEV_MAJOR, sc->unit * 65536 + i + 262272)); + } + + untimeout(dgmpoll, (void *)(int)sc->unit, sc->toh); + callout_handle_init(&sc->toh); + + bus_release_resource(dev, SYS_RES_MEMORY, sc->mrid, sc->mem_res); + bus_release_resource(dev, SYS_RES_IOPORT, sc->iorid, sc->io_res); + + FREE(sc->ports, M_TTYS); + FREE(sc->ttys, M_TTYS); + + return (0); +} + +int +dgmshutdown(device_t dev) +{ +#ifdef DEBUG + struct dgm_softc *sc = device_get_softc(dev); + + DPRINT2(DB_INFO, "dgm%d: shutdown\n", sc->unit); +#endif + + return 0; } /* ARGSUSED */ -static int -dgmopen(dev, flag, mode, p) - dev_t dev; - int flag; - int mode; - struct proc *p; +static int +dgmopen(dev_t dev, int flag, int mode, struct proc *p) { struct dgm_softc *sc; struct tty *tp; @@ -774,49 +922,53 @@ dgmopen(dev, flag, mode, p) int mynor; int pnum; struct dgm_p *port; - int s,cs; + 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); + 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); + sc = devclass_get_softc(dgmdevclass, unit); + if (sc == NULL) { + DPRINT2(DB_EXCEPT, "dgm%d: try to open a nonexisting card\n", + unit); return ENXIO; } - sc=&dgm_softc[unit]; + DPRINT2(DB_INFO, "dgm%d: open\n", sc->unit); - if(sc->status!=ENABLED) { - DPRINT2(DB_EXCEPT,"dgm%d: try to open a disabled card\n",unit); + if (!sc->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); + 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) + if (mynor & CONTROL_MASK) return 0; - tp=&sc->ttys[pnum]; + tp = &sc->ttys[pnum]; dev->si_tty = tp; - port=&sc->ports[pnum]; - bc=port->brdchan; + port = &sc->ports[pnum]; + bc = port->brdchan; open_top: - - s=spltty(); + s = spltty(); - while(port->closing) { - error=tsleep(&port->closing, TTOPRI|PCATCH, "dgocl", 0); + 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); + if (error) { + DPRINT4(DB_OPEN, "dgm%d: port%d: tsleep(dgocl)" + " error = %d\n", unit, pnum, error); goto out; } } @@ -829,29 +981,28 @@ open_top: if (mynor & CALLOUT_MASK) { if (!port->active_out) { error = EBUSY; - DPRINT4(DB_OPEN,"dgm%d: port%d: BUSY error=%d\n",unit,pnum,error); + 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; + } 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 && - suser(p)) { + if (tp->t_state & TS_XCLUDE && suser(p)) { error = EBUSY; goto out; } @@ -862,41 +1013,42 @@ open_top: * 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_stop=dgmstop; - tp->t_dev=dev; + tp->t_oproc = dgmstart; + tp->t_param = dgmparam; + tp->t_stop = dgmstop; + 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; + 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); + 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); + 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); + if (error != 0) { + DPRINT4(DB_OPEN, "dgm%d: port%d: dgmparam error = %d\n", + unit, pnum, error); goto out; } /* 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); - + if ((port->imodem & port->dcd) || mynor & CALLOUT_MASK) + linesw[tp->t_line].l_modem(tp, 1); } /* @@ -908,44 +1060,43 @@ open_top: 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); + 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); + 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->active_out = 1; - port->used=1; + port->used = 1; - /* If any port is open (i.e. the open() call is completed for it) + /* 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); + disc_optim(tp, &tp->t_termios); splx(s); - if( !(tp->t_state & TS_ISOPEN) && port->wopeners==0 ) + 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); + 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; +static int +dgmclose(dev_t dev, int flag, int mode, struct proc *p) { int mynor; struct tty *tp; @@ -955,69 +1106,72 @@ dgmclose(dev, flag, mode, p) int s; int i; - mynor=minor(dev); - if(mynor & CONTROL_MASK) + mynor = minor(dev); + if (mynor & CONTROL_MASK) return 0; - unit=MINOR_TO_UNIT(mynor); - pnum=MINOR_TO_PORT(mynor); + unit = MINOR_TO_UNIT(mynor); + pnum = MINOR_TO_PORT(mynor); - sc=&dgm_softc[unit]; - tp=&sc->ttys[pnum]; - port=sc->ports+pnum; + sc = devclass_get_softc(dgmdevclass, 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: closing\n", unit, pnum); - DPRINT3(DB_CLOSE,"dgm%d: port%d: draining port\n",unit,pnum); + DPRINT3(DB_CLOSE, "dgm%d: port%d: draining port\n", unit, pnum); dgm_drain_or_flush(port); - s=spltty(); + 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); + 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); + 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); + DPRINT3(DB_CLOSE, "dgm%d: port%d: closing tty\n", unit, pnum); ttyclose(tp); - port->closing=0; + port->closing = 0; wakeup(&port->closing); - port->used=0; + port->used = 0; /* mark the card idle when all ports are closed */ - for(i=0; i<sc->numports; i++) - if(sc->ports[i].used) + for (i = 0; i < sc->numports; i++) + if (sc->ports[i].used) break; splx(s); - DPRINT3(DB_CLOSE,"dgm%d: port%d: closed\n",unit,pnum); + DPRINT3(DB_CLOSE, "dgm%d: port%d: closed\n", unit, pnum); wakeup(TSA_CARR_ON(tp)); wakeup(&port->active_out); - port->active_out=0; + port->active_out = 0; - DPRINT3(DB_CLOSE,"dgm%d: port%d: close exit\n",unit,pnum); + DPRINT3(DB_CLOSE, "dgm%d: port%d: close exit\n", unit, pnum); return 0; } static void -dgmhardclose(port) - struct dgm_p *port; +dgmhardclose(struct dgm_p *port) { - struct dgm_softc *sc=&dgm_softc[port->unit]; - volatile struct board_chan *bc=port->brdchan; + volatile struct board_chan *bc = port->brdchan; + struct dgm_softc *sc; int cs; - cs=splclock(); + sc = devclass_get_softc(dgmdevclass, port->sc->unit); + DPRINT2(DB_INFO, "dgm%d: dgmhardclose\n", sc->unit); + cs = splclock(); port->do_timestamp = 0; - setwin(sc,0); + setwin(sc, 0); - bc->idata=0; bc->iempty=0; bc->ilow=0; - if(port->tty->t_cflag & HUPCL) { + 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); } @@ -1029,22 +1183,19 @@ dgmhardclose(port) tsleep(&port->brdchan, TTIPRI | PCATCH, "dgclo", 0); } -static void -dgm_pause(chan) - void *chan; +static void +dgm_pause(void *chan) { -wakeup((caddr_t)chan); + wakeup((caddr_t)chan); } - static void -dgmpoll(unit_c) - void *unit_c; +dgmpoll(void *unit_c) { - int unit=(int)unit_c; + int unit = (int)unit_c; int pnum; struct dgm_p *port; - struct dgm_softc *sc=&dgm_softc[unit]; + struct dgm_softc *sc; int head, tail; u_char *eventbuf; int event, mstat, lstat; @@ -1055,259 +1206,271 @@ dgmpoll(unit_c) int size; u_char *ptr; int ocount; - int ibuf_full,obuf_full; + int ibuf_full, obuf_full; + BoardMemWinState ws = bmws_get(); - BoardMemWinState ws=bmws_get(); + sc = devclass_get_softc(dgmdevclass, unit); + DPRINT2(DB_INFO, "dgm%d: poll\n", sc->unit); + callout_handle_init(&sc->toh); - if(sc->status==DISABLED) { - printf("dgm%d: polling of disabled board stopped\n",unit); + if (!sc->enabled) { + printf("dgm%d: polling of disabled board stopped\n", unit); return; } - - setwin(sc,0); - head=sc->mailbox->ein; - tail=sc->mailbox->eout; + setwin(sc, 0); - while(head!=tail) { - if(head >= FEP_IMAX-FEP_ISTART - || tail >= FEP_IMAX-FEP_ISTART + 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); + 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]; + 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]; + 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 ) { + if (pnum >= sc->numports || !port->enabled) { + 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; + int wrapmask = port->rxbufsize - 1; - if( !(event & ALL_IND) ) + 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); + if (event & DATA_IND) { + DPRINT3(DB_DATA, "dgm%d: port%d: DATA_IND\n", + unit, pnum); - rhead=bc->rin & wrapmask; - rtail=bc->rout & wrapmask; + rhead = bc->rin & wrapmask; + rtail = bc->rout & wrapmask; - if( !(tp->t_cflag & CREAD) || !port->used ) { - bc->rout=rhead; + if (!(tp->t_cflag & CREAD) || !port->used ) { + bc->rout = rhead; goto end_of_data; } - if(bc->orun) { + if (bc->orun) { printf("dgm%d: port%d: overrun\n", unit, pnum); - bc->orun=0; + bc->orun = 0; } - if(!(tp->t_state & TS_ISOPEN)) + 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); + 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; + if (rhead > rtail) + size = rhead - rtail; else - size=port->rxbufsize-rtail; + size = port->rxbufsize - rtail; - ptr=port->rxptr+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 (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 (size) { if (tp->t_state & TS_CAN_BYPASS_L_RINT) { - DPRINT1(DB_RXDATA,"!"); - towin(sc,port->rxwin); + 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); + b_to_q(ptr, size, + &tp->t_rawq); + setwin(sc, 0); } else { - int i=size; + int i = size; unsigned char chr; do { - towin(sc,port->rxwin); - chr= *ptr++; + towin(sc, port->rxwin); + chr = *ptr++; hidewin(sc); (*linesw[tp->t_line].l_rint)(chr, tp); } while (--i > 0 ); - setwin(sc,0); + setwin(sc, 0); } } rtail= (rtail + size) & wrapmask; - bc->rout=rtail; - rhead=bc->rin & wrapmask; + bc->rout = rtail; + rhead = bc->rin & wrapmask; hidewin(sc); ttwakeup(tp); - setwin(sc,0); + 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) { + 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); + 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; + 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); + 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); + 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 & (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; + if ((event & EMPTYTX_IND ) && + tp->t_outq.c_cc == 0 && port->draining) { + port->draining = 0; wakeup(&port->draining); - bc->ilow=0; bc->iempty=0; + bc->ilow = 0; + bc->iempty = 0; } else { - int wrapmask=port->txbufsize-1; + int wrapmask = port->txbufsize - 1; - for(obuf_full=FALSE; tp->t_outq.c_cc!=0 && !obuf_full; ) { + 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)) { + 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) { + 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); + setwin(sc, 0); } - s=spltty(); + s = spltty(); - whead=bc->tin & wrapmask; - wtail=bc->tout & wrapmask; + whead = bc->tin & wrapmask; + wtail = bc->tout & wrapmask; - if(whead<wtail) - size=wtail-whead-1; + if (whead < wtail) + size = wtail - whead - 1; else { - size=port->txbufsize-whead; - if(wtail==0) + size = port->txbufsize - 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; + 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); + towin(sc, port->txwin); - ocount=q_to_b(&tp->t_outq, port->txptr+whead, size); - whead+=ocount; + ocount = q_to_b(&tp->t_outq, port->txptr + whead, size); + whead += ocount; - setwin(sc,0); - bc->tin=whead; - bc->tin=whead & wrapmask; + 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; + if (obuf_full) { + DPRINT1(DB_WR, " +BUSY\n"); + tp->t_state |= TS_BUSY; } else { - DPRINT1(DB_WR," -BUSY\n"); + 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) { + 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) { + if (tp->t_state & TS_ASLEEP) { tp->t_state &= ~TS_ASLEEP; wakeup(TSA_OLOWAT(tp)); } tp->t_state &= ~TS_BUSY; #endif - setwin(sc,0); + setwin(sc, 0); } } } - bc->idata=1; /* require event on incoming data */ + 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; + 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); + tail = (tail + 4) & (FEP_IMAX - FEP_ISTART - 4); } - sc->mailbox->eout=tail; + sc->mailbox->eout = tail; bmws_set(ws); - timeout(dgmpoll, unit_c, hz/POLLSPERSEC); + sc->toh = timeout(dgmpoll, unit_c, hz / POLLSPERSEC); + + DPRINT2(DB_INFO, "dgm%d: poll done\n", sc->unit); } -static int -dgmioctl(dev, cmd, data, flag, p) - dev_t dev; - u_long cmd; - caddr_t data; - int flag; - struct proc *p; +static int +dgmioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p) { struct dgm_softc *sc; int unit, pnum; @@ -1316,7 +1479,7 @@ dgmioctl(dev, cmd, data, flag, p) struct tty *tp; volatile struct board_chan *bc; int error; - int s,cs; + int s, cs; int tiocm_xxx; #if defined(COMPAT_43) || defined(COMPAT_SUNOS) @@ -1324,16 +1487,16 @@ dgmioctl(dev, cmd, data, flag, p) struct termios term; #endif - BoardMemWinState ws=bmws_get(); + BoardMemWinState ws = bmws_get(); - mynor=minor(dev); - unit=MINOR_TO_UNIT(mynor); - pnum=MINOR_TO_PORT(mynor); + 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; + sc = devclass_get_softc(dgmdevclass, unit); + port = &sc->ports[pnum]; + tp = &sc->ttys[pnum]; + bc = port->brdchan; if (mynor & CONTROL_MASK) { struct termios *ct; @@ -1372,7 +1535,7 @@ dgmioctl(dev, cmd, data, flag, p) #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); + 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); @@ -1388,7 +1551,7 @@ dgmioctl(dev, cmd, data, flag, p) 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); + 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) @@ -1406,36 +1569,36 @@ dgmioctl(dev, cmd, data, flag, p) dt->c_ospeed = tp->t_ospeed; } - if(cmd==TIOCSTOP) { - cs=splclock(); - setwin(sc,0); + 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); + } 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; + if (cmd == TIOCSETAW || cmd == TIOCSETAF) + port->mustdrain = 1; error = linesw[tp->t_line].l_ioctl(tp, cmd, data, flag, p); if (error != ENOIOCTL) return error; s = spltty(); error = ttioctl(tp, cmd, data, flag); - disc_optim(tp,&tp->t_termios); - port->mustdrain=0; + disc_optim(tp, &tp->t_termios); + port->mustdrain = 0; if (error != ENOIOCTL) { 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); + 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; } @@ -1443,16 +1606,16 @@ dgmioctl(dev, cmd, data, flag, p) switch (cmd) { case TIOCSBRK: /* Helg: commented */ -/* error=dgmdrain(port);*/ +/* error = dgmdrain(port);*/ - if(error!=0) { + if (error != 0) { splx(s); return error; } - cs=splclock(); - setwin(sc,0); - + cs = splclock(); + setwin(sc, 0); + /* now it sends 250 millisecond break because I don't know */ /* how to send an infinite break */ @@ -1464,111 +1627,110 @@ dgmioctl(dev, cmd, data, flag, p) /* now it's empty */ break; case TIOCSDTR: - DPRINT3(DB_MODEM,"dgm%d: port%d: set DTR\n",unit,pnum); + DPRINT3(DB_MODEM, "dgm%d: port%d: set DTR\n", unit, pnum); port->omodem |= DTR; - cs=splclock(); - setwin(sc,0); + 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); - } + 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); + DPRINT3(DB_MODEM, "dgm%d: port%d: reset DTR\n", unit, pnum); port->omodem &= ~DTR; - cs=splclock(); - setwin(sc,0); + 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); + 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; + if (*(int *)data & TIOCM_DTR) + port->omodem |= DTR; else - port->omodem &=~DTR; + port->omodem &= ~DTR; - if(*(int *)data & TIOCM_RTS) - port->omodem |=RTS; + if (*(int *)data & TIOCM_RTS) + port->omodem |= RTS; else - port->omodem &=~RTS; + port->omodem &= ~RTS; - cs=splclock(); - setwin(sc,0); + 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_DTR) + port->omodem |= DTR; - if(*(int *)data & TIOCM_RTS) - port->omodem |=RTS; + if (*(int *)data & TIOCM_RTS) + port->omodem |= RTS; - cs=splclock(); - setwin(sc,0); + 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_DTR) + port->omodem &= ~DTR; - if(*(int *)data & TIOCM_RTS) - port->omodem &=~RTS; + if (*(int *)data & TIOCM_RTS) + port->omodem &= ~RTS; - cs=splclock(); - setwin(sc,0); + 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; + 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); + DPRINT3(DB_MODEM, "dgm%d: port%d: modem stat -- ", unit, pnum); if (port->imodem & DTR) { - DPRINT1(DB_MODEM,"DTR "); + DPRINT1(DB_MODEM, "DTR "); tiocm_xxx |= TIOCM_DTR; } if (port->imodem & RTS) { - DPRINT1(DB_MODEM,"RTS "); + DPRINT1(DB_MODEM, "RTS "); tiocm_xxx |= TIOCM_RTS; } if (port->imodem & CTS) { - DPRINT1(DB_MODEM,"CTS "); + DPRINT1(DB_MODEM, "CTS "); tiocm_xxx |= TIOCM_CTS; } if (port->imodem & port->dcd) { - DPRINT1(DB_MODEM,"DCD "); + DPRINT1(DB_MODEM, "DCD "); tiocm_xxx |= TIOCM_CD; } if (port->imodem & port->dsr) { - DPRINT1(DB_MODEM,"DSR "); + DPRINT1(DB_MODEM, "DSR "); tiocm_xxx |= TIOCM_DSR; } if (port->imodem & RI) { - DPRINT1(DB_MODEM,"RI "); + DPRINT1(DB_MODEM, "RI "); tiocm_xxx |= TIOCM_RI; } *(int *)data = tiocm_xxx; - DPRINT1(DB_MODEM,"--\n"); + DPRINT1(DB_MODEM, "--\n"); break; case TIOCMSDTRWAIT: /* must be root since the wait applies to following logins */ @@ -1583,11 +1745,11 @@ dgmioctl(dev, cmd, data, flag, p) *(int *)data = port->close_delay * 100 / hz; break; case TIOCTIMESTAMP: - port->do_timestamp = TRUE; + port->do_timestamp = 1; *(struct timeval *)data = port->timestamp; break; case TIOCDCDTIMESTAMP: - port->do_dcd_timestamp = TRUE; + port->do_dcd_timestamp = 1; *(struct timeval *)data = port->dcd_timestamp; break; default: @@ -1601,11 +1763,10 @@ dgmioctl(dev, cmd, data, flag, p) return 0; } -static void -wakeflush(p) - void *p; +static void +wakeflush(void *p) { - struct dgm_p *port=p; + struct dgm_p *port = p; wakeup(&port->draining); } @@ -1613,47 +1774,47 @@ wakeflush(p) /* wait for the output to drain */ static int -dgmdrain(port) - struct dgm_p *port; +dgmdrain(struct dgm_p *port) { - struct dgm_softc *sc=&dgm_softc[port->unit]; - volatile struct board_chan *bc=port->brdchan; + volatile struct board_chan *bc = port->brdchan; + struct dgm_softc *sc; int error; int head, tail; + BoardMemWinState ws = bmws_get(); - BoardMemWinState ws=bmws_get(); + sc = devclass_get_softc(dgmdevclass, port->sc->unit); - setwin(sc,0); + setwin(sc, 0); - bc->iempty=1; - tail=bc->tout; - head=bc->tin; + 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); + while (tail != head) { + DPRINT5(DB_WR, "dgm%d: port%d: drain: head = %d tail = %d\n", + port->sc->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); + 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); + DPRINT4(DB_WR, "dgm%d: port%d: tsleep(dgdrn) error = %d\n", + port->sc->unit, port->pnum, error); - bc->iempty=0; + bc->iempty = 0; bmws_set(ws); return error; } - tail=bc->tout; - head=bc->tin; + 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); + DPRINT5(DB_WR, "dgm%d: port%d: drain: head = %d tail = %d\n", + port->sc->unit, port->pnum, head, tail); bmws_set(ws); return 0; } @@ -1662,148 +1823,150 @@ dgmdrain(port) /* or simply clear the buffer it it's stopped */ static void -dgm_drain_or_flush(port) - struct dgm_p *port; +dgm_drain_or_flush(struct dgm_p *port) { - struct tty *tp=port->tty; - struct dgm_softc *sc=&dgm_softc[port->unit]; - volatile struct board_chan *bc=port->brdchan; + volatile struct board_chan *bc = port->brdchan; + struct tty *tp = port->tty; + struct dgm_softc *sc; int error; int lasttail; int head, tail; - setwin(sc,0); + sc = devclass_get_softc(dgmdevclass, port->sc->unit); + setwin(sc, 0); - lasttail=-1; - bc->iempty=1; - tail=bc->tout; - head=bc->tin; + 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); + while (tail != head /* && tail != lasttail */ ) { + DPRINT5(DB_WR, "dgm%d: port%d: flush: head = %d tail = %d\n", + port->sc->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; + 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); + 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); + DPRINT4(DB_WR, "dgm%d: port%d: tsleep(dgfls)" + " error = %d\n", port->sc->unit, port->pnum, error); /* silently clean the buffer */ - bc->tout=bc->tin=0; - bc->iempty=0; + bc->tout = bc->tin = 0; + bc->iempty = 0; hidewin(sc); return; } - lasttail=tail; - tail=bc->tout; - head=bc->tin; + 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); + DPRINT5(DB_WR, "dgm%d: port%d: flush: head = %d tail = %d\n", + port->sc->unit, port->pnum, head, tail); } static int -dgmparam(tp, t) - struct tty *tp; - struct termios *t; +dgmparam(struct tty *tp, struct termios *t) { - int unit=MINOR_TO_UNIT(minor(tp->t_dev)); - int pnum=MINOR_TO_PORT(minor(tp->t_dev)); - struct dgm_softc *sc=&dgm_softc[unit]; - struct dgm_p *port=&sc->ports[pnum]; - volatile struct board_chan *bc=port->brdchan; + int unit = MINOR_TO_UNIT(minor(tp->t_dev)); + int pnum = MINOR_TO_PORT(minor(tp->t_dev)); + volatile struct board_chan *bc; + struct dgm_softc *sc; + struct dgm_p *port; int cflag; int head; int mval; int iflag; int hflow; int cs; + BoardMemWinState ws = bmws_get(); - BoardMemWinState ws=bmws_get(); + sc = devclass_get_softc(dgmdevclass, unit); + port = &sc->ports[pnum]; + bc = port->brdchan; - 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); + 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); + if (port->mustdrain) { + DPRINT3(DB_PARAM, "dgm%d: port%d: must call dgmdrain()\n", unit, pnum); dgmdrain(port); } - cflag=ttspeedtab(t->c_ospeed, dgmspeedtab); + 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); + DPRINT4(DB_PARAM, "dgm%d: port%d: invalid cflag = 0%o\n", unit, pnum, cflag); return (EINVAL); } - cs=splclock(); - setwin(sc,0); + 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; + 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; - DPRINT5(DB_PARAM,"dgm%d: port%d: set cflag=0x%x c=0x%x\n", - unit,pnum,cflag,t->c_cflag&~CRTSCTS); + if (cflag != port->fepcflag) { + port->fepcflag = cflag; + DPRINT5(DB_PARAM, "dgm%d: port%d: set cflag = 0x%x c = 0x%x\n", + unit, pnum, 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); + 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; + 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); + 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; + + 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]; + 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); } @@ -1815,8 +1978,7 @@ dgmparam(tp, t) } static void -dgmstart(tp) - struct tty *tp; +dgmstart(struct tty *tp) { int unit; int pnum; @@ -1828,82 +1990,84 @@ dgmstart(tp) int s; int wmask; - BoardMemWinState ws=bmws_get(); + 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; + unit = MINOR_TO_UNIT(minor(tp->t_dev)); + pnum = MINOR_TO_PORT(minor(tp->t_dev)); + sc = devclass_get_softc(dgmdevclass, unit); + port = &sc->ports[pnum]; + bc = port->brdchan; - wmask=port->txbufsize-1; + wmask = port->txbufsize - 1; - s=spltty(); + s = spltty(); - while( tp->t_outq.c_cc!=0 ) { + 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) { + 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); + cs = splclock(); + setwin(sc, 0); - head=bc->tin & wmask; + head = bc->tin & wmask; - do { tail=bc->tout; } while (tail != bc->tout); - tail=bc->tout & wmask; + 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); + 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; +#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; + if (tail > head) + size = tail - head - 1; else { - size=port->txbufsize-head/*-1*/; - if(tail==0) + size = port->txbufsize - head; + if (tail == 0) size--; } #endif - if(size==0) { - bc->iempty=1; bc->ilow=1; + if (size == 0) { + bc->iempty = 1; + bc->ilow = 1; splx(cs); bmws_set(ws); - tp->t_state|=TS_BUSY; + tp->t_state |= TS_BUSY; splx(s); return; } - towin(sc,port->txwin); + towin(sc, port->txwin); - ocount=q_to_b(&tp->t_outq, port->txptr+head, size); - head+=ocount; - if(head>=port->txbufsize) - head-=port->txbufsize; + 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; + setwin(sc, 0); + bc->tin = head; - DPRINT5(DB_WR,"dgm%d: port%d: tx avail=%d count=%d\n",unit,pnum,size,ocount); + DPRINT5(DB_WR, "dgm%d: port%d: tx avail = %d count = %d\n", + unit, pnum, size, ocount); hidewin(sc); splx(cs); } @@ -1912,24 +2076,22 @@ dgmstart(tp) splx(s); #ifndef TS_ASLEEP /* post 2.0.5 FreeBSD */ - if(tp->t_state & TS_BUSY) { - tp->t_state&=~TS_BUSY; + 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) { + if (tp->t_state & TS_ASLEEP) { tp->t_state &= ~TS_ASLEEP; wakeup(TSA_OLOWAT(tp)); } - tp->t_state&=~TS_BUSY; + tp->t_state& = ~TS_BUSY; #endif } void -dgmstop(tp, rw) - struct tty *tp; - int rw; +dgmstop(struct tty *tp, int rw) { int unit; int pnum; @@ -1938,29 +2100,30 @@ dgmstop(tp, rw) volatile struct board_chan *bc; int s; - BoardMemWinState ws=bmws_get(); + BoardMemWinState ws = bmws_get(); - unit=MINOR_TO_UNIT(minor(tp->t_dev)); - pnum=MINOR_TO_PORT(minor(tp->t_dev)); + 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; + sc = devclass_get_softc(dgmdevclass, unit); + port = &sc->ports[pnum]; + bc = port->brdchan; - DPRINT3(DB_WR,"dgm%d: port%d: stop\n",port->unit, port->pnum); + DPRINT3(DB_WR, "dgm%d: port%d: stop\n", port->sc->unit, port->pnum); s = spltty(); - setwin(sc,0); + setwin(sc, 0); if (rw & FWRITE) { /* clear output queue */ - bc->tout=bc->tin=0; - bc->ilow=0;bc->iempty=0; + bc->tout = bc->tin = 0; + bc->ilow = 0; + bc->iempty = 0; } if (rw & FREAD) { /* clear input queue */ - bc->rout=bc->rin; - bc->idata=1; + bc->rout = bc->rin; + bc->idata = 1; } hidewin(sc); bmws_set(ws); @@ -1968,64 +2131,67 @@ dgmstop(tp, rw) dgmstart(tp); } -static void -fepcmd(port, cmd, op1, op2, ncmds, bytecmd) - struct dgm_p *port; - unsigned cmd, op1, op2, ncmds, bytecmd; +static void +fepcmd(struct dgm_p *port, + unsigned cmd, + unsigned op1, + unsigned op2, + unsigned ncmds, + unsigned bytecmd) { - struct dgm_softc *sc=&dgm_softc[port->unit]; - u_char *mem=sc->vmem; + u_char *mem; 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); + KASSERT(port->sc, ("Couldn't (re)obtain driver softc")); + mem = port->sc->vmem; + + if (!port->enabled) { + printf("dgm%d: port%d: FEP command on disabled port\n", + port->sc->unit, port->pnum); return; } - /* setwin(sc,0); Require this to be set by caller */ - head=sc->mailbox->cin; + /* setwin(port->sc, 0); Require this to be set by caller */ + head = port->sc->mailbox->cin; - if(head>=(FEP_CMAX-FEP_CSTART) || (head & 3)) { + 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); + port->sc->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; + mem[head + FEP_CSTART] = 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; + 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]); + DPRINT7(DB_FEP, "dgm%d: port%d: %s cmd = 0x%x op1 = 0x%x op2 = 0x%x\n", port->sc->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; + head = (head + 4) & (FEP_CMAX - FEP_CSTART - 4); + port->sc->mailbox->cin = head; - count=FEPTIMEOUT; + count = FEPTIMEOUT; while (count-- != 0) { - head=sc->mailbox->cin; - tail=sc->mailbox->cout; + head = port->sc->mailbox->cin; + tail = port->sc->mailbox->cout; - n = (head-tail) & (FEP_CMAX-FEP_CSTART-4); - if(n <= ncmds * (sizeof(ushort)*4)) + 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); + printf("dgm%d(%d): timeout on FEP cmd = 0x%x\n", port->sc->unit, port->pnum, cmd); } -static void -disc_optim(tp, t) - struct tty *tp; - struct termios *t; +static void +disc_optim(struct tty *tp, struct termios *t) { if (!(t->c_iflag & (ICRNL | IGNCR | IMAXBEL | INLCR | ISTRIP | IXON)) && (!(t->c_iflag & BRKINT) || (t->c_iflag & IGNBRK)) |