/* * IMPORTANT: READ BEFORE DOWNLOADING, COPYING, INSTALLING OR USING. By downloading, copying, installing or * using the software you agree to this license. If you do not agree to this license, do not download, install, * copy or use the software. * * Intel License Agreement * * Copyright (c) 2000, Intel Corporation * All rights reserved. * * Redistribution and use in source and binary forms, with or without modification, are permitted provided that * the following conditions are met: * * -Redistributions of source code must retain the above copyright notice, this list of conditions and the * following disclaimer. * * -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. * * -The name of Intel Corporation may not be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS 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 INTEL 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. */ #include "config.h" #ifdef HAVE_STDLIB_H #include <stdlib.h> #endif #ifdef HAVE_NETINET_IN_H #include <netinet/in.h> #endif #ifdef HAVE_SYS_UIO_H #include <sys/uio.h> #endif #ifdef HAVE_STRING_H #include <string.h> #endif #ifdef HAVE_INTTYPES_H #include <inttypes.h> #endif #include "iscsi.h" #include "iscsiutil.h" /* * Task Command */ int iscsi_task_cmd_encap(uint8_t *header, iscsi_task_cmd_t * cmd) { iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Function: %u\n", cmd->function); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Ref Tag: %#x\n", cmd->ref_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "RefCmdSN: %u\n", cmd->RefCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpDataSN: %u\n", cmd->ExpDataSN); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= ISCSI_TASK_CMD; /* Opcode */ if (cmd->immediate) { header[0] |= 0x40; /* Immediate bit */ } header[1] = cmd->function & 0x80; /* Function */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */ *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->ref_tag); /* Reference Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->RefCmdSN); /* RefCmdSN */ *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->ExpDataSN); /* ExpDataSN */ return 0; } int iscsi_task_cmd_decap(uint8_t *header, iscsi_task_cmd_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_TASK_CMD, NO_CLEANUP, -1); cmd->immediate = ((header[0] & 0x40) == 0x40); /* Immediate bit */ cmd->function = header[1] & 0x80; /* Function */ cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ cmd->ref_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Reference Tag */ cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */ cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */ cmd->RefCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* RefCmdSN */ cmd->ExpDataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* ExpDataSN */ RETURN_NOT_EQUAL("Byte 1, bit 0", header[1] & 0x80, 0x80, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 4-7", *((uint32_t *) (void *) (header + 4)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Function: %u\n", cmd->function); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Ref Tag: %#x\n", cmd->ref_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "RefCmdSN: %u\n", cmd->RefCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpDataSN: %u\n", cmd->ExpDataSN); return 0; } /* * Task Response */ int iscsi_task_rsp_encap(uint8_t *header, iscsi_task_rsp_t * rsp) { uint32_t length; iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Response: %u\n", rsp->response); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", rsp->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= ISCSI_TASK_RSP; /* Opcode */ header[1] |= 0x80; /* Byte 1 bit 0 */ header[2] = rsp->response; /* Response */ length = (rsp->length & 0x00ffffff); /* Length */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag); /* Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN); /* StatSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN); /* ExpCmdSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN); /* MaxCmdSN */ return 0; } int iscsi_task_rsp_decap(uint8_t *header, iscsi_task_rsp_t * rsp) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_TASK_RSP, NO_CLEANUP, 1); rsp->response = header[2]; /* Response */ rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ RETURN_NOT_EQUAL("Byte 0, bits 0-1", header[0] & 0x00, 0x00, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 1, bit 0", header[1] & 0x80, 0x80, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 4-7", *((uint32_t *) (void *) (header + 4)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 8-11", *((uint32_t *) (void *) (header + 8)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 12-15", *((uint32_t *) (void *) (header + 12)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 20-23", *((uint32_t *) (void *) (header + 23)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 36-39", *((uint32_t *) (void *) (header + 36)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Response: %u\n", rsp->response); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); return 0; } /* * NOP-Out */ int iscsi_nop_out_encap(uint8_t *header, iscsi_nop_out_args_t * cmd) { uint32_t length; iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] = ISCSI_NOP_OUT; /* Opcode */ if (cmd->immediate) { header[0] |= 0x40; /* Immediate bit */ } header[1] |= 0x80; /* Byte 1 bit 0 and Reserved */ length = (cmd->length & 0x00ffffff); /* Length */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */ *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Target Transfer Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */ return 0; } int iscsi_nop_out_decap(uint8_t *header, iscsi_nop_out_args_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_NOP_OUT, NO_CLEANUP, 1); cmd->immediate = ((header[0] & 0x40) == 0x40); /* Immediate bit */ cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Target Tranfer Tag */ cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */ cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */ RETURN_NOT_EQUAL("Byte 1", header[1], 0x80, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 4", header[4], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 32-35", *((uint32_t *) (void *) (header + 32)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 36-39", *((uint32_t *) (void *) (header + 36)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); return 0; } /* * NOP-In */ int iscsi_nop_in_encap(uint8_t *header, iscsi_nop_in_args_t * cmd) { uint32_t length; iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", cmd->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", cmd->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", cmd->MaxCmdSN); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] = 0x00 | ISCSI_NOP_IN; /* Opcode */ header[1] |= 0x80; /* Reserved */ length = (cmd->length & 0x00ffffff); /* Length */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */ *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Target Transfer Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->StatSN); /* StatSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpCmdSN); /* ExpCmdSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->MaxCmdSN); /* MaxCmdSN */ return 0; } int iscsi_nop_in_decap(uint8_t *header, iscsi_nop_in_args_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_NOP_IN, NO_CLEANUP, 1); cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Target Transfer Tag */ cmd->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ cmd->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ cmd->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ RETURN_NOT_EQUAL("Byte 0, bits 0-1", header[0] & 0xc0, 0x00, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 1", header[1], 0x80, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 4", header[4], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 36-39", *((uint32_t *) (void *) (header + 36)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", cmd->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", cmd->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", cmd->MaxCmdSN); return 0; } /* * Text Command */ int iscsi_text_cmd_encap(uint8_t *header, iscsi_text_cmd_args_t * cmd) { uint32_t length; iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %d\n", cmd->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Continue: %d\n", cmd->cont); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= ISCSI_TEXT_CMD; /* Opcode */ if (cmd->immediate) { header[0] |= 0x40; /* Immediate bit */ } if (cmd->final) { header[1] |= 0x80; /* Final bit */ } if (cmd->cont) { header[1] |= 0x40; /* Continue bit */ } length = (cmd->length & 0x00ffffff); /* Length */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */ *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Transfer Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */ return 0; } int iscsi_text_cmd_decap(uint8_t *header, iscsi_text_cmd_args_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_TEXT_CMD, NO_CLEANUP, 1); cmd->immediate = ((header[0] & 0x40) == 0x40); /* Immediate bit */ cmd->final = ((header[1] & 0x80) == 0x80); /* Final bit */ cmd->cont = ((header[1] & 0x40) == 0x40); /* Continue bit */ cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Transfer Tag */ cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */ cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */ RETURN_NOT_EQUAL("Byte 1, Bits 2-7", header[1] & 0x00, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 4", header[4], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 8-11", *((uint32_t *) (void *) (header + 8)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 12-15", *((uint32_t *) (void *) (header + 12)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 32-35", *((uint32_t *) (void *) (header + 32)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 36-39", *((uint32_t *) (void *) (header + 36)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %d\n", cmd->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Continue: %d\n", cmd->cont); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); return 0; } /* * Text Response */ int iscsi_text_rsp_encap(uint8_t *header, iscsi_text_rsp_args_t * rsp) { uint32_t length; iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %d\n", rsp->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Continue: %d\n", rsp->cont); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", rsp->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", rsp->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", rsp->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= 0x00 | ISCSI_TEXT_RSP; /* Opcode */ if (rsp->final) { header[1] |= 0x80; /* Final bit */ } if (rsp->cont) { header[1] |= 0x40; /* Continue */ } length = (rsp->length & 0x00ffffff); /* Length */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(rsp->lun); /* LUN */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag); /* Tag */ *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(rsp->transfer_tag); /* Transfer Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN); /* StatSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN); /* ExpCmdSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN); /* MaxCmdSN */ return 0; } int iscsi_text_rsp_decap(uint8_t *header, iscsi_text_rsp_args_t * rsp) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_TEXT_RSP, NO_CLEANUP, 1); rsp->final = ((header[1] & 0x80) == 0x80); /* Final bit */ rsp->cont = ((header[1] & 0x40) == 0x40); /* Continue bit */ rsp->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ rsp->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ rsp->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Transfer Tag */ rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ RETURN_NOT_EQUAL("Byte 1, Bits 2-7", header[1] & 0x3f, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 4", header[4], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 8-11", *((uint32_t *) (void *) (header + 8)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 12-15", *((uint32_t *) (void *) (header + 12)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 36-39", *((uint32_t *) (void *) (header + 36)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %d\n", rsp->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Continue: %d\n", rsp->cont); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", rsp->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", rsp->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", rsp->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); return 0; } /* * Login Command */ int iscsi_login_cmd_encap(uint8_t *header, iscsi_login_cmd_args_t * cmd) { uint32_t length; iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transit: %d\n", cmd->transit); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Continue: %d\n", cmd->cont); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CSG: %u\n", cmd->csg); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "NSG: %u\n", cmd->nsg); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Version_min: %u\n", cmd->version_min); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Version_max: %u\n", cmd->version_max); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TotalAHSLength: %u\n", cmd->AHSlength); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ISID: %" PRIu64 "\n", cmd->isid); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TSIH: %hu\n", cmd->tsih); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CID: %hu\n", cmd->cid); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= 0x40 | ISCSI_LOGIN_CMD; /* Opcode */ if (cmd->transit) { header[1] |= 0x80; /* Transit */ } if (cmd->cont) { header[1] |= 0x40; /* Continue */ } header[1] |= ((cmd->csg) << 2) & 0x0c; /* CSG */ header[1] |= (cmd->nsg) & 0x03; /* NSG */ header[2] = cmd->version_max; /* Version-Max */ header[3] = cmd->version_min; /* Version-Min */ header[4] = cmd->AHSlength; /* TotalAHSLength */ length = (cmd->length & 0x00ffffff); /* Length */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->isid); /* ISID */ *((uint16_t *) (void *) (header + 14)) = ISCSI_HTONS(cmd->tsih); /* TSIH */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Task Tag */ *((uint16_t *) (void *) (header + 20)) = ISCSI_HTONS(cmd->cid); /* CID */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */ return 0; } int iscsi_login_cmd_decap(uint8_t *header, iscsi_login_cmd_args_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_LOGIN_CMD, NO_CLEANUP, 1); cmd->transit = (header[1] & 0x80) ? 1 : 0; /* Transit */ cmd->cont = (header[1] & 0x40) ? 1 : 0; /* Continue */ cmd->csg = (header[1] & 0x0cU) >> 2; /* CSG */ cmd->nsg = header[1] & 0x03; /* NSG */ cmd->version_max = header[2]; /* Version-Max */ cmd->version_min = header[3]; /* Version-Min */ cmd->AHSlength = header[4]; /* TotalAHSLength */ cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ cmd->isid = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* ISID */ cmd->tsih = ISCSI_NTOHS(*((uint16_t *) (void *) (header + 14))); /* TSIH */ cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Task Tag */ cmd->cid = ISCSI_NTOHS(*((uint16_t *) (void *) (header + 20))); /* CID */ cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */ cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */ iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transit: %d\n", cmd->transit); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Continue: %d\n", cmd->cont); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CSG: %u\n", cmd->csg); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "NSG: %u\n", cmd->nsg); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Version_min: %u\n", cmd->version_min); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Version_max: %u\n", cmd->version_max); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TotalAHSLength: %u\n", cmd->AHSlength); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ISID: %" PRIu64 "\n", cmd->isid); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TSIH: %hu\n", cmd->tsih); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CID: %hu\n", cmd->cid); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); RETURN_NOT_EQUAL("Byte 1, bits 2-3", (header[1] & 0x30U) >> 4U, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 22-23", *((uint16_t *) (void *) (header + 22)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 32-35", *((uint32_t *) (void *) (header + 32)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 36-39", *((uint32_t *) (void *) (header + 36)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); if (cmd->transit) { if (cmd->nsg <= cmd->csg) { return -1; } if ((cmd->nsg != 0) && (cmd->nsg != 1) && (cmd->nsg != 3)) { return -1; } } return 0; } /* * Login Response */ int iscsi_login_rsp_encap(uint8_t *header, iscsi_login_rsp_args_t * rsp) { iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transit: %d\n", rsp->transit); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Continue: %d\n", rsp->cont); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CSG: %u\n", rsp->csg); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "NSG: %u\n", rsp->nsg); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Version_max: %u\n", rsp->version_max); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Version_active: %u\n", rsp->version_active); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TotalAHSLength: %u\n", rsp->AHSlength); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", rsp->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ISID: %" PRIu64 "\n", rsp->isid); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TSIH: %u\n", rsp->tsih); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Status-Class: %u\n", rsp->status_class); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Status-Detail: %u\n", rsp->status_detail); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= 0x00 | ISCSI_LOGIN_RSP; /* Opcode */ if (rsp->transit) { header[1] |= 0x80; /* Transit */ } if (rsp->cont) { header[1] |= 0x40; /* Continue */ } header[1] |= ((rsp->csg) << 2) & 0x0c; /* CSG */ if (rsp->transit) { header[1] |= (rsp->nsg) & 0x03; /* NSG */ } header[2] = rsp->version_max; /* Version-max */ header[3] = rsp->version_active; /* Version-active */ header[4] = rsp->AHSlength; /* TotalAHSLength */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(rsp->length); /* Length */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(rsp->isid); /* ISID */ *((uint16_t *) (void *) (header + 14)) = ISCSI_HTONS(rsp->tsih); /* TSIH */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag); /* Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN); /* StatRn */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN); /* ExpCmdSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN); /* MaxCmdSN */ header[36] = rsp->status_class; /* Status-Class */ header[37] = rsp->status_detail; /* Status-Detail */ return 0; } int iscsi_login_rsp_decap(uint8_t *header, iscsi_login_rsp_args_t * rsp) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_LOGIN_RSP, NO_CLEANUP, 1); rsp->transit = (header[1] & 0x80U) >> 7; /* Transit */ rsp->cont = (header[1] & 0x40U) >> 6; /* Continue */ rsp->csg = (header[1] & 0x0cU) >> 2; /* CSG */ rsp->nsg = header[1] & 0x03; /* NSG */ rsp->version_max = header[2]; /* Version-max */ rsp->version_active = header[3]; /* Version-active */ rsp->AHSlength = header[4]; /* TotalAHSLength */ rsp->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ rsp->isid = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* ISID */ rsp->tsih = ISCSI_NTOHS(*((uint16_t *) (void *) (header + 14))); /* TSIH */ rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ rsp->status_class = header[36]; /* Status-Class */ rsp->status_detail = header[37]; /* Status-Detail */ iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transit: %d\n", rsp->transit); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Continue: %d\n", rsp->cont); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CSG: %u\n", rsp->csg); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "NSG: %u\n", rsp->nsg); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Version_max: %u\n", rsp->version_max); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Version_active: %u\n", rsp->version_active); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TotalAHSLength: %u\n", rsp->AHSlength); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", rsp->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ISID: %" PRIu64 "\n", rsp->isid); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TSIH: %u\n", rsp->tsih); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Status-Class: %u\n", rsp->status_class); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Status-Detail: %u\n", rsp->status_detail); RETURN_NOT_EQUAL("Byte 1, bits 2-3", (header[1] & 0x30U) >> 4, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 20-23", *((uint32_t *) (void *) (header + 20)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 38", header[38], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 39", header[39], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); return 0; } /* * Logout Command */ int iscsi_logout_cmd_encap(uint8_t *header, iscsi_logout_cmd_args_t * cmd) { iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Reason: %u\n", cmd->reason); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CID: %hu\n", cmd->cid); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] = ISCSI_LOGOUT_CMD; /* Opcode */ if (cmd->immediate) { header[0] |= 0x40; /* Immediate */ } header[1] = cmd->reason | 0x80; /* Reason */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */ *((uint16_t *) (void *) (header + 20)) = ISCSI_HTONS(cmd->cid); /* CID */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */ return 0; } int iscsi_logout_cmd_decap(uint8_t *header, iscsi_logout_cmd_args_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_LOGOUT_CMD, NO_CLEANUP, 1); cmd->immediate = (header[0] & 0x40) ? 1 : 0; /* Immediate */ cmd->reason = header[1] & 0x7f; /* Reason */ cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ cmd->cid = ISCSI_NTOHS(*((uint16_t *) (void *) (header + 20))); /* CID */ cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */ cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */ iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Reason: %u\n", cmd->reason); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CID: %hu\n", cmd->cid); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); RETURN_NOT_EQUAL("Byte 0 bit 0", (unsigned)(header[0]) >> 7U, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 1 bit 0", (unsigned)(header[1]) >> 7U, 1, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 4-7", *((uint32_t *) (void *) (header + 4)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 8-11", *((uint32_t *) (void *) (header + 8)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 12-15", *((uint32_t *) (void *) (header + 12)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 22-23", *((uint16_t *) (void *) (header + 22)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 32-35", *((uint32_t *) (void *) (header + 32)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 36-39", *((uint32_t *) (void *) (header + 36)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); return 0; } /* * Logout Response */ int iscsi_logout_rsp_encap(uint8_t *header, iscsi_logout_rsp_args_t * rsp) { iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Response: %u\n", rsp->response); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", rsp->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Time2Wait: %hu\n", rsp->Time2Wait); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Time2Retain: %hu\n", rsp->Time2Retain); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= 0x00 | ISCSI_LOGOUT_RSP; /* Opcode */ header[1] |= 0x80; /* Reserved */ header[2] = rsp->response; /* Response */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(rsp->length); /* Length */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag); /* Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN); /* StatSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN); /* ExpCmdSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN); /* MaxCmdSN */ *((uint16_t *) (void *) (header + 40)) = ISCSI_HTONS(rsp->Time2Wait); /* Time2Wait */ *((uint16_t *) (void *) (header + 42)) = ISCSI_HTONS(rsp->Time2Retain); /* Time2Retain */ return 0; } int iscsi_logout_rsp_decap(uint8_t *header, iscsi_logout_rsp_args_t * rsp) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_LOGOUT_RSP, NO_CLEANUP, 1); rsp->response = header[2]; /* Response */ rsp->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ rsp->Time2Wait = ISCSI_NTOHS(*((uint32_t *) (void *) (header + 40))); /* Time2Wait */ rsp->Time2Retain = ISCSI_NTOHS(*((uint32_t *) (void *) (header + 42))); /* Time2Retain */ RETURN_NOT_EQUAL("Byte 0 bits 0-1", (header[0] & 0x20), 0x20, NO_CLEANUP, -1); RETURN_NOT_EQUAL("Byte 1 bit 0", header[1] & 0x80, 0x80, NO_CLEANUP, -1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, -1); RETURN_NOT_EQUAL("Bytes 4-7", *((uint32_t *) (void *) (header + 4)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 8-11", *((uint32_t *) (void *) (header + 8)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 12-15", *((uint32_t *) (void *) (header + 12)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 20-23", *((uint32_t *) (void *) (header + 20)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 36-39", *((uint32_t *) (void *) (header + 36)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Response: %u\n", rsp->response); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", rsp->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Time2Wait: %hu\n", rsp->Time2Wait); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Time2Retain: %hu\n", rsp->Time2Retain); return 0; } /* * SCSI Command */ int iscsi_scsi_cmd_encap(uint8_t *header, iscsi_scsi_cmd_args_t * cmd) { iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %d\n", cmd->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Input: %d\n", cmd->input); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Output: %d\n", cmd->output); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ATTR: %d\n", cmd->attr); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TotalAHSLength: %u\n", cmd->ahs_len); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Length: %u\n", cmd->trans_len); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CDB: %#x\n", cmd->cdb[0]); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= ISCSI_SCSI_CMD; /* Opcode */ if (cmd->immediate) { header[0] |= 0x40; /* Immediate */ } if (cmd->final) { header[1] |= 0x80; /* Final */ } if (cmd->input) { header[1] |= 0x40; /* Input bit */ } if (cmd->output) { header[1] |= 0x20; /* Output bit */ } header[1] |= cmd->attr & 0x07; /* ATTR */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(cmd->length); /* DataSegmentLength */ header[4] = cmd->ahs_len; /* TotalAHSLength */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Task Tag */ *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->trans_len); /* Expected Transfer * Length */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */ memcpy(header + 32, cmd->cdb, 16); /* CDB */ return 0; } int iscsi_scsi_cmd_decap(uint8_t *header, iscsi_scsi_cmd_args_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_SCSI_CMD, NO_CLEANUP, 1); cmd->immediate = (header[0] & 0x40) ? 1 : 0; /* Immediate */ cmd->final = (header[1] & 0x80) ? 1 : 0; /* Final */ cmd->input = (header[1] & 0x40) ? 1 : 0; /* Input */ cmd->output = (header[1] & 0x20) ? 1 : 0; /* Output */ cmd->attr = header[1] & 0x07; /* ATTR */ cmd->ahs_len = header[4]; header[4] = 0x00; cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* DataSegmentLength */ cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Task Tag */ cmd->trans_len = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Expected Transfer * Length */ cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */ cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */ cmd->cdb = header + 32; /* CDB */ RETURN_NOT_EQUAL("Byte 1, Bits 3-4", header[1] & 0x18, 0, NO_CLEANUP, -1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Immediate: %d\n", cmd->immediate); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %d\n", cmd->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Input: %d\n", cmd->input); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Output: %d\n", cmd->output); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ATTR: %d\n", cmd->attr); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TotalAHSLength: %u\n", cmd->ahs_len); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Length: %u\n", cmd->trans_len); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CmdSN: %u\n", cmd->CmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "CDB: %#x\n", cmd->cdb[0]); return 0; } /* * SCSI Response */ int iscsi_scsi_rsp_encap(uint8_t *header, iscsi_scsi_rsp_t * rsp) { iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Bidi Overflow: %d\n", rsp->bidi_overflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Bidi Underflow: %d\n", rsp->bidi_underflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Overflow: %d\n", rsp->overflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Underflow: %d\n", rsp->underflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "iSCSI Response: %u\n", rsp->response); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "SCSI Status: %u\n", rsp->status); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", rsp->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpDataSN: %u\n", rsp->ExpDataSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Bidi Residual Count: %u\n", rsp->bidi_res_cnt); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Residual Count: %u\n", rsp->basic_res_cnt); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= 0x00 | ISCSI_SCSI_RSP; /* Opcode */ header[1] |= 0x80; /* Byte 1 bit 7 */ if (rsp->bidi_overflow) { header[1] |= 0x10; /* Bidi overflow */ } if (rsp->bidi_underflow) { header[1] |= 0x08; /* Bidi underflow */ } if (rsp->overflow) { header[1] |= 0x04; /* Overflow */ } if (rsp->underflow) { header[1] |= 0x02; /* Underflow */ } header[2] = rsp->response; /* iSCSI Response */ header[3] = rsp->status;/* SCSI Status */ header[4] = rsp->ahs_len; /* TotalAHSLength */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(rsp->length); /* DataSegmentLength */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag); /* Task Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN); /* StatSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN); /* ExpCmdSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN); /* MaxCmdSN */ *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(rsp->ExpDataSN); /* ExpDataSN */ *((uint32_t *) (void *) (header + 40)) = ISCSI_HTONL(rsp->bidi_res_cnt); /* Bidi Residual Count */ *((uint32_t *) (void *) (header + 44)) = ISCSI_HTONL(rsp->basic_res_cnt); /* Residual Count */ return 0; } int iscsi_scsi_rsp_decap(uint8_t *header, iscsi_scsi_rsp_t * rsp) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_SCSI_RSP, NO_CLEANUP, 1); rsp->bidi_overflow = (header[1] & 0x10) ? 1 : 0; /* Bidi overflow */ rsp->bidi_underflow = (header[1] & 0x08) ? 1 : 0; /* Bidi underflow */ rsp->overflow = (header[1] & 0x04) ? 1 : 0; /* Overflow */ rsp->underflow = (header[1] & 0x02) ? 1 : 0; /* Underflow */ rsp->response = header[2]; /* iSCSI Response */ rsp->status = header[3];/* SCSI Status */ rsp->ahs_len = header[4]; /* TotalAHSLength */ rsp->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* DataSegmentLength */ rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Task Tag */ rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ rsp->ExpDataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* ExpDataSN */ rsp->bidi_res_cnt = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 40))); /* Bidi Residual Count */ rsp->basic_res_cnt = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 44))); /* Residual Count */ RETURN_NOT_EQUAL("Byte 0 bits 0-1", header[0] & 0x00, 0x00, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 1 bit 0", header[1] & 0x80, 0x80, NO_CLEANUP, 1); RETURN_NOT_EQUAL("bidi_res_cnt", rsp->bidi_res_cnt, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("bidi_overflow", rsp->bidi_overflow, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("bidi_underflow", rsp->bidi_underflow, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("overflow", rsp->overflow, 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Bidi Overflow: %d\n", rsp->bidi_overflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Bidi Underflow: %d\n", rsp->bidi_underflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Overflow: %d\n", rsp->overflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Underflow: %d\n", rsp->underflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "iSCSI Response: %u\n", rsp->response); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "SCSI Status: %u\n", rsp->status); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", rsp->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", rsp->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Residual Count: %u\n", rsp->basic_res_cnt); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", rsp->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", rsp->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", rsp->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpDataSN: %u\n", rsp->ExpDataSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Bidi Residual Count: %u\n", rsp->bidi_res_cnt); return 0; } /* * Ready To Transfer */ int iscsi_r2t_encap(uint8_t *header, iscsi_r2t_t * cmd) { uint32_t length; iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TotalAHSLength: %u\n", cmd->AHSlength); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", cmd->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", cmd->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", cmd->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "R2TSN: %u\n", cmd->R2TSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Offset: %u\n", cmd->offset); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= 0x00 | ISCSI_R2T; /* Opcode */ header[1] |= 0x80; length = (cmd->AHSlength & 0x00ffffff); /* AHSLength */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* AHSLength */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */ *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Transfer Tag */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->StatSN); /* StatSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpCmdSN); /* ExpCmdSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->MaxCmdSN); /* MaxCmdSN */ *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->R2TSN); /* R2TSN */ *((uint32_t *) (void *) (header + 40)) = ISCSI_HTONL(cmd->offset); /* Buffer Offset */ *((uint32_t *) (void *) (header + 44)) = ISCSI_HTONL(cmd->length); /* Transfer Length */ return 0; } int iscsi_r2t_decap(uint8_t *header, iscsi_r2t_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_R2T, NO_CLEANUP, 1); cmd->AHSlength = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* TotalAHSLength */ cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Transfer Tag */ cmd->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ cmd->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ cmd->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ cmd->R2TSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* R2TSN */ cmd->offset = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 40))); /* Offset */ cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 44))); /* Transfer Length */ RETURN_NOT_EQUAL("Byte 1, Bits 1-7", header[1] & 0x7f, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 4-7", *((uint32_t *) (void *) (header + 4)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 8-11", *((uint32_t *) (void *) (header + 8)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 12-15", *((uint32_t *) (void *) (header + 12)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "AHSLength: %u\n", cmd->AHSlength); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", cmd->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", cmd->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", cmd->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "R2TSN: %u\n", cmd->R2TSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Offset: %u\n", cmd->offset); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); return 0; } /* * SCSI Write Data */ int iscsi_write_data_encap(uint8_t *header, iscsi_write_data_t * cmd) { iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %u\n", cmd->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSN: %u\n", cmd->DataSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Buffer Offset: %u\n", cmd->offset); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] = 0x00 | ISCSI_WRITE_DATA; /* Opcode */ if (cmd->final) { header[1] |= 0x80; /* Final */ } *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(cmd->length); /* Length */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */ *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Transfer Tag */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */ *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->DataSN); /* DataSN */ *((uint32_t *) (void *) (header + 40)) = ISCSI_HTONL(cmd->offset); /* Buffer Offset */ return 0; } int iscsi_write_data_decap(uint8_t *header, iscsi_write_data_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_WRITE_DATA, NO_CLEANUP, 1); cmd->final = (header[1] & 0x80) ? 1 : 0; /* Final */ cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */ cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Transfer Tag */ cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */ cmd->DataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* DataSN */ cmd->offset = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 40))); /* Buffer Offset */ RETURN_NOT_EQUAL("Byte 1, Bits 1-7", header[1] & 0x7f, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 4", header[4], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 24-27", *((uint32_t *) (void *) (header + 24)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 32-35", *((uint32_t *) (void *) (header + 32)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %u\n", cmd->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpStatSN: %u\n", cmd->ExpStatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSN: %u\n", cmd->DataSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Buffer Offset: %u\n", cmd->offset); return 0; } /* * SCSI Read Data */ int iscsi_read_data_encap(uint8_t *header, iscsi_read_data_t * cmd) { iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %d\n", cmd->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Acknowledge: %d\n", cmd->ack); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Overflow: %d\n", cmd->overflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Underflow: %d\n", cmd->underflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "S_bit: %d\n", cmd->S_bit); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Status: %u\n", cmd->status); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", cmd->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->task_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Transfer Tag: %#x\n", cmd->transfer_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", cmd->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", cmd->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", cmd->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSN: %u\n", cmd->DataSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Buffer Offset %u\n", cmd->offset); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Residual Count: %u\n", cmd->res_count); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] = 0x00 | ISCSI_READ_DATA; /* Opcode */ if (cmd->final) { header[1] |= 0x80; /* Final */ } if (cmd->ack) { header[1] |= 0x40; /* ACK */ } if (cmd->overflow) { header[1] |= 0x04; /* Overflow */ } if (cmd->underflow) { header[1] |= 0x02; /* Underflow */ } if (cmd->S_bit) { header[1] |= 0x01; /* S Bit */ } if (cmd->S_bit) { header[3] = cmd->status; /* Status */ } *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(cmd->length); /* Length */ *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */ *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->task_tag); /* Task Tag */ *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Transfer Tag */ if (cmd->S_bit) { *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->StatSN); /* StatSN */ } *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpCmdSN); /* ExpCmdSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->MaxCmdSN); /* MaxCmdSN */ *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->DataSN); /* DataSN */ *((uint32_t *) (void *) (header + 40)) = ISCSI_HTONL(cmd->offset); /* Buffer Offset */ if (cmd->S_bit) { *((uint32_t *) (void *) (header + 44)) = ISCSI_HTONL(cmd->res_count); /* Residual Count */ } return 0; } int iscsi_read_data_decap(uint8_t *header, iscsi_read_data_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_READ_DATA, NO_CLEANUP, 1); cmd->final = (header[1] & 0x80) ? 1 : 0; /* Final */ cmd->ack = (header[1] & 0x40) ? 1 : 0; /* Acknowledge */ cmd->overflow = (header[1] & 0x04) ? 1 : 0; /* Overflow */ cmd->underflow = (header[1] & 0x02) ? 1 : 0; /* Underflow */ cmd->S_bit = (header[1] & 0x01) ? 1 : 0; /* S Bit */ cmd->status = header[3];/* Status */ cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ cmd->task_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Task Tag */ cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Transfer Tag */ cmd->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ cmd->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ cmd->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ cmd->DataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* DataSN */ cmd->offset = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 40))); /* Buffer Offset */ cmd->res_count = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 44))); /* Residual Count */ RETURN_NOT_EQUAL("Byte 0, Bits 0-1", header[0] & 0xc0, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 1, Bits 2-4", header[1] & 0x38, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 2", header[2], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 4", header[4], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 8-11", *((uint32_t *) (void *) (header + 8)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 12-15", *((uint32_t *) (void *) (header + 12)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Final: %d\n", cmd->final); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Acknowledge: %d\n", cmd->ack); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Overflow: %d\n", cmd->overflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Underflow: %d\n", cmd->underflow); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "S_bit: %d\n", cmd->S_bit); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Status: %u\n", cmd->status); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Task Tag: %#x\n", cmd->task_tag); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Residual Count: %u\n", cmd->res_count); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", cmd->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", cmd->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", cmd->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSN: %u\n", cmd->DataSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Buffer Offset %u\n", cmd->offset); return 0; } /* * Reject */ int iscsi_reject_encap(uint8_t *header, iscsi_reject_t * cmd) { iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Reason: %u\n", cmd->reason); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", cmd->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", cmd->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", cmd->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSN: %u\n", cmd->DataSN); (void) memset(header, 0x0, ISCSI_HEADER_LEN); header[0] |= 0x00 | ISCSI_REJECT; /* Opcode */ header[1] |= 0x80; header[2] = cmd->reason;/* Reason */ *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(cmd->length); /* Length */ *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->StatSN); /* StatSN */ *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpCmdSN); /* ExpCmdSN */ *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->MaxCmdSN); /* MaxCmdSN */ *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->DataSN); /* DataSN */ return 0; } int iscsi_reject_decap(uint8_t *header, iscsi_reject_t * cmd) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_REJECT, NO_CLEANUP, 1); cmd->reason = header[2];/* Reason */ cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ cmd->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ cmd->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ cmd->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ cmd->DataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* DataSN */ RETURN_NOT_EQUAL("Byte 0, Bits 0-1", header[0] & 0xc0, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 1, Bits 1-7", header[1] & 0x7f, 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 3", header[3], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Byte 4", header[4], 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 8-11", *((uint32_t *) (void *) (header + 8)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 12-15", *((uint32_t *) (void *) (header + 12)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 20-23", *((uint32_t *) (void *) (header + 20)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 40-43", *((uint32_t *) (void *) (header + 40)), 0, NO_CLEANUP, 1); RETURN_NOT_EQUAL("Bytes 44-47", *((uint32_t *) (void *) (header + 44)), 0, NO_CLEANUP, 1); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Reason: %u\n", cmd->reason); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "Length: %u\n", cmd->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", cmd->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", cmd->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", cmd->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSN: %u\n", cmd->DataSN); return 0; } int iscsi_amsg_decap(uint8_t *header, iscsi_async_msg_t * msg) { RETURN_NOT_EQUAL("Opcode", ISCSI_OPCODE(header), ISCSI_ASYNC, NO_CLEANUP, 1); msg->AHSlength = header[4]; /* TotalAHSLength */ msg->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */ msg->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */ msg->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */ msg->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */ msg->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */ msg->AsyncEvent = header[36]; /* Async Event */ msg->AsyncVCode = header[37]; /* Async Vendor Code */ iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "TotalAHSLength: %u\n", msg->AHSlength); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "DataSegmentLength: %u\n", msg->length); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "LUN: %" PRIu64 "\n", msg->lun); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "StatSN: %u\n", msg->StatSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "ExpCmdSN: %u\n", msg->ExpCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "MaxCmdSN: %u\n", msg->MaxCmdSN); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "AsyncEvent: %u\n", msg->AsyncEvent); iscsi_trace(TRACE_ISCSI_ARGS, __FILE__, __LINE__, "AsyncVCode: %u\n", msg->AsyncVCode); return 0; }