xref: /openbmc/linux/drivers/gpu/drm/sun4i/sun4i_tcon.c (revision 45e88f994add84d8cd3864d36064ea1ed1b08cdf)
19026e0d1SMaxime Ripard /*
29026e0d1SMaxime Ripard  * Copyright (C) 2015 Free Electrons
39026e0d1SMaxime Ripard  * Copyright (C) 2015 NextThing Co
49026e0d1SMaxime Ripard  *
59026e0d1SMaxime Ripard  * Maxime Ripard <maxime.ripard@free-electrons.com>
69026e0d1SMaxime Ripard  *
79026e0d1SMaxime Ripard  * This program is free software; you can redistribute it and/or
89026e0d1SMaxime Ripard  * modify it under the terms of the GNU General Public License as
99026e0d1SMaxime Ripard  * published by the Free Software Foundation; either version 2 of
109026e0d1SMaxime Ripard  * the License, or (at your option) any later version.
119026e0d1SMaxime Ripard  */
129026e0d1SMaxime Ripard 
139026e0d1SMaxime Ripard #include <drm/drmP.h>
149026e0d1SMaxime Ripard #include <drm/drm_atomic_helper.h>
159026e0d1SMaxime Ripard #include <drm/drm_crtc.h>
169026e0d1SMaxime Ripard #include <drm/drm_crtc_helper.h>
17ad537fb2SChen-Yu Tsai #include <drm/drm_encoder.h>
189026e0d1SMaxime Ripard #include <drm/drm_modes.h>
19ebc94461SRob Herring #include <drm/drm_of.h>
209026e0d1SMaxime Ripard 
21ad537fb2SChen-Yu Tsai #include <uapi/drm/drm_mode.h>
22ad537fb2SChen-Yu Tsai 
239026e0d1SMaxime Ripard #include <linux/component.h>
249026e0d1SMaxime Ripard #include <linux/ioport.h>
259026e0d1SMaxime Ripard #include <linux/of_address.h>
2691ea2f29SChen-Yu Tsai #include <linux/of_device.h>
279026e0d1SMaxime Ripard #include <linux/of_irq.h>
289026e0d1SMaxime Ripard #include <linux/regmap.h>
299026e0d1SMaxime Ripard #include <linux/reset.h>
309026e0d1SMaxime Ripard 
319026e0d1SMaxime Ripard #include "sun4i_crtc.h"
329026e0d1SMaxime Ripard #include "sun4i_dotclock.h"
339026e0d1SMaxime Ripard #include "sun4i_drv.h"
3429e57fabSMaxime Ripard #include "sun4i_rgb.h"
359026e0d1SMaxime Ripard #include "sun4i_tcon.h"
3687969338SIcenowy Zheng #include "sunxi_engine.h"
379026e0d1SMaxime Ripard 
38*45e88f99SMaxime Ripard static void sun4i_tcon_channel_set_status(struct sun4i_tcon *tcon, int channel,
39*45e88f99SMaxime Ripard 					  bool enabled)
409026e0d1SMaxime Ripard {
41*45e88f99SMaxime Ripard 	struct clk *clk;
429026e0d1SMaxime Ripard 
43*45e88f99SMaxime Ripard 	switch (channel) {
44*45e88f99SMaxime Ripard 	case 0:
459026e0d1SMaxime Ripard 		regmap_update_bits(tcon->regs, SUN4I_TCON0_CTL_REG,
469026e0d1SMaxime Ripard 				   SUN4I_TCON0_CTL_TCON_ENABLE,
47*45e88f99SMaxime Ripard 				   enabled ? SUN4I_TCON0_CTL_TCON_ENABLE : 0);
48*45e88f99SMaxime Ripard 		clk = tcon->dclk;
49*45e88f99SMaxime Ripard 		break;
50*45e88f99SMaxime Ripard 	case 1:
5191ea2f29SChen-Yu Tsai 		WARN_ON(!tcon->quirks->has_channel_1);
529026e0d1SMaxime Ripard 		regmap_update_bits(tcon->regs, SUN4I_TCON1_CTL_REG,
539026e0d1SMaxime Ripard 				   SUN4I_TCON1_CTL_TCON_ENABLE,
54*45e88f99SMaxime Ripard 				   enabled ? SUN4I_TCON1_CTL_TCON_ENABLE : 0);
55*45e88f99SMaxime Ripard 		clk = tcon->sclk1;
56*45e88f99SMaxime Ripard 		break;
57*45e88f99SMaxime Ripard 	default:
58*45e88f99SMaxime Ripard 		DRM_WARN("Unknown channel... doing nothing\n");
59*45e88f99SMaxime Ripard 		return;
609026e0d1SMaxime Ripard 	}
61*45e88f99SMaxime Ripard 
62*45e88f99SMaxime Ripard 	if (enabled)
63*45e88f99SMaxime Ripard 		clk_prepare_enable(clk);
64*45e88f99SMaxime Ripard 	else
65*45e88f99SMaxime Ripard 		clk_disable_unprepare(clk);
66*45e88f99SMaxime Ripard }
67*45e88f99SMaxime Ripard 
68*45e88f99SMaxime Ripard void sun4i_tcon_set_status(struct sun4i_tcon *tcon,
69*45e88f99SMaxime Ripard 			   const struct drm_encoder *encoder,
70*45e88f99SMaxime Ripard 			   bool enabled)
71*45e88f99SMaxime Ripard {
72*45e88f99SMaxime Ripard 	int channel;
73*45e88f99SMaxime Ripard 
74*45e88f99SMaxime Ripard 	switch (encoder->encoder_type) {
75*45e88f99SMaxime Ripard 	case DRM_MODE_ENCODER_NONE:
76*45e88f99SMaxime Ripard 		channel = 0;
77*45e88f99SMaxime Ripard 		break;
78*45e88f99SMaxime Ripard 	case DRM_MODE_ENCODER_TMDS:
79*45e88f99SMaxime Ripard 	case DRM_MODE_ENCODER_TVDAC:
80*45e88f99SMaxime Ripard 		channel = 1;
81*45e88f99SMaxime Ripard 		break;
82*45e88f99SMaxime Ripard 	default:
83*45e88f99SMaxime Ripard 		DRM_DEBUG_DRIVER("Unknown encoder type, doing nothing...\n");
84*45e88f99SMaxime Ripard 		return;
85*45e88f99SMaxime Ripard 	}
86*45e88f99SMaxime Ripard 
87*45e88f99SMaxime Ripard 	regmap_update_bits(tcon->regs, SUN4I_TCON_GCTL_REG,
88*45e88f99SMaxime Ripard 			   SUN4I_TCON_GCTL_TCON_ENABLE,
89*45e88f99SMaxime Ripard 			   enabled ? SUN4I_TCON_GCTL_TCON_ENABLE : 0);
90*45e88f99SMaxime Ripard 
91*45e88f99SMaxime Ripard 	sun4i_tcon_channel_set_status(tcon, channel, enabled);
92*45e88f99SMaxime Ripard }
939026e0d1SMaxime Ripard 
949026e0d1SMaxime Ripard void sun4i_tcon_enable_vblank(struct sun4i_tcon *tcon, bool enable)
959026e0d1SMaxime Ripard {
969026e0d1SMaxime Ripard 	u32 mask, val = 0;
979026e0d1SMaxime Ripard 
989026e0d1SMaxime Ripard 	DRM_DEBUG_DRIVER("%sabling VBLANK interrupt\n", enable ? "En" : "Dis");
999026e0d1SMaxime Ripard 
1009026e0d1SMaxime Ripard 	mask = SUN4I_TCON_GINT0_VBLANK_ENABLE(0) |
1019026e0d1SMaxime Ripard 	       SUN4I_TCON_GINT0_VBLANK_ENABLE(1);
1029026e0d1SMaxime Ripard 
1039026e0d1SMaxime Ripard 	if (enable)
1049026e0d1SMaxime Ripard 		val = mask;
1059026e0d1SMaxime Ripard 
1069026e0d1SMaxime Ripard 	regmap_update_bits(tcon->regs, SUN4I_TCON_GINT0_REG, mask, val);
1079026e0d1SMaxime Ripard }
1089026e0d1SMaxime Ripard EXPORT_SYMBOL(sun4i_tcon_enable_vblank);
1099026e0d1SMaxime Ripard 
11067e32645SChen-Yu Tsai /*
11167e32645SChen-Yu Tsai  * This function is a helper for TCON output muxing. The TCON output
11267e32645SChen-Yu Tsai  * muxing control register in earlier SoCs (without the TCON TOP block)
11367e32645SChen-Yu Tsai  * are located in TCON0. This helper returns a pointer to TCON0's
11467e32645SChen-Yu Tsai  * sun4i_tcon structure, or NULL if not found.
11567e32645SChen-Yu Tsai  */
11667e32645SChen-Yu Tsai static struct sun4i_tcon *sun4i_get_tcon0(struct drm_device *drm)
11767e32645SChen-Yu Tsai {
11867e32645SChen-Yu Tsai 	struct sun4i_drv *drv = drm->dev_private;
11967e32645SChen-Yu Tsai 	struct sun4i_tcon *tcon;
12067e32645SChen-Yu Tsai 
12167e32645SChen-Yu Tsai 	list_for_each_entry(tcon, &drv->tcon_list, list)
12267e32645SChen-Yu Tsai 		if (tcon->id == 0)
12367e32645SChen-Yu Tsai 			return tcon;
12467e32645SChen-Yu Tsai 
12567e32645SChen-Yu Tsai 	dev_warn(drm->dev,
12667e32645SChen-Yu Tsai 		 "TCON0 not found, display output muxing may not work\n");
12767e32645SChen-Yu Tsai 
12867e32645SChen-Yu Tsai 	return NULL;
12967e32645SChen-Yu Tsai }
13067e32645SChen-Yu Tsai 
131f8c73f4fSMaxime Ripard void sun4i_tcon_set_mux(struct sun4i_tcon *tcon, int channel,
132abcb8766SMaxime Ripard 			const struct drm_encoder *encoder)
133f8c73f4fSMaxime Ripard {
134ad537fb2SChen-Yu Tsai 	int ret = -ENOTSUPP;
135b7cb9b91SMaxime Ripard 
136ad537fb2SChen-Yu Tsai 	if (tcon->quirks->set_mux)
137ad537fb2SChen-Yu Tsai 		ret = tcon->quirks->set_mux(tcon, encoder);
138f8c73f4fSMaxime Ripard 
139ad537fb2SChen-Yu Tsai 	DRM_DEBUG_DRIVER("Muxing encoder %s to CRTC %s: %d\n",
140ad537fb2SChen-Yu Tsai 			 encoder->name, encoder->crtc->name, ret);
141f8c73f4fSMaxime Ripard }
142f8c73f4fSMaxime Ripard EXPORT_SYMBOL(sun4i_tcon_set_mux);
143f8c73f4fSMaxime Ripard 
144961c645cSMaxime Ripard static int sun4i_tcon_get_clk_delay(const struct drm_display_mode *mode,
1459026e0d1SMaxime Ripard 				    int channel)
1469026e0d1SMaxime Ripard {
1479026e0d1SMaxime Ripard 	int delay = mode->vtotal - mode->vdisplay;
1489026e0d1SMaxime Ripard 
1499026e0d1SMaxime Ripard 	if (mode->flags & DRM_MODE_FLAG_INTERLACE)
1509026e0d1SMaxime Ripard 		delay /= 2;
1519026e0d1SMaxime Ripard 
1529026e0d1SMaxime Ripard 	if (channel == 1)
1539026e0d1SMaxime Ripard 		delay -= 2;
1549026e0d1SMaxime Ripard 
1559026e0d1SMaxime Ripard 	delay = min(delay, 30);
1569026e0d1SMaxime Ripard 
1579026e0d1SMaxime Ripard 	DRM_DEBUG_DRIVER("TCON %d clock delay %u\n", channel, delay);
1589026e0d1SMaxime Ripard 
1599026e0d1SMaxime Ripard 	return delay;
1609026e0d1SMaxime Ripard }
1619026e0d1SMaxime Ripard 
1629026e0d1SMaxime Ripard void sun4i_tcon0_mode_set(struct sun4i_tcon *tcon,
1639026e0d1SMaxime Ripard 			  struct drm_display_mode *mode)
1649026e0d1SMaxime Ripard {
1659026e0d1SMaxime Ripard 	unsigned int bp, hsync, vsync;
1669026e0d1SMaxime Ripard 	u8 clk_delay;
1679026e0d1SMaxime Ripard 	u32 val = 0;
1689026e0d1SMaxime Ripard 
16986cf6788SChen-Yu Tsai 	/* Configure the dot clock */
17086cf6788SChen-Yu Tsai 	clk_set_rate(tcon->dclk, mode->crtc_clock * 1000);
17186cf6788SChen-Yu Tsai 
1729026e0d1SMaxime Ripard 	/* Adjust clock delay */
1739026e0d1SMaxime Ripard 	clk_delay = sun4i_tcon_get_clk_delay(mode, 0);
1749026e0d1SMaxime Ripard 	regmap_update_bits(tcon->regs, SUN4I_TCON0_CTL_REG,
1759026e0d1SMaxime Ripard 			   SUN4I_TCON0_CTL_CLK_DELAY_MASK,
1769026e0d1SMaxime Ripard 			   SUN4I_TCON0_CTL_CLK_DELAY(clk_delay));
1779026e0d1SMaxime Ripard 
1789026e0d1SMaxime Ripard 	/* Set the resolution */
1799026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON0_BASIC0_REG,
1809026e0d1SMaxime Ripard 		     SUN4I_TCON0_BASIC0_X(mode->crtc_hdisplay) |
1819026e0d1SMaxime Ripard 		     SUN4I_TCON0_BASIC0_Y(mode->crtc_vdisplay));
1829026e0d1SMaxime Ripard 
1839026e0d1SMaxime Ripard 	/*
1849026e0d1SMaxime Ripard 	 * This is called a backporch in the register documentation,
18523a1cb11SChen-Yu Tsai 	 * but it really is the back porch + hsync
1869026e0d1SMaxime Ripard 	 */
1879026e0d1SMaxime Ripard 	bp = mode->crtc_htotal - mode->crtc_hsync_start;
1889026e0d1SMaxime Ripard 	DRM_DEBUG_DRIVER("Setting horizontal total %d, backporch %d\n",
1899026e0d1SMaxime Ripard 			 mode->crtc_htotal, bp);
1909026e0d1SMaxime Ripard 
1919026e0d1SMaxime Ripard 	/* Set horizontal display timings */
1929026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON0_BASIC1_REG,
1939026e0d1SMaxime Ripard 		     SUN4I_TCON0_BASIC1_H_TOTAL(mode->crtc_htotal) |
1949026e0d1SMaxime Ripard 		     SUN4I_TCON0_BASIC1_H_BACKPORCH(bp));
1959026e0d1SMaxime Ripard 
1969026e0d1SMaxime Ripard 	/*
1979026e0d1SMaxime Ripard 	 * This is called a backporch in the register documentation,
19823a1cb11SChen-Yu Tsai 	 * but it really is the back porch + hsync
1999026e0d1SMaxime Ripard 	 */
2009026e0d1SMaxime Ripard 	bp = mode->crtc_vtotal - mode->crtc_vsync_start;
2019026e0d1SMaxime Ripard 	DRM_DEBUG_DRIVER("Setting vertical total %d, backporch %d\n",
2029026e0d1SMaxime Ripard 			 mode->crtc_vtotal, bp);
2039026e0d1SMaxime Ripard 
2049026e0d1SMaxime Ripard 	/* Set vertical display timings */
2059026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON0_BASIC2_REG,
206a88cbbd4SMaxime Ripard 		     SUN4I_TCON0_BASIC2_V_TOTAL(mode->crtc_vtotal * 2) |
2079026e0d1SMaxime Ripard 		     SUN4I_TCON0_BASIC2_V_BACKPORCH(bp));
2089026e0d1SMaxime Ripard 
2099026e0d1SMaxime Ripard 	/* Set Hsync and Vsync length */
2109026e0d1SMaxime Ripard 	hsync = mode->crtc_hsync_end - mode->crtc_hsync_start;
2119026e0d1SMaxime Ripard 	vsync = mode->crtc_vsync_end - mode->crtc_vsync_start;
2129026e0d1SMaxime Ripard 	DRM_DEBUG_DRIVER("Setting HSYNC %d, VSYNC %d\n", hsync, vsync);
2139026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON0_BASIC3_REG,
2149026e0d1SMaxime Ripard 		     SUN4I_TCON0_BASIC3_V_SYNC(vsync) |
2159026e0d1SMaxime Ripard 		     SUN4I_TCON0_BASIC3_H_SYNC(hsync));
2169026e0d1SMaxime Ripard 
2179026e0d1SMaxime Ripard 	/* Setup the polarity of the various signals */
2189026e0d1SMaxime Ripard 	if (!(mode->flags & DRM_MODE_FLAG_PHSYNC))
2199026e0d1SMaxime Ripard 		val |= SUN4I_TCON0_IO_POL_HSYNC_POSITIVE;
2209026e0d1SMaxime Ripard 
2219026e0d1SMaxime Ripard 	if (!(mode->flags & DRM_MODE_FLAG_PVSYNC))
2229026e0d1SMaxime Ripard 		val |= SUN4I_TCON0_IO_POL_VSYNC_POSITIVE;
2239026e0d1SMaxime Ripard 
2249026e0d1SMaxime Ripard 	regmap_update_bits(tcon->regs, SUN4I_TCON0_IO_POL_REG,
2259026e0d1SMaxime Ripard 			   SUN4I_TCON0_IO_POL_HSYNC_POSITIVE | SUN4I_TCON0_IO_POL_VSYNC_POSITIVE,
2269026e0d1SMaxime Ripard 			   val);
2279026e0d1SMaxime Ripard 
2289026e0d1SMaxime Ripard 	/* Map output pins to channel 0 */
2299026e0d1SMaxime Ripard 	regmap_update_bits(tcon->regs, SUN4I_TCON_GCTL_REG,
2309026e0d1SMaxime Ripard 			   SUN4I_TCON_GCTL_IOMAP_MASK,
2319026e0d1SMaxime Ripard 			   SUN4I_TCON_GCTL_IOMAP_TCON0);
2329026e0d1SMaxime Ripard 
2339026e0d1SMaxime Ripard 	/* Enable the output on the pins */
2349026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON0_IO_TRI_REG, 0);
2359026e0d1SMaxime Ripard }
2369026e0d1SMaxime Ripard EXPORT_SYMBOL(sun4i_tcon0_mode_set);
2379026e0d1SMaxime Ripard 
2389026e0d1SMaxime Ripard void sun4i_tcon1_mode_set(struct sun4i_tcon *tcon,
2399026e0d1SMaxime Ripard 			  struct drm_display_mode *mode)
2409026e0d1SMaxime Ripard {
241b8317a3dSMaxime Ripard 	unsigned int bp, hsync, vsync, vtotal;
2429026e0d1SMaxime Ripard 	u8 clk_delay;
2439026e0d1SMaxime Ripard 	u32 val;
2449026e0d1SMaxime Ripard 
24591ea2f29SChen-Yu Tsai 	WARN_ON(!tcon->quirks->has_channel_1);
2468e924047SMaxime Ripard 
24786cf6788SChen-Yu Tsai 	/* Configure the dot clock */
24886cf6788SChen-Yu Tsai 	clk_set_rate(tcon->sclk1, mode->crtc_clock * 1000);
24986cf6788SChen-Yu Tsai 
2509026e0d1SMaxime Ripard 	/* Adjust clock delay */
2519026e0d1SMaxime Ripard 	clk_delay = sun4i_tcon_get_clk_delay(mode, 1);
2529026e0d1SMaxime Ripard 	regmap_update_bits(tcon->regs, SUN4I_TCON1_CTL_REG,
2539026e0d1SMaxime Ripard 			   SUN4I_TCON1_CTL_CLK_DELAY_MASK,
2549026e0d1SMaxime Ripard 			   SUN4I_TCON1_CTL_CLK_DELAY(clk_delay));
2559026e0d1SMaxime Ripard 
2569026e0d1SMaxime Ripard 	/* Set interlaced mode */
2579026e0d1SMaxime Ripard 	if (mode->flags & DRM_MODE_FLAG_INTERLACE)
2589026e0d1SMaxime Ripard 		val = SUN4I_TCON1_CTL_INTERLACE_ENABLE;
2599026e0d1SMaxime Ripard 	else
2609026e0d1SMaxime Ripard 		val = 0;
2619026e0d1SMaxime Ripard 	regmap_update_bits(tcon->regs, SUN4I_TCON1_CTL_REG,
2629026e0d1SMaxime Ripard 			   SUN4I_TCON1_CTL_INTERLACE_ENABLE,
2639026e0d1SMaxime Ripard 			   val);
2649026e0d1SMaxime Ripard 
2659026e0d1SMaxime Ripard 	/* Set the input resolution */
2669026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON1_BASIC0_REG,
2679026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC0_X(mode->crtc_hdisplay) |
2689026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC0_Y(mode->crtc_vdisplay));
2699026e0d1SMaxime Ripard 
2709026e0d1SMaxime Ripard 	/* Set the upscaling resolution */
2719026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON1_BASIC1_REG,
2729026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC1_X(mode->crtc_hdisplay) |
2739026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC1_Y(mode->crtc_vdisplay));
2749026e0d1SMaxime Ripard 
2759026e0d1SMaxime Ripard 	/* Set the output resolution */
2769026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON1_BASIC2_REG,
2779026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC2_X(mode->crtc_hdisplay) |
2789026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC2_Y(mode->crtc_vdisplay));
2799026e0d1SMaxime Ripard 
2809026e0d1SMaxime Ripard 	/* Set horizontal display timings */
2813cb2f46bSMaxime Ripard 	bp = mode->crtc_htotal - mode->crtc_hsync_start;
2829026e0d1SMaxime Ripard 	DRM_DEBUG_DRIVER("Setting horizontal total %d, backporch %d\n",
2839026e0d1SMaxime Ripard 			 mode->htotal, bp);
2849026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON1_BASIC3_REG,
2859026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC3_H_TOTAL(mode->crtc_htotal) |
2869026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC3_H_BACKPORCH(bp));
2879026e0d1SMaxime Ripard 
2883cb2f46bSMaxime Ripard 	bp = mode->crtc_vtotal - mode->crtc_vsync_start;
2899026e0d1SMaxime Ripard 	DRM_DEBUG_DRIVER("Setting vertical total %d, backporch %d\n",
290b8317a3dSMaxime Ripard 			 mode->crtc_vtotal, bp);
291b8317a3dSMaxime Ripard 
292b8317a3dSMaxime Ripard 	/*
293b8317a3dSMaxime Ripard 	 * The vertical resolution needs to be doubled in all
294b8317a3dSMaxime Ripard 	 * cases. We could use crtc_vtotal and always multiply by two,
295b8317a3dSMaxime Ripard 	 * but that leads to a rounding error in interlace when vtotal
296b8317a3dSMaxime Ripard 	 * is odd.
297b8317a3dSMaxime Ripard 	 *
298b8317a3dSMaxime Ripard 	 * This happens with TV's PAL for example, where vtotal will
299b8317a3dSMaxime Ripard 	 * be 625, crtc_vtotal 312, and thus crtc_vtotal * 2 will be
300b8317a3dSMaxime Ripard 	 * 624, which apparently confuses the hardware.
301b8317a3dSMaxime Ripard 	 *
302b8317a3dSMaxime Ripard 	 * To work around this, we will always use vtotal, and
303b8317a3dSMaxime Ripard 	 * multiply by two only if we're not in interlace.
304b8317a3dSMaxime Ripard 	 */
305b8317a3dSMaxime Ripard 	vtotal = mode->vtotal;
306b8317a3dSMaxime Ripard 	if (!(mode->flags & DRM_MODE_FLAG_INTERLACE))
307b8317a3dSMaxime Ripard 		vtotal = vtotal * 2;
308b8317a3dSMaxime Ripard 
309b8317a3dSMaxime Ripard 	/* Set vertical display timings */
3109026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON1_BASIC4_REG,
311b8317a3dSMaxime Ripard 		     SUN4I_TCON1_BASIC4_V_TOTAL(vtotal) |
3129026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC4_V_BACKPORCH(bp));
3139026e0d1SMaxime Ripard 
3149026e0d1SMaxime Ripard 	/* Set Hsync and Vsync length */
3159026e0d1SMaxime Ripard 	hsync = mode->crtc_hsync_end - mode->crtc_hsync_start;
3169026e0d1SMaxime Ripard 	vsync = mode->crtc_vsync_end - mode->crtc_vsync_start;
3179026e0d1SMaxime Ripard 	DRM_DEBUG_DRIVER("Setting HSYNC %d, VSYNC %d\n", hsync, vsync);
3189026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON1_BASIC5_REG,
3199026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC5_V_SYNC(vsync) |
3209026e0d1SMaxime Ripard 		     SUN4I_TCON1_BASIC5_H_SYNC(hsync));
3219026e0d1SMaxime Ripard 
3229026e0d1SMaxime Ripard 	/* Map output pins to channel 1 */
3239026e0d1SMaxime Ripard 	regmap_update_bits(tcon->regs, SUN4I_TCON_GCTL_REG,
3249026e0d1SMaxime Ripard 			   SUN4I_TCON_GCTL_IOMAP_MASK,
3259026e0d1SMaxime Ripard 			   SUN4I_TCON_GCTL_IOMAP_TCON1);
3269026e0d1SMaxime Ripard }
3279026e0d1SMaxime Ripard EXPORT_SYMBOL(sun4i_tcon1_mode_set);
3289026e0d1SMaxime Ripard 
3299026e0d1SMaxime Ripard static void sun4i_tcon_finish_page_flip(struct drm_device *dev,
3309026e0d1SMaxime Ripard 					struct sun4i_crtc *scrtc)
3319026e0d1SMaxime Ripard {
3329026e0d1SMaxime Ripard 	unsigned long flags;
3339026e0d1SMaxime Ripard 
3349026e0d1SMaxime Ripard 	spin_lock_irqsave(&dev->event_lock, flags);
3359026e0d1SMaxime Ripard 	if (scrtc->event) {
3369026e0d1SMaxime Ripard 		drm_crtc_send_vblank_event(&scrtc->crtc, scrtc->event);
3379026e0d1SMaxime Ripard 		drm_crtc_vblank_put(&scrtc->crtc);
3389026e0d1SMaxime Ripard 		scrtc->event = NULL;
3399026e0d1SMaxime Ripard 	}
3409026e0d1SMaxime Ripard 	spin_unlock_irqrestore(&dev->event_lock, flags);
3419026e0d1SMaxime Ripard }
3429026e0d1SMaxime Ripard 
3439026e0d1SMaxime Ripard static irqreturn_t sun4i_tcon_handler(int irq, void *private)
3449026e0d1SMaxime Ripard {
3459026e0d1SMaxime Ripard 	struct sun4i_tcon *tcon = private;
3469026e0d1SMaxime Ripard 	struct drm_device *drm = tcon->drm;
34746cce6daSChen-Yu Tsai 	struct sun4i_crtc *scrtc = tcon->crtc;
3489026e0d1SMaxime Ripard 	unsigned int status;
3499026e0d1SMaxime Ripard 
3509026e0d1SMaxime Ripard 	regmap_read(tcon->regs, SUN4I_TCON_GINT0_REG, &status);
3519026e0d1SMaxime Ripard 
3529026e0d1SMaxime Ripard 	if (!(status & (SUN4I_TCON_GINT0_VBLANK_INT(0) |
3539026e0d1SMaxime Ripard 			SUN4I_TCON_GINT0_VBLANK_INT(1))))
3549026e0d1SMaxime Ripard 		return IRQ_NONE;
3559026e0d1SMaxime Ripard 
3569026e0d1SMaxime Ripard 	drm_crtc_handle_vblank(&scrtc->crtc);
3579026e0d1SMaxime Ripard 	sun4i_tcon_finish_page_flip(drm, scrtc);
3589026e0d1SMaxime Ripard 
3599026e0d1SMaxime Ripard 	/* Acknowledge the interrupt */
3609026e0d1SMaxime Ripard 	regmap_update_bits(tcon->regs, SUN4I_TCON_GINT0_REG,
3619026e0d1SMaxime Ripard 			   SUN4I_TCON_GINT0_VBLANK_INT(0) |
3629026e0d1SMaxime Ripard 			   SUN4I_TCON_GINT0_VBLANK_INT(1),
3639026e0d1SMaxime Ripard 			   0);
3649026e0d1SMaxime Ripard 
3659026e0d1SMaxime Ripard 	return IRQ_HANDLED;
3669026e0d1SMaxime Ripard }
3679026e0d1SMaxime Ripard 
3689026e0d1SMaxime Ripard static int sun4i_tcon_init_clocks(struct device *dev,
3699026e0d1SMaxime Ripard 				  struct sun4i_tcon *tcon)
3709026e0d1SMaxime Ripard {
3719026e0d1SMaxime Ripard 	tcon->clk = devm_clk_get(dev, "ahb");
3729026e0d1SMaxime Ripard 	if (IS_ERR(tcon->clk)) {
3739026e0d1SMaxime Ripard 		dev_err(dev, "Couldn't get the TCON bus clock\n");
3749026e0d1SMaxime Ripard 		return PTR_ERR(tcon->clk);
3759026e0d1SMaxime Ripard 	}
3769026e0d1SMaxime Ripard 	clk_prepare_enable(tcon->clk);
3779026e0d1SMaxime Ripard 
3789026e0d1SMaxime Ripard 	tcon->sclk0 = devm_clk_get(dev, "tcon-ch0");
3799026e0d1SMaxime Ripard 	if (IS_ERR(tcon->sclk0)) {
3809026e0d1SMaxime Ripard 		dev_err(dev, "Couldn't get the TCON channel 0 clock\n");
3819026e0d1SMaxime Ripard 		return PTR_ERR(tcon->sclk0);
3829026e0d1SMaxime Ripard 	}
3839026e0d1SMaxime Ripard 
38491ea2f29SChen-Yu Tsai 	if (tcon->quirks->has_channel_1) {
3859026e0d1SMaxime Ripard 		tcon->sclk1 = devm_clk_get(dev, "tcon-ch1");
3869026e0d1SMaxime Ripard 		if (IS_ERR(tcon->sclk1)) {
3879026e0d1SMaxime Ripard 			dev_err(dev, "Couldn't get the TCON channel 1 clock\n");
3889026e0d1SMaxime Ripard 			return PTR_ERR(tcon->sclk1);
3899026e0d1SMaxime Ripard 		}
3908e924047SMaxime Ripard 	}
3919026e0d1SMaxime Ripard 
3924c7f16d1SChen-Yu Tsai 	return 0;
3939026e0d1SMaxime Ripard }
3949026e0d1SMaxime Ripard 
3959026e0d1SMaxime Ripard static void sun4i_tcon_free_clocks(struct sun4i_tcon *tcon)
3969026e0d1SMaxime Ripard {
3979026e0d1SMaxime Ripard 	clk_disable_unprepare(tcon->clk);
3989026e0d1SMaxime Ripard }
3999026e0d1SMaxime Ripard 
4009026e0d1SMaxime Ripard static int sun4i_tcon_init_irq(struct device *dev,
4019026e0d1SMaxime Ripard 			       struct sun4i_tcon *tcon)
4029026e0d1SMaxime Ripard {
4039026e0d1SMaxime Ripard 	struct platform_device *pdev = to_platform_device(dev);
4049026e0d1SMaxime Ripard 	int irq, ret;
4059026e0d1SMaxime Ripard 
4069026e0d1SMaxime Ripard 	irq = platform_get_irq(pdev, 0);
4079026e0d1SMaxime Ripard 	if (irq < 0) {
4089026e0d1SMaxime Ripard 		dev_err(dev, "Couldn't retrieve the TCON interrupt\n");
4099026e0d1SMaxime Ripard 		return irq;
4109026e0d1SMaxime Ripard 	}
4119026e0d1SMaxime Ripard 
4129026e0d1SMaxime Ripard 	ret = devm_request_irq(dev, irq, sun4i_tcon_handler, 0,
4139026e0d1SMaxime Ripard 			       dev_name(dev), tcon);
4149026e0d1SMaxime Ripard 	if (ret) {
4159026e0d1SMaxime Ripard 		dev_err(dev, "Couldn't request the IRQ\n");
4169026e0d1SMaxime Ripard 		return ret;
4179026e0d1SMaxime Ripard 	}
4189026e0d1SMaxime Ripard 
4199026e0d1SMaxime Ripard 	return 0;
4209026e0d1SMaxime Ripard }
4219026e0d1SMaxime Ripard 
4229026e0d1SMaxime Ripard static struct regmap_config sun4i_tcon_regmap_config = {
4239026e0d1SMaxime Ripard 	.reg_bits	= 32,
4249026e0d1SMaxime Ripard 	.val_bits	= 32,
4259026e0d1SMaxime Ripard 	.reg_stride	= 4,
4269026e0d1SMaxime Ripard 	.max_register	= 0x800,
4279026e0d1SMaxime Ripard };
4289026e0d1SMaxime Ripard 
4299026e0d1SMaxime Ripard static int sun4i_tcon_init_regmap(struct device *dev,
4309026e0d1SMaxime Ripard 				  struct sun4i_tcon *tcon)
4319026e0d1SMaxime Ripard {
4329026e0d1SMaxime Ripard 	struct platform_device *pdev = to_platform_device(dev);
4339026e0d1SMaxime Ripard 	struct resource *res;
4349026e0d1SMaxime Ripard 	void __iomem *regs;
4359026e0d1SMaxime Ripard 
4369026e0d1SMaxime Ripard 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
4379026e0d1SMaxime Ripard 	regs = devm_ioremap_resource(dev, res);
438af346f55SWei Yongjun 	if (IS_ERR(regs))
4399026e0d1SMaxime Ripard 		return PTR_ERR(regs);
4409026e0d1SMaxime Ripard 
4419026e0d1SMaxime Ripard 	tcon->regs = devm_regmap_init_mmio(dev, regs,
4429026e0d1SMaxime Ripard 					   &sun4i_tcon_regmap_config);
4439026e0d1SMaxime Ripard 	if (IS_ERR(tcon->regs)) {
4449026e0d1SMaxime Ripard 		dev_err(dev, "Couldn't create the TCON regmap\n");
4459026e0d1SMaxime Ripard 		return PTR_ERR(tcon->regs);
4469026e0d1SMaxime Ripard 	}
4479026e0d1SMaxime Ripard 
4489026e0d1SMaxime Ripard 	/* Make sure the TCON is disabled and all IRQs are off */
4499026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON_GCTL_REG, 0);
4509026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON_GINT0_REG, 0);
4519026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON_GINT1_REG, 0);
4529026e0d1SMaxime Ripard 
4539026e0d1SMaxime Ripard 	/* Disable IO lines and set them to tristate */
4549026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON0_IO_TRI_REG, ~0);
4559026e0d1SMaxime Ripard 	regmap_write(tcon->regs, SUN4I_TCON1_IO_TRI_REG, ~0);
4569026e0d1SMaxime Ripard 
4579026e0d1SMaxime Ripard 	return 0;
4589026e0d1SMaxime Ripard }
4599026e0d1SMaxime Ripard 
460b317fa3bSChen-Yu Tsai /*
461b317fa3bSChen-Yu Tsai  * On SoCs with the old display pipeline design (Display Engine 1.0),
462b317fa3bSChen-Yu Tsai  * the TCON is always tied to just one backend. Hence we can traverse
463b317fa3bSChen-Yu Tsai  * the of_graph upwards to find the backend our tcon is connected to,
464b317fa3bSChen-Yu Tsai  * and take its ID as our own.
465b317fa3bSChen-Yu Tsai  *
466b317fa3bSChen-Yu Tsai  * We can either identify backends from their compatible strings, which
467b317fa3bSChen-Yu Tsai  * means maintaining a large list of them. Or, since the backend is
468b317fa3bSChen-Yu Tsai  * registered and binded before the TCON, we can just go through the
469b317fa3bSChen-Yu Tsai  * list of registered backends and compare the device node.
47087969338SIcenowy Zheng  *
47187969338SIcenowy Zheng  * As the structures now store engines instead of backends, here this
47287969338SIcenowy Zheng  * function in fact searches the corresponding engine, and the ID is
47387969338SIcenowy Zheng  * requested via the get_id function of the engine.
474b317fa3bSChen-Yu Tsai  */
475e8d5bbf7SChen-Yu Tsai static struct sunxi_engine *
476e8d5bbf7SChen-Yu Tsai sun4i_tcon_find_engine_traverse(struct sun4i_drv *drv,
477b317fa3bSChen-Yu Tsai 				struct device_node *node)
478b317fa3bSChen-Yu Tsai {
479b317fa3bSChen-Yu Tsai 	struct device_node *port, *ep, *remote;
480be3fe0f9SChen-Yu Tsai 	struct sunxi_engine *engine = ERR_PTR(-EINVAL);
481b317fa3bSChen-Yu Tsai 
482b317fa3bSChen-Yu Tsai 	port = of_graph_get_port_by_id(node, 0);
483b317fa3bSChen-Yu Tsai 	if (!port)
484b317fa3bSChen-Yu Tsai 		return ERR_PTR(-EINVAL);
485b317fa3bSChen-Yu Tsai 
4861469619dSChen-Yu Tsai 	/*
4871469619dSChen-Yu Tsai 	 * This only works if there is only one path from the TCON
4881469619dSChen-Yu Tsai 	 * to any display engine. Otherwise the probe order of the
4891469619dSChen-Yu Tsai 	 * TCONs and display engines is not guaranteed. They may
4901469619dSChen-Yu Tsai 	 * either bind to the wrong one, or worse, bind to the same
4911469619dSChen-Yu Tsai 	 * one if additional checks are not done.
4921469619dSChen-Yu Tsai 	 *
4931469619dSChen-Yu Tsai 	 * Bail out if there are multiple input connections.
4941469619dSChen-Yu Tsai 	 */
495be3fe0f9SChen-Yu Tsai 	if (of_get_available_child_count(port) != 1)
496be3fe0f9SChen-Yu Tsai 		goto out_put_port;
4971469619dSChen-Yu Tsai 
498be3fe0f9SChen-Yu Tsai 	/* Get the first connection without specifying an ID */
499be3fe0f9SChen-Yu Tsai 	ep = of_get_next_available_child(port, NULL);
500be3fe0f9SChen-Yu Tsai 	if (!ep)
501be3fe0f9SChen-Yu Tsai 		goto out_put_port;
502be3fe0f9SChen-Yu Tsai 
503b317fa3bSChen-Yu Tsai 	remote = of_graph_get_remote_port_parent(ep);
504b317fa3bSChen-Yu Tsai 	if (!remote)
505be3fe0f9SChen-Yu Tsai 		goto out_put_ep;
506b317fa3bSChen-Yu Tsai 
50787969338SIcenowy Zheng 	/* does this node match any registered engines? */
508be3fe0f9SChen-Yu Tsai 	list_for_each_entry(engine, &drv->engine_list, list)
509be3fe0f9SChen-Yu Tsai 		if (remote == engine->node)
510be3fe0f9SChen-Yu Tsai 			goto out_put_remote;
511b317fa3bSChen-Yu Tsai 
512b317fa3bSChen-Yu Tsai 	/* keep looking through upstream ports */
513e8d5bbf7SChen-Yu Tsai 	engine = sun4i_tcon_find_engine_traverse(drv, remote);
514b317fa3bSChen-Yu Tsai 
515be3fe0f9SChen-Yu Tsai out_put_remote:
516be3fe0f9SChen-Yu Tsai 	of_node_put(remote);
517be3fe0f9SChen-Yu Tsai out_put_ep:
518be3fe0f9SChen-Yu Tsai 	of_node_put(ep);
519be3fe0f9SChen-Yu Tsai out_put_port:
520be3fe0f9SChen-Yu Tsai 	of_node_put(port);
521be3fe0f9SChen-Yu Tsai 
522be3fe0f9SChen-Yu Tsai 	return engine;
523b317fa3bSChen-Yu Tsai }
524b317fa3bSChen-Yu Tsai 
525e8d5bbf7SChen-Yu Tsai /*
526e8d5bbf7SChen-Yu Tsai  * The device tree binding says that the remote endpoint ID of any
527e8d5bbf7SChen-Yu Tsai  * connection between components, up to and including the TCON, of
528e8d5bbf7SChen-Yu Tsai  * the display pipeline should be equal to the actual ID of the local
529e8d5bbf7SChen-Yu Tsai  * component. Thus we can look at any one of the input connections of
530e8d5bbf7SChen-Yu Tsai  * the TCONs, and use that connection's remote endpoint ID as our own.
531e8d5bbf7SChen-Yu Tsai  *
532e8d5bbf7SChen-Yu Tsai  * Since the user of this function already finds the input port,
533e8d5bbf7SChen-Yu Tsai  * the port is passed in directly without further checks.
534e8d5bbf7SChen-Yu Tsai  */
535e8d5bbf7SChen-Yu Tsai static int sun4i_tcon_of_get_id_from_port(struct device_node *port)
536e8d5bbf7SChen-Yu Tsai {
537e8d5bbf7SChen-Yu Tsai 	struct device_node *ep;
538e8d5bbf7SChen-Yu Tsai 	int ret = -EINVAL;
539e8d5bbf7SChen-Yu Tsai 
540e8d5bbf7SChen-Yu Tsai 	/* try finding an upstream endpoint */
541e8d5bbf7SChen-Yu Tsai 	for_each_available_child_of_node(port, ep) {
542e8d5bbf7SChen-Yu Tsai 		struct device_node *remote;
543e8d5bbf7SChen-Yu Tsai 		u32 reg;
544e8d5bbf7SChen-Yu Tsai 
545e8d5bbf7SChen-Yu Tsai 		remote = of_graph_get_remote_endpoint(ep);
546e8d5bbf7SChen-Yu Tsai 		if (!remote)
547e8d5bbf7SChen-Yu Tsai 			continue;
548e8d5bbf7SChen-Yu Tsai 
549e8d5bbf7SChen-Yu Tsai 		ret = of_property_read_u32(remote, "reg", &reg);
550e8d5bbf7SChen-Yu Tsai 		if (ret)
551e8d5bbf7SChen-Yu Tsai 			continue;
552e8d5bbf7SChen-Yu Tsai 
553e8d5bbf7SChen-Yu Tsai 		ret = reg;
554e8d5bbf7SChen-Yu Tsai 	}
555e8d5bbf7SChen-Yu Tsai 
556e8d5bbf7SChen-Yu Tsai 	return ret;
557e8d5bbf7SChen-Yu Tsai }
558e8d5bbf7SChen-Yu Tsai 
559e8d5bbf7SChen-Yu Tsai /*
560e8d5bbf7SChen-Yu Tsai  * Once we know the TCON's id, we can look through the list of
561e8d5bbf7SChen-Yu Tsai  * engines to find a matching one. We assume all engines have
562e8d5bbf7SChen-Yu Tsai  * been probed and added to the list.
563e8d5bbf7SChen-Yu Tsai  */
564e8d5bbf7SChen-Yu Tsai static struct sunxi_engine *sun4i_tcon_get_engine_by_id(struct sun4i_drv *drv,
565e8d5bbf7SChen-Yu Tsai 							int id)
566e8d5bbf7SChen-Yu Tsai {
567e8d5bbf7SChen-Yu Tsai 	struct sunxi_engine *engine;
568e8d5bbf7SChen-Yu Tsai 
569e8d5bbf7SChen-Yu Tsai 	list_for_each_entry(engine, &drv->engine_list, list)
570e8d5bbf7SChen-Yu Tsai 		if (engine->id == id)
571e8d5bbf7SChen-Yu Tsai 			return engine;
572e8d5bbf7SChen-Yu Tsai 
573e8d5bbf7SChen-Yu Tsai 	return ERR_PTR(-EINVAL);
574e8d5bbf7SChen-Yu Tsai }
575e8d5bbf7SChen-Yu Tsai 
576e8d5bbf7SChen-Yu Tsai /*
577e8d5bbf7SChen-Yu Tsai  * On SoCs with the old display pipeline design (Display Engine 1.0),
578e8d5bbf7SChen-Yu Tsai  * we assumed the TCON was always tied to just one backend. However
579e8d5bbf7SChen-Yu Tsai  * this proved not to be the case. On the A31, the TCON can select
580e8d5bbf7SChen-Yu Tsai  * either backend as its source. On the A20 (and likely on the A10),
581e8d5bbf7SChen-Yu Tsai  * the backend can choose which TCON to output to.
582e8d5bbf7SChen-Yu Tsai  *
583e8d5bbf7SChen-Yu Tsai  * The device tree binding says that the remote endpoint ID of any
584e8d5bbf7SChen-Yu Tsai  * connection between components, up to and including the TCON, of
585e8d5bbf7SChen-Yu Tsai  * the display pipeline should be equal to the actual ID of the local
586e8d5bbf7SChen-Yu Tsai  * component. Thus we should be able to look at any one of the input
587e8d5bbf7SChen-Yu Tsai  * connections of the TCONs, and use that connection's remote endpoint
588e8d5bbf7SChen-Yu Tsai  * ID as our own.
589e8d5bbf7SChen-Yu Tsai  *
590e8d5bbf7SChen-Yu Tsai  * However  the connections between the backend and TCON were assumed
591e8d5bbf7SChen-Yu Tsai  * to be always singular, and their endpoit IDs were all incorrectly
592e8d5bbf7SChen-Yu Tsai  * set to 0. This means for these old device trees, we cannot just look
593e8d5bbf7SChen-Yu Tsai  * up the remote endpoint ID of a TCON input endpoint. TCON1 would be
594e8d5bbf7SChen-Yu Tsai  * incorrectly identified as TCON0.
595e8d5bbf7SChen-Yu Tsai  *
596e8d5bbf7SChen-Yu Tsai  * This function first checks if the TCON node has 2 input endpoints.
597e8d5bbf7SChen-Yu Tsai  * If so, then the device tree is a corrected version, and it will use
598e8d5bbf7SChen-Yu Tsai  * sun4i_tcon_of_get_id() and sun4i_tcon_get_engine_by_id() from above
599e8d5bbf7SChen-Yu Tsai  * to fetch the ID and engine directly. If not, then it is likely an
600e8d5bbf7SChen-Yu Tsai  * old device trees, where the endpoint IDs were incorrect, but did not
601e8d5bbf7SChen-Yu Tsai  * have endpoint connections between the backend and TCON across
602e8d5bbf7SChen-Yu Tsai  * different display pipelines. It will fall back to the old method of
603e8d5bbf7SChen-Yu Tsai  * traversing the  of_graph to try and find a matching engine by device
604e8d5bbf7SChen-Yu Tsai  * node.
605e8d5bbf7SChen-Yu Tsai  *
606e8d5bbf7SChen-Yu Tsai  * In the case of single display pipeline device trees, either method
607e8d5bbf7SChen-Yu Tsai  * works.
608e8d5bbf7SChen-Yu Tsai  */
609e8d5bbf7SChen-Yu Tsai static struct sunxi_engine *sun4i_tcon_find_engine(struct sun4i_drv *drv,
610e8d5bbf7SChen-Yu Tsai 						   struct device_node *node)
611e8d5bbf7SChen-Yu Tsai {
612e8d5bbf7SChen-Yu Tsai 	struct device_node *port;
613e8d5bbf7SChen-Yu Tsai 	struct sunxi_engine *engine;
614e8d5bbf7SChen-Yu Tsai 
615e8d5bbf7SChen-Yu Tsai 	port = of_graph_get_port_by_id(node, 0);
616e8d5bbf7SChen-Yu Tsai 	if (!port)
617e8d5bbf7SChen-Yu Tsai 		return ERR_PTR(-EINVAL);
618e8d5bbf7SChen-Yu Tsai 
619e8d5bbf7SChen-Yu Tsai 	/*
620e8d5bbf7SChen-Yu Tsai 	 * Is this a corrected device tree with cross pipeline
621e8d5bbf7SChen-Yu Tsai 	 * connections between the backend and TCON?
622e8d5bbf7SChen-Yu Tsai 	 */
623e8d5bbf7SChen-Yu Tsai 	if (of_get_child_count(port) > 1) {
624e8d5bbf7SChen-Yu Tsai 		/* Get our ID directly from an upstream endpoint */
625e8d5bbf7SChen-Yu Tsai 		int id = sun4i_tcon_of_get_id_from_port(port);
626e8d5bbf7SChen-Yu Tsai 
627e8d5bbf7SChen-Yu Tsai 		/* Get our engine by matching our ID */
628e8d5bbf7SChen-Yu Tsai 		engine = sun4i_tcon_get_engine_by_id(drv, id);
629e8d5bbf7SChen-Yu Tsai 
630e8d5bbf7SChen-Yu Tsai 		of_node_put(port);
631e8d5bbf7SChen-Yu Tsai 		return engine;
632e8d5bbf7SChen-Yu Tsai 	}
633e8d5bbf7SChen-Yu Tsai 
634e8d5bbf7SChen-Yu Tsai 	/* Fallback to old method by traversing input endpoints */
635e8d5bbf7SChen-Yu Tsai 	of_node_put(port);
636e8d5bbf7SChen-Yu Tsai 	return sun4i_tcon_find_engine_traverse(drv, node);
637e8d5bbf7SChen-Yu Tsai }
638e8d5bbf7SChen-Yu Tsai 
6399026e0d1SMaxime Ripard static int sun4i_tcon_bind(struct device *dev, struct device *master,
6409026e0d1SMaxime Ripard 			   void *data)
6419026e0d1SMaxime Ripard {
6429026e0d1SMaxime Ripard 	struct drm_device *drm = data;
6439026e0d1SMaxime Ripard 	struct sun4i_drv *drv = drm->dev_private;
64487969338SIcenowy Zheng 	struct sunxi_engine *engine;
6459026e0d1SMaxime Ripard 	struct sun4i_tcon *tcon;
6469026e0d1SMaxime Ripard 	int ret;
6479026e0d1SMaxime Ripard 
64887969338SIcenowy Zheng 	engine = sun4i_tcon_find_engine(drv, dev->of_node);
64987969338SIcenowy Zheng 	if (IS_ERR(engine)) {
65087969338SIcenowy Zheng 		dev_err(dev, "Couldn't find matching engine\n");
65180a58240SChen-Yu Tsai 		return -EPROBE_DEFER;
652b317fa3bSChen-Yu Tsai 	}
65380a58240SChen-Yu Tsai 
6549026e0d1SMaxime Ripard 	tcon = devm_kzalloc(dev, sizeof(*tcon), GFP_KERNEL);
6559026e0d1SMaxime Ripard 	if (!tcon)
6569026e0d1SMaxime Ripard 		return -ENOMEM;
6579026e0d1SMaxime Ripard 	dev_set_drvdata(dev, tcon);
6589026e0d1SMaxime Ripard 	tcon->drm = drm;
659ae558110SMaxime Ripard 	tcon->dev = dev;
66087969338SIcenowy Zheng 	tcon->id = engine->id;
66191ea2f29SChen-Yu Tsai 	tcon->quirks = of_device_get_match_data(dev);
6629026e0d1SMaxime Ripard 
6639026e0d1SMaxime Ripard 	tcon->lcd_rst = devm_reset_control_get(dev, "lcd");
6649026e0d1SMaxime Ripard 	if (IS_ERR(tcon->lcd_rst)) {
6659026e0d1SMaxime Ripard 		dev_err(dev, "Couldn't get our reset line\n");
6669026e0d1SMaxime Ripard 		return PTR_ERR(tcon->lcd_rst);
6679026e0d1SMaxime Ripard 	}
6689026e0d1SMaxime Ripard 
6699026e0d1SMaxime Ripard 	/* Make sure our TCON is reset */
670d57294c1SChen-Yu Tsai 	ret = reset_control_reset(tcon->lcd_rst);
6719026e0d1SMaxime Ripard 	if (ret) {
6729026e0d1SMaxime Ripard 		dev_err(dev, "Couldn't deassert our reset line\n");
6739026e0d1SMaxime Ripard 		return ret;
6749026e0d1SMaxime Ripard 	}
6759026e0d1SMaxime Ripard 
6769026e0d1SMaxime Ripard 	ret = sun4i_tcon_init_clocks(dev, tcon);
6779026e0d1SMaxime Ripard 	if (ret) {
6789026e0d1SMaxime Ripard 		dev_err(dev, "Couldn't init our TCON clocks\n");
6799026e0d1SMaxime Ripard 		goto err_assert_reset;
6809026e0d1SMaxime Ripard 	}
6819026e0d1SMaxime Ripard 
6824c7f16d1SChen-Yu Tsai 	ret = sun4i_tcon_init_regmap(dev, tcon);
6839026e0d1SMaxime Ripard 	if (ret) {
6844c7f16d1SChen-Yu Tsai 		dev_err(dev, "Couldn't init our TCON regmap\n");
6859026e0d1SMaxime Ripard 		goto err_free_clocks;
6869026e0d1SMaxime Ripard 	}
6879026e0d1SMaxime Ripard 
6884c7f16d1SChen-Yu Tsai 	ret = sun4i_dclk_create(dev, tcon);
6894c7f16d1SChen-Yu Tsai 	if (ret) {
6904c7f16d1SChen-Yu Tsai 		dev_err(dev, "Couldn't create our TCON dot clock\n");
6914c7f16d1SChen-Yu Tsai 		goto err_free_clocks;
6924c7f16d1SChen-Yu Tsai 	}
6934c7f16d1SChen-Yu Tsai 
6949026e0d1SMaxime Ripard 	ret = sun4i_tcon_init_irq(dev, tcon);
6959026e0d1SMaxime Ripard 	if (ret) {
6969026e0d1SMaxime Ripard 		dev_err(dev, "Couldn't init our TCON interrupts\n");
6974c7f16d1SChen-Yu Tsai 		goto err_free_dotclock;
6989026e0d1SMaxime Ripard 	}
6999026e0d1SMaxime Ripard 
70087969338SIcenowy Zheng 	tcon->crtc = sun4i_crtc_init(drm, engine, tcon);
70146cce6daSChen-Yu Tsai 	if (IS_ERR(tcon->crtc)) {
70246cce6daSChen-Yu Tsai 		dev_err(dev, "Couldn't create our CRTC\n");
70346cce6daSChen-Yu Tsai 		ret = PTR_ERR(tcon->crtc);
70446cce6daSChen-Yu Tsai 		goto err_free_clocks;
70546cce6daSChen-Yu Tsai 	}
70646cce6daSChen-Yu Tsai 
707b9c8506cSChen-Yu Tsai 	ret = sun4i_rgb_init(drm, tcon);
70813fef095SChen-Yu Tsai 	if (ret < 0)
70913fef095SChen-Yu Tsai 		goto err_free_clocks;
71013fef095SChen-Yu Tsai 
71127e18de7SChen-Yu Tsai 	if (tcon->quirks->needs_de_be_mux) {
71227e18de7SChen-Yu Tsai 		/*
71327e18de7SChen-Yu Tsai 		 * We assume there is no dynamic muxing of backends
71427e18de7SChen-Yu Tsai 		 * and TCONs, so we select the backend with same ID.
71527e18de7SChen-Yu Tsai 		 *
71627e18de7SChen-Yu Tsai 		 * While dynamic selection might be interesting, since
71727e18de7SChen-Yu Tsai 		 * the CRTC is tied to the TCON, while the layers are
71827e18de7SChen-Yu Tsai 		 * tied to the backends, this means, we will need to
71927e18de7SChen-Yu Tsai 		 * switch between groups of layers. There might not be
72027e18de7SChen-Yu Tsai 		 * a way to represent this constraint in DRM.
72127e18de7SChen-Yu Tsai 		 */
72227e18de7SChen-Yu Tsai 		regmap_update_bits(tcon->regs, SUN4I_TCON0_CTL_REG,
72327e18de7SChen-Yu Tsai 				   SUN4I_TCON0_CTL_SRC_SEL_MASK,
72427e18de7SChen-Yu Tsai 				   tcon->id);
72527e18de7SChen-Yu Tsai 		regmap_update_bits(tcon->regs, SUN4I_TCON1_CTL_REG,
72627e18de7SChen-Yu Tsai 				   SUN4I_TCON1_CTL_SRC_SEL_MASK,
72727e18de7SChen-Yu Tsai 				   tcon->id);
72827e18de7SChen-Yu Tsai 	}
72927e18de7SChen-Yu Tsai 
73080a58240SChen-Yu Tsai 	list_add_tail(&tcon->list, &drv->tcon_list);
73180a58240SChen-Yu Tsai 
73213fef095SChen-Yu Tsai 	return 0;
7339026e0d1SMaxime Ripard 
7344c7f16d1SChen-Yu Tsai err_free_dotclock:
7354c7f16d1SChen-Yu Tsai 	sun4i_dclk_free(tcon);
7369026e0d1SMaxime Ripard err_free_clocks:
7379026e0d1SMaxime Ripard 	sun4i_tcon_free_clocks(tcon);
7389026e0d1SMaxime Ripard err_assert_reset:
7399026e0d1SMaxime Ripard 	reset_control_assert(tcon->lcd_rst);
7409026e0d1SMaxime Ripard 	return ret;
7419026e0d1SMaxime Ripard }
7429026e0d1SMaxime Ripard 
7439026e0d1SMaxime Ripard static void sun4i_tcon_unbind(struct device *dev, struct device *master,
7449026e0d1SMaxime Ripard 			      void *data)
7459026e0d1SMaxime Ripard {
7469026e0d1SMaxime Ripard 	struct sun4i_tcon *tcon = dev_get_drvdata(dev);
7479026e0d1SMaxime Ripard 
74880a58240SChen-Yu Tsai 	list_del(&tcon->list);
7494c7f16d1SChen-Yu Tsai 	sun4i_dclk_free(tcon);
7509026e0d1SMaxime Ripard 	sun4i_tcon_free_clocks(tcon);
7519026e0d1SMaxime Ripard }
7529026e0d1SMaxime Ripard 
753dfeb693dSJulia Lawall static const struct component_ops sun4i_tcon_ops = {
7549026e0d1SMaxime Ripard 	.bind	= sun4i_tcon_bind,
7559026e0d1SMaxime Ripard 	.unbind	= sun4i_tcon_unbind,
7569026e0d1SMaxime Ripard };
7579026e0d1SMaxime Ripard 
7589026e0d1SMaxime Ripard static int sun4i_tcon_probe(struct platform_device *pdev)
7599026e0d1SMaxime Ripard {
76029e57fabSMaxime Ripard 	struct device_node *node = pdev->dev.of_node;
761894f5a9fSMaxime Ripard 	struct drm_bridge *bridge;
76229e57fabSMaxime Ripard 	struct drm_panel *panel;
763ebc94461SRob Herring 	int ret;
76429e57fabSMaxime Ripard 
765ebc94461SRob Herring 	ret = drm_of_find_panel_or_bridge(node, 1, 0, &panel, &bridge);
766ebc94461SRob Herring 	if (ret == -EPROBE_DEFER)
767ebc94461SRob Herring 		return ret;
76829e57fabSMaxime Ripard 
7699026e0d1SMaxime Ripard 	return component_add(&pdev->dev, &sun4i_tcon_ops);
7709026e0d1SMaxime Ripard }
7719026e0d1SMaxime Ripard 
7729026e0d1SMaxime Ripard static int sun4i_tcon_remove(struct platform_device *pdev)
7739026e0d1SMaxime Ripard {
7749026e0d1SMaxime Ripard 	component_del(&pdev->dev, &sun4i_tcon_ops);
7759026e0d1SMaxime Ripard 
7769026e0d1SMaxime Ripard 	return 0;
7779026e0d1SMaxime Ripard }
7789026e0d1SMaxime Ripard 
779ad537fb2SChen-Yu Tsai /* platform specific TCON muxing callbacks */
780ad537fb2SChen-Yu Tsai static int sun5i_a13_tcon_set_mux(struct sun4i_tcon *tcon,
781abcb8766SMaxime Ripard 				  const struct drm_encoder *encoder)
782ad537fb2SChen-Yu Tsai {
783ad537fb2SChen-Yu Tsai 	u32 val;
784ad537fb2SChen-Yu Tsai 
785ad537fb2SChen-Yu Tsai 	if (encoder->encoder_type == DRM_MODE_ENCODER_TVDAC)
786ad537fb2SChen-Yu Tsai 		val = 1;
787ad537fb2SChen-Yu Tsai 	else
788ad537fb2SChen-Yu Tsai 		val = 0;
789ad537fb2SChen-Yu Tsai 
790ad537fb2SChen-Yu Tsai 	/*
791ad537fb2SChen-Yu Tsai 	 * FIXME: Undocumented bits
792ad537fb2SChen-Yu Tsai 	 */
793ad537fb2SChen-Yu Tsai 	return regmap_write(tcon->regs, SUN4I_TCON_MUX_CTRL_REG, val);
794ad537fb2SChen-Yu Tsai }
795ad537fb2SChen-Yu Tsai 
79667e32645SChen-Yu Tsai static int sun6i_tcon_set_mux(struct sun4i_tcon *tcon,
797abcb8766SMaxime Ripard 			      const struct drm_encoder *encoder)
79867e32645SChen-Yu Tsai {
79967e32645SChen-Yu Tsai 	struct sun4i_tcon *tcon0 = sun4i_get_tcon0(encoder->dev);
80067e32645SChen-Yu Tsai 	u32 shift;
80167e32645SChen-Yu Tsai 
80267e32645SChen-Yu Tsai 	if (!tcon0)
80367e32645SChen-Yu Tsai 		return -EINVAL;
80467e32645SChen-Yu Tsai 
80567e32645SChen-Yu Tsai 	switch (encoder->encoder_type) {
80667e32645SChen-Yu Tsai 	case DRM_MODE_ENCODER_TMDS:
80767e32645SChen-Yu Tsai 		/* HDMI */
80867e32645SChen-Yu Tsai 		shift = 8;
80967e32645SChen-Yu Tsai 		break;
81067e32645SChen-Yu Tsai 	default:
81167e32645SChen-Yu Tsai 		/* TODO A31 has MIPI DSI but A31s does not */
81267e32645SChen-Yu Tsai 		return -EINVAL;
81367e32645SChen-Yu Tsai 	}
81467e32645SChen-Yu Tsai 
81567e32645SChen-Yu Tsai 	regmap_update_bits(tcon0->regs, SUN4I_TCON_MUX_CTRL_REG,
81667e32645SChen-Yu Tsai 			   0x3 << shift, tcon->id << shift);
81767e32645SChen-Yu Tsai 
81867e32645SChen-Yu Tsai 	return 0;
81967e32645SChen-Yu Tsai }
82067e32645SChen-Yu Tsai 
82191ea2f29SChen-Yu Tsai static const struct sun4i_tcon_quirks sun5i_a13_quirks = {
82291ea2f29SChen-Yu Tsai 	.has_channel_1		= true,
823ad537fb2SChen-Yu Tsai 	.set_mux		= sun5i_a13_tcon_set_mux,
82491ea2f29SChen-Yu Tsai };
82591ea2f29SChen-Yu Tsai 
82693a5ec14SChen-Yu Tsai static const struct sun4i_tcon_quirks sun6i_a31_quirks = {
82793a5ec14SChen-Yu Tsai 	.has_channel_1		= true,
82827e18de7SChen-Yu Tsai 	.needs_de_be_mux	= true,
82967e32645SChen-Yu Tsai 	.set_mux		= sun6i_tcon_set_mux,
83093a5ec14SChen-Yu Tsai };
83193a5ec14SChen-Yu Tsai 
83293a5ec14SChen-Yu Tsai static const struct sun4i_tcon_quirks sun6i_a31s_quirks = {
83393a5ec14SChen-Yu Tsai 	.has_channel_1		= true,
83427e18de7SChen-Yu Tsai 	.needs_de_be_mux	= true,
83593a5ec14SChen-Yu Tsai };
83693a5ec14SChen-Yu Tsai 
83791ea2f29SChen-Yu Tsai static const struct sun4i_tcon_quirks sun8i_a33_quirks = {
83891ea2f29SChen-Yu Tsai 	/* nothing is supported */
83991ea2f29SChen-Yu Tsai };
84091ea2f29SChen-Yu Tsai 
8411a0edb3fSIcenowy Zheng static const struct sun4i_tcon_quirks sun8i_v3s_quirks = {
8421a0edb3fSIcenowy Zheng 	/* nothing is supported */
8431a0edb3fSIcenowy Zheng };
8441a0edb3fSIcenowy Zheng 
8459026e0d1SMaxime Ripard static const struct of_device_id sun4i_tcon_of_table[] = {
84691ea2f29SChen-Yu Tsai 	{ .compatible = "allwinner,sun5i-a13-tcon", .data = &sun5i_a13_quirks },
84793a5ec14SChen-Yu Tsai 	{ .compatible = "allwinner,sun6i-a31-tcon", .data = &sun6i_a31_quirks },
84893a5ec14SChen-Yu Tsai 	{ .compatible = "allwinner,sun6i-a31s-tcon", .data = &sun6i_a31s_quirks },
84991ea2f29SChen-Yu Tsai 	{ .compatible = "allwinner,sun8i-a33-tcon", .data = &sun8i_a33_quirks },
8501a0edb3fSIcenowy Zheng 	{ .compatible = "allwinner,sun8i-v3s-tcon", .data = &sun8i_v3s_quirks },
8519026e0d1SMaxime Ripard 	{ }
8529026e0d1SMaxime Ripard };
8539026e0d1SMaxime Ripard MODULE_DEVICE_TABLE(of, sun4i_tcon_of_table);
8549026e0d1SMaxime Ripard 
8559026e0d1SMaxime Ripard static struct platform_driver sun4i_tcon_platform_driver = {
8569026e0d1SMaxime Ripard 	.probe		= sun4i_tcon_probe,
8579026e0d1SMaxime Ripard 	.remove		= sun4i_tcon_remove,
8589026e0d1SMaxime Ripard 	.driver		= {
8599026e0d1SMaxime Ripard 		.name		= "sun4i-tcon",
8609026e0d1SMaxime Ripard 		.of_match_table	= sun4i_tcon_of_table,
8619026e0d1SMaxime Ripard 	},
8629026e0d1SMaxime Ripard };
8639026e0d1SMaxime Ripard module_platform_driver(sun4i_tcon_platform_driver);
8649026e0d1SMaxime Ripard 
8659026e0d1SMaxime Ripard MODULE_AUTHOR("Maxime Ripard <maxime.ripard@free-electrons.com>");
8669026e0d1SMaxime Ripard MODULE_DESCRIPTION("Allwinner A10 Timing Controller Driver");
8679026e0d1SMaxime Ripard MODULE_LICENSE("GPL");
868