1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (c) 2022 MediaTek Inc. 4 * Copyright (c) 2022 BayLibre, SAS 5 */ 6 #include <linux/delay.h> 7 #include <linux/io.h> 8 #include <linux/mfd/syscon.h> 9 #include <linux/module.h> 10 #include <linux/phy/phy.h> 11 #include <linux/platform_device.h> 12 #include <linux/types.h> 13 #include <linux/units.h> 14 #include <linux/nvmem-consumer.h> 15 16 #include "phy-mtk-io.h" 17 #include "phy-mtk-hdmi.h" 18 #include "phy-mtk-hdmi-mt8195.h" 19 20 static void mtk_hdmi_ana_fifo_en(struct mtk_hdmi_phy *hdmi_phy) 21 { 22 /* make data fifo writable for hdmi2.0 */ 23 mtk_phy_set_bits(hdmi_phy->regs + HDMI_ANA_CTL, REG_ANA_HDMI20_FIFO_EN); 24 } 25 26 static void 27 mtk_phy_tmds_clk_ratio(struct mtk_hdmi_phy *hdmi_phy, bool enable) 28 { 29 void __iomem *regs = hdmi_phy->regs; 30 31 mtk_hdmi_ana_fifo_en(hdmi_phy); 32 33 /* HDMI 2.0 specification, 3.4Gbps <= TMDS Bit Rate <= 6G, 34 * clock bit ratio 1:40, under 3.4Gbps, clock bit ratio 1:10 35 */ 36 if (enable) 37 mtk_phy_update_field(regs + HDMI20_CLK_CFG, REG_TXC_DIV, 3); 38 else 39 mtk_phy_clear_bits(regs + HDMI20_CLK_CFG, REG_TXC_DIV); 40 } 41 42 static void mtk_hdmi_pll_sel_src(struct clk_hw *hw) 43 { 44 struct mtk_hdmi_phy *hdmi_phy = to_mtk_hdmi_phy(hw); 45 void __iomem *regs = hdmi_phy->regs; 46 47 mtk_phy_clear_bits(regs + HDMI_CTL_3, REG_HDMITX_REF_XTAL_SEL); 48 mtk_phy_clear_bits(regs + HDMI_CTL_3, REG_HDMITX_REF_RESPLL_SEL); 49 50 /* DA_HDMITX21_REF_CK for TXPLL input source */ 51 mtk_phy_clear_bits(regs + HDMI_1_CFG_10, RG_HDMITXPLL_REF_CK_SEL); 52 } 53 54 static void mtk_hdmi_pll_perf(struct clk_hw *hw) 55 { 56 struct mtk_hdmi_phy *hdmi_phy = to_mtk_hdmi_phy(hw); 57 void __iomem *regs = hdmi_phy->regs; 58 59 mtk_phy_set_bits(regs + HDMI_1_PLL_CFG_0, RG_HDMITXPLL_BP2); 60 mtk_phy_set_bits(regs + HDMI_1_PLL_CFG_2, RG_HDMITXPLL_BC); 61 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_2, RG_HDMITXPLL_IC, 0x1); 62 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_2, RG_HDMITXPLL_BR, 0x2); 63 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_2, RG_HDMITXPLL_IR, 0x2); 64 mtk_phy_set_bits(regs + HDMI_1_PLL_CFG_2, RG_HDMITXPLL_BP); 65 mtk_phy_clear_bits(regs + HDMI_1_PLL_CFG_0, RG_HDMITXPLL_IBAND_FIX_EN); 66 mtk_phy_clear_bits(regs + HDMI_1_PLL_CFG_1, RG_HDMITXPLL_RESERVE_BIT14); 67 mtk_phy_clear_bits(regs + HDMI_1_PLL_CFG_2, RG_HDMITXPLL_HIKVCO); 68 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_0, RG_HDMITXPLL_HREN, 0x1); 69 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_0, RG_HDMITXPLL_LVR_SEL, 0x1); 70 mtk_phy_set_bits(regs + HDMI_1_PLL_CFG_1, RG_HDMITXPLL_RESERVE_BIT12_11); 71 mtk_phy_set_bits(regs + HDMI_1_PLL_CFG_0, RG_HDMITXPLL_TCL_EN); 72 } 73 74 static int mtk_hdmi_pll_set_hw(struct clk_hw *hw, u8 prediv, 75 u8 fbkdiv_high, 76 u32 fbkdiv_low, 77 u8 fbkdiv_hs3, u8 posdiv1, 78 u8 posdiv2, u8 txprediv, 79 u8 txposdiv, 80 u8 digital_div) 81 { 82 u8 txposdiv_value; 83 u8 div3_ctrl_value; 84 u8 posdiv_vallue; 85 u8 div_ctrl_value; 86 u8 reserve_3_2_value; 87 u8 prediv_value; 88 u8 reserve13_value; 89 struct mtk_hdmi_phy *hdmi_phy = to_mtk_hdmi_phy(hw); 90 void __iomem *regs = hdmi_phy->regs; 91 92 mtk_hdmi_pll_sel_src(hw); 93 94 mtk_hdmi_pll_perf(hw); 95 96 mtk_phy_update_field(regs + HDMI_1_CFG_10, RG_HDMITX21_BIAS_PE_BG_VREF_SEL, 0x2); 97 mtk_phy_clear_bits(regs + HDMI_1_CFG_10, RG_HDMITX21_VREF_SEL); 98 mtk_phy_update_field(regs + HDMI_1_CFG_9, RG_HDMITX21_SLDO_VREF_SEL, 0x2); 99 mtk_phy_clear_bits(regs + HDMI_1_CFG_10, RG_HDMITX21_BIAS_PE_VREF_SELB); 100 mtk_phy_set_bits(regs + HDMI_1_CFG_3, RG_HDMITX21_SLDOLPF_EN); 101 mtk_phy_update_field(regs + HDMI_1_CFG_6, RG_HDMITX21_INTR_CAL, 0x11); 102 mtk_phy_set_bits(regs + HDMI_1_PLL_CFG_2, RG_HDMITXPLL_PWD); 103 104 /* TXPOSDIV */ 105 txposdiv_value = ilog2(txposdiv); 106 107 mtk_phy_update_field(regs + HDMI_1_CFG_6, RG_HDMITX21_TX_POSDIV, txposdiv_value); 108 mtk_phy_set_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_TX_POSDIV_EN); 109 mtk_phy_clear_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_FRL_EN); 110 111 /* TXPREDIV */ 112 switch (txprediv) { 113 case 2: 114 div3_ctrl_value = 0x0; 115 posdiv_vallue = 0x0; 116 break; 117 case 4: 118 div3_ctrl_value = 0x0; 119 posdiv_vallue = 0x1; 120 break; 121 case 6: 122 div3_ctrl_value = 0x1; 123 posdiv_vallue = 0x0; 124 break; 125 case 12: 126 div3_ctrl_value = 0x1; 127 posdiv_vallue = 0x1; 128 break; 129 default: 130 return -EINVAL; 131 } 132 133 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_4, RG_HDMITXPLL_POSDIV_DIV3_CTRL, div3_ctrl_value); 134 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_4, RG_HDMITXPLL_POSDIV, posdiv_vallue); 135 136 /* POSDIV1 */ 137 switch (posdiv1) { 138 case 5: 139 div_ctrl_value = 0x0; 140 break; 141 case 10: 142 div_ctrl_value = 0x1; 143 break; 144 case 12: 145 div_ctrl_value = 0x2; 146 break; 147 case 15: 148 div_ctrl_value = 0x3; 149 break; 150 default: 151 return -EINVAL; 152 } 153 154 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_4, RG_HDMITXPLL_DIV_CTRL, div_ctrl_value); 155 156 /* DE add new setting */ 157 mtk_phy_clear_bits(regs + HDMI_1_PLL_CFG_1, RG_HDMITXPLL_RESERVE_BIT14); 158 159 /* POSDIV2 */ 160 switch (posdiv2) { 161 case 1: 162 reserve_3_2_value = 0x0; 163 break; 164 case 2: 165 reserve_3_2_value = 0x1; 166 break; 167 case 4: 168 reserve_3_2_value = 0x2; 169 break; 170 case 6: 171 reserve_3_2_value = 0x3; 172 break; 173 default: 174 return -EINVAL; 175 } 176 177 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_1, RG_HDMITXPLL_RESERVE_BIT3_2, reserve_3_2_value); 178 179 /* DE add new setting */ 180 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_1, RG_HDMITXPLL_RESERVE_BIT1_0, 0x2); 181 182 /* PREDIV */ 183 prediv_value = ilog2(prediv); 184 185 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_4, RG_HDMITXPLL_PREDIV, prediv_value); 186 187 /* FBKDIV_HS3 */ 188 reserve13_value = ilog2(fbkdiv_hs3); 189 190 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_1, RG_HDMITXPLL_RESERVE_BIT13, reserve13_value); 191 192 /* FBDIV */ 193 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_4, RG_HDMITXPLL_FBKDIV_HIGH, fbkdiv_high); 194 mtk_phy_update_field(regs + HDMI_1_PLL_CFG_3, RG_HDMITXPLL_FBKDIV_LOW, fbkdiv_low); 195 196 /* Digital DIVIDER */ 197 mtk_phy_clear_bits(regs + HDMI_CTL_3, REG_PIXEL_CLOCK_SEL); 198 199 if (digital_div == 1) { 200 mtk_phy_clear_bits(regs + HDMI_CTL_3, REG_HDMITX_PIXEL_CLOCK); 201 } else { 202 mtk_phy_set_bits(regs + HDMI_CTL_3, REG_HDMITX_PIXEL_CLOCK); 203 mtk_phy_update_field(regs + HDMI_CTL_3, REG_HDMITXPLL_DIV, digital_div - 1); 204 } 205 206 return 0; 207 } 208 209 static int mtk_hdmi_pll_calc(struct mtk_hdmi_phy *hdmi_phy, struct clk_hw *hw, 210 unsigned long rate, unsigned long parent_rate) 211 { 212 u8 digital_div, txprediv, txposdiv, fbkdiv_high, posdiv1, posdiv2; 213 u64 tmds_clk, pixel_clk, da_hdmitx21_ref_ck, ns_hdmipll_ck, pcw; 214 u8 txpredivs[4] = { 2, 4, 6, 12 }; 215 u32 fbkdiv_low; 216 int i; 217 218 pixel_clk = rate; 219 tmds_clk = pixel_clk; 220 221 if (tmds_clk < 25 * MEGA || tmds_clk > 594 * MEGA) 222 return -EINVAL; 223 224 if (tmds_clk >= 340 * MEGA) 225 hdmi_phy->tmds_over_340M = true; 226 else 227 hdmi_phy->tmds_over_340M = false; 228 229 /* in Hz */ 230 da_hdmitx21_ref_ck = 26 * MEGA; 231 232 /* TXPOSDIV stage treatment: 233 * 0M < TMDS clk < 54M /8 234 * 54M <= TMDS clk < 148.35M /4 235 * 148.35M <=TMDS clk < 296.7M /2 236 * 296.7 <=TMDS clk <= 594M /1 237 */ 238 if (tmds_clk < 54 * MEGA) 239 txposdiv = 8; 240 else if (tmds_clk >= 54 * MEGA && (tmds_clk * 100) < 14835 * MEGA) 241 txposdiv = 4; 242 else if ((tmds_clk * 100) >= 14835 * MEGA && (tmds_clk * 10) < 2967 * MEGA) 243 txposdiv = 2; 244 else if ((tmds_clk * 10) >= 2967 * MEGA && tmds_clk <= 594 * MEGA) 245 txposdiv = 1; 246 else 247 return -EINVAL; 248 249 /* calculate txprediv: can be 2, 4, 6, 12 250 * ICO clk = 5*TMDS_CLK*TXPOSDIV*TXPREDIV 251 * ICO clk constraint: 5G =< ICO clk <= 12G 252 */ 253 for (i = 0; i < ARRAY_SIZE(txpredivs); i++) { 254 ns_hdmipll_ck = 5 * tmds_clk * txposdiv * txpredivs[i]; 255 if (ns_hdmipll_ck >= 5 * GIGA && 256 ns_hdmipll_ck <= 1 * GIGA) 257 break; 258 } 259 if (i == (ARRAY_SIZE(txpredivs) - 1) && 260 (ns_hdmipll_ck < 5 * GIGA || ns_hdmipll_ck > 12 * GIGA)) { 261 return -EINVAL; 262 } 263 if (i == ARRAY_SIZE(txpredivs)) 264 return -EINVAL; 265 266 txprediv = txpredivs[i]; 267 268 /* PCW calculation: FBKDIV 269 * formula: pcw=(frequency_out*2^pcw_bit) / frequency_in / FBKDIV_HS3; 270 * RG_HDMITXPLL_FBKDIV[32:0]: 271 * [32,24] 9bit integer, [23,0]:24bit fraction 272 */ 273 pcw = div_u64(((u64)ns_hdmipll_ck) << PCW_DECIMAL_WIDTH, 274 da_hdmitx21_ref_ck * PLL_FBKDIV_HS3); 275 276 if (pcw > GENMASK_ULL(32, 0)) 277 return -EINVAL; 278 279 fbkdiv_high = FIELD_GET(GENMASK_ULL(63, 32), pcw); 280 fbkdiv_low = FIELD_GET(GENMASK(31, 0), pcw); 281 282 /* posdiv1: 283 * posdiv1 stage treatment according to color_depth: 284 * 24bit -> posdiv1 /10, 30bit -> posdiv1 /12.5, 285 * 36bit -> posdiv1 /15, 48bit -> posdiv1 /10 286 */ 287 posdiv1 = 10; 288 posdiv2 = 1; 289 290 /* Digital clk divider, max /32 */ 291 digital_div = div_u64(ns_hdmipll_ck, posdiv1 * posdiv2 * pixel_clk); 292 if (!(digital_div <= 32 && digital_div >= 1)) 293 return -EINVAL; 294 295 return mtk_hdmi_pll_set_hw(hw, PLL_PREDIV, fbkdiv_high, fbkdiv_low, 296 PLL_FBKDIV_HS3, posdiv1, posdiv2, txprediv, 297 txposdiv, digital_div); 298 } 299 300 static int mtk_hdmi_pll_drv_setting(struct clk_hw *hw) 301 { 302 struct mtk_hdmi_phy *hdmi_phy = to_mtk_hdmi_phy(hw); 303 void __iomem *regs = hdmi_phy->regs; 304 u8 data_channel_bias, clk_channel_bias; 305 u8 impedance, impedance_en; 306 u32 tmds_clk; 307 u32 pixel_clk = hdmi_phy->pll_rate; 308 309 tmds_clk = pixel_clk; 310 311 /* bias & impedance setting: 312 * 3G < data rate <= 6G: enable impedance 100ohm, 313 * data channel bias 24mA, clock channel bias 20mA 314 * pixel clk >= HD, 74.175MHZ <= pixel clk <= 300MHZ: 315 * enalbe impedance 100ohm 316 * data channel 20mA, clock channel 16mA 317 * 27M =< pixel clk < 74.175: disable impedance 318 * data channel & clock channel bias 10mA 319 */ 320 321 /* 3G < data rate <= 6G, 300M < tmds rate <= 594M */ 322 if (tmds_clk > 300 * MEGA && tmds_clk <= 594 * MEGA) { 323 data_channel_bias = 0x3c; /* 24mA */ 324 clk_channel_bias = 0x34; /* 20mA */ 325 impedance_en = 0xf; 326 impedance = 0x36; /* 100ohm */ 327 } else if (((u64)pixel_clk * 1000) >= 74175 * MEGA && pixel_clk <= 300 * MEGA) { 328 data_channel_bias = 0x34; /* 20mA */ 329 clk_channel_bias = 0x2c; /* 16mA */ 330 impedance_en = 0xf; 331 impedance = 0x36; /* 100ohm */ 332 } else if (pixel_clk >= 27 * MEGA && ((u64)pixel_clk * 1000) < 74175 * MEGA) { 333 data_channel_bias = 0x14; /* 10mA */ 334 clk_channel_bias = 0x14; /* 10mA */ 335 impedance_en = 0x0; 336 impedance = 0x0; 337 } else { 338 return -EINVAL; 339 } 340 341 /* bias */ 342 mtk_phy_update_field(regs + HDMI_1_CFG_1, RG_HDMITX21_DRV_IBIAS_D0, data_channel_bias); 343 mtk_phy_update_field(regs + HDMI_1_CFG_1, RG_HDMITX21_DRV_IBIAS_D1, data_channel_bias); 344 mtk_phy_update_field(regs + HDMI_1_CFG_1, RG_HDMITX21_DRV_IBIAS_D2, data_channel_bias); 345 mtk_phy_update_field(regs + HDMI_1_CFG_0, RG_HDMITX21_DRV_IBIAS_CLK, clk_channel_bias); 346 347 /* impedance */ 348 mtk_phy_update_field(regs + HDMI_1_CFG_0, RG_HDMITX21_DRV_IMP_EN, impedance_en); 349 mtk_phy_update_field(regs + HDMI_1_CFG_2, RG_HDMITX21_DRV_IMP_D0_EN1, impedance); 350 mtk_phy_update_field(regs + HDMI_1_CFG_2, RG_HDMITX21_DRV_IMP_D1_EN1, impedance); 351 mtk_phy_update_field(regs + HDMI_1_CFG_2, RG_HDMITX21_DRV_IMP_D2_EN1, impedance); 352 mtk_phy_update_field(regs + HDMI_1_CFG_2, RG_HDMITX21_DRV_IMP_CLK_EN1, impedance); 353 354 return 0; 355 } 356 357 static int mtk_hdmi_pll_prepare(struct clk_hw *hw) 358 { 359 struct mtk_hdmi_phy *hdmi_phy = to_mtk_hdmi_phy(hw); 360 void __iomem *regs = hdmi_phy->regs; 361 362 mtk_phy_set_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_TX_POSDIV_EN); 363 364 mtk_phy_set_bits(regs + HDMI_1_CFG_0, RG_HDMITX21_SER_EN); 365 mtk_phy_set_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_D0_DRV_OP_EN); 366 mtk_phy_set_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_D1_DRV_OP_EN); 367 mtk_phy_set_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_D2_DRV_OP_EN); 368 mtk_phy_set_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_CK_DRV_OP_EN); 369 370 mtk_phy_clear_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_FRL_D0_EN); 371 mtk_phy_clear_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_FRL_D1_EN); 372 mtk_phy_clear_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_FRL_D2_EN); 373 mtk_phy_clear_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_FRL_CK_EN); 374 375 mtk_hdmi_pll_drv_setting(hw); 376 377 mtk_phy_clear_bits(regs + HDMI_1_CFG_10, RG_HDMITX21_BG_PWD); 378 mtk_phy_set_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_BIAS_EN); 379 mtk_phy_set_bits(regs + HDMI_1_CFG_3, RG_HDMITX21_CKLDO_EN); 380 mtk_phy_set_bits(regs + HDMI_1_CFG_3, RG_HDMITX21_SLDO_EN); 381 382 mtk_phy_set_bits(regs + HDMI_1_PLL_CFG_4, DA_HDMITXPLL_PWR_ON); 383 usleep_range(5, 10); 384 mtk_phy_clear_bits(regs + HDMI_1_PLL_CFG_4, DA_HDMITXPLL_ISO_EN); 385 usleep_range(5, 10); 386 mtk_phy_clear_bits(regs + HDMI_1_PLL_CFG_2, RG_HDMITXPLL_PWD); 387 usleep_range(30, 50); 388 return 0; 389 } 390 391 static void mtk_hdmi_pll_unprepare(struct clk_hw *hw) 392 { 393 struct mtk_hdmi_phy *hdmi_phy = to_mtk_hdmi_phy(hw); 394 void __iomem *regs = hdmi_phy->regs; 395 396 mtk_phy_set_bits(regs + HDMI_1_CFG_10, RG_HDMITX21_BG_PWD); 397 mtk_phy_clear_bits(regs + HDMI_1_CFG_6, RG_HDMITX21_BIAS_EN); 398 mtk_phy_clear_bits(regs + HDMI_1_CFG_3, RG_HDMITX21_CKLDO_EN); 399 mtk_phy_clear_bits(regs + HDMI_1_CFG_3, RG_HDMITX21_SLDO_EN); 400 401 mtk_phy_set_bits(regs + HDMI_1_PLL_CFG_2, RG_HDMITXPLL_PWD); 402 usleep_range(10, 20); 403 mtk_phy_set_bits(regs + HDMI_1_PLL_CFG_4, DA_HDMITXPLL_ISO_EN); 404 usleep_range(10, 20); 405 mtk_phy_clear_bits(regs + HDMI_1_PLL_CFG_4, DA_HDMITXPLL_PWR_ON); 406 } 407 408 static int mtk_hdmi_pll_set_rate(struct clk_hw *hw, unsigned long rate, 409 unsigned long parent_rate) 410 { 411 struct mtk_hdmi_phy *hdmi_phy = to_mtk_hdmi_phy(hw); 412 413 dev_dbg(hdmi_phy->dev, "%s: %lu Hz, parent: %lu Hz\n", __func__, rate, 414 parent_rate); 415 416 return mtk_hdmi_pll_calc(hdmi_phy, hw, rate, parent_rate); 417 } 418 419 static long mtk_hdmi_pll_round_rate(struct clk_hw *hw, unsigned long rate, 420 unsigned long *parent_rate) 421 { 422 struct mtk_hdmi_phy *hdmi_phy = to_mtk_hdmi_phy(hw); 423 424 hdmi_phy->pll_rate = rate; 425 return rate; 426 } 427 428 static unsigned long mtk_hdmi_pll_recalc_rate(struct clk_hw *hw, 429 unsigned long parent_rate) 430 { 431 struct mtk_hdmi_phy *hdmi_phy = to_mtk_hdmi_phy(hw); 432 433 return hdmi_phy->pll_rate; 434 } 435 436 static const struct clk_ops mtk_hdmi_pll_ops = { 437 .prepare = mtk_hdmi_pll_prepare, 438 .unprepare = mtk_hdmi_pll_unprepare, 439 .set_rate = mtk_hdmi_pll_set_rate, 440 .round_rate = mtk_hdmi_pll_round_rate, 441 .recalc_rate = mtk_hdmi_pll_recalc_rate, 442 }; 443 444 static void vtx_signal_en(struct mtk_hdmi_phy *hdmi_phy, bool on) 445 { 446 void __iomem *regs = hdmi_phy->regs; 447 448 if (on) 449 mtk_phy_set_bits(regs + HDMI_1_CFG_0, RG_HDMITX21_DRV_EN); 450 else 451 mtk_phy_clear_bits(regs + HDMI_1_CFG_0, RG_HDMITX21_DRV_EN); 452 } 453 454 static void mtk_hdmi_phy_enable_tmds(struct mtk_hdmi_phy *hdmi_phy) 455 { 456 vtx_signal_en(hdmi_phy, true); 457 usleep_range(100, 150); 458 } 459 460 static void mtk_hdmi_phy_disable_tmds(struct mtk_hdmi_phy *hdmi_phy) 461 { 462 vtx_signal_en(hdmi_phy, false); 463 } 464 465 static int mtk_hdmi_phy_configure(struct phy *phy, union phy_configure_opts *opts) 466 { 467 struct phy_configure_opts_dp *dp_opts = &opts->dp; 468 struct mtk_hdmi_phy *hdmi_phy = phy_get_drvdata(phy); 469 int ret; 470 471 ret = clk_set_rate(hdmi_phy->pll, dp_opts->link_rate); 472 473 if (ret) 474 return ret; 475 476 mtk_phy_tmds_clk_ratio(hdmi_phy, hdmi_phy->tmds_over_340M); 477 478 return ret; 479 } 480 481 struct mtk_hdmi_phy_conf mtk_hdmi_phy_8195_conf = { 482 .flags = CLK_SET_RATE_PARENT | CLK_SET_RATE_GATE, 483 .hdmi_phy_clk_ops = &mtk_hdmi_pll_ops, 484 .hdmi_phy_enable_tmds = mtk_hdmi_phy_enable_tmds, 485 .hdmi_phy_disable_tmds = mtk_hdmi_phy_disable_tmds, 486 .hdmi_phy_configure = mtk_hdmi_phy_configure, 487 }; 488 489 MODULE_AUTHOR("Can Zeng <can.zeng@mediatek.com>"); 490 MODULE_DESCRIPTION("MediaTek MT8195 HDMI PHY Driver"); 491 MODULE_LICENSE("GPL v2"); 492