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