| 1 | // SPDX-License-Identifier: GPL-2.0 | 
|---|
| 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 | /* Command group 3 is reserved and should never be used.  */ | 
|---|
| 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 | /* NB: These are exposed through /proc/scsi/scsi and form part of the ABI. | 
|---|
| 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(s: scsilun->scsi_lun, c: 0, n: 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(s: sshdr, c: 0, n: 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) // short descriptor ?? | 
|---|
| 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;	/* descriptor, current */ | 
|---|
| 288 | buf[1] = key; | 
|---|
| 289 | buf[2] = asc; | 
|---|
| 290 | buf[3] = ascq; | 
|---|
| 291 | buf[7] = 0; | 
|---|
| 292 | } else { | 
|---|
| 293 | buf[0] = 0x70;	/* fixed, current */ | 
|---|
| 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 | /* Not enough room for info */ | 
|---|
| 326 | return -EINVAL; | 
|---|
| 327 |  | 
|---|
| 328 | ucp[0] = 0; | 
|---|
| 329 | ucp[1] = 0xa; | 
|---|
| 330 | ucp[2] = 0x80; /* Valid bit */ | 
|---|
| 331 | ucp[3] = 0; | 
|---|
| 332 | put_unaligned_be64(val: info, p: &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(val: (u32)info, p: &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 | /* Not enough room for info */ | 
|---|
| 376 | return -EINVAL; | 
|---|
| 377 |  | 
|---|
| 378 | ucp[0] = 2; | 
|---|
| 379 | ucp[1] = 6; | 
|---|
| 380 | ucp[4] = 0x80; /* Valid bit */ | 
|---|
| 381 | if (cd) | 
|---|
| 382 | ucp[4] |= 0x40; | 
|---|
| 383 | if (bp < 0x8) | 
|---|
| 384 | ucp[4] |= 0x8 | bp; | 
|---|
| 385 | put_unaligned_be16(val: fp, p: &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(val: fp, p: &buf[16]); | 
|---|
| 397 | } | 
|---|
| 398 |  | 
|---|
| 399 | return 0; | 
|---|
| 400 | } | 
|---|
| 401 | EXPORT_SYMBOL(scsi_set_sense_field_pointer); | 
|---|
| 402 |  | 
|---|