Home | History | Annotate | Line # | Download | only in vme
xd.c revision 1.86.4.1
      1  1.86.4.1     rmind /*	$NetBSD: xd.c,v 1.86.4.1 2011/03/05 20:54:19 rmind Exp $	*/
      2       1.1        pk 
      3       1.1        pk /*
      4       1.1        pk  * Copyright (c) 1995 Charles D. Cranor
      5       1.1        pk  * All rights reserved.
      6       1.1        pk  *
      7       1.1        pk  * Redistribution and use in source and binary forms, with or without
      8       1.1        pk  * modification, are permitted provided that the following conditions
      9       1.1        pk  * are met:
     10       1.1        pk  * 1. Redistributions of source code must retain the above copyright
     11       1.1        pk  *    notice, this list of conditions and the following disclaimer.
     12       1.1        pk  * 2. Redistributions in binary form must reproduce the above copyright
     13       1.1        pk  *    notice, this list of conditions and the following disclaimer in the
     14       1.1        pk  *    documentation and/or other materials provided with the distribution.
     15       1.1        pk  *
     16       1.1        pk  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17       1.1        pk  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18       1.1        pk  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19       1.1        pk  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20       1.1        pk  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     21       1.1        pk  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     22       1.1        pk  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     23       1.1        pk  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     24       1.1        pk  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     25       1.1        pk  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     26       1.1        pk  */
     27       1.1        pk 
     28       1.1        pk /*
     29       1.1        pk  *
     30       1.1        pk  * x d . c   x y l o g i c s   7 5 3 / 7 0 5 3   v m e / s m d   d r i v e r
     31       1.1        pk  *
     32  1.86.4.1     rmind  * author: Chuck Cranor <chuck@netbsd>
     33       1.1        pk  * started: 27-Feb-95
     34       1.1        pk  * references: [1] Xylogics Model 753 User's Manual
     35       1.1        pk  *                 part number: 166-753-001, Revision B, May 21, 1988.
     36       1.1        pk  *                 "Your Partner For Performance"
     37       1.1        pk  *             [2] other NetBSD disk device drivers
     38       1.1        pk  *
     39       1.1        pk  * Special thanks go to Scott E. Campbell of Xylogics, Inc. for taking
     40       1.1        pk  * the time to answer some of my questions about the 753/7053.
     41       1.1        pk  *
     42       1.1        pk  * note: the 753 and the 7053 are programmed the same way, but are
     43       1.1        pk  * different sizes.   the 753 is a 6U VME card, while the 7053 is a 9U
     44       1.1        pk  * VME card (found in many VME based suns).
     45       1.1        pk  */
     46      1.39     lukem 
     47      1.39     lukem #include <sys/cdefs.h>
     48  1.86.4.1     rmind __KERNEL_RCSID(0, "$NetBSD: xd.c,v 1.86.4.1 2011/03/05 20:54:19 rmind Exp $");
     49       1.1        pk 
     50       1.1        pk #undef XDC_DEBUG		/* full debug */
     51       1.1        pk #define XDC_DIAG		/* extra sanity checks */
     52       1.1        pk #if defined(DIAGNOSTIC) && !defined(XDC_DIAG)
     53       1.1        pk #define XDC_DIAG		/* link in with master DIAG option */
     54       1.1        pk #endif
     55       1.1        pk 
     56       1.1        pk #include <sys/param.h>
     57       1.1        pk #include <sys/proc.h>
     58       1.1        pk #include <sys/systm.h>
     59       1.1        pk #include <sys/kernel.h>
     60       1.1        pk #include <sys/file.h>
     61       1.1        pk #include <sys/stat.h>
     62       1.1        pk #include <sys/ioctl.h>
     63       1.1        pk #include <sys/buf.h>
     64      1.55      yamt #include <sys/bufq.h>
     65       1.1        pk #include <sys/uio.h>
     66       1.1        pk #include <sys/malloc.h>
     67       1.1        pk #include <sys/device.h>
     68       1.1        pk #include <sys/disklabel.h>
     69       1.1        pk #include <sys/disk.h>
     70       1.1        pk #include <sys/syslog.h>
     71       1.1        pk #include <sys/dkbad.h>
     72       1.1        pk #include <sys/conf.h>
     73      1.62      yamt #include <sys/kauth.h>
     74       1.1        pk 
     75      1.71        ad #include <sys/bus.h>
     76      1.71        ad #include <sys/intr.h>
     77      1.13       mrg 
     78      1.27       chs #if defined(__sparc__) || defined(sun3)
     79      1.13       mrg #include <dev/sun/disklabel.h>
     80      1.14        pk #endif
     81       1.1        pk 
     82      1.30        pk #include <dev/vme/vmereg.h>
     83       1.1        pk #include <dev/vme/vmevar.h>
     84       1.1        pk 
     85       1.1        pk #include <dev/vme/xdreg.h>
     86       1.1        pk #include <dev/vme/xdvar.h>
     87       1.1        pk #include <dev/vme/xio.h>
     88       1.1        pk 
     89       1.1        pk #include "locators.h"
     90       1.1        pk 
     91       1.1        pk /*
     92       1.1        pk  * macros
     93       1.1        pk  */
     94       1.1        pk 
     95       1.1        pk /*
     96       1.1        pk  * XDC_TWAIT: add iorq "N" to tail of SC's wait queue
     97       1.1        pk  */
     98       1.1        pk #define XDC_TWAIT(SC, N) { \
     99       1.1        pk 	(SC)->waitq[(SC)->waitend] = (N); \
    100       1.1        pk 	(SC)->waitend = ((SC)->waitend + 1) % XDC_MAXIOPB; \
    101       1.1        pk 	(SC)->nwait++; \
    102       1.1        pk }
    103       1.1        pk 
    104       1.1        pk /*
    105       1.1        pk  * XDC_HWAIT: add iorq "N" to head of SC's wait queue
    106       1.1        pk  */
    107       1.1        pk #define XDC_HWAIT(SC, N) { \
    108       1.1        pk 	(SC)->waithead = ((SC)->waithead == 0) ? \
    109       1.1        pk 		(XDC_MAXIOPB - 1) : ((SC)->waithead - 1); \
    110       1.1        pk 	(SC)->waitq[(SC)->waithead] = (N); \
    111       1.1        pk 	(SC)->nwait++; \
    112       1.1        pk }
    113       1.1        pk 
    114       1.1        pk /*
    115       1.1        pk  * XDC_GET_WAITER: gets the first request waiting on the waitq
    116       1.1        pk  * and removes it (so it can be submitted)
    117       1.1        pk  */
    118       1.1        pk #define XDC_GET_WAITER(XDCSC, RQ) { \
    119       1.1        pk 	(RQ) = (XDCSC)->waitq[(XDCSC)->waithead]; \
    120       1.1        pk 	(XDCSC)->waithead = ((XDCSC)->waithead + 1) % XDC_MAXIOPB; \
    121       1.1        pk 	xdcsc->nwait--; \
    122       1.1        pk }
    123       1.1        pk 
    124       1.1        pk /*
    125       1.1        pk  * XDC_FREE: add iorq "N" to SC's free list
    126       1.1        pk  */
    127       1.1        pk #define XDC_FREE(SC, N) { \
    128       1.1        pk 	(SC)->freereq[(SC)->nfree++] = (N); \
    129       1.1        pk 	(SC)->reqs[N].mode = 0; \
    130       1.1        pk 	if ((SC)->nfree == 1) wakeup(&(SC)->nfree); \
    131       1.1        pk }
    132       1.1        pk 
    133       1.1        pk 
    134       1.1        pk /*
    135       1.1        pk  * XDC_RQALLOC: allocate an iorq off the free list (assume nfree > 0).
    136       1.1        pk  */
    137       1.1        pk #define XDC_RQALLOC(XDCSC) (XDCSC)->freereq[--((XDCSC)->nfree)]
    138       1.1        pk 
    139       1.1        pk /*
    140       1.1        pk  * XDC_GO: start iopb ADDR (DVMA addr in a u_long) on XDC
    141       1.1        pk  */
    142       1.1        pk #define XDC_GO(XDC, ADDR) { \
    143       1.1        pk 	(XDC)->xdc_iopbaddr0 = ((ADDR) & 0xff); \
    144       1.1        pk 	(ADDR) = ((ADDR) >> 8); \
    145       1.1        pk 	(XDC)->xdc_iopbaddr1 = ((ADDR) & 0xff); \
    146       1.1        pk 	(ADDR) = ((ADDR) >> 8); \
    147       1.1        pk 	(XDC)->xdc_iopbaddr2 = ((ADDR) & 0xff); \
    148       1.1        pk 	(ADDR) = ((ADDR) >> 8); \
    149       1.1        pk 	(XDC)->xdc_iopbaddr3 = (ADDR); \
    150       1.1        pk 	(XDC)->xdc_iopbamod = XDC_ADDRMOD; \
    151       1.1        pk 	(XDC)->xdc_csr = XDC_ADDIOPB; /* go! */ \
    152       1.1        pk }
    153       1.1        pk 
    154       1.1        pk /*
    155       1.1        pk  * XDC_WAIT: wait for XDC's csr "BITS" to come on in "TIME".
    156       1.1        pk  *   LCV is a counter.  If it goes to zero then we timed out.
    157       1.1        pk  */
    158       1.1        pk #define XDC_WAIT(XDC, LCV, TIME, BITS) { \
    159       1.1        pk 	(LCV) = (TIME); \
    160       1.1        pk 	while ((LCV) > 0) { \
    161       1.1        pk 		if ((XDC)->xdc_csr & (BITS)) break; \
    162       1.1        pk 		(LCV) = (LCV) - 1; \
    163       1.1        pk 		DELAY(1); \
    164       1.1        pk 	} \
    165       1.1        pk }
    166       1.1        pk 
    167       1.1        pk /*
    168       1.1        pk  * XDC_DONE: don't need IORQ, get error code and free (done after xdc_cmd)
    169       1.1        pk  */
    170       1.1        pk #define XDC_DONE(SC,RQ,ER) { \
    171       1.1        pk 	if ((RQ) == XD_ERR_FAIL) { \
    172       1.1        pk 		(ER) = (RQ); \
    173       1.1        pk 	} else { \
    174       1.1        pk 		if ((SC)->ndone-- == XDC_SUBWAITLIM) \
    175       1.1        pk 		wakeup(&(SC)->ndone); \
    176      1.64  christos 		(ER) = (SC)->reqs[RQ].errnum; \
    177       1.1        pk 		XDC_FREE((SC), (RQ)); \
    178       1.1        pk 	} \
    179       1.1        pk }
    180       1.1        pk 
    181       1.1        pk /*
    182       1.1        pk  * XDC_ADVANCE: advance iorq's pointers by a number of sectors
    183       1.1        pk  */
    184       1.1        pk #define XDC_ADVANCE(IORQ, N) { \
    185       1.1        pk 	if (N) { \
    186       1.1        pk 		(IORQ)->sectcnt -= (N); \
    187       1.1        pk 		(IORQ)->blockno += (N); \
    188       1.1        pk 		(IORQ)->dbuf += ((N)*XDFM_BPS); \
    189       1.1        pk 	} \
    190       1.1        pk }
    191       1.1        pk 
    192       1.1        pk /*
    193       1.1        pk  * note - addresses you can sleep on:
    194       1.1        pk  *   [1] & of xd_softc's "state" (waiting for a chance to attach a drive)
    195       1.1        pk  *   [2] & of xdc_softc's "nfree" (waiting for a free iorq/iopb)
    196       1.1        pk  *   [3] & of xdc_softc's "ndone" (waiting for number of done iorq/iopb's
    197       1.1        pk  *                                 to drop below XDC_SUBWAITLIM)
    198       1.1        pk  *   [4] & an iorq (waiting for an XD_SUB_WAIT iorq to finish)
    199       1.1        pk  */
    200       1.1        pk 
    201       1.1        pk 
    202       1.1        pk /*
    203       1.1        pk  * function prototypes
    204       1.1        pk  * "xdc_*" functions are internal, all others are external interfaces
    205       1.1        pk  */
    206       1.1        pk 
    207       1.1        pk extern int pil_to_vme[];	/* from obio.c */
    208       1.1        pk 
    209       1.1        pk /* internals */
    210      1.56     perry int	xdc_cmd(struct xdc_softc *, int, int, int, int, int, char *, int);
    211      1.57   tsutsui const char *xdc_e2str(int);
    212      1.56     perry int	xdc_error(struct xdc_softc *, struct xd_iorq *,
    213      1.56     perry 		   struct xd_iopb *, int, int);
    214      1.56     perry int	xdc_ioctlcmd(struct xd_softc *, dev_t dev, struct xd_iocmd *);
    215      1.56     perry void	xdc_perror(struct xd_iorq *, struct xd_iopb *, int);
    216      1.56     perry int	xdc_piodriver(struct xdc_softc *, int, int);
    217      1.56     perry int	xdc_remove_iorq(struct xdc_softc *);
    218      1.56     perry int	xdc_reset(struct xdc_softc *, int, int, int, struct xd_softc *);
    219      1.56     perry inline void xdc_rqinit(struct xd_iorq *, struct xdc_softc *,
    220      1.56     perry 			struct xd_softc *, int, u_long, int,
    221      1.66  christos 			void *, struct buf *);
    222      1.56     perry void	xdc_rqtopb(struct xd_iorq *, struct xd_iopb *, int, int);
    223      1.56     perry void	xdc_start(struct xdc_softc *, int);
    224      1.56     perry int	xdc_startbuf(struct xdc_softc *, struct xd_softc *, struct buf *);
    225      1.56     perry int	xdc_submit_iorq(struct xdc_softc *, int, int);
    226      1.56     perry void	xdc_tick(void *);
    227      1.56     perry void	xdc_xdreset(struct xdc_softc *, struct xd_softc *);
    228      1.21        pk int	xd_dmamem_alloc(bus_dma_tag_t, bus_dmamap_t, bus_dma_segment_t *,
    229      1.66  christos 			int *, bus_size_t, void **, bus_addr_t *);
    230      1.21        pk void	xd_dmamem_free(bus_dma_tag_t, bus_dmamap_t, bus_dma_segment_t *,
    231      1.66  christos 			int, bus_size_t, void *);
    232      1.21        pk 
    233       1.1        pk 
    234       1.1        pk /* machine interrupt hook */
    235      1.56     perry int	xdcintr(void *);
    236       1.1        pk 
    237       1.1        pk /* autoconf */
    238      1.86    cegger int	xdcmatch(device_t, cfdata_t, void *);
    239      1.86    cegger void	xdcattach(device_t, device_t, void *);
    240      1.86    cegger int	xdmatch(device_t, cfdata_t, void *);
    241      1.86    cegger void	xdattach(device_t, device_t, void *);
    242      1.56     perry static	int xdc_probe(void *, bus_space_tag_t, bus_space_handle_t);
    243       1.1        pk 
    244      1.56     perry static	void xddummystrat(struct buf *);
    245      1.56     perry int	xdgetdisklabel(struct xd_softc *, void *);
    246       1.1        pk 
    247       1.1        pk /* XXX - think about this more.. xd_machdep? */
    248      1.56     perry void xdc_md_setup(void);
    249       1.1        pk int	XDC_DELAY;
    250      1.18   thorpej 
    251      1.20       chs #if defined(__sparc__)
    252       1.1        pk #include <sparc/sparc/vaddrs.h>
    253       1.1        pk #include <sparc/sparc/cpuvar.h>
    254      1.81    cegger void xdc_md_setup(void)
    255       1.1        pk {
    256       1.1        pk 	if (CPU_ISSUN4 && cpuinfo.cpu_type == CPUTYP_4_300)
    257       1.1        pk 		XDC_DELAY = XDC_DELAY_4_300;
    258       1.1        pk 	else
    259       1.1        pk 		XDC_DELAY = XDC_DELAY_SPARC;
    260       1.1        pk }
    261      1.27       chs #elif defined(sun3)
    262      1.81    cegger void xdc_md_setup(void)
    263       1.1        pk {
    264       1.1        pk 	XDC_DELAY = XDC_DELAY_SUN3;
    265       1.1        pk }
    266      1.18   thorpej #else
    267      1.81    cegger void xdc_md_setup(void)
    268      1.18   thorpej {
    269      1.18   thorpej 	XDC_DELAY = 0;
    270      1.18   thorpej }
    271       1.1        pk #endif
    272      1.18   thorpej 
    273       1.1        pk /*
    274       1.4   thorpej  * cfattach's: device driver interface to autoconfig
    275       1.1        pk  */
    276       1.1        pk 
    277      1.44   thorpej CFATTACH_DECL(xdc, sizeof(struct xdc_softc),
    278      1.45   thorpej     xdcmatch, xdcattach, NULL, NULL);
    279       1.1        pk 
    280      1.44   thorpej CFATTACH_DECL(xd, sizeof(struct xd_softc),
    281      1.45   thorpej     xdmatch, xdattach, NULL, NULL);
    282       1.1        pk 
    283       1.4   thorpej extern struct cfdriver xd_cd;
    284      1.42   gehenna 
    285      1.42   gehenna dev_type_open(xdopen);
    286      1.42   gehenna dev_type_close(xdclose);
    287      1.42   gehenna dev_type_read(xdread);
    288      1.42   gehenna dev_type_write(xdwrite);
    289      1.42   gehenna dev_type_ioctl(xdioctl);
    290      1.42   gehenna dev_type_strategy(xdstrategy);
    291      1.42   gehenna dev_type_dump(xddump);
    292      1.42   gehenna dev_type_size(xdsize);
    293      1.42   gehenna 
    294      1.42   gehenna const struct bdevsw xd_bdevsw = {
    295      1.42   gehenna 	xdopen, xdclose, xdstrategy, xdioctl, xddump, xdsize, D_DISK
    296      1.42   gehenna };
    297      1.42   gehenna 
    298      1.42   gehenna const struct cdevsw xd_cdevsw = {
    299      1.42   gehenna 	xdopen, xdclose, xdread, xdwrite, xdioctl,
    300      1.46  jdolecek 	nostop, notty, nopoll, nommap, nokqfilter, D_DISK
    301      1.42   gehenna };
    302       1.1        pk 
    303       1.1        pk struct xdc_attach_args {	/* this is the "aux" args to xdattach */
    304       1.1        pk 	int	driveno;	/* unit number */
    305       1.1        pk 	int	fullmode;	/* submit mode */
    306       1.1        pk 	int	booting;	/* are we booting or not? */
    307       1.1        pk };
    308       1.1        pk 
    309       1.1        pk /*
    310       1.1        pk  * dkdriver
    311       1.1        pk  */
    312       1.1        pk 
    313       1.1        pk struct dkdriver xddkdriver = {xdstrategy};
    314       1.1        pk 
    315       1.1        pk /*
    316       1.1        pk  * start: disk label fix code (XXX)
    317       1.1        pk  */
    318       1.1        pk 
    319       1.1        pk static void *xd_labeldata;
    320       1.1        pk 
    321       1.1        pk static void
    322      1.79       dsl xddummystrat(struct buf *bp)
    323       1.1        pk {
    324       1.1        pk 	if (bp->b_bcount != XDFM_BPS)
    325       1.1        pk 		panic("xddummystrat");
    326      1.84   tsutsui 	memcpy(bp->b_data, xd_labeldata, XDFM_BPS);
    327      1.72        ad 	bp->b_oflags |= BO_DONE;
    328      1.72        ad 	bp->b_cflags &= ~BC_BUSY;
    329       1.1        pk }
    330       1.1        pk 
    331       1.1        pk int
    332      1.79       dsl xdgetdisklabel(struct xd_softc *xd, void *b)
    333       1.1        pk {
    334      1.48       dsl 	const char *err;
    335      1.27       chs #if defined(__sparc__) || defined(sun3)
    336       1.1        pk 	struct sun_disklabel *sdl;
    337      1.14        pk #endif
    338       1.1        pk 
    339       1.1        pk 	/* We already have the label data in `b'; setup for dummy strategy */
    340       1.1        pk 	xd_labeldata = b;
    341       1.1        pk 
    342       1.1        pk 	/* Required parameter for readdisklabel() */
    343       1.1        pk 	xd->sc_dk.dk_label->d_secsize = XDFM_BPS;
    344       1.1        pk 
    345      1.60   thorpej 	err = readdisklabel(MAKEDISKDEV(0, device_unit(&xd->sc_dev), RAW_PART),
    346       1.1        pk 			    xddummystrat,
    347       1.1        pk 			    xd->sc_dk.dk_label, xd->sc_dk.dk_cpulabel);
    348       1.1        pk 	if (err) {
    349      1.75    cegger 		aprint_error_dev(&xd->sc_dev, "%s\n", err);
    350       1.1        pk 		return(XD_ERR_FAIL);
    351       1.1        pk 	}
    352       1.1        pk 
    353      1.27       chs #if defined(__sparc__) || defined(sun3)
    354       1.1        pk 	/* Ok, we have the label; fill in `pcyl' if there's SunOS magic */
    355       1.1        pk 	sdl = (struct sun_disklabel *)xd->sc_dk.dk_cpulabel->cd_block;
    356      1.14        pk 	if (sdl->sl_magic == SUN_DKMAGIC) {
    357       1.1        pk 		xd->pcyl = sdl->sl_pcylinders;
    358      1.14        pk 	} else
    359      1.17  drochner #endif
    360      1.14        pk 	{
    361       1.1        pk 		printf("%s: WARNING: no `pcyl' in disk label.\n",
    362      1.75    cegger 			device_xname(&xd->sc_dev));
    363       1.1        pk 		xd->pcyl = xd->sc_dk.dk_label->d_ncylinders +
    364       1.1        pk 			xd->sc_dk.dk_label->d_acylinders;
    365       1.1        pk 		printf("%s: WARNING: guessing pcyl=%d (ncyl+acyl)\n",
    366      1.75    cegger 			device_xname(&xd->sc_dev), xd->pcyl);
    367       1.1        pk 	}
    368       1.1        pk 
    369       1.1        pk 	xd->ncyl = xd->sc_dk.dk_label->d_ncylinders;
    370       1.1        pk 	xd->acyl = xd->sc_dk.dk_label->d_acylinders;
    371       1.1        pk 	xd->nhead = xd->sc_dk.dk_label->d_ntracks;
    372       1.1        pk 	xd->nsect = xd->sc_dk.dk_label->d_nsectors;
    373       1.1        pk 	xd->sectpercyl = xd->nhead * xd->nsect;
    374       1.1        pk 	xd->sc_dk.dk_label->d_secsize = XDFM_BPS; /* not handled by
    375       1.1        pk 						  * sun->bsd */
    376       1.1        pk 	return(XD_ERR_AOK);
    377       1.1        pk }
    378       1.1        pk 
    379       1.1        pk /*
    380       1.1        pk  * end: disk label fix code (XXX)
    381       1.1        pk  */
    382       1.1        pk 
    383       1.1        pk /*
    384      1.21        pk  * Shorthand for allocating, mapping and loading a DMA buffer
    385      1.21        pk  */
    386      1.21        pk int
    387      1.79       dsl xd_dmamem_alloc(bus_dma_tag_t tag, bus_dmamap_t map, bus_dma_segment_t *seg, int *nsegp, bus_size_t len, void * *kvap, bus_addr_t *dmap)
    388      1.21        pk {
    389      1.21        pk 	int nseg;
    390      1.21        pk 	int error;
    391      1.21        pk 
    392      1.22        pk 	if ((error = bus_dmamem_alloc(tag, len, 0, 0,
    393      1.21        pk 				      seg, 1, &nseg, BUS_DMA_NOWAIT)) != 0) {
    394      1.21        pk 		return (error);
    395      1.21        pk 	}
    396      1.21        pk 
    397      1.36   thorpej 	if ((error = bus_dmamem_map(tag, seg, nseg,
    398      1.36   thorpej 				    len, kvap,
    399      1.36   thorpej 				    BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) != 0) {
    400      1.21        pk 		bus_dmamem_free(tag, seg, nseg);
    401      1.21        pk 		return (error);
    402      1.21        pk 	}
    403      1.21        pk 
    404      1.36   thorpej 	if ((error = bus_dmamap_load(tag, map,
    405      1.36   thorpej 				     *kvap, len, NULL,
    406      1.36   thorpej 				     BUS_DMA_NOWAIT)) != 0) {
    407      1.36   thorpej 		bus_dmamem_unmap(tag, *kvap, len);
    408      1.21        pk 		bus_dmamem_free(tag, seg, nseg);
    409      1.21        pk 		return (error);
    410      1.21        pk 	}
    411      1.21        pk 
    412      1.21        pk 	*dmap = map->dm_segs[0].ds_addr;
    413      1.21        pk 	*nsegp = nseg;
    414      1.21        pk 	return (0);
    415      1.21        pk }
    416      1.21        pk 
    417      1.21        pk void
    418      1.79       dsl xd_dmamem_free(bus_dma_tag_t tag, bus_dmamap_t map, bus_dma_segment_t *seg, int nseg, bus_size_t len, void * kva)
    419      1.21        pk {
    420      1.21        pk 
    421      1.21        pk 	bus_dmamap_unload(tag, map);
    422      1.21        pk 	bus_dmamem_unmap(tag, kva, len);
    423      1.21        pk 	bus_dmamem_free(tag, seg, nseg);
    424      1.21        pk }
    425      1.21        pk 
    426      1.21        pk 
    427      1.21        pk /*
    428       1.1        pk  * a u t o c o n f i g   f u n c t i o n s
    429       1.1        pk  */
    430       1.1        pk 
    431       1.1        pk /*
    432       1.1        pk  * xdcmatch: determine if xdc is present or not.   we do a
    433       1.1        pk  * soft reset to detect the xdc.
    434       1.1        pk  */
    435       1.1        pk 
    436       1.7        pk int
    437      1.79       dsl xdc_probe(void *arg, bus_space_tag_t tag, bus_space_handle_t handle)
    438       1.7        pk {
    439      1.15  drochner 	struct xdc *xdc = (void *)handle; /* XXX */
    440       1.7        pk 	int del = 0;
    441       1.7        pk 
    442       1.7        pk 	xdc->xdc_csr = XDC_RESET;
    443       1.7        pk 	XDC_WAIT(xdc, del, XDC_RESETUSEC, XDC_RESET);
    444      1.15  drochner 	return (del > 0 ? 0 : EIO);
    445       1.7        pk }
    446       1.7        pk 
    447       1.1        pk int xdcmatch(parent, cf, aux)
    448      1.86    cegger 	device_t parent;
    449      1.85    cegger 	cfdata_t cf;
    450       1.1        pk 	void *aux;
    451       1.1        pk {
    452       1.1        pk 	struct vme_attach_args	*va = aux;
    453      1.15  drochner 	vme_chipset_tag_t	ct = va->va_vct;
    454      1.15  drochner 	vme_am_t		mod;
    455      1.15  drochner 	int error;
    456      1.15  drochner 
    457      1.30        pk 	mod = VME_AM_A16 | VME_AM_MBO | VME_AM_SUPER | VME_AM_DATA;
    458      1.30        pk 	if (vme_space_alloc(ct, va->r[0].offset, sizeof(struct xdc), mod))
    459      1.15  drochner 		return (0);
    460      1.30        pk 
    461      1.15  drochner 	error = vme_probe(ct, va->r[0].offset, sizeof(struct xdc),
    462      1.15  drochner 			  mod, VME_D32, xdc_probe, 0);
    463      1.15  drochner 	vme_space_free(va->va_vct, va->r[0].offset, sizeof(struct xdc), mod);
    464      1.15  drochner 
    465      1.15  drochner 	return (error == 0);
    466       1.1        pk }
    467       1.1        pk 
    468       1.1        pk /*
    469       1.1        pk  * xdcattach: attach controller
    470       1.1        pk  */
    471       1.1        pk void
    472      1.86    cegger xdcattach(device_t parent, device_t self, void *aux)
    473       1.1        pk {
    474       1.1        pk 	struct vme_attach_args	*va = aux;
    475      1.15  drochner 	vme_chipset_tag_t	ct = va->va_vct;
    476      1.15  drochner 	bus_space_tag_t		bt;
    477       1.1        pk 	bus_space_handle_t	bh;
    478       1.1        pk 	vme_intr_handle_t	ih;
    479      1.15  drochner 	vme_am_t		mod;
    480      1.76  drochner 	struct xdc_softc	*xdc = device_private(self);
    481       1.1        pk 	struct xdc_attach_args	xa;
    482       1.3        pk 	int			lcv, rqno, error;
    483       1.1        pk 	struct xd_iopb_ctrl	*ctl;
    484       1.3        pk 	bus_dma_segment_t	seg;
    485       1.3        pk 	int			rseg;
    486      1.15  drochner 	vme_mapresc_t resc;
    487      1.52       mrg 	bus_addr_t		busaddr;
    488       1.1        pk 
    489      1.18   thorpej 	xdc_md_setup();
    490       1.1        pk 
    491       1.1        pk 	/* get addressing and intr level stuff from autoconfig and load it
    492       1.1        pk 	 * into our xdc_softc. */
    493       1.1        pk 
    494      1.15  drochner 	xdc->dmatag = va->va_bdt;
    495      1.30        pk 	mod = VME_AM_A16 | VME_AM_MBO | VME_AM_SUPER | VME_AM_DATA;
    496       1.1        pk 
    497      1.30        pk 	if (vme_space_alloc(ct, va->r[0].offset, sizeof(struct xdc), mod))
    498      1.15  drochner 		panic("xdc: vme alloc");
    499      1.30        pk 
    500      1.15  drochner 	if (vme_space_map(ct, va->r[0].offset, sizeof(struct xdc),
    501      1.15  drochner 			  mod, VME_D32, 0, &bt, &bh, &resc) != 0)
    502       1.2        pk 		panic("xdc: vme_map");
    503       1.1        pk 
    504      1.15  drochner 	xdc->xdc = (struct xdc *) bh; /* XXX */
    505      1.15  drochner 	xdc->ipl = va->ilevel;
    506      1.15  drochner 	xdc->vector = va->ivector;
    507       1.1        pk 
    508       1.1        pk 	for (lcv = 0; lcv < XDC_MAXDEV; lcv++)
    509       1.1        pk 		xdc->sc_drives[lcv] = (struct xd_softc *) 0;
    510       1.1        pk 
    511      1.21        pk 	/*
    512      1.21        pk 	 * allocate and zero buffers
    513       1.1        pk 	 *
    514       1.1        pk 	 * note: we simplify the code by allocating the max number of iopbs and
    515       1.1        pk 	 * iorq's up front.   thus, we avoid linked lists and the costs
    516      1.21        pk 	 * associated with them in exchange for wasting a little memory.
    517      1.21        pk 	 */
    518       1.1        pk 
    519      1.21        pk 	/* Get DMA handle for misc. transfers */
    520      1.30        pk 	if ((error = vme_dmamap_create(
    521      1.30        pk 				ct,		/* VME chip tag */
    522      1.30        pk 				MAXPHYS,	/* size */
    523      1.30        pk 				VME_AM_A24,	/* address modifier */
    524      1.30        pk 				VME_D32,	/* data size */
    525      1.30        pk 				0,		/* swap */
    526      1.21        pk 				1,		/* nsegments */
    527      1.30        pk 				MAXPHYS,	/* maxsegsz */
    528      1.21        pk 				0,		/* boundary */
    529      1.21        pk 				BUS_DMA_NOWAIT,
    530      1.21        pk 				&xdc->auxmap)) != 0) {
    531      1.30        pk 
    532      1.75    cegger 		aprint_error_dev(&xdc->sc_dev, "DMA buffer map create error %d\n",
    533      1.75    cegger 			error);
    534       1.3        pk 		return;
    535       1.3        pk 	}
    536       1.3        pk 
    537      1.30        pk 
    538      1.21        pk 	/* Get DMA handle for mapping iorq descriptors */
    539      1.30        pk 	if ((error = vme_dmamap_create(
    540      1.30        pk 				ct,		/* VME chip tag */
    541      1.21        pk 				XDC_MAXIOPB * sizeof(struct xd_iopb),
    542      1.30        pk 				VME_AM_A24,	/* address modifier */
    543      1.30        pk 				VME_D32,	/* data size */
    544      1.30        pk 				0,		/* swap */
    545      1.21        pk 				1,		/* nsegments */
    546       1.3        pk 				XDC_MAXIOPB * sizeof(struct xd_iopb),
    547      1.21        pk 				0,		/* boundary */
    548      1.21        pk 				BUS_DMA_NOWAIT,
    549      1.21        pk 				&xdc->iopmap)) != 0) {
    550      1.30        pk 
    551      1.75    cegger 		aprint_error_dev(&xdc->sc_dev, "DMA buffer map create error %d\n",
    552      1.75    cegger 			error);
    553      1.21        pk 		return;
    554      1.21        pk 	}
    555      1.21        pk 
    556      1.21        pk 	/* Get DMA buffer for iorq descriptors */
    557      1.21        pk 	if ((error = xd_dmamem_alloc(xdc->dmatag, xdc->iopmap, &seg, &rseg,
    558      1.21        pk 				     XDC_MAXIOPB * sizeof(struct xd_iopb),
    559      1.66  christos 				     (void **)&xdc->iopbase,
    560      1.52       mrg 				     &busaddr)) != 0) {
    561      1.75    cegger 		aprint_error_dev(&xdc->sc_dev, "DMA buffer alloc error %d\n",
    562      1.75    cegger 			error);
    563       1.3        pk 		return;
    564       1.3        pk 	}
    565      1.53       mrg 	xdc->dvmaiopb = (struct xd_iopb *)(u_long)BUS_ADDR_PADDR(busaddr);
    566      1.21        pk 
    567      1.82    cegger 	memset(xdc->iopbase, 0, XDC_MAXIOPB * sizeof(struct xd_iopb));
    568       1.1        pk 
    569       1.1        pk 	xdc->reqs = (struct xd_iorq *)
    570      1.40   tsutsui 	    malloc(XDC_MAXIOPB * sizeof(struct xd_iorq),
    571      1.40   tsutsui 	    M_DEVBUF, M_NOWAIT|M_ZERO);
    572       1.1        pk 	if (xdc->reqs == NULL)
    573       1.1        pk 		panic("xdc malloc");
    574       1.1        pk 
    575       1.1        pk 	/* init free list, iorq to iopb pointers, and non-zero fields in the
    576       1.1        pk 	 * iopb which never change. */
    577       1.1        pk 
    578       1.1        pk 	for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
    579       1.1        pk 		xdc->reqs[lcv].iopb = &xdc->iopbase[lcv];
    580      1.12        pk 		xdc->reqs[lcv].dmaiopb = &xdc->dvmaiopb[lcv];
    581       1.1        pk 		xdc->freereq[lcv] = lcv;
    582       1.1        pk 		xdc->iopbase[lcv].fixd = 1;	/* always the same */
    583       1.1        pk 		xdc->iopbase[lcv].naddrmod = XDC_ADDRMOD; /* always the same */
    584       1.1        pk 		xdc->iopbase[lcv].intr_vec = xdc->vector; /* always the same */
    585       1.3        pk 
    586      1.30        pk 		if ((error = vme_dmamap_create(
    587      1.30        pk 				ct,		/* VME chip tag */
    588       1.3        pk 				MAXPHYS,	/* size */
    589      1.30        pk 				VME_AM_A24,	/* address modifier */
    590      1.30        pk 				VME_D32,	/* data size */
    591      1.30        pk 				0,		/* swap */
    592       1.3        pk 				1,		/* nsegments */
    593       1.3        pk 				MAXPHYS,	/* maxsegsz */
    594       1.3        pk 				0,		/* boundary */
    595       1.3        pk 				BUS_DMA_NOWAIT,
    596      1.30        pk 				&xdc->reqs[lcv].dmamap)) != 0) {
    597      1.30        pk 
    598      1.75    cegger 			aprint_error_dev(&xdc->sc_dev, "DMA buffer map create error %d\n",
    599      1.75    cegger 				error);
    600       1.3        pk 			return;
    601       1.3        pk 		}
    602       1.1        pk 	}
    603       1.1        pk 	xdc->nfree = XDC_MAXIOPB;
    604       1.1        pk 	xdc->nrun = 0;
    605       1.1        pk 	xdc->waithead = xdc->waitend = xdc->nwait = 0;
    606       1.1        pk 	xdc->ndone = 0;
    607       1.1        pk 
    608       1.1        pk 	/* init queue of waiting bufs */
    609       1.1        pk 
    610      1.58      yamt 	bufq_alloc(&xdc->sc_wq, "fcfs", 0);
    611      1.68        ad 	callout_init(&xdc->sc_tick_ch, 0);
    612       1.1        pk 
    613       1.1        pk 	/*
    614       1.1        pk 	 * section 7 of the manual tells us how to init the controller:
    615       1.1        pk 	 * - read controller parameters (6/0)
    616       1.1        pk 	 * - write controller parameters (5/0)
    617       1.1        pk 	 */
    618       1.1        pk 
    619       1.1        pk 	/* read controller parameters and insure we have a 753/7053 */
    620       1.1        pk 
    621       1.1        pk 	rqno = xdc_cmd(xdc, XDCMD_RDP, XDFUN_CTL, 0, 0, 0, 0, XD_SUB_POLL);
    622       1.1        pk 	if (rqno == XD_ERR_FAIL) {
    623       1.1        pk 		printf(": couldn't read controller params\n");
    624       1.1        pk 		return;		/* shouldn't ever happen */
    625       1.1        pk 	}
    626      1.21        pk 	ctl = (struct xd_iopb_ctrl *) &xdc->iopbase[rqno];
    627       1.1        pk 	if (ctl->ctype != XDCT_753) {
    628      1.64  christos 		if (xdc->reqs[rqno].errnum)
    629      1.64  christos 			printf(": %s: ", xdc_e2str(xdc->reqs[rqno].errnum));
    630       1.1        pk 		printf(": doesn't identify as a 753/7053\n");
    631       1.3        pk 		XDC_DONE(xdc, rqno, error);
    632       1.1        pk 		return;
    633       1.1        pk 	}
    634       1.1        pk 	printf(": Xylogics 753/7053, PROM=0x%x.%02x.%02x\n",
    635       1.1        pk 	    ctl->eprom_partno, ctl->eprom_lvl, ctl->eprom_rev);
    636       1.3        pk 	XDC_DONE(xdc, rqno, error);
    637       1.1        pk 
    638       1.1        pk 	/* now write controller parameters (xdc_cmd sets all params for us) */
    639       1.1        pk 
    640       1.1        pk 	rqno = xdc_cmd(xdc, XDCMD_WRP, XDFUN_CTL, 0, 0, 0, 0, XD_SUB_POLL);
    641       1.3        pk 	XDC_DONE(xdc, rqno, error);
    642       1.3        pk 	if (error) {
    643      1.75    cegger 		aprint_error_dev(&xdc->sc_dev, "controller config error: %s\n",
    644      1.75    cegger 			xdc_e2str(error));
    645       1.1        pk 		return;
    646       1.1        pk 	}
    647       1.1        pk 
    648       1.1        pk 	/* link in interrupt with higher level software */
    649      1.32       scw 	vme_intr_map(ct, va->ilevel, va->ivector, &ih);
    650      1.15  drochner 	vme_intr_establish(ct, ih, IPL_BIO, xdcintr, xdc);
    651      1.26       cgd 	evcnt_attach_dynamic(&xdc->sc_intrcnt, EVCNT_TYPE_INTR, NULL,
    652      1.75    cegger 	    device_xname(&xdc->sc_dev), "intr");
    653       1.1        pk 
    654       1.1        pk 
    655       1.1        pk 	/* now we must look for disks using autoconfig */
    656       1.1        pk 	xa.fullmode = XD_SUB_POLL;
    657       1.1        pk 	xa.booting = 1;
    658       1.1        pk 
    659       1.1        pk 	for (xa.driveno = 0; xa.driveno < XDC_MAXDEV; xa.driveno++)
    660       1.1        pk 		(void) config_found(self, (void *) &xa, NULL);
    661       1.1        pk 
    662       1.1        pk 	/* start the watchdog clock */
    663      1.19   thorpej 	callout_reset(&xdc->sc_tick_ch, XDC_TICKCNT, xdc_tick, xdc);
    664       1.1        pk 
    665       1.1        pk }
    666       1.1        pk 
    667       1.1        pk /*
    668       1.1        pk  * xdmatch: probe for disk.
    669       1.1        pk  *
    670       1.1        pk  * note: we almost always say disk is present.   this allows us to
    671       1.1        pk  * spin up and configure a disk after the system is booted (we can
    672       1.1        pk  * call xdattach!).
    673       1.1        pk  */
    674       1.1        pk int
    675      1.86    cegger xdmatch(device_t parent, cfdata_t cf, void *aux)
    676       1.1        pk {
    677       1.1        pk 	struct xdc_attach_args *xa = aux;
    678       1.1        pk 
    679       1.1        pk 	/* looking for autoconf wildcard or exact match */
    680       1.1        pk 
    681       1.1        pk 	if (cf->cf_loc[XDCCF_DRIVE] != XDCCF_DRIVE_DEFAULT &&
    682       1.1        pk 	    cf->cf_loc[XDCCF_DRIVE] != xa->driveno)
    683       1.1        pk 		return 0;
    684       1.1        pk 
    685       1.1        pk 	return 1;
    686       1.1        pk 
    687       1.1        pk }
    688       1.1        pk 
    689       1.1        pk /*
    690       1.1        pk  * xdattach: attach a disk.   this can be called from autoconf and also
    691       1.1        pk  * from xdopen/xdstrategy.
    692       1.1        pk  */
    693       1.1        pk void
    694      1.86    cegger xdattach(device_t parent, device_t self, void *aux)
    695       1.1        pk {
    696      1.76  drochner 	struct xd_softc *xd = device_private(self);
    697      1.76  drochner 	struct xdc_softc *xdc = device_private(parent);
    698       1.1        pk 	struct xdc_attach_args *xa = aux;
    699       1.3        pk 	int     rqno, spt = 0, mb, blk, lcv, fmode, s = 0, newstate;
    700       1.1        pk 	struct xd_iopb_drive *driopb;
    701       1.1        pk 	struct dkbad *dkb;
    702       1.3        pk 	int			rseg, error;
    703       1.3        pk 	bus_dma_segment_t	seg;
    704      1.52       mrg 	bus_addr_t		busaddr;
    705      1.66  christos 	void *			dmaddr;
    706      1.67       mrg 	char *			buf;
    707       1.1        pk 
    708       1.1        pk 	/*
    709       1.1        pk 	 * Always re-initialize the disk structure.  We want statistics
    710       1.1        pk 	 * to start with a clean slate.
    711       1.1        pk 	 */
    712      1.82    cegger 	memset(&xd->sc_dk, 0, sizeof(xd->sc_dk));
    713       1.1        pk 
    714       1.1        pk 	/* if booting, init the xd_softc */
    715       1.1        pk 
    716       1.1        pk 	if (xa->booting) {
    717       1.1        pk 		xd->state = XD_DRIVE_UNKNOWN;	/* to start */
    718       1.1        pk 		xd->flags = 0;
    719       1.1        pk 		xd->parent = xdc;
    720       1.1        pk 	}
    721       1.1        pk 	xd->xd_drive = xa->driveno;
    722       1.1        pk 	fmode = xa->fullmode;
    723       1.1        pk 	xdc->sc_drives[xa->driveno] = xd;
    724       1.1        pk 
    725       1.1        pk 	/* if not booting, make sure we are the only process in the attach for
    726       1.1        pk 	 * this drive.   if locked out, sleep on it. */
    727       1.1        pk 
    728       1.1        pk 	if (!xa->booting) {
    729       1.1        pk 		s = splbio();
    730       1.1        pk 		while (xd->state == XD_DRIVE_ATTACHING) {
    731       1.1        pk 			if (tsleep(&xd->state, PRIBIO, "xdattach", 0)) {
    732       1.1        pk 				splx(s);
    733       1.1        pk 				return;
    734       1.1        pk 			}
    735       1.1        pk 		}
    736       1.1        pk 		printf("%s at %s",
    737      1.75    cegger 			device_xname(&xd->sc_dev), device_xname(&xd->parent->sc_dev));
    738       1.1        pk 	}
    739       1.3        pk 
    740       1.1        pk 	/* we now have control */
    741       1.1        pk 	xd->state = XD_DRIVE_ATTACHING;
    742       1.1        pk 	newstate = XD_DRIVE_UNKNOWN;
    743       1.1        pk 
    744       1.3        pk 	buf = NULL;
    745      1.21        pk 	if ((error = xd_dmamem_alloc(xdc->dmatag, xdc->auxmap, &seg, &rseg,
    746      1.21        pk 				     XDFM_BPS,
    747      1.66  christos 				     (void **)&buf,
    748      1.52       mrg 				     &busaddr)) != 0) {
    749      1.75    cegger 		aprint_error_dev(&xdc->sc_dev, "DMA buffer alloc error %d\n",
    750      1.75    cegger 			error);
    751      1.21        pk 		return;
    752       1.3        pk 	}
    753      1.66  christos 	dmaddr = (void *)(u_long)BUS_ADDR_PADDR(busaddr);
    754       1.3        pk 
    755       1.1        pk 	/* first try and reset the drive */
    756       1.1        pk 
    757       1.1        pk 	rqno = xdc_cmd(xdc, XDCMD_RST, 0, xd->xd_drive, 0, 0, 0, fmode);
    758       1.3        pk 	XDC_DONE(xdc, rqno, error);
    759       1.3        pk 	if (error == XD_ERR_NRDY) {
    760       1.1        pk 		printf(" drive %d: off-line\n", xa->driveno);
    761       1.1        pk 		goto done;
    762       1.1        pk 	}
    763       1.3        pk 	if (error) {
    764       1.3        pk 		printf(": ERROR 0x%02x (%s)\n", error, xdc_e2str(error));
    765       1.1        pk 		goto done;
    766       1.1        pk 	}
    767       1.1        pk 	printf(" drive %d: ready\n", xa->driveno);
    768       1.1        pk 
    769       1.1        pk 	/* now set format parameters */
    770       1.1        pk 
    771       1.1        pk 	rqno = xdc_cmd(xdc, XDCMD_WRP, XDFUN_FMT, xd->xd_drive, 0, 0, 0, fmode);
    772       1.3        pk 	XDC_DONE(xdc, rqno, error);
    773       1.3        pk 	if (error) {
    774      1.75    cegger 		aprint_error_dev(&xd->sc_dev, "write format parameters failed: %s\n",
    775      1.75    cegger 			xdc_e2str(error));
    776       1.1        pk 		goto done;
    777       1.1        pk 	}
    778       1.1        pk 
    779       1.1        pk 	/* get drive parameters */
    780       1.1        pk 	rqno = xdc_cmd(xdc, XDCMD_RDP, XDFUN_DRV, xd->xd_drive, 0, 0, 0, fmode);
    781       1.1        pk 	if (rqno != XD_ERR_FAIL) {
    782      1.21        pk 		driopb = (struct xd_iopb_drive *) &xdc->iopbase[rqno];
    783       1.1        pk 		spt = driopb->sectpertrk;
    784       1.1        pk 	}
    785       1.3        pk 	XDC_DONE(xdc, rqno, error);
    786       1.3        pk 	if (error) {
    787      1.75    cegger 		aprint_error_dev(&xd->sc_dev, "read drive parameters failed: %s\n",
    788      1.75    cegger 			xdc_e2str(error));
    789       1.1        pk 		goto done;
    790       1.1        pk 	}
    791       1.1        pk 
    792       1.1        pk 	/*
    793       1.1        pk 	 * now set drive parameters (to semi-bogus values) so we can read the
    794       1.1        pk 	 * disk label.
    795       1.1        pk 	 */
    796       1.1        pk 	xd->pcyl = xd->ncyl = 1;
    797       1.1        pk 	xd->acyl = 0;
    798       1.1        pk 	xd->nhead = 1;
    799       1.1        pk 	xd->nsect = 1;
    800       1.1        pk 	xd->sectpercyl = 1;
    801       1.1        pk 	for (lcv = 0; lcv < 126; lcv++)	/* init empty bad144 table */
    802       1.1        pk 		xd->dkb.bt_bad[lcv].bt_cyl = xd->dkb.bt_bad[lcv].bt_trksec = 0xffff;
    803       1.1        pk 	rqno = xdc_cmd(xdc, XDCMD_WRP, XDFUN_DRV, xd->xd_drive, 0, 0, 0, fmode);
    804       1.3        pk 	XDC_DONE(xdc, rqno, error);
    805       1.3        pk 	if (error) {
    806      1.75    cegger 		aprint_error_dev(&xd->sc_dev, "write drive parameters failed: %s\n",
    807      1.75    cegger 			xdc_e2str(error));
    808       1.1        pk 		goto done;
    809       1.1        pk 	}
    810       1.1        pk 
    811       1.1        pk 	/* read disk label */
    812       1.3        pk 	rqno = xdc_cmd(xdc, XDCMD_RD, 0, xd->xd_drive, 0, 1, dmaddr, fmode);
    813       1.3        pk 	XDC_DONE(xdc, rqno, error);
    814       1.3        pk 	if (error) {
    815      1.75    cegger 		aprint_error_dev(&xd->sc_dev, "reading disk label failed: %s\n",
    816      1.75    cegger 			xdc_e2str(error));
    817       1.1        pk 		goto done;
    818       1.1        pk 	}
    819       1.1        pk 	newstate = XD_DRIVE_NOLABEL;
    820       1.1        pk 
    821       1.1        pk 	xd->hw_spt = spt;
    822       1.1        pk 	/* Attach the disk: must be before getdisklabel to malloc label */
    823      1.75    cegger 	disk_init(&xd->sc_dk, device_xname(&xd->sc_dev), &xddkdriver);
    824       1.1        pk 	disk_attach(&xd->sc_dk);
    825       1.1        pk 
    826       1.3        pk 	if (xdgetdisklabel(xd, buf) != XD_ERR_AOK)
    827       1.1        pk 		goto done;
    828       1.1        pk 
    829       1.1        pk 	/* inform the user of what is up */
    830      1.75    cegger 	printf("%s: <%s>, pcyl %d, hw_spt %d\n", device_xname(&xd->sc_dev),
    831       1.3        pk 		buf, xd->pcyl, spt);
    832       1.1        pk 	mb = xd->ncyl * (xd->nhead * xd->nsect) / (1048576 / XDFM_BPS);
    833       1.1        pk 	printf("%s: %dMB, %d cyl, %d head, %d sec, %d bytes/sec\n",
    834      1.75    cegger 		device_xname(&xd->sc_dev), mb, xd->ncyl, xd->nhead, xd->nsect,
    835       1.1        pk 		XDFM_BPS);
    836       1.1        pk 
    837       1.1        pk 	/* now set the real drive parameters! */
    838       1.1        pk 
    839       1.1        pk 	rqno = xdc_cmd(xdc, XDCMD_WRP, XDFUN_DRV, xd->xd_drive, 0, 0, 0, fmode);
    840       1.3        pk 	XDC_DONE(xdc, rqno, error);
    841       1.3        pk 	if (error) {
    842      1.75    cegger 		aprint_error_dev(&xd->sc_dev, "write real drive parameters failed: %s\n",
    843      1.75    cegger 			xdc_e2str(error));
    844       1.1        pk 		goto done;
    845       1.1        pk 	}
    846       1.1        pk 	newstate = XD_DRIVE_ONLINE;
    847       1.1        pk 
    848       1.1        pk 	/*
    849       1.1        pk 	 * read bad144 table. this table resides on the first sector of the
    850       1.1        pk 	 * last track of the disk (i.e. second cyl of "acyl" area).
    851       1.1        pk 	 */
    852       1.1        pk 
    853       1.1        pk 	blk = (xd->ncyl + xd->acyl - 1) * (xd->nhead * xd->nsect) + /* last cyl */
    854       1.1        pk 	    (xd->nhead - 1) * xd->nsect;	/* last head */
    855       1.3        pk 	rqno = xdc_cmd(xdc, XDCMD_RD, 0, xd->xd_drive, blk, 1, dmaddr, fmode);
    856       1.3        pk 	XDC_DONE(xdc, rqno, error);
    857       1.3        pk 	if (error) {
    858      1.75    cegger 		aprint_error_dev(&xd->sc_dev, "reading bad144 failed: %s\n",
    859      1.75    cegger 			xdc_e2str(error));
    860       1.1        pk 		goto done;
    861       1.1        pk 	}
    862       1.1        pk 
    863       1.1        pk 	/* check dkbad for sanity */
    864       1.3        pk 	dkb = (struct dkbad *) buf;
    865       1.1        pk 	for (lcv = 0; lcv < 126; lcv++) {
    866       1.1        pk 		if ((dkb->bt_bad[lcv].bt_cyl == 0xffff ||
    867       1.1        pk 				dkb->bt_bad[lcv].bt_cyl == 0) &&
    868       1.1        pk 		     dkb->bt_bad[lcv].bt_trksec == 0xffff)
    869       1.1        pk 			continue;	/* blank */
    870       1.1        pk 		if (dkb->bt_bad[lcv].bt_cyl >= xd->ncyl)
    871       1.1        pk 			break;
    872       1.1        pk 		if ((dkb->bt_bad[lcv].bt_trksec >> 8) >= xd->nhead)
    873       1.1        pk 			break;
    874       1.1        pk 		if ((dkb->bt_bad[lcv].bt_trksec & 0xff) >= xd->nsect)
    875       1.1        pk 			break;
    876       1.1        pk 	}
    877       1.1        pk 	if (lcv != 126) {
    878      1.75    cegger 		aprint_error_dev(&xd->sc_dev, "warning: invalid bad144 sector!\n");
    879       1.1        pk 	} else {
    880      1.84   tsutsui 		memcpy(&xd->dkb, buf, XDFM_BPS);
    881       1.1        pk 	}
    882       1.1        pk 
    883       1.1        pk done:
    884       1.3        pk 	if (buf != NULL) {
    885      1.21        pk 		xd_dmamem_free(xdc->dmatag, xdc->auxmap,
    886      1.21        pk 				&seg, rseg, XDFM_BPS, buf);
    887       1.3        pk 	}
    888       1.3        pk 
    889       1.1        pk 	xd->state = newstate;
    890       1.1        pk 	if (!xa->booting) {
    891       1.1        pk 		wakeup(&xd->state);
    892       1.1        pk 		splx(s);
    893       1.1        pk 	}
    894       1.1        pk }
    895       1.1        pk 
    896       1.1        pk /*
    897       1.1        pk  * end of autoconfig functions
    898       1.1        pk  */
    899       1.1        pk 
    900       1.1        pk /*
    901       1.1        pk  * { b , c } d e v s w   f u n c t i o n s
    902       1.1        pk  */
    903       1.1        pk 
    904       1.1        pk /*
    905       1.1        pk  * xdclose: close device
    906       1.1        pk  */
    907       1.1        pk int
    908      1.80       dsl xdclose(dev_t dev, int flag, int fmt, struct lwp *l)
    909       1.1        pk {
    910      1.76  drochner 	struct xd_softc *xd = device_lookup_private(&xd_cd, DISKUNIT(dev));
    911       1.1        pk 	int     part = DISKPART(dev);
    912       1.1        pk 
    913       1.1        pk 	/* clear mask bits */
    914       1.1        pk 
    915       1.1        pk 	switch (fmt) {
    916       1.1        pk 	case S_IFCHR:
    917       1.1        pk 		xd->sc_dk.dk_copenmask &= ~(1 << part);
    918       1.1        pk 		break;
    919       1.1        pk 	case S_IFBLK:
    920       1.1        pk 		xd->sc_dk.dk_bopenmask &= ~(1 << part);
    921       1.1        pk 		break;
    922       1.1        pk 	}
    923       1.1        pk 	xd->sc_dk.dk_openmask = xd->sc_dk.dk_copenmask | xd->sc_dk.dk_bopenmask;
    924       1.1        pk 
    925       1.1        pk 	return 0;
    926       1.1        pk }
    927       1.1        pk 
    928       1.1        pk /*
    929       1.1        pk  * xddump: crash dump system
    930       1.1        pk  */
    931       1.1        pk int
    932      1.79       dsl xddump(dev_t dev, daddr_t blkno, void *va, size_t size)
    933       1.1        pk {
    934       1.1        pk 	int     unit, part;
    935       1.1        pk 	struct xd_softc *xd;
    936       1.1        pk 
    937       1.1        pk 	unit = DISKUNIT(dev);
    938       1.1        pk 	part = DISKPART(dev);
    939       1.1        pk 
    940      1.76  drochner 	xd = device_lookup_private(&xd_cd, unit);
    941      1.76  drochner 	if (!xd)
    942      1.76  drochner 		return ENXIO;
    943       1.1        pk 
    944      1.75    cegger 	printf("%s%c: crash dump not supported (yet)\n", device_xname(&xd->sc_dev),
    945       1.1        pk 	    'a' + part);
    946       1.1        pk 
    947       1.1        pk 	return ENXIO;
    948       1.1        pk 
    949       1.1        pk 	/* outline: globals: "dumplo" == sector number of partition to start
    950       1.1        pk 	 * dump at (convert to physical sector with partition table)
    951       1.1        pk 	 * "dumpsize" == size of dump in clicks "physmem" == size of physical
    952       1.1        pk 	 * memory (clicks, ctob() to get bytes) (normal case: dumpsize ==
    953       1.1        pk 	 * physmem)
    954       1.1        pk 	 *
    955       1.1        pk 	 * dump a copy of physical memory to the dump device starting at sector
    956       1.1        pk 	 * "dumplo" in the swap partition (make sure > 0).   map in pages as
    957       1.1        pk 	 * we go.   use polled I/O.
    958       1.1        pk 	 *
    959       1.1        pk 	 * XXX how to handle NON_CONTIG? */
    960       1.1        pk 
    961       1.1        pk }
    962       1.1        pk 
    963      1.73      elad static enum kauth_device_req
    964      1.73      elad xd_getkauthreq(u_char cmd)
    965      1.73      elad {
    966      1.73      elad 	enum kauth_device_req req;
    967      1.73      elad 
    968      1.73      elad 	switch (cmd) {
    969      1.73      elad 	case XDCMD_WR:
    970      1.73      elad 	case XDCMD_XWR:
    971      1.74      elad 		req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_WRITE;
    972      1.73      elad 		break;
    973      1.73      elad 
    974      1.73      elad 	case XDCMD_RD:
    975      1.74      elad 		req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_READ;
    976      1.73      elad 		break;
    977      1.73      elad 
    978      1.73      elad 	case XDCMD_RDP:
    979      1.73      elad 	case XDCMD_XRD:
    980      1.74      elad 		req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_READCONF;
    981      1.73      elad 		break;
    982      1.73      elad 
    983      1.73      elad 	case XDCMD_WRP:
    984      1.73      elad 	case XDCMD_RST:
    985      1.74      elad 		req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_WRITECONF;
    986      1.73      elad 		break;
    987      1.73      elad 
    988      1.73      elad 	case XDCMD_NOP:
    989      1.73      elad 	case XDCMD_SK:
    990      1.73      elad 	case XDCMD_TST:
    991      1.73      elad 	default:
    992      1.73      elad 		req = 0;
    993      1.73      elad 		break;
    994      1.73      elad 	}
    995      1.73      elad 
    996      1.73      elad 	return (req);
    997      1.73      elad }
    998      1.73      elad 
    999       1.1        pk /*
   1000       1.1        pk  * xdioctl: ioctls on XD drives.   based on ioctl's of other netbsd disks.
   1001       1.1        pk  */
   1002       1.1        pk int
   1003      1.59  christos xdioctl(dev, command, addr, flag, l)
   1004       1.1        pk 	dev_t   dev;
   1005       1.1        pk 	u_long  command;
   1006      1.66  christos 	void *addr;
   1007       1.1        pk 	int     flag;
   1008      1.59  christos 	struct lwp *l;
   1009       1.1        pk 
   1010       1.1        pk {
   1011       1.1        pk 	struct xd_softc *xd;
   1012       1.1        pk 	struct xd_iocmd *xio;
   1013       1.1        pk 	int     error, s, unit;
   1014      1.33      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1015      1.35      fvdl 	struct disklabel newlabel;
   1016      1.33      fvdl #endif
   1017      1.35      fvdl 	struct disklabel *lp;
   1018       1.1        pk 
   1019       1.1        pk 	unit = DISKUNIT(dev);
   1020       1.1        pk 
   1021      1.76  drochner 	if ((xd = device_lookup_private(&xd_cd, unit)) == NULL)
   1022       1.1        pk 		return (ENXIO);
   1023       1.1        pk 
   1024       1.1        pk 	/* switch on ioctl type */
   1025       1.1        pk 
   1026       1.1        pk 	switch (command) {
   1027       1.1        pk 	case DIOCSBAD:		/* set bad144 info */
   1028       1.1        pk 		if ((flag & FWRITE) == 0)
   1029       1.1        pk 			return EBADF;
   1030       1.1        pk 		s = splbio();
   1031      1.84   tsutsui 		memcpy(&xd->dkb, addr, sizeof(xd->dkb));
   1032       1.1        pk 		splx(s);
   1033       1.1        pk 		return 0;
   1034       1.1        pk 
   1035       1.1        pk 	case DIOCGDINFO:	/* get disk label */
   1036      1.84   tsutsui 		memcpy(addr, xd->sc_dk.dk_label, sizeof(struct disklabel));
   1037       1.1        pk 		return 0;
   1038      1.33      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1039      1.33      fvdl 	case ODIOCGDINFO:
   1040      1.33      fvdl 		newlabel = *(xd->sc_dk.dk_label);
   1041      1.33      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
   1042      1.34      fvdl 			return ENOTTY;
   1043      1.33      fvdl 		memcpy(addr, &newlabel, sizeof (struct olddisklabel));
   1044      1.33      fvdl 		return 0;
   1045      1.33      fvdl #endif
   1046       1.1        pk 
   1047       1.1        pk 	case DIOCGPART:	/* get partition info */
   1048       1.1        pk 		((struct partinfo *) addr)->disklab = xd->sc_dk.dk_label;
   1049       1.1        pk 		((struct partinfo *) addr)->part =
   1050       1.1        pk 		    &xd->sc_dk.dk_label->d_partitions[DISKPART(dev)];
   1051       1.1        pk 		return 0;
   1052       1.1        pk 
   1053       1.1        pk 	case DIOCSDINFO:	/* set disk label */
   1054      1.33      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1055      1.33      fvdl 	case ODIOCSDINFO:
   1056      1.33      fvdl 		if (command == ODIOCSDINFO) {
   1057      1.33      fvdl 			memset(&newlabel, 0, sizeof newlabel);
   1058      1.33      fvdl 			memcpy(&newlabel, addr, sizeof (struct olddisklabel));
   1059      1.33      fvdl 			lp = &newlabel;
   1060      1.33      fvdl 		} else
   1061      1.33      fvdl #endif
   1062      1.33      fvdl 		lp = (struct disklabel *)addr;
   1063      1.33      fvdl 
   1064       1.1        pk 		if ((flag & FWRITE) == 0)
   1065       1.1        pk 			return EBADF;
   1066       1.1        pk 		error = setdisklabel(xd->sc_dk.dk_label,
   1067      1.33      fvdl 		    lp, /* xd->sc_dk.dk_openmask : */ 0,
   1068       1.1        pk 		    xd->sc_dk.dk_cpulabel);
   1069       1.1        pk 		if (error == 0) {
   1070       1.1        pk 			if (xd->state == XD_DRIVE_NOLABEL)
   1071       1.1        pk 				xd->state = XD_DRIVE_ONLINE;
   1072       1.1        pk 		}
   1073       1.1        pk 		return error;
   1074       1.1        pk 
   1075       1.1        pk 	case DIOCWLABEL:	/* change write status of disk label */
   1076       1.1        pk 		if ((flag & FWRITE) == 0)
   1077       1.1        pk 			return EBADF;
   1078       1.1        pk 		if (*(int *) addr)
   1079       1.1        pk 			xd->flags |= XD_WLABEL;
   1080       1.1        pk 		else
   1081       1.1        pk 			xd->flags &= ~XD_WLABEL;
   1082       1.1        pk 		return 0;
   1083       1.1        pk 
   1084       1.1        pk 	case DIOCWDINFO:	/* write disk label */
   1085      1.33      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1086      1.33      fvdl 	case ODIOCWDINFO:
   1087      1.33      fvdl 		if (command == ODIOCWDINFO) {
   1088      1.33      fvdl 			memset(&newlabel, 0, sizeof newlabel);
   1089      1.33      fvdl 			memcpy(&newlabel, addr, sizeof (struct olddisklabel));
   1090      1.33      fvdl 			lp = &newlabel;
   1091      1.33      fvdl 		} else
   1092      1.33      fvdl #endif
   1093      1.33      fvdl 		lp = (struct disklabel *)addr;
   1094      1.33      fvdl 
   1095       1.1        pk 		if ((flag & FWRITE) == 0)
   1096       1.1        pk 			return EBADF;
   1097       1.1        pk 		error = setdisklabel(xd->sc_dk.dk_label,
   1098      1.33      fvdl 		    lp, /* xd->sc_dk.dk_openmask : */ 0,
   1099       1.1        pk 		    xd->sc_dk.dk_cpulabel);
   1100       1.1        pk 		if (error == 0) {
   1101       1.1        pk 			if (xd->state == XD_DRIVE_NOLABEL)
   1102       1.1        pk 				xd->state = XD_DRIVE_ONLINE;
   1103       1.1        pk 
   1104       1.1        pk 			/* Simulate opening partition 0 so write succeeds. */
   1105       1.1        pk 			xd->sc_dk.dk_openmask |= (1 << 0);
   1106      1.33      fvdl 			error = writedisklabel(MAKEDISKDEV(major(dev),
   1107      1.33      fvdl 			    DISKUNIT(dev), RAW_PART),
   1108       1.1        pk 			    xdstrategy, xd->sc_dk.dk_label,
   1109       1.1        pk 			    xd->sc_dk.dk_cpulabel);
   1110       1.1        pk 			xd->sc_dk.dk_openmask =
   1111       1.1        pk 			    xd->sc_dk.dk_copenmask | xd->sc_dk.dk_bopenmask;
   1112       1.1        pk 		}
   1113       1.1        pk 		return error;
   1114       1.1        pk 
   1115      1.73      elad 	case DIOSXDCMD: {
   1116      1.73      elad 		enum kauth_device_req req;
   1117      1.73      elad 
   1118       1.1        pk 		xio = (struct xd_iocmd *) addr;
   1119      1.73      elad 		req = xd_getkauthreq(xio->cmd);
   1120      1.73      elad 		if ((error = kauth_authorize_device_passthru(l->l_cred,
   1121      1.73      elad 		    dev, req, xio)) != 0)
   1122       1.1        pk 			return (error);
   1123       1.1        pk 		return (xdc_ioctlcmd(xd, dev, xio));
   1124      1.73      elad 		}
   1125       1.1        pk 
   1126       1.1        pk 	default:
   1127       1.1        pk 		return ENOTTY;
   1128       1.1        pk 	}
   1129       1.1        pk }
   1130       1.1        pk /*
   1131       1.1        pk  * xdopen: open drive
   1132       1.1        pk  */
   1133       1.1        pk 
   1134       1.1        pk int
   1135      1.80       dsl xdopen(dev_t dev, int flag, int fmt, struct lwp *l)
   1136       1.1        pk {
   1137       1.1        pk 	int     unit, part;
   1138       1.1        pk 	struct xd_softc *xd;
   1139       1.1        pk 	struct xdc_attach_args xa;
   1140       1.1        pk 
   1141       1.1        pk 	/* first, could it be a valid target? */
   1142       1.1        pk 
   1143       1.1        pk 	unit = DISKUNIT(dev);
   1144      1.76  drochner 	if ((xd = device_lookup_private(&xd_cd, unit)) == NULL)
   1145       1.1        pk 		return (ENXIO);
   1146       1.1        pk 	part = DISKPART(dev);
   1147       1.1        pk 
   1148       1.1        pk 	/* do we need to attach the drive? */
   1149       1.1        pk 
   1150       1.1        pk 	if (xd->state == XD_DRIVE_UNKNOWN) {
   1151       1.1        pk 		xa.driveno = xd->xd_drive;
   1152       1.1        pk 		xa.fullmode = XD_SUB_WAIT;
   1153       1.1        pk 		xa.booting = 0;
   1154      1.86    cegger 		xdattach((device_t) xd->parent, (device_t) xd, &xa);
   1155       1.1        pk 		if (xd->state == XD_DRIVE_UNKNOWN) {
   1156       1.1        pk 			return (EIO);
   1157       1.1        pk 		}
   1158       1.1        pk 	}
   1159       1.1        pk 	/* check for partition */
   1160       1.1        pk 
   1161       1.1        pk 	if (part != RAW_PART &&
   1162       1.1        pk 	    (part >= xd->sc_dk.dk_label->d_npartitions ||
   1163       1.1        pk 		xd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
   1164       1.1        pk 		return (ENXIO);
   1165       1.1        pk 	}
   1166       1.1        pk 	/* set open masks */
   1167       1.1        pk 
   1168       1.1        pk 	switch (fmt) {
   1169       1.1        pk 	case S_IFCHR:
   1170       1.1        pk 		xd->sc_dk.dk_copenmask |= (1 << part);
   1171       1.1        pk 		break;
   1172       1.1        pk 	case S_IFBLK:
   1173       1.1        pk 		xd->sc_dk.dk_bopenmask |= (1 << part);
   1174       1.1        pk 		break;
   1175       1.1        pk 	}
   1176       1.1        pk 	xd->sc_dk.dk_openmask = xd->sc_dk.dk_copenmask | xd->sc_dk.dk_bopenmask;
   1177       1.1        pk 
   1178       1.1        pk 	return 0;
   1179       1.1        pk }
   1180       1.1        pk 
   1181       1.1        pk int
   1182      1.79       dsl xdread(dev_t dev, struct uio *uio, int flags)
   1183       1.1        pk {
   1184       1.1        pk 
   1185       1.1        pk 	return (physio(xdstrategy, NULL, dev, B_READ, minphys, uio));
   1186       1.1        pk }
   1187       1.1        pk 
   1188       1.1        pk int
   1189      1.79       dsl xdwrite(dev_t dev, struct uio *uio, int flags)
   1190       1.1        pk {
   1191       1.1        pk 
   1192       1.1        pk 	return (physio(xdstrategy, NULL, dev, B_WRITE, minphys, uio));
   1193       1.1        pk }
   1194       1.1        pk 
   1195       1.1        pk 
   1196       1.1        pk /*
   1197       1.1        pk  * xdsize: return size of a partition for a dump
   1198       1.1        pk  */
   1199       1.1        pk 
   1200       1.1        pk int
   1201       1.1        pk xdsize(dev)
   1202       1.1        pk 	dev_t   dev;
   1203       1.1        pk 
   1204       1.1        pk {
   1205       1.1        pk 	struct xd_softc *xdsc;
   1206       1.1        pk 	int     unit, part, size, omask;
   1207       1.1        pk 
   1208       1.1        pk 	/* valid unit? */
   1209       1.1        pk 	unit = DISKUNIT(dev);
   1210      1.76  drochner 	if ((xdsc = device_lookup_private(&xd_cd, unit)) == NULL)
   1211       1.1        pk 		return (-1);
   1212       1.1        pk 
   1213       1.1        pk 	part = DISKPART(dev);
   1214       1.1        pk 	omask = xdsc->sc_dk.dk_openmask & (1 << part);
   1215       1.1        pk 
   1216       1.1        pk 	if (omask == 0 && xdopen(dev, 0, S_IFBLK, NULL) != 0)
   1217       1.1        pk 		return (-1);
   1218       1.1        pk 
   1219       1.1        pk 	/* do it */
   1220       1.1        pk 	if (xdsc->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
   1221       1.1        pk 		size = -1;	/* only give valid size for swap partitions */
   1222       1.1        pk 	else
   1223       1.1        pk 		size = xdsc->sc_dk.dk_label->d_partitions[part].p_size *
   1224       1.1        pk 		    (xdsc->sc_dk.dk_label->d_secsize / DEV_BSIZE);
   1225       1.1        pk 	if (omask == 0 && xdclose(dev, 0, S_IFBLK, NULL) != 0)
   1226       1.1        pk 		return (-1);
   1227       1.1        pk 	return (size);
   1228       1.1        pk }
   1229       1.1        pk /*
   1230       1.1        pk  * xdstrategy: buffering system interface to xd.
   1231       1.1        pk  */
   1232       1.1        pk 
   1233       1.1        pk void
   1234       1.1        pk xdstrategy(bp)
   1235       1.1        pk 	struct buf *bp;
   1236       1.1        pk 
   1237       1.1        pk {
   1238       1.1        pk 	struct xd_softc *xd;
   1239       1.1        pk 	struct xdc_softc *parent;
   1240       1.1        pk 	int     s, unit;
   1241       1.1        pk 	struct xdc_attach_args xa;
   1242       1.1        pk 
   1243       1.1        pk 	unit = DISKUNIT(bp->b_dev);
   1244       1.1        pk 
   1245       1.1        pk 	/* check for live device */
   1246       1.1        pk 
   1247      1.76  drochner 	if (!(xd = device_lookup_private(&xd_cd, unit)) ||
   1248       1.1        pk 	    bp->b_blkno < 0 ||
   1249       1.1        pk 	    (bp->b_bcount % xd->sc_dk.dk_label->d_secsize) != 0) {
   1250       1.1        pk 		bp->b_error = EINVAL;
   1251      1.69        ad 		goto done;
   1252       1.1        pk 	}
   1253       1.1        pk 	/* do we need to attach the drive? */
   1254       1.1        pk 
   1255       1.1        pk 	if (xd->state == XD_DRIVE_UNKNOWN) {
   1256       1.1        pk 		xa.driveno = xd->xd_drive;
   1257       1.1        pk 		xa.fullmode = XD_SUB_WAIT;
   1258       1.1        pk 		xa.booting = 0;
   1259      1.86    cegger 		xdattach((device_t)xd->parent, (device_t)xd, &xa);
   1260       1.1        pk 		if (xd->state == XD_DRIVE_UNKNOWN) {
   1261       1.1        pk 			bp->b_error = EIO;
   1262      1.69        ad 			goto done;
   1263       1.1        pk 		}
   1264       1.1        pk 	}
   1265       1.1        pk 	if (xd->state != XD_DRIVE_ONLINE && DISKPART(bp->b_dev) != RAW_PART) {
   1266       1.1        pk 		/* no I/O to unlabeled disks, unless raw partition */
   1267       1.1        pk 		bp->b_error = EIO;
   1268      1.69        ad 		goto done;
   1269       1.1        pk 	}
   1270       1.1        pk 	/* short circuit zero length request */
   1271       1.1        pk 
   1272       1.1        pk 	if (bp->b_bcount == 0)
   1273       1.1        pk 		goto done;
   1274       1.1        pk 
   1275       1.1        pk 	/* check bounds with label (disksubr.c).  Determine the size of the
   1276       1.1        pk 	 * transfer, and make sure it is within the boundaries of the
   1277       1.1        pk 	 * partition. Adjust transfer if needed, and signal errors or early
   1278       1.1        pk 	 * completion. */
   1279       1.1        pk 
   1280      1.49   thorpej 	if (bounds_check_with_label(&xd->sc_dk, bp,
   1281       1.1        pk 		(xd->flags & XD_WLABEL) != 0) <= 0)
   1282       1.1        pk 		goto done;
   1283       1.1        pk 
   1284       1.1        pk 	/*
   1285       1.1        pk 	 * now we know we have a valid buf structure that we need to do I/O
   1286       1.1        pk 	 * on.
   1287       1.1        pk 	 *
   1288       1.1        pk 	 * note that we don't disksort because the controller has a sorting
   1289       1.1        pk 	 * algorithm built into the hardware.
   1290       1.1        pk 	 */
   1291       1.1        pk 
   1292       1.1        pk 	s = splbio();		/* protect the queues */
   1293       1.1        pk 
   1294       1.1        pk 	/* first, give jobs in front of us a chance */
   1295       1.1        pk 	parent = xd->parent;
   1296      1.78      yamt 	while (parent->nfree > 0 && bufq_peek(parent->sc_wq) != NULL)
   1297       1.1        pk 		if (xdc_startbuf(parent, NULL, NULL) != XD_ERR_AOK)
   1298       1.1        pk 			break;
   1299       1.1        pk 
   1300       1.1        pk 	/* if there are no free iorq's, then we just queue and return. the
   1301       1.1        pk 	 * buffs will get picked up later by xdcintr().
   1302       1.1        pk 	 */
   1303       1.1        pk 
   1304       1.1        pk 	if (parent->nfree == 0) {
   1305      1.78      yamt 		bufq_put(parent->sc_wq, bp);
   1306       1.1        pk 		splx(s);
   1307       1.1        pk 		return;
   1308       1.1        pk 	}
   1309       1.1        pk 
   1310       1.1        pk 	/* now we have free iopb's and we are at splbio... start 'em up */
   1311       1.1        pk 	if (xdc_startbuf(parent, xd, bp) != XD_ERR_AOK) {
   1312       1.1        pk 		return;
   1313       1.1        pk 	}
   1314       1.1        pk 
   1315       1.1        pk 	/* done! */
   1316       1.1        pk 
   1317       1.1        pk 	splx(s);
   1318       1.1        pk 	return;
   1319       1.1        pk 
   1320       1.1        pk done:				/* tells upper layers we are done with this
   1321       1.1        pk 				 * buf */
   1322       1.1        pk 	bp->b_resid = bp->b_bcount;
   1323       1.1        pk 	biodone(bp);
   1324       1.1        pk }
   1325       1.1        pk /*
   1326       1.1        pk  * end of {b,c}devsw functions
   1327       1.1        pk  */
   1328       1.1        pk 
   1329       1.1        pk /*
   1330       1.1        pk  * i n t e r r u p t   f u n c t i o n
   1331       1.1        pk  *
   1332       1.1        pk  * xdcintr: hardware interrupt.
   1333       1.1        pk  */
   1334       1.1        pk int
   1335       1.1        pk xdcintr(v)
   1336       1.1        pk 	void   *v;
   1337       1.1        pk 
   1338       1.1        pk {
   1339       1.1        pk 	struct xdc_softc *xdcsc = v;
   1340       1.1        pk 
   1341       1.1        pk 	/* kick the event counter */
   1342       1.1        pk 
   1343       1.1        pk 	xdcsc->sc_intrcnt.ev_count++;
   1344       1.1        pk 
   1345       1.1        pk 	/* remove as many done IOPBs as possible */
   1346       1.1        pk 
   1347       1.1        pk 	xdc_remove_iorq(xdcsc);
   1348       1.1        pk 
   1349       1.1        pk 	/* start any iorq's already waiting */
   1350       1.1        pk 
   1351       1.1        pk 	xdc_start(xdcsc, XDC_MAXIOPB);
   1352       1.1        pk 
   1353       1.1        pk 	/* fill up any remaining iorq's with queue'd buffers */
   1354       1.1        pk 
   1355      1.78      yamt 	while (xdcsc->nfree > 0 && bufq_peek(xdcsc->sc_wq) != NULL)
   1356       1.1        pk 		if (xdc_startbuf(xdcsc, NULL, NULL) != XD_ERR_AOK)
   1357       1.1        pk 			break;
   1358       1.1        pk 
   1359       1.1        pk 	return (1);
   1360       1.1        pk }
   1361       1.1        pk /*
   1362       1.1        pk  * end of interrupt function
   1363       1.1        pk  */
   1364       1.1        pk 
   1365       1.1        pk /*
   1366       1.1        pk  * i n t e r n a l   f u n c t i o n s
   1367       1.1        pk  */
   1368       1.1        pk 
   1369       1.1        pk /*
   1370       1.1        pk  * xdc_rqinit: fill out the fields of an I/O request
   1371       1.1        pk  */
   1372       1.1        pk 
   1373       1.1        pk inline void
   1374      1.79       dsl xdc_rqinit(struct xd_iorq *rq, struct xdc_softc *xdc, struct xd_softc *xd, int md, u_long blk, int cnt, void *db, struct buf *bp)
   1375       1.1        pk {
   1376       1.1        pk 	rq->xdc = xdc;
   1377       1.1        pk 	rq->xd = xd;
   1378       1.1        pk 	rq->ttl = XDC_MAXTTL + 10;
   1379       1.1        pk 	rq->mode = md;
   1380      1.64  christos 	rq->tries = rq->errnum = rq->lasterror = 0;
   1381       1.1        pk 	rq->blockno = blk;
   1382       1.1        pk 	rq->sectcnt = cnt;
   1383       1.3        pk 	rq->dbuf = db;
   1384       1.1        pk 	rq->buf = bp;
   1385       1.1        pk }
   1386       1.1        pk /*
   1387       1.1        pk  * xdc_rqtopb: load up an IOPB based on an iorq
   1388       1.1        pk  */
   1389       1.1        pk 
   1390       1.1        pk void
   1391       1.1        pk xdc_rqtopb(iorq, iopb, cmd, subfun)
   1392       1.1        pk 	struct xd_iorq *iorq;
   1393       1.1        pk 	struct xd_iopb *iopb;
   1394       1.1        pk 	int     cmd, subfun;
   1395       1.1        pk 
   1396       1.1        pk {
   1397       1.1        pk 	u_long  block, dp;
   1398       1.1        pk 
   1399       1.1        pk 	/* standard stuff */
   1400       1.1        pk 
   1401       1.1        pk 	iopb->errs = iopb->done = 0;
   1402       1.1        pk 	iopb->comm = cmd;
   1403      1.64  christos 	iopb->errnum = iopb->status = 0;
   1404       1.1        pk 	iopb->subfun = subfun;
   1405       1.1        pk 	if (iorq->xd)
   1406       1.1        pk 		iopb->unit = iorq->xd->xd_drive;
   1407       1.1        pk 	else
   1408       1.1        pk 		iopb->unit = 0;
   1409       1.1        pk 
   1410       1.1        pk 	/* check for alternate IOPB format */
   1411       1.1        pk 
   1412       1.1        pk 	if (cmd == XDCMD_WRP) {
   1413       1.1        pk 		switch (subfun) {
   1414       1.1        pk 		case XDFUN_CTL:{
   1415       1.1        pk 			struct xd_iopb_ctrl *ctrl =
   1416       1.1        pk 				(struct xd_iopb_ctrl *) iopb;
   1417       1.1        pk 			iopb->lll = 0;
   1418       1.1        pk 			iopb->intl = (XD_STATE(iorq->mode) == XD_SUB_POLL)
   1419       1.1        pk 					? 0
   1420       1.1        pk 					: iorq->xdc->ipl;
   1421       1.1        pk 			ctrl->param_a = XDPA_TMOD | XDPA_DACF;
   1422       1.1        pk 			ctrl->param_b = XDPB_ROR | XDPB_TDT_3_2USEC;
   1423       1.1        pk 			ctrl->param_c = XDPC_OVS | XDPC_COP | XDPC_ASR |
   1424       1.1        pk 					XDPC_RBC | XDPC_ECC2;
   1425       1.1        pk 			ctrl->throttle = XDC_THROTTLE;
   1426       1.1        pk 			ctrl->delay = XDC_DELAY;
   1427       1.1        pk 			break;
   1428       1.1        pk 			}
   1429       1.1        pk 		case XDFUN_DRV:{
   1430       1.1        pk 			struct xd_iopb_drive *drv =
   1431       1.1        pk 				(struct xd_iopb_drive *)iopb;
   1432       1.1        pk 			/* we assume that the disk label has the right
   1433       1.1        pk 			 * info */
   1434       1.1        pk 			if (XD_STATE(iorq->mode) == XD_SUB_POLL)
   1435       1.1        pk 				drv->dparam_ipl = (XDC_DPARAM << 3);
   1436       1.1        pk 			else
   1437       1.1        pk 				drv->dparam_ipl = (XDC_DPARAM << 3) |
   1438       1.1        pk 						  iorq->xdc->ipl;
   1439       1.1        pk 			drv->maxsect = iorq->xd->nsect - 1;
   1440       1.1        pk 			drv->maxsector = drv->maxsect;
   1441       1.1        pk 			/* note: maxsector != maxsect only if you are
   1442       1.1        pk 			 * doing cyl sparing */
   1443       1.1        pk 			drv->headoff = 0;
   1444       1.1        pk 			drv->maxcyl = iorq->xd->pcyl - 1;
   1445       1.1        pk 			drv->maxhead = iorq->xd->nhead - 1;
   1446       1.1        pk 			break;
   1447       1.1        pk 			}
   1448       1.1        pk 		case XDFUN_FMT:{
   1449       1.1        pk 			struct xd_iopb_format *form =
   1450       1.1        pk 					(struct xd_iopb_format *) iopb;
   1451       1.1        pk 			if (XD_STATE(iorq->mode) == XD_SUB_POLL)
   1452       1.1        pk 				form->interleave_ipl = (XDC_INTERLEAVE << 3);
   1453       1.1        pk 			else
   1454       1.1        pk 				form->interleave_ipl = (XDC_INTERLEAVE << 3) |
   1455       1.1        pk 						       iorq->xdc->ipl;
   1456       1.1        pk 			form->field1 = XDFM_FIELD1;
   1457       1.1        pk 			form->field2 = XDFM_FIELD2;
   1458       1.1        pk 			form->field3 = XDFM_FIELD3;
   1459       1.1        pk 			form->field4 = XDFM_FIELD4;
   1460       1.1        pk 			form->bytespersec = XDFM_BPS;
   1461       1.1        pk 			form->field6 = XDFM_FIELD6;
   1462       1.1        pk 			form->field7 = XDFM_FIELD7;
   1463       1.1        pk 			break;
   1464       1.1        pk 			}
   1465       1.1        pk 		}
   1466       1.1        pk 	} else {
   1467       1.1        pk 
   1468       1.1        pk 		/* normal IOPB case (harmless to RDP command) */
   1469       1.1        pk 
   1470       1.1        pk 		iopb->lll = 0;
   1471       1.1        pk 		iopb->intl = (XD_STATE(iorq->mode) == XD_SUB_POLL)
   1472       1.1        pk 				? 0
   1473       1.1        pk 				: iorq->xdc->ipl;
   1474       1.1        pk 		iopb->sectcnt = iorq->sectcnt;
   1475       1.1        pk 		block = iorq->blockno;
   1476       1.1        pk 		if (iorq->xd == NULL || block == 0) {
   1477       1.1        pk 			iopb->sectno = iopb->headno = iopb->cylno = 0;
   1478       1.1        pk 		} else {
   1479       1.1        pk 			iopb->sectno = block % iorq->xd->nsect;
   1480       1.1        pk 			block = block / iorq->xd->nsect;
   1481       1.1        pk 			iopb->headno = block % iorq->xd->nhead;
   1482       1.1        pk 			block = block / iorq->xd->nhead;
   1483       1.1        pk 			iopb->cylno = block;
   1484       1.1        pk 		}
   1485       1.3        pk 		dp = (u_long) iorq->dbuf;
   1486       1.1        pk 		dp = iopb->daddr = (iorq->dbuf == NULL) ? 0 : dp;
   1487       1.1        pk 		iopb->addrmod = ((dp + (XDFM_BPS * iorq->sectcnt)) > 0x1000000)
   1488       1.1        pk 					? XDC_ADDRMOD32
   1489       1.1        pk 					: XDC_ADDRMOD;
   1490       1.1        pk 	}
   1491       1.1        pk }
   1492       1.1        pk 
   1493       1.1        pk /*
   1494       1.1        pk  * xdc_cmd: front end for POLL'd and WAIT'd commands.  Returns rqno.
   1495       1.1        pk  * If you've already got an IORQ, you can call submit directly (currently
   1496      1.37       wiz  * there is no need to do this).    NORM requests are handled separately.
   1497       1.1        pk  */
   1498       1.1        pk int
   1499       1.1        pk xdc_cmd(xdcsc, cmd, subfn, unit, block, scnt, dptr, fullmode)
   1500       1.1        pk 	struct xdc_softc *xdcsc;
   1501       1.1        pk 	int     cmd, subfn, unit, block, scnt;
   1502       1.1        pk 	char   *dptr;
   1503       1.1        pk 	int     fullmode;
   1504       1.1        pk 
   1505       1.1        pk {
   1506       1.1        pk 	int     rqno, submode = XD_STATE(fullmode), retry;
   1507       1.1        pk 	struct xd_iorq *iorq;
   1508       1.1        pk 	struct xd_iopb *iopb;
   1509       1.1        pk 
   1510       1.1        pk 	/* get iorq/iopb */
   1511       1.1        pk 	switch (submode) {
   1512       1.1        pk 	case XD_SUB_POLL:
   1513       1.1        pk 		while (xdcsc->nfree == 0) {
   1514       1.1        pk 			if (xdc_piodriver(xdcsc, 0, 1) != XD_ERR_AOK)
   1515       1.1        pk 				return (XD_ERR_FAIL);
   1516       1.1        pk 		}
   1517       1.1        pk 		break;
   1518       1.1        pk 	case XD_SUB_WAIT:
   1519       1.1        pk 		retry = 1;
   1520       1.1        pk 		while (retry) {
   1521       1.1        pk 			while (xdcsc->nfree == 0) {
   1522       1.1        pk 			    if (tsleep(&xdcsc->nfree, PRIBIO, "xdnfree", 0))
   1523       1.1        pk 				return (XD_ERR_FAIL);
   1524       1.1        pk 			}
   1525       1.1        pk 			while (xdcsc->ndone > XDC_SUBWAITLIM) {
   1526       1.1        pk 			    if (tsleep(&xdcsc->ndone, PRIBIO, "xdsubwait", 0))
   1527       1.1        pk 				return (XD_ERR_FAIL);
   1528       1.1        pk 			}
   1529       1.1        pk 			if (xdcsc->nfree)
   1530       1.1        pk 				retry = 0;	/* got it */
   1531       1.1        pk 		}
   1532       1.1        pk 		break;
   1533       1.1        pk 	default:
   1534       1.1        pk 		return (XD_ERR_FAIL);	/* illegal */
   1535       1.1        pk 	}
   1536       1.1        pk 	if (xdcsc->nfree == 0)
   1537       1.1        pk 		panic("xdcmd nfree");
   1538       1.1        pk 	rqno = XDC_RQALLOC(xdcsc);
   1539       1.1        pk 	iorq = &xdcsc->reqs[rqno];
   1540       1.1        pk 	iopb = iorq->iopb;
   1541       1.1        pk 
   1542       1.1        pk 
   1543       1.1        pk 	/* init iorq/iopb */
   1544       1.1        pk 
   1545       1.1        pk 	xdc_rqinit(iorq, xdcsc,
   1546       1.1        pk 	    (unit == XDC_NOUNIT) ? NULL : xdcsc->sc_drives[unit],
   1547       1.1        pk 	    fullmode, block, scnt, dptr, NULL);
   1548       1.1        pk 
   1549       1.1        pk 	/* load IOPB from iorq */
   1550       1.1        pk 
   1551       1.1        pk 	xdc_rqtopb(iorq, iopb, cmd, subfn);
   1552       1.1        pk 
   1553       1.1        pk 	/* submit it for processing */
   1554       1.1        pk 
   1555       1.1        pk 	xdc_submit_iorq(xdcsc, rqno, fullmode);	/* error code will be in iorq */
   1556       1.1        pk 
   1557       1.1        pk 	return (rqno);
   1558       1.1        pk }
   1559       1.1        pk /*
   1560       1.1        pk  * xdc_startbuf
   1561       1.1        pk  * start a buffer running, assumes nfree > 0
   1562       1.1        pk  */
   1563       1.1        pk 
   1564       1.1        pk int
   1565       1.1        pk xdc_startbuf(xdcsc, xdsc, bp)
   1566       1.1        pk 	struct xdc_softc *xdcsc;
   1567       1.1        pk 	struct xd_softc *xdsc;
   1568       1.1        pk 	struct buf *bp;
   1569       1.1        pk 
   1570       1.1        pk {
   1571       1.1        pk 	int     rqno, partno;
   1572       1.1        pk 	struct xd_iorq *iorq;
   1573       1.1        pk 	struct xd_iopb *iopb;
   1574       1.1        pk 	u_long  block;
   1575      1.66  christos /*	void *dbuf;*/
   1576       1.3        pk 	int error;
   1577       1.1        pk 
   1578       1.1        pk 	if (!xdcsc->nfree)
   1579       1.1        pk 		panic("xdc_startbuf free");
   1580       1.1        pk 	rqno = XDC_RQALLOC(xdcsc);
   1581       1.1        pk 	iorq = &xdcsc->reqs[rqno];
   1582       1.1        pk 	iopb = iorq->iopb;
   1583       1.1        pk 
   1584       1.1        pk 	/* get buf */
   1585       1.1        pk 
   1586       1.1        pk 	if (bp == NULL) {
   1587      1.78      yamt 		bp = bufq_get(xdcsc->sc_wq);
   1588      1.18   thorpej 		if (bp == NULL)
   1589       1.1        pk 			panic("xdc_startbuf bp");
   1590       1.1        pk 		xdsc = xdcsc->sc_drives[DISKUNIT(bp->b_dev)];
   1591       1.1        pk 	}
   1592       1.1        pk 	partno = DISKPART(bp->b_dev);
   1593       1.1        pk #ifdef XDC_DEBUG
   1594      1.75    cegger 	printf("xdc_startbuf: %s%c: %s block %d\n", device_xname(&xdsc->sc_dev),
   1595       1.1        pk 	    'a' + partno, (bp->b_flags & B_READ) ? "read" : "write", bp->b_blkno);
   1596       1.1        pk 	printf("xdc_startbuf: b_bcount %d, b_data 0x%x\n",
   1597       1.1        pk 	    bp->b_bcount, bp->b_data);
   1598       1.1        pk #endif
   1599       1.1        pk 
   1600       1.1        pk 	/*
   1601       1.1        pk 	 * load request.  we have to calculate the correct block number based
   1602       1.1        pk 	 * on partition info.
   1603       1.1        pk 	 *
   1604       1.1        pk 	 * note that iorq points to the buffer as mapped into DVMA space,
   1605       1.1        pk 	 * where as the bp->b_data points to its non-DVMA mapping.
   1606       1.1        pk 	 */
   1607       1.1        pk 
   1608       1.1        pk 	block = bp->b_blkno + ((partno == RAW_PART) ? 0 :
   1609       1.1        pk 	    xdsc->sc_dk.dk_label->d_partitions[partno].p_offset);
   1610       1.1        pk 
   1611       1.3        pk 	error = bus_dmamap_load(xdcsc->dmatag, iorq->dmamap,
   1612       1.3        pk 			 bp->b_data, bp->b_bcount, 0, BUS_DMA_NOWAIT);
   1613       1.3        pk 	if (error != 0) {
   1614      1.75    cegger 		aprint_error_dev(&xdcsc->sc_dev, "warning: cannot load DMA map\n");
   1615       1.1        pk 		XDC_FREE(xdcsc, rqno);
   1616      1.78      yamt 		bufq_put(xdcsc->sc_wq, bp);
   1617       1.1        pk 		return (XD_ERR_FAIL);	/* XXX: need some sort of
   1618       1.1        pk 					 * call-back scheme here? */
   1619       1.1        pk 	}
   1620       1.9   thorpej 	bus_dmamap_sync(xdcsc->dmatag, iorq->dmamap, 0,
   1621       1.9   thorpej 			iorq->dmamap->dm_mapsize, (bp->b_flags & B_READ)
   1622       1.3        pk 				? BUS_DMASYNC_PREREAD
   1623       1.3        pk 				: BUS_DMASYNC_PREWRITE);
   1624       1.1        pk 
   1625       1.1        pk 	/* init iorq and load iopb from it */
   1626       1.1        pk 	xdc_rqinit(iorq, xdcsc, xdsc, XD_SUB_NORM | XD_MODE_VERBO, block,
   1627       1.3        pk 		   bp->b_bcount / XDFM_BPS,
   1628      1.66  christos 		   (void *)(u_long)iorq->dmamap->dm_segs[0].ds_addr,
   1629       1.3        pk 		   bp);
   1630       1.1        pk 
   1631       1.1        pk 	xdc_rqtopb(iorq, iopb, (bp->b_flags & B_READ) ? XDCMD_RD : XDCMD_WR, 0);
   1632       1.1        pk 
   1633       1.1        pk 	/* Instrumentation. */
   1634       1.1        pk 	disk_busy(&xdsc->sc_dk);
   1635       1.1        pk 
   1636       1.1        pk 	/* now submit [note that xdc_submit_iorq can never fail on NORM reqs] */
   1637       1.1        pk 
   1638       1.1        pk 	xdc_submit_iorq(xdcsc, rqno, XD_SUB_NORM);
   1639       1.1        pk 	return (XD_ERR_AOK);
   1640       1.1        pk }
   1641       1.1        pk 
   1642       1.1        pk 
   1643       1.1        pk /*
   1644       1.1        pk  * xdc_submit_iorq: submit an iorq for processing.  returns XD_ERR_AOK
   1645       1.1        pk  * if ok.  if it fail returns an error code.  type is XD_SUB_*.
   1646       1.1        pk  *
   1647       1.1        pk  * note: caller frees iorq in all cases except NORM
   1648       1.1        pk  *
   1649       1.1        pk  * return value:
   1650       1.1        pk  *   NORM: XD_AOK (req pending), XD_FAIL (couldn't submit request)
   1651       1.1        pk  *   WAIT: XD_AOK (success), <error-code> (failed)
   1652       1.1        pk  *   POLL: <same as WAIT>
   1653       1.1        pk  *   NOQ : <same as NORM>
   1654       1.1        pk  *
   1655       1.1        pk  * there are three sources for i/o requests:
   1656       1.1        pk  * [1] xdstrategy: normal block I/O, using "struct buf" system.
   1657       1.1        pk  * [2] autoconfig/crash dump: these are polled I/O requests, no interrupts.
   1658       1.1        pk  * [3] open/ioctl: these are I/O requests done in the context of a process,
   1659       1.1        pk  *                 and the process should block until they are done.
   1660       1.1        pk  *
   1661       1.1        pk  * software state is stored in the iorq structure.  each iorq has an
   1662       1.1        pk  * iopb structure.  the hardware understands the iopb structure.
   1663       1.1        pk  * every command must go through an iopb.  a 7053 can only handle
   1664       1.1        pk  * XDC_MAXIOPB (31) active iopbs at one time.  iopbs are allocated in
   1665       1.1        pk  * DVMA space at boot up time.  what happens if we run out of iopb's?
   1666       1.1        pk  * for i/o type [1], the buffers are queued at the "buff" layer and
   1667       1.1        pk  * picked up later by the interrupt routine.  for case [2] the
   1668       1.1        pk  * programmed i/o driver is called with a special flag that says
   1669       1.1        pk  * return when one iopb is free.  for case [3] the process can sleep
   1670      1.54       wiz  * on the iorq free list until some iopbs are available.
   1671       1.1        pk  */
   1672       1.1        pk 
   1673       1.1        pk 
   1674       1.1        pk int
   1675       1.1        pk xdc_submit_iorq(xdcsc, iorqno, type)
   1676       1.1        pk 	struct xdc_softc *xdcsc;
   1677       1.1        pk 	int     iorqno;
   1678       1.1        pk 	int     type;
   1679       1.1        pk 
   1680       1.1        pk {
   1681       1.1        pk 	u_long  iopbaddr;
   1682       1.1        pk 	struct xd_iorq *iorq = &xdcsc->reqs[iorqno];
   1683       1.1        pk 
   1684       1.1        pk #ifdef XDC_DEBUG
   1685      1.75    cegger 	printf("xdc_submit_iorq(%s, no=%d, type=%d)\n", device_xname(&xdcsc->sc_dev),
   1686       1.1        pk 	    iorqno, type);
   1687       1.1        pk #endif
   1688       1.1        pk 
   1689       1.1        pk 	/* first check and see if controller is busy */
   1690       1.1        pk 	if (xdcsc->xdc->xdc_csr & XDC_ADDING) {
   1691       1.1        pk #ifdef XDC_DEBUG
   1692       1.1        pk 		printf("xdc_submit_iorq: XDC not ready (ADDING)\n");
   1693       1.1        pk #endif
   1694       1.1        pk 		if (type == XD_SUB_NOQ)
   1695       1.1        pk 			return (XD_ERR_FAIL);	/* failed */
   1696       1.1        pk 		XDC_TWAIT(xdcsc, iorqno);	/* put at end of waitq */
   1697       1.1        pk 		switch (type) {
   1698       1.1        pk 		case XD_SUB_NORM:
   1699       1.1        pk 			return XD_ERR_AOK;	/* success */
   1700       1.1        pk 		case XD_SUB_WAIT:
   1701       1.1        pk 			while (iorq->iopb->done == 0) {
   1702      1.25   thorpej 				(void) tsleep(iorq, PRIBIO, "xdciorq", 0);
   1703       1.1        pk 			}
   1704      1.64  christos 			return (iorq->errnum);
   1705       1.1        pk 		case XD_SUB_POLL:
   1706       1.1        pk 			return (xdc_piodriver(xdcsc, iorqno, 0));
   1707       1.1        pk 		default:
   1708       1.1        pk 			panic("xdc_submit_iorq adding");
   1709       1.1        pk 		}
   1710       1.1        pk 	}
   1711       1.1        pk #ifdef XDC_DEBUG
   1712       1.1        pk 	{
   1713       1.1        pk 		u_char *rio = (u_char *) iorq->iopb;
   1714       1.1        pk 		int     sz = sizeof(struct xd_iopb), lcv;
   1715       1.1        pk 		printf("%s: aio #%d [",
   1716      1.75    cegger 			device_xname(&xdcsc->sc_dev), iorq - xdcsc->reqs);
   1717       1.1        pk 		for (lcv = 0; lcv < sz; lcv++)
   1718       1.1        pk 			printf(" %02x", rio[lcv]);
   1719       1.1        pk 		printf("]\n");
   1720       1.1        pk 	}
   1721       1.1        pk #endif				/* XDC_DEBUG */
   1722       1.1        pk 
   1723       1.1        pk 	/* controller not busy, start command */
   1724      1.12        pk 	iopbaddr = (u_long) iorq->dmaiopb;
   1725       1.1        pk 	XDC_GO(xdcsc->xdc, iopbaddr);	/* go! */
   1726       1.1        pk 	xdcsc->nrun++;
   1727       1.1        pk 	/* command now running, wrap it up */
   1728       1.1        pk 	switch (type) {
   1729       1.1        pk 	case XD_SUB_NORM:
   1730       1.1        pk 	case XD_SUB_NOQ:
   1731       1.1        pk 		return (XD_ERR_AOK);	/* success */
   1732       1.1        pk 	case XD_SUB_WAIT:
   1733       1.1        pk 		while (iorq->iopb->done == 0) {
   1734      1.25   thorpej 			(void) tsleep(iorq, PRIBIO, "xdciorq", 0);
   1735       1.1        pk 		}
   1736      1.64  christos 		return (iorq->errnum);
   1737       1.1        pk 	case XD_SUB_POLL:
   1738       1.1        pk 		return (xdc_piodriver(xdcsc, iorqno, 0));
   1739       1.1        pk 	default:
   1740       1.1        pk 		panic("xdc_submit_iorq wrap up");
   1741       1.1        pk 	}
   1742       1.1        pk 	panic("xdc_submit_iorq");
   1743       1.1        pk 	return 0;	/* not reached */
   1744       1.1        pk }
   1745       1.1        pk 
   1746       1.1        pk 
   1747       1.1        pk /*
   1748       1.1        pk  * xdc_piodriver
   1749       1.1        pk  *
   1750       1.1        pk  * programmed i/o driver.   this function takes over the computer
   1751       1.1        pk  * and drains off all i/o requests.   it returns the status of the iorq
   1752       1.1        pk  * the caller is interesting in.   if freeone is true, then it returns
   1753       1.1        pk  * when there is a free iorq.
   1754       1.1        pk  */
   1755       1.1        pk int
   1756       1.1        pk xdc_piodriver(xdcsc, iorqno, freeone)
   1757      1.11        pk 	struct	xdc_softc *xdcsc;
   1758      1.11        pk 	int	iorqno;
   1759      1.11        pk 	int	freeone;
   1760       1.1        pk 
   1761       1.1        pk {
   1762      1.11        pk 	int	nreset = 0;
   1763      1.11        pk 	int	retval = 0;
   1764      1.11        pk 	u_long	count;
   1765      1.11        pk 	struct	xdc *xdc = xdcsc->xdc;
   1766       1.1        pk #ifdef XDC_DEBUG
   1767      1.75    cegger 	printf("xdc_piodriver(%s, %d, freeone=%d)\n", device_xname(&xdcsc->sc_dev),
   1768       1.1        pk 	    iorqno, freeone);
   1769       1.1        pk #endif
   1770       1.1        pk 
   1771       1.1        pk 	while (xdcsc->nwait || xdcsc->nrun) {
   1772       1.1        pk #ifdef XDC_DEBUG
   1773       1.1        pk 		printf("xdc_piodriver: wait=%d, run=%d\n",
   1774       1.1        pk 			xdcsc->nwait, xdcsc->nrun);
   1775       1.1        pk #endif
   1776       1.1        pk 		XDC_WAIT(xdc, count, XDC_MAXTIME, (XDC_REMIOPB | XDC_F_ERROR));
   1777       1.1        pk #ifdef XDC_DEBUG
   1778       1.1        pk 		printf("xdc_piodriver: done wait with count = %d\n", count);
   1779       1.1        pk #endif
   1780       1.1        pk 		/* we expect some progress soon */
   1781       1.1        pk 		if (count == 0 && nreset >= 2) {
   1782       1.1        pk 			xdc_reset(xdcsc, 0, XD_RSET_ALL, XD_ERR_FAIL, 0);
   1783       1.1        pk #ifdef XDC_DEBUG
   1784       1.1        pk 			printf("xdc_piodriver: timeout\n");
   1785       1.1        pk #endif
   1786       1.1        pk 			return (XD_ERR_FAIL);
   1787       1.1        pk 		}
   1788       1.1        pk 		if (count == 0) {
   1789       1.1        pk 			if (xdc_reset(xdcsc, 0,
   1790       1.1        pk 				      (nreset++ == 0) ? XD_RSET_NONE : iorqno,
   1791       1.1        pk 				      XD_ERR_FAIL,
   1792       1.1        pk 				      0) == XD_ERR_FAIL)
   1793       1.1        pk 				return (XD_ERR_FAIL);	/* flushes all but POLL
   1794       1.1        pk 							 * requests, resets */
   1795       1.1        pk 			continue;
   1796       1.1        pk 		}
   1797       1.1        pk 		xdc_remove_iorq(xdcsc);	/* could resubmit request */
   1798       1.1        pk 		if (freeone) {
   1799       1.1        pk 			if (xdcsc->nrun < XDC_MAXIOPB) {
   1800       1.1        pk #ifdef XDC_DEBUG
   1801       1.1        pk 				printf("xdc_piodriver: done: one free\n");
   1802       1.1        pk #endif
   1803       1.1        pk 				return (XD_ERR_AOK);
   1804       1.1        pk 			}
   1805       1.1        pk 			continue;	/* don't xdc_start */
   1806       1.1        pk 		}
   1807       1.1        pk 		xdc_start(xdcsc, XDC_MAXIOPB);
   1808       1.1        pk 	}
   1809       1.1        pk 
   1810       1.1        pk 	/* get return value */
   1811       1.1        pk 
   1812      1.64  christos 	retval = xdcsc->reqs[iorqno].errnum;
   1813       1.1        pk 
   1814       1.1        pk #ifdef XDC_DEBUG
   1815       1.1        pk 	printf("xdc_piodriver: done, retval = 0x%x (%s)\n",
   1816      1.64  christos 	    xdcsc->reqs[iorqno].errnum, xdc_e2str(xdcsc->reqs[iorqno].errnum));
   1817       1.1        pk #endif
   1818       1.1        pk 
   1819       1.1        pk 	/* now that we've drained everything, start up any bufs that have
   1820       1.1        pk 	 * queued */
   1821       1.1        pk 
   1822      1.78      yamt 	while (xdcsc->nfree > 0 && bufq_peek(xdcsc->sc_wq) != NULL)
   1823       1.1        pk 		if (xdc_startbuf(xdcsc, NULL, NULL) != XD_ERR_AOK)
   1824       1.1        pk 			break;
   1825       1.1        pk 
   1826       1.1        pk 	return (retval);
   1827       1.1        pk }
   1828       1.1        pk 
   1829       1.1        pk /*
   1830       1.1        pk  * xdc_reset: reset one drive.   NOTE: assumes xdc was just reset.
   1831       1.1        pk  * we steal iopb[0] for this, but we put it back when we are done.
   1832       1.1        pk  */
   1833       1.1        pk void
   1834       1.1        pk xdc_xdreset(xdcsc, xdsc)
   1835       1.1        pk 	struct xdc_softc *xdcsc;
   1836       1.1        pk 	struct xd_softc *xdsc;
   1837       1.1        pk 
   1838       1.1        pk {
   1839       1.1        pk 	struct xd_iopb tmpiopb;
   1840       1.1        pk 	u_long  addr;
   1841       1.1        pk 	int     del;
   1842      1.84   tsutsui 	memcpy(&tmpiopb, xdcsc->iopbase, sizeof(tmpiopb));
   1843      1.82    cegger 	memset(xdcsc->iopbase, 0, sizeof(tmpiopb));
   1844       1.1        pk 	xdcsc->iopbase->comm = XDCMD_RST;
   1845       1.1        pk 	xdcsc->iopbase->unit = xdsc->xd_drive;
   1846       1.1        pk 	addr = (u_long) xdcsc->dvmaiopb;
   1847       1.1        pk 	XDC_GO(xdcsc->xdc, addr);	/* go! */
   1848       1.1        pk 	XDC_WAIT(xdcsc->xdc, del, XDC_RESETUSEC, XDC_REMIOPB);
   1849       1.1        pk 	if (del <= 0 || xdcsc->iopbase->errs) {
   1850      1.75    cegger 		printf("%s: off-line: %s\n", device_xname(&xdcsc->sc_dev),
   1851      1.64  christos 		    xdc_e2str(xdcsc->iopbase->errnum));
   1852       1.1        pk 		xdcsc->xdc->xdc_csr = XDC_RESET;
   1853       1.1        pk 		XDC_WAIT(xdcsc->xdc, del, XDC_RESETUSEC, XDC_RESET);
   1854       1.1        pk 		if (del <= 0)
   1855       1.1        pk 			panic("xdc_reset");
   1856       1.1        pk 	} else {
   1857       1.1        pk 		xdcsc->xdc->xdc_csr = XDC_CLRRIO;	/* clear RIO */
   1858       1.1        pk 	}
   1859      1.84   tsutsui 	memcpy(xdcsc->iopbase, &tmpiopb, sizeof(tmpiopb));
   1860       1.1        pk }
   1861       1.1        pk 
   1862       1.1        pk 
   1863       1.1        pk /*
   1864       1.1        pk  * xdc_reset: reset everything: requests are marked as errors except
   1865       1.1        pk  * a polled request (which is resubmitted)
   1866       1.1        pk  */
   1867       1.1        pk int
   1868       1.1        pk xdc_reset(xdcsc, quiet, blastmode, error, xdsc)
   1869       1.1        pk 	struct xdc_softc *xdcsc;
   1870       1.1        pk 	int     quiet, blastmode, error;
   1871       1.1        pk 	struct xd_softc *xdsc;
   1872       1.1        pk 
   1873       1.1        pk {
   1874       1.1        pk 	int     del = 0, lcv, retval = XD_ERR_AOK;
   1875       1.1        pk 	int     oldfree = xdcsc->nfree;
   1876       1.1        pk 
   1877       1.1        pk 	/* soft reset hardware */
   1878       1.1        pk 
   1879       1.1        pk 	if (!quiet)
   1880      1.75    cegger 		printf("%s: soft reset\n", device_xname(&xdcsc->sc_dev));
   1881       1.1        pk 	xdcsc->xdc->xdc_csr = XDC_RESET;
   1882       1.1        pk 	XDC_WAIT(xdcsc->xdc, del, XDC_RESETUSEC, XDC_RESET);
   1883       1.1        pk 	if (del <= 0) {
   1884       1.1        pk 		blastmode = XD_RSET_ALL;	/* dead, flush all requests */
   1885       1.1        pk 		retval = XD_ERR_FAIL;
   1886       1.1        pk 	}
   1887       1.1        pk 	if (xdsc)
   1888       1.1        pk 		xdc_xdreset(xdcsc, xdsc);
   1889       1.1        pk 
   1890       1.1        pk 	/* fix queues based on "blast-mode" */
   1891       1.1        pk 
   1892       1.1        pk 	for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
   1893       1.1        pk 		register struct xd_iorq *iorq = &xdcsc->reqs[lcv];
   1894       1.1        pk 
   1895       1.1        pk 		if (XD_STATE(iorq->mode) != XD_SUB_POLL &&
   1896       1.1        pk 		    XD_STATE(iorq->mode) != XD_SUB_WAIT &&
   1897       1.1        pk 		    XD_STATE(iorq->mode) != XD_SUB_NORM)
   1898       1.1        pk 			/* is it active? */
   1899       1.1        pk 			continue;
   1900       1.1        pk 
   1901       1.1        pk 		xdcsc->nrun--;	/* it isn't running any more */
   1902       1.1        pk 		if (blastmode == XD_RSET_ALL || blastmode != lcv) {
   1903       1.1        pk 			/* failed */
   1904      1.64  christos 			iorq->errnum = error;
   1905       1.1        pk 			xdcsc->iopbase[lcv].done = xdcsc->iopbase[lcv].errs = 1;
   1906       1.1        pk 			switch (XD_STATE(xdcsc->reqs[lcv].mode)) {
   1907       1.1        pk 			case XD_SUB_NORM:
   1908       1.1        pk 			    iorq->buf->b_error = EIO;
   1909       1.1        pk 			    iorq->buf->b_resid =
   1910       1.1        pk 			       iorq->sectcnt * XDFM_BPS;
   1911       1.3        pk 
   1912       1.9   thorpej 			    bus_dmamap_sync(xdcsc->dmatag, iorq->dmamap, 0,
   1913       1.9   thorpej 					    iorq->dmamap->dm_mapsize,
   1914       1.3        pk 					    (iorq->buf->b_flags & B_READ)
   1915       1.3        pk 						? BUS_DMASYNC_POSTREAD
   1916       1.3        pk 						: BUS_DMASYNC_POSTWRITE);
   1917       1.3        pk 
   1918       1.3        pk 			    bus_dmamap_unload(xdcsc->dmatag, iorq->dmamap);
   1919       1.3        pk 
   1920       1.1        pk 			    disk_unbusy(&xdcsc->reqs[lcv].xd->sc_dk,
   1921       1.1        pk 				(xdcsc->reqs[lcv].buf->b_bcount -
   1922      1.47       mrg 				xdcsc->reqs[lcv].buf->b_resid),
   1923      1.47       mrg 				(iorq->buf->b_flags & B_READ));
   1924       1.1        pk 			    biodone(iorq->buf);
   1925       1.1        pk 			    XDC_FREE(xdcsc, lcv);	/* add to free list */
   1926       1.1        pk 			    break;
   1927       1.1        pk 			case XD_SUB_WAIT:
   1928       1.1        pk 			    wakeup(iorq);
   1929       1.1        pk 			case XD_SUB_POLL:
   1930       1.1        pk 			    xdcsc->ndone++;
   1931       1.1        pk 			    iorq->mode =
   1932       1.1        pk 				XD_NEWSTATE(iorq->mode, XD_SUB_DONE);
   1933       1.1        pk 			    break;
   1934       1.1        pk 			}
   1935       1.1        pk 
   1936       1.1        pk 		} else {
   1937       1.1        pk 
   1938       1.1        pk 			/* resubmit, put at front of wait queue */
   1939       1.1        pk 			XDC_HWAIT(xdcsc, lcv);
   1940       1.1        pk 		}
   1941       1.1        pk 	}
   1942       1.1        pk 
   1943       1.1        pk 	/*
   1944       1.1        pk 	 * now, if stuff is waiting, start it.
   1945       1.1        pk 	 * since we just reset it should go
   1946       1.1        pk 	 */
   1947       1.1        pk 	xdc_start(xdcsc, XDC_MAXIOPB);
   1948       1.1        pk 
   1949       1.1        pk 	/* ok, we did it */
   1950       1.1        pk 	if (oldfree == 0 && xdcsc->nfree)
   1951       1.1        pk 		wakeup(&xdcsc->nfree);
   1952       1.1        pk 
   1953       1.1        pk #ifdef XDC_DIAG
   1954       1.1        pk 	del = xdcsc->nwait + xdcsc->nrun + xdcsc->nfree + xdcsc->ndone;
   1955       1.1        pk 	if (del != XDC_MAXIOPB)
   1956       1.1        pk 		printf("%s: diag: xdc_reset miscount (%d should be %d)!\n",
   1957      1.75    cegger 		    device_xname(&xdcsc->sc_dev), del, XDC_MAXIOPB);
   1958       1.1        pk 	else
   1959       1.1        pk 		if (xdcsc->ndone > XDC_MAXIOPB - XDC_SUBWAITLIM)
   1960       1.1        pk 			printf("%s: diag: lots of done jobs (%d)\n",
   1961      1.75    cegger 			    device_xname(&xdcsc->sc_dev), xdcsc->ndone);
   1962       1.1        pk #endif
   1963       1.1        pk 	printf("RESET DONE\n");
   1964       1.1        pk 	return (retval);
   1965       1.1        pk }
   1966       1.1        pk /*
   1967       1.1        pk  * xdc_start: start all waiting buffers
   1968       1.1        pk  */
   1969       1.1        pk 
   1970       1.1        pk void
   1971       1.1        pk xdc_start(xdcsc, maxio)
   1972       1.1        pk 	struct xdc_softc *xdcsc;
   1973       1.1        pk 	int     maxio;
   1974       1.1        pk 
   1975       1.1        pk {
   1976       1.1        pk 	int     rqno;
   1977       1.1        pk 	while (maxio && xdcsc->nwait &&
   1978       1.1        pk 		(xdcsc->xdc->xdc_csr & XDC_ADDING) == 0) {
   1979       1.1        pk 		XDC_GET_WAITER(xdcsc, rqno);	/* note: rqno is an "out"
   1980       1.1        pk 						 * param */
   1981       1.1        pk 		if (xdc_submit_iorq(xdcsc, rqno, XD_SUB_NOQ) != XD_ERR_AOK)
   1982       1.1        pk 			panic("xdc_start");	/* should never happen */
   1983       1.1        pk 		maxio--;
   1984       1.1        pk 	}
   1985       1.1        pk }
   1986       1.1        pk /*
   1987       1.1        pk  * xdc_remove_iorq: remove "done" IOPB's.
   1988       1.1        pk  */
   1989       1.1        pk 
   1990       1.1        pk int
   1991       1.1        pk xdc_remove_iorq(xdcsc)
   1992       1.1        pk 	struct xdc_softc *xdcsc;
   1993       1.1        pk 
   1994       1.1        pk {
   1995      1.64  christos 	int     errnum, rqno, comm, errs;
   1996       1.1        pk 	struct xdc *xdc = xdcsc->xdc;
   1997       1.1        pk 	struct xd_iopb *iopb;
   1998       1.1        pk 	struct xd_iorq *iorq;
   1999       1.1        pk 	struct buf *bp;
   2000       1.1        pk 
   2001       1.1        pk 	if (xdc->xdc_csr & XDC_F_ERROR) {
   2002       1.1        pk 		/*
   2003       1.1        pk 		 * FATAL ERROR: should never happen under normal use. This
   2004       1.1        pk 		 * error is so bad, you can't even tell which IOPB is bad, so
   2005       1.1        pk 		 * we dump them all.
   2006       1.1        pk 		 */
   2007      1.64  christos 		errnum = xdc->xdc_f_err;
   2008      1.75    cegger 		aprint_error_dev(&xdcsc->sc_dev, "fatal error 0x%02x: %s\n",
   2009      1.64  christos 		    errnum, xdc_e2str(errnum));
   2010      1.64  christos 		if (xdc_reset(xdcsc, 0, XD_RSET_ALL, errnum, 0) != XD_ERR_AOK) {
   2011      1.75    cegger 			aprint_error_dev(&xdcsc->sc_dev, "soft reset failed!\n");
   2012       1.1        pk 			panic("xdc_remove_iorq: controller DEAD");
   2013       1.1        pk 		}
   2014       1.1        pk 		return (XD_ERR_AOK);
   2015       1.1        pk 	}
   2016       1.1        pk 
   2017       1.1        pk 	/*
   2018       1.1        pk 	 * get iopb that is done
   2019       1.1        pk 	 *
   2020       1.1        pk 	 * hmm... I used to read the address of the done IOPB off the VME
   2021       1.1        pk 	 * registers and calculate the rqno directly from that.   that worked
   2022       1.1        pk 	 * until I started putting a load on the controller.   when loaded, i
   2023       1.1        pk 	 * would get interrupts but neither the REMIOPB or F_ERROR bits would
   2024       1.1        pk 	 * be set, even after DELAY'ing a while!   later on the timeout
   2025       1.1        pk 	 * routine would detect IOPBs that were marked "running" but their
   2026       1.1        pk 	 * "done" bit was set.   rather than dealing directly with this
   2027       1.1        pk 	 * problem, it is just easier to look at all running IOPB's for the
   2028       1.1        pk 	 * done bit.
   2029       1.1        pk 	 */
   2030       1.1        pk 	if (xdc->xdc_csr & XDC_REMIOPB) {
   2031       1.1        pk 		xdc->xdc_csr = XDC_CLRRIO;
   2032       1.1        pk 	}
   2033       1.1        pk 
   2034       1.1        pk 	for (rqno = 0; rqno < XDC_MAXIOPB; rqno++) {
   2035       1.1        pk 		iorq = &xdcsc->reqs[rqno];
   2036       1.1        pk 		if (iorq->mode == 0 || XD_STATE(iorq->mode) == XD_SUB_DONE)
   2037       1.1        pk 			continue;	/* free, or done */
   2038       1.1        pk 		iopb = &xdcsc->iopbase[rqno];
   2039       1.1        pk 		if (iopb->done == 0)
   2040       1.1        pk 			continue;	/* not done yet */
   2041       1.1        pk 
   2042       1.1        pk #ifdef XDC_DEBUG
   2043       1.1        pk 		{
   2044       1.1        pk 			u_char *rio = (u_char *) iopb;
   2045       1.1        pk 			int     sz = sizeof(struct xd_iopb), lcv;
   2046      1.75    cegger 			printf("%s: rio #%d [", device_xname(&xdcsc->sc_dev), rqno);
   2047       1.1        pk 			for (lcv = 0; lcv < sz; lcv++)
   2048       1.1        pk 				printf(" %02x", rio[lcv]);
   2049       1.1        pk 			printf("]\n");
   2050       1.1        pk 		}
   2051       1.1        pk #endif				/* XDC_DEBUG */
   2052       1.1        pk 
   2053       1.1        pk 		xdcsc->nrun--;
   2054       1.1        pk 
   2055       1.1        pk 		comm = iopb->comm;
   2056       1.1        pk 		errs = iopb->errs;
   2057       1.1        pk 
   2058       1.1        pk 		if (errs)
   2059      1.64  christos 			iorq->errnum = iopb->errnum;
   2060       1.1        pk 		else
   2061      1.64  christos 			iorq->errnum = 0;
   2062       1.1        pk 
   2063       1.1        pk 		/* handle non-fatal errors */
   2064       1.1        pk 
   2065       1.1        pk 		if (errs &&
   2066       1.1        pk 		    xdc_error(xdcsc, iorq, iopb, rqno, comm) == XD_ERR_AOK)
   2067       1.1        pk 			continue;	/* AOK: we resubmitted it */
   2068       1.1        pk 
   2069       1.1        pk 
   2070       1.1        pk 		/* this iorq is now done (hasn't been restarted or anything) */
   2071       1.1        pk 
   2072       1.1        pk 		if ((iorq->mode & XD_MODE_VERBO) && iorq->lasterror)
   2073       1.1        pk 			xdc_perror(iorq, iopb, 0);
   2074       1.1        pk 
   2075       1.1        pk 		/* now, if read/write check to make sure we got all the data
   2076       1.1        pk 		 * we needed. (this may not be the case if we got an error in
   2077       1.1        pk 		 * the middle of a multisector request).   */
   2078       1.1        pk 
   2079       1.1        pk 		if ((iorq->mode & XD_MODE_B144) != 0 && errs == 0 &&
   2080       1.1        pk 		    (comm == XDCMD_RD || comm == XDCMD_WR)) {
   2081       1.1        pk 			/* we just successfully processed a bad144 sector
   2082       1.1        pk 			 * note: if we are in bad 144 mode, the pointers have
   2083       1.1        pk 			 * been advanced already (see above) and are pointing
   2084       1.1        pk 			 * at the bad144 sector.   to exit bad144 mode, we
   2085       1.1        pk 			 * must advance the pointers 1 sector and issue a new
   2086       1.1        pk 			 * request if there are still sectors left to process
   2087       1.1        pk 			 *
   2088       1.1        pk 			 */
   2089       1.1        pk 			XDC_ADVANCE(iorq, 1);	/* advance 1 sector */
   2090       1.1        pk 
   2091       1.1        pk 			/* exit b144 mode */
   2092       1.1        pk 			iorq->mode = iorq->mode & (~XD_MODE_B144);
   2093       1.1        pk 
   2094       1.1        pk 			if (iorq->sectcnt) {	/* more to go! */
   2095      1.64  christos 				iorq->lasterror = iorq->errnum = iopb->errnum = 0;
   2096       1.1        pk 				iopb->errs = iopb->done = 0;
   2097       1.1        pk 				iorq->tries = 0;
   2098       1.1        pk 				iopb->sectcnt = iorq->sectcnt;
   2099       1.1        pk 				iopb->cylno = iorq->blockno /
   2100       1.1        pk 						iorq->xd->sectpercyl;
   2101       1.1        pk 				iopb->headno =
   2102       1.1        pk 					(iorq->blockno / iorq->xd->nhead) %
   2103       1.1        pk 						iorq->xd->nhead;
   2104       1.1        pk 				iopb->sectno = iorq->blockno % XDFM_BPS;
   2105       1.3        pk 				iopb->daddr = (u_long) iorq->dbuf;
   2106       1.1        pk 				XDC_HWAIT(xdcsc, rqno);
   2107       1.1        pk 				xdc_start(xdcsc, 1);	/* resubmit */
   2108       1.1        pk 				continue;
   2109       1.1        pk 			}
   2110       1.1        pk 		}
   2111       1.1        pk 		/* final cleanup, totally done with this request */
   2112       1.1        pk 
   2113       1.1        pk 		switch (XD_STATE(iorq->mode)) {
   2114       1.1        pk 		case XD_SUB_NORM:
   2115       1.1        pk 			bp = iorq->buf;
   2116       1.1        pk 			if (errs) {
   2117       1.1        pk 				bp->b_error = EIO;
   2118       1.1        pk 				bp->b_resid = iorq->sectcnt * XDFM_BPS;
   2119       1.1        pk 			} else {
   2120       1.1        pk 				bp->b_resid = 0;	/* done */
   2121       1.1        pk 			}
   2122       1.9   thorpej 			bus_dmamap_sync(xdcsc->dmatag, iorq->dmamap, 0,
   2123       1.9   thorpej 					iorq->dmamap->dm_mapsize,
   2124       1.3        pk 					(bp->b_flags & B_READ)
   2125       1.3        pk 						? BUS_DMASYNC_POSTREAD
   2126       1.3        pk 						: BUS_DMASYNC_POSTWRITE);
   2127       1.3        pk 			bus_dmamap_unload(xdcsc->dmatag, iorq->dmamap);
   2128       1.3        pk 
   2129       1.1        pk 			disk_unbusy(&iorq->xd->sc_dk,
   2130      1.47       mrg 			    (bp->b_bcount - bp->b_resid),
   2131      1.47       mrg 			    (bp->b_flags & B_READ));
   2132       1.1        pk 			XDC_FREE(xdcsc, rqno);
   2133       1.1        pk 			biodone(bp);
   2134       1.1        pk 			break;
   2135       1.1        pk 		case XD_SUB_WAIT:
   2136       1.1        pk 			iorq->mode = XD_NEWSTATE(iorq->mode, XD_SUB_DONE);
   2137       1.1        pk 			xdcsc->ndone++;
   2138       1.1        pk 			wakeup(iorq);
   2139       1.1        pk 			break;
   2140       1.1        pk 		case XD_SUB_POLL:
   2141       1.1        pk 			iorq->mode = XD_NEWSTATE(iorq->mode, XD_SUB_DONE);
   2142       1.1        pk 			xdcsc->ndone++;
   2143       1.1        pk 			break;
   2144       1.1        pk 		}
   2145       1.1        pk 	}
   2146       1.1        pk 
   2147       1.1        pk 	return (XD_ERR_AOK);
   2148       1.1        pk }
   2149       1.1        pk 
   2150       1.1        pk /*
   2151       1.1        pk  * xdc_perror: print error.
   2152       1.1        pk  * - if still_trying is true: we got an error, retried and got a
   2153       1.1        pk  *   different error.  in that case lasterror is the old error,
   2154      1.64  christos  *   and errnum is the new one.
   2155       1.1        pk  * - if still_trying is not true, then if we ever had an error it
   2156      1.64  christos  *   is in lasterror. also, if iorq->errnum == 0, then we recovered
   2157      1.64  christos  *   from that error (otherwise iorq->errnum == iorq->lasterror).
   2158       1.1        pk  */
   2159       1.1        pk void
   2160       1.1        pk xdc_perror(iorq, iopb, still_trying)
   2161       1.1        pk 	struct xd_iorq *iorq;
   2162       1.1        pk 	struct xd_iopb *iopb;
   2163       1.1        pk 	int     still_trying;
   2164       1.1        pk 
   2165       1.1        pk {
   2166       1.1        pk 
   2167       1.1        pk 	int     error = iorq->lasterror;
   2168       1.1        pk 
   2169      1.75    cegger 	printf("%s", (iorq->xd) ? device_xname(&iorq->xd->sc_dev)
   2170      1.75    cegger 	    : device_xname(&iorq->xdc->sc_dev));
   2171       1.1        pk 	if (iorq->buf)
   2172      1.77    cegger 		printf("%c: ", 'a' + (char)DISKPART(iorq->buf->b_dev));
   2173       1.1        pk 	if (iopb->comm == XDCMD_RD || iopb->comm == XDCMD_WR)
   2174       1.1        pk 		printf("%s %d/%d/%d: ",
   2175       1.1        pk 			(iopb->comm == XDCMD_RD) ? "read" : "write",
   2176       1.1        pk 			iopb->cylno, iopb->headno, iopb->sectno);
   2177       1.1        pk 	printf("%s", xdc_e2str(error));
   2178       1.1        pk 
   2179       1.1        pk 	if (still_trying)
   2180      1.64  christos 		printf(" [still trying, new error=%s]", xdc_e2str(iorq->errnum));
   2181       1.1        pk 	else
   2182      1.64  christos 		if (iorq->errnum == 0)
   2183       1.1        pk 			printf(" [recovered in %d tries]", iorq->tries);
   2184       1.1        pk 
   2185       1.1        pk 	printf("\n");
   2186       1.1        pk }
   2187       1.1        pk 
   2188       1.1        pk /*
   2189       1.1        pk  * xdc_error: non-fatal error encountered... recover.
   2190       1.1        pk  * return AOK if resubmitted, return FAIL if this iopb is done
   2191       1.1        pk  */
   2192       1.1        pk int
   2193       1.1        pk xdc_error(xdcsc, iorq, iopb, rqno, comm)
   2194       1.1        pk 	struct xdc_softc *xdcsc;
   2195       1.1        pk 	struct xd_iorq *iorq;
   2196       1.1        pk 	struct xd_iopb *iopb;
   2197       1.1        pk 	int     rqno, comm;
   2198       1.1        pk 
   2199       1.1        pk {
   2200      1.64  christos 	int     errnum = iorq->errnum;
   2201      1.64  christos 	int     erract = errnum & XD_ERA_MASK;
   2202      1.15  drochner 	int     oldmode, advance;
   2203      1.20       chs #ifdef __sparc__
   2204      1.15  drochner 	int i;
   2205      1.15  drochner #endif
   2206       1.1        pk 
   2207       1.1        pk 	if (erract == XD_ERA_RSET) {	/* some errors require a reset */
   2208       1.1        pk 		oldmode = iorq->mode;
   2209       1.1        pk 		iorq->mode = XD_SUB_DONE | (~XD_SUB_MASK & oldmode);
   2210       1.1        pk 		xdcsc->ndone++;
   2211       1.1        pk 		/* make xdc_start ignore us */
   2212      1.64  christos 		xdc_reset(xdcsc, 1, XD_RSET_NONE, errnum, iorq->xd);
   2213       1.1        pk 		iorq->mode = oldmode;
   2214       1.1        pk 		xdcsc->ndone--;
   2215       1.1        pk 	}
   2216       1.1        pk 	/* check for read/write to a sector in bad144 table if bad: redirect
   2217       1.1        pk 	 * request to bad144 area */
   2218       1.1        pk 
   2219       1.1        pk 	if ((comm == XDCMD_RD || comm == XDCMD_WR) &&
   2220       1.1        pk 	    (iorq->mode & XD_MODE_B144) == 0) {
   2221       1.1        pk 		advance = iorq->sectcnt - iopb->sectcnt;
   2222       1.1        pk 		XDC_ADVANCE(iorq, advance);
   2223      1.20       chs #ifdef __sparc__
   2224       1.1        pk 		if ((i = isbad(&iorq->xd->dkb, iorq->blockno / iorq->xd->sectpercyl,
   2225       1.1        pk 			    (iorq->blockno / iorq->xd->nsect) % iorq->xd->nhead,
   2226       1.1        pk 			    iorq->blockno % iorq->xd->nsect)) != -1) {
   2227       1.1        pk 			iorq->mode |= XD_MODE_B144;	/* enter bad144 mode &
   2228       1.1        pk 							 * redirect */
   2229      1.64  christos 			iopb->errnum = iopb->done = iopb->errs = 0;
   2230       1.1        pk 			iopb->sectcnt = 1;
   2231       1.1        pk 			iopb->cylno = (iorq->xd->ncyl + iorq->xd->acyl) - 2;
   2232       1.1        pk 			/* second to last acyl */
   2233       1.1        pk 			i = iorq->xd->sectpercyl - 1 - i;	/* follow bad144
   2234       1.1        pk 								 * standard */
   2235       1.1        pk 			iopb->headno = i / iorq->xd->nhead;
   2236       1.1        pk 			iopb->sectno = i % iorq->xd->nhead;
   2237       1.1        pk 			XDC_HWAIT(xdcsc, rqno);
   2238       1.1        pk 			xdc_start(xdcsc, 1);	/* resubmit */
   2239       1.1        pk 			return (XD_ERR_AOK);	/* recovered! */
   2240       1.1        pk 		}
   2241      1.15  drochner #endif
   2242       1.1        pk 	}
   2243       1.1        pk 
   2244       1.1        pk 	/*
   2245       1.1        pk 	 * it isn't a bad144 sector, must be real error! see if we can retry
   2246       1.1        pk 	 * it?
   2247       1.1        pk 	 */
   2248       1.1        pk 	if ((iorq->mode & XD_MODE_VERBO) && iorq->lasterror)
   2249       1.1        pk 		xdc_perror(iorq, iopb, 1);	/* inform of error state
   2250       1.1        pk 						 * change */
   2251      1.64  christos 	iorq->lasterror = errnum;
   2252       1.1        pk 
   2253       1.1        pk 	if ((erract == XD_ERA_RSET || erract == XD_ERA_HARD)
   2254       1.1        pk 	    && iorq->tries < XDC_MAXTRIES) {	/* retry? */
   2255       1.1        pk 		iorq->tries++;
   2256      1.64  christos 		iorq->errnum = iopb->errnum = iopb->done = iopb->errs = 0;
   2257       1.1        pk 		XDC_HWAIT(xdcsc, rqno);
   2258       1.1        pk 		xdc_start(xdcsc, 1);	/* restart */
   2259       1.1        pk 		return (XD_ERR_AOK);	/* recovered! */
   2260       1.1        pk 	}
   2261       1.1        pk 
   2262       1.1        pk 	/* failed to recover from this error */
   2263       1.1        pk 	return (XD_ERR_FAIL);
   2264       1.1        pk }
   2265       1.1        pk 
   2266       1.1        pk /*
   2267       1.1        pk  * xdc_tick: make sure xd is still alive and ticking (err, kicking).
   2268       1.1        pk  */
   2269       1.1        pk void
   2270       1.1        pk xdc_tick(arg)
   2271       1.1        pk 	void   *arg;
   2272       1.1        pk 
   2273       1.1        pk {
   2274       1.1        pk 	struct xdc_softc *xdcsc = arg;
   2275       1.1        pk 	int     lcv, s, reset = 0;
   2276       1.1        pk #ifdef XDC_DIAG
   2277      1.57   tsutsui 	int     nwait, nrun, nfree, ndone, whd = 0;
   2278       1.1        pk 	u_char  fqc[XDC_MAXIOPB], wqc[XDC_MAXIOPB], mark[XDC_MAXIOPB];
   2279       1.1        pk 	s = splbio();
   2280      1.57   tsutsui 	nwait = xdcsc->nwait;
   2281      1.57   tsutsui 	nrun = xdcsc->nrun;
   2282      1.57   tsutsui 	nfree = xdcsc->nfree;
   2283      1.57   tsutsui 	ndone = xdcsc->ndone;
   2284      1.84   tsutsui 	memcpy(wqc, xdcsc->waitq, sizeof(wqc));
   2285      1.84   tsutsui 	memcpy(fqc, xdcsc->freereq, sizeof(fqc));
   2286       1.1        pk 	splx(s);
   2287      1.57   tsutsui 	if (nwait + nrun + nfree + ndone != XDC_MAXIOPB) {
   2288       1.1        pk 		printf("%s: diag: IOPB miscount (got w/f/r/d %d/%d/%d/%d, wanted %d)\n",
   2289      1.75    cegger 		    device_xname(&xdcsc->sc_dev), nwait, nfree, nrun, ndone,
   2290      1.57   tsutsui 		    XDC_MAXIOPB);
   2291      1.82    cegger 		memset(mark, 0, sizeof(mark));
   2292       1.1        pk 		printf("FREE: ");
   2293      1.57   tsutsui 		for (lcv = nfree; lcv > 0; lcv--) {
   2294       1.1        pk 			printf("%d ", fqc[lcv - 1]);
   2295       1.1        pk 			mark[fqc[lcv - 1]] = 1;
   2296       1.1        pk 		}
   2297       1.1        pk 		printf("\nWAIT: ");
   2298      1.57   tsutsui 		lcv = nwait;
   2299       1.1        pk 		while (lcv > 0) {
   2300       1.1        pk 			printf("%d ", wqc[whd]);
   2301       1.1        pk 			mark[wqc[whd]] = 1;
   2302       1.1        pk 			whd = (whd + 1) % XDC_MAXIOPB;
   2303       1.1        pk 			lcv--;
   2304       1.1        pk 		}
   2305       1.1        pk 		printf("\n");
   2306       1.1        pk 		for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
   2307       1.1        pk 			if (mark[lcv] == 0)
   2308      1.64  christos 				printf("MARK: running %d: mode %d done %d errs %d errnum 0x%x ttl %d buf %p\n",
   2309       1.1        pk 				lcv, xdcsc->reqs[lcv].mode,
   2310       1.1        pk 				xdcsc->iopbase[lcv].done,
   2311       1.1        pk 				xdcsc->iopbase[lcv].errs,
   2312      1.64  christos 				xdcsc->iopbase[lcv].errnum,
   2313       1.1        pk 				xdcsc->reqs[lcv].ttl, xdcsc->reqs[lcv].buf);
   2314       1.1        pk 		}
   2315       1.1        pk 	} else
   2316      1.57   tsutsui 		if (ndone > XDC_MAXIOPB - XDC_SUBWAITLIM)
   2317       1.1        pk 			printf("%s: diag: lots of done jobs (%d)\n",
   2318      1.75    cegger 				device_xname(&xdcsc->sc_dev), ndone);
   2319       1.1        pk 
   2320       1.1        pk #endif
   2321       1.1        pk #ifdef XDC_DEBUG
   2322       1.1        pk 	printf("%s: tick: csr 0x%x, w/f/r/d %d/%d/%d/%d\n",
   2323      1.75    cegger 		device_xname(&xdcsc->sc_dev),
   2324       1.1        pk 		xdcsc->xdc->xdc_csr, xdcsc->nwait, xdcsc->nfree, xdcsc->nrun,
   2325       1.1        pk 		xdcsc->ndone);
   2326       1.1        pk 	for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
   2327       1.1        pk 		if (xdcsc->reqs[lcv].mode)
   2328      1.64  christos 		  printf("running %d: mode %d done %d errs %d errnum 0x%x\n",
   2329       1.1        pk 			 lcv,
   2330       1.1        pk 			 xdcsc->reqs[lcv].mode, xdcsc->iopbase[lcv].done,
   2331      1.64  christos 			 xdcsc->iopbase[lcv].errs, xdcsc->iopbase[lcv].errnum);
   2332       1.1        pk 	}
   2333       1.1        pk #endif
   2334       1.1        pk 
   2335       1.1        pk 	/* reduce ttl for each request if one goes to zero, reset xdc */
   2336       1.1        pk 	s = splbio();
   2337       1.1        pk 	for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
   2338       1.1        pk 		if (xdcsc->reqs[lcv].mode == 0 ||
   2339       1.1        pk 		    XD_STATE(xdcsc->reqs[lcv].mode) == XD_SUB_DONE)
   2340       1.1        pk 			continue;
   2341       1.1        pk 		xdcsc->reqs[lcv].ttl--;
   2342       1.1        pk 		if (xdcsc->reqs[lcv].ttl == 0)
   2343       1.1        pk 			reset = 1;
   2344       1.1        pk 	}
   2345       1.1        pk 	if (reset) {
   2346      1.75    cegger 		printf("%s: watchdog timeout\n", device_xname(&xdcsc->sc_dev));
   2347       1.1        pk 		xdc_reset(xdcsc, 0, XD_RSET_NONE, XD_ERR_FAIL, NULL);
   2348       1.1        pk 	}
   2349       1.1        pk 	splx(s);
   2350       1.1        pk 
   2351       1.1        pk 	/* until next time */
   2352       1.1        pk 
   2353      1.19   thorpej 	callout_reset(&xdcsc->sc_tick_ch, XDC_TICKCNT, xdc_tick, xdcsc);
   2354       1.1        pk }
   2355       1.1        pk 
   2356       1.1        pk /*
   2357       1.1        pk  * xdc_ioctlcmd: this function provides a user level interface to the
   2358       1.1        pk  * controller via ioctl.   this allows "format" programs to be written
   2359       1.1        pk  * in user code, and is also useful for some debugging.   we return
   2360       1.1        pk  * an error code.   called at user priority.
   2361       1.1        pk  */
   2362       1.1        pk int
   2363       1.1        pk xdc_ioctlcmd(xd, dev, xio)
   2364       1.1        pk 	struct xd_softc *xd;
   2365       1.1        pk 	dev_t   dev;
   2366       1.1        pk 	struct xd_iocmd *xio;
   2367       1.1        pk 
   2368       1.1        pk {
   2369       1.3        pk 	int     s, rqno, dummy;
   2370      1.67       mrg 	char *dvmabuf = NULL, *buf = NULL;
   2371       1.1        pk 	struct xdc_softc *xdcsc;
   2372       1.3        pk 	int			rseg, error;
   2373       1.3        pk 	bus_dma_segment_t	seg;
   2374       1.1        pk 
   2375       1.1        pk 	/* check sanity of requested command */
   2376       1.1        pk 
   2377       1.1        pk 	switch (xio->cmd) {
   2378       1.1        pk 
   2379       1.1        pk 	case XDCMD_NOP:	/* no op: everything should be zero */
   2380       1.1        pk 		if (xio->subfn || xio->dptr || xio->dlen ||
   2381       1.1        pk 		    xio->block || xio->sectcnt)
   2382       1.1        pk 			return (EINVAL);
   2383       1.1        pk 		break;
   2384       1.1        pk 
   2385       1.1        pk 	case XDCMD_RD:		/* read / write sectors (up to XD_IOCMD_MAXS) */
   2386       1.1        pk 	case XDCMD_WR:
   2387       1.1        pk 		if (xio->subfn || xio->sectcnt > XD_IOCMD_MAXS ||
   2388       1.1        pk 		    xio->sectcnt * XDFM_BPS != xio->dlen || xio->dptr == NULL)
   2389       1.1        pk 			return (EINVAL);
   2390       1.1        pk 		break;
   2391       1.1        pk 
   2392       1.1        pk 	case XDCMD_SK:		/* seek: doesn't seem useful to export this */
   2393       1.1        pk 		return (EINVAL);
   2394       1.1        pk 
   2395       1.1        pk 	case XDCMD_WRP:	/* write parameters */
   2396       1.1        pk 		return (EINVAL);/* not useful, except maybe drive
   2397       1.1        pk 				 * parameters... but drive parameters should
   2398       1.1        pk 				 * go via disklabel changes */
   2399       1.1        pk 
   2400       1.1        pk 	case XDCMD_RDP:	/* read parameters */
   2401       1.1        pk 		if (xio->subfn != XDFUN_DRV ||
   2402       1.1        pk 		    xio->dlen || xio->block || xio->dptr)
   2403       1.1        pk 			return (EINVAL);	/* allow read drive params to
   2404       1.1        pk 						 * get hw_spt */
   2405       1.1        pk 		xio->sectcnt = xd->hw_spt;	/* we already know the answer */
   2406       1.1        pk 		return (0);
   2407       1.1        pk 		break;
   2408       1.1        pk 
   2409       1.1        pk 	case XDCMD_XRD:	/* extended read/write */
   2410       1.1        pk 	case XDCMD_XWR:
   2411       1.1        pk 
   2412       1.1        pk 		switch (xio->subfn) {
   2413       1.1        pk 
   2414       1.1        pk 		case XDFUN_THD:/* track headers */
   2415       1.1        pk 			if (xio->sectcnt != xd->hw_spt ||
   2416       1.1        pk 			    (xio->block % xd->nsect) != 0 ||
   2417       1.1        pk 			    xio->dlen != XD_IOCMD_HSZ * xd->hw_spt ||
   2418       1.1        pk 			    xio->dptr == NULL)
   2419       1.1        pk 				return (EINVAL);
   2420       1.1        pk 			xio->sectcnt = 0;
   2421       1.1        pk 			break;
   2422       1.1        pk 
   2423       1.1        pk 		case XDFUN_FMT:/* NOTE: also XDFUN_VFY */
   2424       1.1        pk 			if (xio->cmd == XDCMD_XRD)
   2425       1.1        pk 				return (EINVAL);	/* no XDFUN_VFY */
   2426       1.1        pk 			if (xio->sectcnt || xio->dlen ||
   2427       1.1        pk 			    (xio->block % xd->nsect) != 0 || xio->dptr)
   2428       1.1        pk 				return (EINVAL);
   2429       1.1        pk 			break;
   2430       1.1        pk 
   2431       1.1        pk 		case XDFUN_HDR:/* header, header verify, data, data ECC */
   2432       1.1        pk 			return (EINVAL);	/* not yet */
   2433       1.1        pk 
   2434       1.1        pk 		case XDFUN_DM:	/* defect map */
   2435       1.1        pk 		case XDFUN_DMX:/* defect map (alternate location) */
   2436       1.1        pk 			if (xio->sectcnt || xio->dlen != XD_IOCMD_DMSZ ||
   2437       1.1        pk 			    (xio->block % xd->nsect) != 0 || xio->dptr == NULL)
   2438       1.1        pk 				return (EINVAL);
   2439       1.1        pk 			break;
   2440       1.1        pk 
   2441       1.1        pk 		default:
   2442       1.1        pk 			return (EINVAL);
   2443       1.1        pk 		}
   2444       1.1        pk 		break;
   2445       1.1        pk 
   2446       1.1        pk 	case XDCMD_TST:	/* diagnostics */
   2447       1.1        pk 		return (EINVAL);
   2448       1.1        pk 
   2449       1.1        pk 	default:
   2450       1.1        pk 		return (EINVAL);/* ??? */
   2451       1.1        pk 	}
   2452       1.1        pk 
   2453       1.3        pk 	xdcsc = xd->parent;
   2454       1.3        pk 
   2455       1.1        pk 	/* create DVMA buffer for request if needed */
   2456       1.3        pk 	if (xio->dlen) {
   2457      1.52       mrg 		bus_addr_t busbuf;
   2458      1.52       mrg 
   2459      1.21        pk 		if ((error = xd_dmamem_alloc(xdcsc->dmatag, xdcsc->auxmap,
   2460      1.21        pk 					     &seg, &rseg,
   2461      1.67       mrg 					     xio->dlen, (void **)&buf,
   2462      1.52       mrg 					     &busbuf)) != 0) {
   2463       1.3        pk 			return (error);
   2464      1.21        pk 		}
   2465      1.66  christos 		dvmabuf = (void *)(u_long)BUS_ADDR_PADDR(busbuf);
   2466       1.1        pk 
   2467       1.1        pk 		if (xio->cmd == XDCMD_WR || xio->cmd == XDCMD_XWR) {
   2468       1.3        pk 			if ((error = copyin(xio->dptr, buf, xio->dlen)) != 0) {
   2469       1.3        pk 				bus_dmamem_unmap(xdcsc->dmatag, buf, xio->dlen);
   2470       1.3        pk 				bus_dmamem_free(xdcsc->dmatag, &seg, rseg);
   2471       1.3        pk 				return (error);
   2472       1.1        pk 			}
   2473       1.1        pk 		}
   2474       1.1        pk 	}
   2475       1.3        pk 
   2476       1.1        pk 	/* do it! */
   2477       1.1        pk 
   2478       1.3        pk 	error = 0;
   2479       1.1        pk 	s = splbio();
   2480       1.1        pk 	rqno = xdc_cmd(xdcsc, xio->cmd, xio->subfn, xd->xd_drive, xio->block,
   2481       1.1        pk 	    xio->sectcnt, dvmabuf, XD_SUB_WAIT);
   2482       1.1        pk 	if (rqno == XD_ERR_FAIL) {
   2483       1.3        pk 		error = EIO;
   2484       1.1        pk 		goto done;
   2485       1.1        pk 	}
   2486      1.64  christos 	xio->errnum = xdcsc->reqs[rqno].errnum;
   2487       1.1        pk 	xio->tries = xdcsc->reqs[rqno].tries;
   2488       1.1        pk 	XDC_DONE(xdcsc, rqno, dummy);
   2489       1.1        pk 
   2490       1.1        pk 	if (xio->cmd == XDCMD_RD || xio->cmd == XDCMD_XRD)
   2491       1.3        pk 		error = copyout(buf, xio->dptr, xio->dlen);
   2492       1.1        pk 
   2493       1.1        pk done:
   2494       1.1        pk 	splx(s);
   2495       1.3        pk 	if (dvmabuf) {
   2496      1.21        pk 		xd_dmamem_free(xdcsc->dmatag, xdcsc->auxmap, &seg, rseg,
   2497      1.21        pk 				xio->dlen, buf);
   2498       1.3        pk 	}
   2499       1.3        pk 	return (error);
   2500       1.1        pk }
   2501       1.1        pk 
   2502       1.1        pk /*
   2503       1.1        pk  * xdc_e2str: convert error code number into an error string
   2504       1.1        pk  */
   2505      1.57   tsutsui const char *
   2506      1.79       dsl xdc_e2str(int no)
   2507       1.1        pk {
   2508       1.1        pk 	switch (no) {
   2509       1.1        pk 	case XD_ERR_FAIL:
   2510       1.1        pk 		return ("Software fatal error");
   2511       1.1        pk 	case XD_ERR_AOK:
   2512       1.1        pk 		return ("Successful completion");
   2513       1.1        pk 	case XD_ERR_ICYL:
   2514       1.1        pk 		return ("Illegal cylinder address");
   2515       1.1        pk 	case XD_ERR_IHD:
   2516       1.1        pk 		return ("Illegal head address");
   2517       1.1        pk 	case XD_ERR_ISEC:
   2518       1.1        pk 		return ("Illgal sector address");
   2519       1.1        pk 	case XD_ERR_CZER:
   2520       1.1        pk 		return ("Count zero");
   2521       1.1        pk 	case XD_ERR_UIMP:
   2522       1.1        pk 		return ("Unimplemented command");
   2523       1.1        pk 	case XD_ERR_IF1:
   2524       1.1        pk 		return ("Illegal field length 1");
   2525       1.1        pk 	case XD_ERR_IF2:
   2526       1.1        pk 		return ("Illegal field length 2");
   2527       1.1        pk 	case XD_ERR_IF3:
   2528       1.1        pk 		return ("Illegal field length 3");
   2529       1.1        pk 	case XD_ERR_IF4:
   2530       1.1        pk 		return ("Illegal field length 4");
   2531       1.1        pk 	case XD_ERR_IF5:
   2532       1.1        pk 		return ("Illegal field length 5");
   2533       1.1        pk 	case XD_ERR_IF6:
   2534       1.1        pk 		return ("Illegal field length 6");
   2535       1.1        pk 	case XD_ERR_IF7:
   2536       1.1        pk 		return ("Illegal field length 7");
   2537       1.1        pk 	case XD_ERR_ISG:
   2538       1.1        pk 		return ("Illegal scatter/gather length");
   2539       1.1        pk 	case XD_ERR_ISPT:
   2540       1.1        pk 		return ("Not enough sectors per track");
   2541       1.1        pk 	case XD_ERR_ALGN:
   2542       1.1        pk 		return ("Next IOPB address alignment error");
   2543       1.1        pk 	case XD_ERR_SGAL:
   2544       1.1        pk 		return ("Scatter/gather address alignment error");
   2545       1.1        pk 	case XD_ERR_SGEC:
   2546       1.1        pk 		return ("Scatter/gather with auto-ECC");
   2547       1.1        pk 	case XD_ERR_SECC:
   2548       1.1        pk 		return ("Soft ECC corrected");
   2549       1.1        pk 	case XD_ERR_SIGN:
   2550       1.1        pk 		return ("ECC ignored");
   2551       1.1        pk 	case XD_ERR_ASEK:
   2552       1.1        pk 		return ("Auto-seek retry recovered");
   2553       1.1        pk 	case XD_ERR_RTRY:
   2554       1.1        pk 		return ("Soft retry recovered");
   2555       1.1        pk 	case XD_ERR_HECC:
   2556       1.1        pk 		return ("Hard data ECC");
   2557       1.1        pk 	case XD_ERR_NHDR:
   2558       1.1        pk 		return ("Header not found");
   2559       1.1        pk 	case XD_ERR_NRDY:
   2560       1.1        pk 		return ("Drive not ready");
   2561       1.1        pk 	case XD_ERR_TOUT:
   2562       1.1        pk 		return ("Operation timeout");
   2563       1.1        pk 	case XD_ERR_VTIM:
   2564       1.1        pk 		return ("VMEDMA timeout");
   2565       1.1        pk 	case XD_ERR_DSEQ:
   2566       1.1        pk 		return ("Disk sequencer error");
   2567       1.1        pk 	case XD_ERR_HDEC:
   2568       1.1        pk 		return ("Header ECC error");
   2569       1.1        pk 	case XD_ERR_RVFY:
   2570       1.1        pk 		return ("Read verify");
   2571       1.1        pk 	case XD_ERR_VFER:
   2572       1.1        pk 		return ("Fatail VMEDMA error");
   2573       1.1        pk 	case XD_ERR_VBUS:
   2574       1.1        pk 		return ("VMEbus error");
   2575       1.1        pk 	case XD_ERR_DFLT:
   2576       1.1        pk 		return ("Drive faulted");
   2577       1.1        pk 	case XD_ERR_HECY:
   2578       1.1        pk 		return ("Header error/cyliner");
   2579       1.1        pk 	case XD_ERR_HEHD:
   2580       1.1        pk 		return ("Header error/head");
   2581       1.1        pk 	case XD_ERR_NOCY:
   2582       1.1        pk 		return ("Drive not on-cylinder");
   2583       1.1        pk 	case XD_ERR_SEEK:
   2584       1.1        pk 		return ("Seek error");
   2585       1.1        pk 	case XD_ERR_ILSS:
   2586       1.1        pk 		return ("Illegal sector size");
   2587       1.1        pk 	case XD_ERR_SEC:
   2588       1.1        pk 		return ("Soft ECC");
   2589       1.1        pk 	case XD_ERR_WPER:
   2590       1.1        pk 		return ("Write-protect error");
   2591       1.1        pk 	case XD_ERR_IRAM:
   2592       1.1        pk 		return ("IRAM self test failure");
   2593       1.1        pk 	case XD_ERR_MT3:
   2594       1.1        pk 		return ("Maintenance test 3 failure (DSKCEL RAM)");
   2595       1.1        pk 	case XD_ERR_MT4:
   2596       1.1        pk 		return ("Maintenance test 4 failure (header shift reg)");
   2597       1.1        pk 	case XD_ERR_MT5:
   2598       1.1        pk 		return ("Maintenance test 5 failure (VMEDMA regs)");
   2599       1.1        pk 	case XD_ERR_MT6:
   2600       1.1        pk 		return ("Maintenance test 6 failure (REGCEL chip)");
   2601       1.1        pk 	case XD_ERR_MT7:
   2602       1.1        pk 		return ("Maintenance test 7 failure (buffer parity)");
   2603       1.1        pk 	case XD_ERR_MT8:
   2604       1.1        pk 		return ("Maintenance test 8 failure (disk FIFO)");
   2605       1.1        pk 	case XD_ERR_IOCK:
   2606       1.1        pk 		return ("IOPB checksum miscompare");
   2607       1.1        pk 	case XD_ERR_IODM:
   2608       1.1        pk 		return ("IOPB DMA fatal");
   2609       1.1        pk 	case XD_ERR_IOAL:
   2610       1.1        pk 		return ("IOPB address alignment error");
   2611       1.1        pk 	case XD_ERR_FIRM:
   2612       1.1        pk 		return ("Firmware error");
   2613       1.1        pk 	case XD_ERR_MMOD:
   2614       1.1        pk 		return ("Illegal maintenance mode test number");
   2615       1.1        pk 	case XD_ERR_ACFL:
   2616       1.1        pk 		return ("ACFAIL asserted");
   2617       1.1        pk 	default:
   2618       1.1        pk 		return ("Unknown error");
   2619       1.1        pk 	}
   2620       1.1        pk }
   2621