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