1 /*
2 * Copyright (C) 2008 Freescale Semiconductor, Inc.
3 * Dave Liu <daveliu@freescale.com>
4 * port from the libata of linux kernel
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License as
8 * published by the Free Software Foundation; either version 2 of
9 * the License, or (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
19 * MA 02111-1307 USA
20 *
21 */
22
23 #include <libata.h>
24
ata_id_n_sectors(u16 * id)25 u64 ata_id_n_sectors(u16 *id)
26 {
27 if (ata_id_has_lba(id)) {
28 if (ata_id_has_lba48(id))
29 return ata_id_u64(id, ATA_ID_LBA48_SECTORS);
30 else
31 return ata_id_u32(id, ATA_ID_LBA_SECTORS);
32 } else {
33 return 0;
34 }
35 }
36
ata_dev_classify(u32 sig)37 u32 ata_dev_classify(u32 sig)
38 {
39 u8 lbam, lbah;
40
41 lbam = (sig >> 16) & 0xff;
42 lbah = (sig >> 24) & 0xff;
43
44 if (((lbam == 0) && (lbah == 0)) ||
45 ((lbam == 0x3c) && (lbah == 0xc3)))
46 return ATA_DEV_ATA;
47
48 if ((lbam == 0x14) && (lbah == 0xeb))
49 return ATA_DEV_ATAPI;
50
51 if ((lbam == 0x69) && (lbah == 0x96))
52 return ATA_DEV_PMP;
53
54 return ATA_DEV_UNKNOWN;
55 }
56
ata_id_string(const u16 * id,unsigned char * s,unsigned int ofs,unsigned int len)57 static void ata_id_string(const u16 *id, unsigned char *s,
58 unsigned int ofs, unsigned int len)
59 {
60 unsigned int c;
61
62 while (len > 0) {
63 c = id[ofs] >> 8;
64 *s = c;
65 s++;
66
67 c = id[ofs] & 0xff;
68 *s = c;
69 s++;
70
71 ofs++;
72 len -= 2;
73 }
74 }
75
ata_id_c_string(const u16 * id,unsigned char * s,unsigned int ofs,unsigned int len)76 void ata_id_c_string(const u16 *id, unsigned char *s,
77 unsigned int ofs, unsigned int len)
78 {
79 unsigned char *p;
80
81 ata_id_string(id, s, ofs, len - 1);
82
83 p = s + strnlen((char *)s, len - 1);
84 while (p > s && p[-1] == ' ')
85 p--;
86 *p = '\0';
87 }
88
ata_dump_id(u16 * id)89 void ata_dump_id(u16 *id)
90 {
91 unsigned char serial[ATA_ID_SERNO_LEN + 1];
92 unsigned char firmware[ATA_ID_FW_REV_LEN + 1];
93 unsigned char product[ATA_ID_PROD_LEN + 1];
94 u64 n_sectors;
95
96 /* Serial number */
97 ata_id_c_string(id, serial, ATA_ID_SERNO, sizeof(serial));
98 printf("S/N: %s\n\r", serial);
99
100 /* Firmware version */
101 ata_id_c_string(id, firmware, ATA_ID_FW_REV, sizeof(firmware));
102 printf("Firmware version: %s\n\r", firmware);
103
104 /* Product model */
105 ata_id_c_string(id, product, ATA_ID_PROD, sizeof(product));
106 printf("Product model number: %s\n\r", product);
107
108 /* Total sectors of device */
109 n_sectors = ata_id_n_sectors(id);
110 printf("Capablity: %lld sectors\n\r", n_sectors);
111
112 printf ("id[49]: capabilities = 0x%04x\n"
113 "id[53]: field valid = 0x%04x\n"
114 "id[63]: mwdma = 0x%04x\n"
115 "id[64]: pio = 0x%04x\n"
116 "id[75]: queue depth = 0x%04x\n",
117 id[49],
118 id[53],
119 id[63],
120 id[64],
121 id[75]);
122
123 printf ("id[76]: sata capablity = 0x%04x\n"
124 "id[78]: sata features supported = 0x%04x\n"
125 "id[79]: sata features enable = 0x%04x\n",
126 id[76],
127 id[78],
128 id[79]);
129
130 printf ("id[80]: major version = 0x%04x\n"
131 "id[81]: minor version = 0x%04x\n"
132 "id[82]: command set supported 1 = 0x%04x\n"
133 "id[83]: command set supported 2 = 0x%04x\n"
134 "id[84]: command set extension = 0x%04x\n",
135 id[80],
136 id[81],
137 id[82],
138 id[83],
139 id[84]);
140 printf ("id[85]: command set enable 1 = 0x%04x\n"
141 "id[86]: command set enable 2 = 0x%04x\n"
142 "id[87]: command set default = 0x%04x\n"
143 "id[88]: udma = 0x%04x\n"
144 "id[93]: hardware reset result = 0x%04x\n",
145 id[85],
146 id[86],
147 id[87],
148 id[88],
149 id[93]);
150 }
151
ata_swap_buf_le16(u16 * buf,unsigned int buf_words)152 void ata_swap_buf_le16(u16 *buf, unsigned int buf_words)
153 {
154 unsigned int i;
155
156 for (i = 0; i < buf_words; i++)
157 buf[i] = le16_to_cpu(buf[i]);
158 }
159