sbd_scsi.c revision 450396635f70344c58b6b1e4db38cf17ff34445c
/*
* CDDL HEADER START
*
* The contents of this file are subject to the terms of the
* Common Development and Distribution License (the "License").
* You may not use this file except in compliance with the License.
*
* You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
* or http://www.opensolaris.org/os/licensing.
* See the License for the specific language governing permissions
* and limitations under the License.
*
* When distributing Covered Code, include this CDDL HEADER in each
* file and include the License file at usr/src/OPENSOLARIS.LICENSE.
* If applicable, add the following below this CDDL HEADER, with the
* fields enclosed by brackets "[]" replaced with your own identifying
* information: Portions Copyright [yyyy] [name of copyright owner]
*
* CDDL HEADER END
*/
/*
* Copyright 2009 Sun Microsystems, Inc. All rights reserved.
* Use is subject to license terms.
*/
#include <sys/conf.h>
#include <sys/file.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/modctl.h>
#include <sys/scsi/scsi.h>
#include <sys/scsi/impl/scsi_reset_notify.h>
#include <sys/scsi/generic/mode.h>
#include <sys/disp.h>
#include <sys/byteorder.h>
#include <sys/atomic.h>
#include <sys/sdt.h>
#include <sys/dkio.h>
#include <stmf.h>
#include <lpif.h>
#include <portif.h>
#include <stmf_ioctl.h>
#include <stmf_sbd.h>
#include <stmf_sbd_ioctl.h>
#include <sbd_impl.h>
#define SCSI2_CONFLICT_FREE_CMDS(cdb) ( \
/* ----------------------- */ \
/* Refer Both */ \
/* SPC-2 (rev 20) Table 10 */ \
/* SPC-3 (rev 23) Table 31 */ \
/* ----------------------- */ \
((cdb[0]) == SCMD_INQUIRY) || \
((cdb[0]) == SCMD_LOG_SENSE_G1) || \
((cdb[0]) == SCMD_RELEASE) || \
((cdb[0]) == SCMD_RELEASE_G1) || \
((cdb[0]) == SCMD_REPORT_LUNS) || \
((cdb[0]) == SCMD_REQUEST_SENSE) || \
/* PREVENT ALLOW MEDIUM REMOVAL with prevent == 0 */ \
((((cdb[0]) == SCMD_DOORLOCK) && (((cdb[4]) & 0x3) == 0))) || \
/* SERVICE ACTION IN with READ MEDIA SERIAL NUMBER (0x01) */ \
(((cdb[0]) == SCMD_SVC_ACTION_IN_G5) && ( \
((cdb[1]) & 0x1F) == 0x01)) || \
/* MAINTENANCE IN with service actions REPORT ALIASES (0x0Bh) */ \
/* REPORT DEVICE IDENTIFIER (0x05) REPORT PRIORITY (0x0Eh) */ \
/* REPORT TARGET PORT GROUPS (0x0A) REPORT TIMESTAMP (0x0F) */ \
(((cdb[0]) == SCMD_MAINTENANCE_IN) && ( \
(((cdb[1]) & 0x1F) == 0x0B) || \
(((cdb[1]) & 0x1F) == 0x05) || \
(((cdb[1]) & 0x1F) == 0x0E) || \
(((cdb[1]) & 0x1F) == 0x0A) || \
(((cdb[1]) & 0x1F) == 0x0F))) || \
/* ----------------------- */ \
/* SBC-3 (rev 17) Table 3 */ \
/* ----------------------- */ \
/* READ CAPACITY(10) */ \
((cdb[0]) == SCMD_READ_CAPACITY) || \
/* READ CAPACITY(16) */ \
(((cdb[0]) == SCMD_SVC_ACTION_IN_G4) && ( \
((cdb[1]) & 0x1F) == 0x10)) || \
/* START STOP UNIT with START bit 0 and POWER CONDITION 0 */ \
(((cdb[0]) == SCMD_START_STOP) && ( \
(((cdb[4]) & 0xF0) == 0) && (((cdb[4]) & 0x01) == 0))))
/* End of SCSI2_CONFLICT_FREE_CMDS */
stmf_status_t sbd_lu_reset_state(stmf_lu_t *lu);
static void sbd_handle_sync_cache(struct scsi_task *task,
struct stmf_data_buf *initial_dbuf);
void sbd_handle_read_xfer_completion(struct scsi_task *task,
sbd_cmd_t *scmd, struct stmf_data_buf *dbuf);
void sbd_handle_short_write_xfer_completion(scsi_task_t *task,
stmf_data_buf_t *dbuf);
void sbd_handle_short_write_transfers(scsi_task_t *task,
stmf_data_buf_t *dbuf, uint32_t cdb_xfer_size);
static void sbd_handle_sync_cache(struct scsi_task *task,
struct stmf_data_buf *initial_dbuf);
void sbd_handle_mode_select_xfer(scsi_task_t *task, uint8_t *buf,
uint32_t buflen);
void sbd_handle_mode_select(scsi_task_t *task, stmf_data_buf_t *dbuf);
extern void sbd_pgr_initialize_it(scsi_task_t *);
extern int sbd_pgr_reservation_conflict(scsi_task_t *);
extern void sbd_pgr_reset(sbd_lu_t *);
extern void sbd_pgr_remove_it_handle(sbd_lu_t *, sbd_it_data_t *);
extern void sbd_handle_pgr_in_cmd(scsi_task_t *, stmf_data_buf_t *);
extern void sbd_handle_pgr_out_cmd(scsi_task_t *, stmf_data_buf_t *);
extern void sbd_handle_pgr_out_data(scsi_task_t *, stmf_data_buf_t *);
/*
* IMPORTANT NOTE:
* =================
* The whole world here is based on the assumption that everything within
* a scsi task executes in a single threaded manner, even the aborts.
* Dont ever change that. There wont be any performance gain but there
* will be tons of race conditions.
*/
void
sbd_do_read_xfer(struct scsi_task *task, sbd_cmd_t *scmd,
struct stmf_data_buf *dbuf)
{
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
uint64_t laddr;
uint32_t len, buflen, iolen;
int ndx;
int bufs_to_take;
/* Lets try not to hog all the buffers the port has. */
bufs_to_take = ((task->task_max_nbufs > 2) &&
(task->task_cmd_xfer_length < (32 * 1024))) ? 2 :
task->task_max_nbufs;
len = scmd->len > dbuf->db_buf_size ? dbuf->db_buf_size : scmd->len;
laddr = scmd->addr + scmd->current_ro;
for (buflen = 0, ndx = 0; (buflen < len) &&
(ndx < dbuf->db_sglist_length); ndx++) {
iolen = min(len - buflen, dbuf->db_sglist[ndx].seg_length);
if (iolen == 0)
break;
if (sbd_data_read(sl, laddr, (uint64_t)iolen,
dbuf->db_sglist[ndx].seg_addr) != STMF_SUCCESS) {
scmd->flags |= SBD_SCSI_CMD_XFER_FAIL;
/* Do not need to do xfer anymore, just complete it */
dbuf->db_data_size = 0;
dbuf->db_xfer_status = STMF_SUCCESS;
sbd_handle_read_xfer_completion(task, scmd, dbuf);
return;
}
buflen += iolen;
laddr += (uint64_t)iolen;
}
dbuf->db_relative_offset = scmd->current_ro;
dbuf->db_data_size = buflen;
dbuf->db_flags = DB_DIRECTION_TO_RPORT;
(void) stmf_xfer_data(task, dbuf, 0);
scmd->len -= buflen;
scmd->current_ro += buflen;
if (scmd->len && (scmd->nbufs < bufs_to_take)) {
uint32_t maxsize, minsize, old_minsize;
maxsize = (scmd->len > (128*1024)) ? 128*1024 : scmd->len;
minsize = maxsize >> 2;
do {
/*
* A bad port implementation can keep on failing the
* the request but keep on sending us a false
* minsize.
*/
old_minsize = minsize;
dbuf = stmf_alloc_dbuf(task, maxsize, &minsize, 0);
} while ((dbuf == NULL) && (old_minsize > minsize) &&
(minsize >= 512));
if (dbuf == NULL) {
return;
}
scmd->nbufs++;
sbd_do_read_xfer(task, scmd, dbuf);
}
}
void
sbd_handle_read_xfer_completion(struct scsi_task *task, sbd_cmd_t *scmd,
struct stmf_data_buf *dbuf)
{
if (dbuf->db_xfer_status != STMF_SUCCESS) {
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
dbuf->db_xfer_status, NULL);
return;
}
task->task_nbytes_transferred += dbuf->db_data_size;
if (scmd->len == 0 || scmd->flags & SBD_SCSI_CMD_XFER_FAIL) {
stmf_free_dbuf(task, dbuf);
scmd->nbufs--;
if (scmd->nbufs)
return; /* wait for all buffers to complete */
scmd->flags &= ~SBD_SCSI_CMD_ACTIVE;
if (scmd->flags & SBD_SCSI_CMD_XFER_FAIL)
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_READ_ERROR);
else
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
if (dbuf->db_flags & DB_DONT_REUSE) {
/* allocate new dbuf */
uint32_t maxsize, minsize, old_minsize;
stmf_free_dbuf(task, dbuf);
maxsize = (scmd->len > (128*1024)) ? 128*1024 : scmd->len;
minsize = maxsize >> 2;
do {
old_minsize = minsize;
dbuf = stmf_alloc_dbuf(task, maxsize, &minsize, 0);
} while ((dbuf == NULL) && (old_minsize > minsize) &&
(minsize >= 512));
if (dbuf == NULL) {
scmd->nbufs --;
if (scmd->nbufs == 0) {
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
STMF_ALLOC_FAILURE, NULL);
}
return;
}
}
sbd_do_read_xfer(task, scmd, dbuf);
}
void
sbd_handle_read(struct scsi_task *task, struct stmf_data_buf *initial_dbuf)
{
uint64_t lba, laddr;
uint32_t len;
uint8_t op = task->task_cdb[0];
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
sbd_cmd_t *scmd;
stmf_data_buf_t *dbuf;
int fast_path;
if (op == SCMD_READ) {
lba = READ_SCSI21(&task->task_cdb[1], uint64_t);
len = (uint32_t)task->task_cdb[4];
if (len == 0) {
len = 256;
}
} else if (op == SCMD_READ_G1) {
lba = READ_SCSI32(&task->task_cdb[2], uint64_t);
len = READ_SCSI16(&task->task_cdb[7], uint32_t);
} else if (op == SCMD_READ_G5) {
lba = READ_SCSI32(&task->task_cdb[2], uint64_t);
len = READ_SCSI32(&task->task_cdb[6], uint32_t);
} else if (op == SCMD_READ_G4) {
lba = READ_SCSI64(&task->task_cdb[2], uint64_t);
len = READ_SCSI32(&task->task_cdb[10], uint32_t);
} else {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_OPCODE);
return;
}
laddr = lba << sl->sl_data_blocksize_shift;
len <<= sl->sl_data_blocksize_shift;
if ((laddr + (uint64_t)len) > sl->sl_lu_size) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_LBA_OUT_OF_RANGE);
return;
}
task->task_cmd_xfer_length = len;
if (task->task_additional_flags & TASK_AF_NO_EXPECTED_XFER_LENGTH) {
task->task_expected_xfer_length = len;
}
if (len != task->task_expected_xfer_length) {
fast_path = 0;
len = (len > task->task_expected_xfer_length) ?
task->task_expected_xfer_length : len;
} else {
fast_path = 1;
}
if (len == 0) {
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
if (initial_dbuf == NULL) {
uint32_t maxsize, minsize, old_minsize;
maxsize = (len > (128*1024)) ? 128*1024 : len;
minsize = maxsize >> 2;
do {
old_minsize = minsize;
initial_dbuf = stmf_alloc_dbuf(task, maxsize,
&minsize, 0);
} while ((initial_dbuf == NULL) && (old_minsize > minsize) &&
(minsize >= 512));
if (initial_dbuf == NULL) {
stmf_scsilib_send_status(task, STATUS_QFULL, 0);
return;
}
}
dbuf = initial_dbuf;
if ((dbuf->db_buf_size >= len) && fast_path &&
(dbuf->db_sglist_length == 1)) {
if (sbd_data_read(sl, laddr, (uint64_t)len,
dbuf->db_sglist[0].seg_addr) == STMF_SUCCESS) {
dbuf->db_relative_offset = 0;
dbuf->db_data_size = len;
dbuf->db_flags = DB_SEND_STATUS_GOOD |
DB_DIRECTION_TO_RPORT;
(void) stmf_xfer_data(task, dbuf, STMF_IOF_LU_DONE);
} else {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_READ_ERROR);
}
return;
}
if (task->task_lu_private) {
scmd = (sbd_cmd_t *)task->task_lu_private;
} else {
scmd = (sbd_cmd_t *)kmem_alloc(sizeof (sbd_cmd_t), KM_SLEEP);
task->task_lu_private = scmd;
}
scmd->flags = SBD_SCSI_CMD_ACTIVE;
scmd->cmd_type = SBD_CMD_SCSI_READ;
scmd->nbufs = 1;
scmd->addr = laddr;
scmd->len = len;
scmd->current_ro = 0;
sbd_do_read_xfer(task, scmd, dbuf);
}
void
sbd_do_write_xfer(struct scsi_task *task, sbd_cmd_t *scmd,
struct stmf_data_buf *dbuf)
{
uint32_t len;
int bufs_to_take;
/* Lets try not to hog all the buffers the port has. */
bufs_to_take = ((task->task_max_nbufs > 2) &&
(task->task_cmd_xfer_length < (32 * 1024))) ? 2 :
task->task_max_nbufs;
len = scmd->len > dbuf->db_buf_size ? dbuf->db_buf_size : scmd->len;
dbuf->db_relative_offset = scmd->current_ro;
dbuf->db_data_size = len;
dbuf->db_flags = DB_DIRECTION_FROM_RPORT;
(void) stmf_xfer_data(task, dbuf, 0);
scmd->len -= len;
scmd->current_ro += len;
if (scmd->len && (scmd->nbufs < bufs_to_take)) {
uint32_t maxsize, minsize, old_minsize;
maxsize = (scmd->len > (128*1024)) ? 128*1024 : scmd->len;
minsize = maxsize >> 2;
do {
old_minsize = minsize;
dbuf = stmf_alloc_dbuf(task, maxsize, &minsize, 0);
} while ((dbuf == NULL) && (old_minsize > minsize) &&
(minsize >= 512));
if (dbuf == NULL) {
return;
}
scmd->nbufs++;
sbd_do_write_xfer(task, scmd, dbuf);
}
}
void
sbd_handle_write_xfer_completion(struct scsi_task *task, sbd_cmd_t *scmd,
struct stmf_data_buf *dbuf, uint8_t dbuf_reusable)
{
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
uint64_t laddr;
uint32_t buflen, iolen;
int ndx;
if (dbuf->db_xfer_status != STMF_SUCCESS) {
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
dbuf->db_xfer_status, NULL);
return;
}
if (scmd->flags & SBD_SCSI_CMD_XFER_FAIL) {
goto WRITE_XFER_DONE;
}
laddr = scmd->addr + dbuf->db_relative_offset;
for (buflen = 0, ndx = 0; (buflen < dbuf->db_data_size) &&
(ndx < dbuf->db_sglist_length); ndx++) {
iolen = min(dbuf->db_data_size - buflen,
dbuf->db_sglist[ndx].seg_length);
if (iolen == 0)
break;
if (sbd_data_write(sl, laddr, (uint64_t)iolen,
dbuf->db_sglist[ndx].seg_addr) != STMF_SUCCESS) {
scmd->flags |= SBD_SCSI_CMD_XFER_FAIL;
break;
}
buflen += iolen;
laddr += (uint64_t)iolen;
}
task->task_nbytes_transferred += buflen;
WRITE_XFER_DONE:
if (scmd->len == 0 || scmd->flags & SBD_SCSI_CMD_XFER_FAIL) {
stmf_free_dbuf(task, dbuf);
scmd->nbufs--;
if (scmd->nbufs)
return; /* wait for all buffers to complete */
scmd->flags &= ~SBD_SCSI_CMD_ACTIVE;
if (scmd->flags & SBD_SCSI_CMD_XFER_FAIL)
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_WRITE_ERROR);
else
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
if (dbuf->db_flags & DB_DONT_REUSE || dbuf_reusable == 0) {
uint32_t maxsize, minsize, old_minsize;
/* free current dbuf and allocate a new one */
stmf_free_dbuf(task, dbuf);
maxsize = (scmd->len > (128*1024)) ? 128*1024 : scmd->len;
minsize = maxsize >> 2;
do {
old_minsize = minsize;
dbuf = stmf_alloc_dbuf(task, maxsize, &minsize, 0);
} while ((dbuf == NULL) && (old_minsize > minsize) &&
(minsize >= 512));
if (dbuf == NULL) {
scmd->nbufs --;
if (scmd->nbufs == 0) {
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
STMF_ALLOC_FAILURE, NULL);
}
return;
}
}
sbd_do_write_xfer(task, scmd, dbuf);
}
void
sbd_handle_write(struct scsi_task *task, struct stmf_data_buf *initial_dbuf)
{
uint64_t lba, laddr;
uint32_t len;
uint8_t op = task->task_cdb[0], do_immediate_data = 0;
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
sbd_cmd_t *scmd;
stmf_data_buf_t *dbuf;
if (sl->sl_flags & SL_WRITE_PROTECTED) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_WRITE_PROTECTED);
return;
}
if (op == SCMD_WRITE) {
lba = READ_SCSI21(&task->task_cdb[1], uint64_t);
len = (uint32_t)task->task_cdb[4];
if (len == 0) {
len = 256;
}
} else if (op == SCMD_WRITE_G1) {
lba = READ_SCSI32(&task->task_cdb[2], uint64_t);
len = READ_SCSI16(&task->task_cdb[7], uint32_t);
} else if (op == SCMD_WRITE_G5) {
lba = READ_SCSI32(&task->task_cdb[2], uint64_t);
len = READ_SCSI32(&task->task_cdb[6], uint32_t);
} else if (op == SCMD_WRITE_G4) {
lba = READ_SCSI64(&task->task_cdb[2], uint64_t);
len = READ_SCSI32(&task->task_cdb[10], uint32_t);
} else {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_OPCODE);
return;
}
laddr = lba << sl->sl_data_blocksize_shift;
len <<= sl->sl_data_blocksize_shift;
if ((laddr + (uint64_t)len) > sl->sl_lu_size) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_LBA_OUT_OF_RANGE);
return;
}
task->task_cmd_xfer_length = len;
if (task->task_additional_flags & TASK_AF_NO_EXPECTED_XFER_LENGTH) {
task->task_expected_xfer_length = len;
}
len = (len > task->task_expected_xfer_length) ?
task->task_expected_xfer_length : len;
if (len == 0) {
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
if (initial_dbuf == NULL) {
uint32_t maxsize, minsize, old_minsize;
maxsize = (len > (128*1024)) ? 128*1024 : len;
minsize = maxsize >> 2;
do {
old_minsize = minsize;
initial_dbuf = stmf_alloc_dbuf(task, maxsize,
&minsize, 0);
} while ((initial_dbuf == NULL) && (old_minsize > minsize) &&
(minsize >= 512));
if (initial_dbuf == NULL) {
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
STMF_ALLOC_FAILURE, NULL);
return;
}
} else if (task->task_flags & TF_INITIAL_BURST) {
if (initial_dbuf->db_data_size > len) {
if (initial_dbuf->db_data_size >
task->task_expected_xfer_length) {
/* protocol error */
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
STMF_INVALID_ARG, NULL);
return;
}
initial_dbuf->db_data_size = len;
}
do_immediate_data = 1;
}
dbuf = initial_dbuf;
if (task->task_lu_private) {
scmd = (sbd_cmd_t *)task->task_lu_private;
} else {
scmd = (sbd_cmd_t *)kmem_alloc(sizeof (sbd_cmd_t), KM_SLEEP);
task->task_lu_private = scmd;
}
scmd->flags = SBD_SCSI_CMD_ACTIVE;
scmd->cmd_type = SBD_CMD_SCSI_WRITE;
scmd->nbufs = 1;
scmd->addr = laddr;
scmd->len = len;
scmd->current_ro = 0;
if (do_immediate_data) {
scmd->len -= dbuf->db_data_size;
scmd->current_ro += dbuf->db_data_size;
dbuf->db_xfer_status = STMF_SUCCESS;
sbd_handle_write_xfer_completion(task, scmd, dbuf, 0);
} else {
sbd_do_write_xfer(task, scmd, dbuf);
}
}
/*
* Utility routine to handle small non performance data transfers to the
* initiators. dbuf is an initial data buf (if any), 'p' points to a data
* buffer which is source of data for transfer, cdb_xfer_size is the
* transfer size based on CDB, cmd_xfer_size is the actual amount of data
* which this command would transfer (the size of data pointed to by 'p').
*/
void
sbd_handle_short_read_transfers(scsi_task_t *task, stmf_data_buf_t *dbuf,
uint8_t *p, uint32_t cdb_xfer_size, uint32_t cmd_xfer_size)
{
uint32_t bufsize, ndx;
sbd_cmd_t *scmd;
cmd_xfer_size = min(cmd_xfer_size, cdb_xfer_size);
task->task_cmd_xfer_length = cmd_xfer_size;
if (task->task_additional_flags & TASK_AF_NO_EXPECTED_XFER_LENGTH) {
task->task_expected_xfer_length = cmd_xfer_size;
} else {
cmd_xfer_size = min(cmd_xfer_size,
task->task_expected_xfer_length);
}
if (cmd_xfer_size == 0) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
if (dbuf == NULL) {
uint32_t minsize = cmd_xfer_size;
dbuf = stmf_alloc_dbuf(task, cmd_xfer_size, &minsize, 0);
}
if (dbuf == NULL) {
stmf_scsilib_send_status(task, STATUS_QFULL, 0);
return;
}
for (bufsize = 0, ndx = 0; bufsize < cmd_xfer_size; ndx++) {
uint8_t *d;
uint32_t s;
d = dbuf->db_sglist[ndx].seg_addr;
s = min((cmd_xfer_size - bufsize),
dbuf->db_sglist[ndx].seg_length);
bcopy(p+bufsize, d, s);
bufsize += s;
}
dbuf->db_relative_offset = 0;
dbuf->db_data_size = cmd_xfer_size;
dbuf->db_flags = DB_DIRECTION_TO_RPORT;
if (task->task_lu_private == NULL) {
task->task_lu_private =
kmem_alloc(sizeof (sbd_cmd_t), KM_SLEEP);
}
scmd = (sbd_cmd_t *)task->task_lu_private;
scmd->cmd_type = SBD_CMD_SMALL_READ;
scmd->flags = SBD_SCSI_CMD_ACTIVE;
(void) stmf_xfer_data(task, dbuf, 0);
}
void
sbd_handle_short_read_xfer_completion(struct scsi_task *task, sbd_cmd_t *scmd,
struct stmf_data_buf *dbuf)
{
if (dbuf->db_xfer_status != STMF_SUCCESS) {
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
dbuf->db_xfer_status, NULL);
return;
}
task->task_nbytes_transferred = dbuf->db_data_size;
scmd->flags &= ~SBD_SCSI_CMD_ACTIVE;
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
}
void
sbd_handle_short_write_transfers(scsi_task_t *task,
stmf_data_buf_t *dbuf, uint32_t cdb_xfer_size)
{
sbd_cmd_t *scmd;
task->task_cmd_xfer_length = cdb_xfer_size;
if (task->task_additional_flags & TASK_AF_NO_EXPECTED_XFER_LENGTH) {
task->task_expected_xfer_length = cdb_xfer_size;
} else {
cdb_xfer_size = min(cdb_xfer_size,
task->task_expected_xfer_length);
}
if (cdb_xfer_size == 0) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
if (task->task_lu_private == NULL) {
task->task_lu_private = kmem_zalloc(sizeof (sbd_cmd_t),
KM_SLEEP);
} else {
bzero(task->task_lu_private, sizeof (sbd_cmd_t));
}
scmd = (sbd_cmd_t *)task->task_lu_private;
scmd->cmd_type = SBD_CMD_SMALL_WRITE;
scmd->flags = SBD_SCSI_CMD_ACTIVE;
scmd->len = cdb_xfer_size;
if (dbuf == NULL) {
uint32_t minsize = cdb_xfer_size;
dbuf = stmf_alloc_dbuf(task, cdb_xfer_size, &minsize, 0);
if (dbuf == NULL) {
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
STMF_ALLOC_FAILURE, NULL);
return;
}
dbuf->db_data_size = cdb_xfer_size;
dbuf->db_relative_offset = 0;
dbuf->db_flags = DB_DIRECTION_FROM_RPORT;
stmf_xfer_data(task, dbuf, 0);
} else {
if (dbuf->db_data_size < cdb_xfer_size) {
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
STMF_ABORTED, NULL);
return;
}
dbuf->db_data_size = cdb_xfer_size;
sbd_handle_short_write_xfer_completion(task, dbuf);
}
}
void
sbd_handle_short_write_xfer_completion(scsi_task_t *task,
stmf_data_buf_t *dbuf)
{
sbd_cmd_t *scmd;
stmf_status_t st_ret;
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
/*
* For now lets assume we will get only one sglist element
* for short writes. If that ever changes, we should allocate
* a local buffer and copy all the sg elements to one linear space.
*/
if ((dbuf->db_xfer_status != STMF_SUCCESS) ||
(dbuf->db_sglist_length > 1)) {
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
dbuf->db_xfer_status, NULL);
return;
}
task->task_nbytes_transferred = dbuf->db_data_size;
scmd = (sbd_cmd_t *)task->task_lu_private;
scmd->flags &= ~SBD_SCSI_CMD_ACTIVE;
/* Lets find out who to call */
switch (task->task_cdb[0]) {
case SCMD_MODE_SELECT:
case SCMD_MODE_SELECT_G1:
if (sl->sl_access_state == SBD_LU_STANDBY) {
st_ret = stmf_proxy_scsi_cmd(task, dbuf);
if (st_ret != STMF_SUCCESS) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_LU_NO_ACCESS_UNAVAIL);
}
} else {
sbd_handle_mode_select_xfer(task,
dbuf->db_sglist[0].seg_addr, dbuf->db_data_size);
}
break;
case SCMD_PERSISTENT_RESERVE_OUT:
if (sl->sl_access_state == SBD_LU_STANDBY) {
st_ret = stmf_proxy_scsi_cmd(task, dbuf);
if (st_ret != STMF_SUCCESS) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_LU_NO_ACCESS_UNAVAIL);
}
} else {
sbd_handle_pgr_out_data(task, dbuf);
}
break;
default:
/* This should never happen */
stmf_abort(STMF_QUEUE_TASK_ABORT, task,
STMF_ABORTED, NULL);
}
}
void
sbd_handle_read_capacity(struct scsi_task *task,
struct stmf_data_buf *initial_dbuf)
{
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
uint32_t cdb_len;
uint8_t p[32];
uint64_t s;
uint16_t blksize;
s = sl->sl_lu_size >> sl->sl_data_blocksize_shift;
s--;
blksize = ((uint16_t)1) << sl->sl_data_blocksize_shift;
switch (task->task_cdb[0]) {
case SCMD_READ_CAPACITY:
if (s & 0xffffffff00000000ull) {
p[0] = p[1] = p[2] = p[3] = 0xFF;
} else {
p[0] = (s >> 24) & 0xff;
p[1] = (s >> 16) & 0xff;
p[2] = (s >> 8) & 0xff;
p[3] = s & 0xff;
}
p[4] = 0; p[5] = 0;
p[6] = (blksize >> 8) & 0xff;
p[7] = blksize & 0xff;
sbd_handle_short_read_transfers(task, initial_dbuf, p, 8, 8);
break;
case SCMD_SVC_ACTION_IN_G4:
cdb_len = READ_SCSI32(&task->task_cdb[10], uint32_t);
bzero(p, 32);
p[0] = (s >> 56) & 0xff;
p[1] = (s >> 48) & 0xff;
p[2] = (s >> 40) & 0xff;
p[3] = (s >> 32) & 0xff;
p[4] = (s >> 24) & 0xff;
p[5] = (s >> 16) & 0xff;
p[6] = (s >> 8) & 0xff;
p[7] = s & 0xff;
p[10] = (blksize >> 8) & 0xff;
p[11] = blksize & 0xff;
sbd_handle_short_read_transfers(task, initial_dbuf, p,
cdb_len, 32);
break;
}
}
void
sbd_calc_geometry(uint64_t s, uint16_t blksize, uint8_t *nsectors,
uint8_t *nheads, uint32_t *ncyl)
{
if (s < (4ull * 1024ull * 1024ull * 1024ull)) {
*nsectors = 32;
*nheads = 8;
} else {
*nsectors = 254;
*nheads = 254;
}
*ncyl = s / ((uint64_t)blksize * (uint64_t)(*nsectors) *
(uint64_t)(*nheads));
}
void
sbd_handle_mode_sense(struct scsi_task *task,
struct stmf_data_buf *initial_dbuf, uint8_t *buf)
{
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
uint32_t cmd_size, n;
uint8_t *cdb;
uint32_t ncyl;
uint8_t nsectors, nheads;
uint8_t page, ctrl, header_size, pc_valid;
uint16_t nbytes;
uint8_t *p;
uint64_t s = sl->sl_lu_size;
uint32_t dev_spec_param_offset;
p = buf; /* buf is assumed to be zeroed out and large enough */
n = 0;
cdb = &task->task_cdb[0];
page = cdb[2] & 0x3F;
ctrl = (cdb[2] >> 6) & 3;
cmd_size = (cdb[0] == SCMD_MODE_SENSE) ? cdb[4] :
READ_SCSI16(&cdb[7], uint32_t);
if (cdb[0] == SCMD_MODE_SENSE) {
header_size = 4;
dev_spec_param_offset = 2;
} else {
header_size = 8;
dev_spec_param_offset = 3;
}
/* Now validate the command */
if ((cdb[2] == 0) || (page == MODEPAGE_ALLPAGES) || (page == 0x08) ||
(page == 0x0A) || (page == 0x03) || (page == 0x04)) {
pc_valid = 1;
} else {
pc_valid = 0;
}
if ((cmd_size < header_size) || (pc_valid == 0)) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
/* We will update the length in the mode header at the end */
/* Block dev device specific param in mode param header has wp bit */
if (sl->sl_flags & SL_WRITE_PROTECTED) {
p[n + dev_spec_param_offset] = BIT_7;
}
n += header_size;
/* We are not going to return any block descriptor */
nbytes = ((uint16_t)1) << sl->sl_data_blocksize_shift;
sbd_calc_geometry(s, nbytes, &nsectors, &nheads, &ncyl);
if ((page == 0x03) || (page == MODEPAGE_ALLPAGES)) {
p[n] = 0x03;
p[n+1] = 0x16;
if (ctrl != 1) {
p[n + 11] = nsectors;
p[n + 12] = nbytes >> 8;
p[n + 13] = nbytes & 0xff;
p[n + 20] = 0x80;
}
n += 24;
}
if ((page == 0x04) || (page == MODEPAGE_ALLPAGES)) {
p[n] = 0x04;
p[n + 1] = 0x16;
if (ctrl != 1) {
p[n + 2] = ncyl >> 16;
p[n + 3] = ncyl >> 8;
p[n + 4] = ncyl & 0xff;
p[n + 5] = nheads;
p[n + 20] = 0x15;
p[n + 21] = 0x18;
}
n += 24;
}
if ((page == MODEPAGE_CACHING) || (page == MODEPAGE_ALLPAGES)) {
struct mode_caching *mode_caching_page;
mode_caching_page = (struct mode_caching *)&p[n];
mode_caching_page->mode_page.code = MODEPAGE_CACHING;
mode_caching_page->mode_page.ps = 1; /* A saveable page */
mode_caching_page->mode_page.length = 0x12;
switch (ctrl) {
case (0):
/* Current */
if ((sl->sl_flags & SL_WRITEBACK_CACHE_DISABLE) == 0) {
mode_caching_page->wce = 1;
}
break;
case (1):
/* Changeable */
if ((sl->sl_flags &
SL_WRITEBACK_CACHE_SET_UNSUPPORTED) == 0) {
mode_caching_page->wce = 1;
}
break;
default:
if ((sl->sl_flags &
SL_SAVED_WRITE_CACHE_DISABLE) == 0) {
mode_caching_page->wce = 1;
}
break;
}
n += (sizeof (struct mode_page) +
mode_caching_page->mode_page.length);
}
if ((page == MODEPAGE_CTRL_MODE) || (page == MODEPAGE_ALLPAGES)) {
struct mode_control_scsi3 *mode_control_page;
mode_control_page = (struct mode_control_scsi3 *)&p[n];
mode_control_page->mode_page.code = MODEPAGE_CTRL_MODE;
mode_control_page->mode_page.length =
PAGELENGTH_MODE_CONTROL_SCSI3;
if (ctrl != 1) {
/* If not looking for changeable values, report this. */
mode_control_page->que_mod = CTRL_QMOD_UNRESTRICT;
}
n += (sizeof (struct mode_page) +
mode_control_page->mode_page.length);
}
if (cdb[0] == SCMD_MODE_SENSE) {
if (n > 255) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
/*
* Mode parameter header length doesn't include the number
* of bytes in the length field, so adjust the count.
* Byte count minus header length field size.
*/
buf[0] = (n - 1) & 0xff;
} else {
/* Byte count minus header length field size. */
buf[1] = (n - 2) & 0xff;
buf[0] = ((n - 2) >> 8) & 0xff;
}
sbd_handle_short_read_transfers(task, initial_dbuf, buf,
cmd_size, n);
}
void
sbd_handle_mode_select(scsi_task_t *task, stmf_data_buf_t *dbuf)
{
uint32_t cmd_xfer_len;
if (task->task_cdb[0] == SCMD_MODE_SELECT) {
cmd_xfer_len = (uint32_t)task->task_cdb[4];
} else {
cmd_xfer_len = READ_SCSI16(&task->task_cdb[7], uint32_t);
}
if ((task->task_cdb[1] & 0xFE) != 0x10) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
if (cmd_xfer_len == 0) {
/* zero byte mode selects are allowed */
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
sbd_handle_short_write_transfers(task, dbuf, cmd_xfer_len);
}
void
sbd_handle_mode_select_xfer(scsi_task_t *task, uint8_t *buf, uint32_t buflen)
{
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
sbd_it_data_t *it;
int hdr_len, bd_len;
sbd_status_t sret;
int i;
if (task->task_cdb[0] == SCMD_MODE_SELECT) {
hdr_len = 4;
} else {
hdr_len = 8;
}
if (buflen < hdr_len)
goto mode_sel_param_len_err;
bd_len = hdr_len == 4 ? buf[3] : READ_SCSI16(&buf[6], int);
if (buflen < (hdr_len + bd_len + 2))
goto mode_sel_param_len_err;
buf += hdr_len + bd_len;
buflen -= hdr_len + bd_len;
if ((buf[0] != 8) || (buflen != ((uint32_t)buf[1] + 2))) {
goto mode_sel_param_len_err;
}
if (buf[2] & 0xFB) {
goto mode_sel_param_field_err;
}
for (i = 3; i < (buf[1] + 2); i++) {
if (buf[i]) {
goto mode_sel_param_field_err;
}
}
sret = SBD_SUCCESS;
/* All good. Lets handle the write cache change, if any */
if (buf[2] & BIT_2) {
sret = sbd_wcd_set(0, sl);
} else {
sret = sbd_wcd_set(1, sl);
}
if (sret != SBD_SUCCESS) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_WRITE_ERROR);
return;
}
/* set on the device passed, now set the flags */
mutex_enter(&sl->sl_lock);
if (buf[2] & BIT_2) {
sl->sl_flags &= ~SL_WRITEBACK_CACHE_DISABLE;
} else {
sl->sl_flags |= SL_WRITEBACK_CACHE_DISABLE;
}
for (it = sl->sl_it_list; it != NULL; it = it->sbd_it_next) {
if (it == task->task_lu_itl_handle)
continue;
it->sbd_it_ua_conditions |= SBD_UA_MODE_PARAMETERS_CHANGED;
}
if (task->task_cdb[1] & 1) {
if (buf[2] & BIT_2) {
sl->sl_flags &= ~SL_SAVED_WRITE_CACHE_DISABLE;
} else {
sl->sl_flags |= SL_SAVED_WRITE_CACHE_DISABLE;
}
mutex_exit(&sl->sl_lock);
sret = sbd_write_lu_info(sl);
} else {
mutex_exit(&sl->sl_lock);
}
if (sret == SBD_SUCCESS) {
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
} else {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_WRITE_ERROR);
}
return;
mode_sel_param_len_err:
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_PARAM_LIST_LENGTH_ERROR);
return;
mode_sel_param_field_err:
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_PARAM_LIST);
}
/*
* This function parse through a string, passed to it as a pointer to a string,
* by adjusting the pointer to the first non-space character and returns
* the count/length of the first bunch of non-space characters. Multiple
* Management URLs are stored as a space delimited string in sl_mgmt_url
* field of sbd_lu_t. This function is used to retrieve one url at a time.
*
* i/p : pointer to pointer to a url string
* o/p : Adjust the pointer to the url to the first non white character
* and returns the length of the URL
*/
uint16_t
sbd_parse_mgmt_url(char **url_addr) {
uint16_t url_length = 0;
char *url;
url = *url_addr;
while (*url != '\0') {
if (*url == ' ' || *url == '\t' || *url == '\n') {
(*url_addr)++;
url = *url_addr;
} else {
break;
}
}
while (*url != '\0') {
if (*url == ' ' || *url == '\t' ||
*url == '\n' || *url == '\0') {
break;
}
url++;
url_length++;
}
return (url_length);
}
void
sbd_handle_inquiry(struct scsi_task *task, struct stmf_data_buf *initial_dbuf)
{
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
uint8_t *cdbp = (uint8_t *)&task->task_cdb[0];
uint8_t *p;
uint8_t byte0;
uint8_t page_length;
uint16_t bsize = 512;
uint16_t cmd_size;
uint32_t xfer_size = 4;
uint32_t mgmt_url_size = 0;
byte0 = DTYPE_DIRECT;
/*
* Basic protocol checks.
*/
if ((((cdbp[1] & 1) == 0) && cdbp[2]) || cdbp[5]) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
/*
* Zero byte allocation length is not an error. Just
* return success.
*/
cmd_size = (((uint16_t)cdbp[3]) << 8) | cdbp[4];
if (cmd_size == 0) {
task->task_cmd_xfer_length = 0;
if (task->task_additional_flags &
TASK_AF_NO_EXPECTED_XFER_LENGTH) {
task->task_expected_xfer_length = 0;
}
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
if (sl->sl_mgmt_url) {
mgmt_url_size = strlen(sl->sl_mgmt_url);
}
/*
* Standard inquiry
*/
if ((cdbp[1] & 1) == 0) {
int i;
struct scsi_inquiry *inq;
p = (uint8_t *)kmem_zalloc(bsize, KM_SLEEP);
inq = (struct scsi_inquiry *)p;
page_length = 69;
xfer_size = page_length + 5;
inq->inq_dtype = DTYPE_DIRECT;
inq->inq_ansi = 5; /* SPC-3 */
inq->inq_hisup = 1;
inq->inq_rdf = 2; /* Response data format for SPC-3 */
inq->inq_len = page_length;
inq->inq_tpgs = TPGS_FAILOVER_IMPLICIT;
inq->inq_cmdque = 1;
if (sl->sl_flags & SL_VID_VALID) {
bcopy(sl->sl_vendor_id, inq->inq_vid, 8);
} else {
bcopy(sbd_vendor_id, inq->inq_vid, 8);
}
if (sl->sl_flags & SL_PID_VALID) {
bcopy(sl->sl_product_id, inq->inq_pid, 16);
} else {
bcopy(sbd_product_id, inq->inq_pid, 16);
}
if (sl->sl_flags & SL_REV_VALID) {
bcopy(sl->sl_revision, inq->inq_revision, 4);
} else {
bcopy(sbd_revision, inq->inq_revision, 4);
}
/* Adding Version Descriptors */
i = 0;
/* SAM-3 no version */
inq->inq_vd[i].inq_vd_msb = 0x00;
inq->inq_vd[i].inq_vd_lsb = 0x60;
i++;
/* transport */
switch (task->task_lport->lport_id->protocol_id) {
case PROTOCOL_FIBRE_CHANNEL:
inq->inq_vd[i].inq_vd_msb = 0x09;
inq->inq_vd[i].inq_vd_lsb = 0x00;
i++;
break;
case PROTOCOL_PARALLEL_SCSI:
case PROTOCOL_SSA:
case PROTOCOL_IEEE_1394:
/* Currently no claims of conformance */
break;
case PROTOCOL_SRP:
inq->inq_vd[i].inq_vd_msb = 0x09;
inq->inq_vd[i].inq_vd_lsb = 0x40;
i++;
break;
case PROTOCOL_iSCSI:
inq->inq_vd[i].inq_vd_msb = 0x09;
inq->inq_vd[i].inq_vd_lsb = 0x60;
i++;
break;
case PROTOCOL_SAS:
case PROTOCOL_ADT:
case PROTOCOL_ATAPI:
default:
/* Currently no claims of conformance */
break;
}
/* SPC-3 no version */
inq->inq_vd[i].inq_vd_msb = 0x03;
inq->inq_vd[i].inq_vd_lsb = 0x00;
i++;
/* SBC-2 no version */
inq->inq_vd[i].inq_vd_msb = 0x03;
inq->inq_vd[i].inq_vd_lsb = 0x20;
sbd_handle_short_read_transfers(task, initial_dbuf, p, cmd_size,
min(cmd_size, xfer_size));
kmem_free(p, bsize);
return;
}
/*
* EVPD handling
*/
/* Default 512 bytes may not be enough, increase bsize if necessary */
if (cdbp[2] == 0x83 || cdbp[2] == 0x85) {
if (bsize < cmd_size)
bsize = cmd_size;
}
p = (uint8_t *)kmem_zalloc(bsize, KM_SLEEP);
switch (cdbp[2]) {
case 0x00:
page_length = 4 + (mgmt_url_size ? 1 : 0);
p[0] = byte0;
p[3] = page_length;
/* Supported VPD pages in ascending order */
{
uint8_t i = 5;
p[i++] = 0x80;
p[i++] = 0x83;
if (mgmt_url_size != 0)
p[i++] = 0x85;
p[i++] = 0x86;
}
xfer_size = page_length + 4;
break;
case 0x80:
if (sl->sl_serial_no_size) {
page_length = sl->sl_serial_no_size;
bcopy(sl->sl_serial_no, p + 4, sl->sl_serial_no_size);
} else {
/* if no serial num is specified set 4 spaces */
page_length = 4;
bcopy(" ", p + 4, 4);
}
p[0] = byte0;
p[1] = 0x80;
p[3] = page_length;
xfer_size = page_length + 4;
break;
case 0x83:
xfer_size = stmf_scsilib_prepare_vpd_page83(task, p,
bsize, byte0, STMF_VPD_LU_ID|STMF_VPD_TARGET_ID|
STMF_VPD_TP_GROUP|STMF_VPD_RELATIVE_TP_ID);
break;
case 0x85:
if (mgmt_url_size == 0) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
kmem_free(p, bsize);
return;
}
{
uint16_t idx, newidx, sz, url_size;
char *url;
p[0] = byte0;
p[1] = 0x85;
idx = 4;
url = sl->sl_mgmt_url;
url_size = sbd_parse_mgmt_url(&url);
/* Creating Network Service Descriptors */
while (url_size != 0) {
/* Null terminated and 4 Byte aligned */
sz = url_size + 1;
sz += (sz % 4) ? 4 - (sz % 4) : 0;
newidx = idx + sz + 4;
if (newidx < bsize) {
/*
* SPC-3r23 : Table 320 (Sec 7.6.5)
* (Network service descriptor format
*
* Note: Hard coding service type as
* "Storage Configuration Service".
*/
p[idx] = 1;
SCSI_WRITE16(p + idx + 2, sz);
bcopy(url, p + idx + 4, url_size);
xfer_size = newidx + 4;
}
idx = newidx;
/* skip to next mgmt url if any */
url += url_size;
url_size = sbd_parse_mgmt_url(&url);
}
/* Total descriptor length */
SCSI_WRITE16(p + 2, idx - 4);
break;
}
case 0x86:
page_length = 0x3c;
p[0] = byte0;
p[1] = 0x86; /* Page 86 response */
p[3] = page_length;
/*
* Bits 0, 1, and 2 will need to be updated
* to reflect the queue tag handling if/when
* that is implemented. For now, we're going
* to claim support only for Simple TA.
*/
p[5] = 1;
xfer_size = page_length + 4;
break;
default:
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
kmem_free(p, bsize);
return;
}
sbd_handle_short_read_transfers(task, initial_dbuf, p, cmd_size,
min(cmd_size, xfer_size));
kmem_free(p, bsize);
}
stmf_status_t
sbd_task_alloc(struct scsi_task *task)
{
if ((task->task_lu_private =
kmem_alloc(sizeof (sbd_cmd_t), KM_NOSLEEP)) != NULL) {
sbd_cmd_t *scmd = (sbd_cmd_t *)task->task_lu_private;
scmd->flags = 0;
return (STMF_SUCCESS);
}
return (STMF_ALLOC_FAILURE);
}
void
sbd_remove_it_handle(sbd_lu_t *sl, sbd_it_data_t *it)
{
sbd_it_data_t **ppit;
sbd_pgr_remove_it_handle(sl, it);
mutex_enter(&sl->sl_lock);
for (ppit = &sl->sl_it_list; *ppit != NULL;
ppit = &((*ppit)->sbd_it_next)) {
if ((*ppit) == it) {
*ppit = it->sbd_it_next;
break;
}
}
mutex_exit(&sl->sl_lock);
DTRACE_PROBE2(itl__nexus__end, stmf_lu_t *, sl->sl_lu,
sbd_it_data_t *, it);
kmem_free(it, sizeof (*it));
}
void
sbd_check_and_clear_scsi2_reservation(sbd_lu_t *sl, sbd_it_data_t *it)
{
mutex_enter(&sl->sl_lock);
if ((sl->sl_flags & SL_LU_HAS_SCSI2_RESERVATION) == 0) {
/* If we dont have any reservations, just get out. */
mutex_exit(&sl->sl_lock);
return;
}
if (it == NULL) {
/* Find the I_T nexus which is holding the reservation. */
for (it = sl->sl_it_list; it != NULL; it = it->sbd_it_next) {
if (it->sbd_it_flags & SBD_IT_HAS_SCSI2_RESERVATION) {
ASSERT(it->sbd_it_session_id ==
sl->sl_rs_owner_session_id);
break;
}
}
ASSERT(it != NULL);
} else {
/*
* We were passed an I_T nexus. If this nexus does not hold
* the reservation, do nothing. This is why this function is
* called "check_and_clear".
*/
if ((it->sbd_it_flags & SBD_IT_HAS_SCSI2_RESERVATION) == 0) {
mutex_exit(&sl->sl_lock);
return;
}
}
it->sbd_it_flags &= ~SBD_IT_HAS_SCSI2_RESERVATION;
sl->sl_flags &= ~SL_LU_HAS_SCSI2_RESERVATION;
mutex_exit(&sl->sl_lock);
}
void
sbd_new_task(struct scsi_task *task, struct stmf_data_buf *initial_dbuf)
{
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
sbd_it_data_t *it;
uint8_t cdb0, cdb1;
stmf_status_t st_ret;
if ((it = task->task_lu_itl_handle) == NULL) {
mutex_enter(&sl->sl_lock);
for (it = sl->sl_it_list; it != NULL; it = it->sbd_it_next) {
if (it->sbd_it_session_id ==
task->task_session->ss_session_id) {
mutex_exit(&sl->sl_lock);
stmf_scsilib_send_status(task, STATUS_BUSY, 0);
return;
}
}
it = (sbd_it_data_t *)kmem_zalloc(sizeof (*it), KM_NOSLEEP);
if (it == NULL) {
mutex_exit(&sl->sl_lock);
stmf_scsilib_send_status(task, STATUS_BUSY, 0);
return;
}
it->sbd_it_session_id = task->task_session->ss_session_id;
bcopy(task->task_lun_no, it->sbd_it_lun, 8);
it->sbd_it_next = sl->sl_it_list;
sl->sl_it_list = it;
mutex_exit(&sl->sl_lock);
DTRACE_PROBE1(itl__nexus__start, scsi_task *, task);
sbd_pgr_initialize_it(task);
if (stmf_register_itl_handle(task->task_lu, task->task_lun_no,
task->task_session, it->sbd_it_session_id, it)
!= STMF_SUCCESS) {
sbd_remove_it_handle(sl, it);
stmf_scsilib_send_status(task, STATUS_BUSY, 0);
return;
}
task->task_lu_itl_handle = it;
if (sl->sl_access_state != SBD_LU_STANDBY) {
it->sbd_it_ua_conditions = SBD_UA_POR;
}
} else if (it->sbd_it_flags & SBD_IT_PGR_CHECK_FLAG) {
sbd_pgr_initialize_it(task);
mutex_enter(&sl->sl_lock);
it->sbd_it_flags &= ~SBD_IT_PGR_CHECK_FLAG;
mutex_exit(&sl->sl_lock);
}
if (task->task_mgmt_function) {
stmf_scsilib_handle_task_mgmt(task);
return;
}
/*
* if we're transitioning between access
* states, return NOT READY
*/
if (sl->sl_access_state == SBD_LU_TRANSITION_TO_STANDBY ||
sl->sl_access_state == SBD_LU_TRANSITION_TO_ACTIVE) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_LU_NO_ACCESS_UNAVAIL);
return;
}
/* Checking ua conditions as per SAM3R14 5.3.2 specified order */
if ((it->sbd_it_ua_conditions) && (task->task_cdb[0] != SCMD_INQUIRY)) {
uint32_t saa = 0;
mutex_enter(&sl->sl_lock);
if (it->sbd_it_ua_conditions & SBD_UA_POR) {
it->sbd_it_ua_conditions &= ~SBD_UA_POR;
saa = STMF_SAA_POR;
}
mutex_exit(&sl->sl_lock);
if (saa) {
stmf_scsilib_send_status(task, STATUS_CHECK, saa);
return;
}
}
/* Reservation conflict checks */
if (sl->sl_access_state != SBD_LU_STANDBY) {
if (SBD_PGR_RSVD(sl->sl_pgr)) {
if (sbd_pgr_reservation_conflict(task)) {
stmf_scsilib_send_status(task,
STATUS_RESERVATION_CONFLICT, 0);
return;
}
} else if ((sl->sl_flags & SL_LU_HAS_SCSI2_RESERVATION) &&
((it->sbd_it_flags & SBD_IT_HAS_SCSI2_RESERVATION) == 0)) {
if (!(SCSI2_CONFLICT_FREE_CMDS(task->task_cdb))) {
stmf_scsilib_send_status(task,
STATUS_RESERVATION_CONFLICT, 0);
return;
}
}
}
/* Rest of the ua conndition checks */
if ((it->sbd_it_ua_conditions) && (task->task_cdb[0] != SCMD_INQUIRY)) {
uint32_t saa = 0;
mutex_enter(&sl->sl_lock);
if (it->sbd_it_ua_conditions & SBD_UA_CAPACITY_CHANGED) {
it->sbd_it_ua_conditions &= ~SBD_UA_CAPACITY_CHANGED;
if ((task->task_cdb[0] == SCMD_READ_CAPACITY) ||
((task->task_cdb[0] == SCMD_SVC_ACTION_IN_G4) &&
(task->task_cdb[1] ==
SSVC_ACTION_READ_CAPACITY_G4))) {
saa = 0;
} else {
saa = STMF_SAA_CAPACITY_DATA_HAS_CHANGED;
}
} else if (it->sbd_it_ua_conditions &
SBD_UA_MODE_PARAMETERS_CHANGED) {
it->sbd_it_ua_conditions &=
~SBD_UA_MODE_PARAMETERS_CHANGED;
saa = STMF_SAA_MODE_PARAMETERS_CHANGED;
} else if (it->sbd_it_ua_conditions &
SBD_UA_ASYMMETRIC_ACCESS_CHANGED) {
it->sbd_it_ua_conditions &=
~SBD_UA_ASYMMETRIC_ACCESS_CHANGED;
saa = STMF_SAA_ASYMMETRIC_ACCESS_CHANGED;
} else if (it->sbd_it_ua_conditions &
SBD_UA_ACCESS_STATE_TRANSITION) {
it->sbd_it_ua_conditions &=
~SBD_UA_ACCESS_STATE_TRANSITION;
saa = STMF_SAA_LU_NO_ACCESS_TRANSITION;
} else {
it->sbd_it_ua_conditions = 0;
saa = 0;
}
mutex_exit(&sl->sl_lock);
if (saa) {
stmf_scsilib_send_status(task, STATUS_CHECK, saa);
return;
}
}
cdb0 = task->task_cdb[0];
cdb1 = task->task_cdb[1];
if (sl->sl_access_state == SBD_LU_STANDBY) {
if (cdb0 != SCMD_INQUIRY &&
cdb0 != SCMD_MODE_SENSE &&
cdb0 != SCMD_MODE_SENSE_G1 &&
cdb0 != SCMD_MODE_SELECT &&
cdb0 != SCMD_MODE_SELECT_G1 &&
cdb0 != SCMD_RESERVE &&
cdb0 != SCMD_RELEASE &&
cdb0 != SCMD_PERSISTENT_RESERVE_OUT &&
cdb0 != SCMD_PERSISTENT_RESERVE_IN &&
cdb0 != SCMD_REQUEST_SENSE &&
!(cdb0 == SCMD_MAINTENANCE_IN &&
(cdb1 & 0x1F) == 0x0A)) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_LU_NO_ACCESS_STANDBY);
return;
}
/*
* is this a short write?
* if so, we'll need to wait until we have the buffer
* before proxying the command
*/
switch (cdb0) {
case SCMD_MODE_SELECT:
case SCMD_MODE_SELECT_G1:
case SCMD_PERSISTENT_RESERVE_OUT:
break;
default:
st_ret = stmf_proxy_scsi_cmd(task,
initial_dbuf);
if (st_ret != STMF_SUCCESS) {
stmf_scsilib_send_status(task,
STATUS_CHECK,
STMF_SAA_LU_NO_ACCESS_UNAVAIL);
}
return;
}
}
cdb0 = task->task_cdb[0] & 0x1F;
if ((cdb0 == SCMD_READ) || (cdb0 == SCMD_WRITE)) {
if (task->task_additional_flags & TASK_AF_PORT_LOAD_HIGH) {
stmf_scsilib_send_status(task, STATUS_QFULL, 0);
return;
}
if (cdb0 == SCMD_READ) {
sbd_handle_read(task, initial_dbuf);
return;
}
sbd_handle_write(task, initial_dbuf);
return;
}
cdb0 = task->task_cdb[0];
cdb1 = task->task_cdb[1];
if (cdb0 == SCMD_INQUIRY) { /* Inquiry */
sbd_handle_inquiry(task, initial_dbuf);
return;
}
if (cdb0 == SCMD_PERSISTENT_RESERVE_OUT) {
sbd_handle_pgr_out_cmd(task, initial_dbuf);
return;
}
if (cdb0 == SCMD_PERSISTENT_RESERVE_IN) {
sbd_handle_pgr_in_cmd(task, initial_dbuf);
return;
}
if (cdb0 == SCMD_RELEASE) {
if (cdb1) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
mutex_enter(&sl->sl_lock);
if (sl->sl_flags & SL_LU_HAS_SCSI2_RESERVATION) {
/* If not owner don't release it, just return good */
if (it->sbd_it_session_id !=
sl->sl_rs_owner_session_id) {
mutex_exit(&sl->sl_lock);
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
}
sl->sl_flags &= ~SL_LU_HAS_SCSI2_RESERVATION;
it->sbd_it_flags &= ~SBD_IT_HAS_SCSI2_RESERVATION;
mutex_exit(&sl->sl_lock);
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
if (cdb0 == SCMD_RESERVE) {
if (cdb1) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
mutex_enter(&sl->sl_lock);
if (sl->sl_flags & SL_LU_HAS_SCSI2_RESERVATION) {
/* If not owner, return conflict status */
if (it->sbd_it_session_id !=
sl->sl_rs_owner_session_id) {
mutex_exit(&sl->sl_lock);
stmf_scsilib_send_status(task,
STATUS_RESERVATION_CONFLICT, 0);
return;
}
}
sl->sl_flags |= SL_LU_HAS_SCSI2_RESERVATION;
it->sbd_it_flags |= SBD_IT_HAS_SCSI2_RESERVATION;
sl->sl_rs_owner_session_id = it->sbd_it_session_id;
mutex_exit(&sl->sl_lock);
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
if (cdb0 == SCMD_REQUEST_SENSE) {
/*
* LU provider needs to store unretrieved sense data
* (e.g. after power-on/reset). For now, we'll just
* return good status with no sense.
*/
if ((cdb1 & ~1) || task->task_cdb[2] || task->task_cdb[3] ||
task->task_cdb[5]) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
} else {
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
}
return;
}
/* Report Target Port Groups */
if ((cdb0 == SCMD_MAINTENANCE_IN) &&
((cdb1 & 0x1F) == 0x0A)) {
stmf_scsilib_handle_report_tpgs(task, initial_dbuf);
return;
}
if (cdb0 == SCMD_START_STOP) { /* Start stop */
task->task_cmd_xfer_length = 0;
if (task->task_cdb[4] & 0xFC) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
if (task->task_cdb[4] & 2) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
} else {
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
}
return;
}
if ((cdb0 == SCMD_MODE_SENSE) || (cdb0 == SCMD_MODE_SENSE_G1)) {
uint8_t *p;
p = kmem_zalloc(512, KM_SLEEP);
sbd_handle_mode_sense(task, initial_dbuf, p);
kmem_free(p, 512);
return;
}
if ((cdb0 == SCMD_MODE_SELECT) || (cdb0 == SCMD_MODE_SELECT_G1)) {
sbd_handle_mode_select(task, initial_dbuf);
return;
}
if (cdb0 == SCMD_TEST_UNIT_READY) { /* Test unit ready */
task->task_cmd_xfer_length = 0;
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
if (cdb0 == SCMD_READ_CAPACITY) { /* Read Capacity */
sbd_handle_read_capacity(task, initial_dbuf);
return;
}
if (cdb0 == SCMD_SVC_ACTION_IN_G4) { /* Read Capacity or read long */
if (cdb1 == SSVC_ACTION_READ_CAPACITY_G4) {
sbd_handle_read_capacity(task, initial_dbuf);
return;
/*
* } else if (cdb1 == SSVC_ACTION_READ_LONG_G4) {
* sbd_handle_read(task, initial_dbuf);
* return;
*/
}
}
/*
* if (cdb0 == SCMD_SVC_ACTION_OUT_G4) {
* if (cdb1 == SSVC_ACTION_WRITE_LONG_G4) {
* sbd_handle_write(task, initial_dbuf);
* return;
* }
* }
*/
if (cdb0 == SCMD_VERIFY) {
/*
* Something more likely needs to be done here.
*/
task->task_cmd_xfer_length = 0;
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
return;
}
if (cdb0 == SCMD_SYNCHRONIZE_CACHE ||
cdb0 == SCMD_SYNCHRONIZE_CACHE_G4) {
sbd_handle_sync_cache(task, initial_dbuf);
return;
}
stmf_scsilib_send_status(task, STATUS_CHECK, STMF_SAA_INVALID_OPCODE);
}
void
sbd_dbuf_xfer_done(struct scsi_task *task, struct stmf_data_buf *dbuf)
{
sbd_cmd_t *scmd = NULL;
scmd = (sbd_cmd_t *)task->task_lu_private;
if ((scmd == NULL) || ((scmd->flags & SBD_SCSI_CMD_ACTIVE) == 0))
return;
switch (scmd->cmd_type) {
case (SBD_CMD_SCSI_READ):
sbd_handle_read_xfer_completion(task, scmd, dbuf);
break;
case (SBD_CMD_SCSI_WRITE):
sbd_handle_write_xfer_completion(task, scmd, dbuf, 1);
break;
case (SBD_CMD_SMALL_READ):
sbd_handle_short_read_xfer_completion(task, scmd, dbuf);
break;
case (SBD_CMD_SMALL_WRITE):
sbd_handle_short_write_xfer_completion(task, dbuf);
break;
default:
cmn_err(CE_PANIC, "Unknown cmd type, task = %p", (void *)task);
break;
}
}
/* ARGSUSED */
void
sbd_send_status_done(struct scsi_task *task)
{
cmn_err(CE_PANIC,
"sbd_send_status_done: this should not have been called");
}
void
sbd_task_free(struct scsi_task *task)
{
if (task->task_lu_private) {
sbd_cmd_t *scmd = (sbd_cmd_t *)task->task_lu_private;
if (scmd->flags & SBD_SCSI_CMD_ACTIVE) {
cmn_err(CE_PANIC, "cmd is active, task = %p",
(void *)task);
}
kmem_free(scmd, sizeof (sbd_cmd_t));
}
}
/*
* Aborts are synchronus w.r.t. I/O AND
* All the I/O which SBD does is synchronous AND
* Everything within a task is single threaded.
* IT MEANS
* If this function is called, we are doing nothing with this task
* inside of sbd module.
*/
/* ARGSUSED */
stmf_status_t
sbd_abort(struct stmf_lu *lu, int abort_cmd, void *arg, uint32_t flags)
{
sbd_lu_t *sl = (sbd_lu_t *)lu->lu_provider_private;
scsi_task_t *task;
if (abort_cmd == STMF_LU_RESET_STATE) {
return (sbd_lu_reset_state(lu));
}
if (abort_cmd == STMF_LU_ITL_HANDLE_REMOVED) {
sbd_check_and_clear_scsi2_reservation(sl, (sbd_it_data_t *)arg);
sbd_remove_it_handle(sl, (sbd_it_data_t *)arg);
return (STMF_SUCCESS);
}
ASSERT(abort_cmd == STMF_LU_ABORT_TASK);
task = (scsi_task_t *)arg;
if (task->task_lu_private) {
sbd_cmd_t *scmd = (sbd_cmd_t *)task->task_lu_private;
if (scmd->flags & SBD_SCSI_CMD_ACTIVE) {
scmd->flags &= ~SBD_SCSI_CMD_ACTIVE;
return (STMF_ABORT_SUCCESS);
}
}
return (STMF_NOT_FOUND);
}
/* ARGSUSED */
void
sbd_ctl(struct stmf_lu *lu, int cmd, void *arg)
{
sbd_lu_t *sl = (sbd_lu_t *)lu->lu_provider_private;
stmf_change_status_t st;
ASSERT((cmd == STMF_CMD_LU_ONLINE) ||
(cmd == STMF_CMD_LU_OFFLINE) ||
(cmd == STMF_ACK_LU_ONLINE_COMPLETE) ||
(cmd == STMF_ACK_LU_OFFLINE_COMPLETE));
st.st_completion_status = STMF_SUCCESS;
st.st_additional_info = NULL;
switch (cmd) {
case STMF_CMD_LU_ONLINE:
if (sl->sl_state == STMF_STATE_ONLINE)
st.st_completion_status = STMF_ALREADY;
else if (sl->sl_state != STMF_STATE_OFFLINE)
st.st_completion_status = STMF_FAILURE;
if (st.st_completion_status == STMF_SUCCESS) {
sl->sl_state = STMF_STATE_ONLINE;
sl->sl_state_not_acked = 1;
}
(void) stmf_ctl(STMF_CMD_LU_ONLINE_COMPLETE, lu, &st);
break;
case STMF_CMD_LU_OFFLINE:
if (sl->sl_state == STMF_STATE_OFFLINE)
st.st_completion_status = STMF_ALREADY;
else if (sl->sl_state != STMF_STATE_ONLINE)
st.st_completion_status = STMF_FAILURE;
if (st.st_completion_status == STMF_SUCCESS) {
sl->sl_flags &= ~(SL_MEDIUM_REMOVAL_PREVENTED |
SL_LU_HAS_SCSI2_RESERVATION);
sl->sl_state = STMF_STATE_OFFLINE;
sl->sl_state_not_acked = 1;
sbd_pgr_reset(sl);
}
(void) stmf_ctl(STMF_CMD_LU_OFFLINE_COMPLETE, lu, &st);
break;
case STMF_ACK_LU_ONLINE_COMPLETE:
/* Fallthrough */
case STMF_ACK_LU_OFFLINE_COMPLETE:
sl->sl_state_not_acked = 0;
break;
}
}
/* ARGSUSED */
stmf_status_t
sbd_info(uint32_t cmd, stmf_lu_t *lu, void *arg, uint8_t *buf,
uint32_t *bufsizep)
{
return (STMF_NOT_SUPPORTED);
}
stmf_status_t
sbd_lu_reset_state(stmf_lu_t *lu)
{
sbd_lu_t *sl = (sbd_lu_t *)lu->lu_provider_private;
mutex_enter(&sl->sl_lock);
if (sl->sl_flags & SL_SAVED_WRITE_CACHE_DISABLE) {
sl->sl_flags |= SL_WRITEBACK_CACHE_DISABLE;
mutex_exit(&sl->sl_lock);
if (sl->sl_access_state == SBD_LU_ACTIVE) {
(void) sbd_wcd_set(1, sl);
}
} else {
sl->sl_flags &= ~SL_WRITEBACK_CACHE_DISABLE;
mutex_exit(&sl->sl_lock);
if (sl->sl_access_state == SBD_LU_ACTIVE) {
(void) sbd_wcd_set(0, sl);
}
}
sbd_pgr_reset(sl);
sbd_check_and_clear_scsi2_reservation(sl, NULL);
if (stmf_deregister_all_lu_itl_handles(lu) != STMF_SUCCESS) {
return (STMF_FAILURE);
}
return (STMF_SUCCESS);
}
sbd_status_t
sbd_flush_data_cache(sbd_lu_t *sl, int fsync_done)
{
int r = 0;
int ret;
if (fsync_done)
goto over_fsync;
if ((sl->sl_data_vtype == VREG) || (sl->sl_data_vtype == VBLK)) {
if (VOP_FSYNC(sl->sl_data_vp, FSYNC, kcred, NULL))
return (SBD_FAILURE);
}
over_fsync:
if (((sl->sl_data_vtype == VCHR) || (sl->sl_data_vtype == VBLK)) &&
((sl->sl_flags & SL_NO_DATA_DKIOFLUSH) == 0)) {
ret = VOP_IOCTL(sl->sl_data_vp, DKIOCFLUSHWRITECACHE, NULL,
FKIOCTL, kcred, &r, NULL);
if ((ret == ENOTTY) || (ret == ENOTSUP)) {
mutex_enter(&sl->sl_lock);
sl->sl_flags |= SL_NO_DATA_DKIOFLUSH;
mutex_exit(&sl->sl_lock);
} else if (ret != 0) {
return (SBD_FAILURE);
}
}
return (SBD_SUCCESS);
}
/* ARGSUSED */
static void
sbd_handle_sync_cache(struct scsi_task *task,
struct stmf_data_buf *initial_dbuf)
{
sbd_lu_t *sl = (sbd_lu_t *)task->task_lu->lu_provider_private;
uint64_t lba, laddr;
sbd_status_t sret;
uint32_t len;
int is_g4 = 0;
int immed;
task->task_cmd_xfer_length = 0;
/*
* Determine if this is a 10 or 16 byte CDB
*/
if (task->task_cdb[0] == SCMD_SYNCHRONIZE_CACHE_G4)
is_g4 = 1;
/*
* Determine other requested parameters
*
* We don't have a non-volatile cache, so don't care about SYNC_NV.
* Do not support the IMMED bit.
*/
immed = (task->task_cdb[1] & 0x02);
if (immed) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
/*
* Check to be sure we're not being asked to sync an LBA
* that is out of range. While checking, verify reserved fields.
*/
if (is_g4) {
if ((task->task_cdb[1] & 0xf9) || task->task_cdb[14] ||
task->task_cdb[15]) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
lba = READ_SCSI64(&task->task_cdb[2], uint64_t);
len = READ_SCSI32(&task->task_cdb[10], uint32_t);
} else {
if ((task->task_cdb[1] & 0xf9) || task->task_cdb[6] ||
task->task_cdb[9]) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_INVALID_FIELD_IN_CDB);
return;
}
lba = READ_SCSI32(&task->task_cdb[2], uint64_t);
len = READ_SCSI16(&task->task_cdb[7], uint32_t);
}
laddr = lba << sl->sl_data_blocksize_shift;
len <<= sl->sl_data_blocksize_shift;
if ((laddr + (uint64_t)len) > sl->sl_lu_size) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_LBA_OUT_OF_RANGE);
return;
}
sret = sbd_flush_data_cache(sl, 0);
if (sret != SBD_SUCCESS) {
stmf_scsilib_send_status(task, STATUS_CHECK,
STMF_SAA_WRITE_ERROR);
return;
}
stmf_scsilib_send_status(task, STATUS_GOOD, 0);
}