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