| /* |
| * Copyright (c) 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 "dsi_phy.h" |
| #include "dsi.xml.h" |
| |
| static void dsi_20nm_dphy_set_timing(struct msm_dsi_phy *phy, |
| struct msm_dsi_dphy_timing *timing) |
| { |
| void __iomem *base = phy->base; |
| |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_0, |
| DSI_20nm_PHY_TIMING_CTRL_0_CLK_ZERO(timing->clk_zero)); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_1, |
| DSI_20nm_PHY_TIMING_CTRL_1_CLK_TRAIL(timing->clk_trail)); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_2, |
| DSI_20nm_PHY_TIMING_CTRL_2_CLK_PREPARE(timing->clk_prepare)); |
| if (timing->clk_zero & BIT(8)) |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_3, |
| DSI_20nm_PHY_TIMING_CTRL_3_CLK_ZERO_8); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_4, |
| DSI_20nm_PHY_TIMING_CTRL_4_HS_EXIT(timing->hs_exit)); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_5, |
| DSI_20nm_PHY_TIMING_CTRL_5_HS_ZERO(timing->hs_zero)); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_6, |
| DSI_20nm_PHY_TIMING_CTRL_6_HS_PREPARE(timing->hs_prepare)); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_7, |
| DSI_20nm_PHY_TIMING_CTRL_7_HS_TRAIL(timing->hs_trail)); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_8, |
| DSI_20nm_PHY_TIMING_CTRL_8_HS_RQST(timing->hs_rqst)); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_9, |
| DSI_20nm_PHY_TIMING_CTRL_9_TA_GO(timing->ta_go) | |
| DSI_20nm_PHY_TIMING_CTRL_9_TA_SURE(timing->ta_sure)); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_10, |
| DSI_20nm_PHY_TIMING_CTRL_10_TA_GET(timing->ta_get)); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_TIMING_CTRL_11, |
| DSI_20nm_PHY_TIMING_CTRL_11_TRIG3_CMD(0)); |
| } |
| |
| static void dsi_20nm_phy_regulator_ctrl(struct msm_dsi_phy *phy, bool enable) |
| { |
| void __iomem *base = phy->reg_base; |
| |
| if (!enable) { |
| dsi_phy_write(base + REG_DSI_20nm_PHY_REGULATOR_CAL_PWR_CFG, 0); |
| return; |
| } |
| |
| if (phy->regulator_ldo_mode) { |
| dsi_phy_write(phy->base + REG_DSI_20nm_PHY_LDO_CNTRL, 0x1d); |
| return; |
| } |
| |
| /* non LDO mode */ |
| dsi_phy_write(base + REG_DSI_20nm_PHY_REGULATOR_CTRL_1, 0x03); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_REGULATOR_CTRL_2, 0x03); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_REGULATOR_CTRL_3, 0x00); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_REGULATOR_CTRL_4, 0x20); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_REGULATOR_CAL_PWR_CFG, 0x01); |
| dsi_phy_write(phy->base + REG_DSI_20nm_PHY_LDO_CNTRL, 0x00); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_REGULATOR_CTRL_0, 0x03); |
| } |
| |
| static int dsi_20nm_phy_enable(struct msm_dsi_phy *phy, int src_pll_id, |
| struct msm_dsi_phy_clk_request *clk_req) |
| { |
| struct msm_dsi_dphy_timing *timing = &phy->timing; |
| int i; |
| void __iomem *base = phy->base; |
| u32 cfg_4[4] = {0x20, 0x40, 0x20, 0x00}; |
| |
| DBG(""); |
| |
| if (msm_dsi_dphy_timing_calc(timing, clk_req)) { |
| dev_err(&phy->pdev->dev, |
| "%s: D-PHY timing calculation failed\n", __func__); |
| return -EINVAL; |
| } |
| |
| dsi_20nm_phy_regulator_ctrl(phy, true); |
| |
| dsi_phy_write(base + REG_DSI_20nm_PHY_STRENGTH_0, 0xff); |
| |
| msm_dsi_phy_set_src_pll(phy, src_pll_id, |
| REG_DSI_20nm_PHY_GLBL_TEST_CTRL, |
| DSI_20nm_PHY_GLBL_TEST_CTRL_BITCLK_HS_SEL); |
| |
| for (i = 0; i < 4; i++) { |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LN_CFG_3(i), |
| (i >> 1) * 0x40); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LN_TEST_STR_0(i), 0x01); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LN_TEST_STR_1(i), 0x46); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LN_CFG_0(i), 0x02); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LN_CFG_1(i), 0xa0); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LN_CFG_4(i), cfg_4[i]); |
| } |
| |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LNCK_CFG_3, 0x80); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LNCK_TEST_STR0, 0x01); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LNCK_TEST_STR1, 0x46); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LNCK_CFG_0, 0x00); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LNCK_CFG_1, 0xa0); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LNCK_CFG_2, 0x00); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_LNCK_CFG_4, 0x00); |
| |
| dsi_20nm_dphy_set_timing(phy, timing); |
| |
| dsi_phy_write(base + REG_DSI_20nm_PHY_CTRL_1, 0x00); |
| |
| dsi_phy_write(base + REG_DSI_20nm_PHY_STRENGTH_1, 0x06); |
| |
| /* make sure everything is written before enable */ |
| wmb(); |
| dsi_phy_write(base + REG_DSI_20nm_PHY_CTRL_0, 0x7f); |
| |
| return 0; |
| } |
| |
| static void dsi_20nm_phy_disable(struct msm_dsi_phy *phy) |
| { |
| dsi_phy_write(phy->base + REG_DSI_20nm_PHY_CTRL_0, 0); |
| dsi_20nm_phy_regulator_ctrl(phy, false); |
| } |
| |
| const struct msm_dsi_phy_cfg dsi_phy_20nm_cfgs = { |
| .type = MSM_DSI_PHY_20NM, |
| .src_pll_truthtable = { {false, true}, {false, true} }, |
| .reg_cfg = { |
| .num = 2, |
| .regs = { |
| {"vddio", 100000, 100}, /* 1.8 V */ |
| {"vcca", 10000, 100}, /* 1.0 V */ |
| }, |
| }, |
| .ops = { |
| .enable = dsi_20nm_phy_enable, |
| .disable = dsi_20nm_phy_disable, |
| .init = msm_dsi_phy_init_common, |
| }, |
| .io_start = { 0xfd998300, 0xfd9a0300 }, |
| .num_dsi_phy = 2, |
| }; |
| |