162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci// 362306a36Sopenharmony_ci// Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com/ 462306a36Sopenharmony_ci// 562306a36Sopenharmony_ci 662306a36Sopenharmony_ci#include <linux/clk.h> 762306a36Sopenharmony_ci#include <linux/io.h> 862306a36Sopenharmony_ci#include <linux/kernel.h> 962306a36Sopenharmony_ci#include <linux/module.h> 1062306a36Sopenharmony_ci#include <linux/of_platform.h> 1162306a36Sopenharmony_ci#include <linux/platform_device.h> 1262306a36Sopenharmony_ci#include <linux/pm_runtime.h> 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#define TI_UFS_SS_CTRL 0x4 1562306a36Sopenharmony_ci#define TI_UFS_SS_RST_N_PCS BIT(0) 1662306a36Sopenharmony_ci#define TI_UFS_SS_CLK_26MHZ BIT(4) 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_cistatic int ti_j721e_ufs_probe(struct platform_device *pdev) 1962306a36Sopenharmony_ci{ 2062306a36Sopenharmony_ci struct device *dev = &pdev->dev; 2162306a36Sopenharmony_ci unsigned long clk_rate; 2262306a36Sopenharmony_ci void __iomem *regbase; 2362306a36Sopenharmony_ci struct clk *clk; 2462306a36Sopenharmony_ci u32 reg = 0; 2562306a36Sopenharmony_ci int ret; 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci regbase = devm_platform_ioremap_resource(pdev, 0); 2862306a36Sopenharmony_ci if (IS_ERR(regbase)) 2962306a36Sopenharmony_ci return PTR_ERR(regbase); 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci pm_runtime_enable(dev); 3262306a36Sopenharmony_ci ret = pm_runtime_resume_and_get(dev); 3362306a36Sopenharmony_ci if (ret < 0) 3462306a36Sopenharmony_ci goto disable_pm; 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_ci /* Select MPHY refclk frequency */ 3762306a36Sopenharmony_ci clk = devm_clk_get(dev, NULL); 3862306a36Sopenharmony_ci if (IS_ERR(clk)) { 3962306a36Sopenharmony_ci ret = PTR_ERR(clk); 4062306a36Sopenharmony_ci dev_err(dev, "Cannot claim MPHY clock.\n"); 4162306a36Sopenharmony_ci goto clk_err; 4262306a36Sopenharmony_ci } 4362306a36Sopenharmony_ci clk_rate = clk_get_rate(clk); 4462306a36Sopenharmony_ci if (clk_rate == 26000000) 4562306a36Sopenharmony_ci reg |= TI_UFS_SS_CLK_26MHZ; 4662306a36Sopenharmony_ci devm_clk_put(dev, clk); 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci /* Take UFS slave device out of reset */ 4962306a36Sopenharmony_ci reg |= TI_UFS_SS_RST_N_PCS; 5062306a36Sopenharmony_ci writel(reg, regbase + TI_UFS_SS_CTRL); 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_ci ret = of_platform_populate(pdev->dev.of_node, NULL, NULL, 5362306a36Sopenharmony_ci dev); 5462306a36Sopenharmony_ci if (ret) { 5562306a36Sopenharmony_ci dev_err(dev, "failed to populate child nodes %d\n", ret); 5662306a36Sopenharmony_ci goto clk_err; 5762306a36Sopenharmony_ci } 5862306a36Sopenharmony_ci 5962306a36Sopenharmony_ci return ret; 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ciclk_err: 6262306a36Sopenharmony_ci pm_runtime_put_sync(dev); 6362306a36Sopenharmony_cidisable_pm: 6462306a36Sopenharmony_ci pm_runtime_disable(dev); 6562306a36Sopenharmony_ci return ret; 6662306a36Sopenharmony_ci} 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_cistatic int ti_j721e_ufs_remove(struct platform_device *pdev) 6962306a36Sopenharmony_ci{ 7062306a36Sopenharmony_ci of_platform_depopulate(&pdev->dev); 7162306a36Sopenharmony_ci pm_runtime_put_sync(&pdev->dev); 7262306a36Sopenharmony_ci pm_runtime_disable(&pdev->dev); 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_ci return 0; 7562306a36Sopenharmony_ci} 7662306a36Sopenharmony_ci 7762306a36Sopenharmony_cistatic const struct of_device_id ti_j721e_ufs_of_match[] = { 7862306a36Sopenharmony_ci { 7962306a36Sopenharmony_ci .compatible = "ti,j721e-ufs", 8062306a36Sopenharmony_ci }, 8162306a36Sopenharmony_ci { }, 8262306a36Sopenharmony_ci}; 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, ti_j721e_ufs_of_match); 8562306a36Sopenharmony_ci 8662306a36Sopenharmony_cistatic struct platform_driver ti_j721e_ufs_driver = { 8762306a36Sopenharmony_ci .probe = ti_j721e_ufs_probe, 8862306a36Sopenharmony_ci .remove = ti_j721e_ufs_remove, 8962306a36Sopenharmony_ci .driver = { 9062306a36Sopenharmony_ci .name = "ti-j721e-ufs", 9162306a36Sopenharmony_ci .of_match_table = ti_j721e_ufs_of_match, 9262306a36Sopenharmony_ci }, 9362306a36Sopenharmony_ci}; 9462306a36Sopenharmony_cimodule_platform_driver(ti_j721e_ufs_driver); 9562306a36Sopenharmony_ci 9662306a36Sopenharmony_ciMODULE_AUTHOR("Vignesh Raghavendra <vigneshr@ti.com>"); 9762306a36Sopenharmony_ciMODULE_DESCRIPTION("TI UFS host controller glue driver"); 9862306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 99