19f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao/*
29f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao * Copyright (C) 2010 Marvell International Ltd.
39f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao *		Zhangfei Gao <zhangfei.gao@marvell.com>
49f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao *		Kevin Wang <dwang4@marvell.com>
59f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao *		Jun Nie <njun@marvell.com>
69f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao *		Qiming Wu <wuqm@marvell.com>
79f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao *		Philip Rakity <prakity@marvell.com>
89f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao *
99f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao * This software is licensed under the terms of the GNU General Public
109f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao * License version 2, as published by the Free Software Foundation, and
119f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao * may be copied, distributed, and modified under those terms.
129f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao *
139f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao * This program is distributed in the hope that it will be useful,
149f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao * but WITHOUT ANY WARRANTY; without even the implied warranty of
159f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
169f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao * GNU General Public License for more details.
179f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao *
189f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao */
199f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
209f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include <linux/err.h>
219f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include <linux/init.h>
229f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include <linux/platform_device.h>
239f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include <linux/clk.h>
2488b47679746b81534002bcba42da97ab82b5d12aPaul Gortmaker#include <linux/module.h>
259f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include <linux/io.h>
269f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include <linux/gpio.h>
279f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include <linux/mmc/card.h>
289f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include <linux/mmc/host.h>
29bfed345edfe05b291f7e5d396d4b447b6e8e66faZhangfei Gao#include <linux/platform_data/pxa_sdhci.h>
309f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include <linux/slab.h>
319f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include "sdhci.h"
329f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#include "sdhci-pltfm.h"
339f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
349f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define SD_FIFO_PARAM		0xe0
359f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define DIS_PAD_SD_CLK_GATE	0x0400 /* Turn on/off Dynamic SD Clock Gating */
369f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define CLK_GATE_ON		0x0200 /* Disable/enable Clock Gate */
379f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define CLK_GATE_CTL		0x0100 /* Clock Gate Control */
389f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define CLK_GATE_SETTING_BITS	(DIS_PAD_SD_CLK_GATE | \
399f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		CLK_GATE_ON | CLK_GATE_CTL)
409f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
419f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define SD_CLOCK_BURST_SIZE_SETUP	0xe6
429f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define SDCLK_SEL_SHIFT		8
439f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define SDCLK_SEL_MASK		0x3
449f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define SDCLK_DELAY_SHIFT	10
459f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define SDCLK_DELAY_MASK	0x3c
469f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
479f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define SD_CE_ATA_2		0xea
489f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define MMC_CARD		0x1000
499f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao#define MMC_WIDTH		0x0100
509f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
519f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gaostatic void pxav2_set_private_registers(struct sdhci_host *host, u8 mask)
529f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao{
539f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct platform_device *pdev = to_platform_device(mmc_dev(host->mmc));
549f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct sdhci_pxa_platdata *pdata = pdev->dev.platform_data;
559f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
569f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	if (mask == SDHCI_RESET_ALL) {
579f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		u16 tmp = 0;
589f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
599f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		/*
609f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		 * tune timing of read data/command when crc error happen
619f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		 * no performance impact
629f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		 */
63329f22371460587c59b866dcbffce5b498b61f38Tanmay Upadhyay		if (pdata && pdata->clk_delay_sel == 1) {
649f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp = readw(host->ioaddr + SD_CLOCK_BURST_SIZE_SETUP);
659f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
669f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp &= ~(SDCLK_DELAY_MASK << SDCLK_DELAY_SHIFT);
679f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp |= (pdata->clk_delay_cycles & SDCLK_DELAY_MASK)
689f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao				<< SDCLK_DELAY_SHIFT;
699f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp &= ~(SDCLK_SEL_MASK << SDCLK_SEL_SHIFT);
709f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp |= (1 & SDCLK_SEL_MASK) << SDCLK_SEL_SHIFT;
719f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
729f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			writew(tmp, host->ioaddr + SD_CLOCK_BURST_SIZE_SETUP);
739f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		}
749f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
75329f22371460587c59b866dcbffce5b498b61f38Tanmay Upadhyay		if (pdata && (pdata->flags & PXA_FLAG_ENABLE_CLOCK_GATING)) {
769f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp = readw(host->ioaddr + SD_FIFO_PARAM);
779f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp &= ~CLK_GATE_SETTING_BITS;
789f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			writew(tmp, host->ioaddr + SD_FIFO_PARAM);
799f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		} else {
809f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp = readw(host->ioaddr + SD_FIFO_PARAM);
819f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp &= ~CLK_GATE_SETTING_BITS;
829f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			tmp |= CLK_GATE_SETTING_BITS;
839f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			writew(tmp, host->ioaddr + SD_FIFO_PARAM);
849f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		}
859f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	}
869f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao}
879f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
889f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gaostatic int pxav2_mmc_set_width(struct sdhci_host *host, int width)
899f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao{
909f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	u8 ctrl;
919f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	u16 tmp;
929f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
939f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	ctrl = readb(host->ioaddr + SDHCI_HOST_CONTROL);
949f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	tmp = readw(host->ioaddr + SD_CE_ATA_2);
959f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	if (width == MMC_BUS_WIDTH_8) {
969f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		ctrl &= ~SDHCI_CTRL_4BITBUS;
979f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		tmp |= MMC_CARD | MMC_WIDTH;
989f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	} else {
999f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		tmp &= ~(MMC_CARD | MMC_WIDTH);
1009f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		if (width == MMC_BUS_WIDTH_4)
1019f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			ctrl |= SDHCI_CTRL_4BITBUS;
1029f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		else
1039f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			ctrl &= ~SDHCI_CTRL_4BITBUS;
1049f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	}
1059f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	writew(tmp, host->ioaddr + SD_CE_ATA_2);
1069f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	writeb(ctrl, host->ioaddr + SDHCI_HOST_CONTROL);
1079f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1089f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	return 0;
1099f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao}
1109f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1119f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gaostatic u32 pxav2_get_max_clock(struct sdhci_host *host)
1129f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao{
1139f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
1149f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1159f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	return clk_get_rate(pltfm_host->clk);
1169f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao}
1179f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1189f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gaostatic struct sdhci_ops pxav2_sdhci_ops = {
1199f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	.get_max_clock = pxav2_get_max_clock,
1209f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	.platform_reset_exit = pxav2_set_private_registers,
1219f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	.platform_8bit_width = pxav2_mmc_set_width,
1229f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao};
1239f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1249f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gaostatic int __devinit sdhci_pxav2_probe(struct platform_device *pdev)
1259f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao{
1269f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct sdhci_pltfm_host *pltfm_host;
1279f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct sdhci_pxa_platdata *pdata = pdev->dev.platform_data;
1289f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct device *dev = &pdev->dev;
1299f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct sdhci_host *host = NULL;
1309f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct sdhci_pxa *pxa = NULL;
1319f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	int ret;
1329f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct clk *clk;
1339f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1349f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	pxa = kzalloc(sizeof(struct sdhci_pxa), GFP_KERNEL);
1359f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	if (!pxa)
1369f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		return -ENOMEM;
1379f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1389f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	host = sdhci_pltfm_init(pdev, NULL);
1399f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	if (IS_ERR(host)) {
1409f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		kfree(pxa);
1419f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		return PTR_ERR(host);
1429f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	}
1439f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	pltfm_host = sdhci_priv(host);
1449f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	pltfm_host->priv = pxa;
1459f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1469f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	clk = clk_get(dev, "PXA-SDHCLK");
1479f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	if (IS_ERR(clk)) {
1489f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		dev_err(dev, "failed to get io clock\n");
1499f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		ret = PTR_ERR(clk);
1509f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		goto err_clk_get;
1519f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	}
1529f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	pltfm_host->clk = clk;
1539f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	clk_enable(clk);
1549f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1559f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	host->quirks = SDHCI_QUIRK_BROKEN_ADMA
1569f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		| SDHCI_QUIRK_BROKEN_TIMEOUT_VAL
1579f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		| SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN;
1589f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1599f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	if (pdata) {
1609f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		if (pdata->flags & PXA_FLAG_CARD_PERMANENT) {
1619f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			/* on-chip device */
1629f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			host->quirks |= SDHCI_QUIRK_BROKEN_CARD_DETECTION;
1639f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			host->mmc->caps |= MMC_CAP_NONREMOVABLE;
1649f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		}
1659f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1669f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		/* If slot design supports 8 bit data, indicate this to MMC. */
1679f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		if (pdata->flags & PXA_FLAG_SD_8_BIT_CAPABLE_SLOT)
1689f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			host->mmc->caps |= MMC_CAP_8_BIT_DATA;
1699f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1709f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		if (pdata->quirks)
1719f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			host->quirks |= pdata->quirks;
1729f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		if (pdata->host_caps)
1739f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			host->mmc->caps |= pdata->host_caps;
1749f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		if (pdata->pm_caps)
1759f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao			host->mmc->pm_caps |= pdata->pm_caps;
1769f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	}
1779f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1789f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	host->ops = &pxav2_sdhci_ops;
1799f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1809f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	ret = sdhci_add_host(host);
1819f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	if (ret) {
1829f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		dev_err(&pdev->dev, "failed to add host\n");
1839f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		goto err_add_host;
1849f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	}
1859f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1869f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	platform_set_drvdata(pdev, host);
1879f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1889f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	return 0;
1899f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1909f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gaoerr_add_host:
1919f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	clk_disable(clk);
1929f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	clk_put(clk);
1939f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gaoerr_clk_get:
1949f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	sdhci_pltfm_free(pdev);
1959f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	kfree(pxa);
1969f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	return ret;
1979f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao}
1989f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
1999f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gaostatic int __devexit sdhci_pxav2_remove(struct platform_device *pdev)
2009f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao{
2019f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct sdhci_host *host = platform_get_drvdata(pdev);
2029f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
2039f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	struct sdhci_pxa *pxa = pltfm_host->priv;
2049f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
2059f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	sdhci_remove_host(host, 1);
2069f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
2079f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	clk_disable(pltfm_host->clk);
2089f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	clk_put(pltfm_host->clk);
2099f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	sdhci_pltfm_free(pdev);
2109f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	kfree(pxa);
2119f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
2129f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	platform_set_drvdata(pdev, NULL);
2139f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
2149f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	return 0;
2159f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao}
2169f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
2179f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gaostatic struct platform_driver sdhci_pxav2_driver = {
2189f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	.driver		= {
2199f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		.name	= "sdhci-pxav2",
2209f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao		.owner	= THIS_MODULE,
22129495aa04a30c21565243c5b9c028510446d242cManuel Lauss		.pm	= SDHCI_PLTFM_PMOPS,
2229f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	},
2239f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	.probe		= sdhci_pxav2_probe,
2249f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao	.remove		= __devexit_p(sdhci_pxav2_remove),
2259f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao};
2269f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
227d1f81a64a4250bdd776978be06ae2b8e13ec7471Axel Linmodule_platform_driver(sdhci_pxav2_driver);
2289f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
2299f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei GaoMODULE_DESCRIPTION("SDHCI driver for pxav2");
2309f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei GaoMODULE_AUTHOR("Marvell International Ltd.");
2319f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei GaoMODULE_LICENSE("GPL v2");
2329f5d71e4a78a02f80f0bfbbbe84555d5a5468774Zhangfei Gao
233