smaeul-u-boot/drivers/ufs/ti-j721e-ufs.c
Tom Rini d678a59d2d Revert "Merge patch series "arm: dts: am62-beagleplay: Fix Beagleplay Ethernet""
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay
Ethernet"' I failed to notice that b4 noticed it was based on next and
so took that as the base commit and merged that part of next to master.

This reverts commit c8ffd1356d42223cbb8c86280a083cc3c93e6426, reversing
changes made to 2ee6f3a5f7550de3599faef9704e166e5dcace35.

Reported-by: Jonas Karlman <jonas@kwiboo.se>
Signed-off-by: Tom Rini <trini@konsulko.com>
2024-05-19 08:16:36 -06:00

75 lines
1.5 KiB
C

// SPDX-License-Identifier: GPL-2.0+
/*
* Copyright (C) 2019 Texas Instruments Incorporated - https://www.ti.com/
*/
#include <asm/io.h>
#include <clk.h>
#include <common.h>
#include <dm.h>
#include <dm/device_compat.h>
#include <linux/bitops.h>
#include <linux/err.h>
#define UFS_SS_CTRL 0x4
#define UFS_SS_RST_N_PCS BIT(0)
#define UFS_SS_CLK_26MHZ BIT(4)
static int ti_j721e_ufs_probe(struct udevice *dev)
{
void __iomem *base;
unsigned int clock;
struct clk clk;
u32 reg = 0;
int ret;
ret = clk_get_by_index(dev, 0, &clk);
if (ret) {
dev_err(dev, "failed to get M-PHY clock\n");
return ret;
}
clock = clk_get_rate(&clk);
if (IS_ERR_VALUE(clock)) {
dev_err(dev, "failed to get rate\n");
return ret;
}
base = dev_remap_addr_index(dev, 0);
if (clock == 26000000)
reg |= UFS_SS_CLK_26MHZ;
/* Take UFS slave device out of reset */
reg |= UFS_SS_RST_N_PCS;
writel(reg, base + UFS_SS_CTRL);
return 0;
}
static int ti_j721e_ufs_remove(struct udevice *dev)
{
void __iomem *base = dev_remap_addr_index(dev, 0);
u32 reg = readl(base + UFS_SS_CTRL);
reg &= ~UFS_SS_RST_N_PCS;
writel(reg, base + UFS_SS_CTRL);
return 0;
}
static const struct udevice_id ti_j721e_ufs_ids[] = {
{
.compatible = "ti,j721e-ufs",
},
{},
};
U_BOOT_DRIVER(ti_j721e_ufs) = {
.name = "ti-j721e-ufs",
.id = UCLASS_MISC,
.of_match = ti_j721e_ufs_ids,
.probe = ti_j721e_ufs_probe,
.remove = ti_j721e_ufs_remove,
.flags = DM_FLAG_OS_PREPARE,
};