blob: d684270dcda18f2d9426042473e403a662c00c80 [file] [log] [blame]
Dave Liuffc664e2008-03-26 22:51:44 +08001/*
2 * Copyright (C) 2008 Freescale Semiconductor, Inc.
3 * Dave Liu <daveliu@freescale.com>
4 * port from the libata of linux kernel
5 *
Wolfgang Denk1a459662013-07-08 09:37:19 +02006 * SPDX-License-Identifier: GPL-2.0+
Dave Liuffc664e2008-03-26 22:51:44 +08007 */
8
9#include <libata.h>
10
11u64 ata_id_n_sectors(u16 *id)
12{
13 if (ata_id_has_lba(id)) {
14 if (ata_id_has_lba48(id))
15 return ata_id_u64(id, ATA_ID_LBA48_SECTORS);
16 else
17 return ata_id_u32(id, ATA_ID_LBA_SECTORS);
18 } else {
19 return 0;
20 }
21}
22
23u32 ata_dev_classify(u32 sig)
24{
25 u8 lbam, lbah;
26
27 lbam = (sig >> 16) & 0xff;
28 lbah = (sig >> 24) & 0xff;
29
30 if (((lbam == 0) && (lbah == 0)) ||
31 ((lbam == 0x3c) && (lbah == 0xc3)))
32 return ATA_DEV_ATA;
33
34 if ((lbam == 0x14) && (lbah == 0xeb))
35 return ATA_DEV_ATAPI;
36
37 if ((lbam == 0x69) && (lbah == 0x96))
38 return ATA_DEV_PMP;
39
40 return ATA_DEV_UNKNOWN;
41}
42
43static void ata_id_string(const u16 *id, unsigned char *s,
44 unsigned int ofs, unsigned int len)
45{
46 unsigned int c;
47
48 while (len > 0) {
49 c = id[ofs] >> 8;
50 *s = c;
51 s++;
52
53 c = id[ofs] & 0xff;
54 *s = c;
55 s++;
56
57 ofs++;
58 len -= 2;
59 }
60}
61
62void ata_id_c_string(const u16 *id, unsigned char *s,
63 unsigned int ofs, unsigned int len)
64{
65 unsigned char *p;
66
67 ata_id_string(id, s, ofs, len - 1);
68
69 p = s + strnlen((char *)s, len - 1);
70 while (p > s && p[-1] == ' ')
71 p--;
72 *p = '\0';
73}
74
75void ata_dump_id(u16 *id)
76{
77 unsigned char serial[ATA_ID_SERNO_LEN + 1];
78 unsigned char firmware[ATA_ID_FW_REV_LEN + 1];
79 unsigned char product[ATA_ID_PROD_LEN + 1];
80 u64 n_sectors;
81
82 /* Serial number */
83 ata_id_c_string(id, serial, ATA_ID_SERNO, sizeof(serial));
84 printf("S/N: %s\n\r", serial);
85
86 /* Firmware version */
87 ata_id_c_string(id, firmware, ATA_ID_FW_REV, sizeof(firmware));
88 printf("Firmware version: %s\n\r", firmware);
89
90 /* Product model */
91 ata_id_c_string(id, product, ATA_ID_PROD, sizeof(product));
92 printf("Product model number: %s\n\r", product);
93
94 /* Total sectors of device */
95 n_sectors = ata_id_n_sectors(id);
Kim Phillips4109df62008-07-10 14:00:15 -050096 printf("Capablity: %lld sectors\n\r", n_sectors);
Dave Liuffc664e2008-03-26 22:51:44 +080097
Dave Liuf297b7a2008-03-27 18:51:17 +080098 printf ("id[49]: capabilities = 0x%04x\n"
99 "id[53]: field valid = 0x%04x\n"
100 "id[63]: mwdma = 0x%04x\n"
101 "id[64]: pio = 0x%04x\n"
102 "id[75]: queue depth = 0x%04x\n",
Dave Liuffc664e2008-03-26 22:51:44 +0800103 id[49],
104 id[53],
105 id[63],
106 id[64],
107 id[75]);
108
Dave Liuf297b7a2008-03-27 18:51:17 +0800109 printf ("id[76]: sata capablity = 0x%04x\n"
110 "id[78]: sata features supported = 0x%04x\n"
111 "id[79]: sata features enable = 0x%04x\n",
Dave Liuffc664e2008-03-26 22:51:44 +0800112 id[76],
113 id[78],
114 id[79]);
115
Dave Liuf297b7a2008-03-27 18:51:17 +0800116 printf ("id[80]: major version = 0x%04x\n"
117 "id[81]: minor version = 0x%04x\n"
118 "id[82]: command set supported 1 = 0x%04x\n"
119 "id[83]: command set supported 2 = 0x%04x\n"
120 "id[84]: command set extension = 0x%04x\n",
Dave Liuffc664e2008-03-26 22:51:44 +0800121 id[80],
122 id[81],
123 id[82],
124 id[83],
125 id[84]);
Dave Liuf297b7a2008-03-27 18:51:17 +0800126 printf ("id[85]: command set enable 1 = 0x%04x\n"
127 "id[86]: command set enable 2 = 0x%04x\n"
128 "id[87]: command set default = 0x%04x\n"
129 "id[88]: udma = 0x%04x\n"
130 "id[93]: hardware reset result = 0x%04x\n",
Dave Liuffc664e2008-03-26 22:51:44 +0800131 id[85],
132 id[86],
133 id[87],
134 id[88],
135 id[93]);
136}
137
138void ata_swap_buf_le16(u16 *buf, unsigned int buf_words)
139{
140 unsigned int i;
141
142 for (i = 0; i < buf_words; i++)
143 buf[i] = le16_to_cpu(buf[i]);
144}