mmc-uclass.c 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220
  1. /*
  2. * Copyright (C) 2015 Google, Inc
  3. * Written by Simon Glass <sjg@chromium.org>
  4. *
  5. * SPDX-License-Identifier: GPL-2.0+
  6. */
  7. #include <common.h>
  8. #include <mmc.h>
  9. #include <dm.h>
  10. #include <dm/device-internal.h>
  11. #include <dm/lists.h>
  12. #include <dm/root.h>
  13. #include "mmc_private.h"
  14. struct mmc *mmc_get_mmc_dev(struct udevice *dev)
  15. {
  16. struct mmc_uclass_priv *upriv;
  17. if (!device_active(dev))
  18. return NULL;
  19. upriv = dev_get_uclass_priv(dev);
  20. return upriv->mmc;
  21. }
  22. #ifdef CONFIG_BLK
  23. struct mmc *find_mmc_device(int dev_num)
  24. {
  25. struct udevice *dev, *mmc_dev;
  26. int ret;
  27. ret = blk_get_device(IF_TYPE_MMC, dev_num, &dev);
  28. if (ret) {
  29. #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
  30. printf("MMC Device %d not found\n", dev_num);
  31. #endif
  32. return NULL;
  33. }
  34. mmc_dev = dev_get_parent(dev);
  35. return mmc_get_mmc_dev(mmc_dev);
  36. }
  37. int get_mmc_num(void)
  38. {
  39. return max(blk_find_max_devnum(IF_TYPE_MMC), 0);
  40. }
  41. int mmc_get_next_devnum(void)
  42. {
  43. int ret;
  44. ret = get_mmc_num();
  45. if (ret < 0)
  46. return ret;
  47. return ret + 1;
  48. }
  49. struct blk_desc *mmc_get_blk_desc(struct mmc *mmc)
  50. {
  51. struct blk_desc *desc;
  52. struct udevice *dev;
  53. device_find_first_child(mmc->dev, &dev);
  54. if (!dev)
  55. return NULL;
  56. desc = dev_get_uclass_platdata(dev);
  57. return desc;
  58. }
  59. void mmc_do_preinit(void)
  60. {
  61. struct udevice *dev;
  62. struct uclass *uc;
  63. int ret;
  64. ret = uclass_get(UCLASS_MMC, &uc);
  65. if (ret)
  66. return;
  67. uclass_foreach_dev(dev, uc) {
  68. struct mmc *m = mmc_get_mmc_dev(dev);
  69. if (!m)
  70. continue;
  71. #ifdef CONFIG_FSL_ESDHC_ADAPTER_IDENT
  72. mmc_set_preinit(m, 1);
  73. #endif
  74. if (m->preinit)
  75. mmc_start_init(m);
  76. }
  77. }
  78. #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
  79. void print_mmc_devices(char separator)
  80. {
  81. struct udevice *dev;
  82. char *mmc_type;
  83. bool first = true;
  84. for (uclass_first_device(UCLASS_MMC, &dev);
  85. dev;
  86. uclass_next_device(&dev)) {
  87. struct mmc *m = mmc_get_mmc_dev(dev);
  88. if (!first) {
  89. printf("%c", separator);
  90. if (separator != '\n')
  91. puts(" ");
  92. }
  93. if (m->has_init)
  94. mmc_type = IS_SD(m) ? "SD" : "eMMC";
  95. else
  96. mmc_type = NULL;
  97. printf("%s: %d", m->cfg->name, mmc_get_blk_desc(m)->devnum);
  98. if (mmc_type)
  99. printf(" (%s)", mmc_type);
  100. }
  101. printf("\n");
  102. }
  103. #else
  104. void print_mmc_devices(char separator) { }
  105. #endif
  106. int mmc_bind(struct udevice *dev, struct mmc *mmc, const struct mmc_config *cfg)
  107. {
  108. struct blk_desc *bdesc;
  109. struct udevice *bdev;
  110. int ret;
  111. ret = blk_create_devicef(dev, "mmc_blk", "blk", IF_TYPE_MMC, -1, 512,
  112. 0, &bdev);
  113. if (ret) {
  114. debug("Cannot create block device\n");
  115. return ret;
  116. }
  117. bdesc = dev_get_uclass_platdata(bdev);
  118. mmc->cfg = cfg;
  119. mmc->priv = dev;
  120. /* the following chunk was from mmc_register() */
  121. /* Setup dsr related values */
  122. mmc->dsr_imp = 0;
  123. mmc->dsr = 0xffffffff;
  124. /* Setup the universal parts of the block interface just once */
  125. bdesc->removable = 1;
  126. /* setup initial part type */
  127. bdesc->part_type = cfg->part_type;
  128. mmc->dev = dev;
  129. return 0;
  130. }
  131. int mmc_unbind(struct udevice *dev)
  132. {
  133. struct udevice *bdev;
  134. device_find_first_child(dev, &bdev);
  135. if (bdev) {
  136. device_remove(bdev);
  137. device_unbind(bdev);
  138. }
  139. return 0;
  140. }
  141. static int mmc_select_hwpart(struct udevice *bdev, int hwpart)
  142. {
  143. struct udevice *mmc_dev = dev_get_parent(bdev);
  144. struct mmc *mmc = mmc_get_mmc_dev(mmc_dev);
  145. struct blk_desc *desc = dev_get_uclass_platdata(bdev);
  146. int ret;
  147. if (desc->hwpart == hwpart)
  148. return 0;
  149. if (mmc->part_config == MMCPART_NOAVAILABLE)
  150. return -EMEDIUMTYPE;
  151. ret = mmc_switch_part(mmc, hwpart);
  152. if (ret)
  153. return ret;
  154. return 0;
  155. }
  156. static const struct blk_ops mmc_blk_ops = {
  157. .read = mmc_bread,
  158. #ifndef CONFIG_SPL_BUILD
  159. .write = mmc_bwrite,
  160. #endif
  161. .select_hwpart = mmc_select_hwpart,
  162. };
  163. U_BOOT_DRIVER(mmc_blk) = {
  164. .name = "mmc_blk",
  165. .id = UCLASS_BLK,
  166. .ops = &mmc_blk_ops,
  167. };
  168. #endif /* CONFIG_BLK */
  169. U_BOOT_DRIVER(mmc) = {
  170. .name = "mmc",
  171. .id = UCLASS_MMC,
  172. };
  173. UCLASS_DRIVER(mmc) = {
  174. .id = UCLASS_MMC,
  175. .name = "mmc",
  176. .flags = DM_UC_FLAG_SEQ_ALIAS,
  177. .per_device_auto_alloc_size = sizeof(struct mmc_uclass_priv),
  178. };