sdhci.c revision e538fbe83e374a3521128c1f4642aca037661c9d
1d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman/*
270f10482c668301c483acded13bf68780ad352b9Pierre Ossman *  linux/drivers/mmc/host/sdhci.c - Secure Digital Host Controller Interface driver
3d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *
414d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov *  Copyright (C) 2005-2007 Pierre Ossman, All Rights Reserved.
5d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *
6d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman * This program is free software; you can redistribute it and/or modify
7643f720cea989d2913fc0120a2384fecc1be1f9aPierre Ossman * it under the terms of the GNU General Public License as published by
8643f720cea989d2913fc0120a2384fecc1be1f9aPierre Ossman * the Free Software Foundation; either version 2 of the License, or (at
9643f720cea989d2913fc0120a2384fecc1be1f9aPierre Ossman * your option) any later version.
10d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman */
11d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
12d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#include <linux/delay.h>
13d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#include <linux/highmem.h>
14d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#include <linux/pci.h>
15d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#include <linux/dma-mapping.h>
16d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
17d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#include <linux/mmc/host.h>
18d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
19d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#include <asm/scatterlist.h>
20d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
21d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#include "sdhci.h"
22d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
23d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#define DRIVER_NAME "sdhci"
24d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
25d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#define DBG(f, x...) \
26c65631781eb0f2e81865017c1484e9aef76e1b61Russell King	pr_debug(DRIVER_NAME " [%s()]: " f, __func__,## x)
27d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
286743527441430586aa82a0dee1b2700a2a974ebcPierre Ossmanstatic unsigned int debug_nodma = 0;
296743527441430586aa82a0dee1b2700a2a974ebcPierre Ossmanstatic unsigned int debug_forcedma = 0;
30df673b227ce08a7706b30fd2bf6512393d9c3c29Pierre Ossmanstatic unsigned int debug_quirks = 0;
316743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman
32645289dca5021224279e67b4655796cafdfdad00Pierre Ossman#define SDHCI_QUIRK_CLOCK_BEFORE_RESET			(1<<0)
3398608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman#define SDHCI_QUIRK_FORCE_DMA				(1<<1)
348a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman/* Controller doesn't like some resets when there is no card inserted. */
358a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman#define SDHCI_QUIRK_NO_CARD_NO_RESET			(1<<2)
369e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt#define SDHCI_QUIRK_SINGLE_POWER_WRITE			(1<<3)
37b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo#define SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS		(1<<4)
38645289dca5021224279e67b4655796cafdfdad00Pierre Ossman
39d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic const struct pci_device_id pci_ids[] __devinitdata = {
40645289dca5021224279e67b4655796cafdfdad00Pierre Ossman	{
41645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		.vendor		= PCI_VENDOR_ID_RICOH,
42645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		.device		= PCI_DEVICE_ID_RICOH_R5C822,
43645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		.subvendor	= PCI_VENDOR_ID_IBM,
44645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		.subdevice	= PCI_ANY_ID,
4598608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.driver_data	= SDHCI_QUIRK_CLOCK_BEFORE_RESET |
4698608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman				  SDHCI_QUIRK_FORCE_DMA,
4798608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman	},
4898608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman
4998608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman	{
5098608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.vendor		= PCI_VENDOR_ID_RICOH,
5198608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.device		= PCI_DEVICE_ID_RICOH_R5C822,
5298608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.subvendor	= PCI_ANY_ID,
5398608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.subdevice	= PCI_ANY_ID,
548a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman		.driver_data	= SDHCI_QUIRK_FORCE_DMA |
558a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman				  SDHCI_QUIRK_NO_CARD_NO_RESET,
5698608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman	},
5798608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman
5898608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman	{
5998608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.vendor		= PCI_VENDOR_ID_TI,
6098608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.device		= PCI_DEVICE_ID_TI_XX21_XX11_SD,
6198608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.subvendor	= PCI_ANY_ID,
6298608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.subdevice	= PCI_ANY_ID,
6398608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		.driver_data	= SDHCI_QUIRK_FORCE_DMA,
64645289dca5021224279e67b4655796cafdfdad00Pierre Ossman	},
65645289dca5021224279e67b4655796cafdfdad00Pierre Ossman
669e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt	{
679e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt		.vendor		= PCI_VENDOR_ID_ENE,
689e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt		.device		= PCI_DEVICE_ID_ENE_CB712_SD,
699e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt		.subvendor	= PCI_ANY_ID,
709e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt		.subdevice	= PCI_ANY_ID,
719e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt		.driver_data	= SDHCI_QUIRK_SINGLE_POWER_WRITE,
729e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt	},
739e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt
747de064ebc67d9baf6c933d3a7046feb9b4eced05Milko Krachounov	{
757de064ebc67d9baf6c933d3a7046feb9b4eced05Milko Krachounov		.vendor		= PCI_VENDOR_ID_ENE,
767de064ebc67d9baf6c933d3a7046feb9b4eced05Milko Krachounov		.device		= PCI_DEVICE_ID_ENE_CB712_SD_2,
777de064ebc67d9baf6c933d3a7046feb9b4eced05Milko Krachounov		.subvendor	= PCI_ANY_ID,
787de064ebc67d9baf6c933d3a7046feb9b4eced05Milko Krachounov		.subdevice	= PCI_ANY_ID,
797de064ebc67d9baf6c933d3a7046feb9b4eced05Milko Krachounov		.driver_data	= SDHCI_QUIRK_SINGLE_POWER_WRITE,
807de064ebc67d9baf6c933d3a7046feb9b4eced05Milko Krachounov	},
817de064ebc67d9baf6c933d3a7046feb9b4eced05Milko Krachounov
82b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	{
83b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.vendor         = PCI_VENDOR_ID_ENE,
84b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.device         = PCI_DEVICE_ID_ENE_CB714_SD,
85b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.subvendor      = PCI_ANY_ID,
86b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.subdevice      = PCI_ANY_ID,
87b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.driver_data    = SDHCI_QUIRK_SINGLE_POWER_WRITE |
88b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo				  SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS,
89b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	},
90b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo
91b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	{
92b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.vendor         = PCI_VENDOR_ID_ENE,
93b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.device         = PCI_DEVICE_ID_ENE_CB714_SD_2,
94b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.subvendor      = PCI_ANY_ID,
95b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.subdevice      = PCI_ANY_ID,
96b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		.driver_data    = SDHCI_QUIRK_SINGLE_POWER_WRITE |
97b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo				  SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS,
98b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	},
99b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo
100645289dca5021224279e67b4655796cafdfdad00Pierre Ossman	{	/* Generic SD host controller */
101645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		PCI_DEVICE_CLASS((PCI_CLASS_SYSTEM_SDHCI << 8), 0xFFFF00)
102645289dca5021224279e67b4655796cafdfdad00Pierre Ossman	},
103645289dca5021224279e67b4655796cafdfdad00Pierre Ossman
104d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	{ /* end: all zeroes */ },
105d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman};
106d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
107d129bceb1d44ed3c23b99164849193703372bab4Pierre OssmanMODULE_DEVICE_TABLE(pci, pci_ids);
108d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
109d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_prepare_data(struct sdhci_host *, struct mmc_data *);
110d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_finish_data(struct sdhci_host *);
111d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
112d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_send_command(struct sdhci_host *, struct mmc_command *);
113d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_finish_command(struct sdhci_host *);
114d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
115d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_dumpregs(struct sdhci_host *host)
116d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
117d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": ============== REGISTER DUMP ==============\n");
118d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
119d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": Sys addr: 0x%08x | Version:  0x%08x\n",
120d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readl(host->ioaddr + SDHCI_DMA_ADDRESS),
121d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readw(host->ioaddr + SDHCI_HOST_VERSION));
122d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": Blk size: 0x%08x | Blk cnt:  0x%08x\n",
123d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readw(host->ioaddr + SDHCI_BLOCK_SIZE),
124d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readw(host->ioaddr + SDHCI_BLOCK_COUNT));
125d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": Argument: 0x%08x | Trn mode: 0x%08x\n",
126d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readl(host->ioaddr + SDHCI_ARGUMENT),
127d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readw(host->ioaddr + SDHCI_TRANSFER_MODE));
128d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": Present:  0x%08x | Host ctl: 0x%08x\n",
129d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readl(host->ioaddr + SDHCI_PRESENT_STATE),
130d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readb(host->ioaddr + SDHCI_HOST_CONTROL));
131d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": Power:    0x%08x | Blk gap:  0x%08x\n",
132d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readb(host->ioaddr + SDHCI_POWER_CONTROL),
133d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readb(host->ioaddr + SDHCI_BLOCK_GAP_CONTROL));
134d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": Wake-up:  0x%08x | Clock:    0x%08x\n",
135d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readb(host->ioaddr + SDHCI_WALK_UP_CONTROL),
136d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readw(host->ioaddr + SDHCI_CLOCK_CONTROL));
137d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": Timeout:  0x%08x | Int stat: 0x%08x\n",
138d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readb(host->ioaddr + SDHCI_TIMEOUT_CONTROL),
139d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readl(host->ioaddr + SDHCI_INT_STATUS));
140d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": Int enab: 0x%08x | Sig enab: 0x%08x\n",
141d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readl(host->ioaddr + SDHCI_INT_ENABLE),
142d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readl(host->ioaddr + SDHCI_SIGNAL_ENABLE));
143d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": AC12 err: 0x%08x | Slot int: 0x%08x\n",
144d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readw(host->ioaddr + SDHCI_ACMD12_ERR),
145d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readw(host->ioaddr + SDHCI_SLOT_INT_STATUS));
146d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": Caps:     0x%08x | Max curr: 0x%08x\n",
147d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readl(host->ioaddr + SDHCI_CAPABILITIES),
148d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		readl(host->ioaddr + SDHCI_MAX_CURRENT));
149d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
150d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_DEBUG DRIVER_NAME ": ===========================================\n");
151d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
152d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
153d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman/*****************************************************************************\
154d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
155d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman * Low level functions                                                       *
156d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
157d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman\*****************************************************************************/
158d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
159d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_reset(struct sdhci_host *host, u8 mask)
160d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
161e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman	unsigned long timeout;
162e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman
1638a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman	if (host->chip->quirks & SDHCI_QUIRK_NO_CARD_NO_RESET) {
1648a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman		if (!(readl(host->ioaddr + SDHCI_PRESENT_STATE) &
1658a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman			SDHCI_CARD_PRESENT))
1668a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman			return;
1678a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman	}
1688a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman
169d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writeb(mask, host->ioaddr + SDHCI_SOFTWARE_RESET);
170d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
171e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman	if (mask & SDHCI_RESET_ALL)
172d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->clock = 0;
173d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
174e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman	/* Wait max 100 ms */
175e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman	timeout = 100;
176e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman
177e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman	/* hw clears the bit when it's done */
178e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman	while (readb(host->ioaddr + SDHCI_SOFTWARE_RESET) & mask) {
179e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman		if (timeout == 0) {
180acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman			printk(KERN_ERR "%s: Reset 0x%x never completed.\n",
181e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman				mmc_hostname(host->mmc), (int)mask);
182e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman			sdhci_dumpregs(host);
183e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman			return;
184e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman		}
185e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman		timeout--;
186e16514d8d86ecbde18a2a7495cf028861b34c157Pierre Ossman		mdelay(1);
187d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
188d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
189d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
190d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_init(struct sdhci_host *host)
191d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
192d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	u32 intmask;
193d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
194d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	sdhci_reset(host, SDHCI_RESET_ALL);
195d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1963192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman	intmask = SDHCI_INT_BUS_POWER | SDHCI_INT_DATA_END_BIT |
1973192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman		SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_TIMEOUT | SDHCI_INT_INDEX |
1983192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman		SDHCI_INT_END_BIT | SDHCI_INT_CRC | SDHCI_INT_TIMEOUT |
1993192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman		SDHCI_INT_CARD_REMOVE | SDHCI_INT_CARD_INSERT |
200a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL |
2013192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman		SDHCI_INT_DMA_END | SDHCI_INT_DATA_END | SDHCI_INT_RESPONSE;
202d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
203d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writel(intmask, host->ioaddr + SDHCI_INT_ENABLE);
204d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writel(intmask, host->ioaddr + SDHCI_SIGNAL_ENABLE);
205d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
206d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
207d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_activate_led(struct sdhci_host *host)
208d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
209d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	u8 ctrl;
210d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
211d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	ctrl = readb(host->ioaddr + SDHCI_HOST_CONTROL);
212d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	ctrl |= SDHCI_CTRL_LED;
213d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writeb(ctrl, host->ioaddr + SDHCI_HOST_CONTROL);
214d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
215d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
216d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_deactivate_led(struct sdhci_host *host)
217d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
218d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	u8 ctrl;
219d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
220d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	ctrl = readb(host->ioaddr + SDHCI_HOST_CONTROL);
221d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	ctrl &= ~SDHCI_CTRL_LED;
222d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writeb(ctrl, host->ioaddr + SDHCI_HOST_CONTROL);
223d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
224d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
225d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman/*****************************************************************************\
226d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
227d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman * Core functions                                                            *
228d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
229d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman\*****************************************************************************/
230d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
2312a22b14edfdf1dce303ec48bb934a6a2edb278b5Pierre Ossmanstatic inline char* sdhci_sg_to_buffer(struct sdhci_host* host)
232d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
2332a22b14edfdf1dce303ec48bb934a6a2edb278b5Pierre Ossman	return page_address(host->cur_sg->page) + host->cur_sg->offset;
234d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
235d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
236d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic inline int sdhci_next_sg(struct sdhci_host* host)
237d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
238d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
239d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * Skip to next SG entry.
240d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
241d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->cur_sg++;
242d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->num_sg--;
243d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
244d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
245d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * Any entries left?
246d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
247d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (host->num_sg > 0) {
248d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->offset = 0;
249d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->remain = host->cur_sg->length;
250d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
251d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
252d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return host->num_sg;
253d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
254d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
255a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossmanstatic void sdhci_read_block_pio(struct sdhci_host *host)
256d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
257a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	int blksize, chunk_remain;
258a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	u32 data;
259d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	char *buffer;
260a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	int size;
261d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
262a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	DBG("PIO reading\n");
263d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
264a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	blksize = host->data->blksz;
265a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	chunk_remain = 0;
266a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	data = 0;
267d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
2682a22b14edfdf1dce303ec48bb934a6a2edb278b5Pierre Ossman	buffer = sdhci_sg_to_buffer(host) + host->offset;
269d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
270a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	while (blksize) {
271a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		if (chunk_remain == 0) {
272a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			data = readl(host->ioaddr + SDHCI_BUFFER);
273a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			chunk_remain = min(blksize, 4);
274a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		}
275d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
27614d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov		size = min(host->remain, chunk_remain);
277d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
278a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		chunk_remain -= size;
279a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		blksize -= size;
280a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		host->offset += size;
281a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		host->remain -= size;
28214d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov
283a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		while (size) {
284a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			*buffer = data & 0xFF;
285a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			buffer++;
286a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			data >>= 8;
287a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			size--;
288a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		}
289d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
290a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		if (host->remain == 0) {
291a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			if (sdhci_next_sg(host) == 0) {
292a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman				BUG_ON(blksize != 0);
293a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman				return;
294a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			}
2952a22b14edfdf1dce303ec48bb934a6a2edb278b5Pierre Ossman			buffer = sdhci_sg_to_buffer(host);
296d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
297a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	}
298a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman}
299d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
300a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossmanstatic void sdhci_write_block_pio(struct sdhci_host *host)
301a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman{
302a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	int blksize, chunk_remain;
303a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	u32 data;
304a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	char *buffer;
305a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	int bytes, size;
306d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
307a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	DBG("PIO writing\n");
308a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman
309a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	blksize = host->data->blksz;
310a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	chunk_remain = 4;
311a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	data = 0;
312d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
313a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	bytes = 0;
3142a22b14edfdf1dce303ec48bb934a6a2edb278b5Pierre Ossman	buffer = sdhci_sg_to_buffer(host) + host->offset;
315d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
316a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	while (blksize) {
31714d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov		size = min(host->remain, chunk_remain);
318a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman
319a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		chunk_remain -= size;
320a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		blksize -= size;
321d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->offset += size;
322d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->remain -= size;
32314d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov
324a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		while (size) {
325a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			data >>= 8;
326a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			data |= (u32)*buffer << 24;
327a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			buffer++;
328a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			size--;
329a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		}
330a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman
331a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		if (chunk_remain == 0) {
332a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			writel(data, host->ioaddr + SDHCI_BUFFER);
333a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			chunk_remain = min(blksize, 4);
334a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		}
335d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
336d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (host->remain == 0) {
337d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			if (sdhci_next_sg(host) == 0) {
338a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman				BUG_ON(blksize != 0);
339d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				return;
340d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			}
3412a22b14edfdf1dce303ec48bb934a6a2edb278b5Pierre Ossman			buffer = sdhci_sg_to_buffer(host);
342d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
343d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
344a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman}
345a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman
346a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossmanstatic void sdhci_transfer_pio(struct sdhci_host *host)
347a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman{
348a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	u32 mask;
349a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman
350a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	BUG_ON(!host->data);
351a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman
35214d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov	if (host->num_sg == 0)
353a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		return;
354a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman
355a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	if (host->data->flags & MMC_DATA_READ)
356a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		mask = SDHCI_DATA_AVAILABLE;
357a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	else
358a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		mask = SDHCI_SPACE_AVAILABLE;
359a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman
360a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	while (readl(host->ioaddr + SDHCI_PRESENT_STATE) & mask) {
361a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		if (host->data->flags & MMC_DATA_READ)
362a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			sdhci_read_block_pio(host);
363a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		else
364a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			sdhci_write_block_pio(host);
365d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
36614d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov		if (host->num_sg == 0)
367a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman			break;
368a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	}
369d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
370a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman	DBG("PIO transfer complete.\n");
371d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
372d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
373d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data)
374d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
3751c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	u8 count;
3761c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	unsigned target_timeout, current_timeout;
377d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
378d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	WARN_ON(host->data);
379d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
380c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	if (data == NULL)
381d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return;
382d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
383bab7696184bbf0ea48d56902bd1f9ac983079ad2Pierre Ossman	/* Sanity checks */
384bab7696184bbf0ea48d56902bd1f9ac983079ad2Pierre Ossman	BUG_ON(data->blksz * data->blocks > 524288);
385fe4a3c7a20f14d86022a8132adbf6ddb98e7197cPierre Ossman	BUG_ON(data->blksz > host->mmc->max_blk_size);
3861d676e02970d9e511c9b96101501da90954ee265Pierre Ossman	BUG_ON(data->blocks > 65535);
387d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
388e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman	host->data = data;
389e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman	host->data_early = 0;
390e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman
3911c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	/* timeout in us */
3921c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	target_timeout = data->timeout_ns / 1000 +
3931c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		data->timeout_clks / host->clock;
394d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
3951c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	/*
3961c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	 * Figure out needed cycles.
3971c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	 * We do this in steps in order to fit inside a 32 bit int.
3981c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	 * The first step is the minimum timeout, which will have a
3991c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	 * minimum resolution of 6 bits:
4001c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	 * (1) 2^13*1000 > 2^22,
4011c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	 * (2) host->timeout_clk < 2^16
4021c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	 *     =>
4031c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	 *     (1) / (2) > 2^6
4041c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	 */
4051c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	count = 0;
4061c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	current_timeout = (1 << 13) * 1000 / host->timeout_clk;
4071c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	while (current_timeout < target_timeout) {
4081c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		count++;
4091c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		current_timeout <<= 1;
4101c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		if (count >= 0xF)
4111c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman			break;
4121c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	}
4131c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman
4141c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	if (count >= 0xF) {
4151c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		printk(KERN_WARNING "%s: Too large timeout requested!\n",
4161c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman			mmc_hostname(host->mmc));
4171c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		count = 0xE;
4181c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	}
4191c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman
4201c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	writeb(count, host->ioaddr + SDHCI_TIMEOUT_CONTROL);
421d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
422d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (host->flags & SDHCI_USE_DMA) {
423d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		int count;
424d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
425d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		count = pci_map_sg(host->chip->pdev, data->sg, data->sg_len,
426d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			(data->flags & MMC_DATA_READ)?PCI_DMA_FROMDEVICE:PCI_DMA_TODEVICE);
427d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		BUG_ON(count != 1);
428d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
429d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		writel(sg_dma_address(data->sg), host->ioaddr + SDHCI_DMA_ADDRESS);
430d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	} else {
431d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->cur_sg = data->sg;
432d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->num_sg = data->sg_len;
433d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
434d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->offset = 0;
435d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->remain = host->cur_sg->length;
436d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
437c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman
438bab7696184bbf0ea48d56902bd1f9ac983079ad2Pierre Ossman	/* We do not handle DMA boundaries, so set it to max (512 KiB) */
439bab7696184bbf0ea48d56902bd1f9ac983079ad2Pierre Ossman	writew(SDHCI_MAKE_BLKSZ(7, data->blksz),
440bab7696184bbf0ea48d56902bd1f9ac983079ad2Pierre Ossman		host->ioaddr + SDHCI_BLOCK_SIZE);
441c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	writew(data->blocks, host->ioaddr + SDHCI_BLOCK_COUNT);
442c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman}
443c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman
444c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossmanstatic void sdhci_set_transfer_mode(struct sdhci_host *host,
445c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	struct mmc_data *data)
446c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman{
447c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	u16 mode;
448c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman
449c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	if (data == NULL)
450c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman		return;
451c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman
452e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman	WARN_ON(!host->data);
453e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman
454c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	mode = SDHCI_TRNS_BLK_CNT_EN;
455c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	if (data->blocks > 1)
456c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman		mode |= SDHCI_TRNS_MULTI;
457c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	if (data->flags & MMC_DATA_READ)
458c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman		mode |= SDHCI_TRNS_READ;
459c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	if (host->flags & SDHCI_USE_DMA)
460c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman		mode |= SDHCI_TRNS_DMA;
461c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman
462c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	writew(mode, host->ioaddr + SDHCI_TRANSFER_MODE);
463d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
464d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
465d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_finish_data(struct sdhci_host *host)
466d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
467d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct mmc_data *data;
468d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	u16 blocks;
469d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
470d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	BUG_ON(!host->data);
471d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
472d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	data = host->data;
473d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->data = NULL;
474d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
475d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (host->flags & SDHCI_USE_DMA) {
476d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		pci_unmap_sg(host->chip->pdev, data->sg, data->sg_len,
477d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			(data->flags & MMC_DATA_READ)?PCI_DMA_FROMDEVICE:PCI_DMA_TODEVICE);
478d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
479d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
480d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
481d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * Controller doesn't count down when in single block mode.
482d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
4832b061973404802fb87db93175b856ee0dfbe38e4Pierre Ossman	if (data->blocks == 1)
4842b061973404802fb87db93175b856ee0dfbe38e4Pierre Ossman		blocks = (data->error == MMC_ERR_NONE) ? 0 : 1;
485d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else
486d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		blocks = readw(host->ioaddr + SDHCI_BLOCK_COUNT);
487a3fd4a1b9ced850ac1a9d5bb9f8fab494d07f3faRussell King	data->bytes_xfered = data->blksz * (data->blocks - blocks);
488d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
489d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if ((data->error == MMC_ERR_NONE) && blocks) {
490d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		printk(KERN_ERR "%s: Controller signalled completion even "
491acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman			"though there were blocks left.\n",
492acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman			mmc_hostname(host->mmc));
493d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		data->error = MMC_ERR_FAILED;
494d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
495d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
496d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (data->stop) {
497d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		/*
498d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		 * The controller needs a reset of internal state machines
499d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		 * upon error conditions.
500d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		 */
501d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (data->error != MMC_ERR_NONE) {
502d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			sdhci_reset(host, SDHCI_RESET_CMD);
503d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			sdhci_reset(host, SDHCI_RESET_DATA);
504d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
505d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
506d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_send_command(host, data->stop);
507d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	} else
508d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		tasklet_schedule(&host->finish_tasklet);
509d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
510d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
511d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_send_command(struct sdhci_host *host, struct mmc_command *cmd)
512d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
513d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	int flags;
514fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman	u32 mask;
5157cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman	unsigned long timeout;
516d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
517d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	WARN_ON(host->cmd);
518d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
519d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/* Wait max 10 ms */
5207cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman	timeout = 10;
521fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman
522fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman	mask = SDHCI_CMD_INHIBIT;
523fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman	if ((cmd->data != NULL) || (cmd->flags & MMC_RSP_BUSY))
524fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman		mask |= SDHCI_DATA_INHIBIT;
525fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman
526fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman	/* We shouldn't wait for data inihibit for stop commands, even
527fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman	   though they might use busy signaling */
528fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman	if (host->mrq->data && (cmd == host->mrq->data->stop))
529fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman		mask &= ~SDHCI_DATA_INHIBIT;
530fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman
531fd2208d7c72ef5995b730f1e23b082261499e334Pierre Ossman	while (readl(host->ioaddr + SDHCI_PRESENT_STATE) & mask) {
5327cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman		if (timeout == 0) {
533d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			printk(KERN_ERR "%s: Controller never released "
534acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman				"inhibit bit(s).\n", mmc_hostname(host->mmc));
535d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			sdhci_dumpregs(host);
536d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			cmd->error = MMC_ERR_FAILED;
537d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			tasklet_schedule(&host->finish_tasklet);
538d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			return;
539d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
5407cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman		timeout--;
5417cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman		mdelay(1);
5427cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman	}
543d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
544d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mod_timer(&host->timer, jiffies + 10 * HZ);
545d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
546d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->cmd = cmd;
547d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
548d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	sdhci_prepare_data(host, cmd->data);
549d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
550d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writel(cmd->arg, host->ioaddr + SDHCI_ARGUMENT);
551d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
552c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman	sdhci_set_transfer_mode(host, cmd->data);
553c7fa9963ee6317b54e85b260791d603ea2feb8e3Pierre Ossman
554d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) {
555acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman		printk(KERN_ERR "%s: Unsupported response type!\n",
556d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			mmc_hostname(host->mmc));
557d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		cmd->error = MMC_ERR_INVALID;
558d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		tasklet_schedule(&host->finish_tasklet);
559d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return;
560d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
561d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
562d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!(cmd->flags & MMC_RSP_PRESENT))
563d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		flags = SDHCI_CMD_RESP_NONE;
564d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else if (cmd->flags & MMC_RSP_136)
565d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		flags = SDHCI_CMD_RESP_LONG;
566d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else if (cmd->flags & MMC_RSP_BUSY)
567d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		flags = SDHCI_CMD_RESP_SHORT_BUSY;
568d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else
569d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		flags = SDHCI_CMD_RESP_SHORT;
570d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
571d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (cmd->flags & MMC_RSP_CRC)
572d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		flags |= SDHCI_CMD_CRC;
573d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (cmd->flags & MMC_RSP_OPCODE)
574d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		flags |= SDHCI_CMD_INDEX;
575d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (cmd->data)
576d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		flags |= SDHCI_CMD_DATA;
577d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
578fb61e2895170920564410baadf71c5b3561dbf42Pierre Ossman	writew(SDHCI_MAKE_CMD(cmd->opcode, flags),
579d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->ioaddr + SDHCI_COMMAND);
580d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
581d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
582d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_finish_command(struct sdhci_host *host)
583d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
584d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	int i;
585d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
586d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	BUG_ON(host->cmd == NULL);
587d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
588d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (host->cmd->flags & MMC_RSP_PRESENT) {
589d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (host->cmd->flags & MMC_RSP_136) {
590d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			/* CRC is stripped so we need to do some shifting. */
591d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			for (i = 0;i < 4;i++) {
592d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				host->cmd->resp[i] = readl(host->ioaddr +
593d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman					SDHCI_RESPONSE + (3-i)*4) << 8;
594d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				if (i != 3)
595d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman					host->cmd->resp[i] |=
596d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman						readb(host->ioaddr +
597d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman						SDHCI_RESPONSE + (3-i)*4-1);
598d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			}
599d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		} else {
600d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			host->cmd->resp[0] = readl(host->ioaddr + SDHCI_RESPONSE);
601d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
602d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
603d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
604d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->cmd->error = MMC_ERR_NONE;
605d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
606e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman	if (host->data && host->data_early)
607e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman		sdhci_finish_data(host);
608e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman
609e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman	if (!host->cmd->data)
610d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		tasklet_schedule(&host->finish_tasklet);
611d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
612d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->cmd = NULL;
613d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
614d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
615d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_set_clock(struct sdhci_host *host, unsigned int clock)
616d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
617d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	int div;
618d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	u16 clk;
6197cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman	unsigned long timeout;
620d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
621d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (clock == host->clock)
622d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return;
623d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
624d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writew(0, host->ioaddr + SDHCI_CLOCK_CONTROL);
625d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
626d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (clock == 0)
627d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		goto out;
628d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
629d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	for (div = 1;div < 256;div *= 2) {
630d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if ((host->max_clk / div) <= clock)
631d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			break;
632d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
633d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	div >>= 1;
634d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
635d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	clk = div << SDHCI_DIVIDER_SHIFT;
636d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	clk |= SDHCI_CLOCK_INT_EN;
637d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writew(clk, host->ioaddr + SDHCI_CLOCK_CONTROL);
638d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
639d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/* Wait max 10 ms */
6407cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman	timeout = 10;
6417cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman	while (!((clk = readw(host->ioaddr + SDHCI_CLOCK_CONTROL))
6427cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman		& SDHCI_CLOCK_INT_STABLE)) {
6437cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman		if (timeout == 0) {
644acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman			printk(KERN_ERR "%s: Internal clock never "
645acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman				"stabilised.\n", mmc_hostname(host->mmc));
646d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			sdhci_dumpregs(host);
647d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			return;
648d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
6497cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman		timeout--;
6507cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman		mdelay(1);
6517cb2c76fa2251474e42d55b75163c9d7ed11741ePierre Ossman	}
652d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
653d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	clk |= SDHCI_CLOCK_CARD_EN;
654d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writew(clk, host->ioaddr + SDHCI_CLOCK_CONTROL);
655d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
656d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanout:
657d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->clock = clock;
658d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
659d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
660146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossmanstatic void sdhci_set_power(struct sdhci_host *host, unsigned short power)
661146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman{
662146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	u8 pwr;
663146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman
664146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	if (host->power == power)
665146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		return;
666146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman
6679e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt	if (power == (unsigned short)-1) {
6689e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt		writeb(0, host->ioaddr + SDHCI_POWER_CONTROL);
669146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		goto out;
6709e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt	}
6719e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt
6729e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt	/*
6739e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt	 * Spec says that we should clear the power reg before setting
6749e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt	 * a new value. Some controllers don't seem to like this though.
6759e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt	 */
6769e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt	if (!(host->chip->quirks & SDHCI_QUIRK_SINGLE_POWER_WRITE))
6779e9dc5f29f2eb65153a15c4fdb12b4382e3a75b2Darren Salt		writeb(0, host->ioaddr + SDHCI_POWER_CONTROL);
678146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman
679146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	pwr = SDHCI_POWER_ON;
680146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman
6814be34c99a2f3aa90fa42e62c0918f07afb8a645bPhilip Langdale	switch (1 << power) {
68255556da01284af8c2174b786b3eca8e11301b656Philip Langdale	case MMC_VDD_165_195:
683146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		pwr |= SDHCI_POWER_180;
684146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		break;
6854be34c99a2f3aa90fa42e62c0918f07afb8a645bPhilip Langdale	case MMC_VDD_29_30:
6864be34c99a2f3aa90fa42e62c0918f07afb8a645bPhilip Langdale	case MMC_VDD_30_31:
687146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		pwr |= SDHCI_POWER_300;
688146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		break;
6894be34c99a2f3aa90fa42e62c0918f07afb8a645bPhilip Langdale	case MMC_VDD_32_33:
6904be34c99a2f3aa90fa42e62c0918f07afb8a645bPhilip Langdale	case MMC_VDD_33_34:
691146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		pwr |= SDHCI_POWER_330;
692146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		break;
693146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	default:
694146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		BUG();
695146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	}
696146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman
697146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	writeb(pwr, host->ioaddr + SDHCI_POWER_CONTROL);
698146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman
699146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossmanout:
700146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	host->power = power;
701146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman}
702146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman
703d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman/*****************************************************************************\
704d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
705d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman * MMC callbacks                                                             *
706d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
707d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman\*****************************************************************************/
708d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
709d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_request(struct mmc_host *mmc, struct mmc_request *mrq)
710d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
711d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_host *host;
712d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	unsigned long flags;
713d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
714d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host = mmc_priv(mmc);
715d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
716d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_lock_irqsave(&host->lock, flags);
717d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
718d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	WARN_ON(host->mrq != NULL);
719d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
720d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	sdhci_activate_led(host);
721d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
722d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->mrq = mrq;
723d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
724d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!(readl(host->ioaddr + SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT)) {
725d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->mrq->cmd->error = MMC_ERR_TIMEOUT;
726d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		tasklet_schedule(&host->finish_tasklet);
727d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	} else
728d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_send_command(host, mrq->cmd);
729d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
7305f25a66f6bbac563c94af94f03491b3ae43c40afPierre Ossman	mmiowb();
731d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_unlock_irqrestore(&host->lock, flags);
732d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
733d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
734d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
735d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
736d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_host *host;
737d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	unsigned long flags;
738d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	u8 ctrl;
739d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
740d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host = mmc_priv(mmc);
741d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
742d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_lock_irqsave(&host->lock, flags);
743d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
744d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
745d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * Reset the chip on each power off.
746d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * Should clear out any weird states.
747d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
748d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (ios->power_mode == MMC_POWER_OFF) {
749d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		writel(0, host->ioaddr + SDHCI_SIGNAL_ENABLE);
750d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_init(host);
751d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
752d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
753d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	sdhci_set_clock(host, ios->clock);
754d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
755d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (ios->power_mode == MMC_POWER_OFF)
756146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		sdhci_set_power(host, -1);
757d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else
758146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		sdhci_set_power(host, ios->vdd);
759d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
760d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	ctrl = readb(host->ioaddr + SDHCI_HOST_CONTROL);
761cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman
762d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (ios->bus_width == MMC_BUS_WIDTH_4)
763d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		ctrl |= SDHCI_CTRL_4BITBUS;
764d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else
765d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		ctrl &= ~SDHCI_CTRL_4BITBUS;
766cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman
767cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman	if (ios->timing == MMC_TIMING_SD_HS)
768cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman		ctrl |= SDHCI_CTRL_HISPD;
769cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman	else
770cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman		ctrl &= ~SDHCI_CTRL_HISPD;
771cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman
772d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	writeb(ctrl, host->ioaddr + SDHCI_HOST_CONTROL);
773d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
774b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	/*
775b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	 * Some (ENE) controllers go apeshit on some ios operation,
776b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	 * signalling timeout and CRC errors even on CMD0. Resetting
777b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	 * it on each ios seems to solve the problem.
778b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	 */
779b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo	if(host->chip->quirks & SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS)
780b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo		sdhci_reset(host, SDHCI_RESET_CMD | SDHCI_RESET_DATA);
781b8352260d28b30cb2bb2df99814fb9c360e38901Leandro Dorileo
7825f25a66f6bbac563c94af94f03491b3ae43c40afPierre Ossman	mmiowb();
783d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_unlock_irqrestore(&host->lock, flags);
784d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
785d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
786d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic int sdhci_get_ro(struct mmc_host *mmc)
787d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
788d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_host *host;
789d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	unsigned long flags;
790d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	int present;
791d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
792d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host = mmc_priv(mmc);
793d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
794d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_lock_irqsave(&host->lock, flags);
795d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
796d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	present = readl(host->ioaddr + SDHCI_PRESENT_STATE);
797d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
798d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_unlock_irqrestore(&host->lock, flags);
799d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
800d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return !(present & SDHCI_WRITE_PROTECT);
801d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
802d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
803ab7aefd0b38297e6d2d71f43e8f81f9f4a36cdaeDavid Brownellstatic const struct mmc_host_ops sdhci_ops = {
804d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	.request	= sdhci_request,
805d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	.set_ios	= sdhci_set_ios,
806d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	.get_ro		= sdhci_get_ro,
807d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman};
808d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
809d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman/*****************************************************************************\
810d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
811d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman * Tasklets                                                                  *
812d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
813d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman\*****************************************************************************/
814d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
815d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_tasklet_card(unsigned long param)
816d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
817d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_host *host;
818d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	unsigned long flags;
819d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
820d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host = (struct sdhci_host*)param;
821d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
822d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_lock_irqsave(&host->lock, flags);
823d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
824d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!(readl(host->ioaddr + SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT)) {
825d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (host->mrq) {
826d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			printk(KERN_ERR "%s: Card removed during transfer!\n",
827d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				mmc_hostname(host->mmc));
828d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			printk(KERN_ERR "%s: Resetting controller.\n",
829d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				mmc_hostname(host->mmc));
830d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
831d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			sdhci_reset(host, SDHCI_RESET_CMD);
832d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			sdhci_reset(host, SDHCI_RESET_DATA);
833d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
834d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			host->mrq->cmd->error = MMC_ERR_FAILED;
835d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			tasklet_schedule(&host->finish_tasklet);
836d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
837d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
838d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
839d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_unlock_irqrestore(&host->lock, flags);
840d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
841d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc_detect_change(host->mmc, msecs_to_jiffies(500));
842d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
843d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
844d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_tasklet_finish(unsigned long param)
845d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
846d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_host *host;
847d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	unsigned long flags;
848d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct mmc_request *mrq;
849d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
850d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host = (struct sdhci_host*)param;
851d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
852d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_lock_irqsave(&host->lock, flags);
853d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
854d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	del_timer(&host->timer);
855d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
856d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mrq = host->mrq;
857d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
858d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
859d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * The controller needs a reset of internal state machines
860d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * upon error conditions.
861d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
862d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if ((mrq->cmd->error != MMC_ERR_NONE) ||
863d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		(mrq->data && ((mrq->data->error != MMC_ERR_NONE) ||
864d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		(mrq->data->stop && (mrq->data->stop->error != MMC_ERR_NONE))))) {
865645289dca5021224279e67b4655796cafdfdad00Pierre Ossman
866645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		/* Some controllers need this kick or reset won't work here */
867645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		if (host->chip->quirks & SDHCI_QUIRK_CLOCK_BEFORE_RESET) {
868645289dca5021224279e67b4655796cafdfdad00Pierre Ossman			unsigned int clock;
869645289dca5021224279e67b4655796cafdfdad00Pierre Ossman
870645289dca5021224279e67b4655796cafdfdad00Pierre Ossman			/* This is to force an update */
871645289dca5021224279e67b4655796cafdfdad00Pierre Ossman			clock = host->clock;
872645289dca5021224279e67b4655796cafdfdad00Pierre Ossman			host->clock = 0;
873645289dca5021224279e67b4655796cafdfdad00Pierre Ossman			sdhci_set_clock(host, clock);
874645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		}
875645289dca5021224279e67b4655796cafdfdad00Pierre Ossman
876645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		/* Spec says we should do both at the same time, but Ricoh
877645289dca5021224279e67b4655796cafdfdad00Pierre Ossman		   controllers do not like that. */
878d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_reset(host, SDHCI_RESET_CMD);
879d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_reset(host, SDHCI_RESET_DATA);
880d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
881d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
882d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->mrq = NULL;
883d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->cmd = NULL;
884d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->data = NULL;
885d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
886d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	sdhci_deactivate_led(host);
887d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
8885f25a66f6bbac563c94af94f03491b3ae43c40afPierre Ossman	mmiowb();
889d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_unlock_irqrestore(&host->lock, flags);
890d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
891d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc_request_done(host->mmc, mrq);
892d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
893d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
894d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_timeout_timer(unsigned long data)
895d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
896d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_host *host;
897d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	unsigned long flags;
898d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
899d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host = (struct sdhci_host*)data;
900d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
901d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_lock_irqsave(&host->lock, flags);
902d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
903d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (host->mrq) {
904acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman		printk(KERN_ERR "%s: Timeout waiting for hardware "
905acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman			"interrupt.\n", mmc_hostname(host->mmc));
906d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_dumpregs(host);
907d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
908d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (host->data) {
909d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			host->data->error = MMC_ERR_TIMEOUT;
910d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			sdhci_finish_data(host);
911d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		} else {
912d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			if (host->cmd)
913d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				host->cmd->error = MMC_ERR_TIMEOUT;
914d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			else
915d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				host->mrq->cmd->error = MMC_ERR_TIMEOUT;
916d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
917d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			tasklet_schedule(&host->finish_tasklet);
918d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
919d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
920d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
9215f25a66f6bbac563c94af94f03491b3ae43c40afPierre Ossman	mmiowb();
922d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_unlock_irqrestore(&host->lock, flags);
923d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
924d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
925d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman/*****************************************************************************\
926d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
927d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman * Interrupt handling                                                        *
928d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
929d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman\*****************************************************************************/
930d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
931d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask)
932d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
933d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	BUG_ON(intmask == 0);
934d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
935d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!host->cmd) {
936d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		printk(KERN_ERR "%s: Got command interrupt even though no "
937d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			"command operation was in progress.\n",
938d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			mmc_hostname(host->mmc));
939d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_dumpregs(host);
940d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return;
941d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
942d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
94343b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman	if (intmask & SDHCI_INT_TIMEOUT)
94443b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman		host->cmd->error = MMC_ERR_TIMEOUT;
94543b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman	else if (intmask & SDHCI_INT_CRC)
94643b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman		host->cmd->error = MMC_ERR_BADCRC;
94743b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman	else if (intmask & (SDHCI_INT_END_BIT | SDHCI_INT_INDEX))
94843b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman		host->cmd->error = MMC_ERR_FAILED;
94943b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman
95043b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman	if (host->cmd->error != MMC_ERR_NONE)
951d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		tasklet_schedule(&host->finish_tasklet);
95243b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman	else if (intmask & SDHCI_INT_RESPONSE)
95343b58b36b7e6554b8a96be6b9f63542c583c06e5Pierre Ossman		sdhci_finish_command(host);
954d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
955d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
956d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
957d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
958d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	BUG_ON(intmask == 0);
959d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
960d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!host->data) {
961d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		/*
962d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		 * A data end interrupt is sent together with the response
963d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		 * for the stop command.
964d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		 */
965d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (intmask & SDHCI_INT_DATA_END)
966d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			return;
967d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
968d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		printk(KERN_ERR "%s: Got data interrupt even though no "
969d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			"data operation was in progress.\n",
970d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			mmc_hostname(host->mmc));
971d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_dumpregs(host);
972d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
973d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return;
974d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
975d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
976d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (intmask & SDHCI_INT_DATA_TIMEOUT)
977d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->data->error = MMC_ERR_TIMEOUT;
978d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else if (intmask & SDHCI_INT_DATA_CRC)
979d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->data->error = MMC_ERR_BADCRC;
980d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else if (intmask & SDHCI_INT_DATA_END_BIT)
981d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->data->error = MMC_ERR_FAILED;
982d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
983d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (host->data->error != MMC_ERR_NONE)
984d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_finish_data(host);
985d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else {
986a406f5a3b68ee1db2306a2ba1c9b00dbd3505d05Pierre Ossman		if (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL))
987d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			sdhci_transfer_pio(host);
988d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
9896ba736a10e4ae63b38ccfee9f22b3263a6e5d050Pierre Ossman		/*
9906ba736a10e4ae63b38ccfee9f22b3263a6e5d050Pierre Ossman		 * We currently don't do anything fancy with DMA
9916ba736a10e4ae63b38ccfee9f22b3263a6e5d050Pierre Ossman		 * boundaries, but as we can't disable the feature
9926ba736a10e4ae63b38ccfee9f22b3263a6e5d050Pierre Ossman		 * we need to at least restart the transfer.
9936ba736a10e4ae63b38ccfee9f22b3263a6e5d050Pierre Ossman		 */
9946ba736a10e4ae63b38ccfee9f22b3263a6e5d050Pierre Ossman		if (intmask & SDHCI_INT_DMA_END)
9956ba736a10e4ae63b38ccfee9f22b3263a6e5d050Pierre Ossman			writel(readl(host->ioaddr + SDHCI_DMA_ADDRESS),
9966ba736a10e4ae63b38ccfee9f22b3263a6e5d050Pierre Ossman				host->ioaddr + SDHCI_DMA_ADDRESS);
9976ba736a10e4ae63b38ccfee9f22b3263a6e5d050Pierre Ossman
998e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman		if (intmask & SDHCI_INT_DATA_END) {
999e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman			if (host->cmd) {
1000e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman				/*
1001e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman				 * Data managed to finish before the
1002e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman				 * command completed. Make sure we do
1003e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman				 * things in the proper order.
1004e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman				 */
1005e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman				host->data_early = 1;
1006e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman			} else {
1007e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman				sdhci_finish_data(host);
1008e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman			}
1009e538fbe83e374a3521128c1f4642aca037661c9dPierre Ossman		}
1010d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1011d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1012d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
10137d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t sdhci_irq(int irq, void *dev_id)
1014d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
1015d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	irqreturn_t result;
1016d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_host* host = dev_id;
1017d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	u32 intmask;
1018d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1019d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_lock(&host->lock);
1020d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1021d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	intmask = readl(host->ioaddr + SDHCI_INT_STATUS);
1022d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
102362df67a523acd7a22d936bf946b1889dbd60ca98Mark Lord	if (!intmask || intmask == 0xffffffff) {
1024d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		result = IRQ_NONE;
1025d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		goto out;
1026d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1027d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1028d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	DBG("*** %s got interrupt: 0x%08x\n", host->slot_descr, intmask);
1029d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
10303192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman	if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
10313192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman		writel(intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE),
10323192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman			host->ioaddr + SDHCI_INT_STATUS);
1033d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		tasklet_schedule(&host->card_tasklet);
10343192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman	}
1035d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
10363192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman	intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE);
1037d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
10383192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman	if (intmask & SDHCI_INT_CMD_MASK) {
1039d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		writel(intmask & SDHCI_INT_CMD_MASK,
1040d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			host->ioaddr + SDHCI_INT_STATUS);
10413192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman		sdhci_cmd_irq(host, intmask & SDHCI_INT_CMD_MASK);
1042d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1043d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1044d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (intmask & SDHCI_INT_DATA_MASK) {
1045d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		writel(intmask & SDHCI_INT_DATA_MASK,
1046d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			host->ioaddr + SDHCI_INT_STATUS);
10473192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman		sdhci_data_irq(host, intmask & SDHCI_INT_DATA_MASK);
1048d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1049d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1050d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	intmask &= ~(SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK);
1051d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1052964f9ce2ff42dc47cf40fbd2f5c81cd60689e384Pierre Ossman	intmask &= ~SDHCI_INT_ERROR;
1053964f9ce2ff42dc47cf40fbd2f5c81cd60689e384Pierre Ossman
1054d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (intmask & SDHCI_INT_BUS_POWER) {
10553192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman		printk(KERN_ERR "%s: Card is consuming too much power!\n",
1056d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			mmc_hostname(host->mmc));
10573192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman		writel(SDHCI_INT_BUS_POWER, host->ioaddr + SDHCI_INT_STATUS);
1058d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1059d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
10609d26a5d3f2b9c4fe4b2ba491683c6989ecd6ae04Rolf Eike Beer	intmask &= ~SDHCI_INT_BUS_POWER;
10613192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman
10623192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman	if (intmask) {
1063acf1da4522add3771f4851c09c7fe6bcf1dd6636Pierre Ossman		printk(KERN_ERR "%s: Unexpected interrupt 0x%08x.\n",
10643192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman			mmc_hostname(host->mmc), intmask);
1065d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_dumpregs(host);
1066d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1067d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		writel(intmask, host->ioaddr + SDHCI_INT_STATUS);
10683192a28f7d34ea8f1d0fef8ca5bc0314b5b5bb19Pierre Ossman	}
1069d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1070d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	result = IRQ_HANDLED;
1071d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
10725f25a66f6bbac563c94af94f03491b3ae43c40afPierre Ossman	mmiowb();
1073d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanout:
1074d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_unlock(&host->lock);
1075d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1076d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return result;
1077d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1078d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1079d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman/*****************************************************************************\
1080d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
1081d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman * Suspend/resume                                                            *
1082d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
1083d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman\*****************************************************************************/
1084d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1085d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#ifdef CONFIG_PM
1086d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1087d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic int sdhci_suspend (struct pci_dev *pdev, pm_message_t state)
1088d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
1089d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_chip *chip;
1090d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	int i, ret;
1091d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1092d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	chip = pci_get_drvdata(pdev);
1093d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!chip)
1094d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return 0;
1095d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1096d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	DBG("Suspending...\n");
1097d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1098d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	for (i = 0;i < chip->num_slots;i++) {
1099d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (!chip->hosts[i])
1100d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			continue;
1101d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		ret = mmc_suspend_host(chip->hosts[i]->mmc, state);
1102d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (ret) {
1103d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			for (i--;i >= 0;i--)
1104d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				mmc_resume_host(chip->hosts[i]->mmc);
1105d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			return ret;
1106d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
1107d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1108d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1109d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_save_state(pdev);
1110d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_enable_wake(pdev, pci_choose_state(pdev, state), 0);
1111a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman
1112a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman	for (i = 0;i < chip->num_slots;i++) {
1113a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman		if (!chip->hosts[i])
1114a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman			continue;
1115a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman		free_irq(chip->hosts[i]->irq, chip->hosts[i]);
1116a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman	}
1117a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman
1118d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_disable_device(pdev);
1119d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_set_power_state(pdev, pci_choose_state(pdev, state));
1120d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1121d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return 0;
1122d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1123d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1124d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic int sdhci_resume (struct pci_dev *pdev)
1125d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
1126d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_chip *chip;
1127d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	int i, ret;
1128d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1129d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	chip = pci_get_drvdata(pdev);
1130d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!chip)
1131d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return 0;
1132d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1133d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	DBG("Resuming...\n");
1134d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1135d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_set_power_state(pdev, PCI_D0);
1136d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_restore_state(pdev);
1137df1c4b7bf7f3b3a48d78c6e5c2fc5b9a1c01b821Pierre Ossman	ret = pci_enable_device(pdev);
1138df1c4b7bf7f3b3a48d78c6e5c2fc5b9a1c01b821Pierre Ossman	if (ret)
1139df1c4b7bf7f3b3a48d78c6e5c2fc5b9a1c01b821Pierre Ossman		return ret;
1140d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1141d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	for (i = 0;i < chip->num_slots;i++) {
1142d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (!chip->hosts[i])
1143d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			continue;
1144d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (chip->hosts[i]->flags & SDHCI_USE_DMA)
1145d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			pci_set_master(pdev);
1146a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman		ret = request_irq(chip->hosts[i]->irq, sdhci_irq,
1147a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman			IRQF_SHARED, chip->hosts[i]->slot_descr,
1148a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman			chip->hosts[i]);
1149a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman		if (ret)
1150a715dfc7b9ef15ed5b398b185bd84cc015ff37f6Pierre Ossman			return ret;
1151d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_init(chip->hosts[i]);
11525f25a66f6bbac563c94af94f03491b3ae43c40afPierre Ossman		mmiowb();
1153d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		ret = mmc_resume_host(chip->hosts[i]->mmc);
1154d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (ret)
1155d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			return ret;
1156d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1157d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1158d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return 0;
1159d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1160d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1161d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#else /* CONFIG_PM */
1162d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1163d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#define sdhci_suspend NULL
1164d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#define sdhci_resume NULL
1165d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1166d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#endif /* CONFIG_PM */
1167d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1168d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman/*****************************************************************************\
1169d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
1170d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman * Device probing/removal                                                    *
1171d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
1172d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman\*****************************************************************************/
1173d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1174d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic int __devinit sdhci_probe_slot(struct pci_dev *pdev, int slot)
1175d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
1176d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	int ret;
11774a9655051fb1efa568e53baf5dfb21e33bad6bf6Pierre Ossman	unsigned int version;
1178d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_chip *chip;
1179d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct mmc_host *mmc;
1180d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_host *host;
1181d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1182d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	u8 first_bar;
1183d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	unsigned int caps;
1184d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1185d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	chip = pci_get_drvdata(pdev);
1186d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	BUG_ON(!chip);
1187d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1188d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	ret = pci_read_config_byte(pdev, PCI_SLOT_INFO, &first_bar);
1189d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (ret)
1190d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return ret;
1191d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1192d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	first_bar &= PCI_SLOT_INFO_FIRST_BAR_MASK;
1193d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1194d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (first_bar > 5) {
1195d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		printk(KERN_ERR DRIVER_NAME ": Invalid first BAR. Aborting.\n");
1196d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return -ENODEV;
1197d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1198d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1199d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!(pci_resource_flags(pdev, first_bar + slot) & IORESOURCE_MEM)) {
1200d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		printk(KERN_ERR DRIVER_NAME ": BAR is not iomem. Aborting.\n");
1201d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return -ENODEV;
1202d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1203d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1204d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (pci_resource_len(pdev, first_bar + slot) != 0x100) {
1205a98087cf81e91999a91ceedb2d2e3a95827c651fPierre Ossman		printk(KERN_ERR DRIVER_NAME ": Invalid iomem size. "
1206a98087cf81e91999a91ceedb2d2e3a95827c651fPierre Ossman			"You may experience problems.\n");
1207d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1208d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
12096743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman	if ((pdev->class & 0x0000FF) == PCI_SDHCI_IFVENDOR) {
12106743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman		printk(KERN_ERR DRIVER_NAME ": Vendor specific interface. Aborting.\n");
12116743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman		return -ENODEV;
12126743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman	}
12136743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman
12146743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman	if ((pdev->class & 0x0000FF) > PCI_SDHCI_IFVENDOR) {
12156743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman		printk(KERN_ERR DRIVER_NAME ": Unknown interface. Aborting.\n");
12166743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman		return -ENODEV;
12176743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman	}
12186743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman
1219d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc = mmc_alloc_host(sizeof(struct sdhci_host), &pdev->dev);
1220d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!mmc)
1221d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return -ENOMEM;
1222d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1223d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host = mmc_priv(mmc);
1224d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->mmc = mmc;
1225d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
12268a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman	host->chip = chip;
12278a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman	chip->hosts[slot] = host;
12288a4da1430f7f2a16df3be9c7b5d55ba4e75b708cPierre Ossman
1229d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->bar = first_bar + slot;
1230d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1231d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->addr = pci_resource_start(pdev, host->bar);
1232d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->irq = pdev->irq;
1233d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1234d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	DBG("slot %d at 0x%08lx, irq %d\n", slot, host->addr, host->irq);
1235d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1236d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	snprintf(host->slot_descr, 20, "sdhci:slot%d", slot);
1237d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1238d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	ret = pci_request_region(pdev, host->bar, host->slot_descr);
1239d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (ret)
1240d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		goto free;
1241d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1242d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->ioaddr = ioremap_nocache(host->addr,
1243d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		pci_resource_len(pdev, host->bar));
1244d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!host->ioaddr) {
1245d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		ret = -ENOMEM;
1246d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		goto release;
1247d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1248d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1249d96649ed5ace812ffc8d86252d7c663326ca47f8Pierre Ossman	sdhci_reset(host, SDHCI_RESET_ALL);
1250d96649ed5ace812ffc8d86252d7c663326ca47f8Pierre Ossman
12514a9655051fb1efa568e53baf5dfb21e33bad6bf6Pierre Ossman	version = readw(host->ioaddr + SDHCI_HOST_VERSION);
12524a9655051fb1efa568e53baf5dfb21e33bad6bf6Pierre Ossman	version = (version & SDHCI_SPEC_VER_MASK) >> SDHCI_SPEC_VER_SHIFT;
12534a9655051fb1efa568e53baf5dfb21e33bad6bf6Pierre Ossman	if (version != 0) {
12544a9655051fb1efa568e53baf5dfb21e33bad6bf6Pierre Ossman		printk(KERN_ERR "%s: Unknown controller version (%d). "
12558b1b21853bab15fe5b60b8222786fe036c4dc365Pierre Ossman			"You may experience problems.\n", host->slot_descr,
12564a9655051fb1efa568e53baf5dfb21e33bad6bf6Pierre Ossman			version);
12574a9655051fb1efa568e53baf5dfb21e33bad6bf6Pierre Ossman	}
12584a9655051fb1efa568e53baf5dfb21e33bad6bf6Pierre Ossman
1259d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	caps = readl(host->ioaddr + SDHCI_CAPABILITIES);
1260d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
12616743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman	if (debug_nodma)
12626743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman		DBG("DMA forced off\n");
12636743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman	else if (debug_forcedma) {
12646743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman		DBG("DMA forced on\n");
12656743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman		host->flags |= SDHCI_USE_DMA;
126698608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman	} else if (chip->quirks & SDHCI_QUIRK_FORCE_DMA)
126798608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman		host->flags |= SDHCI_USE_DMA;
126898608076a21914ab12f1c858a0cdf55366260f12Pierre Ossman	else if ((pdev->class & 0x0000FF) != PCI_SDHCI_IFDMA)
12696743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman		DBG("Controller doesn't have DMA interface\n");
12706743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman	else if (!(caps & SDHCI_CAN_DO_DMA))
12716743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman		DBG("Controller doesn't have DMA capability\n");
12726743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman	else
1273d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->flags |= SDHCI_USE_DMA;
1274d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1275d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (host->flags & SDHCI_USE_DMA) {
1276d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (pci_set_dma_mask(pdev, DMA_32BIT_MASK)) {
1277d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			printk(KERN_WARNING "%s: No suitable DMA available. "
1278d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				"Falling back to PIO.\n", host->slot_descr);
1279d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			host->flags &= ~SDHCI_USE_DMA;
1280d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
1281d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1282d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1283d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (host->flags & SDHCI_USE_DMA)
1284d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		pci_set_master(pdev);
1285d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else /* XXX: Hack to get MMC layer to avoid highmem */
1286d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		pdev->dma_mask = 0;
1287d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
12888ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossman	host->max_clk =
12898ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossman		(caps & SDHCI_CLOCK_BASE_MASK) >> SDHCI_CLOCK_BASE_SHIFT;
12908ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossman	if (host->max_clk == 0) {
12918ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossman		printk(KERN_ERR "%s: Hardware doesn't specify base clock "
12928ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossman			"frequency.\n", host->slot_descr);
12938ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossman		ret = -ENODEV;
12948ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossman		goto unmap;
12958ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossman	}
1296d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host->max_clk *= 1000000;
1297d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
12981c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	host->timeout_clk =
12991c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		(caps & SDHCI_TIMEOUT_CLK_MASK) >> SDHCI_TIMEOUT_CLK_SHIFT;
13001c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	if (host->timeout_clk == 0) {
13011c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		printk(KERN_ERR "%s: Hardware doesn't specify timeout clock "
13021c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman			"frequency.\n", host->slot_descr);
13031c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		ret = -ENODEV;
13041c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		goto unmap;
13051c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	}
13061c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman	if (caps & SDHCI_TIMEOUT_CLK_UNIT)
13071c8cde92fa5c57daa9ff58d970ca6374f8d484a2Pierre Ossman		host->timeout_clk *= 1000;
1308d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1309d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
1310d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * Set host parameters.
1311d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
1312d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc->ops = &sdhci_ops;
1313d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc->f_min = host->max_clk / 256;
1314d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc->f_max = host->max_clk;
131542431acbac43eb47c774c29d370f5c59136805bfRussell King	mmc->caps = MMC_CAP_4_BIT_DATA | MMC_CAP_MULTIWRITE | MMC_CAP_BYTEBLOCK;
1316d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1317cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman	if (caps & SDHCI_CAN_DO_HISPD)
1318cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman		mmc->caps |= MMC_CAP_SD_HIGHSPEED;
1319cd9277c011a99769fa371521b460ed57f6d280b1Pierre Ossman
1320146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	mmc->ocr_avail = 0;
1321146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	if (caps & SDHCI_CAN_VDD_330)
1322146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		mmc->ocr_avail |= MMC_VDD_32_33|MMC_VDD_33_34;
1323c70840e819acdbab96b8cdf71d27cb68c6567efaPierre Ossman	if (caps & SDHCI_CAN_VDD_300)
1324146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		mmc->ocr_avail |= MMC_VDD_29_30|MMC_VDD_30_31;
1325c70840e819acdbab96b8cdf71d27cb68c6567efaPierre Ossman	if (caps & SDHCI_CAN_VDD_180)
132655556da01284af8c2174b786b3eca8e11301b656Philip Langdale		mmc->ocr_avail |= MMC_VDD_165_195;
1327146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman
1328146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	if (mmc->ocr_avail == 0) {
1329146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		printk(KERN_ERR "%s: Hardware doesn't report any "
1330146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman			"support voltages.\n", host->slot_descr);
1331146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		ret = -ENODEV;
1332146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman		goto unmap;
1333146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman	}
1334146ad66eac836c0b976c98f428d73e1f6a75270dPierre Ossman
1335d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	spin_lock_init(&host->lock);
1336d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1337d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
1338d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * Maximum number of segments. Hardware cannot do scatter lists.
1339d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
1340d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (host->flags & SDHCI_USE_DMA)
1341d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		mmc->max_hw_segs = 1;
1342d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	else
1343d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		mmc->max_hw_segs = 16;
1344d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc->max_phys_segs = 16;
1345d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1346d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
1347bab7696184bbf0ea48d56902bd1f9ac983079ad2Pierre Ossman	 * Maximum number of sectors in one transfer. Limited by DMA boundary
134855db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman	 * size (512KiB).
1349d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
135055db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman	mmc->max_req_size = 524288;
1351d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1352d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
1353d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * Maximum segment size. Could be one segment with the maximum number
135455db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman	 * of bytes.
1355d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
135655db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman	mmc->max_seg_size = mmc->max_req_size;
1357d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1358d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	/*
1359fe4a3c7a20f14d86022a8132adbf6ddb98e7197cPierre Ossman	 * Maximum block size. This varies from controller to controller and
1360fe4a3c7a20f14d86022a8132adbf6ddb98e7197cPierre Ossman	 * is specified in the capabilities register.
1361fe4a3c7a20f14d86022a8132adbf6ddb98e7197cPierre Ossman	 */
1362fe4a3c7a20f14d86022a8132adbf6ddb98e7197cPierre Ossman	mmc->max_blk_size = (caps & SDHCI_MAX_BLOCK_MASK) >> SDHCI_MAX_BLOCK_SHIFT;
1363fe4a3c7a20f14d86022a8132adbf6ddb98e7197cPierre Ossman	if (mmc->max_blk_size >= 3) {
136403f8590d90844f04d20488a80e75eaf4c4e0b35cDavid Vrabel		printk(KERN_WARNING "%s: Invalid maximum block size, assuming 512\n",
1365fe4a3c7a20f14d86022a8132adbf6ddb98e7197cPierre Ossman			host->slot_descr);
136603f8590d90844f04d20488a80e75eaf4c4e0b35cDavid Vrabel		mmc->max_blk_size = 512;
136703f8590d90844f04d20488a80e75eaf4c4e0b35cDavid Vrabel	} else
136803f8590d90844f04d20488a80e75eaf4c4e0b35cDavid Vrabel		mmc->max_blk_size = 512 << mmc->max_blk_size;
1369fe4a3c7a20f14d86022a8132adbf6ddb98e7197cPierre Ossman
1370fe4a3c7a20f14d86022a8132adbf6ddb98e7197cPierre Ossman	/*
137155db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman	 * Maximum block count.
137255db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman	 */
137355db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman	mmc->max_blk_count = 65535;
137455db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman
137555db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman	/*
1376d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 * Init tasklets.
1377d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	 */
1378d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	tasklet_init(&host->card_tasklet,
1379d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_tasklet_card, (unsigned long)host);
1380d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	tasklet_init(&host->finish_tasklet,
1381d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sdhci_tasklet_finish, (unsigned long)host);
1382d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1383e4cad1b5a4851c90c1bcf460062074a2fa10815bAl Viro	setup_timer(&host->timer, sdhci_timeout_timer, (unsigned long)host);
1384d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1385dace145374b8e39aeb920304c358ab5e220341abThomas Gleixner	ret = request_irq(host->irq, sdhci_irq, IRQF_SHARED,
1386d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->slot_descr, host);
1387d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (ret)
13888ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossman		goto untasklet;
1389d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1390d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	sdhci_init(host);
1391d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1392d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#ifdef CONFIG_MMC_DEBUG
1393d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	sdhci_dumpregs(host);
1394d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman#endif
1395d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
13965f25a66f6bbac563c94af94f03491b3ae43c40afPierre Ossman	mmiowb();
13975f25a66f6bbac563c94af94f03491b3ae43c40afPierre Ossman
1398d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc_add_host(mmc);
1399d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1400d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_INFO "%s: SDHCI at 0x%08lx irq %d %s\n", mmc_hostname(mmc),
1401d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		host->addr, host->irq,
1402d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		(host->flags & SDHCI_USE_DMA)?"DMA":"PIO");
1403d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1404d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return 0;
1405d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
14068ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossmanuntasklet:
1407d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	tasklet_kill(&host->card_tasklet);
1408d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	tasklet_kill(&host->finish_tasklet);
14098ef1a14379e105c1419d21e96ffac53202bc0501Pierre Ossmanunmap:
1410d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	iounmap(host->ioaddr);
1411d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanrelease:
1412d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_release_region(pdev, host->bar);
1413d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanfree:
1414d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc_free_host(mmc);
1415d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1416d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return ret;
1417d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1418d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1419d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void sdhci_remove_slot(struct pci_dev *pdev, int slot)
1420d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
1421d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_chip *chip;
1422d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct mmc_host *mmc;
1423d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_host *host;
1424d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1425d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	chip = pci_get_drvdata(pdev);
1426d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	host = chip->hosts[slot];
1427d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc = host->mmc;
1428d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1429d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	chip->hosts[slot] = NULL;
1430d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1431d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc_remove_host(mmc);
1432d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1433d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	sdhci_reset(host, SDHCI_RESET_ALL);
1434d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1435d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	free_irq(host->irq, host);
1436d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1437d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	del_timer_sync(&host->timer);
1438d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1439d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	tasklet_kill(&host->card_tasklet);
1440d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	tasklet_kill(&host->finish_tasklet);
1441d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1442d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	iounmap(host->ioaddr);
1443d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1444d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_release_region(pdev, host->bar);
1445d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1446d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	mmc_free_host(mmc);
1447d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1448d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1449d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic int __devinit sdhci_probe(struct pci_dev *pdev,
1450d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	const struct pci_device_id *ent)
1451d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
1452d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	int ret, i;
145351f82bc07a9673d790c2a17de8e3fa8046543f04Pierre Ossman	u8 slots, rev;
1454d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_chip *chip;
1455d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1456d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	BUG_ON(pdev == NULL);
1457d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	BUG_ON(ent == NULL);
1458d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
145951f82bc07a9673d790c2a17de8e3fa8046543f04Pierre Ossman	pci_read_config_byte(pdev, PCI_CLASS_REVISION, &rev);
146051f82bc07a9673d790c2a17de8e3fa8046543f04Pierre Ossman
146151f82bc07a9673d790c2a17de8e3fa8046543f04Pierre Ossman	printk(KERN_INFO DRIVER_NAME
146251f82bc07a9673d790c2a17de8e3fa8046543f04Pierre Ossman		": SDHCI controller found at %s [%04x:%04x] (rev %x)\n",
146351f82bc07a9673d790c2a17de8e3fa8046543f04Pierre Ossman		pci_name(pdev), (int)pdev->vendor, (int)pdev->device,
146451f82bc07a9673d790c2a17de8e3fa8046543f04Pierre Ossman		(int)rev);
1465d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1466d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	ret = pci_read_config_byte(pdev, PCI_SLOT_INFO, &slots);
1467d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (ret)
1468d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return ret;
1469d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1470d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	slots = PCI_SLOT_INFO_SLOTS(slots) + 1;
1471d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	DBG("found %d slot(s)\n", slots);
1472d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (slots == 0)
1473d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return -ENODEV;
1474d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1475d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	ret = pci_enable_device(pdev);
1476d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (ret)
1477d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		return ret;
1478d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1479d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	chip = kzalloc(sizeof(struct sdhci_chip) +
1480d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		sizeof(struct sdhci_host*) * slots, GFP_KERNEL);
1481d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (!chip) {
1482d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		ret = -ENOMEM;
1483d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		goto err;
1484d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1485d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1486d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	chip->pdev = pdev;
1487df673b227ce08a7706b30fd2bf6512393d9c3c29Pierre Ossman	chip->quirks = ent->driver_data;
1488df673b227ce08a7706b30fd2bf6512393d9c3c29Pierre Ossman
1489df673b227ce08a7706b30fd2bf6512393d9c3c29Pierre Ossman	if (debug_quirks)
1490df673b227ce08a7706b30fd2bf6512393d9c3c29Pierre Ossman		chip->quirks = debug_quirks;
1491d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1492d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	chip->num_slots = slots;
1493d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_set_drvdata(pdev, chip);
1494d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1495d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	for (i = 0;i < slots;i++) {
1496d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		ret = sdhci_probe_slot(pdev, i);
1497d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		if (ret) {
1498d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			for (i--;i >= 0;i--)
1499d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman				sdhci_remove_slot(pdev, i);
1500d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			goto free;
1501d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		}
1502d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1503d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1504d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return 0;
1505d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1506d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanfree:
1507d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_set_drvdata(pdev, NULL);
1508d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	kfree(chip);
1509d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1510d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanerr:
1511d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_disable_device(pdev);
1512d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return ret;
1513d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1514d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1515d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void __devexit sdhci_remove(struct pci_dev *pdev)
1516d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
1517d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	int i;
1518d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	struct sdhci_chip *chip;
1519d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1520d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	chip = pci_get_drvdata(pdev);
1521d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1522d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	if (chip) {
1523d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		for (i = 0;i < chip->num_slots;i++)
1524d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman			sdhci_remove_slot(pdev, i);
1525d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1526d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		pci_set_drvdata(pdev, NULL);
1527d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1528d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman		kfree(chip);
1529d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	}
1530d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1531d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_disable_device(pdev);
1532d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1533d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1534d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic struct pci_driver sdhci_driver = {
1535d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	.name = 	DRIVER_NAME,
1536d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	.id_table =	pci_ids,
1537d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	.probe = 	sdhci_probe,
1538d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	.remove =	__devexit_p(sdhci_remove),
1539d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	.suspend =	sdhci_suspend,
1540d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	.resume	=	sdhci_resume,
1541d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman};
1542d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1543d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman/*****************************************************************************\
1544d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
1545d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman * Driver init/exit                                                          *
1546d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman *                                                                           *
1547d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman\*****************************************************************************/
1548d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1549d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic int __init sdhci_drv_init(void)
1550d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
1551d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_INFO DRIVER_NAME
155252fbf9c976b36654e08e94c3107ddbaac7e2da33Pierre Ossman		": Secure Digital Host Controller Interface driver\n");
1553d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	printk(KERN_INFO DRIVER_NAME ": Copyright(c) Pierre Ossman\n");
1554d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1555d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	return pci_register_driver(&sdhci_driver);
1556d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1557d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1558d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanstatic void __exit sdhci_drv_exit(void)
1559d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman{
1560d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	DBG("Exiting\n");
1561d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1562d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman	pci_unregister_driver(&sdhci_driver);
1563d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman}
1564d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
1565d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanmodule_init(sdhci_drv_init);
1566d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossmanmodule_exit(sdhci_drv_exit);
1567d129bceb1d44ed3c23b99164849193703372bab4Pierre Ossman
15686743527441430586aa82a0dee1b2700a2a974ebcPierre Ossmanmodule_param(debug_nodma, uint, 0444);
15696743527441430586aa82a0dee1b2700a2a974ebcPierre Ossmanmodule_param(debug_forcedma, uint, 0444);
1570df673b227ce08a7706b30fd2bf6512393d9c3c29Pierre Ossmanmodule_param(debug_quirks, uint, 0444);
15716743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman
1572d129bceb1d44ed3c23b99164849193703372bab4Pierre OssmanMODULE_AUTHOR("Pierre Ossman <drzeus@drzeus.cx>");
1573d129bceb1d44ed3c23b99164849193703372bab4Pierre OssmanMODULE_DESCRIPTION("Secure Digital Host Controller Interface driver");
1574d129bceb1d44ed3c23b99164849193703372bab4Pierre OssmanMODULE_LICENSE("GPL");
15756743527441430586aa82a0dee1b2700a2a974ebcPierre Ossman
15766743527441430586aa82a0dee1b2700a2a974ebcPierre OssmanMODULE_PARM_DESC(debug_nodma, "Forcefully disable DMA transfers. (default 0)");
15776743527441430586aa82a0dee1b2700a2a974ebcPierre OssmanMODULE_PARM_DESC(debug_forcedma, "Forcefully enable DMA transfers. (default 0)");
1578df673b227ce08a7706b30fd2bf6512393d9c3c29Pierre OssmanMODULE_PARM_DESC(debug_quirks, "Force certain quirks.");
1579