127 static void mtk_dpi_mask(struct mtk_dpi *dpi, u32 offset, u32 val, u32 mask)  in mtk_dpi_mask()  argument
129 	u32 tmp = readl(dpi->regs + offset) & ~mask;  in mtk_dpi_mask()
132 	writel(tmp, dpi->regs + offset);  in mtk_dpi_mask()
135 static void mtk_dpi_sw_reset(struct mtk_dpi *dpi, bool reset)  in mtk_dpi_sw_reset()  argument
137 	mtk_dpi_mask(dpi, DPI_RET, reset ? RST : 0, RST);  in mtk_dpi_sw_reset()
140 static void mtk_dpi_enable(struct mtk_dpi *dpi)  in mtk_dpi_enable()  argument
142 	mtk_dpi_mask(dpi, DPI_EN, EN, EN);  in mtk_dpi_enable()
145 static void mtk_dpi_disable(struct mtk_dpi *dpi)  in mtk_dpi_disable()  argument
147 	mtk_dpi_mask(dpi, DPI_EN, 0, EN);  in mtk_dpi_disable()
150 static void mtk_dpi_config_hsync(struct mtk_dpi *dpi,  in mtk_dpi_config_hsync()  argument
153 	mtk_dpi_mask(dpi, DPI_TGEN_HWIDTH,  in mtk_dpi_config_hsync()
155 	mtk_dpi_mask(dpi, DPI_TGEN_HPORCH,  in mtk_dpi_config_hsync()
157 	mtk_dpi_mask(dpi, DPI_TGEN_HPORCH, sync->front_porch << HFP,  in mtk_dpi_config_hsync()
161 static void mtk_dpi_config_vsync(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync()  argument
165 	mtk_dpi_mask(dpi, width_addr,  in mtk_dpi_config_vsync()
168 	mtk_dpi_mask(dpi, width_addr,  in mtk_dpi_config_vsync()
171 	mtk_dpi_mask(dpi, porch_addr,  in mtk_dpi_config_vsync()
174 	mtk_dpi_mask(dpi, porch_addr,  in mtk_dpi_config_vsync()
179 static void mtk_dpi_config_vsync_lodd(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_lodd()  argument
182 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH, DPI_TGEN_VPORCH);  in mtk_dpi_config_vsync_lodd()
185 static void mtk_dpi_config_vsync_leven(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_leven()  argument
188 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH_LEVEN,  in mtk_dpi_config_vsync_leven()
192 static void mtk_dpi_config_vsync_rodd(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_rodd()  argument
195 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH_RODD,  in mtk_dpi_config_vsync_rodd()
199 static void mtk_dpi_config_vsync_reven(struct mtk_dpi *dpi,  in mtk_dpi_config_vsync_reven()  argument
202 	mtk_dpi_config_vsync(dpi, sync, DPI_TGEN_VWIDTH_REVEN,  in mtk_dpi_config_vsync_reven()
206 static void mtk_dpi_config_pol(struct mtk_dpi *dpi,  in mtk_dpi_config_pol()  argument
215 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, pol,  in mtk_dpi_config_pol()
219 static void mtk_dpi_config_3d(struct mtk_dpi *dpi, bool en_3d)  in mtk_dpi_config_3d()  argument
221 	mtk_dpi_mask(dpi, DPI_CON, en_3d ? TDFP_EN : 0, TDFP_EN);  in mtk_dpi_config_3d()
224 static void mtk_dpi_config_interface(struct mtk_dpi *dpi, bool inter)  in mtk_dpi_config_interface()  argument
226 	mtk_dpi_mask(dpi, DPI_CON, inter ? INTL_EN : 0, INTL_EN);  in mtk_dpi_config_interface()
229 static void mtk_dpi_config_fb_size(struct mtk_dpi *dpi, u32 width, u32 height)  in mtk_dpi_config_fb_size()  argument
231 	mtk_dpi_mask(dpi, DPI_SIZE, width << HSIZE, HSIZE_MASK);  in mtk_dpi_config_fb_size()
232 	mtk_dpi_mask(dpi, DPI_SIZE, height << VSIZE, VSIZE_MASK);  in mtk_dpi_config_fb_size()
235 static void mtk_dpi_config_channel_limit(struct mtk_dpi *dpi,  in mtk_dpi_config_channel_limit()  argument
238 	mtk_dpi_mask(dpi, DPI_Y_LIMIT, limit->y_bottom << Y_LIMINT_BOT,  in mtk_dpi_config_channel_limit()
240 	mtk_dpi_mask(dpi, DPI_Y_LIMIT, limit->y_top << Y_LIMINT_TOP,  in mtk_dpi_config_channel_limit()
242 	mtk_dpi_mask(dpi, DPI_C_LIMIT, limit->c_bottom << C_LIMIT_BOT,  in mtk_dpi_config_channel_limit()
244 	mtk_dpi_mask(dpi, DPI_C_LIMIT, limit->c_top << C_LIMIT_TOP,  in mtk_dpi_config_channel_limit()
248 static void mtk_dpi_config_bit_num(struct mtk_dpi *dpi,  in mtk_dpi_config_bit_num()  argument
270 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, val << OUT_BIT,  in mtk_dpi_config_bit_num()
274 static void mtk_dpi_config_yc_map(struct mtk_dpi *dpi,  in mtk_dpi_config_yc_map()  argument
300 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, val << YC_MAP, YC_MAP_MASK);  in mtk_dpi_config_yc_map()
303 static void mtk_dpi_config_channel_swap(struct mtk_dpi *dpi,  in mtk_dpi_config_channel_swap()  argument
332 	mtk_dpi_mask(dpi, DPI_OUTPUT_SETTING, val << CH_SWAP, CH_SWAP_MASK);  in mtk_dpi_config_channel_swap()
335 static void mtk_dpi_config_yuv422_enable(struct mtk_dpi *dpi, bool enable)  in mtk_dpi_config_yuv422_enable()  argument
337 	mtk_dpi_mask(dpi, DPI_CON, enable ? YUV422_EN : 0, YUV422_EN);  in mtk_dpi_config_yuv422_enable()
340 static void mtk_dpi_config_csc_enable(struct mtk_dpi *dpi, bool enable)  in mtk_dpi_config_csc_enable()  argument
342 	mtk_dpi_mask(dpi, DPI_CON, enable ? CSC_ENABLE : 0, CSC_ENABLE);  in mtk_dpi_config_csc_enable()
345 static void mtk_dpi_config_swap_input(struct mtk_dpi *dpi, bool enable)  in mtk_dpi_config_swap_input()  argument
347 	mtk_dpi_mask(dpi, DPI_CON, enable ? IN_RB_SWAP : 0, IN_RB_SWAP);  in mtk_dpi_config_swap_input()
350 static void mtk_dpi_config_2n_h_fre(struct mtk_dpi *dpi)  in mtk_dpi_config_2n_h_fre()  argument
352 	mtk_dpi_mask(dpi, dpi->conf->reg_h_fre_con, H_FRE_2N, H_FRE_2N);  in mtk_dpi_config_2n_h_fre()
355 static void mtk_dpi_config_disable_edge(struct mtk_dpi *dpi)  in mtk_dpi_config_disable_edge()  argument
357 	if (dpi->conf->edge_sel_en)  in mtk_dpi_config_disable_edge()
358 		mtk_dpi_mask(dpi, dpi->conf->reg_h_fre_con, 0, EDGE_SEL_EN);  in mtk_dpi_config_disable_edge()
361 static void mtk_dpi_config_color_format(struct mtk_dpi *dpi,  in mtk_dpi_config_color_format()  argument
366 		mtk_dpi_config_yuv422_enable(dpi, false);  in mtk_dpi_config_color_format()
367 		mtk_dpi_config_csc_enable(dpi, true);  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_BGR);  in mtk_dpi_config_color_format()
372 		mtk_dpi_config_yuv422_enable(dpi, true);  in mtk_dpi_config_color_format()
373 		mtk_dpi_config_csc_enable(dpi, true);  in mtk_dpi_config_color_format()
374 		mtk_dpi_config_swap_input(dpi, true);  in mtk_dpi_config_color_format()
375 		mtk_dpi_config_channel_swap(dpi, MTK_DPI_OUT_CHANNEL_SWAP_RGB);  in mtk_dpi_config_color_format()
377 		mtk_dpi_config_yuv422_enable(dpi, false);  in mtk_dpi_config_color_format()
378 		mtk_dpi_config_csc_enable(dpi, false);  in mtk_dpi_config_color_format()
379 		mtk_dpi_config_swap_input(dpi, false);  in mtk_dpi_config_color_format()
380 		mtk_dpi_config_channel_swap(dpi, MTK_DPI_OUT_CHANNEL_SWAP_RGB);  in mtk_dpi_config_color_format()
384 static void mtk_dpi_power_off(struct mtk_dpi *dpi)  in mtk_dpi_power_off()  argument
386 	if (WARN_ON(dpi->refcount == 0))  in mtk_dpi_power_off()
389 	if (--dpi->refcount != 0)  in mtk_dpi_power_off()
392 	if (dpi->pinctrl && dpi->pins_gpio)  in mtk_dpi_power_off()
393 		pinctrl_select_state(dpi->pinctrl, dpi->pins_gpio);  in mtk_dpi_power_off()
395 	mtk_dpi_disable(dpi);  in mtk_dpi_power_off()
396 	clk_disable_unprepare(dpi->pixel_clk);  in mtk_dpi_power_off()
397 	clk_disable_unprepare(dpi->engine_clk);  in mtk_dpi_power_off()
400 static int mtk_dpi_power_on(struct mtk_dpi *dpi)  in mtk_dpi_power_on()  argument
404 	if (++dpi->refcount != 1)  in mtk_dpi_power_on()
407 	ret = clk_prepare_enable(dpi->engine_clk);  in mtk_dpi_power_on()
409 		dev_err(dpi->dev, "Failed to enable engine clock: %d\n", ret);  in mtk_dpi_power_on()
413 	ret = clk_prepare_enable(dpi->pixel_clk);  in mtk_dpi_power_on()
415 		dev_err(dpi->dev, "Failed to enable pixel clock: %d\n", ret);  in mtk_dpi_power_on()
419 	if (dpi->pinctrl && dpi->pins_dpi)  in mtk_dpi_power_on()
420 		pinctrl_select_state(dpi->pinctrl, dpi->pins_dpi);  in mtk_dpi_power_on()
422 	mtk_dpi_enable(dpi);  in mtk_dpi_power_on()
426 	clk_disable_unprepare(dpi->engine_clk);  in mtk_dpi_power_on()
428 	dpi->refcount--;  in mtk_dpi_power_on()
432 static int mtk_dpi_set_display_mode(struct mtk_dpi *dpi,  in mtk_dpi_set_display_mode()  argument
447 	factor = dpi->conf->cal_factor(mode->clock);  in mtk_dpi_set_display_mode()
451 	dev_dbg(dpi->dev, "Want PLL %lu Hz, pixel clock %lu Hz\n",  in mtk_dpi_set_display_mode()
454 	clk_set_rate(dpi->tvd_clk, pll_rate);  in mtk_dpi_set_display_mode()
455 	pll_rate = clk_get_rate(dpi->tvd_clk);  in mtk_dpi_set_display_mode()
458 	clk_set_rate(dpi->pixel_clk, vm.pixelclock);  in mtk_dpi_set_display_mode()
459 	vm.pixelclock = clk_get_rate(dpi->pixel_clk);  in mtk_dpi_set_display_mode()
461 	dev_dbg(dpi->dev, "Got  PLL %lu Hz, pixel clock %lu Hz\n",  in mtk_dpi_set_display_mode()
499 	mtk_dpi_sw_reset(dpi, true);  in mtk_dpi_set_display_mode()
500 	mtk_dpi_config_pol(dpi, &dpi_pol);  in mtk_dpi_set_display_mode()
502 	mtk_dpi_config_hsync(dpi, &hsync);  in mtk_dpi_set_display_mode()
503 	mtk_dpi_config_vsync_lodd(dpi, &vsync_lodd);  in mtk_dpi_set_display_mode()
504 	mtk_dpi_config_vsync_rodd(dpi, &vsync_rodd);  in mtk_dpi_set_display_mode()
505 	mtk_dpi_config_vsync_leven(dpi, &vsync_leven);  in mtk_dpi_set_display_mode()
506 	mtk_dpi_config_vsync_reven(dpi, &vsync_reven);  in mtk_dpi_set_display_mode()
508 	mtk_dpi_config_3d(dpi, !!(mode->flags & DRM_MODE_FLAG_3D_MASK));  in mtk_dpi_set_display_mode()
509 	mtk_dpi_config_interface(dpi, !!(vm.flags &  in mtk_dpi_set_display_mode()
512 		mtk_dpi_config_fb_size(dpi, vm.hactive, vm.vactive >> 1);  in mtk_dpi_set_display_mode()
514 		mtk_dpi_config_fb_size(dpi, vm.hactive, vm.vactive);  in mtk_dpi_set_display_mode()
516 	mtk_dpi_config_channel_limit(dpi, &limit);  in mtk_dpi_set_display_mode()
517 	mtk_dpi_config_bit_num(dpi, dpi->bit_num);  in mtk_dpi_set_display_mode()
518 	mtk_dpi_config_channel_swap(dpi, dpi->channel_swap);  in mtk_dpi_set_display_mode()
519 	mtk_dpi_config_yc_map(dpi, dpi->yc_map);  in mtk_dpi_set_display_mode()
520 	mtk_dpi_config_color_format(dpi, dpi->color_format);  in mtk_dpi_set_display_mode()
521 	mtk_dpi_config_2n_h_fre(dpi);  in mtk_dpi_set_display_mode()
522 	mtk_dpi_config_disable_edge(dpi);  in mtk_dpi_set_display_mode()
523 	mtk_dpi_sw_reset(dpi, false);  in mtk_dpi_set_display_mode()
531 	struct mtk_dpi *dpi = bridge_to_dpi(bridge);  in mtk_dpi_bridge_attach()  local
533 	return drm_bridge_attach(bridge->encoder, dpi->next_bridge,  in mtk_dpi_bridge_attach()
534 				 &dpi->bridge, flags);  in mtk_dpi_bridge_attach()
541 	struct mtk_dpi *dpi = bridge_to_dpi(bridge);  in mtk_dpi_bridge_mode_set()  local
543 	drm_mode_copy(&dpi->mode, adjusted_mode);  in mtk_dpi_bridge_mode_set()
548 	struct mtk_dpi *dpi = bridge_to_dpi(bridge);  in mtk_dpi_bridge_disable()  local
550 	mtk_dpi_power_off(dpi);  in mtk_dpi_bridge_disable()
555 	struct mtk_dpi *dpi = bridge_to_dpi(bridge);  in mtk_dpi_bridge_enable()  local
557 	mtk_dpi_power_on(dpi);  in mtk_dpi_bridge_enable()
558 	mtk_dpi_set_display_mode(dpi, &dpi->mode);  in mtk_dpi_bridge_enable()
566 	struct mtk_dpi *dpi = bridge_to_dpi(bridge);  in mtk_dpi_bridge_mode_valid()  local
568 	if (mode->clock > dpi->conf->max_clock_khz)  in mtk_dpi_bridge_mode_valid()
584 	struct mtk_dpi *dpi = dev_get_drvdata(dev);  in mtk_dpi_start()  local
586 	mtk_dpi_power_on(dpi);  in mtk_dpi_start()
591 	struct mtk_dpi *dpi = dev_get_drvdata(dev);  in mtk_dpi_stop()  local
593 	mtk_dpi_power_off(dpi);  in mtk_dpi_stop()
598 	struct mtk_dpi *dpi = dev_get_drvdata(dev);  in mtk_dpi_bind()  local
602 	ret = drm_simple_encoder_init(drm_dev, &dpi->encoder,  in mtk_dpi_bind()
609 	dpi->encoder.possible_crtcs = mtk_drm_find_possible_crtc_by_comp(drm_dev, dpi->dev);  in mtk_dpi_bind()
611 	ret = drm_bridge_attach(&dpi->encoder, &dpi->bridge, NULL,  in mtk_dpi_bind()
618 	dpi->connector = drm_bridge_connector_init(drm_dev, &dpi->encoder);  in mtk_dpi_bind()
619 	if (IS_ERR(dpi->connector)) {  in mtk_dpi_bind()
621 		ret = PTR_ERR(dpi->connector);  in mtk_dpi_bind()
624 	drm_connector_attach_encoder(dpi->connector, &dpi->encoder);  in mtk_dpi_bind()
626 	dpi->bit_num = MTK_DPI_OUT_BIT_NUM_8BITS;  in mtk_dpi_bind()
627 	dpi->channel_swap = MTK_DPI_OUT_CHANNEL_SWAP_RGB;  in mtk_dpi_bind()
628 	dpi->yc_map = MTK_DPI_OUT_YC_MAP_RGB;  in mtk_dpi_bind()
629 	dpi->color_format = MTK_DPI_COLOR_FORMAT_RGB;  in mtk_dpi_bind()
634 	drm_encoder_cleanup(&dpi->encoder);  in mtk_dpi_bind()
641 	struct mtk_dpi *dpi = dev_get_drvdata(dev);  in mtk_dpi_unbind()  local
643 	drm_encoder_cleanup(&dpi->encoder);  in mtk_dpi_unbind()
711 	struct mtk_dpi *dpi;  in mtk_dpi_probe()  local
715 	dpi = devm_kzalloc(dev, sizeof(*dpi), GFP_KERNEL);  in mtk_dpi_probe()
716 	if (!dpi)  in mtk_dpi_probe()
719 	dpi->dev = dev;  in mtk_dpi_probe()
720 	dpi->conf = (struct mtk_dpi_conf *)of_device_get_match_data(dev);  in mtk_dpi_probe()
722 	dpi->pinctrl = devm_pinctrl_get(&pdev->dev);  in mtk_dpi_probe()
723 	if (IS_ERR(dpi->pinctrl)) {  in mtk_dpi_probe()
724 		dpi->pinctrl = NULL;  in mtk_dpi_probe()
727 	if (dpi->pinctrl) {  in mtk_dpi_probe()
728 		dpi->pins_gpio = pinctrl_lookup_state(dpi->pinctrl, "sleep");  in mtk_dpi_probe()
729 		if (IS_ERR(dpi->pins_gpio)) {  in mtk_dpi_probe()
730 			dpi->pins_gpio = NULL;  in mtk_dpi_probe()
733 		if (dpi->pins_gpio)  in mtk_dpi_probe()
734 			pinctrl_select_state(dpi->pinctrl, dpi->pins_gpio);  in mtk_dpi_probe()
736 		dpi->pins_dpi = pinctrl_lookup_state(dpi->pinctrl, "default");  in mtk_dpi_probe()
737 		if (IS_ERR(dpi->pins_dpi)) {  in mtk_dpi_probe()
738 			dpi->pins_dpi = NULL;  in mtk_dpi_probe()
743 	dpi->regs = devm_ioremap_resource(dev, mem);  in mtk_dpi_probe()
744 	if (IS_ERR(dpi->regs)) {  in mtk_dpi_probe()
745 		ret = PTR_ERR(dpi->regs);  in mtk_dpi_probe()
750 	dpi->engine_clk = devm_clk_get(dev, "engine");  in mtk_dpi_probe()
751 	if (IS_ERR(dpi->engine_clk)) {  in mtk_dpi_probe()
752 		ret = PTR_ERR(dpi->engine_clk);  in mtk_dpi_probe()
759 	dpi->pixel_clk = devm_clk_get(dev, "pixel");  in mtk_dpi_probe()
760 	if (IS_ERR(dpi->pixel_clk)) {  in mtk_dpi_probe()
761 		ret = PTR_ERR(dpi->pixel_clk);  in mtk_dpi_probe()
768 	dpi->tvd_clk = devm_clk_get(dev, "pll");  in mtk_dpi_probe()
769 	if (IS_ERR(dpi->tvd_clk)) {  in mtk_dpi_probe()
770 		ret = PTR_ERR(dpi->tvd_clk);  in mtk_dpi_probe()
777 	dpi->irq = platform_get_irq(pdev, 0);  in mtk_dpi_probe()
778 	if (dpi->irq <= 0)  in mtk_dpi_probe()
782 					  NULL, &dpi->next_bridge);  in mtk_dpi_probe()
786 	dev_info(dev, "Found bridge node: %pOF\n", dpi->next_bridge->of_node);  in mtk_dpi_probe()
788 	platform_set_drvdata(pdev, dpi);  in mtk_dpi_probe()
790 	dpi->bridge.funcs = &mtk_dpi_bridge_funcs;  in mtk_dpi_probe()
791 	dpi->bridge.of_node = dev->of_node;  in mtk_dpi_probe()
792 	dpi->bridge.type = DRM_MODE_CONNECTOR_DPI;  in mtk_dpi_probe()
794 	drm_bridge_add(&dpi->bridge);  in mtk_dpi_probe()
798 		drm_bridge_remove(&dpi->bridge);  in mtk_dpi_probe()
808 	struct mtk_dpi *dpi = platform_get_drvdata(pdev);  in mtk_dpi_remove()  local
811 	drm_bridge_remove(&dpi->bridge);  in mtk_dpi_remove()