18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci// 38c2ecf20Sopenharmony_ci// Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com/ 48c2ecf20Sopenharmony_ci// 58c2ecf20Sopenharmony_ci 68c2ecf20Sopenharmony_ci#include <linux/clk.h> 78c2ecf20Sopenharmony_ci#include <linux/io.h> 88c2ecf20Sopenharmony_ci#include <linux/kernel.h> 98c2ecf20Sopenharmony_ci#include <linux/module.h> 108c2ecf20Sopenharmony_ci#include <linux/of_platform.h> 118c2ecf20Sopenharmony_ci#include <linux/platform_device.h> 128c2ecf20Sopenharmony_ci#include <linux/pm_runtime.h> 138c2ecf20Sopenharmony_ci 148c2ecf20Sopenharmony_ci#define TI_UFS_SS_CTRL 0x4 158c2ecf20Sopenharmony_ci#define TI_UFS_SS_RST_N_PCS BIT(0) 168c2ecf20Sopenharmony_ci#define TI_UFS_SS_CLK_26MHZ BIT(4) 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_cistatic int ti_j721e_ufs_probe(struct platform_device *pdev) 198c2ecf20Sopenharmony_ci{ 208c2ecf20Sopenharmony_ci struct device *dev = &pdev->dev; 218c2ecf20Sopenharmony_ci unsigned long clk_rate; 228c2ecf20Sopenharmony_ci void __iomem *regbase; 238c2ecf20Sopenharmony_ci struct clk *clk; 248c2ecf20Sopenharmony_ci u32 reg = 0; 258c2ecf20Sopenharmony_ci int ret; 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_ci regbase = devm_platform_ioremap_resource(pdev, 0); 288c2ecf20Sopenharmony_ci if (IS_ERR(regbase)) 298c2ecf20Sopenharmony_ci return PTR_ERR(regbase); 308c2ecf20Sopenharmony_ci 318c2ecf20Sopenharmony_ci pm_runtime_enable(dev); 328c2ecf20Sopenharmony_ci ret = pm_runtime_resume_and_get(dev); 338c2ecf20Sopenharmony_ci if (ret < 0) 348c2ecf20Sopenharmony_ci goto disable_pm; 358c2ecf20Sopenharmony_ci 368c2ecf20Sopenharmony_ci /* Select MPHY refclk frequency */ 378c2ecf20Sopenharmony_ci clk = devm_clk_get(dev, NULL); 388c2ecf20Sopenharmony_ci if (IS_ERR(clk)) { 398c2ecf20Sopenharmony_ci ret = PTR_ERR(clk); 408c2ecf20Sopenharmony_ci dev_err(dev, "Cannot claim MPHY clock.\n"); 418c2ecf20Sopenharmony_ci goto clk_err; 428c2ecf20Sopenharmony_ci } 438c2ecf20Sopenharmony_ci clk_rate = clk_get_rate(clk); 448c2ecf20Sopenharmony_ci if (clk_rate == 26000000) 458c2ecf20Sopenharmony_ci reg |= TI_UFS_SS_CLK_26MHZ; 468c2ecf20Sopenharmony_ci devm_clk_put(dev, clk); 478c2ecf20Sopenharmony_ci 488c2ecf20Sopenharmony_ci /* Take UFS slave device out of reset */ 498c2ecf20Sopenharmony_ci reg |= TI_UFS_SS_RST_N_PCS; 508c2ecf20Sopenharmony_ci writel(reg, regbase + TI_UFS_SS_CTRL); 518c2ecf20Sopenharmony_ci 528c2ecf20Sopenharmony_ci ret = of_platform_populate(pdev->dev.of_node, NULL, NULL, 538c2ecf20Sopenharmony_ci dev); 548c2ecf20Sopenharmony_ci if (ret) { 558c2ecf20Sopenharmony_ci dev_err(dev, "failed to populate child nodes %d\n", ret); 568c2ecf20Sopenharmony_ci goto clk_err; 578c2ecf20Sopenharmony_ci } 588c2ecf20Sopenharmony_ci 598c2ecf20Sopenharmony_ci return ret; 608c2ecf20Sopenharmony_ci 618c2ecf20Sopenharmony_ciclk_err: 628c2ecf20Sopenharmony_ci pm_runtime_put_sync(dev); 638c2ecf20Sopenharmony_cidisable_pm: 648c2ecf20Sopenharmony_ci pm_runtime_disable(dev); 658c2ecf20Sopenharmony_ci return ret; 668c2ecf20Sopenharmony_ci} 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_cistatic int ti_j721e_ufs_remove(struct platform_device *pdev) 698c2ecf20Sopenharmony_ci{ 708c2ecf20Sopenharmony_ci of_platform_depopulate(&pdev->dev); 718c2ecf20Sopenharmony_ci pm_runtime_put_sync(&pdev->dev); 728c2ecf20Sopenharmony_ci pm_runtime_disable(&pdev->dev); 738c2ecf20Sopenharmony_ci 748c2ecf20Sopenharmony_ci return 0; 758c2ecf20Sopenharmony_ci} 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_cistatic const struct of_device_id ti_j721e_ufs_of_match[] = { 788c2ecf20Sopenharmony_ci { 798c2ecf20Sopenharmony_ci .compatible = "ti,j721e-ufs", 808c2ecf20Sopenharmony_ci }, 818c2ecf20Sopenharmony_ci { }, 828c2ecf20Sopenharmony_ci}; 838c2ecf20Sopenharmony_ci 848c2ecf20Sopenharmony_cistatic struct platform_driver ti_j721e_ufs_driver = { 858c2ecf20Sopenharmony_ci .probe = ti_j721e_ufs_probe, 868c2ecf20Sopenharmony_ci .remove = ti_j721e_ufs_remove, 878c2ecf20Sopenharmony_ci .driver = { 888c2ecf20Sopenharmony_ci .name = "ti-j721e-ufs", 898c2ecf20Sopenharmony_ci .of_match_table = ti_j721e_ufs_of_match, 908c2ecf20Sopenharmony_ci }, 918c2ecf20Sopenharmony_ci}; 928c2ecf20Sopenharmony_cimodule_platform_driver(ti_j721e_ufs_driver); 938c2ecf20Sopenharmony_ci 948c2ecf20Sopenharmony_ciMODULE_AUTHOR("Vignesh Raghavendra <vigneshr@ti.com>"); 958c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("TI UFS host controller glue driver"); 968c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL v2"); 97