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   */
scsi_device_type(unsigned type)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  
scsi_pr_type_to_block(enum scsi_pr_type type)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  
block_pr_type_to_scsi(enum pr_type type)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   */
scsilun_to_int(struct scsi_lun * scsilun)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   */
int_to_scsilun(u64 lun,struct scsi_lun * scsilun)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   */
scsi_normalize_sense(const u8 * sense_buffer,int sb_len,struct scsi_sense_hdr * sshdr)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   */
scsi_sense_desc_find(const u8 * sense_buffer,int sb_len,int desc_type)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   **/
scsi_build_sense_buffer(int desc,u8 * buf,u8 key,u8 asc,u8 ascq)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   **/
scsi_set_sense_information(u8 * buf,int buf_len,u64 info)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(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   */
scsi_set_sense_field_pointer(u8 * buf,int buf_len,u16 fp,u8 bp,bool cd)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(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);
402