1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com/
11 #define UFS_SS_CTRL 0x4
12 #define UFS_SS_RST_N_PCS BIT(0)
13 #define UFS_SS_CLK_26MHZ BIT(4)
15 static int ti_j721e_ufs_probe(struct udevice *dev)
23 ret = clk_get_by_index(dev, 0, &clk);
25 dev_err(dev, "failed to get M-PHY clock\n");
29 clock = clk_get_rate(&clk);
30 if (IS_ERR_VALUE(clock)) {
31 dev_err(dev, "failed to get rate\n");
35 base = dev_remap_addr_index(dev, 0);
37 if (clock == 26000000)
38 reg |= UFS_SS_CLK_26MHZ;
39 /* Take UFS slave device out of reset */
40 reg |= UFS_SS_RST_N_PCS;
41 writel(reg, base + UFS_SS_CTRL);
46 static int ti_j721e_ufs_remove(struct udevice *dev)
48 void __iomem *base = dev_remap_addr_index(dev, 0);
49 u32 reg = readl(base + UFS_SS_CTRL);
51 reg &= ~UFS_SS_RST_N_PCS;
52 writel(reg, base + UFS_SS_CTRL);
57 static const struct udevice_id ti_j721e_ufs_ids[] = {
59 .compatible = "ti,j721e-ufs",
64 U_BOOT_DRIVER(ti_j721e_ufs) = {
65 .name = "ti-j721e-ufs",
67 .of_match = ti_j721e_ufs_ids,
68 .probe = ti_j721e_ufs_probe,
69 .remove = ti_j721e_ufs_remove,
70 .flags = DM_FLAG_OS_PREPARE,