Eric Lee / linux-smarc-t335x-v3.2

Download as
Browse Code ยป

Commit 64aca22977c3cab5a7ec6f4348860f025943ff49

Authored by Eric Lee
1 parent def7279fa5
Exists in v3.2_SMARCT335xPSP_04.06.00.11

Upgrade eMMC from 4GB to 8GB

Showing 1 changed file with 1 additions and 1 deletions Inline Diff

drivers/mmc/core/mmc.c
Diff comments   View file @ 64aca22
1 /* 1 /*
2 * linux/drivers/mmc/core/mmc.c 2 * linux/drivers/mmc/core/mmc.c
3 * 3 *
4 * Copyright (C) 2003-2004 Russell King, All Rights Reserved. 4 * Copyright (C) 2003-2004 Russell King, All Rights Reserved.
5 * Copyright (C) 2005-2007 Pierre Ossman, All Rights Reserved. 5 * Copyright (C) 2005-2007 Pierre Ossman, All Rights Reserved.
6 * MMCv4 support Copyright (C) 2006 Philip Langdale, All Rights Reserved. 6 * MMCv4 support Copyright (C) 2006 Philip Langdale, All Rights Reserved.
7 * 7 *
8 * This program is free software; you can redistribute it and/or modify 8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as 9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation. 10 * published by the Free Software Foundation.
11 */ 11 */
12 12
13 #include <linux/err.h> 13 #include <linux/err.h>
14 #include <linux/slab.h> 14 #include <linux/slab.h>
15 #include <linux/stat.h> 15 #include <linux/stat.h>
16 16
17 #include <linux/mmc/host.h> 17 #include <linux/mmc/host.h>
18 #include <linux/mmc/card.h> 18 #include <linux/mmc/card.h>
19 #include <linux/mmc/mmc.h> 19 #include <linux/mmc/mmc.h>
20 20
21 #include "core.h" 21 #include "core.h"
22 #include "bus.h" 22 #include "bus.h"
23 #include "mmc_ops.h" 23 #include "mmc_ops.h"
24 #include "sd_ops.h" 24 #include "sd_ops.h"
25 25
26 static const unsigned int tran_exp[] = { 26 static const unsigned int tran_exp[] = {
27 10000, 100000, 1000000, 10000000, 27 10000, 100000, 1000000, 10000000,
28 0, 0, 0, 0 28 0, 0, 0, 0
29 }; 29 };
30 30
31 static const unsigned char tran_mant[] = { 31 static const unsigned char tran_mant[] = {
32 0, 10, 12, 13, 15, 20, 25, 30, 32 0, 10, 12, 13, 15, 20, 25, 30,
33 35, 40, 45, 50, 55, 60, 70, 80, 33 35, 40, 45, 50, 55, 60, 70, 80,
34 }; 34 };
35 35
36 static const unsigned int tacc_exp[] = { 36 static const unsigned int tacc_exp[] = {
37 1, 10, 100, 1000, 10000, 100000, 1000000, 10000000, 37 1, 10, 100, 1000, 10000, 100000, 1000000, 10000000,
38 }; 38 };
39 39
40 static const unsigned int tacc_mant[] = { 40 static const unsigned int tacc_mant[] = {
41 0, 10, 12, 13, 15, 20, 25, 30, 41 0, 10, 12, 13, 15, 20, 25, 30,
42 35, 40, 45, 50, 55, 60, 70, 80, 42 35, 40, 45, 50, 55, 60, 70, 80,
43 }; 43 };
44 44
45 #define UNSTUFF_BITS(resp,start,size) \ 45 #define UNSTUFF_BITS(resp,start,size) \
46 ({ \ 46 ({ \
47 const int __size = size; \ 47 const int __size = size; \
48 const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \ 48 const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \
49 const int __off = 3 - ((start) / 32); \ 49 const int __off = 3 - ((start) / 32); \
50 const int __shft = (start) & 31; \ 50 const int __shft = (start) & 31; \
51 u32 __res; \ 51 u32 __res; \
52 \ 52 \
53 __res = resp[__off] >> __shft; \ 53 __res = resp[__off] >> __shft; \
54 if (__size + __shft > 32) \ 54 if (__size + __shft > 32) \
55 __res |= resp[__off-1] << ((32 - __shft) % 32); \ 55 __res |= resp[__off-1] << ((32 - __shft) % 32); \
56 __res & __mask; \ 56 __res & __mask; \
57 }) 57 })
58 58
59 /* 59 /*
60 * Given the decoded CSD structure, decode the raw CID to our CID structure. 60 * Given the decoded CSD structure, decode the raw CID to our CID structure.
61 */ 61 */
62 static int mmc_decode_cid(struct mmc_card *card) 62 static int mmc_decode_cid(struct mmc_card *card)
63 { 63 {
64 u32 *resp = card->raw_cid; 64 u32 *resp = card->raw_cid;
65 65
66 /* 66 /*
67 * The selection of the format here is based upon published 67 * The selection of the format here is based upon published
68 * specs from sandisk and from what people have reported. 68 * specs from sandisk and from what people have reported.
69 */ 69 */
70 switch (card->csd.mmca_vsn) { 70 switch (card->csd.mmca_vsn) {
71 case 0: /* MMC v1.0 - v1.2 */ 71 case 0: /* MMC v1.0 - v1.2 */
72 case 1: /* MMC v1.4 */ 72 case 1: /* MMC v1.4 */
73 card->cid.manfid = UNSTUFF_BITS(resp, 104, 24); 73 card->cid.manfid = UNSTUFF_BITS(resp, 104, 24);
74 card->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8); 74 card->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8);
75 card->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8); 75 card->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8);
76 card->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8); 76 card->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8);
77 card->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8); 77 card->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8);
78 card->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8); 78 card->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8);
79 card->cid.prod_name[5] = UNSTUFF_BITS(resp, 56, 8); 79 card->cid.prod_name[5] = UNSTUFF_BITS(resp, 56, 8);
80 card->cid.prod_name[6] = UNSTUFF_BITS(resp, 48, 8); 80 card->cid.prod_name[6] = UNSTUFF_BITS(resp, 48, 8);
81 card->cid.hwrev = UNSTUFF_BITS(resp, 44, 4); 81 card->cid.hwrev = UNSTUFF_BITS(resp, 44, 4);
82 card->cid.fwrev = UNSTUFF_BITS(resp, 40, 4); 82 card->cid.fwrev = UNSTUFF_BITS(resp, 40, 4);
83 card->cid.serial = UNSTUFF_BITS(resp, 16, 24); 83 card->cid.serial = UNSTUFF_BITS(resp, 16, 24);
84 card->cid.month = UNSTUFF_BITS(resp, 12, 4); 84 card->cid.month = UNSTUFF_BITS(resp, 12, 4);
85 card->cid.year = UNSTUFF_BITS(resp, 8, 4) + 1997; 85 card->cid.year = UNSTUFF_BITS(resp, 8, 4) + 1997;
86 break; 86 break;
87 87
88 case 2: /* MMC v2.0 - v2.2 */ 88 case 2: /* MMC v2.0 - v2.2 */
89 case 3: /* MMC v3.1 - v3.3 */ 89 case 3: /* MMC v3.1 - v3.3 */
90 case 4: /* MMC v4 */ 90 case 4: /* MMC v4 */
91 card->cid.manfid = UNSTUFF_BITS(resp, 120, 8); 91 card->cid.manfid = UNSTUFF_BITS(resp, 120, 8);
92 card->cid.oemid = UNSTUFF_BITS(resp, 104, 16); 92 card->cid.oemid = UNSTUFF_BITS(resp, 104, 16);
93 card->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8); 93 card->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8);
94 card->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8); 94 card->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8);
95 card->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8); 95 card->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8);
96 card->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8); 96 card->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8);
97 card->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8); 97 card->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8);
98 card->cid.prod_name[5] = UNSTUFF_BITS(resp, 56, 8); 98 card->cid.prod_name[5] = UNSTUFF_BITS(resp, 56, 8);
99 card->cid.serial = UNSTUFF_BITS(resp, 16, 32); 99 card->cid.serial = UNSTUFF_BITS(resp, 16, 32);
100 card->cid.month = UNSTUFF_BITS(resp, 12, 4); 100 card->cid.month = UNSTUFF_BITS(resp, 12, 4);
101 card->cid.year = UNSTUFF_BITS(resp, 8, 4) + 1997; 101 card->cid.year = UNSTUFF_BITS(resp, 8, 4) + 1997;
102 break; 102 break;
103 103
104 default: 104 default:
105 pr_err("%s: card has unknown MMCA version %d\n", 105 pr_err("%s: card has unknown MMCA version %d\n",
106 mmc_hostname(card->host), card->csd.mmca_vsn); 106 mmc_hostname(card->host), card->csd.mmca_vsn);
107 return -EINVAL; 107 return -EINVAL;
108 } 108 }
109 109
110 return 0; 110 return 0;
111 } 111 }
112 112
113 static void mmc_set_erase_size(struct mmc_card *card) 113 static void mmc_set_erase_size(struct mmc_card *card)
114 { 114 {
115 if (card->ext_csd.erase_group_def & 1) 115 if (card->ext_csd.erase_group_def & 1)
116 card->erase_size = card->ext_csd.hc_erase_size; 116 card->erase_size = card->ext_csd.hc_erase_size;
117 else 117 else
118 card->erase_size = card->csd.erase_size; 118 card->erase_size = card->csd.erase_size;
119 119
120 mmc_init_erase(card); 120 mmc_init_erase(card);
121 } 121 }
122 122
123 /* 123 /*
124 * Given a 128-bit response, decode to our card CSD structure. 124 * Given a 128-bit response, decode to our card CSD structure.
125 */ 125 */
126 static int mmc_decode_csd(struct mmc_card *card) 126 static int mmc_decode_csd(struct mmc_card *card)
127 { 127 {
128 struct mmc_csd *csd = &card->csd; 128 struct mmc_csd *csd = &card->csd;
129 unsigned int e, m, a, b; 129 unsigned int e, m, a, b;
130 u32 *resp = card->raw_csd; 130 u32 *resp = card->raw_csd;
131 131
132 /* 132 /*
133 * We only understand CSD structure v1.1 and v1.2. 133 * We only understand CSD structure v1.1 and v1.2.
134 * v1.2 has extra information in bits 15, 11 and 10. 134 * v1.2 has extra information in bits 15, 11 and 10.
135 * We also support eMMC v4.4 & v4.41. 135 * We also support eMMC v4.4 & v4.41.
136 */ 136 */
137 csd->structure = UNSTUFF_BITS(resp, 126, 2); 137 csd->structure = UNSTUFF_BITS(resp, 126, 2);
138 if (csd->structure == 0) { 138 if (csd->structure == 0) {
139 pr_err("%s: unrecognised CSD structure version %d\n", 139 pr_err("%s: unrecognised CSD structure version %d\n",
140 mmc_hostname(card->host), csd->structure); 140 mmc_hostname(card->host), csd->structure);
141 return -EINVAL; 141 return -EINVAL;
142 } 142 }
143 143
144 csd->mmca_vsn = UNSTUFF_BITS(resp, 122, 4); 144 csd->mmca_vsn = UNSTUFF_BITS(resp, 122, 4);
145 m = UNSTUFF_BITS(resp, 115, 4); 145 m = UNSTUFF_BITS(resp, 115, 4);
146 e = UNSTUFF_BITS(resp, 112, 3); 146 e = UNSTUFF_BITS(resp, 112, 3);
147 csd->tacc_ns = (tacc_exp[e] * tacc_mant[m] + 9) / 10; 147 csd->tacc_ns = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
148 csd->tacc_clks = UNSTUFF_BITS(resp, 104, 8) * 100; 148 csd->tacc_clks = UNSTUFF_BITS(resp, 104, 8) * 100;
149 149
150 m = UNSTUFF_BITS(resp, 99, 4); 150 m = UNSTUFF_BITS(resp, 99, 4);
151 e = UNSTUFF_BITS(resp, 96, 3); 151 e = UNSTUFF_BITS(resp, 96, 3);
152 csd->max_dtr = tran_exp[e] * tran_mant[m]; 152 csd->max_dtr = tran_exp[e] * tran_mant[m];
153 csd->cmdclass = UNSTUFF_BITS(resp, 84, 12); 153 csd->cmdclass = UNSTUFF_BITS(resp, 84, 12);
154 154
155 e = UNSTUFF_BITS(resp, 47, 3); 155 e = UNSTUFF_BITS(resp, 47, 3);
156 m = UNSTUFF_BITS(resp, 62, 12); 156 m = UNSTUFF_BITS(resp, 62, 12);
157 csd->capacity = (1 + m) << (e + 2); 157 csd->capacity = (1 + m) << (e + 2);
158 158
159 csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4); 159 csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
160 csd->read_partial = UNSTUFF_BITS(resp, 79, 1); 160 csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
161 csd->write_misalign = UNSTUFF_BITS(resp, 78, 1); 161 csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
162 csd->read_misalign = UNSTUFF_BITS(resp, 77, 1); 162 csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
163 csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3); 163 csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
164 csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4); 164 csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
165 csd->write_partial = UNSTUFF_BITS(resp, 21, 1); 165 csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
166 166
167 if (csd->write_blkbits >= 9) { 167 if (csd->write_blkbits >= 9) {
168 a = UNSTUFF_BITS(resp, 42, 5); 168 a = UNSTUFF_BITS(resp, 42, 5);
169 b = UNSTUFF_BITS(resp, 37, 5); 169 b = UNSTUFF_BITS(resp, 37, 5);
170 csd->erase_size = (a + 1) * (b + 1); 170 csd->erase_size = (a + 1) * (b + 1);
171 csd->erase_size <<= csd->write_blkbits - 9; 171 csd->erase_size <<= csd->write_blkbits - 9;
172 } 172 }
173 173
174 return 0; 174 return 0;
175 } 175 }
176 176
177 /* 177 /*
178 * Read extended CSD. 178 * Read extended CSD.
179 */ 179 */
180 static int mmc_get_ext_csd(struct mmc_card *card, u8 **new_ext_csd) 180 static int mmc_get_ext_csd(struct mmc_card *card, u8 **new_ext_csd)
181 { 181 {
182 int err; 182 int err;
183 u8 *ext_csd; 183 u8 *ext_csd;
184 184
185 BUG_ON(!card); 185 BUG_ON(!card);
186 BUG_ON(!new_ext_csd); 186 BUG_ON(!new_ext_csd);
187 187
188 *new_ext_csd = NULL; 188 *new_ext_csd = NULL;
189 189
190 if (card->csd.mmca_vsn < CSD_SPEC_VER_4) 190 if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
191 return 0; 191 return 0;
192 192
193 /* 193 /*
194 * As the ext_csd is so large and mostly unused, we don't store the 194 * As the ext_csd is so large and mostly unused, we don't store the
195 * raw block in mmc_card. 195 * raw block in mmc_card.
196 */ 196 */
197 ext_csd = kmalloc(512, GFP_KERNEL); 197 ext_csd = kmalloc(512, GFP_KERNEL);
198 if (!ext_csd) { 198 if (!ext_csd) {
199 pr_err("%s: could not allocate a buffer to " 199 pr_err("%s: could not allocate a buffer to "
200 "receive the ext_csd.\n", mmc_hostname(card->host)); 200 "receive the ext_csd.\n", mmc_hostname(card->host));
201 return -ENOMEM; 201 return -ENOMEM;
202 } 202 }
203 203
204 err = mmc_send_ext_csd(card, ext_csd); 204 err = mmc_send_ext_csd(card, ext_csd);
205 if (err) { 205 if (err) {
206 kfree(ext_csd); 206 kfree(ext_csd);
207 *new_ext_csd = NULL; 207 *new_ext_csd = NULL;
208 208
209 /* If the host or the card can't do the switch, 209 /* If the host or the card can't do the switch,
210 * fail more gracefully. */ 210 * fail more gracefully. */
211 if ((err != -EINVAL) 211 if ((err != -EINVAL)
212 && (err != -ENOSYS) 212 && (err != -ENOSYS)
213 && (err != -EFAULT)) 213 && (err != -EFAULT))
214 return err; 214 return err;
215 215
216 /* 216 /*
217 * High capacity cards should have this "magic" size 217 * High capacity cards should have this "magic" size
218 * stored in their CSD. 218 * stored in their CSD.
219 */ 219 */
220 if (card->csd.capacity == (4096 * 512)) { 220 if (card->csd.capacity == (4096 * 512)) {
221 pr_err("%s: unable to read EXT_CSD " 221 pr_err("%s: unable to read EXT_CSD "
222 "on a possible high capacity card. " 222 "on a possible high capacity card. "
223 "Card will be ignored.\n", 223 "Card will be ignored.\n",
224 mmc_hostname(card->host)); 224 mmc_hostname(card->host));
225 } else { 225 } else {
226 pr_warning("%s: unable to read " 226 pr_warning("%s: unable to read "
227 "EXT_CSD, performance might " 227 "EXT_CSD, performance might "
228 "suffer.\n", 228 "suffer.\n",
229 mmc_hostname(card->host)); 229 mmc_hostname(card->host));
230 err = 0; 230 err = 0;
231 } 231 }
232 } else 232 } else
233 *new_ext_csd = ext_csd; 233 *new_ext_csd = ext_csd;
234 234
235 return err; 235 return err;
236 } 236 }
237 237
238 /* 238 /*
239 * Decode extended CSD. 239 * Decode extended CSD.
240 */ 240 */
241 static int mmc_read_ext_csd(struct mmc_card *card, u8 *ext_csd) 241 static int mmc_read_ext_csd(struct mmc_card *card, u8 *ext_csd)
242 { 242 {
243 int err = 0, idx; 243 int err = 0, idx;
244 unsigned int part_size; 244 unsigned int part_size;
245 u8 hc_erase_grp_sz = 0, hc_wp_grp_sz = 0; 245 u8 hc_erase_grp_sz = 0, hc_wp_grp_sz = 0;
246 246
247 BUG_ON(!card); 247 BUG_ON(!card);
248 248
249 if (!ext_csd) 249 if (!ext_csd)
250 return 0; 250 return 0;
251 251
252 /* Version is coded in the CSD_STRUCTURE byte in the EXT_CSD register */ 252 /* Version is coded in the CSD_STRUCTURE byte in the EXT_CSD register */
253 card->ext_csd.raw_ext_csd_structure = ext_csd[EXT_CSD_STRUCTURE]; 253 card->ext_csd.raw_ext_csd_structure = ext_csd[EXT_CSD_STRUCTURE];
254 if (card->csd.structure == 3) { 254 if (card->csd.structure == 3) {
255 if (card->ext_csd.raw_ext_csd_structure > 2) { 255 if (card->ext_csd.raw_ext_csd_structure > 2) {
256 pr_err("%s: unrecognised EXT_CSD structure " 256 pr_err("%s: unrecognised EXT_CSD structure "
257 "version %d\n", mmc_hostname(card->host), 257 "version %d\n", mmc_hostname(card->host),
258 card->ext_csd.raw_ext_csd_structure); 258 card->ext_csd.raw_ext_csd_structure);
259 err = -EINVAL; 259 err = -EINVAL;
260 goto out; 260 goto out;
261 } 261 }
262 } 262 }
263 263
264 card->ext_csd.rev = ext_csd[EXT_CSD_REV]; 264 card->ext_csd.rev = ext_csd[EXT_CSD_REV];
265 if (card->ext_csd.rev > 7) { 265 if (card->ext_csd.rev > 8) {
266 pr_err("%s: unrecognised EXT_CSD revision %d\n", 266 pr_err("%s: unrecognised EXT_CSD revision %d\n",
267 mmc_hostname(card->host), card->ext_csd.rev); 267 mmc_hostname(card->host), card->ext_csd.rev);
268 err = -EINVAL; 268 err = -EINVAL;
269 goto out; 269 goto out;
270 } 270 }
271 271
272 card->ext_csd.raw_sectors[0] = ext_csd[EXT_CSD_SEC_CNT + 0]; 272 card->ext_csd.raw_sectors[0] = ext_csd[EXT_CSD_SEC_CNT + 0];
273 card->ext_csd.raw_sectors[1] = ext_csd[EXT_CSD_SEC_CNT + 1]; 273 card->ext_csd.raw_sectors[1] = ext_csd[EXT_CSD_SEC_CNT + 1];
274 card->ext_csd.raw_sectors[2] = ext_csd[EXT_CSD_SEC_CNT + 2]; 274 card->ext_csd.raw_sectors[2] = ext_csd[EXT_CSD_SEC_CNT + 2];
275 card->ext_csd.raw_sectors[3] = ext_csd[EXT_CSD_SEC_CNT + 3]; 275 card->ext_csd.raw_sectors[3] = ext_csd[EXT_CSD_SEC_CNT + 3];
276 if (card->ext_csd.rev >= 2) { 276 if (card->ext_csd.rev >= 2) {
277 card->ext_csd.sectors = 277 card->ext_csd.sectors =
278 ext_csd[EXT_CSD_SEC_CNT + 0] << 0 | 278 ext_csd[EXT_CSD_SEC_CNT + 0] << 0 |
279 ext_csd[EXT_CSD_SEC_CNT + 1] << 8 | 279 ext_csd[EXT_CSD_SEC_CNT + 1] << 8 |
280 ext_csd[EXT_CSD_SEC_CNT + 2] << 16 | 280 ext_csd[EXT_CSD_SEC_CNT + 2] << 16 |
281 ext_csd[EXT_CSD_SEC_CNT + 3] << 24; 281 ext_csd[EXT_CSD_SEC_CNT + 3] << 24;
282 282
283 /* Cards with density > 2GiB are sector addressed */ 283 /* Cards with density > 2GiB are sector addressed */
284 if (card->ext_csd.sectors > (2u * 1024 * 1024 * 1024) / 512) 284 if (card->ext_csd.sectors > (2u * 1024 * 1024 * 1024) / 512)
285 mmc_card_set_blockaddr(card); 285 mmc_card_set_blockaddr(card);
286 } 286 }
287 card->ext_csd.raw_card_type = ext_csd[EXT_CSD_CARD_TYPE]; 287 card->ext_csd.raw_card_type = ext_csd[EXT_CSD_CARD_TYPE];
288 switch (ext_csd[EXT_CSD_CARD_TYPE] & EXT_CSD_CARD_TYPE_MASK) { 288 switch (ext_csd[EXT_CSD_CARD_TYPE] & EXT_CSD_CARD_TYPE_MASK) {
289 case EXT_CSD_CARD_TYPE_DDR_52 | EXT_CSD_CARD_TYPE_52 | 289 case EXT_CSD_CARD_TYPE_DDR_52 | EXT_CSD_CARD_TYPE_52 |
290 EXT_CSD_CARD_TYPE_26: 290 EXT_CSD_CARD_TYPE_26:
291 card->ext_csd.hs_max_dtr = 52000000; 291 card->ext_csd.hs_max_dtr = 52000000;
292 card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_52; 292 card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_52;
293 break; 293 break;
294 case EXT_CSD_CARD_TYPE_DDR_1_2V | EXT_CSD_CARD_TYPE_52 | 294 case EXT_CSD_CARD_TYPE_DDR_1_2V | EXT_CSD_CARD_TYPE_52 |
295 EXT_CSD_CARD_TYPE_26: 295 EXT_CSD_CARD_TYPE_26:
296 card->ext_csd.hs_max_dtr = 52000000; 296 card->ext_csd.hs_max_dtr = 52000000;
297 card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_1_2V; 297 card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_1_2V;
298 break; 298 break;
299 case EXT_CSD_CARD_TYPE_DDR_1_8V | EXT_CSD_CARD_TYPE_52 | 299 case EXT_CSD_CARD_TYPE_DDR_1_8V | EXT_CSD_CARD_TYPE_52 |
300 EXT_CSD_CARD_TYPE_26: 300 EXT_CSD_CARD_TYPE_26:
301 card->ext_csd.hs_max_dtr = 52000000; 301 card->ext_csd.hs_max_dtr = 52000000;
302 card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_1_8V; 302 card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_1_8V;
303 break; 303 break;
304 case EXT_CSD_CARD_TYPE_52 | EXT_CSD_CARD_TYPE_26: 304 case EXT_CSD_CARD_TYPE_52 | EXT_CSD_CARD_TYPE_26:
305 card->ext_csd.hs_max_dtr = 52000000; 305 card->ext_csd.hs_max_dtr = 52000000;
306 break; 306 break;
307 case EXT_CSD_CARD_TYPE_26: 307 case EXT_CSD_CARD_TYPE_26:
308 card->ext_csd.hs_max_dtr = 26000000; 308 card->ext_csd.hs_max_dtr = 26000000;
309 break; 309 break;
310 default: 310 default:
311 /* MMC v4 spec says this cannot happen */ 311 /* MMC v4 spec says this cannot happen */
312 pr_warning("%s: card is mmc v4 but doesn't " 312 pr_warning("%s: card is mmc v4 but doesn't "
313 "support any high-speed modes.\n", 313 "support any high-speed modes.\n",
314 mmc_hostname(card->host)); 314 mmc_hostname(card->host));
315 } 315 }
316 316
317 card->ext_csd.raw_s_a_timeout = ext_csd[EXT_CSD_S_A_TIMEOUT]; 317 card->ext_csd.raw_s_a_timeout = ext_csd[EXT_CSD_S_A_TIMEOUT];
318 card->ext_csd.raw_erase_timeout_mult = 318 card->ext_csd.raw_erase_timeout_mult =
319 ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT]; 319 ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT];
320 card->ext_csd.raw_hc_erase_grp_size = 320 card->ext_csd.raw_hc_erase_grp_size =
321 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]; 321 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
322 if (card->ext_csd.rev >= 3) { 322 if (card->ext_csd.rev >= 3) {
323 u8 sa_shift = ext_csd[EXT_CSD_S_A_TIMEOUT]; 323 u8 sa_shift = ext_csd[EXT_CSD_S_A_TIMEOUT];
324 card->ext_csd.part_config = ext_csd[EXT_CSD_PART_CONFIG]; 324 card->ext_csd.part_config = ext_csd[EXT_CSD_PART_CONFIG];
325 325
326 /* EXT_CSD value is in units of 10ms, but we store in ms */ 326 /* EXT_CSD value is in units of 10ms, but we store in ms */
327 card->ext_csd.part_time = 10 * ext_csd[EXT_CSD_PART_SWITCH_TIME]; 327 card->ext_csd.part_time = 10 * ext_csd[EXT_CSD_PART_SWITCH_TIME];
328 328
329 /* Sleep / awake timeout in 100ns units */ 329 /* Sleep / awake timeout in 100ns units */
330 if (sa_shift > 0 && sa_shift <= 0x17) 330 if (sa_shift > 0 && sa_shift <= 0x17)
331 card->ext_csd.sa_timeout = 331 card->ext_csd.sa_timeout =
332 1 << ext_csd[EXT_CSD_S_A_TIMEOUT]; 332 1 << ext_csd[EXT_CSD_S_A_TIMEOUT];
333 card->ext_csd.erase_group_def = 333 card->ext_csd.erase_group_def =
334 ext_csd[EXT_CSD_ERASE_GROUP_DEF]; 334 ext_csd[EXT_CSD_ERASE_GROUP_DEF];
335 card->ext_csd.hc_erase_timeout = 300 * 335 card->ext_csd.hc_erase_timeout = 300 *
336 ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT]; 336 ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT];
337 card->ext_csd.hc_erase_size = 337 card->ext_csd.hc_erase_size =
338 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] << 10; 338 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] << 10;
339 339
340 card->ext_csd.rel_sectors = ext_csd[EXT_CSD_REL_WR_SEC_C]; 340 card->ext_csd.rel_sectors = ext_csd[EXT_CSD_REL_WR_SEC_C];
341 341
342 /* 342 /*
343 * There are two boot regions of equal size, defined in 343 * There are two boot regions of equal size, defined in
344 * multiples of 128K. 344 * multiples of 128K.
345 */ 345 */
346 if (ext_csd[EXT_CSD_BOOT_MULT] && mmc_boot_partition_access(card->host)) { 346 if (ext_csd[EXT_CSD_BOOT_MULT] && mmc_boot_partition_access(card->host)) {
347 for (idx = 0; idx < MMC_NUM_BOOT_PARTITION; idx++) { 347 for (idx = 0; idx < MMC_NUM_BOOT_PARTITION; idx++) {
348 part_size = ext_csd[EXT_CSD_BOOT_MULT] << 17; 348 part_size = ext_csd[EXT_CSD_BOOT_MULT] << 17;
349 mmc_part_add(card, part_size, 349 mmc_part_add(card, part_size,
350 EXT_CSD_PART_CONFIG_ACC_BOOT0 + idx, 350 EXT_CSD_PART_CONFIG_ACC_BOOT0 + idx,
351 "boot%d", idx, true); 351 "boot%d", idx, true);
352 } 352 }
353 } 353 }
354 } 354 }
355 355
356 card->ext_csd.raw_hc_erase_gap_size = 356 card->ext_csd.raw_hc_erase_gap_size =
357 ext_csd[EXT_CSD_PARTITION_ATTRIBUTE]; 357 ext_csd[EXT_CSD_PARTITION_ATTRIBUTE];
358 card->ext_csd.raw_sec_trim_mult = 358 card->ext_csd.raw_sec_trim_mult =
359 ext_csd[EXT_CSD_SEC_TRIM_MULT]; 359 ext_csd[EXT_CSD_SEC_TRIM_MULT];
360 card->ext_csd.raw_sec_erase_mult = 360 card->ext_csd.raw_sec_erase_mult =
361 ext_csd[EXT_CSD_SEC_ERASE_MULT]; 361 ext_csd[EXT_CSD_SEC_ERASE_MULT];
362 card->ext_csd.raw_sec_feature_support = 362 card->ext_csd.raw_sec_feature_support =
363 ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT]; 363 ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT];
364 card->ext_csd.raw_trim_mult = 364 card->ext_csd.raw_trim_mult =
365 ext_csd[EXT_CSD_TRIM_MULT]; 365 ext_csd[EXT_CSD_TRIM_MULT];
366 if (card->ext_csd.rev >= 4) { 366 if (card->ext_csd.rev >= 4) {
367 /* 367 /*
368 * Enhanced area feature support -- check whether the eMMC 368 * Enhanced area feature support -- check whether the eMMC
369 * card has the Enhanced area enabled. If so, export enhanced 369 * card has the Enhanced area enabled. If so, export enhanced
370 * area offset and size to user by adding sysfs interface. 370 * area offset and size to user by adding sysfs interface.
371 */ 371 */
372 card->ext_csd.raw_partition_support = ext_csd[EXT_CSD_PARTITION_SUPPORT]; 372 card->ext_csd.raw_partition_support = ext_csd[EXT_CSD_PARTITION_SUPPORT];
373 if ((ext_csd[EXT_CSD_PARTITION_SUPPORT] & 0x2) && 373 if ((ext_csd[EXT_CSD_PARTITION_SUPPORT] & 0x2) &&
374 (ext_csd[EXT_CSD_PARTITION_ATTRIBUTE] & 0x1)) { 374 (ext_csd[EXT_CSD_PARTITION_ATTRIBUTE] & 0x1)) {
375 hc_erase_grp_sz = 375 hc_erase_grp_sz =
376 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]; 376 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
377 hc_wp_grp_sz = 377 hc_wp_grp_sz =
378 ext_csd[EXT_CSD_HC_WP_GRP_SIZE]; 378 ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
379 379
380 card->ext_csd.enhanced_area_en = 1; 380 card->ext_csd.enhanced_area_en = 1;
381 /* 381 /*
382 * calculate the enhanced data area offset, in bytes 382 * calculate the enhanced data area offset, in bytes
383 */ 383 */
384 card->ext_csd.enhanced_area_offset = 384 card->ext_csd.enhanced_area_offset =
385 (ext_csd[139] << 24) + (ext_csd[138] << 16) + 385 (ext_csd[139] << 24) + (ext_csd[138] << 16) +
386 (ext_csd[137] << 8) + ext_csd[136]; 386 (ext_csd[137] << 8) + ext_csd[136];
387 if (mmc_card_blockaddr(card)) 387 if (mmc_card_blockaddr(card))
388 card->ext_csd.enhanced_area_offset <<= 9; 388 card->ext_csd.enhanced_area_offset <<= 9;
389 /* 389 /*
390 * calculate the enhanced data area size, in kilobytes 390 * calculate the enhanced data area size, in kilobytes
391 */ 391 */
392 card->ext_csd.enhanced_area_size = 392 card->ext_csd.enhanced_area_size =
393 (ext_csd[142] << 16) + (ext_csd[141] << 8) + 393 (ext_csd[142] << 16) + (ext_csd[141] << 8) +
394 ext_csd[140]; 394 ext_csd[140];
395 card->ext_csd.enhanced_area_size *= 395 card->ext_csd.enhanced_area_size *=
396 (size_t)(hc_erase_grp_sz * hc_wp_grp_sz); 396 (size_t)(hc_erase_grp_sz * hc_wp_grp_sz);
397 card->ext_csd.enhanced_area_size <<= 9; 397 card->ext_csd.enhanced_area_size <<= 9;
398 } else { 398 } else {
399 /* 399 /*
400 * If the enhanced area is not enabled, disable these 400 * If the enhanced area is not enabled, disable these
401 * device attributes. 401 * device attributes.
402 */ 402 */
403 card->ext_csd.enhanced_area_offset = -EINVAL; 403 card->ext_csd.enhanced_area_offset = -EINVAL;
404 card->ext_csd.enhanced_area_size = -EINVAL; 404 card->ext_csd.enhanced_area_size = -EINVAL;
405 } 405 }
406 406
407 /* 407 /*
408 * General purpose partition feature support -- 408 * General purpose partition feature support --
409 * If ext_csd has the size of general purpose partitions, 409 * If ext_csd has the size of general purpose partitions,
410 * set size, part_cfg, partition name in mmc_part. 410 * set size, part_cfg, partition name in mmc_part.
411 */ 411 */
412 if (ext_csd[EXT_CSD_PARTITION_SUPPORT] & 412 if (ext_csd[EXT_CSD_PARTITION_SUPPORT] &
413 EXT_CSD_PART_SUPPORT_PART_EN) { 413 EXT_CSD_PART_SUPPORT_PART_EN) {
414 if (card->ext_csd.enhanced_area_en != 1) { 414 if (card->ext_csd.enhanced_area_en != 1) {
415 hc_erase_grp_sz = 415 hc_erase_grp_sz =
416 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]; 416 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
417 hc_wp_grp_sz = 417 hc_wp_grp_sz =
418 ext_csd[EXT_CSD_HC_WP_GRP_SIZE]; 418 ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
419 419
420 card->ext_csd.enhanced_area_en = 1; 420 card->ext_csd.enhanced_area_en = 1;
421 } 421 }
422 422
423 for (idx = 0; idx < MMC_NUM_GP_PARTITION; idx++) { 423 for (idx = 0; idx < MMC_NUM_GP_PARTITION; idx++) {
424 if (!ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3] && 424 if (!ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3] &&
425 !ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1] && 425 !ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1] &&
426 !ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2]) 426 !ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2])
427 continue; 427 continue;
428 part_size = 428 part_size =
429 (ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2] 429 (ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2]
430 << 16) + 430 << 16) +
431 (ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1] 431 (ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1]
432 << 8) + 432 << 8) +
433 ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3]; 433 ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3];
434 part_size *= (size_t)(hc_erase_grp_sz * 434 part_size *= (size_t)(hc_erase_grp_sz *
435 hc_wp_grp_sz); 435 hc_wp_grp_sz);
436 mmc_part_add(card, part_size << 19, 436 mmc_part_add(card, part_size << 19,
437 EXT_CSD_PART_CONFIG_ACC_GP0 + idx, 437 EXT_CSD_PART_CONFIG_ACC_GP0 + idx,
438 "gp%d", idx, false); 438 "gp%d", idx, false);
439 } 439 }
440 } 440 }
441 card->ext_csd.sec_trim_mult = 441 card->ext_csd.sec_trim_mult =
442 ext_csd[EXT_CSD_SEC_TRIM_MULT]; 442 ext_csd[EXT_CSD_SEC_TRIM_MULT];
443 card->ext_csd.sec_erase_mult = 443 card->ext_csd.sec_erase_mult =
444 ext_csd[EXT_CSD_SEC_ERASE_MULT]; 444 ext_csd[EXT_CSD_SEC_ERASE_MULT];
445 card->ext_csd.sec_feature_support = 445 card->ext_csd.sec_feature_support =
446 ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT]; 446 ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT];
447 card->ext_csd.trim_timeout = 300 * 447 card->ext_csd.trim_timeout = 300 *
448 ext_csd[EXT_CSD_TRIM_MULT]; 448 ext_csd[EXT_CSD_TRIM_MULT];
449 } 449 }
450 450
451 if (card->ext_csd.rev >= 5) { 451 if (card->ext_csd.rev >= 5) {
452 /* check whether the eMMC card supports HPI */ 452 /* check whether the eMMC card supports HPI */
453 if (ext_csd[EXT_CSD_HPI_FEATURES] & 0x1) { 453 if (ext_csd[EXT_CSD_HPI_FEATURES] & 0x1) {
454 card->ext_csd.hpi = 1; 454 card->ext_csd.hpi = 1;
455 if (ext_csd[EXT_CSD_HPI_FEATURES] & 0x2) 455 if (ext_csd[EXT_CSD_HPI_FEATURES] & 0x2)
456 card->ext_csd.hpi_cmd = MMC_STOP_TRANSMISSION; 456 card->ext_csd.hpi_cmd = MMC_STOP_TRANSMISSION;
457 else 457 else
458 card->ext_csd.hpi_cmd = MMC_SEND_STATUS; 458 card->ext_csd.hpi_cmd = MMC_SEND_STATUS;
459 /* 459 /*
460 * Indicate the maximum timeout to close 460 * Indicate the maximum timeout to close
461 * a command interrupted by HPI 461 * a command interrupted by HPI
462 */ 462 */
463 card->ext_csd.out_of_int_time = 463 card->ext_csd.out_of_int_time =
464 ext_csd[EXT_CSD_OUT_OF_INTERRUPT_TIME] * 10; 464 ext_csd[EXT_CSD_OUT_OF_INTERRUPT_TIME] * 10;
465 } 465 }
466 466
467 card->ext_csd.rel_param = ext_csd[EXT_CSD_WR_REL_PARAM]; 467 card->ext_csd.rel_param = ext_csd[EXT_CSD_WR_REL_PARAM];
468 card->ext_csd.rst_n_function = ext_csd[EXT_CSD_RST_N_FUNCTION]; 468 card->ext_csd.rst_n_function = ext_csd[EXT_CSD_RST_N_FUNCTION];
469 } 469 }
470 470
471 card->ext_csd.raw_erased_mem_count = ext_csd[EXT_CSD_ERASED_MEM_CONT]; 471 card->ext_csd.raw_erased_mem_count = ext_csd[EXT_CSD_ERASED_MEM_CONT];
472 if (ext_csd[EXT_CSD_ERASED_MEM_CONT]) 472 if (ext_csd[EXT_CSD_ERASED_MEM_CONT])
473 card->erased_byte = 0xFF; 473 card->erased_byte = 0xFF;
474 else 474 else
475 card->erased_byte = 0x0; 475 card->erased_byte = 0x0;
476 476
477 /* eMMC v4.5 or later */ 477 /* eMMC v4.5 or later */
478 if (card->ext_csd.rev >= 6) { 478 if (card->ext_csd.rev >= 6) {
479 card->ext_csd.feature_support |= MMC_DISCARD_FEATURE; 479 card->ext_csd.feature_support |= MMC_DISCARD_FEATURE;
480 480
481 card->ext_csd.generic_cmd6_time = 10 * 481 card->ext_csd.generic_cmd6_time = 10 *
482 ext_csd[EXT_CSD_GENERIC_CMD6_TIME]; 482 ext_csd[EXT_CSD_GENERIC_CMD6_TIME];
483 card->ext_csd.power_off_longtime = 10 * 483 card->ext_csd.power_off_longtime = 10 *
484 ext_csd[EXT_CSD_POWER_OFF_LONG_TIME]; 484 ext_csd[EXT_CSD_POWER_OFF_LONG_TIME];
485 485
486 card->ext_csd.cache_size = 486 card->ext_csd.cache_size =
487 ext_csd[EXT_CSD_CACHE_SIZE + 0] << 0 | 487 ext_csd[EXT_CSD_CACHE_SIZE + 0] << 0 |
488 ext_csd[EXT_CSD_CACHE_SIZE + 1] << 8 | 488 ext_csd[EXT_CSD_CACHE_SIZE + 1] << 8 |
489 ext_csd[EXT_CSD_CACHE_SIZE + 2] << 16 | 489 ext_csd[EXT_CSD_CACHE_SIZE + 2] << 16 |
490 ext_csd[EXT_CSD_CACHE_SIZE + 3] << 24; 490 ext_csd[EXT_CSD_CACHE_SIZE + 3] << 24;
491 } 491 }
492 492
493 out: 493 out:
494 return err; 494 return err;
495 } 495 }
496 496
497 static inline void mmc_free_ext_csd(u8 *ext_csd) 497 static inline void mmc_free_ext_csd(u8 *ext_csd)
498 { 498 {
499 kfree(ext_csd); 499 kfree(ext_csd);
500 } 500 }
501 501
502 502
503 static int mmc_compare_ext_csds(struct mmc_card *card, unsigned bus_width) 503 static int mmc_compare_ext_csds(struct mmc_card *card, unsigned bus_width)
504 { 504 {
505 u8 *bw_ext_csd; 505 u8 *bw_ext_csd;
506 int err; 506 int err;
507 507
508 if (bus_width == MMC_BUS_WIDTH_1) 508 if (bus_width == MMC_BUS_WIDTH_1)
509 return 0; 509 return 0;
510 510
511 err = mmc_get_ext_csd(card, &bw_ext_csd); 511 err = mmc_get_ext_csd(card, &bw_ext_csd);
512 512
513 if (err || bw_ext_csd == NULL) { 513 if (err || bw_ext_csd == NULL) {
514 if (bus_width != MMC_BUS_WIDTH_1) 514 if (bus_width != MMC_BUS_WIDTH_1)
515 err = -EINVAL; 515 err = -EINVAL;
516 goto out; 516 goto out;
517 } 517 }
518 518
519 if (bus_width == MMC_BUS_WIDTH_1) 519 if (bus_width == MMC_BUS_WIDTH_1)
520 goto out; 520 goto out;
521 521
522 /* only compare read only fields */ 522 /* only compare read only fields */
523 err = (!(card->ext_csd.raw_partition_support == 523 err = (!(card->ext_csd.raw_partition_support ==
524 bw_ext_csd[EXT_CSD_PARTITION_SUPPORT]) && 524 bw_ext_csd[EXT_CSD_PARTITION_SUPPORT]) &&
525 (card->ext_csd.raw_erased_mem_count == 525 (card->ext_csd.raw_erased_mem_count ==
526 bw_ext_csd[EXT_CSD_ERASED_MEM_CONT]) && 526 bw_ext_csd[EXT_CSD_ERASED_MEM_CONT]) &&
527 (card->ext_csd.rev == 527 (card->ext_csd.rev ==
528 bw_ext_csd[EXT_CSD_REV]) && 528 bw_ext_csd[EXT_CSD_REV]) &&
529 (card->ext_csd.raw_ext_csd_structure == 529 (card->ext_csd.raw_ext_csd_structure ==
530 bw_ext_csd[EXT_CSD_STRUCTURE]) && 530 bw_ext_csd[EXT_CSD_STRUCTURE]) &&
531 (card->ext_csd.raw_card_type == 531 (card->ext_csd.raw_card_type ==
532 bw_ext_csd[EXT_CSD_CARD_TYPE]) && 532 bw_ext_csd[EXT_CSD_CARD_TYPE]) &&
533 (card->ext_csd.raw_s_a_timeout == 533 (card->ext_csd.raw_s_a_timeout ==
534 bw_ext_csd[EXT_CSD_S_A_TIMEOUT]) && 534 bw_ext_csd[EXT_CSD_S_A_TIMEOUT]) &&
535 (card->ext_csd.raw_hc_erase_gap_size == 535 (card->ext_csd.raw_hc_erase_gap_size ==
536 bw_ext_csd[EXT_CSD_HC_WP_GRP_SIZE]) && 536 bw_ext_csd[EXT_CSD_HC_WP_GRP_SIZE]) &&
537 (card->ext_csd.raw_erase_timeout_mult == 537 (card->ext_csd.raw_erase_timeout_mult ==
538 bw_ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT]) && 538 bw_ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT]) &&
539 (card->ext_csd.raw_hc_erase_grp_size == 539 (card->ext_csd.raw_hc_erase_grp_size ==
540 bw_ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]) && 540 bw_ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]) &&
541 (card->ext_csd.raw_sec_trim_mult == 541 (card->ext_csd.raw_sec_trim_mult ==
542 bw_ext_csd[EXT_CSD_SEC_TRIM_MULT]) && 542 bw_ext_csd[EXT_CSD_SEC_TRIM_MULT]) &&
543 (card->ext_csd.raw_sec_erase_mult == 543 (card->ext_csd.raw_sec_erase_mult ==
544 bw_ext_csd[EXT_CSD_SEC_ERASE_MULT]) && 544 bw_ext_csd[EXT_CSD_SEC_ERASE_MULT]) &&
545 (card->ext_csd.raw_sec_feature_support == 545 (card->ext_csd.raw_sec_feature_support ==
546 bw_ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT]) && 546 bw_ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT]) &&
547 (card->ext_csd.raw_trim_mult == 547 (card->ext_csd.raw_trim_mult ==
548 bw_ext_csd[EXT_CSD_TRIM_MULT]) && 548 bw_ext_csd[EXT_CSD_TRIM_MULT]) &&
549 (card->ext_csd.raw_sectors[0] == 549 (card->ext_csd.raw_sectors[0] ==
550 bw_ext_csd[EXT_CSD_SEC_CNT + 0]) && 550 bw_ext_csd[EXT_CSD_SEC_CNT + 0]) &&
551 (card->ext_csd.raw_sectors[1] == 551 (card->ext_csd.raw_sectors[1] ==
552 bw_ext_csd[EXT_CSD_SEC_CNT + 1]) && 552 bw_ext_csd[EXT_CSD_SEC_CNT + 1]) &&
553 (card->ext_csd.raw_sectors[2] == 553 (card->ext_csd.raw_sectors[2] ==
554 bw_ext_csd[EXT_CSD_SEC_CNT + 2]) && 554 bw_ext_csd[EXT_CSD_SEC_CNT + 2]) &&
555 (card->ext_csd.raw_sectors[3] == 555 (card->ext_csd.raw_sectors[3] ==
556 bw_ext_csd[EXT_CSD_SEC_CNT + 3])); 556 bw_ext_csd[EXT_CSD_SEC_CNT + 3]));
557 if (err) 557 if (err)
558 err = -EINVAL; 558 err = -EINVAL;
559 559
560 out: 560 out:
561 mmc_free_ext_csd(bw_ext_csd); 561 mmc_free_ext_csd(bw_ext_csd);
562 return err; 562 return err;
563 } 563 }
564 564
565 MMC_DEV_ATTR(cid, "%08x%08x%08x%08x\n", card->raw_cid[0], card->raw_cid[1], 565 MMC_DEV_ATTR(cid, "%08x%08x%08x%08x\n", card->raw_cid[0], card->raw_cid[1],
566 card->raw_cid[2], card->raw_cid[3]); 566 card->raw_cid[2], card->raw_cid[3]);
567 MMC_DEV_ATTR(csd, "%08x%08x%08x%08x\n", card->raw_csd[0], card->raw_csd[1], 567 MMC_DEV_ATTR(csd, "%08x%08x%08x%08x\n", card->raw_csd[0], card->raw_csd[1],
568 card->raw_csd[2], card->raw_csd[3]); 568 card->raw_csd[2], card->raw_csd[3]);
569 MMC_DEV_ATTR(date, "%02d/%04d\n", card->cid.month, card->cid.year); 569 MMC_DEV_ATTR(date, "%02d/%04d\n", card->cid.month, card->cid.year);
570 MMC_DEV_ATTR(erase_size, "%u\n", card->erase_size << 9); 570 MMC_DEV_ATTR(erase_size, "%u\n", card->erase_size << 9);
571 MMC_DEV_ATTR(preferred_erase_size, "%u\n", card->pref_erase << 9); 571 MMC_DEV_ATTR(preferred_erase_size, "%u\n", card->pref_erase << 9);
572 MMC_DEV_ATTR(fwrev, "0x%x\n", card->cid.fwrev); 572 MMC_DEV_ATTR(fwrev, "0x%x\n", card->cid.fwrev);
573 MMC_DEV_ATTR(hwrev, "0x%x\n", card->cid.hwrev); 573 MMC_DEV_ATTR(hwrev, "0x%x\n", card->cid.hwrev);
574 MMC_DEV_ATTR(manfid, "0x%06x\n", card->cid.manfid); 574 MMC_DEV_ATTR(manfid, "0x%06x\n", card->cid.manfid);
575 MMC_DEV_ATTR(name, "%s\n", card->cid.prod_name); 575 MMC_DEV_ATTR(name, "%s\n", card->cid.prod_name);
576 MMC_DEV_ATTR(oemid, "0x%04x\n", card->cid.oemid); 576 MMC_DEV_ATTR(oemid, "0x%04x\n", card->cid.oemid);
577 MMC_DEV_ATTR(serial, "0x%08x\n", card->cid.serial); 577 MMC_DEV_ATTR(serial, "0x%08x\n", card->cid.serial);
578 MMC_DEV_ATTR(enhanced_area_offset, "%llu\n", 578 MMC_DEV_ATTR(enhanced_area_offset, "%llu\n",
579 card->ext_csd.enhanced_area_offset); 579 card->ext_csd.enhanced_area_offset);
580 MMC_DEV_ATTR(enhanced_area_size, "%u\n", card->ext_csd.enhanced_area_size); 580 MMC_DEV_ATTR(enhanced_area_size, "%u\n", card->ext_csd.enhanced_area_size);
581 581
582 static struct attribute *mmc_std_attrs[] = { 582 static struct attribute *mmc_std_attrs[] = {
583 &dev_attr_cid.attr, 583 &dev_attr_cid.attr,
584 &dev_attr_csd.attr, 584 &dev_attr_csd.attr,
585 &dev_attr_date.attr, 585 &dev_attr_date.attr,
586 &dev_attr_erase_size.attr, 586 &dev_attr_erase_size.attr,
587 &dev_attr_preferred_erase_size.attr, 587 &dev_attr_preferred_erase_size.attr,
588 &dev_attr_fwrev.attr, 588 &dev_attr_fwrev.attr,
589 &dev_attr_hwrev.attr, 589 &dev_attr_hwrev.attr,
590 &dev_attr_manfid.attr, 590 &dev_attr_manfid.attr,
591 &dev_attr_name.attr, 591 &dev_attr_name.attr,
592 &dev_attr_oemid.attr, 592 &dev_attr_oemid.attr,
593 &dev_attr_serial.attr, 593 &dev_attr_serial.attr,
594 &dev_attr_enhanced_area_offset.attr, 594 &dev_attr_enhanced_area_offset.attr,
595 &dev_attr_enhanced_area_size.attr, 595 &dev_attr_enhanced_area_size.attr,
596 NULL, 596 NULL,
597 }; 597 };
598 598
599 static struct attribute_group mmc_std_attr_group = { 599 static struct attribute_group mmc_std_attr_group = {
600 .attrs = mmc_std_attrs, 600 .attrs = mmc_std_attrs,
601 }; 601 };
602 602
603 static const struct attribute_group *mmc_attr_groups[] = { 603 static const struct attribute_group *mmc_attr_groups[] = {
604 &mmc_std_attr_group, 604 &mmc_std_attr_group,
605 NULL, 605 NULL,
606 }; 606 };
607 607
608 static struct device_type mmc_type = { 608 static struct device_type mmc_type = {
609 .groups = mmc_attr_groups, 609 .groups = mmc_attr_groups,
610 }; 610 };
611 611
612 /* 612 /*
613 * Select the PowerClass for the current bus width 613 * Select the PowerClass for the current bus width
614 * If power class is defined for 4/8 bit bus in the 614 * If power class is defined for 4/8 bit bus in the
615 * extended CSD register, select it by executing the 615 * extended CSD register, select it by executing the
616 * mmc_switch command. 616 * mmc_switch command.
617 */ 617 */
618 static int mmc_select_powerclass(struct mmc_card *card, 618 static int mmc_select_powerclass(struct mmc_card *card,
619 unsigned int bus_width, u8 *ext_csd) 619 unsigned int bus_width, u8 *ext_csd)
620 { 620 {
621 int err = 0; 621 int err = 0;
622 unsigned int pwrclass_val; 622 unsigned int pwrclass_val;
623 unsigned int index = 0; 623 unsigned int index = 0;
624 struct mmc_host *host; 624 struct mmc_host *host;
625 625
626 BUG_ON(!card); 626 BUG_ON(!card);
627 627
628 host = card->host; 628 host = card->host;
629 BUG_ON(!host); 629 BUG_ON(!host);
630 630
631 if (ext_csd == NULL) 631 if (ext_csd == NULL)
632 return 0; 632 return 0;
633 633
634 /* Power class selection is supported for versions >= 4.0 */ 634 /* Power class selection is supported for versions >= 4.0 */
635 if (card->csd.mmca_vsn < CSD_SPEC_VER_4) 635 if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
636 return 0; 636 return 0;
637 637
638 /* Power class values are defined only for 4/8 bit bus */ 638 /* Power class values are defined only for 4/8 bit bus */
639 if (bus_width == EXT_CSD_BUS_WIDTH_1) 639 if (bus_width == EXT_CSD_BUS_WIDTH_1)
640 return 0; 640 return 0;
641 641
642 switch (1 << host->ios.vdd) { 642 switch (1 << host->ios.vdd) {
643 case MMC_VDD_165_195: 643 case MMC_VDD_165_195:
644 if (host->ios.clock <= 26000000) 644 if (host->ios.clock <= 26000000)
645 index = EXT_CSD_PWR_CL_26_195; 645 index = EXT_CSD_PWR_CL_26_195;
646 else if (host->ios.clock <= 52000000) 646 else if (host->ios.clock <= 52000000)
647 index = (bus_width <= EXT_CSD_BUS_WIDTH_8) ? 647 index = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
648 EXT_CSD_PWR_CL_52_195 : 648 EXT_CSD_PWR_CL_52_195 :
649 EXT_CSD_PWR_CL_DDR_52_195; 649 EXT_CSD_PWR_CL_DDR_52_195;
650 else if (host->ios.clock <= 200000000) 650 else if (host->ios.clock <= 200000000)
651 index = EXT_CSD_PWR_CL_200_195; 651 index = EXT_CSD_PWR_CL_200_195;
652 break; 652 break;
653 case MMC_VDD_32_33: 653 case MMC_VDD_32_33:
654 case MMC_VDD_33_34: 654 case MMC_VDD_33_34:
655 case MMC_VDD_34_35: 655 case MMC_VDD_34_35:
656 case MMC_VDD_35_36: 656 case MMC_VDD_35_36:
657 if (host->ios.clock <= 26000000) 657 if (host->ios.clock <= 26000000)
658 index = EXT_CSD_PWR_CL_26_360; 658 index = EXT_CSD_PWR_CL_26_360;
659 else if (host->ios.clock <= 52000000) 659 else if (host->ios.clock <= 52000000)
660 index = (bus_width <= EXT_CSD_BUS_WIDTH_8) ? 660 index = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
661 EXT_CSD_PWR_CL_52_360 : 661 EXT_CSD_PWR_CL_52_360 :
662 EXT_CSD_PWR_CL_DDR_52_360; 662 EXT_CSD_PWR_CL_DDR_52_360;
663 else if (host->ios.clock <= 200000000) 663 else if (host->ios.clock <= 200000000)
664 index = EXT_CSD_PWR_CL_200_360; 664 index = EXT_CSD_PWR_CL_200_360;
665 break; 665 break;
666 default: 666 default:
667 pr_warning("%s: Voltage range not supported " 667 pr_warning("%s: Voltage range not supported "
668 "for power class.\n", mmc_hostname(host)); 668 "for power class.\n", mmc_hostname(host));
669 return -EINVAL; 669 return -EINVAL;
670 } 670 }
671 671
672 pwrclass_val = ext_csd[index]; 672 pwrclass_val = ext_csd[index];
673 673
674 if (bus_width & (EXT_CSD_BUS_WIDTH_8 | EXT_CSD_DDR_BUS_WIDTH_8)) 674 if (bus_width & (EXT_CSD_BUS_WIDTH_8 | EXT_CSD_DDR_BUS_WIDTH_8))
675 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_8BIT_MASK) >> 675 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_8BIT_MASK) >>
676 EXT_CSD_PWR_CL_8BIT_SHIFT; 676 EXT_CSD_PWR_CL_8BIT_SHIFT;
677 else 677 else
678 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_4BIT_MASK) >> 678 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_4BIT_MASK) >>
679 EXT_CSD_PWR_CL_4BIT_SHIFT; 679 EXT_CSD_PWR_CL_4BIT_SHIFT;
680 680
681 /* If the power class is different from the default value */ 681 /* If the power class is different from the default value */
682 if (pwrclass_val > 0) { 682 if (pwrclass_val > 0) {
683 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, 683 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
684 EXT_CSD_POWER_CLASS, 684 EXT_CSD_POWER_CLASS,
685 pwrclass_val, 685 pwrclass_val,
686 card->ext_csd.generic_cmd6_time); 686 card->ext_csd.generic_cmd6_time);
687 } 687 }
688 688
689 return err; 689 return err;
690 } 690 }
691 691
692 /* 692 /*
693 * Handle the detection and initialisation of a card. 693 * Handle the detection and initialisation of a card.
694 * 694 *
695 * In the case of a resume, "oldcard" will contain the card 695 * In the case of a resume, "oldcard" will contain the card
696 * we're trying to reinitialise. 696 * we're trying to reinitialise.
697 */ 697 */
698 static int mmc_init_card(struct mmc_host *host, u32 ocr, 698 static int mmc_init_card(struct mmc_host *host, u32 ocr,
699 struct mmc_card *oldcard) 699 struct mmc_card *oldcard)
700 { 700 {
701 struct mmc_card *card; 701 struct mmc_card *card;
702 int err, ddr = 0; 702 int err, ddr = 0;
703 u32 cid[4]; 703 u32 cid[4];
704 unsigned int max_dtr; 704 unsigned int max_dtr;
705 u32 rocr; 705 u32 rocr;
706 u8 *ext_csd = NULL; 706 u8 *ext_csd = NULL;
707 707
708 BUG_ON(!host); 708 BUG_ON(!host);
709 WARN_ON(!host->claimed); 709 WARN_ON(!host->claimed);
710 710
711 /* Set correct bus mode for MMC before attempting init */ 711 /* Set correct bus mode for MMC before attempting init */
712 if (!mmc_host_is_spi(host)) 712 if (!mmc_host_is_spi(host))
713 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN); 713 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);
714 714
715 /* 715 /*
716 * Since we're changing the OCR value, we seem to 716 * Since we're changing the OCR value, we seem to
717 * need to tell some cards to go back to the idle 717 * need to tell some cards to go back to the idle
718 * state. We wait 1ms to give cards time to 718 * state. We wait 1ms to give cards time to
719 * respond. 719 * respond.
720 * mmc_go_idle is needed for eMMC that are asleep 720 * mmc_go_idle is needed for eMMC that are asleep
721 */ 721 */
722 mmc_go_idle(host); 722 mmc_go_idle(host);
723 723
724 /* The extra bit indicates that we support high capacity */ 724 /* The extra bit indicates that we support high capacity */
725 err = mmc_send_op_cond(host, ocr | (1 << 30), &rocr); 725 err = mmc_send_op_cond(host, ocr | (1 << 30), &rocr);
726 if (err) 726 if (err)
727 goto err; 727 goto err;
728 728
729 /* 729 /*
730 * For SPI, enable CRC as appropriate. 730 * For SPI, enable CRC as appropriate.
731 */ 731 */
732 if (mmc_host_is_spi(host)) { 732 if (mmc_host_is_spi(host)) {
733 err = mmc_spi_set_crc(host, use_spi_crc); 733 err = mmc_spi_set_crc(host, use_spi_crc);
734 if (err) 734 if (err)
735 goto err; 735 goto err;
736 } 736 }
737 737
738 /* 738 /*
739 * Fetch CID from card. 739 * Fetch CID from card.
740 */ 740 */
741 if (mmc_host_is_spi(host)) 741 if (mmc_host_is_spi(host))
742 err = mmc_send_cid(host, cid); 742 err = mmc_send_cid(host, cid);
743 else 743 else
744 err = mmc_all_send_cid(host, cid); 744 err = mmc_all_send_cid(host, cid);
745 if (err) 745 if (err)
746 goto err; 746 goto err;
747 747
748 if (oldcard) { 748 if (oldcard) {
749 if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0) { 749 if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0) {
750 err = -ENOENT; 750 err = -ENOENT;
751 goto err; 751 goto err;
752 } 752 }
753 753
754 card = oldcard; 754 card = oldcard;
755 } else { 755 } else {
756 /* 756 /*
757 * Allocate card structure. 757 * Allocate card structure.
758 */ 758 */
759 card = mmc_alloc_card(host, &mmc_type); 759 card = mmc_alloc_card(host, &mmc_type);
760 if (IS_ERR(card)) { 760 if (IS_ERR(card)) {
761 err = PTR_ERR(card); 761 err = PTR_ERR(card);
762 goto err; 762 goto err;
763 } 763 }
764 764
765 card->type = MMC_TYPE_MMC; 765 card->type = MMC_TYPE_MMC;
766 card->rca = 1; 766 card->rca = 1;
767 memcpy(card->raw_cid, cid, sizeof(card->raw_cid)); 767 memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
768 } 768 }
769 769
770 /* 770 /*
771 * For native busses: set card RCA and quit open drain mode. 771 * For native busses: set card RCA and quit open drain mode.
772 */ 772 */
773 if (!mmc_host_is_spi(host)) { 773 if (!mmc_host_is_spi(host)) {
774 err = mmc_set_relative_addr(card); 774 err = mmc_set_relative_addr(card);
775 if (err) 775 if (err)
776 goto free_card; 776 goto free_card;
777 777
778 mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL); 778 mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL);
779 } 779 }
780 780
781 if (!oldcard) { 781 if (!oldcard) {
782 /* 782 /*
783 * Fetch CSD from card. 783 * Fetch CSD from card.
784 */ 784 */
785 err = mmc_send_csd(card, card->raw_csd); 785 err = mmc_send_csd(card, card->raw_csd);
786 if (err) 786 if (err)
787 goto free_card; 787 goto free_card;
788 788
789 err = mmc_decode_csd(card); 789 err = mmc_decode_csd(card);
790 if (err) 790 if (err)
791 goto free_card; 791 goto free_card;
792 err = mmc_decode_cid(card); 792 err = mmc_decode_cid(card);
793 if (err) 793 if (err)
794 goto free_card; 794 goto free_card;
795 } 795 }
796 796
797 /* 797 /*
798 * Select card, as all following commands rely on that. 798 * Select card, as all following commands rely on that.
799 */ 799 */
800 if (!mmc_host_is_spi(host)) { 800 if (!mmc_host_is_spi(host)) {
801 err = mmc_select_card(card); 801 err = mmc_select_card(card);
802 if (err) 802 if (err)
803 goto free_card; 803 goto free_card;
804 } 804 }
805 805
806 if (!oldcard) { 806 if (!oldcard) {
807 /* 807 /*
808 * Fetch and process extended CSD. 808 * Fetch and process extended CSD.
809 */ 809 */
810 810
811 err = mmc_get_ext_csd(card, &ext_csd); 811 err = mmc_get_ext_csd(card, &ext_csd);
812 if (err) 812 if (err)
813 goto free_card; 813 goto free_card;
814 err = mmc_read_ext_csd(card, ext_csd); 814 err = mmc_read_ext_csd(card, ext_csd);
815 if (err) 815 if (err)
816 goto free_card; 816 goto free_card;
817 817
818 /* If doing byte addressing, check if required to do sector 818 /* If doing byte addressing, check if required to do sector
819 * addressing. Handle the case of <2GB cards needing sector 819 * addressing. Handle the case of <2GB cards needing sector
820 * addressing. See section 8.1 JEDEC Standard JED84-A441; 820 * addressing. See section 8.1 JEDEC Standard JED84-A441;
821 * ocr register has bit 30 set for sector addressing. 821 * ocr register has bit 30 set for sector addressing.
822 */ 822 */
823 if (!(mmc_card_blockaddr(card)) && (rocr & (1<<30))) 823 if (!(mmc_card_blockaddr(card)) && (rocr & (1<<30)))
824 mmc_card_set_blockaddr(card); 824 mmc_card_set_blockaddr(card);
825 825
826 /* Erase size depends on CSD and Extended CSD */ 826 /* Erase size depends on CSD and Extended CSD */
827 mmc_set_erase_size(card); 827 mmc_set_erase_size(card);
828 } 828 }
829 829
830 /* 830 /*
831 * If enhanced_area_en is TRUE, host needs to enable ERASE_GRP_DEF 831 * If enhanced_area_en is TRUE, host needs to enable ERASE_GRP_DEF
832 * bit. This bit will be lost every time after a reset or power off. 832 * bit. This bit will be lost every time after a reset or power off.
833 */ 833 */
834 if (card->ext_csd.enhanced_area_en) { 834 if (card->ext_csd.enhanced_area_en) {
835 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, 835 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
836 EXT_CSD_ERASE_GROUP_DEF, 1, 836 EXT_CSD_ERASE_GROUP_DEF, 1,
837 card->ext_csd.generic_cmd6_time); 837 card->ext_csd.generic_cmd6_time);
838 838
839 if (err && err != -EBADMSG) 839 if (err && err != -EBADMSG)
840 goto free_card; 840 goto free_card;
841 841
842 if (err) { 842 if (err) {
843 err = 0; 843 err = 0;
844 /* 844 /*
845 * Just disable enhanced area off & sz 845 * Just disable enhanced area off & sz
846 * will try to enable ERASE_GROUP_DEF 846 * will try to enable ERASE_GROUP_DEF
847 * during next time reinit 847 * during next time reinit
848 */ 848 */
849 card->ext_csd.enhanced_area_offset = -EINVAL; 849 card->ext_csd.enhanced_area_offset = -EINVAL;
850 card->ext_csd.enhanced_area_size = -EINVAL; 850 card->ext_csd.enhanced_area_size = -EINVAL;
851 } else { 851 } else {
852 card->ext_csd.erase_group_def = 1; 852 card->ext_csd.erase_group_def = 1;
853 /* 853 /*
854 * enable ERASE_GRP_DEF successfully. 854 * enable ERASE_GRP_DEF successfully.
855 * This will affect the erase size, so 855 * This will affect the erase size, so
856 * here need to reset erase size 856 * here need to reset erase size
857 */ 857 */
858 mmc_set_erase_size(card); 858 mmc_set_erase_size(card);
859 } 859 }
860 } 860 }
861 861
862 /* 862 /*
863 * Ensure eMMC user default partition is enabled 863 * Ensure eMMC user default partition is enabled
864 */ 864 */
865 if (card->ext_csd.part_config & EXT_CSD_PART_CONFIG_ACC_MASK) { 865 if (card->ext_csd.part_config & EXT_CSD_PART_CONFIG_ACC_MASK) {
866 card->ext_csd.part_config &= ~EXT_CSD_PART_CONFIG_ACC_MASK; 866 card->ext_csd.part_config &= ~EXT_CSD_PART_CONFIG_ACC_MASK;
867 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_PART_CONFIG, 867 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_PART_CONFIG,
868 card->ext_csd.part_config, 868 card->ext_csd.part_config,
869 card->ext_csd.part_time); 869 card->ext_csd.part_time);
870 if (err && err != -EBADMSG) 870 if (err && err != -EBADMSG)
871 goto free_card; 871 goto free_card;
872 } 872 }
873 873
874 /* 874 /*
875 * If the host supports the power_off_notify capability then 875 * If the host supports the power_off_notify capability then
876 * set the notification byte in the ext_csd register of device 876 * set the notification byte in the ext_csd register of device
877 */ 877 */
878 if ((host->caps2 & MMC_CAP2_POWEROFF_NOTIFY) && 878 if ((host->caps2 & MMC_CAP2_POWEROFF_NOTIFY) &&
879 (card->ext_csd.rev >= 6)) { 879 (card->ext_csd.rev >= 6)) {
880 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, 880 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
881 EXT_CSD_POWER_OFF_NOTIFICATION, 881 EXT_CSD_POWER_OFF_NOTIFICATION,
882 EXT_CSD_POWER_ON, 882 EXT_CSD_POWER_ON,
883 card->ext_csd.generic_cmd6_time); 883 card->ext_csd.generic_cmd6_time);
884 if (err && err != -EBADMSG) 884 if (err && err != -EBADMSG)
885 goto free_card; 885 goto free_card;
886 886
887 /* 887 /*
888 * The err can be -EBADMSG or 0, 888 * The err can be -EBADMSG or 0,
889 * so check for success and update the flag 889 * so check for success and update the flag
890 */ 890 */
891 if (!err) 891 if (!err)
892 card->poweroff_notify_state = MMC_POWERED_ON; 892 card->poweroff_notify_state = MMC_POWERED_ON;
893 } 893 }
894 894
895 /* 895 /*
896 * Activate high speed (if supported) 896 * Activate high speed (if supported)
897 */ 897 */
898 if ((card->ext_csd.hs_max_dtr != 0) && 898 if ((card->ext_csd.hs_max_dtr != 0) &&
899 (host->caps & MMC_CAP_MMC_HIGHSPEED)) { 899 (host->caps & MMC_CAP_MMC_HIGHSPEED)) {
900 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, 900 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
901 EXT_CSD_HS_TIMING, 1, 901 EXT_CSD_HS_TIMING, 1,
902 card->ext_csd.generic_cmd6_time); 902 card->ext_csd.generic_cmd6_time);
903 if (err && err != -EBADMSG) 903 if (err && err != -EBADMSG)
904 goto free_card; 904 goto free_card;
905 905
906 if (err) { 906 if (err) {
907 pr_warning("%s: switch to highspeed failed\n", 907 pr_warning("%s: switch to highspeed failed\n",
908 mmc_hostname(card->host)); 908 mmc_hostname(card->host));
909 err = 0; 909 err = 0;
910 } else { 910 } else {
911 mmc_card_set_highspeed(card); 911 mmc_card_set_highspeed(card);
912 mmc_set_timing(card->host, MMC_TIMING_MMC_HS); 912 mmc_set_timing(card->host, MMC_TIMING_MMC_HS);
913 } 913 }
914 } 914 }
915 915
916 /* 916 /*
917 * Enable HPI feature (if supported) 917 * Enable HPI feature (if supported)
918 */ 918 */
919 if (card->ext_csd.hpi) { 919 if (card->ext_csd.hpi) {
920 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, 920 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
921 EXT_CSD_HPI_MGMT, 1, 0); 921 EXT_CSD_HPI_MGMT, 1, 0);
922 if (err && err != -EBADMSG) 922 if (err && err != -EBADMSG)
923 goto free_card; 923 goto free_card;
924 if (err) { 924 if (err) {
925 pr_warning("%s: Enabling HPI failed\n", 925 pr_warning("%s: Enabling HPI failed\n",
926 mmc_hostname(card->host)); 926 mmc_hostname(card->host));
927 err = 0; 927 err = 0;
928 } else 928 } else
929 card->ext_csd.hpi_en = 1; 929 card->ext_csd.hpi_en = 1;
930 } 930 }
931 931
932 /* 932 /*
933 * Compute bus speed. 933 * Compute bus speed.
934 */ 934 */
935 max_dtr = (unsigned int)-1; 935 max_dtr = (unsigned int)-1;
936 936
937 if (mmc_card_highspeed(card)) { 937 if (mmc_card_highspeed(card)) {
938 if (max_dtr > card->ext_csd.hs_max_dtr) 938 if (max_dtr > card->ext_csd.hs_max_dtr)
939 max_dtr = card->ext_csd.hs_max_dtr; 939 max_dtr = card->ext_csd.hs_max_dtr;
940 } else if (max_dtr > card->csd.max_dtr) { 940 } else if (max_dtr > card->csd.max_dtr) {
941 max_dtr = card->csd.max_dtr; 941 max_dtr = card->csd.max_dtr;
942 } 942 }
943 943
944 mmc_set_clock(host, max_dtr); 944 mmc_set_clock(host, max_dtr);
945 945
946 /* 946 /*
947 * Indicate DDR mode (if supported). 947 * Indicate DDR mode (if supported).
948 */ 948 */
949 if (mmc_card_highspeed(card)) { 949 if (mmc_card_highspeed(card)) {
950 if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_8V) 950 if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_8V)
951 && ((host->caps & (MMC_CAP_1_8V_DDR | 951 && ((host->caps & (MMC_CAP_1_8V_DDR |
952 MMC_CAP_UHS_DDR50)) 952 MMC_CAP_UHS_DDR50))
953 == (MMC_CAP_1_8V_DDR | MMC_CAP_UHS_DDR50))) 953 == (MMC_CAP_1_8V_DDR | MMC_CAP_UHS_DDR50)))
954 ddr = MMC_1_8V_DDR_MODE; 954 ddr = MMC_1_8V_DDR_MODE;
955 else if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_2V) 955 else if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_2V)
956 && ((host->caps & (MMC_CAP_1_2V_DDR | 956 && ((host->caps & (MMC_CAP_1_2V_DDR |
957 MMC_CAP_UHS_DDR50)) 957 MMC_CAP_UHS_DDR50))
958 == (MMC_CAP_1_2V_DDR | MMC_CAP_UHS_DDR50))) 958 == (MMC_CAP_1_2V_DDR | MMC_CAP_UHS_DDR50)))
959 ddr = MMC_1_2V_DDR_MODE; 959 ddr = MMC_1_2V_DDR_MODE;
960 } 960 }
961 961
962 /* 962 /*
963 * Activate wide bus and DDR (if supported). 963 * Activate wide bus and DDR (if supported).
964 */ 964 */
965 if ((card->csd.mmca_vsn >= CSD_SPEC_VER_4) && 965 if ((card->csd.mmca_vsn >= CSD_SPEC_VER_4) &&
966 (host->caps & (MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA))) { 966 (host->caps & (MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA))) {
967 static unsigned ext_csd_bits[][2] = { 967 static unsigned ext_csd_bits[][2] = {
968 { EXT_CSD_BUS_WIDTH_8, EXT_CSD_DDR_BUS_WIDTH_8 }, 968 { EXT_CSD_BUS_WIDTH_8, EXT_CSD_DDR_BUS_WIDTH_8 },
969 { EXT_CSD_BUS_WIDTH_4, EXT_CSD_DDR_BUS_WIDTH_4 }, 969 { EXT_CSD_BUS_WIDTH_4, EXT_CSD_DDR_BUS_WIDTH_4 },
970 { EXT_CSD_BUS_WIDTH_1, EXT_CSD_BUS_WIDTH_1 }, 970 { EXT_CSD_BUS_WIDTH_1, EXT_CSD_BUS_WIDTH_1 },
971 }; 971 };
972 static unsigned bus_widths[] = { 972 static unsigned bus_widths[] = {
973 MMC_BUS_WIDTH_8, 973 MMC_BUS_WIDTH_8,
974 MMC_BUS_WIDTH_4, 974 MMC_BUS_WIDTH_4,
975 MMC_BUS_WIDTH_1 975 MMC_BUS_WIDTH_1
976 }; 976 };
977 unsigned idx, bus_width = 0; 977 unsigned idx, bus_width = 0;
978 978
979 if (host->caps & MMC_CAP_8_BIT_DATA) 979 if (host->caps & MMC_CAP_8_BIT_DATA)
980 idx = 0; 980 idx = 0;
981 else 981 else
982 idx = 1; 982 idx = 1;
983 for (; idx < ARRAY_SIZE(bus_widths); idx++) { 983 for (; idx < ARRAY_SIZE(bus_widths); idx++) {
984 bus_width = bus_widths[idx]; 984 bus_width = bus_widths[idx];
985 if (bus_width == MMC_BUS_WIDTH_1) 985 if (bus_width == MMC_BUS_WIDTH_1)
986 ddr = 0; /* no DDR for 1-bit width */ 986 ddr = 0; /* no DDR for 1-bit width */
987 err = mmc_select_powerclass(card, ext_csd_bits[idx][0], 987 err = mmc_select_powerclass(card, ext_csd_bits[idx][0],
988 ext_csd); 988 ext_csd);
989 if (err) 989 if (err)
990 pr_err("%s: power class selection to " 990 pr_err("%s: power class selection to "
991 "bus width %d failed\n", 991 "bus width %d failed\n",
992 mmc_hostname(card->host), 992 mmc_hostname(card->host),
993 1 << bus_width); 993 1 << bus_width);
994 994
995 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, 995 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
996 EXT_CSD_BUS_WIDTH, 996 EXT_CSD_BUS_WIDTH,
997 ext_csd_bits[idx][0], 997 ext_csd_bits[idx][0],
998 card->ext_csd.generic_cmd6_time); 998 card->ext_csd.generic_cmd6_time);
999 if (!err) { 999 if (!err) {
1000 mmc_set_bus_width(card->host, bus_width); 1000 mmc_set_bus_width(card->host, bus_width);
1001 1001
1002 /* 1002 /*
1003 * If controller can't handle bus width test, 1003 * If controller can't handle bus width test,
1004 * compare ext_csd previously read in 1 bit mode 1004 * compare ext_csd previously read in 1 bit mode
1005 * against ext_csd at new bus width 1005 * against ext_csd at new bus width
1006 */ 1006 */
1007 if (!(host->caps & MMC_CAP_BUS_WIDTH_TEST)) 1007 if (!(host->caps & MMC_CAP_BUS_WIDTH_TEST))
1008 err = mmc_compare_ext_csds(card, 1008 err = mmc_compare_ext_csds(card,
1009 bus_width); 1009 bus_width);
1010 else 1010 else
1011 err = mmc_bus_test(card, bus_width); 1011 err = mmc_bus_test(card, bus_width);
1012 if (!err) 1012 if (!err)
1013 break; 1013 break;
1014 } 1014 }
1015 } 1015 }
1016 1016
1017 if (!err && ddr) { 1017 if (!err && ddr) {
1018 err = mmc_select_powerclass(card, ext_csd_bits[idx][1], 1018 err = mmc_select_powerclass(card, ext_csd_bits[idx][1],
1019 ext_csd); 1019 ext_csd);
1020 if (err) 1020 if (err)
1021 pr_err("%s: power class selection to " 1021 pr_err("%s: power class selection to "
1022 "bus width %d ddr %d failed\n", 1022 "bus width %d ddr %d failed\n",
1023 mmc_hostname(card->host), 1023 mmc_hostname(card->host),
1024 1 << bus_width, ddr); 1024 1 << bus_width, ddr);
1025 1025
1026 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, 1026 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1027 EXT_CSD_BUS_WIDTH, 1027 EXT_CSD_BUS_WIDTH,
1028 ext_csd_bits[idx][1], 1028 ext_csd_bits[idx][1],
1029 card->ext_csd.generic_cmd6_time); 1029 card->ext_csd.generic_cmd6_time);
1030 } 1030 }
1031 if (err) { 1031 if (err) {
1032 pr_warning("%s: switch to bus width %d ddr %d " 1032 pr_warning("%s: switch to bus width %d ddr %d "
1033 "failed\n", mmc_hostname(card->host), 1033 "failed\n", mmc_hostname(card->host),
1034 1 << bus_width, ddr); 1034 1 << bus_width, ddr);
1035 goto free_card; 1035 goto free_card;
1036 } else if (ddr) { 1036 } else if (ddr) {
1037 /* 1037 /*
1038 * eMMC cards can support 3.3V to 1.2V i/o (vccq) 1038 * eMMC cards can support 3.3V to 1.2V i/o (vccq)
1039 * signaling. 1039 * signaling.
1040 * 1040 *
1041 * EXT_CSD_CARD_TYPE_DDR_1_8V means 3.3V or 1.8V vccq. 1041 * EXT_CSD_CARD_TYPE_DDR_1_8V means 3.3V or 1.8V vccq.
1042 * 1042 *
1043 * 1.8V vccq at 3.3V core voltage (vcc) is not required 1043 * 1.8V vccq at 3.3V core voltage (vcc) is not required
1044 * in the JEDEC spec for DDR. 1044 * in the JEDEC spec for DDR.
1045 * 1045 *
1046 * Do not force change in vccq since we are obviously 1046 * Do not force change in vccq since we are obviously
1047 * working and no change to vccq is needed. 1047 * working and no change to vccq is needed.
1048 * 1048 *
1049 * WARNING: eMMC rules are NOT the same as SD DDR 1049 * WARNING: eMMC rules are NOT the same as SD DDR
1050 */ 1050 */
1051 if (ddr == EXT_CSD_CARD_TYPE_DDR_1_2V) { 1051 if (ddr == EXT_CSD_CARD_TYPE_DDR_1_2V) {
1052 err = mmc_set_signal_voltage(host, 1052 err = mmc_set_signal_voltage(host,
1053 MMC_SIGNAL_VOLTAGE_120, 0); 1053 MMC_SIGNAL_VOLTAGE_120, 0);
1054 if (err) 1054 if (err)
1055 goto err; 1055 goto err;
1056 } 1056 }
1057 mmc_card_set_ddr_mode(card); 1057 mmc_card_set_ddr_mode(card);
1058 mmc_set_timing(card->host, MMC_TIMING_UHS_DDR50); 1058 mmc_set_timing(card->host, MMC_TIMING_UHS_DDR50);
1059 mmc_set_bus_width(card->host, bus_width); 1059 mmc_set_bus_width(card->host, bus_width);
1060 } 1060 }
1061 } 1061 }
1062 1062
1063 /* 1063 /*
1064 * If cache size is higher than 0, this indicates 1064 * If cache size is higher than 0, this indicates
1065 * the existence of cache and it can be turned on. 1065 * the existence of cache and it can be turned on.
1066 */ 1066 */
1067 if ((host->caps2 & MMC_CAP2_CACHE_CTRL) && 1067 if ((host->caps2 & MMC_CAP2_CACHE_CTRL) &&
1068 card->ext_csd.cache_size > 0) { 1068 card->ext_csd.cache_size > 0) {
1069 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, 1069 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1070 EXT_CSD_CACHE_CTRL, 1, 0); 1070 EXT_CSD_CACHE_CTRL, 1, 0);
1071 if (err && err != -EBADMSG) 1071 if (err && err != -EBADMSG)
1072 goto free_card; 1072 goto free_card;
1073 1073
1074 /* 1074 /*
1075 * Only if no error, cache is turned on successfully. 1075 * Only if no error, cache is turned on successfully.
1076 */ 1076 */
1077 card->ext_csd.cache_ctrl = err ? 0 : 1; 1077 card->ext_csd.cache_ctrl = err ? 0 : 1;
1078 } 1078 }
1079 1079
1080 if (!oldcard) 1080 if (!oldcard)
1081 host->card = card; 1081 host->card = card;
1082 1082
1083 mmc_free_ext_csd(ext_csd); 1083 mmc_free_ext_csd(ext_csd);
1084 return 0; 1084 return 0;
1085 1085
1086 free_card: 1086 free_card:
1087 if (!oldcard) 1087 if (!oldcard)
1088 mmc_remove_card(card); 1088 mmc_remove_card(card);
1089 err: 1089 err:
1090 mmc_free_ext_csd(ext_csd); 1090 mmc_free_ext_csd(ext_csd);
1091 1091
1092 return err; 1092 return err;
1093 } 1093 }
1094 1094
1095 /* 1095 /*
1096 * Host is being removed. Free up the current card. 1096 * Host is being removed. Free up the current card.
1097 */ 1097 */
1098 static void mmc_remove(struct mmc_host *host) 1098 static void mmc_remove(struct mmc_host *host)
1099 { 1099 {
1100 BUG_ON(!host); 1100 BUG_ON(!host);
1101 BUG_ON(!host->card); 1101 BUG_ON(!host->card);
1102 1102
1103 mmc_remove_card(host->card); 1103 mmc_remove_card(host->card);
1104 host->card = NULL; 1104 host->card = NULL;
1105 } 1105 }
1106 1106
1107 /* 1107 /*
1108 * Card detection - card is alive. 1108 * Card detection - card is alive.
1109 */ 1109 */
1110 static int mmc_alive(struct mmc_host *host) 1110 static int mmc_alive(struct mmc_host *host)
1111 { 1111 {
1112 return mmc_send_status(host->card, NULL); 1112 return mmc_send_status(host->card, NULL);
1113 } 1113 }
1114 1114
1115 /* 1115 /*
1116 * Card detection callback from host. 1116 * Card detection callback from host.
1117 */ 1117 */
1118 static void mmc_detect(struct mmc_host *host) 1118 static void mmc_detect(struct mmc_host *host)
1119 { 1119 {
1120 int err; 1120 int err;
1121 1121
1122 BUG_ON(!host); 1122 BUG_ON(!host);
1123 BUG_ON(!host->card); 1123 BUG_ON(!host->card);
1124 1124
1125 mmc_claim_host(host); 1125 mmc_claim_host(host);
1126 1126
1127 /* 1127 /*
1128 * Just check if our card has been removed. 1128 * Just check if our card has been removed.
1129 */ 1129 */
1130 err = _mmc_detect_card_removed(host); 1130 err = _mmc_detect_card_removed(host);
1131 1131
1132 mmc_release_host(host); 1132 mmc_release_host(host);
1133 1133
1134 if (err) { 1134 if (err) {
1135 mmc_remove(host); 1135 mmc_remove(host);
1136 1136
1137 mmc_claim_host(host); 1137 mmc_claim_host(host);
1138 mmc_detach_bus(host); 1138 mmc_detach_bus(host);
1139 mmc_power_off(host); 1139 mmc_power_off(host);
1140 mmc_release_host(host); 1140 mmc_release_host(host);
1141 } 1141 }
1142 } 1142 }
1143 1143
1144 /* 1144 /*
1145 * Suspend callback from host. 1145 * Suspend callback from host.
1146 */ 1146 */
1147 static int mmc_suspend(struct mmc_host *host) 1147 static int mmc_suspend(struct mmc_host *host)
1148 { 1148 {
1149 int err = 0; 1149 int err = 0;
1150 1150
1151 BUG_ON(!host); 1151 BUG_ON(!host);
1152 BUG_ON(!host->card); 1152 BUG_ON(!host->card);
1153 1153
1154 mmc_claim_host(host); 1154 mmc_claim_host(host);
1155 if (mmc_card_can_sleep(host)) 1155 if (mmc_card_can_sleep(host))
1156 err = mmc_card_sleep(host); 1156 err = mmc_card_sleep(host);
1157 else if (!mmc_host_is_spi(host)) 1157 else if (!mmc_host_is_spi(host))
1158 mmc_deselect_cards(host); 1158 mmc_deselect_cards(host);
1159 host->card->state &= ~MMC_STATE_HIGHSPEED; 1159 host->card->state &= ~MMC_STATE_HIGHSPEED;
1160 mmc_release_host(host); 1160 mmc_release_host(host);
1161 1161
1162 return err; 1162 return err;
1163 } 1163 }
1164 1164
1165 /* 1165 /*
1166 * Resume callback from host. 1166 * Resume callback from host.
1167 * 1167 *
1168 * This function tries to determine if the same card is still present 1168 * This function tries to determine if the same card is still present
1169 * and, if so, restore all state to it. 1169 * and, if so, restore all state to it.
1170 */ 1170 */
1171 static int mmc_resume(struct mmc_host *host) 1171 static int mmc_resume(struct mmc_host *host)
1172 { 1172 {
1173 int err; 1173 int err;
1174 1174
1175 BUG_ON(!host); 1175 BUG_ON(!host);
1176 BUG_ON(!host->card); 1176 BUG_ON(!host->card);
1177 1177
1178 mmc_claim_host(host); 1178 mmc_claim_host(host);
1179 err = mmc_init_card(host, host->ocr, host->card); 1179 err = mmc_init_card(host, host->ocr, host->card);
1180 mmc_release_host(host); 1180 mmc_release_host(host);
1181 1181
1182 return err; 1182 return err;
1183 } 1183 }
1184 1184
1185 static int mmc_power_restore(struct mmc_host *host) 1185 static int mmc_power_restore(struct mmc_host *host)
1186 { 1186 {
1187 int ret; 1187 int ret;
1188 1188
1189 host->card->state &= ~MMC_STATE_HIGHSPEED; 1189 host->card->state &= ~MMC_STATE_HIGHSPEED;
1190 mmc_claim_host(host); 1190 mmc_claim_host(host);
1191 ret = mmc_init_card(host, host->ocr, host->card); 1191 ret = mmc_init_card(host, host->ocr, host->card);
1192 mmc_release_host(host); 1192 mmc_release_host(host);
1193 1193
1194 return ret; 1194 return ret;
1195 } 1195 }
1196 1196
1197 static int mmc_sleep(struct mmc_host *host) 1197 static int mmc_sleep(struct mmc_host *host)
1198 { 1198 {
1199 struct mmc_card *card = host->card; 1199 struct mmc_card *card = host->card;
1200 int err = -ENOSYS; 1200 int err = -ENOSYS;
1201 1201
1202 if (card && card->ext_csd.rev >= 3) { 1202 if (card && card->ext_csd.rev >= 3) {
1203 err = mmc_card_sleepawake(host, 1); 1203 err = mmc_card_sleepawake(host, 1);
1204 if (err < 0) 1204 if (err < 0)
1205 pr_debug("%s: Error %d while putting card into sleep", 1205 pr_debug("%s: Error %d while putting card into sleep",
1206 mmc_hostname(host), err); 1206 mmc_hostname(host), err);
1207 } 1207 }
1208 1208
1209 return err; 1209 return err;
1210 } 1210 }
1211 1211
1212 static int mmc_awake(struct mmc_host *host) 1212 static int mmc_awake(struct mmc_host *host)
1213 { 1213 {
1214 struct mmc_card *card = host->card; 1214 struct mmc_card *card = host->card;
1215 int err = -ENOSYS; 1215 int err = -ENOSYS;
1216 1216
1217 if (card && card->ext_csd.rev >= 3) { 1217 if (card && card->ext_csd.rev >= 3) {
1218 err = mmc_card_sleepawake(host, 0); 1218 err = mmc_card_sleepawake(host, 0);
1219 if (err < 0) 1219 if (err < 0)
1220 pr_debug("%s: Error %d while awaking sleeping card", 1220 pr_debug("%s: Error %d while awaking sleeping card",
1221 mmc_hostname(host), err); 1221 mmc_hostname(host), err);
1222 } 1222 }
1223 1223
1224 return err; 1224 return err;
1225 } 1225 }
1226 1226
1227 static const struct mmc_bus_ops mmc_ops = { 1227 static const struct mmc_bus_ops mmc_ops = {
1228 .awake = mmc_awake, 1228 .awake = mmc_awake,
1229 .sleep = mmc_sleep, 1229 .sleep = mmc_sleep,
1230 .remove = mmc_remove, 1230 .remove = mmc_remove,
1231 .detect = mmc_detect, 1231 .detect = mmc_detect,
1232 .suspend = NULL, 1232 .suspend = NULL,
1233 .resume = NULL, 1233 .resume = NULL,
1234 .power_restore = mmc_power_restore, 1234 .power_restore = mmc_power_restore,
1235 .alive = mmc_alive, 1235 .alive = mmc_alive,
1236 }; 1236 };
1237 1237
1238 static const struct mmc_bus_ops mmc_ops_unsafe = { 1238 static const struct mmc_bus_ops mmc_ops_unsafe = {
1239 .awake = mmc_awake, 1239 .awake = mmc_awake,
1240 .sleep = mmc_sleep, 1240 .sleep = mmc_sleep,
1241 .remove = mmc_remove, 1241 .remove = mmc_remove,
1242 .detect = mmc_detect, 1242 .detect = mmc_detect,
1243 .suspend = mmc_suspend, 1243 .suspend = mmc_suspend,
1244 .resume = mmc_resume, 1244 .resume = mmc_resume,
1245 .power_restore = mmc_power_restore, 1245 .power_restore = mmc_power_restore,
1246 .alive = mmc_alive, 1246 .alive = mmc_alive,
1247 }; 1247 };
1248 1248
1249 static void mmc_attach_bus_ops(struct mmc_host *host) 1249 static void mmc_attach_bus_ops(struct mmc_host *host)
1250 { 1250 {
1251 const struct mmc_bus_ops *bus_ops; 1251 const struct mmc_bus_ops *bus_ops;
1252 1252
1253 if (!mmc_card_is_removable(host)) 1253 if (!mmc_card_is_removable(host))
1254 bus_ops = &mmc_ops_unsafe; 1254 bus_ops = &mmc_ops_unsafe;
1255 else 1255 else
1256 bus_ops = &mmc_ops; 1256 bus_ops = &mmc_ops;
1257 mmc_attach_bus(host, bus_ops); 1257 mmc_attach_bus(host, bus_ops);
1258 } 1258 }
1259 1259
1260 /* 1260 /*
1261 * Starting point for MMC card init. 1261 * Starting point for MMC card init.
1262 */ 1262 */
1263 int mmc_attach_mmc(struct mmc_host *host) 1263 int mmc_attach_mmc(struct mmc_host *host)
1264 { 1264 {
1265 int err; 1265 int err;
1266 u32 ocr; 1266 u32 ocr;
1267 1267
1268 BUG_ON(!host); 1268 BUG_ON(!host);
1269 WARN_ON(!host->claimed); 1269 WARN_ON(!host->claimed);
1270 1270
1271 /* Set correct bus mode for MMC before attempting attach */ 1271 /* Set correct bus mode for MMC before attempting attach */
1272 if (!mmc_host_is_spi(host)) 1272 if (!mmc_host_is_spi(host))
1273 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN); 1273 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);
1274 1274
1275 err = mmc_send_op_cond(host, 0, &ocr); 1275 err = mmc_send_op_cond(host, 0, &ocr);
1276 if (err) 1276 if (err)
1277 return err; 1277 return err;
1278 1278
1279 mmc_attach_bus_ops(host); 1279 mmc_attach_bus_ops(host);
1280 if (host->ocr_avail_mmc) 1280 if (host->ocr_avail_mmc)
1281 host->ocr_avail = host->ocr_avail_mmc; 1281 host->ocr_avail = host->ocr_avail_mmc;
1282 1282
1283 /* 1283 /*
1284 * We need to get OCR a different way for SPI. 1284 * We need to get OCR a different way for SPI.
1285 */ 1285 */
1286 if (mmc_host_is_spi(host)) { 1286 if (mmc_host_is_spi(host)) {
1287 err = mmc_spi_read_ocr(host, 1, &ocr); 1287 err = mmc_spi_read_ocr(host, 1, &ocr);
1288 if (err) 1288 if (err)
1289 goto err; 1289 goto err;
1290 } 1290 }
1291 1291
1292 /* 1292 /*
1293 * Sanity check the voltages that the card claims to 1293 * Sanity check the voltages that the card claims to
1294 * support. 1294 * support.
1295 */ 1295 */
1296 if (ocr & 0x7F) { 1296 if (ocr & 0x7F) {
1297 pr_warning("%s: card claims to support voltages " 1297 pr_warning("%s: card claims to support voltages "
1298 "below the defined range. These will be ignored.\n", 1298 "below the defined range. These will be ignored.\n",
1299 mmc_hostname(host)); 1299 mmc_hostname(host));
1300 ocr &= ~0x7F; 1300 ocr &= ~0x7F;
1301 } 1301 }
1302 1302
1303 host->ocr = mmc_select_voltage(host, ocr); 1303 host->ocr = mmc_select_voltage(host, ocr);
1304 1304
1305 /* 1305 /*
1306 * Can we support the voltage of the card? 1306 * Can we support the voltage of the card?
1307 */ 1307 */
1308 if (!host->ocr) { 1308 if (!host->ocr) {
1309 err = -EINVAL; 1309 err = -EINVAL;
1310 goto err; 1310 goto err;
1311 } 1311 }
1312 1312
1313 /* 1313 /*
1314 * Detect and init the card. 1314 * Detect and init the card.
1315 */ 1315 */
1316 err = mmc_init_card(host, host->ocr, NULL); 1316 err = mmc_init_card(host, host->ocr, NULL);
1317 if (err) 1317 if (err)
1318 goto err; 1318 goto err;
1319 1319
1320 mmc_release_host(host); 1320 mmc_release_host(host);
1321 err = mmc_add_card(host->card); 1321 err = mmc_add_card(host->card);
1322 mmc_claim_host(host); 1322 mmc_claim_host(host);
1323 if (err) 1323 if (err)
1324 goto remove_card; 1324 goto remove_card;
1325 1325
1326 return 0; 1326 return 0;
1327 1327
1328 remove_card: 1328 remove_card:
1329 mmc_release_host(host); 1329 mmc_release_host(host);
1330 mmc_remove_card(host->card); 1330 mmc_remove_card(host->card);
1331 mmc_claim_host(host); 1331 mmc_claim_host(host);
1332 host->card = NULL; 1332 host->card = NULL;
1333 err: 1333 err:
1334 mmc_detach_bus(host); 1334 mmc_detach_bus(host);
1335 1335
1336 pr_err("%s: error %d whilst initialising MMC card\n", 1336 pr_err("%s: error %d whilst initialising MMC card\n",
1337 mmc_hostname(host), err); 1337 mmc_hostname(host), err);
1338 1338
1339 return err; 1339 return err;
1340 } 1340 }
1341 1341