Linux Audio

Check our new training course

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