2 * Copyright (c) 2012-2015, The Linux Foundation. All rights reserved.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 and
6 * only version 2 as published by the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
16 static int dsi_pll_enable(struct msm_dsi_pll *pll)
21 * Certain PLLs do not allow VCO rate update when it is on.
22 * Keep track of their status to turn on/off after set rate success.
24 if (unlikely(pll->pll_on))
27 /* Try all enable sequences until one succeeds */
28 for (i = 0; i < pll->en_seq_cnt; i++) {
29 ret = pll->enable_seqs[i](pll);
30 DBG("DSI PLL %s after sequence #%d",
31 ret ? "unlocked" : "locked", i + 1);
37 DRM_ERROR("DSI PLL failed to lock\n");
46 static void dsi_pll_disable(struct msm_dsi_pll *pll)
48 if (unlikely(!pll->pll_on))
51 pll->disable_seq(pll);
57 * DSI PLL Helper functions
59 long msm_dsi_pll_helper_clk_round_rate(struct clk_hw *hw,
60 unsigned long rate, unsigned long *parent_rate)
62 struct msm_dsi_pll *pll = hw_clk_to_pll(hw);
64 if (rate < pll->min_rate)
66 else if (rate > pll->max_rate)
72 int msm_dsi_pll_helper_clk_prepare(struct clk_hw *hw)
74 struct msm_dsi_pll *pll = hw_clk_to_pll(hw);
76 return dsi_pll_enable(pll);
79 void msm_dsi_pll_helper_clk_unprepare(struct clk_hw *hw)
81 struct msm_dsi_pll *pll = hw_clk_to_pll(hw);
86 void msm_dsi_pll_helper_unregister_clks(struct platform_device *pdev,
87 struct clk **clks, u32 num_clks)
89 of_clk_del_provider(pdev->dev.of_node);
91 if (!num_clks || !clks)
95 clk_unregister(clks[--num_clks]);
96 clks[num_clks] = NULL;
103 int msm_dsi_pll_get_clk_provider(struct msm_dsi_pll *pll,
104 struct clk **byte_clk_provider, struct clk **pixel_clk_provider)
106 if (pll->get_provider)
107 return pll->get_provider(pll,
114 void msm_dsi_pll_destroy(struct msm_dsi_pll *pll)
120 void msm_dsi_pll_save_state(struct msm_dsi_pll *pll)
122 if (pll->save_state) {
123 pll->save_state(pll);
124 pll->state_saved = true;
128 int msm_dsi_pll_restore_state(struct msm_dsi_pll *pll)
132 if (pll->restore_state && pll->state_saved) {
133 ret = pll->restore_state(pll);
137 pll->state_saved = false;
143 struct msm_dsi_pll *msm_dsi_pll_init(struct platform_device *pdev,
144 enum msm_dsi_phy_type type, int id)
146 struct device *dev = &pdev->dev;
147 struct msm_dsi_pll *pll;
150 case MSM_DSI_PHY_28NM_HPM:
151 case MSM_DSI_PHY_28NM_LP:
152 pll = msm_dsi_pll_28nm_init(pdev, type, id);
155 pll = ERR_PTR(-ENXIO);
160 dev_err(dev, "%s: failed to init DSI PLL\n", __func__);
166 DBG("DSI:%d PLL registered", id);