Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
| 2 | |
| 3 | #include <device/mmio.h> |
| 4 | #include <console/console.h> |
Vinod Polimera | 0af24f7 | 2022-05-31 06:49:15 +0530 | [diff] [blame] | 5 | #include <delay.h> |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 6 | #include <edid.h> |
Vinod Polimera | 0af24f7 | 2022-05-31 06:49:15 +0530 | [diff] [blame] | 7 | #include <soc/clock.h> |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 8 | #include <soc/display/mdssreg.h> |
| 9 | |
Vinod Polimera | b524d2b | 2020-10-30 15:34:03 +0530 | [diff] [blame] | 10 | #define MDSS_MDP_MAX_PREFILL_FETCH 24 |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 11 | |
| 12 | static void mdss_source_pipe_config(struct edid *edid) |
| 13 | { |
| 14 | uint32_t img_size, out_size, stride; |
| 15 | uint32_t fb_off = 0; |
| 16 | uint32_t flip_bits = 0; |
| 17 | uint32_t src_xy = 0; |
| 18 | uint32_t dst_xy = 0; |
| 19 | |
| 20 | /* write active region size*/ |
| 21 | img_size = (edid->mode.va << 16) | edid->mode.ha; |
| 22 | out_size = img_size; |
| 23 | stride = (edid->mode.ha * edid->framebuffer_bits_per_pixel/8); |
| 24 | |
| 25 | if (!fb_off) { /* left */ |
| 26 | dst_xy = (edid->mode.vborder << 16) | edid->mode.hborder; |
| 27 | src_xy = dst_xy; |
| 28 | } else { /* right */ |
| 29 | dst_xy = (edid->mode.vborder << 16); |
| 30 | src_xy = (edid->mode.vborder << 16) | fb_off; |
| 31 | } |
| 32 | |
| 33 | printk(BIOS_INFO, "%s: src=%x fb_off=%x src_xy=%x dst_xy=%x\n", |
| 34 | __func__, out_size, fb_off, src_xy, dst_xy); |
| 35 | |
| 36 | write32(&mdp_sspp->sspp_src_ystride0, stride); |
| 37 | write32(&mdp_sspp->sspp_src_size, out_size); |
| 38 | write32(&mdp_sspp->sspp_out_size, out_size); |
| 39 | write32(&mdp_sspp->sspp_src_xy, src_xy); |
| 40 | write32(&mdp_sspp->sspp_out_xy, dst_xy); |
| 41 | |
| 42 | /* Tight Packing 4bpp Alpha 8-bit A R B G */ |
| 43 | write32(&mdp_sspp->sspp_src_format, 0x000236ff); |
| 44 | write32(&mdp_sspp->sspp_src_unpack_pattern, 0x03020001); |
| 45 | |
Vinod Polimera | 0af24f7 | 2022-05-31 06:49:15 +0530 | [diff] [blame] | 46 | flip_bits |= SW_PIX_EXT_OVERRIDE; |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 47 | write32(&mdp_sspp->sspp_sw_pic_ext_c0_req_pixels, out_size); |
| 48 | write32(&mdp_sspp->sspp_sw_pic_ext_c1c2_req_pixels, out_size); |
| 49 | write32(&mdp_sspp->sspp_sw_pic_ext_c3_req_pixels, out_size); |
| 50 | write32(&mdp_sspp->sspp_src_op_mode, flip_bits); |
| 51 | } |
| 52 | |
| 53 | static void mdss_vbif_setup(void) |
| 54 | { |
| 55 | write32(&vbif_rt->vbif_out_axi_amemtype_conf0, 0x33333333); |
| 56 | write32(&vbif_rt->vbif_out_axi_amemtype_conf1, 0x00333333); |
| 57 | } |
| 58 | |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 59 | static void mdss_intf_fetch_start_config(struct edid *edid) |
| 60 | { |
| 61 | uint32_t v_total, h_total, fetch_start, vfp_start; |
| 62 | uint32_t prefetch_avail, prefetch_needed; |
Vinod Polimera | 0af24f7 | 2022-05-31 06:49:15 +0530 | [diff] [blame] | 63 | uint32_t fetch_enable = PROG_FETCH_START_EN; |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 64 | |
| 65 | /* |
| 66 | * MDP programmable fetch is for MDP with rev >= 1.05. |
| 67 | * Programmable fetch is not needed if vertical back porch |
Vinod Polimera | b524d2b | 2020-10-30 15:34:03 +0530 | [diff] [blame] | 68 | * plus vertical pulse width plus extra line for the extra h_total |
| 69 | * added during fetch start is >= 24. |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 70 | */ |
Vinod Polimera | b524d2b | 2020-10-30 15:34:03 +0530 | [diff] [blame] | 71 | if ((edid->mode.vbl - edid->mode.vso + 1) >= MDSS_MDP_MAX_PREFILL_FETCH) |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 72 | return; |
| 73 | |
| 74 | /* |
| 75 | * Fetch should always be outside the active lines. If the fetching |
| 76 | * is programmed within active region, hardware behavior is unknown. |
| 77 | */ |
| 78 | v_total = edid->mode.va + edid->mode.vbl; |
| 79 | h_total = edid->mode.ha + edid->mode.hbl; |
| 80 | vfp_start = edid->mode.va + edid->mode.vbl - edid->mode.vso; |
| 81 | prefetch_avail = v_total - vfp_start; |
| 82 | prefetch_needed = MDSS_MDP_MAX_PREFILL_FETCH - edid->mode.vbl + edid->mode.vso; |
| 83 | |
| 84 | /* |
| 85 | * In some cases, vertical front porch is too high. In such cases limit |
| 86 | * the mdp fetch lines as the last (25 - vbp - vpw) lines of |
| 87 | * vertical front porch. |
| 88 | */ |
| 89 | if (prefetch_avail > prefetch_needed) |
| 90 | prefetch_avail = prefetch_needed; |
| 91 | |
| 92 | fetch_start = (v_total - prefetch_avail) * h_total + h_total + 1; |
| 93 | write32(&mdp_intf->intf_prof_fetch_start, fetch_start); |
| 94 | write32(&mdp_intf->intf_config, fetch_enable); |
| 95 | } |
| 96 | |
| 97 | static void mdss_layer_mixer_setup(struct edid *edid) |
| 98 | { |
| 99 | uint32_t mdp_rgb_size; |
| 100 | uint32_t left_staging_level; |
| 101 | |
| 102 | /* write active region size*/ |
| 103 | mdp_rgb_size = (edid->mode.va << 16) | edid->mode.ha; |
| 104 | |
| 105 | write32(&mdp_layer_mixer->layer_out_size, mdp_rgb_size); |
| 106 | write32(&mdp_layer_mixer->layer_op_mode, 0x0); |
| 107 | for (int i = 0; i < 6; i++) { |
| 108 | write32(&mdp_layer_mixer->layer_blend[i].layer_blend_op, 0x100); |
| 109 | write32(&mdp_layer_mixer->layer_blend[i].layer_blend_const_alpha, 0x00ff0000); |
| 110 | } |
| 111 | |
| 112 | /* Enable border fill */ |
Vinod Polimera | 0af24f7 | 2022-05-31 06:49:15 +0530 | [diff] [blame] | 113 | left_staging_level = BORDER_OUT; |
| 114 | left_staging_level |= VIG_0_OUT; |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 115 | |
| 116 | /* Base layer for layer mixer 0 */ |
| 117 | write32(&mdp_ctl->ctl_layer0, left_staging_level); |
| 118 | } |
| 119 | |
| 120 | static void mdss_vbif_qos_remapper_setup(void) |
| 121 | { |
| 122 | /* |
| 123 | * VBIF remapper registers are used for translating internal display hardware |
| 124 | * priority level (from 0 to 7) into system fabric priority level. |
| 125 | * These remapper settings are defined for all the clients which corresponds |
| 126 | * to the xin clients connected to SSPP on VBIF. |
| 127 | */ |
| 128 | write32(&vbif_rt->qos_rp_remap[0].vbif_xinl_qos_rp_remap, 0x00000003); |
| 129 | write32(&vbif_rt->qos_rp_remap[1].vbif_xinl_qos_rp_remap, 0x11111113); |
| 130 | write32(&vbif_rt->qos_rp_remap[2].vbif_xinl_qos_rp_remap, 0x22222224); |
| 131 | write32(&vbif_rt->qos_rp_remap[3].vbif_xinl_qos_rp_remap, 0x33333334); |
| 132 | write32(&vbif_rt->qos_rp_remap[4].vbif_xinl_qos_rp_remap, 0x44444445); |
| 133 | write32(&vbif_rt->qos_rp_remap[7].vbif_xinl_qos_rp_remap, 0x77777776); |
| 134 | write32(&vbif_rt->qos_lvl_remap[0].vbif_xinl_qos_lvl_remap, 0x00000003); |
| 135 | write32(&vbif_rt->qos_lvl_remap[1].vbif_xinl_qos_lvl_remap, 0x11111113); |
| 136 | write32(&vbif_rt->qos_lvl_remap[2].vbif_xinl_qos_lvl_remap, 0x22222224); |
| 137 | write32(&vbif_rt->qos_lvl_remap[3].vbif_xinl_qos_lvl_remap, 0x33333334); |
| 138 | write32(&vbif_rt->qos_lvl_remap[4].vbif_xinl_qos_lvl_remap, 0x44444445); |
| 139 | write32(&vbif_rt->qos_lvl_remap[5].vbif_xinl_qos_lvl_remap, 0x77777776); |
| 140 | } |
| 141 | |
| 142 | void mdp_dsi_video_config(struct edid *edid) |
| 143 | { |
| 144 | mdss_intf_tg_setup(edid); |
| 145 | mdss_intf_fetch_start_config(edid); |
| 146 | mdss_vbif_setup(); |
| 147 | mdss_vbif_qos_remapper_setup(); |
| 148 | mdss_source_pipe_config(edid); |
| 149 | mdss_layer_mixer_setup(edid); |
Vinod Polimera | 0af24f7 | 2022-05-31 06:49:15 +0530 | [diff] [blame] | 150 | mdss_ctrl_config(); |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 151 | write32(&mdp_intf->intf_mux, 0x0F0000); |
| 152 | } |
| 153 | |
| 154 | void mdp_dsi_video_on(void) |
| 155 | { |
| 156 | uint32_t ctl0_reg_val; |
| 157 | |
| 158 | ctl0_reg_val = VIG_0 | LAYER_MIXER_0 | CTL | INTF; |
Vinod Polimera | 0af24f7 | 2022-05-31 06:49:15 +0530 | [diff] [blame] | 159 | write32(&mdp_ctl->ctl_intf_flush, INTF_FLUSH); |
Vinod Polimera | 3b4c45e | 2020-03-03 12:13:26 +0530 | [diff] [blame] | 160 | write32(&mdp_ctl->ctl_flush, ctl0_reg_val); |
| 161 | } |