Merge tag 'r8169-upstream-20061204-00' of git://electric-eye.fr.zoreil.com/home/romie...
[firefly-linux-kernel-4.4.55.git] / drivers / mmc / mmc.c
1 /*
2  *  linux/drivers/mmc/mmc.c
3  *
4  *  Copyright (C) 2003-2004 Russell King, All Rights Reserved.
5  *  SD support Copyright (C) 2004 Ian Molton, All Rights Reserved.
6  *  SD support Copyright (C) 2005 Pierre Ossman, All Rights Reserved.
7  *  MMCv4 support Copyright (C) 2006 Philip Langdale, All Rights Reserved.
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License version 2 as
11  * published by the Free Software Foundation.
12  */
13 #include <linux/module.h>
14 #include <linux/init.h>
15 #include <linux/interrupt.h>
16 #include <linux/completion.h>
17 #include <linux/device.h>
18 #include <linux/delay.h>
19 #include <linux/pagemap.h>
20 #include <linux/err.h>
21 #include <asm/scatterlist.h>
22 #include <linux/scatterlist.h>
23
24 #include <linux/mmc/card.h>
25 #include <linux/mmc/host.h>
26 #include <linux/mmc/protocol.h>
27
28 #include "mmc.h"
29
30 #define CMD_RETRIES     3
31
32 /*
33  * OCR Bit positions to 10s of Vdd mV.
34  */
35 static const unsigned short mmc_ocr_bit_to_vdd[] = {
36         150,    155,    160,    165,    170,    180,    190,    200,
37         210,    220,    230,    240,    250,    260,    270,    280,
38         290,    300,    310,    320,    330,    340,    350,    360
39 };
40
41 static const unsigned int tran_exp[] = {
42         10000,          100000,         1000000,        10000000,
43         0,              0,              0,              0
44 };
45
46 static const unsigned char tran_mant[] = {
47         0,      10,     12,     13,     15,     20,     25,     30,
48         35,     40,     45,     50,     55,     60,     70,     80,
49 };
50
51 static const unsigned int tacc_exp[] = {
52         1,      10,     100,    1000,   10000,  100000, 1000000, 10000000,
53 };
54
55 static const unsigned int tacc_mant[] = {
56         0,      10,     12,     13,     15,     20,     25,     30,
57         35,     40,     45,     50,     55,     60,     70,     80,
58 };
59
60
61 /**
62  *      mmc_request_done - finish processing an MMC request
63  *      @host: MMC host which completed request
64  *      @mrq: MMC request which request
65  *
66  *      MMC drivers should call this function when they have completed
67  *      their processing of a request.
68  */
69 void mmc_request_done(struct mmc_host *host, struct mmc_request *mrq)
70 {
71         struct mmc_command *cmd = mrq->cmd;
72         int err = cmd->error;
73
74         pr_debug("%s: req done (CMD%u): %d/%d/%d: %08x %08x %08x %08x\n",
75                  mmc_hostname(host), cmd->opcode, err,
76                  mrq->data ? mrq->data->error : 0,
77                  mrq->stop ? mrq->stop->error : 0,
78                  cmd->resp[0], cmd->resp[1], cmd->resp[2], cmd->resp[3]);
79
80         if (err && cmd->retries) {
81                 cmd->retries--;
82                 cmd->error = 0;
83                 host->ops->request(host, mrq);
84         } else if (mrq->done) {
85                 mrq->done(mrq);
86         }
87 }
88
89 EXPORT_SYMBOL(mmc_request_done);
90
91 /**
92  *      mmc_start_request - start a command on a host
93  *      @host: MMC host to start command on
94  *      @mrq: MMC request to start
95  *
96  *      Queue a command on the specified host.  We expect the
97  *      caller to be holding the host lock with interrupts disabled.
98  */
99 void
100 mmc_start_request(struct mmc_host *host, struct mmc_request *mrq)
101 {
102         pr_debug("%s: starting CMD%u arg %08x flags %08x\n",
103                  mmc_hostname(host), mrq->cmd->opcode,
104                  mrq->cmd->arg, mrq->cmd->flags);
105
106         WARN_ON(host->card_busy == NULL);
107
108         mrq->cmd->error = 0;
109         mrq->cmd->mrq = mrq;
110         if (mrq->data) {
111                 mrq->cmd->data = mrq->data;
112                 mrq->data->error = 0;
113                 mrq->data->mrq = mrq;
114                 if (mrq->stop) {
115                         mrq->data->stop = mrq->stop;
116                         mrq->stop->error = 0;
117                         mrq->stop->mrq = mrq;
118                 }
119         }
120         host->ops->request(host, mrq);
121 }
122
123 EXPORT_SYMBOL(mmc_start_request);
124
125 static void mmc_wait_done(struct mmc_request *mrq)
126 {
127         complete(mrq->done_data);
128 }
129
130 int mmc_wait_for_req(struct mmc_host *host, struct mmc_request *mrq)
131 {
132         DECLARE_COMPLETION_ONSTACK(complete);
133
134         mrq->done_data = &complete;
135         mrq->done = mmc_wait_done;
136
137         mmc_start_request(host, mrq);
138
139         wait_for_completion(&complete);
140
141         return 0;
142 }
143
144 EXPORT_SYMBOL(mmc_wait_for_req);
145
146 /**
147  *      mmc_wait_for_cmd - start a command and wait for completion
148  *      @host: MMC host to start command
149  *      @cmd: MMC command to start
150  *      @retries: maximum number of retries
151  *
152  *      Start a new MMC command for a host, and wait for the command
153  *      to complete.  Return any error that occurred while the command
154  *      was executing.  Do not attempt to parse the response.
155  */
156 int mmc_wait_for_cmd(struct mmc_host *host, struct mmc_command *cmd, int retries)
157 {
158         struct mmc_request mrq;
159
160         BUG_ON(host->card_busy == NULL);
161
162         memset(&mrq, 0, sizeof(struct mmc_request));
163
164         memset(cmd->resp, 0, sizeof(cmd->resp));
165         cmd->retries = retries;
166
167         mrq.cmd = cmd;
168         cmd->data = NULL;
169
170         mmc_wait_for_req(host, &mrq);
171
172         return cmd->error;
173 }
174
175 EXPORT_SYMBOL(mmc_wait_for_cmd);
176
177 /**
178  *      mmc_wait_for_app_cmd - start an application command and wait for
179                                completion
180  *      @host: MMC host to start command
181  *      @rca: RCA to send MMC_APP_CMD to
182  *      @cmd: MMC command to start
183  *      @retries: maximum number of retries
184  *
185  *      Sends a MMC_APP_CMD, checks the card response, sends the command
186  *      in the parameter and waits for it to complete. Return any error
187  *      that occurred while the command was executing.  Do not attempt to
188  *      parse the response.
189  */
190 int mmc_wait_for_app_cmd(struct mmc_host *host, unsigned int rca,
191         struct mmc_command *cmd, int retries)
192 {
193         struct mmc_request mrq;
194         struct mmc_command appcmd;
195
196         int i, err;
197
198         BUG_ON(host->card_busy == NULL);
199         BUG_ON(retries < 0);
200
201         err = MMC_ERR_INVALID;
202
203         /*
204          * We have to resend MMC_APP_CMD for each attempt so
205          * we cannot use the retries field in mmc_command.
206          */
207         for (i = 0;i <= retries;i++) {
208                 memset(&mrq, 0, sizeof(struct mmc_request));
209
210                 appcmd.opcode = MMC_APP_CMD;
211                 appcmd.arg = rca << 16;
212                 appcmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
213                 appcmd.retries = 0;
214                 memset(appcmd.resp, 0, sizeof(appcmd.resp));
215                 appcmd.data = NULL;
216
217                 mrq.cmd = &appcmd;
218                 appcmd.data = NULL;
219
220                 mmc_wait_for_req(host, &mrq);
221
222                 if (appcmd.error) {
223                         err = appcmd.error;
224                         continue;
225                 }
226
227                 /* Check that card supported application commands */
228                 if (!(appcmd.resp[0] & R1_APP_CMD))
229                         return MMC_ERR_FAILED;
230
231                 memset(&mrq, 0, sizeof(struct mmc_request));
232
233                 memset(cmd->resp, 0, sizeof(cmd->resp));
234                 cmd->retries = 0;
235
236                 mrq.cmd = cmd;
237                 cmd->data = NULL;
238
239                 mmc_wait_for_req(host, &mrq);
240
241                 err = cmd->error;
242                 if (cmd->error == MMC_ERR_NONE)
243                         break;
244         }
245
246         return err;
247 }
248
249 EXPORT_SYMBOL(mmc_wait_for_app_cmd);
250
251 /**
252  *      mmc_set_data_timeout - set the timeout for a data command
253  *      @data: data phase for command
254  *      @card: the MMC card associated with the data transfer
255  *      @write: flag to differentiate reads from writes
256  */
257 void mmc_set_data_timeout(struct mmc_data *data, const struct mmc_card *card,
258                           int write)
259 {
260         unsigned int mult;
261
262         /*
263          * SD cards use a 100 multiplier rather than 10
264          */
265         mult = mmc_card_sd(card) ? 100 : 10;
266
267         /*
268          * Scale up the multiplier (and therefore the timeout) by
269          * the r2w factor for writes.
270          */
271         if (write)
272                 mult <<= card->csd.r2w_factor;
273
274         data->timeout_ns = card->csd.tacc_ns * mult;
275         data->timeout_clks = card->csd.tacc_clks * mult;
276
277         /*
278          * SD cards also have an upper limit on the timeout.
279          */
280         if (mmc_card_sd(card)) {
281                 unsigned int timeout_us, limit_us;
282
283                 timeout_us = data->timeout_ns / 1000;
284                 timeout_us += data->timeout_clks * 1000 /
285                         (card->host->ios.clock / 1000);
286
287                 if (write)
288                         limit_us = 250000;
289                 else
290                         limit_us = 100000;
291
292                 if (timeout_us > limit_us) {
293                         data->timeout_ns = limit_us * 1000;
294                         data->timeout_clks = 0;
295                 }
296         }
297 }
298 EXPORT_SYMBOL(mmc_set_data_timeout);
299
300 static int mmc_select_card(struct mmc_host *host, struct mmc_card *card);
301
302 /**
303  *      __mmc_claim_host - exclusively claim a host
304  *      @host: mmc host to claim
305  *      @card: mmc card to claim host for
306  *
307  *      Claim a host for a set of operations.  If a valid card
308  *      is passed and this wasn't the last card selected, select
309  *      the card before returning.
310  *
311  *      Note: you should use mmc_card_claim_host or mmc_claim_host.
312  */
313 int __mmc_claim_host(struct mmc_host *host, struct mmc_card *card)
314 {
315         DECLARE_WAITQUEUE(wait, current);
316         unsigned long flags;
317         int err = 0;
318
319         add_wait_queue(&host->wq, &wait);
320         spin_lock_irqsave(&host->lock, flags);
321         while (1) {
322                 set_current_state(TASK_UNINTERRUPTIBLE);
323                 if (host->card_busy == NULL)
324                         break;
325                 spin_unlock_irqrestore(&host->lock, flags);
326                 schedule();
327                 spin_lock_irqsave(&host->lock, flags);
328         }
329         set_current_state(TASK_RUNNING);
330         host->card_busy = card;
331         spin_unlock_irqrestore(&host->lock, flags);
332         remove_wait_queue(&host->wq, &wait);
333
334         if (card != (void *)-1) {
335                 err = mmc_select_card(host, card);
336                 if (err != MMC_ERR_NONE)
337                         return err;
338         }
339
340         return err;
341 }
342
343 EXPORT_SYMBOL(__mmc_claim_host);
344
345 /**
346  *      mmc_release_host - release a host
347  *      @host: mmc host to release
348  *
349  *      Release a MMC host, allowing others to claim the host
350  *      for their operations.
351  */
352 void mmc_release_host(struct mmc_host *host)
353 {
354         unsigned long flags;
355
356         BUG_ON(host->card_busy == NULL);
357
358         spin_lock_irqsave(&host->lock, flags);
359         host->card_busy = NULL;
360         spin_unlock_irqrestore(&host->lock, flags);
361
362         wake_up(&host->wq);
363 }
364
365 EXPORT_SYMBOL(mmc_release_host);
366
367 static inline void mmc_set_ios(struct mmc_host *host)
368 {
369         struct mmc_ios *ios = &host->ios;
370
371         pr_debug("%s: clock %uHz busmode %u powermode %u cs %u Vdd %u width %u\n",
372                  mmc_hostname(host), ios->clock, ios->bus_mode,
373                  ios->power_mode, ios->chip_select, ios->vdd,
374                  ios->bus_width);
375         
376         host->ops->set_ios(host, ios);
377 }
378
379 static int mmc_select_card(struct mmc_host *host, struct mmc_card *card)
380 {
381         int err;
382         struct mmc_command cmd;
383
384         BUG_ON(host->card_busy == NULL);
385
386         if (host->card_selected == card)
387                 return MMC_ERR_NONE;
388
389         host->card_selected = card;
390
391         cmd.opcode = MMC_SELECT_CARD;
392         cmd.arg = card->rca << 16;
393         cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
394
395         err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
396         if (err != MMC_ERR_NONE)
397                 return err;
398
399         /*
400          * We can only change the bus width of SD cards when
401          * they are selected so we have to put the handling
402          * here.
403          *
404          * The card is in 1 bit mode by default so
405          * we only need to change if it supports the
406          * wider version.
407          */
408         if (mmc_card_sd(card) &&
409                 (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
410
411                 /*
412                 * Default bus width is 1 bit.
413                 */
414                 host->ios.bus_width = MMC_BUS_WIDTH_1;
415
416                 if (host->caps & MMC_CAP_4_BIT_DATA) {
417                         struct mmc_command cmd;
418                         cmd.opcode = SD_APP_SET_BUS_WIDTH;
419                         cmd.arg = SD_BUS_WIDTH_4;
420                         cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
421
422                         err = mmc_wait_for_app_cmd(host, card->rca, &cmd,
423                                 CMD_RETRIES);
424                         if (err != MMC_ERR_NONE)
425                                 return err;
426
427                         host->ios.bus_width = MMC_BUS_WIDTH_4;
428                 }
429         }
430
431         mmc_set_ios(host);
432
433         return MMC_ERR_NONE;
434 }
435
436 /*
437  * Ensure that no card is selected.
438  */
439 static void mmc_deselect_cards(struct mmc_host *host)
440 {
441         struct mmc_command cmd;
442
443         if (host->card_selected) {
444                 host->card_selected = NULL;
445
446                 cmd.opcode = MMC_SELECT_CARD;
447                 cmd.arg = 0;
448                 cmd.flags = MMC_RSP_NONE | MMC_CMD_AC;
449
450                 mmc_wait_for_cmd(host, &cmd, 0);
451         }
452 }
453
454
455 static inline void mmc_delay(unsigned int ms)
456 {
457         if (ms < 1000 / HZ) {
458                 cond_resched();
459                 mdelay(ms);
460         } else {
461                 msleep(ms);
462         }
463 }
464
465 /*
466  * Mask off any voltages we don't support and select
467  * the lowest voltage
468  */
469 static u32 mmc_select_voltage(struct mmc_host *host, u32 ocr)
470 {
471         int bit;
472
473         ocr &= host->ocr_avail;
474
475         bit = ffs(ocr);
476         if (bit) {
477                 bit -= 1;
478
479                 ocr &= 3 << bit;
480
481                 host->ios.vdd = bit;
482                 mmc_set_ios(host);
483         } else {
484                 ocr = 0;
485         }
486
487         return ocr;
488 }
489
490 #define UNSTUFF_BITS(resp,start,size)                                   \
491         ({                                                              \
492                 const int __size = size;                                \
493                 const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \
494                 const int __off = 3 - ((start) / 32);                   \
495                 const int __shft = (start) & 31;                        \
496                 u32 __res;                                              \
497                                                                         \
498                 __res = resp[__off] >> __shft;                          \
499                 if (__size + __shft > 32)                               \
500                         __res |= resp[__off-1] << ((32 - __shft) % 32); \
501                 __res & __mask;                                         \
502         })
503
504 /*
505  * Given the decoded CSD structure, decode the raw CID to our CID structure.
506  */
507 static void mmc_decode_cid(struct mmc_card *card)
508 {
509         u32 *resp = card->raw_cid;
510
511         memset(&card->cid, 0, sizeof(struct mmc_cid));
512
513         if (mmc_card_sd(card)) {
514                 /*
515                  * SD doesn't currently have a version field so we will
516                  * have to assume we can parse this.
517                  */
518                 card->cid.manfid                = UNSTUFF_BITS(resp, 120, 8);
519                 card->cid.oemid                 = UNSTUFF_BITS(resp, 104, 16);
520                 card->cid.prod_name[0]          = UNSTUFF_BITS(resp, 96, 8);
521                 card->cid.prod_name[1]          = UNSTUFF_BITS(resp, 88, 8);
522                 card->cid.prod_name[2]          = UNSTUFF_BITS(resp, 80, 8);
523                 card->cid.prod_name[3]          = UNSTUFF_BITS(resp, 72, 8);
524                 card->cid.prod_name[4]          = UNSTUFF_BITS(resp, 64, 8);
525                 card->cid.hwrev                 = UNSTUFF_BITS(resp, 60, 4);
526                 card->cid.fwrev                 = UNSTUFF_BITS(resp, 56, 4);
527                 card->cid.serial                = UNSTUFF_BITS(resp, 24, 32);
528                 card->cid.year                  = UNSTUFF_BITS(resp, 12, 8);
529                 card->cid.month                 = UNSTUFF_BITS(resp, 8, 4);
530
531                 card->cid.year += 2000; /* SD cards year offset */
532         } else {
533                 /*
534                  * The selection of the format here is based upon published
535                  * specs from sandisk and from what people have reported.
536                  */
537                 switch (card->csd.mmca_vsn) {
538                 case 0: /* MMC v1.0 - v1.2 */
539                 case 1: /* MMC v1.4 */
540                         card->cid.manfid        = UNSTUFF_BITS(resp, 104, 24);
541                         card->cid.prod_name[0]  = UNSTUFF_BITS(resp, 96, 8);
542                         card->cid.prod_name[1]  = UNSTUFF_BITS(resp, 88, 8);
543                         card->cid.prod_name[2]  = UNSTUFF_BITS(resp, 80, 8);
544                         card->cid.prod_name[3]  = UNSTUFF_BITS(resp, 72, 8);
545                         card->cid.prod_name[4]  = UNSTUFF_BITS(resp, 64, 8);
546                         card->cid.prod_name[5]  = UNSTUFF_BITS(resp, 56, 8);
547                         card->cid.prod_name[6]  = UNSTUFF_BITS(resp, 48, 8);
548                         card->cid.hwrev         = UNSTUFF_BITS(resp, 44, 4);
549                         card->cid.fwrev         = UNSTUFF_BITS(resp, 40, 4);
550                         card->cid.serial        = UNSTUFF_BITS(resp, 16, 24);
551                         card->cid.month         = UNSTUFF_BITS(resp, 12, 4);
552                         card->cid.year          = UNSTUFF_BITS(resp, 8, 4) + 1997;
553                         break;
554
555                 case 2: /* MMC v2.0 - v2.2 */
556                 case 3: /* MMC v3.1 - v3.3 */
557                 case 4: /* MMC v4 */
558                         card->cid.manfid        = UNSTUFF_BITS(resp, 120, 8);
559                         card->cid.oemid         = UNSTUFF_BITS(resp, 104, 16);
560                         card->cid.prod_name[0]  = UNSTUFF_BITS(resp, 96, 8);
561                         card->cid.prod_name[1]  = UNSTUFF_BITS(resp, 88, 8);
562                         card->cid.prod_name[2]  = UNSTUFF_BITS(resp, 80, 8);
563                         card->cid.prod_name[3]  = UNSTUFF_BITS(resp, 72, 8);
564                         card->cid.prod_name[4]  = UNSTUFF_BITS(resp, 64, 8);
565                         card->cid.prod_name[5]  = UNSTUFF_BITS(resp, 56, 8);
566                         card->cid.serial        = UNSTUFF_BITS(resp, 16, 32);
567                         card->cid.month         = UNSTUFF_BITS(resp, 12, 4);
568                         card->cid.year          = UNSTUFF_BITS(resp, 8, 4) + 1997;
569                         break;
570
571                 default:
572                         printk("%s: card has unknown MMCA version %d\n",
573                                 mmc_hostname(card->host), card->csd.mmca_vsn);
574                         mmc_card_set_bad(card);
575                         break;
576                 }
577         }
578 }
579
580 /*
581  * Given a 128-bit response, decode to our card CSD structure.
582  */
583 static void mmc_decode_csd(struct mmc_card *card)
584 {
585         struct mmc_csd *csd = &card->csd;
586         unsigned int e, m, csd_struct;
587         u32 *resp = card->raw_csd;
588
589         if (mmc_card_sd(card)) {
590                 csd_struct = UNSTUFF_BITS(resp, 126, 2);
591                 if (csd_struct != 0) {
592                         printk("%s: unrecognised CSD structure version %d\n",
593                                 mmc_hostname(card->host), csd_struct);
594                         mmc_card_set_bad(card);
595                         return;
596                 }
597
598                 m = UNSTUFF_BITS(resp, 115, 4);
599                 e = UNSTUFF_BITS(resp, 112, 3);
600                 csd->tacc_ns     = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
601                 csd->tacc_clks   = UNSTUFF_BITS(resp, 104, 8) * 100;
602
603                 m = UNSTUFF_BITS(resp, 99, 4);
604                 e = UNSTUFF_BITS(resp, 96, 3);
605                 csd->max_dtr      = tran_exp[e] * tran_mant[m];
606                 csd->cmdclass     = UNSTUFF_BITS(resp, 84, 12);
607
608                 e = UNSTUFF_BITS(resp, 47, 3);
609                 m = UNSTUFF_BITS(resp, 62, 12);
610                 csd->capacity     = (1 + m) << (e + 2);
611
612                 csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
613                 csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
614                 csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
615                 csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
616                 csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
617                 csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
618                 csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
619         } else {
620                 /*
621                  * We only understand CSD structure v1.1 and v1.2.
622                  * v1.2 has extra information in bits 15, 11 and 10.
623                  */
624                 csd_struct = UNSTUFF_BITS(resp, 126, 2);
625                 if (csd_struct != 1 && csd_struct != 2) {
626                         printk("%s: unrecognised CSD structure version %d\n",
627                                 mmc_hostname(card->host), csd_struct);
628                         mmc_card_set_bad(card);
629                         return;
630                 }
631
632                 csd->mmca_vsn    = UNSTUFF_BITS(resp, 122, 4);
633                 m = UNSTUFF_BITS(resp, 115, 4);
634                 e = UNSTUFF_BITS(resp, 112, 3);
635                 csd->tacc_ns     = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
636                 csd->tacc_clks   = UNSTUFF_BITS(resp, 104, 8) * 100;
637
638                 m = UNSTUFF_BITS(resp, 99, 4);
639                 e = UNSTUFF_BITS(resp, 96, 3);
640                 csd->max_dtr      = tran_exp[e] * tran_mant[m];
641                 csd->cmdclass     = UNSTUFF_BITS(resp, 84, 12);
642
643                 e = UNSTUFF_BITS(resp, 47, 3);
644                 m = UNSTUFF_BITS(resp, 62, 12);
645                 csd->capacity     = (1 + m) << (e + 2);
646
647                 csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
648                 csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
649                 csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
650                 csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
651                 csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
652                 csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
653                 csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
654         }
655 }
656
657 /*
658  * Given a 64-bit response, decode to our card SCR structure.
659  */
660 static void mmc_decode_scr(struct mmc_card *card)
661 {
662         struct sd_scr *scr = &card->scr;
663         unsigned int scr_struct;
664         u32 resp[4];
665
666         BUG_ON(!mmc_card_sd(card));
667
668         resp[3] = card->raw_scr[1];
669         resp[2] = card->raw_scr[0];
670
671         scr_struct = UNSTUFF_BITS(resp, 60, 4);
672         if (scr_struct != 0) {
673                 printk("%s: unrecognised SCR structure version %d\n",
674                         mmc_hostname(card->host), scr_struct);
675                 mmc_card_set_bad(card);
676                 return;
677         }
678
679         scr->sda_vsn = UNSTUFF_BITS(resp, 56, 4);
680         scr->bus_widths = UNSTUFF_BITS(resp, 48, 4);
681 }
682
683 /*
684  * Locate a MMC card on this MMC host given a raw CID.
685  */
686 static struct mmc_card *mmc_find_card(struct mmc_host *host, u32 *raw_cid)
687 {
688         struct mmc_card *card;
689
690         list_for_each_entry(card, &host->cards, node) {
691                 if (memcmp(card->raw_cid, raw_cid, sizeof(card->raw_cid)) == 0)
692                         return card;
693         }
694         return NULL;
695 }
696
697 /*
698  * Allocate a new MMC card, and assign a unique RCA.
699  */
700 static struct mmc_card *
701 mmc_alloc_card(struct mmc_host *host, u32 *raw_cid, unsigned int *frca)
702 {
703         struct mmc_card *card, *c;
704         unsigned int rca = *frca;
705
706         card = kmalloc(sizeof(struct mmc_card), GFP_KERNEL);
707         if (!card)
708                 return ERR_PTR(-ENOMEM);
709
710         mmc_init_card(card, host);
711         memcpy(card->raw_cid, raw_cid, sizeof(card->raw_cid));
712
713  again:
714         list_for_each_entry(c, &host->cards, node)
715                 if (c->rca == rca) {
716                         rca++;
717                         goto again;
718                 }
719
720         card->rca = rca;
721
722         *frca = rca;
723
724         return card;
725 }
726
727 /*
728  * Tell attached cards to go to IDLE state
729  */
730 static void mmc_idle_cards(struct mmc_host *host)
731 {
732         struct mmc_command cmd;
733
734         host->ios.chip_select = MMC_CS_HIGH;
735         mmc_set_ios(host);
736
737         mmc_delay(1);
738
739         cmd.opcode = MMC_GO_IDLE_STATE;
740         cmd.arg = 0;
741         cmd.flags = MMC_RSP_NONE | MMC_CMD_BC;
742
743         mmc_wait_for_cmd(host, &cmd, 0);
744
745         mmc_delay(1);
746
747         host->ios.chip_select = MMC_CS_DONTCARE;
748         mmc_set_ios(host);
749
750         mmc_delay(1);
751 }
752
753 /*
754  * Apply power to the MMC stack.  This is a two-stage process.
755  * First, we enable power to the card without the clock running.
756  * We then wait a bit for the power to stabilise.  Finally,
757  * enable the bus drivers and clock to the card.
758  *
759  * We must _NOT_ enable the clock prior to power stablising.
760  *
761  * If a host does all the power sequencing itself, ignore the
762  * initial MMC_POWER_UP stage.
763  */
764 static void mmc_power_up(struct mmc_host *host)
765 {
766         int bit = fls(host->ocr_avail) - 1;
767
768         host->ios.vdd = bit;
769         host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
770         host->ios.chip_select = MMC_CS_DONTCARE;
771         host->ios.power_mode = MMC_POWER_UP;
772         host->ios.bus_width = MMC_BUS_WIDTH_1;
773         mmc_set_ios(host);
774
775         mmc_delay(1);
776
777         host->ios.clock = host->f_min;
778         host->ios.power_mode = MMC_POWER_ON;
779         mmc_set_ios(host);
780
781         mmc_delay(2);
782 }
783
784 static void mmc_power_off(struct mmc_host *host)
785 {
786         host->ios.clock = 0;
787         host->ios.vdd = 0;
788         host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
789         host->ios.chip_select = MMC_CS_DONTCARE;
790         host->ios.power_mode = MMC_POWER_OFF;
791         host->ios.bus_width = MMC_BUS_WIDTH_1;
792         mmc_set_ios(host);
793 }
794
795 static int mmc_send_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr)
796 {
797         struct mmc_command cmd;
798         int i, err = 0;
799
800         cmd.opcode = MMC_SEND_OP_COND;
801         cmd.arg = ocr;
802         cmd.flags = MMC_RSP_R3 | MMC_CMD_BCR;
803
804         for (i = 100; i; i--) {
805                 err = mmc_wait_for_cmd(host, &cmd, 0);
806                 if (err != MMC_ERR_NONE)
807                         break;
808
809                 if (cmd.resp[0] & MMC_CARD_BUSY || ocr == 0)
810                         break;
811
812                 err = MMC_ERR_TIMEOUT;
813
814                 mmc_delay(10);
815         }
816
817         if (rocr)
818                 *rocr = cmd.resp[0];
819
820         return err;
821 }
822
823 static int mmc_send_app_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr)
824 {
825         struct mmc_command cmd;
826         int i, err = 0;
827
828         cmd.opcode = SD_APP_OP_COND;
829         cmd.arg = ocr;
830         cmd.flags = MMC_RSP_R3 | MMC_CMD_BCR;
831
832         for (i = 100; i; i--) {
833                 err = mmc_wait_for_app_cmd(host, 0, &cmd, CMD_RETRIES);
834                 if (err != MMC_ERR_NONE)
835                         break;
836
837                 if (cmd.resp[0] & MMC_CARD_BUSY || ocr == 0)
838                         break;
839
840                 err = MMC_ERR_TIMEOUT;
841
842                 mmc_delay(10);
843         }
844
845         if (rocr)
846                 *rocr = cmd.resp[0];
847
848         return err;
849 }
850
851 /*
852  * Discover cards by requesting their CID.  If this command
853  * times out, it is not an error; there are no further cards
854  * to be discovered.  Add new cards to the list.
855  *
856  * Create a mmc_card entry for each discovered card, assigning
857  * it an RCA, and save the raw CID for decoding later.
858  */
859 static void mmc_discover_cards(struct mmc_host *host)
860 {
861         struct mmc_card *card;
862         unsigned int first_rca = 1, err;
863
864         while (1) {
865                 struct mmc_command cmd;
866
867                 cmd.opcode = MMC_ALL_SEND_CID;
868                 cmd.arg = 0;
869                 cmd.flags = MMC_RSP_R2 | MMC_CMD_BCR;
870
871                 err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
872                 if (err == MMC_ERR_TIMEOUT) {
873                         err = MMC_ERR_NONE;
874                         break;
875                 }
876                 if (err != MMC_ERR_NONE) {
877                         printk(KERN_ERR "%s: error requesting CID: %d\n",
878                                 mmc_hostname(host), err);
879                         break;
880                 }
881
882                 card = mmc_find_card(host, cmd.resp);
883                 if (!card) {
884                         card = mmc_alloc_card(host, cmd.resp, &first_rca);
885                         if (IS_ERR(card)) {
886                                 err = PTR_ERR(card);
887                                 break;
888                         }
889                         list_add(&card->node, &host->cards);
890                 }
891
892                 card->state &= ~MMC_STATE_DEAD;
893
894                 if (host->mode == MMC_MODE_SD) {
895                         mmc_card_set_sd(card);
896
897                         cmd.opcode = SD_SEND_RELATIVE_ADDR;
898                         cmd.arg = 0;
899                         cmd.flags = MMC_RSP_R6 | MMC_CMD_BCR;
900
901                         err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
902                         if (err != MMC_ERR_NONE)
903                                 mmc_card_set_dead(card);
904                         else {
905                                 card->rca = cmd.resp[0] >> 16;
906
907                                 if (!host->ops->get_ro) {
908                                         printk(KERN_WARNING "%s: host does not "
909                                                 "support reading read-only "
910                                                 "switch. assuming write-enable.\n",
911                                                 mmc_hostname(host));
912                                 } else {
913                                         if (host->ops->get_ro(host))
914                                                 mmc_card_set_readonly(card);
915                                 }
916                         }
917                 } else {
918                         cmd.opcode = MMC_SET_RELATIVE_ADDR;
919                         cmd.arg = card->rca << 16;
920                         cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
921
922                         err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
923                         if (err != MMC_ERR_NONE)
924                                 mmc_card_set_dead(card);
925                 }
926         }
927 }
928
929 static void mmc_read_csds(struct mmc_host *host)
930 {
931         struct mmc_card *card;
932
933         list_for_each_entry(card, &host->cards, node) {
934                 struct mmc_command cmd;
935                 int err;
936
937                 if (card->state & (MMC_STATE_DEAD|MMC_STATE_PRESENT))
938                         continue;
939
940                 cmd.opcode = MMC_SEND_CSD;
941                 cmd.arg = card->rca << 16;
942                 cmd.flags = MMC_RSP_R2 | MMC_CMD_AC;
943
944                 err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
945                 if (err != MMC_ERR_NONE) {
946                         mmc_card_set_dead(card);
947                         continue;
948                 }
949
950                 memcpy(card->raw_csd, cmd.resp, sizeof(card->raw_csd));
951
952                 mmc_decode_csd(card);
953                 mmc_decode_cid(card);
954         }
955 }
956
957 static void mmc_process_ext_csds(struct mmc_host *host)
958 {
959         int err;
960         struct mmc_card *card;
961
962         struct mmc_request mrq;
963         struct mmc_command cmd;
964         struct mmc_data data;
965
966         struct scatterlist sg;
967
968         /*
969          * As the ext_csd is so large and mostly unused, we don't store the
970          * raw block in mmc_card.
971          */
972         u8 *ext_csd;
973         ext_csd = kmalloc(512, GFP_KERNEL);
974         if (!ext_csd) {
975                 printk("%s: could not allocate a buffer to receive the ext_csd."
976                        "mmc v4 cards will be treated as v3.\n",
977                         mmc_hostname(host));
978                 return;
979         }
980
981         list_for_each_entry(card, &host->cards, node) {
982                 if (card->state & (MMC_STATE_DEAD|MMC_STATE_PRESENT))
983                         continue;
984                 if (mmc_card_sd(card))
985                         continue;
986                 if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
987                         continue;
988
989                 err = mmc_select_card(host, card);
990                 if (err != MMC_ERR_NONE) {
991                         mmc_card_set_dead(card);
992                         continue;
993                 }
994
995                 memset(&cmd, 0, sizeof(struct mmc_command));
996
997                 cmd.opcode = MMC_SEND_EXT_CSD;
998                 cmd.arg = 0;
999                 cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
1000
1001                 memset(&data, 0, sizeof(struct mmc_data));
1002
1003                 mmc_set_data_timeout(&data, card, 0);
1004
1005                 data.blksz = 512;
1006                 data.blocks = 1;
1007                 data.flags = MMC_DATA_READ;
1008                 data.sg = &sg;
1009                 data.sg_len = 1;
1010
1011                 memset(&mrq, 0, sizeof(struct mmc_request));
1012
1013                 mrq.cmd = &cmd;
1014                 mrq.data = &data;
1015
1016                 sg_init_one(&sg, ext_csd, 512);
1017
1018                 mmc_wait_for_req(host, &mrq);
1019
1020                 if (cmd.error != MMC_ERR_NONE || data.error != MMC_ERR_NONE) {
1021                         mmc_card_set_dead(card);
1022                         continue;
1023                 }
1024
1025                 switch (ext_csd[EXT_CSD_CARD_TYPE]) {
1026                 case EXT_CSD_CARD_TYPE_52 | EXT_CSD_CARD_TYPE_26:
1027                         card->ext_csd.hs_max_dtr = 52000000;
1028                         break;
1029                 case EXT_CSD_CARD_TYPE_26:
1030                         card->ext_csd.hs_max_dtr = 26000000;
1031                         break;
1032                 default:
1033                         /* MMC v4 spec says this cannot happen */
1034                         printk("%s: card is mmc v4 but doesn't support "
1035                                "any high-speed modes.\n",
1036                                 mmc_hostname(card->host));
1037                         mmc_card_set_bad(card);
1038                         continue;
1039                 }
1040
1041                 /* Activate highspeed support. */
1042                 cmd.opcode = MMC_SWITCH;
1043                 cmd.arg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
1044                           (EXT_CSD_HS_TIMING << 16) |
1045                           (1 << 8) |
1046                           EXT_CSD_CMD_SET_NORMAL;
1047                 cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
1048
1049                 err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
1050                 if (err != MMC_ERR_NONE) {
1051                         printk("%s: failed to switch card to mmc v4 "
1052                                "high-speed mode.\n",
1053                                mmc_hostname(card->host));
1054                         continue;
1055                 }
1056
1057                 mmc_card_set_highspeed(card);
1058
1059                 /* Check for host support for wide-bus modes. */
1060                 if (!(host->caps & MMC_CAP_4_BIT_DATA)) {
1061                         continue;
1062                 }
1063
1064                 /* Activate 4-bit support. */
1065                 cmd.opcode = MMC_SWITCH;
1066                 cmd.arg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
1067                           (EXT_CSD_BUS_WIDTH << 16) |
1068                           (EXT_CSD_BUS_WIDTH_4 << 8) |
1069                           EXT_CSD_CMD_SET_NORMAL;
1070                 cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
1071
1072                 err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
1073                 if (err != MMC_ERR_NONE) {
1074                         printk("%s: failed to switch card to "
1075                                "mmc v4 4-bit bus mode.\n",
1076                                mmc_hostname(card->host));
1077                         continue;
1078                 }
1079
1080                 host->ios.bus_width = MMC_BUS_WIDTH_4;
1081         }
1082
1083         kfree(ext_csd);
1084
1085         mmc_deselect_cards(host);
1086 }
1087
1088 static void mmc_read_scrs(struct mmc_host *host)
1089 {
1090         int err;
1091         struct mmc_card *card;
1092         struct mmc_request mrq;
1093         struct mmc_command cmd;
1094         struct mmc_data data;
1095         struct scatterlist sg;
1096
1097         list_for_each_entry(card, &host->cards, node) {
1098                 if (card->state & (MMC_STATE_DEAD|MMC_STATE_PRESENT))
1099                         continue;
1100                 if (!mmc_card_sd(card))
1101                         continue;
1102
1103                 err = mmc_select_card(host, card);
1104                 if (err != MMC_ERR_NONE) {
1105                         mmc_card_set_dead(card);
1106                         continue;
1107                 }
1108
1109                 memset(&cmd, 0, sizeof(struct mmc_command));
1110
1111                 cmd.opcode = MMC_APP_CMD;
1112                 cmd.arg = card->rca << 16;
1113                 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
1114
1115                 err = mmc_wait_for_cmd(host, &cmd, 0);
1116                 if ((err != MMC_ERR_NONE) || !(cmd.resp[0] & R1_APP_CMD)) {
1117                         mmc_card_set_dead(card);
1118                         continue;
1119                 }
1120
1121                 memset(&cmd, 0, sizeof(struct mmc_command));
1122
1123                 cmd.opcode = SD_APP_SEND_SCR;
1124                 cmd.arg = 0;
1125                 cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
1126
1127                 memset(&data, 0, sizeof(struct mmc_data));
1128
1129                 mmc_set_data_timeout(&data, card, 0);
1130
1131                 data.blksz = 1 << 3;
1132                 data.blocks = 1;
1133                 data.flags = MMC_DATA_READ;
1134                 data.sg = &sg;
1135                 data.sg_len = 1;
1136
1137                 memset(&mrq, 0, sizeof(struct mmc_request));
1138
1139                 mrq.cmd = &cmd;
1140                 mrq.data = &data;
1141
1142                 sg_init_one(&sg, (u8*)card->raw_scr, 8);
1143
1144                 mmc_wait_for_req(host, &mrq);
1145
1146                 if (cmd.error != MMC_ERR_NONE || data.error != MMC_ERR_NONE) {
1147                         mmc_card_set_dead(card);
1148                         continue;
1149                 }
1150
1151                 card->raw_scr[0] = ntohl(card->raw_scr[0]);
1152                 card->raw_scr[1] = ntohl(card->raw_scr[1]);
1153
1154                 mmc_decode_scr(card);
1155         }
1156
1157         mmc_deselect_cards(host);
1158 }
1159
1160 static void mmc_read_switch_caps(struct mmc_host *host)
1161 {
1162         int err;
1163         struct mmc_card *card;
1164         struct mmc_request mrq;
1165         struct mmc_command cmd;
1166         struct mmc_data data;
1167         unsigned char *status;
1168         struct scatterlist sg;
1169
1170         status = kmalloc(64, GFP_KERNEL);
1171         if (!status) {
1172                 printk(KERN_WARNING "%s: Unable to allocate buffer for "
1173                         "reading switch capabilities.\n",
1174                         mmc_hostname(host));
1175                 return;
1176         }
1177
1178         list_for_each_entry(card, &host->cards, node) {
1179                 if (card->state & (MMC_STATE_DEAD|MMC_STATE_PRESENT))
1180                         continue;
1181                 if (!mmc_card_sd(card))
1182                         continue;
1183                 if (card->scr.sda_vsn < SCR_SPEC_VER_1)
1184                         continue;
1185
1186                 err = mmc_select_card(host, card);
1187                 if (err != MMC_ERR_NONE) {
1188                         mmc_card_set_dead(card);
1189                         continue;
1190                 }
1191
1192                 memset(&cmd, 0, sizeof(struct mmc_command));
1193
1194                 cmd.opcode = SD_SWITCH;
1195                 cmd.arg = 0x00FFFFF1;
1196                 cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
1197
1198                 memset(&data, 0, sizeof(struct mmc_data));
1199
1200                 mmc_set_data_timeout(&data, card, 0);
1201
1202                 data.blksz = 64;
1203                 data.blocks = 1;
1204                 data.flags = MMC_DATA_READ;
1205                 data.sg = &sg;
1206                 data.sg_len = 1;
1207
1208                 memset(&mrq, 0, sizeof(struct mmc_request));
1209
1210                 mrq.cmd = &cmd;
1211                 mrq.data = &data;
1212
1213                 sg_init_one(&sg, status, 64);
1214
1215                 mmc_wait_for_req(host, &mrq);
1216
1217                 if (cmd.error != MMC_ERR_NONE || data.error != MMC_ERR_NONE) {
1218                         mmc_card_set_dead(card);
1219                         continue;
1220                 }
1221
1222                 if (status[13] & 0x02)
1223                         card->sw_caps.hs_max_dtr = 50000000;
1224
1225                 memset(&cmd, 0, sizeof(struct mmc_command));
1226
1227                 cmd.opcode = SD_SWITCH;
1228                 cmd.arg = 0x80FFFFF1;
1229                 cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
1230
1231                 memset(&data, 0, sizeof(struct mmc_data));
1232
1233                 mmc_set_data_timeout(&data, card, 0);
1234
1235                 data.blksz = 64;
1236                 data.blocks = 1;
1237                 data.flags = MMC_DATA_READ;
1238                 data.sg = &sg;
1239                 data.sg_len = 1;
1240
1241                 memset(&mrq, 0, sizeof(struct mmc_request));
1242
1243                 mrq.cmd = &cmd;
1244                 mrq.data = &data;
1245
1246                 sg_init_one(&sg, status, 64);
1247
1248                 mmc_wait_for_req(host, &mrq);
1249
1250                 if (cmd.error != MMC_ERR_NONE || data.error != MMC_ERR_NONE) {
1251                         mmc_card_set_dead(card);
1252                         continue;
1253                 }
1254
1255                 if ((status[16] & 0xF) != 1) {
1256                         printk(KERN_WARNING "%s: Problem switching card "
1257                                 "into high-speed mode!\n",
1258                                 mmc_hostname(host));
1259                         continue;
1260                 }
1261
1262                 mmc_card_set_highspeed(card);
1263         }
1264
1265         kfree(status);
1266
1267         mmc_deselect_cards(host);
1268 }
1269
1270 static unsigned int mmc_calculate_clock(struct mmc_host *host)
1271 {
1272         struct mmc_card *card;
1273         unsigned int max_dtr = host->f_max;
1274
1275         list_for_each_entry(card, &host->cards, node)
1276                 if (!mmc_card_dead(card)) {
1277                         if (mmc_card_highspeed(card) && mmc_card_sd(card)) {
1278                                 if (max_dtr > card->sw_caps.hs_max_dtr)
1279                                         max_dtr = card->sw_caps.hs_max_dtr;
1280                         } else if (mmc_card_highspeed(card) && !mmc_card_sd(card)) {
1281                                 if (max_dtr > card->ext_csd.hs_max_dtr)
1282                                         max_dtr = card->ext_csd.hs_max_dtr;
1283                         } else if (max_dtr > card->csd.max_dtr) {
1284                                 max_dtr = card->csd.max_dtr;
1285                         }
1286                 }
1287
1288         pr_debug("%s: selected %d.%03dMHz transfer rate\n",
1289                  mmc_hostname(host),
1290                  max_dtr / 1000000, (max_dtr / 1000) % 1000);
1291
1292         return max_dtr;
1293 }
1294
1295 /*
1296  * Check whether cards we already know about are still present.
1297  * We do this by requesting status, and checking whether a card
1298  * responds.
1299  *
1300  * A request for status does not cause a state change in data
1301  * transfer mode.
1302  */
1303 static void mmc_check_cards(struct mmc_host *host)
1304 {
1305         struct list_head *l, *n;
1306
1307         mmc_deselect_cards(host);
1308
1309         list_for_each_safe(l, n, &host->cards) {
1310                 struct mmc_card *card = mmc_list_to_card(l);
1311                 struct mmc_command cmd;
1312                 int err;
1313
1314                 cmd.opcode = MMC_SEND_STATUS;
1315                 cmd.arg = card->rca << 16;
1316                 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
1317
1318                 err = mmc_wait_for_cmd(host, &cmd, CMD_RETRIES);
1319                 if (err == MMC_ERR_NONE)
1320                         continue;
1321
1322                 mmc_card_set_dead(card);
1323         }
1324 }
1325
1326 static void mmc_setup(struct mmc_host *host)
1327 {
1328         if (host->ios.power_mode != MMC_POWER_ON) {
1329                 int err;
1330                 u32 ocr;
1331
1332                 host->mode = MMC_MODE_SD;
1333
1334                 mmc_power_up(host);
1335                 mmc_idle_cards(host);
1336
1337                 err = mmc_send_app_op_cond(host, 0, &ocr);
1338
1339                 /*
1340                  * If we fail to detect any SD cards then try
1341                  * searching for MMC cards.
1342                  */
1343                 if (err != MMC_ERR_NONE) {
1344                         host->mode = MMC_MODE_MMC;
1345
1346                         err = mmc_send_op_cond(host, 0, &ocr);
1347                         if (err != MMC_ERR_NONE)
1348                                 return;
1349                 }
1350
1351                 host->ocr = mmc_select_voltage(host, ocr);
1352
1353                 /*
1354                  * Since we're changing the OCR value, we seem to
1355                  * need to tell some cards to go back to the idle
1356                  * state.  We wait 1ms to give cards time to
1357                  * respond.
1358                  */
1359                 if (host->ocr)
1360                         mmc_idle_cards(host);
1361         } else {
1362                 host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
1363                 host->ios.clock = host->f_min;
1364                 mmc_set_ios(host);
1365
1366                 /*
1367                  * We should remember the OCR mask from the existing
1368                  * cards, and detect the new cards OCR mask, combine
1369                  * the two and re-select the VDD.  However, if we do
1370                  * change VDD, we should do an idle, and then do a
1371                  * full re-initialisation.  We would need to notify
1372                  * drivers so that they can re-setup the cards as
1373                  * well, while keeping their queues at bay.
1374                  *
1375                  * For the moment, we take the easy way out - if the
1376                  * new cards don't like our currently selected VDD,
1377                  * they drop off the bus.
1378                  */
1379         }
1380
1381         if (host->ocr == 0)
1382                 return;
1383
1384         /*
1385          * Send the selected OCR multiple times... until the cards
1386          * all get the idea that they should be ready for CMD2.
1387          * (My SanDisk card seems to need this.)
1388          */
1389         if (host->mode == MMC_MODE_SD)
1390                 mmc_send_app_op_cond(host, host->ocr, NULL);
1391         else
1392                 mmc_send_op_cond(host, host->ocr, NULL);
1393
1394         mmc_discover_cards(host);
1395
1396         /*
1397          * Ok, now switch to push-pull mode.
1398          */
1399         host->ios.bus_mode = MMC_BUSMODE_PUSHPULL;
1400         mmc_set_ios(host);
1401
1402         mmc_read_csds(host);
1403
1404         if (host->mode == MMC_MODE_SD) {
1405                 mmc_read_scrs(host);
1406                 mmc_read_switch_caps(host);
1407         } else
1408                 mmc_process_ext_csds(host);
1409 }
1410
1411
1412 /**
1413  *      mmc_detect_change - process change of state on a MMC socket
1414  *      @host: host which changed state.
1415  *      @delay: optional delay to wait before detection (jiffies)
1416  *
1417  *      All we know is that card(s) have been inserted or removed
1418  *      from the socket(s).  We don't know which socket or cards.
1419  */
1420 void mmc_detect_change(struct mmc_host *host, unsigned long delay)
1421 {
1422         mmc_schedule_delayed_work(&host->detect, delay);
1423 }
1424
1425 EXPORT_SYMBOL(mmc_detect_change);
1426
1427
1428 static void mmc_rescan(struct work_struct *work)
1429 {
1430         struct mmc_host *host =
1431                 container_of(work, struct mmc_host, detect.work);
1432         struct list_head *l, *n;
1433         unsigned char power_mode;
1434
1435         mmc_claim_host(host);
1436
1437         /*
1438          * Check for removed cards and newly inserted ones. We check for
1439          * removed cards first so we can intelligently re-select the VDD.
1440          */
1441         power_mode = host->ios.power_mode;
1442         if (power_mode == MMC_POWER_ON)
1443                 mmc_check_cards(host);
1444
1445         mmc_setup(host);
1446
1447         /*
1448          * Some broken cards process CMD1 even in stand-by state. There is
1449          * no reply, but an ILLEGAL_COMMAND error is cached and returned
1450          * after next command. We poll for card status here to clear any
1451          * possibly pending error.
1452          */
1453         if (power_mode == MMC_POWER_ON)
1454                 mmc_check_cards(host);
1455
1456         if (!list_empty(&host->cards)) {
1457                 /*
1458                  * (Re-)calculate the fastest clock rate which the
1459                  * attached cards and the host support.
1460                  */
1461                 host->ios.clock = mmc_calculate_clock(host);
1462                 mmc_set_ios(host);
1463         }
1464
1465         mmc_release_host(host);
1466
1467         list_for_each_safe(l, n, &host->cards) {
1468                 struct mmc_card *card = mmc_list_to_card(l);
1469
1470                 /*
1471                  * If this is a new and good card, register it.
1472                  */
1473                 if (!mmc_card_present(card) && !mmc_card_dead(card)) {
1474                         if (mmc_register_card(card))
1475                                 mmc_card_set_dead(card);
1476                         else
1477                                 mmc_card_set_present(card);
1478                 }
1479
1480                 /*
1481                  * If this card is dead, destroy it.
1482                  */
1483                 if (mmc_card_dead(card)) {
1484                         list_del(&card->node);
1485                         mmc_remove_card(card);
1486                 }
1487         }
1488
1489         /*
1490          * If we discover that there are no cards on the
1491          * bus, turn off the clock and power down.
1492          */
1493         if (list_empty(&host->cards))
1494                 mmc_power_off(host);
1495 }
1496
1497
1498 /**
1499  *      mmc_alloc_host - initialise the per-host structure.
1500  *      @extra: sizeof private data structure
1501  *      @dev: pointer to host device model structure
1502  *
1503  *      Initialise the per-host structure.
1504  */
1505 struct mmc_host *mmc_alloc_host(int extra, struct device *dev)
1506 {
1507         struct mmc_host *host;
1508
1509         host = mmc_alloc_host_sysfs(extra, dev);
1510         if (host) {
1511                 spin_lock_init(&host->lock);
1512                 init_waitqueue_head(&host->wq);
1513                 INIT_LIST_HEAD(&host->cards);
1514                 INIT_DELAYED_WORK(&host->detect, mmc_rescan);
1515
1516                 /*
1517                  * By default, hosts do not support SGIO or large requests.
1518                  * They have to set these according to their abilities.
1519                  */
1520                 host->max_hw_segs = 1;
1521                 host->max_phys_segs = 1;
1522                 host->max_sectors = 1 << (PAGE_CACHE_SHIFT - 9);
1523                 host->max_seg_size = PAGE_CACHE_SIZE;
1524         }
1525
1526         return host;
1527 }
1528
1529 EXPORT_SYMBOL(mmc_alloc_host);
1530
1531 /**
1532  *      mmc_add_host - initialise host hardware
1533  *      @host: mmc host
1534  */
1535 int mmc_add_host(struct mmc_host *host)
1536 {
1537         int ret;
1538
1539         ret = mmc_add_host_sysfs(host);
1540         if (ret == 0) {
1541                 mmc_power_off(host);
1542                 mmc_detect_change(host, 0);
1543         }
1544
1545         return ret;
1546 }
1547
1548 EXPORT_SYMBOL(mmc_add_host);
1549
1550 /**
1551  *      mmc_remove_host - remove host hardware
1552  *      @host: mmc host
1553  *
1554  *      Unregister and remove all cards associated with this host,
1555  *      and power down the MMC bus.
1556  */
1557 void mmc_remove_host(struct mmc_host *host)
1558 {
1559         struct list_head *l, *n;
1560
1561         list_for_each_safe(l, n, &host->cards) {
1562                 struct mmc_card *card = mmc_list_to_card(l);
1563
1564                 mmc_remove_card(card);
1565         }
1566
1567         mmc_power_off(host);
1568         mmc_remove_host_sysfs(host);
1569 }
1570
1571 EXPORT_SYMBOL(mmc_remove_host);
1572
1573 /**
1574  *      mmc_free_host - free the host structure
1575  *      @host: mmc host
1576  *
1577  *      Free the host once all references to it have been dropped.
1578  */
1579 void mmc_free_host(struct mmc_host *host)
1580 {
1581         mmc_flush_scheduled_work();
1582         mmc_free_host_sysfs(host);
1583 }
1584
1585 EXPORT_SYMBOL(mmc_free_host);
1586
1587 #ifdef CONFIG_PM
1588
1589 /**
1590  *      mmc_suspend_host - suspend a host
1591  *      @host: mmc host
1592  *      @state: suspend mode (PM_SUSPEND_xxx)
1593  */
1594 int mmc_suspend_host(struct mmc_host *host, pm_message_t state)
1595 {
1596         mmc_claim_host(host);
1597         mmc_deselect_cards(host);
1598         mmc_power_off(host);
1599         mmc_release_host(host);
1600
1601         return 0;
1602 }
1603
1604 EXPORT_SYMBOL(mmc_suspend_host);
1605
1606 /**
1607  *      mmc_resume_host - resume a previously suspended host
1608  *      @host: mmc host
1609  */
1610 int mmc_resume_host(struct mmc_host *host)
1611 {
1612         mmc_rescan(&host->detect.work);
1613
1614         return 0;
1615 }
1616
1617 EXPORT_SYMBOL(mmc_resume_host);
1618
1619 #endif
1620
1621 MODULE_LICENSE("GPL");