/*
* Copyright (C) 2008-2012 Daisuke Aoyama <aoyama@peach.ne.jp>.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <inttypes.h>
#include <stdint.h>
#include <errno.h>
#include <stdio.h>
#include <string.h>
#include <pthread.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#ifdef HAVE_UUID_H
#include <uuid.h>
#endif
#include "istgt.h"
#include "istgt_ver.h"
#include "istgt_log.h"
#include "istgt_conf.h"
#include "istgt_sock.h"
#include "istgt_misc.h"
#include "istgt_iscsi.h"
#include "istgt_lu.h"
#include "istgt_proto.h"
#include "istgt_scsi.h"
#if !defined(__GNUC__)
#undef __attribute__
#define __attribute__(x)
#endif
//#define ISTGT_TRACE_DVD
#define DEFAULT_DVD_BLOCKLEN 2048
#define DEFAULT_DVD_PROFILE MM_PROF_DVDROM
enum {
MM_PROF_CDROM = 0x0008,
MM_PROF_DVDROM = 0x0010,
} ISTGT_LU_MM_PROF;
typedef struct istgt_lu_dvd_t {
ISTGT_LU_Ptr lu;
int num;
int lun;
int fd;
const char *file;
uint64_t size;
uint64_t blocklen;
uint64_t blockcnt;
#ifdef HAVE_UUID_H
uuid_t uuid;
#endif /* HAVE_UUID_H */
/* cache flags */
int read_cache;
int write_cache;
/* flags */
int mflags;
/* current DVD/CD profile */
int profile;
/* media state */
volatile int mload;
volatile int mchanged;
volatile int mwait;
/* mode flags */
volatile int lock;
/* SCSI sense code */
volatile int sense;
} ISTGT_LU_DVD;
#define BUILD_SENSE(SK,ASC,ASCQ) \
do { \
*sense_len = \
istgt_lu_dvd_build_sense_data(spec, sense_data, \
ISTGT_SCSI_SENSE_ ## SK, \
(ASC), (ASCQ)); \
} while (0)
static int istgt_lu_dvd_build_sense_data(ISTGT_LU_DVD *spec, uint8_t *data, int sk, int asc, int ascq);
static int
istgt_lu_dvd_open(ISTGT_LU_DVD *spec, int flags, int mode)
{
int rc;
rc = open(spec->file, flags, mode);
if (rc < 0) {
return -1;
}
spec->fd = rc;
return 0;
}
static int
istgt_lu_dvd_close(ISTGT_LU_DVD *spec)
{
int rc;
if (spec->fd == -1)
return 0;
rc = close(spec->fd);
if (rc < 0) {
return -1;
}
spec->fd = -1;
return 0;
}
static int64_t
istgt_lu_dvd_seek(ISTGT_LU_DVD *spec, uint64_t offset)
{
off_t rc;
rc = lseek(spec->fd, (off_t) offset, SEEK_SET);
if (rc < 0) {
return -1;
}
return 0;
}
static int64_t
istgt_lu_dvd_read(ISTGT_LU_DVD *spec, void *buf, uint64_t nbytes)
{
int64_t rc;
rc = (int64_t) read(spec->fd, buf, (size_t) nbytes);
if (rc < 0) {
return -1;
}
return rc;
}
static int64_t
istgt_lu_dvd_write(ISTGT_LU_DVD *spec, const void *buf, uint64_t nbytes)
{
int64_t rc;
rc = (int64_t) write(spec->fd, buf, (size_t) nbytes);
if (rc < 0) {
return -1;
}
return rc;
}
static int64_t
istgt_lu_dvd_sync(ISTGT_LU_DVD *spec, uint64_t offset __attribute__((__unused__)), uint64_t nbytes __attribute__((__unused__)))
{
int64_t rc;
rc = (int64_t) fsync(spec->fd);
if (rc < 0) {
return -1;
}
return rc;
}
int
istgt_lu_dvd_media_present(ISTGT_LU_DVD *spec)
{
if (spec->mload) {
return 1;
}
return 0;
}
int
istgt_lu_dvd_media_lock(ISTGT_LU_DVD *spec)
{
if (spec->lock) {
return 1;
}
return 0;
}
static int istgt_lu_dvd_allocate(ISTGT_LU_DVD *spec);
int
istgt_lu_dvd_load_media(ISTGT_LU_DVD *spec)
{
ISTGT_LU_Ptr lu;
int flags;
int newfile;
int rc;
if (istgt_lu_dvd_media_present(spec)) {
/* media present */
return -1;
}
if (spec->mchanged) {
/* changed soon */
return -1;
}
lu = spec->lu;
if (lu->lun[spec->lun].type != ISTGT_LU_LUN_TYPE_REMOVABLE) {
ISTGT_ERRLOG("LU%d: not removable\n", lu->num);
return -1;
}
if (strcasecmp(lu->lun[spec->lun].u.removable.file,
"/dev/null") == 0) {
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "LU%d: empty\n", lu->num);
spec->file = NULL;
spec->size = 0;
spec->mflags = 0;
spec->blocklen = DEFAULT_DVD_BLOCKLEN;
spec->blockcnt = spec->size / spec->blocklen;
spec->profile = DEFAULT_DVD_PROFILE;
return 0;
}
spec->file = lu->lun[spec->lun].u.removable.file;
spec->size = lu->lun[spec->lun].u.removable.size;
spec->mflags = lu->lun[spec->lun].u.removable.flags;
//spec->blocklen = lu->blocklen;
spec->blocklen = DEFAULT_DVD_BLOCKLEN;
spec->blockcnt = spec->size / spec->blocklen;
spec->profile = DEFAULT_DVD_PROFILE;
spec->mload = 0;
spec->mchanged = 1;
spec->mwait = 3;
if (access(spec->file, W_OK) != 0) {
if (errno != ENOENT) {
spec->mflags |= ISTGT_LU_FLAG_MEDIA_READONLY;
}
} else {
struct stat st;
rc = stat(spec->file, &st);
if (rc != 0 || !S_ISREG(st.st_mode)) {
spec->mflags |= ISTGT_LU_FLAG_MEDIA_READONLY;
} else {
if ((st.st_mode & (S_IWUSR | S_IWGRP | S_IWOTH)) == 0) {
spec->mflags |= ISTGT_LU_FLAG_MEDIA_READONLY;
}
}
}
if (lu->readonly
|| (spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY)) {
flags = O_RDONLY;
} else {
flags = O_RDWR;
}
newfile = 0;
rc = istgt_lu_dvd_open(spec, flags, 0666);
if (rc < 0) {
newfile = 1;
if (lu->readonly
|| (spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY)) {
flags = O_RDONLY;
} else {
flags = (O_CREAT | O_EXCL | O_RDWR);
}
rc = istgt_lu_dvd_open(spec, flags, 0666);
if (rc < 0) {
ISTGT_ERRLOG("LU%d: LUN%d: open error(errno=%d)\n",
lu->num, spec->lun, errno);
return -1;
}
if (lu->lun[spec->lun].u.removable.size < ISTGT_LU_MEDIA_SIZE_MIN) {
lu->lun[spec->lun].u.removable.size = ISTGT_LU_MEDIA_SIZE_MIN;
}
}
if (lu->readonly
|| (spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY)) {
/* readonly */
} else {
if (newfile == 0) {
/* XXX TODO: existing file check */
}
rc = istgt_lu_dvd_allocate(spec);
if (rc < 0) {
ISTGT_ERRLOG("LU%d: LUN%d: allocate error\n", lu->num, spec->lun);
return -1;
}
}
return 0;
}
int
istgt_lu_dvd_unload_media(ISTGT_LU_DVD *spec)
{
int64_t rc;
if (!istgt_lu_dvd_media_present(spec)
&& !spec->mchanged) {
/* media absent */
return 0;
}
if (istgt_lu_dvd_media_lock(spec)) {
return -1;
}
if (!spec->lu->readonly
&& !(spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY)) {
rc = istgt_lu_dvd_sync(spec, 0, spec->size);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_sync() failed\n");
return -1;
}
}
rc = (int64_t) istgt_lu_dvd_close(spec);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_close() failed\n");
return -1;
}
spec->file = NULL;
spec->size = 0;
spec->mflags = 0;
spec->blocklen = DEFAULT_DVD_BLOCKLEN;
spec->blockcnt = spec->size / spec->blocklen;
spec->profile = DEFAULT_DVD_PROFILE;
spec->mload = 0;
spec->mchanged = 0;
spec->mwait = 3;
return 0;
}
int
istgt_lu_dvd_change_media(ISTGT_LU_DVD *spec, char *type, char *flags, char *file, char *size)
{
ISTGT_LU_Ptr lu;
char *mfile;
uint64_t msize;
int mflags;
int rc;
if (istgt_lu_dvd_media_lock(spec)) {
return -1;
}
lu = spec->lu;
if (lu->lun[spec->lun].type != ISTGT_LU_LUN_TYPE_REMOVABLE) {
ISTGT_ERRLOG("LU%d: not removable\n", lu->num);
return -1;
}
if (strcmp(type, "-") == 0) {
/* use ISO image */
;
} else {
ISTGT_ERRLOG("unsupported media type\n");
return -1;
}
mfile = xstrdup(file);
mflags = istgt_lu_parse_media_flags(flags);
msize = istgt_lu_parse_media_size(file, size, &mflags);
rc = istgt_lu_dvd_unload_media(spec);
if (rc < 0) {
return -1;
}
/* replace */
xfree(lu->lun[spec->lun].u.removable.file);
lu->lun[spec->lun].u.removable.file = mfile;
lu->lun[spec->lun].u.removable.size = msize;
lu->lun[spec->lun].u.removable.flags = mflags;
/* reload */
rc = istgt_lu_dvd_load_media(spec);
if (rc < 0) {
(void) istgt_lu_dvd_unload_media(spec);
}
if (spec->file == NULL) {
(void) istgt_lu_dvd_unload_media(spec);
}
spec->mwait = 5;
return rc;
}
static int
istgt_lu_dvd_allocate(ISTGT_LU_DVD *spec)
{
uint8_t *data;
uint64_t fsize;
uint64_t size;
uint64_t blocklen;
uint64_t offset;
uint64_t nbytes;
int64_t rc;
size = spec->size;
blocklen = spec->blocklen;
nbytes = blocklen;
data = xmalloc(nbytes);
memset(data, 0, nbytes);
fsize = istgt_lu_get_filesize(spec->file);
if (fsize > size) {
xfree(data);
return 0;
}
offset = size - nbytes;
rc = istgt_lu_dvd_seek(spec, offset);
if (rc == -1) {
ISTGT_ERRLOG("lu_dvd_seek() failed\n");
xfree(data);
return -1;
}
rc = istgt_lu_dvd_read(spec, data, nbytes);
/* EOF is OK */
if (rc == -1) {
ISTGT_ERRLOG("lu_dvd_read() failed\n");
xfree(data);
return -1;
}
rc = istgt_lu_dvd_seek(spec, offset);
if (rc == -1) {
ISTGT_ERRLOG("lu_dvd_seek() failed\n");
xfree(data);
return -1;
}
rc = istgt_lu_dvd_write(spec, data, nbytes);
if (rc == -1 || (uint64_t) rc != nbytes) {
ISTGT_ERRLOG("lu_dvd_write() failed\n");
xfree(data);
return -1;
}
xfree(data);
return 0;
}
int
istgt_lu_dvd_init(ISTGT_Ptr istgt __attribute__((__unused__)), ISTGT_LU_Ptr lu)
{
ISTGT_LU_DVD *spec;
uint64_t gb_size;
uint64_t mb_size;
#ifdef HAVE_UUID_H
uint32_t status;
#endif /* HAVE_UUID_H */
int mb_digit;
int ro;
int rc;
int i;
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "istgt_lu_dvd_init\n");
printf("LU%d DVD UNIT\n", lu->num);
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "LU%d TargetName=%s\n",
lu->num, lu->name);
for (i = 0; i < lu->maxlun; i++) {
if (lu->lun[i].type == ISTGT_LU_LUN_TYPE_NONE) {
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "LU%d: LUN%d none\n",
lu->num, i);
lu->lun[i].spec = NULL;
continue;
}
if (lu->lun[i].type != ISTGT_LU_LUN_TYPE_REMOVABLE) {
ISTGT_ERRLOG("LU%d: unsupported type\n", lu->num);
return -1;
}
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "LU%d: LUN%d removable\n",
lu->num, i);
spec = xmalloc(sizeof *spec);
memset(spec, 0, sizeof *spec);
spec->lu = lu;
spec->num = lu->num;
spec->lun = i;
spec->fd = -1;
spec->read_cache = 1;
spec->write_cache = 1;
#ifdef HAVE_UUID_H
uuid_create(&spec->uuid, &status);
if (status != uuid_s_ok) {
ISTGT_ERRLOG("LU%d: LUN%d: uuid_create() failed\n", lu->num, i);
xfree(spec);
return -1;
}
#endif /* HAVE_UUID_H */
spec->mload = 0;
spec->mchanged = 0;
spec->mwait = 0;
rc = istgt_lu_dvd_load_media(spec);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_load_media() failed\n");
xfree(spec);
return -1;
}
if (spec->file != NULL) {
/* initial state */
spec->mload = 1;
spec->mchanged = 0;
spec->mwait = 0;
if (spec->lu->readonly
|| (spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY)) {
ro = 1;
} else {
ro = 0;
}
printf("LU%d: LUN%d file=%s, size=%"PRIu64", flag=%s\n",
lu->num, i, spec->file, spec->size, ro ? "ro" : "rw");
printf("LU%d: LUN%d %"PRIu64" blocks, %"PRIu64" bytes/block\n",
lu->num, i, spec->blockcnt, spec->blocklen);
gb_size = spec->size / ISTGT_LU_1GB;
mb_size = (spec->size % ISTGT_LU_1GB) / ISTGT_LU_1MB;
if (gb_size > 0) {
mb_digit = (int) (((mb_size * 100) / 1024) / 10);
printf("LU%d: LUN%d %"PRIu64".%dGB %sstorage for %s\n",
lu->num, i, gb_size, mb_digit,
lu->readonly ? "readonly " : "", lu->name);
} else {
printf("LU%d: LUN%d %"PRIu64"MB %sstorage for %s\n",
lu->num, i, mb_size,
lu->readonly ? "readonly " : "", lu->name);
}
} else {
/* initial state */
spec->mload = 0;
spec->mchanged = 0;
spec->mwait = 0;
printf("LU%d: LUN%d empty slot\n",
lu->num, i);
}
lu->lun[i].spec = spec;
}
return 0;
}
int
istgt_lu_dvd_shutdown(ISTGT_Ptr istgt __attribute__((__unused__)), ISTGT_LU_Ptr lu)
{
ISTGT_LU_DVD *spec;
int rc;
int i;
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "istgt_lu_dvd_shutdown\n");
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "LU%d TargetName=%s\n",
lu->num, lu->name);
for (i = 0; i < lu->maxlun; i++) {
if (lu->lun[i].type == ISTGT_LU_LUN_TYPE_NONE) {
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "LU%d: LUN%d none\n",
lu->num, i);
continue;
}
if (lu->lun[i].type != ISTGT_LU_LUN_TYPE_REMOVABLE) {
ISTGT_ERRLOG("LU%d: unsupported type\n", lu->num);
return -1;
}
spec = (ISTGT_LU_DVD *) lu->lun[i].spec;
if (!spec->lu->readonly
&& !(spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY)) {
rc = istgt_lu_dvd_sync(spec, 0, spec->size);
if (rc < 0) {
//ISTGT_ERRLOG("LU%d: lu_dvd_sync() failed\n", lu->num);
/* ignore error */
}
}
rc = istgt_lu_dvd_close(spec);
if (rc < 0) {
//ISTGT_ERRLOG("LU%d: lu_dvd_close() failed\n", lu->num);
/* ignore error */
}
xfree(spec);
lu->lun[i].spec = NULL;
}
return 0;
}
static int
istgt_lu_dvd_scsi_report_luns(ISTGT_LU_Ptr lu, CONN_Ptr conn __attribute__((__unused__)), uint8_t *cdb __attribute__((__unused__)), int sel, uint8_t *data, int alloc_len)
{
uint64_t fmt_lun, lun, method;
int hlen = 0, len = 0;
int i;
if (alloc_len < 8) {
return -1;
}
if (sel == 0x00) {
/* logical unit with addressing method */
} else if (sel == 0x01) {
/* well known logical unit */
} else if (sel == 0x02) {
/* logical unit */
} else {
return -1;
}
/* LUN LIST LENGTH */
DSET32(&data[0], 0);
/* Reserved */
DSET32(&data[4], 0);
hlen = 8;
for (i = 0; i < lu->maxlun; i++) {
if (lu->lun[i].type == ISTGT_LU_LUN_TYPE_NONE) {
#if 0
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "LU%d: LUN%d none\n",
lu->num, i);
#endif
continue;
}
if (alloc_len - (hlen + len) < 8) {
return -1;
}
lun = (uint64_t) i;
if (lu->maxlun <= 0x0100) {
/* below 256 */
method = 0x00U;
fmt_lun = (method & 0x03U) << 62;
fmt_lun |= (lun & 0x00ffU) << 48;
} else if (lu->maxlun <= 0x4000) {
/* below 16384 */
method = 0x01U;
fmt_lun = (method & 0x03U) << 62;
fmt_lun |= (lun & 0x3fffU) << 48;
} else {
/* XXX */
fmt_lun = 0;
}
/* LUN */
DSET64(&data[hlen + len], fmt_lun);
len += 8;
}
/* LUN LIST LENGTH */
DSET32(&data[0], len);
return hlen + len;
}
static int
istgt_lu_dvd_scsi_inquiry(ISTGT_LU_DVD *spec, CONN_Ptr conn, uint8_t *cdb, uint8_t *data, int alloc_len)
{
uint64_t LUI;
uint8_t *cp, *cp2;
int hlen = 0, len = 0, plen, plen2;
int pc;
int pq, pd;
int rmb;
int evpd;
int pg_tag;
int i, j;
if (alloc_len < 0xff) {
return -1;
}
pq = 0x00;
pd = SPC_PERIPHERAL_DEVICE_TYPE_DVD;
rmb = 1;
LUI = istgt_get_lui(spec->lu->name, spec->lun & 0xffffU);
pc = cdb[2];
evpd = BGET8(&cdb[1], 0);
if (evpd) {
/* Vital product data */
switch (pc) {
case SPC_VPD_SUPPORTED_VPD_PAGES:
/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
BDSET8W(&data[0], pq, 7, 3);
BDADD8W(&data[0], pd, 4, 5);
/* PAGE CODE */
data[1] = pc;
/* Reserved */
data[2] = 0;
/* PAGE LENGTH */
data[3] = 0;
hlen = 4;
data[4] = SPC_VPD_SUPPORTED_VPD_PAGES; /* 0x00 */
data[5] = SPC_VPD_UNIT_SERIAL_NUMBER; /* 0x80 */
data[6] = SPC_VPD_DEVICE_IDENTIFICATION; /* 0x83 */
data[7] = SPC_VPD_MANAGEMENT_NETWORK_ADDRESSES; /* 0x85 */
data[8] = SPC_VPD_EXTENDED_INQUIRY_DATA; /* 0x86 */
data[9] = SPC_VPD_MODE_PAGE_POLICY; /* 0x87 */
data[10]= SPC_VPD_SCSI_PORTS; /* 0x88 */
len = 11 - hlen;
/* PAGE LENGTH */
data[3] = len;
break;
case SPC_VPD_UNIT_SERIAL_NUMBER:
/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
BDSET8W(&data[0], pq, 7, 3);
BDADD8W(&data[0], pd, 4, 5);
/* PAGE CODE */
data[1] = pc;
/* Reserved */
data[2] = 0;
/* PAGE LENGTH */
data[3] = 0;
hlen = 4;
/* PRODUCT SERIAL NUMBER */
len = strlen(spec->lu->inq_serial);
if (len > MAX_LU_SERIAL_STRING) {
len = MAX_LU_SERIAL_STRING;
}
istgt_strcpy_pad(&data[4], len, spec->lu->inq_serial, ' ');
/* PAGE LENGTH */
data[3] = len;
break;
case SPC_VPD_DEVICE_IDENTIFICATION:
/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
BDSET8W(&data[0], pq, 7, 3);
BDADD8W(&data[0], pd, 4, 5);
/* PAGE CODE */
data[1] = pc;
/* PAGE LENGTH */
DSET16(&data[2], 0);
hlen = 4;
/* Identification descriptor 1 */
/* Logical Unit */
cp = &data[hlen + len];
/* PROTOCOL IDENTIFIER(7-4) CODE SET(3-0) */
BDSET8W(&cp[0], 0, 7, 4);
BDADD8W(&cp[0], SPC_VPD_CODE_SET_BINARY, 3, 4);
/* PIV(7) ASSOCIATION(5-4) IDENTIFIER TYPE(3-0) */
BDSET8W(&cp[1], 0, 7, 1); /* PIV=0 */
BDADD8W(&cp[1], SPC_VPD_ASSOCIATION_LOGICAL_UNIT, 5, 2);
BDADD8W(&cp[1], SPC_VPD_IDENTIFIER_TYPE_NAA, 3, 4);
/* Reserved */
cp[2] = 0;
/* IDENTIFIER LENGTH */
cp[3] = 0;
/* IDENTIFIER */
#if 0
/* 16bytes ID */
plen = istgt_lu_set_extid(&cp[4], 0, LUI);
#else
plen = istgt_lu_set_lid(&cp[4], LUI);
#endif
cp[3] = plen;
len += 4 + plen;
/* Identification descriptor 2 */
/* T10 VENDOR IDENTIFICATION */
cp = &data[hlen + len];
/* PROTOCOL IDENTIFIER(7-4) CODE SET(3-0) */
BDSET8W(&cp[0], 0, 7, 4);
BDADD8W(&cp[0], SPC_VPD_CODE_SET_UTF8, 3, 4);
/* PIV(7) ASSOCIATION(5-4) IDENTIFIER TYPE(3-0) */
BDSET8W(&cp[1], 0, 7, 1); /* PIV=0 */
BDADD8W(&cp[1], SPC_VPD_ASSOCIATION_LOGICAL_UNIT, 5, 2);
BDADD8W(&cp[1], SPC_VPD_IDENTIFIER_TYPE_T10_VENDOR_ID, 3, 4);
/* Reserved */
cp[2] = 0;
/* IDENTIFIER LENGTH */
cp[3] = 0;
/* IDENTIFIER */
/* T10 VENDOR IDENTIFICATION */
istgt_strcpy_pad(&cp[4], 8, spec->lu->inq_vendor, ' ');
plen = 8;
/* VENDOR SPECIFIC IDENTIFIER */
/* PRODUCT IDENTIFICATION */
istgt_strcpy_pad(&cp[12], 16, spec->lu->inq_product, ' ');
/* PRODUCT SERIAL NUMBER */
istgt_strcpy_pad(&cp[28], MAX_LU_SERIAL_STRING,
spec->lu->inq_serial, ' ');
plen += 16 + MAX_LU_SERIAL_STRING;
cp[3] = plen;
len += 4 + plen;
/* Identification descriptor 3 */
/* Target Device */
cp = &data[hlen + len];
/* PROTOCOL IDENTIFIER(7-4) CODE SET(3-0) */
BDSET8W(&cp[0], SPC_PROTOCOL_IDENTIFIER_ISCSI, 7, 4);
BDADD8W(&cp[0], SPC_VPD_CODE_SET_UTF8, 3, 4);
/* PIV(7) ASSOCIATION(5-4) IDENTIFIER TYPE(3-0) */
BDSET8W(&cp[1], 1, 7, 1); /* PIV */
BDADD8W(&cp[1], SPC_VPD_ASSOCIATION_TARGET_DEVICE, 5, 2);
BDADD8W(&cp[1], SPC_VPD_IDENTIFIER_TYPE_SCSI_NAME, 3, 4);
/* Reserved */
cp[2] = 0;
/* IDENTIFIER LENGTH */
cp[3] = 0;
/* IDENTIFIER */
plen = snprintf((char *) &cp[4], MAX_TARGET_NAME,
"%s", spec->lu->name);
cp[3] = plen;
len += 4 + plen;
/* Identification descriptor 4 */
/* Target Port */
cp = &data[hlen + len];
/* PROTOCOL IDENTIFIER(7-4) CODE SET(3-0) */
BDSET8W(&cp[0], SPC_PROTOCOL_IDENTIFIER_ISCSI, 7, 4);
BDADD8W(&cp[0], SPC_VPD_CODE_SET_UTF8, 3, 4);
/* PIV(7) ASSOCIATION(5-4) IDENTIFIER TYPE(3-0) */
BDSET8W(&cp[1], 1, 7, 1); /* PIV */
BDADD8W(&cp[1], SPC_VPD_ASSOCIATION_TARGET_PORT, 5, 2);
BDADD8W(&cp[1], SPC_VPD_IDENTIFIER_TYPE_SCSI_NAME, 3, 4);
/* Reserved */
cp[2] = 0;
/* IDENTIFIER LENGTH */
cp[3] = 0;
/* IDENTIFIER */
plen = snprintf((char *) &cp[4], MAX_TARGET_NAME,
"%s"",t,0x""%4.4x", spec->lu->name, conn->portal.tag);
cp[3] = plen;
len += 4 + plen;
/* Identification descriptor 5 */
/* Relative Target Port */
cp = &data[hlen + len];
/* PROTOCOL IDENTIFIER(7-4) CODE SET(3-0) */
BDSET8W(&cp[0], SPC_PROTOCOL_IDENTIFIER_ISCSI, 7, 4);
BDADD8W(&cp[0], SPC_VPD_CODE_SET_BINARY, 3, 4);
/* PIV(7) ASSOCIATION(5-4) IDENTIFIER TYPE(3-0) */
BDSET8W(&cp[1], 1, 7, 1); /* PIV */
BDADD8W(&cp[1], SPC_VPD_ASSOCIATION_TARGET_PORT, 5, 2);
BDADD8W(&cp[1], SPC_VPD_IDENTIFIER_TYPE_RELATIVE_TARGET_PORT,
3, 4);
/* Reserved */
cp[2] = 0;
/* IDENTIFIER LENGTH */
cp[3] = 0;
/* IDENTIFIER */
/* Obsolete */
DSET16(&cp[4], 0);
/* Relative Target Port Identifier */
//DSET16(&cp[6], 1); /* port1 as port A */
//DSET16(&cp[6], 2); /* port2 as port B */
DSET16(&cp[6], (uint16_t) (1 + conn->portal.idx));
plen = 4;
cp[3] = plen;
len += 4 + plen;
/* Identification descriptor 6 */
/* Target port group */
cp = &data[hlen + len];
/* PROTOCOL IDENTIFIER(7-4) CODE SET(3-0) */
BDSET8W(&cp[0], SPC_PROTOCOL_IDENTIFIER_ISCSI, 7, 4);
BDADD8W(&cp[0], SPC_VPD_CODE_SET_BINARY, 3, 4);
/* PIV(7) ASSOCIATION(5-4) IDENTIFIER TYPE(3-0) */
BDSET8W(&cp[1], 1, 7, 1); /* PIV */
BDADD8W(&cp[1], SPC_VPD_ASSOCIATION_TARGET_PORT, 5, 2);
BDADD8W(&cp[1], SPC_VPD_IDENTIFIER_TYPE_TARGET_PORT_GROUP,
3, 4);
/* Reserved */
cp[2] = 0;
/* IDENTIFIER LENGTH */
cp[3] = 0;
/* IDENTIFIER */
/* Reserved */
DSET16(&cp[4], 0);
/* TARGET PORT GROUP */
DSET16(&cp[6], (uint16_t) (conn->portal.tag));
plen = 4;
cp[3] = plen;
len += 4 + plen;
/* Identification descriptor 7 */
/* Logical unit group */
cp = &data[hlen + len];
/* PROTOCOL IDENTIFIER(7-4) CODE SET(3-0) */
BDSET8W(&cp[0], SPC_PROTOCOL_IDENTIFIER_ISCSI, 7, 4);
BDADD8W(&cp[0], SPC_VPD_CODE_SET_BINARY, 3, 4);
/* PIV(7) ASSOCIATION(5-4) IDENTIFIER TYPE(3-0) */
BDSET8W(&cp[1], 1, 7, 1); /* PIV */
BDADD8W(&cp[1], SPC_VPD_ASSOCIATION_TARGET_PORT, 5, 2);
BDADD8W(&cp[1], SPC_VPD_IDENTIFIER_TYPE_LOGICAL_UNIT_GROUP,
3, 4);
/* Reserved */
cp[2] = 0;
/* IDENTIFIER LENGTH */
cp[3] = 0;
/* IDENTIFIER */
/* Reserved */
DSET16(&cp[4], 0);
/* LOGICAL UNIT GROUP */
DSET16(&cp[6], (uint16_t) (spec->lu->num));
plen = 4;
cp[3] = plen;
len += 4 + plen;
/* PAGE LENGTH */
if (len > 0xffff) {
len = 0xffff;
}
DSET16(&data[2], len);
break;
case SPC_VPD_EXTENDED_INQUIRY_DATA:
/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
BDSET8W(&data[0], pq, 7, 3);
BDADD8W(&data[0], pd, 4, 5);
/* PAGE CODE */
data[1] = pc;
/* Reserved */
data[2] = 0;
/* PAGE LENGTH */
data[3] = 0;
hlen = 4;
/* RTO(3) GRD_CHK(2) APP_CHK(1) REF_CHK(0) */
data[4] = 0;
/* GROUP_SUP(4) PRIOR_SUP(3) HEADSUP(2) ORDSUP(1) SIMPSUP(0) */
data[5] = 0;
/* NV_SUP(1) V_SUP(0) */
data[6] = 0;
/* Reserved[7-63] */
memset(&data[7], 0, (64 - 7));
len = 64 - hlen;
/* PAGE LENGTH */
data[3] = len;
break;
case SPC_VPD_MANAGEMENT_NETWORK_ADDRESSES:
/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
BDSET8W(&data[0], pq, 7, 3);
BDADD8W(&data[0], pd, 4, 5);
/* PAGE CODE */
data[1] = pc;
/* PAGE LENGTH */
DSET16(&data[2], 0);
hlen = 4;
#if 0
/* Network services descriptor N */
cp = &data[hlen + len];
/* ASSOCIATION(6-5) SERVICE TYPE(4-0) */
BDSET8W(&cp[0], 0x00, 6, 2);
BDADD8W(&cp[0], 0x00, 4, 5);
/* Reserved */
cp[1] = 0;
/* NETWORK ADDRESS LENGTH */
DSET16(&cp[2], 0);
/* NETWORK ADDRESS */
cp[4] = 0;
/* ... */
plen = 0;
DSET16(&cp[2], plen);
len += 4 + plen;
#endif
/* PAGE LENGTH */
if (len > 0xffff) {
len = 0xffff;
}
DSET16(&data[2], len);
break;
case SPC_VPD_MODE_PAGE_POLICY:
/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
BDSET8W(&data[0], pq, 7, 3);
BDADD8W(&data[0], pd, 4, 5);
/* PAGE CODE */
data[1] = pc;
/* PAGE LENGTH */
DSET16(&data[2], 0);
hlen = 4;
/* Mode page policy descriptor 1 */
cp = &data[hlen + len];
/* POLICY PAGE CODE(5-0) */
BDSET8W(&cp[0], 0x3f, 5, 6); /* all page code */
/* POLICY SUBPAGE CODE */
cp[1] = 0xff; /* all sub page */
/* MLUS(7) MODE PAGE POLICY(1-0) */
//BDSET8(&cp[2], 1, 7); /* multiple logical units share */
BDSET8(&cp[2], 0, 7); /* own copy */
BDADD8W(&cp[2], 0x00, 1, 2); /* Shared */
//BDADD8W(&cp[2], 0x01, 1, 2); /* Per target port */
//BDADD8W(&cp[2], 0x02, 1, 2); /* Per initiator port */
//BDADD8W(&cp[2], 0x03, 1, 2); /* Per I_T nexus */
/* Reserved */
cp[3] = 0;
len += 4;
/* PAGE LENGTH */
if (len > 0xffff) {
len = 0xffff;
}
DSET16(&data[2], len);
break;
case SPC_VPD_SCSI_PORTS:
/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
BDSET8W(&data[0], pq, 7, 3);
BDADD8W(&data[0], pd, 4, 5);
/* PAGE CODE */
data[1] = pc;
/* PAGE LENGTH */
DSET16(&data[2], 0);
hlen = 4;
/* Identification descriptor list */
for (i = 0; i < spec->lu->maxmap; i++) {
pg_tag = spec->lu->map[i].pg_tag;
/* skip same pg_tag */
for (j = 0; j < i; j++) {
if (spec->lu->map[j].pg_tag == pg_tag) {
goto skip_pg_tag;
}
}
/* Identification descriptor N */
cp = &data[hlen + len];
/* Reserved */
DSET16(&cp[0], 0);
/* RELATIVE PORT IDENTIFIER */
DSET16(&cp[2], (uint16_t) (1 + pg_tag));
/* Reserved */
DSET16(&cp[4], 0);
/* INITIATOR PORT TRANSPORTID LENGTH */
DSET16(&cp[6], 0);
/* Reserved */
DSET16(&cp[8], 0);
/* TARGET PORT DESCRIPTORS LENGTH */
DSET16(&cp[10], 0);
len += 12;
plen2 = 0;
/* Target port descriptor 1 */
cp2 = &data[hlen + len + plen2];
/* PROTOCOL IDENTIFIER(7-4) CODE SET(3-0) */
BDSET8W(&cp2[0], SPC_PROTOCOL_IDENTIFIER_ISCSI, 7, 4);
BDADD8W(&cp2[0], SPC_VPD_CODE_SET_UTF8, 3, 4);
/* PIV(7) ASSOCIATION(5-4) IDENTIFIER TYPE(3-0) */
BDSET8W(&cp2[1], 1, 7, 1); /* PIV */
BDADD8W(&cp2[1], SPC_VPD_ASSOCIATION_TARGET_PORT, 5, 2);
BDADD8W(&cp2[1], SPC_VPD_IDENTIFIER_TYPE_SCSI_NAME, 3, 4);
/* Reserved */
cp2[2] = 0;
/* IDENTIFIER LENGTH */
cp2[3] = 0;
/* IDENTIFIER */
plen = snprintf((char *) &cp2[4], MAX_TARGET_NAME,
"%s"",t,0x""%4.4x", spec->lu->name, pg_tag);
cp2[3] = plen;
plen2 += 4 + plen;
/* TARGET PORT DESCRIPTORS LENGTH */
DSET16(&cp[10], plen2);
len += plen2;
skip_pg_tag:
;
}
/* PAGE LENGTH */
if (len > 0xffff) {
len = 0xffff;
}
DSET16(&data[2], len);
break;
default:
if (pc >= 0xc0 && pc <= 0xff) {
ISTGT_WARNLOG("Vendor specific INQUIRY VPD page 0x%x\n", pc);
} else {
ISTGT_ERRLOG("unsupported INQUIRY VPD page 0x%x\n", pc);
}
return -1;
}
} else {
/* Standard INQUIRY data */
/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
BDSET8W(&data[0], pq, 7, 3);
BDADD8W(&data[0], pd, 4, 5);
/* RMB(7) */
BDSET8W(&data[1], rmb, 7, 1);
/* VERSION */
/* See SPC3/SBC2/MMC4/SAM2 for more details */
data[2] = SPC_VERSION_SPC3;
/* NORMACA(5) HISUP(4) RESPONSE DATA FORMAT(3-0) */
BDSET8W(&data[3], 2, 3, 4); /* format 2 */
BDADD8(&data[1], 1, 4); /* hierarchical support */
/* ADDITIONAL LENGTH */
data[4] = 0;
hlen = 5;
/* SCCS(7) ACC(6) TPGS(5-4) 3PC(3) PROTECT(0) */
data[5] = 0;
/* BQUE(7) ENCSERV(6) VS(5) MULTIP(4) MCHNGR(3) ADDR16(0) */
data[6] = 0;
/* WBUS16(5) SYNC(4) LINKED(3) CMDQUE(1) VS(0) */
data[7] = 0;
/* T10 VENDOR IDENTIFICATION */
istgt_strcpy_pad(&data[8], 8, spec->lu->inq_vendor, ' ');
/* PRODUCT IDENTIFICATION */
istgt_strcpy_pad(&data[16], 16, spec->lu->inq_product, ' ');
/* PRODUCT REVISION LEVEL */
istgt_strcpy_pad(&data[32], 4, spec->lu->inq_revision, ' ');
/* Vendor specific */
memset(&data[36], 0x20, 20);
/* CLOCKING(3-2) QAS(1) IUS(0) */
data[56] = 0;
/* Reserved */
data[57] = 0;
/* VERSION DESCRIPTOR 1-8 */
DSET16(&data[58], 0x0960); /* iSCSI (no version claimed) */
DSET16(&data[60], 0x0300); /* SPC-3 (no version claimed) */
DSET16(&data[62], 0x03a0); /* MMC-4 (no version claimed) */
DSET16(&data[64], 0x0040); /* SAM-2 (no version claimed) */
DSET16(&data[66], 0x0000);
DSET16(&data[68], 0x0000);
DSET16(&data[70], 0x0000);
DSET16(&data[72], 0x0000);
/* Reserved[74-95] */
memset(&data[74], 0, (96 - 74));
/* Vendor specific parameters[96-n] */
//data[96] = 0;
len = 96 - hlen;
/* ADDITIONAL LENGTH */
data[4] = len;
}
return hlen + len;
}
#define MODE_SENSE_PAGE_INIT(B,L,P,SP) \
do { \
memset((B), 0, (L)); \
if ((SP) != 0x00) { \
(B)[0] = (P) | 0x40; /* PAGE + SPF=1 */ \
(B)[1] = (SP); \
DSET16(&(B)[2], (L) - 4); \
} else { \
(B)[0] = (P); \
(B)[1] = (L) - 2; \
} \
} while (0)
static int
istgt_lu_dvd_scsi_mode_sense_page(ISTGT_LU_DVD *spec, CONN_Ptr conn, uint8_t *cdb, int pc, int page, int subpage, uint8_t *data, int alloc_len)
{
uint8_t *cp;
int len = 0;
int plen;
int i;
#if 0
printf("SENSE pc=%d, page=%2.2x, subpage=%2.2x\n", pc, page, subpage);
#endif
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "MODE_SENSE: pc=%d, page=%2.2x, subpage=%2.2x\n", pc, page, subpage);
if (pc == 0x00) {
/* Current values */
} else if (pc == 0x01) {
/* Changeable values */
if (page != 0x08) {
/* not supported */
return -1;
}
} else if (pc == 0x02) {
/* Default values */
} else {
/* Saved values */
}
cp = &data[len];
switch (page) {
case 0x00:
/* Vendor specific */
break;
case 0x01:
/* Read-Write Error Recovery */
break;
case 0x02:
/* Reserved */
break;
case 0x03:
/* MRW */
break;
case 0x04:
/* Reserved */
break;
case 0x05:
/* Write Parameter */
break;
case 0x06:
/* Reserved */
break;
case 0x07:
/* Verify Error Recovery */
break;
case 0x08:
/* Caching */
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "MODE_SENSE Caching\n");
if (subpage != 0x00)
break;
plen = 0x12 + 2;
MODE_SENSE_PAGE_INIT(cp, plen, page, subpage);
BDADD8(&cp[0], 1, 7); /* PS */
if (pc == 0x01) {
// Changeable values
BDADD8(&cp[2], 1, 2); /* WCE */
BDADD8(&cp[2], 1, 0); /* RCD */
len += plen;
break;
}
BDADD8(&cp[2], 1, 2); /* WCE */
//BDADD8(&cp[2], 1, 0); /* RCD */
if (spec->write_cache == 1) {
BDADD8(&cp[2], 1, 2); /* WCE=1 */
} else {
BDADD8(&cp[2], 0, 2); /* WCE=0 */
}
if (spec->read_cache == 0) {
BDADD8(&cp[2], 1, 0); /* RCD=1 */
} else {
BDADD8(&cp[2], 0, 0); /* RCD=0 */
}
len += plen;
break;
case 0x09:
case 0x0a:
/* Reserved */
break;
case 0x0b:
/* Medium Types Supported */
break;
case 0x0c:
/* Reserved */
break;
case 0x0d:
/* CD Device Parameters */
break;
case 0x0e:
/* CD Audio Control */
break;
case 0x0f:
case 0x10:
case 0x11:
case 0x12:
case 0x13:
case 0x14:
case 0x15:
case 0x16:
case 0x17:
case 0x18:
case 0x19:
/* Reserved */
break;
case 0x1a:
/* Power Condition */
break;
case 0x1b:
/* Reserved */
break;
case 0x1c:
/* Informational Exceptions Control */
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "MODE_SENSE Informational Exceptions Control\n");
if (subpage != 0x00)
break;
plen = 0x0a + 2;
MODE_SENSE_PAGE_INIT(cp, plen, page, subpage);
len += plen;
break;
case 0x1d:
/* Time-out & Protect */
break;
case 0x1e:
case 0x1f:
/* Reserved */
break;
case 0x20:
case 0x21:
case 0x22:
case 0x23:
case 0x24:
case 0x25:
case 0x26:
case 0x27:
case 0x28:
case 0x29:
/* Vendor-specific */
break;
case 0x2a:
/* MM Capabilities & Mechanical Status */
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "MODE_SENSE MM Capabilities & Mechanical Status\n");
if (subpage != 0x00)
break;
plen = 28 + 2;
MODE_SENSE_PAGE_INIT(cp, plen, page, subpage);
BDADD8(&cp[2], 1, 3); /* DVD-ROM read */
len += plen;
break;
case 0x2b:
/* Reserved */
break;
case 0x2c:
case 0x2d:
case 0x2e:
case 0x2f:
case 0x30:
case 0x31:
case 0x32:
case 0x33:
case 0x34:
case 0x35:
case 0x36:
case 0x37:
case 0x38:
case 0x39:
case 0x3a:
case 0x3b:
case 0x3c:
case 0x3d:
case 0x3e:
/* Vendor-specific */
break;
case 0x3f:
switch (subpage) {
case 0x00:
/* All mode pages */
for (i = 0x00; i < 0x3e; i ++) {
len += istgt_lu_dvd_scsi_mode_sense_page(spec, conn, cdb, pc, i, 0x00, &cp[len], alloc_len);
}
break;
case 0xff:
/* All mode pages and subpages */
for (i = 0x00; i < 0x3e; i ++) {
len += istgt_lu_dvd_scsi_mode_sense_page(spec, conn, cdb, pc, i, 0x00, &cp[len], alloc_len);
}
for (i = 0x00; i < 0x3e; i ++) {
len += istgt_lu_dvd_scsi_mode_sense_page(spec, conn, cdb, pc, i, 0xff, &cp[len], alloc_len);
}
break;
default:
/* 0x01-0x3e: Reserved */
break;
}
}
return len;
}
static int
istgt_lu_dvd_scsi_mode_sense6(ISTGT_LU_DVD *spec, CONN_Ptr conn, uint8_t *cdb, int dbd, int pc, int page, int subpage, uint8_t *data, int alloc_len)
{
uint8_t *cp;
int hlen = 0, len = 0, plen;
int total;
int llbaa = 0;
data[0] = 0; /* Mode Data Length */
if (spec->mload) {
data[1] = 0; /* Medium Type */
data[2] = 0; /* Device-Specific Parameter */
if (spec->lu->readonly
|| (spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY)) {
BDADD8(&data[2], 1, 7); /* WP */
}
} else {
data[1] = 0; /* Medium Type */
data[2] = 0; /* Device-Specific Parameter */
}
data[3] = 0; /* Block Descripter Length */
hlen = 4;
cp = &data[4];
if (dbd) { /* Disable Block Descripters */
len = 0;
} else {
if (llbaa) {
if (spec->mload) {
/* Number of Blocks */
DSET64(&cp[0], spec->blockcnt);
/* Reserved */
DSET32(&cp[8], 0);
/* Block Length */
DSET32(&cp[12], (uint32_t) spec->blocklen);
} else {
/* Number of Blocks */
DSET64(&cp[0], 0ULL);
/* Reserved */
DSET32(&cp[8], 0);
/* Block Length */
DSET32(&cp[12], 0);
}
len = 16;
} else {
if (spec->mload) {
/* Number of Blocks */
if (spec->blockcnt > 0xffffffffULL) {
DSET32(&cp[0], 0xffffffffUL);
} else {
DSET32(&cp[0], (uint32_t) spec->blockcnt);
}
/* Block Length */
DSET32(&cp[4], (uint32_t) spec->blocklen);
} else {
/* Number of Blocks */
DSET32(&cp[0], 0);
/* Block Length */
DSET32(&cp[4], 0);
}
len = 8;
}
cp += len;
}
data[3] = len; /* Block Descripter Length */
plen = istgt_lu_dvd_scsi_mode_sense_page(spec, conn, cdb, pc, page, subpage, &cp[0], alloc_len);
if (plen < 0) {
return -1;
}
cp += plen;
total = hlen + len + plen;
data[0] = total - 1; /* Mode Data Length */
return total;
}
static int
istgt_lu_dvd_scsi_mode_sense10(ISTGT_LU_DVD *spec, CONN_Ptr conn, uint8_t *cdb, int dbd, int llbaa, int pc, int page, int subpage, uint8_t *data, int alloc_len)
{
uint8_t *cp;
int hlen = 0, len = 0, plen;
int total;
DSET16(&data[0], 0); /* Mode Data Length */
if (spec->mload) {
data[2] = 0; /* Medium Type */
data[3] = 0; /* Device-Specific Parameter */
if (spec->lu->readonly
|| (spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY)) {
BDADD8(&data[3], 1, 7); /* WP */
}
} else {
data[2] = 0; /* Medium Type */
data[3] = 0; /* Device-Specific Parameter */
}
if (llbaa) {
BDSET8(&data[4], 1, 1); /* Long LBA */
} else {
BDSET8(&data[4], 0, 1); /* Short LBA */
}
data[5] = 0; /* Reserved */
DSET16(&data[6], 0); /* Block Descripter Length */
hlen = 8;
cp = &data[8];
if (dbd) { /* Disable Block Descripters */
len = 0;
} else {
if (llbaa) {
if (spec->mload) {
/* Number of Blocks */
DSET64(&cp[0], spec->blockcnt);
/* Reserved */
DSET32(&cp[8], 0);
/* Block Length */
DSET32(&cp[12], (uint32_t) spec->blocklen);
} else {
/* Number of Blocks */
DSET64(&cp[0], 0ULL);
/* Reserved */
DSET32(&cp[8], 0);
/* Block Length */
DSET32(&cp[12], 0);
}
len = 16;
} else {
if (spec->mload) {
/* Number of Blocks */
if (spec->blockcnt > 0xffffffffULL) {
DSET32(&cp[0], 0xffffffffUL);
} else {
DSET32(&cp[0], (uint32_t) spec->blockcnt);
}
/* Block Length */
DSET32(&cp[4], (uint32_t) spec->blocklen);
} else {
/* Number of Blocks */
DSET32(&cp[0], 0);
/* Block Length */
DSET32(&cp[4], 0);
}
len = 8;
}
cp += len;
}
DSET16(&data[6], len); /* Block Descripter Length */
plen = istgt_lu_dvd_scsi_mode_sense_page(spec, conn, cdb, pc, page, subpage, &cp[0], alloc_len);
if (plen < 0) {
return -1;
}
cp += plen;
total = hlen + len + plen;
DSET16(&data[0], total - 2); /* Mode Data Length */
return total;
}
static int
istgt_lu_dvd_transfer_data(CONN_Ptr conn, ISTGT_LU_CMD_Ptr lu_cmd, uint8_t *buf, size_t bufsize, size_t len)
{
int rc;
if (len > bufsize) {
ISTGT_ERRLOG("bufsize(%zd) too small\n", bufsize);
return -1;
}
rc = istgt_iscsi_transfer_out(conn, lu_cmd, buf, bufsize, len);
if (rc < 0) {
ISTGT_ERRLOG("iscsi_transfer_out()\n");
return -1;
}
return 0;
}
static int
istgt_lu_dvd_scsi_mode_select_page(ISTGT_LU_DVD *spec, CONN_Ptr conn, uint8_t *cdb, int pf, int sp, uint8_t *data, size_t len)
{
size_t hlen, plen;
int ps, spf, page, subpage;
int rc;
if (pf == 0) {
/* vendor specific */
return 0;
}
if (len < 1)
return 0;
ps = BGET8(&data[0], 7);
spf = BGET8(&data[0], 6);
page = data[0] & 0x3f;
if (spf) {
/* Sub_page mode page format */
hlen = 4;
if (len < hlen)
return 0;
subpage = data[1];
plen = DGET16(&data[2]);
} else {
/* Page_0 mode page format */
hlen = 2;
if (len < hlen)
return 0;
subpage = 0;
plen = data[1];
}
plen += hlen;
if (len < plen)
return 0;
#if 0
printf("ps=%d, page=%2.2x, subpage=%2.2x\n", ps, page, subpage);
#endif
switch (page) {
case 0x08:
/* Caching */
{
int wce, rcd;
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "MODE_SELECT Caching\n");
if (subpage != 0x00)
break;
if (plen != 0x12 + hlen) {
/* unknown format */
break;
}
wce = BGET8(&data[2], 2); /* WCE */
rcd = BGET8(&data[2], 0); /* RCD */
if (wce) {
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "MODE_SELECT Writeback cache enable\n");
spec->write_cache = 1;
} else {
spec->write_cache = 0;
}
if (rcd) {
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "MODE_SELECT Read cache disable\n");
spec->read_cache = 0;
} else {
spec->read_cache = 1;
}
}
break;
default:
/* not supported */
break;
}
len -= plen;
if (len != 0) {
rc = istgt_lu_dvd_scsi_mode_select_page(spec, conn, cdb, pf, sp, &data[plen], len);
if (rc < 0) {
return rc;
}
}
return 0;
}
#define FEATURE_DESCRIPTOR_INIT(B,L,FC) \
do { \
memset((B), 0, (L)); \
DSET16(&(B)[0], (FC)); \
(B)[3] = (L) - 4; \
} while (0)
static int
istgt_lu_dvd_get_feature_descriptor(ISTGT_LU_DVD *spec, CONN_Ptr conn __attribute__((__unused__)), uint8_t *cdb __attribute__((__unused__)), int fc, uint8_t *data)
{
uint8_t *cp;
int hlen = 0, len = 0, plen;
switch (fc) {
case 0x0000:
/* Profile List */
plen = 2 * 4 + 4;
FEATURE_DESCRIPTOR_INIT(data, plen, fc);
/* Version(5-2) Persistent(1) Current(0) */
BDSET8W(&data[2], 0, 5, 4);
BSET8(&data[2], 1); /* Persistent=1 */
BSET8(&data[2], 0); /* Current=1 */
hlen = 4;
/* Profile Descriptor */
cp = &data[hlen + len];
/* Profile 1 (CDROM) */
DSET16(&cp[0], 0x0008);
if (spec->profile == MM_PROF_CDROM) {
BSET8(&cp[2], 0); /* CurrentP(0)=1 */
}
plen = 4;
len += plen;
cp = &data[hlen + len];
/* Profile 2 (DVDROM) */
DSET16(&cp[0], 0x0010);
if (spec->profile == MM_PROF_DVDROM) {
BSET8(&cp[2], 0); /* CurrentP(0)=1 */
}
plen = 4;
len += plen;
break;
case 0x0001:
/* Core Feature */
/* GET CONFIGURATION/GET EVENT STATUS NOTIFICATION/INQUIRY */
/* MODE SELECT (10)/MODE SENSE (10)/REQUEST SENSE/TEST UNIT READY */
plen = 8 + 4;
FEATURE_DESCRIPTOR_INIT(data, plen, fc);
/* Version(5-2) Persistent(1) Current(0) */
BDSET8W(&data[2], 0x01, 5, 4); /* MMC4 */
BSET8(&data[2], 1); /* Persistent=1 */
BSET8(&data[2], 0); /* Current=1 */
hlen = 4;
/* Physical Interface Standard */
DSET32(&data[4], 0x00000000); /* Unspecified */
/* DBE(0) */
BCLR8(&data[8], 0); /* DBE=0*/
len = 8;
break;
case 0x0003:
/* Removable Medium */
/* MECHANISM STATUS/PREVENT ALLOW MEDIUM REMOVAL/START STOP UNIT */
plen = 0x04 + 4;
FEATURE_DESCRIPTOR_INIT(data, plen, fc);
/* Version(5-2) Persistent(1) Current(0) */
BDSET8W(&data[2], 0x01, 5, 4);
BSET8(&data[2], 1); /* Persistent=1 */
BSET8(&data[2], 0); /* Current=1 */
hlen = 4;
/* Loading Mechanism Type(7-5) Eject(3) Pvnt Jmpr(2) Lock(0) */
BDSET8W(&data[4], 0x01, 7, 3); /* Tray type loading mechanism */
BSET8(&data[4], 3); /* eject via START/STOP YES */
BSET8(&data[4], 0); /* locking YES */
len = 8;
break;
case 0x0010:
/* Random Readable */
/* READ CAPACITY/READ (10) */
plen = 4 + 4;
FEATURE_DESCRIPTOR_INIT(data, plen, fc);
/* Version(5-2) Persistent(1) Current(0) */
BDSET8W(&data[2], 0x00, 5, 4);
BSET8(&data[2], 1); /* Persistent=1 */
BSET8(&data[2], 0); /* Current=1 */
hlen = 4;
/* Logical Block Size */
DSET32(&data[4], (uint32_t) spec->blocklen);
/* Blocking */
DSET16(&data[8], 1);
/* PP(0) */
BCLR8(&data[10], 0); /* PP=0 */
len = 4;
break;
case 0x001d:
/* Multi-Read Feature */
/* READ (10)/READ CD/READ DISC INFORMATION/READ TRACK INFORMATION */
plen = 4;
FEATURE_DESCRIPTOR_INIT(data, plen, fc);
/* Version(5-2) Persistent(1) Current(0) */
BDSET8W(&data[2], 0x00, 5, 4);
BSET8(&data[2], 1); /* Persistent=1 */
BSET8(&data[2], 0); /* Current=1 */
hlen = 4;
len = 0;
break;
case 0x001e:
/* CD Read */
/* READ CD/READ CD MSF/READ TOC/PMA/ATIP */
plen = 4 + 4;
FEATURE_DESCRIPTOR_INIT(data, plen, fc);
/* Version(5-2) Persistent(1) Current(0) */
BDSET8W(&data[2], 0x02, 5, 4); /* MMC4 */
BCLR8(&data[2], 1); /* Persistent=0 */
if (spec->profile == MM_PROF_CDROM) {
BSET8(&data[2], 0); /* Current=1 */
} else {
BCLR8(&data[2], 0); /* Current=0 */
}
hlen = 4;
/* DAP(7) C2 Flags(1) CD-Text(0) */
BCLR8(&data[4], 7); /* not support DAP */
BCLR8(&data[4], 1); /* not support C2 */
BCLR8(&data[4], 0); /* not support CD-Text */
len = 4;
break;
case 0x001f:
/* DVD Read */
/* READ (10)/READ (12)/READ DVD STRUCTURE/READ TOC/PMA/ATIP */
plen = 4;
FEATURE_DESCRIPTOR_INIT(data, plen, fc);
/* Version(5-2) Persistent(1) Current(0) */
BDSET8W(&data[2], 0x00, 5, 4);
BCLR8(&data[2], 1); /* Persistent=0 */
if (spec->profile == MM_PROF_DVDROM) {
BSET8(&data[2], 0); /* Current=1 */
} else {
BCLR8(&data[2], 0); /* Current=0 */
}
hlen = 4;
len = 0;
break;
default:
/* not supported */
break;
}
return hlen + len;
}
static int
istgt_lu_dvd_scsi_get_configuration(ISTGT_LU_DVD *spec, CONN_Ptr conn, uint8_t *cdb, int rt, int sfn, uint8_t *data)
{
uint8_t *cp;
int hlen = 0, len = 0, plen;
int fc;
/* Feature Header */
/* Data Length */
DSET32(&data[0], 0);
/* Reserved */
data[4] = 0;
/* Reserved */
data[5] = 0;
/* Current Profile */
DSET16(&data[6], spec->profile);
hlen = 8;
cp = &data[hlen];
switch (rt) {
case 0x00:
/* all of features */
for (fc = sfn; fc < 0xffff; fc++) {
plen = istgt_lu_dvd_get_feature_descriptor(spec, conn, cdb, fc, &cp[len]);
len += plen;
}
break;
case 0x01:
/* current of features */
for (fc = sfn; fc < 0xffff; fc++) {
plen = istgt_lu_dvd_get_feature_descriptor(spec, conn, cdb, fc, &cp[len]);
if (BGET8(&cp[2], 0) == 1) {
len += plen;
} else {
/* drop non active descriptors */
}
}
break;
case 0x02:
/* specified feature */
fc = sfn;
plen = istgt_lu_dvd_get_feature_descriptor(spec, conn, cdb, fc, &cp[len]);
len += plen;
break;
default:
/* not supported */
break;
}
/* Data Length */
DSET32(&data[0], len);
return hlen + len;
}
static int
istgt_lu_dvd_scsi_get_event_status_notification(ISTGT_LU_DVD *spec, CONN_Ptr conn __attribute__((__unused__)), uint8_t *cdb __attribute__((__unused__)), int keep __attribute__((__unused__)), int ncr, uint8_t *data)
{
uint8_t *cp;
int hlen = 0, len = 0;
/* Event Descriptor Length */
DSET16(&data[0], 0);
/* NEA(7) Notification Class(2-0) */
data[2] = 0;
/* Supported Event Classes */
data[3] = 0x7e;
hlen = 4;
cp = &data[hlen];
/* Lowest class number has highest priority */
if (ncr & (1 << 0)) {
/* Reserved */
len = 0;
}
if (ncr & (1 << 1)) {
/* Operational Change */
BDSET8W(&data[2], 0x01, 2, 3); /* Notification Class */
/* Event Code */
BDSET8W(&cp[0], 0x00, 3, 4); /* NoChg */
/* Persistent Prevented(7) Operational Status(3-0) */
BDSET8(&cp[1], 0, 7); /* not prevented */
BDADD8W(&cp[1], 0, 3, 4);
/* Operational Change */
DSET16(&cp[2], 0x00); /* NoChg */
len = 4;
goto event_available;
}
if (ncr & (1 << 2)) {
/* Power Management */
BDSET8W(&data[2], 0x02, 2, 3); /* Notification Class */
/* Event Code */
BDSET8W(&cp[0], 0x00, 3, 4); /* NoChg */
/* Power Status */
cp[1] = 0x01; /* Active */
/* Reserved */
cp[2] = 0;
/* Reserved */
cp[3] = 0;
len = 4;
goto event_available;
}
if (ncr & (1 << 3)) {
/* External Request */
BDSET8W(&data[2], 0x03, 2, 3); /* Notification Class */
/* Event Code */
BDSET8W(&cp[0], 0x00, 3, 4); /* NoChg */
/* Persistent Prevented(7) External Request Status(3-0) */
BDSET8(&cp[1], 0, 7); /* not prevented */
BDADD8W(&cp[1], 0, 3, 4); /* Ready */
/* External Request */
DSET16(&cp[2], 0x00); /* No Request */
len = 4;
goto event_available;
}
if (ncr & (1 << 4)) {
/* Media */
BDSET8W(&data[2], 0x04, 2, 3); /* Notification Class */
if (spec->mchanged) {
if (spec->mwait > 0) {
spec->mwait--;
} else {
spec->mchanged = 0;
spec->mload = 1;
}
if (spec->mload) {
/* Event Code */
BDSET8W(&cp[0], 0x02, 3, 4); /* NewMedia */
/* Media Status */
/* Media Present(1) Door or Tray open(0) */
BDSET8(&cp[1], 1, 1); /* media present */
BDADD8(&cp[1], 0, 0); /* tray close */
} else {
/* Event Code */
BDSET8W(&cp[0], 0x03, 3, 4); /* MediaRemoval */
/* Media Status */
/* Media Present(1) Door or Tray open(0) */
BDSET8(&cp[1], 0, 1); /* media absent */
BDADD8(&cp[1], 1, 0); /* tray open */
}
} else {
if (spec->mwait > 0) {
spec->mwait--;
/* Event Code */
BDSET8W(&cp[0], 0x01, 3, 4); /* EjectRequest */
/* Media Status */
/* Media Present(1) Door or Tray open(0) */
BDSET8(&cp[1], 0, 1); /* media absent */
BDADD8(&cp[1], 1, 0); /* tray open */
} else {
if (spec->mload) {
/* Event Code */
BDSET8W(&cp[0], 0x00, 3, 4); /* NoChg */
/* Media Status */
/* Media Present(1) Door or Tray open(0) */
BDSET8(&cp[1], 1, 1); /* media present */
BDADD8(&cp[1], 0, 0); /* tray close */
} else {
/* Event Code */
BDSET8W(&cp[0], 0x00, 3, 4); /* NoChg */
/* Media Status */
/* Media Present(1) Door or Tray open(0) */
BDSET8(&cp[1], 0, 1); /* media absent */
BDADD8(&cp[1], 0, 0); /* tray close */
}
}
}
/* Start Slot */
cp[2] = 0;
/* End Slot */
cp[3] = 0;
len = 4;
goto event_available;
}
if (ncr & (1 << 5)) {
/* Multi-Initiator */
BDSET8W(&data[2], 0x05, 2, 3); /* Notification Class */
/* Event Code */
BDSET8W(&cp[0], 0x00, 3, 4); /* NoChg */
/* Persistent Prevented(7) Multiple Initiator Status(3-0) */
BDSET8(&cp[1], 0, 7); /* not prevented */
BDADD8W(&cp[1], 0, 3, 4); /* Ready */
/* Multiple Initiator Priority */
DSET16(&cp[2], 0x00); /* No Request */
len = 4;
goto event_available;
}
if (ncr & (1 << 6)) {
/* Device Busy */
BDSET8W(&data[2], 0x06, 2, 3); /* Notification Class */
/* Event Code */
BDSET8W(&cp[0], 0x00, 3, 4); /* NoChg */
/* Media Status */
/* Device Busy Status */
cp[1] = 0; /* Not Busy */
/* Time */
DSET16(&cp[2], 0);
len = 4;
goto event_available;
}
if (ncr & (1 << 7)) {
/* Reserved */
len = 0;
}
if (len == 0) {
/* No Event Available */
BDSET8(&data[2], 0, 7); /* NEA=1 */
}
event_available:
/* Event Descriptor Length */
DSET16(&data[0], len + (hlen - 2));
return hlen + len;
}
static int
istgt_lu_dvd_scsi_mechanism_status(ISTGT_LU_DVD *spec, CONN_Ptr conn __attribute__((__unused__)), uint8_t *cdb __attribute__((__unused__)), uint8_t *data)
{
uint8_t *cp;
int hlen = 0, len = 0, plen;
int selected_slot = 0, max_slots = 1;
/* Mechanism Status Header */
/* Fault(7) Changer State(6-5) Current Slot(4-0) */
BDSET8(&data[0], 0, 7);
BDADD8W(&data[0], 0x00, 6, 2); /* Ready */
BDADD8W(&data[0], (selected_slot & 0x1f), 4, 5); /* slot low bits */
/* Mechanism State(7-5) Door open(4) Current Slot(2-0) */
BDSET8W(&data[1], 0x00, 7, 3); /* Idle */
BDADD8W(&data[1], (selected_slot & 0xe0) >> 5, 2, 3); /* slot high bits */
/* Current LBA (Legacy) */
DSET24(&data[2], 0);
/* Number of Slots Available */
data[5] = max_slots;
/* Length of Slot Tables */
DSET16(&data[6], 0);
hlen = 8;
/* Slot Tables */
/* Slot 0 */
cp = &data[hlen + len];
if (spec->mchanged) {
if (spec->mload) {
/* Disc Present(7) Change(0) */
BDSET8(&cp[0], 1, 7); /* disc in slot */
} else {
/* Disc Present(7) Change(0) */
BDSET8(&cp[0], 0, 7); /* no disc in slot */
}
BDADD8(&cp[0], 1, 0); /* disc changed */
} else {
if (spec->mload) {
/* Disc Present(7) Change(0) */
BDSET8(&cp[0], 1, 7); /* disc in slot */
} else {
/* Disc Present(7) Change(0) */
BDSET8(&cp[0], 0, 7); /* no disc in slot */
}
BDADD8(&cp[0], 0, 0); /* disc not changed */
}
/* CWP_V(1) CWP(0) */
BDSET8(&cp[1], 0, 1); /* non Cartridge Write Protection */
BDADD8(&cp[1], 0, 0); /* CWP=0 */
/* Reserved */
cp[2] = 0;
/* Reserved */
cp[3] = 0;
plen = 4;
len += plen;
/* Length of Slot Tables */
DSET16(&data[6], len);
return hlen + len;
}
static int
istgt_lu_dvd_scsi_read_toc(ISTGT_LU_DVD *spec, CONN_Ptr conn __attribute__((__unused__)), uint8_t *cdb __attribute__((__unused__)), int msf, int format, int track __attribute__((__unused__)), uint8_t *data)
{
uint8_t *cp;
int hlen = 0, len = 0, plen;
switch (format) {
case 0x00: /* Formatted TOC */
/* TOC Data Length */
DSET16(&data[0], 0);
/* First Track Number */
data[2] = 1;
/* Last Track Number */
data[3] = 1;
hlen = 4;
/* TOC Track Descriptor */
/* Track 1 Descriptor */
cp = &data[hlen + len];
/* Reserved */
cp[0] = 0;
/* ADR(7-4) CONTROL(3-0) */
cp[1] = 0x14;
/* Track Number */
cp[2] = 1;
/* Reserved */
cp[3] = 0;
/* Track Start Address */
if (msf) {
DSET32(&cp[4], istgt_lba2msf(0));
} else {
DSET32(&cp[4], 0);
}
plen = 8;
len += plen;
/* Track AAh (Lead-out) Descriptor */
cp = &data[hlen + len];
/* Reserved */
cp[0] = 0;
/* ADR(7-4) CONTROL(3-0) */
cp[1] = 0x14;
/* Track Number */
cp[2] = 0xaa;
/* Reserved */
cp[3] = 0;
/* Track Start Address */
if (msf) {
DSET32(&cp[4], istgt_lba2msf(spec->blockcnt));
} else {
DSET32(&cp[4], spec->blockcnt);
}
plen = 8;
len += plen;
/* TOC Data Length */
DSET16(&data[0], hlen + len - 2);
break;
case 0x01: /* Multi-session Information */
/* TOC Data Length */
DSET16(&data[0], 0);
/* First Complete Session Number */
data[2] = 1;
/* Last Complete Session Number */
data[3] = 1;
hlen = 4;
/* TOC Track Descriptor */
cp = &data[hlen + len];
/* Reserved */
cp[0] = 0;
/* ADR(7-4) CONTROL(3-0) */
cp[1] = 0x14;
/* First Track Number In Last Complete Session */
cp[2] = 1;
/* Reserved */
cp[3] = 0;
/* Start Address of First Track in Last Session */
if (msf) {
DSET32(&cp[4], istgt_lba2msf(0));
} else {
DSET32(&cp[4], 0);
}
len = 8;
/* TOC Data Length */
DSET16(&data[0], hlen + len - 2);
break;
case 0x02: /* Raw TOC */
/* TOC Data Length */
DSET16(&data[0], 0);
/* First Complete Session Number */
data[2] = 1;
/* Last Complete Session Number */
data[3] = 1;
hlen = 4;
/* TOC Track Descriptor */
/* First Track number in the program area */
cp = &data[hlen + len];
/* Session Number */
cp[0] = 1;
/* ADR(7-4) CONTROL(3-0) */
cp[1] = 0x14;
/* TNO */
cp[2] = 0;
/* POINT */
cp[3] = 0xa0;
/* Min */
cp[4] = 0;
/* Sec */
cp[5] = 0;
/* Frame */
cp[6] = 0;
/* Zero */
cp[7] = 0;
/* PMIN / First Track Number */
cp[8] = 1;
/* PSEC / Disc Type */
cp[9] = 0x00; /* CD-DA or CD Data with first track in Mode 1 */
/* PFRAME */
cp[10] = 0;
plen = 11;
len += plen;
/* Last Track number in the program area */
cp = &data[hlen + len];
/* Session Number */
cp[0] = 1;
/* ADR(7-4) CONTROL(3-0) */
cp[1] = 0x14;
/* TNO */
cp[2] = 0;
/* POINT */
cp[3] = 0xa1;
/* Min */
cp[4] = 0;
/* Sec */
cp[5] = 0;
/* Frame */
cp[6] = 0;
/* Zero */
cp[7] = 0;
/* PMIN / Last Track Number */
cp[8] = 1;
/* PSEC */
cp[9] = 0;
/* PFRAME */
cp[10] = 0;
plen = 11;
len += plen;
/* Start location of the Lead-out area */
cp = &data[hlen + len];
/* Session Number */
cp[0] = 1;
/* ADR(7-4) CONTROL(3-0) */
cp[1] = 0x14;
/* TNO */
cp[2] = 0;
/* POINT */
cp[3] = 0xa2;
/* Min */
cp[4] = 0;
/* Sec */
cp[5] = 0;
/* Frame */
cp[6] = 0;
/* Zero */
cp[7] = 0;
/* PMIN / Start position of Lead-out */
/* PSEC / Start position of Lead-out */
/* PFRAME / Start position of Lead-out */
if (msf) {
DSET24(&cp[8], istgt_lba2msf(spec->blockcnt));
} else {
DSET24(&cp[8], spec->blockcnt);
}
plen = 11;
len += plen;
/* Track data */
cp = &data[hlen + len];
/* Session Number */
cp[0] = 1;
/* ADR(7-4) CONTROL(3-0) */
cp[1] = 0x14;
/* TNO */
cp[2] = 0;
/* POINT */
cp[3] = 1;
/* Min */
cp[4] = 0;
/* Sec */
cp[5] = 0;
/* Frame */
cp[6] = 0;
/* Zero */
cp[7] = 0;
/* PMIN / Start position of Lead-out */
/* PSEC / Start position of Lead-out */
/* PFRAME / Start position of Lead-out */
if (msf) {
DSET24(&cp[8], istgt_lba2msf(0));
} else {
DSET24(&cp[8], 0);
}
plen = 11;
len += plen;
/* TOC Data Length */
DSET16(&data[0], hlen + len - 2);
break;
default:
ISTGT_ERRLOG("unsupported format 0x%x\n", format);
return -1;
}
return hlen + len;
}
static int
istgt_lu_dvd_scsi_read_disc_information(ISTGT_LU_DVD *spec __attribute__((__unused__)), CONN_Ptr conn __attribute__((__unused__)), uint8_t *cdb __attribute__((__unused__)), int datatype, uint8_t *data)
{
int hlen = 0, len = 0;
switch (datatype) {
case 0x00: /* Disc Information Block */
/* Disc Information Length */
DSET16(&data[0], 0);
hlen = 2;
/* Disc Information Data Type(7-5) Erasable(4) */
/* State of last Session(3-2) Disc Status(1-0) */
BDSET8W(&data[2], datatype, 7, 3);
BDADD8W(&data[2], 0, 4, 1);
BDADD8W(&data[2], 0x03, 3, 2); /* Complete Session */
BDADD8W(&data[2], 0x02, 1, 2); /* Finalized Disc */
/* Number of First Track on Disc */
data[3] = 1;
/* Number of Sessions (Least Significant Byte) */
data[4] = (1) & 0xff;
/* First Track Number in Last Session (Least Significant Byte) */
data[5] = (1) & 0xff;
/* Last Track Number in Last Session (Least Significant Byte) */
data[6] = (1) & 0xff;
/* DID_V(7) DBC_V(6) URU(5) DAC_V(4) BG Format Status(1-0) */
BDSET8(&data[7], 0, 7); /* Disc ID Valid */
BDADD8(&data[7], 0, 6); /* Disc Bar Code Valid */
BDADD8(&data[7], 1, 5); /* Unrestricted Use Disc */
BDADD8(&data[7], 0, 4); /* Disc Application Code Valid */
BDADD8W(&data[7], 0, 1, 2); /* BG Format Status */
/* Disc Type */
data[8] = 0x00; /* CD-DA or CD-ROM Disc */
/* Number of Sessions (Most Significant Byte) */
data[9] = (1 >> 8) & 0xff;
/* First Track Number in Last Session (Most Significant Byte) */
data[10] = (1 >> 8) & 0xff;
/* Last Track Number in Last Session (Most Significant Byte) */
data[11] = (1 >> 8) & 0xff;
/* Disc Identification */
DSET32(&data[12], 0);
/* Last Session Lead-in Start Address */
DSET32(&data[16], 0);
/* Last Possible Lead-out Start Address */
DSET32(&data[20], 0);
/* Disc Bar Code */
memset(&data[24], 0, 8);
/* Disc Application Code */
data[32] = 0;
/* Number of OPC Tables */
data[33] = 0;
/* OPC Table Entries */
//data[34] = 0;
len = 34 - hlen;
/* Disc Information Length */
DSET16(&data[0], len);
break;
case 0x01: /* Track Resources Information Block */
/* Disc Information Length */
DSET16(&data[0], 0);
hlen = 2;
/* Disc Information Data Type(7-5) */
BDSET8W(&data[2], datatype, 7, 3);
/* Reserved */
data[3] = 0;
/* Maximum possible number of the Tracks on the disc */
DSET16(&data[4], 99);
/* Number of the assigned Tracks on the disc */
DSET16(&data[6], 1);
/* Maximum possible number of appendable Tracks on the disc */
DSET16(&data[8], 99);
/* Current number of appendable Tracks on the disc */
DSET16(&data[10], 99);
len = 12 - hlen;
/* Disc Information Length */
DSET16(&data[0], len);
break;
case 0x02: /* POW Resources Information Block */
/* Disc Information Length */
DSET16(&data[0], 0);
hlen = 2;
/* Disc Information Data Type(7-5) */
BDSET8W(&data[2], datatype, 7, 3);
/* Reserved */
data[3] = 0;
/* Remaining POW Replacements */
DSET32(&data[4], 0);
/* Remaining POW Reallocation Map Entries */
DSET32(&data[8], 0);
/* Number of Remaining POW Updates */
DSET32(&data[12], 0);
len = 16 - hlen;
/* Disc Information Length */
DSET16(&data[0], len);
break;
default:
ISTGT_ERRLOG("unsupported datatype 0x%x\n", datatype);
return -1;
}
return hlen + len;
}
static int
istgt_lu_dvd_scsi_read_disc_structure(ISTGT_LU_DVD *spec, CONN_Ptr conn __attribute__((__unused__)), uint8_t *cdb __attribute__((__unused__)), int mediatype, int layernumber __attribute__((__unused__)), int format, int agid __attribute__((__unused__)), uint8_t *data)
{
uint8_t *cp;
int hlen = 0, len = 0;
if (mediatype == 0x00) {
/* DVD and HD DVD types */
} else if (mediatype == 0x01) {
/* BD */
} else {
/* Reserved */
}
switch (format) {
case 0x00: /* Physical Format Information */
/* Disc Structure Data Length */
DSET16(&data[0], 0);
/* Reserved */
data[2] = 0;
/* Reserved */
data[3] = 0;
hlen = 4;
/* Physical Format Information */
cp = &data[hlen + len];
/* Disk Category(7-4) Part Version(3-0) */
BDSET8W(&cp[0], 0x00, 7, 4); /* DVD-ROM */
BDADD8W(&cp[0], 0x01, 3, 4); /* part 1 */
/* Disc Size(7-4) Maximum Rate(0-3) */
BDSET8W(&cp[1], 0x00, 7, 4); /* 120mm */
BDADD8W(&cp[1], 0x0f, 3, 4); /* Not Specified */
/* Number of Layers(6-5) Track(4) Layer Type(3-0) */
BDSET8W(&cp[2], 0x00, 6, 2); /* one layer */
BDADD8W(&cp[2], 0x00, 4, 1); /* Parallel Track Path */
BDADD8W(&cp[2], 0x00, 3, 4); /* embossed data */
/* Linear Density(7-4) Track Density(3-0) */
BDSET8W(&cp[3], 0x00, 7, 4); /* 0.267 um/bit */
BDADD8W(&cp[3], 0x00, 3, 4); /* 0.74 um/track */
/* Starting Physical Sector Number of Data Area */
DSET32(&cp[4], 0);
/* End Physical Sector Number of Data Area */
DSET32(&cp[8], spec->blockcnt - 1);
/* End Physical Sector Number in Layer 0 */
DSET32(&cp[12], spec->blockcnt - 1);
/* BCA(7) */
BDSET8(&cp[16], 0, 7);
/* Media Specific */
memset(&cp[17], 0, 2048 - 16);
len = 2048;
/* Disc Information Length */
DSET16(&data[0], hlen + len - 2);
break;
case 0x01: /* DVD Copyright Information */
/* Disc Structure Data Length */
DSET16(&data[0], 0);
/* Reserved */
data[2] = 0;
/* Reserved */
data[3] = 0;
hlen = 4;
/* DVD Copyright Information */
cp = &data[hlen + len];
/* Copyright Protection System Type */
cp[0] = 0x00;
//cp[0] = 0x01; /* CSS/CPPM */
/* Region Management Information */
cp[1] = 0x00;
//cp[1] = 0xff & ~(1 << (2 - 1)); /* 2=Japan */
/* Reserved */
cp[2] = 0;
/* Reserved */
cp[3] = 0;
len = 4;
/* Disc Information Length */
DSET16(&data[0], hlen + len - 2);
break;
default:
ISTGT_ERRLOG("unsupported format 0x%x\n", format);
return -1;
}
return hlen + len;
}
static int
istgt_lu_dvd_scsi_report_key(ISTGT_LU_DVD *spec __attribute__((__unused__)), CONN_Ptr conn __attribute__((__unused__)), uint8_t *cdb __attribute__((__unused__)), int keyclass, int agid __attribute__((__unused__)), int keyformat, uint8_t *data)
{
uint8_t *cp;
int hlen = 0, len = 0;
if (keyclass == 0x00) {
/* DVD CSS/CPPM or CPRM */
} else {
return -1;
}
switch (keyformat) {
case 0x08: /* Report Drive region settings */
/* REPORT KEY Data Length */
DSET16(&data[0], 6);
/* Reserved */
data[2] = 0;
/* Reserved */
data[3] = 0;
hlen = 4;
/* RPC State */
cp = &data[hlen + len];
/* Type Code(7-6) # of Vendor Resets Available(5-3) */
/* # of User Controlled Changes Available(2-0) */
BDSET8W(&cp[0], 0x00, 7, 2); /* No Drive region setting */
//BDSET8W(&cp[0], 0x01, 7, 2); /* Drive region is set */
BDADD8W(&cp[0], 4, 5, 3); /* # of vendor */
BDADD8W(&cp[0], 5, 2, 3); /* # of user */
/* Region Mask */
cp[1] = 0;
//cp[1] = 0xff & ~(1 << (2 - 1)); /* 2=Japan */
/* RPC Scheme */
cp[2] = 0;
//cp[2] = 0x01; /* RPC Phase II */
/* Reserved */
cp[3] = 0;
len = 4;
/* REPORT KEY Data Length */
DSET16(&data[0], hlen + len - 2);
break;
case 0x00: /* AGID for CSS/CPPM */
case 0x01: /* Challenge Key */
case 0x02: /* KEY1 */
case 0x04: /* TITLE KEY */
case 0x05: /* ASF */
case 0x11: /* AGID for CPRM */
/* not supported */
return -1;
default:
ISTGT_ERRLOG("unsupported keyformat 0x%x\n", keyformat);
return -1;
}
return hlen + len;
}
static int
istgt_lu_dvd_lbread(ISTGT_LU_DVD *spec, CONN_Ptr conn __attribute__((__unused__)), ISTGT_LU_CMD_Ptr lu_cmd, uint64_t lba, uint32_t len)
{
uint8_t *data;
uint64_t maxlba;
uint64_t llen;
uint64_t blen;
uint64_t offset;
uint64_t nbytes;
int64_t rc;
if (len == 0) {
lu_cmd->data = NULL;
lu_cmd->data_len = 0;
return 0;
}
maxlba = spec->blockcnt;
llen = (uint64_t) len;
blen = spec->blocklen;
offset = lba * blen;
nbytes = llen * blen;
ISTGT_TRACELOG(ISTGT_TRACE_SCSI,
"Read: max=%"PRIu64", lba=%"PRIu64", len=%u\n",
maxlba, lba, len);
if (lba >= maxlba || llen > maxlba || lba > (maxlba - llen)) {
ISTGT_ERRLOG("end of media\n");
return -1;
}
if (nbytes > lu_cmd->iobufsize) {
ISTGT_ERRLOG("nbytes(%zu) > iobufsize(%zu)\n",
(size_t) nbytes, lu_cmd->iobufsize);
return -1;
}
data = lu_cmd->iobuf;
rc = istgt_lu_dvd_seek(spec, offset);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_seek() failed\n");
return -1;
}
rc = istgt_lu_dvd_read(spec, data, nbytes);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_read() failed\n");
return -1;
}
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "Read %"PRId64"/%"PRIu64" bytes\n",
rc, nbytes);
lu_cmd->data = data;
lu_cmd->data_len = rc;
return 0;
}
#if 0
static int
istgt_lu_dvd_lbwrite(ISTGT_LU_DVD *spec, CONN_Ptr conn, ISTGT_LU_CMD_Ptr lu_cmd, uint64_t lba, uint32_t len)
{
uint8_t *data;
uint64_t maxlba;
uint64_t llen;
uint64_t blen;
uint64_t offset;
uint64_t nbytes;
int64_t rc;
if (len == 0) {
lu_cmd->data_len = 0;
return 0;
}
maxlba = spec->blockcnt;
llen = (uint64_t) len;
blen = spec->blocklen;
offset = lba * blen;
nbytes = llen * blen;
ISTGT_TRACELOG(ISTGT_TRACE_SCSI,
"Write: max=%"PRIu64", lba=%"PRIu64", len=%u\n",
maxlba, lba, len);
if (lba >= maxlba || llen > maxlba || lba > (maxlba - llen)) {
ISTGT_ERRLOG("end of media\n");
return -1;
}
if (nbytes > lu_cmd->iobufsize) {
ISTGT_ERRLOG("nbytes(%u) > iobufsize(%u)\n",
nbytes, lu_cmd->iobufsize);
return -1;
}
data = lu_cmd->iobuf;
rc = istgt_lu_dvd_transfer_data(conn, lu_cmd, lu_cmd->iobuf,
lu_cmd->iobufsize, nbytes);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_transfer_data() failed\n");
return -1;
}
if (spec->lu->readonly) {
ISTGT_ERRLOG("LU%d: readonly unit\n", spec->lu->num);
return -1;
}
if (spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY) {
ISTGT_ERRLOG("LU%d: readonly media\n", spec->lu->num);
return -1;
}
rc = istgt_lu_dvd_seek(spec, offset);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_seek() failed\n");
return -1;
}
rc = istgt_lu_dvd_write(spec, data, nbytes);
if (rc < 0 || rc != nbytes) {
ISTGT_ERRLOG("lu_dvd_write() failed\n");
return -1;
}
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "Wrote %"PRId64"/%"PRIu64" bytes\n",
rc, nbytes);
lu_cmd->data_len = rc;
return 0;
}
static int
istgt_lu_dvd_lbsync(ISTGT_LU_DVD *spec, CONN_Ptr conn, ISTGT_LU_CMD_Ptr lu_cmd, uint64_t lba, uint32_t len)
{
uint64_t maxlba;
uint64_t llen;
uint64_t blen;
uint64_t offset;
uint64_t nbytes;
int64_t rc;
if (len == 0) {
return 0;
}
maxlba = spec->blockcnt;
llen = (uint64_t) len;
blen = spec->blocklen;
offset = lba * blen;
nbytes = llen * blen;
ISTGT_TRACELOG(ISTGT_TRACE_SCSI,
"Sync: max=%"PRIu64", lba=%"PRIu64", len=%u\n",
maxlba, lba, len);
if (lba >= maxlba || llen > maxlba || lba > (maxlba - llen)) {
ISTGT_ERRLOG("end of media\n");
return -1;
}
rc = istgt_lu_dvd_sync(spec, offset, nbytes);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_sync() failed\n");
return -1;
}
return 0;
}
#endif
static int
istgt_lu_dvd_build_sense_data(ISTGT_LU_DVD *spec __attribute__((__unused__)), uint8_t *data, int sk, int asc, int ascq)
{
int rc;
rc = istgt_lu_scsi_build_sense_data(data, sk, asc, ascq);
if (rc < 0) {
return -1;
}
return rc;
}
static int
istgt_lu_dvd_build_sense_media(ISTGT_LU_DVD *spec, uint8_t *data)
{
uint8_t *sense_data;
int *sense_len;
int data_len;
sense_data = data;
sense_len = &data_len;
*sense_len = 0;
if (!spec->mload && !spec->mchanged) {
/* MEDIUM NOT PRESENT */
BUILD_SENSE(NOT_READY, 0x3a, 0x00);
return data_len;
}
if (spec->mchanged) {
/* MEDIUM NOT PRESENT */
BUILD_SENSE(NOT_READY, 0x3a, 0x00);
return data_len;
#if 0
/* LOGICAL UNIT NOT READY, CAUSE NOT REPORTABLE */
BUILD_SENSE(NOT_READY, 0x04, 0x00);
return data_len;
/* LOGICAL UNIT IS IN PROCESS OF BECOMING READY */
BUILD_SENSE(NOT_READY, 0x04, 0x01);
return data_len;
#endif
}
return 0;
}
int
istgt_lu_dvd_reset(ISTGT_LU_Ptr lu, int lun)
{
ISTGT_LU_DVD *spec;
int flags;
int rc;
if (lu == NULL) {
return -1;
}
if (lun >= lu->maxlun) {
return -1;
}
if (lu->lun[lun].type == ISTGT_LU_LUN_TYPE_NONE) {
return -1;
}
if (lu->lun[lun].type != ISTGT_LU_LUN_TYPE_REMOVABLE) {
return -1;
}
spec = (ISTGT_LU_DVD *) lu->lun[lun].spec;
if (spec->lock) {
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "unlock by reset\n");
spec->lock = 0;
}
/* re-open file */
if (!spec->lu->readonly
&& !(spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY)) {
rc = istgt_lu_dvd_sync(spec, 0, spec->size);
if (rc < 0) {
ISTGT_ERRLOG("LU%d: LUN%d: lu_dvd_sync() failed\n",
lu->num, lun);
/* ignore error */
}
}
rc = istgt_lu_dvd_close(spec);
if (rc < 0) {
ISTGT_ERRLOG("LU%d: LUN%d: lu_dvd_close() failed\n",
lu->num, lun);
/* ignore error */
}
flags = (lu->readonly || (spec->mflags & ISTGT_LU_FLAG_MEDIA_READONLY))
? O_RDONLY : O_RDWR;
rc = istgt_lu_dvd_open(spec, flags, 0666);
if (rc < 0) {
ISTGT_ERRLOG("LU%d: LUN%d: lu_dvd_open() failed\n",
lu->num, lun);
return -1;
}
return 0;
}
int
istgt_lu_dvd_execute(CONN_Ptr conn, ISTGT_LU_CMD_Ptr lu_cmd)
{
ISTGT_LU_Ptr lu;
ISTGT_LU_DVD *spec;
uint8_t *data;
uint8_t *cdb;
uint64_t fmt_lun;
uint64_t lun;
uint64_t method;
uint32_t allocation_len;
int data_len;
int data_alloc_len;
uint64_t lba;
uint32_t transfer_len;
uint8_t *sense_data;
size_t *sense_len;
int rc;
if (lu_cmd == NULL)
return -1;
lu = lu_cmd->lu;
if (lu == NULL) {
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
spec = NULL;
cdb = lu_cmd->cdb;
data = lu_cmd->data;
data_alloc_len = lu_cmd->alloc_len;
sense_data = lu_cmd->sense_data;
sense_len = &lu_cmd->sense_data_len;
*sense_len = 0;
fmt_lun = lu_cmd->lun;
method = (fmt_lun >> 62) & 0x03U;
fmt_lun = fmt_lun >> 48;
if (method == 0x00U) {
lun = fmt_lun & 0x00ffU;
} else if (method == 0x01U) {
lun = fmt_lun & 0x3fffU;
} else {
lun = 0xffffU;
}
if (lun >= (uint64_t) lu->maxlun) {
#ifdef ISTGT_TRACE_DVD
ISTGT_ERRLOG("LU%d: LUN%4.4"PRIx64" invalid\n",
lu->num, lun);
#endif /* ISTGT_TRACE_DVD */
if (cdb[0] == SPC_INQUIRY) {
allocation_len = DGET16(&cdb[3]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
BDSET8W(&data[0], 0x03, 7, 3);
BDADD8W(&data[0], 0x1f, 4, 5);
data_len = 96;
memset(&data[1], 0, data_len - 1);
/* ADDITIONAL LENGTH */
data[4] = data_len - 5;
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
return 0;
} else {
/* LOGICAL UNIT NOT SUPPORTED */
BUILD_SENSE(ILLEGAL_REQUEST, 0x25, 0x00);
lu_cmd->data_len = 0;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return 0;
}
}
spec = (ISTGT_LU_DVD *) lu->lun[lun].spec;
if (spec == NULL) {
/* LOGICAL UNIT NOT SUPPORTED */
BUILD_SENSE(ILLEGAL_REQUEST, 0x25, 0x00);
lu_cmd->data_len = 0;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return 0;
}
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "SCSI OP=0x%x, LUN=0x%16.16"PRIx64"\n",
cdb[0], lu_cmd->lun);
#ifdef ISTGT_TRACE_DVD
if (cdb[0] != SPC_TEST_UNIT_READY
&& cdb[0] != MMC_GET_EVENT_STATUS_NOTIFICATION) {
istgt_scsi_dump_cdb(cdb);
} else {
istgt_scsi_dump_cdb(cdb);
}
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "mload=%d, mchanged=%d, mwait=%d\n", spec->mload, spec->mchanged, spec->mwait);
#endif /* ISTGT_TRACE_DVD */
switch (cdb[0]) {
case SPC_INQUIRY:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "INQUIRY\n");
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
allocation_len = DGET16(&cdb[3]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_inquiry(spec, conn, cdb,
data, data_alloc_len);
if (data_len < 0) {
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
ISTGT_TRACEDUMP(ISTGT_TRACE_DEBUG, "INQUIRY", data, data_len);
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
case SPC_REPORT_LUNS:
{
int sel;
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "REPORT LUNS\n");
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
return -1;
}
sel = cdb[2];
ISTGT_TRACELOG(ISTGT_TRACE_DEBUG, "sel=%x\n", sel);
allocation_len = DGET32(&cdb[6]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
if (allocation_len < 16) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_report_luns(lu, conn, cdb, sel,
data, data_alloc_len);
if (data_len < 0) {
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
ISTGT_TRACEDUMP(ISTGT_TRACE_DEBUG, "REPORT LUNS", data, data_len);
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
}
break;
case SPC_TEST_UNIT_READY:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "TEST_UNIT_READY\n");
{
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
/* media state change? */
if (spec->mchanged) {
/* wait OS polling */
if (spec->mwait > 0) {
spec->mwait--;
} else {
/* load new media */
spec->mchanged = 0;
spec->mload = 1;
}
}
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
/* OK media present */
lu_cmd->data_len = 0;
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_START_STOP_UNIT:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "START_STOP_UNIT\n");
{
int pc, fl, loej, start;
pc = BGET8W(&cdb[4], 7, 4);
fl = BGET8(&cdb[4], 2);
loej = BGET8(&cdb[4], 1);
start = BGET8(&cdb[4], 0);
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
if (!loej) {
if (start) {
/* start */
} else {
/* stop */
}
lu_cmd->data_len = 0;
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
/* loej=1 */
if (start) {
/* load disc */
if (!spec->mload) {
if (istgt_lu_dvd_load_media(spec) < 0) {
ISTGT_ERRLOG("lu_dvd_load_media() failed\n");
/* INTERNAL TARGET FAILURE */
BUILD_SENSE(HARDWARE_ERROR, 0x44, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
/* OK load */
}
} else {
/* eject */
if (!spec->lock) {
if (spec->mload) {
if (istgt_lu_dvd_unload_media(spec) < 0) {
ISTGT_ERRLOG("lu_dvd_unload_media() failed\n");
/* INTERNAL TARGET FAILURE */
BUILD_SENSE(HARDWARE_ERROR, 0x44, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
/* OK unload */
}
} else {
/* MEDIUM REMOVAL PREVENTED */
BUILD_SENSE(ILLEGAL_REQUEST, 0x53, 0x02);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
}
lu_cmd->data_len = 0;
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case SPC_PREVENT_ALLOW_MEDIUM_REMOVAL:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "PREVENT_ALLOW_MEDIUM_REMOVAL\n");
{
int persistent, prevent;
persistent = BGET8(&cdb[4], 1);
prevent = BGET8(&cdb[4], 0);
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
if (persistent) {
if (prevent) {
/* Persistent Prevent */
} else {
/* Persistent Allow */
}
} else {
if (prevent) {
/* Locked */
spec->lock = 1;
} else {
/* Unlocked */
spec->lock = 0;
}
}
lu_cmd->data_len = 0;
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_READ_CAPACITY:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "READ_CAPACITY\n");
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
return -1;
}
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
if (spec->blockcnt - 1 > 0xffffffffULL) {
DSET32(&data[0], 0xffffffffUL);
} else {
DSET32(&data[0], (uint32_t) (spec->blockcnt - 1));
}
DSET32(&data[4], (uint32_t) spec->blocklen);
data_len = 8;
lu_cmd->data_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
case SPC_MODE_SELECT_6:
{
int pf, sp, pllen;
int mdlen, mt, dsp, bdlen;
pf = BGET8(&cdb[1], 4);
sp = BGET8(&cdb[1], 0);
pllen = cdb[4]; /* Parameter List Length */
/* Data-Out */
rc = istgt_lu_dvd_transfer_data(conn, lu_cmd, lu_cmd->iobuf,
lu_cmd->iobufsize, pllen);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_transfer_data() failed\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
#if 0
istgt_dump("MODE SELECT(6)", lu_cmd->iobuf, pllen);
#endif
data = lu_cmd->iobuf;
mdlen = data[0]; /* Mode Data Length */
mt = data[1]; /* Medium Type */
dsp = data[2]; /* Device-Specific Parameter */
bdlen = data[3]; /* Block Descriptor Length */
/* Short LBA mode parameter block descriptor */
/* data[4]-data[7] Number of Blocks */
/* data[8]-data[11] Block Length */
/* page data */
data_len = istgt_lu_dvd_scsi_mode_select_page(spec, conn, cdb, pf, sp, &data[4 + bdlen], pllen - (4 + bdlen));
if (data_len != 0) {
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->data_len = pllen;
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case SPC_MODE_SELECT_10:
{
int pf, sp, pllen;
int mdlen, mt, dsp, bdlen;
int llba;
pf = BGET8(&cdb[1], 4);
sp = BGET8(&cdb[1], 0);
pllen = DGET16(&cdb[7]); /* Parameter List Length */
/* Data-Out */
rc = istgt_lu_dvd_transfer_data(conn, lu_cmd, lu_cmd->iobuf,
lu_cmd->iobufsize, pllen);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_transfer_data() failed\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
#if 0
istgt_dump("MODE SELECT(10)", lu_cmd->iobuf, pllen);
#endif
data = lu_cmd->iobuf;
mdlen = DGET16(&data[0]); /* Mode Data Length */
mt = data[2]; /* Medium Type */
dsp = data[3]; /* Device-Specific Parameter */
llba = BGET8(&data[4], 0); /* Long LBA */
bdlen = DGET16(&data[6]); /* Block Descriptor Length */
if (llba) {
/* Long LBA mode parameter block descriptor */
/* data[8]-data[15] Number of Blocks */
/* data[16]-data[19] Reserved */
/* data[20]-data[23] Block Length */
} else {
/* Short LBA mode parameter block descriptor */
/* data[8]-data[11] Number of Blocks */
/* data[12]-data[15] Block Length */
}
/* page data */
data_len = istgt_lu_dvd_scsi_mode_select_page(spec, conn, cdb, pf, sp, &data[8 + bdlen], pllen - (8 + bdlen));
if (data_len != 0) {
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->data_len = pllen;
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case SPC_MODE_SENSE_6:
{
int dbd, pc, page, subpage;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
dbd = BGET8(&cdb[1], 3);
pc = BGET8W(&cdb[2], 7, 2);
page = BGET8W(&cdb[2], 5, 6);
subpage = cdb[3];
allocation_len = cdb[4];
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_mode_sense6(spec, conn, cdb, dbd, pc, page, subpage, data, data_alloc_len);
if (data_len < 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
#if 0
istgt_dump("MODE SENSE(6)", data, data_len);
#endif
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case SPC_MODE_SENSE_10:
{
int dbd, pc, page, subpage;
int llbaa;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
llbaa = BGET8(&cdb[1], 4);
dbd = BGET8(&cdb[1], 3);
pc = BGET8W(&cdb[2], 7, 2);
page = BGET8W(&cdb[2], 5, 6);
subpage = cdb[3];
allocation_len = DGET16(&cdb[7]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_mode_sense10(spec, conn, cdb, llbaa, dbd, pc, page, subpage, data, data_alloc_len);
if (data_len < 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
#if 0
istgt_dump("MODE SENSE(10)", data, data_len);
#endif
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case SPC_LOG_SELECT:
case SPC_LOG_SENSE:
/* INVALID COMMAND OPERATION CODE */
BUILD_SENSE(ILLEGAL_REQUEST, 0x20, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
case SPC_REQUEST_SENSE:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "REQUEST_SENSE\n");
{
int desc;
int sk, asc, ascq;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
desc = BGET8(&cdb[1], 0);
if (desc != 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
/* media state change? */
if (spec->mchanged) {
/* wait OS polling */
if (spec->mwait > 0) {
spec->mwait--;
} else {
/* load new media */
spec->mchanged = 0;
spec->mload = 1;
}
}
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
allocation_len = cdb[4];
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
if (!spec->sense) {
/* NO ADDITIONAL SENSE INFORMATION */
sk = ISTGT_SCSI_SENSE_NO_SENSE;
asc = 0x00;
ascq = 0x00;
} else {
sk = (spec->sense >> 16) & 0xffU;
asc = (spec->sense >> 8) & 0xffU;
ascq = spec->sense & 0xffU;
}
data_len = istgt_lu_dvd_build_sense_data(spec, sense_data,
sk, asc, ascq);
if (data_len < 0 || data_len < 2) {
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
/* omit SenseLength */
data_len -= 2;
memcpy(data, sense_data + 2, data_len);
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_GET_CONFIGURATION:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "GET_CONFIGURATION\n");
{
int rt, sfn;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
rt = BGET8W(&cdb[1], 1, 2);
sfn = DGET16(&cdb[2]);
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
allocation_len = DGET16(&cdb[7]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_get_configuration(spec, conn, cdb, rt, sfn, data);
if (data_len < 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_GET_EVENT_STATUS_NOTIFICATION:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "GET_EVENT_STATUS_NOTIFICATION\n");
{
int polled, ncr;
int keep = 0;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
polled = BGET8(&cdb[1], 0);
ncr = cdb[4];
allocation_len = DGET16(&cdb[7]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
if (!polled) {
/* asynchronous operation */
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
if (allocation_len <= 4) {
/* shall not clear any event */
keep = 1;
}
data_len = istgt_lu_dvd_scsi_get_event_status_notification(spec, conn, cdb, keep, ncr, data);
if (data_len < 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
ISTGT_TRACEDUMP(ISTGT_TRACE_DEBUG, "EVENT", data, data_len);
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_GET_PERFORMANCE:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "GET_PERFORMANCE\n");
{
int dt, mnd, type;
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
dt = BGET8W(&cdb[1], 4, 5);
lba = DGET32(&cdb[2]);
mnd = DGET16(&cdb[8]);
type = cdb[10];
/* INVALID COMMAND OPERATION CODE */
BUILD_SENSE(ILLEGAL_REQUEST, 0x20, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
case MMC_MECHANISM_STATUS:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "MECHANISM_STATUS\n");
{
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
allocation_len = DGET16(&cdb[8]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_mechanism_status(spec, conn, cdb, data);
if (data_len < 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_READ_TOC_PMA_ATIP:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "READ_TOC_PMA_ATIP\n");
{
int msf, format, track;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
msf = BGET8(&cdb[1], 1);
format = BGET8W(&cdb[2], 3, 4);
track = cdb[6];
allocation_len = DGET16(&cdb[7]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_read_toc(spec, conn, cdb, msf, format, track, data);
if (data_len < 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_READ_DISC_INFORMATION:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "READ_DISC_INFORMATION\n");
{
int datatype;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
datatype = BGET8W(&cdb[1], 2, 3);
allocation_len = DGET16(&cdb[7]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_read_disc_information(spec, conn, cdb, datatype, data);
if (data_len < 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_READ_DISC_STRUCTURE:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "READ_DISC_STRUCTURE\n");
{
int mediatype, layernumber, format, agid;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
mediatype = BGET8W(&cdb[1], 3, 4);
layernumber = cdb[6];
format = cdb[7];
agid = BGET8W(&cdb[10], 7, 2);
allocation_len = DGET16(&cdb[8]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_read_disc_structure(spec, conn, cdb, mediatype, layernumber, format, agid, data);
if (data_len < 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_READ_SUB_CHANNEL:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "READ_SUB_CHANNEL\n");
{
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
/* INVALID COMMAND OPERATION CODE */
BUILD_SENSE(ILLEGAL_REQUEST, 0x20, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
case MMC_REPORT_KEY:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "REPORT_KEY\n");
{
int keyclass, agid, keyformat;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
keyclass = cdb[7];
agid = BGET8W(&cdb[10], 7, 2);
keyformat = BGET8W(&cdb[10], 5, 6);
allocation_len = DGET16(&cdb[8]);
if (allocation_len > (size_t) data_alloc_len) {
ISTGT_ERRLOG("data_alloc_len(%d) too small\n",
data_alloc_len);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
memset(data, 0, allocation_len);
data_len = istgt_lu_dvd_scsi_report_key(spec, conn, cdb, keyclass, agid, keyformat, data);
if (data_len < 0) {
/* INVALID FIELD IN CDB */
BUILD_SENSE(ILLEGAL_REQUEST, 0x24, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->data_len = DMIN32((size_t)data_len, lu_cmd->transfer_len);
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_SEND_KEY:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "SEND_KEY\n");
{
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
/* INVALID COMMAND OPERATION CODE */
BUILD_SENSE(ILLEGAL_REQUEST, 0x20, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
case MMC_READ_10:
{
int dpo, fua;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
dpo = BGET8(&cdb[1], 4);
fua = BGET8(&cdb[1], 3);
lba = (uint64_t) DGET32(&cdb[2]);
transfer_len = (uint32_t) DGET16(&cdb[7]);
ISTGT_TRACELOG(ISTGT_TRACE_SCSI,
"READ_10(lba %"PRIu64", len %u blocks)\n",
lba, transfer_len);
rc = istgt_lu_dvd_lbread(spec, conn, lu_cmd, lba, transfer_len);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_lbread() failed\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
case MMC_READ_12:
{
int dpo, fua;
if (lu_cmd->R_bit == 0) {
ISTGT_ERRLOG("R_bit == 0\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
return -1;
}
data_len = istgt_lu_dvd_build_sense_media(spec, sense_data);
if (data_len != 0) {
*sense_len = data_len;
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
dpo = BGET8(&cdb[1], 4);
fua = BGET8(&cdb[1], 3);
lba = (uint64_t) DGET32(&cdb[2]);
transfer_len = (uint32_t) DGET32(&cdb[6]);
ISTGT_TRACELOG(ISTGT_TRACE_SCSI,
"READ_12(lba %"PRIu64", len %u blocks)\n",
lba, transfer_len);
rc = istgt_lu_dvd_lbread(spec, conn, lu_cmd, lba, transfer_len);
if (rc < 0) {
ISTGT_ERRLOG("lu_dvd_lbread() failed\n");
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
}
#if 0
case MMC_WRITE_10:
case MMC_WRITE_AND_VERIFY_10:
case MMC_WRITE_12:
case MMC_VERIFY_10:
case MMC_SYNCHRONIZE_CACHE:
/* INVALID COMMAND OPERATION CODE */
BUILD_SENSE(ILLEGAL_REQUEST, 0x20, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
#endif
/* XXX TODO: fix */
case SPC2_RELEASE_6:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "RELEASE_6\n");
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
case SPC2_RELEASE_10:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "RELEASE_10\n");
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
case SPC2_RESERVE_6:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "RESERVE_6\n");
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
case SPC2_RESERVE_10:
ISTGT_TRACELOG(ISTGT_TRACE_SCSI, "RESERVE_10\n");
lu_cmd->status = ISTGT_SCSI_STATUS_GOOD;
break;
default:
ISTGT_ERRLOG("unsupported SCSI OP=0x%x\n", cdb[0]);
/* INVALID COMMAND OPERATION CODE */
BUILD_SENSE(ILLEGAL_REQUEST, 0x20, 0x00);
lu_cmd->status = ISTGT_SCSI_STATUS_CHECK_CONDITION;
break;
}
ISTGT_TRACELOG(ISTGT_TRACE_SCSI,
"SCSI OP=0x%x, LUN=0x%16.16"PRIx64" status=0x%x,"
" complete\n",
cdb[0], lu_cmd->lun, lu_cmd->status);
return 0;
}
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to istgt_lu_dvd.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / istgt / src