mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-02 16:44:10 +08:00
phy: qcom-qmp-ufs: provide symbol clocks
Register three UFS symbol clocks (ufs_rx_symbol_0_clk_src, ufs_rx_symbol_1_clk_src ufs_tx_symbol_0_clk_src). Register OF clock provider to let other devices link these clocks through the DT. Signed-off-by: Dmitry Baryshkov <dmitry.baryshkov@linaro.org> Link: https://lore.kernel.org/r/20221123104443.3415267-3-dmitry.baryshkov@linaro.org Signed-off-by: Vinod Koul <vkoul@kernel.org>
This commit is contained in:
parent
521d431fca
commit
7bd7044fcd
@ -1021,6 +1021,59 @@ static int qmp_ufs_clk_init(struct qmp_ufs *qmp)
|
||||
return devm_clk_bulk_get(dev, num, qmp->clks);
|
||||
}
|
||||
|
||||
static void qmp_ufs_clk_release_provider(void *res)
|
||||
{
|
||||
of_clk_del_provider(res);
|
||||
}
|
||||
|
||||
#define UFS_SYMBOL_CLOCKS 3
|
||||
|
||||
static int qmp_ufs_register_clocks(struct qmp_ufs *qmp, struct device_node *np)
|
||||
{
|
||||
struct clk_hw_onecell_data *clk_data;
|
||||
struct clk_hw *hw;
|
||||
char name[64];
|
||||
int ret;
|
||||
|
||||
clk_data = devm_kzalloc(qmp->dev,
|
||||
struct_size(clk_data, hws, UFS_SYMBOL_CLOCKS),
|
||||
GFP_KERNEL);
|
||||
if (!clk_data)
|
||||
return -ENOMEM;
|
||||
|
||||
clk_data->num = UFS_SYMBOL_CLOCKS;
|
||||
|
||||
snprintf(name, sizeof(name), "%s::rx_symbol_0", dev_name(qmp->dev));
|
||||
hw = devm_clk_hw_register_fixed_rate(qmp->dev, name, NULL, 0, 0);
|
||||
if (IS_ERR(hw))
|
||||
return PTR_ERR(hw);
|
||||
|
||||
clk_data->hws[0] = hw;
|
||||
|
||||
snprintf(name, sizeof(name), "%s::rx_symbol_1", dev_name(qmp->dev));
|
||||
hw = devm_clk_hw_register_fixed_rate(qmp->dev, name, NULL, 0, 0);
|
||||
if (IS_ERR(hw))
|
||||
return PTR_ERR(hw);
|
||||
|
||||
clk_data->hws[1] = hw;
|
||||
|
||||
snprintf(name, sizeof(name), "%s::tx_symbol_0", dev_name(qmp->dev));
|
||||
hw = devm_clk_hw_register_fixed_rate(qmp->dev, name, NULL, 0, 0);
|
||||
if (IS_ERR(hw))
|
||||
return PTR_ERR(hw);
|
||||
|
||||
clk_data->hws[2] = hw;
|
||||
|
||||
ret = of_clk_add_hw_provider(np, of_clk_hw_onecell_get, clk_data);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/*
|
||||
* Roll a devm action because the clock provider can be a child node.
|
||||
*/
|
||||
return devm_add_action_or_reset(qmp->dev, qmp_ufs_clk_release_provider, np);
|
||||
}
|
||||
|
||||
static int qmp_ufs_parse_dt_legacy(struct qmp_ufs *qmp, struct device_node *np)
|
||||
{
|
||||
struct platform_device *pdev = to_platform_device(qmp->dev);
|
||||
@ -1133,6 +1186,10 @@ static int qmp_ufs_probe(struct platform_device *pdev)
|
||||
if (ret)
|
||||
goto err_node_put;
|
||||
|
||||
ret = qmp_ufs_register_clocks(qmp, np);
|
||||
if (ret)
|
||||
goto err_node_put;
|
||||
|
||||
qmp->phy = devm_phy_create(dev, np, &qcom_qmp_ufs_phy_ops);
|
||||
if (IS_ERR(qmp->phy)) {
|
||||
ret = PTR_ERR(qmp->phy);
|
||||
|
Loading…
Reference in New Issue
Block a user