sdhci-of-dwcmshc.c 2.7 KB

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