]> git.sur5r.net Git - u-boot/blob - drivers/ata/libata.c
dm: sata: dw_sata: Move exported functions to the end
[u-boot] / drivers / ata / libata.c
1 /*
2  * Copyright (C) 2008 Freescale Semiconductor, Inc.
3  *              Dave Liu <daveliu@freescale.com>
4  *              port from the libata of linux kernel
5  *
6  * SPDX-License-Identifier:     GPL-2.0+
7  */
8
9 #include <libata.h>
10
11 u64 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
23 u32 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
43 static 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
62 void 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
75 void 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);
96         printf("Capablity: %lld sectors\n\r", n_sectors);
97
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",
103                 id[49],
104                 id[53],
105                 id[63],
106                 id[64],
107                 id[75]);
108
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",
112                 id[76],
113                 id[78],
114                 id[79]);
115
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",
121                 id[80],
122                 id[81],
123                 id[82],
124                 id[83],
125                 id[84]);
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",
131                 id[85],
132                 id[86],
133                 id[87],
134                 id[88],
135                 id[93]);
136 }
137
138 void 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 }