Home | History | Annotate | Line # | Download | only in boot
sd.c revision 1.2
      1 /*	$NetBSD: sd.c,v 1.2 2014/06/10 18:37:26 phx Exp $	*/
      2 /*
      3  * Copyright (c) 2010 KIYOHARA Takashi
      4  * All rights reserved.
      5  *
      6  * Redistribution and use in source and binary forms, with or without
      7  * modification, are permitted provided that the following conditions
      8  * are met:
      9  * 1. Redistributions of source code must retain the above copyright
     10  *    notice, this list of conditions and the following disclaimer.
     11  * 2. Redistributions in binary form must reproduce the above copyright
     12  *    notice, this list of conditions and the following disclaimer in the
     13  *    documentation and/or other materials provided with the distribution.
     14  *
     15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     17  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     18  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     19  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     20  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     21  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     23  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     24  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     25  * POSSIBILITY OF SUCH DAMAGE.
     26  */
     27 
     28 #include <sys/param.h>
     29 #include <sys/types.h>
     30 #include <sys/stdint.h>
     31 
     32 #include <lib/libsa/stand.h>
     33 #include <lib/libkern/libkern.h>
     34 
     35 #include <machine/param.h>
     36 
     37 #include "boot.h"
     38 #include "sdvar.h"
     39 
     40 #ifdef DEBUG
     41 #define DPRINTF(x)	printf x
     42 #else
     43 #define DPRINTF(x)
     44 #endif
     45 
     46 #define SD_DEFAULT_BLKSIZE	512
     47 
     48 
     49 struct sd_mode_sense_data {
     50 	struct scsi_mode_parameter_header_6 header;
     51 	struct scsi_general_block_descriptor blk_desc;
     52 	union scsi_disk_pages pages;
     53 };
     54 
     55 static int sd_validate_blksize(int);
     56 static uint64_t sd_read_capacity(struct sd_softc *, int *);
     57 static int sd_get_simplifiedparms(struct sd_softc *);
     58 static int sd_get_capacity(struct sd_softc *);
     59 static int sd_get_parms_page4(struct sd_softc *, struct disk_parms *);
     60 static int sd_get_parms_page5(struct sd_softc *, struct disk_parms *);
     61 static int sd_get_parms(struct sd_softc *);
     62 static void sdgetdefaultlabel(struct sd_softc *, struct disklabel *);
     63 static int sdgetdisklabel(struct sd_softc *);
     64 
     65 int sdopen(struct open_file *, ...);
     66 int sdclose(struct open_file *);
     67 int sdstrategy(void *, int, daddr_t, size_t, void *, size_t *);
     68 
     69 
     70 static int
     71 sd_validate_blksize(int len)
     72 {
     73 
     74 	switch (len) {
     75 	case 256:
     76 	case 512:
     77 	case 1024:
     78 	case 2048:
     79 	case 4096:
     80 		return 1;
     81 	}
     82 	return 0;
     83 }
     84 
     85 /*
     86  * sd_read_capacity:
     87  *
     88  *	Find out from the device what its capacity is.
     89  */
     90 static uint64_t
     91 sd_read_capacity(struct sd_softc *sd, int *blksize)
     92 {
     93 	union {
     94 		struct scsipi_read_capacity_10 cmd;
     95 		struct scsipi_read_capacity_16 cmd16;
     96 	} cmd;
     97 	union {
     98 		struct scsipi_read_capacity_10_data data;
     99 		struct scsipi_read_capacity_16_data data16;
    100 	} data;
    101 	uint64_t rv;
    102 
    103 	memset(&cmd, 0, sizeof(cmd));
    104 	cmd.cmd.opcode = READ_CAPACITY_10;
    105 
    106 	/*
    107 	 * If the command works, interpret the result as a 4 byte
    108 	 * number of blocks
    109 	 */
    110 	rv = 0;
    111 	memset(&data, 0, sizeof(data.data));
    112 	if (scsi_command(sd, (void *)&cmd.cmd, sizeof(cmd.cmd),
    113 	    (void *)&data, sizeof(data.data)) != 0)
    114 		goto out;
    115 
    116 	if (_4btol(data.data.addr) != 0xffffffff) {
    117 		*blksize = _4btol(data.data.length);
    118 		rv = _4btol(data.data.addr) + 1;
    119 		goto out;
    120 	}
    121 
    122 	/*
    123 	 * Device is larger than can be reflected by READ CAPACITY (10).
    124 	 * Try READ CAPACITY (16).
    125 	 */
    126 
    127 	memset(&cmd, 0, sizeof(cmd));
    128 	cmd.cmd16.opcode = READ_CAPACITY_16;
    129 	cmd.cmd16.byte2 = SRC16_SERVICE_ACTION;
    130 	_lto4b(sizeof(data.data16), cmd.cmd16.len);
    131 
    132 	memset(&data, 0, sizeof(data.data16));
    133 	if (scsi_command(sd, (void *)&cmd.cmd16, sizeof(cmd.cmd16),
    134 	    (void *)&data, sizeof(data.data16)) != 0)
    135 		goto out;
    136 
    137 	*blksize = _4btol(data.data16.length);
    138 	rv = _8btol(data.data16.addr) + 1;
    139 
    140  out:
    141 	return rv;
    142 }
    143 
    144 static int
    145 sd_get_simplifiedparms(struct sd_softc *sd)
    146 {
    147 	struct {
    148 		struct scsi_mode_parameter_header_6 header;
    149 		/* no block descriptor */
    150 		uint8_t pg_code; /* page code (should be 6) */
    151 		uint8_t pg_length; /* page length (should be 11) */
    152 		uint8_t wcd; /* bit0: cache disable */
    153 		uint8_t lbs[2]; /* logical block size */
    154 		uint8_t size[5]; /* number of log. blocks */
    155 		uint8_t pp; /* power/performance */
    156 		uint8_t flags;
    157 		uint8_t resvd;
    158 	} scsipi_sense;
    159 	struct disk_parms *dp = &sd->sc_params;
    160 	uint64_t blocks;
    161 	int error, blksize;
    162 
    163 	/*
    164 	 * sd_read_capacity (ie "read capacity") and mode sense page 6
    165 	 * give the same information. Do both for now, and check
    166 	 * for consistency.
    167 	 * XXX probably differs for removable media
    168 	 */
    169 	dp->blksize = SD_DEFAULT_BLKSIZE;
    170 	if ((blocks = sd_read_capacity(sd, &blksize)) == 0)
    171 		return SDGP_RESULT_OFFLINE;		/* XXX? */
    172 
    173 	error = scsi_mode_sense(sd, SMS_DBD, 6,
    174 	    &scsipi_sense.header, sizeof(scsipi_sense));
    175 
    176 	if (error != 0)
    177 		return SDGP_RESULT_OFFLINE;		/* XXX? */
    178 
    179 	dp->blksize = blksize;
    180 	if (!sd_validate_blksize(dp->blksize))
    181 		dp->blksize = _2btol(scsipi_sense.lbs);
    182 	if (!sd_validate_blksize(dp->blksize))
    183 		dp->blksize = SD_DEFAULT_BLKSIZE;
    184 
    185 	/*
    186 	 * Create a pseudo-geometry.
    187 	 */
    188 	dp->heads = 64;
    189 	dp->sectors = 32;
    190 	dp->cyls = blocks / (dp->heads * dp->sectors);
    191 	dp->disksize = _5btol(scsipi_sense.size);
    192 	if (dp->disksize <= UINT32_MAX && dp->disksize != blocks) {
    193 		printf("RBC size: mode sense=%llu, get cap=%llu\n",
    194 		       (unsigned long long)dp->disksize,
    195 		       (unsigned long long)blocks);
    196 		dp->disksize = blocks;
    197 	}
    198 	dp->disksize512 = (dp->disksize * dp->blksize) / DEV_BSIZE;
    199 
    200 	return SDGP_RESULT_OK;
    201 }
    202 
    203 /*
    204  * Get the scsi driver to send a full inquiry to the * device and use the
    205  * results to fill out the disk parameter structure.
    206  */
    207 static int
    208 sd_get_capacity(struct sd_softc *sd)
    209 {
    210 	struct disk_parms *dp = &sd->sc_params;
    211 	uint64_t blocks;
    212 	int error, blksize;
    213 
    214 	dp->disksize = blocks = sd_read_capacity(sd, &blksize);
    215 	if (blocks == 0) {
    216 		struct scsipi_read_format_capacities cmd;
    217 		struct {
    218 			struct scsipi_capacity_list_header header;
    219 			struct scsipi_capacity_descriptor desc;
    220 		} __packed data;
    221 
    222 		memset(&cmd, 0, sizeof(cmd));
    223 		memset(&data, 0, sizeof(data));
    224 		cmd.opcode = READ_FORMAT_CAPACITIES;
    225 		_lto2b(sizeof(data), cmd.length);
    226 
    227 		error = scsi_command(sd,
    228 		    (void *)&cmd, sizeof(cmd), (void *)&data, sizeof(data));
    229 		if (error == EFTYPE)
    230 			/* Medium Format Corrupted, handle as not formatted */
    231 			return SDGP_RESULT_UNFORMATTED;
    232 		if (error || data.header.length == 0)
    233 			return SDGP_RESULT_OFFLINE;
    234 
    235 		switch (data.desc.byte5 & SCSIPI_CAP_DESC_CODE_MASK) {
    236 		case SCSIPI_CAP_DESC_CODE_RESERVED:
    237 		case SCSIPI_CAP_DESC_CODE_FORMATTED:
    238 			break;
    239 
    240 		case SCSIPI_CAP_DESC_CODE_UNFORMATTED:
    241 			return SDGP_RESULT_UNFORMATTED;
    242 
    243 		case SCSIPI_CAP_DESC_CODE_NONE:
    244 			return SDGP_RESULT_OFFLINE;
    245 		}
    246 
    247 		dp->disksize = blocks = _4btol(data.desc.nblks);
    248 		if (blocks == 0)
    249 			return SDGP_RESULT_OFFLINE;		/* XXX? */
    250 
    251 		blksize = _3btol(data.desc.blklen);
    252 
    253 	} else if (!sd_validate_blksize(blksize)) {
    254 		struct sd_mode_sense_data scsipi_sense;
    255 		int bsize;
    256 
    257 		memset(&scsipi_sense, 0, sizeof(scsipi_sense));
    258 		error = scsi_mode_sense(sd, 0, 0, &scsipi_sense.header,
    259 		    sizeof(struct scsi_mode_parameter_header_6) +
    260 						sizeof(scsipi_sense.blk_desc));
    261 		if (!error) {
    262 			bsize = scsipi_sense.header.blk_desc_len;
    263 
    264 			if (bsize >= 8)
    265 				blksize = _3btol(scsipi_sense.blk_desc.blklen);
    266 		}
    267 	}
    268 
    269 	if (!sd_validate_blksize(blksize))
    270 		blksize = SD_DEFAULT_BLKSIZE;
    271 
    272 	dp->blksize = blksize;
    273 	dp->disksize512 = (blocks * dp->blksize) / DEV_BSIZE;
    274 	return 0;
    275 }
    276 
    277 static int
    278 sd_get_parms_page4(struct sd_softc *sd, struct disk_parms *dp)
    279 {
    280 	struct sd_mode_sense_data scsipi_sense;
    281 	union scsi_disk_pages *pages;
    282 	size_t poffset;
    283 	int byte2, error;
    284 
    285 	byte2 = SMS_DBD;
    286 again:
    287 	memset(&scsipi_sense, 0, sizeof(scsipi_sense));
    288 	error = scsi_mode_sense(sd, byte2, 4, &scsipi_sense.header,
    289 	    (byte2 ? 0 : sizeof(scsipi_sense.blk_desc)) +
    290 				sizeof(scsipi_sense.pages.rigid_geometry));
    291 	if (error) {
    292 		if (byte2 == SMS_DBD) {
    293 			/* No result; try once more with DBD off */
    294 			byte2 = 0;
    295 			goto again;
    296 		}
    297 		return error;
    298 	}
    299 
    300 	poffset = sizeof(scsipi_sense.header);
    301 	poffset += scsipi_sense.header.blk_desc_len;
    302 
    303 	if (poffset > sizeof(scsipi_sense) - sizeof(pages->rigid_geometry))
    304 		return ERESTART;
    305 
    306 	pages = (void *)((u_long)&scsipi_sense + poffset);
    307 #if 0
    308 	{
    309 		size_t i;
    310 		u_int8_t *p;
    311 
    312 		printf("page 4 sense:");
    313 		for (i = sizeof(scsipi_sense), p = (void *)&scsipi_sense; i;
    314 		    i--, p++)
    315 			printf(" %02x", *p);
    316 		printf("\n");
    317 		printf("page 4 pg_code=%d sense=%p/%p\n",
    318 		    pages->rigid_geometry.pg_code, &scsipi_sense, pages);
    319 	}
    320 #endif
    321 
    322 	if ((pages->rigid_geometry.pg_code & PGCODE_MASK) != 4)
    323 		return ERESTART;
    324 
    325 	/*
    326 	 * KLUDGE!! (for zone recorded disks)
    327 	 * give a number of sectors so that sec * trks * cyls
    328 	 * is <= disk_size
    329 	 * can lead to wasted space! THINK ABOUT THIS !
    330 	 */
    331 	dp->heads = pages->rigid_geometry.nheads;
    332 	dp->cyls = _3btol(pages->rigid_geometry.ncyl);
    333 	if (dp->heads == 0 || dp->cyls == 0)
    334 		return ERESTART;
    335 	dp->sectors = dp->disksize / (dp->heads * dp->cyls);	/* XXX */
    336 
    337 	dp->rot_rate = _2btol(pages->rigid_geometry.rpm);
    338 	if (dp->rot_rate == 0)
    339 		dp->rot_rate = 3600;
    340 
    341 #if 0
    342 printf("page 4 ok\n");
    343 #endif
    344 	return 0;
    345 }
    346 
    347 static int
    348 sd_get_parms_page5(struct sd_softc *sd, struct disk_parms *dp)
    349 {
    350 	struct sd_mode_sense_data scsipi_sense;
    351 	union scsi_disk_pages *pages;
    352 	size_t poffset;
    353 	int byte2, error;
    354 
    355 	byte2 = SMS_DBD;
    356 again:
    357 	memset(&scsipi_sense, 0, sizeof(scsipi_sense));
    358 	error = scsi_mode_sense(sd, 0, 5, &scsipi_sense.header,
    359 	    (byte2 ? 0 : sizeof(scsipi_sense.blk_desc)) +
    360 				sizeof(scsipi_sense.pages.flex_geometry));
    361 	if (error) {
    362 		if (byte2 == SMS_DBD) {
    363 			/* No result; try once more with DBD off */
    364 			byte2 = 0;
    365 			goto again;
    366 		}
    367 		return error;
    368 	}
    369 
    370 	poffset = sizeof(scsipi_sense.header);
    371 	poffset += scsipi_sense.header.blk_desc_len;
    372 
    373 	if (poffset > sizeof(scsipi_sense) - sizeof(pages->flex_geometry))
    374 		return ERESTART;
    375 
    376 	pages = (void *)((u_long)&scsipi_sense + poffset);
    377 #if 0
    378 	{
    379 		size_t i;
    380 		u_int8_t *p;
    381 
    382 		printf("page 5 sense:");
    383 		for (i = sizeof(scsipi_sense), p = (void *)&scsipi_sense; i;
    384 		    i--, p++)
    385 			printf(" %02x", *p);
    386 		printf("\n");
    387 		printf("page 5 pg_code=%d sense=%p/%p\n",
    388 		    pages->flex_geometry.pg_code, &scsipi_sense, pages);
    389 	}
    390 #endif
    391 
    392 	if ((pages->flex_geometry.pg_code & PGCODE_MASK) != 5)
    393 		return ERESTART;
    394 
    395 	dp->heads = pages->flex_geometry.nheads;
    396 	dp->cyls = _2btol(pages->flex_geometry.ncyl);
    397 	dp->sectors = pages->flex_geometry.ph_sec_tr;
    398 	if (dp->heads == 0 || dp->cyls == 0 || dp->sectors == 0)
    399 		return ERESTART;
    400 
    401 	dp->rot_rate = _2btol(pages->rigid_geometry.rpm);
    402 	if (dp->rot_rate == 0)
    403 		dp->rot_rate = 3600;
    404 
    405 #if 0
    406 printf("page 5 ok\n");
    407 #endif
    408 	return 0;
    409 }
    410 
    411 static int
    412 sd_get_parms(struct sd_softc *sd)
    413 {
    414 	struct disk_parms *dp = &sd->sc_params;
    415 	int error;
    416 
    417 	/*
    418 	 * If offline, the SDEV_MEDIA_LOADED flag will be
    419 	 * cleared by the caller if necessary.
    420 	 */
    421 	if (sd->sc_type == T_SIMPLE_DIRECT) {
    422 		error = sd_get_simplifiedparms(sd);
    423 		if (error)
    424 			return error;
    425 		goto ok;
    426 	}
    427 
    428 	error = sd_get_capacity(sd);
    429 	if (error)
    430 		return error;
    431 
    432 	if (sd->sc_type == T_OPTICAL)
    433 		goto page0;
    434 
    435 	if (sd->sc_flags & FLAGS_REMOVABLE) {
    436 		if (!sd_get_parms_page5(sd, dp) ||
    437 		    !sd_get_parms_page4(sd, dp))
    438 			goto ok;
    439 	} else {
    440 		if (!sd_get_parms_page4(sd, dp) ||
    441 		    !sd_get_parms_page5(sd, dp))
    442 			goto ok;
    443 	}
    444 
    445 page0:
    446 	printf("fabricating a geometry\n");
    447 	/* Try calling driver's method for figuring out geometry. */
    448 	/*
    449 	 * Use adaptec standard fictitious geometry
    450 	 * this depends on which controller (e.g. 1542C is
    451 	 * different. but we have to put SOMETHING here..)
    452 	 */
    453 	dp->heads = 64;
    454 	dp->sectors = 32;
    455 	dp->cyls = dp->disksize / (64 * 32);
    456 	dp->rot_rate = 3600;
    457 
    458 ok:
    459 	DPRINTF(("disksize = %" PRId64 ", disksize512 = %" PRId64 ".\n",
    460 	    dp->disksize, dp->disksize512));
    461 
    462 	return 0;
    463 }
    464 
    465 static void
    466 sdgetdefaultlabel(struct sd_softc *sd, struct disklabel *lp)
    467 {
    468 
    469 	memset(lp, 0, sizeof(struct disklabel));
    470 
    471 	lp->d_secsize = sd->sc_params.blksize;
    472 	lp->d_ntracks = sd->sc_params.heads;
    473 	lp->d_nsectors = sd->sc_params.sectors;
    474 	lp->d_ncylinders = sd->sc_params.cyls;
    475 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
    476 
    477 	lp->d_type = DTYPE_SCSI;
    478 
    479 	strncpy(lp->d_packname, "fictitious", 16);
    480 	lp->d_secperunit = sd->sc_params.disksize;
    481 	lp->d_rpm = sd->sc_params.rot_rate;
    482 	lp->d_interleave = 1;
    483 	lp->d_flags = (sd->sc_flags & FLAGS_REMOVABLE) ? D_REMOVABLE : 0;
    484 
    485 	lp->d_partitions[RAW_PART].p_offset = 0;
    486 	lp->d_partitions[RAW_PART].p_size = lp->d_secperunit;
    487 	lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
    488 	lp->d_npartitions = RAW_PART + 1;
    489 
    490 	lp->d_magic = DISKMAGIC;
    491 	lp->d_magic2 = DISKMAGIC;
    492 	lp->d_checksum = dkcksum(lp);
    493 }
    494 
    495 /*
    496  * Load the label information on the named device.
    497  */
    498 static int
    499 sdgetdisklabel(struct sd_softc *sd)
    500 {
    501 	struct mbr_sector *mbr;
    502 	struct mbr_partition *mp;
    503 	struct disklabel *lp = &sd->sc_label;
    504 	size_t rsize;
    505 	int sector, i;
    506 	char *msg;
    507 	uint8_t buf[DEV_BSIZE];
    508 
    509 	sdgetdefaultlabel(sd, lp);
    510 
    511 	if (lp->d_secpercyl == 0) {
    512 		lp->d_secpercyl = 100;
    513 		/* as long as it's not 0 - readdisklabel divides by it (?) */
    514 	}
    515 
    516 	/*
    517 	 * Find NetBSD Partition in DOS partition table.
    518 	 */
    519 	sector = 0;
    520 	if (sdstrategy(sd, F_READ, MBR_BBSECTOR, DEV_BSIZE, buf, &rsize))
    521 		return EOFFSET;
    522 
    523 	mbr = (struct mbr_sector *)buf;
    524 	if (mbr->mbr_magic == htole16(MBR_MAGIC)) {
    525 		/*
    526 		 * Lookup NetBSD slice. If there is none, go ahead
    527 		 * and try to read the disklabel off sector #0.
    528 		 */
    529 		mp = mbr->mbr_parts;
    530 		for (i = 0; i < MBR_PART_COUNT; i++) {
    531 			if (mp[i].mbrp_type == MBR_PTYPE_NETBSD) {
    532 				sector = le32toh(mp[i].mbrp_start);
    533 				break;
    534 			}
    535 		}
    536 	}
    537 
    538 	if (sdstrategy(sd, F_READ, sector + LABELSECTOR, DEV_BSIZE,
    539 	    buf, &rsize))
    540 		return EOFFSET;
    541 
    542 	msg = getdisklabel((const char *)buf + LABELOFFSET, &sd->sc_label);
    543 	if (msg)
    544 		printf("sd(%d,%d,%d,...): getdisklabel: %s\n",
    545 		    sd->sc_bus, sd->sc_target, sd->sc_lun, msg);
    546 
    547 	/* check partition */
    548 	if ((sd->sc_part >= lp->d_npartitions) ||
    549 	    (lp->d_partitions[sd->sc_part].p_fstype == FS_UNUSED)) {
    550 		DPRINTF(("illegal partition\n"));
    551 		return EPART;
    552 	}
    553 
    554 	DPRINTF(("label info: d_secsize %d, d_nsectors %d, d_ncylinders %d,"
    555 	    " d_ntracks %d, d_secpercyl %d\n",
    556 	    sd->sc_label.d_secsize,
    557 	    sd->sc_label.d_nsectors,
    558 	    sd->sc_label.d_ncylinders,
    559 	    sd->sc_label.d_ntracks,
    560 	    sd->sc_label.d_secpercyl));
    561 
    562 	return 0;
    563 }
    564 
    565 /*
    566  * Open device (read drive parameters and disklabel)
    567  */
    568 int
    569 sdopen(struct open_file *f, ...)
    570 {
    571 	struct sd_softc *sd;
    572 	struct scsi_test_unit_ready cmd;
    573 	struct scsipi_inquiry_data *inqbuf;
    574 	u_int bus, target, lun, part;
    575 	int error;
    576 	char buf[SCSIPI_INQUIRY_LENGTH_SCSI2];
    577 	va_list ap;
    578 
    579 	va_start(ap, f);
    580 	bus = 0;
    581 	target = va_arg(ap, u_int);
    582 	lun = va_arg(ap, u_int);
    583 	part = va_arg(ap, u_int);
    584 	va_end(ap);
    585 
    586 	DPRINTF(("sdopen: sd(%d,%d,%d)\n", target, lun, part));
    587 
    588 	sd = alloc(sizeof(struct sd_softc));
    589 	if (sd == NULL)
    590 		return ENOMEM;
    591 
    592 	memset(sd, 0, sizeof(struct sd_softc));
    593 
    594 	sd->sc_part = part;
    595 	sd->sc_lun = lun;
    596 	sd->sc_target = target;
    597 	sd->sc_bus = bus;
    598 
    599 	if ((error = scsi_inquire(sd, sizeof(buf), buf)) != 0)
    600 		return error;
    601 
    602 	inqbuf = (struct scsipi_inquiry_data *)buf;
    603 
    604 	sd->sc_type = inqbuf->device & SID_TYPE;
    605 
    606 	/*
    607 	 * Determine the operating mode capabilities of the device.
    608 	 */
    609 	if ((inqbuf->version & SID_ANSII) >= 2) {
    610 //		if ((inqbuf->flags3 & SID_CmdQue) != 0)
    611 //			sd->sc_cap |= PERIPH_CAP_TQING;
    612 		if ((inqbuf->flags3 & SID_Sync) != 0)
    613 			sd->sc_cap |= PERIPH_CAP_SYNC;
    614 
    615 		/* SPC-2 */
    616 		if ((inqbuf->version & SID_ANSII) >= 3) {
    617 			/*
    618 			 * Report ST clocking though CAP_WIDExx/CAP_SYNC.
    619 			 * If the device only supports DT, clear these
    620 			 * flags (DT implies SYNC and WIDE)
    621 			 */
    622 			switch (inqbuf->flags4 & SID_Clocking) {
    623 			case SID_CLOCKING_DT_ONLY:
    624 				sd->sc_cap &= ~PERIPH_CAP_SYNC;
    625 				break;
    626 			}
    627 		}
    628 	}
    629 	sd->sc_flags =
    630 	    (inqbuf->dev_qual2 & SID_REMOVABLE) ? FLAGS_REMOVABLE : 0;
    631 
    632 	memset(&cmd, 0, sizeof(cmd));
    633 	cmd.opcode = SCSI_TEST_UNIT_READY;
    634 	if ((error = scsi_command(sd, (void *)&cmd, sizeof(cmd), NULL, 0)) != 0)
    635 		return error;
    636 
    637 	if (sd->sc_flags & FLAGS_REMOVABLE) {
    638 		printf("XXXXX: removable device found. will not support\n");
    639 	}
    640 	if (!(sd->sc_flags & FLAGS_MEDIA_LOADED))
    641 		sd->sc_flags |= FLAGS_MEDIA_LOADED;
    642 
    643 	if ((error = sd_get_parms(sd)) != 0)
    644 		return error;
    645 
    646 	strncpy(sd->sc_label.d_typename, inqbuf->product, 16);
    647 	if ((error = sdgetdisklabel(sd)) != 0)
    648 		return error;
    649 
    650 	f->f_devdata = sd;
    651 	return 0;
    652 }
    653 
    654 /*
    655  * Close device.
    656  */
    657 int
    658 sdclose(struct open_file *f)
    659 {
    660 
    661 	return 0;
    662 }
    663 
    664 /*
    665  * Read some data.
    666  */
    667 int
    668 sdstrategy(void *f, int rw, daddr_t dblk, size_t size, void *p, size_t *rsize)
    669 {
    670 	struct sd_softc *sd;
    671 	struct disklabel *lp;
    672 	struct partition *pp;
    673 	struct scsipi_generic *cmdp;
    674 	struct scsipi_rw_16 cmd16;
    675 	struct scsipi_rw_10 cmd_big;
    676 	struct scsi_rw_6 cmd_small;
    677 	daddr_t blkno;
    678 	int cmdlen, nsect, i;
    679 	uint8_t *buf;
    680 
    681 	if (size == 0)
    682 		return 0;
    683 
    684 	if (rw != F_READ)
    685 		return EOPNOTSUPP;
    686 
    687 	buf = p;
    688 	sd = f;
    689 	lp = &sd->sc_label;
    690 	pp = &lp->d_partitions[sd->sc_part];
    691 
    692 	if (!(sd->sc_flags & FLAGS_MEDIA_LOADED))
    693 		return EIO;
    694 
    695 	nsect = howmany(size, lp->d_secsize);
    696 	blkno = dblk + pp->p_offset;
    697 
    698 	for (i = 0; i < nsect; i++, blkno++) {
    699 		int error;
    700 
    701 		/*
    702 		 * Fill out the scsi command.  Use the smallest CDB possible
    703 		 * (6-byte, 10-byte, or 16-byte).
    704 		 */
    705 		if ((blkno & 0x1fffff) == blkno) {
    706 			/* 6-byte CDB */
    707 			memset(&cmd_small, 0, sizeof(cmd_small));
    708 			cmd_small.opcode = SCSI_READ_6_COMMAND;
    709 			_lto3b(blkno, cmd_small.addr);
    710 			cmd_small.length = 1;
    711 			cmdlen = sizeof(cmd_small);
    712 			cmdp = (struct scsipi_generic *)&cmd_small;
    713 		} else if ((blkno & 0xffffffff) == blkno) {
    714 			/* 10-byte CDB */
    715 			memset(&cmd_big, 0, sizeof(cmd_big));
    716 			cmd_big.opcode = READ_10;
    717 			_lto4b(blkno, cmd_big.addr);
    718 			_lto2b(1, cmd_big.length);
    719 			cmdlen = sizeof(cmd_big);
    720 			cmdp = (struct scsipi_generic *)&cmd_big;
    721 		} else {
    722 			/* 16-byte CDB */
    723 			memset(&cmd16, 0, sizeof(cmd16));
    724 			cmd16.opcode = READ_16;
    725 			_lto8b(blkno, cmd16.addr);
    726 			_lto4b(1, cmd16.length);
    727 			cmdlen = sizeof(cmd16);
    728 			cmdp = (struct scsipi_generic *)&cmd16;
    729 		}
    730 
    731 		error = scsi_command(sd, cmdp, cmdlen, buf, lp->d_secsize);
    732 		if (error)
    733 			return error;
    734 
    735 		buf += lp->d_secsize;
    736 	}
    737 
    738 	*rsize = size;
    739 	return 0;
    740 }
    741