← Back to branch summary

~ubuntu-branches/ubuntu/maverick/u-boot-omap3/maverick

« back to all changes in this revision

Viewing changes to drivers/block/libata.c

  • Committer: Bazaar Package Importer
  • Author(s): Oliver Grawert
  • Date: 2010-03-22 15:06:23 UTC
  • Revision ID: james.westby@ubuntu.com-20100322150623-i21g8rgiyl5dohag
Tags: upstream-2010.3git20100315
Import upstream version 2010.3git20100315

Show diffs side-by-side

added added

removed removed

Lines of Context:
drivers/block/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
 * 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
 
 
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
 
 
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
 
 
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
 
 
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
 
 
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
 
 
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
}