119 static void mtk_dpi_mask(struct mtk_dpi *dpi, u32 offset, u32 val, u32 mask)  in mtk_dpi_mask()  argument
121 	u32 tmp = readl(dpi->regs + offset) & ~mask;  in mtk_dpi_mask()
124 	writel(tmp, dpi->regs + offset);  in mtk_dpi_mask()
127 static void mtk_dpi_sw_reset(struct mtk_dpi *dpi, bool reset)  in mtk_dpi_sw_reset()  argument
129 	mtk_dpi_mask(dpi, DPI_RET, reset ? RST : 0, RST);  in mtk_dpi_sw_reset()
132 static void mtk_dpi_enable(struct mtk_dpi *dpi)  in mtk_dpi_enable()  argument
134 	mtk_dpi_mask(dpi, DPI_EN, EN, EN);  in mtk_dpi_enable()
137 static void mtk_dpi_disable(struct mtk_dpi *dpi)  in mtk_dpi_disable()  argument
139 	mtk_dpi_mask(dpi, DPI_EN, 0, EN);  in mtk_dpi_disable()
142 static void mtk_dpi_config_hsync(struct mtk_dpi *dpi,  in mtk_dpi_config_hsync()  argument
145 	mtk_dpi_mask(dpi, DPI_TGEN_HWIDTH,  in mtk_dpi_config_hsync()
147 	mtk_dpi_mask(dpi, DPI_TGEN_HPORCH,  in mtk_dpi_config_hsync()
149 	mtk_dpi_mask(dpi, DPI_TGEN_HPORCH, sync->front_porch << HFP,  in mtk_dpi_config_hsync()
153 static void mtk_dpi_config_vsync(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync()  argument
157 	mtk_dpi_mask(dpi, width_addr,  in mtk_dpi_config_vsync()
160 	mtk_dpi_mask(dpi, width_addr,  in mtk_dpi_config_vsync()
163 	mtk_dpi_mask(dpi, porch_addr,  in mtk_dpi_config_vsync()
166 	mtk_dpi_mask(dpi, porch_addr,  in mtk_dpi_config_vsync()
171 static void mtk_dpi_config_vsync_lodd(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_lodd()  argument
174 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH, DPI_TGEN_VPORCH);  in mtk_dpi_config_vsync_lodd()
177 static void mtk_dpi_config_vsync_leven(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_leven()  argument
180 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH_LEVEN,  in mtk_dpi_config_vsync_leven()
184 static void mtk_dpi_config_vsync_rodd(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_rodd()  argument
187 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH_RODD,  in mtk_dpi_config_vsync_rodd()
191 static void mtk_dpi_config_vsync_reven(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_reven()  argument
194 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH_REVEN,  in mtk_dpi_config_vsync_reven()
198 static void mtk_dpi_config_pol(struct mtk_dpi *dpi,  in mtk_dpi_config_pol()  argument
207 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, pol,  in mtk_dpi_config_pol()
211 static void mtk_dpi_config_3d(struct mtk_dpi *dpi, bool en_3d)  in mtk_dpi_config_3d()  argument
213 	mtk_dpi_mask(dpi, DPI_CON, en_3d ? TDFP_EN : 0, TDFP_EN);  in mtk_dpi_config_3d()
216 static void mtk_dpi_config_interface(struct mtk_dpi *dpi, bool inter)  in mtk_dpi_config_interface()  argument
218 	mtk_dpi_mask(dpi, DPI_CON, inter ? INTL_EN : 0, INTL_EN);  in mtk_dpi_config_interface()
221 static void mtk_dpi_config_fb_size(struct mtk_dpi *dpi, u32 width, u32 height)  in mtk_dpi_config_fb_size()  argument
223 	mtk_dpi_mask(dpi, DPI_SIZE, width << HSIZE, HSIZE_MASK);  in mtk_dpi_config_fb_size()
224 	mtk_dpi_mask(dpi, DPI_SIZE, height << VSIZE, VSIZE_MASK);  in mtk_dpi_config_fb_size()
227 static void mtk_dpi_config_channel_limit(struct mtk_dpi *dpi,  in mtk_dpi_config_channel_limit()  argument
230 	mtk_dpi_mask(dpi, DPI_Y_LIMIT, limit->y_bottom << Y_LIMINT_BOT,  in mtk_dpi_config_channel_limit()
232 	mtk_dpi_mask(dpi, DPI_Y_LIMIT, limit->y_top << Y_LIMINT_TOP,  in mtk_dpi_config_channel_limit()
234 	mtk_dpi_mask(dpi, DPI_C_LIMIT, limit->c_bottom << C_LIMIT_BOT,  in mtk_dpi_config_channel_limit()
236 	mtk_dpi_mask(dpi, DPI_C_LIMIT, limit->c_top << C_LIMIT_TOP,  in mtk_dpi_config_channel_limit()
240 static void mtk_dpi_config_bit_num(struct mtk_dpi *dpi,  in mtk_dpi_config_bit_num()  argument
262 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, val << OUT_BIT,  in mtk_dpi_config_bit_num()
266 static void mtk_dpi_config_yc_map(struct mtk_dpi *dpi,  in mtk_dpi_config_yc_map()  argument
292 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, val << YC_MAP, YC_MAP_MASK);  in mtk_dpi_config_yc_map()
295 static void mtk_dpi_config_channel_swap(struct mtk_dpi *dpi,  in mtk_dpi_config_channel_swap()  argument
324 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, val << CH_SWAP, CH_SWAP_MASK);  in mtk_dpi_config_channel_swap()
327 static void mtk_dpi_config_yuv422_enable(struct mtk_dpi *dpi, bool enable)  in mtk_dpi_config_yuv422_enable()  argument
329 	mtk_dpi_mask(dpi, DPI_CON, enable ? YUV422_EN : 0, YUV422_EN);  in mtk_dpi_config_yuv422_enable()
332 static void mtk_dpi_config_csc_enable(struct mtk_dpi *dpi, bool enable)  in mtk_dpi_config_csc_enable()  argument
334 	mtk_dpi_mask(dpi, DPI_CON, enable ? CSC_ENABLE : 0, CSC_ENABLE);  in mtk_dpi_config_csc_enable()
337 static void mtk_dpi_config_swap_input(struct mtk_dpi *dpi, bool enable)  in mtk_dpi_config_swap_input()  argument
339 	mtk_dpi_mask(dpi, DPI_CON, enable ? IN_RB_SWAP : 0, IN_RB_SWAP);  in mtk_dpi_config_swap_input()
342 static void mtk_dpi_config_2n_h_fre(struct mtk_dpi *dpi)  in mtk_dpi_config_2n_h_fre()  argument
344 	mtk_dpi_mask(dpi, DPI_H_FRE_CON, H_FRE_2N, H_FRE_2N);  in mtk_dpi_config_2n_h_fre()
347 static void mtk_dpi_config_color_format(struct mtk_dpi *dpi,  in mtk_dpi_config_color_format()  argument
352 		mtk_dpi_config_yuv422_enable(dpi, false);  in mtk_dpi_config_color_format()
353 		mtk_dpi_config_csc_enable(dpi, true);  in mtk_dpi_config_color_format()
354 		mtk_dpi_config_swap_input(dpi, false);  in mtk_dpi_config_color_format()
355 		mtk_dpi_config_channel_swap(dpi, MTK_DPI_OUT_CHANNEL_SWAP_BGR);  in mtk_dpi_config_color_format()
358 		mtk_dpi_config_yuv422_enable(dpi, true);  in mtk_dpi_config_color_format()
359 		mtk_dpi_config_csc_enable(dpi, true);  in mtk_dpi_config_color_format()
360 		mtk_dpi_config_swap_input(dpi, true);  in mtk_dpi_config_color_format()
361 		mtk_dpi_config_channel_swap(dpi, MTK_DPI_OUT_CHANNEL_SWAP_RGB);  in mtk_dpi_config_color_format()
363 		mtk_dpi_config_yuv422_enable(dpi, false);  in mtk_dpi_config_color_format()
364 		mtk_dpi_config_csc_enable(dpi, false);  in mtk_dpi_config_color_format()
365 		mtk_dpi_config_swap_input(dpi, false);  in mtk_dpi_config_color_format()
366 		mtk_dpi_config_channel_swap(dpi, MTK_DPI_OUT_CHANNEL_SWAP_RGB);  in mtk_dpi_config_color_format()
370 static void mtk_dpi_power_off(struct mtk_dpi *dpi, enum mtk_dpi_power_ctl pctl)  in mtk_dpi_power_off()  argument
372 	dpi->power_ctl &= ~pctl;  in mtk_dpi_power_off()
374 	if ((dpi->power_ctl & DPI_POWER_START) ||  in mtk_dpi_power_off()
375 	    (dpi->power_ctl & DPI_POWER_ENABLE))  in mtk_dpi_power_off()
378 	if (!dpi->power_sta)  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()
384 	dpi->power_sta = false;  in mtk_dpi_power_off()
387 static int mtk_dpi_power_on(struct mtk_dpi *dpi, enum mtk_dpi_power_ctl pctl)  in mtk_dpi_power_on()  argument
391 	dpi->power_ctl |= pctl;  in mtk_dpi_power_on()
393 	if (!(dpi->power_ctl & DPI_POWER_START) &&  in mtk_dpi_power_on()
394 	    !(dpi->power_ctl & DPI_POWER_ENABLE))  in mtk_dpi_power_on()
397 	if (dpi->power_sta)  in mtk_dpi_power_on()
400 	ret = clk_prepare_enable(dpi->engine_clk);  in mtk_dpi_power_on()
402 		dev_err(dpi->dev, "Failed to enable engine clock: %d\n", ret);  in mtk_dpi_power_on()
406 	ret = clk_prepare_enable(dpi->pixel_clk);  in mtk_dpi_power_on()
408 		dev_err(dpi->dev, "Failed to enable pixel clock: %d\n", ret);  in mtk_dpi_power_on()
412 	mtk_dpi_enable(dpi);  in mtk_dpi_power_on()
413 	dpi->power_sta = true;  in mtk_dpi_power_on()
417 	clk_disable_unprepare(dpi->engine_clk);  in mtk_dpi_power_on()
419 	dpi->power_ctl &= ~pctl;  in mtk_dpi_power_on()
423 static int mtk_dpi_set_display_mode(struct mtk_dpi *dpi,  in mtk_dpi_set_display_mode()  argument
450 	dev_dbg(dpi->dev, "Want PLL %lu Hz, pixel clock %lu Hz\n",  in mtk_dpi_set_display_mode()
453 	clk_set_rate(dpi->tvd_clk, pll_rate);  in mtk_dpi_set_display_mode()
454 	pll_rate = clk_get_rate(dpi->tvd_clk);  in mtk_dpi_set_display_mode()
457 	clk_set_rate(dpi->pixel_clk, vm.pixelclock);  in mtk_dpi_set_display_mode()
458 	vm.pixelclock = clk_get_rate(dpi->pixel_clk);  in mtk_dpi_set_display_mode()
460 	dev_dbg(dpi->dev, "Got  PLL %lu Hz, pixel clock %lu Hz\n",  in mtk_dpi_set_display_mode()
498 	mtk_dpi_sw_reset(dpi, true);  in mtk_dpi_set_display_mode()
499 	mtk_dpi_config_pol(dpi, &dpi_pol);  in mtk_dpi_set_display_mode()
501 	mtk_dpi_config_hsync(dpi, &hsync);  in mtk_dpi_set_display_mode()
502 	mtk_dpi_config_vsync_lodd(dpi, &vsync_lodd);  in mtk_dpi_set_display_mode()
503 	mtk_dpi_config_vsync_rodd(dpi, &vsync_rodd);  in mtk_dpi_set_display_mode()
504 	mtk_dpi_config_vsync_leven(dpi, &vsync_leven);  in mtk_dpi_set_display_mode()
505 	mtk_dpi_config_vsync_reven(dpi, &vsync_reven);  in mtk_dpi_set_display_mode()
507 	mtk_dpi_config_3d(dpi, !!(mode->flags & DRM_MODE_FLAG_3D_MASK));  in mtk_dpi_set_display_mode()
508 	mtk_dpi_config_interface(dpi, !!(vm.flags &  in mtk_dpi_set_display_mode()
511 		mtk_dpi_config_fb_size(dpi, vm.hactive, vm.vactive >> 1);  in mtk_dpi_set_display_mode()
513 		mtk_dpi_config_fb_size(dpi, vm.hactive, vm.vactive);  in mtk_dpi_set_display_mode()
515 	mtk_dpi_config_channel_limit(dpi, &limit);  in mtk_dpi_set_display_mode()
516 	mtk_dpi_config_bit_num(dpi, dpi->bit_num);  in mtk_dpi_set_display_mode()
517 	mtk_dpi_config_channel_swap(dpi, dpi->channel_swap);  in mtk_dpi_set_display_mode()
518 	mtk_dpi_config_yc_map(dpi, dpi->yc_map);  in mtk_dpi_set_display_mode()
519 	mtk_dpi_config_color_format(dpi, dpi->color_format);  in mtk_dpi_set_display_mode()
520 	mtk_dpi_config_2n_h_fre(dpi);  in mtk_dpi_set_display_mode()
521 	mtk_dpi_sw_reset(dpi, false);  in mtk_dpi_set_display_mode()
546 	struct mtk_dpi *dpi = mtk_dpi_from_encoder(encoder);  in mtk_dpi_encoder_mode_set()  local
548 	drm_mode_copy(&dpi->mode, adjusted_mode);  in mtk_dpi_encoder_mode_set()
553 	struct mtk_dpi *dpi = mtk_dpi_from_encoder(encoder);  in mtk_dpi_encoder_disable()  local
555 	mtk_dpi_power_off(dpi, DPI_POWER_ENABLE);  in mtk_dpi_encoder_disable()
560 	struct mtk_dpi *dpi = mtk_dpi_from_encoder(encoder);  in mtk_dpi_encoder_enable()  local
562 	mtk_dpi_power_on(dpi, DPI_POWER_ENABLE);  in mtk_dpi_encoder_enable()
563 	mtk_dpi_set_display_mode(dpi, &dpi->mode);  in mtk_dpi_encoder_enable()
583 	struct mtk_dpi *dpi = container_of(comp, struct mtk_dpi, ddp_comp);  in mtk_dpi_start()  local
585 	mtk_dpi_power_on(dpi, DPI_POWER_START);  in mtk_dpi_start()
590 	struct mtk_dpi *dpi = container_of(comp, struct mtk_dpi, ddp_comp);  in mtk_dpi_stop()  local
592 	mtk_dpi_power_off(dpi, DPI_POWER_START);  in mtk_dpi_stop()
602 	struct mtk_dpi *dpi = dev_get_drvdata(dev);  in mtk_dpi_bind()  local
606 	ret = mtk_ddp_comp_register(drm_dev, &dpi->ddp_comp);  in mtk_dpi_bind()
613 	ret = drm_encoder_init(drm_dev, &dpi->encoder, &mtk_dpi_encoder_funcs,  in mtk_dpi_bind()
619 	drm_encoder_helper_add(&dpi->encoder, &mtk_dpi_encoder_helper_funcs);  in mtk_dpi_bind()
622 	dpi->encoder.possible_crtcs = BIT(1);  in mtk_dpi_bind()
624 	ret = drm_bridge_attach(&dpi->encoder, dpi->bridge, NULL);  in mtk_dpi_bind()
630 	dpi->bit_num = MTK_DPI_OUT_BIT_NUM_8BITS;  in mtk_dpi_bind()
631 	dpi->channel_swap = MTK_DPI_OUT_CHANNEL_SWAP_RGB;  in mtk_dpi_bind()
632 	dpi->yc_map = MTK_DPI_OUT_YC_MAP_RGB;  in mtk_dpi_bind()
633 	dpi->color_format = MTK_DPI_COLOR_FORMAT_RGB;  in mtk_dpi_bind()
638 	drm_encoder_cleanup(&dpi->encoder);  in mtk_dpi_bind()
640 	mtk_ddp_comp_unregister(drm_dev, &dpi->ddp_comp);  in mtk_dpi_bind()
647 	struct mtk_dpi *dpi = dev_get_drvdata(dev);  in mtk_dpi_unbind()  local
650 	drm_encoder_cleanup(&dpi->encoder);  in mtk_dpi_unbind()
651 	mtk_ddp_comp_unregister(drm_dev, &dpi->ddp_comp);  in mtk_dpi_unbind()
662 	struct mtk_dpi *dpi;  in mtk_dpi_probe()  local
668 	dpi = devm_kzalloc(dev, sizeof(*dpi), GFP_KERNEL);  in mtk_dpi_probe()
669 	if (!dpi)  in mtk_dpi_probe()
672 	dpi->dev = dev;  in mtk_dpi_probe()
675 	dpi->regs = devm_ioremap_resource(dev, mem);  in mtk_dpi_probe()
676 	if (IS_ERR(dpi->regs)) {  in mtk_dpi_probe()
677 		ret = PTR_ERR(dpi->regs);  in mtk_dpi_probe()
682 	dpi->engine_clk = devm_clk_get(dev, "engine");  in mtk_dpi_probe()
683 	if (IS_ERR(dpi->engine_clk)) {  in mtk_dpi_probe()
684 		ret = PTR_ERR(dpi->engine_clk);  in mtk_dpi_probe()
689 	dpi->pixel_clk = devm_clk_get(dev, "pixel");  in mtk_dpi_probe()
690 	if (IS_ERR(dpi->pixel_clk)) {  in mtk_dpi_probe()
691 		ret = PTR_ERR(dpi->pixel_clk);  in mtk_dpi_probe()
696 	dpi->tvd_clk = devm_clk_get(dev, "pll");  in mtk_dpi_probe()
697 	if (IS_ERR(dpi->tvd_clk)) {  in mtk_dpi_probe()
698 		ret = PTR_ERR(dpi->tvd_clk);  in mtk_dpi_probe()
703 	dpi->irq = platform_get_irq(pdev, 0);  in mtk_dpi_probe()
704 	if (dpi->irq <= 0) {  in mtk_dpi_probe()
705 		dev_err(dev, "Failed to get irq: %d\n", dpi->irq);  in mtk_dpi_probe()
715 	dpi->bridge = of_drm_find_bridge(bridge_node);  in mtk_dpi_probe()
717 	if (!dpi->bridge)  in mtk_dpi_probe()
726 	ret = mtk_ddp_comp_init(dev, dev->of_node, &dpi->ddp_comp, comp_id,  in mtk_dpi_probe()
733 	platform_set_drvdata(pdev, dpi);  in mtk_dpi_probe()
752 	{ .compatible = "mediatek,mt8173-dpi", },
760 		.name = "mediatek-dpi",