Dhaval Patel | bb40871 | 2014-03-18 11:45:53 -0700 | [diff] [blame] | 1 | /* Copyright (c) 2012-2014, The Linux Foundation. All rights reserved. |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 2 | * |
| 3 | * Redistribution and use in source and binary forms, with or without |
| 4 | * modification, are permitted provided that the following conditions are |
| 5 | * met: |
| 6 | * * Redistributions of source code must retain the above copyright |
| 7 | * notice, this list of conditions and the following disclaimer. |
| 8 | * * Redistributions in binary form must reproduce the above |
| 9 | * copyright notice, this list of conditions and the following |
| 10 | * disclaimer in the documentation and/or other materials provided |
| 11 | * with the distribution. |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 12 | * * Neither the name of The Linux Foundation nor the names of its |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 13 | * contributors may be used to endorse or promote products derived |
| 14 | * from this software without specific prior written permission. |
| 15 | * |
| 16 | * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED |
| 17 | * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF |
| 18 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT |
| 19 | * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS |
| 20 | * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| 21 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| 22 | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR |
| 23 | * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| 24 | * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE |
| 25 | * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN |
| 26 | * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| 27 | * |
| 28 | */ |
| 29 | #include <debug.h> |
| 30 | #include <reg.h> |
| 31 | #include <mipi_dsi.h> |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 32 | #include <platform/iomap.h> |
| 33 | |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 34 | #if (DISPLAY_TYPE_MDSS == 0) |
| 35 | #define MIPI_DSI0_BASE MIPI_DSI_BASE |
| 36 | #define MIPI_DSI1_BASE MIPI_DSI_BASE |
| 37 | #endif |
| 38 | |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 39 | static void mipi_dsi_calibration(void) |
| 40 | { |
| 41 | uint32_t i = 0; |
| 42 | uint32_t term_cnt = 5000; |
| 43 | int32_t cal_busy = readl(MIPI_DSI_BASE + 0x550); |
| 44 | |
| 45 | /* DSI1_DSIPHY_REGULATOR_CAL_PWR_CFG */ |
| 46 | writel(0x01, MIPI_DSI_BASE + 0x0518); |
| 47 | |
| 48 | /* DSI1_DSIPHY_CAL_SW_CFG2 */ |
| 49 | writel(0x0, MIPI_DSI_BASE + 0x0534); |
| 50 | /* DSI1_DSIPHY_CAL_HW_CFG1 */ |
| 51 | writel(0x5a, MIPI_DSI_BASE + 0x053c); |
| 52 | /* DSI1_DSIPHY_CAL_HW_CFG3 */ |
| 53 | writel(0x10, MIPI_DSI_BASE + 0x0544); |
| 54 | /* DSI1_DSIPHY_CAL_HW_CFG4 */ |
| 55 | writel(0x01, MIPI_DSI_BASE + 0x0548); |
| 56 | /* DSI1_DSIPHY_CAL_HW_CFG0 */ |
| 57 | writel(0x01, MIPI_DSI_BASE + 0x0538); |
| 58 | |
| 59 | /* DSI1_DSIPHY_CAL_HW_TRIGGER */ |
| 60 | writel(0x01, MIPI_DSI_BASE + 0x0528); |
| 61 | |
| 62 | /* DSI1_DSIPHY_CAL_HW_TRIGGER */ |
| 63 | writel(0x00, MIPI_DSI_BASE + 0x0528); |
| 64 | |
| 65 | cal_busy = readl(MIPI_DSI_BASE + 0x550); |
| 66 | while (cal_busy & 0x10) { |
| 67 | i++; |
| 68 | if (i > term_cnt) { |
| 69 | dprintf(CRITICAL, "DSI1 PHY REGULATOR NOT READY," |
| 70 | "exceeded polling TIMEOUT!\n"); |
| 71 | break; |
| 72 | } |
| 73 | cal_busy = readl(MIPI_DSI_BASE + 0x550); |
| 74 | } |
| 75 | } |
| 76 | |
| 77 | int mipi_dsi_phy_init(struct mipi_dsi_panel_config *pinfo) |
| 78 | { |
| 79 | struct mipi_dsi_phy_ctrl *pd; |
| 80 | uint32_t i, off = 0; |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 81 | int mdp_rev; |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 82 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 83 | mdp_rev = mdp_get_revision(); |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 84 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 85 | if (MDP_REV_303 == mdp_rev || MDP_REV_41 == mdp_rev) { |
| 86 | writel(0x00000001, DSIPHY_SW_RESET); |
| 87 | writel(0x00000000, DSIPHY_SW_RESET); |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 88 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 89 | pd = (pinfo->dsi_phy_config); |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 90 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 91 | off = 0x02cc; /* regulator ctrl 0 */ |
| 92 | for (i = 0; i < 4; i++) { |
| 93 | writel(pd->regulator[i], MIPI_DSI_BASE + off); |
| 94 | off += 4; |
| 95 | } |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 96 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 97 | off = 0x0260; /* phy timig ctrl 0 */ |
| 98 | for (i = 0; i < 11; i++) { |
| 99 | writel(pd->timing[i], MIPI_DSI_BASE + off); |
| 100 | off += 4; |
| 101 | } |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 102 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 103 | /* T_CLK_POST, T_CLK_PRE for CLK lane P/N HS 200 mV timing |
| 104 | length should > data lane HS timing length */ |
| 105 | writel(0xa1e, DSI_CLKOUT_TIMING_CTRL); |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 106 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 107 | off = 0x0290; /* ctrl 0 */ |
| 108 | for (i = 0; i < 4; i++) { |
| 109 | writel(pd->ctrl[i], MIPI_DSI_BASE + off); |
| 110 | off += 4; |
| 111 | } |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 112 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 113 | off = 0x02a0; /* strength 0 */ |
| 114 | for (i = 0; i < 4; i++) { |
| 115 | writel(pd->strength[i], MIPI_DSI_BASE + off); |
| 116 | off += 4; |
| 117 | } |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 118 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 119 | if (1 == pinfo->num_of_lanes) |
| 120 | pd->pll[10] |= 0x8; |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 121 | |
Channagoud Kadabi | 539ef72 | 2012-03-29 16:02:50 +0530 | [diff] [blame] | 122 | off = 0x0204; /* pll ctrl 1, skip 0 */ |
| 123 | for (i = 1; i < 21; i++) { |
| 124 | writel(pd->pll[i], MIPI_DSI_BASE + off); |
| 125 | off += 4; |
| 126 | } |
| 127 | |
| 128 | /* pll ctrl 0 */ |
| 129 | writel(pd->pll[0], MIPI_DSI_BASE + 0x200); |
| 130 | writel((pd->pll[0] | 0x01), MIPI_DSI_BASE + 0x200); |
| 131 | /* lane swp ctrol */ |
| 132 | if (pinfo->lane_swap) |
| 133 | writel(pinfo->lane_swap, MIPI_DSI_BASE + 0xac); |
| 134 | } else { |
| 135 | writel(0x0001, MIPI_DSI_BASE + 0x128); /* start phy sw reset */ |
| 136 | writel(0x0000, MIPI_DSI_BASE + 0x128); /* end phy w reset */ |
| 137 | writel(0x0003, MIPI_DSI_BASE + 0x500); /* regulator_ctrl_0 */ |
| 138 | writel(0x0001, MIPI_DSI_BASE + 0x504); /* regulator_ctrl_1 */ |
| 139 | writel(0x0001, MIPI_DSI_BASE + 0x508); /* regulator_ctrl_2 */ |
| 140 | writel(0x0000, MIPI_DSI_BASE + 0x50c); /* regulator_ctrl_3 */ |
| 141 | writel(0x0100, MIPI_DSI_BASE + 0x510); /* regulator_ctrl_4 */ |
| 142 | |
| 143 | pd = (pinfo->dsi_phy_config); |
| 144 | |
| 145 | off = 0x0480; /* strength 0 - 2 */ |
| 146 | for (i = 0; i < 3; i++) { |
| 147 | writel(pd->strength[i], MIPI_DSI_BASE + off); |
| 148 | off += 4; |
| 149 | } |
| 150 | |
| 151 | off = 0x0470; /* ctrl 0 - 3 */ |
| 152 | for (i = 0; i < 4; i++) { |
| 153 | writel(pd->ctrl[i], MIPI_DSI_BASE + off); |
| 154 | off += 4; |
| 155 | } |
| 156 | |
| 157 | off = 0x0500; /* regulator ctrl 0 - 4 */ |
| 158 | for (i = 0; i < 5; i++) { |
| 159 | writel(pd->regulator[i], MIPI_DSI_BASE + off); |
| 160 | off += 4; |
| 161 | } |
| 162 | mipi_dsi_calibration(); |
| 163 | |
| 164 | off = 0x0204; /* pll ctrl 1 - 19, skip 0 */ |
| 165 | for (i = 1; i < 20; i++) { |
| 166 | writel(pd->pll[i], MIPI_DSI_BASE + off); |
| 167 | off += 4; |
| 168 | } |
| 169 | |
| 170 | /* pll ctrl 0 */ |
| 171 | writel(pd->pll[0], MIPI_DSI_BASE + 0x200); |
| 172 | writel((pd->pll[0] | 0x01), MIPI_DSI_BASE + 0x200); |
| 173 | |
| 174 | /* Check that PHY is ready */ |
| 175 | while (!(readl(DSIPHY_PLL_RDY) & 0x01)) |
| 176 | udelay(1); |
| 177 | |
| 178 | writel(0x202D, DSI_CLKOUT_TIMING_CTRL); |
| 179 | |
| 180 | off = 0x0440; /* phy timing ctrl 0 - 11 */ |
| 181 | for (i = 0; i < 12; i++) { |
| 182 | writel(pd->timing[i], MIPI_DSI_BASE + off); |
| 183 | off += 4; |
| 184 | } |
Shashank Mittal | 4bfb2e3 | 2012-04-16 10:56:27 -0700 | [diff] [blame] | 185 | } |
| 186 | return 0; |
| 187 | } |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 188 | |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 189 | void mdss_dsi_phy_sw_reset(uint32_t ctl_base) |
Chandan Uddaraju | 932723b | 2013-02-21 18:36:20 -0800 | [diff] [blame] | 190 | { |
| 191 | /* start phy sw reset */ |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 192 | writel(0x0001, ctl_base + 0x012c); |
Chandan Uddaraju | 932723b | 2013-02-21 18:36:20 -0800 | [diff] [blame] | 193 | udelay(1000); |
| 194 | |
| 195 | /* end phy sw reset */ |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 196 | writel(0x0000, ctl_base + 0x012c); |
Chandan Uddaraju | 932723b | 2013-02-21 18:36:20 -0800 | [diff] [blame] | 197 | udelay(100); |
| 198 | } |
| 199 | |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 200 | int mdss_dsi_phy_regulator_init(struct mdss_dsi_phy_ctrl *pd) |
| 201 | { |
| 202 | /* DSI0 and DSI1 have a common regulator */ |
| 203 | |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 204 | uint32_t off = 0x0280; /* phy regulator ctrl settings */ |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 205 | |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 206 | /* Regulator ctrl 0 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 207 | writel(0x00, DSI0_PHY_BASE + off + (4 * 0)); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 208 | /* Regulator ctrl - CAL_PWD_CFG */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 209 | writel(pd->regulator[6], DSI0_PHY_BASE + off + (4 * 6)); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 210 | /* Regulator ctrl - TEST */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 211 | writel(pd->regulator[5], DSI0_PHY_BASE + off + (4 * 5)); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 212 | /* Regulator ctrl 3 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 213 | writel(pd->regulator[3], DSI0_PHY_BASE + off + (4 * 3)); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 214 | /* Regulator ctrl 2 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 215 | writel(pd->regulator[2], DSI0_PHY_BASE + off + (4 * 2)); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 216 | /* Regulator ctrl 1 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 217 | writel(pd->regulator[1], DSI0_PHY_BASE + off + (4 * 1)); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 218 | /* Regulator ctrl 0 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 219 | writel(pd->regulator[0], DSI0_PHY_BASE + off + (4 * 0)); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 220 | /* Regulator ctrl 4 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 221 | writel(pd->regulator[4], DSI0_PHY_BASE + off + (4 * 4)); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 222 | dmb(); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 223 | } |
| 224 | |
Terence Hampson | f49ff4e | 2013-06-18 15:11:31 -0400 | [diff] [blame] | 225 | int mdss_dsi_v2_phy_init(struct mipi_dsi_panel_config *pinfo, uint32_t ctl_base) |
| 226 | { |
| 227 | struct mdss_dsi_phy_ctrl *pd; |
| 228 | uint32_t i, ln, off = 0, offset; |
| 229 | |
| 230 | pd = pinfo->mdss_dsi_phy_config; |
| 231 | /* DSI PHY configuration */ |
| 232 | off = 0x480; |
| 233 | writel(pd->strength[0], ctl_base + off + (4 * 0)); |
| 234 | writel(pd->strength[1], ctl_base + off + (4 * 2)); |
| 235 | |
| 236 | off = 0x470; |
| 237 | writel(0x10, ctl_base + off + (4 * 3)); |
| 238 | writel(0x5F, ctl_base + off + (4 * 0)); |
| 239 | |
| 240 | off = 0x500; |
Xiaoming Zhou | 7c9e1ee | 2013-07-18 10:51:41 -0400 | [diff] [blame] | 241 | /* use LDO mode */ |
| 242 | writel(0x25, ctl_base + 0x4B0); |
Terence Hampson | f49ff4e | 2013-06-18 15:11:31 -0400 | [diff] [blame] | 243 | for (i = 0; i < 5; i++) |
| 244 | writel(pd->regulator[i], ctl_base + off + (4 * i)); |
| 245 | |
| 246 | mipi_dsi_calibration(); |
| 247 | |
| 248 | /* 4 lanes + clk lane configuration */ |
| 249 | /* lane config n * (0 - 4) & DataPath setup */ |
| 250 | for (ln = 0; ln < 5; ln++) { |
| 251 | off = 0x0300 + (ln * 0x40); |
| 252 | for (i = 0; i < 9; i++) { |
| 253 | offset = i + (ln * 9); |
| 254 | writel(pd->laneCfg[offset], ctl_base + off); |
| 255 | dmb(); |
| 256 | off += 4; |
| 257 | } |
| 258 | } |
| 259 | |
| 260 | off = 0x440; |
| 261 | for (i = 0; i < 12; i++) |
| 262 | writel(pd->timing[i], ctl_base + off + (4 * i)); |
| 263 | |
| 264 | if (1 == pinfo->num_of_lanes) |
| 265 | writel(0x8, ctl_base + 0x200 + (4 * 11)); |
| 266 | |
| 267 | |
| 268 | if (pinfo->lane_swap) |
| 269 | writel(pinfo->lane_swap, ctl_base + 0x0ac); |
| 270 | |
| 271 | /* T_CLK_POST, T_CLK_PRE for CLK lane P/N HS 200 mV timing |
| 272 | length should > data lane HS timing length */ |
| 273 | writel(0x41b, ctl_base + 0x0c0); |
| 274 | return 0; |
| 275 | } |
| 276 | |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 277 | int mdss_dsi_phy_init(struct mipi_dsi_panel_config *pinfo, |
| 278 | uint32_t ctl_base, uint32_t phy_base) |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 279 | { |
| 280 | struct mdss_dsi_phy_ctrl *pd; |
| 281 | uint32_t i, off = 0, ln, offset; |
| 282 | |
Terence Hampson | f49ff4e | 2013-06-18 15:11:31 -0400 | [diff] [blame] | 283 | if (mdp_get_revision() == MDP_REV_304) |
| 284 | return mdss_dsi_v2_phy_init(pinfo, ctl_base); |
| 285 | |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 286 | pd = (pinfo->mdss_dsi_phy_config); |
| 287 | |
| 288 | /* Strength ctrl 0 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 289 | writel(pd->strength[0], phy_base + 0x0184); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 290 | |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 291 | mdss_dsi_phy_regulator_init(pd); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 292 | |
Chandan Uddaraju | 932723b | 2013-02-21 18:36:20 -0800 | [diff] [blame] | 293 | /* Strength ctrl 0 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 294 | writel(0x00, phy_base + 0x01dc); |
Chandan Uddaraju | 932723b | 2013-02-21 18:36:20 -0800 | [diff] [blame] | 295 | |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 296 | off = 0x0140; /* phy timing ctrl 0 - 11 */ |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 297 | for (i = 0; i < 12; i++) { |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 298 | writel(pd->timing[i], phy_base + off); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 299 | dmb(); |
| 300 | off += 4; |
| 301 | } |
| 302 | |
| 303 | /* MMSS_DSI_0_PHY_DSIPHY_CTRL_1 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 304 | writel(0x00, phy_base + 0x0174); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 305 | /* MMSS_DSI_0_PHY_DSIPHY_CTRL_0 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 306 | writel(0x5f, phy_base + 0x0170); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 307 | |
| 308 | /* Strength ctrl 1 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 309 | writel(pd->strength[1], phy_base + 0x0188); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 310 | dmb(); |
| 311 | /* 4 lanes + clk lane configuration */ |
| 312 | /* lane config n * (0 - 4) & DataPath setup */ |
| 313 | for (ln = 0; ln < 5; ln++) { |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 314 | off = (ln * 0x40); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 315 | for (i = 0; i < 9; i++) { |
| 316 | offset = i + (ln * 9); |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 317 | writel(pd->laneCfg[offset], phy_base + off); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 318 | dmb(); |
| 319 | off += 4; |
| 320 | } |
| 321 | } |
| 322 | |
| 323 | /* MMSS_DSI_0_PHY_DSIPHY_CTRL_0 */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 324 | writel(0x5f, phy_base + 0x0170); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 325 | |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 326 | /* DSI_PHY_DSIPHY_GLBL_TEST_CTRL */ |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 327 | if (phy_base == DSI0_PHY_BASE) |
| 328 | writel(0x01, phy_base + 0x01d4); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 329 | else |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 330 | writel(0x00, phy_base + 0x01d4); |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 331 | |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 332 | dmb(); |
| 333 | |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 334 | off = 0x01b4; /* phy BIST ctrl 0 - 5 */ |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 335 | for (i = 0; i < 6; i++) { |
Padmanabhan Komanduru | cdc651e | 2014-03-25 20:25:55 +0530 | [diff] [blame^] | 336 | writel(pd->bistCtrl[i], phy_base + off); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 337 | off += 4; |
| 338 | } |
| 339 | dmb(); |
| 340 | |
| 341 | /* DSI_0_CLKOUT_TIMING_CTRL */ |
Siddhartha Agrawal | 1b2ed84 | 2013-05-29 18:02:28 -0700 | [diff] [blame] | 342 | writel(0x41b, ctl_base + 0x0c4); |
Siddhartha Agrawal | 3e694ea | 2013-01-23 17:01:31 -0800 | [diff] [blame] | 343 | dmb(); |
| 344 | |
| 345 | } |