Quelle  sdhci-pltfm.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * sdhci-pltfm.c Support for SDHCI platform devices
 * Copyright (c) 2009 Intel Corporation
 *
 * Copyright (c) 2007, 2011 Freescale Semiconductor, Inc.
 * Copyright (c) 2009 MontaVista Software, Inc.
 *
 * Authors: Xiaobo Xie <X.Xie@freescale.com>
 *     Anton Vorontsov <avorontsov@ru.mvista.com>
 */

/* Supports:
 * SDHCI platform devices
 *
 * Inspired by sdhci-pci.c, by Pierre Ossman
 */

#include <linux/err.h>
#include <linux/module.h>
#include <linux/property.h>
#ifdef CONFIG_PPC
#include <asm/machdep.h>
#endif
#include "sdhci-pltfm.h"

unsigned int sdhci_pltfm_clk_get_max_clock(struct sdhci_host *host)
{
 struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);

 return clk_get_rate(pltfm_host->clk);
}
EXPORT_SYMBOL_GPL(sdhci_pltfm_clk_get_max_clock);

static const struct sdhci_ops sdhci_pltfm_ops = {
 .set_clock = sdhci_set_clock,
 .set_bus_width = sdhci_set_bus_width,
 .reset = sdhci_reset,
 .set_uhs_signaling = sdhci_set_uhs_signaling,
};

static bool sdhci_wp_inverted(struct device *dev)
{
 if (device_property_present(dev, "sdhci,wp-inverted") ||
     device_property_present(dev, "wp-inverted"))
  return true;

 /* Old device trees don't have the wp-inverted property. */
#ifdef CONFIG_PPC
 return machine_is(mpc837x_rdb) || machine_is(mpc837x_mds);
#else
 return false;
#endif /* CONFIG_PPC */
}

static void sdhci_get_compatibility(struct platform_device *pdev)
{
 struct device *dev = &pdev->dev;
 struct sdhci_host *host = platform_get_drvdata(pdev);

 if (device_is_compatible(dev, "fsl,p2020-rev1-esdhc"))
  host->quirks |= SDHCI_QUIRK_BROKEN_DMA;

 if (device_is_compatible(dev, "fsl,p2020-esdhc") ||
     device_is_compatible(dev, "fsl,p1010-esdhc") ||
     device_is_compatible(dev, "fsl,t4240-esdhc") ||
     device_is_compatible(dev, "fsl,mpc8536-esdhc"))
  host->quirks |= SDHCI_QUIRK_BROKEN_TIMEOUT_VAL;
}

void sdhci_get_property(struct platform_device *pdev)
{
 struct device *dev = &pdev->dev;
 struct sdhci_host *host = platform_get_drvdata(pdev);
 struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
 u32 bus_width;

 if (device_property_present(dev, "sdhci,auto-cmd12"))
  host->quirks |= SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12;

 if (device_property_present(dev, "sdhci,1-bit-only") ||
     (device_property_read_u32(dev, "bus-width", &bus_width) == 0 &&
     bus_width == 1))
  host->quirks |= SDHCI_QUIRK_FORCE_1_BIT_DATA;

 if (sdhci_wp_inverted(dev))
  host->quirks |= SDHCI_QUIRK_INVERTED_WRITE_PROTECT;

 if (device_property_present(dev, "broken-cd"))
  host->quirks |= SDHCI_QUIRK_BROKEN_CARD_DETECTION;

 if (device_property_present(dev, "no-1-8-v"))
  host->quirks2 |= SDHCI_QUIRK2_NO_1_8_V;

 sdhci_get_compatibility(pdev);

 device_property_read_u32(dev, "clock-frequency", &pltfm_host->clock);

 if (device_property_present(dev, "keep-power-in-suspend"))
  host->mmc->pm_caps |= MMC_PM_KEEP_POWER;

 if (device_property_read_bool(dev, "wakeup-source") ||
     device_property_read_bool(dev, "enable-sdio-wakeup")) /* legacy */
  host->mmc->pm_caps |= MMC_PM_WAKE_SDIO_IRQ;
}
EXPORT_SYMBOL_GPL(sdhci_get_property);

