xref: /OK3568_Linux_fs/kernel/drivers/mmc/host/toshsd.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *  Toshiba PCI Secure Digital Host Controller Interface driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  *  Copyright (C) 2014 Ondrej Zary
6*4882a593Smuzhiyun  *  Copyright (C) 2007 Richard Betts, All Rights Reserved.
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  *	Based on asic3_mmc.c, copyright (c) 2005 SDG Systems, LLC and,
9*4882a593Smuzhiyun  *	sdhci.c, copyright (C) 2005-2006 Pierre Ossman
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <linux/delay.h>
13*4882a593Smuzhiyun #include <linux/device.h>
14*4882a593Smuzhiyun #include <linux/module.h>
15*4882a593Smuzhiyun #include <linux/pci.h>
16*4882a593Smuzhiyun #include <linux/scatterlist.h>
17*4882a593Smuzhiyun #include <linux/interrupt.h>
18*4882a593Smuzhiyun #include <linux/io.h>
19*4882a593Smuzhiyun #include <linux/pm.h>
20*4882a593Smuzhiyun #include <linux/pm_runtime.h>
21*4882a593Smuzhiyun #include <linux/mmc/host.h>
22*4882a593Smuzhiyun #include <linux/mmc/mmc.h>
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun #include "toshsd.h"
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #define DRIVER_NAME "toshsd"
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun static const struct pci_device_id pci_ids[] = {
29*4882a593Smuzhiyun 	{ PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA, 0x0805) },
30*4882a593Smuzhiyun 	{ /* end: all zeroes */ },
31*4882a593Smuzhiyun };
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun MODULE_DEVICE_TABLE(pci, pci_ids);
34*4882a593Smuzhiyun 
toshsd_init(struct toshsd_host * host)35*4882a593Smuzhiyun static void toshsd_init(struct toshsd_host *host)
36*4882a593Smuzhiyun {
37*4882a593Smuzhiyun 	/* enable clock */
38*4882a593Smuzhiyun 	pci_write_config_byte(host->pdev, SD_PCICFG_CLKSTOP,
39*4882a593Smuzhiyun 					SD_PCICFG_CLKSTOP_ENABLE_ALL);
40*4882a593Smuzhiyun 	pci_write_config_byte(host->pdev, SD_PCICFG_CARDDETECT, 2);
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun 	/* reset */
43*4882a593Smuzhiyun 	iowrite16(0, host->ioaddr + SD_SOFTWARERESET); /* assert */
44*4882a593Smuzhiyun 	mdelay(2);
45*4882a593Smuzhiyun 	iowrite16(1, host->ioaddr + SD_SOFTWARERESET); /* deassert */
46*4882a593Smuzhiyun 	mdelay(2);
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun 	/* Clear card registers */
49*4882a593Smuzhiyun 	iowrite16(0, host->ioaddr + SD_CARDCLOCKCTRL);
50*4882a593Smuzhiyun 	iowrite32(0, host->ioaddr + SD_CARDSTATUS);
51*4882a593Smuzhiyun 	iowrite32(0, host->ioaddr + SD_ERRORSTATUS0);
52*4882a593Smuzhiyun 	iowrite16(0, host->ioaddr + SD_STOPINTERNAL);
53*4882a593Smuzhiyun 
54*4882a593Smuzhiyun 	/* SDIO clock? */
55*4882a593Smuzhiyun 	iowrite16(0x100, host->ioaddr + SDIO_BASE + SDIO_CLOCKNWAITCTRL);
56*4882a593Smuzhiyun 
57*4882a593Smuzhiyun 	/* enable LED */
58*4882a593Smuzhiyun 	pci_write_config_byte(host->pdev, SD_PCICFG_SDLED_ENABLE1,
59*4882a593Smuzhiyun 					SD_PCICFG_LED_ENABLE1_START);
60*4882a593Smuzhiyun 	pci_write_config_byte(host->pdev, SD_PCICFG_SDLED_ENABLE2,
61*4882a593Smuzhiyun 					SD_PCICFG_LED_ENABLE2_START);
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun 	/* set interrupt masks */
64*4882a593Smuzhiyun 	iowrite32(~(u32)(SD_CARD_RESP_END | SD_CARD_RW_END
65*4882a593Smuzhiyun 			| SD_CARD_CARD_REMOVED_0 | SD_CARD_CARD_INSERTED_0
66*4882a593Smuzhiyun 			| SD_BUF_READ_ENABLE | SD_BUF_WRITE_ENABLE
67*4882a593Smuzhiyun 			| SD_BUF_CMD_TIMEOUT),
68*4882a593Smuzhiyun 			host->ioaddr + SD_INTMASKCARD);
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun 	iowrite16(0x1000, host->ioaddr + SD_TRANSACTIONCTRL);
71*4882a593Smuzhiyun }
72*4882a593Smuzhiyun 
73*4882a593Smuzhiyun /* Set MMC clock / power.
74*4882a593Smuzhiyun  * Note: This controller uses a simple divider scheme therefore it cannot run
75*4882a593Smuzhiyun  * SD/MMC cards at full speed (24/20MHz). HCLK (=33MHz PCI clock?) is too high
76*4882a593Smuzhiyun  * and the next slowest is 16MHz (div=2).
77*4882a593Smuzhiyun  */
__toshsd_set_ios(struct mmc_host * mmc,struct mmc_ios * ios)78*4882a593Smuzhiyun static void __toshsd_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
79*4882a593Smuzhiyun {
80*4882a593Smuzhiyun 	struct toshsd_host *host = mmc_priv(mmc);
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 	if (ios->clock) {
83*4882a593Smuzhiyun 		u16 clk;
84*4882a593Smuzhiyun 		int div = 1;
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun 		while (ios->clock < HCLK / div)
87*4882a593Smuzhiyun 			div *= 2;
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun 		clk = div >> 2;
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun 		if (div == 1) { /* disable the divider */
92*4882a593Smuzhiyun 			pci_write_config_byte(host->pdev, SD_PCICFG_CLKMODE,
93*4882a593Smuzhiyun 					      SD_PCICFG_CLKMODE_DIV_DISABLE);
94*4882a593Smuzhiyun 			clk |= SD_CARDCLK_DIV_DISABLE;
95*4882a593Smuzhiyun 		} else
96*4882a593Smuzhiyun 			pci_write_config_byte(host->pdev, SD_PCICFG_CLKMODE, 0);
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun 		clk |= SD_CARDCLK_ENABLE_CLOCK;
99*4882a593Smuzhiyun 		iowrite16(clk, host->ioaddr + SD_CARDCLOCKCTRL);
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun 		mdelay(10);
102*4882a593Smuzhiyun 	} else
103*4882a593Smuzhiyun 		iowrite16(0, host->ioaddr + SD_CARDCLOCKCTRL);
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 	switch (ios->power_mode) {
106*4882a593Smuzhiyun 	case MMC_POWER_OFF:
107*4882a593Smuzhiyun 		pci_write_config_byte(host->pdev, SD_PCICFG_POWER1,
108*4882a593Smuzhiyun 					SD_PCICFG_PWR1_OFF);
109*4882a593Smuzhiyun 		mdelay(1);
110*4882a593Smuzhiyun 		break;
111*4882a593Smuzhiyun 	case MMC_POWER_UP:
112*4882a593Smuzhiyun 		break;
113*4882a593Smuzhiyun 	case MMC_POWER_ON:
114*4882a593Smuzhiyun 		pci_write_config_byte(host->pdev, SD_PCICFG_POWER1,
115*4882a593Smuzhiyun 					SD_PCICFG_PWR1_33V);
116*4882a593Smuzhiyun 		pci_write_config_byte(host->pdev, SD_PCICFG_POWER2,
117*4882a593Smuzhiyun 					SD_PCICFG_PWR2_AUTO);
118*4882a593Smuzhiyun 		mdelay(20);
119*4882a593Smuzhiyun 		break;
120*4882a593Smuzhiyun 	}
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun 	switch (ios->bus_width) {
123*4882a593Smuzhiyun 	case MMC_BUS_WIDTH_1:
124*4882a593Smuzhiyun 		iowrite16(SD_CARDOPT_REQUIRED | SD_CARDOPT_DATA_RESP_TIMEOUT(14)
125*4882a593Smuzhiyun 				| SD_CARDOPT_C2_MODULE_ABSENT
126*4882a593Smuzhiyun 				| SD_CARDOPT_DATA_XFR_WIDTH_1,
127*4882a593Smuzhiyun 				host->ioaddr + SD_CARDOPTIONSETUP);
128*4882a593Smuzhiyun 		break;
129*4882a593Smuzhiyun 	case MMC_BUS_WIDTH_4:
130*4882a593Smuzhiyun 		iowrite16(SD_CARDOPT_REQUIRED | SD_CARDOPT_DATA_RESP_TIMEOUT(14)
131*4882a593Smuzhiyun 				| SD_CARDOPT_C2_MODULE_ABSENT
132*4882a593Smuzhiyun 				| SD_CARDOPT_DATA_XFR_WIDTH_4,
133*4882a593Smuzhiyun 				host->ioaddr + SD_CARDOPTIONSETUP);
134*4882a593Smuzhiyun 		break;
135*4882a593Smuzhiyun 	}
136*4882a593Smuzhiyun }
137*4882a593Smuzhiyun 
toshsd_set_led(struct toshsd_host * host,unsigned char state)138*4882a593Smuzhiyun static void toshsd_set_led(struct toshsd_host *host, unsigned char state)
139*4882a593Smuzhiyun {
140*4882a593Smuzhiyun 	iowrite16(state, host->ioaddr + SDIO_BASE + SDIO_LEDCTRL);
141*4882a593Smuzhiyun }
142*4882a593Smuzhiyun 
toshsd_finish_request(struct toshsd_host * host)143*4882a593Smuzhiyun static void toshsd_finish_request(struct toshsd_host *host)
144*4882a593Smuzhiyun {
145*4882a593Smuzhiyun 	struct mmc_request *mrq = host->mrq;
146*4882a593Smuzhiyun 
147*4882a593Smuzhiyun 	/* Write something to end the command */
148*4882a593Smuzhiyun 	host->mrq = NULL;
149*4882a593Smuzhiyun 	host->cmd = NULL;
150*4882a593Smuzhiyun 	host->data = NULL;
151*4882a593Smuzhiyun 
152*4882a593Smuzhiyun 	toshsd_set_led(host, 0);
153*4882a593Smuzhiyun 	mmc_request_done(host->mmc, mrq);
154*4882a593Smuzhiyun }
155*4882a593Smuzhiyun 
toshsd_thread_irq(int irq,void * dev_id)156*4882a593Smuzhiyun static irqreturn_t toshsd_thread_irq(int irq, void *dev_id)
157*4882a593Smuzhiyun {
158*4882a593Smuzhiyun 	struct toshsd_host *host = dev_id;
159*4882a593Smuzhiyun 	struct mmc_data *data = host->data;
160*4882a593Smuzhiyun 	struct sg_mapping_iter *sg_miter = &host->sg_miter;
161*4882a593Smuzhiyun 	unsigned short *buf;
162*4882a593Smuzhiyun 	int count;
163*4882a593Smuzhiyun 	unsigned long flags;
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 	if (!data) {
166*4882a593Smuzhiyun 		dev_warn(&host->pdev->dev, "Spurious Data IRQ\n");
167*4882a593Smuzhiyun 		if (host->cmd) {
168*4882a593Smuzhiyun 			host->cmd->error = -EIO;
169*4882a593Smuzhiyun 			toshsd_finish_request(host);
170*4882a593Smuzhiyun 		}
171*4882a593Smuzhiyun 		return IRQ_NONE;
172*4882a593Smuzhiyun 	}
173*4882a593Smuzhiyun 	spin_lock_irqsave(&host->lock, flags);
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun 	if (!sg_miter_next(sg_miter))
176*4882a593Smuzhiyun 		goto done;
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 	buf = sg_miter->addr;
179*4882a593Smuzhiyun 
180*4882a593Smuzhiyun 	/* Ensure we dont read more than one block. The chip will interrupt us
181*4882a593Smuzhiyun 	 * When the next block is available.
182*4882a593Smuzhiyun 	 */
183*4882a593Smuzhiyun 	count = sg_miter->length;
184*4882a593Smuzhiyun 	if (count > data->blksz)
185*4882a593Smuzhiyun 		count = data->blksz;
186*4882a593Smuzhiyun 
187*4882a593Smuzhiyun 	dev_dbg(&host->pdev->dev, "count: %08x, flags %08x\n", count,
188*4882a593Smuzhiyun 		data->flags);
189*4882a593Smuzhiyun 
190*4882a593Smuzhiyun 	/* Transfer the data */
191*4882a593Smuzhiyun 	if (data->flags & MMC_DATA_READ)
192*4882a593Smuzhiyun 		ioread32_rep(host->ioaddr + SD_DATAPORT, buf, count >> 2);
193*4882a593Smuzhiyun 	else
194*4882a593Smuzhiyun 		iowrite32_rep(host->ioaddr + SD_DATAPORT, buf, count >> 2);
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun 	sg_miter->consumed = count;
197*4882a593Smuzhiyun 	sg_miter_stop(sg_miter);
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun done:
200*4882a593Smuzhiyun 	spin_unlock_irqrestore(&host->lock, flags);
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	return IRQ_HANDLED;
203*4882a593Smuzhiyun }
204*4882a593Smuzhiyun 
toshsd_cmd_irq(struct toshsd_host * host)205*4882a593Smuzhiyun static void toshsd_cmd_irq(struct toshsd_host *host)
206*4882a593Smuzhiyun {
207*4882a593Smuzhiyun 	struct mmc_command *cmd = host->cmd;
208*4882a593Smuzhiyun 	u8 *buf;
209*4882a593Smuzhiyun 	u16 data;
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	if (!host->cmd) {
212*4882a593Smuzhiyun 		dev_warn(&host->pdev->dev, "Spurious CMD irq\n");
213*4882a593Smuzhiyun 		return;
214*4882a593Smuzhiyun 	}
215*4882a593Smuzhiyun 	buf = (u8 *)cmd->resp;
216*4882a593Smuzhiyun 	host->cmd = NULL;
217*4882a593Smuzhiyun 
218*4882a593Smuzhiyun 	if (cmd->flags & MMC_RSP_PRESENT && cmd->flags & MMC_RSP_136) {
219*4882a593Smuzhiyun 		/* R2 */
220*4882a593Smuzhiyun 		buf[12] = 0xff;
221*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE0);
222*4882a593Smuzhiyun 		buf[13] = data & 0xff;
223*4882a593Smuzhiyun 		buf[14] = data >> 8;
224*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE1);
225*4882a593Smuzhiyun 		buf[15] = data & 0xff;
226*4882a593Smuzhiyun 		buf[8] = data >> 8;
227*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE2);
228*4882a593Smuzhiyun 		buf[9] = data & 0xff;
229*4882a593Smuzhiyun 		buf[10] = data >> 8;
230*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE3);
231*4882a593Smuzhiyun 		buf[11] = data & 0xff;
232*4882a593Smuzhiyun 		buf[4] = data >> 8;
233*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE4);
234*4882a593Smuzhiyun 		buf[5] = data & 0xff;
235*4882a593Smuzhiyun 		buf[6] = data >> 8;
236*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE5);
237*4882a593Smuzhiyun 		buf[7] = data & 0xff;
238*4882a593Smuzhiyun 		buf[0] = data >> 8;
239*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE6);
240*4882a593Smuzhiyun 		buf[1] = data & 0xff;
241*4882a593Smuzhiyun 		buf[2] = data >> 8;
242*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE7);
243*4882a593Smuzhiyun 		buf[3] = data & 0xff;
244*4882a593Smuzhiyun 	} else if (cmd->flags & MMC_RSP_PRESENT) {
245*4882a593Smuzhiyun 		/* R1, R1B, R3, R6, R7 */
246*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE0);
247*4882a593Smuzhiyun 		buf[0] = data & 0xff;
248*4882a593Smuzhiyun 		buf[1] = data >> 8;
249*4882a593Smuzhiyun 		data = ioread16(host->ioaddr + SD_RESPONSE1);
250*4882a593Smuzhiyun 		buf[2] = data & 0xff;
251*4882a593Smuzhiyun 		buf[3] = data >> 8;
252*4882a593Smuzhiyun 	}
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	dev_dbg(&host->pdev->dev, "Command IRQ complete %d %d %x\n",
255*4882a593Smuzhiyun 		cmd->opcode, cmd->error, cmd->flags);
256*4882a593Smuzhiyun 
257*4882a593Smuzhiyun 	/* If there is data to handle we will
258*4882a593Smuzhiyun 	 * finish the request in the mmc_data_end_irq handler.*/
259*4882a593Smuzhiyun 	if (host->data)
260*4882a593Smuzhiyun 		return;
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 	toshsd_finish_request(host);
263*4882a593Smuzhiyun }
264*4882a593Smuzhiyun 
toshsd_data_end_irq(struct toshsd_host * host)265*4882a593Smuzhiyun static void toshsd_data_end_irq(struct toshsd_host *host)
266*4882a593Smuzhiyun {
267*4882a593Smuzhiyun 	struct mmc_data *data = host->data;
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 	host->data = NULL;
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 	if (!data) {
272*4882a593Smuzhiyun 		dev_warn(&host->pdev->dev, "Spurious data end IRQ\n");
273*4882a593Smuzhiyun 		return;
274*4882a593Smuzhiyun 	}
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	if (data->error == 0)
277*4882a593Smuzhiyun 		data->bytes_xfered = data->blocks * data->blksz;
278*4882a593Smuzhiyun 	else
279*4882a593Smuzhiyun 		data->bytes_xfered = 0;
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun 	dev_dbg(&host->pdev->dev, "Completed data request xfr=%d\n",
282*4882a593Smuzhiyun 		data->bytes_xfered);
283*4882a593Smuzhiyun 
284*4882a593Smuzhiyun 	iowrite16(0, host->ioaddr + SD_STOPINTERNAL);
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	toshsd_finish_request(host);
287*4882a593Smuzhiyun }
288*4882a593Smuzhiyun 
toshsd_irq(int irq,void * dev_id)289*4882a593Smuzhiyun static irqreturn_t toshsd_irq(int irq, void *dev_id)
290*4882a593Smuzhiyun {
291*4882a593Smuzhiyun 	struct toshsd_host *host = dev_id;
292*4882a593Smuzhiyun 	u32 int_reg, int_mask, int_status, detail;
293*4882a593Smuzhiyun 	int error = 0, ret = IRQ_HANDLED;
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun 	spin_lock(&host->lock);
296*4882a593Smuzhiyun 	int_status = ioread32(host->ioaddr + SD_CARDSTATUS);
297*4882a593Smuzhiyun 	int_mask = ioread32(host->ioaddr + SD_INTMASKCARD);
298*4882a593Smuzhiyun 	int_reg = int_status & ~int_mask & ~IRQ_DONT_CARE_BITS;
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	dev_dbg(&host->pdev->dev, "IRQ status:%x mask:%x\n",
301*4882a593Smuzhiyun 		int_status, int_mask);
302*4882a593Smuzhiyun 
303*4882a593Smuzhiyun 	/* nothing to do: it's not our IRQ */
304*4882a593Smuzhiyun 	if (!int_reg) {
305*4882a593Smuzhiyun 		ret = IRQ_NONE;
306*4882a593Smuzhiyun 		goto irq_end;
307*4882a593Smuzhiyun 	}
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	if (int_reg & SD_BUF_CMD_TIMEOUT) {
310*4882a593Smuzhiyun 		error = -ETIMEDOUT;
311*4882a593Smuzhiyun 		dev_dbg(&host->pdev->dev, "Timeout\n");
312*4882a593Smuzhiyun 	} else if (int_reg & SD_BUF_CRC_ERR) {
313*4882a593Smuzhiyun 		error = -EILSEQ;
314*4882a593Smuzhiyun 		dev_err(&host->pdev->dev, "BadCRC\n");
315*4882a593Smuzhiyun 	} else if (int_reg & (SD_BUF_ILLEGAL_ACCESS
316*4882a593Smuzhiyun 				| SD_BUF_CMD_INDEX_ERR
317*4882a593Smuzhiyun 				| SD_BUF_STOP_BIT_END_ERR
318*4882a593Smuzhiyun 				| SD_BUF_OVERFLOW
319*4882a593Smuzhiyun 				| SD_BUF_UNDERFLOW
320*4882a593Smuzhiyun 				| SD_BUF_DATA_TIMEOUT)) {
321*4882a593Smuzhiyun 		dev_err(&host->pdev->dev, "Buffer status error: { %s%s%s%s%s%s}\n",
322*4882a593Smuzhiyun 			int_reg & SD_BUF_ILLEGAL_ACCESS ? "ILLEGAL_ACC " : "",
323*4882a593Smuzhiyun 			int_reg & SD_BUF_CMD_INDEX_ERR ? "CMD_INDEX " : "",
324*4882a593Smuzhiyun 			int_reg & SD_BUF_STOP_BIT_END_ERR ? "STOPBIT_END " : "",
325*4882a593Smuzhiyun 			int_reg & SD_BUF_OVERFLOW ? "OVERFLOW " : "",
326*4882a593Smuzhiyun 			int_reg & SD_BUF_UNDERFLOW ? "UNDERFLOW " : "",
327*4882a593Smuzhiyun 			int_reg & SD_BUF_DATA_TIMEOUT ? "DATA_TIMEOUT " : "");
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun 		detail = ioread32(host->ioaddr + SD_ERRORSTATUS0);
330*4882a593Smuzhiyun 		dev_err(&host->pdev->dev, "detail error status { %s%s%s%s%s%s%s%s%s%s%s%s%s}\n",
331*4882a593Smuzhiyun 			detail & SD_ERR0_RESP_CMD_ERR ? "RESP_CMD " : "",
332*4882a593Smuzhiyun 			detail & SD_ERR0_RESP_NON_CMD12_END_BIT_ERR ? "RESP_END_BIT " : "",
333*4882a593Smuzhiyun 			detail & SD_ERR0_RESP_CMD12_END_BIT_ERR ? "RESP_END_BIT " : "",
334*4882a593Smuzhiyun 			detail & SD_ERR0_READ_DATA_END_BIT_ERR ? "READ_DATA_END_BIT " : "",
335*4882a593Smuzhiyun 			detail & SD_ERR0_WRITE_CRC_STATUS_END_BIT_ERR ? "WRITE_CMD_END_BIT " : "",
336*4882a593Smuzhiyun 			detail & SD_ERR0_RESP_NON_CMD12_CRC_ERR ? "RESP_CRC " : "",
337*4882a593Smuzhiyun 			detail & SD_ERR0_RESP_CMD12_CRC_ERR ? "RESP_CRC " : "",
338*4882a593Smuzhiyun 			detail & SD_ERR0_READ_DATA_CRC_ERR ? "READ_DATA_CRC " : "",
339*4882a593Smuzhiyun 			detail & SD_ERR0_WRITE_CMD_CRC_ERR ? "WRITE_CMD_CRC " : "",
340*4882a593Smuzhiyun 			detail & SD_ERR1_NO_CMD_RESP ? "NO_CMD_RESP " : "",
341*4882a593Smuzhiyun 			detail & SD_ERR1_TIMEOUT_READ_DATA ? "READ_DATA_TIMEOUT " : "",
342*4882a593Smuzhiyun 			detail & SD_ERR1_TIMEOUT_CRS_STATUS ? "CRS_STATUS_TIMEOUT " : "",
343*4882a593Smuzhiyun 			detail & SD_ERR1_TIMEOUT_CRC_BUSY ? "CRC_BUSY_TIMEOUT " : "");
344*4882a593Smuzhiyun 		error = -EIO;
345*4882a593Smuzhiyun 	}
346*4882a593Smuzhiyun 
347*4882a593Smuzhiyun 	if (error) {
348*4882a593Smuzhiyun 		if (host->cmd)
349*4882a593Smuzhiyun 			host->cmd->error = error;
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 		if (error == -ETIMEDOUT) {
352*4882a593Smuzhiyun 			iowrite32(int_status &
353*4882a593Smuzhiyun 				  ~(SD_BUF_CMD_TIMEOUT | SD_CARD_RESP_END),
354*4882a593Smuzhiyun 				  host->ioaddr + SD_CARDSTATUS);
355*4882a593Smuzhiyun 		} else {
356*4882a593Smuzhiyun 			toshsd_init(host);
357*4882a593Smuzhiyun 			__toshsd_set_ios(host->mmc, &host->mmc->ios);
358*4882a593Smuzhiyun 			goto irq_end;
359*4882a593Smuzhiyun 		}
360*4882a593Smuzhiyun 	}
361*4882a593Smuzhiyun 
362*4882a593Smuzhiyun 	/* Card insert/remove. The mmc controlling code is stateless. */
363*4882a593Smuzhiyun 	if (int_reg & (SD_CARD_CARD_INSERTED_0 | SD_CARD_CARD_REMOVED_0)) {
364*4882a593Smuzhiyun 		iowrite32(int_status &
365*4882a593Smuzhiyun 			  ~(SD_CARD_CARD_REMOVED_0 | SD_CARD_CARD_INSERTED_0),
366*4882a593Smuzhiyun 			  host->ioaddr + SD_CARDSTATUS);
367*4882a593Smuzhiyun 
368*4882a593Smuzhiyun 		if (int_reg & SD_CARD_CARD_INSERTED_0)
369*4882a593Smuzhiyun 			toshsd_init(host);
370*4882a593Smuzhiyun 
371*4882a593Smuzhiyun 		mmc_detect_change(host->mmc, 1);
372*4882a593Smuzhiyun 	}
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun 	/* Data transfer */
375*4882a593Smuzhiyun 	if (int_reg & (SD_BUF_READ_ENABLE | SD_BUF_WRITE_ENABLE)) {
376*4882a593Smuzhiyun 		iowrite32(int_status &
377*4882a593Smuzhiyun 			  ~(SD_BUF_WRITE_ENABLE | SD_BUF_READ_ENABLE),
378*4882a593Smuzhiyun 			  host->ioaddr + SD_CARDSTATUS);
379*4882a593Smuzhiyun 
380*4882a593Smuzhiyun 		ret = IRQ_WAKE_THREAD;
381*4882a593Smuzhiyun 		goto irq_end;
382*4882a593Smuzhiyun 	}
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 	/* Command completion */
385*4882a593Smuzhiyun 	if (int_reg & SD_CARD_RESP_END) {
386*4882a593Smuzhiyun 		iowrite32(int_status & ~(SD_CARD_RESP_END),
387*4882a593Smuzhiyun 			  host->ioaddr + SD_CARDSTATUS);
388*4882a593Smuzhiyun 		toshsd_cmd_irq(host);
389*4882a593Smuzhiyun 	}
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	/* Data transfer completion */
392*4882a593Smuzhiyun 	if (int_reg & SD_CARD_RW_END) {
393*4882a593Smuzhiyun 		iowrite32(int_status & ~(SD_CARD_RW_END),
394*4882a593Smuzhiyun 			  host->ioaddr + SD_CARDSTATUS);
395*4882a593Smuzhiyun 		toshsd_data_end_irq(host);
396*4882a593Smuzhiyun 	}
397*4882a593Smuzhiyun irq_end:
398*4882a593Smuzhiyun 	spin_unlock(&host->lock);
399*4882a593Smuzhiyun 	return ret;
400*4882a593Smuzhiyun }
401*4882a593Smuzhiyun 
toshsd_start_cmd(struct toshsd_host * host,struct mmc_command * cmd)402*4882a593Smuzhiyun static void toshsd_start_cmd(struct toshsd_host *host, struct mmc_command *cmd)
403*4882a593Smuzhiyun {
404*4882a593Smuzhiyun 	struct mmc_data *data = host->data;
405*4882a593Smuzhiyun 	int c = cmd->opcode;
406*4882a593Smuzhiyun 
407*4882a593Smuzhiyun 	dev_dbg(&host->pdev->dev, "Command opcode: %d\n", cmd->opcode);
408*4882a593Smuzhiyun 
409*4882a593Smuzhiyun 	if (cmd->opcode == MMC_STOP_TRANSMISSION) {
410*4882a593Smuzhiyun 		iowrite16(SD_STOPINT_ISSUE_CMD12,
411*4882a593Smuzhiyun 			  host->ioaddr + SD_STOPINTERNAL);
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 		cmd->resp[0] = cmd->opcode;
414*4882a593Smuzhiyun 		cmd->resp[1] = 0;
415*4882a593Smuzhiyun 		cmd->resp[2] = 0;
416*4882a593Smuzhiyun 		cmd->resp[3] = 0;
417*4882a593Smuzhiyun 
418*4882a593Smuzhiyun 		toshsd_finish_request(host);
419*4882a593Smuzhiyun 		return;
420*4882a593Smuzhiyun 	}
421*4882a593Smuzhiyun 
422*4882a593Smuzhiyun 	switch (mmc_resp_type(cmd)) {
423*4882a593Smuzhiyun 	case MMC_RSP_NONE:
424*4882a593Smuzhiyun 		c |= SD_CMD_RESP_TYPE_NONE;
425*4882a593Smuzhiyun 		break;
426*4882a593Smuzhiyun 
427*4882a593Smuzhiyun 	case MMC_RSP_R1:
428*4882a593Smuzhiyun 		c |= SD_CMD_RESP_TYPE_EXT_R1;
429*4882a593Smuzhiyun 		break;
430*4882a593Smuzhiyun 	case MMC_RSP_R1B:
431*4882a593Smuzhiyun 		c |= SD_CMD_RESP_TYPE_EXT_R1B;
432*4882a593Smuzhiyun 		break;
433*4882a593Smuzhiyun 	case MMC_RSP_R2:
434*4882a593Smuzhiyun 		c |= SD_CMD_RESP_TYPE_EXT_R2;
435*4882a593Smuzhiyun 		break;
436*4882a593Smuzhiyun 	case MMC_RSP_R3:
437*4882a593Smuzhiyun 		c |= SD_CMD_RESP_TYPE_EXT_R3;
438*4882a593Smuzhiyun 		break;
439*4882a593Smuzhiyun 
440*4882a593Smuzhiyun 	default:
441*4882a593Smuzhiyun 		dev_err(&host->pdev->dev, "Unknown response type %d\n",
442*4882a593Smuzhiyun 			mmc_resp_type(cmd));
443*4882a593Smuzhiyun 		break;
444*4882a593Smuzhiyun 	}
445*4882a593Smuzhiyun 
446*4882a593Smuzhiyun 	host->cmd = cmd;
447*4882a593Smuzhiyun 
448*4882a593Smuzhiyun 	if (cmd->opcode == MMC_APP_CMD)
449*4882a593Smuzhiyun 		c |= SD_CMD_TYPE_ACMD;
450*4882a593Smuzhiyun 
451*4882a593Smuzhiyun 	if (cmd->opcode == MMC_GO_IDLE_STATE)
452*4882a593Smuzhiyun 		c |= (3 << 8);  /* removed from ipaq-asic3.h for some reason */
453*4882a593Smuzhiyun 
454*4882a593Smuzhiyun 	if (data) {
455*4882a593Smuzhiyun 		c |= SD_CMD_DATA_PRESENT;
456*4882a593Smuzhiyun 
457*4882a593Smuzhiyun 		if (data->blocks > 1) {
458*4882a593Smuzhiyun 			iowrite16(SD_STOPINT_AUTO_ISSUE_CMD12,
459*4882a593Smuzhiyun 				  host->ioaddr + SD_STOPINTERNAL);
460*4882a593Smuzhiyun 			c |= SD_CMD_MULTI_BLOCK;
461*4882a593Smuzhiyun 		}
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 		if (data->flags & MMC_DATA_READ)
464*4882a593Smuzhiyun 			c |= SD_CMD_TRANSFER_READ;
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 		/* MMC_DATA_WRITE does not require a bit to be set */
467*4882a593Smuzhiyun 	}
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun 	/* Send the command */
470*4882a593Smuzhiyun 	iowrite32(cmd->arg, host->ioaddr + SD_ARG0);
471*4882a593Smuzhiyun 	iowrite16(c, host->ioaddr + SD_CMD);
472*4882a593Smuzhiyun }
473*4882a593Smuzhiyun 
toshsd_start_data(struct toshsd_host * host,struct mmc_data * data)474*4882a593Smuzhiyun static void toshsd_start_data(struct toshsd_host *host, struct mmc_data *data)
475*4882a593Smuzhiyun {
476*4882a593Smuzhiyun 	unsigned int flags = SG_MITER_ATOMIC;
477*4882a593Smuzhiyun 
478*4882a593Smuzhiyun 	dev_dbg(&host->pdev->dev, "setup data transfer: blocksize %08x  nr_blocks %d, offset: %08x\n",
479*4882a593Smuzhiyun 		data->blksz, data->blocks, data->sg->offset);
480*4882a593Smuzhiyun 
481*4882a593Smuzhiyun 	host->data = data;
482*4882a593Smuzhiyun 
483*4882a593Smuzhiyun 	if (data->flags & MMC_DATA_READ)
484*4882a593Smuzhiyun 		flags |= SG_MITER_TO_SG;
485*4882a593Smuzhiyun 	else
486*4882a593Smuzhiyun 		flags |= SG_MITER_FROM_SG;
487*4882a593Smuzhiyun 
488*4882a593Smuzhiyun 	sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 	/* Set transfer length and blocksize */
491*4882a593Smuzhiyun 	iowrite16(data->blocks, host->ioaddr + SD_BLOCKCOUNT);
492*4882a593Smuzhiyun 	iowrite16(data->blksz, host->ioaddr + SD_CARDXFERDATALEN);
493*4882a593Smuzhiyun }
494*4882a593Smuzhiyun 
495*4882a593Smuzhiyun /* Process requests from the MMC layer */
toshsd_request(struct mmc_host * mmc,struct mmc_request * mrq)496*4882a593Smuzhiyun static void toshsd_request(struct mmc_host *mmc, struct mmc_request *mrq)
497*4882a593Smuzhiyun {
498*4882a593Smuzhiyun 	struct toshsd_host *host = mmc_priv(mmc);
499*4882a593Smuzhiyun 	unsigned long flags;
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun 	/* abort if card not present */
502*4882a593Smuzhiyun 	if (!(ioread16(host->ioaddr + SD_CARDSTATUS) & SD_CARD_PRESENT_0)) {
503*4882a593Smuzhiyun 		mrq->cmd->error = -ENOMEDIUM;
504*4882a593Smuzhiyun 		mmc_request_done(mmc, mrq);
505*4882a593Smuzhiyun 		return;
506*4882a593Smuzhiyun 	}
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun 	spin_lock_irqsave(&host->lock, flags);
509*4882a593Smuzhiyun 
510*4882a593Smuzhiyun 	WARN_ON(host->mrq != NULL);
511*4882a593Smuzhiyun 
512*4882a593Smuzhiyun 	host->mrq = mrq;
513*4882a593Smuzhiyun 
514*4882a593Smuzhiyun 	if (mrq->data)
515*4882a593Smuzhiyun 		toshsd_start_data(host, mrq->data);
516*4882a593Smuzhiyun 
517*4882a593Smuzhiyun 	toshsd_set_led(host, 1);
518*4882a593Smuzhiyun 
519*4882a593Smuzhiyun 	toshsd_start_cmd(host, mrq->cmd);
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	spin_unlock_irqrestore(&host->lock, flags);
522*4882a593Smuzhiyun }
523*4882a593Smuzhiyun 
toshsd_set_ios(struct mmc_host * mmc,struct mmc_ios * ios)524*4882a593Smuzhiyun static void toshsd_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
525*4882a593Smuzhiyun {
526*4882a593Smuzhiyun 	struct toshsd_host *host = mmc_priv(mmc);
527*4882a593Smuzhiyun 	unsigned long flags;
528*4882a593Smuzhiyun 
529*4882a593Smuzhiyun 	spin_lock_irqsave(&host->lock, flags);
530*4882a593Smuzhiyun 	__toshsd_set_ios(mmc, ios);
531*4882a593Smuzhiyun 	spin_unlock_irqrestore(&host->lock, flags);
532*4882a593Smuzhiyun }
533*4882a593Smuzhiyun 
toshsd_get_ro(struct mmc_host * mmc)534*4882a593Smuzhiyun static int toshsd_get_ro(struct mmc_host *mmc)
535*4882a593Smuzhiyun {
536*4882a593Smuzhiyun 	struct toshsd_host *host = mmc_priv(mmc);
537*4882a593Smuzhiyun 
538*4882a593Smuzhiyun 	/* active low */
539*4882a593Smuzhiyun 	return !(ioread16(host->ioaddr + SD_CARDSTATUS) & SD_CARD_WRITE_PROTECT);
540*4882a593Smuzhiyun }
541*4882a593Smuzhiyun 
toshsd_get_cd(struct mmc_host * mmc)542*4882a593Smuzhiyun static int toshsd_get_cd(struct mmc_host *mmc)
543*4882a593Smuzhiyun {
544*4882a593Smuzhiyun 	struct toshsd_host *host = mmc_priv(mmc);
545*4882a593Smuzhiyun 
546*4882a593Smuzhiyun 	return !!(ioread16(host->ioaddr + SD_CARDSTATUS) & SD_CARD_PRESENT_0);
547*4882a593Smuzhiyun }
548*4882a593Smuzhiyun 
549*4882a593Smuzhiyun static const struct mmc_host_ops toshsd_ops = {
550*4882a593Smuzhiyun 	.request = toshsd_request,
551*4882a593Smuzhiyun 	.set_ios = toshsd_set_ios,
552*4882a593Smuzhiyun 	.get_ro = toshsd_get_ro,
553*4882a593Smuzhiyun 	.get_cd = toshsd_get_cd,
554*4882a593Smuzhiyun };
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun 
toshsd_powerdown(struct toshsd_host * host)557*4882a593Smuzhiyun static void toshsd_powerdown(struct toshsd_host *host)
558*4882a593Smuzhiyun {
559*4882a593Smuzhiyun 	/* mask all interrupts */
560*4882a593Smuzhiyun 	iowrite32(0xffffffff, host->ioaddr + SD_INTMASKCARD);
561*4882a593Smuzhiyun 	/* disable card clock */
562*4882a593Smuzhiyun 	iowrite16(0x000, host->ioaddr + SDIO_BASE + SDIO_CLOCKNWAITCTRL);
563*4882a593Smuzhiyun 	iowrite16(0, host->ioaddr + SD_CARDCLOCKCTRL);
564*4882a593Smuzhiyun 	/* power down card */
565*4882a593Smuzhiyun 	pci_write_config_byte(host->pdev, SD_PCICFG_POWER1, SD_PCICFG_PWR1_OFF);
566*4882a593Smuzhiyun 	/* disable clock */
567*4882a593Smuzhiyun 	pci_write_config_byte(host->pdev, SD_PCICFG_CLKSTOP, 0);
568*4882a593Smuzhiyun }
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun #ifdef CONFIG_PM_SLEEP
toshsd_pm_suspend(struct device * dev)571*4882a593Smuzhiyun static int toshsd_pm_suspend(struct device *dev)
572*4882a593Smuzhiyun {
573*4882a593Smuzhiyun 	struct pci_dev *pdev = to_pci_dev(dev);
574*4882a593Smuzhiyun 	struct toshsd_host *host = pci_get_drvdata(pdev);
575*4882a593Smuzhiyun 
576*4882a593Smuzhiyun 	toshsd_powerdown(host);
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun 	pci_save_state(pdev);
579*4882a593Smuzhiyun 	pci_enable_wake(pdev, PCI_D3hot, 0);
580*4882a593Smuzhiyun 	pci_disable_device(pdev);
581*4882a593Smuzhiyun 	pci_set_power_state(pdev, PCI_D3hot);
582*4882a593Smuzhiyun 
583*4882a593Smuzhiyun 	return 0;
584*4882a593Smuzhiyun }
585*4882a593Smuzhiyun 
toshsd_pm_resume(struct device * dev)586*4882a593Smuzhiyun static int toshsd_pm_resume(struct device *dev)
587*4882a593Smuzhiyun {
588*4882a593Smuzhiyun 	struct pci_dev *pdev = to_pci_dev(dev);
589*4882a593Smuzhiyun 	struct toshsd_host *host = pci_get_drvdata(pdev);
590*4882a593Smuzhiyun 	int ret;
591*4882a593Smuzhiyun 
592*4882a593Smuzhiyun 	pci_set_power_state(pdev, PCI_D0);
593*4882a593Smuzhiyun 	pci_restore_state(pdev);
594*4882a593Smuzhiyun 	ret = pci_enable_device(pdev);
595*4882a593Smuzhiyun 	if (ret)
596*4882a593Smuzhiyun 		return ret;
597*4882a593Smuzhiyun 
598*4882a593Smuzhiyun 	toshsd_init(host);
599*4882a593Smuzhiyun 
600*4882a593Smuzhiyun 	return 0;
601*4882a593Smuzhiyun }
602*4882a593Smuzhiyun #endif /* CONFIG_PM_SLEEP */
603*4882a593Smuzhiyun 
toshsd_probe(struct pci_dev * pdev,const struct pci_device_id * ent)604*4882a593Smuzhiyun static int toshsd_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
605*4882a593Smuzhiyun {
606*4882a593Smuzhiyun 	int ret;
607*4882a593Smuzhiyun 	struct toshsd_host *host;
608*4882a593Smuzhiyun 	struct mmc_host *mmc;
609*4882a593Smuzhiyun 	resource_size_t base;
610*4882a593Smuzhiyun 
611*4882a593Smuzhiyun 	ret = pci_enable_device(pdev);
612*4882a593Smuzhiyun 	if (ret)
613*4882a593Smuzhiyun 		return ret;
614*4882a593Smuzhiyun 
615*4882a593Smuzhiyun 	mmc = mmc_alloc_host(sizeof(struct toshsd_host), &pdev->dev);
616*4882a593Smuzhiyun 	if (!mmc) {
617*4882a593Smuzhiyun 		ret = -ENOMEM;
618*4882a593Smuzhiyun 		goto err;
619*4882a593Smuzhiyun 	}
620*4882a593Smuzhiyun 
621*4882a593Smuzhiyun 	host = mmc_priv(mmc);
622*4882a593Smuzhiyun 	host->mmc = mmc;
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 	host->pdev = pdev;
625*4882a593Smuzhiyun 	pci_set_drvdata(pdev, host);
626*4882a593Smuzhiyun 
627*4882a593Smuzhiyun 	ret = pci_request_regions(pdev, DRIVER_NAME);
628*4882a593Smuzhiyun 	if (ret)
629*4882a593Smuzhiyun 		goto free;
630*4882a593Smuzhiyun 
631*4882a593Smuzhiyun 	host->ioaddr = pci_iomap(pdev, 0, 0);
632*4882a593Smuzhiyun 	if (!host->ioaddr) {
633*4882a593Smuzhiyun 		ret = -ENOMEM;
634*4882a593Smuzhiyun 		goto release;
635*4882a593Smuzhiyun 	}
636*4882a593Smuzhiyun 
637*4882a593Smuzhiyun 	/* Set MMC host parameters */
638*4882a593Smuzhiyun 	mmc->ops = &toshsd_ops;
639*4882a593Smuzhiyun 	mmc->caps = MMC_CAP_4_BIT_DATA;
640*4882a593Smuzhiyun 	mmc->ocr_avail = MMC_VDD_32_33;
641*4882a593Smuzhiyun 
642*4882a593Smuzhiyun 	mmc->f_min = HCLK / 512;
643*4882a593Smuzhiyun 	mmc->f_max = HCLK;
644*4882a593Smuzhiyun 
645*4882a593Smuzhiyun 	spin_lock_init(&host->lock);
646*4882a593Smuzhiyun 
647*4882a593Smuzhiyun 	toshsd_init(host);
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun 	ret = request_threaded_irq(pdev->irq, toshsd_irq, toshsd_thread_irq,
650*4882a593Smuzhiyun 				   IRQF_SHARED, DRIVER_NAME, host);
651*4882a593Smuzhiyun 	if (ret)
652*4882a593Smuzhiyun 		goto unmap;
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun 	mmc_add_host(mmc);
655*4882a593Smuzhiyun 
656*4882a593Smuzhiyun 	base = pci_resource_start(pdev, 0);
657*4882a593Smuzhiyun 	dev_dbg(&pdev->dev, "MMIO %pa, IRQ %d\n", &base, pdev->irq);
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun 	pm_suspend_ignore_children(&pdev->dev, 1);
660*4882a593Smuzhiyun 
661*4882a593Smuzhiyun 	return 0;
662*4882a593Smuzhiyun 
663*4882a593Smuzhiyun unmap:
664*4882a593Smuzhiyun 	pci_iounmap(pdev, host->ioaddr);
665*4882a593Smuzhiyun release:
666*4882a593Smuzhiyun 	pci_release_regions(pdev);
667*4882a593Smuzhiyun free:
668*4882a593Smuzhiyun 	mmc_free_host(mmc);
669*4882a593Smuzhiyun 	pci_set_drvdata(pdev, NULL);
670*4882a593Smuzhiyun err:
671*4882a593Smuzhiyun 	pci_disable_device(pdev);
672*4882a593Smuzhiyun 	return ret;
673*4882a593Smuzhiyun }
674*4882a593Smuzhiyun 
toshsd_remove(struct pci_dev * pdev)675*4882a593Smuzhiyun static void toshsd_remove(struct pci_dev *pdev)
676*4882a593Smuzhiyun {
677*4882a593Smuzhiyun 	struct toshsd_host *host = pci_get_drvdata(pdev);
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun 	mmc_remove_host(host->mmc);
680*4882a593Smuzhiyun 	toshsd_powerdown(host);
681*4882a593Smuzhiyun 	free_irq(pdev->irq, host);
682*4882a593Smuzhiyun 	pci_iounmap(pdev, host->ioaddr);
683*4882a593Smuzhiyun 	pci_release_regions(pdev);
684*4882a593Smuzhiyun 	mmc_free_host(host->mmc);
685*4882a593Smuzhiyun 	pci_set_drvdata(pdev, NULL);
686*4882a593Smuzhiyun 	pci_disable_device(pdev);
687*4882a593Smuzhiyun }
688*4882a593Smuzhiyun 
689*4882a593Smuzhiyun static const struct dev_pm_ops toshsd_pm_ops = {
690*4882a593Smuzhiyun 	SET_SYSTEM_SLEEP_PM_OPS(toshsd_pm_suspend, toshsd_pm_resume)
691*4882a593Smuzhiyun };
692*4882a593Smuzhiyun 
693*4882a593Smuzhiyun static struct pci_driver toshsd_driver = {
694*4882a593Smuzhiyun 	.name = DRIVER_NAME,
695*4882a593Smuzhiyun 	.id_table = pci_ids,
696*4882a593Smuzhiyun 	.probe = toshsd_probe,
697*4882a593Smuzhiyun 	.remove = toshsd_remove,
698*4882a593Smuzhiyun 	.driver.pm = &toshsd_pm_ops,
699*4882a593Smuzhiyun };
700*4882a593Smuzhiyun 
701*4882a593Smuzhiyun module_pci_driver(toshsd_driver);
702*4882a593Smuzhiyun 
703*4882a593Smuzhiyun MODULE_AUTHOR("Ondrej Zary, Richard Betts");
704*4882a593Smuzhiyun MODULE_DESCRIPTION("Toshiba PCI Secure Digital Host Controller Interface driver");
705*4882a593Smuzhiyun MODULE_LICENSE("GPL");
706