1a726aef211d7f45600e874d6572bb8744497350
[~shefty/rdma-dev.git] / drivers / mmc / core / sdio.c
1 /*
2  *  linux/drivers/mmc/sdio.c
3  *
4  *  Copyright 2006-2007 Pierre Ossman
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or (at
9  * your option) any later version.
10  */
11
12 #include <linux/err.h>
13 #include <linux/pm_runtime.h>
14
15 #include <linux/mmc/host.h>
16 #include <linux/mmc/card.h>
17 #include <linux/mmc/mmc.h>
18 #include <linux/mmc/sdio.h>
19 #include <linux/mmc/sdio_func.h>
20 #include <linux/mmc/sdio_ids.h>
21
22 #include "core.h"
23 #include "bus.h"
24 #include "sd.h"
25 #include "sdio_bus.h"
26 #include "mmc_ops.h"
27 #include "sd_ops.h"
28 #include "sdio_ops.h"
29 #include "sdio_cis.h"
30
31 static int sdio_read_fbr(struct sdio_func *func)
32 {
33         int ret;
34         unsigned char data;
35
36         if (mmc_card_nonstd_func_interface(func->card)) {
37                 func->class = SDIO_CLASS_NONE;
38                 return 0;
39         }
40
41         ret = mmc_io_rw_direct(func->card, 0, 0,
42                 SDIO_FBR_BASE(func->num) + SDIO_FBR_STD_IF, 0, &data);
43         if (ret)
44                 goto out;
45
46         data &= 0x0f;
47
48         if (data == 0x0f) {
49                 ret = mmc_io_rw_direct(func->card, 0, 0,
50                         SDIO_FBR_BASE(func->num) + SDIO_FBR_STD_IF_EXT, 0, &data);
51                 if (ret)
52                         goto out;
53         }
54
55         func->class = data;
56
57 out:
58         return ret;
59 }
60
61 static int sdio_init_func(struct mmc_card *card, unsigned int fn)
62 {
63         int ret;
64         struct sdio_func *func;
65
66         BUG_ON(fn > SDIO_MAX_FUNCS);
67
68         func = sdio_alloc_func(card);
69         if (IS_ERR(func))
70                 return PTR_ERR(func);
71
72         func->num = fn;
73
74         if (!(card->quirks & MMC_QUIRK_NONSTD_SDIO)) {
75                 ret = sdio_read_fbr(func);
76                 if (ret)
77                         goto fail;
78
79                 ret = sdio_read_func_cis(func);
80                 if (ret)
81                         goto fail;
82         } else {
83                 func->vendor = func->card->cis.vendor;
84                 func->device = func->card->cis.device;
85                 func->max_blksize = func->card->cis.blksize;
86         }
87
88         card->sdio_func[fn - 1] = func;
89
90         return 0;
91
92 fail:
93         /*
94          * It is okay to remove the function here even though we hold
95          * the host lock as we haven't registered the device yet.
96          */
97         sdio_remove_func(func);
98         return ret;
99 }
100
101 static int sdio_read_cccr(struct mmc_card *card, u32 ocr)
102 {
103         int ret;
104         int cccr_vsn;
105         int uhs = ocr & R4_18V_PRESENT;
106         unsigned char data;
107         unsigned char speed;
108
109         memset(&card->cccr, 0, sizeof(struct sdio_cccr));
110
111         ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_CCCR, 0, &data);
112         if (ret)
113                 goto out;
114
115         cccr_vsn = data & 0x0f;
116
117         if (cccr_vsn > SDIO_CCCR_REV_3_00) {
118                 pr_err("%s: unrecognised CCCR structure version %d\n",
119                         mmc_hostname(card->host), cccr_vsn);
120                 return -EINVAL;
121         }
122
123         card->cccr.sdio_vsn = (data & 0xf0) >> 4;
124
125         ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_CAPS, 0, &data);
126         if (ret)
127                 goto out;
128
129         if (data & SDIO_CCCR_CAP_SMB)
130                 card->cccr.multi_block = 1;
131         if (data & SDIO_CCCR_CAP_LSC)
132                 card->cccr.low_speed = 1;
133         if (data & SDIO_CCCR_CAP_4BLS)
134                 card->cccr.wide_bus = 1;
135
136         if (cccr_vsn >= SDIO_CCCR_REV_1_10) {
137                 ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_POWER, 0, &data);
138                 if (ret)
139                         goto out;
140
141                 if (data & SDIO_POWER_SMPC)
142                         card->cccr.high_power = 1;
143         }
144
145         if (cccr_vsn >= SDIO_CCCR_REV_1_20) {
146                 ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_SPEED, 0, &speed);
147                 if (ret)
148                         goto out;
149
150                 card->scr.sda_spec3 = 0;
151                 card->sw_caps.sd3_bus_mode = 0;
152                 card->sw_caps.sd3_drv_type = 0;
153                 if (cccr_vsn >= SDIO_CCCR_REV_3_00 && uhs) {
154                         card->scr.sda_spec3 = 1;
155                         ret = mmc_io_rw_direct(card, 0, 0,
156                                 SDIO_CCCR_UHS, 0, &data);
157                         if (ret)
158                                 goto out;
159
160                         if (mmc_host_uhs(card->host)) {
161                                 if (data & SDIO_UHS_DDR50)
162                                         card->sw_caps.sd3_bus_mode
163                                                 |= SD_MODE_UHS_DDR50;
164
165                                 if (data & SDIO_UHS_SDR50)
166                                         card->sw_caps.sd3_bus_mode
167                                                 |= SD_MODE_UHS_SDR50;
168
169                                 if (data & SDIO_UHS_SDR104)
170                                         card->sw_caps.sd3_bus_mode
171                                                 |= SD_MODE_UHS_SDR104;
172                         }
173
174                         ret = mmc_io_rw_direct(card, 0, 0,
175                                 SDIO_CCCR_DRIVE_STRENGTH, 0, &data);
176                         if (ret)
177                                 goto out;
178
179                         if (data & SDIO_DRIVE_SDTA)
180                                 card->sw_caps.sd3_drv_type |= SD_DRIVER_TYPE_A;
181                         if (data & SDIO_DRIVE_SDTC)
182                                 card->sw_caps.sd3_drv_type |= SD_DRIVER_TYPE_C;
183                         if (data & SDIO_DRIVE_SDTD)
184                                 card->sw_caps.sd3_drv_type |= SD_DRIVER_TYPE_D;
185                 }
186
187                 /* if no uhs mode ensure we check for high speed */
188                 if (!card->sw_caps.sd3_bus_mode) {
189                         if (speed & SDIO_SPEED_SHS) {
190                                 card->cccr.high_speed = 1;
191                                 card->sw_caps.hs_max_dtr = 50000000;
192                         } else {
193                                 card->cccr.high_speed = 0;
194                                 card->sw_caps.hs_max_dtr = 25000000;
195                         }
196                 }
197         }
198
199 out:
200         return ret;
201 }
202
203 static int sdio_enable_wide(struct mmc_card *card)
204 {
205         int ret;
206         u8 ctrl;
207
208         if (!(card->host->caps & MMC_CAP_4_BIT_DATA))
209                 return 0;
210
211         if (card->cccr.low_speed && !card->cccr.wide_bus)
212                 return 0;
213
214         ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
215         if (ret)
216                 return ret;
217
218         if ((ctrl & SDIO_BUS_WIDTH_MASK) == SDIO_BUS_WIDTH_RESERVED)
219                 pr_warning("%s: SDIO_CCCR_IF is invalid: 0x%02x\n",
220                            mmc_hostname(card->host), ctrl);
221
222         /* set as 4-bit bus width */
223         ctrl &= ~SDIO_BUS_WIDTH_MASK;
224         ctrl |= SDIO_BUS_WIDTH_4BIT;
225
226         ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
227         if (ret)
228                 return ret;
229
230         return 1;
231 }
232
233 /*
234  * If desired, disconnect the pull-up resistor on CD/DAT[3] (pin 1)
235  * of the card. This may be required on certain setups of boards,
236  * controllers and embedded sdio device which do not need the card's
237  * pull-up. As a result, card detection is disabled and power is saved.
238  */
239 static int sdio_disable_cd(struct mmc_card *card)
240 {
241         int ret;
242         u8 ctrl;
243
244         if (!mmc_card_disable_cd(card))
245                 return 0;
246
247         ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
248         if (ret)
249                 return ret;
250
251         ctrl |= SDIO_BUS_CD_DISABLE;
252
253         return mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
254 }
255
256 /*
257  * Devices that remain active during a system suspend are
258  * put back into 1-bit mode.
259  */
260 static int sdio_disable_wide(struct mmc_card *card)
261 {
262         int ret;
263         u8 ctrl;
264
265         if (!(card->host->caps & MMC_CAP_4_BIT_DATA))
266                 return 0;
267
268         if (card->cccr.low_speed && !card->cccr.wide_bus)
269                 return 0;
270
271         ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
272         if (ret)
273                 return ret;
274
275         if (!(ctrl & SDIO_BUS_WIDTH_4BIT))
276                 return 0;
277
278         ctrl &= ~SDIO_BUS_WIDTH_4BIT;
279         ctrl |= SDIO_BUS_ASYNC_INT;
280
281         ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
282         if (ret)
283                 return ret;
284
285         mmc_set_bus_width(card->host, MMC_BUS_WIDTH_1);
286
287         return 0;
288 }
289
290
291 static int sdio_enable_4bit_bus(struct mmc_card *card)
292 {
293         int err;
294
295         if (card->type == MMC_TYPE_SDIO)
296                 return sdio_enable_wide(card);
297
298         if ((card->host->caps & MMC_CAP_4_BIT_DATA) &&
299                 (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
300                 err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
301                 if (err)
302                         return err;
303         } else
304                 return 0;
305
306         err = sdio_enable_wide(card);
307         if (err <= 0)
308                 mmc_app_set_bus_width(card, MMC_BUS_WIDTH_1);
309
310         return err;
311 }
312
313
314 /*
315  * Test if the card supports high-speed mode and, if so, switch to it.
316  */
317 static int mmc_sdio_switch_hs(struct mmc_card *card, int enable)
318 {
319         int ret;
320         u8 speed;
321
322         if (!(card->host->caps & MMC_CAP_SD_HIGHSPEED))
323                 return 0;
324
325         if (!card->cccr.high_speed)
326                 return 0;
327
328         ret = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_SPEED, 0, &speed);
329         if (ret)
330                 return ret;
331
332         if (enable)
333                 speed |= SDIO_SPEED_EHS;
334         else
335                 speed &= ~SDIO_SPEED_EHS;
336
337         ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_SPEED, speed, NULL);
338         if (ret)
339                 return ret;
340
341         return 1;
342 }
343
344 /*
345  * Enable SDIO/combo card's high-speed mode. Return 0/1 if [not]supported.
346  */
347 static int sdio_enable_hs(struct mmc_card *card)
348 {
349         int ret;
350
351         ret = mmc_sdio_switch_hs(card, true);
352         if (ret <= 0 || card->type == MMC_TYPE_SDIO)
353                 return ret;
354
355         ret = mmc_sd_switch_hs(card);
356         if (ret <= 0)
357                 mmc_sdio_switch_hs(card, false);
358
359         return ret;
360 }
361
362 static unsigned mmc_sdio_get_max_clock(struct mmc_card *card)
363 {
364         unsigned max_dtr;
365
366         if (mmc_card_highspeed(card)) {
367                 /*
368                  * The SDIO specification doesn't mention how
369                  * the CIS transfer speed register relates to
370                  * high-speed, but it seems that 50 MHz is
371                  * mandatory.
372                  */
373                 max_dtr = 50000000;
374         } else {
375                 max_dtr = card->cis.max_dtr;
376         }
377
378         if (card->type == MMC_TYPE_SD_COMBO)
379                 max_dtr = min(max_dtr, mmc_sd_get_max_clock(card));
380
381         return max_dtr;
382 }
383
384 static unsigned char host_drive_to_sdio_drive(int host_strength)
385 {
386         switch (host_strength) {
387         case MMC_SET_DRIVER_TYPE_A:
388                 return SDIO_DTSx_SET_TYPE_A;
389         case MMC_SET_DRIVER_TYPE_B:
390                 return SDIO_DTSx_SET_TYPE_B;
391         case MMC_SET_DRIVER_TYPE_C:
392                 return SDIO_DTSx_SET_TYPE_C;
393         case MMC_SET_DRIVER_TYPE_D:
394                 return SDIO_DTSx_SET_TYPE_D;
395         default:
396                 return SDIO_DTSx_SET_TYPE_B;
397         }
398 }
399
400 static void sdio_select_driver_type(struct mmc_card *card)
401 {
402         int host_drv_type = SD_DRIVER_TYPE_B;
403         int card_drv_type = SD_DRIVER_TYPE_B;
404         int drive_strength;
405         unsigned char card_strength;
406         int err;
407
408         /*
409          * If the host doesn't support any of the Driver Types A,C or D,
410          * or there is no board specific handler then default Driver
411          * Type B is used.
412          */
413         if (!(card->host->caps &
414                 (MMC_CAP_DRIVER_TYPE_A |
415                  MMC_CAP_DRIVER_TYPE_C |
416                  MMC_CAP_DRIVER_TYPE_D)))
417                 return;
418
419         if (!card->host->ops->select_drive_strength)
420                 return;
421
422         if (card->host->caps & MMC_CAP_DRIVER_TYPE_A)
423                 host_drv_type |= SD_DRIVER_TYPE_A;
424
425         if (card->host->caps & MMC_CAP_DRIVER_TYPE_C)
426                 host_drv_type |= SD_DRIVER_TYPE_C;
427
428         if (card->host->caps & MMC_CAP_DRIVER_TYPE_D)
429                 host_drv_type |= SD_DRIVER_TYPE_D;
430
431         if (card->sw_caps.sd3_drv_type & SD_DRIVER_TYPE_A)
432                 card_drv_type |= SD_DRIVER_TYPE_A;
433
434         if (card->sw_caps.sd3_drv_type & SD_DRIVER_TYPE_C)
435                 card_drv_type |= SD_DRIVER_TYPE_C;
436
437         if (card->sw_caps.sd3_drv_type & SD_DRIVER_TYPE_D)
438                 card_drv_type |= SD_DRIVER_TYPE_D;
439
440         /*
441          * The drive strength that the hardware can support
442          * depends on the board design.  Pass the appropriate
443          * information and let the hardware specific code
444          * return what is possible given the options
445          */
446         drive_strength = card->host->ops->select_drive_strength(
447                 card->sw_caps.uhs_max_dtr,
448                 host_drv_type, card_drv_type);
449
450         /* if error just use default for drive strength B */
451         err = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_DRIVE_STRENGTH, 0,
452                 &card_strength);
453         if (err)
454                 return;
455
456         card_strength &= ~(SDIO_DRIVE_DTSx_MASK<<SDIO_DRIVE_DTSx_SHIFT);
457         card_strength |= host_drive_to_sdio_drive(drive_strength);
458
459         err = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_DRIVE_STRENGTH,
460                 card_strength, NULL);
461
462         /* if error default to drive strength B */
463         if (!err)
464                 mmc_set_driver_type(card->host, drive_strength);
465 }
466
467
468 static int sdio_set_bus_speed_mode(struct mmc_card *card)
469 {
470         unsigned int bus_speed, timing;
471         int err;
472         unsigned char speed;
473
474         /*
475          * If the host doesn't support any of the UHS-I modes, fallback on
476          * default speed.
477          */
478         if (!mmc_host_uhs(card->host))
479                 return 0;
480
481         bus_speed = SDIO_SPEED_SDR12;
482         timing = MMC_TIMING_UHS_SDR12;
483         if ((card->host->caps & MMC_CAP_UHS_SDR104) &&
484             (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_SDR104)) {
485                         bus_speed = SDIO_SPEED_SDR104;
486                         timing = MMC_TIMING_UHS_SDR104;
487                         card->sw_caps.uhs_max_dtr = UHS_SDR104_MAX_DTR;
488                         card->sd_bus_speed = UHS_SDR104_BUS_SPEED;
489         } else if ((card->host->caps & MMC_CAP_UHS_DDR50) &&
490                    (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_DDR50)) {
491                         bus_speed = SDIO_SPEED_DDR50;
492                         timing = MMC_TIMING_UHS_DDR50;
493                         card->sw_caps.uhs_max_dtr = UHS_DDR50_MAX_DTR;
494                         card->sd_bus_speed = UHS_DDR50_BUS_SPEED;
495         } else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
496                     MMC_CAP_UHS_SDR50)) && (card->sw_caps.sd3_bus_mode &
497                     SD_MODE_UHS_SDR50)) {
498                         bus_speed = SDIO_SPEED_SDR50;
499                         timing = MMC_TIMING_UHS_SDR50;
500                         card->sw_caps.uhs_max_dtr = UHS_SDR50_MAX_DTR;
501                         card->sd_bus_speed = UHS_SDR50_BUS_SPEED;
502         } else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
503                     MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR25)) &&
504                    (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_SDR25)) {
505                         bus_speed = SDIO_SPEED_SDR25;
506                         timing = MMC_TIMING_UHS_SDR25;
507                         card->sw_caps.uhs_max_dtr = UHS_SDR25_MAX_DTR;
508                         card->sd_bus_speed = UHS_SDR25_BUS_SPEED;
509         } else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
510                     MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR25 |
511                     MMC_CAP_UHS_SDR12)) && (card->sw_caps.sd3_bus_mode &
512                     SD_MODE_UHS_SDR12)) {
513                         bus_speed = SDIO_SPEED_SDR12;
514                         timing = MMC_TIMING_UHS_SDR12;
515                         card->sw_caps.uhs_max_dtr = UHS_SDR12_MAX_DTR;
516                         card->sd_bus_speed = UHS_SDR12_BUS_SPEED;
517         }
518
519         err = mmc_io_rw_direct(card, 0, 0, SDIO_CCCR_SPEED, 0, &speed);
520         if (err)
521                 return err;
522
523         speed &= ~SDIO_SPEED_BSS_MASK;
524         speed |= bus_speed;
525         err = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_SPEED, speed, NULL);
526         if (err)
527                 return err;
528
529         if (bus_speed) {
530                 mmc_set_timing(card->host, timing);
531                 mmc_set_clock(card->host, card->sw_caps.uhs_max_dtr);
532         }
533
534         return 0;
535 }
536
537 /*
538  * UHS-I specific initialization procedure
539  */
540 static int mmc_sdio_init_uhs_card(struct mmc_card *card)
541 {
542         int err;
543
544         if (!card->scr.sda_spec3)
545                 return 0;
546
547         /*
548          * Switch to wider bus (if supported).
549          */
550         if (card->host->caps & MMC_CAP_4_BIT_DATA) {
551                 err = sdio_enable_4bit_bus(card);
552                 if (err > 0) {
553                         mmc_set_bus_width(card->host, MMC_BUS_WIDTH_4);
554                         err = 0;
555                 }
556         }
557
558         /* Set the driver strength for the card */
559         sdio_select_driver_type(card);
560
561         /* Set bus speed mode of the card */
562         err = sdio_set_bus_speed_mode(card);
563         if (err)
564                 goto out;
565
566         /* Initialize and start re-tuning timer */
567         if (!mmc_host_is_spi(card->host) && card->host->ops->execute_tuning)
568                 err = card->host->ops->execute_tuning(card->host,
569                                                       MMC_SEND_TUNING_BLOCK);
570
571 out:
572
573         return err;
574 }
575
576 /*
577  * Handle the detection and initialisation of a card.
578  *
579  * In the case of a resume, "oldcard" will contain the card
580  * we're trying to reinitialise.
581  */
582 static int mmc_sdio_init_card(struct mmc_host *host, u32 ocr,
583                               struct mmc_card *oldcard, int powered_resume)
584 {
585         struct mmc_card *card;
586         int err;
587
588         BUG_ON(!host);
589         WARN_ON(!host->claimed);
590
591         /*
592          * Inform the card of the voltage
593          */
594         if (!powered_resume) {
595                 err = mmc_send_io_op_cond(host, host->ocr, &ocr);
596                 if (err)
597                         goto err;
598         }
599
600         /*
601          * For SPI, enable CRC as appropriate.
602          */
603         if (mmc_host_is_spi(host)) {
604                 err = mmc_spi_set_crc(host, use_spi_crc);
605                 if (err)
606                         goto err;
607         }
608
609         /*
610          * Allocate card structure.
611          */
612         card = mmc_alloc_card(host, NULL);
613         if (IS_ERR(card)) {
614                 err = PTR_ERR(card);
615                 goto err;
616         }
617
618         if ((ocr & R4_MEMORY_PRESENT) &&
619             mmc_sd_get_cid(host, host->ocr & ocr, card->raw_cid, NULL) == 0) {
620                 card->type = MMC_TYPE_SD_COMBO;
621
622                 if (oldcard && (oldcard->type != MMC_TYPE_SD_COMBO ||
623                     memcmp(card->raw_cid, oldcard->raw_cid, sizeof(card->raw_cid)) != 0)) {
624                         mmc_remove_card(card);
625                         return -ENOENT;
626                 }
627         } else {
628                 card->type = MMC_TYPE_SDIO;
629
630                 if (oldcard && oldcard->type != MMC_TYPE_SDIO) {
631                         mmc_remove_card(card);
632                         return -ENOENT;
633                 }
634         }
635
636         /*
637          * Call the optional HC's init_card function to handle quirks.
638          */
639         if (host->ops->init_card)
640                 host->ops->init_card(host, card);
641
642         /*
643          * If the host and card support UHS-I mode request the card
644          * to switch to 1.8V signaling level.  No 1.8v signalling if
645          * UHS mode is not enabled to maintain compatibility and some
646          * systems that claim 1.8v signalling in fact do not support
647          * it.
648          */
649         if ((ocr & R4_18V_PRESENT) && mmc_host_uhs(host)) {
650                 err = mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180);
651                 if (err) {
652                         ocr &= ~R4_18V_PRESENT;
653                         host->ocr &= ~R4_18V_PRESENT;
654                 }
655                 err = 0;
656         } else {
657                 ocr &= ~R4_18V_PRESENT;
658                 host->ocr &= ~R4_18V_PRESENT;
659         }
660
661         /*
662          * For native busses:  set card RCA and quit open drain mode.
663          */
664         if (!powered_resume && !mmc_host_is_spi(host)) {
665                 err = mmc_send_relative_addr(host, &card->rca);
666                 if (err)
667                         goto remove;
668
669                 /*
670                  * Update oldcard with the new RCA received from the SDIO
671                  * device -- we're doing this so that it's updated in the
672                  * "card" struct when oldcard overwrites that later.
673                  */
674                 if (oldcard)
675                         oldcard->rca = card->rca;
676         }
677
678         /*
679          * Read CSD, before selecting the card
680          */
681         if (!oldcard && card->type == MMC_TYPE_SD_COMBO) {
682                 err = mmc_sd_get_csd(host, card);
683                 if (err)
684                         return err;
685
686                 mmc_decode_cid(card);
687         }
688
689         /*
690          * Select card, as all following commands rely on that.
691          */
692         if (!powered_resume && !mmc_host_is_spi(host)) {
693                 err = mmc_select_card(card);
694                 if (err)
695                         goto remove;
696         }
697
698         if (card->quirks & MMC_QUIRK_NONSTD_SDIO) {
699                 /*
700                  * This is non-standard SDIO device, meaning it doesn't
701                  * have any CIA (Common I/O area) registers present.
702                  * It's host's responsibility to fill cccr and cis
703                  * structures in init_card().
704                  */
705                 mmc_set_clock(host, card->cis.max_dtr);
706
707                 if (card->cccr.high_speed) {
708                         mmc_card_set_highspeed(card);
709                         mmc_set_timing(card->host, MMC_TIMING_SD_HS);
710                 }
711
712                 goto finish;
713         }
714
715         /*
716          * Read the common registers.
717          */
718         err = sdio_read_cccr(card, ocr);
719         if (err)
720                 goto remove;
721
722         /*
723          * Read the common CIS tuples.
724          */
725         err = sdio_read_common_cis(card);
726         if (err)
727                 goto remove;
728
729         if (oldcard) {
730                 int same = (card->cis.vendor == oldcard->cis.vendor &&
731                             card->cis.device == oldcard->cis.device);
732                 mmc_remove_card(card);
733                 if (!same)
734                         return -ENOENT;
735
736                 card = oldcard;
737         }
738         mmc_fixup_device(card, NULL);
739
740         if (card->type == MMC_TYPE_SD_COMBO) {
741                 err = mmc_sd_setup_card(host, card, oldcard != NULL);
742                 /* handle as SDIO-only card if memory init failed */
743                 if (err) {
744                         mmc_go_idle(host);
745                         if (mmc_host_is_spi(host))
746                                 /* should not fail, as it worked previously */
747                                 mmc_spi_set_crc(host, use_spi_crc);
748                         card->type = MMC_TYPE_SDIO;
749                 } else
750                         card->dev.type = &sd_type;
751         }
752
753         /*
754          * If needed, disconnect card detection pull-up resistor.
755          */
756         err = sdio_disable_cd(card);
757         if (err)
758                 goto remove;
759
760         /* Initialization sequence for UHS-I cards */
761         /* Only if card supports 1.8v and UHS signaling */
762         if ((ocr & R4_18V_PRESENT) && card->sw_caps.sd3_bus_mode) {
763                 err = mmc_sdio_init_uhs_card(card);
764                 if (err)
765                         goto remove;
766
767                 /* Card is an ultra-high-speed card */
768                 mmc_card_set_uhs(card);
769         } else {
770                 /*
771                  * Switch to high-speed (if supported).
772                  */
773                 err = sdio_enable_hs(card);
774                 if (err > 0)
775                         mmc_sd_go_highspeed(card);
776                 else if (err)
777                         goto remove;
778
779                 /*
780                  * Change to the card's maximum speed.
781                  */
782                 mmc_set_clock(host, mmc_sdio_get_max_clock(card));
783
784                 /*
785                  * Switch to wider bus (if supported).
786                  */
787                 err = sdio_enable_4bit_bus(card);
788                 if (err > 0)
789                         mmc_set_bus_width(card->host, MMC_BUS_WIDTH_4);
790                 else if (err)
791                         goto remove;
792         }
793 finish:
794         if (!oldcard)
795                 host->card = card;
796         return 0;
797
798 remove:
799         if (!oldcard)
800                 mmc_remove_card(card);
801
802 err:
803         return err;
804 }
805
806 /*
807  * Host is being removed. Free up the current card.
808  */
809 static void mmc_sdio_remove(struct mmc_host *host)
810 {
811         int i;
812
813         BUG_ON(!host);
814         BUG_ON(!host->card);
815
816         for (i = 0;i < host->card->sdio_funcs;i++) {
817                 if (host->card->sdio_func[i]) {
818                         sdio_remove_func(host->card->sdio_func[i]);
819                         host->card->sdio_func[i] = NULL;
820                 }
821         }
822
823         mmc_remove_card(host->card);
824         host->card = NULL;
825 }
826
827 /*
828  * Card detection - card is alive.
829  */
830 static int mmc_sdio_alive(struct mmc_host *host)
831 {
832         return mmc_select_card(host->card);
833 }
834
835 /*
836  * Card detection callback from host.
837  */
838 static void mmc_sdio_detect(struct mmc_host *host)
839 {
840         int err;
841
842         BUG_ON(!host);
843         BUG_ON(!host->card);
844
845         /* Make sure card is powered before detecting it */
846         if (host->caps & MMC_CAP_POWER_OFF_CARD) {
847                 err = pm_runtime_get_sync(&host->card->dev);
848                 if (err < 0)
849                         goto out;
850         }
851
852         mmc_claim_host(host);
853
854         /*
855          * Just check if our card has been removed.
856          */
857         err = _mmc_detect_card_removed(host);
858
859         mmc_release_host(host);
860
861         /*
862          * Tell PM core it's OK to power off the card now.
863          *
864          * The _sync variant is used in order to ensure that the card
865          * is left powered off in case an error occurred, and the card
866          * is going to be removed.
867          *
868          * Since there is no specific reason to believe a new user
869          * is about to show up at this point, the _sync variant is
870          * desirable anyway.
871          */
872         if (host->caps & MMC_CAP_POWER_OFF_CARD)
873                 pm_runtime_put_sync(&host->card->dev);
874
875 out:
876         if (err) {
877                 mmc_sdio_remove(host);
878
879                 mmc_claim_host(host);
880                 mmc_detach_bus(host);
881                 mmc_power_off(host);
882                 mmc_release_host(host);
883         }
884 }
885
886 /*
887  * SDIO suspend.  We need to suspend all functions separately.
888  * Therefore all registered functions must have drivers with suspend
889  * and resume methods.  Failing that we simply remove the whole card.
890  */
891 static int mmc_sdio_suspend(struct mmc_host *host)
892 {
893         int i, err = 0;
894
895         for (i = 0; i < host->card->sdio_funcs; i++) {
896                 struct sdio_func *func = host->card->sdio_func[i];
897                 if (func && sdio_func_present(func) && func->dev.driver) {
898                         const struct dev_pm_ops *pmops = func->dev.driver->pm;
899                         if (!pmops || !pmops->suspend || !pmops->resume) {
900                                 /* force removal of entire card in that case */
901                                 err = -ENOSYS;
902                         } else
903                                 err = pmops->suspend(&func->dev);
904                         if (err)
905                                 break;
906                 }
907         }
908         while (err && --i >= 0) {
909                 struct sdio_func *func = host->card->sdio_func[i];
910                 if (func && sdio_func_present(func) && func->dev.driver) {
911                         const struct dev_pm_ops *pmops = func->dev.driver->pm;
912                         pmops->resume(&func->dev);
913                 }
914         }
915
916         if (!err && mmc_card_keep_power(host) && mmc_card_wake_sdio_irq(host)) {
917                 mmc_claim_host(host);
918                 sdio_disable_wide(host->card);
919                 mmc_release_host(host);
920         }
921
922         return err;
923 }
924
925 static int mmc_sdio_resume(struct mmc_host *host)
926 {
927         int i, err = 0;
928
929         BUG_ON(!host);
930         BUG_ON(!host->card);
931
932         /* Basic card reinitialization. */
933         mmc_claim_host(host);
934
935         /* No need to reinitialize powered-resumed nonremovable cards */
936         if (mmc_card_is_removable(host) || !mmc_card_keep_power(host)) {
937                 sdio_reset(host);
938                 mmc_go_idle(host);
939                 err = mmc_sdio_init_card(host, host->ocr, host->card,
940                                         mmc_card_keep_power(host));
941         } else if (mmc_card_keep_power(host) && mmc_card_wake_sdio_irq(host)) {
942                 /* We may have switched to 1-bit mode during suspend */
943                 err = sdio_enable_4bit_bus(host->card);
944                 if (err > 0) {
945                         mmc_set_bus_width(host, MMC_BUS_WIDTH_4);
946                         err = 0;
947                 }
948         }
949
950         if (!err && host->sdio_irqs)
951                 wake_up_process(host->sdio_irq_thread);
952         mmc_release_host(host);
953
954         /*
955          * If the card looked to be the same as before suspending, then
956          * we proceed to resume all card functions.  If one of them returns
957          * an error then we simply return that error to the core and the
958          * card will be redetected as new.  It is the responsibility of
959          * the function driver to perform further tests with the extra
960          * knowledge it has of the card to confirm the card is indeed the
961          * same as before suspending (same MAC address for network cards,
962          * etc.) and return an error otherwise.
963          */
964         for (i = 0; !err && i < host->card->sdio_funcs; i++) {
965                 struct sdio_func *func = host->card->sdio_func[i];
966                 if (func && sdio_func_present(func) && func->dev.driver) {
967                         const struct dev_pm_ops *pmops = func->dev.driver->pm;
968                         err = pmops->resume(&func->dev);
969                 }
970         }
971
972         return err;
973 }
974
975 static int mmc_sdio_power_restore(struct mmc_host *host)
976 {
977         int ret;
978         u32 ocr;
979
980         BUG_ON(!host);
981         BUG_ON(!host->card);
982
983         mmc_claim_host(host);
984
985         /*
986          * Reset the card by performing the same steps that are taken by
987          * mmc_rescan_try_freq() and mmc_attach_sdio() during a "normal" probe.
988          *
989          * sdio_reset() is technically not needed. Having just powered up the
990          * hardware, it should already be in reset state. However, some
991          * platforms (such as SD8686 on OLPC) do not instantly cut power,
992          * meaning that a reset is required when restoring power soon after
993          * powering off. It is harmless in other cases.
994          *
995          * The CMD5 reset (mmc_send_io_op_cond()), according to the SDIO spec,
996          * is not necessary for non-removable cards. However, it is required
997          * for OLPC SD8686 (which expects a [CMD5,5,3,7] init sequence), and
998          * harmless in other situations.
999          *
1000          * With these steps taken, mmc_select_voltage() is also required to
1001          * restore the correct voltage setting of the card.
1002          */
1003
1004         sdio_reset(host);
1005         mmc_go_idle(host);
1006         mmc_send_if_cond(host, host->ocr_avail);
1007
1008         ret = mmc_send_io_op_cond(host, 0, &ocr);
1009         if (ret)
1010                 goto out;
1011
1012         if (host->ocr_avail_sdio)
1013                 host->ocr_avail = host->ocr_avail_sdio;
1014
1015         host->ocr = mmc_select_voltage(host, ocr & ~0x7F);
1016         if (!host->ocr) {
1017                 ret = -EINVAL;
1018                 goto out;
1019         }
1020
1021         if (mmc_host_uhs(host))
1022                 /* to query card if 1.8V signalling is supported */
1023                 host->ocr |= R4_18V_PRESENT;
1024
1025         ret = mmc_sdio_init_card(host, host->ocr, host->card,
1026                                 mmc_card_keep_power(host));
1027         if (!ret && host->sdio_irqs)
1028                 mmc_signal_sdio_irq(host);
1029
1030 out:
1031         mmc_release_host(host);
1032
1033         return ret;
1034 }
1035
1036 static const struct mmc_bus_ops mmc_sdio_ops = {
1037         .remove = mmc_sdio_remove,
1038         .detect = mmc_sdio_detect,
1039         .suspend = mmc_sdio_suspend,
1040         .resume = mmc_sdio_resume,
1041         .power_restore = mmc_sdio_power_restore,
1042         .alive = mmc_sdio_alive,
1043 };
1044
1045
1046 /*
1047  * Starting point for SDIO card init.
1048  */
1049 int mmc_attach_sdio(struct mmc_host *host)
1050 {
1051         int err, i, funcs;
1052         u32 ocr;
1053         struct mmc_card *card;
1054
1055         BUG_ON(!host);
1056         WARN_ON(!host->claimed);
1057
1058         err = mmc_send_io_op_cond(host, 0, &ocr);
1059         if (err)
1060                 return err;
1061
1062         mmc_attach_bus(host, &mmc_sdio_ops);
1063         if (host->ocr_avail_sdio)
1064                 host->ocr_avail = host->ocr_avail_sdio;
1065
1066         /*
1067          * Sanity check the voltages that the card claims to
1068          * support.
1069          */
1070         if (ocr & 0x7F) {
1071                 pr_warning("%s: card claims to support voltages "
1072                        "below the defined range. These will be ignored.\n",
1073                        mmc_hostname(host));
1074                 ocr &= ~0x7F;
1075         }
1076
1077         host->ocr = mmc_select_voltage(host, ocr);
1078
1079         /*
1080          * Can we support the voltage(s) of the card(s)?
1081          */
1082         if (!host->ocr) {
1083                 err = -EINVAL;
1084                 goto err;
1085         }
1086
1087         /*
1088          * Detect and init the card.
1089          */
1090         if (mmc_host_uhs(host))
1091                 /* to query card if 1.8V signalling is supported */
1092                 host->ocr |= R4_18V_PRESENT;
1093
1094         err = mmc_sdio_init_card(host, host->ocr, NULL, 0);
1095         if (err) {
1096                 if (err == -EAGAIN) {
1097                         /*
1098                          * Retry initialization with S18R set to 0.
1099                          */
1100                         host->ocr &= ~R4_18V_PRESENT;
1101                         err = mmc_sdio_init_card(host, host->ocr, NULL, 0);
1102                 }
1103                 if (err)
1104                         goto err;
1105         }
1106         card = host->card;
1107
1108         /*
1109          * Enable runtime PM only if supported by host+card+board
1110          */
1111         if (host->caps & MMC_CAP_POWER_OFF_CARD) {
1112                 /*
1113                  * Let runtime PM core know our card is active
1114                  */
1115                 err = pm_runtime_set_active(&card->dev);
1116                 if (err)
1117                         goto remove;
1118
1119                 /*
1120                  * Enable runtime PM for this card
1121                  */
1122                 pm_runtime_enable(&card->dev);
1123         }
1124
1125         /*
1126          * The number of functions on the card is encoded inside
1127          * the ocr.
1128          */
1129         funcs = (ocr & 0x70000000) >> 28;
1130         card->sdio_funcs = 0;
1131
1132         /*
1133          * Initialize (but don't add) all present functions.
1134          */
1135         for (i = 0; i < funcs; i++, card->sdio_funcs++) {
1136                 err = sdio_init_func(host->card, i + 1);
1137                 if (err)
1138                         goto remove;
1139
1140                 /*
1141                  * Enable Runtime PM for this func (if supported)
1142                  */
1143                 if (host->caps & MMC_CAP_POWER_OFF_CARD)
1144                         pm_runtime_enable(&card->sdio_func[i]->dev);
1145         }
1146
1147         /*
1148          * First add the card to the driver model...
1149          */
1150         mmc_release_host(host);
1151         err = mmc_add_card(host->card);
1152         if (err)
1153                 goto remove_added;
1154
1155         /*
1156          * ...then the SDIO functions.
1157          */
1158         for (i = 0;i < funcs;i++) {
1159                 err = sdio_add_func(host->card->sdio_func[i]);
1160                 if (err)
1161                         goto remove_added;
1162         }
1163
1164         mmc_claim_host(host);
1165         return 0;
1166
1167
1168 remove_added:
1169         /* Remove without lock if the device has been added. */
1170         mmc_sdio_remove(host);
1171         mmc_claim_host(host);
1172 remove:
1173         /* And with lock if it hasn't been added. */
1174         mmc_release_host(host);
1175         if (host->card)
1176                 mmc_sdio_remove(host);
1177         mmc_claim_host(host);
1178 err:
1179         mmc_detach_bus(host);
1180
1181         pr_err("%s: error %d whilst initialising SDIO card\n",
1182                 mmc_hostname(host), err);
1183
1184         return err;
1185 }
1186