drivers/phy/mediatek/phy-mtk-hdmi-mt8195.c

   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 < 148.35 * MEGA)
 241                 txposdiv = 4;
 242         else if (tmds_clk >= 148.35 * MEGA && tmds_clk < 296.7 * MEGA)
 243                 txposdiv = 2;
 244         else if (tmds_clk >= 296.7 * 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 (pixel_clk >= 74.175 * 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 && pixel_clk < 74.175 * 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");