mirror of
https://github.com/u-boot/u-boot.git
synced 2025-01-10 21:03:49 +08:00
854f9a71f5
This function is called when the MMC block device is being probed. There is a recursive call in this function since find_mmc_device() itself can cause the MMC device to be probed. Admittedly the MMC device should already be probed, since we would not be probing its child otherwise, but the current code is unnecessarily convoluted. Rewrite this to access the MMC structure directly. Signed-off-by: Simon Glass <sjg@chromium.org>
305 lines
5.7 KiB
C
305 lines
5.7 KiB
C
/*
|
|
* Copyright (C) 2015 Google, Inc
|
|
* Written by Simon Glass <sjg@chromium.org>
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <mmc.h>
|
|
#include <dm.h>
|
|
#include <dm/device-internal.h>
|
|
#include <dm/lists.h>
|
|
#include <dm/root.h>
|
|
#include "mmc_private.h"
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
#ifdef CONFIG_DM_MMC_OPS
|
|
int dm_mmc_send_cmd(struct udevice *dev, struct mmc_cmd *cmd,
|
|
struct mmc_data *data)
|
|
{
|
|
struct mmc *mmc = mmc_get_mmc_dev(dev);
|
|
struct dm_mmc_ops *ops = mmc_get_ops(dev);
|
|
int ret;
|
|
|
|
mmmc_trace_before_send(mmc, cmd);
|
|
if (ops->send_cmd)
|
|
ret = ops->send_cmd(dev, cmd, data);
|
|
else
|
|
ret = -ENOSYS;
|
|
mmmc_trace_after_send(mmc, cmd, ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd, struct mmc_data *data)
|
|
{
|
|
return dm_mmc_send_cmd(mmc->dev, cmd, data);
|
|
}
|
|
|
|
int dm_mmc_set_ios(struct udevice *dev)
|
|
{
|
|
struct dm_mmc_ops *ops = mmc_get_ops(dev);
|
|
|
|
if (!ops->set_ios)
|
|
return -ENOSYS;
|
|
return ops->set_ios(dev);
|
|
}
|
|
|
|
int mmc_set_ios(struct mmc *mmc)
|
|
{
|
|
return dm_mmc_set_ios(mmc->dev);
|
|
}
|
|
|
|
int dm_mmc_get_wp(struct udevice *dev)
|
|
{
|
|
struct dm_mmc_ops *ops = mmc_get_ops(dev);
|
|
|
|
if (!ops->get_wp)
|
|
return -ENOSYS;
|
|
return ops->get_wp(dev);
|
|
}
|
|
|
|
int mmc_getwp(struct mmc *mmc)
|
|
{
|
|
return dm_mmc_get_wp(mmc->dev);
|
|
}
|
|
|
|
int dm_mmc_get_cd(struct udevice *dev)
|
|
{
|
|
struct dm_mmc_ops *ops = mmc_get_ops(dev);
|
|
|
|
if (!ops->get_cd)
|
|
return -ENOSYS;
|
|
return ops->get_cd(dev);
|
|
}
|
|
|
|
int mmc_getcd(struct mmc *mmc)
|
|
{
|
|
return dm_mmc_get_cd(mmc->dev);
|
|
}
|
|
#endif
|
|
|
|
struct mmc *mmc_get_mmc_dev(struct udevice *dev)
|
|
{
|
|
struct mmc_uclass_priv *upriv;
|
|
|
|
if (!device_active(dev))
|
|
return NULL;
|
|
upriv = dev_get_uclass_priv(dev);
|
|
return upriv->mmc;
|
|
}
|
|
|
|
#ifdef CONFIG_BLK
|
|
struct mmc *find_mmc_device(int dev_num)
|
|
{
|
|
struct udevice *dev, *mmc_dev;
|
|
int ret;
|
|
|
|
ret = blk_get_device(IF_TYPE_MMC, dev_num, &dev);
|
|
|
|
if (ret) {
|
|
#if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
|
|
printf("MMC Device %d not found\n", dev_num);
|
|
#endif
|
|
return NULL;
|
|
}
|
|
|
|
mmc_dev = dev_get_parent(dev);
|
|
|
|
return mmc_get_mmc_dev(mmc_dev);
|
|
}
|
|
|
|
int get_mmc_num(void)
|
|
{
|
|
return max((blk_find_max_devnum(IF_TYPE_MMC) + 1), 0);
|
|
}
|
|
|
|
int mmc_get_next_devnum(void)
|
|
{
|
|
return blk_find_max_devnum(IF_TYPE_MMC);
|
|
}
|
|
|
|
struct blk_desc *mmc_get_blk_desc(struct mmc *mmc)
|
|
{
|
|
struct blk_desc *desc;
|
|
struct udevice *dev;
|
|
|
|
device_find_first_child(mmc->dev, &dev);
|
|
if (!dev)
|
|
return NULL;
|
|
desc = dev_get_uclass_platdata(dev);
|
|
|
|
return desc;
|
|
}
|
|
|
|
void mmc_do_preinit(void)
|
|
{
|
|
struct udevice *dev;
|
|
struct uclass *uc;
|
|
int ret;
|
|
|
|
ret = uclass_get(UCLASS_MMC, &uc);
|
|
if (ret)
|
|
return;
|
|
uclass_foreach_dev(dev, uc) {
|
|
struct mmc *m = mmc_get_mmc_dev(dev);
|
|
|
|
if (!m)
|
|
continue;
|
|
#ifdef CONFIG_FSL_ESDHC_ADAPTER_IDENT
|
|
mmc_set_preinit(m, 1);
|
|
#endif
|
|
if (m->preinit)
|
|
mmc_start_init(m);
|
|
}
|
|
}
|
|
|
|
#if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
|
|
void print_mmc_devices(char separator)
|
|
{
|
|
struct udevice *dev;
|
|
char *mmc_type;
|
|
bool first = true;
|
|
|
|
for (uclass_first_device(UCLASS_MMC, &dev);
|
|
dev;
|
|
uclass_next_device(&dev), first = false) {
|
|
struct mmc *m = mmc_get_mmc_dev(dev);
|
|
|
|
if (!first) {
|
|
printf("%c", separator);
|
|
if (separator != '\n')
|
|
puts(" ");
|
|
}
|
|
if (m->has_init)
|
|
mmc_type = IS_SD(m) ? "SD" : "eMMC";
|
|
else
|
|
mmc_type = NULL;
|
|
|
|
printf("%s: %d", m->cfg->name, mmc_get_blk_desc(m)->devnum);
|
|
if (mmc_type)
|
|
printf(" (%s)", mmc_type);
|
|
}
|
|
|
|
printf("\n");
|
|
}
|
|
|
|
#else
|
|
void print_mmc_devices(char separator) { }
|
|
#endif
|
|
|
|
int mmc_bind(struct udevice *dev, struct mmc *mmc, const struct mmc_config *cfg)
|
|
{
|
|
struct blk_desc *bdesc;
|
|
struct udevice *bdev;
|
|
int ret, devnum = -1;
|
|
|
|
#ifdef CONFIG_DM_MMC_OPS
|
|
if (!mmc_get_ops(dev))
|
|
return -ENOSYS;
|
|
#endif
|
|
#ifndef CONFIG_SPL_BUILD
|
|
/* Use the fixed index with aliase node's index */
|
|
fdtdec_get_alias_seq(gd->fdt_blob, "mmc", dev_of_offset(dev), &devnum);
|
|
#endif
|
|
|
|
ret = blk_create_devicef(dev, "mmc_blk", "blk", IF_TYPE_MMC,
|
|
devnum, 512, 0, &bdev);
|
|
if (ret) {
|
|
debug("Cannot create block device\n");
|
|
return ret;
|
|
}
|
|
bdesc = dev_get_uclass_platdata(bdev);
|
|
mmc->cfg = cfg;
|
|
mmc->priv = dev;
|
|
|
|
/* the following chunk was from mmc_register() */
|
|
|
|
/* Setup dsr related values */
|
|
mmc->dsr_imp = 0;
|
|
mmc->dsr = 0xffffffff;
|
|
/* Setup the universal parts of the block interface just once */
|
|
bdesc->removable = 1;
|
|
|
|
/* setup initial part type */
|
|
bdesc->part_type = cfg->part_type;
|
|
mmc->dev = dev;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mmc_unbind(struct udevice *dev)
|
|
{
|
|
struct udevice *bdev;
|
|
|
|
device_find_first_child(dev, &bdev);
|
|
if (bdev) {
|
|
device_remove(bdev, DM_REMOVE_NORMAL);
|
|
device_unbind(bdev);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int mmc_select_hwpart(struct udevice *bdev, int hwpart)
|
|
{
|
|
struct udevice *mmc_dev = dev_get_parent(bdev);
|
|
struct mmc *mmc = mmc_get_mmc_dev(mmc_dev);
|
|
struct blk_desc *desc = dev_get_uclass_platdata(bdev);
|
|
|
|
if (desc->hwpart == hwpart)
|
|
return 0;
|
|
|
|
if (mmc->part_config == MMCPART_NOAVAILABLE)
|
|
return -EMEDIUMTYPE;
|
|
|
|
return mmc_switch_part(mmc, hwpart);
|
|
}
|
|
|
|
static int mmc_blk_probe(struct udevice *dev)
|
|
{
|
|
struct udevice *mmc_dev = dev_get_parent(dev);
|
|
struct mmc_uclass_priv *upriv = dev_get_uclass_priv(mmc_dev);
|
|
struct mmc *mmc = upriv->mmc;
|
|
int ret;
|
|
|
|
ret = mmc_init(mmc);
|
|
if (ret) {
|
|
debug("%s: mmc_init() failed (err=%d)\n", __func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct blk_ops mmc_blk_ops = {
|
|
.read = mmc_bread,
|
|
#ifndef CONFIG_SPL_BUILD
|
|
.write = mmc_bwrite,
|
|
.erase = mmc_berase,
|
|
#endif
|
|
.select_hwpart = mmc_select_hwpart,
|
|
};
|
|
|
|
U_BOOT_DRIVER(mmc_blk) = {
|
|
.name = "mmc_blk",
|
|
.id = UCLASS_BLK,
|
|
.ops = &mmc_blk_ops,
|
|
.probe = mmc_blk_probe,
|
|
};
|
|
#endif /* CONFIG_BLK */
|
|
|
|
U_BOOT_DRIVER(mmc) = {
|
|
.name = "mmc",
|
|
.id = UCLASS_MMC,
|
|
};
|
|
|
|
UCLASS_DRIVER(mmc) = {
|
|
.id = UCLASS_MMC,
|
|
.name = "mmc",
|
|
.flags = DM_UC_FLAG_SEQ_ALIAS,
|
|
.per_device_auto_alloc_size = sizeof(struct mmc_uclass_priv),
|
|
};
|