Home | History | Annotate | Line # | Download | only in qbus
if_dmc.c revision 1.3
      1  1.3  itojun /*	$NetBSD: if_dmc.c,v 1.3 2002/03/05 04:12:59 itojun Exp $	*/
      2  1.1   ragge /*
      3  1.1   ragge  * Copyright (c) 1982, 1986 Regents of the University of California.
      4  1.1   ragge  * All rights reserved.
      5  1.1   ragge  *
      6  1.1   ragge  * Redistribution and use in source and binary forms, with or without
      7  1.1   ragge  * modification, are permitted provided that the following conditions
      8  1.1   ragge  * are met:
      9  1.1   ragge  * 1. Redistributions of source code must retain the above copyright
     10  1.1   ragge  *    notice, this list of conditions and the following disclaimer.
     11  1.1   ragge  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1   ragge  *    notice, this list of conditions and the following disclaimer in the
     13  1.1   ragge  *    documentation and/or other materials provided with the distribution.
     14  1.1   ragge  * 3. All advertising materials mentioning features or use of this software
     15  1.1   ragge  *    must display the following acknowledgement:
     16  1.1   ragge  *	This product includes software developed by the University of
     17  1.1   ragge  *	California, Berkeley and its contributors.
     18  1.1   ragge  * 4. Neither the name of the University nor the names of its contributors
     19  1.1   ragge  *    may be used to endorse or promote products derived from this software
     20  1.1   ragge  *    without specific prior written permission.
     21  1.1   ragge  *
     22  1.1   ragge  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     23  1.1   ragge  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     24  1.1   ragge  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     25  1.1   ragge  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     26  1.1   ragge  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     27  1.1   ragge  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     28  1.1   ragge  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     29  1.1   ragge  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     30  1.1   ragge  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     31  1.1   ragge  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     32  1.1   ragge  * SUCH DAMAGE.
     33  1.1   ragge  *
     34  1.1   ragge  *	@(#)if_dmc.c	7.10 (Berkeley) 12/16/90
     35  1.1   ragge  */
     36  1.1   ragge 
     37  1.1   ragge /*
     38  1.1   ragge  * DMC11 device driver, internet version
     39  1.1   ragge  *
     40  1.1   ragge  *	Bill Nesheim
     41  1.1   ragge  *	Cornell University
     42  1.1   ragge  *
     43  1.1   ragge  *	Lou Salkind
     44  1.1   ragge  *	New York University
     45  1.1   ragge  */
     46  1.2   lukem 
     47  1.2   lukem #include <sys/cdefs.h>
     48  1.3  itojun __KERNEL_RCSID(0, "$NetBSD: if_dmc.c,v 1.3 2002/03/05 04:12:59 itojun Exp $");
     49  1.1   ragge 
     50  1.1   ragge #undef DMCDEBUG	/* for base table dump on fatal error */
     51  1.1   ragge 
     52  1.1   ragge #include "opt_inet.h"
     53  1.1   ragge 
     54  1.1   ragge #include <sys/param.h>
     55  1.1   ragge #include <sys/systm.h>
     56  1.1   ragge #include <sys/mbuf.h>
     57  1.1   ragge #include <sys/ioctl.h>
     58  1.1   ragge #include <sys/socket.h>
     59  1.1   ragge #include <sys/syslog.h>
     60  1.1   ragge #include <sys/device.h>
     61  1.1   ragge 
     62  1.1   ragge #include <net/if.h>
     63  1.1   ragge #include <net/netisr.h>
     64  1.1   ragge 
     65  1.1   ragge #ifdef	INET
     66  1.1   ragge #include <netinet/in.h>
     67  1.1   ragge #include <netinet/in_var.h>
     68  1.1   ragge #endif
     69  1.1   ragge 
     70  1.1   ragge #include <machine/bus.h>
     71  1.1   ragge 
     72  1.1   ragge #include <dev/qbus/ubareg.h>
     73  1.1   ragge #include <dev/qbus/ubavar.h>
     74  1.1   ragge #include <dev/qbus/if_uba.h>
     75  1.1   ragge 
     76  1.1   ragge #include <dev/qbus/if_dmcreg.h>
     77  1.1   ragge 
     78  1.1   ragge 
     79  1.1   ragge /*
     80  1.1   ragge  * output timeout value, sec.; should depend on line speed.
     81  1.1   ragge  */
     82  1.1   ragge static int dmc_timeout = 20;
     83  1.1   ragge 
     84  1.1   ragge #define NRCV 7
     85  1.1   ragge #define NXMT 3
     86  1.1   ragge #define NCMDS	(NRCV+NXMT+4)	/* size of command queue */
     87  1.1   ragge 
     88  1.1   ragge #define DMC_WBYTE(csr, val) \
     89  1.1   ragge 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, csr, val)
     90  1.1   ragge #define DMC_WWORD(csr, val) \
     91  1.1   ragge 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, csr, val)
     92  1.1   ragge #define DMC_RBYTE(csr) \
     93  1.1   ragge 	bus_space_read_1(sc->sc_iot, sc->sc_ioh, csr)
     94  1.1   ragge #define DMC_RWORD(csr) \
     95  1.1   ragge 	bus_space_read_2(sc->sc_iot, sc->sc_ioh, csr)
     96  1.1   ragge 
     97  1.1   ragge 
     98  1.1   ragge #ifdef DMCDEBUG
     99  1.1   ragge #define printd if(dmcdebug)printf
    100  1.1   ragge int dmcdebug = 0;
    101  1.1   ragge #endif
    102  1.1   ragge 
    103  1.1   ragge /* error reporting intervals */
    104  1.1   ragge #define DMC_RPNBFS	50
    105  1.1   ragge #define DMC_RPDSC	1
    106  1.1   ragge #define DMC_RPTMO	10
    107  1.1   ragge #define DMC_RPDCK	10
    108  1.1   ragge 
    109  1.1   ragge struct  dmc_command {
    110  1.1   ragge 	char	qp_cmd;		/* command */
    111  1.1   ragge 	short	qp_ubaddr;	/* buffer address */
    112  1.1   ragge 	short	qp_cc;		/* character count || XMEM */
    113  1.1   ragge 	struct	dmc_command *qp_next;	/* next command on queue */
    114  1.1   ragge };
    115  1.1   ragge 
    116  1.1   ragge struct dmcbufs {
    117  1.1   ragge 	int	ubinfo;		/* from uballoc */
    118  1.1   ragge 	short	cc;		/* buffer size */
    119  1.1   ragge 	short	flags;		/* access control */
    120  1.1   ragge };
    121  1.1   ragge #define	DBUF_OURS	0	/* buffer is available */
    122  1.1   ragge #define	DBUF_DMCS	1	/* buffer claimed by somebody */
    123  1.1   ragge #define	DBUF_XMIT	4	/* transmit buffer */
    124  1.1   ragge #define	DBUF_RCV	8	/* receive buffer */
    125  1.1   ragge 
    126  1.1   ragge 
    127  1.1   ragge /*
    128  1.1   ragge  * DMC software status per interface.
    129  1.1   ragge  *
    130  1.1   ragge  * Each interface is referenced by a network interface structure,
    131  1.1   ragge  * sc_if, which the routing code uses to locate the interface.
    132  1.1   ragge  * This structure contains the output queue for the interface, its address, ...
    133  1.1   ragge  * We also have, for each interface, a  set of 7 UBA interface structures
    134  1.1   ragge  * for each, which
    135  1.1   ragge  * contain information about the UNIBUS resources held by the interface:
    136  1.1   ragge  * map registers, buffered data paths, etc.  Information is cached in this
    137  1.1   ragge  * structure for use by the if_uba.c routines in running the interface
    138  1.1   ragge  * efficiently.
    139  1.1   ragge  */
    140  1.1   ragge struct dmc_softc {
    141  1.1   ragge 	struct	device sc_dev;		/* Configuration common part */
    142  1.1   ragge 	struct	ifnet sc_if;		/* network-visible interface */
    143  1.1   ragge 	short	sc_oused;		/* output buffers currently in use */
    144  1.1   ragge 	short	sc_iused;		/* input buffers given to DMC */
    145  1.1   ragge 	short	sc_flag;		/* flags */
    146  1.1   ragge 	struct	ubinfo sc_ui;		/* UBA mapping info for base table */
    147  1.1   ragge 	int	sc_errors[4];		/* non-fatal error counters */
    148  1.1   ragge 	bus_space_tag_t sc_iot;
    149  1.1   ragge 	bus_addr_t sc_ioh;
    150  1.1   ragge 	bus_dma_tag_t sc_dmat;
    151  1.1   ragge 	struct	evcnt sc_rintrcnt;	/* Interrupt counting */
    152  1.1   ragge 	struct	evcnt sc_tintrcnt;	/* Interrupt counting */
    153  1.1   ragge #define sc_datck sc_errors[0]
    154  1.1   ragge #define sc_timeo sc_errors[1]
    155  1.1   ragge #define sc_nobuf sc_errors[2]
    156  1.1   ragge #define sc_disc  sc_errors[3]
    157  1.1   ragge 	struct	dmcbufs sc_rbufs[NRCV];	/* receive buffer info */
    158  1.1   ragge 	struct	dmcbufs sc_xbufs[NXMT];	/* transmit buffer info */
    159  1.1   ragge 	struct	ifubinfo sc_ifuba;	/* UNIBUS resources */
    160  1.1   ragge 	struct	ifrw sc_ifr[NRCV];	/* UNIBUS receive buffer maps */
    161  1.1   ragge 	struct	ifxmt sc_ifw[NXMT];	/* UNIBUS receive buffer maps */
    162  1.1   ragge 	/* command queue stuff */
    163  1.1   ragge 	struct	dmc_command sc_cmdbuf[NCMDS];
    164  1.1   ragge 	struct	dmc_command *sc_qhead;	/* head of command queue */
    165  1.1   ragge 	struct	dmc_command *sc_qtail;	/* tail of command queue */
    166  1.1   ragge 	struct	dmc_command *sc_qactive;	/* command in progress */
    167  1.1   ragge 	struct	dmc_command *sc_qfreeh;	/* head of list of free cmd buffers */
    168  1.1   ragge 	struct	dmc_command *sc_qfreet;	/* tail of list of free cmd buffers */
    169  1.1   ragge 	/* end command queue stuff */
    170  1.1   ragge 	struct dmc_base {
    171  1.1   ragge 		short	d_base[128];		/* DMC base table */
    172  1.1   ragge 	} dmc_base;
    173  1.1   ragge };
    174  1.1   ragge 
    175  1.1   ragge static  int dmcmatch(struct device *, struct cfdata *, void *);
    176  1.1   ragge static  void dmcattach(struct device *, struct device *, void *);
    177  1.1   ragge static  int dmcinit(struct ifnet *);
    178  1.1   ragge static  void dmcrint(void *);
    179  1.1   ragge static  void dmcxint(void *);
    180  1.1   ragge static  void dmcdown(struct dmc_softc *sc);
    181  1.1   ragge static  void dmcrestart(struct dmc_softc *);
    182  1.1   ragge static  void dmcload(struct dmc_softc *, int, u_short, u_short);
    183  1.1   ragge static  void dmcstart(struct ifnet *);
    184  1.1   ragge static  void dmctimeout(struct ifnet *);
    185  1.1   ragge static  int dmcioctl(struct ifnet *, u_long, caddr_t);
    186  1.1   ragge static  int dmcoutput(struct ifnet *, struct mbuf *, struct sockaddr *,
    187  1.1   ragge 	struct rtentry *);
    188  1.1   ragge static  void dmcreset(struct device *);
    189  1.1   ragge 
    190  1.1   ragge struct	cfattach dmc_ca = {
    191  1.1   ragge 	sizeof(struct dmc_softc), dmcmatch, dmcattach
    192  1.1   ragge };
    193  1.1   ragge 
    194  1.1   ragge /* flags */
    195  1.1   ragge #define DMC_RUNNING	0x01		/* device initialized */
    196  1.1   ragge #define DMC_BMAPPED	0x02		/* base table mapped */
    197  1.1   ragge #define DMC_RESTART	0x04		/* software restart in progress */
    198  1.1   ragge #define DMC_ONLINE	0x08		/* device running (had a RDYO) */
    199  1.1   ragge 
    200  1.1   ragge 
    201  1.1   ragge /* queue manipulation macros */
    202  1.1   ragge #define	QUEUE_AT_HEAD(qp, head, tail) \
    203  1.1   ragge 	(qp)->qp_next = (head); \
    204  1.1   ragge 	(head) = (qp); \
    205  1.1   ragge 	if ((tail) == (struct dmc_command *) 0) \
    206  1.1   ragge 		(tail) = (head)
    207  1.1   ragge 
    208  1.1   ragge #define QUEUE_AT_TAIL(qp, head, tail) \
    209  1.1   ragge 	if ((tail)) \
    210  1.1   ragge 		(tail)->qp_next = (qp); \
    211  1.1   ragge 	else \
    212  1.1   ragge 		(head) = (qp); \
    213  1.1   ragge 	(qp)->qp_next = (struct dmc_command *) 0; \
    214  1.1   ragge 	(tail) = (qp)
    215  1.1   ragge 
    216  1.1   ragge #define DEQUEUE(head, tail) \
    217  1.1   ragge 	(head) = (head)->qp_next;\
    218  1.1   ragge 	if ((head) == (struct dmc_command *) 0)\
    219  1.1   ragge 		(tail) = (head)
    220  1.1   ragge 
    221  1.1   ragge int
    222  1.1   ragge dmcmatch(struct device *parent, struct cfdata *cf, void *aux)
    223  1.1   ragge {
    224  1.1   ragge 	struct uba_attach_args *ua = aux;
    225  1.1   ragge 	struct dmc_softc ssc;
    226  1.1   ragge 	struct dmc_softc *sc = &ssc;
    227  1.1   ragge 	int i;
    228  1.1   ragge 
    229  1.1   ragge 	sc->sc_iot = ua->ua_iot;
    230  1.1   ragge 	sc->sc_ioh = ua->ua_ioh;
    231  1.1   ragge 
    232  1.1   ragge 	DMC_WBYTE(DMC_BSEL1, DMC_MCLR);
    233  1.1   ragge 	for (i = 100000; i && (DMC_RBYTE(DMC_BSEL1) & DMC_RUN) == 0; i--)
    234  1.1   ragge 		;
    235  1.1   ragge 	if ((DMC_RBYTE(DMC_BSEL1) & DMC_RUN) == 0) {
    236  1.1   ragge 		printf("dmcprobe: can't start device\n" );
    237  1.1   ragge 		return (0);
    238  1.1   ragge 	}
    239  1.1   ragge 	DMC_WBYTE(DMC_BSEL0, DMC_RQI|DMC_IEI);
    240  1.1   ragge 	/* let's be paranoid */
    241  1.1   ragge 	DMC_WBYTE(DMC_BSEL0, DMC_RBYTE(DMC_BSEL0) | DMC_RQI|DMC_IEI);
    242  1.1   ragge 	DELAY(1000000);
    243  1.1   ragge 	DMC_WBYTE(DMC_BSEL1, DMC_MCLR);
    244  1.1   ragge 	for (i = 100000; i && (DMC_RBYTE(DMC_BSEL1) & DMC_RUN) == 0; i--)
    245  1.1   ragge 		;
    246  1.1   ragge 	return (1);
    247  1.1   ragge }
    248  1.1   ragge 
    249  1.1   ragge /*
    250  1.1   ragge  * Interface exists: make available by filling in network interface
    251  1.1   ragge  * record.  System will initialize the interface when it is ready
    252  1.1   ragge  * to accept packets.
    253  1.1   ragge  */
    254  1.1   ragge void
    255  1.1   ragge dmcattach(struct device *parent, struct device *self, void *aux)
    256  1.1   ragge {
    257  1.1   ragge 	struct uba_attach_args *ua = aux;
    258  1.1   ragge 	struct dmc_softc *sc = (struct dmc_softc *)self;
    259  1.1   ragge 
    260  1.1   ragge 	sc->sc_iot = ua->ua_iot;
    261  1.1   ragge 	sc->sc_ioh = ua->ua_ioh;
    262  1.1   ragge 	sc->sc_dmat = ua->ua_dmat;
    263  1.1   ragge 
    264  1.1   ragge 	strcpy(sc->sc_if.if_xname, sc->sc_dev.dv_xname);
    265  1.1   ragge 	sc->sc_if.if_mtu = DMCMTU;
    266  1.1   ragge 	sc->sc_if.if_init = dmcinit;
    267  1.1   ragge 	sc->sc_if.if_output = dmcoutput;
    268  1.1   ragge 	sc->sc_if.if_ioctl = dmcioctl;
    269  1.1   ragge 	sc->sc_if.if_watchdog = dmctimeout;
    270  1.1   ragge 	sc->sc_if.if_flags = IFF_POINTOPOINT;
    271  1.1   ragge 	sc->sc_if.if_softc = sc;
    272  1.3  itojun 	IFQ_SET_READY(&sc->sc_if.if_snd);
    273  1.1   ragge 
    274  1.1   ragge 	uba_intr_establish(ua->ua_icookie, ua->ua_cvec, dmcrint, sc,
    275  1.1   ragge 	    &sc->sc_rintrcnt);
    276  1.1   ragge 	uba_intr_establish(ua->ua_icookie, ua->ua_cvec+4, dmcxint, sc,
    277  1.1   ragge 	    &sc->sc_tintrcnt);
    278  1.1   ragge 	uba_reset_establish(dmcreset, &sc->sc_dev);
    279  1.1   ragge 	evcnt_attach_dynamic(&sc->sc_rintrcnt, EVCNT_TYPE_INTR, ua->ua_evcnt,
    280  1.1   ragge 	    sc->sc_dev.dv_xname, "intr");
    281  1.1   ragge 	evcnt_attach_dynamic(&sc->sc_tintrcnt, EVCNT_TYPE_INTR, ua->ua_evcnt,
    282  1.1   ragge 	    sc->sc_dev.dv_xname, "intr");
    283  1.1   ragge 
    284  1.1   ragge 	if_attach(&sc->sc_if);
    285  1.1   ragge }
    286  1.1   ragge 
    287  1.1   ragge /*
    288  1.1   ragge  * Reset of interface after UNIBUS reset.
    289  1.1   ragge  * If interface is on specified UBA, reset its state.
    290  1.1   ragge  */
    291  1.1   ragge void
    292  1.1   ragge dmcreset(struct device *dev)
    293  1.1   ragge {
    294  1.1   ragge 	struct dmc_softc *sc = (struct dmc_softc *)dev;
    295  1.1   ragge 
    296  1.1   ragge 	sc->sc_flag = 0;
    297  1.1   ragge 	sc->sc_if.if_flags &= ~IFF_RUNNING;
    298  1.1   ragge 	dmcinit(&sc->sc_if);
    299  1.1   ragge }
    300  1.1   ragge 
    301  1.1   ragge /*
    302  1.1   ragge  * Initialization of interface; reinitialize UNIBUS usage.
    303  1.1   ragge  */
    304  1.1   ragge int
    305  1.1   ragge dmcinit(struct ifnet *ifp)
    306  1.1   ragge {
    307  1.1   ragge 	struct dmc_softc *sc = ifp->if_softc;
    308  1.1   ragge 	struct ifrw *ifrw;
    309  1.1   ragge 	struct ifxmt *ifxp;
    310  1.1   ragge 	struct dmcbufs *rp;
    311  1.1   ragge 	struct dmc_command *qp;
    312  1.1   ragge 	struct ifaddr *ifa;
    313  1.1   ragge 	struct cfdata *ui = sc->sc_dev.dv_cfdata;
    314  1.1   ragge 	int base;
    315  1.1   ragge 	int s;
    316  1.1   ragge 
    317  1.1   ragge 	/*
    318  1.1   ragge 	 * Check to see that an address has been set
    319  1.1   ragge 	 * (both local and destination for an address family).
    320  1.1   ragge 	 */
    321  1.1   ragge 	TAILQ_FOREACH(ifa, &ifp->if_addrlist, ifa_list)
    322  1.1   ragge 		if (ifa->ifa_addr->sa_family && ifa->ifa_dstaddr->sa_family)
    323  1.1   ragge 			break;
    324  1.1   ragge 	if (ifa == (struct ifaddr *) 0)
    325  1.1   ragge 		return 0;
    326  1.1   ragge 
    327  1.1   ragge 	if ((DMC_RBYTE(DMC_BSEL1) & DMC_RUN) == 0) {
    328  1.1   ragge 		printf("dmcinit: DMC not running\n");
    329  1.1   ragge 		ifp->if_flags &= ~IFF_UP;
    330  1.1   ragge 		return 0;
    331  1.1   ragge 	}
    332  1.1   ragge 	/* map base table */
    333  1.1   ragge 	if ((sc->sc_flag & DMC_BMAPPED) == 0) {
    334  1.1   ragge 		sc->sc_ui.ui_size = sizeof(struct dmc_base);
    335  1.1   ragge 		sc->sc_ui.ui_vaddr = (caddr_t)&sc->dmc_base;
    336  1.1   ragge 		uballoc((void *)sc->sc_dev.dv_parent, &sc->sc_ui, 0);
    337  1.1   ragge 		sc->sc_flag |= DMC_BMAPPED;
    338  1.1   ragge 	}
    339  1.1   ragge 	/* initialize UNIBUS resources */
    340  1.1   ragge 	sc->sc_iused = sc->sc_oused = 0;
    341  1.1   ragge 	if ((ifp->if_flags & IFF_RUNNING) == 0) {
    342  1.1   ragge 		if (if_ubaminit(&sc->sc_ifuba, (void *)sc->sc_dev.dv_parent,
    343  1.1   ragge 		    sizeof(struct dmc_header) + DMCMTU,
    344  1.1   ragge 		    sc->sc_ifr, NRCV, sc->sc_ifw, NXMT) == 0) {
    345  1.1   ragge 			printf("%s: can't allocate uba resources\n",
    346  1.1   ragge 			    sc->sc_dev.dv_xname);
    347  1.1   ragge 			ifp->if_flags &= ~IFF_UP;
    348  1.1   ragge 			return 0;
    349  1.1   ragge 		}
    350  1.1   ragge 		ifp->if_flags |= IFF_RUNNING;
    351  1.1   ragge 	}
    352  1.1   ragge 	sc->sc_flag &= ~DMC_ONLINE;
    353  1.1   ragge 	sc->sc_flag |= DMC_RUNNING;
    354  1.1   ragge 	/*
    355  1.1   ragge 	 * Limit packets enqueued until we see if we're on the air.
    356  1.1   ragge 	 */
    357  1.1   ragge 	ifp->if_snd.ifq_maxlen = 3;
    358  1.1   ragge 
    359  1.1   ragge 	/* initialize buffer pool */
    360  1.1   ragge 	/* receives */
    361  1.1   ragge 	ifrw = &sc->sc_ifr[0];
    362  1.1   ragge 	for (rp = &sc->sc_rbufs[0]; rp < &sc->sc_rbufs[NRCV]; rp++) {
    363  1.1   ragge 		rp->ubinfo = ifrw->ifrw_info;
    364  1.1   ragge 		rp->cc = DMCMTU + sizeof (struct dmc_header);
    365  1.1   ragge 		rp->flags = DBUF_OURS|DBUF_RCV;
    366  1.1   ragge 		ifrw++;
    367  1.1   ragge 	}
    368  1.1   ragge 	/* transmits */
    369  1.1   ragge 	ifxp = &sc->sc_ifw[0];
    370  1.1   ragge 	for (rp = &sc->sc_xbufs[0]; rp < &sc->sc_xbufs[NXMT]; rp++) {
    371  1.1   ragge 		rp->ubinfo = ifxp->ifw_info;
    372  1.1   ragge 		rp->cc = 0;
    373  1.1   ragge 		rp->flags = DBUF_OURS|DBUF_XMIT;
    374  1.1   ragge 		ifxp++;
    375  1.1   ragge 	}
    376  1.1   ragge 
    377  1.1   ragge 	/* set up command queues */
    378  1.1   ragge 	sc->sc_qfreeh = sc->sc_qfreet
    379  1.1   ragge 		 = sc->sc_qhead = sc->sc_qtail = sc->sc_qactive =
    380  1.1   ragge 		(struct dmc_command *)0;
    381  1.1   ragge 	/* set up free command buffer list */
    382  1.1   ragge 	for (qp = &sc->sc_cmdbuf[0]; qp < &sc->sc_cmdbuf[NCMDS]; qp++) {
    383  1.1   ragge 		QUEUE_AT_HEAD(qp, sc->sc_qfreeh, sc->sc_qfreet);
    384  1.1   ragge 	}
    385  1.1   ragge 
    386  1.1   ragge 	/* base in */
    387  1.1   ragge 	base = sc->sc_ui.ui_baddr;
    388  1.1   ragge 	dmcload(sc, DMC_BASEI, (u_short)base, (base>>2) & DMC_XMEM);
    389  1.1   ragge 	/* specify half duplex operation, flags tell if primary */
    390  1.1   ragge 	/* or secondary station */
    391  1.1   ragge 	if (ui->cf_flags == 0)
    392  1.1   ragge 		/* use DDCMP mode in full duplex */
    393  1.1   ragge 		dmcload(sc, DMC_CNTLI, 0, 0);
    394  1.1   ragge 	else if (ui->cf_flags == 1)
    395  1.1   ragge 		/* use MAINTENENCE mode */
    396  1.1   ragge 		dmcload(sc, DMC_CNTLI, 0, DMC_MAINT );
    397  1.1   ragge 	else if (ui->cf_flags == 2)
    398  1.1   ragge 		/* use DDCMP half duplex as primary station */
    399  1.1   ragge 		dmcload(sc, DMC_CNTLI, 0, DMC_HDPLX);
    400  1.1   ragge 	else if (ui->cf_flags == 3)
    401  1.1   ragge 		/* use DDCMP half duplex as secondary station */
    402  1.1   ragge 		dmcload(sc, DMC_CNTLI, 0, DMC_HDPLX | DMC_SEC);
    403  1.1   ragge 
    404  1.1   ragge 	/* enable operation done interrupts */
    405  1.1   ragge 	while ((DMC_RBYTE(DMC_BSEL2) & DMC_IEO) == 0)
    406  1.1   ragge 		DMC_WBYTE(DMC_BSEL2, DMC_RBYTE(DMC_BSEL2) | DMC_IEO);
    407  1.1   ragge 	s = splnet();
    408  1.1   ragge 	/* queue first NRCV buffers for DMC to fill */
    409  1.1   ragge 	for (rp = &sc->sc_rbufs[0]; rp < &sc->sc_rbufs[NRCV]; rp++) {
    410  1.1   ragge 		rp->flags |= DBUF_DMCS;
    411  1.1   ragge 		dmcload(sc, DMC_READ, rp->ubinfo,
    412  1.1   ragge 			(((rp->ubinfo>>2)&DMC_XMEM) | rp->cc));
    413  1.1   ragge 		sc->sc_iused++;
    414  1.1   ragge 	}
    415  1.1   ragge 	splx(s);
    416  1.1   ragge 	return 0;
    417  1.1   ragge }
    418  1.1   ragge 
    419  1.1   ragge /*
    420  1.1   ragge  * Start output on interface.  Get another datagram
    421  1.1   ragge  * to send from the interface queue and map it to
    422  1.1   ragge  * the interface before starting output.
    423  1.1   ragge  *
    424  1.1   ragge  * Must be called at spl 5
    425  1.1   ragge  */
    426  1.1   ragge void
    427  1.1   ragge dmcstart(struct ifnet *ifp)
    428  1.1   ragge {
    429  1.1   ragge 	struct dmc_softc *sc = ifp->if_softc;
    430  1.1   ragge 	struct mbuf *m;
    431  1.1   ragge 	struct dmcbufs *rp;
    432  1.1   ragge 	int n;
    433  1.1   ragge 
    434  1.1   ragge 	/*
    435  1.1   ragge 	 * Dequeue up to NXMT requests and map them to the UNIBUS.
    436  1.1   ragge 	 * If no more requests, or no dmc buffers available, just return.
    437  1.1   ragge 	 */
    438  1.1   ragge 	n = 0;
    439  1.1   ragge 	for (rp = &sc->sc_xbufs[0]; rp < &sc->sc_xbufs[NXMT]; rp++ ) {
    440  1.1   ragge 		/* find an available buffer */
    441  1.1   ragge 		if ((rp->flags & DBUF_DMCS) == 0) {
    442  1.3  itojun 			IFQ_DEQUEUE(&sc->sc_if.if_snd, m);
    443  1.1   ragge 			if (m == 0)
    444  1.1   ragge 				return;
    445  1.1   ragge 			/* mark it dmcs */
    446  1.1   ragge 			rp->flags |= (DBUF_DMCS);
    447  1.1   ragge 			/*
    448  1.1   ragge 			 * Have request mapped to UNIBUS for transmission
    449  1.1   ragge 			 * and start the output.
    450  1.1   ragge 			 */
    451  1.1   ragge 			rp->cc = if_ubaput(&sc->sc_ifuba, &sc->sc_ifw[n], m);
    452  1.1   ragge 			rp->cc &= DMC_CCOUNT;
    453  1.1   ragge 			if (++sc->sc_oused == 1)
    454  1.1   ragge 				sc->sc_if.if_timer = dmc_timeout;
    455  1.1   ragge 			dmcload(sc, DMC_WRITE, rp->ubinfo,
    456  1.1   ragge 				rp->cc | ((rp->ubinfo>>2)&DMC_XMEM));
    457  1.1   ragge 		}
    458  1.1   ragge 		n++;
    459  1.1   ragge 	}
    460  1.1   ragge }
    461  1.1   ragge 
    462  1.1   ragge /*
    463  1.1   ragge  * Utility routine to load the DMC device registers.
    464  1.1   ragge  */
    465  1.1   ragge void
    466  1.1   ragge dmcload(struct dmc_softc *sc, int type, u_short w0, u_short w1)
    467  1.1   ragge {
    468  1.1   ragge 	struct dmc_command *qp;
    469  1.1   ragge 	int sps;
    470  1.1   ragge 
    471  1.1   ragge 	sps = splnet();
    472  1.1   ragge 
    473  1.1   ragge 	/* grab a command buffer from the free list */
    474  1.1   ragge 	if ((qp = sc->sc_qfreeh) == (struct dmc_command *)0)
    475  1.1   ragge 		panic("dmc command queue overflow");
    476  1.1   ragge 	DEQUEUE(sc->sc_qfreeh, sc->sc_qfreet);
    477  1.1   ragge 
    478  1.1   ragge 	/* fill in requested info */
    479  1.1   ragge 	qp->qp_cmd = (type | DMC_RQI);
    480  1.1   ragge 	qp->qp_ubaddr = w0;
    481  1.1   ragge 	qp->qp_cc = w1;
    482  1.1   ragge 
    483  1.1   ragge 	if (sc->sc_qactive) {	/* command in progress */
    484  1.1   ragge 		if (type == DMC_READ) {
    485  1.1   ragge 			QUEUE_AT_HEAD(qp, sc->sc_qhead, sc->sc_qtail);
    486  1.1   ragge 		} else {
    487  1.1   ragge 			QUEUE_AT_TAIL(qp, sc->sc_qhead, sc->sc_qtail);
    488  1.1   ragge 		}
    489  1.1   ragge 	} else {	/* command port free */
    490  1.1   ragge 		sc->sc_qactive = qp;
    491  1.1   ragge 		DMC_WBYTE(DMC_BSEL0, qp->qp_cmd);
    492  1.1   ragge 		dmcrint(sc);
    493  1.1   ragge 	}
    494  1.1   ragge 	splx(sps);
    495  1.1   ragge }
    496  1.1   ragge 
    497  1.1   ragge /*
    498  1.1   ragge  * DMC interface receiver interrupt.
    499  1.1   ragge  * Ready to accept another command,
    500  1.1   ragge  * pull one off the command queue.
    501  1.1   ragge  */
    502  1.1   ragge void
    503  1.1   ragge dmcrint(void *arg)
    504  1.1   ragge {
    505  1.1   ragge 	struct dmc_softc *sc = arg;
    506  1.1   ragge 	struct dmc_command *qp;
    507  1.1   ragge 	int n;
    508  1.1   ragge 
    509  1.1   ragge 	if ((qp = sc->sc_qactive) == (struct dmc_command *) 0) {
    510  1.1   ragge 		printf("%s: dmcrint no command\n", sc->sc_dev.dv_xname);
    511  1.1   ragge 		return;
    512  1.1   ragge 	}
    513  1.1   ragge 	while (DMC_RBYTE(DMC_BSEL0) & DMC_RDYI) {
    514  1.1   ragge 		DMC_WWORD(DMC_SEL4, qp->qp_ubaddr);
    515  1.1   ragge 		DMC_WWORD(DMC_SEL6, qp->qp_cc);
    516  1.1   ragge 		DMC_WBYTE(DMC_BSEL0, DMC_RBYTE(DMC_BSEL0) & ~(DMC_IEI|DMC_RQI));
    517  1.1   ragge 		/* free command buffer */
    518  1.1   ragge 		QUEUE_AT_HEAD(qp, sc->sc_qfreeh, sc->sc_qfreet);
    519  1.1   ragge 		while (DMC_RBYTE(DMC_BSEL0) & DMC_RDYI) {
    520  1.1   ragge 			/*
    521  1.1   ragge 			 * Can't check for RDYO here 'cause
    522  1.1   ragge 			 * this routine isn't reentrant!
    523  1.1   ragge 			 */
    524  1.1   ragge 			DELAY(5);
    525  1.1   ragge 		}
    526  1.1   ragge 		/* move on to next command */
    527  1.1   ragge 		if ((sc->sc_qactive = sc->sc_qhead) == (struct dmc_command *)0)
    528  1.1   ragge 			break;		/* all done */
    529  1.1   ragge 		/* more commands to do, start the next one */
    530  1.1   ragge 		qp = sc->sc_qactive;
    531  1.1   ragge 		DEQUEUE(sc->sc_qhead, sc->sc_qtail);
    532  1.1   ragge 		DMC_WBYTE(DMC_BSEL0, qp->qp_cmd);
    533  1.1   ragge 		n = RDYSCAN;
    534  1.1   ragge 		while (n-- > 0)
    535  1.1   ragge 			if ((DMC_RBYTE(DMC_BSEL0) & DMC_RDYI) ||
    536  1.1   ragge 			    (DMC_RBYTE(DMC_BSEL2) & DMC_RDYO))
    537  1.1   ragge 				break;
    538  1.1   ragge 	}
    539  1.1   ragge 	if (sc->sc_qactive) {
    540  1.1   ragge 		DMC_WBYTE(DMC_BSEL0, DMC_RBYTE(DMC_BSEL0) & (DMC_IEI|DMC_RQI));
    541  1.1   ragge 		/* VMS does it twice !*$%@# */
    542  1.1   ragge 		DMC_WBYTE(DMC_BSEL0, DMC_RBYTE(DMC_BSEL0) & (DMC_IEI|DMC_RQI));
    543  1.1   ragge 	}
    544  1.1   ragge 
    545  1.1   ragge }
    546  1.1   ragge 
    547  1.1   ragge /*
    548  1.1   ragge  * DMC interface transmitter interrupt.
    549  1.1   ragge  * A transfer may have completed, check for errors.
    550  1.1   ragge  * If it was a read, notify appropriate protocol.
    551  1.1   ragge  * If it was a write, pull the next one off the queue.
    552  1.1   ragge  */
    553  1.1   ragge void
    554  1.1   ragge dmcxint(void *a)
    555  1.1   ragge {
    556  1.1   ragge         struct dmc_softc *sc = a;
    557  1.1   ragge 
    558  1.1   ragge 	struct ifnet *ifp;
    559  1.1   ragge 	struct mbuf *m;
    560  1.1   ragge 	struct ifqueue *inq;
    561  1.1   ragge 	int arg, pkaddr, cmd, len, s;
    562  1.1   ragge 	struct ifrw *ifrw;
    563  1.1   ragge 	struct dmcbufs *rp;
    564  1.1   ragge 	struct ifxmt *ifxp;
    565  1.1   ragge 	struct dmc_header *dh;
    566  1.1   ragge 	char buf[64];
    567  1.1   ragge 
    568  1.1   ragge 	ifp = &sc->sc_if;
    569  1.1   ragge 
    570  1.1   ragge 	while (DMC_RBYTE(DMC_BSEL2) & DMC_RDYO) {
    571  1.1   ragge 
    572  1.1   ragge 		cmd = DMC_RBYTE(DMC_BSEL2) & 0xff;
    573  1.1   ragge 		arg = DMC_RWORD(DMC_SEL6) & 0xffff;
    574  1.1   ragge 		/* reconstruct UNIBUS address of buffer returned to us */
    575  1.1   ragge 		pkaddr = ((arg&DMC_XMEM)<<2) | (DMC_RWORD(DMC_SEL4) & 0xffff);
    576  1.1   ragge 		/* release port */
    577  1.1   ragge 		DMC_WBYTE(DMC_BSEL2, DMC_RBYTE(DMC_BSEL2) & ~DMC_RDYO);
    578  1.1   ragge 		switch (cmd & 07) {
    579  1.1   ragge 
    580  1.1   ragge 		case DMC_OUR:
    581  1.1   ragge 			/*
    582  1.1   ragge 			 * A read has completed.
    583  1.1   ragge 			 * Pass packet to type specific
    584  1.1   ragge 			 * higher-level input routine.
    585  1.1   ragge 			 */
    586  1.1   ragge 			ifp->if_ipackets++;
    587  1.1   ragge 			/* find location in dmcuba struct */
    588  1.1   ragge 			ifrw= &sc->sc_ifr[0];
    589  1.1   ragge 			for (rp = &sc->sc_rbufs[0]; rp < &sc->sc_rbufs[NRCV]; rp++) {
    590  1.1   ragge 				if(rp->ubinfo == pkaddr)
    591  1.1   ragge 					break;
    592  1.1   ragge 				ifrw++;
    593  1.1   ragge 			}
    594  1.1   ragge 			if (rp >= &sc->sc_rbufs[NRCV])
    595  1.1   ragge 				panic("dmc rcv");
    596  1.1   ragge 			if ((rp->flags & DBUF_DMCS) == 0)
    597  1.1   ragge 				printf("%s: done unalloc rbuf\n",
    598  1.1   ragge 				    sc->sc_dev.dv_xname);
    599  1.1   ragge 
    600  1.1   ragge 			len = (arg & DMC_CCOUNT) - sizeof (struct dmc_header);
    601  1.1   ragge 			if (len < 0 || len > DMCMTU) {
    602  1.1   ragge 				ifp->if_ierrors++;
    603  1.1   ragge #ifdef DMCDEBUG
    604  1.1   ragge 				printd("%s: bad rcv pkt addr 0x%x len 0x%x\n",
    605  1.1   ragge 				    sc->sc_dev.dv_xname, pkaddr, len);
    606  1.1   ragge #endif
    607  1.1   ragge 				goto setup;
    608  1.1   ragge 			}
    609  1.1   ragge 			/*
    610  1.1   ragge 			 * Deal with trailer protocol: if type is trailer
    611  1.1   ragge 			 * get true type from first 16-bit word past data.
    612  1.1   ragge 			 * Remember that type was trailer by setting off.
    613  1.1   ragge 			 */
    614  1.1   ragge 			dh = (struct dmc_header *)ifrw->ifrw_addr;
    615  1.1   ragge 			dh->dmc_type = ntohs((u_short)dh->dmc_type);
    616  1.1   ragge 			if (len == 0)
    617  1.1   ragge 				goto setup;
    618  1.1   ragge 
    619  1.1   ragge 			/*
    620  1.1   ragge 			 * Pull packet off interface.  Off is nonzero if
    621  1.1   ragge 			 * packet has trailing header; dmc_get will then
    622  1.1   ragge 			 * force this header information to be at the front,
    623  1.1   ragge 			 * but we still have to drop the type and length
    624  1.1   ragge 			 * which are at the front of any trailer data.
    625  1.1   ragge 			 */
    626  1.1   ragge 			m = if_ubaget(&sc->sc_ifuba, ifrw, ifp, len);
    627  1.1   ragge 			if (m == 0)
    628  1.1   ragge 				goto setup;
    629  1.1   ragge 			/* Shave off dmc_header */
    630  1.1   ragge 			m_adj(m, sizeof(struct dmc_header));
    631  1.1   ragge 			switch (dh->dmc_type) {
    632  1.1   ragge 
    633  1.1   ragge #ifdef INET
    634  1.1   ragge 			case DMC_IPTYPE:
    635  1.1   ragge 				schednetisr(NETISR_IP);
    636  1.1   ragge 				inq = &ipintrq;
    637  1.1   ragge 				break;
    638  1.1   ragge #endif
    639  1.1   ragge 			default:
    640  1.1   ragge 				m_freem(m);
    641  1.1   ragge 				goto setup;
    642  1.1   ragge 			}
    643  1.1   ragge 
    644  1.1   ragge 			s = splnet();
    645  1.1   ragge 			if (IF_QFULL(inq)) {
    646  1.1   ragge 				IF_DROP(inq);
    647  1.1   ragge 				m_freem(m);
    648  1.1   ragge 			} else
    649  1.1   ragge 				IF_ENQUEUE(inq, m);
    650  1.1   ragge 			splx(s);
    651  1.1   ragge 
    652  1.1   ragge 	setup:
    653  1.1   ragge 			/* is this needed? */
    654  1.1   ragge 			rp->ubinfo = ifrw->ifrw_info;
    655  1.1   ragge 
    656  1.1   ragge 			dmcload(sc, DMC_READ, rp->ubinfo,
    657  1.1   ragge 			    ((rp->ubinfo >> 2) & DMC_XMEM) | rp->cc);
    658  1.1   ragge 			break;
    659  1.1   ragge 
    660  1.1   ragge 		case DMC_OUX:
    661  1.1   ragge 			/*
    662  1.1   ragge 			 * A write has completed, start another
    663  1.1   ragge 			 * transfer if there is more data to send.
    664  1.1   ragge 			 */
    665  1.1   ragge 			ifp->if_opackets++;
    666  1.1   ragge 			/* find associated dmcbuf structure */
    667  1.1   ragge 			ifxp = &sc->sc_ifw[0];
    668  1.1   ragge 			for (rp = &sc->sc_xbufs[0]; rp < &sc->sc_xbufs[NXMT]; rp++) {
    669  1.1   ragge 				if(rp->ubinfo == pkaddr)
    670  1.1   ragge 					break;
    671  1.1   ragge 				ifxp++;
    672  1.1   ragge 			}
    673  1.1   ragge 			if (rp >= &sc->sc_xbufs[NXMT]) {
    674  1.1   ragge 				printf("%s: bad packet address 0x%x\n",
    675  1.1   ragge 				    sc->sc_dev.dv_xname, pkaddr);
    676  1.1   ragge 				break;
    677  1.1   ragge 			}
    678  1.1   ragge 			if ((rp->flags & DBUF_DMCS) == 0)
    679  1.1   ragge 				printf("%s: unallocated packet 0x%x\n",
    680  1.1   ragge 				    sc->sc_dev.dv_xname, pkaddr);
    681  1.1   ragge 			/* mark buffer free */
    682  1.1   ragge 			if_ubaend(&sc->sc_ifuba, ifxp);
    683  1.1   ragge 			rp->flags &= ~DBUF_DMCS;
    684  1.1   ragge 			if (--sc->sc_oused == 0)
    685  1.1   ragge 				sc->sc_if.if_timer = 0;
    686  1.1   ragge 			else
    687  1.1   ragge 				sc->sc_if.if_timer = dmc_timeout;
    688  1.1   ragge 			if ((sc->sc_flag & DMC_ONLINE) == 0) {
    689  1.1   ragge 				extern int ifqmaxlen;
    690  1.1   ragge 
    691  1.1   ragge 				/*
    692  1.1   ragge 				 * We're on the air.
    693  1.1   ragge 				 * Open the queue to the usual value.
    694  1.1   ragge 				 */
    695  1.1   ragge 				sc->sc_flag |= DMC_ONLINE;
    696  1.1   ragge 				ifp->if_snd.ifq_maxlen = ifqmaxlen;
    697  1.1   ragge 			}
    698  1.1   ragge 			break;
    699  1.1   ragge 
    700  1.1   ragge 		case DMC_CNTLO:
    701  1.1   ragge 			arg &= DMC_CNTMASK;
    702  1.1   ragge 			if (arg & DMC_FATAL) {
    703  1.1   ragge 				if (arg != DMC_START) {
    704  1.1   ragge 					bitmask_snprintf(arg, CNTLO_BITS,
    705  1.1   ragge 					    buf, sizeof(buf));
    706  1.1   ragge 					log(LOG_ERR,
    707  1.1   ragge 					    "%s: fatal error, flags=%s\n",
    708  1.1   ragge 					    sc->sc_dev.dv_xname, buf);
    709  1.1   ragge 				}
    710  1.1   ragge 				dmcrestart(sc);
    711  1.1   ragge 				break;
    712  1.1   ragge 			}
    713  1.1   ragge 			/* ACCUMULATE STATISTICS */
    714  1.1   ragge 			switch(arg) {
    715  1.1   ragge 			case DMC_NOBUFS:
    716  1.1   ragge 				ifp->if_ierrors++;
    717  1.1   ragge 				if ((sc->sc_nobuf++ % DMC_RPNBFS) == 0)
    718  1.1   ragge 					goto report;
    719  1.1   ragge 				break;
    720  1.1   ragge 			case DMC_DISCONN:
    721  1.1   ragge 				if ((sc->sc_disc++ % DMC_RPDSC) == 0)
    722  1.1   ragge 					goto report;
    723  1.1   ragge 				break;
    724  1.1   ragge 			case DMC_TIMEOUT:
    725  1.1   ragge 				if ((sc->sc_timeo++ % DMC_RPTMO) == 0)
    726  1.1   ragge 					goto report;
    727  1.1   ragge 				break;
    728  1.1   ragge 			case DMC_DATACK:
    729  1.1   ragge 				ifp->if_oerrors++;
    730  1.1   ragge 				if ((sc->sc_datck++ % DMC_RPDCK) == 0)
    731  1.1   ragge 					goto report;
    732  1.1   ragge 				break;
    733  1.1   ragge 			default:
    734  1.1   ragge 				goto report;
    735  1.1   ragge 			}
    736  1.1   ragge 			break;
    737  1.1   ragge 		report:
    738  1.1   ragge #ifdef DMCDEBUG
    739  1.1   ragge 			bitmask_snprintf(arg, CNTLO_BITS, buf, sizeof(buf));
    740  1.1   ragge 			printd("%s: soft error, flags=%s\n",
    741  1.1   ragge 			    sc->sc_dev.dv_xname, buf);
    742  1.1   ragge #endif
    743  1.1   ragge 			if ((sc->sc_flag & DMC_RESTART) == 0) {
    744  1.1   ragge 				/*
    745  1.1   ragge 				 * kill off the dmc to get things
    746  1.1   ragge 				 * going again by generating a
    747  1.1   ragge 				 * procedure error
    748  1.1   ragge 				 */
    749  1.1   ragge 				sc->sc_flag |= DMC_RESTART;
    750  1.1   ragge 				arg = sc->sc_ui.ui_baddr;
    751  1.1   ragge 				dmcload(sc, DMC_BASEI, arg, (arg>>2)&DMC_XMEM);
    752  1.1   ragge 			}
    753  1.1   ragge 			break;
    754  1.1   ragge 
    755  1.1   ragge 		default:
    756  1.1   ragge 			printf("%s: bad control %o\n",
    757  1.1   ragge 			    sc->sc_dev.dv_xname, cmd);
    758  1.1   ragge 			break;
    759  1.1   ragge 		}
    760  1.1   ragge 	}
    761  1.1   ragge 	dmcstart(ifp);
    762  1.1   ragge }
    763  1.1   ragge 
    764  1.1   ragge /*
    765  1.1   ragge  * DMC output routine.
    766  1.1   ragge  * Encapsulate a packet of type family for the dmc.
    767  1.1   ragge  * Use trailer local net encapsulation if enough data in first
    768  1.1   ragge  * packet leaves a multiple of 512 bytes of data in remainder.
    769  1.1   ragge  */
    770  1.1   ragge int
    771  1.1   ragge dmcoutput(struct ifnet *ifp, struct mbuf *m0, struct sockaddr *dst,
    772  1.1   ragge     struct rtentry *rt)
    773  1.1   ragge {
    774  1.1   ragge 	int type, error, s;
    775  1.1   ragge 	struct mbuf *m = m0;
    776  1.1   ragge 	struct dmc_header *dh;
    777  1.3  itojun 	ALTQ_DECL(struct altq_pktattr pktattr;)
    778  1.1   ragge 
    779  1.1   ragge 	if ((ifp->if_flags & IFF_UP) == 0) {
    780  1.1   ragge 		error = ENETDOWN;
    781  1.1   ragge 		goto bad;
    782  1.1   ragge 	}
    783  1.1   ragge 
    784  1.3  itojun 	IFQ_CLASSIFY(&ifp->if_snd, m, dst->sa_family, &pktattr);
    785  1.3  itojun 
    786  1.1   ragge 	switch (dst->sa_family) {
    787  1.1   ragge #ifdef	INET
    788  1.1   ragge 	case AF_INET:
    789  1.1   ragge 		type = DMC_IPTYPE;
    790  1.1   ragge 		break;
    791  1.1   ragge #endif
    792  1.1   ragge 
    793  1.1   ragge 	case AF_UNSPEC:
    794  1.1   ragge 		dh = (struct dmc_header *)dst->sa_data;
    795  1.1   ragge 		type = dh->dmc_type;
    796  1.1   ragge 		break;
    797  1.1   ragge 
    798  1.1   ragge 	default:
    799  1.1   ragge 		printf("%s: can't handle af%d\n", ifp->if_xname,
    800  1.1   ragge 			dst->sa_family);
    801  1.1   ragge 		error = EAFNOSUPPORT;
    802  1.1   ragge 		goto bad;
    803  1.1   ragge 	}
    804  1.1   ragge 
    805  1.1   ragge 	/*
    806  1.1   ragge 	 * Add local network header
    807  1.1   ragge 	 * (there is space for a uba on a vax to step on)
    808  1.1   ragge 	 */
    809  1.1   ragge 	M_PREPEND(m, sizeof(struct dmc_header), M_DONTWAIT);
    810  1.1   ragge 	if (m == 0) {
    811  1.1   ragge 		error = ENOBUFS;
    812  1.1   ragge 		goto bad;
    813  1.1   ragge 	}
    814  1.1   ragge 	dh = mtod(m, struct dmc_header *);
    815  1.1   ragge 	dh->dmc_type = htons((u_short)type);
    816  1.1   ragge 
    817  1.1   ragge 	/*
    818  1.1   ragge 	 * Queue message on interface, and start output if interface
    819  1.1   ragge 	 * not yet active.
    820  1.1   ragge 	 */
    821  1.1   ragge 	s = splnet();
    822  1.3  itojun 	IFQ_ENQUEUE(&ifp->if_snd, m, &pktattr, error);
    823  1.3  itojun 	if (error) {
    824  1.3  itojun 		/* mbuf is already freed */
    825  1.1   ragge 		splx(s);
    826  1.3  itojun 		return (error);
    827  1.1   ragge 	}
    828  1.1   ragge 	dmcstart(ifp);
    829  1.1   ragge 	splx(s);
    830  1.1   ragge 	return (0);
    831  1.1   ragge 
    832  1.1   ragge bad:
    833  1.1   ragge 	m_freem(m0);
    834  1.1   ragge 	return (error);
    835  1.1   ragge }
    836  1.1   ragge 
    837  1.1   ragge 
    838  1.1   ragge /*
    839  1.1   ragge  * Process an ioctl request.
    840  1.1   ragge  */
    841  1.1   ragge /* ARGSUSED */
    842  1.1   ragge int
    843  1.1   ragge dmcioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
    844  1.1   ragge {
    845  1.1   ragge 	int s = splnet(), error = 0;
    846  1.1   ragge 	register struct dmc_softc *sc = ifp->if_softc;
    847  1.1   ragge 
    848  1.1   ragge 	switch (cmd) {
    849  1.1   ragge 
    850  1.1   ragge 	case SIOCSIFADDR:
    851  1.1   ragge 		ifp->if_flags |= IFF_UP;
    852  1.1   ragge 		if ((ifp->if_flags & IFF_RUNNING) == 0)
    853  1.1   ragge 			dmcinit(ifp);
    854  1.1   ragge 		break;
    855  1.1   ragge 
    856  1.1   ragge 	case SIOCSIFDSTADDR:
    857  1.1   ragge 		if ((ifp->if_flags & IFF_RUNNING) == 0)
    858  1.1   ragge 			dmcinit(ifp);
    859  1.1   ragge 		break;
    860  1.1   ragge 
    861  1.1   ragge 	case SIOCSIFFLAGS:
    862  1.1   ragge 		if ((ifp->if_flags & IFF_UP) == 0 &&
    863  1.1   ragge 		    sc->sc_flag & DMC_RUNNING)
    864  1.1   ragge 			dmcdown(sc);
    865  1.1   ragge 		else if (ifp->if_flags & IFF_UP &&
    866  1.1   ragge 		    (sc->sc_flag & DMC_RUNNING) == 0)
    867  1.1   ragge 			dmcrestart(sc);
    868  1.1   ragge 		break;
    869  1.1   ragge 
    870  1.1   ragge 	default:
    871  1.1   ragge 		error = EINVAL;
    872  1.1   ragge 	}
    873  1.1   ragge 	splx(s);
    874  1.1   ragge 	return (error);
    875  1.1   ragge }
    876  1.1   ragge 
    877  1.1   ragge /*
    878  1.1   ragge  * Restart after a fatal error.
    879  1.1   ragge  * Clear device and reinitialize.
    880  1.1   ragge  */
    881  1.1   ragge void
    882  1.1   ragge dmcrestart(struct dmc_softc *sc)
    883  1.1   ragge {
    884  1.1   ragge 	int s, i;
    885  1.1   ragge 
    886  1.1   ragge #ifdef DMCDEBUG
    887  1.1   ragge 	/* dump base table */
    888  1.1   ragge 	printf("%s base table:\n", sc->sc_dev.dv_xname);
    889  1.1   ragge 	for (i = 0; i < sizeof (struct dmc_base); i++)
    890  1.1   ragge 		printf("%o\n" ,dmc_base[unit].d_base[i]);
    891  1.1   ragge #endif
    892  1.1   ragge 
    893  1.1   ragge 	dmcdown(sc);
    894  1.1   ragge 
    895  1.1   ragge 	/*
    896  1.1   ragge 	 * Let the DMR finish the MCLR.	 At 1 Mbit, it should do so
    897  1.1   ragge 	 * in about a max of 6.4 milliseconds with diagnostics enabled.
    898  1.1   ragge 	 */
    899  1.1   ragge 	for (i = 100000; i && (DMC_RBYTE(DMC_BSEL1) & DMC_RUN) == 0; i--)
    900  1.1   ragge 		;
    901  1.1   ragge 	/* Did the timer expire or did the DMR finish? */
    902  1.1   ragge 	if ((DMC_RBYTE(DMC_BSEL1) & DMC_RUN) == 0) {
    903  1.1   ragge 		log(LOG_ERR, "%s: M820 Test Failed\n", sc->sc_dev.dv_xname);
    904  1.1   ragge 		return;
    905  1.1   ragge 	}
    906  1.1   ragge 
    907  1.1   ragge 	/* restart DMC */
    908  1.1   ragge 	dmcinit(&sc->sc_if);
    909  1.1   ragge 	sc->sc_flag &= ~DMC_RESTART;
    910  1.1   ragge 	s = splnet();
    911  1.1   ragge 	dmcstart(&sc->sc_if);
    912  1.1   ragge 	splx(s);
    913  1.1   ragge 	sc->sc_if.if_collisions++;	/* why not? */
    914  1.1   ragge }
    915  1.1   ragge 
    916  1.1   ragge /*
    917  1.1   ragge  * Reset a device and mark down.
    918  1.1   ragge  * Flush output queue and drop queue limit.
    919  1.1   ragge  */
    920  1.1   ragge void
    921  1.1   ragge dmcdown(struct dmc_softc *sc)
    922  1.1   ragge {
    923  1.1   ragge 	struct ifxmt *ifxp;
    924  1.1   ragge 
    925  1.1   ragge 	DMC_WBYTE(DMC_BSEL1, DMC_MCLR);
    926  1.1   ragge 	sc->sc_flag &= ~(DMC_RUNNING | DMC_ONLINE);
    927  1.1   ragge 
    928  1.1   ragge 	for (ifxp = sc->sc_ifw; ifxp < &sc->sc_ifw[NXMT]; ifxp++) {
    929  1.1   ragge #ifdef notyet
    930  1.1   ragge 		if (ifxp->ifw_xtofree) {
    931  1.1   ragge 			(void) m_freem(ifxp->ifw_xtofree);
    932  1.1   ragge 			ifxp->ifw_xtofree = 0;
    933  1.1   ragge 		}
    934  1.1   ragge #endif
    935  1.1   ragge 	}
    936  1.1   ragge 	IF_PURGE(&sc->sc_if.if_snd);
    937  1.1   ragge }
    938  1.1   ragge 
    939  1.1   ragge /*
    940  1.1   ragge  * Watchdog timeout to see that transmitted packets don't
    941  1.1   ragge  * lose interrupts.  The device has to be online (the first
    942  1.1   ragge  * transmission may block until the other side comes up).
    943  1.1   ragge  */
    944  1.1   ragge void
    945  1.1   ragge dmctimeout(struct ifnet *ifp)
    946  1.1   ragge {
    947  1.1   ragge 	struct dmc_softc *sc = ifp->if_softc;
    948  1.1   ragge 	char buf1[64], buf2[64];
    949  1.1   ragge 
    950  1.1   ragge 	if (sc->sc_flag & DMC_ONLINE) {
    951  1.1   ragge 		bitmask_snprintf(DMC_RBYTE(DMC_BSEL0) & 0xff, DMC0BITS,
    952  1.1   ragge 		    buf1, sizeof(buf1));
    953  1.1   ragge 		bitmask_snprintf(DMC_RBYTE(DMC_BSEL2) & 0xff, DMC2BITS,
    954  1.1   ragge 		    buf2, sizeof(buf2));
    955  1.1   ragge 		log(LOG_ERR, "%s: output timeout, bsel0=%s bsel2=%s\n",
    956  1.1   ragge 		    sc->sc_dev.dv_xname, buf1, buf2);
    957  1.1   ragge 		dmcrestart(sc);
    958  1.1   ragge 	}
    959  1.1   ragge }
    960