dw_mmc-bluefield.c 2.0 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2018 Mellanox Technologies.
  4. */
  5. #include <linux/bitfield.h>
  6. #include <linux/bitops.h>
  7. #include <linux/mmc/host.h>
  8. #include <linux/mmc/mmc.h>
  9. #include <linux/module.h>
  10. #include <linux/of.h>
  11. #include <linux/platform_device.h>
  12. #include <linux/pm_runtime.h>
  13. #include "dw_mmc.h"
  14. #include "dw_mmc-pltfm.h"
  15. #define UHS_REG_EXT_SAMPLE_MASK GENMASK(22, 16)
  16. #define UHS_REG_EXT_DRIVE_MASK GENMASK(29, 23)
  17. #define BLUEFIELD_UHS_REG_EXT_SAMPLE 2
  18. #define BLUEFIELD_UHS_REG_EXT_DRIVE 4
  19. static void dw_mci_bluefield_set_ios(struct dw_mci *host, struct mmc_ios *ios)
  20. {
  21. u32 reg;
  22. /* Update the Drive and Sample fields in register UHS_REG_EXT. */
  23. reg = mci_readl(host, UHS_REG_EXT);
  24. reg &= ~UHS_REG_EXT_SAMPLE_MASK;
  25. reg |= FIELD_PREP(UHS_REG_EXT_SAMPLE_MASK,
  26. BLUEFIELD_UHS_REG_EXT_SAMPLE);
  27. reg &= ~UHS_REG_EXT_DRIVE_MASK;
  28. reg |= FIELD_PREP(UHS_REG_EXT_DRIVE_MASK, BLUEFIELD_UHS_REG_EXT_DRIVE);
  29. mci_writel(host, UHS_REG_EXT, reg);
  30. }
  31. static const struct dw_mci_drv_data bluefield_drv_data = {
  32. .set_ios = dw_mci_bluefield_set_ios
  33. };
  34. static const struct of_device_id dw_mci_bluefield_match[] = {
  35. { .compatible = "mellanox,bluefield-dw-mshc",
  36. .data = &bluefield_drv_data },
  37. {},
  38. };
  39. MODULE_DEVICE_TABLE(of, dw_mci_bluefield_match);
  40. static int dw_mci_bluefield_probe(struct platform_device *pdev)
  41. {
  42. const struct dw_mci_drv_data *drv_data = NULL;
  43. const struct of_device_id *match;
  44. if (pdev->dev.of_node) {
  45. match = of_match_node(dw_mci_bluefield_match,
  46. pdev->dev.of_node);
  47. drv_data = match->data;
  48. }
  49. return dw_mci_pltfm_register(pdev, drv_data);
  50. }
  51. static struct platform_driver dw_mci_bluefield_pltfm_driver = {
  52. .probe = dw_mci_bluefield_probe,
  53. .remove = dw_mci_pltfm_remove,
  54. .driver = {
  55. .name = "dwmmc_bluefield",
  56. .of_match_table = dw_mci_bluefield_match,
  57. .pm = &dw_mci_pltfm_pmops,
  58. },
  59. };
  60. module_platform_driver(dw_mci_bluefield_pltfm_driver);
  61. MODULE_DESCRIPTION("BlueField DW Multimedia Card driver");
  62. MODULE_AUTHOR("Mellanox Technologies");
  63. MODULE_LICENSE("GPL v2");