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