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