summaryrefslogtreecommitdiff
path: root/drivers/clk
diff options
context:
space:
mode:
authorVeera Sundaram Sankaran <veeras@codeaurora.org>2015-04-14 18:21:49 -0700
committerDavid Keitel <dkeitel@codeaurora.org>2016-03-23 20:41:45 -0700
commit56c32840d45d088cee2d5f8fc948db6fa43eb36d (patch)
treecbd5fc65e723ecc5ecd141c614e3c663dd773fea /drivers/clk
parent62a635513878360feff57e9dfa8b7102ec99d593 (diff)
clk: mdss: Remove pll support for all targets except msm8996
As part of 3.18 upgrade, remove support pll support for all other targets except msm8996. Change-Id: Idc778ccba25ce22ad7e418c45f2bd8d21ccb95e8 Signed-off-by: Veera Sundaram Sankaran <veeras@codeaurora.org>
Diffstat (limited to 'drivers/clk')
-rw-r--r--drivers/clk/msm/mdss/Makefile7
-rw-r--r--drivers/clk/msm/mdss/mdss-dsi-20nm-pll-util.c1011
-rw-r--r--drivers/clk/msm/mdss/mdss-dsi-pll-20nm.c608
-rw-r--r--drivers/clk/msm/mdss/mdss-dsi-pll-28hpm.c335
-rw-r--r--drivers/clk/msm/mdss/mdss-dsi-pll-28lpm.c306
-rw-r--r--drivers/clk/msm/mdss/mdss-dsi-pll-util.c588
-rw-r--r--drivers/clk/msm/mdss/mdss-dsi-pll.h8
-rw-r--r--drivers/clk/msm/mdss/mdss-edp-pll-28hpm.c594
-rw-r--r--drivers/clk/msm/mdss/mdss-edp-pll.h27
-rw-r--r--drivers/clk/msm/mdss/mdss-hdmi-pll-20nm.c974
-rw-r--r--drivers/clk/msm/mdss/mdss-hdmi-pll-28hpm.c1104
-rw-r--r--drivers/clk/msm/mdss/mdss-pll.c84
-rw-r--r--drivers/clk/msm/mdss/mdss-pll.h12
13 files changed, 9 insertions, 5649 deletions
diff --git a/drivers/clk/msm/mdss/Makefile b/drivers/clk/msm/mdss/Makefile
index f3d6106facde..75891dc10dda 100644
--- a/drivers/clk/msm/mdss/Makefile
+++ b/drivers/clk/msm/mdss/Makefile
@@ -1,12 +1,5 @@
obj-$(CONFIG_MSM_MDSS_PLL) += mdss-pll-util.o
obj-$(CONFIG_MSM_MDSS_PLL) += mdss-pll.o
-obj-$(CONFIG_MSM_MDSS_PLL) += mdss-dsi-pll-util.o mdss-dsi-20nm-pll-util.o
-obj-$(CONFIG_MSM_MDSS_PLL) += mdss-dsi-pll-28hpm.o
-obj-$(CONFIG_MSM_MDSS_PLL) += mdss-dsi-pll-28lpm.o
-obj-$(CONFIG_MSM_MDSS_PLL) += mdss-dsi-pll-20nm.o
obj-$(CONFIG_MSM_MDSS_PLL) += mdss-dsi-pll-8996.o
obj-$(CONFIG_MSM_MDSS_PLL) += mdss-dsi-pll-8996-util.o
-obj-$(CONFIG_MSM_MDSS_PLL) += mdss-edp-pll-28hpm.o
-obj-$(CONFIG_MSM_MDSS_PLL) += mdss-hdmi-pll-28hpm.o
-obj-$(CONFIG_MSM_MDSS_PLL) += mdss-hdmi-pll-20nm.o
obj-$(CONFIG_MSM_MDSS_PLL) += mdss-hdmi-pll-8996.o
diff --git a/drivers/clk/msm/mdss/mdss-dsi-20nm-pll-util.c b/drivers/clk/msm/mdss/mdss-dsi-20nm-pll-util.c
deleted file mode 100644
index b3b334f18e61..000000000000
--- a/drivers/clk/msm/mdss/mdss-dsi-20nm-pll-util.c
+++ /dev/null
@@ -1,1011 +0,0 @@
-/* Copyright (c) 2014-2015, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- */
-
-#define pr_fmt(fmt) "%s: " fmt, __func__
-
-#include <linux/kernel.h>
-#include <linux/err.h>
-#include <linux/iopoll.h>
-#include <linux/delay.h>
-#include <linux/clk/msm-clock-generic.h>
-
-#include "mdss-pll.h"
-#include "mdss-dsi-pll.h"
-
-#define MMSS_DSI_PHY_PLL_SYS_CLK_CTRL 0x0000
-#define MMSS_DSI_PHY_PLL_PLL_VCOTAIL_EN 0x0004
-#define MMSS_DSI_PHY_PLL_CMN_MODE 0x0008
-#define MMSS_DSI_PHY_PLL_IE_TRIM 0x000C
-#define MMSS_DSI_PHY_PLL_IP_TRIM 0x0010
-
-#define MMSS_DSI_PHY_PLL_PLL_PHSEL_CONTROL 0x0018
-#define MMSS_DSI_PHY_PLL_IPTAT_TRIM_VCCA_TX_SEL 0x001C
-#define MMSS_DSI_PHY_PLL_PLL_PHSEL_DC 0x0020
-#define MMSS_DSI_PHY_PLL_PLL_IP_SETI 0x0024
-#define MMSS_DSI_PHY_PLL_CORE_CLK_IN_SYNC_SEL 0x0028
-
-#define MMSS_DSI_PHY_PLL_BIAS_EN_CLKBUFLR_EN 0x0030
-#define MMSS_DSI_PHY_PLL_PLL_CP_SETI 0x0034
-#define MMSS_DSI_PHY_PLL_PLL_IP_SETP 0x0038
-#define MMSS_DSI_PHY_PLL_PLL_CP_SETP 0x003C
-#define MMSS_DSI_PHY_PLL_ATB_SEL1 0x0040
-#define MMSS_DSI_PHY_PLL_ATB_SEL2 0x0044
-#define MMSS_DSI_PHY_PLL_SYSCLK_EN_SEL_TXBAND 0x0048
-#define MMSS_DSI_PHY_PLL_RESETSM_CNTRL 0x004C
-#define MMSS_DSI_PHY_PLL_RESETSM_CNTRL2 0x0050
-#define MMSS_DSI_PHY_PLL_RESETSM_CNTRL3 0x0054
-#define MMSS_DSI_PHY_PLL_RESETSM_PLL_CAL_COUNT1 0x0058
-#define MMSS_DSI_PHY_PLL_RESETSM_PLL_CAL_COUNT2 0x005C
-#define MMSS_DSI_PHY_PLL_DIV_REF1 0x0060
-#define MMSS_DSI_PHY_PLL_DIV_REF2 0x0064
-#define MMSS_DSI_PHY_PLL_KVCO_COUNT1 0x0068
-#define MMSS_DSI_PHY_PLL_KVCO_COUNT2 0x006C
-#define MMSS_DSI_PHY_PLL_KVCO_CAL_CNTRL 0x0070
-#define MMSS_DSI_PHY_PLL_KVCO_CODE 0x0074
-#define MMSS_DSI_PHY_PLL_VREF_CFG1 0x0078
-#define MMSS_DSI_PHY_PLL_VREF_CFG2 0x007C
-#define MMSS_DSI_PHY_PLL_VREF_CFG3 0x0080
-#define MMSS_DSI_PHY_PLL_VREF_CFG4 0x0084
-#define MMSS_DSI_PHY_PLL_VREF_CFG5 0x0088
-#define MMSS_DSI_PHY_PLL_VREF_CFG6 0x008C
-#define MMSS_DSI_PHY_PLL_PLLLOCK_CMP1 0x0090
-#define MMSS_DSI_PHY_PLL_PLLLOCK_CMP2 0x0094
-#define MMSS_DSI_PHY_PLL_PLLLOCK_CMP3 0x0098
-
-#define MMSS_DSI_PHY_PLL_BGTC 0x00A0
-#define MMSS_DSI_PHY_PLL_PLL_TEST_UPDN 0x00A4
-#define MMSS_DSI_PHY_PLL_PLL_VCO_TUNE 0x00A8
-#define MMSS_DSI_PHY_PLL_DEC_START1 0x00AC
-#define MMSS_DSI_PHY_PLL_PLL_AMP_OS 0x00B0
-#define MMSS_DSI_PHY_PLL_SSC_EN_CENTER 0x00B4
-#define MMSS_DSI_PHY_PLL_SSC_ADJ_PER1 0x00B8
-#define MMSS_DSI_PHY_PLL_SSC_ADJ_PER2 0x00BC
-#define MMSS_DSI_PHY_PLL_SSC_PER1 0x00C0
-#define MMSS_DSI_PHY_PLL_SSC_PER2 0x00C4
-#define MMSS_DSI_PHY_PLL_SSC_STEP_SIZE1 0x00C8
-#define MMSS_DSI_PHY_PLL_SSC_STEP_SIZE2 0x00CC
-#define MMSS_DSI_PHY_PLL_RES_CODE_UP 0x00D0
-#define MMSS_DSI_PHY_PLL_RES_CODE_DN 0x00D4
-#define MMSS_DSI_PHY_PLL_RES_CODE_UP_OFFSET 0x00D8
-#define MMSS_DSI_PHY_PLL_RES_CODE_DN_OFFSET 0x00DC
-#define MMSS_DSI_PHY_PLL_RES_CODE_START_SEG1 0x00E0
-#define MMSS_DSI_PHY_PLL_RES_CODE_START_SEG2 0x00E4
-#define MMSS_DSI_PHY_PLL_RES_CODE_CAL_CSR 0x00E8
-#define MMSS_DSI_PHY_PLL_RES_CODE 0x00EC
-#define MMSS_DSI_PHY_PLL_RES_TRIM_CONTROL 0x00F0
-#define MMSS_DSI_PHY_PLL_RES_TRIM_CONTROL2 0x00F4
-#define MMSS_DSI_PHY_PLL_RES_TRIM_EN_VCOCALDONE 0x00F8
-#define MMSS_DSI_PHY_PLL_FAUX_EN 0x00FC
-
-#define MMSS_DSI_PHY_PLL_DIV_FRAC_START1 0x0100
-#define MMSS_DSI_PHY_PLL_DIV_FRAC_START2 0x0104
-#define MMSS_DSI_PHY_PLL_DIV_FRAC_START3 0x0108
-#define MMSS_DSI_PHY_PLL_DEC_START2 0x010C
-#define MMSS_DSI_PHY_PLL_PLL_RXTXEPCLK_EN 0x0110
-#define MMSS_DSI_PHY_PLL_PLL_CRCTRL 0x0114
-#define MMSS_DSI_PHY_PLL_LOW_POWER_RO_CONTROL 0x013C
-#define MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL 0x0140
-#define MMSS_DSI_PHY_PLL_HR_OCLK2_DIVIDER 0x0144
-#define MMSS_DSI_PHY_PLL_HR_OCLK3_DIVIDER 0x0148
-#define MMSS_DSI_PHY_PLL_PLL_VCO_HIGH 0x014C
-#define MMSS_DSI_PHY_PLL_RESET_SM 0x0150
-#define MMSS_DSI_PHY_PLL_MUXVAL 0x0154
-#define MMSS_DSI_PHY_PLL_CORE_RES_CODE_DN 0x0158
-#define MMSS_DSI_PHY_PLL_CORE_RES_CODE_UP 0x015C
-#define MMSS_DSI_PHY_PLL_CORE_VCO_TUNE 0x0160
-#define MMSS_DSI_PHY_PLL_CORE_VCO_TAIL 0x0164
-#define MMSS_DSI_PHY_PLL_CORE_KVCO_CODE 0x0168
-
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL0 0x014
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL1 0x018
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL2 0x01C
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL3 0x020
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL4 0x024
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL5 0x028
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL6 0x02C
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL7 0x030
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL8 0x034
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL9 0x038
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL10 0x03C
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL11 0x040
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL12 0x044
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL13 0x048
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL14 0x04C
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL15 0x050
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL16 0x054
-#define MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL17 0x058
-
-#define DSI_PLL_POLL_DELAY_US 1000
-#define DSI_PLL_POLL_TIMEOUT_US 15000
-
-int set_mdss_byte_mux_sel(struct mux_clk *clk, int sel)
-{
- return 0;
-}
-
-int get_mdss_byte_mux_sel(struct mux_clk *clk)
-{
- return 0;
-}
-
-int set_mdss_pixel_mux_sel(struct mux_clk *clk, int sel)
-{
- return 0;
-}
-
-int get_mdss_pixel_mux_sel(struct mux_clk *clk)
-{
- return 0;
-}
-
-static void pll_20nm_cache_trim_codes(struct mdss_pll_resources *dsi_pll_res)
-{
- int rc;
-
- if (dsi_pll_res->reg_upd)
- return;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return;
- }
-
- dsi_pll_res->cache_pll_trim_codes[0] =
- MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_CORE_KVCO_CODE);
- dsi_pll_res->cache_pll_trim_codes[1] =
- MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_CORE_VCO_TUNE);
-
- pr_debug("core_kvco_code=0x%x core_vco_turn=0x%x\n",
- dsi_pll_res->cache_pll_trim_codes[0],
- dsi_pll_res->cache_pll_trim_codes[1]);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
-
- dsi_pll_res->reg_upd = true;
-}
-
-static void pll_20nm_override_trim_codes(struct mdss_pll_resources *dsi_pll_res)
-{
- u32 reg_data;
- void __iomem *pll_base = dsi_pll_res->pll_base;
-
- /*
- * Override mux config for all cached trim codes from
- * saved config except for VCO Tune
- */
- reg_data = (dsi_pll_res->cache_pll_trim_codes[0] & 0x3f) | BIT(5);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_KVCO_CODE, reg_data);
-
- reg_data = (dsi_pll_res->cache_pll_trim_codes[1] & 0x7f) | BIT(7);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_VCO_TUNE, reg_data);
-}
-
-
-int set_bypass_lp_div_mux_sel(struct mux_clk *clk, int sel)
-{
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
- int reg_data;
-
- pr_debug("bypass_lp_div mux set to %s mode\n",
- sel ? "indirect" : "direct");
-
- pr_debug("POST_DIVIDER_CONTROL = 0x%x\n",
- MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL));
-
- reg_data = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL);
- reg_data |= BIT(7);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL,
- reg_data | (sel << 5));
- pr_debug("POST_DIVIDER_CONTROL = 0x%x\n",
- MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL));
-
- return 0;
-}
-
-int set_shadow_bypass_lp_div_mux_sel(struct mux_clk *clk, int sel)
-{
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
- int reg_data, rem;
-
- if (!dsi_pll_res->resource_enable) {
- pr_err("PLL resources disabled. Dynamic fps invalid\n");
- return -EINVAL;
- }
-
- reg_data = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL);
- reg_data |= BIT(7);
-
- pr_debug("%d: reg_data = %x\n", __LINE__, reg_data);
-
- /* Repeat POST DIVIDER 2 times (4 writes)*/
- for (rem = 0; rem < 2; rem++)
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL16 + (4 * rem),
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL,
- (reg_data | (sel << 5)), (reg_data | (sel << 5)));
-
- return 0;
-}
-
-int get_bypass_lp_div_mux_sel(struct mux_clk *clk)
-{
- int mux_mode, rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- mux_mode = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL) & BIT(5);
-
- pr_debug("bypass_lp_div mux mode = %s",
- mux_mode ? "indirect" : "direct");
- mdss_pll_resource_enable(dsi_pll_res, false);
-
- return !!mux_mode;
-}
-
-int ndiv_set_div(struct div_clk *clk, int div)
-{
- int rc, reg_data;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- reg_data = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL,
- reg_data | div);
-
- pr_debug("POST_DIVIDER_CONTROL = 0x%x\n",
- MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL));
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-int shadow_ndiv_set_div(struct div_clk *clk, int div)
-{
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (!dsi_pll_res->resource_enable) {
- pr_err("PLL resources disabled. Dynamic fps invalid\n");
- return -EINVAL;
- }
-
- pr_debug("%d div=%i\n", __LINE__, div);
-
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL14,
- MMSS_DSI_PHY_PLL_RESETSM_CNTRL3,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL,
- 0x07, (0xB | div));
-
- return 0;
-}
-
-int ndiv_get_div(struct div_clk *clk)
-{
- int div = 0, rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(clk->priv, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- div = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL) & 0x0F;
-
- mdss_pll_resource_enable(dsi_pll_res, false);
-
- return div;
-}
-
-int fixed_hr_oclk2_set_div(struct div_clk *clk, int div)
-{
- int rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_HR_OCLK2_DIVIDER,
- (div - 1));
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-int shadow_fixed_hr_oclk2_set_div(struct div_clk *clk, int div)
-{
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (!dsi_pll_res->resource_enable) {
- pr_err("PLL resources disabled. Dynamic fps invalid\n");
- return -EINVAL;
- }
- pr_debug("%d div = %d\n", __LINE__, div);
-
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL5,
- MMSS_DSI_PHY_PLL_HR_OCLK2_DIVIDER,
- MMSS_DSI_PHY_PLL_HR_OCLK2_DIVIDER,
- (div - 1), (div - 1));
-
- return 0;
-}
-
-int fixed_hr_oclk2_get_div(struct div_clk *clk)
-{
- int div = 0, rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- div = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_HR_OCLK2_DIVIDER);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return div + 1;
-}
-
-int hr_oclk3_set_div(struct div_clk *clk, int div)
-{
- int rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- pr_debug("%d div = %d\n", __LINE__, div);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_HR_OCLK3_DIVIDER,
- (div - 1));
- pr_debug("%s: HR_OCLK3_DIVIDER = 0x%x\n", __func__,
- MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_HR_OCLK3_DIVIDER));
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-int shadow_hr_oclk3_set_div(struct div_clk *clk, int div)
-{
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (!dsi_pll_res->resource_enable) {
- pr_err("PLL resources disabled. Dynamic fps invalid\n");
- return -EINVAL;
- }
-
- pr_debug("%d div = %d\n", __LINE__, div);
-
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL6,
- MMSS_DSI_PHY_PLL_HR_OCLK3_DIVIDER,
- MMSS_DSI_PHY_PLL_HR_OCLK3_DIVIDER,
- (div - 1), (div - 1));
-
- return 0;
-}
-
-int hr_oclk3_get_div(struct div_clk *clk)
-{
- int div = 0, rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- div = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_HR_OCLK3_DIVIDER);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return div + 1;
-}
-
-static bool pll_20nm_is_pll_locked(struct mdss_pll_resources *dsi_pll_res)
-{
- u32 status;
- bool pll_locked;
-
- /* poll for PLL ready status */
- if (readl_poll_timeout_atomic((dsi_pll_res->pll_base +
- MMSS_DSI_PHY_PLL_RESET_SM),
- status,
- ((status & BIT(5)) > 0),
- DSI_PLL_POLL_DELAY_US,
- DSI_PLL_POLL_TIMEOUT_US)) {
- pr_debug("DSI PLL status=%x failed to Lock\n", status);
- pll_locked = false;
- } else if (readl_poll_timeout_atomic((dsi_pll_res->pll_base +
- MMSS_DSI_PHY_PLL_RESET_SM),
- status,
- ((status & BIT(6)) > 0),
- DSI_PLL_POLL_DELAY_US,
- DSI_PLL_POLL_TIMEOUT_US)) {
- pr_debug("DSI PLL status=%x PLl not ready\n", status);
- pll_locked = false;
- } else {
- pll_locked = true;
- }
-
- return pll_locked;
-}
-
-void __dsi_pll_disable(void __iomem *pll_base)
-{
- if (!pll_base) {
- pr_err("Invalid pll base.\n");
- return;
- }
- pr_debug("Disabling PHY PLL for PLL_BASE=%p\n", pll_base);
-
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_VCOTAIL_EN, 0x02);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_RESETSM_CNTRL3, 0x06);
-}
-
-static void pll_20nm_config_powerdown(void __iomem *pll_base)
-{
- if (!pll_base) {
- pr_err("Invalid pll base.\n");
- return;
- }
-
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_SYS_CLK_CTRL, 0x00);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_CMN_MODE, 0x01);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_VCOTAIL_EN, 0x82);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_BIAS_EN_CLKBUFLR_EN, 0x02);
-}
-
-static int dsi_pll_enable(struct clk *c)
-{
- int i, rc;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- /* Try all enable sequences until one succeeds */
- for (i = 0; i < vco->pll_en_seq_cnt; i++) {
- rc = vco->pll_enable_seqs[i](dsi_pll_res);
- pr_debug("DSI PLL %s after sequence #%d\n",
- rc ? "unlocked" : "locked", i + 1);
- if (!rc)
- break;
- }
- /* Disable PLL1 to avoid current leakage while toggling MDSS GDSC */
- if (dsi_pll_res->pll_1_base)
- pll_20nm_config_powerdown(dsi_pll_res->pll_1_base);
-
- if (rc) {
- mdss_pll_resource_enable(dsi_pll_res, false);
- pr_err("DSI PLL failed to lock\n");
- }
- dsi_pll_res->pll_on = true;
-
- return rc;
-}
-
-static void dsi_pll_disable(struct clk *c)
-{
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (!dsi_pll_res->pll_on &&
- mdss_pll_resource_enable(dsi_pll_res, true)) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return;
- }
-
- dsi_pll_res->handoff_resources = false;
-
- __dsi_pll_disable(dsi_pll_res->pll_base);
-
- /* Disable PLL1 to avoid current leakage while toggling MDSS GDSC */
- if (dsi_pll_res->pll_1_base)
- pll_20nm_config_powerdown(dsi_pll_res->pll_1_base);
-
- pll_20nm_config_powerdown(dsi_pll_res->pll_base);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
-
- dsi_pll_res->pll_on = false;
-
- pr_debug("DSI PLL Disabled\n");
- return;
-}
-
-static void pll_20nm_config_common_block_1(void __iomem *pll_base)
-{
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_VCOTAIL_EN, 0x82);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_BIAS_EN_CLKBUFLR_EN, 0x2a);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_BIAS_EN_CLKBUFLR_EN, 0x2b);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_RESETSM_CNTRL3, 0x02);
-}
-
-static void pll_20nm_config_common_block_2(void __iomem *pll_base)
-{
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_SYS_CLK_CTRL, 0x40);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_IE_TRIM, 0x0F);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_IP_TRIM, 0x0F);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_PHSEL_CONTROL, 0x08);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_IPTAT_TRIM_VCCA_TX_SEL, 0x0E);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_BKG_KVCO_CAL_EN, 0x08);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_SYSCLK_EN_SEL_TXBAND, 0x4A);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_DIV_REF1, 0x00);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_DIV_REF2, 0x01);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_CNTRL, 0x07);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_KVCO_CAL_CNTRL, 0x1f);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_KVCO_COUNT1, 0x8A);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_VREF_CFG3, 0x10);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_SSC_EN_CENTER, 0x00);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_FAUX_EN, 0x0C);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_RXTXEPCLK_EN, 0x0a);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_LOW_POWER_RO_CONTROL, 0x0f);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_CMN_MODE, 0x00);
-}
-
-static void pll_20nm_config_loop_bw(void __iomem *pll_base)
-{
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_IP_SETI, 0x03);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_CP_SETI, 0x3F);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_IP_SETP, 0x03);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_CP_SETP, 0x1F);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_CRCTRL, 0x77);
-}
-
-static void pll_20nm_vco_rate_calc(struct mdss_pll_vco_calc *vco_calc,
- s64 vco_clk_rate, s64 ref_clk_rate)
-{
- s64 multiplier = (1 << 20);
- s64 duration = 1024, pll_comp_val;
- s64 dec_start_multiple, dec_start;
- s32 div_frac_start;
- s64 dec_start1, dec_start2;
- s32 div_frac_start1, div_frac_start2, div_frac_start3;
- s64 pll_plllock_cmp1, pll_plllock_cmp2, pll_plllock_cmp3;
-
- memset(vco_calc, 0, sizeof(*vco_calc));
- pr_debug("vco_clk_rate=%lld ref_clk_rate=%lld\n", vco_clk_rate,
- ref_clk_rate);
-
- dec_start_multiple = div_s64(vco_clk_rate * multiplier,
- 2 * ref_clk_rate);
- div_s64_rem(dec_start_multiple,
- multiplier, &div_frac_start);
-
- dec_start = div_s64(dec_start_multiple, multiplier);
- dec_start1 = (dec_start & 0x7f) | BIT(7);
- dec_start2 = ((dec_start & 0x80) >> 7) | BIT(1);
- div_frac_start1 = (div_frac_start & 0x7f) | BIT(7);
- div_frac_start2 = ((div_frac_start >> 7) & 0x7f) | BIT(7);
- div_frac_start3 = ((div_frac_start >> 14) & 0x3f) | BIT(6);
- pll_comp_val = (div_s64(dec_start_multiple * 2 * duration,
- 10 * multiplier)) - 1;
- pll_plllock_cmp1 = pll_comp_val & 0xff;
- pll_plllock_cmp2 = (pll_comp_val >> 8) & 0xff;
- pll_plllock_cmp3 = (pll_comp_val >> 16) & 0xff;
-
- pr_debug("dec_start_multiple = 0x%llx\n", dec_start_multiple);
- pr_debug("dec_start = 0x%llx, div_frac_start = 0x%x\n",
- dec_start, div_frac_start);
- pr_debug("dec_start1 = 0x%llx, dec_start2 = 0x%llx\n",
- dec_start1, dec_start2);
- pr_debug("div_frac_start1 = 0x%x, div_frac_start2 = 0x%x\n",
- div_frac_start1, div_frac_start2);
- pr_debug("div_frac_start3 = 0x%x\n", div_frac_start3);
- pr_debug("pll_comp_val = 0x%llx\n", pll_comp_val);
- pr_debug("pll_plllock_cmp1 = 0x%llx, pll_plllock_cmp2 =%llx\n",
- pll_plllock_cmp1, pll_plllock_cmp2);
- pr_debug("pll_plllock_cmp3 = 0x%llx\n", pll_plllock_cmp3);
-
- /* Assign to vco struct */
- vco_calc->div_frac_start1 = div_frac_start1;
- vco_calc->div_frac_start2 = div_frac_start2;
- vco_calc->div_frac_start3 = div_frac_start3;
- vco_calc->dec_start1 = dec_start1;
- vco_calc->dec_start2 = dec_start2;
- vco_calc->pll_plllock_cmp1 = pll_plllock_cmp1;
- vco_calc->pll_plllock_cmp2 = pll_plllock_cmp2;
- vco_calc->pll_plllock_cmp3 = pll_plllock_cmp3;
-}
-
-static void pll_20nm_config_vco_rate(void __iomem *pll_base,
- struct mdss_pll_vco_calc *vco_calc)
-{
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_DIV_FRAC_START1,
- vco_calc->div_frac_start1);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_DIV_FRAC_START2,
- vco_calc->div_frac_start2);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_DIV_FRAC_START3,
- vco_calc->div_frac_start3);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_DEC_START1,
- vco_calc->dec_start1);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_DEC_START2,
- vco_calc->dec_start2);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLLLOCK_CMP1,
- vco_calc->pll_plllock_cmp1);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLLLOCK_CMP2,
- vco_calc->pll_plllock_cmp2);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLLLOCK_CMP3,
- vco_calc->pll_plllock_cmp3);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLLLOCK_CMP_EN, 0x01);
-}
-
-int pll_20nm_vco_set_rate(struct dsi_pll_vco_clk *vco, unsigned long rate)
-{
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- dsi_pll_res->vco_current_rate = rate;
- dsi_pll_res->vco_ref_clk_rate = vco->ref_clk_rate;
-
- return 0;
-}
-
-int shadow_pll_20nm_vco_set_rate(struct dsi_pll_vco_clk *vco,
- unsigned long rate)
-{
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
- struct mdss_pll_vco_calc vco_calc;
- s64 vco_clk_rate = rate;
- u32 rem;
-
- if (!dsi_pll_res->resource_enable) {
- pr_err("PLL resources disabled. Dynamic fps invalid\n");
- return -EINVAL;
- }
-
- pr_debug("req vco set rate: %lld\n", vco_clk_rate);
-
- pll_20nm_override_trim_codes(dsi_pll_res);
-
- /* div fraction, start and comp calculations */
- pll_20nm_vco_rate_calc(&vco_calc, vco_clk_rate,
- dsi_pll_res->vco_ref_clk_rate);
-
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL0,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL,
- MMSS_DSI_PHY_PLL_PLLLOCK_CMP_EN,
- 0xB1, 0);
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL1,
- MMSS_DSI_PHY_PLL_PLLLOCK_CMP1,
- MMSS_DSI_PHY_PLL_PLLLOCK_CMP2,
- vco_calc.pll_plllock_cmp1, vco_calc.pll_plllock_cmp2);
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL2,
- MMSS_DSI_PHY_PLL_PLLLOCK_CMP3,
- MMSS_DSI_PHY_PLL_DEC_START1,
- vco_calc.pll_plllock_cmp3, vco_calc.dec_start1);
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL3,
- MMSS_DSI_PHY_PLL_DEC_START2,
- MMSS_DSI_PHY_PLL_DIV_FRAC_START1,
- vco_calc.dec_start2, vco_calc.div_frac_start1);
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL4,
- MMSS_DSI_PHY_PLL_DIV_FRAC_START2,
- MMSS_DSI_PHY_PLL_DIV_FRAC_START3,
- vco_calc.div_frac_start2, vco_calc.div_frac_start3);
- /* Method 2 - Auto PLL calibration */
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL7,
- MMSS_DSI_PHY_PLL_PLL_VCO_TUNE,
- MMSS_DSI_PHY_PLL_PLLLOCK_CMP_EN,
- 0, 0x0D);
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL8,
- MMSS_DSI_PHY_PLL_POST_DIVIDER_CONTROL,
- MMSS_DSI_PHY_PLL_RESETSM_CNTRL3,
- 0xF0, 0x07);
-
- /*
- * RESETSM_CTRL3 has to be set for 12 times (6 reg writes),
- * Each register setting write 2 times, running in loop for 5
- * times (5 reg writes) and other two iterations are taken
- * care (one above and other in shadow_bypass
- */
- for (rem = 0; rem < 5; rem++) {
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL9 + (4 * rem),
- MMSS_DSI_PHY_PLL_RESETSM_CNTRL3,
- MMSS_DSI_PHY_PLL_RESETSM_CNTRL3,
- 0x07, 0x07);
- }
-
- MDSS_DYN_PLL_REG_W(dsi_pll_res->dyn_pll_base,
- MMSS_DSI_DYNAMIC_REFRESH_PLL_CTRL15,
- MMSS_DSI_PHY_PLL_RESETSM_CNTRL3,
- MMSS_DSI_PHY_PLL_RESETSM_CNTRL3,
- 0x03, 0x03);
-
- wmb();
- return 0;
-}
-
-unsigned long pll_20nm_vco_get_rate(struct clk *c)
-{
- u64 vco_rate, multiplier = (1 << 20);
- s32 div_frac_start;
- u32 dec_start;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- u64 ref_clk = vco->ref_clk_rate;
- int rc;
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- dec_start = (MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_DEC_START2) & BIT(0)) << 7;
- dec_start |= (MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_DEC_START1) & 0x7f);
- pr_debug("dec_start = 0x%x\n", dec_start);
-
- div_frac_start = (MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_DIV_FRAC_START3) & 0x3f) << 14;
- div_frac_start |= (MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_DIV_FRAC_START2) & 0x7f) << 7;
- div_frac_start |= MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- MMSS_DSI_PHY_PLL_DIV_FRAC_START1) & 0x7f;
- pr_debug("div_frac_start = 0x%x\n", div_frac_start);
-
- vco_rate = ref_clk * 2 * dec_start;
- vco_rate += ((ref_clk * 2 * div_frac_start) / multiplier);
- pr_debug("returning vco rate = %lu\n", (unsigned long)vco_rate);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
-
- return (unsigned long)vco_rate;
-}
-long pll_20nm_vco_round_rate(struct clk *c, unsigned long rate)
-{
- unsigned long rrate = rate;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
-
- if (rate < vco->min_rate)
- rrate = vco->min_rate;
- if (rate > vco->max_rate)
- rrate = vco->max_rate;
-
- return rrate;
-}
-
-enum handoff pll_20nm_vco_handoff(struct clk *c)
-{
- int rc;
- enum handoff ret = HANDOFF_DISABLED_CLK;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return HANDOFF_DISABLED_CLK;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return ret;
- }
-
- if (pll_20nm_is_pll_locked(dsi_pll_res)) {
- dsi_pll_res->handoff_resources = true;
- dsi_pll_res->pll_on = true;
- c->rate = pll_20nm_vco_get_rate(c);
- ret = HANDOFF_ENABLED_CLK;
- dsi_pll_res->vco_locking_rate = c->rate;
- dsi_pll_res->is_init_locked = true;
- pll_20nm_cache_trim_codes(dsi_pll_res);
- pr_debug("handoff vco_locking_rate=0x%llu\n",
- dsi_pll_res->vco_locking_rate);
- } else {
- mdss_pll_resource_enable(dsi_pll_res, false);
- dsi_pll_res->vco_locking_rate = 0;
- dsi_pll_res->is_init_locked = false;
- }
-
- return ret;
-}
-
-int pll_20nm_vco_prepare(struct clk *c)
-{
- int rc = 0;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (!dsi_pll_res) {
- pr_err("Dsi pll resources are not available\n");
- return -EINVAL;
- }
-
- if ((dsi_pll_res->vco_cached_rate != 0)
- && (dsi_pll_res->vco_cached_rate == c->rate)) {
- rc = c->ops->set_rate(c, dsi_pll_res->vco_cached_rate);
- if (rc) {
- pr_err("vco_set_rate failed. rc=%d\n", rc);
- goto error;
- }
- }
-
- rc = dsi_pll_enable(c);
-
-error:
- return rc;
-}
-
-void pll_20nm_vco_unprepare(struct clk *c)
-{
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (!dsi_pll_res) {
- pr_err("Dsi pll resources are not available\n");
- return;
- }
-
- dsi_pll_res->vco_cached_rate = c->rate;
- dsi_pll_disable(c);
-}
-
-static void pll_20nm_config_resetsm(void __iomem *pll_base)
-{
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_RESETSM_CNTRL, 0x24);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_RESETSM_CNTRL2, 0x07);
-}
-
-static void pll_20nm_config_vco_start(void __iomem *pll_base)
-{
-
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_VCOTAIL_EN, 0x03);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_RESETSM_CNTRL3, 0x02);
- udelay(10);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_RESETSM_CNTRL3, 0x03);
-}
-
-static void pll_20nm_config_bypass_cal(void __iomem *pll_base)
-{
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_RESETSM_CNTRL, 0xac);
- MDSS_PLL_REG_W(pll_base, MMSS_DSI_PHY_PLL_PLL_BKG_KVCO_CAL_EN, 0x28);
-}
-
-static int pll_20nm_vco_relock(struct mdss_pll_resources *dsi_pll_res)
-{
- int rc = 0;
-
- pll_20nm_override_trim_codes(dsi_pll_res);
- pll_20nm_config_bypass_cal(dsi_pll_res->pll_base);
- pll_20nm_config_vco_start(dsi_pll_res->pll_base);
-
- if (!pll_20nm_is_pll_locked(dsi_pll_res)) {
- pr_err("DSI PLL re-lock failed\n");
- rc = -EINVAL;
- }
-
- return rc;
-}
-
-static int pll_20nm_vco_init_lock(struct mdss_pll_resources *dsi_pll_res)
-{
- int rc = 0;
-
- pll_20nm_config_resetsm(dsi_pll_res->pll_base);
- pll_20nm_config_vco_start(dsi_pll_res->pll_base);
-
- if (!pll_20nm_is_pll_locked(dsi_pll_res)) {
- pr_err("DSI PLL init lock failed\n");
- rc = -EINVAL;
- goto init_lock_err;
- }
-
- pll_20nm_cache_trim_codes(dsi_pll_res);
-
-init_lock_err:
- return rc;
-}
-
-int pll_20nm_vco_enable_seq(struct mdss_pll_resources *dsi_pll_res)
-{
- int rc = 0;
- struct mdss_pll_vco_calc vco_calc;
-
- if (!dsi_pll_res) {
- pr_err("Invalid PLL resources\n");
- return -EINVAL;
- }
-
- pll_20nm_config_common_block_1(dsi_pll_res->pll_1_base);
- pll_20nm_config_common_block_1(dsi_pll_res->pll_base);
- pll_20nm_config_common_block_2(dsi_pll_res->pll_base);
- pll_20nm_config_loop_bw(dsi_pll_res->pll_base);
-
- pll_20nm_vco_rate_calc(&vco_calc, dsi_pll_res->vco_current_rate,
- dsi_pll_res->vco_ref_clk_rate);
- pll_20nm_config_vco_rate(dsi_pll_res->pll_base, &vco_calc);
-
- pr_debug("init lock=%d prev vco_rate=%llu, new vco_rate=%llu\n",
- dsi_pll_res->is_init_locked, dsi_pll_res->vco_locking_rate,
- dsi_pll_res->vco_current_rate);
- /*
- * Run auto-lock sequence if it is either bootup initial
- * locking or when the vco rate is changed. Otherwise, just
- * use stored codes and bypass caliberation.
- */
- if (!dsi_pll_res->is_init_locked || (dsi_pll_res->vco_locking_rate !=
- dsi_pll_res->vco_current_rate)) {
- rc = pll_20nm_vco_init_lock(dsi_pll_res);
- dsi_pll_res->is_init_locked = (rc) ? false : true;
- } else {
- rc = pll_20nm_vco_relock(dsi_pll_res);
- }
-
- dsi_pll_res->vco_locking_rate = (rc) ? 0 :
- dsi_pll_res->vco_current_rate;
-
- return rc;
-}
diff --git a/drivers/clk/msm/mdss/mdss-dsi-pll-20nm.c b/drivers/clk/msm/mdss/mdss-dsi-pll-20nm.c
deleted file mode 100644
index 1ab7a0e8b5cd..000000000000
--- a/drivers/clk/msm/mdss/mdss-dsi-pll-20nm.c
+++ /dev/null
@@ -1,608 +0,0 @@
-/* Copyright (c) 2014, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- */
-
-#define pr_fmt(fmt) "%s: " fmt, __func__
-
-#include <linux/kernel.h>
-#include <linux/err.h>
-#include <linux/delay.h>
-#include <linux/clk/msm-clk-provider.h>
-#include <linux/clk/msm-clk.h>
-#include <linux/workqueue.h>
-#include <linux/clk/msm-clock-generic.h>
-#include <dt-bindings/clock/msm-clocks-8994.h>
-
-#include "mdss-pll.h"
-#include "mdss-dsi-pll.h"
-
-#define VCO_DELAY_USEC 1
-
-static struct clk_ops bypass_lp_div_mux_clk_ops;
-static struct clk_ops pixel_clk_src_ops;
-static struct clk_ops byte_clk_src_ops;
-static struct clk_ops ndiv_clk_ops;
-
-static struct clk_ops shadow_pixel_clk_src_ops;
-static struct clk_ops shadow_byte_clk_src_ops;
-static struct clk_ops clk_ops_gen_mux_dsi;
-
-static int vco_set_rate_20nm(struct clk *c, unsigned long rate)
-{
- int rc;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- pr_debug("Cancel pending pll off work\n");
- cancel_work_sync(&dsi_pll_res->pll_off);
- rc = pll_20nm_vco_set_rate(vco, rate);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-static int pll1_vco_set_rate_20nm(struct clk *c, unsigned long rate)
-{
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *pll_res = vco->priv;
-
- mdss_pll_resource_enable(pll_res, true);
- __dsi_pll_disable(pll_res->pll_base);
- mdss_pll_resource_enable(pll_res, false);
-
- pr_debug("Configuring PLL1 registers.\n");
-
- return 0;
-}
-
-static int shadow_vco_set_rate_20nm(struct clk *c, unsigned long rate)
-{
- int rc;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (!dsi_pll_res->resource_enable) {
- pr_err("PLL resources disabled. Dynamic fps invalid\n");
- return -EINVAL;
- }
-
- rc = shadow_pll_20nm_vco_set_rate(vco, rate);
-
- return rc;
-}
-
-/* Op structures */
-
-static struct clk_ops pll1_clk_ops_dsi_vco = {
- .set_rate = pll1_vco_set_rate_20nm,
-};
-
-static struct clk_ops clk_ops_dsi_vco = {
- .set_rate = vco_set_rate_20nm,
- .round_rate = pll_20nm_vco_round_rate,
- .handoff = pll_20nm_vco_handoff,
- .prepare = pll_20nm_vco_prepare,
- .unprepare = pll_20nm_vco_unprepare,
-};
-
-static struct clk_div_ops fixed_hr_oclk2_div_ops = {
- .set_div = fixed_hr_oclk2_set_div,
- .get_div = fixed_hr_oclk2_get_div,
-};
-
-static struct clk_div_ops ndiv_ops = {
- .set_div = ndiv_set_div,
- .get_div = ndiv_get_div,
-};
-
-static struct clk_div_ops hr_oclk3_div_ops = {
- .set_div = hr_oclk3_set_div,
- .get_div = hr_oclk3_get_div,
-};
-
-static struct clk_mux_ops bypass_lp_div_mux_ops = {
- .set_mux_sel = set_bypass_lp_div_mux_sel,
- .get_mux_sel = get_bypass_lp_div_mux_sel,
-};
-
-static struct clk_ops shadow_clk_ops_dsi_vco = {
- .set_rate = shadow_vco_set_rate_20nm,
- .round_rate = pll_20nm_vco_round_rate,
- .handoff = pll_20nm_vco_handoff,
-};
-
-static struct clk_div_ops shadow_fixed_hr_oclk2_div_ops = {
- .set_div = shadow_fixed_hr_oclk2_set_div,
- .get_div = fixed_hr_oclk2_get_div,
-};
-
-static struct clk_div_ops shadow_ndiv_ops = {
- .set_div = shadow_ndiv_set_div,
- .get_div = ndiv_get_div,
-};
-
-static struct clk_div_ops shadow_hr_oclk3_div_ops = {
- .set_div = shadow_hr_oclk3_set_div,
- .get_div = hr_oclk3_get_div,
-};
-
-static struct clk_mux_ops shadow_bypass_lp_div_mux_ops = {
- .set_mux_sel = set_shadow_bypass_lp_div_mux_sel,
- .get_mux_sel = get_bypass_lp_div_mux_sel,
-};
-
-static struct clk_mux_ops mdss_byte_mux_ops = {
- .set_mux_sel = set_mdss_byte_mux_sel,
- .get_mux_sel = get_mdss_byte_mux_sel,
-};
-
-static struct clk_mux_ops mdss_pixel_mux_ops = {
- .set_mux_sel = set_mdss_pixel_mux_sel,
- .get_mux_sel = get_mdss_pixel_mux_sel,
-};
-
-static struct dsi_pll_vco_clk mdss_dsi1_vco_clk_src = {
- .c = {
- .dbg_name = "mdss_dsi1_vco_clk_src",
- .ops = &pll1_clk_ops_dsi_vco,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(mdss_dsi1_vco_clk_src.c),
- },
-};
-
-static struct dsi_pll_vco_clk dsi_vco_clk_8994 = {
- .ref_clk_rate = 19200000,
- .min_rate = 300000000,
- .max_rate = 1500000000,
- .pll_en_seq_cnt = 1,
- .pll_enable_seqs[0] = pll_20nm_vco_enable_seq,
- .c = {
- .dbg_name = "dsi_vco_clk_8994",
- .ops = &clk_ops_dsi_vco,
- CLK_INIT(dsi_vco_clk_8994.c),
- },
-};
-
-static struct dsi_pll_vco_clk shadow_dsi_vco_clk_8994 = {
- .ref_clk_rate = 19200000,
- .min_rate = 300000000,
- .max_rate = 1500000000,
- .c = {
- .dbg_name = "shadow_dsi_vco_clk_8994",
- .ops = &shadow_clk_ops_dsi_vco,
- CLK_INIT(shadow_dsi_vco_clk_8994.c),
- },
-};
-
-static struct div_clk ndiv_clk_8994 = {
- .data = {
- .max_div = 15,
- .min_div = 1,
- },
- .ops = &ndiv_ops,
- .c = {
- .parent = &dsi_vco_clk_8994.c,
- .dbg_name = "ndiv_clk_8994",
- .ops = &ndiv_clk_ops,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(ndiv_clk_8994.c),
- },
-};
-
-static struct div_clk shadow_ndiv_clk_8994 = {
- .data = {
- .max_div = 15,
- .min_div = 1,
- },
- .ops = &shadow_ndiv_ops,
- .c = {
- .parent = &shadow_dsi_vco_clk_8994.c,
- .dbg_name = "shadow_ndiv_clk_8994",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(shadow_ndiv_clk_8994.c),
- },
-};
-
-static struct div_clk indirect_path_div2_clk_8994 = {
- .data = {
- .div = 2,
- .min_div = 2,
- .max_div = 2,
- },
- .c = {
- .parent = &ndiv_clk_8994.c,
- .dbg_name = "indirect_path_div2_clk_8994",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(indirect_path_div2_clk_8994.c),
- },
-};
-
-static struct div_clk shadow_indirect_path_div2_clk_8994 = {
- .data = {
- .div = 2,
- .min_div = 2,
- .max_div = 2,
- },
- .c = {
- .parent = &shadow_ndiv_clk_8994.c,
- .dbg_name = "shadow_indirect_path_div2_clk_8994",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(shadow_indirect_path_div2_clk_8994.c),
- },
-};
-
-static struct div_clk hr_oclk3_div_clk_8994 = {
- .data = {
- .max_div = 255,
- .min_div = 1,
- },
- .ops = &hr_oclk3_div_ops,
- .c = {
- .parent = &dsi_vco_clk_8994.c,
- .dbg_name = "hr_oclk3_div_clk_8994",
- .ops = &pixel_clk_src_ops,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(hr_oclk3_div_clk_8994.c),
- },
-};
-
-static struct div_clk shadow_hr_oclk3_div_clk_8994 = {
- .data = {
- .max_div = 255,
- .min_div = 1,
- },
- .ops = &shadow_hr_oclk3_div_ops,
- .c = {
- .parent = &shadow_dsi_vco_clk_8994.c,
- .dbg_name = "shadow_hr_oclk3_div_clk_8994",
- .ops = &shadow_pixel_clk_src_ops,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(shadow_hr_oclk3_div_clk_8994.c),
- },
-};
-
-static struct div_clk pixel_clk_src = {
- .data = {
- .div = 2,
- .min_div = 2,
- .max_div = 2,
- },
- .c = {
- .parent = &hr_oclk3_div_clk_8994.c,
- .dbg_name = "pixel_clk_src",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(pixel_clk_src.c),
- },
-};
-
-static struct div_clk shadow_pixel_clk_src = {
- .data = {
- .div = 2,
- .min_div = 2,
- .max_div = 2,
- },
- .c = {
- .parent = &shadow_hr_oclk3_div_clk_8994.c,
- .dbg_name = "shadow_pixel_clk_src",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(shadow_pixel_clk_src.c),
- },
-};
-
-static struct mux_clk bypass_lp_div_mux_8994 = {
- .num_parents = 2,
- .parents = (struct clk_src[]){
- {&dsi_vco_clk_8994.c, 0},
- {&indirect_path_div2_clk_8994.c, 1},
- },
- .ops = &bypass_lp_div_mux_ops,
- .c = {
- .parent = &dsi_vco_clk_8994.c,
- .dbg_name = "bypass_lp_div_mux_8994",
- .ops = &bypass_lp_div_mux_clk_ops,
- CLK_INIT(bypass_lp_div_mux_8994.c),
- },
-};
-
-static struct mux_clk shadow_bypass_lp_div_mux_8994 = {
- .num_parents = 2,
- .parents = (struct clk_src[]){
- {&shadow_dsi_vco_clk_8994.c, 0},
- {&shadow_indirect_path_div2_clk_8994.c, 1},
- },
- .ops = &shadow_bypass_lp_div_mux_ops,
- .c = {
- .parent = &shadow_dsi_vco_clk_8994.c,
- .dbg_name = "shadow_bypass_lp_div_mux_8994",
- .ops = &clk_ops_gen_mux,
- CLK_INIT(shadow_bypass_lp_div_mux_8994.c),
- },
-};
-
-static struct div_clk fixed_hr_oclk2_div_clk_8994 = {
- .ops = &fixed_hr_oclk2_div_ops,
- .data = {
- .min_div = 4,
- .max_div = 4,
- },
- .c = {
- .parent = &bypass_lp_div_mux_8994.c,
- .dbg_name = "fixed_hr_oclk2_div_clk_8994",
- .ops = &byte_clk_src_ops,
- CLK_INIT(fixed_hr_oclk2_div_clk_8994.c),
- },
-};
-
-static struct div_clk shadow_fixed_hr_oclk2_div_clk_8994 = {
- .ops = &shadow_fixed_hr_oclk2_div_ops,
- .data = {
- .min_div = 4,
- .max_div = 4,
- },
- .c = {
- .parent = &shadow_bypass_lp_div_mux_8994.c,
- .dbg_name = "shadow_fixed_hr_oclk2_div_clk_8994",
- .ops = &shadow_byte_clk_src_ops,
- CLK_INIT(shadow_fixed_hr_oclk2_div_clk_8994.c),
- },
-};
-
-static struct div_clk byte_clk_src = {
- .data = {
- .div = 2,
- .min_div = 2,
- .max_div = 2,
- },
- .c = {
- .parent = &fixed_hr_oclk2_div_clk_8994.c,
- .dbg_name = "byte_clk_src",
- .ops = &clk_ops_div,
- CLK_INIT(byte_clk_src.c),
- },
-};
-
-static struct div_clk shadow_byte_clk_src = {
- .data = {
- .div = 2,
- .min_div = 2,
- .max_div = 2,
- },
- .c = {
- .parent = &shadow_fixed_hr_oclk2_div_clk_8994.c,
- .dbg_name = "shadow_byte_clk_src",
- .ops = &clk_ops_div,
- CLK_INIT(shadow_byte_clk_src.c),
- },
-};
-
-static struct mux_clk mdss_pixel_clk_mux = {
- .num_parents = 2,
- .parents = (struct clk_src[]) {
- {&pixel_clk_src.c, 0},
- {&shadow_pixel_clk_src.c, 1},
- },
- .ops = &mdss_pixel_mux_ops,
- .c = {
- .parent = &pixel_clk_src.c,
- .dbg_name = "mdss_pixel_clk_mux",
- .ops = &clk_ops_gen_mux,
- CLK_INIT(mdss_pixel_clk_mux.c),
- }
-};
-
-static struct mux_clk mdss_byte_clk_mux = {
- .num_parents = 2,
- .parents = (struct clk_src[]) {
- {&byte_clk_src.c, 0},
- {&shadow_byte_clk_src.c, 1},
- },
- .ops = &mdss_byte_mux_ops,
- .c = {
- .parent = &byte_clk_src.c,
- .dbg_name = "mdss_byte_clk_mux",
- .ops = &clk_ops_gen_mux_dsi,
- CLK_INIT(mdss_byte_clk_mux.c),
- }
-};
-
-static struct clk_lookup mdss_dsi_pll_1_cc_8994[] = {
- CLK_LIST(mdss_dsi1_vco_clk_src),
-};
-
-static struct clk_lookup mdss_dsi_pllcc_8994[] = {
- CLK_LIST(mdss_pixel_clk_mux),
- CLK_LIST(mdss_byte_clk_mux),
- CLK_LIST(pixel_clk_src),
- CLK_LIST(byte_clk_src),
- CLK_LIST(fixed_hr_oclk2_div_clk_8994),
- CLK_LIST(bypass_lp_div_mux_8994),
- CLK_LIST(hr_oclk3_div_clk_8994),
- CLK_LIST(indirect_path_div2_clk_8994),
- CLK_LIST(ndiv_clk_8994),
- CLK_LIST(dsi_vco_clk_8994),
- CLK_LIST(shadow_pixel_clk_src),
- CLK_LIST(shadow_byte_clk_src),
- CLK_LIST(shadow_fixed_hr_oclk2_div_clk_8994),
- CLK_LIST(shadow_bypass_lp_div_mux_8994),
- CLK_LIST(shadow_hr_oclk3_div_clk_8994),
- CLK_LIST(shadow_indirect_path_div2_clk_8994),
- CLK_LIST(shadow_ndiv_clk_8994),
- CLK_LIST(shadow_dsi_vco_clk_8994),
-};
-
-static void dsi_pll_off_work(struct work_struct *work)
-{
- struct mdss_pll_resources *pll_res;
-
- if (!work) {
- pr_err("pll_resource is invalid\n");
- return;
- }
-
- pr_debug("Starting PLL off Worker%s\n", __func__);
-
- pll_res = container_of(work, struct
- mdss_pll_resources, pll_off);
-
- mdss_pll_resource_enable(pll_res, true);
- __dsi_pll_disable(pll_res->pll_base);
- if (pll_res->pll_1_base)
- __dsi_pll_disable(pll_res->pll_1_base);
- mdss_pll_resource_enable(pll_res, false);
-}
-
-static int dsi_pll_regulator_notifier_call(struct notifier_block *self,
- unsigned long event, void *data)
-{
-
- struct mdss_pll_resources *pll_res;
-
- if (!self) {
- pr_err("pll_resource is invalid\n");
- goto error;
- }
-
- pll_res = container_of(self, struct
- mdss_pll_resources, gdsc_cb);
-
- if (event & REGULATOR_EVENT_ENABLE) {
- pr_debug("Regulator ON event. Scheduling pll off worker\n");
- schedule_work(&pll_res->pll_off);
- }
-
- if (event & REGULATOR_EVENT_DISABLE)
- pr_debug("Regulator OFF event.\n");
-
-error:
- return NOTIFY_OK;
-}
-
-int dsi_pll_clock_register_20nm(struct platform_device *pdev,
- struct mdss_pll_resources *pll_res)
-{
- int rc;
- struct dss_vreg *pll_reg;
-
- if (!pdev || !pdev->dev.of_node) {
- pr_err("Invalid input parameters\n");
- return -EINVAL;
- }
-
- if (!pll_res || !pll_res->pll_base) {
- pr_err("Invalid PLL resources\n");
- return -EPROBE_DEFER;
- }
-
- /*
- * Set client data to mux, div and vco clocks.
- * This needs to be done only for PLL0 since, that is the one in
- * use.
- **/
- if (!pll_res->index) {
- byte_clk_src.priv = pll_res;
- pixel_clk_src.priv = pll_res;
- bypass_lp_div_mux_8994.priv = pll_res;
- indirect_path_div2_clk_8994.priv = pll_res;
- ndiv_clk_8994.priv = pll_res;
- fixed_hr_oclk2_div_clk_8994.priv = pll_res;
- hr_oclk3_div_clk_8994.priv = pll_res;
- dsi_vco_clk_8994.priv = pll_res;
-
- shadow_byte_clk_src.priv = pll_res;
- shadow_pixel_clk_src.priv = pll_res;
- shadow_bypass_lp_div_mux_8994.priv = pll_res;
- shadow_indirect_path_div2_clk_8994.priv = pll_res;
- shadow_ndiv_clk_8994.priv = pll_res;
- shadow_fixed_hr_oclk2_div_clk_8994.priv = pll_res;
- shadow_hr_oclk3_div_clk_8994.priv = pll_res;
- shadow_dsi_vco_clk_8994.priv = pll_res;
-
- pll_res->vco_delay = VCO_DELAY_USEC;
-
- /* Set clock source operations */
- pixel_clk_src_ops = clk_ops_slave_div;
- pixel_clk_src_ops.prepare = dsi_pll_div_prepare;
-
- ndiv_clk_ops = clk_ops_div;
- ndiv_clk_ops.prepare = dsi_pll_div_prepare;
-
- byte_clk_src_ops = clk_ops_div;
- byte_clk_src_ops.prepare = dsi_pll_div_prepare;
-
- bypass_lp_div_mux_clk_ops = clk_ops_gen_mux;
- bypass_lp_div_mux_clk_ops.prepare = dsi_pll_mux_prepare;
-
- clk_ops_gen_mux_dsi = clk_ops_gen_mux;
- clk_ops_gen_mux_dsi.round_rate = parent_round_rate;
- clk_ops_gen_mux_dsi.set_rate = parent_set_rate;
-
- shadow_pixel_clk_src_ops = clk_ops_slave_div;
- shadow_pixel_clk_src_ops.prepare = dsi_pll_div_prepare;
-
- shadow_byte_clk_src_ops = clk_ops_div;
- shadow_byte_clk_src_ops.prepare = dsi_pll_div_prepare;
- } else {
- mdss_dsi1_vco_clk_src.priv = pll_res;
- }
-
- if ((pll_res->target_id == MDSS_PLL_TARGET_8994) ||
- (pll_res->target_id == MDSS_PLL_TARGET_8992)) {
- if (pll_res->index) {
- rc = of_msm_clock_register(pdev->dev.of_node,
- mdss_dsi_pll_1_cc_8994,
- ARRAY_SIZE(mdss_dsi_pll_1_cc_8994));
- if (rc) {
- pr_err("Clock register failed\n");
- rc = -EPROBE_DEFER;
- }
- } else {
- rc = of_msm_clock_register(pdev->dev.of_node,
- mdss_dsi_pllcc_8994,
- ARRAY_SIZE(mdss_dsi_pllcc_8994));
- if (rc) {
- pr_err("Clock register failed\n");
- rc = -EPROBE_DEFER;
- }
- pll_res->gdsc_cb.notifier_call =
- dsi_pll_regulator_notifier_call;
- INIT_WORK(&pll_res->pll_off, dsi_pll_off_work);
-
- pll_reg = mdss_pll_get_mp_by_reg_name(pll_res, "gdsc");
- if (pll_reg) {
- pr_debug("Registering for gdsc regulator events\n");
- if (regulator_register_notifier(pll_reg->vreg,
- &(pll_res->gdsc_cb)))
- pr_err("Regulator notification registration failed!\n");
- }
- }
-
- } else {
- pr_err("Invalid target ID\n");
- rc = -EINVAL;
- }
-
- if (!rc)
- pr_info("Registered DSI PLL clocks successfully\n");
-
- return rc;
-}
diff --git a/drivers/clk/msm/mdss/mdss-dsi-pll-28hpm.c b/drivers/clk/msm/mdss/mdss-dsi-pll-28hpm.c
deleted file mode 100644
index aab7e5e2263c..000000000000
--- a/drivers/clk/msm/mdss/mdss-dsi-pll-28hpm.c
+++ /dev/null
@@ -1,335 +0,0 @@
-/* Copyright (c) 2012-2014, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- */
-
-#define pr_fmt(fmt) "%s: " fmt, __func__
-
-#include <linux/kernel.h>
-#include <linux/err.h>
-#include <linux/delay.h>
-#include <linux/clk/msm-clk-provider.h>
-#include <linux/clk/msm-clk.h>
-#include <linux/clk/msm-clock-generic.h>
-#include <dt-bindings/clock/msm-clocks-8974.h>
-
-#include "mdss-pll.h"
-#include "mdss-dsi-pll.h"
-
-#define VCO_DELAY_USEC 1
-
-static struct clk_div_ops fixed_2div_ops;
-static struct clk_ops byte_mux_clk_ops;
-static struct clk_ops pixel_clk_src_ops;
-static struct clk_ops byte_clk_src_ops;
-static struct clk_ops analog_postdiv_clk_ops;
-static struct lpfr_cfg lpfr_lut_struct[] = {
- {479500000, 8},
- {480000000, 11},
- {575500000, 8},
- {576000000, 12},
- {610500000, 8},
- {659500000, 9},
- {671500000, 10},
- {672000000, 14},
- {708500000, 10},
- {750000000, 11},
-};
-
-static void dsi_pll_software_reset(struct mdss_pll_resources *dsi_pll_res)
-{
- /*
- * Add HW recommended delays after toggling the software
- * reset bit off and back on.
- */
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_TEST_CFG, 0x01);
- udelay(1);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_TEST_CFG, 0x00);
- udelay(1);
-}
-
-static int vco_set_rate_hpm(struct clk *c, unsigned long rate)
-{
- int rc;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- rc = vco_set_rate(vco, rate);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-static int dsi_pll_enable_seq_8974(struct mdss_pll_resources *dsi_pll_res)
-{
- int i, rc = 0;
- int pll_locked;
-
- dsi_pll_software_reset(dsi_pll_res);
-
- /*
- * PLL power up sequence.
- * Add necessary delays recommeded by hardware.
- */
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x01);
- udelay(1);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x05);
- udelay(200);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x07);
- udelay(500);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x0f);
- udelay(500);
-
- for (i = 0; i < 2; i++) {
- udelay(100);
- /* DSI Uniphy lock detect setting */
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_LKDET_CFG2, 0x0c);
- udelay(100);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_LKDET_CFG2, 0x0d);
-
- pll_locked = dsi_pll_lock_status(dsi_pll_res);
- if (pll_locked)
- break;
-
- dsi_pll_software_reset(dsi_pll_res);
- /*
- * PLL power up sequence.
- * Add necessary delays recommeded by hardware.
- */
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x1);
- udelay(1);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x5);
- udelay(200);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x7);
- udelay(250);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x5);
- udelay(200);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x7);
- udelay(500);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0xf);
- udelay(500);
-
- }
-
- if (!pll_locked) {
- pr_err("DSI PLL lock failed\n");
- rc = -EINVAL;
- } else {
- pr_debug("DSI PLL Lock success\n");
- }
-
- return rc;
-}
-
-/* Op structures */
-
-static struct clk_ops clk_ops_dsi_vco = {
- .set_rate = vco_set_rate_hpm,
- .round_rate = vco_round_rate,
- .handoff = vco_handoff,
- .prepare = vco_prepare,
- .unprepare = vco_unprepare,
-};
-
-
-static struct clk_div_ops fixed_4div_ops = {
- .set_div = fixed_4div_set_div,
- .get_div = fixed_4div_get_div,
-};
-
-static struct clk_div_ops analog_postdiv_ops = {
- .set_div = analog_set_div,
- .get_div = analog_get_div,
-};
-
-static struct clk_div_ops digital_postdiv_ops = {
- .set_div = digital_set_div,
- .get_div = digital_get_div,
-};
-
-static struct clk_mux_ops byte_mux_ops = {
- .set_mux_sel = set_byte_mux_sel,
- .get_mux_sel = get_byte_mux_sel,
-};
-
-static struct dsi_pll_vco_clk dsi_vco_clk_8974 = {
- .ref_clk_rate = 19200000,
- .min_rate = 350000000,
- .max_rate = 750000000,
- .pll_en_seq_cnt = 3,
- .pll_enable_seqs[0] = dsi_pll_enable_seq_8974,
- .pll_enable_seqs[1] = dsi_pll_enable_seq_8974,
- .pll_enable_seqs[2] = dsi_pll_enable_seq_8974,
- .lpfr_lut_size = 10,
- .lpfr_lut = lpfr_lut_struct,
- .c = {
- .dbg_name = "dsi_vco_clk_8974",
- .ops = &clk_ops_dsi_vco,
- CLK_INIT(dsi_vco_clk_8974.c),
- },
-};
-
-static struct div_clk analog_postdiv_clk_8974 = {
- .data = {
- .max_div = 255,
- .min_div = 1,
- },
- .ops = &analog_postdiv_ops,
- .c = {
- .parent = &dsi_vco_clk_8974.c,
- .dbg_name = "analog_postdiv_clk",
- .ops = &analog_postdiv_clk_ops,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(analog_postdiv_clk_8974.c),
- },
-};
-
-static struct div_clk indirect_path_div2_clk_8974 = {
- .ops = &fixed_2div_ops,
- .data = {
- .div = 2,
- .min_div = 2,
- .max_div = 2,
- },
- .c = {
- .parent = &analog_postdiv_clk_8974.c,
- .dbg_name = "indirect_path_div2_clk",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(indirect_path_div2_clk_8974.c),
- },
-};
-
-static struct div_clk pixel_clk_src_8974 = {
- .data = {
- .max_div = 255,
- .min_div = 1,
- },
- .ops = &digital_postdiv_ops,
- .c = {
- .parent = &dsi_vco_clk_8974.c,
- .dbg_name = "pixel_clk_src_8974",
- .ops = &pixel_clk_src_ops,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(pixel_clk_src_8974.c),
- },
-};
-
-static struct mux_clk byte_mux_8974 = {
- .num_parents = 2,
- .parents = (struct clk_src[]){
- {&dsi_vco_clk_8974.c, 0},
- {&indirect_path_div2_clk_8974.c, 1},
- },
- .ops = &byte_mux_ops,
- .c = {
- .parent = &dsi_vco_clk_8974.c,
- .dbg_name = "byte_mux_8974",
- .ops = &byte_mux_clk_ops,
- CLK_INIT(byte_mux_8974.c),
- },
-};
-
-static struct div_clk byte_clk_src_8974 = {
- .ops = &fixed_4div_ops,
- .data = {
- .min_div = 4,
- .max_div = 4,
- },
- .c = {
- .parent = &byte_mux_8974.c,
- .dbg_name = "byte_clk_src_8974",
- .ops = &byte_clk_src_ops,
- CLK_INIT(byte_clk_src_8974.c),
- },
-};
-
-static struct clk_lookup mdss_dsi_pllcc_8974[] = {
- CLK_LOOKUP_OF("pixel_src", pixel_clk_src_8974,
- "fd8c0000.qcom,mmsscc-mdss"),
- CLK_LOOKUP_OF("byte_src", byte_clk_src_8974,
- "fd8c0000.qcom,mmsscc-mdss"),
-};
-
-int dsi_pll_clock_register_hpm(struct platform_device *pdev,
- struct mdss_pll_resources *pll_res)
-{
- int rc;
-
- if (!pdev || !pdev->dev.of_node) {
- pr_err("Invalid input parameters\n");
- return -EINVAL;
- }
-
- if (!pll_res || !pll_res->pll_base) {
- pr_err("Invalid PLL resources\n");
- return -EPROBE_DEFER;
- }
-
- /* Set client data to mux, div and vco clocks */
- byte_clk_src_8974.priv = pll_res;
- pixel_clk_src_8974.priv = pll_res;
- byte_mux_8974.priv = pll_res;
- indirect_path_div2_clk_8974.priv = pll_res;
- analog_postdiv_clk_8974.priv = pll_res;
- dsi_vco_clk_8974.priv = pll_res;
- pll_res->vco_delay = VCO_DELAY_USEC;
-
- /* Set clock source operations */
- pixel_clk_src_ops = clk_ops_slave_div;
- pixel_clk_src_ops.prepare = dsi_pll_div_prepare;
-
- analog_postdiv_clk_ops = clk_ops_div;
- analog_postdiv_clk_ops.prepare = dsi_pll_div_prepare;
-
- byte_clk_src_ops = clk_ops_div;
- byte_clk_src_ops.prepare = dsi_pll_div_prepare;
-
- byte_mux_clk_ops = clk_ops_gen_mux;
- byte_mux_clk_ops.prepare = dsi_pll_mux_prepare;
-
- if (pll_res->target_id == MDSS_PLL_TARGET_8974) {
- rc = of_msm_clock_register(pdev->dev.of_node,
- mdss_dsi_pllcc_8974, ARRAY_SIZE(mdss_dsi_pllcc_8974));
- if (rc) {
- pr_err("Clock register failed\n");
- rc = -EPROBE_DEFER;
- }
- } else {
- pr_err("Invalid target ID\n");
- rc = -EINVAL;
- }
-
- if (!rc)
- pr_info("Registered DSI PLL clocks successfully\n");
-
- return rc;
-}
diff --git a/drivers/clk/msm/mdss/mdss-dsi-pll-28lpm.c b/drivers/clk/msm/mdss/mdss-dsi-pll-28lpm.c
deleted file mode 100644
index 2c8e93670c80..000000000000
--- a/drivers/clk/msm/mdss/mdss-dsi-pll-28lpm.c
+++ /dev/null
@@ -1,306 +0,0 @@
-/* Copyright (c) 2012-2014, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- */
-
-#define pr_fmt(fmt) "%s: " fmt, __func__
-
-#include <linux/kernel.h>
-#include <linux/err.h>
-#include <linux/delay.h>
-#include <linux/clk/msm-clk.h>
-#include <linux/clk/msm-clock-generic.h>
-#include <linux/clk/msm-clk-provider.h>
-#include <dt-bindings/clock/msm-clocks-8916.h>
-
-#include "mdss-pll.h"
-#include "mdss-dsi-pll.h"
-
-#define VCO_DELAY_USEC 1000
-
-static struct clk_div_ops fixed_2div_ops;
-static struct clk_ops byte_mux_clk_ops;
-static struct clk_ops pixel_clk_src_ops;
-static struct clk_ops byte_clk_src_ops;
-static struct clk_ops analog_postdiv_clk_ops;
-static struct lpfr_cfg lpfr_lut_struct[] = {
- {479500000, 8},
- {480000000, 11},
- {575500000, 8},
- {576000000, 12},
- {610500000, 8},
- {659500000, 9},
- {671500000, 10},
- {672000000, 14},
- {708500000, 10},
- {750000000, 11},
-};
-
-static int vco_set_rate_lpm(struct clk *c, unsigned long rate)
-{
- int rc;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- /*
- * DSI PLL software reset. Add HW recommended delays after toggling
- * the software reset bit off and back on.
- */
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_TEST_CFG, 0x01);
- udelay(1000);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_TEST_CFG, 0x00);
- udelay(1000);
-
- rc = vco_set_rate(vco, rate);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-static int dsi_pll_enable_seq_8916(struct mdss_pll_resources *dsi_pll_res)
-{
- int pll_locked = 0;
-
- /*
- * DSI PLL software reset. Add HW recommended delays after toggling
- * the software reset bit off and back on.
- */
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_TEST_CFG, 0x01);
- ndelay(500);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_TEST_CFG, 0x00);
-
- /*
- * PLL power up sequence.
- * Add necessary delays recommended by hardware.
- */
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG1, 0x34);
- ndelay(500);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x01);
- ndelay(500);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x05);
- ndelay(500);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x0f);
- ndelay(500);
-
- /* DSI PLL toggle lock detect setting */
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_LKDET_CFG2, 0x04);
- ndelay(500);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_LKDET_CFG2, 0x05);
- udelay(512);
-
- pll_locked = dsi_pll_lock_status(dsi_pll_res);
-
- if (pll_locked)
- pr_debug("PLL Locked\n");
- else
- pr_err("PLL failed to lock\n");
-
- return pll_locked ? 0 : -EINVAL;
-}
-
-/* Op structures */
-
-static struct clk_ops clk_ops_dsi_vco = {
- .set_rate = vco_set_rate_lpm,
- .round_rate = vco_round_rate,
- .handoff = vco_handoff,
- .prepare = vco_prepare,
- .unprepare = vco_unprepare,
-};
-
-
-static struct clk_div_ops fixed_4div_ops = {
- .set_div = fixed_4div_set_div,
- .get_div = fixed_4div_get_div,
-};
-
-static struct clk_div_ops analog_postdiv_ops = {
- .set_div = analog_set_div,
- .get_div = analog_get_div,
-};
-
-static struct clk_div_ops digital_postdiv_ops = {
- .set_div = digital_set_div,
- .get_div = digital_get_div,
-};
-
-static struct clk_mux_ops byte_mux_ops = {
- .set_mux_sel = set_byte_mux_sel,
- .get_mux_sel = get_byte_mux_sel,
-};
-
-static struct dsi_pll_vco_clk dsi_vco_clk_8916 = {
- .ref_clk_rate = 19200000,
- .min_rate = 350000000,
- .max_rate = 750000000,
- .pll_en_seq_cnt = 1,
- .pll_enable_seqs[0] = dsi_pll_enable_seq_8916,
- .lpfr_lut_size = 10,
- .lpfr_lut = lpfr_lut_struct,
- .c = {
- .dbg_name = "dsi_vco_clk_8916",
- .ops = &clk_ops_dsi_vco,
- CLK_INIT(dsi_vco_clk_8916.c),
- },
-};
-
-static struct div_clk analog_postdiv_clk_8916 = {
- .data = {
- .max_div = 255,
- .min_div = 1,
- },
- .ops = &analog_postdiv_ops,
- .c = {
- .parent = &dsi_vco_clk_8916.c,
- .dbg_name = "analog_postdiv_clk",
- .ops = &analog_postdiv_clk_ops,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(analog_postdiv_clk_8916.c),
- },
-};
-
-static struct div_clk indirect_path_div2_clk_8916 = {
- .ops = &fixed_2div_ops,
- .data = {
- .div = 2,
- .min_div = 2,
- .max_div = 2,
- },
- .c = {
- .parent = &analog_postdiv_clk_8916.c,
- .dbg_name = "indirect_path_div2_clk",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(indirect_path_div2_clk_8916.c),
- },
-};
-
-static struct div_clk pixel_clk_src = {
- .data = {
- .max_div = 255,
- .min_div = 1,
- },
- .ops = &digital_postdiv_ops,
- .c = {
- .parent = &dsi_vco_clk_8916.c,
- .dbg_name = "pixel_clk_src_8916",
- .ops = &pixel_clk_src_ops,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(pixel_clk_src.c),
- },
-};
-
-static struct mux_clk byte_mux_8916 = {
- .num_parents = 2,
- .parents = (struct clk_src[]){
- {&dsi_vco_clk_8916.c, 0},
- {&indirect_path_div2_clk_8916.c, 1},
- },
- .ops = &byte_mux_ops,
- .c = {
- .parent = &dsi_vco_clk_8916.c,
- .dbg_name = "byte_mux_8916",
- .ops = &byte_mux_clk_ops,
- CLK_INIT(byte_mux_8916.c),
- },
-};
-
-static struct div_clk byte_clk_src = {
- .ops = &fixed_4div_ops,
- .data = {
- .min_div = 4,
- .max_div = 4,
- },
- .c = {
- .parent = &byte_mux_8916.c,
- .dbg_name = "byte_clk_src_8916",
- .ops = &byte_clk_src_ops,
- CLK_INIT(byte_clk_src.c),
- },
-};
-
-static struct clk_lookup mdss_dsi_pllcc_8916[] = {
- CLK_LIST(pixel_clk_src),
- CLK_LIST(byte_clk_src),
-};
-
-int dsi_pll_clock_register_lpm(struct platform_device *pdev,
- struct mdss_pll_resources *pll_res)
-{
- int rc;
-
- if (!pdev || !pdev->dev.of_node) {
- pr_err("Invalid input parameters\n");
- return -EINVAL;
- }
-
- if (!pll_res || !pll_res->pll_base) {
- pr_err("Invalid PLL resources\n");
- return -EPROBE_DEFER;
- }
-
- /* Set client data to mux, div and vco clocks */
- byte_clk_src.priv = pll_res;
- pixel_clk_src.priv = pll_res;
- byte_mux_8916.priv = pll_res;
- indirect_path_div2_clk_8916.priv = pll_res;
- analog_postdiv_clk_8916.priv = pll_res;
- dsi_vco_clk_8916.priv = pll_res;
- pll_res->vco_delay = VCO_DELAY_USEC;
-
- /* Set clock source operations */
- pixel_clk_src_ops = clk_ops_slave_div;
- pixel_clk_src_ops.prepare = dsi_pll_div_prepare;
-
- analog_postdiv_clk_ops = clk_ops_div;
- analog_postdiv_clk_ops.prepare = dsi_pll_div_prepare;
-
- byte_clk_src_ops = clk_ops_div;
- byte_clk_src_ops.prepare = dsi_pll_div_prepare;
-
- byte_mux_clk_ops = clk_ops_gen_mux;
- byte_mux_clk_ops.prepare = dsi_pll_mux_prepare;
-
- if (pll_res->target_id == MDSS_PLL_TARGET_8916 ||
- pll_res->target_id == MDSS_PLL_TARGET_8939 ||
- pll_res->target_id == MDSS_PLL_TARGET_8909) {
- rc = of_msm_clock_register(pdev->dev.of_node,
- mdss_dsi_pllcc_8916, ARRAY_SIZE(mdss_dsi_pllcc_8916));
- if (rc) {
- pr_err("Clock register failed\n");
- rc = -EPROBE_DEFER;
- }
- } else {
- pr_err("Invalid target ID\n");
- rc = -EINVAL;
- }
-
- if (!rc)
- pr_info("Registered DSI PLL clocks successfully\n");
-
- return rc;
-}
diff --git a/drivers/clk/msm/mdss/mdss-dsi-pll-util.c b/drivers/clk/msm/mdss/mdss-dsi-pll-util.c
deleted file mode 100644
index 6a26fcd3411a..000000000000
--- a/drivers/clk/msm/mdss/mdss-dsi-pll-util.c
+++ /dev/null
@@ -1,588 +0,0 @@
-/* Copyright (c) 2012-2015, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- */
-
-#define pr_fmt(fmt) "%s: " fmt, __func__
-
-#include <linux/kernel.h>
-#include <linux/err.h>
-#include <linux/iopoll.h>
-#include <linux/delay.h>
-#include <linux/clk/msm-clock-generic.h>
-
-#include "mdss-pll.h"
-#include "mdss-dsi-pll.h"
-
-#define DSI_PHY_PLL_UNIPHY_PLL_REFCLK_CFG (0x0)
-#define DSI_PHY_PLL_UNIPHY_PLL_POSTDIV1_CFG (0x0004)
-#define DSI_PHY_PLL_UNIPHY_PLL_CHGPUMP_CFG (0x0008)
-#define DSI_PHY_PLL_UNIPHY_PLL_VCOLPF_CFG (0x000C)
-#define DSI_PHY_PLL_UNIPHY_PLL_VREG_CFG (0x0010)
-#define DSI_PHY_PLL_UNIPHY_PLL_PWRGEN_CFG (0x0014)
-#define DSI_PHY_PLL_UNIPHY_PLL_POSTDIV2_CFG (0x0024)
-#define DSI_PHY_PLL_UNIPHY_PLL_POSTDIV3_CFG (0x0028)
-#define DSI_PHY_PLL_UNIPHY_PLL_LPFR_CFG (0x002C)
-#define DSI_PHY_PLL_UNIPHY_PLL_LPFC1_CFG (0x0030)
-#define DSI_PHY_PLL_UNIPHY_PLL_LPFC2_CFG (0x0034)
-#define DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG0 (0x0038)
-#define DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG1 (0x003C)
-#define DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG2 (0x0040)
-#define DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG3 (0x0044)
-#define DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG4 (0x0048)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG0 (0x006C)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG2 (0x0074)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG3 (0x0078)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG4 (0x007C)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG5 (0x0080)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG6 (0x0084)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG7 (0x0088)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG8 (0x008C)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG9 (0x0090)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG10 (0x0094)
-#define DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG11 (0x0098)
-#define DSI_PHY_PLL_UNIPHY_PLL_EFUSE_CFG (0x009C)
-#define DSI_PHY_PLL_UNIPHY_PLL_STATUS (0x00C0)
-
-#define DSI_PLL_POLL_DELAY_US 50
-#define DSI_PLL_POLL_TIMEOUT_US 500
-
-int set_byte_mux_sel(struct mux_clk *clk, int sel)
-{
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- pr_debug("byte mux set to %s mode\n", sel ? "indirect" : "direct");
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_VREG_CFG, (sel << 1));
-
- return 0;
-}
-
-int get_byte_mux_sel(struct mux_clk *clk)
-{
- int mux_mode, rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- mux_mode = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_VREG_CFG) & BIT(1);
-
- pr_debug("byte mux mode = %s", mux_mode ? "indirect" : "direct");
- mdss_pll_resource_enable(dsi_pll_res, false);
-
- return !!mux_mode;
-}
-
-int dsi_pll_div_prepare(struct clk *c)
-{
- struct div_clk *div = to_div_clk(c);
- /* Restore the divider's value */
- return div->ops->set_div(div, div->data.div);
-}
-
-int dsi_pll_mux_prepare(struct clk *c)
-{
- struct mux_clk *mux = to_mux_clk(c);
- int i, rc, sel = 0;
- struct mdss_pll_resources *dsi_pll_res = mux->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- for (i = 0; i < mux->num_parents; i++)
- if (mux->parents[i].src == c->parent) {
- sel = mux->parents[i].sel;
- break;
- }
-
- if (i == mux->num_parents) {
- pr_err("Failed to select the parent clock\n");
- rc = -EINVAL;
- goto error;
- }
-
- /* Restore the mux source select value */
- rc = mux->ops->set_mux_sel(mux, sel);
-
-error:
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-int fixed_4div_set_div(struct div_clk *clk, int div)
-{
- int rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_POSTDIV2_CFG, (div - 1));
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-int fixed_4div_get_div(struct div_clk *clk)
-{
- int div = 0, rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- div = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_POSTDIV2_CFG);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return div + 1;
-}
-
-int digital_set_div(struct div_clk *clk, int div)
-{
- int rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_POSTDIV3_CFG, (div - 1));
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-int digital_get_div(struct div_clk *clk)
-{
- int div = 0, rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- div = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_POSTDIV3_CFG);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return div + 1;
-}
-
-int analog_set_div(struct div_clk *clk, int div)
-{
- int rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_POSTDIV1_CFG, div - 1);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- return rc;
-}
-
-int analog_get_div(struct div_clk *clk)
-{
- int div = 0, rc;
- struct mdss_pll_resources *dsi_pll_res = clk->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(clk->priv, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- div = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_POSTDIV1_CFG) + 1;
-
- mdss_pll_resource_enable(dsi_pll_res, false);
-
- return div;
-}
-
-int dsi_pll_lock_status(struct mdss_pll_resources *dsi_pll_res)
-{
- u32 status;
- int pll_locked;
-
- /* poll for PLL ready status */
- if (readl_poll_timeout_atomic((dsi_pll_res->pll_base +
- DSI_PHY_PLL_UNIPHY_PLL_STATUS),
- status,
- ((status & BIT(0)) == 1),
- DSI_PLL_POLL_DELAY_US,
- DSI_PLL_POLL_TIMEOUT_US)) {
- pr_debug("DSI PLL status=%x failed to Lock\n", status);
- pll_locked = 0;
- } else {
- pll_locked = 1;
- }
-
- return pll_locked;
-}
-
-int vco_set_rate(struct dsi_pll_vco_clk *vco, unsigned long rate)
-{
- s64 vco_clk_rate = rate;
- s32 rem;
- s64 refclk_cfg, frac_n_mode, ref_doubler_en_b;
- s64 ref_clk_to_pll, div_fbx1000, frac_n_value;
- s64 sdm_cfg0, sdm_cfg1, sdm_cfg2, sdm_cfg3;
- s64 gen_vco_clk, cal_cfg10, cal_cfg11;
- u32 res;
- int i;
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- /* Configure the Loop filter resistance */
- for (i = 0; i < vco->lpfr_lut_size; i++)
- if (vco_clk_rate <= vco->lpfr_lut[i].vco_rate)
- break;
- if (i == vco->lpfr_lut_size) {
- pr_err("unable to get loop filter resistance. vco=%ld\n", rate);
- return -EINVAL;
- }
- res = vco->lpfr_lut[i].r;
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_LPFR_CFG, res);
-
- /* Loop filter capacitance values : c1 and c2 */
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_LPFC1_CFG, 0x70);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_LPFC2_CFG, 0x15);
-
- div_s64_rem(vco_clk_rate, vco->ref_clk_rate, &rem);
- if (rem) {
- refclk_cfg = 0x1;
- frac_n_mode = 1;
- ref_doubler_en_b = 0;
- } else {
- refclk_cfg = 0x0;
- frac_n_mode = 0;
- ref_doubler_en_b = 1;
- }
-
- pr_debug("refclk_cfg = %lld\n", refclk_cfg);
-
- ref_clk_to_pll = ((vco->ref_clk_rate * 2 * (refclk_cfg))
- + (ref_doubler_en_b * vco->ref_clk_rate));
- div_fbx1000 = div_s64((vco_clk_rate * 1000), ref_clk_to_pll);
-
- div_s64_rem(div_fbx1000, 1000, &rem);
- frac_n_value = div_s64((rem * (1 << 16)), 1000);
- gen_vco_clk = div_s64(div_fbx1000 * ref_clk_to_pll, 1000);
-
- pr_debug("ref_clk_to_pll = %lld\n", ref_clk_to_pll);
- pr_debug("div_fb = %lld\n", div_fbx1000);
- pr_debug("frac_n_value = %lld\n", frac_n_value);
-
- pr_debug("Generated VCO Clock: %lld\n", gen_vco_clk);
- rem = 0;
- if (frac_n_mode) {
- sdm_cfg0 = (0x0 << 5);
- sdm_cfg0 |= (0x0 & 0x3f);
- sdm_cfg1 = (div_s64(div_fbx1000, 1000) & 0x3f) - 1;
- sdm_cfg3 = div_s64_rem(frac_n_value, 256, &rem);
- sdm_cfg2 = rem;
- } else {
- sdm_cfg0 = (0x1 << 5);
- sdm_cfg0 |= (div_s64(div_fbx1000, 1000) & 0x3f) - 1;
- sdm_cfg1 = (0x0 & 0x3f);
- sdm_cfg2 = 0;
- sdm_cfg3 = 0;
- }
-
- pr_debug("sdm_cfg0=%lld\n", sdm_cfg0);
- pr_debug("sdm_cfg1=%lld\n", sdm_cfg1);
- pr_debug("sdm_cfg2=%lld\n", sdm_cfg2);
- pr_debug("sdm_cfg3=%lld\n", sdm_cfg3);
-
- cal_cfg11 = div_s64_rem(gen_vco_clk, 256 * 1000000, &rem);
- cal_cfg10 = rem / 1000000;
- pr_debug("cal_cfg10=%lld, cal_cfg11=%lld\n", cal_cfg10, cal_cfg11);
-
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CHGPUMP_CFG, 0x02);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG3, 0x2b);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG4, 0x66);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_LKDET_CFG2, 0x0d);
-
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG1, (u32)(sdm_cfg1 & 0xff));
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG2, (u32)(sdm_cfg2 & 0xff));
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG3, (u32)(sdm_cfg3 & 0xff));
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG4, 0x00);
-
- /* Add hardware recommended delay for correct PLL configuration */
- if (dsi_pll_res->vco_delay)
- udelay(dsi_pll_res->vco_delay);
-
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_REFCLK_CFG, (u32)refclk_cfg);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_PWRGEN_CFG, 0x00);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_VCOLPF_CFG, 0x71);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG0, (u32)sdm_cfg0);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG0, 0x12);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG6, 0x30);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG7, 0x00);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG9, 0x00);
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG10, (u32)(cal_cfg10 & 0xff));
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_CAL_CFG11, (u32)(cal_cfg11 & 0xff));
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_EFUSE_CFG, 0x20);
-
- return 0;
-}
-
-unsigned long vco_get_rate(struct clk *c)
-{
- u32 sdm0, doubler, sdm_byp_div;
- u64 vco_rate;
- u32 sdm_dc_off, sdm_freq_seed, sdm2, sdm3;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- u64 ref_clk = vco->ref_clk_rate;
- int rc;
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- /* Check to see if the ref clk doubler is enabled */
- doubler = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_REFCLK_CFG) & BIT(0);
- ref_clk += (doubler * vco->ref_clk_rate);
-
- /* see if it is integer mode or sdm mode */
- sdm0 = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG0);
- if (sdm0 & BIT(6)) {
- /* integer mode */
- sdm_byp_div = (MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG0) & 0x3f) + 1;
- vco_rate = ref_clk * sdm_byp_div;
- } else {
- /* sdm mode */
- sdm_dc_off = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG1) & 0xFF;
- pr_debug("sdm_dc_off = %d\n", sdm_dc_off);
- sdm2 = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG2) & 0xFF;
- sdm3 = MDSS_PLL_REG_R(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_SDM_CFG3) & 0xFF;
- sdm_freq_seed = (sdm3 << 8) | sdm2;
- pr_debug("sdm_freq_seed = %d\n", sdm_freq_seed);
-
- vco_rate = (ref_clk * (sdm_dc_off + 1)) +
- mult_frac(ref_clk, sdm_freq_seed, BIT(16));
- pr_debug("vco rate = %lld", vco_rate);
- }
-
- pr_debug("returning vco rate = %lu\n", (unsigned long)vco_rate);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
-
- return (unsigned long)vco_rate;
-}
-
-static int dsi_pll_enable(struct clk *c)
-{
- int i, rc;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return rc;
- }
-
- /* Try all enable sequences until one succeeds */
- for (i = 0; i < vco->pll_en_seq_cnt; i++) {
- rc = vco->pll_enable_seqs[i](dsi_pll_res);
- pr_debug("DSI PLL %s after sequence #%d\n",
- rc ? "unlocked" : "locked", i + 1);
- if (!rc)
- break;
- }
-
- if (rc) {
- mdss_pll_resource_enable(dsi_pll_res, false);
- pr_err("DSI PLL failed to lock\n");
- }
- dsi_pll_res->pll_on = true;
-
- return rc;
-}
-
-static void dsi_pll_disable(struct clk *c)
-{
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (!dsi_pll_res->pll_on &&
- mdss_pll_resource_enable(dsi_pll_res, true)) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return;
- }
-
- dsi_pll_res->handoff_resources = false;
-
- MDSS_PLL_REG_W(dsi_pll_res->pll_base,
- DSI_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x00);
-
- mdss_pll_resource_enable(dsi_pll_res, false);
- dsi_pll_res->pll_on = false;
-
- pr_debug("DSI PLL Disabled\n");
- return;
-}
-
-long vco_round_rate(struct clk *c, unsigned long rate)
-{
- unsigned long rrate = rate;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
-
- if (rate < vco->min_rate)
- rrate = vco->min_rate;
- if (rate > vco->max_rate)
- rrate = vco->max_rate;
-
- return rrate;
-}
-
-enum handoff vco_handoff(struct clk *c)
-{
- int rc;
- enum handoff ret = HANDOFF_DISABLED_CLK;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (is_gdsc_disabled(dsi_pll_res))
- return HANDOFF_DISABLED_CLK;
-
- rc = mdss_pll_resource_enable(dsi_pll_res, true);
- if (rc) {
- pr_err("Failed to enable mdss dsi pll resources\n");
- return ret;
- }
-
- if (dsi_pll_lock_status(dsi_pll_res)) {
- dsi_pll_res->handoff_resources = true;
- dsi_pll_res->pll_on = true;
- c->rate = vco_get_rate(c);
- ret = HANDOFF_ENABLED_CLK;
- } else {
- mdss_pll_resource_enable(dsi_pll_res, false);
- }
-
- return ret;
-}
-
-int vco_prepare(struct clk *c)
-{
- int rc = 0;
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (!dsi_pll_res) {
- pr_err("Dsi pll resources are not available\n");
- return -EINVAL;
- }
-
- if ((dsi_pll_res->vco_cached_rate != 0)
- && (dsi_pll_res->vco_cached_rate == c->rate)) {
- rc = c->ops->set_rate(c, dsi_pll_res->vco_cached_rate);
- if (rc) {
- pr_err("vco_set_rate failed. rc=%d\n", rc);
- goto error;
- }
- }
-
- rc = dsi_pll_enable(c);
-
-error:
- return rc;
-}
-
-void vco_unprepare(struct clk *c)
-{
- struct dsi_pll_vco_clk *vco = to_vco_clk(c);
- struct mdss_pll_resources *dsi_pll_res = vco->priv;
-
- if (!dsi_pll_res) {
- pr_err("Dsi pll resources are not available\n");
- return;
- }
-
- dsi_pll_res->vco_cached_rate = c->rate;
- dsi_pll_disable(c);
-}
-
diff --git a/drivers/clk/msm/mdss/mdss-dsi-pll.h b/drivers/clk/msm/mdss/mdss-dsi-pll.h
index 5e6ac6af0595..51a421aaaf2f 100644
--- a/drivers/clk/msm/mdss/mdss-dsi-pll.h
+++ b/drivers/clk/msm/mdss/mdss-dsi-pll.h
@@ -50,6 +50,13 @@ static inline struct dsi_pll_vco_clk *to_vco_clk(struct clk *clk)
return container_of(clk, struct dsi_pll_vco_clk, c);
}
+static inline int dsi_pll_div_prepare(struct clk *c)
+{
+ struct div_clk *div = to_div_clk(c);
+ /* Restore the divider's value */
+ return div->ops->set_div(div, div->data.div);
+}
+
int dsi_pll_clock_register_hpm(struct platform_device *pdev,
struct mdss_pll_resources *pll_res);
int dsi_pll_clock_register_20nm(struct platform_device *pdev,
@@ -61,7 +68,6 @@ int dsi_pll_clock_register_8996(struct platform_device *pdev,
int set_byte_mux_sel(struct mux_clk *clk, int sel);
int get_byte_mux_sel(struct mux_clk *clk);
-int dsi_pll_div_prepare(struct clk *c);
int dsi_pll_mux_prepare(struct clk *c);
int fixed_4div_set_div(struct div_clk *clk, int div);
int fixed_4div_get_div(struct div_clk *clk);
diff --git a/drivers/clk/msm/mdss/mdss-edp-pll-28hpm.c b/drivers/clk/msm/mdss/mdss-edp-pll-28hpm.c
deleted file mode 100644
index 48a38bc38b42..000000000000
--- a/drivers/clk/msm/mdss/mdss-edp-pll-28hpm.c
+++ /dev/null
@@ -1,594 +0,0 @@
-/* Copyright (c) 2012-2015, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- */
-
-#define pr_fmt(fmt) "%s: " fmt, __func__
-
-#include <linux/kernel.h>
-#include <linux/err.h>
-#include <linux/delay.h>
-#include <linux/clk.h>
-#include <linux/iopoll.h>
-#include <linux/clk/msm-clk-provider.h>
-#include <linux/clk/msm-clk.h>
-#include <linux/clk/msm-clock-generic.h>
-
-#include <dt-bindings/clock/msm-clocks-8974.h>
-
-#include "mdss-pll.h"
-#include "mdss-edp-pll.h"
-
-#define EDP_PHY_PLL_UNIPHY_PLL_REFCLK_CFG (0x0)
-#define EDP_PHY_PLL_UNIPHY_PLL_POSTDIV1_CFG (0x0004)
-#define EDP_PHY_PLL_UNIPHY_PLL_VCOLPF_CFG (0x000C)
-#define EDP_PHY_PLL_UNIPHY_PLL_GLB_CFG (0x0020)
-#define EDP_PHY_PLL_UNIPHY_PLL_POSTDIV2_CFG (0x0024)
-#define EDP_PHY_PLL_UNIPHY_PLL_POSTDIV3_CFG (0x0028)
-#define EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG0 (0x0038)
-#define EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG1 (0x003C)
-#define EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG2 (0x0040)
-#define EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG3 (0x0044)
-#define EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG4 (0x0048)
-#define EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG0 (0x004C)
-#define EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG1 (0x0050)
-#define EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG2 (0x0054)
-#define EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG3 (0x0058)
-#define EDP_PHY_PLL_UNIPHY_PLL_LKDET_CFG2 (0x0064)
-#define EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG0 (0x006C)
-#define EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG2 (0x0074)
-#define EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG6 (0x0084)
-#define EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG7 (0x0088)
-#define EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG8 (0x008C)
-#define EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG9 (0x0090)
-#define EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG10 (0x0094)
-#define EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG11 (0x0098)
-#define EDP_PHY_PLL_UNIPHY_PLL_LKDET_CFG0 (0x005C)
-#define EDP_PHY_PLL_UNIPHY_PLL_LKDET_CFG1 (0x0060)
-
-#define EDP_PLL_POLL_DELAY_US 50
-#define EDP_PLL_POLL_TIMEOUT_US 500
-
-static struct clk_ops edp_mainlink_clk_src_ops;
-static struct clk_div_ops fixed_5div_ops; /* null ops */
-static struct clk_ops edp_pixel_clk_ops;
-
-static inline struct edp_pll_vco_clk *to_edp_vco_clk(struct clk *clk)
-{
- return container_of(clk, struct edp_pll_vco_clk, c);
-}
-
-int edp_div_prepare(struct clk *c)
-{
- struct div_clk *div = to_div_clk(c);
- /* Restore the divider's value */
- return div->ops->set_div(div, div->data.div);
-}
-
-static int edp_vco_set_rate(struct clk *c, unsigned long vco_rate)
-{
- struct edp_pll_vco_clk *vco = to_edp_vco_clk(c);
- struct mdss_pll_resources *edp_pll_res = vco->priv;
- int rc;
-
- pr_debug("vco_rate=%d\n", (int)vco_rate);
-
- rc = mdss_pll_resource_enable(edp_pll_res, true);
- if (rc) {
- pr_err("failed to enable edp pll res rc=%d\n", rc);
- rc = -EINVAL;
- }
-
- if (vco_rate == 810000000) {
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_VCOLPF_CFG, 0x18);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_LKDET_CFG2, 0x0d);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_REFCLK_CFG, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG0, 0x36);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG1, 0x69);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG2, 0xff);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG3, 0x2f);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG0, 0x80);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG1, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG2, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG3, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG0, 0x12);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG6, 0x5a);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG7, 0x0);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG9, 0x0);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG10, 0x2a);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG11, 0x3);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_LKDET_CFG1, 0x1a);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_POSTDIV1_CFG, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_POSTDIV3_CFG, 0x00);
- } else if (vco_rate == 1350000000) {
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_LKDET_CFG2, 0x0d);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_REFCLK_CFG, 0x01);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG0, 0x36);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG1, 0x62);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG2, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG3, 0x28);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG0, 0x80);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG1, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG2, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_SSC_CFG3, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG0, 0x12);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG6, 0x5a);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG7, 0x0);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG9, 0x0);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG10, 0x46);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_CAL_CFG11, 0x5);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_LKDET_CFG1, 0x1a);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_POSTDIV1_CFG, 0x00);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_POSTDIV3_CFG, 0x00);
- } else {
- pr_err("rate=%d is NOT supported\n", (int)vco_rate);
- vco_rate = 0;
- rc = -EINVAL;
- }
-
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x01);
- udelay(100);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x05);
- udelay(100);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x07);
- udelay(100);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x0f);
- udelay(100);
- mdss_pll_resource_enable(edp_pll_res, false);
-
- vco->rate = vco_rate;
-
- return rc;
-}
-
-static int edp_pll_ready_poll(struct mdss_pll_resources *edp_pll_res)
-{
- int cnt;
- u32 status;
-
- cnt = 100;
- while (cnt--) {
- udelay(100);
- status = MDSS_PLL_REG_R(edp_pll_res->pll_base, 0xc0);
- status &= 0x01;
- if (status)
- break;
- }
- pr_debug("cnt=%d status=%d\n", cnt, (int)status);
-
- if (status)
- return 1;
-
- return 0;
-}
-
-static int edp_vco_enable(struct clk *c)
-{
- int i, ready;
- int rc;
- struct edp_pll_vco_clk *vco = to_edp_vco_clk(c);
- struct mdss_pll_resources *edp_pll_res = vco->priv;
-
- rc = mdss_pll_resource_enable(edp_pll_res, true);
- if (rc) {
- pr_err("edp pll resources not available\n");
- return rc;
- }
-
- for (i = 0; i < 3; i++) {
- ready = edp_pll_ready_poll(edp_pll_res);
- if (ready)
- break;
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x01);
- udelay(100);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x05);
- udelay(100);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x07);
- udelay(100);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_GLB_CFG, 0x0f);
- udelay(100);
- }
-
- if (ready) {
- pr_debug("EDP PLL lock success\n");
- edp_pll_res->pll_on = true;
- rc = 0;
- } else {
- pr_err("EDP PLL failed to lock\n");
- mdss_pll_resource_enable(edp_pll_res, false);
- rc = -EINVAL;
- }
-
- return rc;
-}
-
-static void edp_vco_disable(struct clk *c)
-{
- struct edp_pll_vco_clk *vco = to_edp_vco_clk(c);
- struct mdss_pll_resources *edp_pll_res = vco->priv;
-
- if (!edp_pll_res) {
- pr_err("Invalid input parameter\n");
- return;
- }
-
- if (!edp_pll_res->pll_on &&
- mdss_pll_resource_enable(edp_pll_res, true)) {
- pr_err("edp pll resources not available\n");
- return;
- }
-
- MDSS_PLL_REG_W(edp_pll_res->pll_base, 0x20, 0x00);
-
- edp_pll_res->handoff_resources = false;
- edp_pll_res->pll_on = false;
-
- mdss_pll_resource_enable(edp_pll_res, false);
-
- pr_debug("EDP PLL Disabled\n");
- return;
-}
-
-static unsigned long edp_vco_get_rate(struct clk *c)
-{
- struct edp_pll_vco_clk *vco = to_edp_vco_clk(c);
- struct mdss_pll_resources *edp_pll_res = vco->priv;
- u32 pll_status, div2;
- int rc;
-
- if (is_gdsc_disabled(edp_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(edp_pll_res, true);
- if (rc) {
- pr_err("edp pll resources not available\n");
- return rc;
- }
-
- if (vco->rate == 0) {
- pll_status = MDSS_PLL_REG_R(edp_pll_res->pll_base, 0xc0);
- if (pll_status & 0x01) {
- div2 = MDSS_PLL_REG_R(edp_pll_res->pll_base, 0x24);
- if (div2 & 0x01)
- vco->rate = 1350000000;
- else
- vco->rate = 810000000;
- }
- }
- mdss_pll_resource_enable(edp_pll_res, false);
-
- pr_debug("rate=%d\n", (int)vco->rate);
-
- return vco->rate;
-}
-
-static long edp_vco_round_rate(struct clk *c, unsigned long rate)
-{
- struct edp_pll_vco_clk *vco = to_edp_vco_clk(c);
- unsigned long rrate = -ENOENT;
- unsigned long *lp;
-
- lp = vco->rate_list;
- while (*lp) {
- rrate = *lp;
- if (rate <= rrate)
- break;
- lp++;
- }
-
- pr_debug("rrate=%d\n", (int)rrate);
-
- return rrate;
-}
-
-static int edp_vco_prepare(struct clk *c)
-{
- struct edp_pll_vco_clk *vco = to_edp_vco_clk(c);
-
- pr_debug("rate=%d\n", (int)vco->rate);
-
- return edp_vco_set_rate(c, vco->rate);
-}
-
-static void edp_vco_unprepare(struct clk *c)
-{
- struct edp_pll_vco_clk *vco = to_edp_vco_clk(c);
-
- pr_debug("rate=%d\n", (int)vco->rate);
-
- edp_vco_disable(c);
-}
-
-static int edp_pll_lock_status(struct mdss_pll_resources *edp_pll_res)
-{
- u32 status;
- int pll_locked = 0;
- int rc;
-
- rc = mdss_pll_resource_enable(edp_pll_res, true);
- if (rc) {
- pr_err("edp pll resources not available\n");
- return rc;
- }
-
- /* poll for PLL ready status */
- if (readl_poll_timeout_atomic((edp_pll_res->pll_base + 0xc0),
- status, ((status & BIT(0)) == 1),
- EDP_PLL_POLL_DELAY_US,
- EDP_PLL_POLL_TIMEOUT_US)) {
- pr_debug("EDP PLL status=%x failed to Lock\n", status);
- pll_locked = 0;
- } else {
- pll_locked = 1;
- }
- mdss_pll_resource_enable(edp_pll_res, false);
-
- return pll_locked;
-}
-
-static enum handoff edp_vco_handoff(struct clk *c)
-{
- enum handoff ret = HANDOFF_DISABLED_CLK;
- struct edp_pll_vco_clk *vco = to_edp_vco_clk(c);
- struct mdss_pll_resources *edp_pll_res = vco->priv;
-
- if (is_gdsc_disabled(edp_pll_res))
- return HANDOFF_DISABLED_CLK;
-
- if (mdss_pll_resource_enable(edp_pll_res, true)) {
- pr_err("edp pll resources not available\n");
- return ret;
- }
-
- edp_pll_res->handoff_resources = true;
-
- if (edp_pll_lock_status(edp_pll_res)) {
- c->rate = edp_vco_get_rate(c);
- edp_pll_res->pll_on = true;
- ret = HANDOFF_ENABLED_CLK;
- } else {
- edp_pll_res->handoff_resources = false;
- mdss_pll_resource_enable(edp_pll_res, false);
- }
-
- pr_debug("done, ret=%d\n", ret);
- return ret;
-}
-
-static unsigned long edp_vco_rate_list[] = {
- 810000000, 1350000000, 0};
-
-struct clk_ops edp_vco_clk_ops = {
- .enable = edp_vco_enable,
- .set_rate = edp_vco_set_rate,
- .get_rate = edp_vco_get_rate,
- .round_rate = edp_vco_round_rate,
- .prepare = edp_vco_prepare,
- .unprepare = edp_vco_unprepare,
- .handoff = edp_vco_handoff,
-};
-
-struct edp_pll_vco_clk edp_vco_clk = {
- .ref_clk_rate = 19200000,
- .rate = 0,
- .rate_list = edp_vco_rate_list,
- .c = {
- .dbg_name = "edp_vco_clk",
- .ops = &edp_vco_clk_ops,
- CLK_INIT(edp_vco_clk.c),
- },
-};
-
-static unsigned long edp_mainlink_get_rate(struct clk *c)
-{
- struct div_clk *mclk = to_div_clk(c);
- struct clk *pclk;
- unsigned long rate = 0;
-
- pclk = clk_get_parent(c);
-
- if (pclk && pclk->ops->get_rate) {
- rate = pclk->ops->get_rate(pclk);
- rate /= mclk->data.div;
- }
-
- pr_debug("rate=%d div=%d\n", (int)rate, mclk->data.div);
-
- return rate;
-}
-
-
-struct div_clk edp_mainlink_clk_src = {
- .ops = &fixed_5div_ops,
- .data = {
- .div = 5,
- .min_div = 5,
- .max_div = 5,
- },
- .c = {
- .parent = &edp_vco_clk.c,
- .dbg_name = "edp_mainlink_clk_src",
- .ops = &edp_mainlink_clk_src_ops,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(edp_mainlink_clk_src.c),
- }
-};
-
-/*
- * this rate is from pll to clock controller
- * output from pll to CC has two possibilities
- * 1: if mainlink rate is 270M, then 675M
- * 2: if mainlink rate is 162M, then 810M
- */
-static int edp_pixel_set_div(struct div_clk *clk, int div)
-{
- int rc;
- struct mdss_pll_resources *edp_pll_res = clk->priv;
-
- rc = mdss_pll_resource_enable(edp_pll_res, true);
- if (rc) {
- pr_err("edp pll resources not available\n");
- return rc;
- }
-
- pr_debug("div=%d\n", div);
- MDSS_PLL_REG_W(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_POSTDIV2_CFG, (div - 1));
- mdss_pll_resource_enable(edp_pll_res, false);
-
- return 0;
-}
-
-static int edp_pixel_get_div(struct div_clk *clk)
-{
- int div = 0;
- int rc;
- struct mdss_pll_resources *edp_pll_res = clk->priv;
-
- if (is_gdsc_disabled(edp_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(edp_pll_res, true);
- if (rc) {
- pr_err("edp pll resources not available\n");
- return rc;
- }
-
- div = MDSS_PLL_REG_R(edp_pll_res->pll_base,
- EDP_PHY_PLL_UNIPHY_PLL_POSTDIV2_CFG);
- mdss_pll_resource_enable(edp_pll_res, false);
- div &= 0x01;
- pr_debug("div=%d\n", div);
- return div + 1;
-}
-
-static struct clk_div_ops edp_pixel_ops = {
- .set_div = edp_pixel_set_div,
- .get_div = edp_pixel_get_div,
-};
-
-struct div_clk edp_pixel_clk_src = {
- .data = {
- .max_div = 2,
- .min_div = 1,
- },
- .ops = &edp_pixel_ops,
- .c = {
- .parent = &edp_vco_clk.c,
- .dbg_name = "edp_pixel_clk_src",
- .ops = &edp_pixel_clk_ops,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(edp_pixel_clk_src.c),
- },
-};
-
-static struct clk_lookup mdss_edp_pllcc_8974[] = {
- CLK_LOOKUP("edp_pixel_src", edp_pixel_clk_src.c,
- "fd8c0000.qcom,mmsscc-mdss"),
- CLK_LOOKUP("edp_mainlink_src", edp_mainlink_clk_src.c,
- "fd8c0000.qcom,mmsscc-mdss"),
-};
-
-int edp_pll_clock_register(struct platform_device *pdev,
- struct mdss_pll_resources *pll_res)
-{
- int rc = -ENOTSUPP;
-
- if (!pll_res || !pll_res->pll_base) {
- pr_err("Invalid input parameters\n");
- return -EPROBE_DEFER;
- }
-
- /* Set client data to div and vco clocks */
- edp_pixel_clk_src.priv = pll_res;
- edp_mainlink_clk_src.priv = pll_res;
- edp_vco_clk.priv = pll_res;
-
- /* Set clock operation for mainlink and pixel clock */
- edp_mainlink_clk_src_ops = clk_ops_div;
- edp_mainlink_clk_src_ops.get_parent = clk_get_parent;
- edp_mainlink_clk_src_ops.get_rate = edp_mainlink_get_rate;
-
- edp_pixel_clk_ops = clk_ops_slave_div;
- edp_pixel_clk_ops.prepare = edp_div_prepare;
-
- rc = of_msm_clock_register(pdev->dev.of_node, mdss_edp_pllcc_8974,
- ARRAY_SIZE(mdss_edp_pllcc_8974));
- if (rc) {
- pr_err("Clock register failed rc=%d\n", rc);
- rc = -EPROBE_DEFER;
- }
-
- return rc;
-}
diff --git a/drivers/clk/msm/mdss/mdss-edp-pll.h b/drivers/clk/msm/mdss/mdss-edp-pll.h
deleted file mode 100644
index c1f4f91db4eb..000000000000
--- a/drivers/clk/msm/mdss/mdss-edp-pll.h
+++ /dev/null
@@ -1,27 +0,0 @@
-/* Copyright (c) 2012-2014, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- */
-
-#ifndef __MDSS_EDP_PLL_H
-#define __MDSS_EDP_PLL_H
-
-struct edp_pll_vco_clk {
- unsigned long ref_clk_rate;
- unsigned long rate; /* vco rate */
- unsigned long *rate_list;
- void *priv;
-
- struct clk c;
-};
-
-int edp_pll_clock_register(struct platform_device *pdev,
- struct mdss_pll_resources *pll_res);
-#endif
diff --git a/drivers/clk/msm/mdss/mdss-hdmi-pll-20nm.c b/drivers/clk/msm/mdss/mdss-hdmi-pll-20nm.c
deleted file mode 100644
index 443c7f1ac3ae..000000000000
--- a/drivers/clk/msm/mdss/mdss-hdmi-pll-20nm.c
+++ /dev/null
@@ -1,974 +0,0 @@
-/* Copyright (c) 2012-2015, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- */
-
-#include <linux/kernel.h>
-#include <linux/err.h>
-#include <linux/delay.h>
-#include <linux/iopoll.h>
-#include <linux/clk/msm-clk-provider.h>
-#include <linux/clk/msm-clk.h>
-#include <linux/clk/msm-clock-generic.h>
-#include <dt-bindings/clock/msm-clocks-8994.h>
-
-#include "mdss-pll.h"
-#include "mdss-hdmi-pll.h"
-
-/* hdmi phy registers */
-
-#define HDMI_PHY_CMD_SIZE 68
-#define HDMI_PHY_CLK_SIZE 97
-
-/* Set to 1 for auto KVCO cal; set to 0 for fixed value */
-#define HDMI_PHY_AUTO_KVCO_CAL 1
-
-/* PLL REGISTERS */
-#define QSERDES_COM_SYS_CLK_CTRL (0x000)
-#define QSERDES_COM_PLL_VCOTAIL_EN (0x004)
-#define QSERDES_COM_CMN_MODE (0x008)
-#define QSERDES_COM_IE_TRIM (0x00C)
-#define QSERDES_COM_IP_TRIM (0x010)
-#define QSERDES_COM_PLL_CNTRL (0x014)
-#define QSERDES_COM_PLL_PHSEL_CONTROL (0x018)
-#define QSERDES_COM_IPTAT_TRIM_VCCA_TX_SEL (0x01C)
-#define QSERDES_COM_PLL_PHSEL_DC (0x020)
-#define QSERDES_COM_PLL_IP_SETI (0x024)
-#define QSERDES_COM_CORE_CLK_IN_SYNC_SEL (0x028)
-#define QSERDES_COM_PLL_BKG_KVCO_CAL_EN (0x02C)
-#define QSERDES_COM_BIAS_EN_CLKBUFLR_EN (0x030)
-#define QSERDES_COM_PLL_CP_SETI (0x034)
-#define QSERDES_COM_PLL_IP_SETP (0x038)
-#define QSERDES_COM_PLL_CP_SETP (0x03C)
-#define QSERDES_COM_ATB_SEL1 (0x040)
-#define QSERDES_COM_ATB_SEL2 (0x044)
-#define QSERDES_COM_SYSCLK_EN_SEL_TXBAND (0x048)
-#define QSERDES_COM_RESETSM_CNTRL (0x04C)
-#define QSERDES_COM_RESETSM_CNTRL2 (0x050)
-#define QSERDES_COM_RESETSM_CNTRL3 (0x054)
-#define QSERDES_COM_RESETSM_PLL_CAL_COUNT1 (0x058)
-#define QSERDES_COM_RESETSM_PLL_CAL_COUNT2 (0x05C)
-#define QSERDES_COM_DIV_REF1 (0x060)
-#define QSERDES_COM_DIV_REF2 (0x064)
-#define QSERDES_COM_KVCO_COUNT1 (0x068)
-#define QSERDES_COM_KVCO_COUNT2 (0x06C)
-#define QSERDES_COM_KVCO_CAL_CNTRL (0x070)
-#define QSERDES_COM_KVCO_CODE (0x074)
-#define QSERDES_COM_VREF_CFG1 (0x078)
-#define QSERDES_COM_VREF_CFG2 (0x07C)
-#define QSERDES_COM_VREF_CFG3 (0x080)
-#define QSERDES_COM_VREF_CFG4 (0x084)
-#define QSERDES_COM_VREF_CFG5 (0x088)
-#define QSERDES_COM_VREF_CFG6 (0x08C)
-#define QSERDES_COM_PLLLOCK_CMP1 (0x090)
-#define QSERDES_COM_PLLLOCK_CMP2 (0x094)
-#define QSERDES_COM_PLLLOCK_CMP3 (0x098)
-#define QSERDES_COM_PLLLOCK_CMP_EN (0x09C)
-#define QSERDES_COM_BGTC (0x0A0)
-#define QSERDES_COM_PLL_TEST_UPDN (0x0A4)
-#define QSERDES_COM_PLL_VCO_TUNE (0x0A8)
-#define QSERDES_COM_DEC_START1 (0x0AC)
-#define QSERDES_COM_PLL_AMP_OS (0x0B0)
-#define QSERDES_COM_SSC_EN_CENTER (0x0B4)
-#define QSERDES_COM_SSC_ADJ_PER1 (0x0B8)
-#define QSERDES_COM_SSC_ADJ_PER2 (0x0BC)
-#define QSERDES_COM_SSC_PER1 (0x0C0)
-#define QSERDES_COM_SSC_PER2 (0x0C4)
-#define QSERDES_COM_SSC_STEP_SIZE1 (0x0C8)
-#define QSERDES_COM_SSC_STEP_SIZE2 (0x0CC)
-#define QSERDES_COM_RES_CODE_UP (0x0D0)
-#define QSERDES_COM_RES_CODE_DN (0x0D4)
-#define QSERDES_COM_RES_CODE_UP_OFFSET (0x0D8)
-#define QSERDES_COM_RES_CODE_DN_OFFSET (0x0DC)
-#define QSERDES_COM_RES_CODE_START_SEG1 (0x0E0)
-#define QSERDES_COM_RES_CODE_START_SEG2 (0x0E4)
-#define QSERDES_COM_RES_CODE_CAL_CSR (0x0E8)
-#define QSERDES_COM_RES_CODE (0x0EC)
-#define QSERDES_COM_RES_TRIM_CONTROL (0x0F0)
-#define QSERDES_COM_RES_TRIM_CONTROL2 (0x0F4)
-#define QSERDES_COM_RES_TRIM_EN_VCOCALDONE (0x0F8)
-#define QSERDES_COM_FAUX_EN (0x0FC)
-#define QSERDES_COM_DIV_FRAC_START1 (0x100)
-#define QSERDES_COM_DIV_FRAC_START2 (0x104)
-#define QSERDES_COM_DIV_FRAC_START3 (0x108)
-#define QSERDES_COM_DEC_START2 (0x10C)
-#define QSERDES_COM_PLL_RXTXEPCLK_EN (0x110)
-#define QSERDES_COM_PLL_CRCTRL (0x114)
-#define QSERDES_COM_PLL_CLKEPDIV (0x118)
-#define QSERDES_COM_PLL_FREQUPDATE (0x11C)
-#define QSERDES_COM_PLL_BKGCAL_TRIM_UP (0x120)
-#define QSERDES_COM_PLL_BKGCAL_TRIM_DN (0x124)
-#define QSERDES_COM_PLL_BKGCAL_TRIM_MUX (0x128)
-#define QSERDES_COM_PLL_BKGCAL_VREF_CFG (0x12C)
-#define QSERDES_COM_PLL_BKGCAL_DIV_REF1 (0x130)
-#define QSERDES_COM_PLL_BKGCAL_DIV_REF2 (0x134)
-#define QSERDES_COM_MUXADDR (0x138)
-#define QSERDES_COM_LOW_POWER_RO_CONTROL (0x13C)
-#define QSERDES_COM_POST_DIVIDER_CONTROL (0x140)
-#define QSERDES_COM_HR_OCLK2_DIVIDER (0x144)
-#define QSERDES_COM_HR_OCLK3_DIVIDER (0x148)
-#define QSERDES_COM_PLL_VCO_HIGH (0x14C)
-#define QSERDES_COM_RESET_SM (0x150)
-#define QSERDES_COM_MUXVAL (0x154)
-#define QSERDES_COM_CORE_RES_CODE_DN (0x158)
-#define QSERDES_COM_CORE_RES_CODE_UP (0x15C)
-#define QSERDES_COM_CORE_VCO_TUNE (0x160)
-#define QSERDES_COM_CORE_VCO_TAIL (0x164)
-#define QSERDES_COM_CORE_KVCO_CODE (0x168)
-
-/* Tx Channel 0 REGISTERS */
-#define QSERDES_TX_L0_BIST_MODE_LANENO (0x00)
-#define QSERDES_TX_L0_CLKBUF_ENABLE (0x04)
-#define QSERDES_TX_L0_TX_EMP_POST1_LVL (0x08)
-#define QSERDES_TX_L0_TX_DRV_LVL (0x0C)
-#define QSERDES_TX_L0_RESET_TSYNC_EN (0x10)
-#define QSERDES_TX_L0_LPB_EN (0x14)
-#define QSERDES_TX_L0_RES_CODE_UP (0x18)
-#define QSERDES_TX_L0_RES_CODE_DN (0x1C)
-#define QSERDES_TX_L0_PERL_LENGTH1 (0x20)
-#define QSERDES_TX_L0_PERL_LENGTH2 (0x24)
-#define QSERDES_TX_L0_SERDES_BYP_EN_OUT (0x28)
-#define QSERDES_TX_L0_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN (0x2C)
-#define QSERDES_TX_L0_PARRATE_REC_DETECT_IDLE_EN (0x30)
-#define QSERDES_TX_L0_BIST_PATTERN1 (0x34)
-#define QSERDES_TX_L0_BIST_PATTERN2 (0x38)
-#define QSERDES_TX_L0_BIST_PATTERN3 (0x3C)
-#define QSERDES_TX_L0_BIST_PATTERN4 (0x40)
-#define QSERDES_TX_L0_BIST_PATTERN5 (0x44)
-#define QSERDES_TX_L0_BIST_PATTERN6 (0x48)
-#define QSERDES_TX_L0_BIST_PATTERN7 (0x4C)
-#define QSERDES_TX_L0_BIST_PATTERN8 (0x50)
-#define QSERDES_TX_L0_LANE_MODE (0x54)
-#define QSERDES_TX_L0_IDAC_CAL_LANE_MODE (0x58)
-#define QSERDES_TX_L0_IDAC_CAL_LANE_MODE_CONFIGURATION (0x5C)
-#define QSERDES_TX_L0_ATB_SEL1 (0x60)
-#define QSERDES_TX_L0_ATB_SEL2 (0x64)
-#define QSERDES_TX_L0_RCV_DETECT_LVL (0x68)
-#define QSERDES_TX_L0_PRBS_SEED1 (0x6C)
-#define QSERDES_TX_L0_PRBS_SEED2 (0x70)
-#define QSERDES_TX_L0_PRBS_SEED3 (0x74)
-#define QSERDES_TX_L0_PRBS_SEED4 (0x78)
-#define QSERDES_TX_L0_RESET_GEN (0x7C)
-#define QSERDES_TX_L0_TRAN_DRVR_EMP_EN (0x80)
-#define QSERDES_TX_L0_TX_INTERFACE_MODE (0x84)
-#define QSERDES_TX_L0_PWM_CTRL (0x88)
-#define QSERDES_TX_L0_PWM_DATA (0x8C)
-#define QSERDES_TX_L0_PWM_ENC_DIV_CTRL (0x90)
-#define QSERDES_TX_L0_VMODE_CTRL1 (0x94)
-#define QSERDES_TX_L0_VMODE_CTRL2 (0x98)
-#define QSERDES_TX_L0_VMODE_CTRL3 (0x9C)
-#define QSERDES_TX_L0_VMODE_CTRL4 (0xA0)
-#define QSERDES_TX_L0_VMODE_CTRL5 (0xA4)
-#define QSERDES_TX_L0_VMODE_CTRL6 (0xA8)
-#define QSERDES_TX_L0_VMODE_CTRL7 (0xAC)
-#define QSERDES_TX_L0_TX_ALOG_INTF_OBSV_CNTL (0xB0)
-#define QSERDES_TX_L0_BIST_STATUS (0xB4)
-#define QSERDES_TX_L0_BIST_ERROR_COUNT1 (0xB8)
-#define QSERDES_TX_L0_BIST_ERROR_COUNT2 (0xBC)
-#define QSERDES_TX_L0_TX_ALOG_INTF_OBSV (0xC0)
-#define QSERDES_TX_L0_PWM_DEC_STATUS (0xC4)
-
-/* Tx Channel 1 REGISTERS */
-#define QSERDES_TX_L1_BIST_MODE_LANENO (0x00)
-#define QSERDES_TX_L1_CLKBUF_ENABLE (0x04)
-#define QSERDES_TX_L1_TX_EMP_POST1_LVL (0x08)
-#define QSERDES_TX_L1_TX_DRV_LVL (0x0C)
-#define QSERDES_TX_L1_RESET_TSYNC_EN (0x10)
-#define QSERDES_TX_L1_LPB_EN (0x14)
-#define QSERDES_TX_L1_RES_CODE_UP (0x18)
-#define QSERDES_TX_L1_RES_CODE_DN (0x1C)
-#define QSERDES_TX_L1_PERL_LENGTH1 (0x20)
-#define QSERDES_TX_L1_PERL_LENGTH2 (0x24)
-#define QSERDES_TX_L1_SERDES_BYP_EN_OUT (0x28)
-#define QSERDES_TX_L1_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN (0x2C)
-#define QSERDES_TX_L1_PARRATE_REC_DETECT_IDLE_EN (0x30)
-#define QSERDES_TX_L1_BIST_PATTERN1 (0x34)
-#define QSERDES_TX_L1_BIST_PATTERN2 (0x38)
-#define QSERDES_TX_L1_BIST_PATTERN3 (0x3C)
-#define QSERDES_TX_L1_BIST_PATTERN4 (0x40)
-#define QSERDES_TX_L1_BIST_PATTERN5 (0x44)
-#define QSERDES_TX_L1_BIST_PATTERN6 (0x48)
-#define QSERDES_TX_L1_BIST_PATTERN7 (0x4C)
-#define QSERDES_TX_L1_BIST_PATTERN8 (0x50)
-#define QSERDES_TX_L1_LANE_MODE (0x54)
-#define QSERDES_TX_L1_IDAC_CAL_LANE_MODE (0x58)
-#define QSERDES_TX_L1_IDAC_CAL_LANE_MODE_CONFIGURATION (0x5C)
-#define QSERDES_TX_L1_ATB_SEL1 (0x60)
-#define QSERDES_TX_L1_ATB_SEL2 (0x64)
-#define QSERDES_TX_L1_RCV_DETECT_LVL (0x68)
-#define QSERDES_TX_L1_PRBS_SEED1 (0x6C)
-#define QSERDES_TX_L1_PRBS_SEED2 (0x70)
-#define QSERDES_TX_L1_PRBS_SEED3 (0x74)
-#define QSERDES_TX_L1_PRBS_SEED4 (0x78)
-#define QSERDES_TX_L1_RESET_GEN (0x7C)
-#define QSERDES_TX_L1_TRAN_DRVR_EMP_EN (0x80)
-#define QSERDES_TX_L1_TX_INTERFACE_MODE (0x84)
-#define QSERDES_TX_L1_PWM_CTRL (0x88)
-#define QSERDES_TX_L1_PWM_DATA (0x8C)
-#define QSERDES_TX_L1_PWM_ENC_DIV_CTRL (0x90)
-#define QSERDES_TX_L1_VMODE_CTRL1 (0x94)
-#define QSERDES_TX_L1_VMODE_CTRL2 (0x98)
-#define QSERDES_TX_L1_VMODE_CTRL3 (0x9C)
-#define QSERDES_TX_L1_VMODE_CTRL4 (0xA0)
-#define QSERDES_TX_L1_VMODE_CTRL5 (0xA4)
-#define QSERDES_TX_L1_VMODE_CTRL6 (0xA8)
-#define QSERDES_TX_L1_VMODE_CTRL7 (0xAC)
-#define QSERDES_TX_L1_TX_ALOG_INTF_OBSV_CNTL (0xB0)
-#define QSERDES_TX_L1_BIST_STATUS (0xB4)
-#define QSERDES_TX_L1_BIST_ERROR_COUNT1 (0xB8)
-#define QSERDES_TX_L1_BIST_ERROR_COUNT2 (0xBC)
-#define QSERDES_TX_L1_TX_ALOG_INTF_OBSV (0xC0)
-#define QSERDES_TX_L1_PWM_DEC_STATUS (0xC4)
-
-/* Tx Channel 2 REGISERS */
-#define QSERDES_TX_L2_BIST_MODE_LANENO (0x00)
-#define QSERDES_TX_L2_CLKBUF_ENABLE (0x04)
-#define QSERDES_TX_L2_TX_EMP_POST1_LVL (0x08)
-#define QSERDES_TX_L2_TX_DRV_LVL (0x0C)
-#define QSERDES_TX_L2_RESET_TSYNC_EN (0x10)
-#define QSERDES_TX_L2_LPB_EN (0x14)
-#define QSERDES_TX_L2_RES_CODE_UP (0x18)
-#define QSERDES_TX_L2_RES_CODE_DN (0x1C)
-#define QSERDES_TX_L2_PERL_LENGTH1 (0x20)
-#define QSERDES_TX_L2_PERL_LENGTH2 (0x24)
-#define QSERDES_TX_L2_SERDES_BYP_EN_OUT (0x28)
-#define QSERDES_TX_L2_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN (0x2C)
-#define QSERDES_TX_L2_PARRATE_REC_DETECT_IDLE_EN (0x30)
-#define QSERDES_TX_L2_BIST_PATTERN1 (0x34)
-#define QSERDES_TX_L2_BIST_PATTERN2 (0x38)
-#define QSERDES_TX_L2_BIST_PATTERN3 (0x3C)
-#define QSERDES_TX_L2_BIST_PATTERN4 (0x40)
-#define QSERDES_TX_L2_BIST_PATTERN5 (0x44)
-#define QSERDES_TX_L2_BIST_PATTERN6 (0x48)
-#define QSERDES_TX_L2_BIST_PATTERN7 (0x4C)
-#define QSERDES_TX_L2_BIST_PATTERN8 (0x50)
-#define QSERDES_TX_L2_LANE_MODE (0x54)
-#define QSERDES_TX_L2_IDAC_CAL_LANE_MODE (0x58)
-#define QSERDES_TX_L2_IDAC_CAL_LANE_MODE_CONFIGURATION (0x5C)
-#define QSERDES_TX_L2_ATB_SEL1 (0x60)
-#define QSERDES_TX_L2_ATB_SEL2 (0x64)
-#define QSERDES_TX_L2_RCV_DETECT_LVL (0x68)
-#define QSERDES_TX_L2_PRBS_SEED1 (0x6C)
-#define QSERDES_TX_L2_PRBS_SEED2 (0x70)
-#define QSERDES_TX_L2_PRBS_SEED3 (0x74)
-#define QSERDES_TX_L2_PRBS_SEED4 (0x78)
-#define QSERDES_TX_L2_RESET_GEN (0x7C)
-#define QSERDES_TX_L2_TRAN_DRVR_EMP_EN (0x80)
-#define QSERDES_TX_L2_TX_INTERFACE_MODE (0x84)
-#define QSERDES_TX_L2_PWM_CTRL (0x88)
-#define QSERDES_TX_L2_PWM_DATA (0x8C)
-#define QSERDES_TX_L2_PWM_ENC_DIV_CTRL (0x90)
-#define QSERDES_TX_L2_VMODE_CTRL1 (0x94)
-#define QSERDES_TX_L2_VMODE_CTRL2 (0x98)
-#define QSERDES_TX_L2_VMODE_CTRL3 (0x9C)
-#define QSERDES_TX_L2_VMODE_CTRL4 (0xA0)
-#define QSERDES_TX_L2_VMODE_CTRL5 (0xA4)
-#define QSERDES_TX_L2_VMODE_CTRL6 (0xA8)
-#define QSERDES_TX_L2_VMODE_CTRL7 (0xAC)
-#define QSERDES_TX_L2_TX_ALOG_INTF_OBSV_CNTL (0xB0)
-#define QSERDES_TX_L2_BIST_STATUS (0xB4)
-#define QSERDES_TX_L2_BIST_ERROR_COUNT1 (0xB8)
-#define QSERDES_TX_L2_BIST_ERROR_COUNT2 (0xBC)
-#define QSERDES_TX_L2_TX_ALOG_INTF_OBSV (0xC0)
-#define QSERDES_TX_L2_PWM_DEC_STATUS (0xC4)
-
-/* Tx Channel 3 REGISERS */
-#define QSERDES_TX_L3_BIST_MODE_LANENO (0x00)
-#define QSERDES_TX_L3_CLKBUF_ENABLE (0x04)
-#define QSERDES_TX_L3_TX_EMP_POST1_LVL (0x08)
-#define QSERDES_TX_L3_TX_DRV_LVL (0x0C)
-#define QSERDES_TX_L3_RESET_TSYNC_EN (0x10)
-#define QSERDES_TX_L3_LPB_EN (0x14)
-#define QSERDES_TX_L3_RES_CODE_UP (0x18)
-#define QSERDES_TX_L3_RES_CODE_DN (0x1C)
-#define QSERDES_TX_L3_PERL_LENGTH1 (0x20)
-#define QSERDES_TX_L3_PERL_LENGTH2 (0x24)
-#define QSERDES_TX_L3_SERDES_BYP_EN_OUT (0x28)
-#define QSERDES_TX_L3_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN (0x2C)
-#define QSERDES_TX_L3_PARRATE_REC_DETECT_IDLE_EN (0x30)
-#define QSERDES_TX_L3_BIST_PATTERN1 (0x34)
-#define QSERDES_TX_L3_BIST_PATTERN2 (0x38)
-#define QSERDES_TX_L3_BIST_PATTERN3 (0x3C)
-#define QSERDES_TX_L3_BIST_PATTERN4 (0x40)
-#define QSERDES_TX_L3_BIST_PATTERN5 (0x44)
-#define QSERDES_TX_L3_BIST_PATTERN6 (0x48)
-#define QSERDES_TX_L3_BIST_PATTERN7 (0x4C)
-#define QSERDES_TX_L3_BIST_PATTERN8 (0x50)
-#define QSERDES_TX_L3_LANE_MODE (0x54)
-#define QSERDES_TX_L3_IDAC_CAL_LANE_MODE (0x58)
-#define QSERDES_TX_L3_IDAC_CAL_LANE_MODE_CONFIGURATION (0x5C)
-#define QSERDES_TX_L3_ATB_SEL1 (0x60)
-#define QSERDES_TX_L3_ATB_SEL2 (0x64)
-#define QSERDES_TX_L3_RCV_DETECT_LVL (0x68)
-#define QSERDES_TX_L3_PRBS_SEED1 (0x6C)
-#define QSERDES_TX_L3_PRBS_SEED2 (0x70)
-#define QSERDES_TX_L3_PRBS_SEED3 (0x74)
-#define QSERDES_TX_L3_PRBS_SEED4 (0x78)
-#define QSERDES_TX_L3_RESET_GEN (0x7C)
-#define QSERDES_TX_L3_TRAN_DRVR_EMP_EN (0x80)
-#define QSERDES_TX_L3_TX_INTERFACE_MODE (0x84)
-#define QSERDES_TX_L3_PWM_CTRL (0x88)
-#define QSERDES_TX_L3_PWM_DATA (0x8C)
-#define QSERDES_TX_L3_PWM_ENC_DIV_CTRL (0x90)
-#define QSERDES_TX_L3_VMODE_CTRL1 (0x94)
-#define QSERDES_TX_L3_VMODE_CTRL2 (0x98)
-#define QSERDES_TX_L3_VMODE_CTRL3 (0x9C)
-#define QSERDES_TX_L3_VMODE_CTRL4 (0xA0)
-#define QSERDES_TX_L3_VMODE_CTRL5 (0xA4)
-#define QSERDES_TX_L3_VMODE_CTRL6 (0xA8)
-#define QSERDES_TX_L3_VMODE_CTRL7 (0xAC)
-#define QSERDES_TX_L3_TX_ALOG_INTF_OBSV_CNTL (0xB0)
-#define QSERDES_TX_L3_BIST_STATUS (0xB4)
-#define QSERDES_TX_L3_BIST_ERROR_COUNT1 (0xB8)
-#define QSERDES_TX_L3_BIST_ERROR_COUNT2 (0xBC)
-#define QSERDES_TX_L3_TX_ALOG_INTF_OBSV (0xC0)
-#define QSERDES_TX_L3_PWM_DEC_STATUS (0xC4)
-
-/* HDMI PHY REGISTERS */
-#define HDMI_PHY_CFG (0x00)
-#define HDMI_PHY_PD_CTL (0x04)
-#define HDMI_PHY_MODE (0x08)
-#define HDMI_PHY_MISR_CLEAR (0x0C)
-#define HDMI_PHY_TX0_TX1_BIST_CFG0 (0x10)
-#define HDMI_PHY_TX0_TX1_BIST_CFG1 (0x14)
-#define HDMI_PHY_TX0_TX1_PRBS_SEED_BYTE0 (0x18)
-#define HDMI_PHY_TX0_TX1_PRBS_SEED_BYTE1 (0x1C)
-#define HDMI_PHY_TX0_TX1_PRBS_SEED_BYTE2 (0x20)
-#define HDMI_PHY_TX0_TX1_PRBS_SEED_BYTE3 (0x24)
-#define HDMI_PHY_TX0_TX1_PRBS_POLY_BYTE0 (0x28)
-#define HDMI_PHY_TX0_TX1_PRBS_POLY_BYTE1 (0x2C)
-#define HDMI_PHY_TX0_TX1_PRBS_POLY_BYTE2 (0x30)
-#define HDMI_PHY_TX0_TX1_PRBS_POLY_BYTE3 (0x34)
-#define HDMI_PHY_TX2_TX3_BIST_CFG0 (0x38)
-#define HDMI_PHY_TX2_TX3_BIST_CFG1 (0x3C)
-#define HDMI_PHY_TX2_TX3_PRBS_SEED_BYTE0 (0x40)
-#define HDMI_PHY_TX2_TX3_PRBS_SEED_BYTE1 (0x44)
-#define HDMI_PHY_TX2_TX3_PRBS_SEED_BYTE2 (0x48)
-#define HDMI_PHY_TX2_TX3_PRBS_SEED_BYTE3 (0x4C)
-#define HDMI_PHY_TX2_TX3_PRBS_POLY_BYTE0 (0x50)
-#define HDMI_PHY_TX2_TX3_PRBS_POLY_BYTE1 (0x54)
-#define HDMI_PHY_TX2_TX3_PRBS_POLY_BYTE2 (0x58)
-#define HDMI_PHY_TX2_TX3_PRBS_POLY_BYTE3 (0x5C)
-#define HDMI_PHY_DEBUG_BUS_SEL (0x60)
-#define HDMI_PHY_TXCAL_CFG0 (0x64)
-#define HDMI_PHY_TXCAL_CFG1 (0x68)
-#define HDMI_PHY_TX0_TX1_BIST_STATUS0 (0x6C)
-#define HDMI_PHY_TX0_TX1_BIST_STATUS1 (0x70)
-#define HDMI_PHY_TX0_TX1_BIST_STATUS2 (0x74)
-#define HDMI_PHY_TX2_TX3_BIST_STATUS0 (0x78)
-#define HDMI_PHY_TX2_TX3_BIST_STATUS1 (0x7C)
-#define HDMI_PHY_TX2_TX3_BIST_STATUS2 (0x80)
-#define HDMI_PHY_PRE_MISR_STATUS0 (0x84)
-#define HDMI_PHY_PRE_MISR_STATUS1 (0x88)
-#define HDMI_PHY_PRE_MISR_STATUS2 (0x8C)
-#define HDMI_PHY_PRE_MISR_STATUS3 (0x90)
-#define HDMI_PHY_POST_MISR_STATUS0 (0x94)
-#define HDMI_PHY_POST_MISR_STATUS1 (0x98)
-#define HDMI_PHY_POST_MISR_STATUS2 (0x9C)
-#define HDMI_PHY_POST_MISR_STATUS3 (0xA0)
-#define HDMI_PHY_STATUS (0xA4)
-#define HDMI_PHY_MISC3_STATUS (0xA8)
-#define HDMI_PHY_DEBUG_BUS0 (0xAC)
-#define HDMI_PHY_DEBUG_BUS1 (0xB0)
-#define HDMI_PHY_DEBUG_BUS2 (0xB4)
-#define HDMI_PHY_DEBUG_BUS3 (0xB8)
-#define HDMI_PHY_REVISION_ID0 (0xBC)
-#define HDMI_PHY_REVISION_ID1 (0xC0)
-#define HDMI_PHY_REVISION_ID2 (0xC4)
-#define HDMI_PHY_REVISION_ID3 (0xC8)
-
-#define HDMI_PLL_POLL_DELAY_US 50
-#define HDMI_PLL_POLL_TIMEOUT_US 125000
-#define HDMI_PLL_REF_CLK_RATE 192ULL
-#define HDMI_PLL_DIVISOR 10000000000ULL
-#define HDMI_PLL_DIVISOR_32 100000U
-#define HDMI_PLL_MIN_VCO_CLK 160000000ULL
-#define HDMI_PLL_TMDS_MAX 800000000U
-
-
-static int hdmi_20nm_pll_lock_status(struct mdss_pll_resources *io)
-{
- u32 status;
- int pll_locked = 0;
- int phy_ready = 0;
- int rc;
-
- rc = mdss_pll_resource_enable(io, true);
- if (rc) {
- pr_err("pll resource can't be enabled\n");
- return rc;
- }
-
- /* Poll for C_READY and PHY READY */
- pr_debug("%s: Waiting for PHY Ready\n", __func__);
-
- /* poll for PLL ready status */
- if (!readl_poll_timeout_atomic(
- (io->pll_base + QSERDES_COM_RESET_SM),
- status, ((status & BIT(6)) == 1),
- HDMI_PLL_POLL_DELAY_US,
- HDMI_PLL_POLL_TIMEOUT_US)) {
- pr_debug("%s: C READY\n", __func__);
- pll_locked = 1;
- } else {
- pr_debug("%s: C READY TIMEOUT\n", __func__);
- pll_locked = 0;
- }
-
- /* poll for PHY ready status */
- if (pll_locked && !readl_poll_timeout_atomic(
- (io->phy_base + HDMI_PHY_STATUS),
- status, ((status & BIT(0)) == 1),
- HDMI_PLL_POLL_DELAY_US,
- HDMI_PLL_POLL_TIMEOUT_US)) {
- pr_debug("%s: PHY READY\n", __func__);
- phy_ready = 1;
- } else {
- pr_debug("%s: PHY READY TIMEOUT\n", __func__);
- phy_ready = 0;
- }
- mdss_pll_resource_enable(io, false);
-
- return phy_ready;
-}
-
-static inline struct hdmi_pll_vco_clk *to_hdmi_20nm_vco_clk(struct clk *clk)
-{
- return container_of(clk, struct hdmi_pll_vco_clk, c);
-}
-
-static inline u32 hdmi_20nm_phy_pll_vco_reg_val(struct hdmi_pll_cfg *pll_cfg,
- u32 tmds_clk)
-{
- u32 index = 0;
- while (pll_cfg[index].vco_rate < HDMI_PLL_TMDS_MAX &&
- pll_cfg[index].vco_rate < tmds_clk)
- index++;
- return pll_cfg[index].reg;
-}
-
-static void hdmi_20nm_phy_pll_calc_settings(struct mdss_pll_resources *io,
- struct hdmi_pll_vco_clk *vco, u32 vco_clk, u32 tmds_clk)
-{
- u32 val = 0;
- u64 dec_start_val, frac_start_val, pll_lock_cmp;
-
- /* Calculate decimal and fractional values */
- dec_start_val = 1000000UL * vco_clk;
- do_div(dec_start_val, HDMI_PLL_REF_CLK_RATE);
- do_div(dec_start_val, 2U);
- frac_start_val = dec_start_val;
- do_div(frac_start_val, HDMI_PLL_DIVISOR_32);
- do_div(frac_start_val, HDMI_PLL_DIVISOR_32);
- frac_start_val *= HDMI_PLL_DIVISOR;
- frac_start_val = dec_start_val - frac_start_val;
- frac_start_val *= (u64)(2 << 19);
- do_div(frac_start_val, HDMI_PLL_DIVISOR_32);
- do_div(frac_start_val, HDMI_PLL_DIVISOR_32);
- pll_lock_cmp = dec_start_val;
- do_div(pll_lock_cmp, 10U);
- pll_lock_cmp *= 0x800;
- do_div(pll_lock_cmp, HDMI_PLL_DIVISOR_32);
- do_div(pll_lock_cmp, HDMI_PLL_DIVISOR_32);
- pll_lock_cmp -= 1U;
- do_div(dec_start_val, HDMI_PLL_DIVISOR_32);
- do_div(dec_start_val, HDMI_PLL_DIVISOR_32);
-
- /* PLL loop bandwidth */
- val = hdmi_20nm_phy_pll_vco_reg_val(vco->ip_seti, tmds_clk);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_IP_SETI, val);
- val = hdmi_20nm_phy_pll_vco_reg_val(vco->cp_seti, tmds_clk);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_CP_SETI, val);
- val = hdmi_20nm_phy_pll_vco_reg_val(vco->cp_setp, tmds_clk);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_CP_SETP, val);
- val = hdmi_20nm_phy_pll_vco_reg_val(vco->ip_setp, tmds_clk);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_IP_SETP, val);
- val = hdmi_20nm_phy_pll_vco_reg_val(vco->crctrl, tmds_clk);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_CRCTRL, val);
-
- /* PLL calibration */
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_DIV_FRAC_START1,
- 0x80 | (frac_start_val & 0x7F));
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_DIV_FRAC_START2,
- 0x80 | ((frac_start_val >> 7) & 0x7F));
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_DIV_FRAC_START3,
- 0x40 | ((frac_start_val >> 14) & 0x3F));
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_DEC_START1,
- 0x80 | (dec_start_val & 0x7F));
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_DEC_START2,
- 0x02 | (0x01 & dec_start_val >> 7));
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLLLOCK_CMP1,
- pll_lock_cmp & 0xFF);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLLLOCK_CMP2,
- (pll_lock_cmp >> 8) & 0xFF);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLLLOCK_CMP3,
- (pll_lock_cmp >> 16) & 0xFF);
-}
-
-static u32 hdmi_20nm_phy_pll_set_clk_rate(struct clk *c, u32 tmds_clk)
-{
- u32 tx_band = 0;
-
- struct hdmi_pll_vco_clk *vco = to_hdmi_20nm_vco_clk(c);
- struct mdss_pll_resources *io = vco->priv;
- u64 vco_clk = tmds_clk;
-
- while (vco_clk > 0 && vco_clk < HDMI_PLL_MIN_VCO_CLK) {
- tx_band++;
- vco_clk *= 2;
- }
-
- /* Initially shut down PHY */
- pr_debug("%s: Disabling PHY\n", __func__);
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_PD_CTL, 0x0);
- udelay(1000);
- mb();
-
- /* power-up and recommended common block settings */
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_PD_CTL, 0x1F);
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_CFG, 0x01);
- udelay(1000);
- mb();
-
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_CFG, 0x07);
- udelay(1000);
- mb();
-
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_CFG, 0x05);
- udelay(1000);
- mb();
-
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_SYS_CLK_CTRL, 0x42);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_VCOTAIL_EN, 0x03);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_CMN_MODE, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_IE_TRIM, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_IP_TRIM, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_CNTRL, 0x07);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_PHSEL_CONTROL, 0x04);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_IPTAT_TRIM_VCCA_TX_SEL, 0xA0);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_PHSEL_DC, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_CORE_CLK_IN_SYNC_SEL, 0x00);
-
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_BKG_KVCO_CAL_EN, 0x00);
-
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_BIAS_EN_CLKBUFLR_EN, 0x0F);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_ATB_SEL1, 0x01);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_ATB_SEL2, 0x01);
-
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_SYSCLK_EN_SEL_TXBAND,
- 0x4A + (0x10 * tx_band));
-
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_VREF_CFG1, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_VREF_CFG2, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_BGTC, 0xFF);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_TEST_UPDN, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_VCO_TUNE, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_AMP_OS, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_SSC_EN_CENTER, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_RES_CODE_UP, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_RES_CODE_DN, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_KVCO_CODE,
- tmds_clk > 300000000 ? 0x3F : 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_KVCO_COUNT1,
- tmds_clk > 300000000 ? 0x00 : 0x8A);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_DIV_REF1, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_DIV_REF2,
- tmds_clk > 300000000 ? 0x00 : 0x01);
-
-
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_KVCO_CAL_CNTRL,
- tmds_clk > 300000000 ? 0x00 : 0x1F);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_VREF_CFG3,
- tmds_clk > 300000000 ? 0x00 : 0x40);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_VREF_CFG4, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_VREF_CFG5, 0x10);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_RESETSM_CNTRL,
- tmds_clk > 300000000 ? 0x80 : 0x00);
-
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_RES_CODE_CAL_CSR, 0x77);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_RES_TRIM_EN_VCOCALDONE, 0x00);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_RXTXEPCLK_EN, 0x0C);
-
- hdmi_20nm_phy_pll_calc_settings(io, vco, vco_clk, tmds_clk);
-
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLLLOCK_CMP_EN, 0x11);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_PLL_CNTRL, 0x07);
-
- /* Resistor calibration linear search */
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_RES_CODE_START_SEG1, 0x60);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_RES_CODE_START_SEG2, 0x60);
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_RES_TRIM_CONTROL, 0x01);
-
- MDSS_PLL_REG_W(io->pll_base, QSERDES_COM_RESETSM_CNTRL2, 0x07);
-
- udelay(1000);
- mb();
-
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_MODE, tx_band);
-
- /* TX lanes (transceivers) power-up sequence */
- MDSS_PLL_REG_W(io->pll_base + 0x400, QSERDES_TX_L0_CLKBUF_ENABLE, 0x03);
- MDSS_PLL_REG_W(io->pll_base + 0x600, QSERDES_TX_L1_CLKBUF_ENABLE, 0x03);
- MDSS_PLL_REG_W(io->pll_base + 0x800, QSERDES_TX_L2_CLKBUF_ENABLE, 0x03);
- MDSS_PLL_REG_W(io->pll_base + 0xA00, QSERDES_TX_L3_CLKBUF_ENABLE, 0x03);
-
- MDSS_PLL_REG_W(io->pll_base + 0x400,
- QSERDES_TX_L0_TRAN_DRVR_EMP_EN, 0x03);
- MDSS_PLL_REG_W(io->pll_base + 0x600,
- QSERDES_TX_L1_TRAN_DRVR_EMP_EN, 0x03);
- MDSS_PLL_REG_W(io->pll_base + 0x800,
- QSERDES_TX_L2_TRAN_DRVR_EMP_EN, 0x03);
- MDSS_PLL_REG_W(io->pll_base + 0xA00,
- QSERDES_TX_L3_TRAN_DRVR_EMP_EN, 0x03);
-
- MDSS_PLL_REG_W(io->pll_base + 0x400,
- QSERDES_TX_L0_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN , 0x6F);
- MDSS_PLL_REG_W(io->pll_base + 0x600,
- QSERDES_TX_L1_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN , 0x6F);
- MDSS_PLL_REG_W(io->pll_base + 0x800,
- QSERDES_TX_L2_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN , 0x6F);
- MDSS_PLL_REG_W(io->pll_base + 0xA00,
- QSERDES_TX_L3_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN , 0x6F);
-
- MDSS_PLL_REG_W(io->pll_base + 0x400,
- QSERDES_TX_L0_TX_EMP_POST1_LVL, 0x0000002F);
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_TXCAL_CFG0, 0x000000AF);
-
- MDSS_PLL_REG_W(io->pll_base + 0x400, QSERDES_TX_L0_VMODE_CTRL1, 0x08);
- MDSS_PLL_REG_W(io->pll_base + 0x800, QSERDES_TX_L2_VMODE_CTRL1, 0x09);
- MDSS_PLL_REG_W(io->pll_base + 0x400, QSERDES_TX_L0_VMODE_CTRL5, 0xA0);
- MDSS_PLL_REG_W(io->pll_base + 0x400, QSERDES_TX_L0_VMODE_CTRL6, 0x01);
- MDSS_PLL_REG_W(io->pll_base + 0x800, QSERDES_TX_L2_VMODE_CTRL5, 0xA0);
- MDSS_PLL_REG_W(io->pll_base + 0x800, QSERDES_TX_L2_VMODE_CTRL6, 0x01);
-
- MDSS_PLL_REG_W(io->pll_base + 0x400,
- QSERDES_TX_L0_PARRATE_REC_DETECT_IDLE_EN, 0x40);
- MDSS_PLL_REG_W(io->pll_base + 0x400,
- QSERDES_TX_L0_TX_INTERFACE_MODE, 0x00);
- MDSS_PLL_REG_W(io->pll_base + 0x600,
- QSERDES_TX_L1_PARRATE_REC_DETECT_IDLE_EN, 0x40);
- MDSS_PLL_REG_W(io->pll_base + 0x600,
- QSERDES_TX_L1_TX_INTERFACE_MODE, 0x00);
- MDSS_PLL_REG_W(io->pll_base + 0x800,
- QSERDES_TX_L2_PARRATE_REC_DETECT_IDLE_EN, 0x40);
- MDSS_PLL_REG_W(io->pll_base + 0x800,
- QSERDES_TX_L2_TX_INTERFACE_MODE, 0x00);
- MDSS_PLL_REG_W(io->pll_base + 0xA00,
- QSERDES_TX_L3_PARRATE_REC_DETECT_IDLE_EN, 0x40);
- MDSS_PLL_REG_W(io->pll_base + 0xA00,
- QSERDES_TX_L3_TX_INTERFACE_MODE, 0x00);
-
- return 0;
-}
-
-static int hdmi_20nm_vco_enable(struct clk *c)
-{
- u32 ready_poll;
- u32 time_out_loop;
- /* Hardware recommended timeout iterator */
- u32 time_out_max = 50000;
-
- struct hdmi_pll_vco_clk *vco = to_hdmi_20nm_vco_clk(c);
- struct mdss_pll_resources *io = vco->priv;
-
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_CFG, 0x00000000);
- udelay(100);
- mb();
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_CFG, 0x00000003);
- udelay(100);
- mb();
- MDSS_PLL_REG_W(io->phy_base, HDMI_PHY_CFG, 0x00000009);
- udelay(100);
- mb();
-
- /* Poll for C_READY and PHY READY */
- pr_debug("%s: Waiting for PHY Ready\n", __func__);
- time_out_loop = 0;
- do {
- ready_poll = MDSS_PLL_REG_R(io->pll_base, QSERDES_COM_RESET_SM);
- time_out_loop++;
- udelay(10);
- } while (((ready_poll & (1 << 6)) == 0) &&
- (time_out_loop < time_out_max));
- if (time_out_loop >= time_out_max)
- pr_err("%s: ERROR: TIMED OUT BEFORE C READY\n", __func__);
- else
- pr_debug("%s: C READY\n", __func__);
-
- /* Poll for PHY READY */
- pr_debug("%s: Waiting for PHY Ready\n", __func__);
- time_out_loop = 0;
- do {
- ready_poll = MDSS_PLL_REG_R(io->phy_base, HDMI_PHY_STATUS);
- time_out_loop++;
- udelay(1);
- } while (((ready_poll & 0x1) == 0) && (time_out_loop < time_out_max));
-
- if (time_out_loop >= time_out_max)
- pr_err("%s: TIMED OUT BEFORE PHY READY\n", __func__);
- else
- pr_debug("%s: HDMI PHY READY\n", __func__);
-
- io->pll_on = true;
-
- return 0;
-}
-
-
-static int hdmi_20nm_vco_set_rate(struct clk *c, unsigned long rate)
-{
- struct hdmi_pll_vco_clk *vco = to_hdmi_20nm_vco_clk(c);
- struct mdss_pll_resources *io = vco->priv;
- void __iomem *pll_base;
- void __iomem *phy_base;
- unsigned int set_power_dwn = 0;
- int rc;
-
- rc = mdss_pll_resource_enable(io, true);
- if (rc) {
- pr_err("pll resource can't be enabled\n");
- return rc;
- }
-
- if (io->pll_on)
- set_power_dwn = 1;
-
- pll_base = io->pll_base;
- phy_base = io->phy_base;
-
- pr_debug("rate=%ld\n", rate);
-
- hdmi_20nm_phy_pll_set_clk_rate(c, rate);
-
- mdss_pll_resource_enable(io, false);
-
- if (set_power_dwn)
- hdmi_20nm_vco_enable(c);
-
- vco->rate = rate;
- vco->rate_set = true;
-
- return 0;
-}
-
-static unsigned long hdmi_20nm_vco_get_rate(struct clk *c)
-{
- unsigned long freq = 0;
- int rc;
- struct hdmi_pll_vco_clk *vco = to_hdmi_20nm_vco_clk(c);
- struct mdss_pll_resources *io = vco->priv;
-
- if (is_gdsc_disabled(io))
- return 0;
-
- rc = mdss_pll_resource_enable(io, true);
- if (rc) {
- pr_err("pll resource can't be enabled\n");
- return rc;
- }
-
- mdss_pll_resource_enable(io, false);
-
- return freq;
-}
-
-static long hdmi_20nm_vco_round_rate(struct clk *c, unsigned long rate)
-{
- unsigned long rrate = rate;
-
- pr_debug("rrate=%ld\n", rrate);
-
- return rrate;
-}
-
-static int hdmi_20nm_vco_prepare(struct clk *c)
-{
- struct hdmi_pll_vco_clk *vco = to_hdmi_20nm_vco_clk(c);
- struct mdss_pll_resources *io = vco->priv;
- int ret = 0;
-
- pr_debug("rate=%ld\n", vco->rate);
-
- if (!vco->rate_set && vco->rate)
- ret = hdmi_20nm_vco_set_rate(c, vco->rate);
-
- if (!ret) {
- ret = mdss_pll_resource_enable(io, true);
- if (ret)
- pr_err("pll resource can't be enabled\n");
- }
-
- return ret;
-}
-
-static void hdmi_20nm_vco_unprepare(struct clk *c)
-{
- struct hdmi_pll_vco_clk *vco = to_hdmi_20nm_vco_clk(c);
- struct mdss_pll_resources *io = vco->priv;
-
- vco->rate_set = false;
-
- if (!io) {
- pr_err("Invalid input parameter\n");
- return;
- }
-
- if (!io->pll_on &&
- mdss_pll_resource_enable(io, true)) {
- pr_err("pll resource can't be enabled\n");
- return;
- }
-
- io->handoff_resources = false;
- mdss_pll_resource_enable(io, false);
- io->pll_on = false;
-}
-
-static enum handoff hdmi_20nm_vco_handoff(struct clk *c)
-{
- enum handoff ret = HANDOFF_DISABLED_CLK;
- struct hdmi_pll_vco_clk *vco = to_hdmi_20nm_vco_clk(c);
- struct mdss_pll_resources *io = vco->priv;
-
- if (is_gdsc_disabled(io))
- return HANDOFF_DISABLED_CLK;
-
- if (mdss_pll_resource_enable(io, true)) {
- pr_err("pll resource can't be enabled\n");
- return ret;
- }
-
- io->handoff_resources = true;
-
- if (hdmi_20nm_pll_lock_status(io)) {
- io->pll_on = true;
- c->rate = hdmi_20nm_vco_get_rate(c);
- ret = HANDOFF_ENABLED_CLK;
- } else {
- io->handoff_resources = false;
- mdss_pll_resource_enable(io, false);
- }
-
- pr_debug("done, ret=%d\n", ret);
- return ret;
-}
-
-static struct clk_ops hdmi_20nm_vco_clk_ops = {
- .enable = hdmi_20nm_vco_enable,
- .set_rate = hdmi_20nm_vco_set_rate,
- .get_rate = hdmi_20nm_vco_get_rate,
- .round_rate = hdmi_20nm_vco_round_rate,
- .prepare = hdmi_20nm_vco_prepare,
- .unprepare = hdmi_20nm_vco_unprepare,
- .handoff = hdmi_20nm_vco_handoff,
-};
-
-static struct hdmi_pll_vco_clk hdmi_20nm_vco_clk = {
- .ip_seti = (struct hdmi_pll_cfg[]){
- {550890000, 0x03},
- {589240000, 0x07},
- {689290000, 0x03},
- {727600000, 0x07},
- {HDMI_PLL_TMDS_MAX, 0x03},
- },
- .cp_seti = (struct hdmi_pll_cfg[]){
- {34440000, 0x3F},
- {36830000, 0x2F},
- {68870000, 0x3F},
- {73660000, 0x2F},
- {137730000, 0x3F},
- {147310000, 0x2F},
- {275450000, 0x3F},
- {294620000, 0x2F},
- {344650000, 0x3F},
- {363800000, 0x2F},
- {477960000, 0x3F},
- {512530000, 0x2F},
- {550890000, 0x1F},
- {589240000, 0x2F},
- {630900000, 0x3F},
- {650590000, 0x2F},
- {689290000, 0x1F},
- {727600000, 0x2F},
- {HDMI_PLL_TMDS_MAX, 0x3F},
- },
- .ip_setp = (struct hdmi_pll_cfg[]){
- {497340000, 0x03},
- {512530000, 0x07},
- {535680000, 0x03},
- {550890000, 0x07},
- {574060000, 0x03},
- {727600000, 0x07},
- {HDMI_PLL_TMDS_MAX, 0x03},
- },
- .cp_setp = (struct hdmi_pll_cfg[]){
- {36830000, 0x1F},
- {40010000, 0x17},
- {73660000, 0x1F},
- {80000000, 0x17},
- {147310000, 0x1F},
- {160010000, 0x17},
- {294620000, 0x1F},
- {363800000, 0x17},
- {497340000, 0x0F},
- {512530000, 0x1F},
- {535680000, 0x0F},
- {550890000, 0x1F},
- {574060000, 0x0F},
- {589240000, 0x1F},
- {727600000, 0x17},
- {HDMI_PLL_TMDS_MAX, 0x07},
- },
- .crctrl = (struct hdmi_pll_cfg[]){
- {40010000, 0xBB},
- {40030000, 0x77},
- {80000000, 0xBB},
- {80060000, 0x77},
- {160010000, 0xBB},
- {160120000, 0x77},
- {772930000, 0xBB},
- {HDMI_PLL_TMDS_MAX, 0xFF},
- },
- .c = {
- .dbg_name = "hdmi_20nm_vco_clk",
- .ops = &hdmi_20nm_vco_clk_ops,
- CLK_INIT(hdmi_20nm_vco_clk.c),
- },
-};
-
-static struct clk_lookup hdmipllcc_8994[] = {
- CLK_LIST(hdmi_20nm_vco_clk),
-};
-
-int hdmi_20nm_pll_clock_register(struct platform_device *pdev,
- struct mdss_pll_resources *pll_res)
-{
- int rc = -ENOTSUPP;
-
- if (!pll_res || !pll_res->phy_base || !pll_res->pll_base) {
- pr_err("Invalide input parameters\n");
- return -EPROBE_DEFER;
- }
-
- /* Set client data for vco, mux and div clocks */
- hdmi_20nm_vco_clk.priv = pll_res;
-
- rc = of_msm_clock_register(pdev->dev.of_node, hdmipllcc_8994,
- ARRAY_SIZE(hdmipllcc_8994));
- if (rc) {
- pr_err("Clock register failed rc=%d\n", rc);
- rc = -EPROBE_DEFER;
- } else {
- pr_debug("%s: SUCCESS\n", __func__);
- }
-
- return rc;
-}
diff --git a/drivers/clk/msm/mdss/mdss-hdmi-pll-28hpm.c b/drivers/clk/msm/mdss/mdss-hdmi-pll-28hpm.c
deleted file mode 100644
index 30f447cbeab1..000000000000
--- a/drivers/clk/msm/mdss/mdss-hdmi-pll-28hpm.c
+++ /dev/null
@@ -1,1104 +0,0 @@
-/* Copyright (c) 2012-2015, The Linux Foundation. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 and
- * only version 2 as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- */
-
-#define pr_fmt(fmt) "%s: " fmt, __func__
-
-#include <linux/kernel.h>
-#include <linux/err.h>
-#include <linux/delay.h>
-#include <linux/iopoll.h>
-#include <linux/clk/msm-clk-provider.h>
-#include <linux/clk/msm-clk.h>
-#include <linux/clk/msm-clock-generic.h>
-
-#include "mdss-pll.h"
-#include "mdss-hdmi-pll.h"
-
-/* hdmi phy registers */
-#define HDMI_PHY_ANA_CFG0 (0x0000)
-#define HDMI_PHY_ANA_CFG1 (0x0004)
-#define HDMI_PHY_ANA_CFG2 (0x0008)
-#define HDMI_PHY_ANA_CFG3 (0x000C)
-#define HDMI_PHY_PD_CTRL0 (0x0010)
-#define HDMI_PHY_PD_CTRL1 (0x0014)
-#define HDMI_PHY_GLB_CFG (0x0018)
-#define HDMI_PHY_DCC_CFG0 (0x001C)
-#define HDMI_PHY_DCC_CFG1 (0x0020)
-#define HDMI_PHY_TXCAL_CFG0 (0x0024)
-#define HDMI_PHY_TXCAL_CFG1 (0x0028)
-#define HDMI_PHY_TXCAL_CFG2 (0x002C)
-#define HDMI_PHY_TXCAL_CFG3 (0x0030)
-#define HDMI_PHY_BIST_CFG0 (0x0034)
-#define HDMI_PHY_BIST_CFG1 (0x0038)
-#define HDMI_PHY_BIST_PATN0 (0x003C)
-#define HDMI_PHY_BIST_PATN1 (0x0040)
-#define HDMI_PHY_BIST_PATN2 (0x0044)
-#define HDMI_PHY_BIST_PATN3 (0x0048)
-#define HDMI_PHY_STATUS (0x005C)
-
-/* hdmi phy unified pll registers */
-#define HDMI_UNI_PLL_REFCLK_CFG (0x0000)
-#define HDMI_UNI_PLL_POSTDIV1_CFG (0x0004)
-#define HDMI_UNI_PLL_CHFPUMP_CFG (0x0008)
-#define HDMI_UNI_PLL_VCOLPF_CFG (0x000C)
-#define HDMI_UNI_PLL_VREG_CFG (0x0010)
-#define HDMI_UNI_PLL_PWRGEN_CFG (0x0014)
-#define HDMI_UNI_PLL_GLB_CFG (0x0020)
-#define HDMI_UNI_PLL_POSTDIV2_CFG (0x0024)
-#define HDMI_UNI_PLL_POSTDIV3_CFG (0x0028)
-#define HDMI_UNI_PLL_LPFR_CFG (0x002C)
-#define HDMI_UNI_PLL_LPFC1_CFG (0x0030)
-#define HDMI_UNI_PLL_LPFC2_CFG (0x0034)
-#define HDMI_UNI_PLL_SDM_CFG0 (0x0038)
-#define HDMI_UNI_PLL_SDM_CFG1 (0x003C)
-#define HDMI_UNI_PLL_SDM_CFG2 (0x0040)
-#define HDMI_UNI_PLL_SDM_CFG3 (0x0044)
-#define HDMI_UNI_PLL_SDM_CFG4 (0x0048)
-#define HDMI_UNI_PLL_SSC_CFG0 (0x004C)
-#define HDMI_UNI_PLL_SSC_CFG1 (0x0050)
-#define HDMI_UNI_PLL_SSC_CFG2 (0x0054)
-#define HDMI_UNI_PLL_SSC_CFG3 (0x0058)
-#define HDMI_UNI_PLL_LKDET_CFG0 (0x005C)
-#define HDMI_UNI_PLL_LKDET_CFG1 (0x0060)
-#define HDMI_UNI_PLL_LKDET_CFG2 (0x0064)
-#define HDMI_UNI_PLL_CAL_CFG0 (0x006C)
-#define HDMI_UNI_PLL_CAL_CFG1 (0x0070)
-#define HDMI_UNI_PLL_CAL_CFG2 (0x0074)
-#define HDMI_UNI_PLL_CAL_CFG3 (0x0078)
-#define HDMI_UNI_PLL_CAL_CFG4 (0x007C)
-#define HDMI_UNI_PLL_CAL_CFG5 (0x0080)
-#define HDMI_UNI_PLL_CAL_CFG6 (0x0084)
-#define HDMI_UNI_PLL_CAL_CFG7 (0x0088)
-#define HDMI_UNI_PLL_CAL_CFG8 (0x008C)
-#define HDMI_UNI_PLL_CAL_CFG9 (0x0090)
-#define HDMI_UNI_PLL_CAL_CFG10 (0x0094)
-#define HDMI_UNI_PLL_CAL_CFG11 (0x0098)
-#define HDMI_UNI_PLL_STATUS (0x00C0)
-
-#define HDMI_PLL_POLL_DELAY_US 50
-#define HDMI_PLL_POLL_TIMEOUT_US 500
-
-static inline struct hdmi_pll_vco_clk *to_hdmi_vco_clk(struct clk *clk)
-{
- return container_of(clk, struct hdmi_pll_vco_clk, c);
-}
-
-static void hdmi_vco_disable(struct clk *c)
-{
- struct hdmi_pll_vco_clk *vco = to_hdmi_vco_clk(c);
- struct mdss_pll_resources *hdmi_pll_res = vco->priv;
-
- if (!hdmi_pll_res) {
- pr_err("Invalid input parameter\n");
- return;
- }
-
- if (!hdmi_pll_res->pll_on &&
- mdss_pll_resource_enable(hdmi_pll_res, true)) {
- pr_err("pll resource can't be enabled\n");
- return;
- }
-
- MDSS_PLL_REG_W(hdmi_pll_res->pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0);
- udelay(5);
- MDSS_PLL_REG_W(hdmi_pll_res->phy_base, HDMI_PHY_GLB_CFG, 0x0);
-
- hdmi_pll_res->handoff_resources = false;
- mdss_pll_resource_enable(hdmi_pll_res, false);
- hdmi_pll_res->pll_on = false;
-} /* hdmi_vco_disable */
-
-static int hdmi_vco_enable(struct clk *c)
-{
- u32 status;
- u32 delay_us, timeout_us;
- int rc;
- struct hdmi_pll_vco_clk *vco = to_hdmi_vco_clk(c);
- struct mdss_pll_resources *hdmi_pll_res = vco->priv;
-
- rc = mdss_pll_resource_enable(hdmi_pll_res, true);
- if (rc) {
- pr_err("pll resource can't be enabled\n");
- return rc;
- }
-
- /* Global Enable */
- MDSS_PLL_REG_W(hdmi_pll_res->phy_base, HDMI_PHY_GLB_CFG, 0x81);
- /* Power up power gen */
- MDSS_PLL_REG_W(hdmi_pll_res->phy_base, HDMI_PHY_PD_CTRL0, 0x00);
- udelay(350);
-
- /* PLL Power-Up */
- MDSS_PLL_REG_W(hdmi_pll_res->pll_base, HDMI_UNI_PLL_GLB_CFG, 0x01);
- udelay(5);
- /* Power up PLL LDO */
- MDSS_PLL_REG_W(hdmi_pll_res->pll_base, HDMI_UNI_PLL_GLB_CFG, 0x03);
- udelay(350);
-
- /* PLL Power-Up */
- MDSS_PLL_REG_W(hdmi_pll_res->pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- udelay(350);
-
- /* poll for PLL ready status */
- delay_us = 100;
- timeout_us = 2000;
- if (readl_poll_timeout_atomic(
- (hdmi_pll_res->pll_base + HDMI_UNI_PLL_STATUS),
- status, ((status & BIT(0)) == 1), delay_us, timeout_us)) {
- pr_err("hdmi phy pll status=%x failed to Lock\n", status);
- hdmi_vco_disable(c);
- mdss_pll_resource_enable(hdmi_pll_res, false);
- return -EINVAL;
- }
- pr_debug("hdmi phy pll is locked\n");
-
- udelay(350);
- /* poll for PHY ready status */
- delay_us = 100;
- timeout_us = 2000;
- if (readl_poll_timeout_atomic(
- (hdmi_pll_res->phy_base + HDMI_PHY_STATUS),
- status, ((status & BIT(0)) == 1), delay_us, timeout_us)) {
- pr_err("hdmi phy status=%x failed to Lock\n", status);
- hdmi_vco_disable(c);
- mdss_pll_resource_enable(hdmi_pll_res, false);
- return -EINVAL;
- }
- hdmi_pll_res->pll_on = true;
- pr_debug("hdmi phy is locked\n");
-
- return 0;
-} /* hdmi_vco_enable */
-
-
-static void hdmi_phy_pll_calculator(u32 vco_freq,
- struct mdss_pll_resources *hdmi_pll_res)
-{
- u32 ref_clk = 19200000;
- u32 sdm_mode = 1;
- u32 ref_clk_multiplier = sdm_mode == 1 ? 2 : 1;
- u32 int_ref_clk_freq = ref_clk * ref_clk_multiplier;
- u32 fbclk_pre_div = 1;
- u32 ssc_mode = 0;
- u32 kvco = 270;
- u32 vdd = 95;
- u32 ten_power_six = 1000000;
- u32 ssc_ds_ppm = ssc_mode ? 5000 : 0;
- u32 sdm_res = 16;
- u32 ssc_tri_step = 32;
- u32 ssc_freq = 2;
- u64 ssc_ds = vco_freq * ssc_ds_ppm;
- u32 div_in_freq = vco_freq / fbclk_pre_div;
- u64 dc_offset = (div_in_freq / int_ref_clk_freq - 1) *
- ten_power_six * 10;
- u32 ssc_kdiv = (int_ref_clk_freq / ssc_freq) -
- ten_power_six;
- u64 sdm_freq_seed;
- u32 ssc_tri_inc;
- u64 fb_div_n;
- void __iomem *pll_base = hdmi_pll_res->pll_base;
- u32 val;
-
- pr_debug("vco_freq = %u\n", vco_freq);
-
- do_div(ssc_ds, (u64)ten_power_six);
-
- fb_div_n = (u64)div_in_freq * (u64)ten_power_six * 10;
- do_div(fb_div_n, int_ref_clk_freq);
-
- sdm_freq_seed = ((fb_div_n - dc_offset - ten_power_six * 10) *
- (1 << sdm_res) * 10) + 5;
- do_div(sdm_freq_seed, ((u64)ten_power_six * 100));
-
- ssc_tri_inc = (u32)ssc_ds;
- ssc_tri_inc = (ssc_tri_inc / int_ref_clk_freq) * (1 << 16) /
- ssc_tri_step;
-
- val = (ref_clk_multiplier == 2 ? 1 : 0) +
- ((fbclk_pre_div == 2 ? 1 : 0) * 16);
- pr_debug("HDMI_UNI_PLL_REFCLK_CFG = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_REFCLK_CFG, val);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CHFPUMP_CFG, 0x02);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VCOLPF_CFG, 0x19);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_PWRGEN_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV2_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV3_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFR_CFG, 0x0E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC1_CFG, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC2_CFG, 0x0D);
-
- do_div(dc_offset, (u64)ten_power_six * 10);
- val = sdm_mode == 0 ? 64 + dc_offset : 0;
- pr_debug("HDMI_UNI_PLL_SDM_CFG0 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG0, val);
-
- val = 64 + dc_offset;
- pr_debug("HDMI_UNI_PLL_SDM_CFG1 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG1, val);
-
- val = sdm_freq_seed & 0xFF;
- pr_debug("HDMI_UNI_PLL_SDM_CFG2 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG2, val);
-
- val = (sdm_freq_seed >> 8) & 0xFF;
- pr_debug("HDMI_UNI_PLL_SDM_CFG3 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG3, val);
-
- val = (sdm_freq_seed >> 16) & 0xFF;
- pr_debug("HDMI_UNI_PLL_SDM_CFG4 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG4, val);
-
- val = (ssc_mode == 0 ? 128 : 0) + (ssc_kdiv / ten_power_six);
- pr_debug("HDMI_UNI_PLL_SSC_CFG0 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SSC_CFG0, val);
-
- val = ssc_tri_inc & 0xFF;
- pr_debug("HDMI_UNI_PLL_SSC_CFG1 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SSC_CFG1, val);
-
- val = (ssc_tri_inc >> 8) & 0xFF;
- pr_debug("HDMI_UNI_PLL_SSC_CFG2 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SSC_CFG2, val);
-
- pr_debug("HDMI_UNI_PLL_SSC_CFG3 = 0x%x\n", ssc_tri_step);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SSC_CFG3, ssc_tri_step);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG1, 0x1A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG2, 0x05);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG0, 0x0A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG1, 0x04);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG3, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG4, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG5, 0x00);
-
- val = (kvco * vdd * 10000) / 6;
- val += 500000;
- val /= ten_power_six;
- pr_debug("HDMI_UNI_PLL_CAL_CFG6 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG6, val & 0xFF);
-
- val = (kvco * vdd * 10000) / 6;
- val -= ten_power_six;
- val /= ten_power_six;
- val = (val >> 8) & 0xFF;
- pr_debug("HDMI_UNI_PLL_CAL_CFG7 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG7, val);
-
- val = (ref_clk * 5) / ten_power_six;
- pr_debug("HDMI_UNI_PLL_CAL_CFG8 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG8, val);
-
- val = ((ref_clk * 5) / ten_power_six) >> 8;
- pr_debug("HDMI_UNI_PLL_CAL_CFG9 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG9, val);
-
- vco_freq /= ten_power_six;
- val = vco_freq & 0xFF;
- pr_debug("HDMI_UNI_PLL_CAL_CFG10 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG10, val);
-
- val = vco_freq >> 8;
- pr_debug("HDMI_UNI_PLL_CAL_CFG11 = 0x%x\n", val);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG11, val);
-} /* hdmi_phy_pll_calculator */
-
-static int hdmi_vco_set_rate(struct clk *c, unsigned long rate)
-{
- struct hdmi_pll_vco_clk *vco = to_hdmi_vco_clk(c);
- struct mdss_pll_resources *hdmi_pll_res = vco->priv;
- void __iomem *pll_base;
- void __iomem *phy_base;
- unsigned int set_power_dwn = 0;
- int rc;
-
- rc = mdss_pll_resource_enable(hdmi_pll_res, true);
- if (rc) {
- pr_err("pll resource can't be enabled\n");
- return rc;
- }
-
- if (hdmi_pll_res->pll_on) {
- hdmi_vco_disable(c);
- set_power_dwn = 1;
- }
-
- pll_base = hdmi_pll_res->pll_base;
- phy_base = hdmi_pll_res->phy_base;
-
- pr_debug("rate=%ld\n", rate);
-
- switch (rate) {
- case 0:
- break;
-
- case 756000000:
- /* 640x480p60 */
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_GLB_CFG, 0x81);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_REFCLK_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VCOLPF_CFG, 0x19);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFR_CFG, 0x0E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC1_CFG, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC2_CFG, 0x0D);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG0, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG1, 0x52);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG2, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG3, 0xB0);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG1, 0x1A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG2, 0x05);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV2_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV3_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG9, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG10, 0xF4);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG11, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL0, 0x1F);
- udelay(50);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x10);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG0, 0xDB);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG1, 0x43);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG0, 0xD0);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG1, 0x1A);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG0, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG3, 0x05);
- udelay(200);
- break;
-
- case 810000000:
- /* 576p50/576i50 case */
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_GLB_CFG, 0x81);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_REFCLK_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VCOLPF_CFG, 0x19);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFR_CFG, 0x0E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC1_CFG, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC2_CFG, 0x0D);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG0, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG1, 0x54);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG2, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG3, 0x18);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG1, 0x1A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG2, 0x05);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV2_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV3_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG9, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG10, 0x2A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG11, 0x03);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL0, 0x1F);
- udelay(50);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x10);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG0, 0xDB);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG1, 0x43);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG0, 0xD0);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG1, 0x1A);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG0, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG3, 0x05);
- udelay(200);
- break;
-
- case 810900000:
- /* 480p60/480i60 case */
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_GLB_CFG, 0x81);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_REFCLK_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VCOLPF_CFG, 0x19);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFR_CFG, 0x0E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC1_CFG, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC2_CFG, 0x0D);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG0, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG1, 0x54);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG2, 0x66);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG3, 0x1D);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG1, 0x1A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG2, 0x05);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV2_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV3_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG9, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG10, 0x2A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG11, 0x03);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL0, 0x1F);
- udelay(50);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x10);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG0, 0xDB);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG1, 0x43);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG0, 0xD0);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG1, 0x1A);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG0, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG3, 0x05);
- udelay(200);
- break;
-
- case 650000000:
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_GLB_CFG, 0x81);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_REFCLK_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VCOLPF_CFG, 0x19);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFR_CFG, 0x0E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC1_CFG, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC2_CFG, 0x0D);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG0, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG1, 0x4F);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG2, 0x55);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG3, 0xED);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG1, 0x1A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG2, 0x05);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV2_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV3_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG9, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG10, 0x8A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG11, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL0, 0x1F);
- udelay(50);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x10);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG0, 0xDB);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG1, 0x43);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG0, 0xD0);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG1, 0x1A);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG0, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG3, 0x05);
- udelay(200);
- break;
-
- case 742500000:
- /*
- * 720p60/720p50/1080i60/1080i50
- * 1080p24/1080p30/1080p25 case
- */
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_GLB_CFG, 0x81);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_REFCLK_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VCOLPF_CFG, 0x19);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFR_CFG, 0x0E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC1_CFG, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC2_CFG, 0x0D);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG0, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG1, 0x52);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG2, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG3, 0x56);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG1, 0x1A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG2, 0x05);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV2_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV3_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG9, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG10, 0xE6);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG11, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL0, 0x1F);
- udelay(50);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x10);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG0, 0xDB);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG1, 0x43);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG0, 0xD0);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG1, 0x1A);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG0, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG3, 0x05);
- udelay(200);
- break;
-
- case 1080000000:
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_GLB_CFG, 0x81);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_REFCLK_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VCOLPF_CFG, 0x19);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFR_CFG, 0x0E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC1_CFG, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC2_CFG, 0x0D);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG0, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG1, 0x5B);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG2, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG3, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG1, 0x1A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG2, 0x05);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV2_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV3_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG9, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG10, 0x38);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG11, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL0, 0x1F);
- udelay(50);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x10);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG0, 0xDB);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG1, 0x43);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG0, 0xD0);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG1, 0x1A);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG0, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG3, 0x05);
- udelay(200);
- break;
-
- case 1342500000:
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_GLB_CFG, 0x81);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_REFCLK_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VCOLPF_CFG, 0x19);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFR_CFG, 0x0E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC1_CFG, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC2_CFG, 0x0D);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG0, 0x36);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG1, 0x61);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG3, 0xF6);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG1, 0x1A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG2, 0x05);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV2_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV3_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG9, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG10, 0x3E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG11, 0x05);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL0, 0x1F);
- udelay(50);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x10);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG0, 0xDB);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG1, 0x43);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x05);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG0, 0xD0);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG1, 0x1A);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG0, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x11);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG3, 0x05);
- udelay(200);
- break;
-
- case 1485000000:
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_GLB_CFG, 0x81);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_REFCLK_CFG, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VCOLPF_CFG, 0x19);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFR_CFG, 0x0E);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC1_CFG, 0x20);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LPFC2_CFG, 0x0D);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG0, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG1, 0x65);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG2, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG3, 0xAC);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_SDM_CFG4, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG0, 0x10);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG1, 0x1A);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_LKDET_CFG2, 0x05);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV2_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_POSTDIV3_CFG, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG2, 0x01);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG8, 0x60);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG9, 0x00);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG10, 0xCD);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_CAL_CFG11, 0x05);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL0, 0x1F);
- udelay(50);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x10);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG0, 0xDB);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG1, 0x43);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x06);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x03);
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG0, 0xD0);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG1, 0x1A);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG0, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x02);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG3, 0x05);
- udelay(200);
- break;
-
- default:
- pr_debug("Use pll settings calculator for rate=%ld\n", rate);
-
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_GLB_CFG, 0x81);
- hdmi_phy_pll_calculator(rate, hdmi_pll_res);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL0, 0x1F);
- udelay(50);
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_GLB_CFG, 0x0F);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_PD_CTRL1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x10);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG0, 0xDB);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG1, 0x43);
-
- if (rate < 825000000) {
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x01);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x00);
- } else if (rate >= 825000000 && rate < 1342500000) {
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x05);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x03);
- } else {
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG2, 0x06);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_ANA_CFG3, 0x03);
- }
-
- MDSS_PLL_REG_W(pll_base, HDMI_UNI_PLL_VREG_CFG, 0x04);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG0, 0xD0);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_DCC_CFG1, 0x1A);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG0, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG1, 0x00);
-
- if (rate < 825000000)
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x01);
- else
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG2, 0x00);
-
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_TXCAL_CFG3, 0x05);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_BIST_PATN0, 0x62);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_BIST_PATN1, 0x03);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_BIST_PATN2, 0x69);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_BIST_PATN3, 0x02);
-
- udelay(200);
-
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_BIST_CFG1, 0x00);
- MDSS_PLL_REG_W(phy_base, HDMI_PHY_BIST_CFG0, 0x00);
- }
-
- /* Make sure writes complete before disabling iface clock */
- mb();
-
- mdss_pll_resource_enable(hdmi_pll_res, false);
-
- if (set_power_dwn)
- hdmi_vco_enable(c);
-
- vco->rate = rate;
- vco->rate_set = true;
-
- return 0;
-} /* hdmi_pll_set_rate */
-
-/* HDMI PLL DIV CLK */
-
-static unsigned long hdmi_vco_get_rate(struct clk *c)
-{
- unsigned long freq = 0;
- int rc;
- struct hdmi_pll_vco_clk *vco = to_hdmi_vco_clk(c);
- struct mdss_pll_resources *hdmi_pll_res = vco->priv;
-
- if (is_gdsc_disabled(hdmi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(hdmi_pll_res, true);
- if (rc) {
- pr_err("pll resource can't be enabled\n");
- return rc;
- }
-
- freq = MDSS_PLL_REG_R(hdmi_pll_res->pll_base,
- HDMI_UNI_PLL_CAL_CFG11) << 8 |
- MDSS_PLL_REG_R(hdmi_pll_res->pll_base, HDMI_UNI_PLL_CAL_CFG10);
-
- switch (freq) {
- case 742:
- freq = 742500000;
- break;
- case 810:
- if (MDSS_PLL_REG_R(hdmi_pll_res->pll_base,
- HDMI_UNI_PLL_SDM_CFG3) == 0x18)
- freq = 810000000;
- else
- freq = 810900000;
- break;
- case 1342:
- freq = 1342500000;
- break;
- default:
- freq *= 1000000;
- }
- mdss_pll_resource_enable(hdmi_pll_res, false);
-
- return freq;
-}
-
-static long hdmi_vco_round_rate(struct clk *c, unsigned long rate)
-{
- unsigned long rrate = rate;
- struct hdmi_pll_vco_clk *vco = to_hdmi_vco_clk(c);
-
- if (rate < vco->min_rate)
- rrate = vco->min_rate;
- if (rate > vco->max_rate)
- rrate = vco->max_rate;
-
- pr_debug("rrate=%ld\n", rrate);
-
- return rrate;
-}
-
-static int hdmi_vco_prepare(struct clk *c)
-{
- struct hdmi_pll_vco_clk *vco = to_hdmi_vco_clk(c);
- int ret = 0;
-
- pr_debug("rate=%ld\n", vco->rate);
-
- if (!vco->rate_set && vco->rate)
- ret = hdmi_vco_set_rate(c, vco->rate);
-
- return ret;
-}
-
-static void hdmi_vco_unprepare(struct clk *c)
-{
- struct hdmi_pll_vco_clk *vco = to_hdmi_vco_clk(c);
-
- vco->rate_set = false;
-}
-
-static int hdmi_pll_lock_status(struct mdss_pll_resources *hdmi_pll_res)
-{
- u32 status;
- int pll_locked = 0;
- int rc;
-
- rc = mdss_pll_resource_enable(hdmi_pll_res, true);
- if (rc) {
- pr_err("pll resource can't be enabled\n");
- return rc;
- }
-
- /* poll for PLL ready status */
- if (readl_poll_timeout_atomic(
- (hdmi_pll_res->phy_base + HDMI_PHY_STATUS),
- status, ((status & BIT(0)) == 1),
- HDMI_PLL_POLL_DELAY_US,
- HDMI_PLL_POLL_TIMEOUT_US)) {
- pr_debug("HDMI PLL status=%x failed to Lock\n", status);
- pll_locked = 0;
- } else {
- pll_locked = 1;
- }
- mdss_pll_resource_enable(hdmi_pll_res, false);
-
- return pll_locked;
-}
-
-static enum handoff hdmi_vco_handoff(struct clk *c)
-{
- enum handoff ret = HANDOFF_DISABLED_CLK;
- struct hdmi_pll_vco_clk *vco = to_hdmi_vco_clk(c);
- struct mdss_pll_resources *hdmi_pll_res = vco->priv;
-
- if (is_gdsc_disabled(hdmi_pll_res))
- return HANDOFF_DISABLED_CLK;
-
- if (mdss_pll_resource_enable(hdmi_pll_res, true)) {
- pr_err("pll resource can't be enabled\n");
- return ret;
- }
-
- hdmi_pll_res->handoff_resources = true;
-
- if (hdmi_pll_lock_status(hdmi_pll_res)) {
- hdmi_pll_res->pll_on = true;
- c->rate = hdmi_vco_get_rate(c);
- ret = HANDOFF_ENABLED_CLK;
- } else {
- hdmi_pll_res->handoff_resources = false;
- mdss_pll_resource_enable(hdmi_pll_res, false);
- }
-
- pr_debug("done, ret=%d\n", ret);
- return ret;
-}
-
-static struct clk_ops hdmi_vco_clk_ops = {
- .enable = hdmi_vco_enable,
- .set_rate = hdmi_vco_set_rate,
- .get_rate = hdmi_vco_get_rate,
- .round_rate = hdmi_vco_round_rate,
- .prepare = hdmi_vco_prepare,
- .unprepare = hdmi_vco_unprepare,
- .disable = hdmi_vco_disable,
- .handoff = hdmi_vco_handoff,
-};
-
-static struct hdmi_pll_vco_clk hdmi_vco_clk = {
- .min_rate = 600000000,
- .max_rate = 1800000000,
- .c = {
- .dbg_name = "hdmi_vco_clk",
- .ops = &hdmi_vco_clk_ops,
- CLK_INIT(hdmi_vco_clk.c),
- },
-};
-
-struct div_clk hdmipll_div1_clk = {
- .data = {
- .div = 1,
- .min_div = 1,
- .max_div = 1,
- },
- .c = {
- .parent = &hdmi_vco_clk.c,
- .dbg_name = "hdmipll_div1_clk",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(hdmipll_div1_clk.c),
- },
-};
-
-struct div_clk hdmipll_div2_clk = {
- .data = {
- .div = 2,
- .min_div = 2,
- .max_div = 2,
- },
- .c = {
- .parent = &hdmi_vco_clk.c,
- .dbg_name = "hdmipll_div2_clk",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(hdmipll_div2_clk.c),
- },
-};
-
-struct div_clk hdmipll_div4_clk = {
- .data = {
- .div = 4,
- .min_div = 4,
- .max_div = 4,
- },
- .c = {
- .parent = &hdmi_vco_clk.c,
- .dbg_name = "hdmipll_div4_clk",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(hdmipll_div4_clk.c),
- },
-};
-
-struct div_clk hdmipll_div6_clk = {
- .data = {
- .div = 6,
- .min_div = 6,
- .max_div = 6,
- },
- .c = {
- .parent = &hdmi_vco_clk.c,
- .dbg_name = "hdmipll_div6_clk",
- .ops = &clk_ops_div,
- .flags = CLKFLAG_NO_RATE_CACHE,
- CLK_INIT(hdmipll_div6_clk.c),
- },
-};
-
-static int hdmipll_set_mux_sel(struct mux_clk *clk, int mux_sel)
-{
- struct mdss_pll_resources *hdmi_pll_res = clk->priv;
- int rc;
-
- rc = mdss_pll_resource_enable(hdmi_pll_res, true);
- if (rc) {
- pr_err("pll resource can't be enabled\n");
- return rc;
- }
-
- pr_debug("mux_sel=%d\n", mux_sel);
- MDSS_PLL_REG_W(hdmi_pll_res->pll_base,
- HDMI_UNI_PLL_POSTDIV1_CFG, mux_sel);
- mdss_pll_resource_enable(hdmi_pll_res, false);
-
- return 0;
-}
-
-static int hdmipll_get_mux_sel(struct mux_clk *clk)
-{
- int rc;
- int mux_sel = 0;
- struct mdss_pll_resources *hdmi_pll_res = clk->priv;
-
- if (is_gdsc_disabled(hdmi_pll_res))
- return 0;
-
- rc = mdss_pll_resource_enable(hdmi_pll_res, true);
- if (rc) {
- pr_err("pll resource can't be enabled\n");
- return rc;
- }
-
- mux_sel = MDSS_PLL_REG_R(hdmi_pll_res->pll_base,
- HDMI_UNI_PLL_POSTDIV1_CFG);
- mdss_pll_resource_enable(hdmi_pll_res, false);
- mux_sel &= 0x03;
- pr_debug("mux_sel=%d\n", mux_sel);
-
- return mux_sel;
-}
-
-static struct clk_mux_ops hdmipll_mux_ops = {
- .set_mux_sel = hdmipll_set_mux_sel,
- .get_mux_sel = hdmipll_get_mux_sel,
-};
-
-static struct clk_ops hdmi_mux_ops;
-
-static int hdmi_mux_prepare(struct clk *c)
-{
- int ret = 0;
-
- if (c && c->ops && c->ops->set_rate)
- ret = c->ops->set_rate(c, c->rate);
-
- return ret;
-}
-
-struct mux_clk hdmipll_mux_clk = {
- MUX_SRC_LIST(
- { &hdmipll_div1_clk.c, 0 },
- { &hdmipll_div2_clk.c, 1 },
- { &hdmipll_div4_clk.c, 2 },
- { &hdmipll_div6_clk.c, 3 },
- ),
- .ops = &hdmipll_mux_ops,
- .c = {
- .parent = &hdmipll_div1_clk.c,
- .dbg_name = "hdmipll_mux_clk",
- .ops = &hdmi_mux_ops,
- CLK_INIT(hdmipll_mux_clk.c),
- },
-};
-
-struct div_clk hdmipll_clk_src = {
- .data = {
- .div = 5,
- .min_div = 5,
- .max_div = 5,
- },
- .c = {
- .parent = &hdmipll_mux_clk.c,
- .dbg_name = "hdmipll_clk_src",
- .ops = &clk_ops_div,
- CLK_INIT(hdmipll_clk_src.c),
- },
-};
-
-static struct clk_lookup hdmipllcc_8974[] = {
- CLK_LOOKUP("extp_clk_src", hdmipll_clk_src.c,
- "fd8c0000.qcom,mmsscc-mdss"),
-};
-
-int hdmi_pll_clock_register(struct platform_device *pdev,
- struct mdss_pll_resources *pll_res)
-{
- int rc = -ENOTSUPP;
-
- if (!pll_res || !pll_res->phy_base || !pll_res->pll_base) {
- pr_err("Invalide input parameters\n");
- return -EPROBE_DEFER;
- }
-
- /* Set client data for vco, mux and div clocks */
- hdmipll_clk_src.priv = pll_res;
- hdmipll_mux_clk.priv = pll_res;
- hdmipll_div1_clk.priv = pll_res;
- hdmipll_div2_clk.priv = pll_res;
- hdmipll_div4_clk.priv = pll_res;
- hdmipll_div6_clk.priv = pll_res;
- hdmi_vco_clk.priv = pll_res;
-
- /* Set hdmi mux clock operation */
- hdmi_mux_ops = clk_ops_gen_mux;
- hdmi_mux_ops.prepare = hdmi_mux_prepare;
-
- rc = of_msm_clock_register(pdev->dev.of_node, hdmipllcc_8974,
- ARRAY_SIZE(hdmipllcc_8974));
- if (rc) {
- pr_err("Clock register failed rc=%d\n", rc);
- rc = -EPROBE_DEFER;
- }
-
- return rc;
-}
diff --git a/drivers/clk/msm/mdss/mdss-pll.c b/drivers/clk/msm/mdss/mdss-pll.c
index eb26fc43e109..b17a093e98c7 100644
--- a/drivers/clk/msm/mdss/mdss-pll.c
+++ b/drivers/clk/msm/mdss/mdss-pll.c
@@ -22,7 +22,6 @@
#include <linux/clk/msm-clock-generic.h>
#include "mdss-pll.h"
-#include "mdss-edp-pll.h"
#include "mdss-dsi-pll.h"
#include "mdss-hdmi-pll.h"
@@ -127,35 +126,9 @@ static int mdss_pll_resource_parse(struct platform_device *pdev,
goto err;
}
- if (!strcmp(compatible_stream, "qcom,mdss_dsi_pll_8916")) {
- pll_res->pll_interface_type = MDSS_DSI_PLL_LPM;
- pll_res->target_id = MDSS_PLL_TARGET_8916;
- } else if (!strcmp(compatible_stream, "qcom,mdss_dsi_pll_8939")) {
- pll_res->pll_interface_type = MDSS_DSI_PLL_LPM;
- pll_res->target_id = MDSS_PLL_TARGET_8939;
- } else if (!strcmp(compatible_stream, "qcom,mdss_dsi_pll_8909")) {
- pll_res->pll_interface_type = MDSS_DSI_PLL_LPM;
- pll_res->target_id = MDSS_PLL_TARGET_8909;
- } else if (!strcmp(compatible_stream, "qcom,mdss_dsi_pll_8974")) {
- pll_res->pll_interface_type = MDSS_DSI_PLL_HPM;
- pll_res->target_id = MDSS_PLL_TARGET_8974;
- } else if (!strcmp(compatible_stream, "qcom,mdss_dsi_pll_8994")) {
- pll_res->pll_interface_type = MDSS_DSI_PLL_20NM;
- pll_res->target_id = MDSS_PLL_TARGET_8994;
- } else if (!strcmp(compatible_stream, "qcom,mdss_dsi_pll_8992")) {
- pll_res->pll_interface_type = MDSS_DSI_PLL_20NM;
- pll_res->target_id = MDSS_PLL_TARGET_8992;
- } else if (!strcmp(compatible_stream, "qcom,mdss_dsi_pll_8996")) {
+ if (!strcmp(compatible_stream, "qcom,mdss_dsi_pll_8996")) {
pll_res->pll_interface_type = MDSS_DSI_PLL_8996;
pll_res->target_id = MDSS_PLL_TARGET_8996;
- } else if (!strcmp(compatible_stream, "qcom,mdss_edp_pll")) {
- pll_res->pll_interface_type = MDSS_EDP_PLL;
- } else if (!strcmp(compatible_stream, "qcom,mdss_hdmi_pll")) {
- pll_res->pll_interface_type = MDSS_HDMI_PLL;
- } else if (!strcmp(compatible_stream, "qcom,mdss_hdmi_pll_8994")) {
- pll_res->pll_interface_type = MDSS_HDMI_PLL_20NM;
- } else if (!strcmp(compatible_stream, "qcom,mdss_hdmi_pll_8992")) {
- pll_res->pll_interface_type = MDSS_HDMI_PLL_20NM;
} else if (!strcmp(compatible_stream, "qcom,mdss_hdmi_pll_8996")) {
pll_res->pll_interface_type = MDSS_HDMI_PLL_8996;
} else {
@@ -181,26 +154,9 @@ static int mdss_pll_clock_register(struct platform_device *pdev,
}
switch (pll_res->pll_interface_type) {
- case MDSS_DSI_PLL_LPM:
- rc = dsi_pll_clock_register_lpm(pdev, pll_res);
- break;
- case MDSS_DSI_PLL_HPM:
- rc = dsi_pll_clock_register_hpm(pdev, pll_res);
- break;
- case MDSS_DSI_PLL_20NM:
- rc = dsi_pll_clock_register_20nm(pdev, pll_res);
- break;
case MDSS_DSI_PLL_8996:
rc = dsi_pll_clock_register_8996(pdev, pll_res);
break;
- case MDSS_EDP_PLL:
- rc = edp_pll_clock_register(pdev, pll_res);
- break;
- case MDSS_HDMI_PLL:
- rc = hdmi_pll_clock_register(pdev, pll_res);
- case MDSS_HDMI_PLL_20NM:
- rc = hdmi_20nm_pll_clock_register(pdev, pll_res);
- break;
case MDSS_HDMI_PLL_8996:
rc = hdmi_8996_pll_clock_register(pdev, pll_res);
break;
@@ -279,35 +235,9 @@ static int mdss_pll_probe(struct platform_device *pdev)
goto res_parse_error;
}
- /*
- * DSI PLL 1 is leaking current whenever MDSS GDSC is toggled. Need to
- * map PLL1 registers along with the PLl0 so that we can manually turn
- * off PLL1.
- */
- if (pll_res->pll_interface_type == MDSS_DSI_PLL_20NM) {
- struct resource *pll_1_base_reg;
- pll_1_base_reg = platform_get_resource_byname(pdev,
- IORESOURCE_MEM, "pll_1_base");
- if (pll_1_base_reg) {
- pll_res->pll_1_base = ioremap(pll_1_base_reg->start,
- resource_size(pll_1_base_reg));
- if (!pll_res->pll_1_base)
- pr_err("Unable to remap pll 1 base resources\n");
- } else {
- pr_err("Unable to get the pll 1 base resource\n");
- }
- }
-
phy_base_reg = platform_get_resource_byname(pdev,
IORESOURCE_MEM, "phy_base");
- if (!phy_base_reg) {
- /* This resource is mandatory for HDMI pll */
- if (pll_res->pll_interface_type == MDSS_HDMI_PLL) {
- pr_err("Unable to get the phy base resources\n");
- rc = -ENOMEM;
- goto phy_io_error;
- }
- } else {
+ if (phy_base_reg) {
pll_res->phy_base = ioremap(phy_base_reg->start,
resource_size(phy_base_reg));
if (!pll_res->phy_base) {
@@ -403,18 +333,8 @@ static int mdss_pll_remove(struct platform_device *pdev)
}
static const struct of_device_id mdss_pll_dt_match[] = {
- {.compatible = "qcom,mdss_dsi_pll_8974"},
- {.compatible = "qcom,mdss_dsi_pll_8994"},
{.compatible = "qcom,mdss_dsi_pll_8996"},
- {.compatible = "qcom,mdss_hdmi_pll_8994"},
- {.compatible = "qcom,mdss_dsi_pll_8992"},
- {.compatible = "qcom,mdss_hdmi_pll_8992"},
{.compatible = "qcom,mdss_hdmi_pll_8996"},
- {.compatible = "qcom,mdss_dsi_pll_8916"},
- {.compatible = "qcom,mdss_dsi_pll_8939"},
- {.compatible = "qcom,mdss_dsi_pll_8909"},
- {.compatible = "qcom,mdss_edp_pll"},
- {.compatible = "qcom,mdss_hdmi_pll"},
{}
};
diff --git a/drivers/clk/msm/mdss/mdss-pll.h b/drivers/clk/msm/mdss/mdss-pll.h
index f959097803f3..b87233a22e10 100644
--- a/drivers/clk/msm/mdss/mdss-pll.h
+++ b/drivers/clk/msm/mdss/mdss-pll.h
@@ -28,25 +28,13 @@
(base) + (offset))
enum {
- MDSS_DSI_PLL_LPM,
- MDSS_DSI_PLL_HPM,
- MDSS_DSI_PLL_20NM,
MDSS_DSI_PLL_8996,
- MDSS_EDP_PLL,
- MDSS_HDMI_PLL,
- MDSS_HDMI_PLL_20NM,
MDSS_HDMI_PLL_8996,
MDSS_UNKNOWN_PLL,
};
enum {
- MDSS_PLL_TARGET_8974,
- MDSS_PLL_TARGET_8994,
- MDSS_PLL_TARGET_8992,
MDSS_PLL_TARGET_8996,
- MDSS_PLL_TARGET_8916,
- MDSS_PLL_TARGET_8939,
- MDSS_PLL_TARGET_8909,
};
struct mdss_pll_resources {