1 #include <inttypes.h>
2 #include <string.h>
3
4 /**
5 * ata_id_string - Convert IDENTIFY DEVICE page into string
6 * @id: IDENTIFY DEVICE results we will examine
7 * @s: string into which data is output
8 * @ofs: offset into identify device page
9 * @len: length of string to return. must be an even number.
10 *
11 * The strings in the IDENTIFY DEVICE page are broken up into
12 * 16-bit chunks. Run through the string, and output each
13 * 8-bit chunk linearly, regardless of platform.
14 *
15 * LOCKING:
16 * caller.
17 */
ata_id_string(const uint16_t * id,unsigned char * s,unsigned int ofs,unsigned int len)18 void ata_id_string(const uint16_t * id, unsigned char *s,
19 unsigned int ofs, unsigned int len)
20 {
21 unsigned int c;
22
23 while (len > 0) {
24 c = id[ofs] >> 8;
25 *s = c;
26 s++;
27
28 c = id[ofs] & 0xff;
29 *s = c;
30 s++;
31
32 ofs++;
33 len -= 2;
34 }
35 }
36
37 /**
38 * ata_id_c_string - Convert IDENTIFY DEVICE page into C string
39 * @id: IDENTIFY DEVICE results we will examine
40 * @s: string into which data is output
41 * @ofs: offset into identify device page
42 * @len: length of string to return. must be an odd number.
43 *
44 * This function is identical to ata_id_string except that it
45 * trims trailing spaces and terminates the resulting string with
46 * null. @len must be actual maximum length (even number) + 1.
47 *
48 * LOCKING:
49 * caller.
50 */
ata_id_c_string(const uint16_t * id,unsigned char * s,unsigned int ofs,unsigned int len)51 void ata_id_c_string(const uint16_t * id, unsigned char *s,
52 unsigned int ofs, unsigned int len)
53 {
54 unsigned char *p;
55
56 ata_id_string(id, s, ofs, len - 1);
57
58 p = s + strnlen((const char *)s, len - 1);
59 while (p > s && p[-1] == ' ')
60 p--;
61 *p = '\0';
62 }
63