Home | History | Annotate | Line # | Download | only in vme
xy.c revision 1.74.2.1
      1  1.74.2.1       mjf /*	$NetBSD: xy.c,v 1.74.2.1 2008/02/18 21:06:35 mjf Exp $	*/
      2       1.1        pk 
      3       1.1        pk /*
      4       1.1        pk  *
      5       1.1        pk  * Copyright (c) 1995 Charles D. Cranor
      6       1.1        pk  * All rights reserved.
      7       1.1        pk  *
      8       1.1        pk  * Redistribution and use in source and binary forms, with or without
      9       1.1        pk  * modification, are permitted provided that the following conditions
     10       1.1        pk  * are met:
     11       1.1        pk  * 1. Redistributions of source code must retain the above copyright
     12       1.1        pk  *    notice, this list of conditions and the following disclaimer.
     13       1.1        pk  * 2. Redistributions in binary form must reproduce the above copyright
     14       1.1        pk  *    notice, this list of conditions and the following disclaimer in the
     15       1.1        pk  *    documentation and/or other materials provided with the distribution.
     16       1.1        pk  * 3. All advertising materials mentioning features or use of this software
     17       1.1        pk  *    must display the following acknowledgement:
     18       1.1        pk  *      This product includes software developed by Charles D. Cranor.
     19       1.1        pk  * 4. The name of the author may not be used to endorse or promote products
     20       1.1        pk  *    derived from this software without specific prior written permission.
     21       1.1        pk  *
     22       1.1        pk  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23       1.1        pk  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24       1.1        pk  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25       1.1        pk  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26       1.1        pk  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27       1.1        pk  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28       1.1        pk  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29       1.1        pk  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30       1.1        pk  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     31       1.1        pk  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32       1.1        pk  */
     33       1.1        pk 
     34       1.1        pk /*
     35       1.1        pk  *
     36       1.1        pk  * x y . c   x y l o g i c s   4 5 0 / 4 5 1   s m d   d r i v e r
     37       1.1        pk  *
     38       1.1        pk  * author: Chuck Cranor <chuck (at) ccrc.wustl.edu>
     39       1.1        pk  * started: 14-Sep-95
     40       1.1        pk  * references: [1] Xylogics Model 753 User's Manual
     41       1.1        pk  *                 part number: 166-753-001, Revision B, May 21, 1988.
     42       1.1        pk  *                 "Your Partner For Performance"
     43       1.1        pk  *             [2] other NetBSD disk device drivers
     44       1.1        pk  *	       [3] Xylogics Model 450 User's Manual
     45       1.1        pk  *		   part number: 166-017-001, Revision B, 1983.
     46       1.1        pk  *	       [4] Addendum to Xylogics Model 450 Disk Controller User's
     47       1.1        pk  *			Manual, Jan. 1985.
     48       1.1        pk  *	       [5] The 451 Controller, Rev. B3, September 2, 1986.
     49       1.1        pk  *	       [6] David Jones <dej (at) achilles.net>'s unfinished 450/451 driver
     50       1.1        pk  *
     51       1.1        pk  */
     52      1.38     lukem 
     53      1.38     lukem #include <sys/cdefs.h>
     54  1.74.2.1       mjf __KERNEL_RCSID(0, "$NetBSD: xy.c,v 1.74.2.1 2008/02/18 21:06:35 mjf Exp $");
     55       1.1        pk 
     56       1.1        pk #undef XYC_DEBUG		/* full debug */
     57       1.1        pk #undef XYC_DIAG			/* extra sanity checks */
     58       1.1        pk #if defined(DIAGNOSTIC) && !defined(XYC_DIAG)
     59       1.1        pk #define XYC_DIAG		/* link in with master DIAG option */
     60       1.1        pk #endif
     61       1.1        pk 
     62       1.1        pk #include <sys/param.h>
     63       1.1        pk #include <sys/proc.h>
     64       1.1        pk #include <sys/systm.h>
     65       1.1        pk #include <sys/kernel.h>
     66       1.1        pk #include <sys/file.h>
     67       1.1        pk #include <sys/stat.h>
     68       1.1        pk #include <sys/ioctl.h>
     69       1.1        pk #include <sys/buf.h>
     70      1.56      yamt #include <sys/bufq.h>
     71       1.1        pk #include <sys/uio.h>
     72       1.1        pk #include <sys/malloc.h>
     73       1.1        pk #include <sys/device.h>
     74       1.1        pk #include <sys/disklabel.h>
     75       1.1        pk #include <sys/disk.h>
     76       1.1        pk #include <sys/syslog.h>
     77       1.1        pk #include <sys/dkbad.h>
     78       1.1        pk #include <sys/conf.h>
     79      1.65      yamt #include <sys/kauth.h>
     80       1.1        pk 
     81      1.74        ad #include <sys/bus.h>
     82      1.74        ad #include <sys/intr.h>
     83       1.9       mrg 
     84      1.25       chs #if defined(__sparc__) || defined(sun3)
     85       1.9       mrg #include <dev/sun/disklabel.h>
     86      1.11        pk #endif
     87       1.1        pk 
     88      1.28        pk #include <dev/vme/vmereg.h>
     89       1.1        pk #include <dev/vme/vmevar.h>
     90      1.12  drochner 
     91       1.1        pk #include <dev/vme/xyreg.h>
     92       1.1        pk #include <dev/vme/xyvar.h>
     93       1.1        pk #include <dev/vme/xio.h>
     94       1.1        pk 
     95       1.1        pk #include "locators.h"
     96       1.1        pk 
     97       1.1        pk /*
     98       1.1        pk  * macros
     99       1.1        pk  */
    100       1.1        pk 
    101       1.1        pk /*
    102       1.1        pk  * XYC_GO: start iopb ADDR (DVMA addr in a u_long) on XYC
    103       1.1        pk  */
    104       1.1        pk #define XYC_GO(XYC, ADDR) { \
    105      1.63     skrll 	u_long addr = (u_long)ADDR; \
    106      1.63     skrll 	(XYC)->xyc_addr_lo = ((addr) & 0xff); \
    107      1.63     skrll 	(addr) = ((addr) >> 8); \
    108      1.63     skrll 	(XYC)->xyc_addr_hi = ((addr) & 0xff); \
    109      1.63     skrll 	(addr) = ((addr) >> 8); \
    110      1.63     skrll 	(XYC)->xyc_reloc_lo = ((addr) & 0xff); \
    111      1.63     skrll 	(addr) = ((addr) >> 8); \
    112      1.63     skrll 	(XYC)->xyc_reloc_hi = (addr); \
    113       1.1        pk 	(XYC)->xyc_csr = XYC_GBSY; /* go! */ \
    114       1.1        pk }
    115       1.1        pk 
    116       1.1        pk /*
    117       1.1        pk  * XYC_DONE: don't need IORQ, get error code and free (done after xyc_cmd)
    118       1.1        pk  */
    119       1.1        pk 
    120       1.1        pk #define XYC_DONE(SC,ER) { \
    121       1.1        pk 	if ((ER) == XY_ERR_AOK) { \
    122      1.67  christos 		(ER) = (SC)->ciorq->errnum; \
    123       1.1        pk 		(SC)->ciorq->mode = XY_SUB_FREE; \
    124       1.1        pk 		wakeup((SC)->ciorq); \
    125       1.1        pk 	} \
    126       1.1        pk 	}
    127       1.1        pk 
    128       1.1        pk /*
    129       1.1        pk  * XYC_ADVANCE: advance iorq's pointers by a number of sectors
    130       1.1        pk  */
    131       1.1        pk 
    132       1.1        pk #define XYC_ADVANCE(IORQ, N) { \
    133       1.1        pk 	if (N) { \
    134       1.1        pk 		(IORQ)->sectcnt -= (N); \
    135       1.1        pk 		(IORQ)->blockno += (N); \
    136       1.1        pk 		(IORQ)->dbuf += ((N)*XYFM_BPS); \
    137       1.1        pk 	} \
    138       1.1        pk }
    139       1.1        pk 
    140       1.1        pk /*
    141       1.1        pk  * note - addresses you can sleep on:
    142       1.1        pk  *   [1] & of xy_softc's "state" (waiting for a chance to attach a drive)
    143       1.1        pk  *   [2] & an iorq (waiting for an XY_SUB_WAIT iorq to finish)
    144       1.1        pk  */
    145       1.1        pk 
    146       1.1        pk 
    147       1.1        pk /*
    148       1.1        pk  * function prototypes
    149       1.1        pk  * "xyc_*" functions are internal, all others are external interfaces
    150       1.1        pk  */
    151       1.1        pk 
    152       1.1        pk extern int pil_to_vme[];	/* from obio.c */
    153       1.1        pk 
    154       1.1        pk /* internals */
    155      1.57     perry struct xy_iopb *xyc_chain(struct xyc_softc *, struct xy_iorq *);
    156      1.57     perry int	xyc_cmd(struct xyc_softc *, int, int, int, int, int, char *, int);
    157      1.59   tsutsui const char *xyc_e2str(int);
    158      1.57     perry int	xyc_entoact(int);
    159      1.57     perry int	xyc_error(struct xyc_softc *, struct xy_iorq *,
    160      1.57     perry 		   struct xy_iopb *, int);
    161      1.57     perry int	xyc_ioctlcmd(struct xy_softc *, dev_t dev, struct xd_iocmd *);
    162      1.57     perry void	xyc_perror(struct xy_iorq *, struct xy_iopb *, int);
    163      1.57     perry int	xyc_piodriver(struct xyc_softc *, struct xy_iorq *);
    164      1.57     perry int	xyc_remove_iorq(struct xyc_softc *);
    165      1.57     perry int	xyc_reset(struct xyc_softc *, int, struct xy_iorq *, int,
    166      1.57     perry 		  struct xy_softc *);
    167      1.57     perry inline void xyc_rqinit(struct xy_iorq *, struct xyc_softc *,
    168      1.57     perry 			struct xy_softc *, int, u_long, int,
    169      1.69  christos 			void *, struct buf *);
    170      1.57     perry void	xyc_rqtopb(struct xy_iorq *, struct xy_iopb *, int, int);
    171      1.57     perry void	xyc_start(struct xyc_softc *, struct xy_iorq *);
    172      1.57     perry int	xyc_startbuf(struct xyc_softc *, struct xy_softc *, struct buf *);
    173      1.57     perry int	xyc_submit_iorq(struct xyc_softc *, struct xy_iorq *, int);
    174      1.57     perry void	xyc_tick(void *);
    175      1.57     perry int	xyc_unbusy(struct xyc *, int);
    176      1.57     perry void	xyc_xyreset(struct xyc_softc *, struct xy_softc *);
    177      1.19        pk int	xy_dmamem_alloc(bus_dma_tag_t, bus_dmamap_t, bus_dma_segment_t *,
    178      1.69  christos 			int *, bus_size_t, void **, bus_addr_t *);
    179      1.19        pk void	xy_dmamem_free(bus_dma_tag_t, bus_dmamap_t, bus_dma_segment_t *,
    180      1.69  christos 			int, bus_size_t, void *);
    181       1.1        pk 
    182       1.1        pk /* machine interrupt hook */
    183      1.57     perry int	xycintr(void *);
    184       1.1        pk 
    185       1.1        pk /* autoconf */
    186      1.57     perry int	xycmatch(struct device *, struct cfdata *, void *);
    187      1.57     perry void	xycattach(struct device *, struct device *, void *);
    188      1.57     perry int	xymatch(struct device *, struct cfdata *, void *);
    189      1.57     perry void	xyattach(struct device *, struct device *, void *);
    190      1.57     perry static	int xyc_probe(void *, bus_space_tag_t, bus_space_handle_t);
    191       1.1        pk 
    192      1.57     perry static	void xydummystrat(struct buf *);
    193      1.57     perry int	xygetdisklabel(struct xy_softc *, void *);
    194       1.1        pk 
    195       1.1        pk /*
    196       1.3   thorpej  * cfattach's: device driver interface to autoconfig
    197       1.1        pk  */
    198       1.1        pk 
    199      1.44   thorpej CFATTACH_DECL(xyc, sizeof(struct xyc_softc),
    200      1.45   thorpej     xycmatch, xycattach, NULL, NULL);
    201      1.44   thorpej 
    202      1.44   thorpej CFATTACH_DECL(xy, sizeof(struct xy_softc),
    203      1.45   thorpej     xymatch, xyattach, NULL, NULL);
    204       1.1        pk 
    205       1.3   thorpej extern struct cfdriver xy_cd;
    206      1.41   gehenna 
    207      1.41   gehenna dev_type_open(xyopen);
    208      1.41   gehenna dev_type_close(xyclose);
    209      1.41   gehenna dev_type_read(xyread);
    210      1.41   gehenna dev_type_write(xywrite);
    211      1.41   gehenna dev_type_ioctl(xyioctl);
    212      1.41   gehenna dev_type_strategy(xystrategy);
    213      1.41   gehenna dev_type_dump(xydump);
    214      1.41   gehenna dev_type_size(xysize);
    215      1.41   gehenna 
    216      1.41   gehenna const struct bdevsw xy_bdevsw = {
    217      1.41   gehenna 	xyopen, xyclose, xystrategy, xyioctl, xydump, xysize, D_DISK
    218      1.41   gehenna };
    219      1.41   gehenna 
    220      1.41   gehenna const struct cdevsw xy_cdevsw = {
    221      1.41   gehenna 	xyopen, xyclose, xyread, xywrite, xyioctl,
    222      1.46  jdolecek 	nostop, notty, nopoll, nommap, nokqfilter, D_DISK
    223      1.41   gehenna };
    224       1.1        pk 
    225       1.1        pk struct xyc_attach_args {	/* this is the "aux" args to xyattach */
    226       1.1        pk 	int	driveno;	/* unit number */
    227       1.1        pk 	int	fullmode;	/* submit mode */
    228       1.1        pk 	int	booting;	/* are we booting or not? */
    229       1.1        pk };
    230       1.1        pk 
    231       1.1        pk /*
    232       1.1        pk  * dkdriver
    233       1.1        pk  */
    234       1.1        pk 
    235       1.1        pk struct dkdriver xydkdriver = { xystrategy };
    236       1.1        pk 
    237       1.1        pk /*
    238       1.1        pk  * start: disk label fix code (XXX)
    239       1.1        pk  */
    240       1.1        pk 
    241       1.1        pk static void *xy_labeldata;
    242       1.1        pk 
    243       1.1        pk static void
    244       1.1        pk xydummystrat(bp)
    245       1.1        pk 	struct buf *bp;
    246       1.1        pk {
    247       1.1        pk 	if (bp->b_bcount != XYFM_BPS)
    248       1.1        pk 		panic("xydummystrat");
    249      1.22   thorpej 	bcopy(xy_labeldata, bp->b_data, XYFM_BPS);
    250  1.74.2.1       mjf 	bp->b_oflags |= BO_DONE;
    251  1.74.2.1       mjf 	bp->b_cflags &= ~BC_BUSY;
    252       1.1        pk }
    253       1.1        pk 
    254       1.1        pk int
    255       1.1        pk xygetdisklabel(xy, b)
    256       1.1        pk 	struct xy_softc *xy;
    257       1.1        pk 	void *b;
    258       1.1        pk {
    259      1.48       dsl 	const char *err;
    260      1.25       chs #if defined(__sparc__) || defined(sun3)
    261       1.1        pk 	struct sun_disklabel *sdl;
    262      1.11        pk #endif
    263       1.1        pk 
    264       1.1        pk 	/* We already have the label data in `b'; setup for dummy strategy */
    265       1.1        pk 	xy_labeldata = b;
    266       1.1        pk 
    267       1.1        pk 	/* Required parameter for readdisklabel() */
    268       1.1        pk 	xy->sc_dk.dk_label->d_secsize = XYFM_BPS;
    269       1.1        pk 
    270      1.62   thorpej 	err = readdisklabel(MAKEDISKDEV(0, device_unit(&xy->sc_dev), RAW_PART),
    271       1.1        pk 					xydummystrat,
    272       1.1        pk 				xy->sc_dk.dk_label, xy->sc_dk.dk_cpulabel);
    273       1.1        pk 	if (err) {
    274       1.1        pk 		printf("%s: %s\n", xy->sc_dev.dv_xname, err);
    275       1.1        pk 		return(XY_ERR_FAIL);
    276       1.1        pk 	}
    277       1.1        pk 
    278      1.25       chs #if defined(__sparc__) || defined(sun3)
    279       1.1        pk 	/* Ok, we have the label; fill in `pcyl' if there's SunOS magic */
    280       1.1        pk 	sdl = (struct sun_disklabel *)xy->sc_dk.dk_cpulabel->cd_block;
    281      1.11        pk 	if (sdl->sl_magic == SUN_DKMAGIC) {
    282       1.1        pk 		xy->pcyl = sdl->sl_pcylinders;
    283      1.11        pk 	} else
    284      1.14  drochner #endif
    285      1.11        pk 	{
    286       1.1        pk 		printf("%s: WARNING: no `pcyl' in disk label.\n",
    287       1.1        pk 			xy->sc_dev.dv_xname);
    288       1.1        pk 		xy->pcyl = xy->sc_dk.dk_label->d_ncylinders +
    289       1.1        pk 			xy->sc_dk.dk_label->d_acylinders;
    290       1.1        pk 		printf("%s: WARNING: guessing pcyl=%d (ncyl+acyl)\n",
    291       1.1        pk 		xy->sc_dev.dv_xname, xy->pcyl);
    292       1.1        pk 	}
    293       1.1        pk 
    294       1.1        pk 	xy->ncyl = xy->sc_dk.dk_label->d_ncylinders;
    295       1.1        pk 	xy->acyl = xy->sc_dk.dk_label->d_acylinders;
    296       1.1        pk 	xy->nhead = xy->sc_dk.dk_label->d_ntracks;
    297       1.1        pk 	xy->nsect = xy->sc_dk.dk_label->d_nsectors;
    298       1.1        pk 	xy->sectpercyl = xy->nhead * xy->nsect;
    299       1.1        pk 	xy->sc_dk.dk_label->d_secsize = XYFM_BPS; /* not handled by
    300       1.1        pk                                           	  * sun->bsd */
    301       1.1        pk 	return(XY_ERR_AOK);
    302       1.1        pk }
    303       1.1        pk 
    304       1.1        pk /*
    305       1.1        pk  * end: disk label fix code (XXX)
    306       1.1        pk  */
    307       1.1        pk 
    308       1.1        pk /*
    309      1.19        pk  * Shorthand for allocating, mapping and loading a DMA buffer
    310      1.19        pk  */
    311      1.19        pk int
    312      1.19        pk xy_dmamem_alloc(tag, map, seg, nsegp, len, kvap, dmap)
    313      1.19        pk 	bus_dma_tag_t		tag;
    314      1.19        pk 	bus_dmamap_t		map;
    315      1.19        pk 	bus_dma_segment_t	*seg;
    316      1.19        pk 	int			*nsegp;
    317      1.19        pk 	bus_size_t		len;
    318      1.69  christos 	void *			*kvap;
    319      1.19        pk 	bus_addr_t		*dmap;
    320      1.19        pk {
    321      1.19        pk 	int nseg;
    322      1.19        pk 	int error;
    323      1.19        pk 
    324      1.20        pk 	if ((error = bus_dmamem_alloc(tag, len, 0, 0,
    325      1.19        pk 				      seg, 1, &nseg, BUS_DMA_NOWAIT)) != 0) {
    326      1.19        pk 		return (error);
    327      1.19        pk 	}
    328      1.19        pk 
    329      1.34   thorpej 	if ((error = bus_dmamem_map(tag, seg, nseg,
    330      1.34   thorpej 				    len, kvap,
    331      1.34   thorpej 				    BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) != 0) {
    332      1.19        pk 		bus_dmamem_free(tag, seg, nseg);
    333      1.19        pk 		return (error);
    334      1.19        pk 	}
    335      1.19        pk 
    336      1.35       chs 	if ((error = bus_dmamap_load(tag, map, *kvap, len, NULL,
    337      1.34   thorpej 				     BUS_DMA_NOWAIT)) != 0) {
    338      1.34   thorpej 		bus_dmamem_unmap(tag, *kvap, len);
    339      1.19        pk 		bus_dmamem_free(tag, seg, nseg);
    340      1.19        pk 		return (error);
    341      1.19        pk 	}
    342      1.19        pk 
    343      1.19        pk 	*dmap = map->dm_segs[0].ds_addr;
    344      1.19        pk 	*nsegp = nseg;
    345      1.19        pk 	return (0);
    346      1.19        pk }
    347      1.19        pk 
    348      1.19        pk void
    349      1.19        pk xy_dmamem_free(tag, map, seg, nseg, len, kva)
    350      1.19        pk 	bus_dma_tag_t		tag;
    351      1.19        pk 	bus_dmamap_t		map;
    352      1.19        pk 	bus_dma_segment_t	*seg;
    353      1.19        pk 	int			nseg;
    354      1.19        pk 	bus_size_t		len;
    355      1.69  christos 	void *			kva;
    356      1.19        pk {
    357      1.19        pk 
    358      1.19        pk 	bus_dmamap_unload(tag, map);
    359      1.19        pk 	bus_dmamem_unmap(tag, kva, len);
    360      1.19        pk 	bus_dmamem_free(tag, seg, nseg);
    361      1.19        pk }
    362      1.19        pk 
    363      1.19        pk 
    364      1.19        pk /*
    365       1.1        pk  * a u t o c o n f i g   f u n c t i o n s
    366       1.1        pk  */
    367       1.1        pk 
    368       1.1        pk /*
    369       1.1        pk  * xycmatch: determine if xyc is present or not.   we do a
    370       1.1        pk  * soft reset to detect the xyc.
    371       1.1        pk  */
    372       1.6        pk int
    373      1.12  drochner xyc_probe(arg, tag, handle)
    374       1.6        pk 	void *arg;
    375      1.12  drochner 	bus_space_tag_t tag;
    376      1.12  drochner 	bus_space_handle_t handle;
    377       1.6        pk {
    378      1.12  drochner 	struct xyc *xyc = (void *)handle; /* XXX */
    379       1.6        pk 
    380      1.12  drochner 	return ((xyc_unbusy(xyc, XYC_RESETUSEC) != XY_ERR_FAIL) ? 0 : EIO);
    381       1.6        pk }
    382       1.1        pk 
    383       1.1        pk int xycmatch(parent, cf, aux)
    384       1.1        pk 	struct device *parent;
    385       1.1        pk 	struct cfdata *cf;
    386       1.1        pk 	void *aux;
    387       1.1        pk {
    388       1.1        pk 	struct vme_attach_args	*va = aux;
    389      1.12  drochner 	vme_chipset_tag_t	ct = va->va_vct;
    390      1.12  drochner 	vme_am_t		mod;
    391      1.12  drochner 	int error;
    392      1.12  drochner 
    393      1.28        pk 	mod = VME_AM_A16 | VME_AM_MBO | VME_AM_SUPER | VME_AM_DATA;
    394      1.28        pk 	if (vme_space_alloc(ct, va->r[0].offset, sizeof(struct xyc), mod))
    395      1.12  drochner 		return (0);
    396      1.28        pk 
    397      1.12  drochner 	error = vme_probe(ct, va->r[0].offset, sizeof(struct xyc),
    398      1.28        pk 			  mod, VME_D16, xyc_probe, 0);
    399      1.12  drochner 	vme_space_free(va->va_vct, va->r[0].offset, sizeof(struct xyc), mod);
    400      1.12  drochner 
    401      1.12  drochner 	return (error == 0);
    402       1.1        pk }
    403       1.1        pk 
    404       1.1        pk /*
    405       1.1        pk  * xycattach: attach controller
    406       1.1        pk  */
    407       1.1        pk void
    408       1.1        pk xycattach(parent, self, aux)
    409       1.1        pk 	struct device *parent, *self;
    410       1.1        pk 	void   *aux;
    411       1.1        pk 
    412       1.1        pk {
    413      1.28        pk 	struct xyc_softc	*xyc = (void *) self;
    414       1.1        pk 	struct vme_attach_args	*va = aux;
    415      1.12  drochner 	vme_chipset_tag_t	ct = va->va_vct;
    416      1.12  drochner 	bus_space_tag_t		bt;
    417       1.1        pk 	bus_space_handle_t	bh;
    418       1.1        pk 	vme_intr_handle_t	ih;
    419      1.12  drochner 	vme_am_t		mod;
    420       1.1        pk 	struct xyc_attach_args	xa;
    421      1.19        pk 	int			lcv, res, error;
    422       1.2        pk 	bus_dma_segment_t	seg;
    423       1.2        pk 	int			rseg;
    424      1.12  drochner 	vme_mapresc_t resc;
    425      1.52       mrg 	bus_addr_t		busaddr;
    426       1.1        pk 
    427       1.1        pk 	/* get addressing and intr level stuff from autoconfig and load it
    428       1.1        pk 	 * into our xyc_softc. */
    429       1.1        pk 
    430      1.28        pk 	mod = VME_AM_A16 | VME_AM_MBO | VME_AM_SUPER | VME_AM_DATA;
    431       1.1        pk 
    432      1.28        pk 	if (vme_space_alloc(ct, va->r[0].offset, sizeof(struct xyc), mod))
    433      1.12  drochner 		panic("xyc: vme alloc");
    434      1.28        pk 
    435      1.12  drochner 	if (vme_space_map(ct, va->r[0].offset, sizeof(struct xyc),
    436      1.28        pk 			  mod, VME_D16, 0, &bt, &bh, &resc) != 0)
    437       1.1        pk 		panic("xyc: vme_map");
    438       1.1        pk 
    439      1.12  drochner 	xyc->xyc = (struct xyc *) bh; /* XXX */
    440      1.12  drochner 	xyc->ipl = va->ilevel;
    441      1.12  drochner 	xyc->vector = va->ivector;
    442       1.1        pk 	xyc->no_ols = 0; /* XXX should be from config */
    443       1.1        pk 
    444       1.1        pk 	for (lcv = 0; lcv < XYC_MAXDEV; lcv++)
    445       1.1        pk 		xyc->sc_drives[lcv] = (struct xy_softc *) 0;
    446       1.1        pk 
    447       1.1        pk 	/*
    448       1.1        pk 	 * allocate and zero buffers
    449       1.1        pk 	 * check boundaries of the KVA's ... all IOPBs must reside in
    450       1.1        pk  	 * the same 64K region.
    451       1.1        pk 	 */
    452       1.1        pk 
    453      1.19        pk 	/* Get DMA handle for misc. transfers */
    454      1.28        pk 	if ((error = vme_dmamap_create(
    455      1.28        pk 				ct,		/* VME chip tag */
    456      1.28        pk 				MAXPHYS,	/* size */
    457      1.28        pk 				VME_AM_A24,	/* address modifier */
    458      1.28        pk 				VME_D16,	/* data size */
    459      1.28        pk 				0,		/* swap */
    460      1.19        pk 				1,		/* nsegments */
    461      1.28        pk 				MAXPHYS,	/* maxsegsz */
    462      1.19        pk 				0,		/* boundary */
    463      1.19        pk 				BUS_DMA_NOWAIT,
    464      1.55        pk 				&xyc->auxmap)) != 0) {
    465      1.28        pk 
    466      1.19        pk 		printf("%s: DMA buffer map create error %d\n",
    467      1.19        pk 			xyc->sc_dev.dv_xname, error);
    468      1.19        pk 		return;
    469      1.19        pk 	}
    470       1.2        pk 
    471      1.19        pk 	/* Get DMA handle for mapping iorq descriptors */
    472      1.28        pk 	if ((error = vme_dmamap_create(
    473      1.28        pk 				ct,		/* VME chip tag */
    474      1.19        pk 				XYC_MAXIOPB * sizeof(struct xy_iopb),
    475      1.28        pk 				VME_AM_A24,	/* address modifier */
    476      1.28        pk 				VME_D16,	/* data size */
    477      1.28        pk 				0,		/* swap */
    478      1.19        pk 				1,		/* nsegments */
    479      1.19        pk 				XYC_MAXIOPB * sizeof(struct xy_iopb),
    480      1.19        pk 				64*1024,	/* boundary */
    481      1.19        pk 				BUS_DMA_NOWAIT,
    482      1.19        pk 				&xyc->iopmap)) != 0) {
    483      1.28        pk 
    484      1.19        pk 		printf("%s: DMA buffer map create error %d\n",
    485       1.2        pk 			xyc->sc_dev.dv_xname, error);
    486       1.2        pk 		return;
    487       1.2        pk 	}
    488       1.2        pk 
    489      1.19        pk 	/* Get DMA buffer for iorq descriptors */
    490      1.19        pk 	if ((error = xy_dmamem_alloc(xyc->dmatag, xyc->iopmap, &seg, &rseg,
    491      1.19        pk 				     XYC_MAXIOPB * sizeof(struct xy_iopb),
    492      1.69  christos 				     (void **)&xyc->iopbase,
    493      1.52       mrg 				     &busaddr)) != 0) {
    494      1.19        pk 		printf("%s: DMA buffer alloc error %d\n",
    495       1.2        pk 			xyc->sc_dev.dv_xname, error);
    496       1.2        pk 		return;
    497       1.1        pk 	}
    498      1.53       mrg 	xyc->dvmaiopb = (struct xy_iopb *)(u_long)BUS_ADDR_PADDR(busaddr);
    499      1.19        pk 
    500      1.19        pk 	bzero(xyc->iopbase, XYC_MAXIOPB * sizeof(struct xy_iopb));
    501       1.2        pk 
    502       1.1        pk 	xyc->reqs = (struct xy_iorq *)
    503      1.39   tsutsui 	    malloc(XYC_MAXIOPB * sizeof(struct xy_iorq),
    504      1.39   tsutsui 	    M_DEVBUF, M_NOWAIT|M_ZERO);
    505       1.1        pk 	if (xyc->reqs == NULL)
    506       1.1        pk 		panic("xyc malloc");
    507       1.1        pk 
    508       1.1        pk 	/*
    509       1.1        pk 	 * init iorq to iopb pointers, and non-zero fields in the
    510       1.1        pk 	 * iopb which never change.
    511       1.1        pk 	 */
    512       1.1        pk 
    513       1.1        pk 	for (lcv = 0; lcv < XYC_MAXIOPB; lcv++) {
    514       1.1        pk 		xyc->xy_chain[lcv] = NULL;
    515       1.1        pk 		xyc->reqs[lcv].iopb = &xyc->iopbase[lcv];
    516      1.10        pk 		xyc->reqs[lcv].dmaiopb = &xyc->dvmaiopb[lcv];
    517       1.1        pk 		xyc->iopbase[lcv].asr = 1;	/* always the same */
    518       1.1        pk 		xyc->iopbase[lcv].eef = 1;	/* always the same */
    519       1.1        pk 		xyc->iopbase[lcv].ecm = XY_ECM;	/* always the same */
    520       1.1        pk 		xyc->iopbase[lcv].aud = 1;	/* always the same */
    521       1.1        pk 		xyc->iopbase[lcv].relo = 1;	/* always the same */
    522       1.1        pk 		xyc->iopbase[lcv].thro = XY_THRO;/* always the same */
    523       1.2        pk 
    524      1.28        pk 		if ((error = vme_dmamap_create(
    525      1.28        pk 				ct,		/* VME chip tag */
    526       1.2        pk 				MAXPHYS,	/* size */
    527      1.28        pk 				VME_AM_A24,	/* address modifier */
    528      1.28        pk 				VME_D16,	/* data size */
    529      1.28        pk 				0,		/* swap */
    530       1.2        pk 				1,		/* nsegments */
    531       1.2        pk 				MAXPHYS,	/* maxsegsz */
    532       1.2        pk 				0,		/* boundary */
    533       1.2        pk 				BUS_DMA_NOWAIT,
    534      1.28        pk 				&xyc->reqs[lcv].dmamap)) != 0) {
    535      1.28        pk 
    536       1.2        pk 			printf("%s: DMA buffer map create error %d\n",
    537       1.2        pk 				xyc->sc_dev.dv_xname, error);
    538       1.2        pk 			return;
    539       1.2        pk 		}
    540       1.1        pk 	}
    541       1.1        pk 	xyc->ciorq = &xyc->reqs[XYC_CTLIOPB];    /* short hand name */
    542       1.1        pk 	xyc->ciopb = &xyc->iopbase[XYC_CTLIOPB]; /* short hand name */
    543       1.1        pk 	xyc->xy_hand = 0;
    544       1.1        pk 
    545       1.1        pk 	/* read controller parameters and insure we have a 450/451 */
    546       1.1        pk 
    547       1.2        pk 	error = xyc_cmd(xyc, XYCMD_ST, 0, 0, 0, 0, 0, XY_SUB_POLL);
    548       1.1        pk 	res = xyc->ciopb->ctyp;
    549       1.2        pk 	XYC_DONE(xyc, error);
    550       1.1        pk 	if (res != XYCT_450) {
    551       1.2        pk 		if (error)
    552       1.2        pk 			printf(": %s: ", xyc_e2str(error));
    553       1.1        pk 		printf(": doesn't identify as a 450/451\n");
    554       1.1        pk 		return;
    555       1.1        pk 	}
    556       1.1        pk 	printf(": Xylogics 450/451");
    557       1.1        pk 	if (xyc->no_ols)
    558       1.1        pk 		printf(" [OLS disabled]"); /* 450 doesn't overlap seek right */
    559       1.1        pk 	printf("\n");
    560       1.2        pk 	if (error) {
    561       1.1        pk 		printf("%s: error: %s\n", xyc->sc_dev.dv_xname,
    562       1.2        pk 				xyc_e2str(error));
    563       1.1        pk 		return;
    564       1.1        pk 	}
    565       1.1        pk 	if ((xyc->xyc->xyc_csr & XYC_ADRM) == 0) {
    566       1.1        pk 		printf("%s: 24 bit addressing turned off\n",
    567       1.1        pk 			xyc->sc_dev.dv_xname);
    568       1.1        pk 		printf("please set hardware jumpers JM1-JM2=in, JM3-JM4=out\n");
    569       1.1        pk 		printf("to enable 24 bit mode and this driver\n");
    570       1.1        pk 		return;
    571       1.1        pk 	}
    572       1.1        pk 
    573       1.1        pk 	/* link in interrupt with higher level software */
    574      1.30       scw 	vme_intr_map(ct, va->ilevel, va->ivector, &ih);
    575      1.12  drochner 	vme_intr_establish(ct, ih, IPL_BIO, xycintr, xyc);
    576      1.24       cgd 	evcnt_attach_dynamic(&xyc->sc_intrcnt, EVCNT_TYPE_INTR, NULL,
    577      1.24       cgd 	    xyc->sc_dev.dv_xname, "intr");
    578       1.1        pk 
    579      1.71        ad 	callout_init(&xyc->sc_tick_ch, 0);
    580       1.1        pk 
    581       1.1        pk 	/* now we must look for disks using autoconfig */
    582       1.1        pk 	xa.fullmode = XY_SUB_POLL;
    583       1.1        pk 	xa.booting = 1;
    584       1.1        pk 
    585       1.1        pk 	for (xa.driveno = 0; xa.driveno < XYC_MAXDEV; xa.driveno++)
    586       1.1        pk 		(void) config_found(self, (void *) &xa, NULL);
    587       1.1        pk 
    588       1.1        pk 	/* start the watchdog clock */
    589      1.17   thorpej 	callout_reset(&xyc->sc_tick_ch, XYC_TICKCNT, xyc_tick, xyc);
    590       1.1        pk 
    591       1.1        pk }
    592       1.1        pk 
    593       1.1        pk /*
    594       1.1        pk  * xymatch: probe for disk.
    595       1.1        pk  *
    596       1.1        pk  * note: we almost always say disk is present.   this allows us to
    597       1.1        pk  * spin up and configure a disk after the system is booted (we can
    598       1.1        pk  * call xyattach!).
    599       1.1        pk  */
    600       1.1        pk int
    601       1.1        pk xymatch(parent, cf, aux)
    602       1.1        pk 	struct device *parent;
    603       1.1        pk 	struct cfdata *cf;
    604       1.1        pk 	void *aux;
    605       1.1        pk {
    606       1.1        pk 	struct xyc_attach_args *xa = aux;
    607       1.1        pk 
    608       1.1        pk 	/* looking for autoconf wildcard or exact match */
    609       1.1        pk 
    610       1.1        pk 	if (cf->cf_loc[XYCCF_DRIVE] != XYCCF_DRIVE_DEFAULT &&
    611       1.1        pk 	    cf->cf_loc[XYCCF_DRIVE] != xa->driveno)
    612       1.1        pk 		return 0;
    613       1.1        pk 
    614       1.1        pk 	return 1;
    615       1.1        pk 
    616       1.1        pk }
    617       1.1        pk 
    618       1.1        pk /*
    619       1.1        pk  * xyattach: attach a disk.   this can be called from autoconf and also
    620       1.1        pk  * from xyopen/xystrategy.
    621       1.1        pk  */
    622       1.1        pk void
    623       1.1        pk xyattach(parent, self, aux)
    624       1.1        pk 	struct device *parent, *self;
    625       1.1        pk 	void   *aux;
    626       1.1        pk 
    627       1.1        pk {
    628       1.1        pk 	struct xy_softc *xy = (void *) self, *oxy;
    629       1.1        pk 	struct xyc_softc *xyc = (void *) parent;
    630       1.1        pk 	struct xyc_attach_args *xa = aux;
    631       1.2        pk 	int     spt, mb, blk, lcv, fmode, s = 0, newstate;
    632       1.1        pk 	struct dkbad *dkb;
    633       1.2        pk 	int			rseg, error;
    634       1.2        pk 	bus_dma_segment_t	seg;
    635      1.52       mrg 	bus_addr_t		busaddr;
    636      1.69  christos 	void *			dmaddr;
    637      1.70       mrg 	char *			buf;
    638       1.1        pk 
    639       1.1        pk 	/*
    640       1.1        pk 	 * Always re-initialize the disk structure.  We want statistics
    641       1.1        pk 	 * to start with a clean slate.
    642       1.1        pk 	 */
    643       1.1        pk 	bzero(&xy->sc_dk, sizeof(xy->sc_dk));
    644       1.1        pk 
    645       1.1        pk 	/* if booting, init the xy_softc */
    646       1.1        pk 
    647       1.1        pk 	if (xa->booting) {
    648       1.1        pk 		xy->state = XY_DRIVE_UNKNOWN;	/* to start */
    649       1.1        pk 		xy->flags = 0;
    650       1.1        pk 		xy->parent = xyc;
    651       1.1        pk 
    652       1.1        pk 		/* init queue of waiting bufs */
    653       1.1        pk 
    654      1.60      yamt 		bufq_alloc(&xy->xyq, "disksort", BUFQ_SORT_RAWBLOCK);
    655       1.1        pk 
    656       1.1        pk 		xy->xyrq = &xyc->reqs[xa->driveno];
    657       1.1        pk 
    658       1.1        pk 	}
    659       1.1        pk 	xy->xy_drive = xa->driveno;
    660       1.1        pk 	fmode = xa->fullmode;
    661       1.1        pk 	xyc->sc_drives[xa->driveno] = xy;
    662       1.1        pk 
    663       1.1        pk 	/* if not booting, make sure we are the only process in the attach for
    664       1.1        pk 	 * this drive.   if locked out, sleep on it. */
    665       1.1        pk 
    666       1.1        pk 	if (!xa->booting) {
    667       1.1        pk 		s = splbio();
    668       1.1        pk 		while (xy->state == XY_DRIVE_ATTACHING) {
    669       1.1        pk 			if (tsleep(&xy->state, PRIBIO, "xyattach", 0)) {
    670       1.1        pk 				splx(s);
    671       1.1        pk 				return;
    672       1.1        pk 			}
    673       1.1        pk 		}
    674       1.1        pk 		printf("%s at %s",
    675       1.1        pk 			xy->sc_dev.dv_xname, xy->parent->sc_dev.dv_xname);
    676       1.1        pk 	}
    677       1.2        pk 
    678       1.1        pk 	/* we now have control */
    679       1.1        pk 	xy->state = XY_DRIVE_ATTACHING;
    680       1.1        pk 	newstate = XY_DRIVE_UNKNOWN;
    681       1.1        pk 
    682       1.2        pk 	buf = NULL;
    683      1.19        pk 	if ((error = xy_dmamem_alloc(xyc->dmatag, xyc->auxmap, &seg, &rseg,
    684      1.19        pk 				     XYFM_BPS,
    685      1.69  christos 				     (void **)&buf,
    686      1.52       mrg 				     &busaddr)) != 0) {
    687       1.2        pk 		printf("%s: DMA buffer alloc error %d\n",
    688      1.19        pk 			xyc->sc_dev.dv_xname, error);
    689      1.19        pk 		return;
    690       1.2        pk 	}
    691      1.69  christos 	dmaddr = (void *)(u_long)BUS_ADDR_PADDR(busaddr);
    692       1.2        pk 
    693       1.1        pk 	/* first try and reset the drive */
    694       1.2        pk 	error = xyc_cmd(xyc, XYCMD_RST, 0, xy->xy_drive, 0, 0, 0, fmode);
    695       1.2        pk 	XYC_DONE(xyc, error);
    696       1.2        pk 	if (error == XY_ERR_DNRY) {
    697       1.1        pk 		printf(" drive %d: off-line\n", xa->driveno);
    698       1.1        pk 		goto done;
    699       1.1        pk 	}
    700       1.2        pk 	if (error) {
    701       1.2        pk 		printf(": ERROR 0x%02x (%s)\n", error, xyc_e2str(error));
    702       1.1        pk 		goto done;
    703       1.1        pk 	}
    704       1.1        pk 	printf(" drive %d: ready", xa->driveno);
    705       1.1        pk 
    706       1.1        pk 	/*
    707       1.1        pk 	 * now set drive parameters (to semi-bogus values) so we can read the
    708       1.1        pk 	 * disk label.
    709       1.1        pk 	 */
    710       1.1        pk 	xy->pcyl = xy->ncyl = 1;
    711       1.1        pk 	xy->acyl = 0;
    712       1.1        pk 	xy->nhead = 1;
    713       1.1        pk 	xy->nsect = 1;
    714       1.1        pk 	xy->sectpercyl = 1;
    715       1.1        pk 	for (lcv = 0; lcv < 126; lcv++)	/* init empty bad144 table */
    716       1.1        pk 		xy->dkb.bt_bad[lcv].bt_cyl =
    717       1.1        pk 			xy->dkb.bt_bad[lcv].bt_trksec = 0xffff;
    718       1.1        pk 
    719       1.1        pk 	/* read disk label */
    720       1.1        pk 	for (xy->drive_type = 0 ; xy->drive_type <= XYC_MAXDT ;
    721       1.1        pk 						xy->drive_type++) {
    722       1.2        pk 		error = xyc_cmd(xyc, XYCMD_RD, 0, xy->xy_drive, 0, 1,
    723       1.2        pk 						dmaddr, fmode);
    724       1.2        pk 		XYC_DONE(xyc, error);
    725       1.2        pk 		if (error == XY_ERR_AOK) break;
    726       1.1        pk 	}
    727       1.1        pk 
    728       1.2        pk 	if (error != XY_ERR_AOK) {
    729       1.1        pk 		printf("\n%s: reading disk label failed: %s\n",
    730       1.2        pk 			xy->sc_dev.dv_xname, xyc_e2str(error));
    731       1.1        pk 		goto done;
    732       1.1        pk 	}
    733       1.1        pk 	printf(" (drive type %d)\n", xy->drive_type);
    734       1.1        pk 
    735       1.1        pk 	newstate = XY_DRIVE_NOLABEL;
    736       1.1        pk 
    737       1.1        pk 	xy->hw_spt = spt = 0; /* XXX needed ? */
    738       1.1        pk 	/* Attach the disk: must be before getdisklabel to malloc label */
    739      1.73        ad 	disk_init(&xy->sc_dk, xy->sc_dev.dv_xname, &xydkdriver);
    740       1.1        pk 	disk_attach(&xy->sc_dk);
    741       1.1        pk 
    742       1.2        pk 	if (xygetdisklabel(xy, buf) != XY_ERR_AOK)
    743       1.1        pk 		goto done;
    744       1.1        pk 
    745       1.1        pk 	/* inform the user of what is up */
    746       1.1        pk 	printf("%s: <%s>, pcyl %d\n", xy->sc_dev.dv_xname,
    747       1.2        pk 		buf, xy->pcyl);
    748       1.1        pk 	mb = xy->ncyl * (xy->nhead * xy->nsect) / (1048576 / XYFM_BPS);
    749       1.1        pk 	printf("%s: %dMB, %d cyl, %d head, %d sec, %d bytes/sec\n",
    750       1.1        pk 		xy->sc_dev.dv_xname, mb, xy->ncyl, xy->nhead, xy->nsect,
    751       1.1        pk 		XYFM_BPS);
    752       1.1        pk 
    753       1.1        pk 	/*
    754       1.1        pk 	 * 450/451 stupidity: the drive type is encoded into the format
    755       1.1        pk 	 * of the disk.   the drive type in the IOPB must match the drive
    756       1.1        pk 	 * type in the format, or you will not be able to do I/O to the
    757       1.1        pk 	 * disk (you get header not found errors).  if you have two drives
    758       1.1        pk 	 * of different sizes that have the same drive type in their
    759       1.1        pk 	 * formatting then you are out of luck.
    760       1.1        pk 	 *
    761       1.1        pk 	 * this problem was corrected in the 753/7053.
    762       1.1        pk 	 */
    763       1.1        pk 
    764       1.1        pk 	for (lcv = 0 ; lcv < XYC_MAXDEV ; lcv++) {
    765       1.1        pk 		oxy = xyc->sc_drives[lcv];
    766       1.1        pk 		if (oxy == NULL || oxy == xy) continue;
    767       1.1        pk 		if (oxy->drive_type != xy->drive_type) continue;
    768       1.1        pk 		if (xy->nsect != oxy->nsect || xy->pcyl != oxy->pcyl ||
    769       1.1        pk 			xy->nhead != oxy->nhead) {
    770       1.1        pk 			printf("%s: %s and %s must be the same size!\n",
    771       1.1        pk 				xyc->sc_dev.dv_xname, xy->sc_dev.dv_xname,
    772       1.1        pk 				oxy->sc_dev.dv_xname);
    773       1.1        pk 			panic("xy drive size mismatch");
    774       1.1        pk 		}
    775       1.1        pk 	}
    776       1.1        pk 
    777       1.1        pk 
    778       1.1        pk 	/* now set the real drive parameters! */
    779       1.1        pk 
    780       1.1        pk 	blk = (xy->nsect - 1) +
    781       1.1        pk 		((xy->nhead - 1) * xy->nsect) +
    782       1.1        pk 		((xy->pcyl - 1) * xy->nsect * xy->nhead);
    783       1.2        pk 	error = xyc_cmd(xyc, XYCMD_SDS, 0, xy->xy_drive, blk, 0, 0, fmode);
    784       1.2        pk 	XYC_DONE(xyc, error);
    785       1.2        pk 	if (error) {
    786       1.1        pk 		printf("%s: write drive size failed: %s\n",
    787       1.2        pk 			xy->sc_dev.dv_xname, xyc_e2str(error));
    788       1.1        pk 		goto done;
    789       1.1        pk 	}
    790       1.1        pk 	newstate = XY_DRIVE_ONLINE;
    791       1.1        pk 
    792       1.1        pk 	/*
    793       1.1        pk 	 * read bad144 table. this table resides on the first sector of the
    794       1.1        pk 	 * last track of the disk (i.e. second cyl of "acyl" area).
    795       1.1        pk 	 */
    796       1.1        pk 
    797       1.1        pk 	blk = (xy->ncyl + xy->acyl - 1) * (xy->nhead * xy->nsect) +
    798       1.1        pk 								/* last cyl */
    799       1.1        pk 	    (xy->nhead - 1) * xy->nsect;	/* last head */
    800       1.2        pk 	error = xyc_cmd(xyc, XYCMD_RD, 0, xy->xy_drive, blk, 1,
    801       1.2        pk 						dmaddr, fmode);
    802       1.2        pk 	XYC_DONE(xyc, error);
    803       1.2        pk 	if (error) {
    804       1.1        pk 		printf("%s: reading bad144 failed: %s\n",
    805       1.2        pk 			xy->sc_dev.dv_xname, xyc_e2str(error));
    806       1.1        pk 		goto done;
    807       1.1        pk 	}
    808       1.1        pk 
    809       1.1        pk 	/* check dkbad for sanity */
    810       1.2        pk 	dkb = (struct dkbad *) buf;
    811       1.1        pk 	for (lcv = 0; lcv < 126; lcv++) {
    812       1.1        pk 		if ((dkb->bt_bad[lcv].bt_cyl == 0xffff ||
    813       1.1        pk 				dkb->bt_bad[lcv].bt_cyl == 0) &&
    814       1.1        pk 		     dkb->bt_bad[lcv].bt_trksec == 0xffff)
    815       1.1        pk 			continue;	/* blank */
    816       1.1        pk 		if (dkb->bt_bad[lcv].bt_cyl >= xy->ncyl)
    817       1.1        pk 			break;
    818       1.1        pk 		if ((dkb->bt_bad[lcv].bt_trksec >> 8) >= xy->nhead)
    819       1.1        pk 			break;
    820       1.1        pk 		if ((dkb->bt_bad[lcv].bt_trksec & 0xff) >= xy->nsect)
    821       1.1        pk 			break;
    822       1.1        pk 	}
    823       1.1        pk 	if (lcv != 126) {
    824       1.1        pk 		printf("%s: warning: invalid bad144 sector!\n",
    825       1.1        pk 			xy->sc_dev.dv_xname);
    826       1.1        pk 	} else {
    827       1.2        pk 		bcopy(buf, &xy->dkb, XYFM_BPS);
    828       1.1        pk 	}
    829       1.1        pk 
    830       1.1        pk done:
    831       1.2        pk 	if (buf != NULL) {
    832      1.19        pk 		xy_dmamem_free(xyc->dmatag, xyc->auxmap,
    833      1.19        pk 				&seg, rseg, XYFM_BPS, buf);
    834       1.2        pk 	}
    835       1.2        pk 
    836       1.1        pk 	xy->state = newstate;
    837       1.1        pk 	if (!xa->booting) {
    838       1.1        pk 		wakeup(&xy->state);
    839       1.1        pk 		splx(s);
    840       1.1        pk 	}
    841       1.1        pk }
    842       1.1        pk 
    843       1.1        pk /*
    844       1.1        pk  * end of autoconfig functions
    845       1.1        pk  */
    846       1.1        pk 
    847       1.1        pk /*
    848       1.1        pk  * { b , c } d e v s w   f u n c t i o n s
    849       1.1        pk  */
    850       1.1        pk 
    851       1.1        pk /*
    852       1.1        pk  * xyclose: close device
    853       1.1        pk  */
    854       1.1        pk int
    855      1.61  christos xyclose(dev, flag, fmt, l)
    856       1.1        pk 	dev_t   dev;
    857       1.1        pk 	int     flag, fmt;
    858      1.61  christos 	struct lwp *l;
    859       1.1        pk 
    860       1.1        pk {
    861       1.1        pk 	struct xy_softc *xy = xy_cd.cd_devs[DISKUNIT(dev)];
    862       1.1        pk 	int     part = DISKPART(dev);
    863       1.1        pk 
    864       1.1        pk 	/* clear mask bits */
    865       1.1        pk 
    866       1.1        pk 	switch (fmt) {
    867       1.1        pk 	case S_IFCHR:
    868       1.1        pk 		xy->sc_dk.dk_copenmask &= ~(1 << part);
    869       1.1        pk 		break;
    870       1.1        pk 	case S_IFBLK:
    871       1.1        pk 		xy->sc_dk.dk_bopenmask &= ~(1 << part);
    872       1.1        pk 		break;
    873       1.1        pk 	}
    874       1.1        pk 	xy->sc_dk.dk_openmask = xy->sc_dk.dk_copenmask | xy->sc_dk.dk_bopenmask;
    875       1.1        pk 
    876       1.1        pk 	return 0;
    877       1.1        pk }
    878       1.1        pk 
    879       1.1        pk /*
    880       1.1        pk  * xydump: crash dump system
    881       1.1        pk  */
    882       1.1        pk int
    883       1.1        pk xydump(dev, blkno, va, size)
    884       1.1        pk 	dev_t dev;
    885       1.1        pk 	daddr_t blkno;
    886      1.69  christos 	void *va;
    887       1.1        pk 	size_t size;
    888       1.1        pk {
    889       1.1        pk 	int     unit, part;
    890       1.1        pk 	struct xy_softc *xy;
    891       1.1        pk 
    892       1.1        pk 	unit = DISKUNIT(dev);
    893       1.1        pk 	if (unit >= xy_cd.cd_ndevs)
    894       1.1        pk 		return ENXIO;
    895       1.1        pk 	part = DISKPART(dev);
    896       1.1        pk 
    897       1.1        pk 	xy = xy_cd.cd_devs[unit];
    898       1.1        pk 
    899       1.1        pk 	printf("%s%c: crash dump not supported (yet)\n", xy->sc_dev.dv_xname,
    900       1.1        pk 	    'a' + part);
    901       1.1        pk 
    902       1.1        pk 	return ENXIO;
    903       1.1        pk 
    904       1.1        pk 	/* outline: globals: "dumplo" == sector number of partition to start
    905       1.1        pk 	 * dump at (convert to physical sector with partition table)
    906       1.1        pk 	 * "dumpsize" == size of dump in clicks "physmem" == size of physical
    907       1.1        pk 	 * memory (clicks, ctob() to get bytes) (normal case: dumpsize ==
    908       1.1        pk 	 * physmem)
    909       1.1        pk 	 *
    910       1.1        pk 	 * dump a copy of physical memory to the dump device starting at sector
    911       1.1        pk 	 * "dumplo" in the swap partition (make sure > 0).   map in pages as
    912       1.1        pk 	 * we go.   use polled I/O.
    913       1.1        pk 	 *
    914       1.1        pk 	 * XXX how to handle NON_CONTIG? */
    915       1.1        pk 
    916       1.1        pk }
    917       1.1        pk 
    918  1.74.2.1       mjf static enum kauth_device_req
    919  1.74.2.1       mjf xy_getkauthreq(u_char cmd)
    920  1.74.2.1       mjf {
    921  1.74.2.1       mjf 	enum kauth_device_req req;
    922  1.74.2.1       mjf 
    923  1.74.2.1       mjf 	switch (cmd) {
    924  1.74.2.1       mjf 	case XYCMD_WR:
    925  1.74.2.1       mjf 	case XYCMD_WTH:
    926  1.74.2.1       mjf 	case XYCMD_WFM:
    927  1.74.2.1       mjf 	case XYCMD_WRH:
    928  1.74.2.1       mjf 		req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_WRITE;
    929  1.74.2.1       mjf 		break;
    930  1.74.2.1       mjf 
    931  1.74.2.1       mjf 	case XYCMD_RD:
    932  1.74.2.1       mjf 	case XYCMD_RTH:
    933  1.74.2.1       mjf 	case XYCMD_RDH:
    934  1.74.2.1       mjf 		req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_READ;
    935  1.74.2.1       mjf 		break;
    936  1.74.2.1       mjf 
    937  1.74.2.1       mjf 	case XYCMD_RDS:
    938  1.74.2.1       mjf 	case XYCMD_MBD:
    939  1.74.2.1       mjf 		req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_READCONF;
    940  1.74.2.1       mjf 		break;
    941  1.74.2.1       mjf 
    942  1.74.2.1       mjf 	case XYCMD_RST:
    943  1.74.2.1       mjf 	case XYCMD_SDS:
    944  1.74.2.1       mjf 	case XYCMD_MBL:
    945  1.74.2.1       mjf 		req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_WRITECONF;
    946  1.74.2.1       mjf 		break;
    947  1.74.2.1       mjf 
    948  1.74.2.1       mjf 	case XYCMD_NOP:
    949  1.74.2.1       mjf 	case XYCMD_SK:
    950  1.74.2.1       mjf 	case XYCMD_ST:
    951  1.74.2.1       mjf 	case XYCMD_R:
    952  1.74.2.1       mjf 	default:
    953  1.74.2.1       mjf 		req = 0;
    954  1.74.2.1       mjf 		break;
    955  1.74.2.1       mjf 	}
    956  1.74.2.1       mjf 
    957  1.74.2.1       mjf 	return (req);
    958  1.74.2.1       mjf }
    959  1.74.2.1       mjf 
    960       1.1        pk /*
    961       1.1        pk  * xyioctl: ioctls on XY drives.   based on ioctl's of other netbsd disks.
    962       1.1        pk  */
    963       1.1        pk int
    964      1.61  christos xyioctl(dev, command, addr, flag, l)
    965       1.1        pk 	dev_t   dev;
    966       1.1        pk 	u_long  command;
    967      1.69  christos 	void *addr;
    968       1.1        pk 	int     flag;
    969      1.61  christos 	struct lwp *l;
    970       1.1        pk 
    971       1.1        pk {
    972       1.1        pk 	struct xy_softc *xy;
    973       1.1        pk 	struct xd_iocmd *xio;
    974       1.1        pk 	int     error, s, unit;
    975      1.31      fvdl #ifdef __HAVE_OLD_DISKLABEL
    976      1.33      fvdl 	struct disklabel newlabel;
    977      1.31      fvdl #endif
    978      1.33      fvdl 	struct disklabel *lp;
    979      1.33      fvdl 
    980       1.1        pk 	unit = DISKUNIT(dev);
    981       1.1        pk 
    982       1.1        pk 	if (unit >= xy_cd.cd_ndevs || (xy = xy_cd.cd_devs[unit]) == NULL)
    983       1.1        pk 		return (ENXIO);
    984       1.1        pk 
    985       1.1        pk 	/* switch on ioctl type */
    986       1.1        pk 
    987       1.1        pk 	switch (command) {
    988       1.1        pk 	case DIOCSBAD:		/* set bad144 info */
    989       1.1        pk 		if ((flag & FWRITE) == 0)
    990       1.1        pk 			return EBADF;
    991       1.1        pk 		s = splbio();
    992       1.1        pk 		bcopy(addr, &xy->dkb, sizeof(xy->dkb));
    993       1.1        pk 		splx(s);
    994       1.1        pk 		return 0;
    995       1.1        pk 
    996       1.1        pk 	case DIOCGDINFO:	/* get disk label */
    997       1.1        pk 		bcopy(xy->sc_dk.dk_label, addr, sizeof(struct disklabel));
    998       1.1        pk 		return 0;
    999      1.31      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1000      1.31      fvdl 	case ODIOCGDINFO:
   1001      1.31      fvdl 		newlabel = *(xy->sc_dk.dk_label);
   1002      1.31      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
   1003      1.32      fvdl 			return ENOTTY;
   1004      1.31      fvdl 		memcpy(addr, &newlabel, sizeof (struct olddisklabel));
   1005      1.31      fvdl 		return 0;
   1006      1.31      fvdl #endif
   1007       1.1        pk 
   1008       1.1        pk 	case DIOCGPART:	/* get partition info */
   1009       1.1        pk 		((struct partinfo *) addr)->disklab = xy->sc_dk.dk_label;
   1010       1.1        pk 		((struct partinfo *) addr)->part =
   1011       1.1        pk 		    &xy->sc_dk.dk_label->d_partitions[DISKPART(dev)];
   1012       1.1        pk 		return 0;
   1013       1.1        pk 
   1014       1.1        pk 	case DIOCSDINFO:	/* set disk label */
   1015      1.31      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1016      1.31      fvdl 	case ODIOCSDINFO:
   1017      1.31      fvdl 		if (command == ODIOCSDINFO) {
   1018      1.31      fvdl 			memset(&newlabel, 0, sizeof newlabel);
   1019      1.31      fvdl 			memcpy(&newlabel, addr, sizeof (struct olddisklabel));
   1020      1.31      fvdl 			lp = &newlabel;
   1021      1.31      fvdl 		} else
   1022      1.31      fvdl #endif
   1023      1.31      fvdl 		lp = (struct disklabel *)addr;
   1024      1.31      fvdl 
   1025       1.1        pk 		if ((flag & FWRITE) == 0)
   1026       1.1        pk 			return EBADF;
   1027       1.1        pk 		error = setdisklabel(xy->sc_dk.dk_label,
   1028      1.31      fvdl 		    lp, /* xy->sc_dk.dk_openmask : */ 0,
   1029       1.1        pk 		    xy->sc_dk.dk_cpulabel);
   1030       1.1        pk 		if (error == 0) {
   1031       1.1        pk 			if (xy->state == XY_DRIVE_NOLABEL)
   1032       1.1        pk 				xy->state = XY_DRIVE_ONLINE;
   1033       1.1        pk 		}
   1034       1.1        pk 		return error;
   1035       1.1        pk 
   1036       1.1        pk 	case DIOCWLABEL:	/* change write status of disk label */
   1037       1.1        pk 		if ((flag & FWRITE) == 0)
   1038       1.1        pk 			return EBADF;
   1039       1.1        pk 		if (*(int *) addr)
   1040       1.1        pk 			xy->flags |= XY_WLABEL;
   1041       1.1        pk 		else
   1042       1.1        pk 			xy->flags &= ~XY_WLABEL;
   1043       1.1        pk 		return 0;
   1044       1.1        pk 
   1045       1.1        pk 	case DIOCWDINFO:	/* write disk label */
   1046      1.31      fvdl #ifdef __HAVE_OLD_DISKLABEL
   1047      1.31      fvdl 	case ODIOCWDINFO:
   1048      1.31      fvdl 		if (command == ODIOCWDINFO) {
   1049      1.31      fvdl 			memset(&newlabel, 0, sizeof newlabel);
   1050      1.31      fvdl 			memcpy(&newlabel, addr, sizeof (struct olddisklabel));
   1051      1.31      fvdl 			lp = &newlabel;
   1052      1.31      fvdl 		} else
   1053      1.31      fvdl #endif
   1054      1.31      fvdl 		lp = (struct disklabel *)addr;
   1055      1.31      fvdl 
   1056       1.1        pk 		if ((flag & FWRITE) == 0)
   1057       1.1        pk 			return EBADF;
   1058       1.1        pk 		error = setdisklabel(xy->sc_dk.dk_label,
   1059      1.31      fvdl 		    lp, /* xy->sc_dk.dk_openmask : */ 0,
   1060       1.1        pk 		    xy->sc_dk.dk_cpulabel);
   1061       1.1        pk 		if (error == 0) {
   1062       1.1        pk 			if (xy->state == XY_DRIVE_NOLABEL)
   1063       1.1        pk 				xy->state = XY_DRIVE_ONLINE;
   1064       1.1        pk 
   1065       1.1        pk 			/* Simulate opening partition 0 so write succeeds. */
   1066       1.1        pk 			xy->sc_dk.dk_openmask |= (1 << 0);
   1067       1.1        pk 			error = writedisklabel(MAKEDISKDEV(major(dev), DISKUNIT(dev), RAW_PART),
   1068       1.1        pk 			    xystrategy, xy->sc_dk.dk_label,
   1069       1.1        pk 			    xy->sc_dk.dk_cpulabel);
   1070       1.1        pk 			xy->sc_dk.dk_openmask =
   1071       1.1        pk 			    xy->sc_dk.dk_copenmask | xy->sc_dk.dk_bopenmask;
   1072       1.1        pk 		}
   1073       1.1        pk 		return error;
   1074       1.1        pk 
   1075  1.74.2.1       mjf 	case DIOSXDCMD: {
   1076  1.74.2.1       mjf 		enum kauth_device_req req;
   1077  1.74.2.1       mjf 
   1078       1.1        pk 		xio = (struct xd_iocmd *) addr;
   1079  1.74.2.1       mjf 		req = xy_getkauthreq(xio->cmd);
   1080  1.74.2.1       mjf 		if ((error = kauth_authorize_device_passthru(l->l_cred,
   1081  1.74.2.1       mjf 		    dev, req, xio)) != 0)
   1082       1.1        pk 			return (error);
   1083       1.1        pk 		return (xyc_ioctlcmd(xy, dev, xio));
   1084  1.74.2.1       mjf 		}
   1085       1.1        pk 
   1086       1.1        pk 	default:
   1087       1.1        pk 		return ENOTTY;
   1088       1.1        pk 	}
   1089       1.1        pk }
   1090       1.1        pk 
   1091       1.1        pk /*
   1092       1.1        pk  * xyopen: open drive
   1093       1.1        pk  */
   1094       1.1        pk 
   1095       1.1        pk int
   1096      1.61  christos xyopen(dev, flag, fmt, l)
   1097       1.1        pk 	dev_t   dev;
   1098       1.1        pk 	int     flag, fmt;
   1099      1.61  christos 	struct lwp *l;
   1100       1.1        pk {
   1101       1.1        pk 	int     unit, part;
   1102       1.1        pk 	struct xy_softc *xy;
   1103       1.1        pk 	struct xyc_attach_args xa;
   1104       1.1        pk 
   1105       1.1        pk 	/* first, could it be a valid target? */
   1106       1.1        pk 
   1107       1.1        pk 	unit = DISKUNIT(dev);
   1108       1.1        pk 	if (unit >= xy_cd.cd_ndevs || (xy = xy_cd.cd_devs[unit]) == NULL)
   1109       1.1        pk 		return (ENXIO);
   1110       1.1        pk 	part = DISKPART(dev);
   1111       1.1        pk 
   1112       1.1        pk 	/* do we need to attach the drive? */
   1113       1.1        pk 
   1114       1.1        pk 	if (xy->state == XY_DRIVE_UNKNOWN) {
   1115       1.1        pk 		xa.driveno = xy->xy_drive;
   1116       1.1        pk 		xa.fullmode = XY_SUB_WAIT;
   1117       1.1        pk 		xa.booting = 0;
   1118       1.1        pk 		xyattach((struct device *) xy->parent,
   1119       1.1        pk 						(struct device *) xy, &xa);
   1120       1.1        pk 		if (xy->state == XY_DRIVE_UNKNOWN) {
   1121       1.1        pk 			return (EIO);
   1122       1.1        pk 		}
   1123       1.1        pk 	}
   1124       1.1        pk 	/* check for partition */
   1125       1.1        pk 
   1126       1.1        pk 	if (part != RAW_PART &&
   1127       1.1        pk 	    (part >= xy->sc_dk.dk_label->d_npartitions ||
   1128       1.1        pk 		xy->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
   1129       1.1        pk 		return (ENXIO);
   1130       1.1        pk 	}
   1131       1.1        pk 	/* set open masks */
   1132       1.1        pk 
   1133       1.1        pk 	switch (fmt) {
   1134       1.1        pk 	case S_IFCHR:
   1135       1.1        pk 		xy->sc_dk.dk_copenmask |= (1 << part);
   1136       1.1        pk 		break;
   1137       1.1        pk 	case S_IFBLK:
   1138       1.1        pk 		xy->sc_dk.dk_bopenmask |= (1 << part);
   1139       1.1        pk 		break;
   1140       1.1        pk 	}
   1141       1.1        pk 	xy->sc_dk.dk_openmask = xy->sc_dk.dk_copenmask | xy->sc_dk.dk_bopenmask;
   1142       1.1        pk 
   1143       1.1        pk 	return 0;
   1144       1.1        pk }
   1145       1.1        pk 
   1146       1.1        pk int
   1147       1.1        pk xyread(dev, uio, flags)
   1148       1.1        pk 	dev_t   dev;
   1149       1.1        pk 	struct uio *uio;
   1150       1.1        pk 	int flags;
   1151       1.1        pk {
   1152       1.1        pk 
   1153       1.1        pk 	return (physio(xystrategy, NULL, dev, B_READ, minphys, uio));
   1154       1.1        pk }
   1155       1.1        pk 
   1156       1.1        pk int
   1157       1.1        pk xywrite(dev, uio, flags)
   1158       1.1        pk 	dev_t   dev;
   1159       1.1        pk 	struct uio *uio;
   1160       1.1        pk 	int flags;
   1161       1.1        pk {
   1162       1.1        pk 
   1163       1.1        pk 	return (physio(xystrategy, NULL, dev, B_WRITE, minphys, uio));
   1164       1.1        pk }
   1165       1.1        pk 
   1166       1.1        pk 
   1167       1.1        pk /*
   1168       1.1        pk  * xysize: return size of a partition for a dump
   1169       1.1        pk  */
   1170       1.1        pk 
   1171       1.1        pk int
   1172       1.1        pk xysize(dev)
   1173       1.1        pk 	dev_t   dev;
   1174       1.1        pk 
   1175       1.1        pk {
   1176       1.1        pk 	struct xy_softc *xysc;
   1177       1.1        pk 	int     unit, part, size, omask;
   1178       1.1        pk 
   1179       1.1        pk 	/* valid unit? */
   1180       1.1        pk 	unit = DISKUNIT(dev);
   1181       1.1        pk 	if (unit >= xy_cd.cd_ndevs || (xysc = xy_cd.cd_devs[unit]) == NULL)
   1182       1.1        pk 		return (-1);
   1183       1.1        pk 
   1184       1.1        pk 	part = DISKPART(dev);
   1185       1.1        pk 	omask = xysc->sc_dk.dk_openmask & (1 << part);
   1186       1.1        pk 
   1187       1.1        pk 	if (omask == 0 && xyopen(dev, 0, S_IFBLK, NULL) != 0)
   1188       1.1        pk 		return (-1);
   1189       1.1        pk 
   1190       1.1        pk 	/* do it */
   1191       1.1        pk 	if (xysc->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
   1192       1.1        pk 		size = -1;	/* only give valid size for swap partitions */
   1193       1.1        pk 	else
   1194       1.1        pk 		size = xysc->sc_dk.dk_label->d_partitions[part].p_size *
   1195       1.1        pk 		    (xysc->sc_dk.dk_label->d_secsize / DEV_BSIZE);
   1196       1.1        pk 	if (omask == 0 && xyclose(dev, 0, S_IFBLK, NULL) != 0)
   1197       1.1        pk 		return (-1);
   1198       1.1        pk 	return (size);
   1199       1.1        pk }
   1200       1.1        pk 
   1201       1.1        pk /*
   1202       1.1        pk  * xystrategy: buffering system interface to xy.
   1203       1.1        pk  */
   1204       1.1        pk 
   1205       1.1        pk void
   1206       1.1        pk xystrategy(bp)
   1207       1.1        pk 	struct buf *bp;
   1208       1.1        pk 
   1209       1.1        pk {
   1210       1.1        pk 	struct xy_softc *xy;
   1211       1.1        pk 	int     s, unit;
   1212       1.1        pk 	struct xyc_attach_args xa;
   1213      1.16   thorpej 	struct disklabel *lp;
   1214      1.16   thorpej 	daddr_t blkno;
   1215       1.1        pk 
   1216       1.1        pk 	unit = DISKUNIT(bp->b_dev);
   1217       1.1        pk 
   1218       1.1        pk 	/* check for live device */
   1219       1.1        pk 
   1220       1.1        pk 	if (unit >= xy_cd.cd_ndevs || (xy = xy_cd.cd_devs[unit]) == 0 ||
   1221       1.1        pk 	    bp->b_blkno < 0 ||
   1222       1.1        pk 	    (bp->b_bcount % xy->sc_dk.dk_label->d_secsize) != 0) {
   1223       1.1        pk 		bp->b_error = EINVAL;
   1224      1.72        ad 		goto done;
   1225       1.1        pk 	}
   1226       1.1        pk 	/* do we need to attach the drive? */
   1227       1.1        pk 
   1228       1.1        pk 	if (xy->state == XY_DRIVE_UNKNOWN) {
   1229       1.1        pk 		xa.driveno = xy->xy_drive;
   1230       1.1        pk 		xa.fullmode = XY_SUB_WAIT;
   1231       1.1        pk 		xa.booting = 0;
   1232       1.1        pk 		xyattach((struct device *)xy->parent, (struct device *)xy, &xa);
   1233       1.1        pk 		if (xy->state == XY_DRIVE_UNKNOWN) {
   1234       1.1        pk 			bp->b_error = EIO;
   1235      1.72        ad 			goto done;
   1236       1.1        pk 		}
   1237       1.1        pk 	}
   1238       1.1        pk 	if (xy->state != XY_DRIVE_ONLINE && DISKPART(bp->b_dev) != RAW_PART) {
   1239       1.1        pk 		/* no I/O to unlabeled disks, unless raw partition */
   1240       1.1        pk 		bp->b_error = EIO;
   1241      1.72        ad 		goto done;
   1242       1.1        pk 	}
   1243       1.1        pk 	/* short circuit zero length request */
   1244       1.1        pk 
   1245       1.1        pk 	if (bp->b_bcount == 0)
   1246       1.1        pk 		goto done;
   1247       1.1        pk 
   1248       1.1        pk 	/* check bounds with label (disksubr.c).  Determine the size of the
   1249       1.1        pk 	 * transfer, and make sure it is within the boundaries of the
   1250       1.1        pk 	 * partition. Adjust transfer if needed, and signal errors or early
   1251       1.1        pk 	 * completion. */
   1252       1.1        pk 
   1253      1.16   thorpej 	lp = xy->sc_dk.dk_label;
   1254      1.16   thorpej 
   1255      1.49   thorpej 	if (bounds_check_with_label(&xy->sc_dk, bp,
   1256       1.1        pk 		(xy->flags & XY_WLABEL) != 0) <= 0)
   1257       1.1        pk 		goto done;
   1258       1.1        pk 
   1259       1.1        pk 	/*
   1260      1.16   thorpej 	 * Now convert the block number to absolute and put it in
   1261      1.16   thorpej 	 * terms of the device's logical block size.
   1262      1.16   thorpej 	 */
   1263      1.16   thorpej 	blkno = bp->b_blkno / (lp->d_secsize / DEV_BSIZE);
   1264      1.16   thorpej 	if (DISKPART(bp->b_dev) != RAW_PART)
   1265      1.16   thorpej 		blkno += lp->d_partitions[DISKPART(bp->b_dev)].p_offset;
   1266      1.16   thorpej 
   1267      1.16   thorpej 	bp->b_rawblkno = blkno;
   1268      1.16   thorpej 
   1269      1.16   thorpej 	/*
   1270       1.1        pk 	 * now we know we have a valid buf structure that we need to do I/O
   1271       1.1        pk 	 * on.
   1272       1.1        pk 	 */
   1273       1.1        pk 	s = splbio();		/* protect the queues */
   1274       1.1        pk 
   1275      1.60      yamt 	BUFQ_PUT(xy->xyq, bp);
   1276       1.1        pk 
   1277       1.1        pk 	/* start 'em up */
   1278       1.1        pk 
   1279       1.1        pk 	xyc_start(xy->parent, NULL);
   1280       1.1        pk 
   1281       1.1        pk 	/* done! */
   1282       1.1        pk 
   1283       1.1        pk 	splx(s);
   1284       1.1        pk 	return;
   1285       1.1        pk 
   1286       1.1        pk done:				/* tells upper layers we are done with this
   1287       1.1        pk 				 * buf */
   1288       1.1        pk 	bp->b_resid = bp->b_bcount;
   1289       1.1        pk 	biodone(bp);
   1290       1.1        pk }
   1291       1.1        pk /*
   1292       1.1        pk  * end of {b,c}devsw functions
   1293       1.1        pk  */
   1294       1.1        pk 
   1295       1.1        pk /*
   1296       1.1        pk  * i n t e r r u p t   f u n c t i o n
   1297       1.1        pk  *
   1298       1.1        pk  * xycintr: hardware interrupt.
   1299       1.1        pk  */
   1300       1.1        pk int
   1301       1.1        pk xycintr(v)
   1302       1.1        pk 	void   *v;
   1303       1.1        pk 
   1304       1.1        pk {
   1305       1.1        pk 	struct xyc_softc *xycsc = v;
   1306       1.1        pk 
   1307       1.1        pk 	/* kick the event counter */
   1308       1.1        pk 
   1309       1.1        pk 	xycsc->sc_intrcnt.ev_count++;
   1310       1.1        pk 
   1311       1.1        pk 	/* remove as many done IOPBs as possible */
   1312       1.1        pk 
   1313       1.1        pk 	xyc_remove_iorq(xycsc);
   1314       1.1        pk 
   1315       1.1        pk 	/* start any iorq's already waiting */
   1316       1.1        pk 
   1317       1.1        pk 	xyc_start(xycsc, NULL);
   1318       1.1        pk 
   1319       1.1        pk 	return (1);
   1320       1.1        pk }
   1321       1.1        pk /*
   1322       1.1        pk  * end of interrupt function
   1323       1.1        pk  */
   1324       1.1        pk 
   1325       1.1        pk /*
   1326       1.1        pk  * i n t e r n a l   f u n c t i o n s
   1327       1.1        pk  */
   1328       1.1        pk 
   1329       1.1        pk /*
   1330       1.1        pk  * xyc_rqinit: fill out the fields of an I/O request
   1331       1.1        pk  */
   1332       1.1        pk 
   1333       1.1        pk inline void
   1334       1.1        pk xyc_rqinit(rq, xyc, xy, md, blk, cnt, db, bp)
   1335       1.1        pk 	struct xy_iorq *rq;
   1336       1.1        pk 	struct xyc_softc *xyc;
   1337       1.1        pk 	struct xy_softc *xy;
   1338       1.1        pk 	int     md;
   1339       1.1        pk 	u_long  blk;
   1340       1.1        pk 	int     cnt;
   1341      1.69  christos 	void *db;
   1342       1.1        pk 	struct buf *bp;
   1343       1.1        pk {
   1344       1.1        pk 	rq->xyc = xyc;
   1345       1.1        pk 	rq->xy = xy;
   1346       1.1        pk 	rq->ttl = XYC_MAXTTL + 10;
   1347       1.1        pk 	rq->mode = md;
   1348      1.67  christos 	rq->tries = rq->errnum = rq->lasterror = 0;
   1349       1.1        pk 	rq->blockno = blk;
   1350       1.1        pk 	rq->sectcnt = cnt;
   1351       1.2        pk 	rq->dbuf = db;
   1352       1.1        pk 	rq->buf = bp;
   1353       1.1        pk }
   1354       1.1        pk 
   1355       1.1        pk /*
   1356       1.1        pk  * xyc_rqtopb: load up an IOPB based on an iorq
   1357       1.1        pk  */
   1358       1.1        pk 
   1359       1.1        pk void
   1360       1.1        pk xyc_rqtopb(iorq, iopb, cmd, subfun)
   1361       1.1        pk 	struct xy_iorq *iorq;
   1362       1.1        pk 	struct xy_iopb *iopb;
   1363       1.1        pk 	int     cmd, subfun;
   1364       1.1        pk 
   1365       1.1        pk {
   1366       1.1        pk 	u_long  block, dp;
   1367       1.1        pk 
   1368       1.1        pk 	/* normal IOPB case, standard stuff */
   1369       1.1        pk 
   1370       1.1        pk 	/* chain bit handled later */
   1371       1.1        pk 	iopb->ien = (XY_STATE(iorq->mode) == XY_SUB_POLL) ? 0 : 1;
   1372       1.1        pk 	iopb->com = cmd;
   1373      1.67  christos 	iopb->errnum = 0;
   1374       1.1        pk 	iopb->errs = 0;
   1375       1.1        pk 	iopb->done = 0;
   1376       1.1        pk 	if (iorq->xy) {
   1377       1.1        pk 		iopb->unit = iorq->xy->xy_drive;
   1378       1.1        pk 		iopb->dt = iorq->xy->drive_type;
   1379       1.1        pk 	} else {
   1380       1.1        pk 		iopb->unit = 0;
   1381       1.1        pk 		iopb->dt = 0;
   1382       1.1        pk 	}
   1383       1.1        pk 	block = iorq->blockno;
   1384       1.1        pk 	if (iorq->xy == NULL || block == 0) {
   1385       1.1        pk 		iopb->sect = iopb->head = iopb->cyl = 0;
   1386       1.1        pk 	} else {
   1387       1.1        pk 		iopb->sect = block % iorq->xy->nsect;
   1388       1.1        pk 		block = block / iorq->xy->nsect;
   1389       1.1        pk 		iopb->head = block % iorq->xy->nhead;
   1390       1.1        pk 		block = block / iorq->xy->nhead;
   1391       1.1        pk 		iopb->cyl = block;
   1392       1.1        pk 	}
   1393       1.1        pk 	iopb->scnt = iorq->sectcnt;
   1394       1.2        pk 	dp = (u_long) iorq->dbuf;
   1395       1.1        pk 	if (iorq->dbuf == NULL) {
   1396       1.1        pk 		iopb->dataa = 0;
   1397       1.1        pk 		iopb->datar = 0;
   1398       1.1        pk 	} else {
   1399       1.1        pk 		iopb->dataa = (dp & 0xffff);
   1400       1.1        pk 		iopb->datar = ((dp & 0xff0000) >> 16);
   1401       1.1        pk 	}
   1402       1.1        pk 	iopb->subfn = subfun;
   1403       1.1        pk }
   1404       1.1        pk 
   1405       1.1        pk 
   1406       1.1        pk /*
   1407       1.1        pk  * xyc_unbusy: wait for the xyc to go unbusy, or timeout.
   1408       1.1        pk  */
   1409       1.1        pk 
   1410       1.1        pk int
   1411       1.1        pk xyc_unbusy(xyc, del)
   1412       1.1        pk 
   1413       1.1        pk struct xyc *xyc;
   1414       1.1        pk int del;
   1415       1.1        pk 
   1416       1.1        pk {
   1417       1.1        pk 	while (del-- > 0) {
   1418       1.1        pk 		if ((xyc->xyc_csr & XYC_GBSY) == 0)
   1419       1.1        pk 			break;
   1420       1.1        pk 		DELAY(1);
   1421       1.1        pk 	}
   1422       1.1        pk 	return(del == 0 ? XY_ERR_FAIL : XY_ERR_AOK);
   1423       1.1        pk }
   1424       1.1        pk 
   1425       1.1        pk /*
   1426       1.1        pk  * xyc_cmd: front end for POLL'd and WAIT'd commands.  Returns 0 or error.
   1427      1.36       wiz  * note that NORM requests are handled separately.
   1428       1.1        pk  */
   1429       1.1        pk int
   1430       1.1        pk xyc_cmd(xycsc, cmd, subfn, unit, block, scnt, dptr, fullmode)
   1431       1.1        pk 	struct xyc_softc *xycsc;
   1432       1.1        pk 	int     cmd, subfn, unit, block, scnt;
   1433       1.1        pk 	char   *dptr;
   1434       1.1        pk 	int     fullmode;
   1435       1.1        pk 
   1436       1.1        pk {
   1437       1.1        pk 	int     submode = XY_STATE(fullmode);
   1438       1.1        pk 	struct xy_iorq *iorq = xycsc->ciorq;
   1439       1.1        pk 	struct xy_iopb *iopb = xycsc->ciopb;
   1440       1.1        pk 
   1441       1.1        pk 	/*
   1442       1.1        pk 	 * is someone else using the control iopq wait for it if we can
   1443       1.1        pk 	 */
   1444       1.1        pk start:
   1445       1.1        pk 	if (submode == XY_SUB_WAIT && XY_STATE(iorq->mode) != XY_SUB_FREE) {
   1446       1.1        pk 		if (tsleep(iorq, PRIBIO, "xyc_cmd", 0))
   1447       1.1        pk                                 return(XY_ERR_FAIL);
   1448       1.1        pk 		goto start;
   1449       1.1        pk 	}
   1450       1.1        pk 
   1451       1.1        pk 	if (XY_STATE(iorq->mode) != XY_SUB_FREE) {
   1452       1.1        pk 		DELAY(1000000);		/* XY_SUB_POLL: steal the iorq */
   1453       1.1        pk 		iorq->mode = XY_SUB_FREE;
   1454       1.1        pk 		printf("%s: stole control iopb\n", xycsc->sc_dev.dv_xname);
   1455       1.1        pk 	}
   1456       1.1        pk 
   1457       1.1        pk 	/* init iorq/iopb */
   1458       1.1        pk 
   1459       1.1        pk 	xyc_rqinit(iorq, xycsc,
   1460       1.1        pk 	    (unit == XYC_NOUNIT) ? NULL : xycsc->sc_drives[unit],
   1461       1.1        pk 	    fullmode, block, scnt, dptr, NULL);
   1462       1.1        pk 
   1463       1.1        pk 	/* load IOPB from iorq */
   1464       1.1        pk 
   1465       1.1        pk 	xyc_rqtopb(iorq, iopb, cmd, subfn);
   1466       1.1        pk 
   1467       1.1        pk 	/* submit it for processing */
   1468       1.1        pk 
   1469       1.1        pk 	xyc_submit_iorq(xycsc, iorq, fullmode);	/* error code will be in iorq */
   1470       1.1        pk 
   1471       1.1        pk 	return(XY_ERR_AOK);
   1472       1.1        pk }
   1473       1.1        pk 
   1474       1.1        pk /*
   1475       1.1        pk  * xyc_startbuf
   1476       1.1        pk  * start a buffer for running
   1477       1.1        pk  */
   1478       1.1        pk 
   1479       1.1        pk int
   1480       1.1        pk xyc_startbuf(xycsc, xysc, bp)
   1481       1.1        pk 	struct xyc_softc *xycsc;
   1482       1.1        pk 	struct xy_softc *xysc;
   1483       1.1        pk 	struct buf *bp;
   1484       1.1        pk 
   1485       1.1        pk {
   1486       1.2        pk 	int     partno, error;
   1487       1.1        pk 	struct xy_iorq *iorq;
   1488       1.1        pk 	struct xy_iopb *iopb;
   1489       1.1        pk 	u_long  block;
   1490       1.1        pk 
   1491       1.1        pk 	iorq = xysc->xyrq;
   1492       1.1        pk 	iopb = iorq->iopb;
   1493       1.1        pk 
   1494       1.1        pk 	/* get buf */
   1495       1.1        pk 
   1496       1.1        pk 	if (bp == NULL)
   1497       1.1        pk 		panic("xyc_startbuf null buf");
   1498       1.1        pk 
   1499       1.1        pk 	partno = DISKPART(bp->b_dev);
   1500       1.1        pk #ifdef XYC_DEBUG
   1501       1.1        pk 	printf("xyc_startbuf: %s%c: %s block %d\n", xysc->sc_dev.dv_xname,
   1502       1.1        pk 	    'a' + partno, (bp->b_flags & B_READ) ? "read" : "write", bp->b_blkno);
   1503       1.1        pk 	printf("xyc_startbuf: b_bcount %d, b_data 0x%x\n",
   1504       1.1        pk 	    bp->b_bcount, bp->b_data);
   1505       1.1        pk #endif
   1506       1.1        pk 
   1507       1.1        pk 	/*
   1508      1.16   thorpej 	 * load request.
   1509       1.1        pk 	 *
   1510       1.1        pk 	 * note that iorq points to the buffer as mapped into DVMA space,
   1511       1.1        pk 	 * where as the bp->b_data points to its non-DVMA mapping.
   1512       1.1        pk 	 */
   1513       1.1        pk 
   1514      1.16   thorpej 	block = bp->b_rawblkno;
   1515       1.1        pk 
   1516       1.2        pk 	error = bus_dmamap_load(xycsc->dmatag, iorq->dmamap,
   1517       1.2        pk 			bp->b_data, bp->b_bcount, 0, BUS_DMA_NOWAIT);
   1518      1.10        pk 	if (error != 0) {
   1519       1.2        pk 		printf("%s: warning: cannot load DMA map\n",
   1520       1.1        pk 			xycsc->sc_dev.dv_xname);
   1521       1.1        pk 		return (XY_ERR_FAIL);	/* XXX: need some sort of
   1522       1.1        pk 					 * call-back scheme here? */
   1523       1.1        pk 	}
   1524       1.1        pk 
   1525       1.7   thorpej 	bus_dmamap_sync(xycsc->dmatag, iorq->dmamap, 0,
   1526       1.7   thorpej 			iorq->dmamap->dm_mapsize, (bp->b_flags & B_READ)
   1527       1.2        pk 				? BUS_DMASYNC_PREREAD
   1528       1.2        pk 				: BUS_DMASYNC_PREWRITE);
   1529       1.2        pk 
   1530       1.1        pk 	/* init iorq and load iopb from it */
   1531       1.1        pk 	xyc_rqinit(iorq, xycsc, xysc, XY_SUB_NORM | XY_MODE_VERBO, block,
   1532       1.2        pk 		   bp->b_bcount / XYFM_BPS,
   1533      1.69  christos 		   (void *)(u_long)iorq->dmamap->dm_segs[0].ds_addr,
   1534       1.2        pk 		   bp);
   1535       1.1        pk 
   1536       1.1        pk 	xyc_rqtopb(iorq, iopb, (bp->b_flags & B_READ) ? XYCMD_RD : XYCMD_WR, 0);
   1537       1.1        pk 
   1538       1.1        pk 	/* Instrumentation. */
   1539       1.1        pk 	disk_busy(&xysc->sc_dk);
   1540       1.1        pk 
   1541       1.1        pk 	return (XY_ERR_AOK);
   1542       1.1        pk }
   1543       1.1        pk 
   1544       1.1        pk 
   1545       1.1        pk /*
   1546       1.1        pk  * xyc_submit_iorq: submit an iorq for processing.  returns XY_ERR_AOK
   1547       1.1        pk  * if ok.  if it fail returns an error code.  type is XY_SUB_*.
   1548       1.1        pk  *
   1549       1.1        pk  * note: caller frees iorq in all cases except NORM
   1550       1.1        pk  *
   1551       1.1        pk  * return value:
   1552       1.1        pk  *   NORM: XY_AOK (req pending), XY_FAIL (couldn't submit request)
   1553       1.1        pk  *   WAIT: XY_AOK (success), <error-code> (failed)
   1554       1.1        pk  *   POLL: <same as WAIT>
   1555       1.1        pk  *   NOQ : <same as NORM>
   1556       1.1        pk  *
   1557       1.1        pk  * there are three sources for i/o requests:
   1558       1.1        pk  * [1] xystrategy: normal block I/O, using "struct buf" system.
   1559       1.1        pk  * [2] autoconfig/crash dump: these are polled I/O requests, no interrupts.
   1560       1.1        pk  * [3] open/ioctl: these are I/O requests done in the context of a process,
   1561       1.1        pk  *                 and the process should block until they are done.
   1562       1.1        pk  *
   1563       1.1        pk  * software state is stored in the iorq structure.  each iorq has an
   1564       1.1        pk  * iopb structure.  the hardware understands the iopb structure.
   1565       1.1        pk  * every command must go through an iopb.  a 450 handles one iopb at a
   1566       1.1        pk  * time, where as a 451 can take them in chains.  [the 450 claims it
   1567       1.1        pk  * can handle chains, but is appears to be buggy...]   iopb are allocated
   1568       1.1        pk  * in DVMA space at boot up time.  each disk gets one iopb, and the
   1569       1.1        pk  * controller gets one (for POLL and WAIT commands).  what happens if
   1570       1.1        pk  * the iopb is busy?  for i/o type [1], the buffers are queued at the
   1571       1.1        pk  * "buff" layer and * picked up later by the interrupt routine.  for case
   1572       1.1        pk  * [2] we can only be blocked if there is a WAIT type I/O request being
   1573       1.1        pk  * run.   since this can only happen when we are crashing, we wait a sec
   1574       1.1        pk  * and then steal the IOPB.  for case [3] the process can sleep
   1575      1.54       wiz  * on the iorq free list until some iopbs are available.
   1576       1.1        pk  */
   1577       1.1        pk 
   1578       1.1        pk 
   1579       1.1        pk int
   1580       1.1        pk xyc_submit_iorq(xycsc, iorq, type)
   1581       1.1        pk 	struct xyc_softc *xycsc;
   1582       1.1        pk 	struct xy_iorq *iorq;
   1583       1.1        pk 	int     type;
   1584       1.1        pk 
   1585       1.1        pk {
   1586      1.10        pk 	struct xy_iopb *dmaiopb;
   1587       1.1        pk 
   1588       1.1        pk #ifdef XYC_DEBUG
   1589       1.1        pk 	printf("xyc_submit_iorq(%s, addr=0x%x, type=%d)\n",
   1590       1.1        pk 		xycsc->sc_dev.dv_xname, iorq, type);
   1591       1.1        pk #endif
   1592       1.1        pk 
   1593       1.1        pk 	/* first check and see if controller is busy */
   1594       1.1        pk 	if ((xycsc->xyc->xyc_csr & XYC_GBSY) != 0) {
   1595       1.1        pk #ifdef XYC_DEBUG
   1596       1.1        pk 		printf("xyc_submit_iorq: XYC not ready (BUSY)\n");
   1597       1.1        pk #endif
   1598       1.1        pk 		if (type == XY_SUB_NOQ)
   1599       1.1        pk 			return (XY_ERR_FAIL);	/* failed */
   1600       1.1        pk 		switch (type) {
   1601       1.1        pk 		case XY_SUB_NORM:
   1602       1.1        pk 			return XY_ERR_AOK;	/* success */
   1603       1.1        pk 		case XY_SUB_WAIT:
   1604       1.1        pk 			while (iorq->iopb->done == 0) {
   1605      1.23   thorpej 				(void) tsleep(iorq, PRIBIO, "xyciorq", 0);
   1606       1.1        pk 			}
   1607      1.67  christos 			return (iorq->errnum);
   1608       1.1        pk 		case XY_SUB_POLL:		/* steal controller */
   1609      1.10        pk 			(void)xycsc->xyc->xyc_rsetup; /* RESET */
   1610       1.1        pk 			if (xyc_unbusy(xycsc->xyc,XYC_RESETUSEC) == XY_ERR_FAIL)
   1611       1.1        pk 				panic("xyc_submit_iorq: stuck xyc");
   1612       1.1        pk 			printf("%s: stole controller\n",
   1613       1.1        pk 				xycsc->sc_dev.dv_xname);
   1614       1.1        pk 			break;
   1615       1.1        pk 		default:
   1616       1.1        pk 			panic("xyc_submit_iorq adding");
   1617       1.1        pk 		}
   1618       1.1        pk 	}
   1619       1.1        pk 
   1620      1.10        pk 	dmaiopb = xyc_chain(xycsc, iorq);	 /* build chain */
   1621      1.10        pk 	if (dmaiopb == NULL) { /* nothing doing? */
   1622       1.1        pk 		if (type == XY_SUB_NORM || type == XY_SUB_NOQ)
   1623       1.1        pk 			return(XY_ERR_AOK);
   1624      1.42    provos 		panic("xyc_submit_iorq: xyc_chain failed!");
   1625       1.1        pk 	}
   1626       1.1        pk 
   1627      1.63     skrll 	XYC_GO(xycsc->xyc, dmaiopb);
   1628       1.1        pk 
   1629       1.1        pk 	/* command now running, wrap it up */
   1630       1.1        pk 	switch (type) {
   1631       1.1        pk 	case XY_SUB_NORM:
   1632       1.1        pk 	case XY_SUB_NOQ:
   1633       1.1        pk 		return (XY_ERR_AOK);	/* success */
   1634       1.1        pk 	case XY_SUB_WAIT:
   1635       1.1        pk 		while (iorq->iopb->done == 0) {
   1636      1.23   thorpej 			(void) tsleep(iorq, PRIBIO, "xyciorq", 0);
   1637       1.1        pk 		}
   1638      1.67  christos 		return (iorq->errnum);
   1639       1.1        pk 	case XY_SUB_POLL:
   1640       1.1        pk 		return (xyc_piodriver(xycsc, iorq));
   1641       1.1        pk 	default:
   1642       1.1        pk 		panic("xyc_submit_iorq wrap up");
   1643       1.1        pk 	}
   1644       1.1        pk 	panic("xyc_submit_iorq");
   1645       1.1        pk 	return 0;	/* not reached */
   1646       1.1        pk }
   1647       1.1        pk 
   1648       1.1        pk 
   1649       1.1        pk /*
   1650       1.1        pk  * xyc_chain: build a chain.  return dvma address of first element in
   1651       1.1        pk  * the chain.   iorq != NULL: means we only want that item on the chain.
   1652       1.1        pk  */
   1653       1.1        pk 
   1654       1.1        pk struct xy_iopb *
   1655       1.1        pk xyc_chain(xycsc, iorq)
   1656      1.10        pk 	struct xyc_softc *xycsc;
   1657      1.10        pk 	struct xy_iorq *iorq;
   1658      1.10        pk 
   1659      1.10        pk {
   1660      1.10        pk 	int togo, chain, hand;
   1661      1.10        pk 
   1662      1.10        pk 	bzero(xycsc->xy_chain, sizeof(xycsc->xy_chain));
   1663      1.10        pk 
   1664      1.10        pk 	/*
   1665      1.10        pk 	 * promote control IOPB to the top
   1666      1.10        pk 	 */
   1667      1.10        pk 	if (iorq == NULL) {
   1668      1.10        pk 		if ((XY_STATE(xycsc->reqs[XYC_CTLIOPB].mode) == XY_SUB_POLL ||
   1669      1.10        pk 		     XY_STATE(xycsc->reqs[XYC_CTLIOPB].mode) == XY_SUB_WAIT) &&
   1670      1.10        pk 		     xycsc->iopbase[XYC_CTLIOPB].done == 0)
   1671      1.10        pk 			iorq = &xycsc->reqs[XYC_CTLIOPB];
   1672      1.10        pk 	}
   1673      1.10        pk 
   1674      1.10        pk 	/*
   1675      1.10        pk 	 * special case: if iorq != NULL then we have a POLL or WAIT request.
   1676      1.10        pk 	 * we let these take priority and do them first.
   1677      1.10        pk 	 */
   1678      1.10        pk 	if (iorq) {
   1679      1.10        pk 		xycsc->xy_chain[0] = iorq;
   1680      1.10        pk 		iorq->iopb->chen = 0;
   1681      1.10        pk 		return(iorq->dmaiopb);
   1682      1.10        pk 	}
   1683       1.1        pk 
   1684      1.10        pk 	/*
   1685      1.10        pk 	 * NORM case: do round robin and maybe chain (if allowed and possible)
   1686      1.10        pk 	 */
   1687      1.10        pk 	chain = 0;
   1688      1.10        pk 	hand = xycsc->xy_hand;
   1689      1.10        pk 	xycsc->xy_hand = (xycsc->xy_hand + 1) % XYC_MAXIOPB;
   1690      1.10        pk 
   1691      1.10        pk 	for (togo = XYC_MAXIOPB; togo > 0;
   1692      1.10        pk 	     togo--, hand = (hand + 1) % XYC_MAXIOPB) {
   1693      1.10        pk 		struct xy_iopb *iopb, *prev_iopb, *dmaiopb;
   1694      1.10        pk 
   1695      1.10        pk 		if (XY_STATE(xycsc->reqs[hand].mode) != XY_SUB_NORM ||
   1696      1.10        pk 		    xycsc->iopbase[hand].done)
   1697      1.10        pk 			continue;   /* not ready-for-i/o */
   1698      1.10        pk 
   1699      1.10        pk 		xycsc->xy_chain[chain] = &xycsc->reqs[hand];
   1700      1.10        pk 		iopb = xycsc->xy_chain[chain]->iopb;
   1701      1.10        pk 		iopb->chen = 0;
   1702      1.10        pk 		if (chain != 0) {
   1703      1.10        pk 			/* adding a link to a chain */
   1704      1.10        pk 			prev_iopb = xycsc->xy_chain[chain-1]->iopb;
   1705      1.10        pk 			prev_iopb->chen = 1;
   1706      1.10        pk 			dmaiopb = xycsc->xy_chain[chain]->dmaiopb;
   1707      1.10        pk 			prev_iopb->nxtiopb = ((u_long)dmaiopb) & 0xffff;
   1708      1.10        pk 		} else {
   1709      1.10        pk 			/* head of chain */
   1710      1.10        pk 			iorq = xycsc->xy_chain[chain];
   1711      1.10        pk 		}
   1712      1.10        pk 		chain++;
   1713      1.10        pk 
   1714      1.10        pk 		/* quit if chaining dis-allowed */
   1715      1.10        pk 		if (xycsc->no_ols)
   1716      1.10        pk 			break;
   1717      1.10        pk 	}
   1718       1.1        pk 
   1719      1.10        pk 	return(iorq ? iorq->dmaiopb : NULL);
   1720       1.1        pk }
   1721       1.1        pk 
   1722       1.1        pk /*
   1723       1.1        pk  * xyc_piodriver
   1724       1.1        pk  *
   1725       1.1        pk  * programmed i/o driver.   this function takes over the computer
   1726       1.1        pk  * and drains off the polled i/o request.   it returns the status of the iorq
   1727       1.1        pk  * the caller is interesting in.
   1728       1.1        pk  */
   1729       1.1        pk int
   1730       1.1        pk xyc_piodriver(xycsc, iorq)
   1731       1.1        pk 	struct xyc_softc *xycsc;
   1732       1.1        pk 	struct xy_iorq  *iorq;
   1733       1.1        pk 
   1734       1.1        pk {
   1735       1.1        pk 	int     nreset = 0;
   1736       1.1        pk 	int     retval = 0;
   1737       1.1        pk 	u_long  res;
   1738       1.1        pk #ifdef XYC_DEBUG
   1739       1.1        pk 	printf("xyc_piodriver(%s, 0x%x)\n", xycsc->sc_dev.dv_xname, iorq);
   1740       1.1        pk #endif
   1741       1.1        pk 
   1742       1.1        pk 	while (iorq->iopb->done == 0) {
   1743       1.1        pk 
   1744       1.1        pk 		res = xyc_unbusy(xycsc->xyc, XYC_MAXTIME);
   1745       1.1        pk 
   1746       1.1        pk 		/* we expect some progress soon */
   1747       1.1        pk 		if (res == XY_ERR_FAIL && nreset >= 2) {
   1748       1.1        pk 			xyc_reset(xycsc, 0, XY_RSET_ALL, XY_ERR_FAIL, 0);
   1749       1.1        pk #ifdef XYC_DEBUG
   1750       1.1        pk 			printf("xyc_piodriver: timeout\n");
   1751       1.1        pk #endif
   1752       1.1        pk 			return (XY_ERR_FAIL);
   1753       1.1        pk 		}
   1754       1.1        pk 		if (res == XY_ERR_FAIL) {
   1755       1.1        pk 			if (xyc_reset(xycsc, 0,
   1756       1.1        pk 				      (nreset++ == 0) ? XY_RSET_NONE : iorq,
   1757       1.1        pk 				      XY_ERR_FAIL,
   1758       1.1        pk 				      0) == XY_ERR_FAIL)
   1759       1.1        pk 				return (XY_ERR_FAIL);	/* flushes all but POLL
   1760       1.1        pk 							 * requests, resets */
   1761       1.1        pk 			continue;
   1762       1.1        pk 		}
   1763       1.1        pk 
   1764       1.1        pk 		xyc_remove_iorq(xycsc);	 /* may resubmit request */
   1765       1.1        pk 
   1766       1.1        pk 		if (iorq->iopb->done == 0)
   1767       1.1        pk 			xyc_start(xycsc, iorq);
   1768       1.1        pk 	}
   1769       1.1        pk 
   1770       1.1        pk 	/* get return value */
   1771       1.1        pk 
   1772      1.67  christos 	retval = iorq->errnum;
   1773       1.1        pk 
   1774       1.1        pk #ifdef XYC_DEBUG
   1775       1.1        pk 	printf("xyc_piodriver: done, retval = 0x%x (%s)\n",
   1776      1.67  christos 	    iorq->errnum, xyc_e2str(iorq->errnum));
   1777       1.1        pk #endif
   1778       1.1        pk 
   1779       1.1        pk 	/* start up any bufs that have queued */
   1780       1.1        pk 
   1781       1.1        pk 	xyc_start(xycsc, NULL);
   1782       1.1        pk 
   1783       1.1        pk 	return (retval);
   1784       1.1        pk }
   1785       1.1        pk 
   1786       1.1        pk /*
   1787       1.1        pk  * xyc_xyreset: reset one drive.   NOTE: assumes xyc was just reset.
   1788       1.1        pk  * we steal iopb[XYC_CTLIOPB] for this, but we put it back when we are done.
   1789       1.1        pk  */
   1790       1.1        pk void
   1791       1.1        pk xyc_xyreset(xycsc, xysc)
   1792       1.1        pk 	struct xyc_softc *xycsc;
   1793       1.1        pk 	struct xy_softc *xysc;
   1794       1.1        pk 
   1795       1.1        pk {
   1796       1.1        pk 	struct xy_iopb tmpiopb;
   1797      1.10        pk 	struct xy_iopb *iopb;
   1798       1.1        pk 	int     del;
   1799       1.1        pk 
   1800      1.10        pk 	iopb = xycsc->ciopb;
   1801      1.10        pk 
   1802      1.10        pk 	/* Save contents */
   1803      1.10        pk 	bcopy(iopb, &tmpiopb, sizeof(struct xy_iopb));
   1804      1.10        pk 
   1805      1.10        pk 	iopb->chen = iopb->done = iopb->errs = 0;
   1806      1.10        pk 	iopb->ien = 0;
   1807      1.10        pk 	iopb->com = XYCMD_RST;
   1808      1.10        pk 	iopb->unit = xysc->xy_drive;
   1809      1.10        pk 
   1810      1.63     skrll 	XYC_GO(xycsc->xyc, xycsc->ciorq->dmaiopb);
   1811       1.1        pk 
   1812       1.1        pk 	del = XYC_RESETUSEC;
   1813       1.1        pk 	while (del > 0) {
   1814      1.10        pk 		if ((xycsc->xyc->xyc_csr & XYC_GBSY) == 0)
   1815      1.10        pk 			break;
   1816       1.1        pk 		DELAY(1);
   1817       1.1        pk 		del--;
   1818       1.1        pk 	}
   1819       1.1        pk 
   1820      1.10        pk 	if (del <= 0 || iopb->errs) {
   1821       1.1        pk 		printf("%s: off-line: %s\n", xycsc->sc_dev.dv_xname,
   1822      1.67  christos 		    xyc_e2str(iopb->errnum));
   1823       1.1        pk 		del = xycsc->xyc->xyc_rsetup;
   1824       1.1        pk 		if (xyc_unbusy(xycsc->xyc, XYC_RESETUSEC) == XY_ERR_FAIL)
   1825       1.1        pk 			panic("xyc_reset");
   1826       1.1        pk 	} else {
   1827       1.1        pk 		xycsc->xyc->xyc_csr = XYC_IPND;	/* clear IPND */
   1828       1.1        pk 	}
   1829      1.10        pk 
   1830      1.10        pk 	/* Restore contents */
   1831      1.10        pk 	bcopy(&tmpiopb, iopb, sizeof(struct xy_iopb));
   1832       1.1        pk }
   1833       1.1        pk 
   1834       1.1        pk 
   1835       1.1        pk /*
   1836       1.1        pk  * xyc_reset: reset everything: requests are marked as errors except
   1837       1.1        pk  * a polled request (which is resubmitted)
   1838       1.1        pk  */
   1839       1.1        pk int
   1840       1.1        pk xyc_reset(xycsc, quiet, blastmode, error, xysc)
   1841       1.1        pk 	struct xyc_softc *xycsc;
   1842       1.1        pk 	int     quiet, error;
   1843       1.1        pk 	struct xy_iorq *blastmode;
   1844       1.1        pk 	struct xy_softc *xysc;
   1845       1.1        pk 
   1846       1.1        pk {
   1847       1.1        pk 	int     del = 0, lcv, retval = XY_ERR_AOK;
   1848       1.1        pk 
   1849       1.1        pk 	/* soft reset hardware */
   1850       1.1        pk 
   1851       1.1        pk 	if (!quiet)
   1852       1.1        pk 		printf("%s: soft reset\n", xycsc->sc_dev.dv_xname);
   1853       1.1        pk 	del = xycsc->xyc->xyc_rsetup;
   1854       1.1        pk 	del = xyc_unbusy(xycsc->xyc, XYC_RESETUSEC);
   1855       1.1        pk 	if (del == XY_ERR_FAIL) {
   1856       1.1        pk 		blastmode = XY_RSET_ALL;	/* dead, flush all requests */
   1857       1.1        pk 		retval = XY_ERR_FAIL;
   1858       1.1        pk 	}
   1859       1.1        pk 	if (xysc)
   1860       1.1        pk 		xyc_xyreset(xycsc, xysc);
   1861       1.1        pk 
   1862       1.1        pk 	/* fix queues based on "blast-mode" */
   1863       1.1        pk 
   1864       1.1        pk 	for (lcv = 0; lcv < XYC_MAXIOPB; lcv++) {
   1865       1.1        pk 		register struct xy_iorq *iorq = &xycsc->reqs[lcv];
   1866       1.1        pk 
   1867       1.1        pk 		if (XY_STATE(iorq->mode) != XY_SUB_POLL &&
   1868       1.1        pk 		    XY_STATE(iorq->mode) != XY_SUB_WAIT &&
   1869       1.1        pk 		    XY_STATE(iorq->mode) != XY_SUB_NORM)
   1870       1.1        pk 			/* is it active? */
   1871       1.1        pk 			continue;
   1872       1.1        pk 
   1873       1.1        pk 		if (blastmode == XY_RSET_ALL ||
   1874       1.1        pk 				blastmode != iorq) {
   1875       1.1        pk 			/* failed */
   1876      1.67  christos 			iorq->errnum = error;
   1877       1.1        pk 			xycsc->iopbase[lcv].done = xycsc->iopbase[lcv].errs = 1;
   1878       1.1        pk 			switch (XY_STATE(iorq->mode)) {
   1879       1.1        pk 			case XY_SUB_NORM:
   1880       1.1        pk 			    iorq->buf->b_error = EIO;
   1881       1.1        pk 			    iorq->buf->b_resid = iorq->sectcnt * XYFM_BPS;
   1882       1.2        pk 
   1883       1.7   thorpej 			    bus_dmamap_sync(xycsc->dmatag, iorq->dmamap, 0,
   1884       1.7   thorpej 					iorq->dmamap->dm_mapsize,
   1885       1.2        pk 					(iorq->buf->b_flags & B_READ)
   1886       1.2        pk 						? BUS_DMASYNC_POSTREAD
   1887       1.2        pk 						: BUS_DMASYNC_POSTWRITE);
   1888      1.58     perry 
   1889       1.2        pk 			    bus_dmamap_unload(xycsc->dmatag, iorq->dmamap);
   1890       1.2        pk 
   1891      1.60      yamt 			    (void)BUFQ_GET(iorq->xy->xyq);
   1892       1.1        pk 			    disk_unbusy(&xycsc->reqs[lcv].xy->sc_dk,
   1893       1.1        pk 				(xycsc->reqs[lcv].buf->b_bcount -
   1894      1.47       mrg 				xycsc->reqs[lcv].buf->b_resid),
   1895      1.47       mrg 				(xycsc->reqs[lcv].buf->b_flags & B_READ));
   1896       1.1        pk 			    biodone(iorq->buf);
   1897       1.1        pk 			    iorq->mode = XY_SUB_FREE;
   1898       1.1        pk 			    break;
   1899       1.1        pk 			case XY_SUB_WAIT:
   1900       1.1        pk 			    wakeup(iorq);
   1901       1.1        pk 			case XY_SUB_POLL:
   1902       1.1        pk 			    iorq->mode =
   1903       1.1        pk 				XY_NEWSTATE(iorq->mode, XY_SUB_DONE);
   1904       1.1        pk 			    break;
   1905       1.1        pk 			}
   1906       1.1        pk 
   1907       1.1        pk 		} else {
   1908       1.1        pk 
   1909       1.1        pk 			/* resubmit, no need to do anything here */
   1910       1.1        pk 		}
   1911       1.1        pk 	}
   1912       1.1        pk 
   1913       1.1        pk 	/*
   1914       1.1        pk 	 * now, if stuff is waiting, start it.
   1915       1.1        pk 	 * since we just reset it should go
   1916       1.1        pk 	 */
   1917       1.1        pk 	xyc_start(xycsc, NULL);
   1918       1.1        pk 
   1919       1.1        pk 	return (retval);
   1920       1.1        pk }
   1921       1.1        pk 
   1922       1.1        pk /*
   1923       1.1        pk  * xyc_start: start waiting buffers
   1924       1.1        pk  */
   1925       1.1        pk 
   1926       1.1        pk void
   1927       1.1        pk xyc_start(xycsc, iorq)
   1928       1.1        pk 	struct xyc_softc *xycsc;
   1929       1.1        pk 	struct xy_iorq *iorq;
   1930       1.1        pk 
   1931       1.1        pk {
   1932       1.1        pk 	int lcv;
   1933       1.1        pk 	struct xy_softc *xy;
   1934       1.1        pk 
   1935       1.1        pk 	if (iorq == NULL) {
   1936       1.1        pk 		for (lcv = 0; lcv < XYC_MAXDEV ; lcv++) {
   1937       1.1        pk 			if ((xy = xycsc->sc_drives[lcv]) == NULL) continue;
   1938      1.60      yamt 			if (BUFQ_PEEK(xy->xyq) == NULL) continue;
   1939       1.1        pk 			if (xy->xyrq->mode != XY_SUB_FREE) continue;
   1940      1.60      yamt 			xyc_startbuf(xycsc, xy, BUFQ_PEEK(xy->xyq));
   1941       1.1        pk 		}
   1942       1.1        pk 	}
   1943       1.1        pk 	xyc_submit_iorq(xycsc, iorq, XY_SUB_NOQ);
   1944       1.1        pk }
   1945       1.1        pk 
   1946       1.1        pk /*
   1947       1.1        pk  * xyc_remove_iorq: remove "done" IOPB's.
   1948       1.1        pk  */
   1949       1.1        pk 
   1950       1.1        pk int
   1951       1.1        pk xyc_remove_iorq(xycsc)
   1952       1.1        pk 	struct xyc_softc *xycsc;
   1953       1.1        pk 
   1954       1.1        pk {
   1955      1.67  christos 	int     errnum, rq, comm, errs;
   1956       1.1        pk 	struct xyc *xyc = xycsc->xyc;
   1957       1.1        pk 	u_long  addr;
   1958       1.1        pk 	struct xy_iopb *iopb;
   1959       1.1        pk 	struct xy_iorq *iorq;
   1960       1.1        pk 	struct buf *bp;
   1961       1.1        pk 
   1962       1.1        pk 	if (xyc->xyc_csr & XYC_DERR) {
   1963       1.1        pk 		/*
   1964       1.1        pk 		 * DOUBLE ERROR: should never happen under normal use. This
   1965       1.1        pk 		 * error is so bad, you can't even tell which IOPB is bad, so
   1966       1.1        pk 		 * we dump them all.
   1967       1.1        pk 		 */
   1968      1.67  christos 		errnum = XY_ERR_DERR;
   1969       1.1        pk 		printf("%s: DOUBLE ERROR!\n", xycsc->sc_dev.dv_xname);
   1970      1.67  christos 		if (xyc_reset(xycsc, 0, XY_RSET_ALL, errnum, 0) != XY_ERR_AOK) {
   1971       1.1        pk 			printf("%s: soft reset failed!\n",
   1972       1.1        pk 				xycsc->sc_dev.dv_xname);
   1973       1.1        pk 			panic("xyc_remove_iorq: controller DEAD");
   1974       1.1        pk 		}
   1975       1.1        pk 		return (XY_ERR_AOK);
   1976       1.1        pk 	}
   1977       1.1        pk 
   1978       1.1        pk 	/*
   1979       1.1        pk 	 * get iopb that is done, loop down the chain
   1980       1.1        pk 	 */
   1981       1.1        pk 
   1982       1.1        pk 	if (xyc->xyc_csr & XYC_ERR) {
   1983       1.1        pk 		xyc->xyc_csr = XYC_ERR; /* clear error condition */
   1984       1.1        pk 	}
   1985       1.1        pk 	if (xyc->xyc_csr & XYC_IPND) {
   1986       1.1        pk 		xyc->xyc_csr = XYC_IPND; /* clear interrupt */
   1987       1.1        pk 	}
   1988       1.1        pk 
   1989       1.1        pk 	for (rq = 0; rq < XYC_MAXIOPB; rq++) {
   1990       1.1        pk 		iorq = xycsc->xy_chain[rq];
   1991       1.1        pk 		if (iorq == NULL) break; /* done ! */
   1992       1.1        pk 		if (iorq->mode == 0 || XY_STATE(iorq->mode) == XY_SUB_DONE)
   1993       1.1        pk 			continue;	/* free, or done */
   1994       1.1        pk 		iopb = iorq->iopb;
   1995       1.1        pk 		if (iopb->done == 0)
   1996       1.1        pk 			continue;	/* not done yet */
   1997       1.1        pk 
   1998       1.1        pk 		comm = iopb->com;
   1999       1.1        pk 		errs = iopb->errs;
   2000       1.1        pk 
   2001       1.1        pk 		if (errs)
   2002      1.67  christos 			iorq->errnum = iopb->errnum;
   2003       1.1        pk 		else
   2004      1.67  christos 			iorq->errnum = 0;
   2005       1.1        pk 
   2006       1.1        pk 		/* handle non-fatal errors */
   2007       1.1        pk 
   2008       1.1        pk 		if (errs &&
   2009       1.1        pk 		    xyc_error(xycsc, iorq, iopb, comm) == XY_ERR_AOK)
   2010       1.1        pk 			continue;	/* AOK: we resubmitted it */
   2011       1.1        pk 
   2012       1.1        pk 
   2013       1.1        pk 		/* this iorq is now done (hasn't been restarted or anything) */
   2014       1.1        pk 
   2015       1.1        pk 		if ((iorq->mode & XY_MODE_VERBO) && iorq->lasterror)
   2016       1.1        pk 			xyc_perror(iorq, iopb, 0);
   2017       1.1        pk 
   2018       1.1        pk 		/* now, if read/write check to make sure we got all the data
   2019       1.1        pk 		 * we needed. (this may not be the case if we got an error in
   2020       1.1        pk 		 * the middle of a multisector request).   */
   2021       1.1        pk 
   2022       1.1        pk 		if ((iorq->mode & XY_MODE_B144) != 0 && errs == 0 &&
   2023       1.1        pk 		    (comm == XYCMD_RD || comm == XYCMD_WR)) {
   2024       1.1        pk 			/* we just successfully processed a bad144 sector
   2025       1.1        pk 			 * note: if we are in bad 144 mode, the pointers have
   2026       1.1        pk 			 * been advanced already (see above) and are pointing
   2027       1.1        pk 			 * at the bad144 sector.   to exit bad144 mode, we
   2028       1.1        pk 			 * must advance the pointers 1 sector and issue a new
   2029       1.1        pk 			 * request if there are still sectors left to process
   2030       1.1        pk 			 *
   2031       1.1        pk 			 */
   2032       1.1        pk 			XYC_ADVANCE(iorq, 1);	/* advance 1 sector */
   2033       1.1        pk 
   2034       1.1        pk 			/* exit b144 mode */
   2035       1.1        pk 			iorq->mode = iorq->mode & (~XY_MODE_B144);
   2036       1.1        pk 
   2037       1.1        pk 			if (iorq->sectcnt) {	/* more to go! */
   2038      1.67  christos 				iorq->lasterror = iorq->errnum = iopb->errnum = 0;
   2039       1.1        pk 				iopb->errs = iopb->done = 0;
   2040       1.1        pk 				iorq->tries = 0;
   2041       1.1        pk 				iopb->scnt = iorq->sectcnt;
   2042       1.1        pk 				iopb->cyl = iorq->blockno /
   2043       1.1        pk 						iorq->xy->sectpercyl;
   2044       1.1        pk 				iopb->head =
   2045       1.1        pk 					(iorq->blockno / iorq->xy->nhead) %
   2046       1.1        pk 						iorq->xy->nhead;
   2047       1.1        pk 				iopb->sect = iorq->blockno % XYFM_BPS;
   2048       1.2        pk 				addr = (u_long) iorq->dbuf;
   2049       1.1        pk 				iopb->dataa = (addr & 0xffff);
   2050       1.1        pk 				iopb->datar = ((addr & 0xff0000) >> 16);
   2051       1.1        pk 				/* will resubit at end */
   2052       1.1        pk 				continue;
   2053       1.1        pk 			}
   2054       1.1        pk 		}
   2055       1.1        pk 		/* final cleanup, totally done with this request */
   2056       1.1        pk 
   2057       1.1        pk 		switch (XY_STATE(iorq->mode)) {
   2058       1.1        pk 		case XY_SUB_NORM:
   2059       1.1        pk 			bp = iorq->buf;
   2060       1.1        pk 			if (errs) {
   2061       1.1        pk 				bp->b_error = EIO;
   2062       1.1        pk 				bp->b_resid = iorq->sectcnt * XYFM_BPS;
   2063       1.1        pk 			} else {
   2064       1.1        pk 				bp->b_resid = 0;	/* done */
   2065       1.1        pk 			}
   2066       1.7   thorpej 			bus_dmamap_sync(xycsc->dmatag, iorq->dmamap, 0,
   2067       1.7   thorpej 					iorq->dmamap->dm_mapsize,
   2068       1.2        pk 					(iorq->buf->b_flags & B_READ)
   2069       1.2        pk 						? BUS_DMASYNC_POSTREAD
   2070       1.2        pk 						: BUS_DMASYNC_POSTWRITE);
   2071      1.58     perry 
   2072       1.2        pk 			bus_dmamap_unload(xycsc->dmatag, iorq->dmamap);
   2073       1.2        pk 
   2074      1.60      yamt 			(void)BUFQ_GET(iorq->xy->xyq);
   2075       1.1        pk 			disk_unbusy(&iorq->xy->sc_dk,
   2076      1.47       mrg 			    (bp->b_bcount - bp->b_resid),
   2077      1.47       mrg 			    (bp->b_flags & B_READ));
   2078       1.1        pk 			iorq->mode = XY_SUB_FREE;
   2079       1.1        pk 			biodone(bp);
   2080       1.1        pk 			break;
   2081       1.1        pk 		case XY_SUB_WAIT:
   2082       1.1        pk 			iorq->mode = XY_NEWSTATE(iorq->mode, XY_SUB_DONE);
   2083       1.1        pk 			wakeup(iorq);
   2084       1.1        pk 			break;
   2085       1.1        pk 		case XY_SUB_POLL:
   2086       1.1        pk 			iorq->mode = XY_NEWSTATE(iorq->mode, XY_SUB_DONE);
   2087       1.1        pk 			break;
   2088       1.1        pk 		}
   2089       1.1        pk 	}
   2090       1.1        pk 
   2091       1.1        pk 	return (XY_ERR_AOK);
   2092       1.1        pk }
   2093       1.1        pk 
   2094       1.1        pk /*
   2095       1.1        pk  * xyc_perror: print error.
   2096       1.1        pk  * - if still_trying is true: we got an error, retried and got a
   2097       1.1        pk  *   different error.  in that case lasterror is the old error,
   2098      1.67  christos  *   and errnum is the new one.
   2099       1.1        pk  * - if still_trying is not true, then if we ever had an error it
   2100      1.67  christos  *   is in lasterror. also, if iorq->errnum == 0, then we recovered
   2101      1.67  christos  *   from that error (otherwise iorq->errnum == iorq->lasterror).
   2102       1.1        pk  */
   2103       1.1        pk void
   2104       1.1        pk xyc_perror(iorq, iopb, still_trying)
   2105       1.1        pk 	struct xy_iorq *iorq;
   2106       1.1        pk 	struct xy_iopb *iopb;
   2107       1.1        pk 	int     still_trying;
   2108       1.1        pk 
   2109       1.1        pk {
   2110       1.1        pk 
   2111       1.1        pk 	int     error = iorq->lasterror;
   2112       1.1        pk 
   2113       1.1        pk 	printf("%s", (iorq->xy) ? iorq->xy->sc_dev.dv_xname
   2114       1.1        pk 	    : iorq->xyc->sc_dev.dv_xname);
   2115       1.1        pk 	if (iorq->buf)
   2116       1.1        pk 		printf("%c: ", 'a' + DISKPART(iorq->buf->b_dev));
   2117       1.1        pk 	if (iopb->com == XYCMD_RD || iopb->com == XYCMD_WR)
   2118       1.1        pk 		printf("%s %d/%d/%d: ",
   2119       1.1        pk 			(iopb->com == XYCMD_RD) ? "read" : "write",
   2120       1.1        pk 			iopb->cyl, iopb->head, iopb->sect);
   2121       1.1        pk 	printf("%s", xyc_e2str(error));
   2122       1.1        pk 
   2123       1.1        pk 	if (still_trying)
   2124      1.67  christos 		printf(" [still trying, new error=%s]", xyc_e2str(iorq->errnum));
   2125       1.1        pk 	else
   2126      1.67  christos 		if (iorq->errnum == 0)
   2127       1.1        pk 			printf(" [recovered in %d tries]", iorq->tries);
   2128       1.1        pk 
   2129       1.1        pk 	printf("\n");
   2130       1.1        pk }
   2131       1.1        pk 
   2132       1.1        pk /*
   2133       1.1        pk  * xyc_error: non-fatal error encountered... recover.
   2134       1.1        pk  * return AOK if resubmitted, return FAIL if this iopb is done
   2135       1.1        pk  */
   2136       1.1        pk int
   2137       1.1        pk xyc_error(xycsc, iorq, iopb, comm)
   2138       1.1        pk 	struct xyc_softc *xycsc;
   2139       1.1        pk 	struct xy_iorq *iorq;
   2140       1.1        pk 	struct xy_iopb *iopb;
   2141       1.1        pk 	int     comm;
   2142       1.1        pk 
   2143       1.1        pk {
   2144      1.67  christos 	int     errnum = iorq->errnum;
   2145      1.67  christos 	int     erract = xyc_entoact(errnum);
   2146      1.12  drochner 	int     oldmode, advance;
   2147      1.18       chs #ifdef __sparc__
   2148      1.12  drochner 	int i;
   2149      1.12  drochner #endif
   2150       1.1        pk 
   2151       1.1        pk 	if (erract == XY_ERA_RSET) {	/* some errors require a reset */
   2152       1.1        pk 		oldmode = iorq->mode;
   2153       1.1        pk 		iorq->mode = XY_SUB_DONE | (~XY_SUB_MASK & oldmode);
   2154       1.1        pk 		/* make xyc_start ignore us */
   2155      1.67  christos 		xyc_reset(xycsc, 1, XY_RSET_NONE, errnum, iorq->xy);
   2156       1.1        pk 		iorq->mode = oldmode;
   2157       1.1        pk 	}
   2158       1.1        pk 	/* check for read/write to a sector in bad144 table if bad: redirect
   2159       1.1        pk 	 * request to bad144 area */
   2160       1.1        pk 
   2161       1.1        pk 	if ((comm == XYCMD_RD || comm == XYCMD_WR) &&
   2162       1.1        pk 	    (iorq->mode & XY_MODE_B144) == 0) {
   2163       1.1        pk 		advance = iorq->sectcnt - iopb->scnt;
   2164       1.1        pk 		XYC_ADVANCE(iorq, advance);
   2165      1.18       chs #ifdef __sparc__
   2166       1.1        pk 		if ((i = isbad(&iorq->xy->dkb, iorq->blockno / iorq->xy->sectpercyl,
   2167       1.1        pk 			    (iorq->blockno / iorq->xy->nsect) % iorq->xy->nhead,
   2168       1.1        pk 			    iorq->blockno % iorq->xy->nsect)) != -1) {
   2169       1.1        pk 			iorq->mode |= XY_MODE_B144;	/* enter bad144 mode &
   2170       1.1        pk 							 * redirect */
   2171      1.67  christos 			iopb->errnum = iopb->done = iopb->errs = 0;
   2172       1.1        pk 			iopb->scnt = 1;
   2173       1.1        pk 			iopb->cyl = (iorq->xy->ncyl + iorq->xy->acyl) - 2;
   2174       1.1        pk 			/* second to last acyl */
   2175       1.1        pk 			i = iorq->xy->sectpercyl - 1 - i;	/* follow bad144
   2176       1.1        pk 								 * standard */
   2177       1.1        pk 			iopb->head = i / iorq->xy->nhead;
   2178       1.1        pk 			iopb->sect = i % iorq->xy->nhead;
   2179       1.1        pk 			/* will resubmit when we come out of remove_iorq */
   2180       1.1        pk 			return (XY_ERR_AOK);	/* recovered! */
   2181       1.1        pk 		}
   2182      1.12  drochner #endif
   2183       1.1        pk 	}
   2184       1.1        pk 
   2185       1.1        pk 	/*
   2186       1.1        pk 	 * it isn't a bad144 sector, must be real error! see if we can retry
   2187       1.1        pk 	 * it?
   2188       1.1        pk 	 */
   2189       1.1        pk 	if ((iorq->mode & XY_MODE_VERBO) && iorq->lasterror)
   2190       1.1        pk 		xyc_perror(iorq, iopb, 1);	/* inform of error state
   2191       1.1        pk 						 * change */
   2192      1.67  christos 	iorq->lasterror = errnum;
   2193       1.1        pk 
   2194       1.1        pk 	if ((erract == XY_ERA_RSET || erract == XY_ERA_HARD)
   2195       1.1        pk 	    && iorq->tries < XYC_MAXTRIES) {	/* retry? */
   2196       1.1        pk 		iorq->tries++;
   2197      1.67  christos 		iorq->errnum = iopb->errnum = iopb->done = iopb->errs = 0;
   2198       1.1        pk 		/* will resubmit at end of remove_iorq */
   2199       1.1        pk 		return (XY_ERR_AOK);	/* recovered! */
   2200       1.1        pk 	}
   2201       1.1        pk 
   2202       1.1        pk 	/* failed to recover from this error */
   2203       1.1        pk 	return (XY_ERR_FAIL);
   2204       1.1        pk }
   2205       1.1        pk 
   2206       1.1        pk /*
   2207       1.1        pk  * xyc_tick: make sure xy is still alive and ticking (err, kicking).
   2208       1.1        pk  */
   2209       1.1        pk void
   2210       1.1        pk xyc_tick(arg)
   2211       1.1        pk 	void   *arg;
   2212       1.1        pk 
   2213       1.1        pk {
   2214       1.1        pk 	struct xyc_softc *xycsc = arg;
   2215       1.1        pk 	int     lcv, s, reset = 0;
   2216       1.1        pk 
   2217       1.1        pk 	/* reduce ttl for each request if one goes to zero, reset xyc */
   2218       1.1        pk 	s = splbio();
   2219       1.1        pk 	for (lcv = 0; lcv < XYC_MAXIOPB; lcv++) {
   2220       1.1        pk 		if (xycsc->reqs[lcv].mode == 0 ||
   2221       1.1        pk 		    XY_STATE(xycsc->reqs[lcv].mode) == XY_SUB_DONE)
   2222       1.1        pk 			continue;
   2223       1.1        pk 		xycsc->reqs[lcv].ttl--;
   2224       1.1        pk 		if (xycsc->reqs[lcv].ttl == 0)
   2225       1.1        pk 			reset = 1;
   2226       1.1        pk 	}
   2227       1.1        pk 	if (reset) {
   2228       1.1        pk 		printf("%s: watchdog timeout\n", xycsc->sc_dev.dv_xname);
   2229       1.1        pk 		xyc_reset(xycsc, 0, XY_RSET_NONE, XY_ERR_FAIL, NULL);
   2230       1.1        pk 	}
   2231       1.1        pk 	splx(s);
   2232       1.1        pk 
   2233       1.1        pk 	/* until next time */
   2234       1.1        pk 
   2235      1.17   thorpej 	callout_reset(&xycsc->sc_tick_ch, XYC_TICKCNT, xyc_tick, xycsc);
   2236       1.1        pk }
   2237       1.1        pk 
   2238       1.1        pk /*
   2239       1.1        pk  * xyc_ioctlcmd: this function provides a user level interface to the
   2240       1.1        pk  * controller via ioctl.   this allows "format" programs to be written
   2241       1.1        pk  * in user code, and is also useful for some debugging.   we return
   2242       1.1        pk  * an error code.   called at user priority.
   2243       1.1        pk  *
   2244       1.1        pk  * XXX missing a few commands (see the 7053 driver for ideas)
   2245       1.1        pk  */
   2246       1.1        pk int
   2247       1.1        pk xyc_ioctlcmd(xy, dev, xio)
   2248       1.1        pk 	struct xy_softc *xy;
   2249       1.1        pk 	dev_t   dev;
   2250       1.1        pk 	struct xd_iocmd *xio;
   2251       1.1        pk 
   2252       1.1        pk {
   2253       1.2        pk 	int     s, rqno, dummy = 0;
   2254      1.70       mrg 	char *dvmabuf = NULL, *buf = NULL;
   2255       1.1        pk 	struct xyc_softc *xycsc;
   2256       1.2        pk 	int			rseg, error;
   2257       1.2        pk 	bus_dma_segment_t	seg;
   2258       1.1        pk 
   2259       1.1        pk 	/* check sanity of requested command */
   2260       1.1        pk 
   2261       1.1        pk 	switch (xio->cmd) {
   2262       1.1        pk 
   2263       1.1        pk 	case XYCMD_NOP:	/* no op: everything should be zero */
   2264       1.1        pk 		if (xio->subfn || xio->dptr || xio->dlen ||
   2265       1.1        pk 		    xio->block || xio->sectcnt)
   2266       1.1        pk 			return (EINVAL);
   2267       1.1        pk 		break;
   2268       1.1        pk 
   2269       1.1        pk 	case XYCMD_RD:		/* read / write sectors (up to XD_IOCMD_MAXS) */
   2270       1.1        pk 	case XYCMD_WR:
   2271       1.1        pk 		if (xio->subfn || xio->sectcnt > XD_IOCMD_MAXS ||
   2272       1.1        pk 		    xio->sectcnt * XYFM_BPS != xio->dlen || xio->dptr == NULL)
   2273       1.1        pk 			return (EINVAL);
   2274       1.1        pk 		break;
   2275       1.1        pk 
   2276       1.1        pk 	case XYCMD_SK:		/* seek: doesn't seem useful to export this */
   2277       1.1        pk 		return (EINVAL);
   2278       1.1        pk 
   2279       1.1        pk 		break;
   2280       1.1        pk 
   2281       1.1        pk 	default:
   2282       1.1        pk 		return (EINVAL);/* ??? */
   2283       1.1        pk 	}
   2284       1.1        pk 
   2285       1.2        pk 	xycsc = xy->parent;
   2286       1.2        pk 
   2287       1.1        pk 	/* create DVMA buffer for request if needed */
   2288       1.2        pk 	if (xio->dlen) {
   2289      1.52       mrg 		bus_addr_t busbuf;
   2290      1.52       mrg 
   2291      1.19        pk 		if ((error = xy_dmamem_alloc(xycsc->dmatag, xycsc->auxmap,
   2292      1.19        pk 					     &seg, &rseg,
   2293      1.70       mrg 					     xio->dlen, (void **)&buf,
   2294      1.52       mrg 					     &busbuf)) != 0) {
   2295       1.2        pk 			return (error);
   2296       1.2        pk 		}
   2297      1.69  christos 		dvmabuf = (void *)(u_long)BUS_ADDR_PADDR(busbuf);
   2298       1.1        pk 
   2299       1.1        pk 		if (xio->cmd == XYCMD_WR) {
   2300       1.2        pk 			if ((error = copyin(xio->dptr, buf, xio->dlen)) != 0) {
   2301       1.2        pk 				bus_dmamem_unmap(xycsc->dmatag, buf, xio->dlen);
   2302       1.2        pk 				bus_dmamem_free(xycsc->dmatag, &seg, rseg);
   2303       1.2        pk 				return (error);
   2304       1.1        pk 			}
   2305       1.1        pk 		}
   2306       1.1        pk 	}
   2307       1.1        pk 	/* do it! */
   2308       1.1        pk 
   2309       1.2        pk 	error = 0;
   2310       1.1        pk 	s = splbio();
   2311       1.1        pk 	rqno = xyc_cmd(xycsc, xio->cmd, xio->subfn, xy->xy_drive, xio->block,
   2312       1.1        pk 	    xio->sectcnt, dvmabuf, XY_SUB_WAIT);
   2313       1.1        pk 	if (rqno == XY_ERR_FAIL) {
   2314       1.2        pk 		error = EIO;
   2315       1.1        pk 		goto done;
   2316       1.1        pk 	}
   2317      1.67  christos 	xio->errnum = xycsc->ciorq->errnum;
   2318       1.1        pk 	xio->tries = xycsc->ciorq->tries;
   2319       1.1        pk 	XYC_DONE(xycsc, dummy);
   2320       1.1        pk 
   2321       1.1        pk 	if (xio->cmd == XYCMD_RD)
   2322       1.2        pk 		error = copyout(buf, xio->dptr, xio->dlen);
   2323       1.1        pk 
   2324       1.1        pk done:
   2325       1.1        pk 	splx(s);
   2326       1.2        pk 	if (dvmabuf) {
   2327      1.19        pk 		xy_dmamem_free(xycsc->dmatag, xycsc->auxmap, &seg, rseg,
   2328      1.19        pk 				xio->dlen, buf);
   2329       1.2        pk 	}
   2330       1.2        pk 	return (error);
   2331       1.1        pk }
   2332       1.1        pk 
   2333       1.1        pk /*
   2334       1.1        pk  * xyc_e2str: convert error code number into an error string
   2335       1.1        pk  */
   2336      1.59   tsutsui const char *
   2337       1.1        pk xyc_e2str(no)
   2338       1.1        pk 	int     no;
   2339       1.1        pk {
   2340       1.1        pk 	switch (no) {
   2341       1.1        pk 	case XY_ERR_FAIL:
   2342       1.1        pk 		return ("Software fatal error");
   2343       1.1        pk 	case XY_ERR_DERR:
   2344       1.1        pk 		return ("DOUBLE ERROR");
   2345       1.1        pk 	case XY_ERR_AOK:
   2346       1.1        pk 		return ("Successful completion");
   2347       1.1        pk 	case XY_ERR_IPEN:
   2348       1.1        pk 		return("Interrupt pending");
   2349       1.1        pk 	case XY_ERR_BCFL:
   2350       1.1        pk 		return("Busy conflict");
   2351       1.1        pk 	case XY_ERR_TIMO:
   2352       1.1        pk 		return("Operation timeout");
   2353       1.1        pk 	case XY_ERR_NHDR:
   2354       1.1        pk 		return("Header not found");
   2355       1.1        pk 	case XY_ERR_HARD:
   2356       1.1        pk 		return("Hard ECC error");
   2357       1.1        pk 	case XY_ERR_ICYL:
   2358       1.1        pk 		return("Illegal cylinder address");
   2359       1.1        pk 	case XY_ERR_ISEC:
   2360       1.1        pk 		return("Illegal sector address");
   2361       1.1        pk 	case XY_ERR_SMAL:
   2362       1.1        pk 		return("Last sector too small");
   2363       1.1        pk 	case XY_ERR_SACK:
   2364       1.1        pk 		return("Slave ACK error (non-existent memory)");
   2365       1.1        pk 	case XY_ERR_CHER:
   2366       1.1        pk 		return("Cylinder and head/header error");
   2367       1.1        pk 	case XY_ERR_SRTR:
   2368       1.1        pk 		return("Auto-seek retry successful");
   2369       1.1        pk 	case XY_ERR_WPRO:
   2370       1.1        pk 		return("Write-protect error");
   2371       1.1        pk 	case XY_ERR_UIMP:
   2372       1.1        pk 		return("Unimplemented command");
   2373       1.1        pk 	case XY_ERR_DNRY:
   2374       1.1        pk 		return("Drive not ready");
   2375       1.1        pk 	case XY_ERR_SZER:
   2376       1.1        pk 		return("Sector count zero");
   2377       1.1        pk 	case XY_ERR_DFLT:
   2378       1.1        pk 		return("Drive faulted");
   2379       1.1        pk 	case XY_ERR_ISSZ:
   2380       1.1        pk 		return("Illegal sector size");
   2381       1.1        pk 	case XY_ERR_SLTA:
   2382       1.1        pk 		return("Self test A");
   2383       1.1        pk 	case XY_ERR_SLTB:
   2384       1.1        pk 		return("Self test B");
   2385       1.1        pk 	case XY_ERR_SLTC:
   2386       1.1        pk 		return("Self test C");
   2387       1.1        pk 	case XY_ERR_SOFT:
   2388       1.1        pk 		return("Soft ECC error");
   2389       1.1        pk 	case XY_ERR_SFOK:
   2390       1.1        pk 		return("Soft ECC error recovered");
   2391       1.1        pk 	case XY_ERR_IHED:
   2392       1.1        pk 		return("Illegal head");
   2393       1.1        pk 	case XY_ERR_DSEQ:
   2394       1.1        pk 		return("Disk sequencer error");
   2395       1.1        pk 	case XY_ERR_SEEK:
   2396       1.1        pk 		return("Seek error");
   2397       1.1        pk 	default:
   2398       1.1        pk 		return ("Unknown error");
   2399       1.1        pk 	}
   2400       1.1        pk }
   2401       1.1        pk 
   2402       1.1        pk int
   2403      1.67  christos xyc_entoact(errnum)
   2404       1.1        pk 
   2405      1.67  christos int errnum;
   2406       1.1        pk 
   2407       1.1        pk {
   2408      1.67  christos   switch (errnum) {
   2409       1.1        pk     case XY_ERR_FAIL:	case XY_ERR_DERR:	case XY_ERR_IPEN:
   2410       1.1        pk     case XY_ERR_BCFL:	case XY_ERR_ICYL:	case XY_ERR_ISEC:
   2411       1.1        pk     case XY_ERR_UIMP:	case XY_ERR_SZER:	case XY_ERR_ISSZ:
   2412       1.1        pk     case XY_ERR_SLTA:	case XY_ERR_SLTB:	case XY_ERR_SLTC:
   2413       1.1        pk     case XY_ERR_IHED:	case XY_ERR_SACK:	case XY_ERR_SMAL:
   2414       1.1        pk 
   2415       1.1        pk 	return(XY_ERA_PROG); /* program error ! */
   2416       1.1        pk 
   2417       1.1        pk     case XY_ERR_TIMO:	case XY_ERR_NHDR:	case XY_ERR_HARD:
   2418       1.1        pk     case XY_ERR_DNRY:	case XY_ERR_CHER:	case XY_ERR_SEEK:
   2419       1.1        pk     case XY_ERR_SOFT:
   2420       1.1        pk 
   2421       1.1        pk 	return(XY_ERA_HARD); /* hard error, retry */
   2422       1.1        pk 
   2423       1.1        pk     case XY_ERR_DFLT:	case XY_ERR_DSEQ:
   2424       1.1        pk 
   2425       1.1        pk 	return(XY_ERA_RSET); /* hard error reset */
   2426       1.1        pk 
   2427       1.1        pk     case XY_ERR_SRTR:	case XY_ERR_SFOK:	case XY_ERR_AOK:
   2428       1.1        pk 
   2429       1.1        pk 	return(XY_ERA_SOFT); /* an FYI error */
   2430       1.1        pk 
   2431       1.1        pk     case XY_ERR_WPRO:
   2432       1.1        pk 
   2433       1.1        pk 	return(XY_ERA_WPRO); /* write protect */
   2434       1.1        pk   }
   2435       1.1        pk 
   2436       1.1        pk   return(XY_ERA_PROG); /* ??? */
   2437       1.1        pk }
   2438