116 static void mtk_dpi_mask(struct mtk_dpi *dpi, u32 offset, u32 val, u32 mask)  in mtk_dpi_mask()  argument
118 	u32 tmp = readl(dpi->regs + offset) & ~mask;  in mtk_dpi_mask()
121 	writel(tmp, dpi->regs + offset);  in mtk_dpi_mask()
124 static void mtk_dpi_sw_reset(struct mtk_dpi *dpi, bool reset)  in mtk_dpi_sw_reset()  argument
126 	mtk_dpi_mask(dpi, DPI_RET, reset ? RST : 0, RST);  in mtk_dpi_sw_reset()
129 static void mtk_dpi_enable(struct mtk_dpi *dpi)  in mtk_dpi_enable()  argument
131 	mtk_dpi_mask(dpi, DPI_EN, EN, EN);  in mtk_dpi_enable()
134 static void mtk_dpi_disable(struct mtk_dpi *dpi)  in mtk_dpi_disable()  argument
136 	mtk_dpi_mask(dpi, DPI_EN, 0, EN);  in mtk_dpi_disable()
139 static void mtk_dpi_config_hsync(struct mtk_dpi *dpi,  in mtk_dpi_config_hsync()  argument
142 	mtk_dpi_mask(dpi, DPI_TGEN_HWIDTH,  in mtk_dpi_config_hsync()
144 	mtk_dpi_mask(dpi, DPI_TGEN_HPORCH,  in mtk_dpi_config_hsync()
146 	mtk_dpi_mask(dpi, DPI_TGEN_HPORCH, sync->front_porch << HFP,  in mtk_dpi_config_hsync()
150 static void mtk_dpi_config_vsync(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync()  argument
154 	mtk_dpi_mask(dpi, width_addr,  in mtk_dpi_config_vsync()
157 	mtk_dpi_mask(dpi, width_addr,  in mtk_dpi_config_vsync()
160 	mtk_dpi_mask(dpi, porch_addr,  in mtk_dpi_config_vsync()
163 	mtk_dpi_mask(dpi, porch_addr,  in mtk_dpi_config_vsync()
168 static void mtk_dpi_config_vsync_lodd(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_lodd()  argument
171 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH, DPI_TGEN_VPORCH);  in mtk_dpi_config_vsync_lodd()
174 static void mtk_dpi_config_vsync_leven(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_leven()  argument
177 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH_LEVEN,  in mtk_dpi_config_vsync_leven()
181 static void mtk_dpi_config_vsync_rodd(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_rodd()  argument
184 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH_RODD,  in mtk_dpi_config_vsync_rodd()
188 static void mtk_dpi_config_vsync_reven(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_reven()  argument
191 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH_REVEN,  in mtk_dpi_config_vsync_reven()
195 static void mtk_dpi_config_pol(struct mtk_dpi *dpi,  in mtk_dpi_config_pol()  argument
204 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, pol,  in mtk_dpi_config_pol()
208 static void mtk_dpi_config_3d(struct mtk_dpi *dpi, bool en_3d)  in mtk_dpi_config_3d()  argument
210 	mtk_dpi_mask(dpi, DPI_CON, en_3d ? TDFP_EN : 0, TDFP_EN);  in mtk_dpi_config_3d()
213 static void mtk_dpi_config_interface(struct mtk_dpi *dpi, bool inter)  in mtk_dpi_config_interface()  argument
215 	mtk_dpi_mask(dpi, DPI_CON, inter ? INTL_EN : 0, INTL_EN);  in mtk_dpi_config_interface()
218 static void mtk_dpi_config_fb_size(struct mtk_dpi *dpi, u32 width, u32 height)  in mtk_dpi_config_fb_size()  argument
220 	mtk_dpi_mask(dpi, DPI_SIZE, width << HSIZE, HSIZE_MASK);  in mtk_dpi_config_fb_size()
221 	mtk_dpi_mask(dpi, DPI_SIZE, height << VSIZE, VSIZE_MASK);  in mtk_dpi_config_fb_size()
224 static void mtk_dpi_config_channel_limit(struct mtk_dpi *dpi,  in mtk_dpi_config_channel_limit()  argument
227 	mtk_dpi_mask(dpi, DPI_Y_LIMIT, limit->y_bottom << Y_LIMINT_BOT,  in mtk_dpi_config_channel_limit()
229 	mtk_dpi_mask(dpi, DPI_Y_LIMIT, limit->y_top << Y_LIMINT_TOP,  in mtk_dpi_config_channel_limit()
231 	mtk_dpi_mask(dpi, DPI_C_LIMIT, limit->c_bottom << C_LIMIT_BOT,  in mtk_dpi_config_channel_limit()
233 	mtk_dpi_mask(dpi, DPI_C_LIMIT, limit->c_top << C_LIMIT_TOP,  in mtk_dpi_config_channel_limit()
237 static void mtk_dpi_config_bit_num(struct mtk_dpi *dpi,  in mtk_dpi_config_bit_num()  argument
259 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, val << OUT_BIT,  in mtk_dpi_config_bit_num()
263 static void mtk_dpi_config_yc_map(struct mtk_dpi *dpi,  in mtk_dpi_config_yc_map()  argument
289 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, val << YC_MAP, YC_MAP_MASK);  in mtk_dpi_config_yc_map()
292 static void mtk_dpi_config_channel_swap(struct mtk_dpi *dpi,  in mtk_dpi_config_channel_swap()  argument
321 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, val << CH_SWAP, CH_SWAP_MASK);  in mtk_dpi_config_channel_swap()
324 static void mtk_dpi_config_yuv422_enable(struct mtk_dpi *dpi, bool enable)  in mtk_dpi_config_yuv422_enable()  argument
326 	mtk_dpi_mask(dpi, DPI_CON, enable ? YUV422_EN : 0, YUV422_EN);  in mtk_dpi_config_yuv422_enable()
329 static void mtk_dpi_config_csc_enable(struct mtk_dpi *dpi, bool enable)  in mtk_dpi_config_csc_enable()  argument
331 	mtk_dpi_mask(dpi, DPI_CON, enable ? CSC_ENABLE : 0, CSC_ENABLE);  in mtk_dpi_config_csc_enable()
334 static void mtk_dpi_config_swap_input(struct mtk_dpi *dpi, bool enable)  in mtk_dpi_config_swap_input()  argument
336 	mtk_dpi_mask(dpi, DPI_CON, enable ? IN_RB_SWAP : 0, IN_RB_SWAP);  in mtk_dpi_config_swap_input()
339 static void mtk_dpi_config_2n_h_fre(struct mtk_dpi *dpi)  in mtk_dpi_config_2n_h_fre()  argument
341 	mtk_dpi_mask(dpi, dpi->conf->reg_h_fre_con, H_FRE_2N, H_FRE_2N);  in mtk_dpi_config_2n_h_fre()
344 static void mtk_dpi_config_disable_edge(struct mtk_dpi *dpi)  in mtk_dpi_config_disable_edge()  argument
346 	if (dpi->conf->edge_sel_en)  in mtk_dpi_config_disable_edge()
347 		mtk_dpi_mask(dpi, dpi->conf->reg_h_fre_con, 0, EDGE_SEL_EN);  in mtk_dpi_config_disable_edge()
350 static void mtk_dpi_config_color_format(struct mtk_dpi *dpi,  in mtk_dpi_config_color_format()  argument
355 		mtk_dpi_config_yuv422_enable(dpi, false);  in mtk_dpi_config_color_format()
356 		mtk_dpi_config_csc_enable(dpi, true);  in mtk_dpi_config_color_format()
357 		mtk_dpi_config_swap_input(dpi, false);  in mtk_dpi_config_color_format()
358 		mtk_dpi_config_channel_swap(dpi, MTK_DPI_OUT_CHANNEL_SWAP_BGR);  in mtk_dpi_config_color_format()
361 		mtk_dpi_config_yuv422_enable(dpi, true);  in mtk_dpi_config_color_format()
362 		mtk_dpi_config_csc_enable(dpi, true);  in mtk_dpi_config_color_format()
363 		mtk_dpi_config_swap_input(dpi, true);  in mtk_dpi_config_color_format()
364 		mtk_dpi_config_channel_swap(dpi, MTK_DPI_OUT_CHANNEL_SWAP_RGB);  in mtk_dpi_config_color_format()
366 		mtk_dpi_config_yuv422_enable(dpi, false);  in mtk_dpi_config_color_format()
367 		mtk_dpi_config_csc_enable(dpi, false);  in mtk_dpi_config_color_format()
368 		mtk_dpi_config_swap_input(dpi, false);  in mtk_dpi_config_color_format()
369 		mtk_dpi_config_channel_swap(dpi, MTK_DPI_OUT_CHANNEL_SWAP_RGB);  in mtk_dpi_config_color_format()
373 static void mtk_dpi_power_off(struct mtk_dpi *dpi)  in mtk_dpi_power_off()  argument
375 	if (WARN_ON(dpi->refcount == 0))  in mtk_dpi_power_off()
378 	if (--dpi->refcount != 0)  in mtk_dpi_power_off()
381 	mtk_dpi_disable(dpi);  in mtk_dpi_power_off()
382 	clk_disable_unprepare(dpi->pixel_clk);  in mtk_dpi_power_off()
383 	clk_disable_unprepare(dpi->engine_clk);  in mtk_dpi_power_off()
386 static int mtk_dpi_power_on(struct mtk_dpi *dpi)  in mtk_dpi_power_on()  argument
390 	if (++dpi->refcount != 1)  in mtk_dpi_power_on()
393 	ret = clk_prepare_enable(dpi->engine_clk);  in mtk_dpi_power_on()
395 		dev_err(dpi->dev, "Failed to enable engine clock: %d\n", ret);  in mtk_dpi_power_on()
399 	ret = clk_prepare_enable(dpi->pixel_clk);  in mtk_dpi_power_on()
401 		dev_err(dpi->dev, "Failed to enable pixel clock: %d\n", ret);  in mtk_dpi_power_on()
405 	mtk_dpi_enable(dpi);  in mtk_dpi_power_on()
409 	clk_disable_unprepare(dpi->engine_clk);  in mtk_dpi_power_on()
411 	dpi->refcount--;  in mtk_dpi_power_on()
415 static int mtk_dpi_set_display_mode(struct mtk_dpi *dpi,  in mtk_dpi_set_display_mode()  argument
430 	factor = dpi->conf->cal_factor(mode->clock);  in mtk_dpi_set_display_mode()
434 	dev_dbg(dpi->dev, "Want PLL %lu Hz, pixel clock %lu Hz\n",  in mtk_dpi_set_display_mode()
437 	clk_set_rate(dpi->tvd_clk, pll_rate);  in mtk_dpi_set_display_mode()
438 	pll_rate = clk_get_rate(dpi->tvd_clk);  in mtk_dpi_set_display_mode()
441 	clk_set_rate(dpi->pixel_clk, vm.pixelclock);  in mtk_dpi_set_display_mode()
442 	vm.pixelclock = clk_get_rate(dpi->pixel_clk);  in mtk_dpi_set_display_mode()
444 	dev_dbg(dpi->dev, "Got  PLL %lu Hz, pixel clock %lu Hz\n",  in mtk_dpi_set_display_mode()
482 	mtk_dpi_sw_reset(dpi, true);  in mtk_dpi_set_display_mode()
483 	mtk_dpi_config_pol(dpi, &dpi_pol);  in mtk_dpi_set_display_mode()
485 	mtk_dpi_config_hsync(dpi, &hsync);  in mtk_dpi_set_display_mode()
486 	mtk_dpi_config_vsync_lodd(dpi, &vsync_lodd);  in mtk_dpi_set_display_mode()
487 	mtk_dpi_config_vsync_rodd(dpi, &vsync_rodd);  in mtk_dpi_set_display_mode()
488 	mtk_dpi_config_vsync_leven(dpi, &vsync_leven);  in mtk_dpi_set_display_mode()
489 	mtk_dpi_config_vsync_reven(dpi, &vsync_reven);  in mtk_dpi_set_display_mode()
491 	mtk_dpi_config_3d(dpi, !!(mode->flags & DRM_MODE_FLAG_3D_MASK));  in mtk_dpi_set_display_mode()
492 	mtk_dpi_config_interface(dpi, !!(vm.flags &  in mtk_dpi_set_display_mode()
495 		mtk_dpi_config_fb_size(dpi, vm.hactive, vm.vactive >> 1);  in mtk_dpi_set_display_mode()
497 		mtk_dpi_config_fb_size(dpi, vm.hactive, vm.vactive);  in mtk_dpi_set_display_mode()
499 	mtk_dpi_config_channel_limit(dpi, &limit);  in mtk_dpi_set_display_mode()
500 	mtk_dpi_config_bit_num(dpi, dpi->bit_num);  in mtk_dpi_set_display_mode()
501 	mtk_dpi_config_channel_swap(dpi, dpi->channel_swap);  in mtk_dpi_set_display_mode()
502 	mtk_dpi_config_yc_map(dpi, dpi->yc_map);  in mtk_dpi_set_display_mode()
503 	mtk_dpi_config_color_format(dpi, dpi->color_format);  in mtk_dpi_set_display_mode()
504 	mtk_dpi_config_2n_h_fre(dpi);  in mtk_dpi_set_display_mode()
505 	mtk_dpi_config_disable_edge(dpi);  in mtk_dpi_set_display_mode()
506 	mtk_dpi_sw_reset(dpi, false);  in mtk_dpi_set_display_mode()
531 	struct mtk_dpi *dpi = mtk_dpi_from_encoder(encoder);  in mtk_dpi_encoder_mode_set()  local
533 	drm_mode_copy(&dpi->mode, adjusted_mode);  in mtk_dpi_encoder_mode_set()
538 	struct mtk_dpi *dpi = mtk_dpi_from_encoder(encoder);  in mtk_dpi_encoder_disable()  local
540 	mtk_dpi_power_off(dpi);  in mtk_dpi_encoder_disable()
545 	struct mtk_dpi *dpi = mtk_dpi_from_encoder(encoder);  in mtk_dpi_encoder_enable()  local
547 	mtk_dpi_power_on(dpi);  in mtk_dpi_encoder_enable()
548 	mtk_dpi_set_display_mode(dpi, &dpi->mode);  in mtk_dpi_encoder_enable()
568 	struct mtk_dpi *dpi = container_of(comp, struct mtk_dpi, ddp_comp);  in mtk_dpi_start()  local
570 	mtk_dpi_power_on(dpi);  in mtk_dpi_start()
575 	struct mtk_dpi *dpi = container_of(comp, struct mtk_dpi, ddp_comp);  in mtk_dpi_stop()  local
577 	mtk_dpi_power_off(dpi);  in mtk_dpi_stop()
587 	struct mtk_dpi *dpi = dev_get_drvdata(dev);  in mtk_dpi_bind()  local
591 	ret = mtk_ddp_comp_register(drm_dev, &dpi->ddp_comp);  in mtk_dpi_bind()
598 	ret = drm_encoder_init(drm_dev, &dpi->encoder, &mtk_dpi_encoder_funcs,  in mtk_dpi_bind()
604 	drm_encoder_helper_add(&dpi->encoder, &mtk_dpi_encoder_helper_funcs);  in mtk_dpi_bind()
607 	dpi->encoder.possible_crtcs = BIT(1);  in mtk_dpi_bind()
609 	ret = drm_bridge_attach(&dpi->encoder, dpi->bridge, NULL);  in mtk_dpi_bind()
615 	dpi->bit_num = MTK_DPI_OUT_BIT_NUM_8BITS;  in mtk_dpi_bind()
616 	dpi->channel_swap = MTK_DPI_OUT_CHANNEL_SWAP_RGB;  in mtk_dpi_bind()
617 	dpi->yc_map = MTK_DPI_OUT_YC_MAP_RGB;  in mtk_dpi_bind()
618 	dpi->color_format = MTK_DPI_COLOR_FORMAT_RGB;  in mtk_dpi_bind()
623 	drm_encoder_cleanup(&dpi->encoder);  in mtk_dpi_bind()
625 	mtk_ddp_comp_unregister(drm_dev, &dpi->ddp_comp);  in mtk_dpi_bind()
632 	struct mtk_dpi *dpi = dev_get_drvdata(dev);  in mtk_dpi_unbind()  local
635 	drm_encoder_cleanup(&dpi->encoder);  in mtk_dpi_unbind()
636 	mtk_ddp_comp_unregister(drm_dev, &dpi->ddp_comp);  in mtk_dpi_unbind()
680 	struct mtk_dpi *dpi;  in mtk_dpi_probe()  local
685 	dpi = devm_kzalloc(dev, sizeof(*dpi), GFP_KERNEL);  in mtk_dpi_probe()
686 	if (!dpi)  in mtk_dpi_probe()
689 	dpi->dev = dev;  in mtk_dpi_probe()
690 	dpi->conf = (struct mtk_dpi_conf *)of_device_get_match_data(dev);  in mtk_dpi_probe()
693 	dpi->regs = devm_ioremap_resource(dev, mem);  in mtk_dpi_probe()
694 	if (IS_ERR(dpi->regs)) {  in mtk_dpi_probe()
695 		ret = PTR_ERR(dpi->regs);  in mtk_dpi_probe()
700 	dpi->engine_clk = devm_clk_get(dev, "engine");  in mtk_dpi_probe()
701 	if (IS_ERR(dpi->engine_clk)) {  in mtk_dpi_probe()
702 		ret = PTR_ERR(dpi->engine_clk);  in mtk_dpi_probe()
707 	dpi->pixel_clk = devm_clk_get(dev, "pixel");  in mtk_dpi_probe()
708 	if (IS_ERR(dpi->pixel_clk)) {  in mtk_dpi_probe()
709 		ret = PTR_ERR(dpi->pixel_clk);  in mtk_dpi_probe()
714 	dpi->tvd_clk = devm_clk_get(dev, "pll");  in mtk_dpi_probe()
715 	if (IS_ERR(dpi->tvd_clk)) {  in mtk_dpi_probe()
716 		ret = PTR_ERR(dpi->tvd_clk);  in mtk_dpi_probe()
721 	dpi->irq = platform_get_irq(pdev, 0);  in mtk_dpi_probe()
722 	if (dpi->irq <= 0) {  in mtk_dpi_probe()
723 		dev_err(dev, "Failed to get irq: %d\n", dpi->irq);  in mtk_dpi_probe()
728 					  NULL, &dpi->bridge);  in mtk_dpi_probe()
732 	dev_info(dev, "Found bridge node: %pOF\n", dpi->bridge->of_node);  in mtk_dpi_probe()
740 	ret = mtk_ddp_comp_init(dev, dev->of_node, &dpi->ddp_comp, comp_id,  in mtk_dpi_probe()
747 	platform_set_drvdata(pdev, dpi);  in mtk_dpi_probe()