fix braino in fs: do not assign default i_ino in new_inode
[linux-2.6/btrfs-unstable.git] / drivers / mmc / host / sdhci-pci.c
blobe8aa99deae9ac0f4c04e899c2abe2cd5a8994b36
1 /* linux/drivers/mmc/host/sdhci-pci.c - SDHCI on PCI bus interface
3 * Copyright (C) 2005-2008 Pierre Ossman, All Rights Reserved.
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or (at
8 * your option) any later version.
10 * Thanks to the following companies for their support:
12 * - JMicron (hardware and technical support)
15 #include <linux/delay.h>
16 #include <linux/highmem.h>
17 #include <linux/pci.h>
18 #include <linux/dma-mapping.h>
19 #include <linux/slab.h>
20 #include <linux/device.h>
22 #include <linux/mmc/host.h>
24 #include <asm/scatterlist.h>
25 #include <asm/io.h>
27 #include "sdhci.h"
30 * PCI registers
33 #define PCI_SDHCI_IFPIO 0x00
34 #define PCI_SDHCI_IFDMA 0x01
35 #define PCI_SDHCI_IFVENDOR 0x02
37 #define PCI_SLOT_INFO 0x40 /* 8 bits */
38 #define PCI_SLOT_INFO_SLOTS(x) ((x >> 4) & 7)
39 #define PCI_SLOT_INFO_FIRST_BAR_MASK 0x07
41 #define MAX_SLOTS 8
43 struct sdhci_pci_chip;
44 struct sdhci_pci_slot;
46 struct sdhci_pci_fixes {
47 unsigned int quirks;
49 int (*probe)(struct sdhci_pci_chip*);
51 int (*probe_slot)(struct sdhci_pci_slot*);
52 void (*remove_slot)(struct sdhci_pci_slot*, int);
54 int (*suspend)(struct sdhci_pci_chip*,
55 pm_message_t);
56 int (*resume)(struct sdhci_pci_chip*);
59 struct sdhci_pci_slot {
60 struct sdhci_pci_chip *chip;
61 struct sdhci_host *host;
63 int pci_bar;
66 struct sdhci_pci_chip {
67 struct pci_dev *pdev;
69 unsigned int quirks;
70 const struct sdhci_pci_fixes *fixes;
72 int num_slots; /* Slots on controller */
73 struct sdhci_pci_slot *slots[MAX_SLOTS]; /* Pointers to host slots */
77 /*****************************************************************************\
78 * *
79 * Hardware specific quirk handling *
80 * *
81 \*****************************************************************************/
83 static int ricoh_probe(struct sdhci_pci_chip *chip)
85 if (chip->pdev->subsystem_vendor == PCI_VENDOR_ID_SAMSUNG ||
86 chip->pdev->subsystem_vendor == PCI_VENDOR_ID_SONY)
87 chip->quirks |= SDHCI_QUIRK_NO_CARD_NO_RESET;
88 return 0;
91 static int ricoh_mmc_probe_slot(struct sdhci_pci_slot *slot)
93 slot->host->caps =
94 ((0x21 << SDHCI_TIMEOUT_CLK_SHIFT)
95 & SDHCI_TIMEOUT_CLK_MASK) |
97 ((0x21 << SDHCI_CLOCK_BASE_SHIFT)
98 & SDHCI_CLOCK_BASE_MASK) |
100 SDHCI_TIMEOUT_CLK_UNIT |
101 SDHCI_CAN_VDD_330 |
102 SDHCI_CAN_DO_SDMA;
103 return 0;
106 static int ricoh_mmc_resume(struct sdhci_pci_chip *chip)
108 /* Apply a delay to allow controller to settle */
109 /* Otherwise it becomes confused if card state changed
110 during suspend */
111 msleep(500);
112 return 0;
115 static const struct sdhci_pci_fixes sdhci_ricoh = {
116 .probe = ricoh_probe,
117 .quirks = SDHCI_QUIRK_32BIT_DMA_ADDR |
118 SDHCI_QUIRK_FORCE_DMA |
119 SDHCI_QUIRK_CLOCK_BEFORE_RESET,
122 static const struct sdhci_pci_fixes sdhci_ricoh_mmc = {
123 .probe_slot = ricoh_mmc_probe_slot,
124 .resume = ricoh_mmc_resume,
125 .quirks = SDHCI_QUIRK_32BIT_DMA_ADDR |
126 SDHCI_QUIRK_CLOCK_BEFORE_RESET |
127 SDHCI_QUIRK_NO_CARD_NO_RESET |
128 SDHCI_QUIRK_MISSING_CAPS
131 static const struct sdhci_pci_fixes sdhci_ene_712 = {
132 .quirks = SDHCI_QUIRK_SINGLE_POWER_WRITE |
133 SDHCI_QUIRK_BROKEN_DMA,
136 static const struct sdhci_pci_fixes sdhci_ene_714 = {
137 .quirks = SDHCI_QUIRK_SINGLE_POWER_WRITE |
138 SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS |
139 SDHCI_QUIRK_BROKEN_DMA,
142 static const struct sdhci_pci_fixes sdhci_cafe = {
143 .quirks = SDHCI_QUIRK_NO_SIMULT_VDD_AND_POWER |
144 SDHCI_QUIRK_NO_BUSY_IRQ |
145 SDHCI_QUIRK_BROKEN_TIMEOUT_VAL,
148 static int jmicron_pmos(struct sdhci_pci_chip *chip, int on)
150 u8 scratch;
151 int ret;
153 ret = pci_read_config_byte(chip->pdev, 0xAE, &scratch);
154 if (ret)
155 return ret;
158 * Turn PMOS on [bit 0], set over current detection to 2.4 V
159 * [bit 1:2] and enable over current debouncing [bit 6].
161 if (on)
162 scratch |= 0x47;
163 else
164 scratch &= ~0x47;
166 ret = pci_write_config_byte(chip->pdev, 0xAE, scratch);
167 if (ret)
168 return ret;
170 return 0;
173 static int jmicron_probe(struct sdhci_pci_chip *chip)
175 int ret;
177 if (chip->pdev->revision == 0) {
178 chip->quirks |= SDHCI_QUIRK_32BIT_DMA_ADDR |
179 SDHCI_QUIRK_32BIT_DMA_SIZE |
180 SDHCI_QUIRK_32BIT_ADMA_SIZE |
181 SDHCI_QUIRK_RESET_AFTER_REQUEST |
182 SDHCI_QUIRK_BROKEN_SMALL_PIO;
186 * JMicron chips can have two interfaces to the same hardware
187 * in order to work around limitations in Microsoft's driver.
188 * We need to make sure we only bind to one of them.
190 * This code assumes two things:
192 * 1. The PCI code adds subfunctions in order.
194 * 2. The MMC interface has a lower subfunction number
195 * than the SD interface.
197 if (chip->pdev->device == PCI_DEVICE_ID_JMICRON_JMB38X_SD) {
198 struct pci_dev *sd_dev;
200 sd_dev = NULL;
201 while ((sd_dev = pci_get_device(PCI_VENDOR_ID_JMICRON,
202 PCI_DEVICE_ID_JMICRON_JMB38X_MMC, sd_dev)) != NULL) {
203 if ((PCI_SLOT(chip->pdev->devfn) ==
204 PCI_SLOT(sd_dev->devfn)) &&
205 (chip->pdev->bus == sd_dev->bus))
206 break;
209 if (sd_dev) {
210 pci_dev_put(sd_dev);
211 dev_info(&chip->pdev->dev, "Refusing to bind to "
212 "secondary interface.\n");
213 return -ENODEV;
218 * JMicron chips need a bit of a nudge to enable the power
219 * output pins.
221 ret = jmicron_pmos(chip, 1);
222 if (ret) {
223 dev_err(&chip->pdev->dev, "Failure enabling card power\n");
224 return ret;
227 return 0;
230 static void jmicron_enable_mmc(struct sdhci_host *host, int on)
232 u8 scratch;
234 scratch = readb(host->ioaddr + 0xC0);
236 if (on)
237 scratch |= 0x01;
238 else
239 scratch &= ~0x01;
241 writeb(scratch, host->ioaddr + 0xC0);
244 static int jmicron_probe_slot(struct sdhci_pci_slot *slot)
246 if (slot->chip->pdev->revision == 0) {
247 u16 version;
249 version = readl(slot->host->ioaddr + SDHCI_HOST_VERSION);
250 version = (version & SDHCI_VENDOR_VER_MASK) >>
251 SDHCI_VENDOR_VER_SHIFT;
254 * Older versions of the chip have lots of nasty glitches
255 * in the ADMA engine. It's best just to avoid it
256 * completely.
258 if (version < 0xAC)
259 slot->host->quirks |= SDHCI_QUIRK_BROKEN_ADMA;
263 * The secondary interface requires a bit set to get the
264 * interrupts.
266 if (slot->chip->pdev->device == PCI_DEVICE_ID_JMICRON_JMB38X_MMC)
267 jmicron_enable_mmc(slot->host, 1);
269 return 0;
272 static void jmicron_remove_slot(struct sdhci_pci_slot *slot, int dead)
274 if (dead)
275 return;
277 if (slot->chip->pdev->device == PCI_DEVICE_ID_JMICRON_JMB38X_MMC)
278 jmicron_enable_mmc(slot->host, 0);
281 static int jmicron_suspend(struct sdhci_pci_chip *chip, pm_message_t state)
283 int i;
285 if (chip->pdev->device == PCI_DEVICE_ID_JMICRON_JMB38X_MMC) {
286 for (i = 0;i < chip->num_slots;i++)
287 jmicron_enable_mmc(chip->slots[i]->host, 0);
290 return 0;
293 static int jmicron_resume(struct sdhci_pci_chip *chip)
295 int ret, i;
297 if (chip->pdev->device == PCI_DEVICE_ID_JMICRON_JMB38X_MMC) {
298 for (i = 0;i < chip->num_slots;i++)
299 jmicron_enable_mmc(chip->slots[i]->host, 1);
302 ret = jmicron_pmos(chip, 1);
303 if (ret) {
304 dev_err(&chip->pdev->dev, "Failure enabling card power\n");
305 return ret;
308 return 0;
311 static const struct sdhci_pci_fixes sdhci_jmicron = {
312 .probe = jmicron_probe,
314 .probe_slot = jmicron_probe_slot,
315 .remove_slot = jmicron_remove_slot,
317 .suspend = jmicron_suspend,
318 .resume = jmicron_resume,
321 /* SysKonnect CardBus2SDIO extra registers */
322 #define SYSKT_CTRL 0x200
323 #define SYSKT_RDFIFO_STAT 0x204
324 #define SYSKT_WRFIFO_STAT 0x208
325 #define SYSKT_POWER_DATA 0x20c
326 #define SYSKT_POWER_330 0xef
327 #define SYSKT_POWER_300 0xf8
328 #define SYSKT_POWER_184 0xcc
329 #define SYSKT_POWER_CMD 0x20d
330 #define SYSKT_POWER_START (1 << 7)
331 #define SYSKT_POWER_STATUS 0x20e
332 #define SYSKT_POWER_STATUS_OK (1 << 0)
333 #define SYSKT_BOARD_REV 0x210
334 #define SYSKT_CHIP_REV 0x211
335 #define SYSKT_CONF_DATA 0x212
336 #define SYSKT_CONF_DATA_1V8 (1 << 2)
337 #define SYSKT_CONF_DATA_2V5 (1 << 1)
338 #define SYSKT_CONF_DATA_3V3 (1 << 0)
340 static int syskt_probe(struct sdhci_pci_chip *chip)
342 if ((chip->pdev->class & 0x0000FF) == PCI_SDHCI_IFVENDOR) {
343 chip->pdev->class &= ~0x0000FF;
344 chip->pdev->class |= PCI_SDHCI_IFDMA;
346 return 0;
349 static int syskt_probe_slot(struct sdhci_pci_slot *slot)
351 int tm, ps;
353 u8 board_rev = readb(slot->host->ioaddr + SYSKT_BOARD_REV);
354 u8 chip_rev = readb(slot->host->ioaddr + SYSKT_CHIP_REV);
355 dev_info(&slot->chip->pdev->dev, "SysKonnect CardBus2SDIO, "
356 "board rev %d.%d, chip rev %d.%d\n",
357 board_rev >> 4, board_rev & 0xf,
358 chip_rev >> 4, chip_rev & 0xf);
359 if (chip_rev >= 0x20)
360 slot->host->quirks |= SDHCI_QUIRK_FORCE_DMA;
362 writeb(SYSKT_POWER_330, slot->host->ioaddr + SYSKT_POWER_DATA);
363 writeb(SYSKT_POWER_START, slot->host->ioaddr + SYSKT_POWER_CMD);
364 udelay(50);
365 tm = 10; /* Wait max 1 ms */
366 do {
367 ps = readw(slot->host->ioaddr + SYSKT_POWER_STATUS);
368 if (ps & SYSKT_POWER_STATUS_OK)
369 break;
370 udelay(100);
371 } while (--tm);
372 if (!tm) {
373 dev_err(&slot->chip->pdev->dev,
374 "power regulator never stabilized");
375 writeb(0, slot->host->ioaddr + SYSKT_POWER_CMD);
376 return -ENODEV;
379 return 0;
382 static const struct sdhci_pci_fixes sdhci_syskt = {
383 .quirks = SDHCI_QUIRK_NO_SIMULT_VDD_AND_POWER,
384 .probe = syskt_probe,
385 .probe_slot = syskt_probe_slot,
388 static int via_probe(struct sdhci_pci_chip *chip)
390 if (chip->pdev->revision == 0x10)
391 chip->quirks |= SDHCI_QUIRK_DELAY_AFTER_POWER;
393 return 0;
396 static const struct sdhci_pci_fixes sdhci_via = {
397 .probe = via_probe,
400 static const struct pci_device_id pci_ids[] __devinitdata = {
402 .vendor = PCI_VENDOR_ID_RICOH,
403 .device = PCI_DEVICE_ID_RICOH_R5C822,
404 .subvendor = PCI_ANY_ID,
405 .subdevice = PCI_ANY_ID,
406 .driver_data = (kernel_ulong_t)&sdhci_ricoh,
410 .vendor = PCI_VENDOR_ID_RICOH,
411 .device = 0x843,
412 .subvendor = PCI_ANY_ID,
413 .subdevice = PCI_ANY_ID,
414 .driver_data = (kernel_ulong_t)&sdhci_ricoh_mmc,
418 .vendor = PCI_VENDOR_ID_RICOH,
419 .device = 0xe822,
420 .subvendor = PCI_ANY_ID,
421 .subdevice = PCI_ANY_ID,
422 .driver_data = (kernel_ulong_t)&sdhci_ricoh_mmc,
426 .vendor = PCI_VENDOR_ID_ENE,
427 .device = PCI_DEVICE_ID_ENE_CB712_SD,
428 .subvendor = PCI_ANY_ID,
429 .subdevice = PCI_ANY_ID,
430 .driver_data = (kernel_ulong_t)&sdhci_ene_712,
434 .vendor = PCI_VENDOR_ID_ENE,
435 .device = PCI_DEVICE_ID_ENE_CB712_SD_2,
436 .subvendor = PCI_ANY_ID,
437 .subdevice = PCI_ANY_ID,
438 .driver_data = (kernel_ulong_t)&sdhci_ene_712,
442 .vendor = PCI_VENDOR_ID_ENE,
443 .device = PCI_DEVICE_ID_ENE_CB714_SD,
444 .subvendor = PCI_ANY_ID,
445 .subdevice = PCI_ANY_ID,
446 .driver_data = (kernel_ulong_t)&sdhci_ene_714,
450 .vendor = PCI_VENDOR_ID_ENE,
451 .device = PCI_DEVICE_ID_ENE_CB714_SD_2,
452 .subvendor = PCI_ANY_ID,
453 .subdevice = PCI_ANY_ID,
454 .driver_data = (kernel_ulong_t)&sdhci_ene_714,
458 .vendor = PCI_VENDOR_ID_MARVELL,
459 .device = PCI_DEVICE_ID_MARVELL_88ALP01_SD,
460 .subvendor = PCI_ANY_ID,
461 .subdevice = PCI_ANY_ID,
462 .driver_data = (kernel_ulong_t)&sdhci_cafe,
466 .vendor = PCI_VENDOR_ID_JMICRON,
467 .device = PCI_DEVICE_ID_JMICRON_JMB38X_SD,
468 .subvendor = PCI_ANY_ID,
469 .subdevice = PCI_ANY_ID,
470 .driver_data = (kernel_ulong_t)&sdhci_jmicron,
474 .vendor = PCI_VENDOR_ID_JMICRON,
475 .device = PCI_DEVICE_ID_JMICRON_JMB38X_MMC,
476 .subvendor = PCI_ANY_ID,
477 .subdevice = PCI_ANY_ID,
478 .driver_data = (kernel_ulong_t)&sdhci_jmicron,
482 .vendor = PCI_VENDOR_ID_SYSKONNECT,
483 .device = 0x8000,
484 .subvendor = PCI_ANY_ID,
485 .subdevice = PCI_ANY_ID,
486 .driver_data = (kernel_ulong_t)&sdhci_syskt,
490 .vendor = PCI_VENDOR_ID_VIA,
491 .device = 0x95d0,
492 .subvendor = PCI_ANY_ID,
493 .subdevice = PCI_ANY_ID,
494 .driver_data = (kernel_ulong_t)&sdhci_via,
497 { /* Generic SD host controller */
498 PCI_DEVICE_CLASS((PCI_CLASS_SYSTEM_SDHCI << 8), 0xFFFF00)
501 { /* end: all zeroes */ },
504 MODULE_DEVICE_TABLE(pci, pci_ids);
506 /*****************************************************************************\
508 * SDHCI core callbacks *
510 \*****************************************************************************/
512 static int sdhci_pci_enable_dma(struct sdhci_host *host)
514 struct sdhci_pci_slot *slot;
515 struct pci_dev *pdev;
516 int ret;
518 slot = sdhci_priv(host);
519 pdev = slot->chip->pdev;
521 if (((pdev->class & 0xFFFF00) == (PCI_CLASS_SYSTEM_SDHCI << 8)) &&
522 ((pdev->class & 0x0000FF) != PCI_SDHCI_IFDMA) &&
523 (host->flags & SDHCI_USE_SDMA)) {
524 dev_warn(&pdev->dev, "Will use DMA mode even though HW "
525 "doesn't fully claim to support it.\n");
528 ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
529 if (ret)
530 return ret;
532 pci_set_master(pdev);
534 return 0;
537 static struct sdhci_ops sdhci_pci_ops = {
538 .enable_dma = sdhci_pci_enable_dma,
541 /*****************************************************************************\
543 * Suspend/resume *
545 \*****************************************************************************/
547 #ifdef CONFIG_PM
549 static int sdhci_pci_suspend (struct pci_dev *pdev, pm_message_t state)
551 struct sdhci_pci_chip *chip;
552 struct sdhci_pci_slot *slot;
553 mmc_pm_flag_t pm_flags = 0;
554 int i, ret;
556 chip = pci_get_drvdata(pdev);
557 if (!chip)
558 return 0;
560 for (i = 0;i < chip->num_slots;i++) {
561 slot = chip->slots[i];
562 if (!slot)
563 continue;
565 ret = sdhci_suspend_host(slot->host, state);
567 if (ret) {
568 for (i--;i >= 0;i--)
569 sdhci_resume_host(chip->slots[i]->host);
570 return ret;
573 pm_flags |= slot->host->mmc->pm_flags;
576 if (chip->fixes && chip->fixes->suspend) {
577 ret = chip->fixes->suspend(chip, state);
578 if (ret) {
579 for (i = chip->num_slots - 1;i >= 0;i--)
580 sdhci_resume_host(chip->slots[i]->host);
581 return ret;
585 pci_save_state(pdev);
586 if (pm_flags & MMC_PM_KEEP_POWER) {
587 if (pm_flags & MMC_PM_WAKE_SDIO_IRQ)
588 pci_enable_wake(pdev, PCI_D3hot, 1);
589 pci_set_power_state(pdev, PCI_D3hot);
590 } else {
591 pci_enable_wake(pdev, pci_choose_state(pdev, state), 0);
592 pci_disable_device(pdev);
593 pci_set_power_state(pdev, pci_choose_state(pdev, state));
596 return 0;
599 static int sdhci_pci_resume (struct pci_dev *pdev)
601 struct sdhci_pci_chip *chip;
602 struct sdhci_pci_slot *slot;
603 int i, ret;
605 chip = pci_get_drvdata(pdev);
606 if (!chip)
607 return 0;
609 pci_set_power_state(pdev, PCI_D0);
610 pci_restore_state(pdev);
611 ret = pci_enable_device(pdev);
612 if (ret)
613 return ret;
615 if (chip->fixes && chip->fixes->resume) {
616 ret = chip->fixes->resume(chip);
617 if (ret)
618 return ret;
621 for (i = 0;i < chip->num_slots;i++) {
622 slot = chip->slots[i];
623 if (!slot)
624 continue;
626 ret = sdhci_resume_host(slot->host);
627 if (ret)
628 return ret;
631 return 0;
634 #else /* CONFIG_PM */
636 #define sdhci_pci_suspend NULL
637 #define sdhci_pci_resume NULL
639 #endif /* CONFIG_PM */
641 /*****************************************************************************\
643 * Device probing/removal *
645 \*****************************************************************************/
647 static struct sdhci_pci_slot * __devinit sdhci_pci_probe_slot(
648 struct pci_dev *pdev, struct sdhci_pci_chip *chip, int bar)
650 struct sdhci_pci_slot *slot;
651 struct sdhci_host *host;
653 resource_size_t addr;
655 int ret;
657 if (!(pci_resource_flags(pdev, bar) & IORESOURCE_MEM)) {
658 dev_err(&pdev->dev, "BAR %d is not iomem. Aborting.\n", bar);
659 return ERR_PTR(-ENODEV);
662 if (pci_resource_len(pdev, bar) != 0x100) {
663 dev_err(&pdev->dev, "Invalid iomem size. You may "
664 "experience problems.\n");
667 if ((pdev->class & 0x0000FF) == PCI_SDHCI_IFVENDOR) {
668 dev_err(&pdev->dev, "Vendor specific interface. Aborting.\n");
669 return ERR_PTR(-ENODEV);
672 if ((pdev->class & 0x0000FF) > PCI_SDHCI_IFVENDOR) {
673 dev_err(&pdev->dev, "Unknown interface. Aborting.\n");
674 return ERR_PTR(-ENODEV);
677 host = sdhci_alloc_host(&pdev->dev, sizeof(struct sdhci_pci_slot));
678 if (IS_ERR(host)) {
679 dev_err(&pdev->dev, "cannot allocate host\n");
680 return ERR_CAST(host);
683 slot = sdhci_priv(host);
685 slot->chip = chip;
686 slot->host = host;
687 slot->pci_bar = bar;
689 host->hw_name = "PCI";
690 host->ops = &sdhci_pci_ops;
691 host->quirks = chip->quirks;
693 host->irq = pdev->irq;
695 ret = pci_request_region(pdev, bar, mmc_hostname(host->mmc));
696 if (ret) {
697 dev_err(&pdev->dev, "cannot request region\n");
698 goto free;
701 addr = pci_resource_start(pdev, bar);
702 host->ioaddr = pci_ioremap_bar(pdev, bar);
703 if (!host->ioaddr) {
704 dev_err(&pdev->dev, "failed to remap registers\n");
705 goto release;
708 if (chip->fixes && chip->fixes->probe_slot) {
709 ret = chip->fixes->probe_slot(slot);
710 if (ret)
711 goto unmap;
714 host->mmc->pm_caps = MMC_PM_KEEP_POWER | MMC_PM_WAKE_SDIO_IRQ;
716 ret = sdhci_add_host(host);
717 if (ret)
718 goto remove;
720 return slot;
722 remove:
723 if (chip->fixes && chip->fixes->remove_slot)
724 chip->fixes->remove_slot(slot, 0);
726 unmap:
727 iounmap(host->ioaddr);
729 release:
730 pci_release_region(pdev, bar);
732 free:
733 sdhci_free_host(host);
735 return ERR_PTR(ret);
738 static void sdhci_pci_remove_slot(struct sdhci_pci_slot *slot)
740 int dead;
741 u32 scratch;
743 dead = 0;
744 scratch = readl(slot->host->ioaddr + SDHCI_INT_STATUS);
745 if (scratch == (u32)-1)
746 dead = 1;
748 sdhci_remove_host(slot->host, dead);
750 if (slot->chip->fixes && slot->chip->fixes->remove_slot)
751 slot->chip->fixes->remove_slot(slot, dead);
753 pci_release_region(slot->chip->pdev, slot->pci_bar);
755 sdhci_free_host(slot->host);
758 static int __devinit sdhci_pci_probe(struct pci_dev *pdev,
759 const struct pci_device_id *ent)
761 struct sdhci_pci_chip *chip;
762 struct sdhci_pci_slot *slot;
764 u8 slots, rev, first_bar;
765 int ret, i;
767 BUG_ON(pdev == NULL);
768 BUG_ON(ent == NULL);
770 pci_read_config_byte(pdev, PCI_CLASS_REVISION, &rev);
772 dev_info(&pdev->dev, "SDHCI controller found [%04x:%04x] (rev %x)\n",
773 (int)pdev->vendor, (int)pdev->device, (int)rev);
775 ret = pci_read_config_byte(pdev, PCI_SLOT_INFO, &slots);
776 if (ret)
777 return ret;
779 slots = PCI_SLOT_INFO_SLOTS(slots) + 1;
780 dev_dbg(&pdev->dev, "found %d slot(s)\n", slots);
781 if (slots == 0)
782 return -ENODEV;
784 BUG_ON(slots > MAX_SLOTS);
786 ret = pci_read_config_byte(pdev, PCI_SLOT_INFO, &first_bar);
787 if (ret)
788 return ret;
790 first_bar &= PCI_SLOT_INFO_FIRST_BAR_MASK;
792 if (first_bar > 5) {
793 dev_err(&pdev->dev, "Invalid first BAR. Aborting.\n");
794 return -ENODEV;
797 ret = pci_enable_device(pdev);
798 if (ret)
799 return ret;
801 chip = kzalloc(sizeof(struct sdhci_pci_chip), GFP_KERNEL);
802 if (!chip) {
803 ret = -ENOMEM;
804 goto err;
807 chip->pdev = pdev;
808 chip->fixes = (const struct sdhci_pci_fixes*)ent->driver_data;
809 if (chip->fixes)
810 chip->quirks = chip->fixes->quirks;
811 chip->num_slots = slots;
813 pci_set_drvdata(pdev, chip);
815 if (chip->fixes && chip->fixes->probe) {
816 ret = chip->fixes->probe(chip);
817 if (ret)
818 goto free;
821 for (i = 0;i < slots;i++) {
822 slot = sdhci_pci_probe_slot(pdev, chip, first_bar + i);
823 if (IS_ERR(slot)) {
824 for (i--;i >= 0;i--)
825 sdhci_pci_remove_slot(chip->slots[i]);
826 ret = PTR_ERR(slot);
827 goto free;
830 chip->slots[i] = slot;
833 return 0;
835 free:
836 pci_set_drvdata(pdev, NULL);
837 kfree(chip);
839 err:
840 pci_disable_device(pdev);
841 return ret;
844 static void __devexit sdhci_pci_remove(struct pci_dev *pdev)
846 int i;
847 struct sdhci_pci_chip *chip;
849 chip = pci_get_drvdata(pdev);
851 if (chip) {
852 for (i = 0;i < chip->num_slots; i++)
853 sdhci_pci_remove_slot(chip->slots[i]);
855 pci_set_drvdata(pdev, NULL);
856 kfree(chip);
859 pci_disable_device(pdev);
862 static struct pci_driver sdhci_driver = {
863 .name = "sdhci-pci",
864 .id_table = pci_ids,
865 .probe = sdhci_pci_probe,
866 .remove = __devexit_p(sdhci_pci_remove),
867 .suspend = sdhci_pci_suspend,
868 .resume = sdhci_pci_resume,
871 /*****************************************************************************\
873 * Driver init/exit *
875 \*****************************************************************************/
877 static int __init sdhci_drv_init(void)
879 return pci_register_driver(&sdhci_driver);
882 static void __exit sdhci_drv_exit(void)
884 pci_unregister_driver(&sdhci_driver);
887 module_init(sdhci_drv_init);
888 module_exit(sdhci_drv_exit);
890 MODULE_AUTHOR("Pierre Ossman <pierre@ossman.eu>");
891 MODULE_DESCRIPTION("Secure Digital Host Controller Interface PCI driver");
892 MODULE_LICENSE("GPL");