LCOV - code coverage report
Current view: top level - drivers/gpu/drm/i915/display - icl_dsi.c (source / functions) Hit Total Coverage
Test: combined.info Lines: 0 942 0.0 %
Date: 2022-04-01 14:35:51 Functions: 0 45 0.0 %
Branches: 0 510 0.0 %

           Branch data     Line data    Source code
       1                 :            : /*
       2                 :            :  * Copyright © 2018 Intel Corporation
       3                 :            :  *
       4                 :            :  * Permission is hereby granted, free of charge, to any person obtaining a
       5                 :            :  * copy of this software and associated documentation files (the "Software"),
       6                 :            :  * to deal in the Software without restriction, including without limitation
       7                 :            :  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
       8                 :            :  * and/or sell copies of the Software, and to permit persons to whom the
       9                 :            :  * Software is furnished to do so, subject to the following conditions:
      10                 :            :  *
      11                 :            :  * The above copyright notice and this permission notice (including the next
      12                 :            :  * paragraph) shall be included in all copies or substantial portions of the
      13                 :            :  * Software.
      14                 :            :  *
      15                 :            :  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
      16                 :            :  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
      17                 :            :  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
      18                 :            :  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
      19                 :            :  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
      20                 :            :  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
      21                 :            :  * DEALINGS IN THE SOFTWARE.
      22                 :            :  *
      23                 :            :  * Authors:
      24                 :            :  *   Madhav Chauhan <madhav.chauhan@intel.com>
      25                 :            :  *   Jani Nikula <jani.nikula@intel.com>
      26                 :            :  */
      27                 :            : 
      28                 :            : #include <drm/drm_atomic_helper.h>
      29                 :            : #include <drm/drm_mipi_dsi.h>
      30                 :            : 
      31                 :            : #include "intel_atomic.h"
      32                 :            : #include "intel_combo_phy.h"
      33                 :            : #include "intel_connector.h"
      34                 :            : #include "intel_ddi.h"
      35                 :            : #include "intel_dsi.h"
      36                 :            : #include "intel_panel.h"
      37                 :            : #include "intel_vdsc.h"
      38                 :            : 
      39                 :          0 : static inline int header_credits_available(struct drm_i915_private *dev_priv,
      40                 :            :                                            enum transcoder dsi_trans)
      41                 :            : {
      42                 :          0 :         return (I915_READ(DSI_CMD_TXCTL(dsi_trans)) & FREE_HEADER_CREDIT_MASK)
      43                 :          0 :                 >> FREE_HEADER_CREDIT_SHIFT;
      44                 :            : }
      45                 :            : 
      46                 :          0 : static inline int payload_credits_available(struct drm_i915_private *dev_priv,
      47                 :            :                                             enum transcoder dsi_trans)
      48                 :            : {
      49                 :          0 :         return (I915_READ(DSI_CMD_TXCTL(dsi_trans)) & FREE_PLOAD_CREDIT_MASK)
      50                 :          0 :                 >> FREE_PLOAD_CREDIT_SHIFT;
      51                 :            : }
      52                 :            : 
      53                 :          0 : static void wait_for_header_credits(struct drm_i915_private *dev_priv,
      54                 :            :                                     enum transcoder dsi_trans)
      55                 :            : {
      56   [ #  #  #  #  :          0 :         if (wait_for_us(header_credits_available(dev_priv, dsi_trans) >=
                   #  # ]
      57                 :            :                         MAX_HEADER_CREDIT, 100))
      58                 :          0 :                 DRM_ERROR("DSI header credits not released\n");
      59                 :          0 : }
      60                 :            : 
      61                 :          0 : static void wait_for_payload_credits(struct drm_i915_private *dev_priv,
      62                 :            :                                      enum transcoder dsi_trans)
      63                 :            : {
      64   [ #  #  #  #  :          0 :         if (wait_for_us(payload_credits_available(dev_priv, dsi_trans) >=
                   #  # ]
      65                 :            :                         MAX_PLOAD_CREDIT, 100))
      66                 :          0 :                 DRM_ERROR("DSI payload credits not released\n");
      67                 :          0 : }
      68                 :            : 
      69                 :          0 : static enum transcoder dsi_port_to_transcoder(enum port port)
      70                 :            : {
      71                 :          0 :         if (port == PORT_A)
      72                 :            :                 return TRANSCODER_DSI_0;
      73                 :            :         else
      74                 :          0 :                 return TRANSCODER_DSI_1;
      75                 :            : }
      76                 :            : 
      77                 :          0 : static void wait_for_cmds_dispatched_to_panel(struct intel_encoder *encoder)
      78                 :            : {
      79                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
      80                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
      81                 :          0 :         struct mipi_dsi_device *dsi;
      82                 :          0 :         enum port port;
      83                 :          0 :         enum transcoder dsi_trans;
      84                 :          0 :         int ret;
      85                 :            : 
      86                 :            :         /* wait for header/payload credits to be released */
      87   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
      88         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
      89                 :          0 :                 wait_for_header_credits(dev_priv, dsi_trans);
      90                 :          0 :                 wait_for_payload_credits(dev_priv, dsi_trans);
      91                 :            :         }
      92                 :            : 
      93                 :            :         /* send nop DCS command */
      94   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
      95                 :          0 :                 dsi = intel_dsi->dsi_hosts[port]->device;
      96                 :          0 :                 dsi->mode_flags |= MIPI_DSI_MODE_LPM;
      97                 :          0 :                 dsi->channel = 0;
      98                 :          0 :                 ret = mipi_dsi_dcs_nop(dsi);
      99         [ #  # ]:          0 :                 if (ret < 0)
     100                 :          0 :                         DRM_ERROR("error sending DCS NOP command\n");
     101                 :            :         }
     102                 :            : 
     103                 :            :         /* wait for header credits to be released */
     104   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     105         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     106                 :          0 :                 wait_for_header_credits(dev_priv, dsi_trans);
     107                 :            :         }
     108                 :            : 
     109                 :            :         /* wait for LP TX in progress bit to be cleared */
     110   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     111         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     112   [ #  #  #  #  :          0 :                 if (wait_for_us(!(I915_READ(DSI_LP_MSG(dsi_trans)) &
                   #  # ]
     113                 :            :                                   LPTX_IN_PROGRESS), 20))
     114                 :          0 :                         DRM_ERROR("LPTX bit not cleared\n");
     115                 :            :         }
     116                 :          0 : }
     117                 :            : 
     118                 :            : static bool add_payld_to_queue(struct intel_dsi_host *host, const u8 *data,
     119                 :            :                                u32 len)
     120                 :            : {
     121                 :            :         struct intel_dsi *intel_dsi = host->intel_dsi;
     122                 :            :         struct drm_i915_private *dev_priv = to_i915(intel_dsi->base.base.dev);
     123                 :            :         enum transcoder dsi_trans = dsi_port_to_transcoder(host->port);
     124                 :            :         int free_credits;
     125                 :            :         int i, j;
     126                 :            : 
     127                 :            :         for (i = 0; i < len; i += 4) {
     128                 :            :                 u32 tmp = 0;
     129                 :            : 
     130                 :            :                 free_credits = payload_credits_available(dev_priv, dsi_trans);
     131                 :            :                 if (free_credits < 1) {
     132                 :            :                         DRM_ERROR("Payload credit not available\n");
     133                 :            :                         return false;
     134                 :            :                 }
     135                 :            : 
     136                 :            :                 for (j = 0; j < min_t(u32, len - i, 4); j++)
     137                 :            :                         tmp |= *data++ << 8 * j;
     138                 :            : 
     139                 :            :                 I915_WRITE(DSI_CMD_TXPYLD(dsi_trans), tmp);
     140                 :            :         }
     141                 :            : 
     142                 :            :         return true;
     143                 :            : }
     144                 :            : 
     145                 :          0 : static int dsi_send_pkt_hdr(struct intel_dsi_host *host,
     146                 :            :                             struct mipi_dsi_packet pkt, bool enable_lpdt)
     147                 :            : {
     148                 :          0 :         struct intel_dsi *intel_dsi = host->intel_dsi;
     149         [ #  # ]:          0 :         struct drm_i915_private *dev_priv = to_i915(intel_dsi->base.base.dev);
     150         [ #  # ]:          0 :         enum transcoder dsi_trans = dsi_port_to_transcoder(host->port);
     151                 :          0 :         u32 tmp;
     152                 :          0 :         int free_credits;
     153                 :            : 
     154                 :            :         /* check if header credit available */
     155                 :          0 :         free_credits = header_credits_available(dev_priv, dsi_trans);
     156         [ #  # ]:          0 :         if (free_credits < 1) {
     157                 :          0 :                 DRM_ERROR("send pkt header failed, not enough hdr credits\n");
     158                 :          0 :                 return -1;
     159                 :            :         }
     160                 :            : 
     161                 :          0 :         tmp = I915_READ(DSI_CMD_TXHDR(dsi_trans));
     162                 :            : 
     163         [ #  # ]:          0 :         if (pkt.payload)
     164                 :          0 :                 tmp |= PAYLOAD_PRESENT;
     165                 :            :         else
     166                 :          0 :                 tmp &= ~PAYLOAD_PRESENT;
     167                 :            : 
     168                 :          0 :         tmp &= ~VBLANK_FENCE;
     169                 :            : 
     170         [ #  # ]:          0 :         if (enable_lpdt)
     171                 :          0 :                 tmp |= LP_DATA_TRANSFER;
     172                 :            : 
     173                 :          0 :         tmp &= ~(PARAM_WC_MASK | VC_MASK | DT_MASK);
     174                 :          0 :         tmp |= ((pkt.header[0] & VC_MASK) << VC_SHIFT);
     175                 :          0 :         tmp |= ((pkt.header[0] & DT_MASK) << DT_SHIFT);
     176                 :          0 :         tmp |= (pkt.header[1] << PARAM_WC_LOWER_SHIFT);
     177                 :          0 :         tmp |= (pkt.header[2] << PARAM_WC_UPPER_SHIFT);
     178                 :          0 :         I915_WRITE(DSI_CMD_TXHDR(dsi_trans), tmp);
     179                 :            : 
     180                 :          0 :         return 0;
     181                 :            : }
     182                 :            : 
     183                 :            : static int dsi_send_pkt_payld(struct intel_dsi_host *host,
     184                 :            :                               struct mipi_dsi_packet pkt)
     185                 :            : {
     186                 :            :         /* payload queue can accept *256 bytes*, check limit */
     187                 :            :         if (pkt.payload_length > MAX_PLOAD_CREDIT * 4) {
     188                 :            :                 DRM_ERROR("payload size exceeds max queue limit\n");
     189                 :            :                 return -1;
     190                 :            :         }
     191                 :            : 
     192                 :            :         /* load data into command payload queue */
     193                 :            :         if (!add_payld_to_queue(host, pkt.payload,
     194                 :            :                                 pkt.payload_length)) {
     195                 :            :                 DRM_ERROR("adding payload to queue failed\n");
     196                 :            :                 return -1;
     197                 :            :         }
     198                 :            : 
     199                 :            :         return 0;
     200                 :            : }
     201                 :            : 
     202                 :          0 : static void dsi_program_swing_and_deemphasis(struct intel_encoder *encoder)
     203                 :            : {
     204                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     205                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     206                 :          0 :         enum phy phy;
     207                 :          0 :         u32 tmp;
     208                 :          0 :         int lane;
     209                 :            : 
     210   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys) {
     211                 :            :                 /*
     212                 :            :                  * Program voltage swing and pre-emphasis level values as per
     213                 :            :                  * table in BSPEC under DDI buffer programing
     214                 :            :                  */
     215                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW5_LN0(phy));
     216                 :          0 :                 tmp &= ~(SCALING_MODE_SEL_MASK | RTERM_SELECT_MASK);
     217                 :          0 :                 tmp |= SCALING_MODE_SEL(0x2);
     218                 :          0 :                 tmp |= TAP2_DISABLE | TAP3_DISABLE;
     219                 :          0 :                 tmp |= RTERM_SELECT(0x6);
     220                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW5_GRP(phy), tmp);
     221                 :            : 
     222                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW5_AUX(phy));
     223                 :          0 :                 tmp &= ~(SCALING_MODE_SEL_MASK | RTERM_SELECT_MASK);
     224                 :          0 :                 tmp |= SCALING_MODE_SEL(0x2);
     225                 :          0 :                 tmp |= TAP2_DISABLE | TAP3_DISABLE;
     226                 :          0 :                 tmp |= RTERM_SELECT(0x6);
     227                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW5_AUX(phy), tmp);
     228                 :            : 
     229                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW2_LN0(phy));
     230                 :          0 :                 tmp &= ~(SWING_SEL_LOWER_MASK | SWING_SEL_UPPER_MASK |
     231                 :            :                          RCOMP_SCALAR_MASK);
     232                 :          0 :                 tmp |= SWING_SEL_UPPER(0x2);
     233                 :          0 :                 tmp |= SWING_SEL_LOWER(0x2);
     234                 :          0 :                 tmp |= RCOMP_SCALAR(0x98);
     235                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW2_GRP(phy), tmp);
     236                 :            : 
     237                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW2_AUX(phy));
     238                 :          0 :                 tmp &= ~(SWING_SEL_LOWER_MASK | SWING_SEL_UPPER_MASK |
     239                 :            :                          RCOMP_SCALAR_MASK);
     240                 :          0 :                 tmp |= SWING_SEL_UPPER(0x2);
     241                 :          0 :                 tmp |= SWING_SEL_LOWER(0x2);
     242                 :          0 :                 tmp |= RCOMP_SCALAR(0x98);
     243                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW2_AUX(phy), tmp);
     244                 :            : 
     245                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW4_AUX(phy));
     246                 :          0 :                 tmp &= ~(POST_CURSOR_1_MASK | POST_CURSOR_2_MASK |
     247                 :            :                          CURSOR_COEFF_MASK);
     248                 :          0 :                 tmp |= POST_CURSOR_1(0x0);
     249                 :          0 :                 tmp |= POST_CURSOR_2(0x0);
     250                 :          0 :                 tmp |= CURSOR_COEFF(0x3f);
     251                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW4_AUX(phy), tmp);
     252                 :            : 
     253         [ #  # ]:          0 :                 for (lane = 0; lane <= 3; lane++) {
     254                 :            :                         /* Bspec: must not use GRP register for write */
     255                 :          0 :                         tmp = I915_READ(ICL_PORT_TX_DW4_LN(lane, phy));
     256                 :          0 :                         tmp &= ~(POST_CURSOR_1_MASK | POST_CURSOR_2_MASK |
     257                 :            :                                  CURSOR_COEFF_MASK);
     258                 :          0 :                         tmp |= POST_CURSOR_1(0x0);
     259                 :          0 :                         tmp |= POST_CURSOR_2(0x0);
     260                 :          0 :                         tmp |= CURSOR_COEFF(0x3f);
     261                 :          0 :                         I915_WRITE(ICL_PORT_TX_DW4_LN(lane, phy), tmp);
     262                 :            :                 }
     263                 :            :         }
     264                 :          0 : }
     265                 :            : 
     266                 :          0 : static void configure_dual_link_mode(struct intel_encoder *encoder,
     267                 :            :                                      const struct intel_crtc_state *pipe_config)
     268                 :            : {
     269                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     270                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     271                 :          0 :         u32 dss_ctl1;
     272                 :            : 
     273                 :          0 :         dss_ctl1 = I915_READ(DSS_CTL1);
     274                 :          0 :         dss_ctl1 |= SPLITTER_ENABLE;
     275                 :          0 :         dss_ctl1 &= ~OVERLAP_PIXELS_MASK;
     276                 :          0 :         dss_ctl1 |= OVERLAP_PIXELS(intel_dsi->pixel_overlap);
     277                 :            : 
     278         [ #  # ]:          0 :         if (intel_dsi->dual_link == DSI_DUAL_LINK_FRONT_BACK) {
     279                 :          0 :                 const struct drm_display_mode *adjusted_mode =
     280                 :            :                                         &pipe_config->hw.adjusted_mode;
     281                 :          0 :                 u32 dss_ctl2;
     282                 :          0 :                 u16 hactive = adjusted_mode->crtc_hdisplay;
     283                 :          0 :                 u16 dl_buffer_depth;
     284                 :            : 
     285                 :          0 :                 dss_ctl1 &= ~DUAL_LINK_MODE_INTERLEAVE;
     286                 :          0 :                 dl_buffer_depth = hactive / 2 + intel_dsi->pixel_overlap;
     287                 :            : 
     288         [ #  # ]:          0 :                 if (dl_buffer_depth > MAX_DL_BUFFER_TARGET_DEPTH)
     289                 :          0 :                         DRM_ERROR("DL buffer depth exceed max value\n");
     290                 :            : 
     291                 :          0 :                 dss_ctl1 &= ~LEFT_DL_BUF_TARGET_DEPTH_MASK;
     292                 :          0 :                 dss_ctl1 |= LEFT_DL_BUF_TARGET_DEPTH(dl_buffer_depth);
     293                 :          0 :                 dss_ctl2 = I915_READ(DSS_CTL2);
     294                 :          0 :                 dss_ctl2 &= ~RIGHT_DL_BUF_TARGET_DEPTH_MASK;
     295                 :          0 :                 dss_ctl2 |= RIGHT_DL_BUF_TARGET_DEPTH(dl_buffer_depth);
     296                 :          0 :                 I915_WRITE(DSS_CTL2, dss_ctl2);
     297                 :            :         } else {
     298                 :            :                 /* Interleave */
     299                 :          0 :                 dss_ctl1 |= DUAL_LINK_MODE_INTERLEAVE;
     300                 :            :         }
     301                 :            : 
     302                 :          0 :         I915_WRITE(DSS_CTL1, dss_ctl1);
     303                 :          0 : }
     304                 :            : 
     305                 :            : /* aka DSI 8X clock */
     306                 :          0 : static int afe_clk(struct intel_encoder *encoder,
     307                 :            :                    const struct intel_crtc_state *crtc_state)
     308                 :            : {
     309                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     310                 :          0 :         int bpp;
     311                 :            : 
     312   [ #  #  #  #  :          0 :         if (crtc_state->dsc.compression_enable)
             #  #  #  # ]
     313                 :          0 :                 bpp = crtc_state->dsc.compressed_bpp;
     314                 :            :         else
     315   [ #  #  #  #  :          0 :                 bpp = mipi_dsi_pixel_format_to_bpp(intel_dsi->pixel_format);
          #  #  #  #  #  
                      # ]
     316                 :            : 
     317                 :          0 :         return DIV_ROUND_CLOSEST(intel_dsi->pclk * bpp, intel_dsi->lane_count);
     318                 :            : }
     319                 :            : 
     320                 :          0 : static void gen11_dsi_program_esc_clk_div(struct intel_encoder *encoder,
     321                 :            :                                           const struct intel_crtc_state *crtc_state)
     322                 :            : {
     323         [ #  # ]:          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     324         [ #  # ]:          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     325                 :          0 :         enum port port;
     326                 :          0 :         int afe_clk_khz;
     327                 :          0 :         u32 esc_clk_div_m;
     328                 :            : 
     329         [ #  # ]:          0 :         afe_clk_khz = afe_clk(encoder, crtc_state);
     330                 :          0 :         esc_clk_div_m = DIV_ROUND_UP(afe_clk_khz, DSI_MAX_ESC_CLK);
     331                 :            : 
     332   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     333                 :          0 :                 I915_WRITE(ICL_DSI_ESC_CLK_DIV(port),
     334                 :            :                            esc_clk_div_m & ICL_ESC_CLK_DIV_MASK);
     335                 :          0 :                 POSTING_READ(ICL_DSI_ESC_CLK_DIV(port));
     336                 :            :         }
     337                 :            : 
     338   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     339                 :          0 :                 I915_WRITE(ICL_DPHY_ESC_CLK_DIV(port),
     340                 :            :                            esc_clk_div_m & ICL_ESC_CLK_DIV_MASK);
     341                 :          0 :                 POSTING_READ(ICL_DPHY_ESC_CLK_DIV(port));
     342                 :            :         }
     343                 :          0 : }
     344                 :            : 
     345                 :          0 : static void get_dsi_io_power_domains(struct drm_i915_private *dev_priv,
     346                 :            :                                      struct intel_dsi *intel_dsi)
     347                 :            : {
     348                 :          0 :         enum port port;
     349                 :            : 
     350   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     351         [ #  # ]:          0 :                 WARN_ON(intel_dsi->io_wakeref[port]);
     352                 :          0 :                 intel_dsi->io_wakeref[port] =
     353         [ #  # ]:          0 :                         intel_display_power_get(dev_priv,
     354                 :            :                                                 port == PORT_A ?
     355                 :            :                                                 POWER_DOMAIN_PORT_DDI_A_IO :
     356                 :            :                                                 POWER_DOMAIN_PORT_DDI_B_IO);
     357                 :            :         }
     358                 :          0 : }
     359                 :            : 
     360                 :          0 : static void gen11_dsi_enable_io_power(struct intel_encoder *encoder)
     361                 :            : {
     362                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     363                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     364                 :          0 :         enum port port;
     365                 :          0 :         u32 tmp;
     366                 :            : 
     367   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     368                 :          0 :                 tmp = I915_READ(ICL_DSI_IO_MODECTL(port));
     369                 :          0 :                 tmp |= COMBO_PHY_MODE_DSI;
     370                 :          0 :                 I915_WRITE(ICL_DSI_IO_MODECTL(port), tmp);
     371                 :            :         }
     372                 :            : 
     373                 :          0 :         get_dsi_io_power_domains(dev_priv, intel_dsi);
     374                 :          0 : }
     375                 :            : 
     376                 :          0 : static void gen11_dsi_power_up_lanes(struct intel_encoder *encoder)
     377                 :            : {
     378                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     379                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     380                 :          0 :         enum phy phy;
     381                 :            : 
     382   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys)
     383                 :          0 :                 intel_combo_phy_power_up_lanes(dev_priv, phy, true,
     384                 :          0 :                                                intel_dsi->lane_count, false);
     385                 :          0 : }
     386                 :            : 
     387                 :          0 : static void gen11_dsi_config_phy_lanes_sequence(struct intel_encoder *encoder)
     388                 :            : {
     389                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     390                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     391                 :          0 :         enum phy phy;
     392                 :          0 :         u32 tmp;
     393                 :          0 :         int lane;
     394                 :            : 
     395                 :            :         /* Step 4b(i) set loadgen select for transmit and aux lanes */
     396   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys) {
     397                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW4_AUX(phy));
     398                 :          0 :                 tmp &= ~LOADGEN_SELECT;
     399                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW4_AUX(phy), tmp);
     400         [ #  # ]:          0 :                 for (lane = 0; lane <= 3; lane++) {
     401                 :          0 :                         tmp = I915_READ(ICL_PORT_TX_DW4_LN(lane, phy));
     402                 :          0 :                         tmp &= ~LOADGEN_SELECT;
     403         [ #  # ]:          0 :                         if (lane != 2)
     404                 :          0 :                                 tmp |= LOADGEN_SELECT;
     405                 :          0 :                         I915_WRITE(ICL_PORT_TX_DW4_LN(lane, phy), tmp);
     406                 :            :                 }
     407                 :            :         }
     408                 :            : 
     409                 :            :         /* Step 4b(ii) set latency optimization for transmit and aux lanes */
     410   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys) {
     411                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW2_AUX(phy));
     412                 :          0 :                 tmp &= ~FRC_LATENCY_OPTIM_MASK;
     413                 :          0 :                 tmp |= FRC_LATENCY_OPTIM_VAL(0x5);
     414                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW2_AUX(phy), tmp);
     415                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW2_LN0(phy));
     416                 :          0 :                 tmp &= ~FRC_LATENCY_OPTIM_MASK;
     417                 :          0 :                 tmp |= FRC_LATENCY_OPTIM_VAL(0x5);
     418                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW2_GRP(phy), tmp);
     419                 :            : 
     420                 :            :                 /* For EHL, TGL, set latency optimization for PCS_DW1 lanes */
     421   [ #  #  #  # ]:          0 :                 if (IS_ELKHARTLAKE(dev_priv) || (INTEL_GEN(dev_priv) >= 12)) {
     422                 :          0 :                         tmp = I915_READ(ICL_PORT_PCS_DW1_AUX(phy));
     423                 :          0 :                         tmp &= ~LATENCY_OPTIM_MASK;
     424                 :          0 :                         tmp |= LATENCY_OPTIM_VAL(0);
     425                 :          0 :                         I915_WRITE(ICL_PORT_PCS_DW1_AUX(phy), tmp);
     426                 :            : 
     427                 :          0 :                         tmp = I915_READ(ICL_PORT_PCS_DW1_LN0(phy));
     428                 :          0 :                         tmp &= ~LATENCY_OPTIM_MASK;
     429                 :          0 :                         tmp |= LATENCY_OPTIM_VAL(0x1);
     430                 :          0 :                         I915_WRITE(ICL_PORT_PCS_DW1_GRP(phy), tmp);
     431                 :            :                 }
     432                 :            :         }
     433                 :            : 
     434                 :          0 : }
     435                 :            : 
     436                 :          0 : static void gen11_dsi_voltage_swing_program_seq(struct intel_encoder *encoder)
     437                 :            : {
     438                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     439                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     440                 :          0 :         u32 tmp;
     441                 :          0 :         enum phy phy;
     442                 :            : 
     443                 :            :         /* clear common keeper enable bit */
     444   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys) {
     445                 :          0 :                 tmp = I915_READ(ICL_PORT_PCS_DW1_LN0(phy));
     446                 :          0 :                 tmp &= ~COMMON_KEEPER_EN;
     447                 :          0 :                 I915_WRITE(ICL_PORT_PCS_DW1_GRP(phy), tmp);
     448                 :          0 :                 tmp = I915_READ(ICL_PORT_PCS_DW1_AUX(phy));
     449                 :          0 :                 tmp &= ~COMMON_KEEPER_EN;
     450                 :          0 :                 I915_WRITE(ICL_PORT_PCS_DW1_AUX(phy), tmp);
     451                 :            :         }
     452                 :            : 
     453                 :            :         /*
     454                 :            :          * Set SUS Clock Config bitfield to 11b
     455                 :            :          * Note: loadgen select program is done
     456                 :            :          * as part of lane phy sequence configuration
     457                 :            :          */
     458   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys) {
     459                 :          0 :                 tmp = I915_READ(ICL_PORT_CL_DW5(phy));
     460                 :          0 :                 tmp |= SUS_CLOCK_CONFIG;
     461                 :          0 :                 I915_WRITE(ICL_PORT_CL_DW5(phy), tmp);
     462                 :            :         }
     463                 :            : 
     464                 :            :         /* Clear training enable to change swing values */
     465   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys) {
     466                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW5_LN0(phy));
     467                 :          0 :                 tmp &= ~TX_TRAINING_EN;
     468                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW5_GRP(phy), tmp);
     469                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW5_AUX(phy));
     470                 :          0 :                 tmp &= ~TX_TRAINING_EN;
     471                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW5_AUX(phy), tmp);
     472                 :            :         }
     473                 :            : 
     474                 :            :         /* Program swing and de-emphasis */
     475                 :          0 :         dsi_program_swing_and_deemphasis(encoder);
     476                 :            : 
     477                 :            :         /* Set training enable to trigger update */
     478   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys) {
     479                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW5_LN0(phy));
     480                 :          0 :                 tmp |= TX_TRAINING_EN;
     481                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW5_GRP(phy), tmp);
     482                 :          0 :                 tmp = I915_READ(ICL_PORT_TX_DW5_AUX(phy));
     483                 :          0 :                 tmp |= TX_TRAINING_EN;
     484                 :          0 :                 I915_WRITE(ICL_PORT_TX_DW5_AUX(phy), tmp);
     485                 :            :         }
     486                 :          0 : }
     487                 :            : 
     488                 :          0 : static void gen11_dsi_enable_ddi_buffer(struct intel_encoder *encoder)
     489                 :            : {
     490                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     491                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     492                 :          0 :         u32 tmp;
     493                 :          0 :         enum port port;
     494                 :            : 
     495   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     496                 :          0 :                 tmp = I915_READ(DDI_BUF_CTL(port));
     497                 :          0 :                 tmp |= DDI_BUF_CTL_ENABLE;
     498                 :          0 :                 I915_WRITE(DDI_BUF_CTL(port), tmp);
     499                 :            : 
     500   [ #  #  #  #  :          0 :                 if (wait_for_us(!(I915_READ(DDI_BUF_CTL(port)) &
                   #  # ]
     501                 :            :                                   DDI_BUF_IS_IDLE),
     502                 :            :                                   500))
     503                 :          0 :                         DRM_ERROR("DDI port:%c buffer idle\n", port_name(port));
     504                 :            :         }
     505                 :          0 : }
     506                 :            : 
     507                 :            : static void
     508                 :          0 : gen11_dsi_setup_dphy_timings(struct intel_encoder *encoder,
     509                 :            :                              const struct intel_crtc_state *crtc_state)
     510                 :            : {
     511                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     512                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     513                 :          0 :         u32 tmp;
     514                 :          0 :         enum port port;
     515                 :          0 :         enum phy phy;
     516                 :            : 
     517                 :            :         /* Program T-INIT master registers */
     518   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     519                 :          0 :                 tmp = I915_READ(ICL_DSI_T_INIT_MASTER(port));
     520                 :          0 :                 tmp &= ~MASTER_INIT_TIMER_MASK;
     521                 :          0 :                 tmp |= intel_dsi->init_count;
     522                 :          0 :                 I915_WRITE(ICL_DSI_T_INIT_MASTER(port), tmp);
     523                 :            :         }
     524                 :            : 
     525                 :            :         /* Program DPHY clock lanes timings */
     526   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     527                 :          0 :                 I915_WRITE(DPHY_CLK_TIMING_PARAM(port), intel_dsi->dphy_reg);
     528                 :            : 
     529                 :            :                 /* shadow register inside display core */
     530                 :          0 :                 I915_WRITE(DSI_CLK_TIMING_PARAM(port), intel_dsi->dphy_reg);
     531                 :            :         }
     532                 :            : 
     533                 :            :         /* Program DPHY data lanes timings */
     534   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     535                 :          0 :                 I915_WRITE(DPHY_DATA_TIMING_PARAM(port),
     536                 :            :                            intel_dsi->dphy_data_lane_reg);
     537                 :            : 
     538                 :            :                 /* shadow register inside display core */
     539                 :          0 :                 I915_WRITE(DSI_DATA_TIMING_PARAM(port),
     540                 :            :                            intel_dsi->dphy_data_lane_reg);
     541                 :            :         }
     542                 :            : 
     543                 :            :         /*
     544                 :            :          * If DSI link operating at or below an 800 MHz,
     545                 :            :          * TA_SURE should be override and programmed to
     546                 :            :          * a value '0' inside TA_PARAM_REGISTERS otherwise
     547                 :            :          * leave all fields at HW default values.
     548                 :            :          */
     549         [ #  # ]:          0 :         if (IS_GEN(dev_priv, 11)) {
     550   [ #  #  #  # ]:          0 :                 if (afe_clk(encoder, crtc_state) <= 800000) {
     551   [ #  #  #  # ]:          0 :                         for_each_dsi_port(port, intel_dsi->ports) {
     552                 :          0 :                                 tmp = I915_READ(DPHY_TA_TIMING_PARAM(port));
     553                 :          0 :                                 tmp &= ~TA_SURE_MASK;
     554                 :          0 :                                 tmp |= TA_SURE_OVERRIDE | TA_SURE(0);
     555                 :          0 :                                 I915_WRITE(DPHY_TA_TIMING_PARAM(port), tmp);
     556                 :            : 
     557                 :            :                                 /* shadow register inside display core */
     558                 :          0 :                                 tmp = I915_READ(DSI_TA_TIMING_PARAM(port));
     559                 :          0 :                                 tmp &= ~TA_SURE_MASK;
     560                 :          0 :                                 tmp |= TA_SURE_OVERRIDE | TA_SURE(0);
     561                 :          0 :                                 I915_WRITE(DSI_TA_TIMING_PARAM(port), tmp);
     562                 :            :                         }
     563                 :            :                 }
     564                 :            :         }
     565                 :            : 
     566         [ #  # ]:          0 :         if (IS_ELKHARTLAKE(dev_priv)) {
     567   [ #  #  #  # ]:          0 :                 for_each_dsi_phy(phy, intel_dsi->phys) {
     568                 :          0 :                         tmp = I915_READ(ICL_DPHY_CHKN(phy));
     569                 :          0 :                         tmp |= ICL_DPHY_CHKN_AFE_OVER_PPI_STRAP;
     570                 :          0 :                         I915_WRITE(ICL_DPHY_CHKN(phy), tmp);
     571                 :            :                 }
     572                 :            :         }
     573                 :          0 : }
     574                 :            : 
     575                 :          0 : static void gen11_dsi_gate_clocks(struct intel_encoder *encoder)
     576                 :            : {
     577                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     578                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     579                 :          0 :         u32 tmp;
     580                 :          0 :         enum phy phy;
     581                 :            : 
     582                 :          0 :         mutex_lock(&dev_priv->dpll_lock);
     583                 :          0 :         tmp = I915_READ(ICL_DPCLKA_CFGCR0);
     584   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys)
     585                 :          0 :                 tmp |= ICL_DPCLKA_CFGCR0_DDI_CLK_OFF(phy);
     586                 :            : 
     587                 :          0 :         I915_WRITE(ICL_DPCLKA_CFGCR0, tmp);
     588                 :          0 :         mutex_unlock(&dev_priv->dpll_lock);
     589                 :          0 : }
     590                 :            : 
     591                 :          0 : static void gen11_dsi_ungate_clocks(struct intel_encoder *encoder)
     592                 :            : {
     593                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     594                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     595                 :          0 :         u32 tmp;
     596                 :          0 :         enum phy phy;
     597                 :            : 
     598                 :          0 :         mutex_lock(&dev_priv->dpll_lock);
     599                 :          0 :         tmp = I915_READ(ICL_DPCLKA_CFGCR0);
     600   [ #  #  #  # ]:          0 :         for_each_dsi_phy(phy, intel_dsi->phys)
     601                 :          0 :                 tmp &= ~ICL_DPCLKA_CFGCR0_DDI_CLK_OFF(phy);
     602                 :            : 
     603                 :          0 :         I915_WRITE(ICL_DPCLKA_CFGCR0, tmp);
     604                 :          0 :         mutex_unlock(&dev_priv->dpll_lock);
     605                 :          0 : }
     606                 :            : 
     607                 :            : static void gen11_dsi_map_pll(struct intel_encoder *encoder,
     608                 :            :                               const struct intel_crtc_state *crtc_state)
     609                 :            : {
     610                 :            :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     611                 :            :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     612                 :            :         struct intel_shared_dpll *pll = crtc_state->shared_dpll;
     613                 :            :         enum phy phy;
     614                 :            :         u32 val;
     615                 :            : 
     616                 :            :         mutex_lock(&dev_priv->dpll_lock);
     617                 :            : 
     618                 :            :         val = I915_READ(ICL_DPCLKA_CFGCR0);
     619                 :            :         for_each_dsi_phy(phy, intel_dsi->phys) {
     620                 :            :                 val &= ~ICL_DPCLKA_CFGCR0_DDI_CLK_SEL_MASK(phy);
     621                 :            :                 val |= ICL_DPCLKA_CFGCR0_DDI_CLK_SEL(pll->info->id, phy);
     622                 :            :         }
     623                 :            :         I915_WRITE(ICL_DPCLKA_CFGCR0, val);
     624                 :            : 
     625                 :            :         for_each_dsi_phy(phy, intel_dsi->phys) {
     626                 :            :                 if (INTEL_GEN(dev_priv) >= 12)
     627                 :            :                         val |= ICL_DPCLKA_CFGCR0_DDI_CLK_OFF(phy);
     628                 :            :                 else
     629                 :            :                         val &= ~ICL_DPCLKA_CFGCR0_DDI_CLK_OFF(phy);
     630                 :            :         }
     631                 :            :         I915_WRITE(ICL_DPCLKA_CFGCR0, val);
     632                 :            : 
     633                 :            :         POSTING_READ(ICL_DPCLKA_CFGCR0);
     634                 :            : 
     635                 :            :         mutex_unlock(&dev_priv->dpll_lock);
     636                 :            : }
     637                 :            : 
     638                 :            : static void
     639                 :          0 : gen11_dsi_configure_transcoder(struct intel_encoder *encoder,
     640                 :            :                                const struct intel_crtc_state *pipe_config)
     641                 :            : {
     642                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     643                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     644                 :          0 :         struct intel_crtc *intel_crtc = to_intel_crtc(pipe_config->uapi.crtc);
     645                 :          0 :         enum pipe pipe = intel_crtc->pipe;
     646                 :          0 :         u32 tmp;
     647                 :          0 :         enum port port;
     648                 :          0 :         enum transcoder dsi_trans;
     649                 :            : 
     650   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     651         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     652                 :          0 :                 tmp = I915_READ(DSI_TRANS_FUNC_CONF(dsi_trans));
     653                 :            : 
     654         [ #  # ]:          0 :                 if (intel_dsi->eotp_pkt)
     655                 :          0 :                         tmp &= ~EOTP_DISABLED;
     656                 :            :                 else
     657                 :          0 :                         tmp |= EOTP_DISABLED;
     658                 :            : 
     659                 :            :                 /* enable link calibration if freq > 1.5Gbps */
     660   [ #  #  #  # ]:          0 :                 if (afe_clk(encoder, pipe_config) >= 1500 * 1000) {
     661                 :          0 :                         tmp &= ~LINK_CALIBRATION_MASK;
     662                 :          0 :                         tmp |= CALIBRATION_ENABLED_INITIAL_ONLY;
     663                 :            :                 }
     664                 :            : 
     665                 :            :                 /* configure continuous clock */
     666                 :          0 :                 tmp &= ~CONTINUOUS_CLK_MASK;
     667         [ #  # ]:          0 :                 if (intel_dsi->clock_stop)
     668                 :            :                         tmp |= CLK_ENTER_LP_AFTER_DATA;
     669                 :            :                 else
     670                 :          0 :                         tmp |= CLK_HS_CONTINUOUS;
     671                 :            : 
     672                 :            :                 /* configure buffer threshold limit to minimum */
     673                 :          0 :                 tmp &= ~PIX_BUF_THRESHOLD_MASK;
     674                 :          0 :                 tmp |= PIX_BUF_THRESHOLD_1_4;
     675                 :            : 
     676                 :            :                 /* set virtual channel to '0' */
     677                 :          0 :                 tmp &= ~PIX_VIRT_CHAN_MASK;
     678                 :          0 :                 tmp |= PIX_VIRT_CHAN(0);
     679                 :            : 
     680                 :            :                 /* program BGR transmission */
     681         [ #  # ]:          0 :                 if (intel_dsi->bgr_enabled)
     682                 :          0 :                         tmp |= BGR_TRANSMISSION;
     683                 :            : 
     684                 :            :                 /* select pixel format */
     685                 :          0 :                 tmp &= ~PIX_FMT_MASK;
     686         [ #  # ]:          0 :                 if (pipe_config->dsc.compression_enable) {
     687                 :          0 :                         tmp |= PIX_FMT_COMPRESSED;
     688                 :            :                 } else {
     689   [ #  #  #  #  :          0 :                         switch (intel_dsi->pixel_format) {
                      # ]
     690                 :            :                         default:
     691                 :          0 :                                 MISSING_CASE(intel_dsi->pixel_format);
     692                 :            :                                 /* fallthrough */
     693                 :            :                         case MIPI_DSI_FMT_RGB565:
     694                 :            :                                 tmp |= PIX_FMT_RGB565;
     695                 :            :                                 break;
     696                 :          0 :                         case MIPI_DSI_FMT_RGB666_PACKED:
     697                 :          0 :                                 tmp |= PIX_FMT_RGB666_PACKED;
     698                 :          0 :                                 break;
     699                 :          0 :                         case MIPI_DSI_FMT_RGB666:
     700                 :          0 :                                 tmp |= PIX_FMT_RGB666_LOOSE;
     701                 :          0 :                                 break;
     702                 :          0 :                         case MIPI_DSI_FMT_RGB888:
     703                 :          0 :                                 tmp |= PIX_FMT_RGB888;
     704                 :          0 :                                 break;
     705                 :            :                         }
     706                 :            :                 }
     707                 :            : 
     708         [ #  # ]:          0 :                 if (INTEL_GEN(dev_priv) >= 12) {
     709         [ #  # ]:          0 :                         if (is_vid_mode(intel_dsi))
     710                 :          0 :                                 tmp |= BLANKING_PACKET_ENABLE;
     711                 :            :                 }
     712                 :            : 
     713                 :            :                 /* program DSI operation mode */
     714         [ #  # ]:          0 :                 if (is_vid_mode(intel_dsi)) {
     715                 :          0 :                         tmp &= ~OP_MODE_MASK;
     716      [ #  #  # ]:          0 :                         switch (intel_dsi->video_mode_format) {
     717                 :            :                         default:
     718                 :          0 :                                 MISSING_CASE(intel_dsi->video_mode_format);
     719                 :            :                                 /* fallthrough */
     720                 :          0 :                         case VIDEO_MODE_NON_BURST_WITH_SYNC_EVENTS:
     721                 :          0 :                                 tmp |= VIDEO_MODE_SYNC_EVENT;
     722                 :          0 :                                 break;
     723                 :          0 :                         case VIDEO_MODE_NON_BURST_WITH_SYNC_PULSE:
     724                 :          0 :                                 tmp |= VIDEO_MODE_SYNC_PULSE;
     725                 :          0 :                                 break;
     726                 :            :                         }
     727                 :          0 :                 }
     728                 :            : 
     729                 :          0 :                 I915_WRITE(DSI_TRANS_FUNC_CONF(dsi_trans), tmp);
     730                 :            :         }
     731                 :            : 
     732                 :            :         /* enable port sync mode if dual link */
     733         [ #  # ]:          0 :         if (intel_dsi->dual_link) {
     734   [ #  #  #  # ]:          0 :                 for_each_dsi_port(port, intel_dsi->ports) {
     735         [ #  # ]:          0 :                         dsi_trans = dsi_port_to_transcoder(port);
     736                 :          0 :                         tmp = I915_READ(TRANS_DDI_FUNC_CTL2(dsi_trans));
     737                 :          0 :                         tmp |= PORT_SYNC_MODE_ENABLE;
     738                 :          0 :                         I915_WRITE(TRANS_DDI_FUNC_CTL2(dsi_trans), tmp);
     739                 :            :                 }
     740                 :            : 
     741                 :            :                 /* configure stream splitting */
     742                 :          0 :                 configure_dual_link_mode(encoder, pipe_config);
     743                 :            :         }
     744                 :            : 
     745   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     746         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     747                 :            : 
     748                 :            :                 /* select data lane width */
     749                 :          0 :                 tmp = I915_READ(TRANS_DDI_FUNC_CTL(dsi_trans));
     750                 :          0 :                 tmp &= ~DDI_PORT_WIDTH_MASK;
     751                 :          0 :                 tmp |= DDI_PORT_WIDTH(intel_dsi->lane_count);
     752                 :            : 
     753                 :            :                 /* select input pipe */
     754                 :          0 :                 tmp &= ~TRANS_DDI_EDP_INPUT_MASK;
     755   [ #  #  #  #  :          0 :                 switch (pipe) {
                      # ]
     756                 :            :                 default:
     757                 :          0 :                         MISSING_CASE(pipe);
     758                 :            :                         /* fallthrough */
     759                 :            :                 case PIPE_A:
     760                 :            :                         tmp |= TRANS_DDI_EDP_INPUT_A_ON;
     761                 :            :                         break;
     762                 :          0 :                 case PIPE_B:
     763                 :          0 :                         tmp |= TRANS_DDI_EDP_INPUT_B_ONOFF;
     764                 :          0 :                         break;
     765                 :          0 :                 case PIPE_C:
     766                 :          0 :                         tmp |= TRANS_DDI_EDP_INPUT_C_ONOFF;
     767                 :          0 :                         break;
     768                 :          0 :                 case PIPE_D:
     769                 :          0 :                         tmp |= TRANS_DDI_EDP_INPUT_D_ONOFF;
     770                 :          0 :                         break;
     771                 :            :                 }
     772                 :            : 
     773                 :            :                 /* enable DDI buffer */
     774                 :          0 :                 tmp |= TRANS_DDI_FUNC_ENABLE;
     775                 :          0 :                 I915_WRITE(TRANS_DDI_FUNC_CTL(dsi_trans), tmp);
     776                 :            :         }
     777                 :            : 
     778                 :            :         /* wait for link ready */
     779   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     780         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     781   [ #  #  #  #  :          0 :                 if (wait_for_us((I915_READ(DSI_TRANS_FUNC_CONF(dsi_trans)) &
                   #  # ]
     782                 :            :                                 LINK_READY), 2500))
     783                 :          0 :                         DRM_ERROR("DSI link not ready\n");
     784                 :            :         }
     785                 :          0 : }
     786                 :            : 
     787                 :            : static void
     788                 :          0 : gen11_dsi_set_transcoder_timings(struct intel_encoder *encoder,
     789                 :            :                                  const struct intel_crtc_state *crtc_state)
     790                 :            : {
     791         [ #  # ]:          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     792         [ #  # ]:          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     793                 :          0 :         const struct drm_display_mode *adjusted_mode =
     794                 :            :                 &crtc_state->hw.adjusted_mode;
     795                 :          0 :         enum port port;
     796                 :          0 :         enum transcoder dsi_trans;
     797                 :            :         /* horizontal timings */
     798                 :          0 :         u16 htotal, hactive, hsync_start, hsync_end, hsync_size;
     799                 :          0 :         u16 hback_porch;
     800                 :            :         /* vertical timings */
     801                 :          0 :         u16 vtotal, vactive, vsync_start, vsync_end, vsync_shift;
     802                 :          0 :         int mul = 1, div = 1;
     803                 :            : 
     804                 :            :         /*
     805                 :            :          * Adjust horizontal timings (htotal, hsync_start, hsync_end) to account
     806                 :            :          * for slower link speed if DSC is enabled.
     807                 :            :          *
     808                 :            :          * The compression frequency ratio is the ratio between compressed and
     809                 :            :          * non-compressed link speeds, and simplifies down to the ratio between
     810                 :            :          * compressed and non-compressed bpp.
     811                 :            :          */
     812         [ #  # ]:          0 :         if (crtc_state->dsc.compression_enable) {
     813                 :          0 :                 mul = crtc_state->dsc.compressed_bpp;
     814         [ #  # ]:          0 :                 div = mipi_dsi_pixel_format_to_bpp(intel_dsi->pixel_format);
     815                 :            :         }
     816                 :            : 
     817                 :          0 :         hactive = adjusted_mode->crtc_hdisplay;
     818                 :          0 :         htotal = DIV_ROUND_UP(adjusted_mode->crtc_htotal * mul, div);
     819                 :          0 :         hsync_start = DIV_ROUND_UP(adjusted_mode->crtc_hsync_start * mul, div);
     820                 :          0 :         hsync_end = DIV_ROUND_UP(adjusted_mode->crtc_hsync_end * mul, div);
     821                 :          0 :         hsync_size  = hsync_end - hsync_start;
     822                 :          0 :         hback_porch = (adjusted_mode->crtc_htotal -
     823                 :            :                        adjusted_mode->crtc_hsync_end);
     824                 :          0 :         vactive = adjusted_mode->crtc_vdisplay;
     825                 :          0 :         vtotal = adjusted_mode->crtc_vtotal;
     826                 :          0 :         vsync_start = adjusted_mode->crtc_vsync_start;
     827                 :          0 :         vsync_end = adjusted_mode->crtc_vsync_end;
     828                 :          0 :         vsync_shift = hsync_start - htotal / 2;
     829                 :            : 
     830         [ #  # ]:          0 :         if (intel_dsi->dual_link) {
     831                 :          0 :                 hactive /= 2;
     832         [ #  # ]:          0 :                 if (intel_dsi->dual_link == DSI_DUAL_LINK_FRONT_BACK)
     833                 :          0 :                         hactive += intel_dsi->pixel_overlap;
     834                 :            :                 htotal /= 2;
     835                 :            :         }
     836                 :            : 
     837                 :            :         /* minimum hactive as per bspec: 256 pixels */
     838         [ #  # ]:          0 :         if (adjusted_mode->crtc_hdisplay < 256)
     839                 :          0 :                 DRM_ERROR("hactive is less then 256 pixels\n");
     840                 :            : 
     841                 :            :         /* if RGB666 format, then hactive must be multiple of 4 pixels */
     842   [ #  #  #  # ]:          0 :         if (intel_dsi->pixel_format == MIPI_DSI_FMT_RGB666 && hactive % 4 != 0)
     843                 :          0 :                 DRM_ERROR("hactive pixels are not multiple of 4\n");
     844                 :            : 
     845                 :            :         /* program TRANS_HTOTAL register */
     846   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     847         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     848                 :          0 :                 I915_WRITE(HTOTAL(dsi_trans),
     849                 :            :                            (hactive - 1) | ((htotal - 1) << 16));
     850                 :            :         }
     851                 :            : 
     852                 :            :         /* TRANS_HSYNC register to be programmed only for video mode */
     853         [ #  # ]:          0 :         if (intel_dsi->operation_mode == INTEL_DSI_VIDEO_MODE) {
     854         [ #  # ]:          0 :                 if (intel_dsi->video_mode_format ==
     855                 :            :                     VIDEO_MODE_NON_BURST_WITH_SYNC_PULSE) {
     856                 :            :                         /* BSPEC: hsync size should be atleast 16 pixels */
     857         [ #  # ]:          0 :                         if (hsync_size < 16)
     858                 :          0 :                                 DRM_ERROR("hsync size < 16 pixels\n");
     859                 :            :                 }
     860                 :            : 
     861         [ #  # ]:          0 :                 if (hback_porch < 16)
     862                 :          0 :                         DRM_ERROR("hback porch < 16 pixels\n");
     863                 :            : 
     864         [ #  # ]:          0 :                 if (intel_dsi->dual_link) {
     865                 :          0 :                         hsync_start /= 2;
     866                 :          0 :                         hsync_end /= 2;
     867                 :            :                 }
     868                 :            : 
     869   [ #  #  #  # ]:          0 :                 for_each_dsi_port(port, intel_dsi->ports) {
     870         [ #  # ]:          0 :                         dsi_trans = dsi_port_to_transcoder(port);
     871                 :          0 :                         I915_WRITE(HSYNC(dsi_trans),
     872                 :            :                                    (hsync_start - 1) | ((hsync_end - 1) << 16));
     873                 :            :                 }
     874                 :            :         }
     875                 :            : 
     876                 :            :         /* program TRANS_VTOTAL register */
     877   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     878         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     879                 :            :                 /*
     880                 :            :                  * FIXME: Programing this by assuming progressive mode, since
     881                 :            :                  * non-interlaced info from VBT is not saved inside
     882                 :            :                  * struct drm_display_mode.
     883                 :            :                  * For interlace mode: program required pixel minus 2
     884                 :            :                  */
     885                 :          0 :                 I915_WRITE(VTOTAL(dsi_trans),
     886                 :            :                            (vactive - 1) | ((vtotal - 1) << 16));
     887                 :            :         }
     888                 :            : 
     889         [ #  # ]:          0 :         if (vsync_end < vsync_start || vsync_end > vtotal)
     890                 :          0 :                 DRM_ERROR("Invalid vsync_end value\n");
     891                 :            : 
     892         [ #  # ]:          0 :         if (vsync_start < vactive)
     893                 :          0 :                 DRM_ERROR("vsync_start less than vactive\n");
     894                 :            : 
     895                 :            :         /* program TRANS_VSYNC register */
     896   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     897         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     898                 :          0 :                 I915_WRITE(VSYNC(dsi_trans),
     899                 :            :                            (vsync_start - 1) | ((vsync_end - 1) << 16));
     900                 :            :         }
     901                 :            : 
     902                 :            :         /*
     903                 :            :          * FIXME: It has to be programmed only for interlaced
     904                 :            :          * modes. Put the check condition here once interlaced
     905                 :            :          * info available as described above.
     906                 :            :          * program TRANS_VSYNCSHIFT register
     907                 :            :          */
     908   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     909         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     910                 :          0 :                 I915_WRITE(VSYNCSHIFT(dsi_trans), vsync_shift);
     911                 :            :         }
     912                 :            : 
     913                 :            :         /* program TRANS_VBLANK register, should be same as vtotal programmed */
     914         [ #  # ]:          0 :         if (INTEL_GEN(dev_priv) >= 12) {
     915   [ #  #  #  # ]:          0 :                 for_each_dsi_port(port, intel_dsi->ports) {
     916         [ #  # ]:          0 :                         dsi_trans = dsi_port_to_transcoder(port);
     917                 :          0 :                         I915_WRITE(VBLANK(dsi_trans),
     918                 :            :                                    (vactive - 1) | ((vtotal - 1) << 16));
     919                 :            :                 }
     920                 :            :         }
     921                 :          0 : }
     922                 :            : 
     923                 :          0 : static void gen11_dsi_enable_transcoder(struct intel_encoder *encoder)
     924                 :            : {
     925                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     926                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     927                 :          0 :         enum port port;
     928                 :          0 :         enum transcoder dsi_trans;
     929                 :          0 :         u32 tmp;
     930                 :            : 
     931   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     932         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     933                 :          0 :                 tmp = I915_READ(PIPECONF(dsi_trans));
     934                 :          0 :                 tmp |= PIPECONF_ENABLE;
     935                 :          0 :                 I915_WRITE(PIPECONF(dsi_trans), tmp);
     936                 :            : 
     937                 :            :                 /* wait for transcoder to be enabled */
     938         [ #  # ]:          0 :                 if (intel_de_wait_for_set(dev_priv, PIPECONF(dsi_trans),
     939                 :            :                                           I965_PIPECONF_ACTIVE, 10))
     940                 :          0 :                         DRM_ERROR("DSI transcoder not enabled\n");
     941                 :            :         }
     942                 :          0 : }
     943                 :            : 
     944                 :          0 : static void gen11_dsi_setup_timeouts(struct intel_encoder *encoder,
     945                 :            :                                      const struct intel_crtc_state *crtc_state)
     946                 :            : {
     947                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     948                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
     949                 :          0 :         enum port port;
     950                 :          0 :         enum transcoder dsi_trans;
     951                 :          0 :         u32 tmp, hs_tx_timeout, lp_rx_timeout, ta_timeout, divisor, mul;
     952                 :            : 
     953                 :            :         /*
     954                 :            :          * escape clock count calculation:
     955                 :            :          * BYTE_CLK_COUNT = TIME_NS/(8 * UI)
     956                 :            :          * UI (nsec) = (10^6)/Bitrate
     957                 :            :          * TIME_NS = (BYTE_CLK_COUNT * 8 * 10^6)/ Bitrate
     958                 :            :          * ESCAPE_CLK_COUNT  = TIME_NS/ESC_CLK_NS
     959                 :            :          */
     960         [ #  # ]:          0 :         divisor = intel_dsi_tlpx_ns(intel_dsi) * afe_clk(encoder, crtc_state) * 1000;
     961                 :          0 :         mul = 8 * 1000000;
     962                 :          0 :         hs_tx_timeout = DIV_ROUND_UP(intel_dsi->hs_tx_timeout * mul,
     963                 :            :                                      divisor);
     964                 :          0 :         lp_rx_timeout = DIV_ROUND_UP(intel_dsi->lp_rx_timeout * mul, divisor);
     965                 :          0 :         ta_timeout = DIV_ROUND_UP(intel_dsi->turn_arnd_val * mul, divisor);
     966                 :            : 
     967   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
     968         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
     969                 :            : 
     970                 :            :                 /* program hst_tx_timeout */
     971                 :          0 :                 tmp = I915_READ(DSI_HSTX_TO(dsi_trans));
     972                 :          0 :                 tmp &= ~HSTX_TIMEOUT_VALUE_MASK;
     973                 :          0 :                 tmp |= HSTX_TIMEOUT_VALUE(hs_tx_timeout);
     974                 :          0 :                 I915_WRITE(DSI_HSTX_TO(dsi_trans), tmp);
     975                 :            : 
     976                 :            :                 /* FIXME: DSI_CALIB_TO */
     977                 :            : 
     978                 :            :                 /* program lp_rx_host timeout */
     979                 :          0 :                 tmp = I915_READ(DSI_LPRX_HOST_TO(dsi_trans));
     980                 :          0 :                 tmp &= ~LPRX_TIMEOUT_VALUE_MASK;
     981                 :          0 :                 tmp |= LPRX_TIMEOUT_VALUE(lp_rx_timeout);
     982                 :          0 :                 I915_WRITE(DSI_LPRX_HOST_TO(dsi_trans), tmp);
     983                 :            : 
     984                 :            :                 /* FIXME: DSI_PWAIT_TO */
     985                 :            : 
     986                 :            :                 /* program turn around timeout */
     987                 :          0 :                 tmp = I915_READ(DSI_TA_TO(dsi_trans));
     988                 :          0 :                 tmp &= ~TA_TIMEOUT_VALUE_MASK;
     989                 :          0 :                 tmp |= TA_TIMEOUT_VALUE(ta_timeout);
     990                 :          0 :                 I915_WRITE(DSI_TA_TO(dsi_trans), tmp);
     991                 :            :         }
     992                 :          0 : }
     993                 :            : 
     994                 :            : static void
     995                 :          0 : gen11_dsi_enable_port_and_phy(struct intel_encoder *encoder,
     996                 :            :                               const struct intel_crtc_state *crtc_state)
     997                 :            : {
     998                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
     999                 :            : 
    1000                 :            :         /* step 4a: power up all lanes of the DDI used by DSI */
    1001                 :          0 :         gen11_dsi_power_up_lanes(encoder);
    1002                 :            : 
    1003                 :            :         /* step 4b: configure lane sequencing of the Combo-PHY transmitters */
    1004                 :          0 :         gen11_dsi_config_phy_lanes_sequence(encoder);
    1005                 :            : 
    1006                 :            :         /* step 4c: configure voltage swing and skew */
    1007                 :          0 :         gen11_dsi_voltage_swing_program_seq(encoder);
    1008                 :            : 
    1009                 :            :         /* enable DDI buffer */
    1010                 :          0 :         gen11_dsi_enable_ddi_buffer(encoder);
    1011                 :            : 
    1012                 :            :         /* setup D-PHY timings */
    1013                 :          0 :         gen11_dsi_setup_dphy_timings(encoder, crtc_state);
    1014                 :            : 
    1015                 :            :         /* step 4h: setup DSI protocol timeouts */
    1016                 :          0 :         gen11_dsi_setup_timeouts(encoder, crtc_state);
    1017                 :            : 
    1018                 :            :         /* Step (4h, 4i, 4j, 4k): Configure transcoder */
    1019                 :          0 :         gen11_dsi_configure_transcoder(encoder, crtc_state);
    1020                 :            : 
    1021                 :            :         /* Step 4l: Gate DDI clocks */
    1022         [ #  # ]:          0 :         if (IS_GEN(dev_priv, 11))
    1023                 :          0 :                 gen11_dsi_gate_clocks(encoder);
    1024                 :          0 : }
    1025                 :            : 
    1026                 :          0 : static void gen11_dsi_powerup_panel(struct intel_encoder *encoder)
    1027                 :            : {
    1028                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
    1029                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1030                 :          0 :         struct mipi_dsi_device *dsi;
    1031                 :          0 :         enum port port;
    1032                 :          0 :         enum transcoder dsi_trans;
    1033                 :          0 :         u32 tmp;
    1034                 :          0 :         int ret;
    1035                 :            : 
    1036                 :            :         /* set maximum return packet size */
    1037   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
    1038         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
    1039                 :            : 
    1040                 :            :                 /*
    1041                 :            :                  * FIXME: This uses the number of DW's currently in the payload
    1042                 :            :                  * receive queue. This is probably not what we want here.
    1043                 :            :                  */
    1044                 :          0 :                 tmp = I915_READ(DSI_CMD_RXCTL(dsi_trans));
    1045                 :          0 :                 tmp &= NUMBER_RX_PLOAD_DW_MASK;
    1046                 :            :                 /* multiply "Number Rx Payload DW" by 4 to get max value */
    1047                 :          0 :                 tmp = tmp * 4;
    1048                 :          0 :                 dsi = intel_dsi->dsi_hosts[port]->device;
    1049                 :          0 :                 ret = mipi_dsi_set_maximum_return_packet_size(dsi, tmp);
    1050         [ #  # ]:          0 :                 if (ret < 0)
    1051                 :          0 :                         DRM_ERROR("error setting max return pkt size%d\n", tmp);
    1052                 :            :         }
    1053                 :            : 
    1054                 :            :         /* panel power on related mipi dsi vbt sequences */
    1055                 :          0 :         intel_dsi_vbt_exec_sequence(intel_dsi, MIPI_SEQ_POWER_ON);
    1056                 :          0 :         intel_dsi_msleep(intel_dsi, intel_dsi->panel_on_delay);
    1057                 :          0 :         intel_dsi_vbt_exec_sequence(intel_dsi, MIPI_SEQ_DEASSERT_RESET);
    1058                 :          0 :         intel_dsi_vbt_exec_sequence(intel_dsi, MIPI_SEQ_INIT_OTP);
    1059                 :          0 :         intel_dsi_vbt_exec_sequence(intel_dsi, MIPI_SEQ_DISPLAY_ON);
    1060                 :            : 
    1061                 :            :         /* ensure all panel commands dispatched before enabling transcoder */
    1062                 :          0 :         wait_for_cmds_dispatched_to_panel(encoder);
    1063                 :          0 : }
    1064                 :            : 
    1065                 :          0 : static void gen11_dsi_pre_pll_enable(struct intel_encoder *encoder,
    1066                 :            :                                      const struct intel_crtc_state *crtc_state,
    1067                 :            :                                      const struct drm_connector_state *conn_state)
    1068                 :            : {
    1069                 :            :         /* step2: enable IO power */
    1070                 :          0 :         gen11_dsi_enable_io_power(encoder);
    1071                 :            : 
    1072                 :            :         /* step3: enable DSI PLL */
    1073                 :          0 :         gen11_dsi_program_esc_clk_div(encoder, crtc_state);
    1074                 :          0 : }
    1075                 :            : 
    1076                 :          0 : static void gen11_dsi_pre_enable(struct intel_encoder *encoder,
    1077                 :            :                                  const struct intel_crtc_state *pipe_config,
    1078                 :            :                                  const struct drm_connector_state *conn_state)
    1079                 :            : {
    1080                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1081                 :            : 
    1082                 :            :         /* step3b */
    1083                 :          0 :         gen11_dsi_map_pll(encoder, pipe_config);
    1084                 :            : 
    1085                 :            :         /* step4: enable DSI port and DPHY */
    1086                 :          0 :         gen11_dsi_enable_port_and_phy(encoder, pipe_config);
    1087                 :            : 
    1088                 :            :         /* step5: program and powerup panel */
    1089                 :          0 :         gen11_dsi_powerup_panel(encoder);
    1090                 :            : 
    1091                 :          0 :         intel_dsc_enable(encoder, pipe_config);
    1092                 :            : 
    1093                 :            :         /* step6c: configure transcoder timings */
    1094                 :          0 :         gen11_dsi_set_transcoder_timings(encoder, pipe_config);
    1095                 :            : 
    1096                 :            :         /* step6d: enable dsi transcoder */
    1097                 :          0 :         gen11_dsi_enable_transcoder(encoder);
    1098                 :            : 
    1099                 :            :         /* step7: enable backlight */
    1100                 :          0 :         intel_panel_enable_backlight(pipe_config, conn_state);
    1101                 :          0 :         intel_dsi_vbt_exec_sequence(intel_dsi, MIPI_SEQ_BACKLIGHT_ON);
    1102                 :          0 : }
    1103                 :            : 
    1104                 :          0 : static void gen11_dsi_disable_transcoder(struct intel_encoder *encoder)
    1105                 :            : {
    1106                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
    1107                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1108                 :          0 :         enum port port;
    1109                 :          0 :         enum transcoder dsi_trans;
    1110                 :          0 :         u32 tmp;
    1111                 :            : 
    1112   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
    1113         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
    1114                 :            : 
    1115                 :            :                 /* disable transcoder */
    1116                 :          0 :                 tmp = I915_READ(PIPECONF(dsi_trans));
    1117                 :          0 :                 tmp &= ~PIPECONF_ENABLE;
    1118                 :          0 :                 I915_WRITE(PIPECONF(dsi_trans), tmp);
    1119                 :            : 
    1120                 :            :                 /* wait for transcoder to be disabled */
    1121         [ #  # ]:          0 :                 if (intel_de_wait_for_clear(dev_priv, PIPECONF(dsi_trans),
    1122                 :            :                                             I965_PIPECONF_ACTIVE, 50))
    1123                 :          0 :                         DRM_ERROR("DSI trancoder not disabled\n");
    1124                 :            :         }
    1125                 :          0 : }
    1126                 :            : 
    1127                 :          0 : static void gen11_dsi_powerdown_panel(struct intel_encoder *encoder)
    1128                 :            : {
    1129                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1130                 :            : 
    1131                 :          0 :         intel_dsi_vbt_exec_sequence(intel_dsi, MIPI_SEQ_DISPLAY_OFF);
    1132                 :          0 :         intel_dsi_vbt_exec_sequence(intel_dsi, MIPI_SEQ_ASSERT_RESET);
    1133                 :          0 :         intel_dsi_vbt_exec_sequence(intel_dsi, MIPI_SEQ_POWER_OFF);
    1134                 :            : 
    1135                 :            :         /* ensure cmds dispatched to panel */
    1136                 :          0 :         wait_for_cmds_dispatched_to_panel(encoder);
    1137                 :          0 : }
    1138                 :            : 
    1139                 :          0 : static void gen11_dsi_deconfigure_trancoder(struct intel_encoder *encoder)
    1140                 :            : {
    1141                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
    1142                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1143                 :          0 :         enum port port;
    1144                 :          0 :         enum transcoder dsi_trans;
    1145                 :          0 :         u32 tmp;
    1146                 :            : 
    1147                 :            :         /* put dsi link in ULPS */
    1148   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
    1149         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
    1150                 :          0 :                 tmp = I915_READ(DSI_LP_MSG(dsi_trans));
    1151                 :          0 :                 tmp |= LINK_ENTER_ULPS;
    1152                 :          0 :                 tmp &= ~LINK_ULPS_TYPE_LP11;
    1153                 :          0 :                 I915_WRITE(DSI_LP_MSG(dsi_trans), tmp);
    1154                 :            : 
    1155   [ #  #  #  #  :          0 :                 if (wait_for_us((I915_READ(DSI_LP_MSG(dsi_trans)) &
             #  #  #  # ]
    1156                 :            :                                 LINK_IN_ULPS),
    1157                 :            :                                 10))
    1158                 :          0 :                         DRM_ERROR("DSI link not in ULPS\n");
    1159                 :            :         }
    1160                 :            : 
    1161                 :            :         /* disable ddi function */
    1162   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
    1163         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
    1164                 :          0 :                 tmp = I915_READ(TRANS_DDI_FUNC_CTL(dsi_trans));
    1165                 :          0 :                 tmp &= ~TRANS_DDI_FUNC_ENABLE;
    1166                 :          0 :                 I915_WRITE(TRANS_DDI_FUNC_CTL(dsi_trans), tmp);
    1167                 :            :         }
    1168                 :            : 
    1169                 :            :         /* disable port sync mode if dual link */
    1170         [ #  # ]:          0 :         if (intel_dsi->dual_link) {
    1171   [ #  #  #  # ]:          0 :                 for_each_dsi_port(port, intel_dsi->ports) {
    1172         [ #  # ]:          0 :                         dsi_trans = dsi_port_to_transcoder(port);
    1173                 :          0 :                         tmp = I915_READ(TRANS_DDI_FUNC_CTL2(dsi_trans));
    1174                 :          0 :                         tmp &= ~PORT_SYNC_MODE_ENABLE;
    1175                 :          0 :                         I915_WRITE(TRANS_DDI_FUNC_CTL2(dsi_trans), tmp);
    1176                 :            :                 }
    1177                 :            :         }
    1178                 :          0 : }
    1179                 :            : 
    1180                 :          0 : static void gen11_dsi_disable_port(struct intel_encoder *encoder)
    1181                 :            : {
    1182                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
    1183                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1184                 :          0 :         u32 tmp;
    1185                 :          0 :         enum port port;
    1186                 :            : 
    1187                 :          0 :         gen11_dsi_ungate_clocks(encoder);
    1188   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
    1189                 :          0 :                 tmp = I915_READ(DDI_BUF_CTL(port));
    1190                 :          0 :                 tmp &= ~DDI_BUF_CTL_ENABLE;
    1191                 :          0 :                 I915_WRITE(DDI_BUF_CTL(port), tmp);
    1192                 :            : 
    1193   [ #  #  #  #  :          0 :                 if (wait_for_us((I915_READ(DDI_BUF_CTL(port)) &
             #  #  #  # ]
    1194                 :            :                                  DDI_BUF_IS_IDLE),
    1195                 :            :                                  8))
    1196                 :          0 :                         DRM_ERROR("DDI port:%c buffer not idle\n",
    1197                 :            :                                   port_name(port));
    1198                 :            :         }
    1199                 :          0 :         gen11_dsi_gate_clocks(encoder);
    1200                 :          0 : }
    1201                 :            : 
    1202                 :          0 : static void gen11_dsi_disable_io_power(struct intel_encoder *encoder)
    1203                 :            : {
    1204                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
    1205                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1206                 :          0 :         enum port port;
    1207                 :          0 :         u32 tmp;
    1208                 :            : 
    1209   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
    1210                 :          0 :                 intel_wakeref_t wakeref;
    1211                 :            : 
    1212                 :          0 :                 wakeref = fetch_and_zero(&intel_dsi->io_wakeref[port]);
    1213         [ #  # ]:          0 :                 intel_display_power_put(dev_priv,
    1214                 :            :                                         port == PORT_A ?
    1215                 :            :                                         POWER_DOMAIN_PORT_DDI_A_IO :
    1216                 :            :                                         POWER_DOMAIN_PORT_DDI_B_IO,
    1217                 :            :                                         wakeref);
    1218                 :            :         }
    1219                 :            : 
    1220                 :            :         /* set mode to DDI */
    1221   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
    1222                 :          0 :                 tmp = I915_READ(ICL_DSI_IO_MODECTL(port));
    1223                 :          0 :                 tmp &= ~COMBO_PHY_MODE_DSI;
    1224                 :          0 :                 I915_WRITE(ICL_DSI_IO_MODECTL(port), tmp);
    1225                 :            :         }
    1226                 :          0 : }
    1227                 :            : 
    1228                 :          0 : static void gen11_dsi_disable(struct intel_encoder *encoder,
    1229                 :            :                               const struct intel_crtc_state *old_crtc_state,
    1230                 :            :                               const struct drm_connector_state *old_conn_state)
    1231                 :            : {
    1232                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1233                 :            : 
    1234                 :            :         /* step1: turn off backlight */
    1235                 :          0 :         intel_dsi_vbt_exec_sequence(intel_dsi, MIPI_SEQ_BACKLIGHT_OFF);
    1236                 :          0 :         intel_panel_disable_backlight(old_conn_state);
    1237                 :            : 
    1238                 :            :         /* step2d,e: disable transcoder and wait */
    1239                 :          0 :         gen11_dsi_disable_transcoder(encoder);
    1240                 :            : 
    1241                 :            :         /* step2f,g: powerdown panel */
    1242                 :          0 :         gen11_dsi_powerdown_panel(encoder);
    1243                 :            : 
    1244                 :            :         /* step2h,i,j: deconfig trancoder */
    1245                 :          0 :         gen11_dsi_deconfigure_trancoder(encoder);
    1246                 :            : 
    1247                 :            :         /* step3: disable port */
    1248                 :          0 :         gen11_dsi_disable_port(encoder);
    1249                 :            : 
    1250                 :            :         /* step4: disable IO power */
    1251                 :          0 :         gen11_dsi_disable_io_power(encoder);
    1252                 :          0 : }
    1253                 :            : 
    1254                 :          0 : static void gen11_dsi_post_disable(struct intel_encoder *encoder,
    1255                 :            :                                    const struct intel_crtc_state *old_crtc_state,
    1256                 :            :                                    const struct drm_connector_state *old_conn_state)
    1257                 :            : {
    1258                 :          0 :         intel_crtc_vblank_off(old_crtc_state);
    1259                 :            : 
    1260                 :          0 :         intel_dsc_disable(old_crtc_state);
    1261                 :            : 
    1262                 :          0 :         skl_scaler_disable(old_crtc_state);
    1263                 :          0 : }
    1264                 :            : 
    1265                 :          0 : static enum drm_mode_status gen11_dsi_mode_valid(struct drm_connector *connector,
    1266                 :            :                                                  struct drm_display_mode *mode)
    1267                 :            : {
    1268                 :            :         /* FIXME: DSC? */
    1269                 :          0 :         return intel_dsi_mode_valid(connector, mode);
    1270                 :            : }
    1271                 :            : 
    1272                 :          0 : static void gen11_dsi_get_timings(struct intel_encoder *encoder,
    1273                 :            :                                   struct intel_crtc_state *pipe_config)
    1274                 :            : {
    1275         [ #  # ]:          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1276                 :          0 :         struct drm_display_mode *adjusted_mode =
    1277                 :            :                                         &pipe_config->hw.adjusted_mode;
    1278                 :            : 
    1279         [ #  # ]:          0 :         if (pipe_config->dsc.compressed_bpp) {
    1280                 :          0 :                 int div = pipe_config->dsc.compressed_bpp;
    1281         [ #  # ]:          0 :                 int mul = mipi_dsi_pixel_format_to_bpp(intel_dsi->pixel_format);
    1282                 :            : 
    1283                 :          0 :                 adjusted_mode->crtc_htotal =
    1284                 :          0 :                         DIV_ROUND_UP(adjusted_mode->crtc_htotal * mul, div);
    1285                 :          0 :                 adjusted_mode->crtc_hsync_start =
    1286                 :          0 :                         DIV_ROUND_UP(adjusted_mode->crtc_hsync_start * mul, div);
    1287                 :          0 :                 adjusted_mode->crtc_hsync_end =
    1288                 :          0 :                         DIV_ROUND_UP(adjusted_mode->crtc_hsync_end * mul, div);
    1289                 :            :         }
    1290                 :            : 
    1291         [ #  # ]:          0 :         if (intel_dsi->dual_link) {
    1292                 :          0 :                 adjusted_mode->crtc_hdisplay *= 2;
    1293         [ #  # ]:          0 :                 if (intel_dsi->dual_link == DSI_DUAL_LINK_FRONT_BACK)
    1294                 :          0 :                         adjusted_mode->crtc_hdisplay -=
    1295                 :          0 :                                                 intel_dsi->pixel_overlap;
    1296                 :          0 :                 adjusted_mode->crtc_htotal *= 2;
    1297                 :            :         }
    1298                 :          0 :         adjusted_mode->crtc_hblank_start = adjusted_mode->crtc_hdisplay;
    1299                 :          0 :         adjusted_mode->crtc_hblank_end = adjusted_mode->crtc_htotal;
    1300                 :            : 
    1301         [ #  # ]:          0 :         if (intel_dsi->operation_mode == INTEL_DSI_VIDEO_MODE) {
    1302         [ #  # ]:          0 :                 if (intel_dsi->dual_link) {
    1303                 :          0 :                         adjusted_mode->crtc_hsync_start *= 2;
    1304                 :          0 :                         adjusted_mode->crtc_hsync_end *= 2;
    1305                 :            :                 }
    1306                 :            :         }
    1307                 :          0 :         adjusted_mode->crtc_vblank_start = adjusted_mode->crtc_vdisplay;
    1308                 :          0 :         adjusted_mode->crtc_vblank_end = adjusted_mode->crtc_vtotal;
    1309                 :          0 : }
    1310                 :            : 
    1311                 :          0 : static void gen11_dsi_get_config(struct intel_encoder *encoder,
    1312                 :            :                                  struct intel_crtc_state *pipe_config)
    1313                 :            : {
    1314                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
    1315                 :            :         struct intel_crtc *crtc = to_intel_crtc(pipe_config->uapi.crtc);
    1316                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1317                 :            : 
    1318                 :          0 :         intel_dsc_get_config(encoder, pipe_config);
    1319                 :            : 
    1320                 :            :         /* FIXME: adapt icl_ddi_clock_get() for DSI and use that? */
    1321                 :          0 :         pipe_config->port_clock =
    1322                 :          0 :                 cnl_calc_wrpll_link(dev_priv, &pipe_config->dpll_hw_state);
    1323                 :            : 
    1324                 :          0 :         pipe_config->hw.adjusted_mode.crtc_clock = intel_dsi->pclk;
    1325         [ #  # ]:          0 :         if (intel_dsi->dual_link)
    1326                 :          0 :                 pipe_config->hw.adjusted_mode.crtc_clock *= 2;
    1327                 :            : 
    1328                 :          0 :         gen11_dsi_get_timings(encoder, pipe_config);
    1329                 :          0 :         pipe_config->output_types |= BIT(INTEL_OUTPUT_DSI);
    1330                 :          0 :         pipe_config->pipe_bpp = bdw_get_pipemisc_bpp(crtc);
    1331                 :          0 : }
    1332                 :            : 
    1333                 :          0 : static int gen11_dsi_dsc_compute_config(struct intel_encoder *encoder,
    1334                 :            :                                         struct intel_crtc_state *crtc_state)
    1335                 :            : {
    1336         [ #  # ]:          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
    1337                 :          0 :         struct drm_dsc_config *vdsc_cfg = &crtc_state->dsc.config;
    1338         [ #  # ]:          0 :         int dsc_max_bpc = INTEL_GEN(dev_priv) >= 12 ? 12 : 10;
    1339                 :          0 :         bool use_dsc;
    1340                 :          0 :         int ret;
    1341                 :            : 
    1342                 :          0 :         use_dsc = intel_bios_get_dsc_params(encoder, crtc_state, dsc_max_bpc);
    1343         [ #  # ]:          0 :         if (!use_dsc)
    1344                 :            :                 return 0;
    1345                 :            : 
    1346         [ #  # ]:          0 :         if (crtc_state->pipe_bpp < 8 * 3)
    1347                 :            :                 return -EINVAL;
    1348                 :            : 
    1349                 :            :         /* FIXME: split only when necessary */
    1350         [ #  # ]:          0 :         if (crtc_state->dsc.slice_count > 1)
    1351                 :          0 :                 crtc_state->dsc.dsc_split = true;
    1352                 :            : 
    1353                 :          0 :         vdsc_cfg->convert_rgb = true;
    1354                 :            : 
    1355                 :          0 :         ret = intel_dsc_compute_params(encoder, crtc_state);
    1356         [ #  # ]:          0 :         if (ret)
    1357                 :            :                 return ret;
    1358                 :            : 
    1359                 :            :         /* DSI specific sanity checks on the common code */
    1360         [ #  # ]:          0 :         WARN_ON(vdsc_cfg->vbr_enable);
    1361         [ #  # ]:          0 :         WARN_ON(vdsc_cfg->simple_422);
    1362         [ #  # ]:          0 :         WARN_ON(vdsc_cfg->pic_width % vdsc_cfg->slice_width);
    1363         [ #  # ]:          0 :         WARN_ON(vdsc_cfg->slice_height < 8);
    1364         [ #  # ]:          0 :         WARN_ON(vdsc_cfg->pic_height % vdsc_cfg->slice_height);
    1365                 :            : 
    1366                 :          0 :         ret = drm_dsc_compute_rc_parameters(vdsc_cfg);
    1367         [ #  # ]:          0 :         if (ret)
    1368                 :            :                 return ret;
    1369                 :            : 
    1370                 :          0 :         crtc_state->dsc.compression_enable = true;
    1371                 :            : 
    1372                 :          0 :         return 0;
    1373                 :            : }
    1374                 :            : 
    1375                 :          0 : static int gen11_dsi_compute_config(struct intel_encoder *encoder,
    1376                 :            :                                     struct intel_crtc_state *pipe_config,
    1377                 :            :                                     struct drm_connector_state *conn_state)
    1378                 :            : {
    1379                 :          0 :         struct intel_dsi *intel_dsi = container_of(encoder, struct intel_dsi,
    1380                 :            :                                                    base);
    1381                 :          0 :         struct intel_connector *intel_connector = intel_dsi->attached_connector;
    1382                 :          0 :         struct intel_crtc *crtc = to_intel_crtc(pipe_config->uapi.crtc);
    1383                 :          0 :         const struct drm_display_mode *fixed_mode =
    1384                 :            :                                         intel_connector->panel.fixed_mode;
    1385                 :          0 :         struct drm_display_mode *adjusted_mode =
    1386                 :            :                                         &pipe_config->hw.adjusted_mode;
    1387                 :            : 
    1388                 :          0 :         pipe_config->output_format = INTEL_OUTPUT_FORMAT_RGB;
    1389                 :          0 :         intel_fixed_panel_mode(fixed_mode, adjusted_mode);
    1390                 :          0 :         intel_pch_panel_fitting(crtc, pipe_config, conn_state->scaling_mode);
    1391                 :            : 
    1392                 :          0 :         adjusted_mode->flags = 0;
    1393                 :            : 
    1394                 :            :         /* Dual link goes to trancoder DSI'0' */
    1395         [ #  # ]:          0 :         if (intel_dsi->ports == BIT(PORT_B))
    1396                 :          0 :                 pipe_config->cpu_transcoder = TRANSCODER_DSI_1;
    1397                 :            :         else
    1398                 :          0 :                 pipe_config->cpu_transcoder = TRANSCODER_DSI_0;
    1399                 :            : 
    1400         [ #  # ]:          0 :         if (intel_dsi->pixel_format == MIPI_DSI_FMT_RGB888)
    1401                 :          0 :                 pipe_config->pipe_bpp = 24;
    1402                 :            :         else
    1403                 :          0 :                 pipe_config->pipe_bpp = 18;
    1404                 :            : 
    1405                 :          0 :         pipe_config->clock_set = true;
    1406                 :            : 
    1407         [ #  # ]:          0 :         if (gen11_dsi_dsc_compute_config(encoder, pipe_config))
    1408                 :          0 :                 DRM_DEBUG_KMS("Attempting to use DSC failed\n");
    1409                 :            : 
    1410         [ #  # ]:          0 :         pipe_config->port_clock = afe_clk(encoder, pipe_config) / 5;
    1411                 :            : 
    1412                 :          0 :         return 0;
    1413                 :            : }
    1414                 :            : 
    1415                 :          0 : static void gen11_dsi_get_power_domains(struct intel_encoder *encoder,
    1416                 :            :                                         struct intel_crtc_state *crtc_state)
    1417                 :            : {
    1418                 :          0 :         struct drm_i915_private *i915 = to_i915(encoder->base.dev);
    1419                 :            : 
    1420                 :          0 :         get_dsi_io_power_domains(i915,
    1421                 :            :                                  enc_to_intel_dsi(encoder));
    1422                 :            : 
    1423         [ #  # ]:          0 :         if (crtc_state->dsc.compression_enable)
    1424                 :          0 :                 intel_display_power_get(i915,
    1425                 :            :                                         intel_dsc_power_domain(crtc_state));
    1426                 :          0 : }
    1427                 :            : 
    1428                 :          0 : static bool gen11_dsi_get_hw_state(struct intel_encoder *encoder,
    1429                 :            :                                    enum pipe *pipe)
    1430                 :            : {
    1431                 :          0 :         struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
    1432                 :          0 :         struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
    1433                 :          0 :         enum transcoder dsi_trans;
    1434                 :          0 :         intel_wakeref_t wakeref;
    1435                 :          0 :         enum port port;
    1436                 :          0 :         bool ret = false;
    1437                 :          0 :         u32 tmp;
    1438                 :            : 
    1439                 :          0 :         wakeref = intel_display_power_get_if_enabled(dev_priv,
    1440                 :            :                                                      encoder->power_domain);
    1441         [ #  # ]:          0 :         if (!wakeref)
    1442                 :            :                 return false;
    1443                 :            : 
    1444   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
    1445         [ #  # ]:          0 :                 dsi_trans = dsi_port_to_transcoder(port);
    1446                 :          0 :                 tmp = I915_READ(TRANS_DDI_FUNC_CTL(dsi_trans));
    1447   [ #  #  #  #  :          0 :                 switch (tmp & TRANS_DDI_EDP_INPUT_MASK) {
                      # ]
    1448                 :          0 :                 case TRANS_DDI_EDP_INPUT_A_ON:
    1449                 :          0 :                         *pipe = PIPE_A;
    1450                 :          0 :                         break;
    1451                 :          0 :                 case TRANS_DDI_EDP_INPUT_B_ONOFF:
    1452                 :          0 :                         *pipe = PIPE_B;
    1453                 :          0 :                         break;
    1454                 :          0 :                 case TRANS_DDI_EDP_INPUT_C_ONOFF:
    1455                 :          0 :                         *pipe = PIPE_C;
    1456                 :          0 :                         break;
    1457                 :          0 :                 case TRANS_DDI_EDP_INPUT_D_ONOFF:
    1458                 :          0 :                         *pipe = PIPE_D;
    1459                 :          0 :                         break;
    1460                 :          0 :                 default:
    1461                 :          0 :                         DRM_ERROR("Invalid PIPE input\n");
    1462                 :          0 :                         goto out;
    1463                 :            :                 }
    1464                 :            : 
    1465                 :          0 :                 tmp = I915_READ(PIPECONF(dsi_trans));
    1466                 :          0 :                 ret = tmp & PIPECONF_ENABLE;
    1467                 :            :         }
    1468                 :          0 : out:
    1469                 :          0 :         intel_display_power_put(dev_priv, encoder->power_domain, wakeref);
    1470                 :          0 :         return ret;
    1471                 :            : }
    1472                 :            : 
    1473                 :          0 : static void gen11_dsi_encoder_destroy(struct drm_encoder *encoder)
    1474                 :            : {
    1475                 :          0 :         intel_encoder_destroy(encoder);
    1476                 :          0 : }
    1477                 :            : 
    1478                 :            : static const struct drm_encoder_funcs gen11_dsi_encoder_funcs = {
    1479                 :            :         .destroy = gen11_dsi_encoder_destroy,
    1480                 :            : };
    1481                 :            : 
    1482                 :            : static const struct drm_connector_funcs gen11_dsi_connector_funcs = {
    1483                 :            :         .late_register = intel_connector_register,
    1484                 :            :         .early_unregister = intel_connector_unregister,
    1485                 :            :         .destroy = intel_connector_destroy,
    1486                 :            :         .fill_modes = drm_helper_probe_single_connector_modes,
    1487                 :            :         .atomic_get_property = intel_digital_connector_atomic_get_property,
    1488                 :            :         .atomic_set_property = intel_digital_connector_atomic_set_property,
    1489                 :            :         .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
    1490                 :            :         .atomic_duplicate_state = intel_digital_connector_duplicate_state,
    1491                 :            : };
    1492                 :            : 
    1493                 :            : static const struct drm_connector_helper_funcs gen11_dsi_connector_helper_funcs = {
    1494                 :            :         .get_modes = intel_dsi_get_modes,
    1495                 :            :         .mode_valid = gen11_dsi_mode_valid,
    1496                 :            :         .atomic_check = intel_digital_connector_atomic_check,
    1497                 :            : };
    1498                 :            : 
    1499                 :          0 : static int gen11_dsi_host_attach(struct mipi_dsi_host *host,
    1500                 :            :                                  struct mipi_dsi_device *dsi)
    1501                 :            : {
    1502                 :          0 :         return 0;
    1503                 :            : }
    1504                 :            : 
    1505                 :          0 : static int gen11_dsi_host_detach(struct mipi_dsi_host *host,
    1506                 :            :                                  struct mipi_dsi_device *dsi)
    1507                 :            : {
    1508                 :          0 :         return 0;
    1509                 :            : }
    1510                 :            : 
    1511                 :          0 : static ssize_t gen11_dsi_host_transfer(struct mipi_dsi_host *host,
    1512                 :            :                                        const struct mipi_dsi_msg *msg)
    1513                 :            : {
    1514                 :          0 :         struct intel_dsi_host *intel_dsi_host = to_intel_dsi_host(host);
    1515                 :          0 :         struct mipi_dsi_packet dsi_pkt;
    1516                 :          0 :         ssize_t ret;
    1517                 :          0 :         bool enable_lpdt = false;
    1518                 :            : 
    1519                 :          0 :         ret = mipi_dsi_create_packet(&dsi_pkt, msg);
    1520         [ #  # ]:          0 :         if (ret < 0)
    1521                 :            :                 return ret;
    1522                 :            : 
    1523         [ #  # ]:          0 :         if (msg->flags & MIPI_DSI_MSG_USE_LPM)
    1524                 :          0 :                 enable_lpdt = true;
    1525                 :            : 
    1526                 :            :         /* send packet header */
    1527                 :          0 :         ret  = dsi_send_pkt_hdr(intel_dsi_host, dsi_pkt, enable_lpdt);
    1528         [ #  # ]:          0 :         if (ret < 0)
    1529                 :            :                 return ret;
    1530                 :            : 
    1531                 :            :         /* only long packet contains payload */
    1532         [ #  # ]:          0 :         if (mipi_dsi_packet_format_is_long(msg->type)) {
    1533                 :          0 :                 ret = dsi_send_pkt_payld(intel_dsi_host, dsi_pkt);
    1534         [ #  # ]:          0 :                 if (ret < 0)
    1535                 :            :                         return ret;
    1536                 :            :         }
    1537                 :            : 
    1538                 :            :         //TODO: add payload receive code if needed
    1539                 :            : 
    1540                 :          0 :         ret = sizeof(dsi_pkt.header) + dsi_pkt.payload_length;
    1541                 :            : 
    1542                 :          0 :         return ret;
    1543                 :            : }
    1544                 :            : 
    1545                 :            : static const struct mipi_dsi_host_ops gen11_dsi_host_ops = {
    1546                 :            :         .attach = gen11_dsi_host_attach,
    1547                 :            :         .detach = gen11_dsi_host_detach,
    1548                 :            :         .transfer = gen11_dsi_host_transfer,
    1549                 :            : };
    1550                 :            : 
    1551                 :            : #define ICL_PREPARE_CNT_MAX     0x7
    1552                 :            : #define ICL_CLK_ZERO_CNT_MAX    0xf
    1553                 :            : #define ICL_TRAIL_CNT_MAX       0x7
    1554                 :            : #define ICL_TCLK_PRE_CNT_MAX    0x3
    1555                 :            : #define ICL_TCLK_POST_CNT_MAX   0x7
    1556                 :            : #define ICL_HS_ZERO_CNT_MAX     0xf
    1557                 :            : #define ICL_EXIT_ZERO_CNT_MAX   0x7
    1558                 :            : 
    1559                 :          0 : static void icl_dphy_param_init(struct intel_dsi *intel_dsi)
    1560                 :            : {
    1561                 :          0 :         struct drm_device *dev = intel_dsi->base.base.dev;
    1562                 :          0 :         struct drm_i915_private *dev_priv = to_i915(dev);
    1563                 :          0 :         struct mipi_config *mipi_config = dev_priv->vbt.dsi.config;
    1564                 :          0 :         u32 tlpx_ns;
    1565                 :          0 :         u32 prepare_cnt, exit_zero_cnt, clk_zero_cnt, trail_cnt;
    1566                 :          0 :         u32 ths_prepare_ns, tclk_trail_ns;
    1567                 :          0 :         u32 hs_zero_cnt;
    1568                 :          0 :         u32 tclk_pre_cnt, tclk_post_cnt;
    1569                 :            : 
    1570                 :          0 :         tlpx_ns = intel_dsi_tlpx_ns(intel_dsi);
    1571                 :            : 
    1572                 :          0 :         tclk_trail_ns = max(mipi_config->tclk_trail, mipi_config->ths_trail);
    1573                 :          0 :         ths_prepare_ns = max(mipi_config->ths_prepare,
    1574                 :            :                              mipi_config->tclk_prepare);
    1575                 :            : 
    1576                 :            :         /*
    1577                 :            :          * prepare cnt in escape clocks
    1578                 :            :          * this field represents a hexadecimal value with a precision
    1579                 :            :          * of 1.2 – i.e. the most significant bit is the integer
    1580                 :            :          * and the least significant 2 bits are fraction bits.
    1581                 :            :          * so, the field can represent a range of 0.25 to 1.75
    1582                 :            :          */
    1583                 :          0 :         prepare_cnt = DIV_ROUND_UP(ths_prepare_ns * 4, tlpx_ns);
    1584         [ #  # ]:          0 :         if (prepare_cnt > ICL_PREPARE_CNT_MAX) {
    1585                 :          0 :                 DRM_DEBUG_KMS("prepare_cnt out of range (%d)\n", prepare_cnt);
    1586                 :          0 :                 prepare_cnt = ICL_PREPARE_CNT_MAX;
    1587                 :            :         }
    1588                 :            : 
    1589                 :            :         /* clk zero count in escape clocks */
    1590                 :          0 :         clk_zero_cnt = DIV_ROUND_UP(mipi_config->tclk_prepare_clkzero -
    1591                 :            :                                     ths_prepare_ns, tlpx_ns);
    1592         [ #  # ]:          0 :         if (clk_zero_cnt > ICL_CLK_ZERO_CNT_MAX) {
    1593                 :          0 :                 DRM_DEBUG_KMS("clk_zero_cnt out of range (%d)\n", clk_zero_cnt);
    1594                 :          0 :                 clk_zero_cnt = ICL_CLK_ZERO_CNT_MAX;
    1595                 :            :         }
    1596                 :            : 
    1597                 :            :         /* trail cnt in escape clocks*/
    1598                 :          0 :         trail_cnt = DIV_ROUND_UP(tclk_trail_ns, tlpx_ns);
    1599         [ #  # ]:          0 :         if (trail_cnt > ICL_TRAIL_CNT_MAX) {
    1600                 :          0 :                 DRM_DEBUG_KMS("trail_cnt out of range (%d)\n", trail_cnt);
    1601                 :          0 :                 trail_cnt = ICL_TRAIL_CNT_MAX;
    1602                 :            :         }
    1603                 :            : 
    1604                 :            :         /* tclk pre count in escape clocks */
    1605                 :          0 :         tclk_pre_cnt = DIV_ROUND_UP(mipi_config->tclk_pre, tlpx_ns);
    1606         [ #  # ]:          0 :         if (tclk_pre_cnt > ICL_TCLK_PRE_CNT_MAX) {
    1607                 :          0 :                 DRM_DEBUG_KMS("tclk_pre_cnt out of range (%d)\n", tclk_pre_cnt);
    1608                 :          0 :                 tclk_pre_cnt = ICL_TCLK_PRE_CNT_MAX;
    1609                 :            :         }
    1610                 :            : 
    1611                 :            :         /* tclk post count in escape clocks */
    1612                 :          0 :         tclk_post_cnt = DIV_ROUND_UP(mipi_config->tclk_post, tlpx_ns);
    1613         [ #  # ]:          0 :         if (tclk_post_cnt > ICL_TCLK_POST_CNT_MAX) {
    1614                 :          0 :                 DRM_DEBUG_KMS("tclk_post_cnt out of range (%d)\n", tclk_post_cnt);
    1615                 :          0 :                 tclk_post_cnt = ICL_TCLK_POST_CNT_MAX;
    1616                 :            :         }
    1617                 :            : 
    1618                 :            :         /* hs zero cnt in escape clocks */
    1619                 :          0 :         hs_zero_cnt = DIV_ROUND_UP(mipi_config->ths_prepare_hszero -
    1620                 :            :                                    ths_prepare_ns, tlpx_ns);
    1621         [ #  # ]:          0 :         if (hs_zero_cnt > ICL_HS_ZERO_CNT_MAX) {
    1622                 :          0 :                 DRM_DEBUG_KMS("hs_zero_cnt out of range (%d)\n", hs_zero_cnt);
    1623                 :          0 :                 hs_zero_cnt = ICL_HS_ZERO_CNT_MAX;
    1624                 :            :         }
    1625                 :            : 
    1626                 :            :         /* hs exit zero cnt in escape clocks */
    1627                 :          0 :         exit_zero_cnt = DIV_ROUND_UP(mipi_config->ths_exit, tlpx_ns);
    1628         [ #  # ]:          0 :         if (exit_zero_cnt > ICL_EXIT_ZERO_CNT_MAX) {
    1629                 :          0 :                 DRM_DEBUG_KMS("exit_zero_cnt out of range (%d)\n", exit_zero_cnt);
    1630                 :          0 :                 exit_zero_cnt = ICL_EXIT_ZERO_CNT_MAX;
    1631                 :            :         }
    1632                 :            : 
    1633                 :            :         /* clock lane dphy timings */
    1634                 :          0 :         intel_dsi->dphy_reg = (CLK_PREPARE_OVERRIDE |
    1635                 :          0 :                                CLK_PREPARE(prepare_cnt) |
    1636                 :          0 :                                CLK_ZERO_OVERRIDE |
    1637                 :          0 :                                CLK_ZERO(clk_zero_cnt) |
    1638                 :          0 :                                CLK_PRE_OVERRIDE |
    1639                 :          0 :                                CLK_PRE(tclk_pre_cnt) |
    1640                 :          0 :                                CLK_POST_OVERRIDE |
    1641                 :          0 :                                CLK_POST(tclk_post_cnt) |
    1642                 :          0 :                                CLK_TRAIL_OVERRIDE |
    1643                 :            :                                CLK_TRAIL(trail_cnt));
    1644                 :            : 
    1645                 :            :         /* data lanes dphy timings */
    1646                 :          0 :         intel_dsi->dphy_data_lane_reg = (HS_PREPARE_OVERRIDE |
    1647                 :          0 :                                          HS_PREPARE(prepare_cnt) |
    1648                 :          0 :                                          HS_ZERO_OVERRIDE |
    1649                 :          0 :                                          HS_ZERO(hs_zero_cnt) |
    1650                 :          0 :                                          HS_TRAIL_OVERRIDE |
    1651                 :          0 :                                          HS_TRAIL(trail_cnt) |
    1652                 :          0 :                                          HS_EXIT_OVERRIDE |
    1653                 :            :                                          HS_EXIT(exit_zero_cnt));
    1654                 :            : 
    1655                 :          0 :         intel_dsi_log_params(intel_dsi);
    1656                 :          0 : }
    1657                 :            : 
    1658                 :          0 : static void icl_dsi_add_properties(struct intel_connector *connector)
    1659                 :            : {
    1660                 :          0 :         u32 allowed_scalers;
    1661                 :            : 
    1662                 :          0 :         allowed_scalers = BIT(DRM_MODE_SCALE_ASPECT) |
    1663                 :            :                            BIT(DRM_MODE_SCALE_FULLSCREEN) |
    1664                 :            :                            BIT(DRM_MODE_SCALE_CENTER);
    1665                 :            : 
    1666                 :          0 :         drm_connector_attach_scaling_mode_property(&connector->base,
    1667                 :            :                                                    allowed_scalers);
    1668                 :            : 
    1669                 :          0 :         connector->base.state->scaling_mode = DRM_MODE_SCALE_ASPECT;
    1670                 :            : 
    1671                 :          0 :         connector->base.display_info.panel_orientation =
    1672                 :          0 :                         intel_dsi_get_panel_orientation(connector);
    1673                 :          0 :         drm_connector_init_panel_orientation_property(&connector->base,
    1674                 :            :                                 connector->panel.fixed_mode->hdisplay,
    1675                 :          0 :                                 connector->panel.fixed_mode->vdisplay);
    1676                 :          0 : }
    1677                 :            : 
    1678                 :          0 : void icl_dsi_init(struct drm_i915_private *dev_priv)
    1679                 :            : {
    1680                 :          0 :         struct drm_device *dev = &dev_priv->drm;
    1681                 :          0 :         struct intel_dsi *intel_dsi;
    1682                 :          0 :         struct intel_encoder *encoder;
    1683                 :          0 :         struct intel_connector *intel_connector;
    1684                 :          0 :         struct drm_connector *connector;
    1685                 :          0 :         struct drm_display_mode *fixed_mode;
    1686                 :          0 :         enum port port;
    1687                 :            : 
    1688         [ #  # ]:          0 :         if (!intel_bios_is_dsi_present(dev_priv, &port))
    1689                 :          0 :                 return;
    1690                 :            : 
    1691                 :          0 :         intel_dsi = kzalloc(sizeof(*intel_dsi), GFP_KERNEL);
    1692         [ #  # ]:          0 :         if (!intel_dsi)
    1693                 :            :                 return;
    1694                 :            : 
    1695                 :          0 :         intel_connector = intel_connector_alloc();
    1696         [ #  # ]:          0 :         if (!intel_connector) {
    1697                 :          0 :                 kfree(intel_dsi);
    1698                 :          0 :                 return;
    1699                 :            :         }
    1700                 :            : 
    1701                 :          0 :         encoder = &intel_dsi->base;
    1702                 :          0 :         intel_dsi->attached_connector = intel_connector;
    1703                 :          0 :         connector = &intel_connector->base;
    1704                 :            : 
    1705                 :            :         /* register DSI encoder with DRM subsystem */
    1706                 :          0 :         drm_encoder_init(dev, &encoder->base, &gen11_dsi_encoder_funcs,
    1707                 :            :                          DRM_MODE_ENCODER_DSI, "DSI %c", port_name(port));
    1708                 :            : 
    1709                 :          0 :         encoder->pre_pll_enable = gen11_dsi_pre_pll_enable;
    1710                 :          0 :         encoder->pre_enable = gen11_dsi_pre_enable;
    1711                 :          0 :         encoder->disable = gen11_dsi_disable;
    1712                 :          0 :         encoder->post_disable = gen11_dsi_post_disable;
    1713                 :          0 :         encoder->port = port;
    1714                 :          0 :         encoder->get_config = gen11_dsi_get_config;
    1715                 :          0 :         encoder->update_pipe = intel_panel_update_backlight;
    1716                 :          0 :         encoder->compute_config = gen11_dsi_compute_config;
    1717                 :          0 :         encoder->get_hw_state = gen11_dsi_get_hw_state;
    1718                 :          0 :         encoder->type = INTEL_OUTPUT_DSI;
    1719                 :          0 :         encoder->cloneable = 0;
    1720                 :          0 :         encoder->pipe_mask = ~0;
    1721                 :          0 :         encoder->power_domain = POWER_DOMAIN_PORT_DSI;
    1722                 :          0 :         encoder->get_power_domains = gen11_dsi_get_power_domains;
    1723                 :            : 
    1724                 :            :         /* register DSI connector with DRM subsystem */
    1725                 :          0 :         drm_connector_init(dev, connector, &gen11_dsi_connector_funcs,
    1726                 :            :                            DRM_MODE_CONNECTOR_DSI);
    1727                 :          0 :         drm_connector_helper_add(connector, &gen11_dsi_connector_helper_funcs);
    1728                 :          0 :         connector->display_info.subpixel_order = SubPixelHorizontalRGB;
    1729                 :          0 :         connector->interlace_allowed = false;
    1730                 :          0 :         connector->doublescan_allowed = false;
    1731                 :          0 :         intel_connector->get_hw_state = intel_connector_get_hw_state;
    1732                 :            : 
    1733                 :            :         /* attach connector to encoder */
    1734                 :          0 :         intel_connector_attach_encoder(intel_connector, encoder);
    1735                 :            : 
    1736                 :          0 :         mutex_lock(&dev->mode_config.mutex);
    1737                 :          0 :         fixed_mode = intel_panel_vbt_fixed_mode(intel_connector);
    1738                 :          0 :         mutex_unlock(&dev->mode_config.mutex);
    1739                 :            : 
    1740         [ #  # ]:          0 :         if (!fixed_mode) {
    1741                 :          0 :                 DRM_ERROR("DSI fixed mode info missing\n");
    1742                 :          0 :                 goto err;
    1743                 :            :         }
    1744                 :            : 
    1745                 :          0 :         intel_panel_init(&intel_connector->panel, fixed_mode, NULL);
    1746                 :          0 :         intel_panel_setup_backlight(connector, INVALID_PIPE);
    1747                 :            : 
    1748         [ #  # ]:          0 :         if (dev_priv->vbt.dsi.config->dual_link)
    1749                 :          0 :                 intel_dsi->ports = BIT(PORT_A) | BIT(PORT_B);
    1750                 :            :         else
    1751                 :          0 :                 intel_dsi->ports = BIT(port);
    1752                 :            : 
    1753                 :          0 :         intel_dsi->dcs_backlight_ports = dev_priv->vbt.dsi.bl_ports;
    1754                 :          0 :         intel_dsi->dcs_cabc_ports = dev_priv->vbt.dsi.cabc_ports;
    1755                 :            : 
    1756   [ #  #  #  # ]:          0 :         for_each_dsi_port(port, intel_dsi->ports) {
    1757                 :          0 :                 struct intel_dsi_host *host;
    1758                 :            : 
    1759                 :          0 :                 host = intel_dsi_host_init(intel_dsi, &gen11_dsi_host_ops, port);
    1760         [ #  # ]:          0 :                 if (!host)
    1761                 :          0 :                         goto err;
    1762                 :            : 
    1763                 :          0 :                 intel_dsi->dsi_hosts[port] = host;
    1764                 :            :         }
    1765                 :            : 
    1766         [ #  # ]:          0 :         if (!intel_dsi_vbt_init(intel_dsi, MIPI_DSI_GENERIC_PANEL_ID)) {
    1767                 :          0 :                 DRM_DEBUG_KMS("no device found\n");
    1768                 :          0 :                 goto err;
    1769                 :            :         }
    1770                 :            : 
    1771                 :          0 :         icl_dphy_param_init(intel_dsi);
    1772                 :            : 
    1773                 :          0 :         icl_dsi_add_properties(intel_connector);
    1774                 :          0 :         return;
    1775                 :            : 
    1776                 :          0 : err:
    1777                 :          0 :         drm_encoder_cleanup(&encoder->base);
    1778                 :          0 :         kfree(intel_dsi);
    1779                 :          0 :         kfree(intel_connector);
    1780                 :            : }

Generated by: LCOV version 1.14