Home | History | Annotate | Line # | Download | only in usb
umass_scsipi.c revision 1.9.2.7
      1  1.9.2.7     skrll /*	$NetBSD: umass_scsipi.c,v 1.9.2.7 2005/11/10 14:08:06 skrll Exp $	*/
      2      1.1  augustss 
      3      1.1  augustss /*
      4  1.9.2.1     skrll  * Copyright (c) 2001, 2003 The NetBSD Foundation, Inc.
      5      1.1  augustss  * All rights reserved.
      6      1.1  augustss  *
      7      1.1  augustss  * This code is derived from software contributed to The NetBSD Foundation
      8      1.1  augustss  * by Lennart Augustsson (lennart (at) augustsson.net) at
      9  1.9.2.1     skrll  * Carlstedt Research & Technology and by Charles M. Hamnnum.
     10      1.1  augustss  *
     11      1.1  augustss  * Redistribution and use in source and binary forms, with or without
     12      1.1  augustss  * modification, are permitted provided that the following conditions
     13      1.1  augustss  * are met:
     14      1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     15      1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     16      1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     17      1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     18      1.1  augustss  *    documentation and/or other materials provided with the distribution.
     19      1.1  augustss  * 3. All advertising materials mentioning features or use of this software
     20      1.1  augustss  *    must display the following acknowledgement:
     21      1.1  augustss  *        This product includes software developed by the NetBSD
     22      1.1  augustss  *        Foundation, Inc. and its contributors.
     23      1.1  augustss  * 4. Neither the name of The NetBSD Foundation nor the names of its
     24      1.1  augustss  *    contributors may be used to endorse or promote products derived
     25      1.1  augustss  *    from this software without specific prior written permission.
     26      1.1  augustss  *
     27      1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     28      1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     29      1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     30      1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     31      1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32      1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33      1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34      1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35      1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36      1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37      1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     38      1.1  augustss  */
     39      1.1  augustss 
     40      1.1  augustss #include <sys/cdefs.h>
     41  1.9.2.7     skrll __KERNEL_RCSID(0, "$NetBSD: umass_scsipi.c,v 1.9.2.7 2005/11/10 14:08:06 skrll Exp $");
     42      1.1  augustss 
     43      1.1  augustss #include "atapibus.h"
     44      1.1  augustss #include "scsibus.h"
     45      1.1  augustss 
     46      1.1  augustss #include <sys/param.h>
     47      1.1  augustss #include <sys/systm.h>
     48      1.1  augustss #include <sys/kernel.h>
     49      1.1  augustss #include <sys/conf.h>
     50      1.1  augustss #include <sys/buf.h>
     51  1.9.2.5     skrll #include <sys/bufq.h>
     52      1.1  augustss #include <sys/device.h>
     53      1.1  augustss #include <sys/ioctl.h>
     54      1.1  augustss #include <sys/malloc.h>
     55      1.1  augustss 
     56      1.1  augustss /* SCSI & ATAPI */
     57      1.1  augustss #include <sys/scsiio.h>
     58  1.9.2.6     skrll #include <dev/scsipi/scsi_spc.h>
     59      1.1  augustss #include <dev/scsipi/scsi_all.h>
     60      1.1  augustss #include <dev/scsipi/scsipi_all.h>
     61      1.1  augustss #include <dev/scsipi/scsiconf.h>
     62      1.1  augustss 
     63      1.1  augustss #include <dev/scsipi/atapiconf.h>
     64      1.1  augustss 
     65      1.1  augustss #include <dev/scsipi/scsipi_disk.h>
     66      1.1  augustss #include <dev/scsipi/scsi_disk.h>
     67      1.1  augustss #include <dev/scsipi/scsi_changer.h>
     68      1.1  augustss 
     69      1.1  augustss #include <sys/disk.h>		/* XXX */
     70      1.1  augustss #include <dev/scsipi/sdvar.h>	/* XXX */
     71      1.1  augustss 
     72      1.1  augustss /* USB */
     73      1.1  augustss #include <dev/usb/usb.h>
     74      1.1  augustss #include <dev/usb/usbdi.h>
     75      1.1  augustss #include <dev/usb/usbdi_util.h>
     76      1.1  augustss #include <dev/usb/usbdevs.h>
     77      1.1  augustss 
     78      1.1  augustss #include <dev/usb/umassvar.h>
     79      1.1  augustss #include <dev/usb/umass_scsipi.h>
     80      1.1  augustss 
     81      1.1  augustss struct umass_scsipi_softc {
     82      1.1  augustss 	struct umassbus_softc	base;
     83      1.1  augustss 
     84      1.1  augustss 	struct atapi_adapter	sc_atapi_adapter;
     85      1.1  augustss #define sc_adapter sc_atapi_adapter._generic
     86      1.1  augustss 	struct scsipi_channel sc_channel;
     87      1.1  augustss 	usbd_status		sc_sync_status;
     88  1.9.2.6     skrll 	struct scsi_request_sense	sc_sense_cmd;
     89      1.1  augustss };
     90      1.1  augustss 
     91      1.1  augustss 
     92      1.1  augustss #define SHORT_INQUIRY_LENGTH    36 /* XXX */
     93      1.1  augustss 
     94      1.1  augustss #define UMASS_ATAPI_DRIVE	0
     95      1.1  augustss 
     96      1.1  augustss Static void umass_scsipi_request(struct scsipi_channel *,
     97      1.1  augustss 				 scsipi_adapter_req_t, void *);
     98      1.1  augustss Static void umass_scsipi_minphys(struct buf *bp);
     99      1.1  augustss Static int umass_scsipi_ioctl(struct scsipi_channel *, u_long,
    100      1.4  augustss 			      caddr_t, int, usb_proc_ptr );
    101      1.1  augustss Static int umass_scsipi_getgeom(struct scsipi_periph *periph,
    102      1.1  augustss 				struct disk_parms *, u_long sectors);
    103      1.1  augustss 
    104      1.1  augustss Static void umass_scsipi_cb(struct umass_softc *sc, void *priv,
    105      1.1  augustss 			    int residue, int status);
    106      1.1  augustss Static void umass_scsipi_sense_cb(struct umass_softc *sc, void *priv,
    107      1.1  augustss 				  int residue, int status);
    108      1.1  augustss 
    109      1.1  augustss Static struct umass_scsipi_softc *umass_scsipi_setup(struct umass_softc *sc);
    110      1.1  augustss 
    111      1.1  augustss #if NATAPIBUS > 0
    112      1.1  augustss Static void umass_atapi_probe_device(struct atapibus_softc *, int);
    113      1.1  augustss 
    114      1.1  augustss const struct scsipi_bustype umass_atapi_bustype = {
    115      1.1  augustss 	SCSIPI_BUSTYPE_ATAPI,
    116      1.1  augustss 	atapi_scsipi_cmd,
    117      1.1  augustss 	atapi_interpret_sense,
    118      1.1  augustss 	atapi_print_addr,
    119      1.1  augustss 	scsi_kill_pending,
    120      1.1  augustss };
    121      1.1  augustss #endif
    122      1.1  augustss 
    123      1.1  augustss 
    124      1.1  augustss #if NSCSIBUS > 0
    125      1.1  augustss int
    126      1.1  augustss umass_scsi_attach(struct umass_softc *sc)
    127      1.1  augustss {
    128      1.1  augustss 	struct umass_scsipi_softc *scbus;
    129      1.1  augustss 
    130      1.1  augustss 	scbus = umass_scsipi_setup(sc);
    131      1.1  augustss 
    132      1.1  augustss 	scbus->sc_channel.chan_bustype = &scsi_bustype;
    133  1.9.2.1     skrll 	scbus->sc_channel.chan_ntargets = 2;
    134      1.1  augustss 	scbus->sc_channel.chan_nluns = sc->maxlun + 1;
    135  1.9.2.1     skrll 	scbus->sc_channel.chan_id = scbus->sc_channel.chan_ntargets - 1;
    136      1.1  augustss 	DPRINTF(UDMASS_USB, ("%s: umass_attach_bus: SCSI\n",
    137      1.1  augustss 			     USBDEVNAME(sc->sc_dev)));
    138      1.9  augustss 
    139      1.9  augustss 	sc->sc_refcnt++;
    140      1.1  augustss 	scbus->base.sc_child =
    141  1.9.2.7     skrll 	    config_found_ia(&sc->sc_dev, "scsi", &scbus->sc_channel,
    142  1.9.2.7     skrll 		scsiprint);
    143      1.9  augustss 	if (--sc->sc_refcnt < 0)
    144      1.9  augustss 		usb_detach_wakeup(USBDEV(sc->sc_dev));
    145      1.1  augustss 
    146      1.1  augustss 	return (0);
    147      1.1  augustss }
    148      1.1  augustss #endif
    149      1.1  augustss 
    150      1.1  augustss #if NATAPIBUS > 0
    151      1.1  augustss int
    152      1.1  augustss umass_atapi_attach(struct umass_softc *sc)
    153      1.1  augustss {
    154      1.1  augustss 	struct umass_scsipi_softc *scbus;
    155      1.1  augustss 
    156      1.1  augustss 	scbus = umass_scsipi_setup(sc);
    157      1.1  augustss 	scbus->sc_atapi_adapter.atapi_probe_device =  umass_atapi_probe_device;
    158      1.1  augustss 
    159      1.1  augustss 	scbus->sc_channel.chan_bustype = &umass_atapi_bustype;
    160      1.1  augustss 	scbus->sc_channel.chan_ntargets = 2;
    161      1.1  augustss 	scbus->sc_channel.chan_nluns = 1;
    162      1.1  augustss 
    163      1.2  augustss 	scbus->sc_channel.chan_defquirks |= sc->sc_busquirks;
    164      1.1  augustss 	DPRINTF(UDMASS_USB, ("%s: umass_attach_bus: ATAPI\n",
    165      1.1  augustss 			     USBDEVNAME(sc->sc_dev)));
    166      1.9  augustss 
    167      1.9  augustss 	sc->sc_refcnt++;
    168      1.1  augustss 	scbus->base.sc_child =
    169  1.9.2.7     skrll 	    config_found_ia(&sc->sc_dev, "atapi", &scbus->sc_channel,
    170  1.9.2.7     skrll 		atapiprint);
    171      1.9  augustss 	if (--sc->sc_refcnt < 0)
    172      1.9  augustss 		usb_detach_wakeup(USBDEV(sc->sc_dev));
    173      1.1  augustss 
    174      1.1  augustss 	return (0);
    175      1.1  augustss }
    176      1.1  augustss #endif
    177      1.1  augustss 
    178      1.1  augustss Static struct umass_scsipi_softc *
    179      1.1  augustss umass_scsipi_setup(struct umass_softc *sc)
    180      1.1  augustss {
    181      1.1  augustss 	struct umass_scsipi_softc *scbus;
    182      1.1  augustss 
    183      1.1  augustss 	scbus = malloc(sizeof *scbus, M_DEVBUF, M_WAITOK | M_ZERO);
    184      1.1  augustss 	sc->bus = &scbus->base;
    185      1.3  augustss 
    186      1.3  augustss 	/* Only use big commands for USB SCSI devices. */
    187      1.3  augustss 	sc->sc_busquirks |= PQUIRK_ONLYBIG;
    188      1.1  augustss 
    189      1.1  augustss 	/* Fill in the adapter. */
    190      1.1  augustss 	memset(&scbus->sc_adapter, 0, sizeof(scbus->sc_adapter));
    191      1.1  augustss 	scbus->sc_adapter.adapt_dev = &sc->sc_dev;
    192      1.1  augustss 	scbus->sc_adapter.adapt_nchannels = 1;
    193      1.1  augustss 	scbus->sc_adapter.adapt_request = umass_scsipi_request;
    194      1.1  augustss 	scbus->sc_adapter.adapt_minphys = umass_scsipi_minphys;
    195      1.1  augustss 	scbus->sc_adapter.adapt_ioctl = umass_scsipi_ioctl;
    196      1.1  augustss 	scbus->sc_adapter.adapt_getgeom = umass_scsipi_getgeom;
    197      1.1  augustss 
    198      1.1  augustss 	/* Fill in the channel. */
    199      1.1  augustss 	memset(&scbus->sc_channel, 0, sizeof(scbus->sc_channel));
    200      1.1  augustss 	scbus->sc_channel.chan_adapter = &scbus->sc_adapter;
    201      1.1  augustss 	scbus->sc_channel.chan_channel = 0;
    202  1.9.2.1     skrll 	scbus->sc_channel.chan_flags = SCSIPI_CHAN_OPENINGS | SCSIPI_CHAN_NOSETTLE;
    203      1.1  augustss 	scbus->sc_channel.chan_openings = 1;
    204      1.1  augustss 	scbus->sc_channel.chan_max_periph = 1;
    205      1.2  augustss 	scbus->sc_channel.chan_defquirks |= sc->sc_busquirks;
    206      1.1  augustss 
    207      1.1  augustss 	return (scbus);
    208      1.1  augustss }
    209      1.5  augustss 
    210      1.1  augustss Static void
    211      1.1  augustss umass_scsipi_request(struct scsipi_channel *chan,
    212      1.1  augustss 		scsipi_adapter_req_t req, void *arg)
    213      1.1  augustss {
    214      1.1  augustss 	struct scsipi_adapter *adapt = chan->chan_adapter;
    215      1.1  augustss 	struct scsipi_periph *periph;
    216      1.1  augustss 	struct scsipi_xfer *xs;
    217      1.1  augustss 	struct umass_softc *sc = (void *)adapt->adapt_dev;
    218      1.1  augustss 	struct umass_scsipi_softc *scbus = (struct umass_scsipi_softc *)sc->bus;
    219  1.9.2.1     skrll 	struct scsipi_generic *cmd;
    220      1.1  augustss 	int cmdlen;
    221      1.1  augustss 	int dir;
    222      1.1  augustss #ifdef UMASS_DEBUG
    223      1.1  augustss 	microtime(&sc->tv);
    224      1.1  augustss #endif
    225      1.1  augustss 	switch(req) {
    226      1.1  augustss 	case ADAPTER_REQ_RUN_XFER:
    227      1.1  augustss 		xs = arg;
    228      1.1  augustss 		periph = xs->xs_periph;
    229      1.1  augustss 		DIF(UDMASS_UPPER, periph->periph_dbflags |= SCSIPI_DEBUG_FLAGS);
    230      1.1  augustss 
    231      1.1  augustss 		DPRINTF(UDMASS_CMD, ("%s: umass_scsi_cmd: at %lu.%06lu: %d:%d "
    232      1.1  augustss 		    "xs=%p cmd=0x%02x datalen=%d (quirks=0x%x, poll=%d)\n",
    233      1.1  augustss 		    USBDEVNAME(sc->sc_dev), sc->tv.tv_sec, sc->tv.tv_usec,
    234      1.1  augustss 		    periph->periph_target, periph->periph_lun,
    235      1.1  augustss 		    xs, xs->cmd->opcode, xs->datalen,
    236      1.1  augustss 		    periph->periph_quirks, xs->xs_control & XS_CTL_POLL));
    237      1.1  augustss #if defined(USB_DEBUG) && defined(SCSIPI_DEBUG)
    238      1.1  augustss 		if (umassdebug & UDMASS_SCSI)
    239      1.1  augustss 			show_scsipi_xs(xs);
    240      1.1  augustss 		else if (umassdebug & ~UDMASS_CMD)
    241      1.1  augustss 			show_scsipi_cmd(xs);
    242      1.1  augustss #endif
    243      1.1  augustss 
    244      1.1  augustss 		if (sc->sc_dying) {
    245      1.1  augustss 			xs->error = XS_DRIVER_STUFFUP;
    246      1.1  augustss 			goto done;
    247      1.1  augustss 		}
    248      1.1  augustss 
    249      1.1  augustss #ifdef UMASS_DEBUG
    250      1.1  augustss 		if (chan->chan_bustype->bustype_type == SCSIPI_BUSTYPE_ATAPI ?
    251      1.1  augustss 		    periph->periph_target != UMASS_ATAPI_DRIVE :
    252  1.9.2.1     skrll 		    periph->periph_target == chan->chan_id) {
    253      1.1  augustss 			DPRINTF(UDMASS_SCSI, ("%s: wrong SCSI ID %d\n",
    254      1.1  augustss 			    USBDEVNAME(sc->sc_dev),
    255      1.1  augustss 			    periph->periph_target));
    256      1.1  augustss 			xs->error = XS_DRIVER_STUFFUP;
    257      1.1  augustss 			goto done;
    258      1.1  augustss 		}
    259      1.1  augustss #endif
    260      1.1  augustss 
    261      1.1  augustss 		cmd = xs->cmd;
    262      1.1  augustss 		cmdlen = xs->cmdlen;
    263      1.1  augustss 
    264      1.1  augustss 		dir = DIR_NONE;
    265      1.1  augustss 		if (xs->datalen) {
    266      1.1  augustss 			switch (xs->xs_control &
    267      1.1  augustss 			    (XS_CTL_DATA_IN | XS_CTL_DATA_OUT)) {
    268      1.1  augustss 			case XS_CTL_DATA_IN:
    269      1.1  augustss 				dir = DIR_IN;
    270      1.1  augustss 				break;
    271      1.1  augustss 			case XS_CTL_DATA_OUT:
    272      1.1  augustss 				dir = DIR_OUT;
    273      1.1  augustss 				break;
    274      1.1  augustss 			}
    275      1.1  augustss 		}
    276      1.1  augustss 
    277      1.1  augustss 		if (xs->datalen > UMASS_MAX_TRANSFER_SIZE) {
    278      1.1  augustss 			printf("umass_cmd: large datalen, %d\n", xs->datalen);
    279      1.1  augustss 			xs->error = XS_DRIVER_STUFFUP;
    280      1.1  augustss 			goto done;
    281      1.1  augustss 		}
    282      1.1  augustss 
    283      1.1  augustss 		if (xs->xs_control & XS_CTL_POLL) {
    284      1.1  augustss 			/* Use sync transfer. XXX Broken! */
    285      1.1  augustss 			DPRINTF(UDMASS_SCSI,
    286      1.1  augustss 			    ("umass_scsi_cmd: sync dir=%d\n", dir));
    287      1.1  augustss 			sc->sc_xfer_flags = USBD_SYNCHRONOUS;
    288      1.1  augustss 			scbus->sc_sync_status = USBD_INVAL;
    289      1.1  augustss 			sc->sc_methods->wire_xfer(sc, periph->periph_lun, cmd,
    290      1.1  augustss 						  cmdlen, xs->data,
    291      1.1  augustss 						  xs->datalen, dir,
    292      1.1  augustss 						  xs->timeout, 0, xs);
    293      1.1  augustss 			sc->sc_xfer_flags = 0;
    294      1.5  augustss 			DPRINTF(UDMASS_SCSI, ("umass_scsi_cmd: done err=%d\n",
    295      1.1  augustss 					      scbus->sc_sync_status));
    296      1.1  augustss 			switch (scbus->sc_sync_status) {
    297      1.1  augustss 			case USBD_NORMAL_COMPLETION:
    298      1.1  augustss 				xs->error = XS_NOERROR;
    299      1.1  augustss 				break;
    300      1.1  augustss 			case USBD_TIMEOUT:
    301      1.1  augustss 				xs->error = XS_TIMEOUT;
    302      1.1  augustss 				break;
    303      1.1  augustss 			default:
    304      1.1  augustss 				xs->error = XS_DRIVER_STUFFUP;
    305      1.1  augustss 				break;
    306      1.1  augustss 			}
    307      1.1  augustss 			goto done;
    308      1.1  augustss 		} else {
    309      1.1  augustss 			DPRINTF(UDMASS_SCSI,
    310      1.1  augustss 			    ("umass_scsi_cmd: async dir=%d, cmdlen=%d"
    311      1.1  augustss 				      " datalen=%d\n",
    312      1.1  augustss 				      dir, cmdlen, xs->datalen));
    313      1.1  augustss 			sc->sc_methods->wire_xfer(sc, periph->periph_lun, cmd,
    314      1.1  augustss 						  cmdlen, xs->data,
    315      1.1  augustss 						  xs->datalen, dir,
    316      1.1  augustss 						  xs->timeout,
    317      1.1  augustss 						  umass_scsipi_cb, xs);
    318      1.1  augustss 			return;
    319      1.1  augustss 		}
    320      1.1  augustss 
    321      1.1  augustss 		/* Return if command finishes early. */
    322      1.1  augustss  done:
    323      1.1  augustss 		scsipi_done(xs);
    324      1.1  augustss 		return;
    325      1.1  augustss 	default:
    326      1.1  augustss 		/* Not supported, nothing to do. */
    327      1.1  augustss 		;
    328      1.1  augustss 	}
    329      1.1  augustss }
    330      1.1  augustss 
    331      1.1  augustss Static void
    332      1.1  augustss umass_scsipi_minphys(struct buf *bp)
    333      1.1  augustss {
    334      1.1  augustss #ifdef DIAGNOSTIC
    335      1.1  augustss 	if (bp->b_bcount <= 0) {
    336  1.9.2.4     skrll 		printf("umass_scsipi_minphys count(%d) <= 0\n",
    337      1.1  augustss 		       bp->b_bcount);
    338      1.1  augustss 		bp->b_bcount = UMASS_MAX_TRANSFER_SIZE;
    339      1.1  augustss 	}
    340      1.1  augustss #endif
    341      1.1  augustss 	if (bp->b_bcount > UMASS_MAX_TRANSFER_SIZE)
    342      1.1  augustss 		bp->b_bcount = UMASS_MAX_TRANSFER_SIZE;
    343      1.1  augustss 	minphys(bp);
    344      1.1  augustss }
    345      1.1  augustss 
    346      1.1  augustss int
    347      1.1  augustss umass_scsipi_ioctl(struct scsipi_channel *chan, u_long cmd, caddr_t arg,
    348      1.4  augustss 		   int flag, usb_proc_ptr p)
    349      1.1  augustss {
    350      1.1  augustss 	/*struct umass_softc *sc = link->adapter_softc;*/
    351      1.1  augustss 	/*struct umass_scsipi_softc *scbus = sc->bus;*/
    352      1.1  augustss 
    353      1.1  augustss 	switch (cmd) {
    354      1.1  augustss #if 0
    355      1.1  augustss 	case SCBUSIORESET:
    356      1.1  augustss 		ccb->ccb_h.status = CAM_REQ_INPROG;
    357      1.1  augustss 		umass_reset(sc, umass_cam_cb, (void *) ccb);
    358      1.1  augustss 		return (0);
    359      1.1  augustss #endif
    360      1.1  augustss 	default:
    361      1.1  augustss 		return (ENOTTY);
    362      1.1  augustss 	}
    363      1.1  augustss }
    364      1.1  augustss 
    365      1.1  augustss Static int
    366      1.1  augustss umass_scsipi_getgeom(struct scsipi_periph *periph, struct disk_parms *dp,
    367      1.1  augustss 		     u_long sectors)
    368      1.1  augustss {
    369      1.1  augustss 	struct umass_softc *sc =
    370      1.1  augustss 	    (void *)periph->periph_channel->chan_adapter->adapt_dev;
    371      1.1  augustss 
    372      1.1  augustss 	/* If it's not a floppy, we don't know what to do. */
    373      1.1  augustss 	if (sc->sc_cmd != UMASS_CPROTO_UFI)
    374      1.1  augustss 		return (0);
    375      1.1  augustss 
    376      1.1  augustss 	switch (sectors) {
    377      1.1  augustss 	case 1440:
    378      1.1  augustss 		/* Most likely a single density 3.5" floppy. */
    379      1.1  augustss 		dp->heads = 2;
    380      1.1  augustss 		dp->sectors = 9;
    381      1.1  augustss 		dp->cyls = 80;
    382      1.1  augustss 		return (1);
    383      1.1  augustss 	case 2880:
    384      1.1  augustss 		/* Most likely a double density 3.5" floppy. */
    385      1.1  augustss 		dp->heads = 2;
    386      1.1  augustss 		dp->sectors = 18;
    387      1.1  augustss 		dp->cyls = 80;
    388      1.1  augustss 		return (1);
    389      1.1  augustss 	default:
    390      1.1  augustss 		return (0);
    391      1.1  augustss 	}
    392      1.1  augustss }
    393      1.1  augustss 
    394      1.1  augustss Static void
    395      1.1  augustss umass_scsipi_cb(struct umass_softc *sc, void *priv, int residue, int status)
    396      1.1  augustss {
    397      1.1  augustss 	struct umass_scsipi_softc *scbus = (struct umass_scsipi_softc *)sc->bus;
    398      1.1  augustss 	struct scsipi_xfer *xs = priv;
    399      1.1  augustss 	struct scsipi_periph *periph = xs->xs_periph;
    400      1.1  augustss 	int cmdlen;
    401      1.1  augustss 	int s;
    402      1.1  augustss #ifdef UMASS_DEBUG
    403      1.1  augustss 	struct timeval tv;
    404      1.1  augustss 	u_int delta;
    405      1.1  augustss 	microtime(&tv);
    406      1.1  augustss 	delta = (tv.tv_sec - sc->tv.tv_sec) * 1000000 + tv.tv_usec - sc->tv.tv_usec;
    407      1.1  augustss #endif
    408      1.1  augustss 
    409      1.1  augustss 	DPRINTF(UDMASS_CMD,("umass_scsipi_cb: at %lu.%06lu, delta=%u: xs=%p residue=%d"
    410      1.1  augustss 	    " status=%d\n", tv.tv_sec, tv.tv_usec, delta, xs, residue, status));
    411      1.1  augustss 
    412      1.1  augustss 	xs->resid = residue;
    413      1.1  augustss 
    414      1.1  augustss 	switch (status) {
    415      1.1  augustss 	case STATUS_CMD_OK:
    416      1.1  augustss 		xs->error = XS_NOERROR;
    417      1.1  augustss 		break;
    418      1.1  augustss 
    419      1.1  augustss 	case STATUS_CMD_UNKNOWN:
    420      1.1  augustss 		/* FALLTHROUGH */
    421      1.1  augustss 	case STATUS_CMD_FAILED:
    422      1.1  augustss 		/* fetch sense data */
    423  1.9.2.1     skrll 		sc->sc_sense = 1;
    424      1.1  augustss 		memset(&scbus->sc_sense_cmd, 0, sizeof(scbus->sc_sense_cmd));
    425  1.9.2.6     skrll 		scbus->sc_sense_cmd.opcode = SCSI_REQUEST_SENSE;
    426      1.1  augustss 		scbus->sc_sense_cmd.byte2 = periph->periph_lun <<
    427      1.1  augustss 		    SCSI_CMD_LUN_SHIFT;
    428      1.1  augustss 		scbus->sc_sense_cmd.length = sizeof(xs->sense);
    429      1.1  augustss 
    430  1.9.2.1     skrll 		if (sc->sc_cmd == UMASS_CPROTO_UFI ||
    431  1.9.2.1     skrll 		    sc->sc_cmd == UMASS_CPROTO_ATAPI)
    432  1.9.2.1     skrll 			cmdlen = UFI_COMMAND_LENGTH;	/* XXX */
    433  1.9.2.1     skrll 		else
    434  1.9.2.1     skrll 			cmdlen = sizeof(scbus->sc_sense_cmd);
    435      1.1  augustss 		sc->sc_methods->wire_xfer(sc, periph->periph_lun,
    436      1.1  augustss 					  &scbus->sc_sense_cmd, cmdlen,
    437      1.1  augustss 					  &xs->sense, sizeof(xs->sense),
    438      1.1  augustss 					  DIR_IN, xs->timeout,
    439      1.1  augustss 					  umass_scsipi_sense_cb, xs);
    440      1.1  augustss 		return;
    441      1.1  augustss 
    442      1.1  augustss 	case STATUS_WIRE_FAILED:
    443      1.1  augustss 		xs->error = XS_RESET;
    444      1.1  augustss 		break;
    445      1.1  augustss 
    446      1.1  augustss 	default:
    447      1.6    provos 		panic("%s: Unknown status %d in umass_scsipi_cb",
    448      1.1  augustss 			USBDEVNAME(sc->sc_dev), status);
    449      1.1  augustss 	}
    450      1.1  augustss 
    451      1.1  augustss 	DPRINTF(UDMASS_CMD,("umass_scsipi_cb: at %lu.%06lu: return xs->error="
    452      1.1  augustss             "%d, xs->xs_status=0x%x xs->resid=%d\n",
    453      1.1  augustss 	     tv.tv_sec, tv.tv_usec,
    454      1.1  augustss 	     xs->error, xs->xs_status, xs->resid));
    455      1.1  augustss 
    456      1.1  augustss 	s = splbio();
    457      1.1  augustss 	scsipi_done(xs);
    458      1.1  augustss 	splx(s);
    459      1.1  augustss }
    460      1.1  augustss 
    461      1.5  augustss /*
    462      1.1  augustss  * Finalise a completed autosense operation
    463      1.1  augustss  */
    464      1.1  augustss Static void
    465      1.1  augustss umass_scsipi_sense_cb(struct umass_softc *sc, void *priv, int residue,
    466      1.1  augustss 		      int status)
    467      1.1  augustss {
    468      1.1  augustss 	struct scsipi_xfer *xs = priv;
    469      1.1  augustss 	int s;
    470      1.1  augustss 
    471      1.1  augustss 	DPRINTF(UDMASS_CMD,("umass_scsipi_sense_cb: xs=%p residue=%d "
    472      1.1  augustss 		"status=%d\n", xs, residue, status));
    473      1.1  augustss 
    474  1.9.2.1     skrll 	sc->sc_sense = 0;
    475      1.1  augustss 	switch (status) {
    476      1.1  augustss 	case STATUS_CMD_OK:
    477      1.1  augustss 	case STATUS_CMD_UNKNOWN:
    478      1.1  augustss 		/* getting sense data succeeded */
    479      1.1  augustss 		if (residue == 0 || residue == 14)/* XXX */
    480      1.1  augustss 			xs->error = XS_SENSE;
    481      1.1  augustss 		else
    482      1.1  augustss 			xs->error = XS_SHORTSENSE;
    483      1.1  augustss 		break;
    484      1.1  augustss 	default:
    485      1.1  augustss 		DPRINTF(UDMASS_SCSI, ("%s: Autosense failed, status %d\n",
    486      1.1  augustss 			USBDEVNAME(sc->sc_dev), status));
    487      1.1  augustss 		xs->error = XS_DRIVER_STUFFUP;
    488      1.1  augustss 		break;
    489      1.1  augustss 	}
    490      1.1  augustss 
    491      1.1  augustss 	DPRINTF(UDMASS_CMD,("umass_scsipi_sense_cb: return xs->error=%d, "
    492      1.1  augustss 		"xs->xs_status=0x%x xs->resid=%d\n", xs->error, xs->xs_status,
    493      1.1  augustss 		xs->resid));
    494      1.1  augustss 
    495      1.1  augustss 	s = splbio();
    496      1.1  augustss 	scsipi_done(xs);
    497      1.1  augustss 	splx(s);
    498      1.1  augustss }
    499      1.1  augustss 
    500      1.1  augustss #if NATAPIBUS > 0
    501      1.1  augustss Static void
    502      1.1  augustss umass_atapi_probe_device(struct atapibus_softc *atapi, int target)
    503      1.1  augustss {
    504      1.1  augustss 	struct scsipi_channel *chan = atapi->sc_channel;
    505      1.1  augustss 	struct scsipi_periph *periph;
    506      1.1  augustss 	struct scsipibus_attach_args sa;
    507      1.1  augustss 	char vendor[33], product[65], revision[17];
    508      1.1  augustss 	struct scsipi_inquiry_data inqbuf;
    509      1.1  augustss 
    510      1.1  augustss 	DPRINTF(UDMASS_SCSI,("umass_atapi_probe_device: atapi=%p target=%d\n",
    511      1.1  augustss 			     atapi, target));
    512      1.1  augustss 
    513      1.1  augustss 	if (target != UMASS_ATAPI_DRIVE)	/* only probe drive 0 */
    514      1.1  augustss 		return;
    515      1.1  augustss 
    516      1.1  augustss 	/* skip if already attached */
    517      1.1  augustss 	if (scsipi_lookup_periph(chan, target, 0) != NULL)
    518      1.1  augustss 		return;
    519      1.1  augustss 
    520      1.1  augustss 	periph = scsipi_alloc_periph(M_NOWAIT);
    521      1.1  augustss 	if (periph == NULL) {
    522      1.1  augustss 		printf("%s: can't allocate link for drive %d\n",
    523      1.1  augustss 		       atapi->sc_dev.dv_xname, target);
    524      1.5  augustss 		return;
    525      1.1  augustss 	}
    526      1.1  augustss 
    527      1.1  augustss 	DIF(UDMASS_UPPER, periph->periph_dbflags |= 1); /* XXX 1 */
    528      1.1  augustss 	periph->periph_channel = chan;
    529      1.1  augustss 	periph->periph_switch = &atapi_probe_periphsw;
    530      1.1  augustss 	periph->periph_target = target;
    531      1.1  augustss 	periph->periph_quirks = chan->chan_defquirks;
    532      1.1  augustss 
    533      1.1  augustss 	DPRINTF(UDMASS_SCSI, ("umass_atapi_probe_device: doing inquiry\n"));
    534      1.1  augustss 	/* Now go ask the device all about itself. */
    535      1.1  augustss 	memset(&inqbuf, 0, sizeof(inqbuf));
    536      1.1  augustss 	if (scsipi_inquire(periph, &inqbuf,
    537      1.1  augustss 	    XS_CTL_DISCOVERY | XS_CTL_DATA_ONSTACK) != 0) {
    538      1.1  augustss 		DPRINTF(UDMASS_SCSI, ("umass_atapi_probe_device: "
    539      1.1  augustss 		    "scsipi_inquire failed\n"));
    540      1.1  augustss 		free(periph, M_DEVBUF);
    541      1.1  augustss 		return;
    542      1.1  augustss 	}
    543      1.1  augustss 
    544      1.1  augustss 	scsipi_strvis(vendor, 33, inqbuf.vendor, 8);
    545      1.1  augustss 	scsipi_strvis(product, 65, inqbuf.product, 16);
    546      1.1  augustss 	scsipi_strvis(revision, 17, inqbuf.revision, 4);
    547      1.1  augustss 
    548      1.1  augustss 	sa.sa_periph = periph;
    549      1.1  augustss 	sa.sa_inqbuf.type = inqbuf.device;
    550      1.1  augustss 	sa.sa_inqbuf.removable = inqbuf.dev_qual2 & SID_REMOVABLE ?
    551      1.1  augustss 	    T_REMOV : T_FIXED;
    552      1.1  augustss 	if (sa.sa_inqbuf.removable)
    553      1.1  augustss 		periph->periph_flags |= PERIPH_REMOVABLE;
    554      1.1  augustss 	sa.sa_inqbuf.vendor = vendor;
    555      1.1  augustss 	sa.sa_inqbuf.product = product;
    556      1.1  augustss 	sa.sa_inqbuf.revision = revision;
    557      1.1  augustss 	sa.sa_inqptr = NULL;
    558      1.1  augustss 
    559      1.1  augustss 	DPRINTF(UDMASS_SCSI, ("umass_atapi_probedev: doing atapi_probedev on "
    560      1.1  augustss 			      "'%s' '%s' '%s'\n", vendor, product, revision));
    561      1.1  augustss 	atapi_probe_device(atapi, target, periph, &sa);
    562      1.1  augustss 	/* atapi_probe_device() frees the periph when there is no device.*/
    563      1.1  augustss }
    564      1.1  augustss #endif
    565