struct sdhci_host *sdhci_pltfm_init(struct platform_device *pdev,
        const struct sdhci_pltfm_data *pdata,
        size_t priv_size)
{
 struct sdhci_host *host;
 void __iomem *ioaddr;
 int irq;

 ioaddr = devm_platform_ioremap_resource(pdev, 0);
 if (IS_ERR(ioaddr))
  return ERR_CAST(ioaddr);

 irq = platform_get_irq(pdev, 0);
 if (irq < 0)
  return ERR_PTR(irq);

 host = sdhci_alloc_host(&pdev->dev,
  sizeof(struct sdhci_pltfm_host) + priv_size);
 if (IS_ERR(host)) {
  dev_err(&pdev->dev, "%s failed %pe\n", __func__, host);
  return ERR_CAST(host);
 }

 host->ioaddr = ioaddr;
 host->irq = irq;
 host->hw_name = dev_name(&pdev->dev);
 if (pdata && pdata->ops)
  host->ops = pdata->ops;
 else
  host->ops = &sdhci_pltfm_ops;
 if (pdata) {
  host->quirks = pdata->quirks;
  host->quirks2 = pdata->quirks2;
 }

 platform_set_drvdata(pdev, host);

 return host;
}
EXPORT_SYMBOL_GPL(sdhci_pltfm_init);

int sdhci_pltfm_init_and_add_host(struct platform_device *pdev,
      const struct sdhci_pltfm_data *pdata,
      size_t priv_size)
{
 struct sdhci_host *host;

 host = sdhci_pltfm_init(pdev, pdata, priv_size);
 if (IS_ERR(host))
  return PTR_ERR(host);

 sdhci_get_property(pdev);

 return sdhci_add_host(host);
}
EXPORT_SYMBOL_GPL(sdhci_pltfm_init_and_add_host);

void sdhci_pltfm_remove(struct platform_device *pdev)
{
 struct sdhci_host *host = platform_get_drvdata(pdev);
 int dead = (readl(host->ioaddr + SDHCI_INT_STATUS) == 0xffffffff);

 sdhci_remove_host(host, dead);
}
EXPORT_SYMBOL_GPL(sdhci_pltfm_remove);

#ifdef CONFIG_PM_SLEEP
int sdhci_pltfm_suspend(struct device *dev)
{
 struct sdhci_host *host = dev_get_drvdata(dev);
 struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
 int ret;

 if (host->tuning_mode != SDHCI_TUNING_MODE_3)
  mmc_retune_needed(host->mmc);

 ret = sdhci_suspend_host(host);
 if (ret)
  return ret;

 clk_disable_unprepare(pltfm_host->clk);

 return 0;
}
EXPORT_SYMBOL_GPL(sdhci_pltfm_suspend);

int sdhci_pltfm_resume(struct device *dev)
{
 struct sdhci_host *host = dev_get_drvdata(dev);
 struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
 int ret;

 ret = clk_prepare_enable(pltfm_host->clk);
 if (ret)
  return ret;

 ret = sdhci_resume_host(host);
 if (ret)
  clk_disable_unprepare(pltfm_host->clk);

 return ret;
}
EXPORT_SYMBOL_GPL(sdhci_pltfm_resume);
#endif

const struct dev_pm_ops sdhci_pltfm_pmops = {
 SET_SYSTEM_SLEEP_PM_OPS(sdhci_pltfm_suspend, sdhci_pltfm_resume)
};
EXPORT_SYMBOL_GPL(sdhci_pltfm_pmops);

static int __init sdhci_pltfm_drv_init(void)
{
 pr_info("sdhci-pltfm: SDHCI platform and OF driver helper\n");

 return 0;
}
module_init(sdhci_pltfm_drv_init);

static void __exit sdhci_pltfm_drv_exit(void)
{
}
module_exit(sdhci_pltfm_drv_exit);

MODULE_DESCRIPTION("SDHCI platform and OF driver helper");
MODULE_AUTHOR("Intel Corporation");
MODULE_LICENSE("GPL v2");