someday I'll get all this correct (sigh)
[unix-history] / usr / src / sys / vax / if / if_dmc.c
/* if_dmc.c 4.27 83/06/12 */
#include "dmc.h"
#if NDMC > 0
#define printd if(dmcdebug)printf
int dmcdebug = 0;
/*
* DMC11 device driver, internet version
*
* TODO
* allow more than one outstanding read or write.
*
* UNTESTED WITH 4.2
*/
#include "../machine/pte.h"
#include "../h/param.h"
#include "../h/systm.h"
#include "../h/mbuf.h"
#include "../h/buf.h"
#include "../h/tty.h"
#include "../h/protosw.h"
#include "../h/socket.h"
#include "../h/vmmac.h"
#include "../h/ioctl.h"
#include "../h/errno.h"
#include "../net/if.h"
#include "../net/netisr.h"
#include "../net/route.h"
#include "../netinet/in.h"
#include "../netinet/in_systm.h"
#include "../vax/cpu.h"
#include "../vax/mtpr.h"
#include "../vaxif/if_uba.h"
#include "../vaxif/if_dmc.h"
#include "../vaxuba/ubareg.h"
#include "../vaxuba/ubavar.h"
#ifndef DMC_USEMAINT
#define DMC_USEMAINT 1 /* use maintenance mode */
#endif
/*
* Driver information for auto-configuration stuff.
*/
int dmcprobe(), dmcattach(), dmcinit(), dmcioctl();
int dmcoutput(), dmcreset();
struct uba_device *dmcinfo[NDMC];
u_short dmcstd[] = { 0 };
struct uba_driver dmcdriver =
{ dmcprobe, 0, dmcattach, 0, dmcstd, "dmc", dmcinfo };
/*
* DMC software status per interface.
*
* Each interface is referenced by a network interface structure,
* sc_if, which the routing code uses to locate the interface.
* This structure contains the output queue for the interface, its address, ...
* We also have, for each interface, a UBA interface structure, which
* contains information about the UNIBUS resources held by the interface:
* map registers, buffered data paths, etc. Information is cached in this
* structure for use by the if_uba.c routines in running the interface
* efficiently.
*/
struct dmc_softc {
struct ifnet sc_if; /* network-visible interface */
struct ifuba sc_ifuba; /* UNIBUS resources */
short sc_flag; /* flags */
short sc_oactive; /* output active */
int sc_ubinfo; /* UBA mapping info for base table */
struct clist sc_que; /* command queue */
} dmc_softc[NDMC];
/* flags */
#define DMCRUN 01
#define DMCBMAPPED 02 /* base table mapped */
struct dmc_base {
short d_base[128]; /* DMC base table */
} dmc_base[NDMC];
#define loword(x) ((short *)&x)[0]
#define hiword(x) ((short *)&x)[1]
dmcprobe(reg)
caddr_t reg;
{
register int br, cvec;
register struct dmcdevice *addr = (struct dmcdevice *)reg;
register int i;
#ifdef lint
br = 0; cvec = br; br = cvec;
dmcrint(0); dmcxint(0);
#endif
addr->bsel1 = DMC_MCLR;
for (i = 100000; i && (addr->bsel1 & DMC_RUN) == 0; i--)
;
if ((addr->bsel1 & DMC_RUN) == 0)
return (0);
addr->bsel1 &= ~DMC_MCLR;
addr->bsel0 = DMC_RQI|DMC_IEI;
DELAY(100000);
addr->bsel1 = DMC_MCLR;
for (i = 100000; i && (addr->bsel1 & DMC_RUN) == 0; i--)
;
#ifdef ECHACK
br = 0x16;
#endif
return (1);
}
/*
* Interface exists: make available by filling in network interface
* record. System will initialize the interface when it is ready
* to accept packets.
*/
dmcattach(ui)
register struct uba_device *ui;
{
register struct dmc_softc *sc = &dmc_softc[ui->ui_unit];
sc->sc_if.if_unit = ui->ui_unit;
sc->sc_if.if_name = "dmc";
sc->sc_if.if_mtu = DMCMTU;
sc->sc_if.if_init = dmcinit;
sc->sc_if.if_output = dmcoutput;
sc->sc_if.if_ioctl = dmcioctl;
sc->sc_if.if_reset = dmcreset;
/* DON'T KNOW IF THIS WILL WORK WITH A BDP AT HIGH SPEEDS */
sc->sc_ifuba.ifu_flags = UBA_NEEDBDP | UBA_CANTWAIT;
if_attach(&sc->sc_if);
}
/*
* Reset of interface after UNIBUS reset.
* If interface is on specified UBA, reset it's state.
*/
dmcreset(unit, uban)
int unit, uban;
{
register struct uba_device *ui;
if (unit >= NDMC || (ui = dmcinfo[unit]) == 0 || ui->ui_alive == 0 ||
ui->ui_ubanum != uban)
return;
printf(" dmc%d", unit);
dmcinit(unit);
}
/*
* Initialization of interface; reinitialize UNIBUS usage.
*/
dmcinit(unit)
int unit;
{
register struct dmc_softc *sc = &dmc_softc[unit];
register struct uba_device *ui = dmcinfo[unit];
register struct dmcdevice *addr;
register struct ifnet *ifp = &sc->sc_if;
struct sockaddr_in *sin;
int base;
printd("dmcinit\n");
sin = (struct sockaddr_in *)&ifp->if_addr;
if (sin->sin_addr.s_addr == 0)
return;
if ((ifp->if_flags & IFF_RUNNING) == 0) {
if ((sc->sc_flag&DMCBMAPPED) == 0) {
sc->sc_ubinfo = uballoc(ui->ui_ubanum,
(caddr_t)&dmc_base[unit],
sizeof (struct dmc_base), 0);
sc->sc_flag |= DMCBMAPPED;
}
if (if_ubainit(&sc->sc_ifuba, ui->ui_ubanum, 0,
(int)btoc(DMCMTU)) == 0) {
printf("dmc%d: can't initialize\n", unit);
ifp->if_flags &= ~IFF_UP;
return;
}
addr = (struct dmcdevice *)ui->ui_addr;
addr->bsel2 |= DMC_IEO;
base = sc->sc_ubinfo & 0x3ffff;
printd(" base 0x%x\n", base);
dmcload(sc, DMC_BASEI, base, (base>>2)&DMC_XMEM);
dmcload(sc, DMC_CNTLI, 0, DMC_USEMAINT ? DMC_MAINT : 0);
base = sc->sc_ifuba.ifu_r.ifrw_info & 0x3ffff;
dmcload(sc, DMC_READ, base, ((base>>2)&DMC_XMEM)|DMCMTU);
printd(" first read queued, addr 0x%x\n", base);
ifp->if_flags |= IFF_UP|IFF_RUNNING;
}
/* set up routing table entry */
if ((ifp->if_flags & IFF_ROUTE) == 0) {
rtinit(sin, sin, RTF_HOST|RTF_UP);
ifp->if_flags |= IFF_ROUTE;
}
}
/*
* Start output on interface. Get another datagram
* to send from the interface queue and map it to
* the interface before starting output.
*/
dmcstart(dev)
dev_t dev;
{
int unit = minor(dev);
register struct dmc_softc *sc = &dmc_softc[unit];
int addr, len;
struct mbuf *m;
printd("dmcstart\n");
/*
* Dequeue a request and map it to the UNIBUS.
* If no more requests, just return.
*/
IF_DEQUEUE(&sc->sc_if.if_snd, m);
if (m == 0)
return;
len = if_wubaput(&sc->sc_ifuba, m);
/*
* Have request mapped to UNIBUS for transmission.
* Purge any stale data from this BDP and start the output.
*/
if (sc->sc_ifuba.ifu_flags & UBA_NEEDBDP)
UBAPURGE(sc->sc_ifuba.ifu_uba, sc->sc_ifuba.ifu_w.ifrw_bdp);
addr = sc->sc_ifuba.ifu_w.ifrw_info & 0x3ffff;
printd(" len %d, addr 0x%x, ", len, addr);
printd("mr 0x%x\n", sc->sc_ifuba.ifu_w.ifrw_mr[0]);
dmcload(sc, DMC_WRITE, addr, (len&DMC_CCOUNT)|((addr>>2)&DMC_XMEM));
sc->sc_oactive = 1;
}
/*
* Utility routine to load the DMC device registers.
*/
dmcload(sc, type, w0, w1)
register struct dmc_softc *sc;
int type, w0, w1;
{
register struct dmcdevice *addr;
register int unit, sps, n;
printd("dmcload: 0x%x 0x%x 0x%x\n", type, w0, w1);
unit = sc - dmc_softc;
addr = (struct dmcdevice *)dmcinfo[unit]->ui_addr;
sps = spl5();
if ((n = sc->sc_que.c_cc) == 0)
addr->bsel0 = type | DMC_RQI;
else
(void) putc(type | DMC_RQI, &sc->sc_que);
(void) putw(w0, &sc->sc_que);
(void) putw(w1, &sc->sc_que);
if (n == 0)
dmcrint(unit);
splx(sps);
}
/*
* DMC interface receiver interrupt.
* Ready to accept another command,
* pull one off the command queue.
*/
dmcrint(unit)
int unit;
{
register struct dmc_softc *sc;
register struct dmcdevice *addr;
register int n;
addr = (struct dmcdevice *)dmcinfo[unit]->ui_addr;
sc = &dmc_softc[unit];
while (addr->bsel0&DMC_RDYI) {
addr->sel4 = getw(&sc->sc_que);
addr->sel6 = getw(&sc->sc_que);
addr->bsel0 &= ~(DMC_IEI|DMC_RQI);
while (addr->bsel0&DMC_RDYI)
;
if (sc->sc_que.c_cc == 0)
goto out;
addr->bsel0 = getc(&sc->sc_que);
n = RDYSCAN;
while (n-- && (addr->bsel0&DMC_RDYI) == 0)
;
}
if (sc->sc_que.c_cc)
addr->bsel0 |= DMC_IEI;
out:
dmcxint(unit);
}
/*
* DMC interface transmitter interrupt.
* A transfer has completed, check for errors.
* If it was a read, notify appropriate protocol.
* If it was a write, pull the next one off the queue.
*/
dmcxint(unit)
int unit;
{
register struct dmc_softc *sc;
struct uba_device *ui = dmcinfo[unit];
struct dmcdevice *addr;
struct mbuf *m;
register struct ifqueue *inq;
int arg, arg2, cmd, len;
addr = (struct dmcdevice *)ui->ui_addr;
cmd = addr->bsel2 & 0xff;
if ((cmd & DMC_RDYO) == 0)
return;
arg2 = addr->sel4;
arg = addr->sel6;
addr->bsel2 &= ~DMC_RDYO;
sc = &dmc_softc[unit];
printd("dmcxint\n");
switch (cmd & 07) {
case DMC_OUR:
/*
* A read has completed. Purge input buffered
* data path. Pass packet to type specific
* higher-level input routine.
*/
sc->sc_if.if_ipackets++;
if (sc->sc_ifuba.ifu_flags & UBA_NEEDBDP)
UBAPURGE(sc->sc_ifuba.ifu_uba,
sc->sc_ifuba.ifu_r.ifrw_bdp);
len = arg & DMC_CCOUNT;
printd(" read done, len %d\n", len);
switch (ui->ui_flags & DMC_AF) {
#ifdef INET
case AF_INET:
schednetisr(NETISR_IP);
inq = &ipintrq;
break;
#endif
default:
printf("dmc%d: unknown address type %d\n", unit,
ui->ui_flags & DMC_AF);
goto setup;
}
m = if_rubaget(&sc->sc_ifuba, len, 0);
if (m == 0)
goto setup;
if (IF_QFULL(inq)) {
IF_DROP(inq);
m_freem(m);
} else
IF_ENQUEUE(inq, m);
setup:
arg = sc->sc_ifuba.ifu_r.ifrw_info & 0x3ffff;
dmcload(sc, DMC_READ, arg, ((arg >> 2) & DMC_XMEM) | DMCMTU);
return;
case DMC_OUX:
/*
* A write has completed, start another
* transfer if there is more data to send.
*/
if (sc->sc_oactive == 0)
return; /* SHOULD IT BE A FATAL ERROR? */
printd(" write done\n");
sc->sc_if.if_opackets++;
sc->sc_oactive = 0;
if (sc->sc_ifuba.ifu_xtofree) {
m_freem(sc->sc_ifuba.ifu_xtofree);
sc->sc_ifuba.ifu_xtofree = 0;
}
if (sc->sc_if.if_snd.ifq_head == 0)
return;
dmcstart(unit);
return;
case DMC_CNTLO:
arg &= DMC_CNTMASK;
if (arg&DMC_FATAL) {
addr->bsel1 = DMC_MCLR;
sc->sc_flag &= ~DMCRUN;
/*** DO SOMETHING TO RESTART DEVICE ***/
printf("DMC FATAL ERROR 0%o\n", arg);
} else {
/* ACCUMULATE STATISTICS */
printf("DMC SOFT ERROR 0%o\n", arg);
}
return;
default:
printf("dmc%d: bad control %o\n", unit, cmd);
}
}
/*
* DMC output routine.
* Just send the data, header was supplied by
* upper level protocol routines.
*/
dmcoutput(ifp, m, dst)
register struct ifnet *ifp;
register struct mbuf *m;
struct sockaddr *dst;
{
struct uba_device *ui = dmcinfo[ifp->if_unit];
int s;
printd("dmcoutput\n");
if (dst->sa_family != (ui->ui_flags & DMC_AF)) {
printf("dmc%d: af%d not supported\n", ifp->if_unit,
dst->sa_family);
m_freem(m);
return (EAFNOSUPPORT);
}
s = splimp();
if (IF_QFULL(&ifp->if_snd)) {
IF_DROP(&ifp->if_snd);
m_freem(m);
splx(s);
return (ENOBUFS);
}
IF_ENQUEUE(&ifp->if_snd, m);
if (dmc_softc[ifp->if_unit].sc_oactive == 0)
dmcstart(ifp->if_unit);
splx(s);
return (0);
}
/*
* Process an ioctl request.
*/
dmcioctl(ifp, cmd, data)
register struct ifnet *ifp;
int cmd;
caddr_t data;
{
struct ifreq *ifr = (struct ifreq *)data;
struct sockaddr_in *sin;
int s = splimp(), error = 0;
switch (cmd) {
case SIOCSIFADDR:
if (ifp->if_flags & IFF_RUNNING)
if_rtinit(ifp, -1); /* delete previous route */
sin = (struct sockaddr_in *)&ifr->ifr_addr;
ifp->if_addr = *sin;
ifp->if_net = in_netof(sin->sin_addr);
ifp->if_host[0] = in_lnaof(sin->sin_addr);
dmcinit(ifp->if_unit);
break;
case SIOCSIFDSTADDR:
ifp->if_dstaddr = ifr->ifr_dstaddr;
break;
default:
error = EINVAL;
}
splx(s);
return (error);
}