2 * Copyright (C) 2008 Freescale Semiconductor, Inc.
3 * Dave Liu <daveliu@freescale.com>
4 * port from the libata of linux kernel
6 * SPDX-License-Identifier: GPL-2.0+
11 u64 ata_id_n_sectors(u16 *id)
13 if (ata_id_has_lba(id)) {
14 if (ata_id_has_lba48(id))
15 return ata_id_u64(id, ATA_ID_LBA48_SECTORS);
17 return ata_id_u32(id, ATA_ID_LBA_SECTORS);
23 u32 ata_dev_classify(u32 sig)
27 lbam = (sig >> 16) & 0xff;
28 lbah = (sig >> 24) & 0xff;
30 if (((lbam == 0) && (lbah == 0)) ||
31 ((lbam == 0x3c) && (lbah == 0xc3)))
34 if ((lbam == 0x14) && (lbah == 0xeb))
37 if ((lbam == 0x69) && (lbah == 0x96))
40 return ATA_DEV_UNKNOWN;
43 static void ata_id_string(const u16 *id, unsigned char *s,
44 unsigned int ofs, unsigned int len)
62 void ata_id_c_string(const u16 *id, unsigned char *s,
63 unsigned int ofs, unsigned int len)
67 ata_id_string(id, s, ofs, len - 1);
69 p = s + strnlen((char *)s, len - 1);
70 while (p > s && p[-1] == ' ')
75 void ata_dump_id(u16 *id)
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];
83 ata_id_c_string(id, serial, ATA_ID_SERNO, sizeof(serial));
84 printf("S/N: %s\n\r", serial);
86 /* Firmware version */
87 ata_id_c_string(id, firmware, ATA_ID_FW_REV, sizeof(firmware));
88 printf("Firmware version: %s\n\r", firmware);
91 ata_id_c_string(id, product, ATA_ID_PROD, sizeof(product));
92 printf("Product model number: %s\n\r", product);
94 /* Total sectors of device */
95 n_sectors = ata_id_n_sectors(id);
96 printf("Capablity: %lld sectors\n\r", n_sectors);
98 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",
109 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",
116 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",
126 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",
138 void ata_swap_buf_le16(u16 *buf, unsigned int buf_words)
142 for (i = 0; i < buf_words; i++)
143 buf[i] = le16_to_cpu(buf[i]);