drivers/mmc/host/sdhci-of-dwcmshc.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Driver for Synopsys DesignWare Cores Mobile Storage Host Controller
   4  *
   5  * Copyright (C) 2018 Synaptics Incorporated
   6  *
   7  * Author: Jisheng Zhang <jszhang@kernel.org>
   8  */
   9
  10 #include <linux/clk.h>
  11 #include <linux/module.h>
  12 #include <linux/of.h>
  13
  14 #include "sdhci-pltfm.h"
  15
  16 struct dwcmshc_priv {
  17         struct clk      *bus_clk;
  18 };
  19
  20 static const struct sdhci_ops sdhci_dwcmshc_ops = {
  21         .set_clock              = sdhci_set_clock,
  22         .set_bus_width          = sdhci_set_bus_width,
  23         .set_uhs_signaling      = sdhci_set_uhs_signaling,
  24         .get_max_clock          = sdhci_pltfm_clk_get_max_clock,
  25         .reset                  = sdhci_reset,
  26 };
  27
  28 static const struct sdhci_pltfm_data sdhci_dwcmshc_pdata = {
  29         .ops = &sdhci_dwcmshc_ops,
  30         .quirks = SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN,
  31         .quirks2 = SDHCI_QUIRK2_PRESET_VALUE_BROKEN,
  32 };
  33
  34 static int dwcmshc_probe(struct platform_device *pdev)
  35 {
  36         struct sdhci_pltfm_host *pltfm_host;
  37         struct sdhci_host *host;
  38         struct dwcmshc_priv *priv;
  39         int err;
  40
  41         host = sdhci_pltfm_init(pdev, &sdhci_dwcmshc_pdata,
  42                                 sizeof(struct dwcmshc_priv));
  43         if (IS_ERR(host))
  44                 return PTR_ERR(host);
  45
  46         pltfm_host = sdhci_priv(host);
  47         priv = sdhci_pltfm_priv(pltfm_host);
  48
  49         pltfm_host->clk = devm_clk_get(&pdev->dev, "core");
  50         if (IS_ERR(pltfm_host->clk)) {
  51                 err = PTR_ERR(pltfm_host->clk);
  52                 dev_err(&pdev->dev, "failed to get core clk: %d\n", err);
  53                 goto free_pltfm;
  54         }
  55         err = clk_prepare_enable(pltfm_host->clk);
  56         if (err)
  57                 goto free_pltfm;
  58
  59         priv->bus_clk = devm_clk_get(&pdev->dev, "bus");
  60         if (!IS_ERR(priv->bus_clk))
  61                 clk_prepare_enable(priv->bus_clk);
  62
  63         err = mmc_of_parse(host->mmc);
  64         if (err)
  65                 goto err_clk;
  66
  67         sdhci_get_of_property(pdev);
  68
  69         err = sdhci_add_host(host);
  70         if (err)
  71                 goto err_clk;
  72
  73         return 0;
  74
  75 err_clk:
  76         clk_disable_unprepare(pltfm_host->clk);
  77         clk_disable_unprepare(priv->bus_clk);
  78 free_pltfm:
  79         sdhci_pltfm_free(pdev);
  80         return err;
  81 }
  82
  83 static int dwcmshc_remove(struct platform_device *pdev)
  84 {
  85         struct sdhci_host *host = platform_get_drvdata(pdev);
  86         struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
  87         struct dwcmshc_priv *priv = sdhci_pltfm_priv(pltfm_host);
  88
  89         sdhci_remove_host(host, 0);
  90
  91         clk_disable_unprepare(pltfm_host->clk);
  92         clk_disable_unprepare(priv->bus_clk);
  93
  94         sdhci_pltfm_free(pdev);
  95
  96         return 0;
  97 }
  98
  99 static const struct of_device_id sdhci_dwcmshc_dt_ids[] = {
 100         { .compatible = "snps,dwcmshc-sdhci" },
 101         {}
 102 };
 103 MODULE_DEVICE_TABLE(of, sdhci_dwcmshc_dt_ids);
 104
 105 static struct platform_driver sdhci_dwcmshc_driver = {
 106         .driver = {
 107                 .name   = "sdhci-dwcmshc",
 108                 .of_match_table = sdhci_dwcmshc_dt_ids,
 109         },
 110         .probe  = dwcmshc_probe,
 111         .remove = dwcmshc_remove,
 112 };
 113 module_platform_driver(sdhci_dwcmshc_driver);
 114
 115 MODULE_DESCRIPTION("SDHCI platform driver for Synopsys DWC MSHC");
 116 MODULE_AUTHOR("Jisheng Zhang <jszhang@kernel.org>");
 117 MODULE_LICENSE("GPL v2");