?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Sync usage with man page.
[netbsd-mini2440.git] / external / bsd / iscsi / dist / src / lib / protocol.c
blob3822af14a4049d226c6e315e5848ab12e2c6d696
1 /*
2 * IMPORTANT: READ BEFORE DOWNLOADING, COPYING, INSTALLING OR USING.
3 * By downloading, copying, installing or using the software you agree
4 * to this license. If you do not agree to this license, do not
5 * download, install, copy or use the software.
6 *
7 * Intel License Agreement
8 *
9 * Copyright (c) 2000, Intel Corporation
10 * All rights reserved.
11 *
12 * Redistribution and use in source and binary forms, with or without
13 * modification, are permitted provided that the following conditions
14 * are met:
15 *
16 * -Redistributions of source code must retain the above copyright
17 * notice, this list of conditions and the following disclaimer.
18 *
19 * -Redistributions in binary form must reproduce the above copyright
20 * notice, this list of conditions and the following disclaimer in the
21 * documentation and/or other materials provided with the
22 * distribution.
23 *
24 * -The name of Intel Corporation may not be used to endorse or
25 * promote products derived from this software without specific prior
26 * written permission.
27 *
28 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
29 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
30 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
31 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL INTEL
32 * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
33 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
34 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
35 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
36 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
37 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
38 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
39 * SUCH DAMAGE.
40 */
41 #include "config.h"
42
43 #ifdef HAVE_STDLIB_H
44 #include <stdlib.h>
45 #endif
46
47 #ifdef HAVE_NETINET_IN_H
48 #include <netinet/in.h>
49 #endif
50
51 #ifdef HAVE_SYS_UIO_H
52 #include <sys/uio.h>
53 #endif
54
55 #ifdef HAVE_STRING_H
56 #include <string.h>
57 #endif
58
59 #ifdef HAVE_INTTYPES_H
60 #include <inttypes.h>
61 #endif
62
63 #include "iscsiprotocol.h"
64 #include "iscsiutil.h"
65
66
67 /*
68 * Task Command
69 */
70
71 int
72 iscsi_task_cmd_encap(uint8_t *header, iscsi_task_cmd_t * cmd)
73 {
74 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
75 iscsi_trace(TRACE_ISCSI_ARGS, "Function: %u\n", cmd->function);
76 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
77 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
78 iscsi_trace(TRACE_ISCSI_ARGS, "Ref Tag: %#x\n", cmd->ref_tag);
79 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
80 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
81 iscsi_trace(TRACE_ISCSI_ARGS, "RefCmdSN: %u\n", cmd->RefCmdSN);
82 iscsi_trace(TRACE_ISCSI_ARGS, "ExpDataSN: %u\n", cmd->ExpDataSN);
83
84 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
85
86 header[0] |= ISCSI_TASK_CMD; /* Opcode */
87 if (cmd->immediate) {
88 header[0] |= 0x40; /* Immediate bit */
89 }
90 header[1] = cmd->function & 0x80; /* Function */
91 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */
92 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */
93 *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->ref_tag); /* Reference Tag */
94 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */
95 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */
96 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->RefCmdSN); /* RefCmdSN */
97 *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->ExpDataSN); /* ExpDataSN */
98
99 return 0;
100 }
101
102 int
103 iscsi_task_cmd_decap(uint8_t *header, iscsi_task_cmd_t * cmd)
104 {
105 const char *errmsg;
106 uint8_t zeros[16];
107
108 if (ISCSI_OPCODE(header) != ISCSI_TASK_CMD) {
109 iscsi_err(__FILE__, __LINE__, "Opcode");
110 return 1;
111 }
112 cmd->immediate = ((header[0] & 0x40) == 0x40);
113 cmd->function = header[1] & 0x80;
114 cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8)));
115 cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16)));
116 cmd->ref_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20)));
117 cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24)));
118 cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28)));
119 cmd->RefCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32)));
120 cmd->ExpDataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36)));
121
122 errmsg = NULL;
123 (void) memset(zeros, 0x0, sizeof(zeros));
124 if ((header[1] & 0x80) != 0x80) {
125 errmsg = "Byte 1 bit 0";
126 } else if (header[2] != 0) {
127 errmsg = "Byte 2";
128 } else if (header[3] != 0) {
129 errmsg = "Byte 3";
130 } else if (memcmp(header + 4, zeros, 4) != 0) {
131 errmsg = "Bytes 4-7";
132 } else if (memcmp(header + 40, zeros, 8) != 0) {
133 errmsg = "Bytes 40-47";
134 }
135 if (errmsg) {
136 iscsi_err(__FILE__, __LINE__, errmsg);
137 NO_CLEANUP;
138 return 1;
139 }
140
141 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
142 iscsi_trace(TRACE_ISCSI_ARGS, "Function: %u\n", cmd->function);
143 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
144 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
145 iscsi_trace(TRACE_ISCSI_ARGS, "Ref Tag: %#x\n", cmd->ref_tag);
146 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
147 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
148 iscsi_trace(TRACE_ISCSI_ARGS, "RefCmdSN: %u\n", cmd->RefCmdSN);
149 iscsi_trace(TRACE_ISCSI_ARGS, "ExpDataSN: %u\n", cmd->ExpDataSN);
150 return 0;
151 }
152
153 /*
154 * Task Response
155 */
156
157 int
158 iscsi_task_rsp_encap(uint8_t *header, iscsi_task_rsp_t * rsp)
159 {
160 uint32_t length;
161
162 iscsi_trace(TRACE_ISCSI_ARGS, "Response: %u\n", rsp->response);
163 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", rsp->length);
164 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", rsp->tag);
165 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
166 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
167 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
168
169 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
170
171 header[0] |= ISCSI_TASK_RSP; /* Opcode */
172 header[1] |= 0x80; /* Byte 1 bit 0 */
173 header[2] = rsp->response; /* Response */
174 length = (rsp->length & 0x00ffffff); /* Length */
175 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length);
176 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag);
177 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN);
178 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN);
179 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN);
180 return 0;
181 }
182
183 int
184 iscsi_task_rsp_decap(uint8_t *header, iscsi_task_rsp_t * rsp)
185 {
186 const char *errmsg;
187 uint8_t zeros[16];
188
189 if (ISCSI_OPCODE(header) != ISCSI_TASK_RSP) {
190 iscsi_err(__FILE__, __LINE__, "Opcode");
191 return 1;
192 }
193 rsp->response = header[2];
194 rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16)));
195 rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24)));
196 rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28)));
197 rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32)));
198 errmsg = NULL;
199 (void) memset(zeros, 0x0, sizeof(zeros));
200 if ((header[0] & 0x00) != 0x00) {
201 errmsg = "Byte 0 bits 0-1";
202 } else if ((header[1] & 0x80) != 0x80) {
203 errmsg = "Byte 1 bit 0";
204 } else if (header[3] != 0) {
205 errmsg = "Byte 3";
206 } else if (memcmp(header + 4, zeros, 12) != 0) {
207 errmsg = "Bytes 4-15";
208 } else if (memcmp(header + 20, zeros, 4) != 0) {
209 errmsg = "Bytes 20-23";
210 } else if (memcmp(header + 36, zeros, 12) != 0) {
211 errmsg = "Bytes 36-47";
212 }
213 if (errmsg) {
214 iscsi_err(__FILE__, __LINE__, errmsg);
215 NO_CLEANUP;
216 return 1;
217 }
218 iscsi_trace(TRACE_ISCSI_ARGS, "Response: %u\n", rsp->response);
219 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", rsp->tag);
220 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
221 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
222 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
223 return 0;
224 }
225
226 /*
227 * NOP-Out
228 */
229
230 int
231 iscsi_nop_out_encap(uint8_t *header, iscsi_nop_out_args_t * cmd)
232 {
233
234 uint32_t length;
235
236 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
237 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
238 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
239 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
240 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
241 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
242 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
243
244 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
245
246 header[0] = ISCSI_NOP_OUT; /* Opcode */
247 if (cmd->immediate) {
248 header[0] |= 0x40; /* Immediate bit */
249 }
250 header[1] |= 0x80; /* Byte 1 bit 0 and Reserved */
251 length = (cmd->length & 0x00ffffff); /* Length */
252 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */
253 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */
254 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */
255 *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Target Transfer Tag */
256 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */
257 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */
258
259 return 0;
260 }
261
262 int
263 iscsi_nop_out_decap(uint8_t *header, iscsi_nop_out_args_t * cmd)
264 {
265 const char *errmsg;
266 uint8_t zeros[16];
267
268 if (ISCSI_OPCODE(header) != ISCSI_NOP_OUT) {
269 iscsi_err(__FILE__, __LINE__, "Opcode");
270 return 1;
271 }
272 cmd->immediate = ((header[0] & 0x40) == 0x40); /* Immediate bit */
273 cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
274 cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */
275 cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */
276 cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Target Tranfer Tag */
277 cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */
278 cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */
279
280 errmsg = NULL;
281 (void) memset(zeros, 0x0, sizeof(zeros));
282 if (header[1] != 0x80) {
283 errmsg = "Byte 1";
284 } else if (memcmp(header + 2, zeros, 3) != 0) {
285 errmsg = "Bytes 2-4";
286 } else if (memcmp(header + 32, zeros, 16) != 0) {
287 errmsg = "Bytes 32-47";
288 }
289 if (errmsg) {
290 iscsi_err(__FILE__, __LINE__, errmsg);
291 NO_CLEANUP;
292 return 1;
293 }
294 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
295 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
296 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
297 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
298 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
299 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
300 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
301 return 0;
302 }
303
304 /*
305 * NOP-In
306 */
307
308 int
309 iscsi_nop_in_encap(uint8_t *header, iscsi_nop_in_args_t * cmd)
310 {
311 uint32_t length;
312
313 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
314 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
315 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
316 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
317 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", cmd->StatSN);
318 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", cmd->ExpCmdSN);
319 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", cmd->MaxCmdSN);
320
321 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
322
323 header[0] = 0x00 | ISCSI_NOP_IN; /* Opcode */
324 header[1] |= 0x80; /* Reserved */
325 length = (cmd->length & 0x00ffffff); /* Length */
326 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */
327 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */
328 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */
329 *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Target Transfer Tag */
330 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->StatSN); /* StatSN */
331 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpCmdSN); /* ExpCmdSN */
332 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->MaxCmdSN); /* MaxCmdSN */
333
334 return 0;
335 }
336
337 int
338 iscsi_nop_in_decap(uint8_t *header, iscsi_nop_in_args_t * cmd)
339 {
340 const char *errmsg;
341 uint8_t zeros[16];
342
343 if (ISCSI_OPCODE(header) != ISCSI_NOP_IN) {
344 iscsi_err(__FILE__, __LINE__, "Opcode");
345 return 1;
346 }
347 cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
348 cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */
349 cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */
350 cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Target Transfer Tag */
351 cmd->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */
352 cmd->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */
353 cmd->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */
354
355 errmsg = NULL;
356 (void) memset(zeros, 0x0, sizeof(zeros));
357 if ((header[0] & 0xc0) != 0x00) {
358 errmsg = "Byte 0, bits 0-1";
359 } else if (header[1] != 0x80) {
360 errmsg = "Byte 1";
361 } else if (memcmp(header + 2, zeros, 3) != 0) {
362 errmsg = "Bytes 2-4";
363 } else if (memcmp(header + 36, zeros, 12) != 0) {
364 errmsg = "Bytes 36-47";
365 }
366 if (errmsg) {
367 iscsi_err(__FILE__, __LINE__, errmsg);
368 NO_CLEANUP;
369 return 1;
370 }
371 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
372 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
373 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
374 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
375 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", cmd->StatSN);
376 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", cmd->ExpCmdSN);
377 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", cmd->MaxCmdSN);
378 return 0;
379 }
380
381 /*
382 * Text Command
383 */
384
385 int
386 iscsi_text_cmd_encap(uint8_t *header, iscsi_text_cmd_args_t * cmd)
387 {
388 uint32_t length;
389
390 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
391 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %d\n", cmd->final);
392 iscsi_trace(TRACE_ISCSI_ARGS, "Continue: %d\n", cmd->cont);
393 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
394 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
395 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
396 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
397 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
398 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
399
400 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
401
402 header[0] |= ISCSI_TEXT_CMD; /* Opcode */
403 if (cmd->immediate) {
404 header[0] |= 0x40; /* Immediate bit */
405 }
406 if (cmd->final) {
407 header[1] |= 0x80; /* Final bit */
408 }
409 if (cmd->cont) {
410 header[1] |= 0x40; /* Continue bit */
411 }
412 length = (cmd->length & 0x00ffffff); /* Length */
413 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */
414 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */
415 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */
416 *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Transfer Tag */
417 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */
418 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */
419
420 return 0;
421 }
422
423 int
424 iscsi_text_cmd_decap(uint8_t *header, iscsi_text_cmd_args_t * cmd)
425 {
426 const char *errmsg;
427 uint8_t zeros[16];
428
429 if (ISCSI_OPCODE(header) != ISCSI_TEXT_CMD) {
430 iscsi_err(__FILE__, __LINE__, "Opcode");
431 return 1;
432 }
433 cmd->immediate = ((header[0] & 0x40) == 0x40); /* Immediate bit */
434 cmd->final = ((header[1] & 0x80) == 0x80); /* Final bit */
435 cmd->cont = ((header[1] & 0x40) == 0x40); /* Continue bit */
436 cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
437 cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */
438 cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */
439 cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Transfer Tag */
440 cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */
441 cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */
442
443 errmsg = NULL;
444 (void) memset(zeros, 0x0, sizeof(zeros));
445 if ((header[1] & 0x00) != 0x00) {
446 errmsg = "Byte 1, bits 2-7";
447 } else if (memcmp(header + 2, zeros, 3) != 0) {
448 errmsg = "Bytes 2-4";
449 } else if (memcmp(header + 8, zeros, 8) != 0) {
450 errmsg = "Bytes 8-15";
451 } else if (memcmp(header + 32, zeros, 16) != 0) {
452 errmsg = "Bytes 32-47";
453 }
454 if (errmsg) {
455 iscsi_err(__FILE__, __LINE__, errmsg);
456 NO_CLEANUP;
457 return 1;
458 }
459 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
460 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %d\n", cmd->final);
461 iscsi_trace(TRACE_ISCSI_ARGS, "Continue: %d\n", cmd->cont);
462 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
463 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
464 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
465 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
466 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
467 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
468
469 return 0;
470 }
471
472 /*
473 * Text Response
474 */
475
476 int
477 iscsi_text_rsp_encap(uint8_t *header, iscsi_text_rsp_args_t * rsp)
478 {
479 uint32_t length;
480
481 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %d\n", rsp->final);
482 iscsi_trace(TRACE_ISCSI_ARGS, "Continue: %d\n", rsp->cont);
483 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", rsp->length);
484 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", rsp->lun);
485 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", rsp->tag);
486 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", rsp->transfer_tag);
487 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
488 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
489 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
490
491 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
492 header[0] |= 0x00 | ISCSI_TEXT_RSP; /* Opcode */
493 if (rsp->final) {
494 header[1] |= 0x80; /* Final bit */
495 }
496 if (rsp->cont) {
497 header[1] |= 0x40; /* Continue */
498 }
499 length = (rsp->length & 0x00ffffff); /* Length */
500 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */
501 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(rsp->lun); /* LUN */
502 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag); /* Tag */
503 *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(rsp->transfer_tag); /* Transfer Tag */
504 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN); /* StatSN */
505 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN); /* ExpCmdSN */
506 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN); /* MaxCmdSN */
507
508 return 0;
509 }
510
511 int
512 iscsi_text_rsp_decap(uint8_t *header, iscsi_text_rsp_args_t * rsp)
513 {
514 const char *errmsg;
515 uint8_t zeros[16];
516
517 if (ISCSI_OPCODE(header) != ISCSI_TEXT_RSP) {
518 iscsi_err(__FILE__, __LINE__, "Opcode");
519 return 1;
520 }
521 rsp->final = ((header[1] & 0x80) == 0x80); /* Final bit */
522 rsp->cont = ((header[1] & 0x40) == 0x40); /* Continue bit */
523 rsp->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
524 rsp->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */
525 rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */
526 rsp->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Transfer Tag */
527 rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */
528 rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */
529 rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */
530
531 errmsg = NULL;
532 (void) memset(zeros, 0x0, sizeof(zeros));
533 if ((header[1] & 0x3f) != 0x00) {
534 errmsg = "Byte 1, bits 2-7";
535 } else if (memcmp(header + 2, zeros, 3) != 0) {
536 errmsg = "Bytes 2-4";
537 } else if (memcmp(header + 8, zeros, 8) != 0) {
538 errmsg = "Bytes 8-15";
539 } else if (memcmp(header + 36, zeros, 12) != 0) {
540 errmsg = "Bytes 36-47";
541 }
542 if (errmsg) {
543 iscsi_err(__FILE__, __LINE__, errmsg);
544 NO_CLEANUP;
545 return 1;
546 }
547 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %d\n", rsp->final);
548 iscsi_trace(TRACE_ISCSI_ARGS, "Continue: %d\n", rsp->cont);
549 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", rsp->length);
550 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", rsp->lun);
551 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", rsp->tag);
552 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", rsp->transfer_tag);
553 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
554 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
555 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
556
557 return 0;
558 }
559
560 /*
561 * Login Command
562 */
563
564 int
565 iscsi_login_cmd_encap(uint8_t *header, iscsi_login_cmd_args_t * cmd)
566 {
567 uint32_t length;
568
569 iscsi_trace(TRACE_ISCSI_ARGS, "Transit: %d\n", cmd->transit);
570 iscsi_trace(TRACE_ISCSI_ARGS, "Continue: %d\n", cmd->cont);
571 iscsi_trace(TRACE_ISCSI_ARGS, "CSG: %u\n", cmd->csg);
572 iscsi_trace(TRACE_ISCSI_ARGS, "NSG: %u\n", cmd->nsg);
573 iscsi_trace(TRACE_ISCSI_ARGS, "Version_min: %u\n", cmd->version_min);
574 iscsi_trace(TRACE_ISCSI_ARGS, "Version_max: %u\n", cmd->version_max);
575 iscsi_trace(TRACE_ISCSI_ARGS, "TotalAHSLength: %u\n", cmd->AHSlength);
576 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", cmd->length);
577 iscsi_trace(TRACE_ISCSI_ARGS, "ISID: %" PRIu64 "\n", cmd->isid);
578 iscsi_trace(TRACE_ISCSI_ARGS, "TSIH: %hu\n", cmd->tsih);
579 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->tag);
580 iscsi_trace(TRACE_ISCSI_ARGS, "CID: %hu\n", cmd->cid);
581 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
582 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
583
584 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
585
586 header[0] |= 0x40 | ISCSI_LOGIN_CMD; /* Opcode */
587 if (cmd->transit) {
588 header[1] |= 0x80; /* Transit */
589 }
590 if (cmd->cont) {
591 header[1] |= 0x40; /* Continue */
592 }
593 header[1] |= ((cmd->csg) << 2) & 0x0c; /* CSG */
594 header[1] |= (cmd->nsg) & 0x03; /* NSG */
595 header[2] = cmd->version_max; /* Version-Max */
596 header[3] = cmd->version_min; /* Version-Min */
597 header[4] = cmd->AHSlength; /* TotalAHSLength */
598 length = (cmd->length & 0x00ffffff); /* Length */
599 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* Length */
600 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->isid); /* ISID */
601 *((uint16_t *) (void *) (header + 14)) = ISCSI_HTONS(cmd->tsih); /* TSIH */
602 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Task Tag */
603 *((uint16_t *) (void *) (header + 20)) = ISCSI_HTONS(cmd->cid); /* CID */
604 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */
605 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */
606
607 return 0;
608 }
609
610 int
611 iscsi_login_cmd_decap(uint8_t *header, iscsi_login_cmd_args_t * cmd)
612 {
613 const char *errmsg;
614 uint8_t zeros[16];
615
616 if (ISCSI_OPCODE(header) != ISCSI_LOGIN_CMD) {
617 iscsi_err(__FILE__, __LINE__, "Opcode");
618 return 1;
619 }
620 cmd->transit = (header[1] & 0x80) ? 1 : 0; /* Transit */
621 cmd->cont = (header[1] & 0x40) ? 1 : 0; /* Continue */
622 cmd->csg = (header[1] & 0x0cU) >> 2; /* CSG */
623 cmd->nsg = header[1] & 0x03; /* NSG */
624 cmd->version_max = header[2]; /* Version-Max */
625 cmd->version_min = header[3]; /* Version-Min */
626 cmd->AHSlength = header[4]; /* TotalAHSLength */
627 cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
628 cmd->isid = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* ISID */
629 cmd->tsih = ISCSI_NTOHS(*((uint16_t *) (void *) (header + 14))); /* TSIH */
630 cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Task Tag */
631 cmd->cid = ISCSI_NTOHS(*((uint16_t *) (void *) (header + 20))); /* CID */
632 cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */
633 cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */
634
635 iscsi_trace(TRACE_ISCSI_ARGS, "Transit: %d\n", cmd->transit);
636 iscsi_trace(TRACE_ISCSI_ARGS, "Continue: %d\n", cmd->cont);
637 iscsi_trace(TRACE_ISCSI_ARGS, "CSG: %u\n", cmd->csg);
638 iscsi_trace(TRACE_ISCSI_ARGS, "NSG: %u\n", cmd->nsg);
639 iscsi_trace(TRACE_ISCSI_ARGS, "Version_min: %u\n", cmd->version_min);
640 iscsi_trace(TRACE_ISCSI_ARGS, "Version_max: %u\n", cmd->version_max);
641 iscsi_trace(TRACE_ISCSI_ARGS, "TotalAHSLength: %u\n", cmd->AHSlength);
642 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", cmd->length);
643 iscsi_trace(TRACE_ISCSI_ARGS, "ISID: %" PRIu64 "\n", cmd->isid);
644 iscsi_trace(TRACE_ISCSI_ARGS, "TSIH: %hu\n", cmd->tsih);
645 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->tag);
646 iscsi_trace(TRACE_ISCSI_ARGS, "CID: %hu\n", cmd->cid);
647 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
648 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
649
650 errmsg = NULL;
651 (void) memset(zeros, 0x0, sizeof(zeros));
652 if (((header[1] & 0x30U) >> 4U) != 0x0) {
653 errmsg = "Byte 1, bits 2-3";
654 } else if (memcmp(header + 22, zeros, 2) != 0) {
655 errmsg = "Bytes 22-23";
656 } else if (memcmp(header + 32, zeros, 16) != 0) {
657 errmsg = "Bytes 32-47";
658 }
659 if (errmsg) {
660 iscsi_err(__FILE__, __LINE__, errmsg);
661 NO_CLEANUP;
662 return 1;
663 }
664 if (cmd->transit) {
665 if (cmd->nsg <= cmd->csg) {
666 return -1;
667 }
668 if ((cmd->nsg != 0) && (cmd->nsg != 1) && (cmd->nsg != 3)) {
669 return -1;
670 }
671 }
672 return 0;
673 }
674
675 /*
676 * Login Response
677 */
678
679 int
680 iscsi_login_rsp_encap(uint8_t *header, iscsi_login_rsp_args_t * rsp)
681 {
682
683 iscsi_trace(TRACE_ISCSI_ARGS, "Transit: %d\n", rsp->transit);
684 iscsi_trace(TRACE_ISCSI_ARGS, "Continue: %d\n", rsp->cont);
685 iscsi_trace(TRACE_ISCSI_ARGS, "CSG: %u\n", rsp->csg);
686 iscsi_trace(TRACE_ISCSI_ARGS, "NSG: %u\n", rsp->nsg);
687 iscsi_trace(TRACE_ISCSI_ARGS, "Version_max: %u\n", rsp->version_max);
688 iscsi_trace(TRACE_ISCSI_ARGS, "Version_active: %u\n", rsp->version_active);
689 iscsi_trace(TRACE_ISCSI_ARGS, "TotalAHSLength: %u\n", rsp->AHSlength);
690 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", rsp->length);
691 iscsi_trace(TRACE_ISCSI_ARGS, "ISID: %" PRIu64 "\n", rsp->isid);
692 iscsi_trace(TRACE_ISCSI_ARGS, "TSIH: %u\n", rsp->tsih);
693 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", rsp->tag);
694 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
695 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
696 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
697 iscsi_trace(TRACE_ISCSI_ARGS, "Status-Class: %u\n", rsp->status_class);
698 iscsi_trace(TRACE_ISCSI_ARGS, "Status-Detail: %u\n", rsp->status_detail);
699
700 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
701
702 header[0] |= 0x00 | ISCSI_LOGIN_RSP; /* Opcode */
703 if (rsp->transit) {
704 header[1] |= 0x80; /* Transit */
705 }
706 if (rsp->cont) {
707 header[1] |= 0x40; /* Continue */
708 }
709 header[1] |= ((rsp->csg) << 2) & 0x0c; /* CSG */
710 if (rsp->transit) {
711 header[1] |= (rsp->nsg) & 0x03; /* NSG */
712 }
713 header[2] = rsp->version_max; /* Version-max */
714 header[3] = rsp->version_active; /* Version-active */
715 header[4] = rsp->AHSlength; /* TotalAHSLength */
716 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(rsp->length); /* Length */
717 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(rsp->isid); /* ISID */
718 *((uint16_t *) (void *) (header + 14)) = ISCSI_HTONS(rsp->tsih); /* TSIH */
719 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag); /* Tag */
720 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN); /* StatRn */
721 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN); /* ExpCmdSN */
722 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN); /* MaxCmdSN */
723 header[36] = rsp->status_class; /* Status-Class */
724 header[37] = rsp->status_detail; /* Status-Detail */
725
726 return 0;
727 }
728
729 int
730 iscsi_login_rsp_decap(uint8_t *header, iscsi_login_rsp_args_t * rsp)
731 {
732 const char *errmsg;
733 uint8_t zeros[8];
734
735 if (ISCSI_OPCODE(header) != ISCSI_LOGIN_RSP) {
736 iscsi_err(__FILE__, __LINE__, "Opcode");
737 return 1;
738 }
739 rsp->transit = (header[1] & 0x80U) >> 7; /* Transit */
740 rsp->cont = (header[1] & 0x40U) >> 6; /* Continue */
741 rsp->csg = (header[1] & 0x0cU) >> 2; /* CSG */
742 rsp->nsg = header[1] & 0x03; /* NSG */
743 rsp->version_max = header[2]; /* Version-max */
744 rsp->version_active = header[3]; /* Version-active */
745 rsp->AHSlength = header[4]; /* TotalAHSLength */
746 rsp->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
747 rsp->isid = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* ISID */
748 rsp->tsih = ISCSI_NTOHS(*((uint16_t *) (void *) (header + 14))); /* TSIH */
749
750 rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */
751 rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */
752 rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */
753 rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */
754 rsp->status_class = header[36]; /* Status-Class */
755 rsp->status_detail = header[37]; /* Status-Detail */
756
757 iscsi_trace(TRACE_ISCSI_ARGS, "Transit: %d\n", rsp->transit);
758 iscsi_trace(TRACE_ISCSI_ARGS, "Continue: %d\n", rsp->cont);
759 iscsi_trace(TRACE_ISCSI_ARGS, "CSG: %u\n", rsp->csg);
760 iscsi_trace(TRACE_ISCSI_ARGS, "NSG: %u\n", rsp->nsg);
761
762 iscsi_trace(TRACE_ISCSI_ARGS, "Version_max: %u\n", rsp->version_max);
763 iscsi_trace(TRACE_ISCSI_ARGS, "Version_active: %u\n", rsp->version_active);
764 iscsi_trace(TRACE_ISCSI_ARGS, "TotalAHSLength: %u\n", rsp->AHSlength);
765 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", rsp->length);
766 iscsi_trace(TRACE_ISCSI_ARGS, "ISID: %" PRIu64 "\n", rsp->isid);
767 iscsi_trace(TRACE_ISCSI_ARGS, "TSIH: %u\n", rsp->tsih);
768 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", rsp->tag);
769 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
770 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
771 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
772 iscsi_trace(TRACE_ISCSI_ARGS, "Status-Class: %u\n", rsp->status_class);
773 iscsi_trace(TRACE_ISCSI_ARGS, "Status-Detail: %u\n", rsp->status_detail);
774 errmsg = NULL;
775 (void) memset(zeros, 0x0, sizeof(zeros));
776 if (((header[1] & 0x30U) >> 4U) != 0x0) {
777 errmsg = "Byte 1, bits 2-3";
778 } else if (memcmp(header + 20, zeros, 4) != 0) {
779 errmsg = "Bytes 20-23";
780 } else if (memcmp(header + 38, zeros, 2) != 0) {
781 errmsg = "Bytes 38-39";
782 } else if (memcmp(header + 40, zeros, 8) != 0) {
783 errmsg = "Bytes 40-47";
784 }
785 if (errmsg) {
786 iscsi_err(__FILE__, __LINE__, errmsg);
787 NO_CLEANUP;
788 return 1;
789 }
790 return 0;
791 }
792
793 /*
794 * Logout Command
795 */
796
797 int
798 iscsi_logout_cmd_encap(uint8_t *header, iscsi_logout_cmd_args_t * cmd)
799 {
800
801 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
802 iscsi_trace(TRACE_ISCSI_ARGS, "Reason: %u\n", cmd->reason);
803 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->tag);
804 iscsi_trace(TRACE_ISCSI_ARGS, "CID: %hu\n", cmd->cid);
805 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
806 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
807
808 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
809
810 header[0] = ISCSI_LOGOUT_CMD; /* Opcode */
811 if (cmd->immediate) {
812 header[0] |= 0x40; /* Immediate */
813 }
814 header[1] = cmd->reason | 0x80; /* Reason */
815 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */
816 *((uint16_t *) (void *) (header + 20)) = ISCSI_HTONS(cmd->cid); /* CID */
817 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */
818 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */
819
820 return 0;
821 }
822
823 int
824 iscsi_logout_cmd_decap(uint8_t *header, iscsi_logout_cmd_args_t * cmd)
825 {
826 const char *errmsg;
827 uint8_t zeros[16];
828
829 if (ISCSI_OPCODE(header) != ISCSI_LOGOUT_CMD) {
830 iscsi_err(__FILE__, __LINE__, "Opcode");
831 return 1;
832 }
833 cmd->immediate = (header[0] & 0x40) ? 1 : 0; /* Immediate */
834 cmd->reason = header[1] & 0x7f; /* Reason */
835 cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */
836 cmd->cid = ISCSI_NTOHS(*((uint16_t *) (void *) (header + 20))); /* CID */
837 cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */
838 cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */
839
840 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
841 iscsi_trace(TRACE_ISCSI_ARGS, "Reason: %u\n", cmd->reason);
842 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->tag);
843
844 iscsi_trace(TRACE_ISCSI_ARGS, "CID: %hu\n", cmd->cid);
845 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
846 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
847 errmsg = NULL;
848 (void) memset(zeros, 0x0, sizeof(zeros));
849 if ((unsigned)(header[0]) >> 0x7U != 0) {
850 errmsg = "Byte 0, bit 0";
851 } else if ((unsigned)(header[1]) >> 7U != 1) {
852 errmsg = "Byte 1, bit 0";
853 } else if (header[2] != 0) {
854 errmsg = "Byte 2";
855 } else if (header[3] != 0) {
856 errmsg = "Byte 3";
857 } else if (memcmp(header + 4, zeros, 12) != 0) {
858 errmsg = "Bytes 4-7";
859 } else if (memcmp(header + 22, zeros, 2) != 0) {
860 errmsg = "Bytes 22-23";
861 } else if (memcmp(header + 32, zeros, 16) != 0) {
862 errmsg = "Bytes 32-47";
863 }
864 if (errmsg) {
865 iscsi_err(__FILE__, __LINE__, errmsg);
866 NO_CLEANUP;
867 return 1;
868 }
869 return 0;
870 }
871
872 /*
873 * Logout Response
874 */
875
876 int
877 iscsi_logout_rsp_encap(uint8_t *header, iscsi_logout_rsp_args_t * rsp)
878 {
879
880 iscsi_trace(TRACE_ISCSI_ARGS, "Response: %u\n", rsp->response);
881 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", rsp->length);
882 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", rsp->tag);
883 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
884 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
885 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
886
887 iscsi_trace(TRACE_ISCSI_ARGS, "Time2Wait: %hu\n", rsp->Time2Wait);
888 iscsi_trace(TRACE_ISCSI_ARGS, "Time2Retain: %hu\n", rsp->Time2Retain);
889
890 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
891
892 header[0] |= 0x00 | ISCSI_LOGOUT_RSP; /* Opcode */
893 header[1] |= 0x80; /* Reserved */
894 header[2] = rsp->response; /* Response */
895 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(rsp->length); /* Length */
896 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag); /* Tag */
897 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN); /* StatSN */
898 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN); /* ExpCmdSN */
899 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN); /* MaxCmdSN */
900 *((uint16_t *) (void *) (header + 40)) = ISCSI_HTONS(rsp->Time2Wait); /* Time2Wait */
901 *((uint16_t *) (void *) (header + 42)) = ISCSI_HTONS(rsp->Time2Retain); /* Time2Retain */
902
903 return 0;
904 }
905
906 int
907 iscsi_logout_rsp_decap(uint8_t *header, iscsi_logout_rsp_args_t * rsp)
908 {
909 const char *errmsg;
910 uint8_t zeros[16];
911
912 if (ISCSI_OPCODE(header) != ISCSI_LOGOUT_RSP) {
913 iscsi_err(__FILE__, __LINE__, "Opcode");
914 return 1;
915 }
916 rsp->response = header[2]; /* Response */
917 rsp->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
918 rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */
919 rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */
920 rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */
921 rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */
922 rsp->Time2Wait = ISCSI_NTOHS(*((uint32_t *) (void *) (header + 40))); /* Time2Wait */
923 rsp->Time2Retain = ISCSI_NTOHS(*((uint32_t *) (void *) (header + 42))); /* Time2Retain */
924
925 errmsg = NULL;
926 (void) memset(zeros, 0x0, sizeof(zeros));
927 if ((header[0] & 0x20) != 0x20) {
928 errmsg = "Byte 0, bits 0-1";
929 } else if ((header[1] & 0x80) != 0x80) {
930 errmsg = "Byte 1, bit 0";
931 } else if (header[3] != 0) {
932 errmsg = "Byte 3";
933 } else if (memcmp(header + 4, zeros, 12) != 0) {
934 errmsg = "Bytes 4-15";
935 } else if (memcmp(header + 20, zeros, 4) != 0) {
936 errmsg = "Bytes 20-23";
937 } else if (memcmp(header + 36, zeros, 4) != 0) {
938 errmsg = "Bytes 36-39";
939 } else if (memcmp(header + 44, zeros, 4) != 0) {
940 errmsg = "Bytes 44-47";
941 }
942 if (errmsg) {
943 iscsi_err(__FILE__, __LINE__, errmsg);
944 NO_CLEANUP;
945 return 1;
946 }
947 iscsi_trace(TRACE_ISCSI_ARGS, "Response: %u\n", rsp->response);
948 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", rsp->length);
949 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", rsp->tag);
950 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
951 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
952 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
953 iscsi_trace(TRACE_ISCSI_ARGS, "Time2Wait: %hu\n", rsp->Time2Wait);
954 iscsi_trace(TRACE_ISCSI_ARGS, "Time2Retain: %hu\n", rsp->Time2Retain);
955
956 return 0;
957 }
958
959 /*
960 * SCSI Command
961 */
962
963 int
964 iscsi_scsi_cmd_encap(uint8_t *header, iscsi_scsi_cmd_args_t * cmd)
965 {
966
967 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
968 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %d\n", cmd->final);
969 iscsi_trace(TRACE_ISCSI_ARGS, "Input: %d\n", cmd->input);
970 iscsi_trace(TRACE_ISCSI_ARGS, "Output: %d\n", cmd->output);
971 iscsi_trace(TRACE_ISCSI_ARGS, "ATTR: %d\n", cmd->attr);
972 iscsi_trace(TRACE_ISCSI_ARGS, "TotalAHSLength: %u\n", cmd->ahs_len);
973 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", cmd->length);
974 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
975 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->tag);
976 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Length: %u\n", cmd->trans_len);
977 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
978 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
979 iscsi_trace(TRACE_ISCSI_ARGS, "CDB: %#x\n", cmd->cdb[0]);
980
981 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
982
983 header[0] |= ISCSI_SCSI_CMD; /* Opcode */
984 if (cmd->immediate) {
985 header[0] |= 0x40; /* Immediate */
986 }
987 if (cmd->final) {
988 header[1] |= 0x80; /* Final */
989 }
990 if (cmd->input) {
991 header[1] |= 0x40; /* Input bit */
992 }
993 if (cmd->output) {
994 header[1] |= 0x20; /* Output bit */
995 }
996 header[1] |= cmd->attr & 0x07; /* ATTR */
997 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(cmd->length); /* DataSegmentLength */
998 header[4] = cmd->ahs_len; /* TotalAHSLength */
999 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */
1000 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Task Tag */
1001 *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->trans_len); /* Expected Transfer
1002 * Length */
1003 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->CmdSN); /* CmdSN */
1004 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */
1005 memcpy(header + 32, cmd->cdb, 16); /* CDB */
1006
1007 return 0;
1008 }
1009
1010 int
1011 iscsi_scsi_cmd_decap(uint8_t *header, iscsi_scsi_cmd_args_t * cmd)
1012 {
1013 const char *errmsg;
1014
1015 if (ISCSI_OPCODE(header) != ISCSI_SCSI_CMD) {
1016 iscsi_err(__FILE__, __LINE__, "Opcode");
1017 return 1;
1018 }
1019 cmd->immediate = (header[0] & 0x40) ? 1 : 0; /* Immediate */
1020 cmd->final = (header[1] & 0x80) ? 1 : 0; /* Final */
1021 cmd->input = (header[1] & 0x40) ? 1 : 0; /* Input */
1022 cmd->output = (header[1] & 0x20) ? 1 : 0; /* Output */
1023 cmd->attr = header[1] & 0x07; /* ATTR */
1024 cmd->ahs_len = header[4];
1025 header[4] = 0x00;
1026 cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* DataSegmentLength */
1027 cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */
1028 cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Task Tag */
1029 cmd->trans_len = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Expected Transfer
1030 * Length */
1031 cmd->CmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* CmdSN */
1032 cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */
1033 cmd->cdb = header + 32; /* CDB */
1034
1035 errmsg = NULL;
1036 if ((header[1] & 0x18) != 0x0) {
1037 errmsg = "Byte 1, bits 3-4";
1038 } else if (header[2] != 0) {
1039 errmsg = "Byte 2";
1040 } else if (header[3] != 0) {
1041 errmsg = "Byte 3";
1042 }
1043 if (errmsg) {
1044 iscsi_err(__FILE__, __LINE__, errmsg);
1045 NO_CLEANUP;
1046 return 1;
1047 }
1048 iscsi_trace(TRACE_ISCSI_ARGS, "Immediate: %d\n", cmd->immediate);
1049 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %d\n", cmd->final);
1050 iscsi_trace(TRACE_ISCSI_ARGS, "Input: %d\n", cmd->input);
1051 iscsi_trace(TRACE_ISCSI_ARGS, "Output: %d\n", cmd->output);
1052 iscsi_trace(TRACE_ISCSI_ARGS, "ATTR: %d\n", cmd->attr);
1053 iscsi_trace(TRACE_ISCSI_ARGS, "TotalAHSLength: %u\n", cmd->ahs_len);
1054 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", cmd->length);
1055 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
1056 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->tag);
1057 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Length: %u\n", cmd->trans_len);
1058 iscsi_trace(TRACE_ISCSI_ARGS, "CmdSN: %u\n", cmd->CmdSN);
1059 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
1060 iscsi_trace(TRACE_ISCSI_ARGS, "CDB: %#x\n", cmd->cdb[0]);
1061
1062 return 0;
1063 }
1064
1065 /*
1066 * SCSI Response
1067 */
1068
1069 int
1070 iscsi_scsi_rsp_encap(uint8_t *header, iscsi_scsi_rsp_t * rsp)
1071 {
1072
1073 iscsi_trace(TRACE_ISCSI_ARGS, "Bidi Overflow: %d\n", rsp->bidi_overflow);
1074 iscsi_trace(TRACE_ISCSI_ARGS, "Bidi Underflow: %d\n", rsp->bidi_underflow);
1075 iscsi_trace(TRACE_ISCSI_ARGS, "Overflow: %d\n", rsp->overflow);
1076 iscsi_trace(TRACE_ISCSI_ARGS, "Underflow: %d\n", rsp->underflow);
1077 iscsi_trace(TRACE_ISCSI_ARGS, "iSCSI Response: %u\n", rsp->response);
1078 iscsi_trace(TRACE_ISCSI_ARGS, "SCSI Status: %u\n", rsp->status);
1079 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", rsp->length);
1080 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", rsp->tag);
1081 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
1082 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
1083 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
1084 iscsi_trace(TRACE_ISCSI_ARGS, "ExpDataSN: %u\n", rsp->ExpDataSN);
1085 iscsi_trace(TRACE_ISCSI_ARGS, "Bidi Residual Count: %u\n", rsp->bidi_res_cnt);
1086 iscsi_trace(TRACE_ISCSI_ARGS, "Residual Count: %u\n", rsp->basic_res_cnt);
1087
1088 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
1089
1090 header[0] |= 0x00 | ISCSI_SCSI_RSP; /* Opcode */
1091 header[1] |= 0x80; /* Byte 1 bit 7 */
1092 if (rsp->bidi_overflow) {
1093 header[1] |= 0x10; /* Bidi overflow */
1094 }
1095 if (rsp->bidi_underflow) {
1096 header[1] |= 0x08; /* Bidi underflow */
1097 }
1098 if (rsp->overflow) {
1099 header[1] |= 0x04; /* Overflow */
1100 }
1101 if (rsp->underflow) {
1102 header[1] |= 0x02; /* Underflow */
1103 }
1104 header[2] = rsp->response; /* iSCSI Response */
1105 header[3] = rsp->status;/* SCSI Status */
1106 header[4] = rsp->ahs_len; /* TotalAHSLength */
1107 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(rsp->length); /* DataSegmentLength */
1108 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(rsp->tag); /* Task Tag */
1109 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(rsp->StatSN); /* StatSN */
1110 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(rsp->ExpCmdSN); /* ExpCmdSN */
1111 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(rsp->MaxCmdSN); /* MaxCmdSN */
1112 *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(rsp->ExpDataSN); /* ExpDataSN */
1113 *((uint32_t *) (void *) (header + 40)) = ISCSI_HTONL(rsp->bidi_res_cnt); /* Bidi Residual Count */
1114 *((uint32_t *) (void *) (header + 44)) = ISCSI_HTONL(rsp->basic_res_cnt); /* Residual Count */
1115
1116 return 0;
1117 }
1118
1119 int
1120 iscsi_scsi_rsp_decap(uint8_t *header, iscsi_scsi_rsp_t * rsp)
1121 {
1122 const char *errmsg;
1123
1124 if (ISCSI_OPCODE(header) != ISCSI_SCSI_RSP) {
1125 iscsi_err(__FILE__, __LINE__, "Opcode");
1126 return 1;
1127 }
1128 rsp->bidi_overflow = (header[1] & 0x10) ? 1 : 0; /* Bidi overflow */
1129 rsp->bidi_underflow = (header[1] & 0x08) ? 1 : 0; /* Bidi underflow */
1130 rsp->overflow = (header[1] & 0x04) ? 1 : 0; /* Overflow */
1131 rsp->underflow = (header[1] & 0x02) ? 1 : 0; /* Underflow */
1132
1133 rsp->response = header[2]; /* iSCSI Response */
1134 rsp->status = header[3];/* SCSI Status */
1135 rsp->ahs_len = header[4]; /* TotalAHSLength */
1136 rsp->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* DataSegmentLength */
1137 rsp->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Task Tag */
1138 rsp->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */
1139 rsp->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */
1140 rsp->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */
1141 rsp->ExpDataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* ExpDataSN */
1142 rsp->bidi_res_cnt = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 40))); /* Bidi Residual Count */
1143 rsp->basic_res_cnt = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 44))); /* Residual Count */
1144
1145 errmsg = NULL;
1146 if ((header[0] & 0xc0) != 0x0) {
1147 errmsg = "Byte 0, bits 0-1";
1148 } else if ((header[1] & 0x80) != 0x80) {
1149 errmsg = "Byte 1, bit 0";
1150 } else if (rsp->bidi_res_cnt != 0) {
1151 errmsg = "bidi_res_cnt";
1152 } else if (rsp->bidi_overflow != 0) {
1153 errmsg = "bidi_overflow";
1154 } else if (rsp->bidi_underflow != 0) {
1155 errmsg = "bidi_underflow";
1156 } else if (rsp->overflow != 0) {
1157 errmsg = "overflow";
1158 }
1159 if (errmsg) {
1160 iscsi_err(__FILE__, __LINE__, errmsg);
1161 NO_CLEANUP;
1162 return 1;
1163 }
1164 iscsi_trace(TRACE_ISCSI_ARGS, "Bidi Overflow: %d\n", rsp->bidi_overflow);
1165 iscsi_trace(TRACE_ISCSI_ARGS, "Bidi Underflow: %d\n", rsp->bidi_underflow);
1166 iscsi_trace(TRACE_ISCSI_ARGS, "Overflow: %d\n", rsp->overflow);
1167 iscsi_trace(TRACE_ISCSI_ARGS, "Underflow: %d\n", rsp->underflow);
1168 iscsi_trace(TRACE_ISCSI_ARGS, "iSCSI Response: %u\n", rsp->response);
1169 iscsi_trace(TRACE_ISCSI_ARGS, "SCSI Status: %u\n", rsp->status);
1170 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", rsp->length);
1171 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", rsp->tag);
1172 iscsi_trace(TRACE_ISCSI_ARGS, "Residual Count: %u\n", rsp->basic_res_cnt);
1173 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", rsp->StatSN);
1174 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", rsp->ExpCmdSN);
1175 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", rsp->MaxCmdSN);
1176 iscsi_trace(TRACE_ISCSI_ARGS, "ExpDataSN: %u\n", rsp->ExpDataSN);
1177 iscsi_trace(TRACE_ISCSI_ARGS, "Bidi Residual Count: %u\n", rsp->bidi_res_cnt);
1178
1179 return 0;
1180 }
1181
1182
1183 /*
1184 * Ready To Transfer
1185 */
1186
1187 int
1188 iscsi_r2t_encap(uint8_t *header, iscsi_r2t_t * cmd)
1189 {
1190 uint32_t length;
1191
1192 iscsi_trace(TRACE_ISCSI_ARGS, "TotalAHSLength: %u\n", cmd->AHSlength);
1193 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
1194 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
1195 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
1196 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", cmd->StatSN);
1197 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", cmd->ExpCmdSN);
1198 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", cmd->MaxCmdSN);
1199 iscsi_trace(TRACE_ISCSI_ARGS, "R2TSN: %u\n", cmd->R2TSN);
1200 iscsi_trace(TRACE_ISCSI_ARGS, "Offset: %u\n", cmd->offset);
1201 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
1202
1203 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
1204
1205 header[0] |= 0x00 | ISCSI_R2T; /* Opcode */
1206 header[1] |= 0x80;
1207 length = (cmd->AHSlength & 0x00ffffff); /* AHSLength */
1208 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(length); /* AHSLength */
1209 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */
1210 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */
1211 *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Transfer Tag */
1212 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->StatSN); /* StatSN */
1213 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpCmdSN); /* ExpCmdSN */
1214 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->MaxCmdSN); /* MaxCmdSN */
1215 *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->R2TSN); /* R2TSN */
1216 *((uint32_t *) (void *) (header + 40)) = ISCSI_HTONL(cmd->offset); /* Buffer Offset */
1217 *((uint32_t *) (void *) (header + 44)) = ISCSI_HTONL(cmd->length); /* Transfer Length */
1218
1219 return 0;
1220 }
1221
1222 int
1223 iscsi_r2t_decap(uint8_t *header, iscsi_r2t_t * cmd)
1224 {
1225 const char *errmsg;
1226 uint8_t zeros[12];
1227
1228 if (ISCSI_OPCODE(header) != ISCSI_R2T) {
1229 iscsi_err(__FILE__, __LINE__, "Opcode");
1230 return 1;
1231 }
1232 cmd->AHSlength = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* TotalAHSLength */
1233 cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */
1234 cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16)));
1235 cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20)));
1236 cmd->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24)));
1237 cmd->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28)));
1238 cmd->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32)));
1239 cmd->R2TSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36)));
1240 cmd->offset = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 40)));
1241 cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 44)));
1242
1243 errmsg = NULL;
1244 (void) memset(zeros, 0x0, sizeof(zeros));
1245 if ((header[1] & 0x7f) != 0x0) {
1246 errmsg = "Byte 1, bits 1-7";
1247 } else if (header[2] != 0) {
1248 errmsg = "Byte 2";
1249 } else if (header[3] != 0) {
1250 errmsg = "Byte 3";
1251 } else if (memcmp(header + 4, zeros, 12) != 0) {
1252 errmsg = "Bytes 4-15";
1253 }
1254 if (errmsg) {
1255 iscsi_err(__FILE__, __LINE__, errmsg);
1256 NO_CLEANUP;
1257 return 1;
1258 }
1259 iscsi_trace(TRACE_ISCSI_ARGS, "AHSLength: %u\n", cmd->AHSlength);
1260 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
1261 iscsi_trace(TRACE_ISCSI_ARGS, "Tag: %#x\n", cmd->tag);
1262 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
1263 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", cmd->StatSN);
1264 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", cmd->ExpCmdSN);
1265 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", cmd->MaxCmdSN);
1266 iscsi_trace(TRACE_ISCSI_ARGS, "R2TSN: %u\n", cmd->R2TSN);
1267 iscsi_trace(TRACE_ISCSI_ARGS, "Offset: %u\n", cmd->offset);
1268 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
1269 return 0;
1270 }
1271
1272 /*
1273 * SCSI Write Data
1274 */
1275
1276 int
1277 iscsi_write_data_encap(uint8_t *header, iscsi_write_data_t * cmd)
1278 {
1279
1280 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %u\n", cmd->final);
1281 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", cmd->length);
1282 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
1283 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->tag);
1284 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
1285 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
1286 iscsi_trace(TRACE_ISCSI_ARGS, "DataSN: %u\n", cmd->DataSN);
1287 iscsi_trace(TRACE_ISCSI_ARGS, "Buffer Offset: %u\n", cmd->offset);
1288
1289 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
1290 header[0] = 0x00 | ISCSI_WRITE_DATA; /* Opcode */
1291 if (cmd->final) {
1292 header[1] |= 0x80; /* Final */
1293 }
1294 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(cmd->length); /* Length */
1295 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */
1296 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->tag); /* Tag */
1297 *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Transfer Tag */
1298 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpStatSN); /* ExpStatSN */
1299 *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->DataSN); /* DataSN */
1300 *((uint32_t *) (void *) (header + 40)) = ISCSI_HTONL(cmd->offset); /* Buffer Offset */
1301
1302 return 0;
1303 }
1304
1305 int
1306 iscsi_write_data_decap(uint8_t *header, iscsi_write_data_t * cmd)
1307 {
1308 const char *errmsg;
1309 uint8_t zeros[16];
1310
1311 if (ISCSI_OPCODE(header) != ISCSI_WRITE_DATA) {
1312 iscsi_err(__FILE__, __LINE__, "Opcode");
1313 return 1;
1314 }
1315 cmd->final = (header[1] & 0x80) ? 1 : 0; /* Final */
1316 cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
1317 cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */
1318 cmd->tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Tag */
1319 cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Transfer Tag */
1320 cmd->ExpStatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpStatSN */
1321 cmd->DataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* DataSN */
1322 cmd->offset = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 40))); /* Buffer Offset */
1323
1324 errmsg = NULL;
1325 (void) memset(zeros, 0x0, sizeof(zeros));
1326 if ((header[1] & 0x7f) != 0x0) {
1327 errmsg = "Byte 1, bits 1-7";
1328 } else if (header[2] != 0) {
1329 errmsg = "Byte 2";
1330 } else if (header[3] != 0) {
1331 errmsg = "Byte 3";
1332 } else if (header[4] != 0) {
1333 errmsg = "Byte 4";
1334 } else if (memcmp(header + 24, zeros, 4) != 0) {
1335 errmsg = "Bytes 24-27";
1336 } else if (memcmp(header + 32, zeros, 4) != 0) {
1337 errmsg = "Bytes 32-35";
1338 } else if (memcmp(header + 44, zeros, 4) != 0) {
1339 errmsg = "Bytes 44-47";
1340 }
1341 if (errmsg) {
1342 iscsi_err(__FILE__, __LINE__, errmsg);
1343 NO_CLEANUP;
1344 return 1;
1345 }
1346 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %u\n", cmd->final);
1347 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", cmd->length);
1348 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
1349 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->tag);
1350 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
1351 iscsi_trace(TRACE_ISCSI_ARGS, "ExpStatSN: %u\n", cmd->ExpStatSN);
1352 iscsi_trace(TRACE_ISCSI_ARGS, "DataSN: %u\n", cmd->DataSN);
1353 iscsi_trace(TRACE_ISCSI_ARGS, "Buffer Offset: %u\n", cmd->offset);
1354
1355 return 0;
1356 }
1357
1358 /*
1359 * SCSI Read Data
1360 */
1361
1362 int
1363 iscsi_read_data_encap(uint8_t *header, iscsi_read_data_t * cmd)
1364 {
1365
1366 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %d\n", cmd->final);
1367 iscsi_trace(TRACE_ISCSI_ARGS, "Acknowledge: %d\n", cmd->ack);
1368 iscsi_trace(TRACE_ISCSI_ARGS, "Overflow: %d\n", cmd->overflow);
1369 iscsi_trace(TRACE_ISCSI_ARGS, "Underflow: %d\n", cmd->underflow);
1370 iscsi_trace(TRACE_ISCSI_ARGS, "S_bit: %d\n", cmd->S_bit);
1371 iscsi_trace(TRACE_ISCSI_ARGS, "Status: %u\n", cmd->status);
1372 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", cmd->length);
1373 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", cmd->lun);
1374 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->task_tag);
1375 iscsi_trace(TRACE_ISCSI_ARGS, "Transfer Tag: %#x\n", cmd->transfer_tag);
1376 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", cmd->StatSN);
1377 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", cmd->ExpCmdSN);
1378 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", cmd->MaxCmdSN);
1379 iscsi_trace(TRACE_ISCSI_ARGS, "DataSN: %u\n", cmd->DataSN);
1380 iscsi_trace(TRACE_ISCSI_ARGS, "Buffer Offset %u\n", cmd->offset);
1381 iscsi_trace(TRACE_ISCSI_ARGS, "Residual Count: %u\n", cmd->res_count);
1382
1383 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
1384
1385 header[0] = 0x00 | ISCSI_READ_DATA; /* Opcode */
1386 if (cmd->final) {
1387 header[1] |= 0x80; /* Final */
1388 }
1389 if (cmd->ack) {
1390 header[1] |= 0x40; /* ACK */
1391 }
1392 if (cmd->overflow) {
1393 header[1] |= 0x04; /* Overflow */
1394 }
1395 if (cmd->underflow) {
1396 header[1] |= 0x02; /* Underflow */
1397 }
1398 if (cmd->S_bit) {
1399 header[1] |= 0x01; /* S Bit */
1400 }
1401 if (cmd->S_bit) {
1402 header[3] = cmd->status; /* Status */
1403 }
1404 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(cmd->length); /* Length */
1405 *((uint64_t *) (void *) (header + 8)) = ISCSI_HTONLL6(cmd->lun); /* LUN */
1406 *((uint32_t *) (void *) (header + 16)) = ISCSI_HTONL(cmd->task_tag); /* Task Tag */
1407 *((uint32_t *) (void *) (header + 20)) = ISCSI_HTONL(cmd->transfer_tag); /* Transfer Tag */
1408 if (cmd->S_bit) {
1409 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->StatSN); /* StatSN */
1410 }
1411 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpCmdSN); /* ExpCmdSN */
1412 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->MaxCmdSN); /* MaxCmdSN */
1413 *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->DataSN); /* DataSN */
1414 *((uint32_t *) (void *) (header + 40)) = ISCSI_HTONL(cmd->offset); /* Buffer Offset */
1415 if (cmd->S_bit) {
1416 *((uint32_t *) (void *) (header + 44)) = ISCSI_HTONL(cmd->res_count); /* Residual Count */
1417 }
1418
1419 return 0;
1420 }
1421
1422 int
1423 iscsi_read_data_decap(uint8_t *header, iscsi_read_data_t * cmd)
1424 {
1425 const char *errmsg;
1426 uint8_t zeros[16];
1427
1428 if (ISCSI_OPCODE(header) != ISCSI_READ_DATA) {
1429 iscsi_err(__FILE__, __LINE__, "Opcode");
1430 return 1;
1431 }
1432 cmd->final = (header[1] & 0x80) ? 1 : 0; /* Final */
1433 cmd->ack = (header[1] & 0x40) ? 1 : 0; /* Acknowledge */
1434 cmd->overflow = (header[1] & 0x04) ? 1 : 0; /* Overflow */
1435 cmd->underflow = (header[1] & 0x02) ? 1 : 0; /* Underflow */
1436 cmd->S_bit = (header[1] & 0x01) ? 1 : 0; /* S Bit */
1437 cmd->status = header[3];/* Status */
1438 cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
1439 cmd->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */
1440 cmd->task_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 16))); /* Task Tag */
1441 cmd->transfer_tag = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 20))); /* Transfer Tag */
1442 cmd->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */
1443 cmd->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */
1444 cmd->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */
1445 cmd->DataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* DataSN */
1446 cmd->offset = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 40))); /* Buffer Offset */
1447 cmd->res_count = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 44))); /* Residual Count */
1448 errmsg = NULL;
1449 (void) memset(zeros, 0x0, sizeof(zeros));
1450 if ((header[0] & 0xc0) != 0x0) {
1451 errmsg = "Byte 0, bits 0-1";
1452 } else if ((header[1] & 0x38) != 0x0) {
1453 errmsg = "Byte 1, bits 2-4";
1454 } else if (header[2] != 0) {
1455 errmsg = "Byte 2";
1456 } else if (header[4] != 0) {
1457 errmsg = "Byte 4";
1458 } else if (memcmp(header + 8, zeros, 8) != 0) {
1459 errmsg = "Bytes 8-15";
1460 } else if (memcmp(header + 44, zeros, 4) != 0) {
1461 errmsg = "Bytes 44-47";
1462 }
1463 if (errmsg) {
1464 iscsi_err(__FILE__, __LINE__, errmsg);
1465 NO_CLEANUP;
1466 return 1;
1467 }
1468 iscsi_trace(TRACE_ISCSI_ARGS, "Final: %d\n", cmd->final);
1469 iscsi_trace(TRACE_ISCSI_ARGS, "Acknowledge: %d\n", cmd->ack);
1470 iscsi_trace(TRACE_ISCSI_ARGS, "Overflow: %d\n", cmd->overflow);
1471 iscsi_trace(TRACE_ISCSI_ARGS, "Underflow: %d\n", cmd->underflow);
1472 iscsi_trace(TRACE_ISCSI_ARGS, "S_bit: %d\n", cmd->S_bit);
1473 iscsi_trace(TRACE_ISCSI_ARGS, "Status: %u\n", cmd->status);
1474 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", cmd->length);
1475 iscsi_trace(TRACE_ISCSI_ARGS, "Task Tag: %#x\n", cmd->task_tag);
1476 iscsi_trace(TRACE_ISCSI_ARGS, "Residual Count: %u\n", cmd->res_count);
1477 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", cmd->StatSN);
1478 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", cmd->ExpCmdSN);
1479 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", cmd->MaxCmdSN);
1480 iscsi_trace(TRACE_ISCSI_ARGS, "DataSN: %u\n", cmd->DataSN);
1481 iscsi_trace(TRACE_ISCSI_ARGS, "Buffer Offset %u\n", cmd->offset);
1482 return 0;
1483 }
1484
1485 /*
1486 * Reject
1487 */
1488
1489 int
1490 iscsi_reject_encap(uint8_t *header, iscsi_reject_t * cmd)
1491 {
1492
1493 iscsi_trace(TRACE_ISCSI_ARGS, "Reason: %u\n", cmd->reason);
1494 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
1495 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", cmd->StatSN);
1496 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", cmd->ExpCmdSN);
1497 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", cmd->MaxCmdSN);
1498 iscsi_trace(TRACE_ISCSI_ARGS, "DataSN: %u\n", cmd->DataSN);
1499
1500 (void) memset(header, 0x0, ISCSI_HEADER_LEN);
1501
1502 header[0] |= 0x00 | ISCSI_REJECT; /* Opcode */
1503 header[1] |= 0x80;
1504 header[2] = cmd->reason;/* Reason */
1505 *((uint32_t *) (void *) (header + 4)) = ISCSI_HTONL(cmd->length); /* Length */
1506 *((uint32_t *) (void *) (header + 24)) = ISCSI_HTONL(cmd->StatSN); /* StatSN */
1507 *((uint32_t *) (void *) (header + 28)) = ISCSI_HTONL(cmd->ExpCmdSN); /* ExpCmdSN */
1508 *((uint32_t *) (void *) (header + 32)) = ISCSI_HTONL(cmd->MaxCmdSN); /* MaxCmdSN */
1509 *((uint32_t *) (void *) (header + 36)) = ISCSI_HTONL(cmd->DataSN); /* DataSN */
1510
1511 return 0;
1512 }
1513
1514 int
1515 iscsi_reject_decap(uint8_t *header, iscsi_reject_t * cmd)
1516 {
1517 const char *errmsg;
1518 uint8_t zeros[8];
1519
1520 if (ISCSI_OPCODE(header) != ISCSI_REJECT) {
1521 iscsi_err(__FILE__, __LINE__, "Opcode");
1522 return 1;
1523 }
1524 cmd->reason = header[2];/* Reason */
1525 cmd->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
1526 cmd->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */
1527 cmd->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */
1528 cmd->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */
1529 cmd->DataSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 36))); /* DataSN */
1530
1531 errmsg = NULL;
1532 (void) memset(zeros, 0x0, sizeof(zeros));
1533 if ((header[0] & 0xc0) != 0x0) {
1534 errmsg = "Byte 0, bits 0-1";
1535 } else if ((header[1] & 0x7f) != 0x0) {
1536 errmsg = "Byte 1, bits 0-7";
1537 } else if (header[3] != 0) {
1538 errmsg = "Byte 3";
1539 } else if (header[4] != 0) {
1540 errmsg = "Byte 4";
1541 } else if (memcmp(header + 8, zeros, 8) != 0) {
1542 errmsg = "Bytes 8-15";
1543 } else if (memcmp(header + 20, zeros, 4) != 0) {
1544 errmsg = "Bytes 20-23";
1545 } else if (memcmp(header + 40, zeros, 8) != 0) {
1546 errmsg = "Bytes 40-47";
1547 }
1548 if (errmsg) {
1549 iscsi_err(__FILE__, __LINE__, errmsg);
1550 NO_CLEANUP;
1551 return 1;
1552 }
1553 iscsi_trace(TRACE_ISCSI_ARGS, "Reason: %u\n", cmd->reason);
1554 iscsi_trace(TRACE_ISCSI_ARGS, "Length: %u\n", cmd->length);
1555 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", cmd->StatSN);
1556 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", cmd->ExpCmdSN);
1557 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", cmd->MaxCmdSN);
1558 iscsi_trace(TRACE_ISCSI_ARGS, "DataSN: %u\n", cmd->DataSN);
1559 return 0;
1560 }
1561
1562 int
1563 iscsi_amsg_decap(uint8_t *header, iscsi_async_msg_t * msg)
1564 {
1565
1566 if (ISCSI_OPCODE(header) != ISCSI_ASYNC) {
1567 iscsi_err(__FILE__, __LINE__, "Opcode");
1568 return 1;
1569 }
1570 msg->AHSlength = header[4]; /* TotalAHSLength */
1571 msg->length = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 4))); /* Length */
1572 msg->lun = ISCSI_NTOHLL6(*((uint64_t *) (void *) (header + 8))); /* LUN */
1573 msg->StatSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 24))); /* StatSN */
1574 msg->ExpCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 28))); /* ExpCmdSN */
1575 msg->MaxCmdSN = ISCSI_NTOHL(*((uint32_t *) (void *) (header + 32))); /* MaxCmdSN */
1576 msg->AsyncEvent = header[36]; /* Async Event */
1577 msg->AsyncVCode = header[37]; /* Async Vendor Code */
1578
1579 iscsi_trace(TRACE_ISCSI_ARGS, "TotalAHSLength: %u\n", msg->AHSlength);
1580 iscsi_trace(TRACE_ISCSI_ARGS, "DataSegmentLength: %u\n", msg->length);
1581 iscsi_trace(TRACE_ISCSI_ARGS, "LUN: %" PRIu64 "\n", msg->lun);
1582 iscsi_trace(TRACE_ISCSI_ARGS, "StatSN: %u\n", msg->StatSN);
1583 iscsi_trace(TRACE_ISCSI_ARGS, "ExpCmdSN: %u\n", msg->ExpCmdSN);
1584 iscsi_trace(TRACE_ISCSI_ARGS, "MaxCmdSN: %u\n", msg->MaxCmdSN);
1585 iscsi_trace(TRACE_ISCSI_ARGS, "AsyncEvent: %u\n", msg->AsyncEvent);
1586 iscsi_trace(TRACE_ISCSI_ARGS, "AsyncVCode: %u\n", msg->AsyncVCode);
1587
1588 return 0;
1589 }
NetBSD on the FriendlyARM MINI2440