On Mon, 19 Dec 2022, Andrzej Hajda <andrzej.ha...@intel.com> wrote:
> The helper makes the code more compact and readable.
>
> Signed-off-by: Andrzej Hajda <andrzej.ha...@intel.com>

Reviewed-by: Jani Nikula <jani.nik...@intel.com>

> ---
>  drivers/gpu/drm/i915/display/icl_dsi.c | 256 ++++++++-----------------
>  1 file changed, 82 insertions(+), 174 deletions(-)
>
> diff --git a/drivers/gpu/drm/i915/display/icl_dsi.c 
> b/drivers/gpu/drm/i915/display/icl_dsi.c
> index ae14c794c4bc09..b02ac9d2b1e4a2 100644
> --- a/drivers/gpu/drm/i915/display/icl_dsi.c
> +++ b/drivers/gpu/drm/i915/display/icl_dsi.c
> @@ -207,7 +207,7 @@ void icl_dsi_frame_update(struct intel_crtc_state 
> *crtc_state)
>  {
>       struct intel_crtc *crtc = to_intel_crtc(crtc_state->uapi.crtc);
>       struct drm_i915_private *dev_priv = to_i915(crtc->base.dev);
> -     u32 tmp, mode_flags;
> +     u32 mode_flags;
>       enum port port;
>  
>       mode_flags = crtc_state->mode_flags;
> @@ -224,9 +224,7 @@ void icl_dsi_frame_update(struct intel_crtc_state 
> *crtc_state)
>       else
>               return;
>  
> -     tmp = intel_de_read(dev_priv, DSI_CMD_FRMCTL(port));
> -     tmp |= DSI_FRAME_UPDATE_REQUEST;
> -     intel_de_write(dev_priv, DSI_CMD_FRMCTL(port), tmp);
> +     intel_de_rmw(dev_priv, DSI_CMD_FRMCTL(port), 0, 
> DSI_FRAME_UPDATE_REQUEST);
>  }
>  
>  static void dsi_program_swing_and_deemphasis(struct intel_encoder *encoder)
> @@ -234,7 +232,7 @@ static void dsi_program_swing_and_deemphasis(struct 
> intel_encoder *encoder)
>       struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
>       struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
>       enum phy phy;
> -     u32 tmp;
> +     u32 tmp, mask, val;
>       int lane;
>  
>       for_each_dsi_phy(phy, intel_dsi->phys) {
> @@ -242,56 +240,35 @@ static void dsi_program_swing_and_deemphasis(struct 
> intel_encoder *encoder)
>                * Program voltage swing and pre-emphasis level values as per
>                * table in BSPEC under DDI buffer programing
>                */
> +             mask = SCALING_MODE_SEL_MASK | RTERM_SELECT_MASK;
> +             val = SCALING_MODE_SEL(0x2) | TAP2_DISABLE | TAP3_DISABLE |
> +                   RTERM_SELECT(0x6);
>               tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW5_LN(0, phy));
> -             tmp &= ~(SCALING_MODE_SEL_MASK | RTERM_SELECT_MASK);
> -             tmp |= SCALING_MODE_SEL(0x2);
> -             tmp |= TAP2_DISABLE | TAP3_DISABLE;
> -             tmp |= RTERM_SELECT(0x6);
> +             tmp &= ~mask;
> +             tmp |= val;
>               intel_de_write(dev_priv, ICL_PORT_TX_DW5_GRP(phy), tmp);
> +             intel_de_rmw(dev_priv, ICL_PORT_TX_DW5_AUX(phy), mask, val);
>  
> -             tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW5_AUX(phy));
> -             tmp &= ~(SCALING_MODE_SEL_MASK | RTERM_SELECT_MASK);
> -             tmp |= SCALING_MODE_SEL(0x2);
> -             tmp |= TAP2_DISABLE | TAP3_DISABLE;
> -             tmp |= RTERM_SELECT(0x6);
> -             intel_de_write(dev_priv, ICL_PORT_TX_DW5_AUX(phy), tmp);
> -
> +             mask = SWING_SEL_LOWER_MASK | SWING_SEL_UPPER_MASK |
> +                    RCOMP_SCALAR_MASK;
> +             val = SWING_SEL_UPPER(0x2) | SWING_SEL_LOWER(0x2) |
> +                   RCOMP_SCALAR(0x98);
>               tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW2_LN(0, phy));
> -             tmp &= ~(SWING_SEL_LOWER_MASK | SWING_SEL_UPPER_MASK |
> -                      RCOMP_SCALAR_MASK);
> -             tmp |= SWING_SEL_UPPER(0x2);
> -             tmp |= SWING_SEL_LOWER(0x2);
> -             tmp |= RCOMP_SCALAR(0x98);
> +             tmp &= ~mask;
> +             tmp |= val;
>               intel_de_write(dev_priv, ICL_PORT_TX_DW2_GRP(phy), tmp);
> +             intel_de_rmw(dev_priv, ICL_PORT_TX_DW2_AUX(phy), mask, val);
>  
> -             tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW2_AUX(phy));
> -             tmp &= ~(SWING_SEL_LOWER_MASK | SWING_SEL_UPPER_MASK |
> -                      RCOMP_SCALAR_MASK);
> -             tmp |= SWING_SEL_UPPER(0x2);
> -             tmp |= SWING_SEL_LOWER(0x2);
> -             tmp |= RCOMP_SCALAR(0x98);
> -             intel_de_write(dev_priv, ICL_PORT_TX_DW2_AUX(phy), tmp);
> -
> -             tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW4_AUX(phy));
> -             tmp &= ~(POST_CURSOR_1_MASK | POST_CURSOR_2_MASK |
> -                      CURSOR_COEFF_MASK);
> -             tmp |= POST_CURSOR_1(0x0);
> -             tmp |= POST_CURSOR_2(0x0);
> -             tmp |= CURSOR_COEFF(0x3f);
> -             intel_de_write(dev_priv, ICL_PORT_TX_DW4_AUX(phy), tmp);
> -
> -             for (lane = 0; lane <= 3; lane++) {
> -                     /* Bspec: must not use GRP register for write */
> -                     tmp = intel_de_read(dev_priv,
> -                                         ICL_PORT_TX_DW4_LN(lane, phy));
> -                     tmp &= ~(POST_CURSOR_1_MASK | POST_CURSOR_2_MASK |
> -                              CURSOR_COEFF_MASK);
> -                     tmp |= POST_CURSOR_1(0x0);
> -                     tmp |= POST_CURSOR_2(0x0);
> -                     tmp |= CURSOR_COEFF(0x3f);
> -                     intel_de_write(dev_priv,
> -                                    ICL_PORT_TX_DW4_LN(lane, phy), tmp);
> -             }
> +             mask = POST_CURSOR_1_MASK | POST_CURSOR_2_MASK |
> +                    CURSOR_COEFF_MASK;
> +             val = POST_CURSOR_1(0x0) | POST_CURSOR_2(0x0) |
> +                   CURSOR_COEFF(0x3f);
> +             intel_de_rmw(dev_priv, ICL_PORT_TX_DW4_AUX(phy), mask, val);
> +
> +             /* Bspec: must not use GRP register for write */
> +             for (lane = 0; lane <= 3; lane++)
> +                     intel_de_rmw(dev_priv, ICL_PORT_TX_DW4_LN(lane, phy),
> +                                  mask, val);
>       }
>  }
>  
> @@ -310,7 +287,6 @@ static void configure_dual_link_mode(struct intel_encoder 
> *encoder,
>       if (intel_dsi->dual_link == DSI_DUAL_LINK_FRONT_BACK) {
>               const struct drm_display_mode *adjusted_mode =
>                                       &pipe_config->hw.adjusted_mode;
> -             u32 dss_ctl2;
>               u16 hactive = adjusted_mode->crtc_hdisplay;
>               u16 dl_buffer_depth;
>  
> @@ -323,10 +299,8 @@ static void configure_dual_link_mode(struct 
> intel_encoder *encoder,
>  
>               dss_ctl1 &= ~LEFT_DL_BUF_TARGET_DEPTH_MASK;
>               dss_ctl1 |= LEFT_DL_BUF_TARGET_DEPTH(dl_buffer_depth);
> -             dss_ctl2 = intel_de_read(dev_priv, DSS_CTL2);
> -             dss_ctl2 &= ~RIGHT_DL_BUF_TARGET_DEPTH_MASK;
> -             dss_ctl2 |= RIGHT_DL_BUF_TARGET_DEPTH(dl_buffer_depth);
> -             intel_de_write(dev_priv, DSS_CTL2, dss_ctl2);
> +             intel_de_rmw(dev_priv, DSS_CTL2, RIGHT_DL_BUF_TARGET_DEPTH_MASK,
> +                          RIGHT_DL_BUF_TARGET_DEPTH(dl_buffer_depth));
>       } else {
>               /* Interleave */
>               dss_ctl1 |= DUAL_LINK_MODE_INTERLEAVE;
> @@ -412,13 +386,10 @@ static void gen11_dsi_enable_io_power(struct 
> intel_encoder *encoder)
>       struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
>       struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
>       enum port port;
> -     u32 tmp;
>  
> -     for_each_dsi_port(port, intel_dsi->ports) {
> -             tmp = intel_de_read(dev_priv, ICL_DSI_IO_MODECTL(port));
> -             tmp |= COMBO_PHY_MODE_DSI;
> -             intel_de_write(dev_priv, ICL_DSI_IO_MODECTL(port), tmp);
> -     }
> +     for_each_dsi_port(port, intel_dsi->ports)
> +             intel_de_rmw(dev_priv, ICL_DSI_IO_MODECTL(port),
> +                          0, COMBO_PHY_MODE_DSI);
>  
>       get_dsi_io_power_domains(dev_priv, intel_dsi);
>  }
> @@ -444,26 +415,16 @@ static void gen11_dsi_config_phy_lanes_sequence(struct 
> intel_encoder *encoder)
>  
>       /* Step 4b(i) set loadgen select for transmit and aux lanes */
>       for_each_dsi_phy(phy, intel_dsi->phys) {
> -             tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW4_AUX(phy));
> -             tmp &= ~LOADGEN_SELECT;
> -             intel_de_write(dev_priv, ICL_PORT_TX_DW4_AUX(phy), tmp);
> -             for (lane = 0; lane <= 3; lane++) {
> -                     tmp = intel_de_read(dev_priv,
> -                                         ICL_PORT_TX_DW4_LN(lane, phy));
> -                     tmp &= ~LOADGEN_SELECT;
> -                     if (lane != 2)
> -                             tmp |= LOADGEN_SELECT;
> -                     intel_de_write(dev_priv,
> -                                    ICL_PORT_TX_DW4_LN(lane, phy), tmp);
> -             }
> +             intel_de_rmw(dev_priv, ICL_PORT_TX_DW4_AUX(phy), 
> LOADGEN_SELECT, 0);
> +             for (lane = 0; lane <= 3; lane++)
> +                     intel_de_rmw(dev_priv, ICL_PORT_TX_DW4_LN(lane, phy),
> +                                  LOADGEN_SELECT, lane != 2 ? LOADGEN_SELECT 
> : 0);
>       }
>  
>       /* Step 4b(ii) set latency optimization for transmit and aux lanes */
>       for_each_dsi_phy(phy, intel_dsi->phys) {
> -             tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW2_AUX(phy));
> -             tmp &= ~FRC_LATENCY_OPTIM_MASK;
> -             tmp |= FRC_LATENCY_OPTIM_VAL(0x5);
> -             intel_de_write(dev_priv, ICL_PORT_TX_DW2_AUX(phy), tmp);
> +             intel_de_rmw(dev_priv, ICL_PORT_TX_DW2_AUX(phy),
> +                          FRC_LATENCY_OPTIM_MASK, 
> FRC_LATENCY_OPTIM_VAL(0x5));
>               tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW2_LN(0, phy));
>               tmp &= ~FRC_LATENCY_OPTIM_MASK;
>               tmp |= FRC_LATENCY_OPTIM_VAL(0x5);
> @@ -471,12 +432,8 @@ static void gen11_dsi_config_phy_lanes_sequence(struct 
> intel_encoder *encoder)
>  
>               /* For EHL, TGL, set latency optimization for PCS_DW1 lanes */
>               if (IS_JSL_EHL(dev_priv) || (DISPLAY_VER(dev_priv) >= 12)) {
> -                     tmp = intel_de_read(dev_priv,
> -                                         ICL_PORT_PCS_DW1_AUX(phy));
> -                     tmp &= ~LATENCY_OPTIM_MASK;
> -                     tmp |= LATENCY_OPTIM_VAL(0);
> -                     intel_de_write(dev_priv, ICL_PORT_PCS_DW1_AUX(phy),
> -                                    tmp);
> +                     intel_de_rmw(dev_priv, ICL_PORT_PCS_DW1_AUX(phy),
> +                                  LATENCY_OPTIM_MASK, LATENCY_OPTIM_VAL(0));
>  
>                       tmp = intel_de_read(dev_priv,
>                                           ICL_PORT_PCS_DW1_LN(0, phy));
> @@ -501,9 +458,7 @@ static void gen11_dsi_voltage_swing_program_seq(struct 
> intel_encoder *encoder)
>               tmp = intel_de_read(dev_priv, ICL_PORT_PCS_DW1_LN(0, phy));
>               tmp &= ~COMMON_KEEPER_EN;
>               intel_de_write(dev_priv, ICL_PORT_PCS_DW1_GRP(phy), tmp);
> -             tmp = intel_de_read(dev_priv, ICL_PORT_PCS_DW1_AUX(phy));
> -             tmp &= ~COMMON_KEEPER_EN;
> -             intel_de_write(dev_priv, ICL_PORT_PCS_DW1_AUX(phy), tmp);
> +             intel_de_rmw(dev_priv, ICL_PORT_PCS_DW1_AUX(phy), 
> COMMON_KEEPER_EN, 0);
>       }
>  
>       /*
> @@ -511,20 +466,15 @@ static void gen11_dsi_voltage_swing_program_seq(struct 
> intel_encoder *encoder)
>        * Note: loadgen select program is done
>        * as part of lane phy sequence configuration
>        */
> -     for_each_dsi_phy(phy, intel_dsi->phys) {
> -             tmp = intel_de_read(dev_priv, ICL_PORT_CL_DW5(phy));
> -             tmp |= SUS_CLOCK_CONFIG;
> -             intel_de_write(dev_priv, ICL_PORT_CL_DW5(phy), tmp);
> -     }
> +     for_each_dsi_phy(phy, intel_dsi->phys)
> +             intel_de_rmw(dev_priv, ICL_PORT_CL_DW5(phy), 0, 
> SUS_CLOCK_CONFIG);
>  
>       /* Clear training enable to change swing values */
>       for_each_dsi_phy(phy, intel_dsi->phys) {
>               tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW5_LN(0, phy));
>               tmp &= ~TX_TRAINING_EN;
>               intel_de_write(dev_priv, ICL_PORT_TX_DW5_GRP(phy), tmp);
> -             tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW5_AUX(phy));
> -             tmp &= ~TX_TRAINING_EN;
> -             intel_de_write(dev_priv, ICL_PORT_TX_DW5_AUX(phy), tmp);
> +             intel_de_rmw(dev_priv, ICL_PORT_TX_DW5_AUX(phy), 
> TX_TRAINING_EN, 0);
>       }
>  
>       /* Program swing and de-emphasis */
> @@ -535,9 +485,7 @@ static void gen11_dsi_voltage_swing_program_seq(struct 
> intel_encoder *encoder)
>               tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW5_LN(0, phy));
>               tmp |= TX_TRAINING_EN;
>               intel_de_write(dev_priv, ICL_PORT_TX_DW5_GRP(phy), tmp);
> -             tmp = intel_de_read(dev_priv, ICL_PORT_TX_DW5_AUX(phy));
> -             tmp |= TX_TRAINING_EN;
> -             intel_de_write(dev_priv, ICL_PORT_TX_DW5_AUX(phy), tmp);
> +             intel_de_rmw(dev_priv, ICL_PORT_TX_DW5_AUX(phy), 0, 
> TX_TRAINING_EN);
>       }
>  }
>  
> @@ -545,13 +493,10 @@ static void gen11_dsi_enable_ddi_buffer(struct 
> intel_encoder *encoder)
>  {
>       struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
>       struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
> -     u32 tmp;
>       enum port port;
>  
>       for_each_dsi_port(port, intel_dsi->ports) {
> -             tmp = intel_de_read(dev_priv, DDI_BUF_CTL(port));
> -             tmp |= DDI_BUF_CTL_ENABLE;
> -             intel_de_write(dev_priv, DDI_BUF_CTL(port), tmp);
> +             intel_de_rmw(dev_priv, DDI_BUF_CTL(port), 0, 
> DDI_BUF_CTL_ENABLE);
>  
>               if (wait_for_us(!(intel_de_read(dev_priv, DDI_BUF_CTL(port)) &
>                                 DDI_BUF_IS_IDLE),
> @@ -567,17 +512,13 @@ gen11_dsi_setup_dphy_timings(struct intel_encoder 
> *encoder,
>  {
>       struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
>       struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
> -     u32 tmp;
>       enum port port;
>       enum phy phy;
>  
>       /* Program T-INIT master registers */
> -     for_each_dsi_port(port, intel_dsi->ports) {
> -             tmp = intel_de_read(dev_priv, ICL_DSI_T_INIT_MASTER(port));
> -             tmp &= ~DSI_T_INIT_MASTER_MASK;
> -             tmp |= intel_dsi->init_count;
> -             intel_de_write(dev_priv, ICL_DSI_T_INIT_MASTER(port), tmp);
> -     }
> +     for_each_dsi_port(port, intel_dsi->ports)
> +             intel_de_rmw(dev_priv, ICL_DSI_T_INIT_MASTER(port),
> +                          DSI_T_INIT_MASTER_MASK, intel_dsi->init_count);
>  
>       /* Program DPHY clock lanes timings */
>       for_each_dsi_port(port, intel_dsi->ports) {
> @@ -608,31 +549,22 @@ gen11_dsi_setup_dphy_timings(struct intel_encoder 
> *encoder,
>       if (DISPLAY_VER(dev_priv) == 11) {
>               if (afe_clk(encoder, crtc_state) <= 800000) {
>                       for_each_dsi_port(port, intel_dsi->ports) {
> -                             tmp = intel_de_read(dev_priv,
> -                                                 DPHY_TA_TIMING_PARAM(port));
> -                             tmp &= ~TA_SURE_MASK;
> -                             tmp |= TA_SURE_OVERRIDE | TA_SURE(0);
> -                             intel_de_write(dev_priv,
> -                                            DPHY_TA_TIMING_PARAM(port),
> -                                            tmp);
> +                             intel_de_rmw(dev_priv, 
> DPHY_TA_TIMING_PARAM(port),
> +                                          TA_SURE_MASK,
> +                                          TA_SURE_OVERRIDE | TA_SURE(0));
>  
>                               /* shadow register inside display core */
> -                             tmp = intel_de_read(dev_priv,
> -                                                 DSI_TA_TIMING_PARAM(port));
> -                             tmp &= ~TA_SURE_MASK;
> -                             tmp |= TA_SURE_OVERRIDE | TA_SURE(0);
> -                             intel_de_write(dev_priv,
> -                                            DSI_TA_TIMING_PARAM(port), tmp);
> +                             intel_de_rmw(dev_priv, 
> DSI_TA_TIMING_PARAM(port),
> +                                          TA_SURE_MASK,
> +                                          TA_SURE_OVERRIDE | TA_SURE(0));
>                       }
>               }
>       }
>  
>       if (IS_JSL_EHL(dev_priv)) {
> -             for_each_dsi_phy(phy, intel_dsi->phys) {
> -                     tmp = intel_de_read(dev_priv, ICL_DPHY_CHKN(phy));
> -                     tmp |= ICL_DPHY_CHKN_AFE_OVER_PPI_STRAP;
> -                     intel_de_write(dev_priv, ICL_DPHY_CHKN(phy), tmp);
> -             }
> +             for_each_dsi_phy(phy, intel_dsi->phys)
> +                     intel_de_rmw(dev_priv, ICL_DPHY_CHKN(phy),
> +                                  0, ICL_DPHY_CHKN_AFE_OVER_PPI_STRAP);
>       }
>  }
>  
> @@ -824,11 +756,8 @@ gen11_dsi_configure_transcoder(struct intel_encoder 
> *encoder,
>       if (intel_dsi->dual_link) {
>               for_each_dsi_port(port, intel_dsi->ports) {
>                       dsi_trans = dsi_port_to_transcoder(port);
> -                     tmp = intel_de_read(dev_priv,
> -                                         TRANS_DDI_FUNC_CTL2(dsi_trans));
> -                     tmp |= PORT_SYNC_MODE_ENABLE;
> -                     intel_de_write(dev_priv,
> -                                    TRANS_DDI_FUNC_CTL2(dsi_trans), tmp);
> +                     intel_de_rmw(dev_priv, TRANS_DDI_FUNC_CTL2(dsi_trans),
> +                                  0, PORT_SYNC_MODE_ENABLE);
>               }
>  
>               /* configure stream splitting */
> @@ -1044,13 +973,10 @@ static void gen11_dsi_enable_transcoder(struct 
> intel_encoder *encoder)
>       struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
>       enum port port;
>       enum transcoder dsi_trans;
> -     u32 tmp;
>  
>       for_each_dsi_port(port, intel_dsi->ports) {
>               dsi_trans = dsi_port_to_transcoder(port);
> -             tmp = intel_de_read(dev_priv, PIPECONF(dsi_trans));
> -             tmp |= PIPECONF_ENABLE;
> -             intel_de_write(dev_priv, PIPECONF(dsi_trans), tmp);
> +             intel_de_rmw(dev_priv, PIPECONF(dsi_trans), 0, PIPECONF_ENABLE);
>  
>               /* wait for transcoder to be enabled */
>               if (intel_de_wait_for_set(dev_priv, PIPECONF(dsi_trans),
> @@ -1067,7 +993,7 @@ static void gen11_dsi_setup_timeouts(struct 
> intel_encoder *encoder,
>       struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
>       enum port port;
>       enum transcoder dsi_trans;
> -     u32 tmp, hs_tx_timeout, lp_rx_timeout, ta_timeout, divisor, mul;
> +     u32 hs_tx_timeout, lp_rx_timeout, ta_timeout, divisor, mul;
>  
>       /*
>        * escape clock count calculation:
> @@ -1087,26 +1013,23 @@ static void gen11_dsi_setup_timeouts(struct 
> intel_encoder *encoder,
>               dsi_trans = dsi_port_to_transcoder(port);
>  
>               /* program hst_tx_timeout */
> -             tmp = intel_de_read(dev_priv, DSI_HSTX_TO(dsi_trans));
> -             tmp &= ~HSTX_TIMEOUT_VALUE_MASK;
> -             tmp |= HSTX_TIMEOUT_VALUE(hs_tx_timeout);
> -             intel_de_write(dev_priv, DSI_HSTX_TO(dsi_trans), tmp);
> +             intel_de_rmw(dev_priv, DSI_HSTX_TO(dsi_trans),
> +                          HSTX_TIMEOUT_VALUE_MASK,
> +                          HSTX_TIMEOUT_VALUE(hs_tx_timeout));
>  
>               /* FIXME: DSI_CALIB_TO */
>  
>               /* program lp_rx_host timeout */
> -             tmp = intel_de_read(dev_priv, DSI_LPRX_HOST_TO(dsi_trans));
> -             tmp &= ~LPRX_TIMEOUT_VALUE_MASK;
> -             tmp |= LPRX_TIMEOUT_VALUE(lp_rx_timeout);
> -             intel_de_write(dev_priv, DSI_LPRX_HOST_TO(dsi_trans), tmp);
> +             intel_de_rmw(dev_priv, DSI_LPRX_HOST_TO(dsi_trans),
> +                          LPRX_TIMEOUT_VALUE_MASK,
> +                          LPRX_TIMEOUT_VALUE(lp_rx_timeout));
>  
>               /* FIXME: DSI_PWAIT_TO */
>  
>               /* program turn around timeout */
> -             tmp = intel_de_read(dev_priv, DSI_TA_TO(dsi_trans));
> -             tmp &= ~TA_TIMEOUT_VALUE_MASK;
> -             tmp |= TA_TIMEOUT_VALUE(ta_timeout);
> -             intel_de_write(dev_priv, DSI_TA_TO(dsi_trans), tmp);
> +             intel_de_rmw(dev_priv, DSI_TA_TO(dsi_trans),
> +                          TA_TIMEOUT_VALUE_MASK,
> +                          TA_TIMEOUT_VALUE(ta_timeout));
>       }
>  }
>  
> @@ -1310,15 +1233,12 @@ static void gen11_dsi_disable_transcoder(struct 
> intel_encoder *encoder)
>       struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
>       enum port port;
>       enum transcoder dsi_trans;
> -     u32 tmp;
>  
>       for_each_dsi_port(port, intel_dsi->ports) {
>               dsi_trans = dsi_port_to_transcoder(port);
>  
>               /* disable transcoder */
> -             tmp = intel_de_read(dev_priv, PIPECONF(dsi_trans));
> -             tmp &= ~PIPECONF_ENABLE;
> -             intel_de_write(dev_priv, PIPECONF(dsi_trans), tmp);
> +             intel_de_rmw(dev_priv, PIPECONF(dsi_trans), PIPECONF_ENABLE, 0);
>  
>               /* wait for transcoder to be disabled */
>               if (intel_de_wait_for_clear(dev_priv, PIPECONF(dsi_trans),
> @@ -1350,11 +1270,9 @@ static void gen11_dsi_deconfigure_trancoder(struct 
> intel_encoder *encoder)
>  
>       /* disable periodic update mode */
>       if (is_cmd_mode(intel_dsi)) {
> -             for_each_dsi_port(port, intel_dsi->ports) {
> -                     tmp = intel_de_read(dev_priv, DSI_CMD_FRMCTL(port));
> -                     tmp &= ~DSI_PERIODIC_FRAME_UPDATE_ENABLE;
> -                     intel_de_write(dev_priv, DSI_CMD_FRMCTL(port), tmp);
> -             }
> +             for_each_dsi_port(port, intel_dsi->ports)
> +                     intel_de_rmw(dev_priv, DSI_CMD_FRMCTL(port),
> +                                  DSI_PERIODIC_FRAME_UPDATE_ENABLE, 0);
>       }
>  
>       /* put dsi link in ULPS */
> @@ -1374,20 +1292,16 @@ static void gen11_dsi_deconfigure_trancoder(struct 
> intel_encoder *encoder)
>       /* disable ddi function */
>       for_each_dsi_port(port, intel_dsi->ports) {
>               dsi_trans = dsi_port_to_transcoder(port);
> -             tmp = intel_de_read(dev_priv, TRANS_DDI_FUNC_CTL(dsi_trans));
> -             tmp &= ~TRANS_DDI_FUNC_ENABLE;
> -             intel_de_write(dev_priv, TRANS_DDI_FUNC_CTL(dsi_trans), tmp);
> +             intel_de_rmw(dev_priv, TRANS_DDI_FUNC_CTL(dsi_trans),
> +                          TRANS_DDI_FUNC_ENABLE, 0);
>       }
>  
>       /* disable port sync mode if dual link */
>       if (intel_dsi->dual_link) {
>               for_each_dsi_port(port, intel_dsi->ports) {
>                       dsi_trans = dsi_port_to_transcoder(port);
> -                     tmp = intel_de_read(dev_priv,
> -                                         TRANS_DDI_FUNC_CTL2(dsi_trans));
> -                     tmp &= ~PORT_SYNC_MODE_ENABLE;
> -                     intel_de_write(dev_priv,
> -                                    TRANS_DDI_FUNC_CTL2(dsi_trans), tmp);
> +                     intel_de_rmw(dev_priv, TRANS_DDI_FUNC_CTL2(dsi_trans),
> +                                  PORT_SYNC_MODE_ENABLE, 0);
>               }
>       }
>  }
> @@ -1396,14 +1310,11 @@ static void gen11_dsi_disable_port(struct 
> intel_encoder *encoder)
>  {
>       struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
>       struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
> -     u32 tmp;
>       enum port port;
>  
>       gen11_dsi_ungate_clocks(encoder);
>       for_each_dsi_port(port, intel_dsi->ports) {
> -             tmp = intel_de_read(dev_priv, DDI_BUF_CTL(port));
> -             tmp &= ~DDI_BUF_CTL_ENABLE;
> -             intel_de_write(dev_priv, DDI_BUF_CTL(port), tmp);
> +             intel_de_rmw(dev_priv, DDI_BUF_CTL(port), DDI_BUF_CTL_ENABLE, 
> 0);
>  
>               if (wait_for_us((intel_de_read(dev_priv, DDI_BUF_CTL(port)) &
>                                DDI_BUF_IS_IDLE),
> @@ -1420,7 +1331,6 @@ static void gen11_dsi_disable_io_power(struct 
> intel_encoder *encoder)
>       struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
>       struct intel_dsi *intel_dsi = enc_to_intel_dsi(encoder);
>       enum port port;
> -     u32 tmp;
>  
>       for_each_dsi_port(port, intel_dsi->ports) {
>               intel_wakeref_t wakeref;
> @@ -1434,11 +1344,9 @@ static void gen11_dsi_disable_io_power(struct 
> intel_encoder *encoder)
>       }
>  
>       /* set mode to DDI */
> -     for_each_dsi_port(port, intel_dsi->ports) {
> -             tmp = intel_de_read(dev_priv, ICL_DSI_IO_MODECTL(port));
> -             tmp &= ~COMBO_PHY_MODE_DSI;
> -             intel_de_write(dev_priv, ICL_DSI_IO_MODECTL(port), tmp);
> -     }
> +     for_each_dsi_port(port, intel_dsi->ports)
> +             intel_de_rmw(dev_priv, ICL_DSI_IO_MODECTL(port),
> +                          COMBO_PHY_MODE_DSI, 0);
>  }
>  
>  static void gen11_dsi_disable(struct intel_atomic_state *state,

-- 
Jani Nikula, Intel Open Source Graphics Center

Reply via email to