| 1 | |
| 2 | |
| 3 | * SCSI functions used by both the initiator and the target code.
|
| 4 |
|
| 5 |
|
| 6 | #include <linux/bug.h>
|
| 7 | #include <linux/kernel.h>
|
| 8 | #include <linux/string.h>
|
| 9 | #include <linux/errno.h>
|
| 10 | #include <linux/module.h>
|
| 11 | #include <uapi/linux/pr.h>
|
| 12 | #include <linux/unaligned.h>
|
| 13 | #include <scsi/scsi_common.h>
|
| 14 |
|
| 15 | MODULE_DESCRIPTION("SCSI functions used by both the initiator and the target code");
|
| 16 | MODULE_LICENSE("GPL v2");
|
| 17 |
|
| 18 |
|
| 19 | const unsigned char scsi_command_size_tbl[8] = {
|
| 20 | 6, 10, 10, 12, 16, 12, 10, 10
|
| 21 | };
|
| 22 | EXPORT_SYMBOL(scsi_command_size_tbl);
|
| 23 |
|
| 24 | |
| 25 | * You may not alter any existing entry (although adding new ones is
|
| 26 | * encouraged once assigned by ANSI/INCITS T10).
|
| 27 |
|
| 28 | static const char *const scsi_device_types[] = {
|
| 29 | "Direct-Access ",
|
| 30 | "Sequential-Access",
|
| 31 | "Printer ",
|
| 32 | "Processor ",
|
| 33 | "WORM ",
|
| 34 | "CD-ROM ",
|
| 35 | "Scanner ",
|
| 36 | "Optical Device ",
|
| 37 | "Medium Changer ",
|
| 38 | "Communications ",
|
| 39 | "ASC IT8 ",
|
| 40 | "ASC IT8 ",
|
| 41 | "RAID ",
|
| 42 | "Enclosure ",
|
| 43 | "Direct-Access-RBC",
|
| 44 | "Optical card ",
|
| 45 | "Bridge controller",
|
| 46 | "Object storage ",
|
| 47 | "Automation/Drive ",
|
| 48 | "Security Manager ",
|
| 49 | "Direct-Access-ZBC",
|
| 50 | };
|
| 51 |
|
| 52 | |
| 53 | * scsi_device_type - Return 17-char string indicating device type.
|
| 54 | * @type: type number to look up
|
| 55 |
|
| 56 | const char *scsi_device_type(unsigned type)
|
| 57 | {
|
| 58 | if (type == 0x1e)
|
| 59 | return "Well-known LUN ";
|
| 60 | if (type == 0x1f)
|
| 61 | return "No Device ";
|
| 62 | if (type >= ARRAY_SIZE(scsi_device_types))
|
| 63 | return "Unknown ";
|
| 64 | return scsi_device_types[type];
|
| 65 | }
|
| 66 | EXPORT_SYMBOL(scsi_device_type);
|
| 67 |
|
| 68 | enum pr_type scsi_pr_type_to_block(enum scsi_pr_type type)
|
| 69 | {
|
| 70 | switch (type) {
|
| 71 | case SCSI_PR_WRITE_EXCLUSIVE:
|
| 72 | return PR_WRITE_EXCLUSIVE;
|
| 73 | case SCSI_PR_EXCLUSIVE_ACCESS:
|
| 74 | return PR_EXCLUSIVE_ACCESS;
|
| 75 | case SCSI_PR_WRITE_EXCLUSIVE_REG_ONLY:
|
| 76 | return PR_WRITE_EXCLUSIVE_REG_ONLY;
|
| 77 | case SCSI_PR_EXCLUSIVE_ACCESS_REG_ONLY:
|
| 78 | return PR_EXCLUSIVE_ACCESS_REG_ONLY;
|
| 79 | case SCSI_PR_WRITE_EXCLUSIVE_ALL_REGS:
|
| 80 | return PR_WRITE_EXCLUSIVE_ALL_REGS;
|
| 81 | case SCSI_PR_EXCLUSIVE_ACCESS_ALL_REGS:
|
| 82 | return PR_EXCLUSIVE_ACCESS_ALL_REGS;
|
| 83 | }
|
| 84 |
|
| 85 | return 0;
|
| 86 | }
|
| 87 | EXPORT_SYMBOL_GPL(scsi_pr_type_to_block);
|
| 88 |
|
| 89 | enum scsi_pr_type block_pr_type_to_scsi(enum pr_type type)
|
| 90 | {
|
| 91 | switch (type) {
|
| 92 | case PR_WRITE_EXCLUSIVE:
|
| 93 | return SCSI_PR_WRITE_EXCLUSIVE;
|
| 94 | case PR_EXCLUSIVE_ACCESS:
|
| 95 | return SCSI_PR_EXCLUSIVE_ACCESS;
|
| 96 | case PR_WRITE_EXCLUSIVE_REG_ONLY:
|
| 97 | return SCSI_PR_WRITE_EXCLUSIVE_REG_ONLY;
|
| 98 | case PR_EXCLUSIVE_ACCESS_REG_ONLY:
|
| 99 | return SCSI_PR_EXCLUSIVE_ACCESS_REG_ONLY;
|
| 100 | case PR_WRITE_EXCLUSIVE_ALL_REGS:
|
| 101 | return SCSI_PR_WRITE_EXCLUSIVE_ALL_REGS;
|
| 102 | case PR_EXCLUSIVE_ACCESS_ALL_REGS:
|
| 103 | return SCSI_PR_EXCLUSIVE_ACCESS_ALL_REGS;
|
| 104 | }
|
| 105 |
|
| 106 | return 0;
|
| 107 | }
|
| 108 | EXPORT_SYMBOL_GPL(block_pr_type_to_scsi);
|
| 109 |
|
| 110 | |
| 111 | * scsilun_to_int - convert a scsi_lun to an int
|
| 112 | * @scsilun: struct scsi_lun to be converted.
|
| 113 | *
|
| 114 | * Description:
|
| 115 | * Convert @scsilun from a struct scsi_lun to a four-byte host byte-ordered
|
| 116 | * integer, and return the result. The caller must check for
|
| 117 | * truncation before using this function.
|
| 118 | *
|
| 119 | * Notes:
|
| 120 | * For a description of the LUN format, post SCSI-3 see the SCSI
|
| 121 | * Architecture Model, for SCSI-3 see the SCSI Controller Commands.
|
| 122 | *
|
| 123 | * Given a struct scsi_lun of: d2 04 0b 03 00 00 00 00, this function
|
| 124 | * returns the integer: 0x0b03d204
|
| 125 | *
|
| 126 | * This encoding will return a standard integer LUN for LUNs smaller
|
| 127 | * than 256, which typically use a single level LUN structure with
|
| 128 | * addressing method 0.
|
| 129 |
|
| 130 | u64 scsilun_to_int(struct scsi_lun *scsilun)
|
| 131 | {
|
| 132 | int i;
|
| 133 | u64 lun;
|
| 134 |
|
| 135 | lun = 0;
|
| 136 | for (i = 0; i < sizeof(lun); i += 2)
|
| 137 | lun = lun | (((u64)scsilun->scsi_lun[i] << ((i + 1) * 8)) |
|
| 138 | ((u64)scsilun->scsi_lun[i + 1] << (i * 8)));
|
| 139 | return lun;
|
| 140 | }
|
| 141 | EXPORT_SYMBOL(scsilun_to_int);
|
| 142 |
|
| 143 | |
| 144 | * int_to_scsilun - reverts an int into a scsi_lun
|
| 145 | * @lun: integer to be reverted
|
| 146 | * @scsilun: struct scsi_lun to be set.
|
| 147 | *
|
| 148 | * Description:
|
| 149 | * Reverts the functionality of the scsilun_to_int, which packed
|
| 150 | * an 8-byte lun value into an int. This routine unpacks the int
|
| 151 | * back into the lun value.
|
| 152 | *
|
| 153 | * Notes:
|
| 154 | * Given an integer : 0x0b03d204, this function returns a
|
| 155 | * struct scsi_lun of: d2 04 0b 03 00 00 00 00
|
| 156 | *
|
| 157 |
|
| 158 | void int_to_scsilun(u64 lun, struct scsi_lun *scsilun)
|
| 159 | {
|
| 160 | int i;
|
| 161 |
|
| 162 | memset(scsilun->scsi_lun, 0, sizeof(scsilun->scsi_lun));
|
| 163 |
|
| 164 | for (i = 0; i < sizeof(lun); i += 2) {
|
| 165 | scsilun->scsi_lun[i] = (lun >> 8) & 0xFF;
|
| 166 | scsilun->scsi_lun[i+1] = lun & 0xFF;
|
| 167 | lun = lun >> 16;
|
| 168 | }
|
| 169 | }
|
| 170 | EXPORT_SYMBOL(int_to_scsilun);
|
| 171 |
|
| 172 | |
| 173 | * scsi_normalize_sense - normalize main elements from either fixed or
|
| 174 | * descriptor sense data format into a common format.
|
| 175 | *
|
| 176 | * @sense_buffer: byte array containing sense data returned by device
|
| 177 | * @sb_len: number of valid bytes in sense_buffer
|
| 178 | * @sshdr: pointer to instance of structure that common
|
| 179 | * elements are written to.
|
| 180 | *
|
| 181 | * Notes:
|
| 182 | * The "main elements" from sense data are: response_code, sense_key,
|
| 183 | * asc, ascq and additional_length (only for descriptor format).
|
| 184 | *
|
| 185 | * Typically this function can be called after a device has
|
| 186 | * responded to a SCSI command with the CHECK_CONDITION status.
|
| 187 | *
|
| 188 | * Return value:
|
| 189 | * true if valid sense data information found, else false;
|
| 190 |
|
| 191 | bool scsi_normalize_sense(const u8 *sense_buffer, int sb_len,
|
| 192 | struct scsi_sense_hdr *sshdr)
|
| 193 | {
|
| 194 | memset(sshdr, 0, sizeof(struct scsi_sense_hdr));
|
| 195 |
|
| 196 | if (!sense_buffer || !sb_len)
|
| 197 | return false;
|
| 198 |
|
| 199 | sshdr->response_code = (sense_buffer[0] & 0x7f);
|
| 200 |
|
| 201 | if (!scsi_sense_valid(sshdr))
|
| 202 | return false;
|
| 203 |
|
| 204 | if (sshdr->response_code >= 0x72) {
|
| 205 | |
| 206 | * descriptor format
|
| 207 |
|
| 208 | if (sb_len > 1)
|
| 209 | sshdr->sense_key = (sense_buffer[1] & 0xf);
|
| 210 | if (sb_len > 2)
|
| 211 | sshdr->asc = sense_buffer[2];
|
| 212 | if (sb_len > 3)
|
| 213 | sshdr->ascq = sense_buffer[3];
|
| 214 | if (sb_len > 7)
|
| 215 | sshdr->additional_length = sense_buffer[7];
|
| 216 | } else {
|
| 217 | |
| 218 | * fixed format
|
| 219 |
|
| 220 | if (sb_len > 2)
|
| 221 | sshdr->sense_key = (sense_buffer[2] & 0xf);
|
| 222 | if (sb_len > 7) {
|
| 223 | sb_len = min(sb_len, sense_buffer[7] + 8);
|
| 224 | if (sb_len > 12)
|
| 225 | sshdr->asc = sense_buffer[12];
|
| 226 | if (sb_len > 13)
|
| 227 | sshdr->ascq = sense_buffer[13];
|
| 228 | }
|
| 229 | }
|
| 230 |
|
| 231 | return true;
|
| 232 | }
|
| 233 | EXPORT_SYMBOL(scsi_normalize_sense);
|
| 234 |
|
| 235 | |
| 236 | * scsi_sense_desc_find - search for a given descriptor type in descriptor sense data format.
|
| 237 | * @sense_buffer: byte array of descriptor format sense data
|
| 238 | * @sb_len: number of valid bytes in sense_buffer
|
| 239 | * @desc_type: value of descriptor type to find
|
| 240 | * (e.g. 0 -> information)
|
| 241 | *
|
| 242 | * Notes:
|
| 243 | * only valid when sense data is in descriptor format
|
| 244 | *
|
| 245 | * Return value:
|
| 246 | * pointer to start of (first) descriptor if found else NULL
|
| 247 |
|
| 248 | const u8 * scsi_sense_desc_find(const u8 * sense_buffer, int sb_len,
|
| 249 | int desc_type)
|
| 250 | {
|
| 251 | int add_sen_len, add_len, desc_len, k;
|
| 252 | const u8 * descp;
|
| 253 |
|
| 254 | if ((sb_len < 8) || (0 == (add_sen_len = sense_buffer[7])))
|
| 255 | return NULL;
|
| 256 | if ((sense_buffer[0] < 0x72) || (sense_buffer[0] > 0x73))
|
| 257 | return NULL;
|
| 258 | add_sen_len = (add_sen_len < (sb_len - 8)) ?
|
| 259 | add_sen_len : (sb_len - 8);
|
| 260 | descp = &sense_buffer[8];
|
| 261 | for (desc_len = 0, k = 0; k < add_sen_len; k += desc_len) {
|
| 262 | descp += desc_len;
|
| 263 | add_len = (k < (add_sen_len - 1)) ? descp[1]: -1;
|
| 264 | desc_len = add_len + 2;
|
| 265 | if (descp[0] == desc_type)
|
| 266 | return descp;
|
| 267 | if (add_len < 0) |
| 268 | break;
|
| 269 | }
|
| 270 | return NULL;
|
| 271 | }
|
| 272 | EXPORT_SYMBOL(scsi_sense_desc_find);
|
| 273 |
|
| 274 | |
| 275 | * scsi_build_sense_buffer - build sense data in a buffer
|
| 276 | * @desc: Sense format (non-zero == descriptor format,
|
| 277 | * 0 == fixed format)
|
| 278 | * @buf: Where to build sense data
|
| 279 | * @key: Sense key
|
| 280 | * @asc: Additional sense code
|
| 281 | * @ascq: Additional sense code qualifier
|
| 282 | *
|
| 283 | *
|
| 284 | void scsi_build_sense_buffer(int desc, u8 *buf, u8 key, u8 asc, u8 ascq)
|
| 285 | {
|
| 286 | if (desc) {
|
| 287 | buf[0] = 0x72;
|
| 288 | buf[1] = key;
|
| 289 | buf[2] = asc;
|
| 290 | buf[3] = ascq;
|
| 291 | buf[7] = 0;
|
| 292 | } else {
|
| 293 | buf[0] = 0x70;
|
| 294 | buf[2] = key;
|
| 295 | buf[7] = 0xa;
|
| 296 | buf[12] = asc;
|
| 297 | buf[13] = ascq;
|
| 298 | }
|
| 299 | }
|
| 300 | EXPORT_SYMBOL(scsi_build_sense_buffer);
|
| 301 |
|
| 302 | |
| 303 | * scsi_set_sense_information - set the information field in a
|
| 304 | * formatted sense data buffer
|
| 305 | * @buf: Where to build sense data
|
| 306 | * @buf_len: buffer length
|
| 307 | * @info: 64-bit information value to be set
|
| 308 | *
|
| 309 | * Return value:
|
| 310 | * 0 on success or -EINVAL for invalid sense buffer length
|
| 311 | *
|
| 312 | int scsi_set_sense_information(u8 *buf, int buf_len, u64 info)
|
| 313 | {
|
| 314 | if ((buf[0] & 0x7f) == 0x72) {
|
| 315 | u8 *ucp, len;
|
| 316 |
|
| 317 | len = buf[7];
|
| 318 | ucp = (char *)scsi_sense_desc_find(buf, len + 8, 0);
|
| 319 | if (!ucp) {
|
| 320 | buf[7] = len + 0xc;
|
| 321 | ucp = buf + 8 + len;
|
| 322 | }
|
| 323 |
|
| 324 | if (buf_len < len + 0xc)
|
| 325 |
|
| 326 | return -EINVAL;
|
| 327 |
|
| 328 | ucp[0] = 0;
|
| 329 | ucp[1] = 0xa;
|
| 330 | ucp[2] = 0x80;
|
| 331 | ucp[3] = 0;
|
| 332 | put_unaligned_be64(info, &ucp[4]);
|
| 333 | } else if ((buf[0] & 0x7f) == 0x70) {
|
| 334 | |
| 335 | * Only set the 'VALID' bit if we can represent the value
|
| 336 | * correctly; otherwise just fill out the lower bytes and
|
| 337 | * clear the 'VALID' flag.
|
| 338 |
|
| 339 | if (info <= 0xffffffffUL)
|
| 340 | buf[0] |= 0x80;
|
| 341 | else
|
| 342 | buf[0] &= 0x7f;
|
| 343 | put_unaligned_be32((u32)info, &buf[3]);
|
| 344 | }
|
| 345 |
|
| 346 | return 0;
|
| 347 | }
|
| 348 | EXPORT_SYMBOL(scsi_set_sense_information);
|
| 349 |
|
| 350 | |
| 351 | * scsi_set_sense_field_pointer - set the field pointer sense key
|
| 352 | * specific information in a formatted sense data buffer
|
| 353 | * @buf: Where to build sense data
|
| 354 | * @buf_len: buffer length
|
| 355 | * @fp: field pointer to be set
|
| 356 | * @bp: bit pointer to be set
|
| 357 | * @cd: command/data bit
|
| 358 | *
|
| 359 | * Return value:
|
| 360 | * 0 on success or -EINVAL for invalid sense buffer length
|
| 361 |
|
| 362 | int scsi_set_sense_field_pointer(u8 *buf, int buf_len, u16 fp, u8 bp, bool cd)
|
| 363 | {
|
| 364 | u8 *ucp, len;
|
| 365 |
|
| 366 | if ((buf[0] & 0x7f) == 0x72) {
|
| 367 | len = buf[7];
|
| 368 | ucp = (char *)scsi_sense_desc_find(buf, len + 8, 2);
|
| 369 | if (!ucp) {
|
| 370 | buf[7] = len + 8;
|
| 371 | ucp = buf + 8 + len;
|
| 372 | }
|
| 373 |
|
| 374 | if (buf_len < len + 8)
|
| 375 |
|
| 376 | return -EINVAL;
|
| 377 |
|
| 378 | ucp[0] = 2;
|
| 379 | ucp[1] = 6;
|
| 380 | ucp[4] = 0x80;
|
| 381 | if (cd)
|
| 382 | ucp[4] |= 0x40;
|
| 383 | if (bp < 0x8)
|
| 384 | ucp[4] |= 0x8 | bp;
|
| 385 | put_unaligned_be16(fp, &ucp[5]);
|
| 386 | } else if ((buf[0] & 0x7f) == 0x70) {
|
| 387 | len = buf[7];
|
| 388 | if (len < 18)
|
| 389 | buf[7] = 18;
|
| 390 |
|
| 391 | buf[15] = 0x80;
|
| 392 | if (cd)
|
| 393 | buf[15] |= 0x40;
|
| 394 | if (bp < 0x8)
|
| 395 | buf[15] |= 0x8 | bp;
|
| 396 | put_unaligned_be16(fp, &buf[16]);
|
| 397 | }
|
| 398 |
|
| 399 | return 0;
|
| 400 | }
|
| 401 | EXPORT_SYMBOL(scsi_set_sense_field_pointer);
|