| /* SPDX-License-Identifier: GPL-2.0-only */ |
| |
| #include <device/mmio.h> |
| #include <edid.h> |
| #include <soc/addressmap.h> |
| #include <soc/ddp.h> |
| #include <types.h> |
| |
| static void disp_config_main_path_connection(void) |
| { |
| write32(&mmsys_cfg->disp_ovl0_mout_en, OVL0_MOUT_EN_COLOR0); |
| write32(&mmsys_cfg->disp_color0_sel_in, COLOR0_SEL_IN_OVL0); |
| write32(&mmsys_cfg->disp_od_mout_en, OD_MOUT_EN_RDMA0); |
| write32(&mmsys_cfg->disp_ufoe_mout_en, UFOE_MOUT_EN_DSI0); |
| write32(&mmsys_cfg->dsi0_sel_in, DSI0_SEL_IN_UFOE); |
| } |
| |
| static void disp_config_main_path_mutex(void) |
| { |
| write32(&disp_mutex->mutex[0].mod, MUTEX_MOD_MAIN_PATH); |
| |
| /* Clock source from DSI0 */ |
| write32(&disp_mutex->mutex[0].sof, BIT(0)); |
| write32(&disp_mutex->mutex[0].en, BIT(0)); |
| } |
| |
| static void od_start(u32 width, u32 height) |
| { |
| write32(&disp_od->size, width << 16 | height); |
| write32(&disp_od->cfg, OD_RELAY_MODE); |
| |
| write32(&disp_od->en, 1); |
| } |
| |
| static void main_disp_path_setup(u32 width, u32 height, u32 pixel_clk) |
| { |
| ovl_set_roi(0, width, height, 0); |
| rdma_config(width, height, pixel_clk, 8 * KiB); |
| od_start(width, height); |
| write32(&disp_ufoe->start, UFO_BYPASS); |
| color_start(width, height); |
| disp_config_main_path_connection(); |
| disp_config_main_path_mutex(); |
| } |
| |
| static void disp_clock_on(void) |
| { |
| clrbits32(&mmsys_cfg->mmsys_cg_con0, CG_CON0_SMI_COMMON | |
| CG_CON0_SMI_LARB0 | |
| CG_CON0_MUTEX_32K | |
| CG_CON0_DISP_OVL0 | |
| CG_CON0_DISP_RDMA0 | |
| CG_CON0_DISP_COLOR0 | |
| CG_CON0_DISP_UFOE | |
| CG_CON0_DISP_OD); |
| |
| clrbits32(&mmsys_cfg->mmsys_cg_con1, CG_CON1_DSI0_ENGINE | |
| CG_CON1_DSI0_DIGITAL); |
| } |
| |
| void mtk_ddp_init(void) |
| { |
| disp_clock_on(); |
| } |
| |
| void mtk_ddp_mode_set(const struct edid *edid) |
| { |
| u32 fmt = OVL_INFMT_RGBA8888; |
| u32 bpp = edid->framebuffer_bits_per_pixel / 8; |
| |
| main_disp_path_setup(edid->mode.ha, edid->mode.va, |
| edid->mode.pixel_clock); |
| |
| rdma_start(); |
| ovl_layer_config(fmt, bpp, edid->mode.ha, edid->mode.va); |
| } |