1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun //
3*4882a593Smuzhiyun // Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com/
4*4882a593Smuzhiyun //
5*4882a593Smuzhiyun
6*4882a593Smuzhiyun #include <linux/clk.h>
7*4882a593Smuzhiyun #include <linux/io.h>
8*4882a593Smuzhiyun #include <linux/kernel.h>
9*4882a593Smuzhiyun #include <linux/module.h>
10*4882a593Smuzhiyun #include <linux/of_platform.h>
11*4882a593Smuzhiyun #include <linux/platform_device.h>
12*4882a593Smuzhiyun #include <linux/pm_runtime.h>
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun #define TI_UFS_SS_CTRL 0x4
15*4882a593Smuzhiyun #define TI_UFS_SS_RST_N_PCS BIT(0)
16*4882a593Smuzhiyun #define TI_UFS_SS_CLK_26MHZ BIT(4)
17*4882a593Smuzhiyun
ti_j721e_ufs_probe(struct platform_device * pdev)18*4882a593Smuzhiyun static int ti_j721e_ufs_probe(struct platform_device *pdev)
19*4882a593Smuzhiyun {
20*4882a593Smuzhiyun struct device *dev = &pdev->dev;
21*4882a593Smuzhiyun unsigned long clk_rate;
22*4882a593Smuzhiyun void __iomem *regbase;
23*4882a593Smuzhiyun struct clk *clk;
24*4882a593Smuzhiyun u32 reg = 0;
25*4882a593Smuzhiyun int ret;
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun regbase = devm_platform_ioremap_resource(pdev, 0);
28*4882a593Smuzhiyun if (IS_ERR(regbase))
29*4882a593Smuzhiyun return PTR_ERR(regbase);
30*4882a593Smuzhiyun
31*4882a593Smuzhiyun pm_runtime_enable(dev);
32*4882a593Smuzhiyun ret = pm_runtime_resume_and_get(dev);
33*4882a593Smuzhiyun if (ret < 0)
34*4882a593Smuzhiyun goto disable_pm;
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun /* Select MPHY refclk frequency */
37*4882a593Smuzhiyun clk = devm_clk_get(dev, NULL);
38*4882a593Smuzhiyun if (IS_ERR(clk)) {
39*4882a593Smuzhiyun ret = PTR_ERR(clk);
40*4882a593Smuzhiyun dev_err(dev, "Cannot claim MPHY clock.\n");
41*4882a593Smuzhiyun goto clk_err;
42*4882a593Smuzhiyun }
43*4882a593Smuzhiyun clk_rate = clk_get_rate(clk);
44*4882a593Smuzhiyun if (clk_rate == 26000000)
45*4882a593Smuzhiyun reg |= TI_UFS_SS_CLK_26MHZ;
46*4882a593Smuzhiyun devm_clk_put(dev, clk);
47*4882a593Smuzhiyun
48*4882a593Smuzhiyun /* Take UFS slave device out of reset */
49*4882a593Smuzhiyun reg |= TI_UFS_SS_RST_N_PCS;
50*4882a593Smuzhiyun writel(reg, regbase + TI_UFS_SS_CTRL);
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun ret = of_platform_populate(pdev->dev.of_node, NULL, NULL,
53*4882a593Smuzhiyun dev);
54*4882a593Smuzhiyun if (ret) {
55*4882a593Smuzhiyun dev_err(dev, "failed to populate child nodes %d\n", ret);
56*4882a593Smuzhiyun goto clk_err;
57*4882a593Smuzhiyun }
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun return ret;
60*4882a593Smuzhiyun
61*4882a593Smuzhiyun clk_err:
62*4882a593Smuzhiyun pm_runtime_put_sync(dev);
63*4882a593Smuzhiyun disable_pm:
64*4882a593Smuzhiyun pm_runtime_disable(dev);
65*4882a593Smuzhiyun return ret;
66*4882a593Smuzhiyun }
67*4882a593Smuzhiyun
ti_j721e_ufs_remove(struct platform_device * pdev)68*4882a593Smuzhiyun static int ti_j721e_ufs_remove(struct platform_device *pdev)
69*4882a593Smuzhiyun {
70*4882a593Smuzhiyun of_platform_depopulate(&pdev->dev);
71*4882a593Smuzhiyun pm_runtime_put_sync(&pdev->dev);
72*4882a593Smuzhiyun pm_runtime_disable(&pdev->dev);
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun return 0;
75*4882a593Smuzhiyun }
76*4882a593Smuzhiyun
77*4882a593Smuzhiyun static const struct of_device_id ti_j721e_ufs_of_match[] = {
78*4882a593Smuzhiyun {
79*4882a593Smuzhiyun .compatible = "ti,j721e-ufs",
80*4882a593Smuzhiyun },
81*4882a593Smuzhiyun { },
82*4882a593Smuzhiyun };
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun static struct platform_driver ti_j721e_ufs_driver = {
85*4882a593Smuzhiyun .probe = ti_j721e_ufs_probe,
86*4882a593Smuzhiyun .remove = ti_j721e_ufs_remove,
87*4882a593Smuzhiyun .driver = {
88*4882a593Smuzhiyun .name = "ti-j721e-ufs",
89*4882a593Smuzhiyun .of_match_table = ti_j721e_ufs_of_match,
90*4882a593Smuzhiyun },
91*4882a593Smuzhiyun };
92*4882a593Smuzhiyun module_platform_driver(ti_j721e_ufs_driver);
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun MODULE_AUTHOR("Vignesh Raghavendra <vigneshr@ti.com>");
95*4882a593Smuzhiyun MODULE_DESCRIPTION("TI UFS host controller glue driver");
96*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
97