xref: /openbmc/linux/drivers/gpu/drm/tegra/dc.c (revision 977697e20b3d758786b67edc33941e5c410ffe4d)
1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2dee8268fSThierry Reding /*
3dee8268fSThierry Reding  * Copyright (C) 2012 Avionic Design GmbH
4dee8268fSThierry Reding  * Copyright (C) 2012 NVIDIA CORPORATION.  All rights reserved.
5dee8268fSThierry Reding  */
6dee8268fSThierry Reding 
7dee8268fSThierry Reding #include <linux/clk.h>
8dee8268fSThierry Reding #include <linux/debugfs.h>
9eb1df694SSam Ravnborg #include <linux/delay.h>
10df06b759SThierry Reding #include <linux/iommu.h>
11eb1df694SSam Ravnborg #include <linux/module.h>
12b9ff7aeaSThierry Reding #include <linux/of_device.h>
1333a8eb8dSThierry Reding #include <linux/pm_runtime.h>
14ca48080aSStephen Warren #include <linux/reset.h>
15dee8268fSThierry Reding 
169c012700SThierry Reding #include <soc/tegra/pmc.h>
179c012700SThierry Reding 
18eb1df694SSam Ravnborg #include <drm/drm_atomic.h>
19eb1df694SSam Ravnborg #include <drm/drm_atomic_helper.h>
20eb1df694SSam Ravnborg #include <drm/drm_debugfs.h>
21eb1df694SSam Ravnborg #include <drm/drm_fourcc.h>
22eb1df694SSam Ravnborg #include <drm/drm_plane_helper.h>
23eb1df694SSam Ravnborg #include <drm/drm_vblank.h>
24eb1df694SSam Ravnborg 
25dee8268fSThierry Reding #include "dc.h"
26dee8268fSThierry Reding #include "drm.h"
27dee8268fSThierry Reding #include "gem.h"
2847307954SThierry Reding #include "hub.h"
295acd3514SThierry Reding #include "plane.h"
30dee8268fSThierry Reding 
31b7e0b04aSMaarten Lankhorst static void tegra_crtc_atomic_destroy_state(struct drm_crtc *crtc,
32b7e0b04aSMaarten Lankhorst 					    struct drm_crtc_state *state);
33b7e0b04aSMaarten Lankhorst 
34791ddb1eSThierry Reding static void tegra_dc_stats_reset(struct tegra_dc_stats *stats)
35791ddb1eSThierry Reding {
36791ddb1eSThierry Reding 	stats->frames = 0;
37791ddb1eSThierry Reding 	stats->vblank = 0;
38791ddb1eSThierry Reding 	stats->underflow = 0;
39791ddb1eSThierry Reding 	stats->overflow = 0;
40791ddb1eSThierry Reding }
41791ddb1eSThierry Reding 
421087fac1SThierry Reding /* Reads the active copy of a register. */
4386df256fSThierry Reding static u32 tegra_dc_readl_active(struct tegra_dc *dc, unsigned long offset)
4486df256fSThierry Reding {
4586df256fSThierry Reding 	u32 value;
4686df256fSThierry Reding 
4786df256fSThierry Reding 	tegra_dc_writel(dc, READ_MUX, DC_CMD_STATE_ACCESS);
4886df256fSThierry Reding 	value = tegra_dc_readl(dc, offset);
4986df256fSThierry Reding 	tegra_dc_writel(dc, 0, DC_CMD_STATE_ACCESS);
5086df256fSThierry Reding 
5186df256fSThierry Reding 	return value;
5286df256fSThierry Reding }
5386df256fSThierry Reding 
541087fac1SThierry Reding static inline unsigned int tegra_plane_offset(struct tegra_plane *plane,
551087fac1SThierry Reding 					      unsigned int offset)
561087fac1SThierry Reding {
571087fac1SThierry Reding 	if (offset >= 0x500 && offset <= 0x638) {
581087fac1SThierry Reding 		offset = 0x000 + (offset - 0x500);
591087fac1SThierry Reding 		return plane->offset + offset;
601087fac1SThierry Reding 	}
611087fac1SThierry Reding 
621087fac1SThierry Reding 	if (offset >= 0x700 && offset <= 0x719) {
631087fac1SThierry Reding 		offset = 0x180 + (offset - 0x700);
641087fac1SThierry Reding 		return plane->offset + offset;
651087fac1SThierry Reding 	}
661087fac1SThierry Reding 
671087fac1SThierry Reding 	if (offset >= 0x800 && offset <= 0x839) {
681087fac1SThierry Reding 		offset = 0x1c0 + (offset - 0x800);
691087fac1SThierry Reding 		return plane->offset + offset;
701087fac1SThierry Reding 	}
711087fac1SThierry Reding 
721087fac1SThierry Reding 	dev_WARN(plane->dc->dev, "invalid offset: %x\n", offset);
731087fac1SThierry Reding 
741087fac1SThierry Reding 	return plane->offset + offset;
751087fac1SThierry Reding }
761087fac1SThierry Reding 
771087fac1SThierry Reding static inline u32 tegra_plane_readl(struct tegra_plane *plane,
781087fac1SThierry Reding 				    unsigned int offset)
791087fac1SThierry Reding {
801087fac1SThierry Reding 	return tegra_dc_readl(plane->dc, tegra_plane_offset(plane, offset));
811087fac1SThierry Reding }
821087fac1SThierry Reding 
831087fac1SThierry Reding static inline void tegra_plane_writel(struct tegra_plane *plane, u32 value,
841087fac1SThierry Reding 				      unsigned int offset)
851087fac1SThierry Reding {
861087fac1SThierry Reding 	tegra_dc_writel(plane->dc, value, tegra_plane_offset(plane, offset));
871087fac1SThierry Reding }
881087fac1SThierry Reding 
89c57997bcSThierry Reding bool tegra_dc_has_output(struct tegra_dc *dc, struct device *dev)
90c57997bcSThierry Reding {
91c57997bcSThierry Reding 	struct device_node *np = dc->dev->of_node;
92c57997bcSThierry Reding 	struct of_phandle_iterator it;
93c57997bcSThierry Reding 	int err;
94c57997bcSThierry Reding 
95c57997bcSThierry Reding 	of_for_each_phandle(&it, err, np, "nvidia,outputs", NULL, 0)
96c57997bcSThierry Reding 		if (it.node == dev->of_node)
97c57997bcSThierry Reding 			return true;
98c57997bcSThierry Reding 
99c57997bcSThierry Reding 	return false;
100c57997bcSThierry Reding }
101c57997bcSThierry Reding 
10286df256fSThierry Reding /*
103d700ba7aSThierry Reding  * Double-buffered registers have two copies: ASSEMBLY and ACTIVE. When the
104d700ba7aSThierry Reding  * *_ACT_REQ bits are set the ASSEMBLY copy is latched into the ACTIVE copy.
105d700ba7aSThierry Reding  * Latching happens mmediately if the display controller is in STOP mode or
106d700ba7aSThierry Reding  * on the next frame boundary otherwise.
107d700ba7aSThierry Reding  *
108d700ba7aSThierry Reding  * Triple-buffered registers have three copies: ASSEMBLY, ARM and ACTIVE. The
109d700ba7aSThierry Reding  * ASSEMBLY copy is latched into the ARM copy immediately after *_UPDATE bits
110d700ba7aSThierry Reding  * are written. When the *_ACT_REQ bits are written, the ARM copy is latched
111d700ba7aSThierry Reding  * into the ACTIVE copy, either immediately if the display controller is in
112d700ba7aSThierry Reding  * STOP mode, or at the next frame boundary otherwise.
113d700ba7aSThierry Reding  */
11462b9e063SThierry Reding void tegra_dc_commit(struct tegra_dc *dc)
115205d48edSThierry Reding {
116205d48edSThierry Reding 	tegra_dc_writel(dc, GENERAL_ACT_REQ << 8, DC_CMD_STATE_CONTROL);
117205d48edSThierry Reding 	tegra_dc_writel(dc, GENERAL_ACT_REQ, DC_CMD_STATE_CONTROL);
118205d48edSThierry Reding }
119205d48edSThierry Reding 
12010288eeaSThierry Reding static inline u32 compute_dda_inc(unsigned int in, unsigned int out, bool v,
12110288eeaSThierry Reding 				  unsigned int bpp)
12210288eeaSThierry Reding {
12310288eeaSThierry Reding 	fixed20_12 outf = dfixed_init(out);
12410288eeaSThierry Reding 	fixed20_12 inf = dfixed_init(in);
12510288eeaSThierry Reding 	u32 dda_inc;
12610288eeaSThierry Reding 	int max;
12710288eeaSThierry Reding 
12810288eeaSThierry Reding 	if (v)
12910288eeaSThierry Reding 		max = 15;
13010288eeaSThierry Reding 	else {
13110288eeaSThierry Reding 		switch (bpp) {
13210288eeaSThierry Reding 		case 2:
13310288eeaSThierry Reding 			max = 8;
13410288eeaSThierry Reding 			break;
13510288eeaSThierry Reding 
13610288eeaSThierry Reding 		default:
13710288eeaSThierry Reding 			WARN_ON_ONCE(1);
138df561f66SGustavo A. R. Silva 			fallthrough;
13910288eeaSThierry Reding 		case 4:
14010288eeaSThierry Reding 			max = 4;
14110288eeaSThierry Reding 			break;
14210288eeaSThierry Reding 		}
14310288eeaSThierry Reding 	}
14410288eeaSThierry Reding 
14510288eeaSThierry Reding 	outf.full = max_t(u32, outf.full - dfixed_const(1), dfixed_const(1));
14610288eeaSThierry Reding 	inf.full -= dfixed_const(1);
14710288eeaSThierry Reding 
14810288eeaSThierry Reding 	dda_inc = dfixed_div(inf, outf);
14910288eeaSThierry Reding 	dda_inc = min_t(u32, dda_inc, dfixed_const(max));
15010288eeaSThierry Reding 
15110288eeaSThierry Reding 	return dda_inc;
15210288eeaSThierry Reding }
15310288eeaSThierry Reding 
15410288eeaSThierry Reding static inline u32 compute_initial_dda(unsigned int in)
15510288eeaSThierry Reding {
15610288eeaSThierry Reding 	fixed20_12 inf = dfixed_init(in);
15710288eeaSThierry Reding 	return dfixed_frac(inf);
15810288eeaSThierry Reding }
15910288eeaSThierry Reding 
160ab7d3f58SThierry Reding static void tegra_plane_setup_blending_legacy(struct tegra_plane *plane)
161ab7d3f58SThierry Reding {
162ebae8d07SThierry Reding 	u32 background[3] = {
163ebae8d07SThierry Reding 		BLEND_WEIGHT1(0) | BLEND_WEIGHT0(0) | BLEND_COLOR_KEY_NONE,
164ebae8d07SThierry Reding 		BLEND_WEIGHT1(0) | BLEND_WEIGHT0(0) | BLEND_COLOR_KEY_NONE,
165ebae8d07SThierry Reding 		BLEND_WEIGHT1(0) | BLEND_WEIGHT0(0) | BLEND_COLOR_KEY_NONE,
166ebae8d07SThierry Reding 	};
167ebae8d07SThierry Reding 	u32 foreground = BLEND_WEIGHT1(255) | BLEND_WEIGHT0(255) |
168ebae8d07SThierry Reding 			 BLEND_COLOR_KEY_NONE;
169ebae8d07SThierry Reding 	u32 blendnokey = BLEND_WEIGHT1(255) | BLEND_WEIGHT0(255);
170ebae8d07SThierry Reding 	struct tegra_plane_state *state;
1713dae08bcSDmitry Osipenko 	u32 blending[2];
172ebae8d07SThierry Reding 	unsigned int i;
173ebae8d07SThierry Reding 
1743dae08bcSDmitry Osipenko 	/* disable blending for non-overlapping case */
175ebae8d07SThierry Reding 	tegra_plane_writel(plane, blendnokey, DC_WIN_BLEND_NOKEY);
176ebae8d07SThierry Reding 	tegra_plane_writel(plane, foreground, DC_WIN_BLEND_1WIN);
177ab7d3f58SThierry Reding 
1783dae08bcSDmitry Osipenko 	state = to_tegra_plane_state(plane->base.state);
1793dae08bcSDmitry Osipenko 
1803dae08bcSDmitry Osipenko 	if (state->opaque) {
1813dae08bcSDmitry Osipenko 		/*
1823dae08bcSDmitry Osipenko 		 * Since custom fix-weight blending isn't utilized and weight
1833dae08bcSDmitry Osipenko 		 * of top window is set to max, we can enforce dependent
1843dae08bcSDmitry Osipenko 		 * blending which in this case results in transparent bottom
1853dae08bcSDmitry Osipenko 		 * window if top window is opaque and if top window enables
1863dae08bcSDmitry Osipenko 		 * alpha blending, then bottom window is getting alpha value
1873dae08bcSDmitry Osipenko 		 * of 1 minus the sum of alpha components of the overlapping
1883dae08bcSDmitry Osipenko 		 * plane.
1893dae08bcSDmitry Osipenko 		 */
1903dae08bcSDmitry Osipenko 		background[0] |= BLEND_CONTROL_DEPENDENT;
1913dae08bcSDmitry Osipenko 		background[1] |= BLEND_CONTROL_DEPENDENT;
1923dae08bcSDmitry Osipenko 
1933dae08bcSDmitry Osipenko 		/*
1943dae08bcSDmitry Osipenko 		 * The region where three windows overlap is the intersection
1953dae08bcSDmitry Osipenko 		 * of the two regions where two windows overlap. It contributes
1963dae08bcSDmitry Osipenko 		 * to the area if all of the windows on top of it have an alpha
1973dae08bcSDmitry Osipenko 		 * component.
1983dae08bcSDmitry Osipenko 		 */
1993dae08bcSDmitry Osipenko 		switch (state->base.normalized_zpos) {
2003dae08bcSDmitry Osipenko 		case 0:
2013dae08bcSDmitry Osipenko 			if (state->blending[0].alpha &&
2023dae08bcSDmitry Osipenko 			    state->blending[1].alpha)
2033dae08bcSDmitry Osipenko 				background[2] |= BLEND_CONTROL_DEPENDENT;
2043dae08bcSDmitry Osipenko 			break;
2053dae08bcSDmitry Osipenko 
2063dae08bcSDmitry Osipenko 		case 1:
2073dae08bcSDmitry Osipenko 			background[2] |= BLEND_CONTROL_DEPENDENT;
2083dae08bcSDmitry Osipenko 			break;
2093dae08bcSDmitry Osipenko 		}
2103dae08bcSDmitry Osipenko 	} else {
2113dae08bcSDmitry Osipenko 		/*
2123dae08bcSDmitry Osipenko 		 * Enable alpha blending if pixel format has an alpha
2133dae08bcSDmitry Osipenko 		 * component.
2143dae08bcSDmitry Osipenko 		 */
2153dae08bcSDmitry Osipenko 		foreground |= BLEND_CONTROL_ALPHA;
2163dae08bcSDmitry Osipenko 
2173dae08bcSDmitry Osipenko 		/*
2183dae08bcSDmitry Osipenko 		 * If any of the windows on top of this window is opaque, it
2193dae08bcSDmitry Osipenko 		 * will completely conceal this window within that area. If
2203dae08bcSDmitry Osipenko 		 * top window has an alpha component, it is blended over the
2213dae08bcSDmitry Osipenko 		 * bottom window.
2223dae08bcSDmitry Osipenko 		 */
2233dae08bcSDmitry Osipenko 		for (i = 0; i < 2; i++) {
2243dae08bcSDmitry Osipenko 			if (state->blending[i].alpha &&
2253dae08bcSDmitry Osipenko 			    state->blending[i].top)
2263dae08bcSDmitry Osipenko 				background[i] |= BLEND_CONTROL_DEPENDENT;
2273dae08bcSDmitry Osipenko 		}
2283dae08bcSDmitry Osipenko 
2293dae08bcSDmitry Osipenko 		switch (state->base.normalized_zpos) {
2303dae08bcSDmitry Osipenko 		case 0:
2313dae08bcSDmitry Osipenko 			if (state->blending[0].alpha &&
2323dae08bcSDmitry Osipenko 			    state->blending[1].alpha)
2333dae08bcSDmitry Osipenko 				background[2] |= BLEND_CONTROL_DEPENDENT;
2343dae08bcSDmitry Osipenko 			break;
2353dae08bcSDmitry Osipenko 
2363dae08bcSDmitry Osipenko 		case 1:
2373dae08bcSDmitry Osipenko 			/*
2383dae08bcSDmitry Osipenko 			 * When both middle and topmost windows have an alpha,
2393dae08bcSDmitry Osipenko 			 * these windows a mixed together and then the result
2403dae08bcSDmitry Osipenko 			 * is blended over the bottom window.
2413dae08bcSDmitry Osipenko 			 */
2423dae08bcSDmitry Osipenko 			if (state->blending[0].alpha &&
2433dae08bcSDmitry Osipenko 			    state->blending[0].top)
2443dae08bcSDmitry Osipenko 				background[2] |= BLEND_CONTROL_ALPHA;
2453dae08bcSDmitry Osipenko 
2463dae08bcSDmitry Osipenko 			if (state->blending[1].alpha &&
2473dae08bcSDmitry Osipenko 			    state->blending[1].top)
2483dae08bcSDmitry Osipenko 				background[2] |= BLEND_CONTROL_ALPHA;
2493dae08bcSDmitry Osipenko 			break;
2503dae08bcSDmitry Osipenko 		}
2513dae08bcSDmitry Osipenko 	}
2523dae08bcSDmitry Osipenko 
2533dae08bcSDmitry Osipenko 	switch (state->base.normalized_zpos) {
254ab7d3f58SThierry Reding 	case 0:
255ebae8d07SThierry Reding 		tegra_plane_writel(plane, background[0], DC_WIN_BLEND_2WIN_X);
256ebae8d07SThierry Reding 		tegra_plane_writel(plane, background[1], DC_WIN_BLEND_2WIN_Y);
257ebae8d07SThierry Reding 		tegra_plane_writel(plane, background[2], DC_WIN_BLEND_3WIN_XY);
258ab7d3f58SThierry Reding 		break;
259ab7d3f58SThierry Reding 
260ab7d3f58SThierry Reding 	case 1:
2613dae08bcSDmitry Osipenko 		/*
2623dae08bcSDmitry Osipenko 		 * If window B / C is topmost, then X / Y registers are
2633dae08bcSDmitry Osipenko 		 * matching the order of blending[...] state indices,
2643dae08bcSDmitry Osipenko 		 * otherwise a swap is required.
2653dae08bcSDmitry Osipenko 		 */
2663dae08bcSDmitry Osipenko 		if (!state->blending[0].top && state->blending[1].top) {
2673dae08bcSDmitry Osipenko 			blending[0] = foreground;
2683dae08bcSDmitry Osipenko 			blending[1] = background[1];
2693dae08bcSDmitry Osipenko 		} else {
2703dae08bcSDmitry Osipenko 			blending[0] = background[0];
2713dae08bcSDmitry Osipenko 			blending[1] = foreground;
2723dae08bcSDmitry Osipenko 		}
2733dae08bcSDmitry Osipenko 
2743dae08bcSDmitry Osipenko 		tegra_plane_writel(plane, blending[0], DC_WIN_BLEND_2WIN_X);
2753dae08bcSDmitry Osipenko 		tegra_plane_writel(plane, blending[1], DC_WIN_BLEND_2WIN_Y);
276ebae8d07SThierry Reding 		tegra_plane_writel(plane, background[2], DC_WIN_BLEND_3WIN_XY);
277ab7d3f58SThierry Reding 		break;
278ab7d3f58SThierry Reding 
279ab7d3f58SThierry Reding 	case 2:
280ebae8d07SThierry Reding 		tegra_plane_writel(plane, foreground, DC_WIN_BLEND_2WIN_X);
281ebae8d07SThierry Reding 		tegra_plane_writel(plane, foreground, DC_WIN_BLEND_2WIN_Y);
282ebae8d07SThierry Reding 		tegra_plane_writel(plane, foreground, DC_WIN_BLEND_3WIN_XY);
283ab7d3f58SThierry Reding 		break;
284ab7d3f58SThierry Reding 	}
285ab7d3f58SThierry Reding }
286ab7d3f58SThierry Reding 
287ab7d3f58SThierry Reding static void tegra_plane_setup_blending(struct tegra_plane *plane,
288ab7d3f58SThierry Reding 				       const struct tegra_dc_window *window)
289ab7d3f58SThierry Reding {
290ab7d3f58SThierry Reding 	u32 value;
291ab7d3f58SThierry Reding 
292ab7d3f58SThierry Reding 	value = BLEND_FACTOR_DST_ALPHA_ZERO | BLEND_FACTOR_SRC_ALPHA_K2 |
293ab7d3f58SThierry Reding 		BLEND_FACTOR_DST_COLOR_NEG_K1_TIMES_SRC |
294ab7d3f58SThierry Reding 		BLEND_FACTOR_SRC_COLOR_K1_TIMES_SRC;
295ab7d3f58SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_BLEND_MATCH_SELECT);
296ab7d3f58SThierry Reding 
297ab7d3f58SThierry Reding 	value = BLEND_FACTOR_DST_ALPHA_ZERO | BLEND_FACTOR_SRC_ALPHA_K2 |
298ab7d3f58SThierry Reding 		BLEND_FACTOR_DST_COLOR_NEG_K1_TIMES_SRC |
299ab7d3f58SThierry Reding 		BLEND_FACTOR_SRC_COLOR_K1_TIMES_SRC;
300ab7d3f58SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_BLEND_NOMATCH_SELECT);
301ab7d3f58SThierry Reding 
302ab7d3f58SThierry Reding 	value = K2(255) | K1(255) | WINDOW_LAYER_DEPTH(255 - window->zpos);
303ab7d3f58SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_BLEND_LAYER_CONTROL);
304ab7d3f58SThierry Reding }
305ab7d3f58SThierry Reding 
306acc6a3a9SDmitry Osipenko static bool
307acc6a3a9SDmitry Osipenko tegra_plane_use_horizontal_filtering(struct tegra_plane *plane,
308acc6a3a9SDmitry Osipenko 				     const struct tegra_dc_window *window)
309acc6a3a9SDmitry Osipenko {
310acc6a3a9SDmitry Osipenko 	struct tegra_dc *dc = plane->dc;
311acc6a3a9SDmitry Osipenko 
312acc6a3a9SDmitry Osipenko 	if (window->src.w == window->dst.w)
313acc6a3a9SDmitry Osipenko 		return false;
314acc6a3a9SDmitry Osipenko 
315acc6a3a9SDmitry Osipenko 	if (plane->index == 0 && dc->soc->has_win_a_without_filters)
316acc6a3a9SDmitry Osipenko 		return false;
317acc6a3a9SDmitry Osipenko 
318acc6a3a9SDmitry Osipenko 	return true;
319acc6a3a9SDmitry Osipenko }
320acc6a3a9SDmitry Osipenko 
321acc6a3a9SDmitry Osipenko static bool
322acc6a3a9SDmitry Osipenko tegra_plane_use_vertical_filtering(struct tegra_plane *plane,
323acc6a3a9SDmitry Osipenko 				   const struct tegra_dc_window *window)
324acc6a3a9SDmitry Osipenko {
325acc6a3a9SDmitry Osipenko 	struct tegra_dc *dc = plane->dc;
326acc6a3a9SDmitry Osipenko 
327acc6a3a9SDmitry Osipenko 	if (window->src.h == window->dst.h)
328acc6a3a9SDmitry Osipenko 		return false;
329acc6a3a9SDmitry Osipenko 
330acc6a3a9SDmitry Osipenko 	if (plane->index == 0 && dc->soc->has_win_a_without_filters)
331acc6a3a9SDmitry Osipenko 		return false;
332acc6a3a9SDmitry Osipenko 
333acc6a3a9SDmitry Osipenko 	if (plane->index == 2 && dc->soc->has_win_c_without_vert_filter)
334acc6a3a9SDmitry Osipenko 		return false;
335acc6a3a9SDmitry Osipenko 
336acc6a3a9SDmitry Osipenko 	return true;
337acc6a3a9SDmitry Osipenko }
338acc6a3a9SDmitry Osipenko 
3391087fac1SThierry Reding static void tegra_dc_setup_window(struct tegra_plane *plane,
34010288eeaSThierry Reding 				  const struct tegra_dc_window *window)
34110288eeaSThierry Reding {
34210288eeaSThierry Reding 	unsigned h_offset, v_offset, h_size, v_size, h_dda, v_dda, bpp;
3431087fac1SThierry Reding 	struct tegra_dc *dc = plane->dc;
34410288eeaSThierry Reding 	bool yuv, planar;
3451087fac1SThierry Reding 	u32 value;
34610288eeaSThierry Reding 
34710288eeaSThierry Reding 	/*
34810288eeaSThierry Reding 	 * For YUV planar modes, the number of bytes per pixel takes into
34910288eeaSThierry Reding 	 * account only the luma component and therefore is 1.
35010288eeaSThierry Reding 	 */
3515acd3514SThierry Reding 	yuv = tegra_plane_format_is_yuv(window->format, &planar);
35210288eeaSThierry Reding 	if (!yuv)
35310288eeaSThierry Reding 		bpp = window->bits_per_pixel / 8;
35410288eeaSThierry Reding 	else
35510288eeaSThierry Reding 		bpp = planar ? 1 : 2;
35610288eeaSThierry Reding 
3571087fac1SThierry Reding 	tegra_plane_writel(plane, window->format, DC_WIN_COLOR_DEPTH);
3581087fac1SThierry Reding 	tegra_plane_writel(plane, window->swap, DC_WIN_BYTE_SWAP);
35910288eeaSThierry Reding 
36010288eeaSThierry Reding 	value = V_POSITION(window->dst.y) | H_POSITION(window->dst.x);
3611087fac1SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_POSITION);
36210288eeaSThierry Reding 
36310288eeaSThierry Reding 	value = V_SIZE(window->dst.h) | H_SIZE(window->dst.w);
3641087fac1SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_SIZE);
36510288eeaSThierry Reding 
36610288eeaSThierry Reding 	h_offset = window->src.x * bpp;
36710288eeaSThierry Reding 	v_offset = window->src.y;
36810288eeaSThierry Reding 	h_size = window->src.w * bpp;
36910288eeaSThierry Reding 	v_size = window->src.h;
37010288eeaSThierry Reding 
371cd740777SDmitry Osipenko 	if (window->reflect_x)
372cd740777SDmitry Osipenko 		h_offset += (window->src.w - 1) * bpp;
373cd740777SDmitry Osipenko 
374cd740777SDmitry Osipenko 	if (window->reflect_y)
375cd740777SDmitry Osipenko 		v_offset += window->src.h - 1;
376cd740777SDmitry Osipenko 
37710288eeaSThierry Reding 	value = V_PRESCALED_SIZE(v_size) | H_PRESCALED_SIZE(h_size);
3781087fac1SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_PRESCALED_SIZE);
37910288eeaSThierry Reding 
38010288eeaSThierry Reding 	/*
38110288eeaSThierry Reding 	 * For DDA computations the number of bytes per pixel for YUV planar
38210288eeaSThierry Reding 	 * modes needs to take into account all Y, U and V components.
38310288eeaSThierry Reding 	 */
38410288eeaSThierry Reding 	if (yuv && planar)
38510288eeaSThierry Reding 		bpp = 2;
38610288eeaSThierry Reding 
38710288eeaSThierry Reding 	h_dda = compute_dda_inc(window->src.w, window->dst.w, false, bpp);
38810288eeaSThierry Reding 	v_dda = compute_dda_inc(window->src.h, window->dst.h, true, bpp);
38910288eeaSThierry Reding 
39010288eeaSThierry Reding 	value = V_DDA_INC(v_dda) | H_DDA_INC(h_dda);
3911087fac1SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_DDA_INC);
39210288eeaSThierry Reding 
39310288eeaSThierry Reding 	h_dda = compute_initial_dda(window->src.x);
39410288eeaSThierry Reding 	v_dda = compute_initial_dda(window->src.y);
39510288eeaSThierry Reding 
3961087fac1SThierry Reding 	tegra_plane_writel(plane, h_dda, DC_WIN_H_INITIAL_DDA);
3971087fac1SThierry Reding 	tegra_plane_writel(plane, v_dda, DC_WIN_V_INITIAL_DDA);
39810288eeaSThierry Reding 
3991087fac1SThierry Reding 	tegra_plane_writel(plane, 0, DC_WIN_UV_BUF_STRIDE);
4001087fac1SThierry Reding 	tegra_plane_writel(plane, 0, DC_WIN_BUF_STRIDE);
40110288eeaSThierry Reding 
4021087fac1SThierry Reding 	tegra_plane_writel(plane, window->base[0], DC_WINBUF_START_ADDR);
40310288eeaSThierry Reding 
40410288eeaSThierry Reding 	if (yuv && planar) {
4051087fac1SThierry Reding 		tegra_plane_writel(plane, window->base[1], DC_WINBUF_START_ADDR_U);
4061087fac1SThierry Reding 		tegra_plane_writel(plane, window->base[2], DC_WINBUF_START_ADDR_V);
40710288eeaSThierry Reding 		value = window->stride[1] << 16 | window->stride[0];
4081087fac1SThierry Reding 		tegra_plane_writel(plane, value, DC_WIN_LINE_STRIDE);
40910288eeaSThierry Reding 	} else {
4101087fac1SThierry Reding 		tegra_plane_writel(plane, window->stride[0], DC_WIN_LINE_STRIDE);
41110288eeaSThierry Reding 	}
41210288eeaSThierry Reding 
4131087fac1SThierry Reding 	tegra_plane_writel(plane, h_offset, DC_WINBUF_ADDR_H_OFFSET);
4141087fac1SThierry Reding 	tegra_plane_writel(plane, v_offset, DC_WINBUF_ADDR_V_OFFSET);
41510288eeaSThierry Reding 
416c134f019SThierry Reding 	if (dc->soc->supports_block_linear) {
417c134f019SThierry Reding 		unsigned long height = window->tiling.value;
418c134f019SThierry Reding 
419c134f019SThierry Reding 		switch (window->tiling.mode) {
420c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_PITCH:
421c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_PITCH;
422c134f019SThierry Reding 			break;
423c134f019SThierry Reding 
424c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_TILED:
425c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_TILED;
426c134f019SThierry Reding 			break;
427c134f019SThierry Reding 
428c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_BLOCK:
429c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_BLOCK_HEIGHT(height) |
430c134f019SThierry Reding 				DC_WINBUF_SURFACE_KIND_BLOCK;
431c134f019SThierry Reding 			break;
432c134f019SThierry Reding 		}
433c134f019SThierry Reding 
4341087fac1SThierry Reding 		tegra_plane_writel(plane, value, DC_WINBUF_SURFACE_KIND);
43510288eeaSThierry Reding 	} else {
436c134f019SThierry Reding 		switch (window->tiling.mode) {
437c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_PITCH:
43810288eeaSThierry Reding 			value = DC_WIN_BUFFER_ADDR_MODE_LINEAR_UV |
43910288eeaSThierry Reding 				DC_WIN_BUFFER_ADDR_MODE_LINEAR;
440c134f019SThierry Reding 			break;
441c134f019SThierry Reding 
442c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_TILED:
443c134f019SThierry Reding 			value = DC_WIN_BUFFER_ADDR_MODE_TILE_UV |
444c134f019SThierry Reding 				DC_WIN_BUFFER_ADDR_MODE_TILE;
445c134f019SThierry Reding 			break;
446c134f019SThierry Reding 
447c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_BLOCK:
4484aa3df71SThierry Reding 			/*
4494aa3df71SThierry Reding 			 * No need to handle this here because ->atomic_check
4504aa3df71SThierry Reding 			 * will already have filtered it out.
4514aa3df71SThierry Reding 			 */
4524aa3df71SThierry Reding 			break;
45310288eeaSThierry Reding 		}
45410288eeaSThierry Reding 
4551087fac1SThierry Reding 		tegra_plane_writel(plane, value, DC_WIN_BUFFER_ADDR_MODE);
456c134f019SThierry Reding 	}
45710288eeaSThierry Reding 
45810288eeaSThierry Reding 	value = WIN_ENABLE;
45910288eeaSThierry Reding 
46010288eeaSThierry Reding 	if (yuv) {
46110288eeaSThierry Reding 		/* setup default colorspace conversion coefficients */
4621087fac1SThierry Reding 		tegra_plane_writel(plane, 0x00f0, DC_WIN_CSC_YOF);
4631087fac1SThierry Reding 		tegra_plane_writel(plane, 0x012a, DC_WIN_CSC_KYRGB);
4641087fac1SThierry Reding 		tegra_plane_writel(plane, 0x0000, DC_WIN_CSC_KUR);
4651087fac1SThierry Reding 		tegra_plane_writel(plane, 0x0198, DC_WIN_CSC_KVR);
4661087fac1SThierry Reding 		tegra_plane_writel(plane, 0x039b, DC_WIN_CSC_KUG);
4671087fac1SThierry Reding 		tegra_plane_writel(plane, 0x032f, DC_WIN_CSC_KVG);
4681087fac1SThierry Reding 		tegra_plane_writel(plane, 0x0204, DC_WIN_CSC_KUB);
4691087fac1SThierry Reding 		tegra_plane_writel(plane, 0x0000, DC_WIN_CSC_KVB);
47010288eeaSThierry Reding 
47110288eeaSThierry Reding 		value |= CSC_ENABLE;
47210288eeaSThierry Reding 	} else if (window->bits_per_pixel < 24) {
47310288eeaSThierry Reding 		value |= COLOR_EXPAND;
47410288eeaSThierry Reding 	}
47510288eeaSThierry Reding 
476cd740777SDmitry Osipenko 	if (window->reflect_x)
477cd740777SDmitry Osipenko 		value |= H_DIRECTION;
478cd740777SDmitry Osipenko 
479e9e476f7SDmitry Osipenko 	if (window->reflect_y)
48010288eeaSThierry Reding 		value |= V_DIRECTION;
48110288eeaSThierry Reding 
482acc6a3a9SDmitry Osipenko 	if (tegra_plane_use_horizontal_filtering(plane, window)) {
483acc6a3a9SDmitry Osipenko 		/*
484acc6a3a9SDmitry Osipenko 		 * Enable horizontal 6-tap filter and set filtering
485acc6a3a9SDmitry Osipenko 		 * coefficients to the default values defined in TRM.
486acc6a3a9SDmitry Osipenko 		 */
487acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x00008000, DC_WIN_H_FILTER_P(0));
488acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x3e087ce1, DC_WIN_H_FILTER_P(1));
489acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x3b117ac1, DC_WIN_H_FILTER_P(2));
490acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x591b73aa, DC_WIN_H_FILTER_P(3));
491acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x57256d9a, DC_WIN_H_FILTER_P(4));
492acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x552f668b, DC_WIN_H_FILTER_P(5));
493acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x73385e8b, DC_WIN_H_FILTER_P(6));
494acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x72435583, DC_WIN_H_FILTER_P(7));
495acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x714c4c8b, DC_WIN_H_FILTER_P(8));
496acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x70554393, DC_WIN_H_FILTER_P(9));
497acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x715e389b, DC_WIN_H_FILTER_P(10));
498acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x71662faa, DC_WIN_H_FILTER_P(11));
499acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x536d25ba, DC_WIN_H_FILTER_P(12));
500acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x55731bca, DC_WIN_H_FILTER_P(13));
501acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x387a11d9, DC_WIN_H_FILTER_P(14));
502acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x3c7c08f1, DC_WIN_H_FILTER_P(15));
503acc6a3a9SDmitry Osipenko 
504acc6a3a9SDmitry Osipenko 		value |= H_FILTER;
505acc6a3a9SDmitry Osipenko 	}
506acc6a3a9SDmitry Osipenko 
507acc6a3a9SDmitry Osipenko 	if (tegra_plane_use_vertical_filtering(plane, window)) {
508acc6a3a9SDmitry Osipenko 		unsigned int i, k;
509acc6a3a9SDmitry Osipenko 
510acc6a3a9SDmitry Osipenko 		/*
511acc6a3a9SDmitry Osipenko 		 * Enable vertical 2-tap filter and set filtering
512acc6a3a9SDmitry Osipenko 		 * coefficients to the default values defined in TRM.
513acc6a3a9SDmitry Osipenko 		 */
514acc6a3a9SDmitry Osipenko 		for (i = 0, k = 128; i < 16; i++, k -= 8)
515acc6a3a9SDmitry Osipenko 			tegra_plane_writel(plane, k, DC_WIN_V_FILTER_P(i));
516acc6a3a9SDmitry Osipenko 
517acc6a3a9SDmitry Osipenko 		value |= V_FILTER;
518acc6a3a9SDmitry Osipenko 	}
519acc6a3a9SDmitry Osipenko 
5201087fac1SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_WIN_OPTIONS);
52110288eeaSThierry Reding 
522a43d0a00SDmitry Osipenko 	if (dc->soc->has_legacy_blending)
523ab7d3f58SThierry Reding 		tegra_plane_setup_blending_legacy(plane);
524a43d0a00SDmitry Osipenko 	else
525a43d0a00SDmitry Osipenko 		tegra_plane_setup_blending(plane, window);
526c7679306SThierry Reding }
527c7679306SThierry Reding 
528511c7023SThierry Reding static const u32 tegra20_primary_formats[] = {
529511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
530511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
531c7679306SThierry Reding 	DRM_FORMAT_RGB565,
532511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
533511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
534511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
535ebae8d07SThierry Reding 	/* non-native formats */
536ebae8d07SThierry Reding 	DRM_FORMAT_XRGB1555,
537ebae8d07SThierry Reding 	DRM_FORMAT_RGBX5551,
538ebae8d07SThierry Reding 	DRM_FORMAT_XBGR8888,
539ebae8d07SThierry Reding 	DRM_FORMAT_XRGB8888,
540511c7023SThierry Reding };
541511c7023SThierry Reding 
542e90124cbSThierry Reding static const u64 tegra20_modifiers[] = {
543e90124cbSThierry Reding 	DRM_FORMAT_MOD_LINEAR,
544e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_TEGRA_TILED,
545e90124cbSThierry Reding 	DRM_FORMAT_MOD_INVALID
546e90124cbSThierry Reding };
547e90124cbSThierry Reding 
548511c7023SThierry Reding static const u32 tegra114_primary_formats[] = {
549511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
550511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
551511c7023SThierry Reding 	DRM_FORMAT_RGB565,
552511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
553511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
554511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
555511c7023SThierry Reding 	/* new on Tegra114 */
556511c7023SThierry Reding 	DRM_FORMAT_ABGR4444,
557511c7023SThierry Reding 	DRM_FORMAT_ABGR1555,
558511c7023SThierry Reding 	DRM_FORMAT_BGRA5551,
559511c7023SThierry Reding 	DRM_FORMAT_XRGB1555,
560511c7023SThierry Reding 	DRM_FORMAT_RGBX5551,
561511c7023SThierry Reding 	DRM_FORMAT_XBGR1555,
562511c7023SThierry Reding 	DRM_FORMAT_BGRX5551,
563511c7023SThierry Reding 	DRM_FORMAT_BGR565,
564511c7023SThierry Reding 	DRM_FORMAT_BGRA8888,
565511c7023SThierry Reding 	DRM_FORMAT_RGBA8888,
566511c7023SThierry Reding 	DRM_FORMAT_XRGB8888,
567511c7023SThierry Reding 	DRM_FORMAT_XBGR8888,
568511c7023SThierry Reding };
569511c7023SThierry Reding 
570511c7023SThierry Reding static const u32 tegra124_primary_formats[] = {
571511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
572511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
573511c7023SThierry Reding 	DRM_FORMAT_RGB565,
574511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
575511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
576511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
577511c7023SThierry Reding 	/* new on Tegra114 */
578511c7023SThierry Reding 	DRM_FORMAT_ABGR4444,
579511c7023SThierry Reding 	DRM_FORMAT_ABGR1555,
580511c7023SThierry Reding 	DRM_FORMAT_BGRA5551,
581511c7023SThierry Reding 	DRM_FORMAT_XRGB1555,
582511c7023SThierry Reding 	DRM_FORMAT_RGBX5551,
583511c7023SThierry Reding 	DRM_FORMAT_XBGR1555,
584511c7023SThierry Reding 	DRM_FORMAT_BGRX5551,
585511c7023SThierry Reding 	DRM_FORMAT_BGR565,
586511c7023SThierry Reding 	DRM_FORMAT_BGRA8888,
587511c7023SThierry Reding 	DRM_FORMAT_RGBA8888,
588511c7023SThierry Reding 	DRM_FORMAT_XRGB8888,
589511c7023SThierry Reding 	DRM_FORMAT_XBGR8888,
590511c7023SThierry Reding 	/* new on Tegra124 */
591511c7023SThierry Reding 	DRM_FORMAT_RGBX8888,
592511c7023SThierry Reding 	DRM_FORMAT_BGRX8888,
593c7679306SThierry Reding };
594c7679306SThierry Reding 
595e90124cbSThierry Reding static const u64 tegra124_modifiers[] = {
596e90124cbSThierry Reding 	DRM_FORMAT_MOD_LINEAR,
597e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(0),
598e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(1),
599e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(2),
600e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(3),
601e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(4),
602e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(5),
603e90124cbSThierry Reding 	DRM_FORMAT_MOD_INVALID
604e90124cbSThierry Reding };
605e90124cbSThierry Reding 
6064aa3df71SThierry Reding static int tegra_plane_atomic_check(struct drm_plane *plane,
6077c11b99aSMaxime Ripard 				    struct drm_atomic_state *state)
6084aa3df71SThierry Reding {
6097c11b99aSMaxime Ripard 	struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state,
6107c11b99aSMaxime Ripard 										 plane);
611ba5c1649SMaxime Ripard 	struct tegra_plane_state *plane_state = to_tegra_plane_state(new_plane_state);
612cd740777SDmitry Osipenko 	unsigned int supported_rotation = DRM_MODE_ROTATE_0 |
613cd740777SDmitry Osipenko 					  DRM_MODE_REFLECT_X |
614cd740777SDmitry Osipenko 					  DRM_MODE_REFLECT_Y;
615ba5c1649SMaxime Ripard 	unsigned int rotation = new_plane_state->rotation;
6168f604f8cSThierry Reding 	struct tegra_bo_tiling *tiling = &plane_state->tiling;
61747802b09SThierry Reding 	struct tegra_plane *tegra = to_tegra_plane(plane);
618ba5c1649SMaxime Ripard 	struct tegra_dc *dc = to_tegra_dc(new_plane_state->crtc);
619c7679306SThierry Reding 	int err;
620c7679306SThierry Reding 
6214aa3df71SThierry Reding 	/* no need for further checks if the plane is being disabled */
622ba5c1649SMaxime Ripard 	if (!new_plane_state->crtc)
6234aa3df71SThierry Reding 		return 0;
6244aa3df71SThierry Reding 
625ba5c1649SMaxime Ripard 	err = tegra_plane_format(new_plane_state->fb->format->format,
6263dae08bcSDmitry Osipenko 				 &plane_state->format,
6278f604f8cSThierry Reding 				 &plane_state->swap);
6284aa3df71SThierry Reding 	if (err < 0)
6294aa3df71SThierry Reding 		return err;
6304aa3df71SThierry Reding 
631ebae8d07SThierry Reding 	/*
632ebae8d07SThierry Reding 	 * Tegra20 and Tegra30 are special cases here because they support
633ebae8d07SThierry Reding 	 * only variants of specific formats with an alpha component, but not
634ebae8d07SThierry Reding 	 * the corresponding opaque formats. However, the opaque formats can
635ebae8d07SThierry Reding 	 * be emulated by disabling alpha blending for the plane.
636ebae8d07SThierry Reding 	 */
637a43d0a00SDmitry Osipenko 	if (dc->soc->has_legacy_blending) {
6383dae08bcSDmitry Osipenko 		err = tegra_plane_setup_legacy_state(tegra, plane_state);
639ebae8d07SThierry Reding 		if (err < 0)
640ebae8d07SThierry Reding 			return err;
641ebae8d07SThierry Reding 	}
642ebae8d07SThierry Reding 
643ba5c1649SMaxime Ripard 	err = tegra_fb_get_tiling(new_plane_state->fb, tiling);
6448f604f8cSThierry Reding 	if (err < 0)
6458f604f8cSThierry Reding 		return err;
6468f604f8cSThierry Reding 
6478f604f8cSThierry Reding 	if (tiling->mode == TEGRA_BO_TILING_MODE_BLOCK &&
6484aa3df71SThierry Reding 	    !dc->soc->supports_block_linear) {
6494aa3df71SThierry Reding 		DRM_ERROR("hardware doesn't support block linear mode\n");
6504aa3df71SThierry Reding 		return -EINVAL;
6514aa3df71SThierry Reding 	}
6524aa3df71SThierry Reding 
653cd740777SDmitry Osipenko 	/*
654cd740777SDmitry Osipenko 	 * Older userspace used custom BO flag in order to specify the Y
655cd740777SDmitry Osipenko 	 * reflection, while modern userspace uses the generic DRM rotation
656cd740777SDmitry Osipenko 	 * property in order to achieve the same result.  The legacy BO flag
657cd740777SDmitry Osipenko 	 * duplicates the DRM rotation property when both are set.
658cd740777SDmitry Osipenko 	 */
659ba5c1649SMaxime Ripard 	if (tegra_fb_is_bottom_up(new_plane_state->fb))
660cd740777SDmitry Osipenko 		rotation |= DRM_MODE_REFLECT_Y;
661cd740777SDmitry Osipenko 
662cd740777SDmitry Osipenko 	rotation = drm_rotation_simplify(rotation, supported_rotation);
663cd740777SDmitry Osipenko 
664cd740777SDmitry Osipenko 	if (rotation & DRM_MODE_REFLECT_X)
665cd740777SDmitry Osipenko 		plane_state->reflect_x = true;
666cd740777SDmitry Osipenko 	else
667cd740777SDmitry Osipenko 		plane_state->reflect_x = false;
668995c5a50SThierry Reding 
669995c5a50SThierry Reding 	if (rotation & DRM_MODE_REFLECT_Y)
670e9e476f7SDmitry Osipenko 		plane_state->reflect_y = true;
671995c5a50SThierry Reding 	else
672e9e476f7SDmitry Osipenko 		plane_state->reflect_y = false;
673995c5a50SThierry Reding 
6744aa3df71SThierry Reding 	/*
6754aa3df71SThierry Reding 	 * Tegra doesn't support different strides for U and V planes so we
6764aa3df71SThierry Reding 	 * error out if the user tries to display a framebuffer with such a
6774aa3df71SThierry Reding 	 * configuration.
6784aa3df71SThierry Reding 	 */
679ba5c1649SMaxime Ripard 	if (new_plane_state->fb->format->num_planes > 2) {
680ba5c1649SMaxime Ripard 		if (new_plane_state->fb->pitches[2] != new_plane_state->fb->pitches[1]) {
6814aa3df71SThierry Reding 			DRM_ERROR("unsupported UV-plane configuration\n");
6824aa3df71SThierry Reding 			return -EINVAL;
6834aa3df71SThierry Reding 		}
6844aa3df71SThierry Reding 	}
6854aa3df71SThierry Reding 
686ba5c1649SMaxime Ripard 	err = tegra_plane_state_add(tegra, new_plane_state);
68747802b09SThierry Reding 	if (err < 0)
68847802b09SThierry Reding 		return err;
68947802b09SThierry Reding 
6904aa3df71SThierry Reding 	return 0;
6914aa3df71SThierry Reding }
6924aa3df71SThierry Reding 
693a4bfa096SThierry Reding static void tegra_plane_atomic_disable(struct drm_plane *plane,
694*977697e2SMaxime Ripard 				       struct drm_atomic_state *state)
69580d3eef1SDmitry Osipenko {
696*977697e2SMaxime Ripard 	struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state,
697*977697e2SMaxime Ripard 									   plane);
698a4bfa096SThierry Reding 	struct tegra_plane *p = to_tegra_plane(plane);
69980d3eef1SDmitry Osipenko 	u32 value;
70080d3eef1SDmitry Osipenko 
701a4bfa096SThierry Reding 	/* rien ne va plus */
702a4bfa096SThierry Reding 	if (!old_state || !old_state->crtc)
703a4bfa096SThierry Reding 		return;
704a4bfa096SThierry Reding 
7051087fac1SThierry Reding 	value = tegra_plane_readl(p, DC_WIN_WIN_OPTIONS);
70680d3eef1SDmitry Osipenko 	value &= ~WIN_ENABLE;
7071087fac1SThierry Reding 	tegra_plane_writel(p, value, DC_WIN_WIN_OPTIONS);
70880d3eef1SDmitry Osipenko }
70980d3eef1SDmitry Osipenko 
7104aa3df71SThierry Reding static void tegra_plane_atomic_update(struct drm_plane *plane,
711*977697e2SMaxime Ripard 				      struct drm_atomic_state *state)
7124aa3df71SThierry Reding {
713e05162c0SMaxime Ripard 	struct drm_plane_state *new_state = plane->state;
71441016fe1SMaxime Ripard 	struct tegra_plane_state *tegra_plane_state = to_tegra_plane_state(new_state);
715e05162c0SMaxime Ripard 	struct drm_framebuffer *fb = new_state->fb;
7164aa3df71SThierry Reding 	struct tegra_plane *p = to_tegra_plane(plane);
7174aa3df71SThierry Reding 	struct tegra_dc_window window;
7184aa3df71SThierry Reding 	unsigned int i;
7194aa3df71SThierry Reding 
7204aa3df71SThierry Reding 	/* rien ne va plus */
721e05162c0SMaxime Ripard 	if (!new_state->crtc || !new_state->fb)
7224aa3df71SThierry Reding 		return;
7234aa3df71SThierry Reding 
724e05162c0SMaxime Ripard 	if (!new_state->visible)
725*977697e2SMaxime Ripard 		return tegra_plane_atomic_disable(plane, state);
72680d3eef1SDmitry Osipenko 
727c7679306SThierry Reding 	memset(&window, 0, sizeof(window));
728e05162c0SMaxime Ripard 	window.src.x = new_state->src.x1 >> 16;
729e05162c0SMaxime Ripard 	window.src.y = new_state->src.y1 >> 16;
730e05162c0SMaxime Ripard 	window.src.w = drm_rect_width(&new_state->src) >> 16;
731e05162c0SMaxime Ripard 	window.src.h = drm_rect_height(&new_state->src) >> 16;
732e05162c0SMaxime Ripard 	window.dst.x = new_state->dst.x1;
733e05162c0SMaxime Ripard 	window.dst.y = new_state->dst.y1;
734e05162c0SMaxime Ripard 	window.dst.w = drm_rect_width(&new_state->dst);
735e05162c0SMaxime Ripard 	window.dst.h = drm_rect_height(&new_state->dst);
736272725c7SVille Syrjälä 	window.bits_per_pixel = fb->format->cpp[0] * 8;
73741016fe1SMaxime Ripard 	window.reflect_x = tegra_plane_state->reflect_x;
73841016fe1SMaxime Ripard 	window.reflect_y = tegra_plane_state->reflect_y;
739c7679306SThierry Reding 
7408f604f8cSThierry Reding 	/* copy from state */
741e05162c0SMaxime Ripard 	window.zpos = new_state->normalized_zpos;
74241016fe1SMaxime Ripard 	window.tiling = tegra_plane_state->tiling;
74341016fe1SMaxime Ripard 	window.format = tegra_plane_state->format;
74441016fe1SMaxime Ripard 	window.swap = tegra_plane_state->swap;
745c7679306SThierry Reding 
746bcb0b461SVille Syrjälä 	for (i = 0; i < fb->format->num_planes; i++) {
74741016fe1SMaxime Ripard 		window.base[i] = tegra_plane_state->iova[i] + fb->offsets[i];
74808ee0178SDmitry Osipenko 
74908ee0178SDmitry Osipenko 		/*
75008ee0178SDmitry Osipenko 		 * Tegra uses a shared stride for UV planes. Framebuffers are
75108ee0178SDmitry Osipenko 		 * already checked for this in the tegra_plane_atomic_check()
75208ee0178SDmitry Osipenko 		 * function, so it's safe to ignore the V-plane pitch here.
75308ee0178SDmitry Osipenko 		 */
75408ee0178SDmitry Osipenko 		if (i < 2)
7554aa3df71SThierry Reding 			window.stride[i] = fb->pitches[i];
756c7679306SThierry Reding 	}
757c7679306SThierry Reding 
7581087fac1SThierry Reding 	tegra_dc_setup_window(p, &window);
7594aa3df71SThierry Reding }
7604aa3df71SThierry Reding 
761a4bfa096SThierry Reding static const struct drm_plane_helper_funcs tegra_plane_helper_funcs = {
7622e8d8749SThierry Reding 	.prepare_fb = tegra_plane_prepare_fb,
7632e8d8749SThierry Reding 	.cleanup_fb = tegra_plane_cleanup_fb,
7644aa3df71SThierry Reding 	.atomic_check = tegra_plane_atomic_check,
7654aa3df71SThierry Reding 	.atomic_disable = tegra_plane_atomic_disable,
766a4bfa096SThierry Reding 	.atomic_update = tegra_plane_atomic_update,
767c7679306SThierry Reding };
768c7679306SThierry Reding 
76989f65018SThierry Reding static unsigned long tegra_plane_get_possible_crtcs(struct drm_device *drm)
770c7679306SThierry Reding {
771518e6227SThierry Reding 	/*
772518e6227SThierry Reding 	 * Ideally this would use drm_crtc_mask(), but that would require the
773518e6227SThierry Reding 	 * CRTC to already be in the mode_config's list of CRTCs. However, it
774518e6227SThierry Reding 	 * will only be added to that list in the drm_crtc_init_with_planes()
775518e6227SThierry Reding 	 * (in tegra_dc_init()), which in turn requires registration of these
776518e6227SThierry Reding 	 * planes. So we have ourselves a nice little chicken and egg problem
777518e6227SThierry Reding 	 * here.
778518e6227SThierry Reding 	 *
779518e6227SThierry Reding 	 * We work around this by manually creating the mask from the number
780518e6227SThierry Reding 	 * of CRTCs that have been registered, and should therefore always be
781518e6227SThierry Reding 	 * the same as drm_crtc_index() after registration.
782518e6227SThierry Reding 	 */
78389f65018SThierry Reding 	return 1 << drm->mode_config.num_crtc;
78489f65018SThierry Reding }
78589f65018SThierry Reding 
78689f65018SThierry Reding static struct drm_plane *tegra_primary_plane_create(struct drm_device *drm,
78789f65018SThierry Reding 						    struct tegra_dc *dc)
78889f65018SThierry Reding {
78989f65018SThierry Reding 	unsigned long possible_crtcs = tegra_plane_get_possible_crtcs(drm);
79047307954SThierry Reding 	enum drm_plane_type type = DRM_PLANE_TYPE_PRIMARY;
791c7679306SThierry Reding 	struct tegra_plane *plane;
792c7679306SThierry Reding 	unsigned int num_formats;
793e90124cbSThierry Reding 	const u64 *modifiers;
794c7679306SThierry Reding 	const u32 *formats;
795c7679306SThierry Reding 	int err;
796c7679306SThierry Reding 
797c7679306SThierry Reding 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
798c7679306SThierry Reding 	if (!plane)
799c7679306SThierry Reding 		return ERR_PTR(-ENOMEM);
800c7679306SThierry Reding 
8011087fac1SThierry Reding 	/* Always use window A as primary window */
8021087fac1SThierry Reding 	plane->offset = 0xa00;
803c4755fb9SThierry Reding 	plane->index = 0;
8041087fac1SThierry Reding 	plane->dc = dc;
8051087fac1SThierry Reding 
8061087fac1SThierry Reding 	num_formats = dc->soc->num_primary_formats;
8071087fac1SThierry Reding 	formats = dc->soc->primary_formats;
808e90124cbSThierry Reding 	modifiers = dc->soc->modifiers;
809c4755fb9SThierry Reding 
810518e6227SThierry Reding 	err = drm_universal_plane_init(drm, &plane->base, possible_crtcs,
811c1cb4b61SThierry Reding 				       &tegra_plane_funcs, formats,
812e90124cbSThierry Reding 				       num_formats, modifiers, type, NULL);
813c7679306SThierry Reding 	if (err < 0) {
814c7679306SThierry Reding 		kfree(plane);
815c7679306SThierry Reding 		return ERR_PTR(err);
816c7679306SThierry Reding 	}
817c7679306SThierry Reding 
818a4bfa096SThierry Reding 	drm_plane_helper_add(&plane->base, &tegra_plane_helper_funcs);
8193dae08bcSDmitry Osipenko 	drm_plane_create_zpos_property(&plane->base, plane->index, 0, 255);
820ab7d3f58SThierry Reding 
821995c5a50SThierry Reding 	err = drm_plane_create_rotation_property(&plane->base,
822995c5a50SThierry Reding 						 DRM_MODE_ROTATE_0,
823995c5a50SThierry Reding 						 DRM_MODE_ROTATE_0 |
8244fba6d22SDmitry Osipenko 						 DRM_MODE_ROTATE_180 |
825cd740777SDmitry Osipenko 						 DRM_MODE_REFLECT_X |
826995c5a50SThierry Reding 						 DRM_MODE_REFLECT_Y);
827995c5a50SThierry Reding 	if (err < 0)
828995c5a50SThierry Reding 		dev_err(dc->dev, "failed to create rotation property: %d\n",
829995c5a50SThierry Reding 			err);
830995c5a50SThierry Reding 
831c7679306SThierry Reding 	return &plane->base;
832c7679306SThierry Reding }
833c7679306SThierry Reding 
834c7679306SThierry Reding static const u32 tegra_cursor_plane_formats[] = {
835c7679306SThierry Reding 	DRM_FORMAT_RGBA8888,
836c7679306SThierry Reding };
837c7679306SThierry Reding 
8384aa3df71SThierry Reding static int tegra_cursor_atomic_check(struct drm_plane *plane,
8397c11b99aSMaxime Ripard 				     struct drm_atomic_state *state)
840c7679306SThierry Reding {
8417c11b99aSMaxime Ripard 	struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state,
8427c11b99aSMaxime Ripard 										 plane);
84347802b09SThierry Reding 	struct tegra_plane *tegra = to_tegra_plane(plane);
84447802b09SThierry Reding 	int err;
84547802b09SThierry Reding 
8464aa3df71SThierry Reding 	/* no need for further checks if the plane is being disabled */
847ba5c1649SMaxime Ripard 	if (!new_plane_state->crtc)
8484aa3df71SThierry Reding 		return 0;
849c7679306SThierry Reding 
850c7679306SThierry Reding 	/* scaling not supported for cursor */
851ba5c1649SMaxime Ripard 	if ((new_plane_state->src_w >> 16 != new_plane_state->crtc_w) ||
852ba5c1649SMaxime Ripard 	    (new_plane_state->src_h >> 16 != new_plane_state->crtc_h))
853c7679306SThierry Reding 		return -EINVAL;
854c7679306SThierry Reding 
855c7679306SThierry Reding 	/* only square cursors supported */
856ba5c1649SMaxime Ripard 	if (new_plane_state->src_w != new_plane_state->src_h)
857c7679306SThierry Reding 		return -EINVAL;
858c7679306SThierry Reding 
859ba5c1649SMaxime Ripard 	if (new_plane_state->crtc_w != 32 && new_plane_state->crtc_w != 64 &&
860ba5c1649SMaxime Ripard 	    new_plane_state->crtc_w != 128 && new_plane_state->crtc_w != 256)
8614aa3df71SThierry Reding 		return -EINVAL;
8624aa3df71SThierry Reding 
863ba5c1649SMaxime Ripard 	err = tegra_plane_state_add(tegra, new_plane_state);
86447802b09SThierry Reding 	if (err < 0)
86547802b09SThierry Reding 		return err;
86647802b09SThierry Reding 
8674aa3df71SThierry Reding 	return 0;
8684aa3df71SThierry Reding }
8694aa3df71SThierry Reding 
8704aa3df71SThierry Reding static void tegra_cursor_atomic_update(struct drm_plane *plane,
871*977697e2SMaxime Ripard 				       struct drm_atomic_state *state)
8724aa3df71SThierry Reding {
873e05162c0SMaxime Ripard 	struct drm_plane_state *new_state = plane->state;
87441016fe1SMaxime Ripard 	struct tegra_plane_state *tegra_plane_state = to_tegra_plane_state(new_state);
875e05162c0SMaxime Ripard 	struct tegra_dc *dc = to_tegra_dc(new_state->crtc);
8764aa3df71SThierry Reding 	u32 value = CURSOR_CLIP_DISPLAY;
8774aa3df71SThierry Reding 
8784aa3df71SThierry Reding 	/* rien ne va plus */
879e05162c0SMaxime Ripard 	if (!new_state->crtc || !new_state->fb)
8804aa3df71SThierry Reding 		return;
8814aa3df71SThierry Reding 
882e05162c0SMaxime Ripard 	switch (new_state->crtc_w) {
883c7679306SThierry Reding 	case 32:
884c7679306SThierry Reding 		value |= CURSOR_SIZE_32x32;
885c7679306SThierry Reding 		break;
886c7679306SThierry Reding 
887c7679306SThierry Reding 	case 64:
888c7679306SThierry Reding 		value |= CURSOR_SIZE_64x64;
889c7679306SThierry Reding 		break;
890c7679306SThierry Reding 
891c7679306SThierry Reding 	case 128:
892c7679306SThierry Reding 		value |= CURSOR_SIZE_128x128;
893c7679306SThierry Reding 		break;
894c7679306SThierry Reding 
895c7679306SThierry Reding 	case 256:
896c7679306SThierry Reding 		value |= CURSOR_SIZE_256x256;
897c7679306SThierry Reding 		break;
898c7679306SThierry Reding 
899c7679306SThierry Reding 	default:
900c52e167bSThierry Reding 		WARN(1, "cursor size %ux%u not supported\n",
901e05162c0SMaxime Ripard 		     new_state->crtc_w, new_state->crtc_h);
9024aa3df71SThierry Reding 		return;
903c7679306SThierry Reding 	}
904c7679306SThierry Reding 
90541016fe1SMaxime Ripard 	value |= (tegra_plane_state->iova[0] >> 10) & 0x3fffff;
906c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_CURSOR_START_ADDR);
907c7679306SThierry Reding 
908c7679306SThierry Reding #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
90941016fe1SMaxime Ripard 	value = (tegra_plane_state->iova[0] >> 32) & 0x3;
910c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_CURSOR_START_ADDR_HI);
911c7679306SThierry Reding #endif
912c7679306SThierry Reding 
913c7679306SThierry Reding 	/* enable cursor and set blend mode */
914c7679306SThierry Reding 	value = tegra_dc_readl(dc, DC_DISP_DISP_WIN_OPTIONS);
915c7679306SThierry Reding 	value |= CURSOR_ENABLE;
916c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_DISP_WIN_OPTIONS);
917c7679306SThierry Reding 
918c7679306SThierry Reding 	value = tegra_dc_readl(dc, DC_DISP_BLEND_CURSOR_CONTROL);
919c7679306SThierry Reding 	value &= ~CURSOR_DST_BLEND_MASK;
920c7679306SThierry Reding 	value &= ~CURSOR_SRC_BLEND_MASK;
921c7679306SThierry Reding 	value |= CURSOR_MODE_NORMAL;
922c7679306SThierry Reding 	value |= CURSOR_DST_BLEND_NEG_K1_TIMES_SRC;
923c7679306SThierry Reding 	value |= CURSOR_SRC_BLEND_K1_TIMES_SRC;
924c7679306SThierry Reding 	value |= CURSOR_ALPHA;
925c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_BLEND_CURSOR_CONTROL);
926c7679306SThierry Reding 
927c7679306SThierry Reding 	/* position the cursor */
928e05162c0SMaxime Ripard 	value = (new_state->crtc_y & 0x3fff) << 16 |
929e05162c0SMaxime Ripard 		(new_state->crtc_x & 0x3fff);
930c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_CURSOR_POSITION);
931c7679306SThierry Reding }
932c7679306SThierry Reding 
9334aa3df71SThierry Reding static void tegra_cursor_atomic_disable(struct drm_plane *plane,
934*977697e2SMaxime Ripard 					struct drm_atomic_state *state)
935c7679306SThierry Reding {
936*977697e2SMaxime Ripard 	struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state,
937*977697e2SMaxime Ripard 									   plane);
9384aa3df71SThierry Reding 	struct tegra_dc *dc;
939c7679306SThierry Reding 	u32 value;
940c7679306SThierry Reding 
9414aa3df71SThierry Reding 	/* rien ne va plus */
9424aa3df71SThierry Reding 	if (!old_state || !old_state->crtc)
9434aa3df71SThierry Reding 		return;
9444aa3df71SThierry Reding 
9454aa3df71SThierry Reding 	dc = to_tegra_dc(old_state->crtc);
946c7679306SThierry Reding 
947c7679306SThierry Reding 	value = tegra_dc_readl(dc, DC_DISP_DISP_WIN_OPTIONS);
948c7679306SThierry Reding 	value &= ~CURSOR_ENABLE;
949c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_DISP_WIN_OPTIONS);
950c7679306SThierry Reding }
951c7679306SThierry Reding 
9524aa3df71SThierry Reding static const struct drm_plane_helper_funcs tegra_cursor_plane_helper_funcs = {
9532e8d8749SThierry Reding 	.prepare_fb = tegra_plane_prepare_fb,
9542e8d8749SThierry Reding 	.cleanup_fb = tegra_plane_cleanup_fb,
9554aa3df71SThierry Reding 	.atomic_check = tegra_cursor_atomic_check,
9564aa3df71SThierry Reding 	.atomic_update = tegra_cursor_atomic_update,
9574aa3df71SThierry Reding 	.atomic_disable = tegra_cursor_atomic_disable,
958c7679306SThierry Reding };
959c7679306SThierry Reding 
960c7679306SThierry Reding static struct drm_plane *tegra_dc_cursor_plane_create(struct drm_device *drm,
961c7679306SThierry Reding 						      struct tegra_dc *dc)
962c7679306SThierry Reding {
96389f65018SThierry Reding 	unsigned long possible_crtcs = tegra_plane_get_possible_crtcs(drm);
964c7679306SThierry Reding 	struct tegra_plane *plane;
965c7679306SThierry Reding 	unsigned int num_formats;
966c7679306SThierry Reding 	const u32 *formats;
967c7679306SThierry Reding 	int err;
968c7679306SThierry Reding 
969c7679306SThierry Reding 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
970c7679306SThierry Reding 	if (!plane)
971c7679306SThierry Reding 		return ERR_PTR(-ENOMEM);
972c7679306SThierry Reding 
97347802b09SThierry Reding 	/*
974a1df3b24SThierry Reding 	 * This index is kind of fake. The cursor isn't a regular plane, but
975a1df3b24SThierry Reding 	 * its update and activation request bits in DC_CMD_STATE_CONTROL do
976a1df3b24SThierry Reding 	 * use the same programming. Setting this fake index here allows the
977a1df3b24SThierry Reding 	 * code in tegra_add_plane_state() to do the right thing without the
978a1df3b24SThierry Reding 	 * need to special-casing the cursor plane.
97947802b09SThierry Reding 	 */
98047802b09SThierry Reding 	plane->index = 6;
9811087fac1SThierry Reding 	plane->dc = dc;
98247802b09SThierry Reding 
983c7679306SThierry Reding 	num_formats = ARRAY_SIZE(tegra_cursor_plane_formats);
984c7679306SThierry Reding 	formats = tegra_cursor_plane_formats;
985c7679306SThierry Reding 
98689f65018SThierry Reding 	err = drm_universal_plane_init(drm, &plane->base, possible_crtcs,
987c1cb4b61SThierry Reding 				       &tegra_plane_funcs, formats,
988e6fc3b68SBen Widawsky 				       num_formats, NULL,
989e6fc3b68SBen Widawsky 				       DRM_PLANE_TYPE_CURSOR, NULL);
990c7679306SThierry Reding 	if (err < 0) {
991c7679306SThierry Reding 		kfree(plane);
992c7679306SThierry Reding 		return ERR_PTR(err);
993c7679306SThierry Reding 	}
994c7679306SThierry Reding 
9954aa3df71SThierry Reding 	drm_plane_helper_add(&plane->base, &tegra_cursor_plane_helper_funcs);
996fce3a51dSThierry Reding 	drm_plane_create_zpos_immutable_property(&plane->base, 255);
9974aa3df71SThierry Reding 
998c7679306SThierry Reding 	return &plane->base;
999c7679306SThierry Reding }
1000c7679306SThierry Reding 
1001511c7023SThierry Reding static const u32 tegra20_overlay_formats[] = {
1002511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
1003511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
1004dee8268fSThierry Reding 	DRM_FORMAT_RGB565,
1005511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
1006511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
1007511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
1008ebae8d07SThierry Reding 	/* non-native formats */
1009ebae8d07SThierry Reding 	DRM_FORMAT_XRGB1555,
1010ebae8d07SThierry Reding 	DRM_FORMAT_RGBX5551,
1011ebae8d07SThierry Reding 	DRM_FORMAT_XBGR8888,
1012ebae8d07SThierry Reding 	DRM_FORMAT_XRGB8888,
1013511c7023SThierry Reding 	/* planar formats */
1014511c7023SThierry Reding 	DRM_FORMAT_UYVY,
1015511c7023SThierry Reding 	DRM_FORMAT_YUYV,
1016511c7023SThierry Reding 	DRM_FORMAT_YUV420,
1017511c7023SThierry Reding 	DRM_FORMAT_YUV422,
1018511c7023SThierry Reding };
1019511c7023SThierry Reding 
1020511c7023SThierry Reding static const u32 tegra114_overlay_formats[] = {
1021511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
1022511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
1023511c7023SThierry Reding 	DRM_FORMAT_RGB565,
1024511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
1025511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
1026511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
1027511c7023SThierry Reding 	/* new on Tegra114 */
1028511c7023SThierry Reding 	DRM_FORMAT_ABGR4444,
1029511c7023SThierry Reding 	DRM_FORMAT_ABGR1555,
1030511c7023SThierry Reding 	DRM_FORMAT_BGRA5551,
1031511c7023SThierry Reding 	DRM_FORMAT_XRGB1555,
1032511c7023SThierry Reding 	DRM_FORMAT_RGBX5551,
1033511c7023SThierry Reding 	DRM_FORMAT_XBGR1555,
1034511c7023SThierry Reding 	DRM_FORMAT_BGRX5551,
1035511c7023SThierry Reding 	DRM_FORMAT_BGR565,
1036511c7023SThierry Reding 	DRM_FORMAT_BGRA8888,
1037511c7023SThierry Reding 	DRM_FORMAT_RGBA8888,
1038511c7023SThierry Reding 	DRM_FORMAT_XRGB8888,
1039511c7023SThierry Reding 	DRM_FORMAT_XBGR8888,
1040511c7023SThierry Reding 	/* planar formats */
1041511c7023SThierry Reding 	DRM_FORMAT_UYVY,
1042511c7023SThierry Reding 	DRM_FORMAT_YUYV,
1043511c7023SThierry Reding 	DRM_FORMAT_YUV420,
1044511c7023SThierry Reding 	DRM_FORMAT_YUV422,
1045511c7023SThierry Reding };
1046511c7023SThierry Reding 
1047511c7023SThierry Reding static const u32 tegra124_overlay_formats[] = {
1048511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
1049511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
1050511c7023SThierry Reding 	DRM_FORMAT_RGB565,
1051511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
1052511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
1053511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
1054511c7023SThierry Reding 	/* new on Tegra114 */
1055511c7023SThierry Reding 	DRM_FORMAT_ABGR4444,
1056511c7023SThierry Reding 	DRM_FORMAT_ABGR1555,
1057511c7023SThierry Reding 	DRM_FORMAT_BGRA5551,
1058511c7023SThierry Reding 	DRM_FORMAT_XRGB1555,
1059511c7023SThierry Reding 	DRM_FORMAT_RGBX5551,
1060511c7023SThierry Reding 	DRM_FORMAT_XBGR1555,
1061511c7023SThierry Reding 	DRM_FORMAT_BGRX5551,
1062511c7023SThierry Reding 	DRM_FORMAT_BGR565,
1063511c7023SThierry Reding 	DRM_FORMAT_BGRA8888,
1064511c7023SThierry Reding 	DRM_FORMAT_RGBA8888,
1065511c7023SThierry Reding 	DRM_FORMAT_XRGB8888,
1066511c7023SThierry Reding 	DRM_FORMAT_XBGR8888,
1067511c7023SThierry Reding 	/* new on Tegra124 */
1068511c7023SThierry Reding 	DRM_FORMAT_RGBX8888,
1069511c7023SThierry Reding 	DRM_FORMAT_BGRX8888,
1070511c7023SThierry Reding 	/* planar formats */
1071dee8268fSThierry Reding 	DRM_FORMAT_UYVY,
1072f925390eSThierry Reding 	DRM_FORMAT_YUYV,
1073dee8268fSThierry Reding 	DRM_FORMAT_YUV420,
1074dee8268fSThierry Reding 	DRM_FORMAT_YUV422,
1075dee8268fSThierry Reding };
1076dee8268fSThierry Reding 
1077c7679306SThierry Reding static struct drm_plane *tegra_dc_overlay_plane_create(struct drm_device *drm,
1078c7679306SThierry Reding 						       struct tegra_dc *dc,
10799f446d83SDmitry Osipenko 						       unsigned int index,
10809f446d83SDmitry Osipenko 						       bool cursor)
1081dee8268fSThierry Reding {
108289f65018SThierry Reding 	unsigned long possible_crtcs = tegra_plane_get_possible_crtcs(drm);
1083dee8268fSThierry Reding 	struct tegra_plane *plane;
1084c7679306SThierry Reding 	unsigned int num_formats;
10859f446d83SDmitry Osipenko 	enum drm_plane_type type;
1086c7679306SThierry Reding 	const u32 *formats;
1087c7679306SThierry Reding 	int err;
1088dee8268fSThierry Reding 
1089f002abc1SThierry Reding 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
1090dee8268fSThierry Reding 	if (!plane)
1091c7679306SThierry Reding 		return ERR_PTR(-ENOMEM);
1092dee8268fSThierry Reding 
10931087fac1SThierry Reding 	plane->offset = 0xa00 + 0x200 * index;
1094c7679306SThierry Reding 	plane->index = index;
10951087fac1SThierry Reding 	plane->dc = dc;
1096dee8268fSThierry Reding 
1097511c7023SThierry Reding 	num_formats = dc->soc->num_overlay_formats;
1098511c7023SThierry Reding 	formats = dc->soc->overlay_formats;
1099c7679306SThierry Reding 
11009f446d83SDmitry Osipenko 	if (!cursor)
11019f446d83SDmitry Osipenko 		type = DRM_PLANE_TYPE_OVERLAY;
11029f446d83SDmitry Osipenko 	else
11039f446d83SDmitry Osipenko 		type = DRM_PLANE_TYPE_CURSOR;
11049f446d83SDmitry Osipenko 
110589f65018SThierry Reding 	err = drm_universal_plane_init(drm, &plane->base, possible_crtcs,
1106301e0ddbSThierry Reding 				       &tegra_plane_funcs, formats,
11079f446d83SDmitry Osipenko 				       num_formats, NULL, type, NULL);
1108f002abc1SThierry Reding 	if (err < 0) {
1109f002abc1SThierry Reding 		kfree(plane);
1110c7679306SThierry Reding 		return ERR_PTR(err);
1111dee8268fSThierry Reding 	}
1112c7679306SThierry Reding 
1113a4bfa096SThierry Reding 	drm_plane_helper_add(&plane->base, &tegra_plane_helper_funcs);
11143dae08bcSDmitry Osipenko 	drm_plane_create_zpos_property(&plane->base, plane->index, 0, 255);
1115ab7d3f58SThierry Reding 
1116995c5a50SThierry Reding 	err = drm_plane_create_rotation_property(&plane->base,
1117995c5a50SThierry Reding 						 DRM_MODE_ROTATE_0,
1118995c5a50SThierry Reding 						 DRM_MODE_ROTATE_0 |
11194fba6d22SDmitry Osipenko 						 DRM_MODE_ROTATE_180 |
1120cd740777SDmitry Osipenko 						 DRM_MODE_REFLECT_X |
1121995c5a50SThierry Reding 						 DRM_MODE_REFLECT_Y);
1122995c5a50SThierry Reding 	if (err < 0)
1123995c5a50SThierry Reding 		dev_err(dc->dev, "failed to create rotation property: %d\n",
1124995c5a50SThierry Reding 			err);
1125995c5a50SThierry Reding 
1126c7679306SThierry Reding 	return &plane->base;
1127c7679306SThierry Reding }
1128c7679306SThierry Reding 
112947307954SThierry Reding static struct drm_plane *tegra_dc_add_shared_planes(struct drm_device *drm,
113047307954SThierry Reding 						    struct tegra_dc *dc)
1131c7679306SThierry Reding {
113247307954SThierry Reding 	struct drm_plane *plane, *primary = NULL;
113347307954SThierry Reding 	unsigned int i, j;
113447307954SThierry Reding 
113547307954SThierry Reding 	for (i = 0; i < dc->soc->num_wgrps; i++) {
113647307954SThierry Reding 		const struct tegra_windowgroup_soc *wgrp = &dc->soc->wgrps[i];
113747307954SThierry Reding 
113847307954SThierry Reding 		if (wgrp->dc == dc->pipe) {
113947307954SThierry Reding 			for (j = 0; j < wgrp->num_windows; j++) {
114047307954SThierry Reding 				unsigned int index = wgrp->windows[j];
114147307954SThierry Reding 
114247307954SThierry Reding 				plane = tegra_shared_plane_create(drm, dc,
114347307954SThierry Reding 								  wgrp->index,
114447307954SThierry Reding 								  index);
114547307954SThierry Reding 				if (IS_ERR(plane))
114647307954SThierry Reding 					return plane;
114747307954SThierry Reding 
114847307954SThierry Reding 				/*
114947307954SThierry Reding 				 * Choose the first shared plane owned by this
115047307954SThierry Reding 				 * head as the primary plane.
115147307954SThierry Reding 				 */
115247307954SThierry Reding 				if (!primary) {
115347307954SThierry Reding 					plane->type = DRM_PLANE_TYPE_PRIMARY;
115447307954SThierry Reding 					primary = plane;
115547307954SThierry Reding 				}
115647307954SThierry Reding 			}
115747307954SThierry Reding 		}
115847307954SThierry Reding 	}
115947307954SThierry Reding 
116047307954SThierry Reding 	return primary;
116147307954SThierry Reding }
116247307954SThierry Reding 
116347307954SThierry Reding static struct drm_plane *tegra_dc_add_planes(struct drm_device *drm,
116447307954SThierry Reding 					     struct tegra_dc *dc)
116547307954SThierry Reding {
11668f62142eSThierry Reding 	struct drm_plane *planes[2], *primary;
11679f446d83SDmitry Osipenko 	unsigned int planes_num;
1168c7679306SThierry Reding 	unsigned int i;
11698f62142eSThierry Reding 	int err;
1170c7679306SThierry Reding 
117147307954SThierry Reding 	primary = tegra_primary_plane_create(drm, dc);
117247307954SThierry Reding 	if (IS_ERR(primary))
117347307954SThierry Reding 		return primary;
117447307954SThierry Reding 
11759f446d83SDmitry Osipenko 	if (dc->soc->supports_cursor)
11769f446d83SDmitry Osipenko 		planes_num = 2;
11779f446d83SDmitry Osipenko 	else
11789f446d83SDmitry Osipenko 		planes_num = 1;
11799f446d83SDmitry Osipenko 
11809f446d83SDmitry Osipenko 	for (i = 0; i < planes_num; i++) {
11819f446d83SDmitry Osipenko 		planes[i] = tegra_dc_overlay_plane_create(drm, dc, 1 + i,
11829f446d83SDmitry Osipenko 							  false);
11838f62142eSThierry Reding 		if (IS_ERR(planes[i])) {
11848f62142eSThierry Reding 			err = PTR_ERR(planes[i]);
11858f62142eSThierry Reding 
11868f62142eSThierry Reding 			while (i--)
11878f62142eSThierry Reding 				tegra_plane_funcs.destroy(planes[i]);
11888f62142eSThierry Reding 
11898f62142eSThierry Reding 			tegra_plane_funcs.destroy(primary);
11908f62142eSThierry Reding 			return ERR_PTR(err);
119147307954SThierry Reding 		}
1192f002abc1SThierry Reding 	}
1193dee8268fSThierry Reding 
119447307954SThierry Reding 	return primary;
1195dee8268fSThierry Reding }
1196dee8268fSThierry Reding 
1197f002abc1SThierry Reding static void tegra_dc_destroy(struct drm_crtc *crtc)
1198f002abc1SThierry Reding {
1199f002abc1SThierry Reding 	drm_crtc_cleanup(crtc);
1200f002abc1SThierry Reding }
1201f002abc1SThierry Reding 
1202ca915b10SThierry Reding static void tegra_crtc_reset(struct drm_crtc *crtc)
1203ca915b10SThierry Reding {
1204b7e0b04aSMaarten Lankhorst 	struct tegra_dc_state *state = kzalloc(sizeof(*state), GFP_KERNEL);
1205ca915b10SThierry Reding 
12063b59b7acSThierry Reding 	if (crtc->state)
1207b7e0b04aSMaarten Lankhorst 		tegra_crtc_atomic_destroy_state(crtc, crtc->state);
12083b59b7acSThierry Reding 
1209b7e0b04aSMaarten Lankhorst 	__drm_atomic_helper_crtc_reset(crtc, &state->base);
1210ca915b10SThierry Reding }
1211ca915b10SThierry Reding 
1212ca915b10SThierry Reding static struct drm_crtc_state *
1213ca915b10SThierry Reding tegra_crtc_atomic_duplicate_state(struct drm_crtc *crtc)
1214ca915b10SThierry Reding {
1215ca915b10SThierry Reding 	struct tegra_dc_state *state = to_dc_state(crtc->state);
1216ca915b10SThierry Reding 	struct tegra_dc_state *copy;
1217ca915b10SThierry Reding 
12183b59b7acSThierry Reding 	copy = kmalloc(sizeof(*copy), GFP_KERNEL);
1219ca915b10SThierry Reding 	if (!copy)
1220ca915b10SThierry Reding 		return NULL;
1221ca915b10SThierry Reding 
12223b59b7acSThierry Reding 	__drm_atomic_helper_crtc_duplicate_state(crtc, &copy->base);
12233b59b7acSThierry Reding 	copy->clk = state->clk;
12243b59b7acSThierry Reding 	copy->pclk = state->pclk;
12253b59b7acSThierry Reding 	copy->div = state->div;
12263b59b7acSThierry Reding 	copy->planes = state->planes;
1227ca915b10SThierry Reding 
1228ca915b10SThierry Reding 	return &copy->base;
1229ca915b10SThierry Reding }
1230ca915b10SThierry Reding 
1231ca915b10SThierry Reding static void tegra_crtc_atomic_destroy_state(struct drm_crtc *crtc,
1232ca915b10SThierry Reding 					    struct drm_crtc_state *state)
1233ca915b10SThierry Reding {
1234ec2dc6a0SDaniel Vetter 	__drm_atomic_helper_crtc_destroy_state(state);
1235ca915b10SThierry Reding 	kfree(state);
1236ca915b10SThierry Reding }
1237ca915b10SThierry Reding 
1238b95800eeSThierry Reding #define DEBUGFS_REG32(_name) { .name = #_name, .offset = _name }
1239b95800eeSThierry Reding 
1240b95800eeSThierry Reding static const struct debugfs_reg32 tegra_dc_regs[] = {
1241b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_GENERAL_INCR_SYNCPT),
1242b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_GENERAL_INCR_SYNCPT_CNTRL),
1243b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_GENERAL_INCR_SYNCPT_ERROR),
1244b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_A_INCR_SYNCPT),
1245b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_A_INCR_SYNCPT_CNTRL),
1246b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_A_INCR_SYNCPT_ERROR),
1247b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_B_INCR_SYNCPT),
1248b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_B_INCR_SYNCPT_CNTRL),
1249b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_B_INCR_SYNCPT_ERROR),
1250b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_C_INCR_SYNCPT),
1251b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_C_INCR_SYNCPT_CNTRL),
1252b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_C_INCR_SYNCPT_ERROR),
1253b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_CONT_SYNCPT_VSYNC),
1254b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_DISPLAY_COMMAND_OPTION0),
1255b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_DISPLAY_COMMAND),
1256b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_SIGNAL_RAISE),
1257b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_DISPLAY_POWER_CONTROL),
1258b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_STATUS),
1259b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_MASK),
1260b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_ENABLE),
1261b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_TYPE),
1262b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_POLARITY),
1263b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_SIGNAL_RAISE1),
1264b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_SIGNAL_RAISE2),
1265b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_SIGNAL_RAISE3),
1266b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_STATE_ACCESS),
1267b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_STATE_CONTROL),
1268b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_DISPLAY_WINDOW_HEADER),
1269b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_REG_ACT_CONTROL),
1270b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_CRC_CONTROL),
1271b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_CRC_CHECKSUM),
1272b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_ENABLE(0)),
1273b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_ENABLE(1)),
1274b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_ENABLE(2)),
1275b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_ENABLE(3)),
1276b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_POLARITY(0)),
1277b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_POLARITY(1)),
1278b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_POLARITY(2)),
1279b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_POLARITY(3)),
1280b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_DATA(0)),
1281b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_DATA(1)),
1282b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_DATA(2)),
1283b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_DATA(3)),
1284b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_ENABLE(0)),
1285b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_ENABLE(1)),
1286b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_ENABLE(2)),
1287b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_ENABLE(3)),
1288b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_DATA(0)),
1289b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_DATA(1)),
1290b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(0)),
1291b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(1)),
1292b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(2)),
1293b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(3)),
1294b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(4)),
1295b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(5)),
1296b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(6)),
1297b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_MISC_CONTROL),
1298b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_PM0_CONTROL),
1299b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_PM0_DUTY_CYCLE),
1300b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_PM1_CONTROL),
1301b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_PM1_DUTY_CYCLE),
1302b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_SPI_CONTROL),
1303b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_SPI_START_BYTE),
1304b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_HSPI_WRITE_DATA_AB),
1305b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_HSPI_WRITE_DATA_CD),
1306b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_HSPI_CS_DC),
1307b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_SCRATCH_REGISTER_A),
1308b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_SCRATCH_REGISTER_B),
1309b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_GPIO_CTRL),
1310b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_GPIO_DEBOUNCE_COUNTER),
1311b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_CRC_CHECKSUM_LATCHED),
1312b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_SIGNAL_OPTIONS0),
1313b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_SIGNAL_OPTIONS1),
1314b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_WIN_OPTIONS),
1315b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_MEM_HIGH_PRIORITY),
1316b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER),
1317b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_TIMING_OPTIONS),
1318b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_REF_TO_SYNC),
1319b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SYNC_WIDTH),
1320b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_BACK_PORCH),
1321b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_ACTIVE),
1322b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_FRONT_PORCH),
1323b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_CONTROL),
1324b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_POSITION_A),
1325b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_POSITION_B),
1326b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_POSITION_C),
1327b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_POSITION_D),
1328b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_CONTROL),
1329b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_POSITION_A),
1330b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_POSITION_B),
1331b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_POSITION_C),
1332b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_POSITION_D),
1333b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_CONTROL),
1334b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_POSITION_A),
1335b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_POSITION_B),
1336b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_POSITION_C),
1337b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_POSITION_D),
1338b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE0_CONTROL),
1339b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE0_POSITION_A),
1340b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE0_POSITION_B),
1341b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE0_POSITION_C),
1342b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE1_CONTROL),
1343b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE1_POSITION_A),
1344b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE1_POSITION_B),
1345b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE1_POSITION_C),
1346b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE2_CONTROL),
1347b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE2_POSITION_A),
1348b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE3_CONTROL),
1349b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE3_POSITION_A),
1350b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_M0_CONTROL),
1351b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_M1_CONTROL),
1352b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DI_CONTROL),
1353b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_CONTROL),
1354b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_SELECT_A),
1355b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_SELECT_B),
1356b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_SELECT_C),
1357b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_SELECT_D),
1358b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_CLOCK_CONTROL),
1359b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_INTERFACE_CONTROL),
1360b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_COLOR_CONTROL),
1361b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SHIFT_CLOCK_OPTIONS),
1362b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DATA_ENABLE_OPTIONS),
1363b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SERIAL_INTERFACE_OPTIONS),
1364b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_LCD_SPI_OPTIONS),
1365b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_BORDER_COLOR),
1366b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_COLOR_KEY0_LOWER),
1367b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_COLOR_KEY0_UPPER),
1368b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_COLOR_KEY1_LOWER),
1369b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_COLOR_KEY1_UPPER),
1370b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_FOREGROUND),
1371b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_BACKGROUND),
1372b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_START_ADDR),
1373b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_START_ADDR_NS),
1374b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_POSITION),
1375b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_POSITION_NS),
1376b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_INIT_SEQ_CONTROL),
1377b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SPI_INIT_SEQ_DATA_A),
1378b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SPI_INIT_SEQ_DATA_B),
1379b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SPI_INIT_SEQ_DATA_C),
1380b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SPI_INIT_SEQ_DATA_D),
1381b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DC_MCCIF_FIFOCTRL),
1382b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_MCCIF_DISPLAY0A_HYST),
1383b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_MCCIF_DISPLAY0B_HYST),
1384b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_MCCIF_DISPLAY1A_HYST),
1385b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_MCCIF_DISPLAY1B_HYST),
1386b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DAC_CRT_CTRL),
1387b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_MISC_CONTROL),
1388b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_CONTROL),
1389b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_CSC_COEFF),
1390b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(0)),
1391b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(1)),
1392b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(2)),
1393b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(3)),
1394b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(4)),
1395b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(5)),
1396b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(6)),
1397b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(7)),
1398b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(8)),
1399b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_FLICKER_CONTROL),
1400b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DC_PIXEL_COUNT),
1401b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(0)),
1402b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(1)),
1403b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(2)),
1404b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(3)),
1405b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(4)),
1406b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(5)),
1407b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(6)),
1408b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(7)),
1409b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_TF(0)),
1410b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_TF(1)),
1411b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_TF(2)),
1412b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_TF(3)),
1413b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_CONTROL),
1414b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HW_K_VALUES),
1415b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_MAN_K_VALUES),
1416b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_START_ADDR_HI),
1417b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_BLEND_CURSOR_CONTROL),
1418b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_WIN_OPTIONS),
1419b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BYTE_SWAP),
1420b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BUFFER_CONTROL),
1421b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_COLOR_DEPTH),
1422b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_POSITION),
1423b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_SIZE),
1424b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_PRESCALED_SIZE),
1425b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_H_INITIAL_DDA),
1426b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_V_INITIAL_DDA),
1427b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_DDA_INC),
1428b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_LINE_STRIDE),
1429b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BUF_STRIDE),
1430b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_UV_BUF_STRIDE),
1431b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BUFFER_ADDR_MODE),
1432b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_DV_CONTROL),
1433b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_NOKEY),
1434b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_1WIN),
1435b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_2WIN_X),
1436b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_2WIN_Y),
1437b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_3WIN_XY),
1438b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_HP_FETCH_CONTROL),
1439b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR),
1440b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_NS),
1441b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_U),
1442b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_U_NS),
1443b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_V),
1444b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_V_NS),
1445b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_ADDR_H_OFFSET),
1446b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_ADDR_H_OFFSET_NS),
1447b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_ADDR_V_OFFSET),
1448b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_ADDR_V_OFFSET_NS),
1449b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_UFLOW_STATUS),
1450b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_AD_UFLOW_STATUS),
1451b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_BD_UFLOW_STATUS),
1452b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_CD_UFLOW_STATUS),
1453b95800eeSThierry Reding };
1454b95800eeSThierry Reding 
1455b95800eeSThierry Reding static int tegra_dc_show_regs(struct seq_file *s, void *data)
1456b95800eeSThierry Reding {
1457b95800eeSThierry Reding 	struct drm_info_node *node = s->private;
1458b95800eeSThierry Reding 	struct tegra_dc *dc = node->info_ent->data;
1459b95800eeSThierry Reding 	unsigned int i;
1460b95800eeSThierry Reding 	int err = 0;
1461b95800eeSThierry Reding 
1462b95800eeSThierry Reding 	drm_modeset_lock(&dc->base.mutex, NULL);
1463b95800eeSThierry Reding 
1464b95800eeSThierry Reding 	if (!dc->base.state->active) {
1465b95800eeSThierry Reding 		err = -EBUSY;
1466b95800eeSThierry Reding 		goto unlock;
1467b95800eeSThierry Reding 	}
1468b95800eeSThierry Reding 
1469b95800eeSThierry Reding 	for (i = 0; i < ARRAY_SIZE(tegra_dc_regs); i++) {
1470b95800eeSThierry Reding 		unsigned int offset = tegra_dc_regs[i].offset;
1471b95800eeSThierry Reding 
1472b95800eeSThierry Reding 		seq_printf(s, "%-40s %#05x %08x\n", tegra_dc_regs[i].name,
1473b95800eeSThierry Reding 			   offset, tegra_dc_readl(dc, offset));
1474b95800eeSThierry Reding 	}
1475b95800eeSThierry Reding 
1476b95800eeSThierry Reding unlock:
1477b95800eeSThierry Reding 	drm_modeset_unlock(&dc->base.mutex);
1478b95800eeSThierry Reding 	return err;
1479b95800eeSThierry Reding }
1480b95800eeSThierry Reding 
1481b95800eeSThierry Reding static int tegra_dc_show_crc(struct seq_file *s, void *data)
1482b95800eeSThierry Reding {
1483b95800eeSThierry Reding 	struct drm_info_node *node = s->private;
1484b95800eeSThierry Reding 	struct tegra_dc *dc = node->info_ent->data;
1485b95800eeSThierry Reding 	int err = 0;
1486b95800eeSThierry Reding 	u32 value;
1487b95800eeSThierry Reding 
1488b95800eeSThierry Reding 	drm_modeset_lock(&dc->base.mutex, NULL);
1489b95800eeSThierry Reding 
1490b95800eeSThierry Reding 	if (!dc->base.state->active) {
1491b95800eeSThierry Reding 		err = -EBUSY;
1492b95800eeSThierry Reding 		goto unlock;
1493b95800eeSThierry Reding 	}
1494b95800eeSThierry Reding 
1495b95800eeSThierry Reding 	value = DC_COM_CRC_CONTROL_ACTIVE_DATA | DC_COM_CRC_CONTROL_ENABLE;
1496b95800eeSThierry Reding 	tegra_dc_writel(dc, value, DC_COM_CRC_CONTROL);
1497b95800eeSThierry Reding 	tegra_dc_commit(dc);
1498b95800eeSThierry Reding 
1499b95800eeSThierry Reding 	drm_crtc_wait_one_vblank(&dc->base);
1500b95800eeSThierry Reding 	drm_crtc_wait_one_vblank(&dc->base);
1501b95800eeSThierry Reding 
1502b95800eeSThierry Reding 	value = tegra_dc_readl(dc, DC_COM_CRC_CHECKSUM);
1503b95800eeSThierry Reding 	seq_printf(s, "%08x\n", value);
1504b95800eeSThierry Reding 
1505b95800eeSThierry Reding 	tegra_dc_writel(dc, 0, DC_COM_CRC_CONTROL);
1506b95800eeSThierry Reding 
1507b95800eeSThierry Reding unlock:
1508b95800eeSThierry Reding 	drm_modeset_unlock(&dc->base.mutex);
1509b95800eeSThierry Reding 	return err;
1510b95800eeSThierry Reding }
1511b95800eeSThierry Reding 
1512b95800eeSThierry Reding static int tegra_dc_show_stats(struct seq_file *s, void *data)
1513b95800eeSThierry Reding {
1514b95800eeSThierry Reding 	struct drm_info_node *node = s->private;
1515b95800eeSThierry Reding 	struct tegra_dc *dc = node->info_ent->data;
1516b95800eeSThierry Reding 
1517b95800eeSThierry Reding 	seq_printf(s, "frames: %lu\n", dc->stats.frames);
1518b95800eeSThierry Reding 	seq_printf(s, "vblank: %lu\n", dc->stats.vblank);
1519b95800eeSThierry Reding 	seq_printf(s, "underflow: %lu\n", dc->stats.underflow);
1520b95800eeSThierry Reding 	seq_printf(s, "overflow: %lu\n", dc->stats.overflow);
1521b95800eeSThierry Reding 
1522b95800eeSThierry Reding 	return 0;
1523b95800eeSThierry Reding }
1524b95800eeSThierry Reding 
1525b95800eeSThierry Reding static struct drm_info_list debugfs_files[] = {
1526b95800eeSThierry Reding 	{ "regs", tegra_dc_show_regs, 0, NULL },
1527b95800eeSThierry Reding 	{ "crc", tegra_dc_show_crc, 0, NULL },
1528b95800eeSThierry Reding 	{ "stats", tegra_dc_show_stats, 0, NULL },
1529b95800eeSThierry Reding };
1530b95800eeSThierry Reding 
1531b95800eeSThierry Reding static int tegra_dc_late_register(struct drm_crtc *crtc)
1532b95800eeSThierry Reding {
1533b95800eeSThierry Reding 	unsigned int i, count = ARRAY_SIZE(debugfs_files);
1534b95800eeSThierry Reding 	struct drm_minor *minor = crtc->dev->primary;
153539f55c61SArnd Bergmann 	struct dentry *root;
1536b95800eeSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1537b95800eeSThierry Reding 
153839f55c61SArnd Bergmann #ifdef CONFIG_DEBUG_FS
153939f55c61SArnd Bergmann 	root = crtc->debugfs_entry;
154039f55c61SArnd Bergmann #else
154139f55c61SArnd Bergmann 	root = NULL;
154239f55c61SArnd Bergmann #endif
154339f55c61SArnd Bergmann 
1544b95800eeSThierry Reding 	dc->debugfs_files = kmemdup(debugfs_files, sizeof(debugfs_files),
1545b95800eeSThierry Reding 				    GFP_KERNEL);
1546b95800eeSThierry Reding 	if (!dc->debugfs_files)
1547b95800eeSThierry Reding 		return -ENOMEM;
1548b95800eeSThierry Reding 
1549b95800eeSThierry Reding 	for (i = 0; i < count; i++)
1550b95800eeSThierry Reding 		dc->debugfs_files[i].data = dc;
1551b95800eeSThierry Reding 
1552ad6d94f2SWambui Karuga 	drm_debugfs_create_files(dc->debugfs_files, count, root, minor);
1553b95800eeSThierry Reding 
1554b95800eeSThierry Reding 	return 0;
1555b95800eeSThierry Reding }
1556b95800eeSThierry Reding 
1557b95800eeSThierry Reding static void tegra_dc_early_unregister(struct drm_crtc *crtc)
1558b95800eeSThierry Reding {
1559b95800eeSThierry Reding 	unsigned int count = ARRAY_SIZE(debugfs_files);
1560b95800eeSThierry Reding 	struct drm_minor *minor = crtc->dev->primary;
1561b95800eeSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1562b95800eeSThierry Reding 
1563b95800eeSThierry Reding 	drm_debugfs_remove_files(dc->debugfs_files, count, minor);
1564b95800eeSThierry Reding 	kfree(dc->debugfs_files);
1565b95800eeSThierry Reding 	dc->debugfs_files = NULL;
1566b95800eeSThierry Reding }
1567b95800eeSThierry Reding 
1568c49c81e2SThierry Reding static u32 tegra_dc_get_vblank_counter(struct drm_crtc *crtc)
1569c49c81e2SThierry Reding {
1570c49c81e2SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1571c49c81e2SThierry Reding 
157247307954SThierry Reding 	/* XXX vblank syncpoints don't work with nvdisplay yet */
157347307954SThierry Reding 	if (dc->syncpt && !dc->soc->has_nvdisplay)
1574c49c81e2SThierry Reding 		return host1x_syncpt_read(dc->syncpt);
1575c49c81e2SThierry Reding 
1576c49c81e2SThierry Reding 	/* fallback to software emulated VBLANK counter */
15773abe2413SDhinakaran Pandiyan 	return (u32)drm_crtc_vblank_count(&dc->base);
1578c49c81e2SThierry Reding }
1579c49c81e2SThierry Reding 
1580c49c81e2SThierry Reding static int tegra_dc_enable_vblank(struct drm_crtc *crtc)
1581c49c81e2SThierry Reding {
1582c49c81e2SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1583363541e8SThierry Reding 	u32 value;
1584c49c81e2SThierry Reding 
1585c49c81e2SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_INT_MASK);
1586c49c81e2SThierry Reding 	value |= VBLANK_INT;
1587c49c81e2SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
1588c49c81e2SThierry Reding 
1589c49c81e2SThierry Reding 	return 0;
1590c49c81e2SThierry Reding }
1591c49c81e2SThierry Reding 
1592c49c81e2SThierry Reding static void tegra_dc_disable_vblank(struct drm_crtc *crtc)
1593c49c81e2SThierry Reding {
1594c49c81e2SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1595363541e8SThierry Reding 	u32 value;
1596c49c81e2SThierry Reding 
1597c49c81e2SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_INT_MASK);
1598c49c81e2SThierry Reding 	value &= ~VBLANK_INT;
1599c49c81e2SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
1600c49c81e2SThierry Reding }
1601c49c81e2SThierry Reding 
1602dee8268fSThierry Reding static const struct drm_crtc_funcs tegra_crtc_funcs = {
16031503ca47SThierry Reding 	.page_flip = drm_atomic_helper_page_flip,
160474f48791SThierry Reding 	.set_config = drm_atomic_helper_set_config,
1605f002abc1SThierry Reding 	.destroy = tegra_dc_destroy,
1606ca915b10SThierry Reding 	.reset = tegra_crtc_reset,
1607ca915b10SThierry Reding 	.atomic_duplicate_state = tegra_crtc_atomic_duplicate_state,
1608ca915b10SThierry Reding 	.atomic_destroy_state = tegra_crtc_atomic_destroy_state,
1609b95800eeSThierry Reding 	.late_register = tegra_dc_late_register,
1610b95800eeSThierry Reding 	.early_unregister = tegra_dc_early_unregister,
161110437d9bSShawn Guo 	.get_vblank_counter = tegra_dc_get_vblank_counter,
161210437d9bSShawn Guo 	.enable_vblank = tegra_dc_enable_vblank,
161310437d9bSShawn Guo 	.disable_vblank = tegra_dc_disable_vblank,
1614dee8268fSThierry Reding };
1615dee8268fSThierry Reding 
1616dee8268fSThierry Reding static int tegra_dc_set_timings(struct tegra_dc *dc,
1617dee8268fSThierry Reding 				struct drm_display_mode *mode)
1618dee8268fSThierry Reding {
16190444c0ffSThierry Reding 	unsigned int h_ref_to_sync = 1;
16200444c0ffSThierry Reding 	unsigned int v_ref_to_sync = 1;
1621dee8268fSThierry Reding 	unsigned long value;
1622dee8268fSThierry Reding 
162347307954SThierry Reding 	if (!dc->soc->has_nvdisplay) {
1624dee8268fSThierry Reding 		tegra_dc_writel(dc, 0x0, DC_DISP_DISP_TIMING_OPTIONS);
1625dee8268fSThierry Reding 
1626dee8268fSThierry Reding 		value = (v_ref_to_sync << 16) | h_ref_to_sync;
1627dee8268fSThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_REF_TO_SYNC);
162847307954SThierry Reding 	}
1629dee8268fSThierry Reding 
1630dee8268fSThierry Reding 	value = ((mode->vsync_end - mode->vsync_start) << 16) |
1631dee8268fSThierry Reding 		((mode->hsync_end - mode->hsync_start) <<  0);
1632dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_SYNC_WIDTH);
1633dee8268fSThierry Reding 
1634dee8268fSThierry Reding 	value = ((mode->vtotal - mode->vsync_end) << 16) |
1635dee8268fSThierry Reding 		((mode->htotal - mode->hsync_end) <<  0);
1636dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_BACK_PORCH);
1637dee8268fSThierry Reding 
1638dee8268fSThierry Reding 	value = ((mode->vsync_start - mode->vdisplay) << 16) |
1639dee8268fSThierry Reding 		((mode->hsync_start - mode->hdisplay) <<  0);
1640dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_FRONT_PORCH);
1641dee8268fSThierry Reding 
1642dee8268fSThierry Reding 	value = (mode->vdisplay << 16) | mode->hdisplay;
1643dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_ACTIVE);
1644dee8268fSThierry Reding 
1645dee8268fSThierry Reding 	return 0;
1646dee8268fSThierry Reding }
1647dee8268fSThierry Reding 
16489d910b60SThierry Reding /**
16499d910b60SThierry Reding  * tegra_dc_state_setup_clock - check clock settings and store them in atomic
16509d910b60SThierry Reding  *     state
16519d910b60SThierry Reding  * @dc: display controller
16529d910b60SThierry Reding  * @crtc_state: CRTC atomic state
16539d910b60SThierry Reding  * @clk: parent clock for display controller
16549d910b60SThierry Reding  * @pclk: pixel clock
16559d910b60SThierry Reding  * @div: shift clock divider
16569d910b60SThierry Reding  *
16579d910b60SThierry Reding  * Returns:
16589d910b60SThierry Reding  * 0 on success or a negative error-code on failure.
16599d910b60SThierry Reding  */
1660ca915b10SThierry Reding int tegra_dc_state_setup_clock(struct tegra_dc *dc,
1661ca915b10SThierry Reding 			       struct drm_crtc_state *crtc_state,
1662ca915b10SThierry Reding 			       struct clk *clk, unsigned long pclk,
1663ca915b10SThierry Reding 			       unsigned int div)
1664ca915b10SThierry Reding {
1665ca915b10SThierry Reding 	struct tegra_dc_state *state = to_dc_state(crtc_state);
1666ca915b10SThierry Reding 
1667d2982748SThierry Reding 	if (!clk_has_parent(dc->clk, clk))
1668d2982748SThierry Reding 		return -EINVAL;
1669d2982748SThierry Reding 
1670ca915b10SThierry Reding 	state->clk = clk;
1671ca915b10SThierry Reding 	state->pclk = pclk;
1672ca915b10SThierry Reding 	state->div = div;
1673ca915b10SThierry Reding 
1674ca915b10SThierry Reding 	return 0;
1675ca915b10SThierry Reding }
1676ca915b10SThierry Reding 
167776d59ed0SThierry Reding static void tegra_dc_commit_state(struct tegra_dc *dc,
167876d59ed0SThierry Reding 				  struct tegra_dc_state *state)
167976d59ed0SThierry Reding {
168076d59ed0SThierry Reding 	u32 value;
168176d59ed0SThierry Reding 	int err;
168276d59ed0SThierry Reding 
168376d59ed0SThierry Reding 	err = clk_set_parent(dc->clk, state->clk);
168476d59ed0SThierry Reding 	if (err < 0)
168576d59ed0SThierry Reding 		dev_err(dc->dev, "failed to set parent clock: %d\n", err);
168676d59ed0SThierry Reding 
168776d59ed0SThierry Reding 	/*
168876d59ed0SThierry Reding 	 * Outputs may not want to change the parent clock rate. This is only
168976d59ed0SThierry Reding 	 * relevant to Tegra20 where only a single display PLL is available.
169076d59ed0SThierry Reding 	 * Since that PLL would typically be used for HDMI, an internal LVDS
169176d59ed0SThierry Reding 	 * panel would need to be driven by some other clock such as PLL_P
169276d59ed0SThierry Reding 	 * which is shared with other peripherals. Changing the clock rate
169376d59ed0SThierry Reding 	 * should therefore be avoided.
169476d59ed0SThierry Reding 	 */
169576d59ed0SThierry Reding 	if (state->pclk > 0) {
169676d59ed0SThierry Reding 		err = clk_set_rate(state->clk, state->pclk);
169776d59ed0SThierry Reding 		if (err < 0)
169876d59ed0SThierry Reding 			dev_err(dc->dev,
169976d59ed0SThierry Reding 				"failed to set clock rate to %lu Hz\n",
170076d59ed0SThierry Reding 				state->pclk);
170176d59ed0SThierry Reding 	}
170276d59ed0SThierry Reding 
170376d59ed0SThierry Reding 	DRM_DEBUG_KMS("rate: %lu, div: %u\n", clk_get_rate(dc->clk),
170476d59ed0SThierry Reding 		      state->div);
170576d59ed0SThierry Reding 	DRM_DEBUG_KMS("pclk: %lu\n", state->pclk);
170676d59ed0SThierry Reding 
170747307954SThierry Reding 	if (!dc->soc->has_nvdisplay) {
170876d59ed0SThierry Reding 		value = SHIFT_CLK_DIVIDER(state->div) | PIXEL_CLK_DIVIDER_PCD1;
170976d59ed0SThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_DISP_CLOCK_CONTROL);
171047307954SThierry Reding 	}
171139e08affSThierry Reding 
171239e08affSThierry Reding 	err = clk_set_rate(dc->clk, state->pclk);
171339e08affSThierry Reding 	if (err < 0)
171439e08affSThierry Reding 		dev_err(dc->dev, "failed to set clock %pC to %lu Hz: %d\n",
171539e08affSThierry Reding 			dc->clk, state->pclk, err);
171676d59ed0SThierry Reding }
171776d59ed0SThierry Reding 
1718003fc848SThierry Reding static void tegra_dc_stop(struct tegra_dc *dc)
1719003fc848SThierry Reding {
1720003fc848SThierry Reding 	u32 value;
1721003fc848SThierry Reding 
1722003fc848SThierry Reding 	/* stop the display controller */
1723003fc848SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_DISPLAY_COMMAND);
1724003fc848SThierry Reding 	value &= ~DISP_CTRL_MODE_MASK;
1725003fc848SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_DISPLAY_COMMAND);
1726003fc848SThierry Reding 
1727003fc848SThierry Reding 	tegra_dc_commit(dc);
1728003fc848SThierry Reding }
1729003fc848SThierry Reding 
1730003fc848SThierry Reding static bool tegra_dc_idle(struct tegra_dc *dc)
1731003fc848SThierry Reding {
1732003fc848SThierry Reding 	u32 value;
1733003fc848SThierry Reding 
1734003fc848SThierry Reding 	value = tegra_dc_readl_active(dc, DC_CMD_DISPLAY_COMMAND);
1735003fc848SThierry Reding 
1736003fc848SThierry Reding 	return (value & DISP_CTRL_MODE_MASK) == 0;
1737003fc848SThierry Reding }
1738003fc848SThierry Reding 
1739003fc848SThierry Reding static int tegra_dc_wait_idle(struct tegra_dc *dc, unsigned long timeout)
1740003fc848SThierry Reding {
1741003fc848SThierry Reding 	timeout = jiffies + msecs_to_jiffies(timeout);
1742003fc848SThierry Reding 
1743003fc848SThierry Reding 	while (time_before(jiffies, timeout)) {
1744003fc848SThierry Reding 		if (tegra_dc_idle(dc))
1745003fc848SThierry Reding 			return 0;
1746003fc848SThierry Reding 
1747003fc848SThierry Reding 		usleep_range(1000, 2000);
1748003fc848SThierry Reding 	}
1749003fc848SThierry Reding 
1750003fc848SThierry Reding 	dev_dbg(dc->dev, "timeout waiting for DC to become idle\n");
1751003fc848SThierry Reding 	return -ETIMEDOUT;
1752003fc848SThierry Reding }
1753003fc848SThierry Reding 
175464581714SLaurent Pinchart static void tegra_crtc_atomic_disable(struct drm_crtc *crtc,
1755351f950dSMaxime Ripard 				      struct drm_atomic_state *state)
1756003fc848SThierry Reding {
1757003fc848SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1758003fc848SThierry Reding 	u32 value;
1759fd67e9c6SThierry Reding 	int err;
1760003fc848SThierry Reding 
1761003fc848SThierry Reding 	if (!tegra_dc_idle(dc)) {
1762003fc848SThierry Reding 		tegra_dc_stop(dc);
1763003fc848SThierry Reding 
1764003fc848SThierry Reding 		/*
1765003fc848SThierry Reding 		 * Ignore the return value, there isn't anything useful to do
1766003fc848SThierry Reding 		 * in case this fails.
1767003fc848SThierry Reding 		 */
1768003fc848SThierry Reding 		tegra_dc_wait_idle(dc, 100);
1769003fc848SThierry Reding 	}
1770003fc848SThierry Reding 
1771003fc848SThierry Reding 	/*
1772003fc848SThierry Reding 	 * This should really be part of the RGB encoder driver, but clearing
1773003fc848SThierry Reding 	 * these bits has the side-effect of stopping the display controller.
1774003fc848SThierry Reding 	 * When that happens no VBLANK interrupts will be raised. At the same
1775003fc848SThierry Reding 	 * time the encoder is disabled before the display controller, so the
1776003fc848SThierry Reding 	 * above code is always going to timeout waiting for the controller
1777003fc848SThierry Reding 	 * to go idle.
1778003fc848SThierry Reding 	 *
1779003fc848SThierry Reding 	 * Given the close coupling between the RGB encoder and the display
1780003fc848SThierry Reding 	 * controller doing it here is still kind of okay. None of the other
1781003fc848SThierry Reding 	 * encoder drivers require these bits to be cleared.
1782003fc848SThierry Reding 	 *
1783003fc848SThierry Reding 	 * XXX: Perhaps given that the display controller is switched off at
1784003fc848SThierry Reding 	 * this point anyway maybe clearing these bits isn't even useful for
1785003fc848SThierry Reding 	 * the RGB encoder?
1786003fc848SThierry Reding 	 */
1787003fc848SThierry Reding 	if (dc->rgb) {
1788003fc848SThierry Reding 		value = tegra_dc_readl(dc, DC_CMD_DISPLAY_POWER_CONTROL);
1789003fc848SThierry Reding 		value &= ~(PW0_ENABLE | PW1_ENABLE | PW2_ENABLE | PW3_ENABLE |
1790003fc848SThierry Reding 			   PW4_ENABLE | PM0_ENABLE | PM1_ENABLE);
1791003fc848SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_DISPLAY_POWER_CONTROL);
1792003fc848SThierry Reding 	}
1793003fc848SThierry Reding 
1794003fc848SThierry Reding 	tegra_dc_stats_reset(&dc->stats);
1795003fc848SThierry Reding 	drm_crtc_vblank_off(crtc);
179633a8eb8dSThierry Reding 
17979d99ab6eSThierry Reding 	spin_lock_irq(&crtc->dev->event_lock);
17989d99ab6eSThierry Reding 
17999d99ab6eSThierry Reding 	if (crtc->state->event) {
18009d99ab6eSThierry Reding 		drm_crtc_send_vblank_event(crtc, crtc->state->event);
18019d99ab6eSThierry Reding 		crtc->state->event = NULL;
18029d99ab6eSThierry Reding 	}
18039d99ab6eSThierry Reding 
18049d99ab6eSThierry Reding 	spin_unlock_irq(&crtc->dev->event_lock);
18059d99ab6eSThierry Reding 
1806fd67e9c6SThierry Reding 	err = host1x_client_suspend(&dc->client);
1807fd67e9c6SThierry Reding 	if (err < 0)
1808fd67e9c6SThierry Reding 		dev_err(dc->dev, "failed to suspend: %d\n", err);
1809003fc848SThierry Reding }
1810003fc848SThierry Reding 
18110b20a0f8SLaurent Pinchart static void tegra_crtc_atomic_enable(struct drm_crtc *crtc,
1812351f950dSMaxime Ripard 				     struct drm_atomic_state *state)
1813dee8268fSThierry Reding {
18144aa3df71SThierry Reding 	struct drm_display_mode *mode = &crtc->state->adjusted_mode;
1815351f950dSMaxime Ripard 	struct tegra_dc_state *crtc_state = to_dc_state(crtc->state);
1816dee8268fSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1817dbb3f2f7SThierry Reding 	u32 value;
1818fd67e9c6SThierry Reding 	int err;
1819dee8268fSThierry Reding 
1820fd67e9c6SThierry Reding 	err = host1x_client_resume(&dc->client);
1821fd67e9c6SThierry Reding 	if (err < 0) {
1822fd67e9c6SThierry Reding 		dev_err(dc->dev, "failed to resume: %d\n", err);
1823fd67e9c6SThierry Reding 		return;
1824fd67e9c6SThierry Reding 	}
182533a8eb8dSThierry Reding 
182633a8eb8dSThierry Reding 	/* initialize display controller */
182733a8eb8dSThierry Reding 	if (dc->syncpt) {
182847307954SThierry Reding 		u32 syncpt = host1x_syncpt_id(dc->syncpt), enable;
182947307954SThierry Reding 
183047307954SThierry Reding 		if (dc->soc->has_nvdisplay)
183147307954SThierry Reding 			enable = 1 << 31;
183247307954SThierry Reding 		else
183347307954SThierry Reding 			enable = 1 << 8;
183433a8eb8dSThierry Reding 
183533a8eb8dSThierry Reding 		value = SYNCPT_CNTRL_NO_STALL;
183633a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_GENERAL_INCR_SYNCPT_CNTRL);
183733a8eb8dSThierry Reding 
183847307954SThierry Reding 		value = enable | syncpt;
183933a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_CONT_SYNCPT_VSYNC);
184033a8eb8dSThierry Reding 	}
184133a8eb8dSThierry Reding 
184247307954SThierry Reding 	if (dc->soc->has_nvdisplay) {
184347307954SThierry Reding 		value = DSC_TO_UF_INT | DSC_BBUF_UF_INT | DSC_RBUF_UF_INT |
184447307954SThierry Reding 			DSC_OBUF_UF_INT;
184547307954SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_TYPE);
184647307954SThierry Reding 
184747307954SThierry Reding 		value = DSC_TO_UF_INT | DSC_BBUF_UF_INT | DSC_RBUF_UF_INT |
184847307954SThierry Reding 			DSC_OBUF_UF_INT | SD3_BUCKET_WALK_DONE_INT |
184947307954SThierry Reding 			HEAD_UF_INT | MSF_INT | REG_TMOUT_INT |
185047307954SThierry Reding 			REGION_CRC_INT | V_PULSE2_INT | V_PULSE3_INT |
185147307954SThierry Reding 			VBLANK_INT | FRAME_END_INT;
185247307954SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_POLARITY);
185347307954SThierry Reding 
185447307954SThierry Reding 		value = SD3_BUCKET_WALK_DONE_INT | HEAD_UF_INT | VBLANK_INT |
185547307954SThierry Reding 			FRAME_END_INT;
185647307954SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_ENABLE);
185747307954SThierry Reding 
185847307954SThierry Reding 		value = HEAD_UF_INT | REG_TMOUT_INT | FRAME_END_INT;
185947307954SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
186047307954SThierry Reding 
186147307954SThierry Reding 		tegra_dc_writel(dc, READ_MUX, DC_CMD_STATE_ACCESS);
186247307954SThierry Reding 	} else {
186333a8eb8dSThierry Reding 		value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT |
186433a8eb8dSThierry Reding 			WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT;
186533a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_TYPE);
186633a8eb8dSThierry Reding 
186733a8eb8dSThierry Reding 		value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT |
186833a8eb8dSThierry Reding 			WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT;
186933a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_POLARITY);
187033a8eb8dSThierry Reding 
187133a8eb8dSThierry Reding 		/* initialize timer */
187233a8eb8dSThierry Reding 		value = CURSOR_THRESHOLD(0) | WINDOW_A_THRESHOLD(0x20) |
187333a8eb8dSThierry Reding 			WINDOW_B_THRESHOLD(0x20) | WINDOW_C_THRESHOLD(0x20);
187433a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_DISP_MEM_HIGH_PRIORITY);
187533a8eb8dSThierry Reding 
187633a8eb8dSThierry Reding 		value = CURSOR_THRESHOLD(0) | WINDOW_A_THRESHOLD(1) |
187733a8eb8dSThierry Reding 			WINDOW_B_THRESHOLD(1) | WINDOW_C_THRESHOLD(1);
187833a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER);
187933a8eb8dSThierry Reding 
188033a8eb8dSThierry Reding 		value = VBLANK_INT | WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT |
188133a8eb8dSThierry Reding 			WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT;
188233a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_ENABLE);
188333a8eb8dSThierry Reding 
188433a8eb8dSThierry Reding 		value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT |
188533a8eb8dSThierry Reding 			WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT;
188633a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
188747307954SThierry Reding 	}
188833a8eb8dSThierry Reding 
18897116e9a8SThierry Reding 	if (dc->soc->supports_background_color)
18907116e9a8SThierry Reding 		tegra_dc_writel(dc, 0, DC_DISP_BLEND_BACKGROUND_COLOR);
18917116e9a8SThierry Reding 	else
189233a8eb8dSThierry Reding 		tegra_dc_writel(dc, 0, DC_DISP_BORDER_COLOR);
189333a8eb8dSThierry Reding 
189433a8eb8dSThierry Reding 	/* apply PLL and pixel clock changes */
1895351f950dSMaxime Ripard 	tegra_dc_commit_state(dc, crtc_state);
189676d59ed0SThierry Reding 
1897dee8268fSThierry Reding 	/* program display mode */
1898dee8268fSThierry Reding 	tegra_dc_set_timings(dc, mode);
1899dee8268fSThierry Reding 
19008620fc62SThierry Reding 	/* interlacing isn't supported yet, so disable it */
19018620fc62SThierry Reding 	if (dc->soc->supports_interlacing) {
19028620fc62SThierry Reding 		value = tegra_dc_readl(dc, DC_DISP_INTERLACE_CONTROL);
19038620fc62SThierry Reding 		value &= ~INTERLACE_ENABLE;
19048620fc62SThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_INTERLACE_CONTROL);
19058620fc62SThierry Reding 	}
1906666cb873SThierry Reding 
1907666cb873SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_DISPLAY_COMMAND);
1908666cb873SThierry Reding 	value &= ~DISP_CTRL_MODE_MASK;
1909666cb873SThierry Reding 	value |= DISP_CTRL_MODE_C_DISPLAY;
1910666cb873SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_DISPLAY_COMMAND);
1911666cb873SThierry Reding 
191247307954SThierry Reding 	if (!dc->soc->has_nvdisplay) {
1913666cb873SThierry Reding 		value = tegra_dc_readl(dc, DC_CMD_DISPLAY_POWER_CONTROL);
1914666cb873SThierry Reding 		value |= PW0_ENABLE | PW1_ENABLE | PW2_ENABLE | PW3_ENABLE |
1915666cb873SThierry Reding 			 PW4_ENABLE | PM0_ENABLE | PM1_ENABLE;
1916666cb873SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_DISPLAY_POWER_CONTROL);
191747307954SThierry Reding 	}
191847307954SThierry Reding 
191947307954SThierry Reding 	/* enable underflow reporting and display red for missing pixels */
192047307954SThierry Reding 	if (dc->soc->has_nvdisplay) {
192147307954SThierry Reding 		value = UNDERFLOW_MODE_RED | UNDERFLOW_REPORT_ENABLE;
192247307954SThierry Reding 		tegra_dc_writel(dc, value, DC_COM_RG_UNDERFLOW);
192347307954SThierry Reding 	}
1924666cb873SThierry Reding 
1925666cb873SThierry Reding 	tegra_dc_commit(dc);
1926dee8268fSThierry Reding 
19278ff64c17SThierry Reding 	drm_crtc_vblank_on(crtc);
1928dee8268fSThierry Reding }
1929dee8268fSThierry Reding 
1930613d2b27SMaarten Lankhorst static void tegra_crtc_atomic_begin(struct drm_crtc *crtc,
1931f6ebe9f9SMaxime Ripard 				    struct drm_atomic_state *state)
19324aa3df71SThierry Reding {
19339d99ab6eSThierry Reding 	unsigned long flags;
19341503ca47SThierry Reding 
19351503ca47SThierry Reding 	if (crtc->state->event) {
19369d99ab6eSThierry Reding 		spin_lock_irqsave(&crtc->dev->event_lock, flags);
19371503ca47SThierry Reding 
19389d99ab6eSThierry Reding 		if (drm_crtc_vblank_get(crtc) != 0)
19399d99ab6eSThierry Reding 			drm_crtc_send_vblank_event(crtc, crtc->state->event);
19409d99ab6eSThierry Reding 		else
19419d99ab6eSThierry Reding 			drm_crtc_arm_vblank_event(crtc, crtc->state->event);
19421503ca47SThierry Reding 
19439d99ab6eSThierry Reding 		spin_unlock_irqrestore(&crtc->dev->event_lock, flags);
19449d99ab6eSThierry Reding 
19451503ca47SThierry Reding 		crtc->state->event = NULL;
19461503ca47SThierry Reding 	}
19474aa3df71SThierry Reding }
19484aa3df71SThierry Reding 
1949613d2b27SMaarten Lankhorst static void tegra_crtc_atomic_flush(struct drm_crtc *crtc,
1950f6ebe9f9SMaxime Ripard 				    struct drm_atomic_state *state)
19514aa3df71SThierry Reding {
1952253f28b6SMaxime Ripard 	struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state,
1953253f28b6SMaxime Ripard 									  crtc);
1954253f28b6SMaxime Ripard 	struct tegra_dc_state *dc_state = to_dc_state(crtc_state);
195547802b09SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
195647307954SThierry Reding 	u32 value;
195747802b09SThierry Reding 
1958253f28b6SMaxime Ripard 	value = dc_state->planes << 8 | GENERAL_UPDATE;
195947307954SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL);
196047307954SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_STATE_CONTROL);
196147307954SThierry Reding 
1962253f28b6SMaxime Ripard 	value = dc_state->planes | GENERAL_ACT_REQ;
196347307954SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL);
196447307954SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_STATE_CONTROL);
19654aa3df71SThierry Reding }
19664aa3df71SThierry Reding 
1967dee8268fSThierry Reding static const struct drm_crtc_helper_funcs tegra_crtc_helper_funcs = {
19684aa3df71SThierry Reding 	.atomic_begin = tegra_crtc_atomic_begin,
19694aa3df71SThierry Reding 	.atomic_flush = tegra_crtc_atomic_flush,
19700b20a0f8SLaurent Pinchart 	.atomic_enable = tegra_crtc_atomic_enable,
197164581714SLaurent Pinchart 	.atomic_disable = tegra_crtc_atomic_disable,
1972dee8268fSThierry Reding };
1973dee8268fSThierry Reding 
1974dee8268fSThierry Reding static irqreturn_t tegra_dc_irq(int irq, void *data)
1975dee8268fSThierry Reding {
1976dee8268fSThierry Reding 	struct tegra_dc *dc = data;
1977dee8268fSThierry Reding 	unsigned long status;
1978dee8268fSThierry Reding 
1979dee8268fSThierry Reding 	status = tegra_dc_readl(dc, DC_CMD_INT_STATUS);
1980dee8268fSThierry Reding 	tegra_dc_writel(dc, status, DC_CMD_INT_STATUS);
1981dee8268fSThierry Reding 
1982dee8268fSThierry Reding 	if (status & FRAME_END_INT) {
1983dee8268fSThierry Reding 		/*
1984dee8268fSThierry Reding 		dev_dbg(dc->dev, "%s(): frame end\n", __func__);
1985dee8268fSThierry Reding 		*/
1986791ddb1eSThierry Reding 		dc->stats.frames++;
1987dee8268fSThierry Reding 	}
1988dee8268fSThierry Reding 
1989dee8268fSThierry Reding 	if (status & VBLANK_INT) {
1990dee8268fSThierry Reding 		/*
1991dee8268fSThierry Reding 		dev_dbg(dc->dev, "%s(): vertical blank\n", __func__);
1992dee8268fSThierry Reding 		*/
1993ed7dae58SThierry Reding 		drm_crtc_handle_vblank(&dc->base);
1994791ddb1eSThierry Reding 		dc->stats.vblank++;
1995dee8268fSThierry Reding 	}
1996dee8268fSThierry Reding 
1997dee8268fSThierry Reding 	if (status & (WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT)) {
1998dee8268fSThierry Reding 		/*
1999dee8268fSThierry Reding 		dev_dbg(dc->dev, "%s(): underflow\n", __func__);
2000dee8268fSThierry Reding 		*/
2001791ddb1eSThierry Reding 		dc->stats.underflow++;
2002791ddb1eSThierry Reding 	}
2003791ddb1eSThierry Reding 
2004791ddb1eSThierry Reding 	if (status & (WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT)) {
2005791ddb1eSThierry Reding 		/*
2006791ddb1eSThierry Reding 		dev_dbg(dc->dev, "%s(): overflow\n", __func__);
2007791ddb1eSThierry Reding 		*/
2008791ddb1eSThierry Reding 		dc->stats.overflow++;
2009dee8268fSThierry Reding 	}
2010dee8268fSThierry Reding 
201147307954SThierry Reding 	if (status & HEAD_UF_INT) {
201247307954SThierry Reding 		dev_dbg_ratelimited(dc->dev, "%s(): head underflow\n", __func__);
201347307954SThierry Reding 		dc->stats.underflow++;
201447307954SThierry Reding 	}
201547307954SThierry Reding 
2016dee8268fSThierry Reding 	return IRQ_HANDLED;
2017dee8268fSThierry Reding }
2018dee8268fSThierry Reding 
2019e75d0477SThierry Reding static bool tegra_dc_has_window_groups(struct tegra_dc *dc)
2020e75d0477SThierry Reding {
2021e75d0477SThierry Reding 	unsigned int i;
2022e75d0477SThierry Reding 
2023e75d0477SThierry Reding 	if (!dc->soc->wgrps)
2024e75d0477SThierry Reding 		return true;
2025e75d0477SThierry Reding 
2026e75d0477SThierry Reding 	for (i = 0; i < dc->soc->num_wgrps; i++) {
2027e75d0477SThierry Reding 		const struct tegra_windowgroup_soc *wgrp = &dc->soc->wgrps[i];
2028e75d0477SThierry Reding 
2029e75d0477SThierry Reding 		if (wgrp->dc == dc->pipe && wgrp->num_windows > 0)
2030e75d0477SThierry Reding 			return true;
2031e75d0477SThierry Reding 	}
2032e75d0477SThierry Reding 
2033e75d0477SThierry Reding 	return false;
2034e75d0477SThierry Reding }
2035e75d0477SThierry Reding 
2036dee8268fSThierry Reding static int tegra_dc_init(struct host1x_client *client)
2037dee8268fSThierry Reding {
2038608f43adSThierry Reding 	struct drm_device *drm = dev_get_drvdata(client->host);
20392bcdcbfaSThierry Reding 	unsigned long flags = HOST1X_SYNCPT_CLIENT_MANAGED;
2040dee8268fSThierry Reding 	struct tegra_dc *dc = host1x_client_to_dc(client);
2041d1f3e1e0SThierry Reding 	struct tegra_drm *tegra = drm->dev_private;
2042c7679306SThierry Reding 	struct drm_plane *primary = NULL;
2043c7679306SThierry Reding 	struct drm_plane *cursor = NULL;
2044dee8268fSThierry Reding 	int err;
2045dee8268fSThierry Reding 
2046759d706fSThierry Reding 	/*
2047759d706fSThierry Reding 	 * XXX do not register DCs with no window groups because we cannot
2048759d706fSThierry Reding 	 * assign a primary plane to them, which in turn will cause KMS to
2049759d706fSThierry Reding 	 * crash.
2050759d706fSThierry Reding 	 */
2051e75d0477SThierry Reding 	if (!tegra_dc_has_window_groups(dc))
2052759d706fSThierry Reding 		return 0;
2053759d706fSThierry Reding 
2054fd67e9c6SThierry Reding 	/*
2055fd67e9c6SThierry Reding 	 * Set the display hub as the host1x client parent for the display
2056fd67e9c6SThierry Reding 	 * controller. This is needed for the runtime reference counting that
2057fd67e9c6SThierry Reding 	 * ensures the display hub is always powered when any of the display
2058fd67e9c6SThierry Reding 	 * controllers are.
2059fd67e9c6SThierry Reding 	 */
2060fd67e9c6SThierry Reding 	if (dc->soc->has_nvdisplay)
2061fd67e9c6SThierry Reding 		client->parent = &tegra->hub->client;
2062fd67e9c6SThierry Reding 
2063617dd7ccSThierry Reding 	dc->syncpt = host1x_syncpt_request(client, flags);
20642bcdcbfaSThierry Reding 	if (!dc->syncpt)
20652bcdcbfaSThierry Reding 		dev_warn(dc->dev, "failed to allocate syncpoint\n");
20662bcdcbfaSThierry Reding 
20677edd7961SThierry Reding 	err = host1x_client_iommu_attach(client);
2068a8817489SThierry Reding 	if (err < 0 && err != -ENODEV) {
20690c407de5SThierry Reding 		dev_err(client->dev, "failed to attach to domain: %d\n", err);
2070df06b759SThierry Reding 		return err;
2071df06b759SThierry Reding 	}
2072df06b759SThierry Reding 
207347307954SThierry Reding 	if (dc->soc->wgrps)
207447307954SThierry Reding 		primary = tegra_dc_add_shared_planes(drm, dc);
207547307954SThierry Reding 	else
207647307954SThierry Reding 		primary = tegra_dc_add_planes(drm, dc);
207747307954SThierry Reding 
2078c7679306SThierry Reding 	if (IS_ERR(primary)) {
2079c7679306SThierry Reding 		err = PTR_ERR(primary);
2080c7679306SThierry Reding 		goto cleanup;
2081c7679306SThierry Reding 	}
2082c7679306SThierry Reding 
2083c7679306SThierry Reding 	if (dc->soc->supports_cursor) {
2084c7679306SThierry Reding 		cursor = tegra_dc_cursor_plane_create(drm, dc);
2085c7679306SThierry Reding 		if (IS_ERR(cursor)) {
2086c7679306SThierry Reding 			err = PTR_ERR(cursor);
2087c7679306SThierry Reding 			goto cleanup;
2088c7679306SThierry Reding 		}
20899f446d83SDmitry Osipenko 	} else {
20909f446d83SDmitry Osipenko 		/* dedicate one overlay to mouse cursor */
20919f446d83SDmitry Osipenko 		cursor = tegra_dc_overlay_plane_create(drm, dc, 2, true);
20929f446d83SDmitry Osipenko 		if (IS_ERR(cursor)) {
20939f446d83SDmitry Osipenko 			err = PTR_ERR(cursor);
20949f446d83SDmitry Osipenko 			goto cleanup;
20959f446d83SDmitry Osipenko 		}
2096c7679306SThierry Reding 	}
2097c7679306SThierry Reding 
2098c7679306SThierry Reding 	err = drm_crtc_init_with_planes(drm, &dc->base, primary, cursor,
2099f9882876SVille Syrjälä 					&tegra_crtc_funcs, NULL);
2100c7679306SThierry Reding 	if (err < 0)
2101c7679306SThierry Reding 		goto cleanup;
2102c7679306SThierry Reding 
2103dee8268fSThierry Reding 	drm_crtc_helper_add(&dc->base, &tegra_crtc_helper_funcs);
2104dee8268fSThierry Reding 
2105d1f3e1e0SThierry Reding 	/*
2106d1f3e1e0SThierry Reding 	 * Keep track of the minimum pitch alignment across all display
2107d1f3e1e0SThierry Reding 	 * controllers.
2108d1f3e1e0SThierry Reding 	 */
2109d1f3e1e0SThierry Reding 	if (dc->soc->pitch_align > tegra->pitch_align)
2110d1f3e1e0SThierry Reding 		tegra->pitch_align = dc->soc->pitch_align;
2111d1f3e1e0SThierry Reding 
21129910f5c4SThierry Reding 	err = tegra_dc_rgb_init(drm, dc);
2113dee8268fSThierry Reding 	if (err < 0 && err != -ENODEV) {
2114dee8268fSThierry Reding 		dev_err(dc->dev, "failed to initialize RGB output: %d\n", err);
2115c7679306SThierry Reding 		goto cleanup;
2116dee8268fSThierry Reding 	}
2117dee8268fSThierry Reding 
2118dee8268fSThierry Reding 	err = devm_request_irq(dc->dev, dc->irq, tegra_dc_irq, 0,
2119dee8268fSThierry Reding 			       dev_name(dc->dev), dc);
2120dee8268fSThierry Reding 	if (err < 0) {
2121dee8268fSThierry Reding 		dev_err(dc->dev, "failed to request IRQ#%u: %d\n", dc->irq,
2122dee8268fSThierry Reding 			err);
2123c7679306SThierry Reding 		goto cleanup;
2124dee8268fSThierry Reding 	}
2125dee8268fSThierry Reding 
212647b15779SThierry Reding 	/*
212747b15779SThierry Reding 	 * Inherit the DMA parameters (such as maximum segment size) from the
2128608f43adSThierry Reding 	 * parent host1x device.
212947b15779SThierry Reding 	 */
2130608f43adSThierry Reding 	client->dev->dma_parms = client->host->dma_parms;
213147b15779SThierry Reding 
2132dee8268fSThierry Reding 	return 0;
2133c7679306SThierry Reding 
2134c7679306SThierry Reding cleanup:
213547307954SThierry Reding 	if (!IS_ERR_OR_NULL(cursor))
2136c7679306SThierry Reding 		drm_plane_cleanup(cursor);
2137c7679306SThierry Reding 
213847307954SThierry Reding 	if (!IS_ERR(primary))
2139c7679306SThierry Reding 		drm_plane_cleanup(primary);
2140c7679306SThierry Reding 
2141aacdf198SThierry Reding 	host1x_client_iommu_detach(client);
2142fd5ec0dcSThierry Reding 	host1x_syncpt_free(dc->syncpt);
2143fd5ec0dcSThierry Reding 
2144c7679306SThierry Reding 	return err;
2145dee8268fSThierry Reding }
2146dee8268fSThierry Reding 
2147dee8268fSThierry Reding static int tegra_dc_exit(struct host1x_client *client)
2148dee8268fSThierry Reding {
2149dee8268fSThierry Reding 	struct tegra_dc *dc = host1x_client_to_dc(client);
2150dee8268fSThierry Reding 	int err;
2151dee8268fSThierry Reding 
2152e75d0477SThierry Reding 	if (!tegra_dc_has_window_groups(dc))
2153e75d0477SThierry Reding 		return 0;
2154e75d0477SThierry Reding 
215547b15779SThierry Reding 	/* avoid a dangling pointer just in case this disappears */
215647b15779SThierry Reding 	client->dev->dma_parms = NULL;
215747b15779SThierry Reding 
2158dee8268fSThierry Reding 	devm_free_irq(dc->dev, dc->irq, dc);
2159dee8268fSThierry Reding 
2160dee8268fSThierry Reding 	err = tegra_dc_rgb_exit(dc);
2161dee8268fSThierry Reding 	if (err) {
2162dee8268fSThierry Reding 		dev_err(dc->dev, "failed to shutdown RGB output: %d\n", err);
2163dee8268fSThierry Reding 		return err;
2164dee8268fSThierry Reding 	}
2165dee8268fSThierry Reding 
2166aacdf198SThierry Reding 	host1x_client_iommu_detach(client);
21672bcdcbfaSThierry Reding 	host1x_syncpt_free(dc->syncpt);
21682bcdcbfaSThierry Reding 
2169dee8268fSThierry Reding 	return 0;
2170dee8268fSThierry Reding }
2171dee8268fSThierry Reding 
2172fd67e9c6SThierry Reding static int tegra_dc_runtime_suspend(struct host1x_client *client)
2173fd67e9c6SThierry Reding {
2174fd67e9c6SThierry Reding 	struct tegra_dc *dc = host1x_client_to_dc(client);
2175fd67e9c6SThierry Reding 	struct device *dev = client->dev;
2176fd67e9c6SThierry Reding 	int err;
2177fd67e9c6SThierry Reding 
2178fd67e9c6SThierry Reding 	err = reset_control_assert(dc->rst);
2179fd67e9c6SThierry Reding 	if (err < 0) {
2180fd67e9c6SThierry Reding 		dev_err(dev, "failed to assert reset: %d\n", err);
2181fd67e9c6SThierry Reding 		return err;
2182fd67e9c6SThierry Reding 	}
2183fd67e9c6SThierry Reding 
2184fd67e9c6SThierry Reding 	if (dc->soc->has_powergate)
2185fd67e9c6SThierry Reding 		tegra_powergate_power_off(dc->powergate);
2186fd67e9c6SThierry Reding 
2187fd67e9c6SThierry Reding 	clk_disable_unprepare(dc->clk);
2188fd67e9c6SThierry Reding 	pm_runtime_put_sync(dev);
2189fd67e9c6SThierry Reding 
2190fd67e9c6SThierry Reding 	return 0;
2191fd67e9c6SThierry Reding }
2192fd67e9c6SThierry Reding 
2193fd67e9c6SThierry Reding static int tegra_dc_runtime_resume(struct host1x_client *client)
2194fd67e9c6SThierry Reding {
2195fd67e9c6SThierry Reding 	struct tegra_dc *dc = host1x_client_to_dc(client);
2196fd67e9c6SThierry Reding 	struct device *dev = client->dev;
2197fd67e9c6SThierry Reding 	int err;
2198fd67e9c6SThierry Reding 
2199fd67e9c6SThierry Reding 	err = pm_runtime_get_sync(dev);
2200fd67e9c6SThierry Reding 	if (err < 0) {
2201fd67e9c6SThierry Reding 		dev_err(dev, "failed to get runtime PM: %d\n", err);
2202fd67e9c6SThierry Reding 		return err;
2203fd67e9c6SThierry Reding 	}
2204fd67e9c6SThierry Reding 
2205fd67e9c6SThierry Reding 	if (dc->soc->has_powergate) {
2206fd67e9c6SThierry Reding 		err = tegra_powergate_sequence_power_up(dc->powergate, dc->clk,
2207fd67e9c6SThierry Reding 							dc->rst);
2208fd67e9c6SThierry Reding 		if (err < 0) {
2209fd67e9c6SThierry Reding 			dev_err(dev, "failed to power partition: %d\n", err);
2210fd67e9c6SThierry Reding 			goto put_rpm;
2211fd67e9c6SThierry Reding 		}
2212fd67e9c6SThierry Reding 	} else {
2213fd67e9c6SThierry Reding 		err = clk_prepare_enable(dc->clk);
2214fd67e9c6SThierry Reding 		if (err < 0) {
2215fd67e9c6SThierry Reding 			dev_err(dev, "failed to enable clock: %d\n", err);
2216fd67e9c6SThierry Reding 			goto put_rpm;
2217fd67e9c6SThierry Reding 		}
2218fd67e9c6SThierry Reding 
2219fd67e9c6SThierry Reding 		err = reset_control_deassert(dc->rst);
2220fd67e9c6SThierry Reding 		if (err < 0) {
2221fd67e9c6SThierry Reding 			dev_err(dev, "failed to deassert reset: %d\n", err);
2222fd67e9c6SThierry Reding 			goto disable_clk;
2223fd67e9c6SThierry Reding 		}
2224fd67e9c6SThierry Reding 	}
2225fd67e9c6SThierry Reding 
2226fd67e9c6SThierry Reding 	return 0;
2227fd67e9c6SThierry Reding 
2228fd67e9c6SThierry Reding disable_clk:
2229fd67e9c6SThierry Reding 	clk_disable_unprepare(dc->clk);
2230fd67e9c6SThierry Reding put_rpm:
2231fd67e9c6SThierry Reding 	pm_runtime_put_sync(dev);
2232fd67e9c6SThierry Reding 	return err;
2233fd67e9c6SThierry Reding }
2234fd67e9c6SThierry Reding 
2235dee8268fSThierry Reding static const struct host1x_client_ops dc_client_ops = {
2236dee8268fSThierry Reding 	.init = tegra_dc_init,
2237dee8268fSThierry Reding 	.exit = tegra_dc_exit,
2238fd67e9c6SThierry Reding 	.suspend = tegra_dc_runtime_suspend,
2239fd67e9c6SThierry Reding 	.resume = tegra_dc_runtime_resume,
2240dee8268fSThierry Reding };
2241dee8268fSThierry Reding 
22428620fc62SThierry Reding static const struct tegra_dc_soc_info tegra20_dc_soc_info = {
22437116e9a8SThierry Reding 	.supports_background_color = false,
22448620fc62SThierry Reding 	.supports_interlacing = false,
2245e687651bSThierry Reding 	.supports_cursor = false,
2246c134f019SThierry Reding 	.supports_block_linear = false,
2247a43d0a00SDmitry Osipenko 	.has_legacy_blending = true,
2248d1f3e1e0SThierry Reding 	.pitch_align = 8,
22499c012700SThierry Reding 	.has_powergate = false,
2250f68ba691SDmitry Osipenko 	.coupled_pm = true,
225147307954SThierry Reding 	.has_nvdisplay = false,
2252511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra20_primary_formats),
2253511c7023SThierry Reding 	.primary_formats = tegra20_primary_formats,
2254511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra20_overlay_formats),
2255511c7023SThierry Reding 	.overlay_formats = tegra20_overlay_formats,
2256e90124cbSThierry Reding 	.modifiers = tegra20_modifiers,
2257acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = true,
2258acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = true,
22598620fc62SThierry Reding };
22608620fc62SThierry Reding 
22618620fc62SThierry Reding static const struct tegra_dc_soc_info tegra30_dc_soc_info = {
22627116e9a8SThierry Reding 	.supports_background_color = false,
22638620fc62SThierry Reding 	.supports_interlacing = false,
2264e687651bSThierry Reding 	.supports_cursor = false,
2265c134f019SThierry Reding 	.supports_block_linear = false,
2266a43d0a00SDmitry Osipenko 	.has_legacy_blending = true,
2267d1f3e1e0SThierry Reding 	.pitch_align = 8,
22689c012700SThierry Reding 	.has_powergate = false,
2269f68ba691SDmitry Osipenko 	.coupled_pm = false,
227047307954SThierry Reding 	.has_nvdisplay = false,
2271511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra20_primary_formats),
2272511c7023SThierry Reding 	.primary_formats = tegra20_primary_formats,
2273511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra20_overlay_formats),
2274511c7023SThierry Reding 	.overlay_formats = tegra20_overlay_formats,
2275e90124cbSThierry Reding 	.modifiers = tegra20_modifiers,
2276acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = false,
2277acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = false,
2278d1f3e1e0SThierry Reding };
2279d1f3e1e0SThierry Reding 
2280d1f3e1e0SThierry Reding static const struct tegra_dc_soc_info tegra114_dc_soc_info = {
22817116e9a8SThierry Reding 	.supports_background_color = false,
2282d1f3e1e0SThierry Reding 	.supports_interlacing = false,
2283d1f3e1e0SThierry Reding 	.supports_cursor = false,
2284d1f3e1e0SThierry Reding 	.supports_block_linear = false,
2285a43d0a00SDmitry Osipenko 	.has_legacy_blending = true,
2286d1f3e1e0SThierry Reding 	.pitch_align = 64,
22879c012700SThierry Reding 	.has_powergate = true,
2288f68ba691SDmitry Osipenko 	.coupled_pm = false,
228947307954SThierry Reding 	.has_nvdisplay = false,
2290511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra114_primary_formats),
2291511c7023SThierry Reding 	.primary_formats = tegra114_primary_formats,
2292511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra114_overlay_formats),
2293511c7023SThierry Reding 	.overlay_formats = tegra114_overlay_formats,
2294e90124cbSThierry Reding 	.modifiers = tegra20_modifiers,
2295acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = false,
2296acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = false,
22978620fc62SThierry Reding };
22988620fc62SThierry Reding 
22998620fc62SThierry Reding static const struct tegra_dc_soc_info tegra124_dc_soc_info = {
23007116e9a8SThierry Reding 	.supports_background_color = true,
23018620fc62SThierry Reding 	.supports_interlacing = true,
2302e687651bSThierry Reding 	.supports_cursor = true,
2303c134f019SThierry Reding 	.supports_block_linear = true,
2304a43d0a00SDmitry Osipenko 	.has_legacy_blending = false,
2305d1f3e1e0SThierry Reding 	.pitch_align = 64,
23069c012700SThierry Reding 	.has_powergate = true,
2307f68ba691SDmitry Osipenko 	.coupled_pm = false,
230847307954SThierry Reding 	.has_nvdisplay = false,
2309511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra124_primary_formats),
23109a02d3afSStefan Agner 	.primary_formats = tegra124_primary_formats,
2311511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra124_overlay_formats),
23129a02d3afSStefan Agner 	.overlay_formats = tegra124_overlay_formats,
2313e90124cbSThierry Reding 	.modifiers = tegra124_modifiers,
2314acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = false,
2315acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = false,
23168620fc62SThierry Reding };
23178620fc62SThierry Reding 
23185b4f516fSThierry Reding static const struct tegra_dc_soc_info tegra210_dc_soc_info = {
23197116e9a8SThierry Reding 	.supports_background_color = true,
23205b4f516fSThierry Reding 	.supports_interlacing = true,
23215b4f516fSThierry Reding 	.supports_cursor = true,
23225b4f516fSThierry Reding 	.supports_block_linear = true,
2323a43d0a00SDmitry Osipenko 	.has_legacy_blending = false,
23245b4f516fSThierry Reding 	.pitch_align = 64,
23255b4f516fSThierry Reding 	.has_powergate = true,
2326f68ba691SDmitry Osipenko 	.coupled_pm = false,
232747307954SThierry Reding 	.has_nvdisplay = false,
2328511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra114_primary_formats),
2329511c7023SThierry Reding 	.primary_formats = tegra114_primary_formats,
2330511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra114_overlay_formats),
2331511c7023SThierry Reding 	.overlay_formats = tegra114_overlay_formats,
2332e90124cbSThierry Reding 	.modifiers = tegra124_modifiers,
2333acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = false,
2334acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = false,
233547307954SThierry Reding };
233647307954SThierry Reding 
233747307954SThierry Reding static const struct tegra_windowgroup_soc tegra186_dc_wgrps[] = {
233847307954SThierry Reding 	{
233947307954SThierry Reding 		.index = 0,
234047307954SThierry Reding 		.dc = 0,
234147307954SThierry Reding 		.windows = (const unsigned int[]) { 0 },
234247307954SThierry Reding 		.num_windows = 1,
234347307954SThierry Reding 	}, {
234447307954SThierry Reding 		.index = 1,
234547307954SThierry Reding 		.dc = 1,
234647307954SThierry Reding 		.windows = (const unsigned int[]) { 1 },
234747307954SThierry Reding 		.num_windows = 1,
234847307954SThierry Reding 	}, {
234947307954SThierry Reding 		.index = 2,
235047307954SThierry Reding 		.dc = 1,
235147307954SThierry Reding 		.windows = (const unsigned int[]) { 2 },
235247307954SThierry Reding 		.num_windows = 1,
235347307954SThierry Reding 	}, {
235447307954SThierry Reding 		.index = 3,
235547307954SThierry Reding 		.dc = 2,
235647307954SThierry Reding 		.windows = (const unsigned int[]) { 3 },
235747307954SThierry Reding 		.num_windows = 1,
235847307954SThierry Reding 	}, {
235947307954SThierry Reding 		.index = 4,
236047307954SThierry Reding 		.dc = 2,
236147307954SThierry Reding 		.windows = (const unsigned int[]) { 4 },
236247307954SThierry Reding 		.num_windows = 1,
236347307954SThierry Reding 	}, {
236447307954SThierry Reding 		.index = 5,
236547307954SThierry Reding 		.dc = 2,
236647307954SThierry Reding 		.windows = (const unsigned int[]) { 5 },
236747307954SThierry Reding 		.num_windows = 1,
236847307954SThierry Reding 	},
236947307954SThierry Reding };
237047307954SThierry Reding 
237147307954SThierry Reding static const struct tegra_dc_soc_info tegra186_dc_soc_info = {
237247307954SThierry Reding 	.supports_background_color = true,
237347307954SThierry Reding 	.supports_interlacing = true,
237447307954SThierry Reding 	.supports_cursor = true,
237547307954SThierry Reding 	.supports_block_linear = true,
2376a43d0a00SDmitry Osipenko 	.has_legacy_blending = false,
237747307954SThierry Reding 	.pitch_align = 64,
237847307954SThierry Reding 	.has_powergate = false,
2379f68ba691SDmitry Osipenko 	.coupled_pm = false,
238047307954SThierry Reding 	.has_nvdisplay = true,
238147307954SThierry Reding 	.wgrps = tegra186_dc_wgrps,
238247307954SThierry Reding 	.num_wgrps = ARRAY_SIZE(tegra186_dc_wgrps),
23835b4f516fSThierry Reding };
23845b4f516fSThierry Reding 
238547443196SThierry Reding static const struct tegra_windowgroup_soc tegra194_dc_wgrps[] = {
238647443196SThierry Reding 	{
238747443196SThierry Reding 		.index = 0,
238847443196SThierry Reding 		.dc = 0,
238947443196SThierry Reding 		.windows = (const unsigned int[]) { 0 },
239047443196SThierry Reding 		.num_windows = 1,
239147443196SThierry Reding 	}, {
239247443196SThierry Reding 		.index = 1,
239347443196SThierry Reding 		.dc = 1,
239447443196SThierry Reding 		.windows = (const unsigned int[]) { 1 },
239547443196SThierry Reding 		.num_windows = 1,
239647443196SThierry Reding 	}, {
239747443196SThierry Reding 		.index = 2,
239847443196SThierry Reding 		.dc = 1,
239947443196SThierry Reding 		.windows = (const unsigned int[]) { 2 },
240047443196SThierry Reding 		.num_windows = 1,
240147443196SThierry Reding 	}, {
240247443196SThierry Reding 		.index = 3,
240347443196SThierry Reding 		.dc = 2,
240447443196SThierry Reding 		.windows = (const unsigned int[]) { 3 },
240547443196SThierry Reding 		.num_windows = 1,
240647443196SThierry Reding 	}, {
240747443196SThierry Reding 		.index = 4,
240847443196SThierry Reding 		.dc = 2,
240947443196SThierry Reding 		.windows = (const unsigned int[]) { 4 },
241047443196SThierry Reding 		.num_windows = 1,
241147443196SThierry Reding 	}, {
241247443196SThierry Reding 		.index = 5,
241347443196SThierry Reding 		.dc = 2,
241447443196SThierry Reding 		.windows = (const unsigned int[]) { 5 },
241547443196SThierry Reding 		.num_windows = 1,
241647443196SThierry Reding 	},
241747443196SThierry Reding };
241847443196SThierry Reding 
241947443196SThierry Reding static const struct tegra_dc_soc_info tegra194_dc_soc_info = {
242047443196SThierry Reding 	.supports_background_color = true,
242147443196SThierry Reding 	.supports_interlacing = true,
242247443196SThierry Reding 	.supports_cursor = true,
242347443196SThierry Reding 	.supports_block_linear = true,
242447443196SThierry Reding 	.has_legacy_blending = false,
242547443196SThierry Reding 	.pitch_align = 64,
242647443196SThierry Reding 	.has_powergate = false,
242747443196SThierry Reding 	.coupled_pm = false,
242847443196SThierry Reding 	.has_nvdisplay = true,
242947443196SThierry Reding 	.wgrps = tegra194_dc_wgrps,
243047443196SThierry Reding 	.num_wgrps = ARRAY_SIZE(tegra194_dc_wgrps),
243147443196SThierry Reding };
243247443196SThierry Reding 
24338620fc62SThierry Reding static const struct of_device_id tegra_dc_of_match[] = {
24348620fc62SThierry Reding 	{
243547443196SThierry Reding 		.compatible = "nvidia,tegra194-dc",
243647443196SThierry Reding 		.data = &tegra194_dc_soc_info,
243747443196SThierry Reding 	}, {
243847307954SThierry Reding 		.compatible = "nvidia,tegra186-dc",
243947307954SThierry Reding 		.data = &tegra186_dc_soc_info,
244047307954SThierry Reding 	}, {
24415b4f516fSThierry Reding 		.compatible = "nvidia,tegra210-dc",
24425b4f516fSThierry Reding 		.data = &tegra210_dc_soc_info,
24435b4f516fSThierry Reding 	}, {
24448620fc62SThierry Reding 		.compatible = "nvidia,tegra124-dc",
24458620fc62SThierry Reding 		.data = &tegra124_dc_soc_info,
24468620fc62SThierry Reding 	}, {
24479c012700SThierry Reding 		.compatible = "nvidia,tegra114-dc",
24489c012700SThierry Reding 		.data = &tegra114_dc_soc_info,
24499c012700SThierry Reding 	}, {
24508620fc62SThierry Reding 		.compatible = "nvidia,tegra30-dc",
24518620fc62SThierry Reding 		.data = &tegra30_dc_soc_info,
24528620fc62SThierry Reding 	}, {
24538620fc62SThierry Reding 		.compatible = "nvidia,tegra20-dc",
24548620fc62SThierry Reding 		.data = &tegra20_dc_soc_info,
24558620fc62SThierry Reding 	}, {
24568620fc62SThierry Reding 		/* sentinel */
24578620fc62SThierry Reding 	}
24588620fc62SThierry Reding };
2459ef70728cSStephen Warren MODULE_DEVICE_TABLE(of, tegra_dc_of_match);
24608620fc62SThierry Reding 
246113411dddSThierry Reding static int tegra_dc_parse_dt(struct tegra_dc *dc)
246213411dddSThierry Reding {
246313411dddSThierry Reding 	struct device_node *np;
246413411dddSThierry Reding 	u32 value = 0;
246513411dddSThierry Reding 	int err;
246613411dddSThierry Reding 
246713411dddSThierry Reding 	err = of_property_read_u32(dc->dev->of_node, "nvidia,head", &value);
246813411dddSThierry Reding 	if (err < 0) {
246913411dddSThierry Reding 		dev_err(dc->dev, "missing \"nvidia,head\" property\n");
247013411dddSThierry Reding 
247113411dddSThierry Reding 		/*
247213411dddSThierry Reding 		 * If the nvidia,head property isn't present, try to find the
247313411dddSThierry Reding 		 * correct head number by looking up the position of this
247413411dddSThierry Reding 		 * display controller's node within the device tree. Assuming
247513411dddSThierry Reding 		 * that the nodes are ordered properly in the DTS file and
247613411dddSThierry Reding 		 * that the translation into a flattened device tree blob
247713411dddSThierry Reding 		 * preserves that ordering this will actually yield the right
247813411dddSThierry Reding 		 * head number.
247913411dddSThierry Reding 		 *
248013411dddSThierry Reding 		 * If those assumptions don't hold, this will still work for
248113411dddSThierry Reding 		 * cases where only a single display controller is used.
248213411dddSThierry Reding 		 */
248313411dddSThierry Reding 		for_each_matching_node(np, tegra_dc_of_match) {
2484cf6b1744SJulia Lawall 			if (np == dc->dev->of_node) {
2485cf6b1744SJulia Lawall 				of_node_put(np);
248613411dddSThierry Reding 				break;
2487cf6b1744SJulia Lawall 			}
248813411dddSThierry Reding 
248913411dddSThierry Reding 			value++;
249013411dddSThierry Reding 		}
249113411dddSThierry Reding 	}
249213411dddSThierry Reding 
249313411dddSThierry Reding 	dc->pipe = value;
249413411dddSThierry Reding 
249513411dddSThierry Reding 	return 0;
249613411dddSThierry Reding }
249713411dddSThierry Reding 
249892ce7e83SSuzuki K Poulose static int tegra_dc_match_by_pipe(struct device *dev, const void *data)
2499f68ba691SDmitry Osipenko {
2500f68ba691SDmitry Osipenko 	struct tegra_dc *dc = dev_get_drvdata(dev);
250192ce7e83SSuzuki K Poulose 	unsigned int pipe = (unsigned long)(void *)data;
2502f68ba691SDmitry Osipenko 
2503f68ba691SDmitry Osipenko 	return dc->pipe == pipe;
2504f68ba691SDmitry Osipenko }
2505f68ba691SDmitry Osipenko 
2506f68ba691SDmitry Osipenko static int tegra_dc_couple(struct tegra_dc *dc)
2507f68ba691SDmitry Osipenko {
2508f68ba691SDmitry Osipenko 	/*
2509f68ba691SDmitry Osipenko 	 * On Tegra20, DC1 requires DC0 to be taken out of reset in order to
2510f68ba691SDmitry Osipenko 	 * be enabled, otherwise CPU hangs on writing to CMD_DISPLAY_COMMAND /
2511f68ba691SDmitry Osipenko 	 * POWER_CONTROL registers during CRTC enabling.
2512f68ba691SDmitry Osipenko 	 */
2513f68ba691SDmitry Osipenko 	if (dc->soc->coupled_pm && dc->pipe == 1) {
2514e88728f4SVivek Gautam 		u32 flags = DL_FLAG_PM_RUNTIME | DL_FLAG_AUTOREMOVE_CONSUMER;
2515f68ba691SDmitry Osipenko 		struct device_link *link;
2516f68ba691SDmitry Osipenko 		struct device *partner;
2517f68ba691SDmitry Osipenko 
2518ef1b204aSWei Yongjun 		partner = driver_find_device(dc->dev->driver, NULL, NULL,
2519f68ba691SDmitry Osipenko 					     tegra_dc_match_by_pipe);
2520f68ba691SDmitry Osipenko 		if (!partner)
2521f68ba691SDmitry Osipenko 			return -EPROBE_DEFER;
2522f68ba691SDmitry Osipenko 
2523f68ba691SDmitry Osipenko 		link = device_link_add(dc->dev, partner, flags);
2524f68ba691SDmitry Osipenko 		if (!link) {
2525f68ba691SDmitry Osipenko 			dev_err(dc->dev, "failed to link controllers\n");
2526f68ba691SDmitry Osipenko 			return -EINVAL;
2527f68ba691SDmitry Osipenko 		}
2528f68ba691SDmitry Osipenko 
2529f68ba691SDmitry Osipenko 		dev_dbg(dc->dev, "coupled to %s\n", dev_name(partner));
2530f68ba691SDmitry Osipenko 	}
2531f68ba691SDmitry Osipenko 
2532f68ba691SDmitry Osipenko 	return 0;
2533f68ba691SDmitry Osipenko }
2534f68ba691SDmitry Osipenko 
2535dee8268fSThierry Reding static int tegra_dc_probe(struct platform_device *pdev)
2536dee8268fSThierry Reding {
2537dee8268fSThierry Reding 	struct tegra_dc *dc;
2538dee8268fSThierry Reding 	int err;
2539dee8268fSThierry Reding 
2540dee8268fSThierry Reding 	dc = devm_kzalloc(&pdev->dev, sizeof(*dc), GFP_KERNEL);
2541dee8268fSThierry Reding 	if (!dc)
2542dee8268fSThierry Reding 		return -ENOMEM;
2543dee8268fSThierry Reding 
2544b9ff7aeaSThierry Reding 	dc->soc = of_device_get_match_data(&pdev->dev);
25458620fc62SThierry Reding 
2546dee8268fSThierry Reding 	INIT_LIST_HEAD(&dc->list);
2547dee8268fSThierry Reding 	dc->dev = &pdev->dev;
2548dee8268fSThierry Reding 
254913411dddSThierry Reding 	err = tegra_dc_parse_dt(dc);
255013411dddSThierry Reding 	if (err < 0)
255113411dddSThierry Reding 		return err;
255213411dddSThierry Reding 
2553f68ba691SDmitry Osipenko 	err = tegra_dc_couple(dc);
2554f68ba691SDmitry Osipenko 	if (err < 0)
2555f68ba691SDmitry Osipenko 		return err;
2556f68ba691SDmitry Osipenko 
2557dee8268fSThierry Reding 	dc->clk = devm_clk_get(&pdev->dev, NULL);
2558dee8268fSThierry Reding 	if (IS_ERR(dc->clk)) {
2559dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to get clock\n");
2560dee8268fSThierry Reding 		return PTR_ERR(dc->clk);
2561dee8268fSThierry Reding 	}
2562dee8268fSThierry Reding 
2563ca48080aSStephen Warren 	dc->rst = devm_reset_control_get(&pdev->dev, "dc");
2564ca48080aSStephen Warren 	if (IS_ERR(dc->rst)) {
2565ca48080aSStephen Warren 		dev_err(&pdev->dev, "failed to get reset\n");
2566ca48080aSStephen Warren 		return PTR_ERR(dc->rst);
2567ca48080aSStephen Warren 	}
2568ca48080aSStephen Warren 
2569a2f2f740SThierry Reding 	/* assert reset and disable clock */
2570a2f2f740SThierry Reding 	err = clk_prepare_enable(dc->clk);
2571a2f2f740SThierry Reding 	if (err < 0)
2572a2f2f740SThierry Reding 		return err;
2573a2f2f740SThierry Reding 
2574a2f2f740SThierry Reding 	usleep_range(2000, 4000);
2575a2f2f740SThierry Reding 
2576a2f2f740SThierry Reding 	err = reset_control_assert(dc->rst);
2577a2f2f740SThierry Reding 	if (err < 0)
2578a2f2f740SThierry Reding 		return err;
2579a2f2f740SThierry Reding 
2580a2f2f740SThierry Reding 	usleep_range(2000, 4000);
2581a2f2f740SThierry Reding 
2582a2f2f740SThierry Reding 	clk_disable_unprepare(dc->clk);
258333a8eb8dSThierry Reding 
25849c012700SThierry Reding 	if (dc->soc->has_powergate) {
25859c012700SThierry Reding 		if (dc->pipe == 0)
25869c012700SThierry Reding 			dc->powergate = TEGRA_POWERGATE_DIS;
25879c012700SThierry Reding 		else
25889c012700SThierry Reding 			dc->powergate = TEGRA_POWERGATE_DISB;
25899c012700SThierry Reding 
259033a8eb8dSThierry Reding 		tegra_powergate_power_off(dc->powergate);
25919c012700SThierry Reding 	}
2592dee8268fSThierry Reding 
2593a858ac8fSDmitry Osipenko 	dc->regs = devm_platform_ioremap_resource(pdev, 0);
2594dee8268fSThierry Reding 	if (IS_ERR(dc->regs))
2595dee8268fSThierry Reding 		return PTR_ERR(dc->regs);
2596dee8268fSThierry Reding 
2597dee8268fSThierry Reding 	dc->irq = platform_get_irq(pdev, 0);
25985f1df70fSTang Bin 	if (dc->irq < 0)
2599dee8268fSThierry Reding 		return -ENXIO;
2600dee8268fSThierry Reding 
2601dee8268fSThierry Reding 	err = tegra_dc_rgb_probe(dc);
2602dee8268fSThierry Reding 	if (err < 0 && err != -ENODEV) {
26038f839fb6SDmitry Osipenko 		const char *level = KERN_ERR;
26048f839fb6SDmitry Osipenko 
26058f839fb6SDmitry Osipenko 		if (err == -EPROBE_DEFER)
26068f839fb6SDmitry Osipenko 			level = KERN_DEBUG;
26078f839fb6SDmitry Osipenko 
26088f839fb6SDmitry Osipenko 		dev_printk(level, dc->dev, "failed to probe RGB output: %d\n",
26098f839fb6SDmitry Osipenko 			   err);
2610dee8268fSThierry Reding 		return err;
2611dee8268fSThierry Reding 	}
2612dee8268fSThierry Reding 
261333a8eb8dSThierry Reding 	platform_set_drvdata(pdev, dc);
261433a8eb8dSThierry Reding 	pm_runtime_enable(&pdev->dev);
261533a8eb8dSThierry Reding 
261633a8eb8dSThierry Reding 	INIT_LIST_HEAD(&dc->client.list);
261733a8eb8dSThierry Reding 	dc->client.ops = &dc_client_ops;
261833a8eb8dSThierry Reding 	dc->client.dev = &pdev->dev;
261933a8eb8dSThierry Reding 
2620dee8268fSThierry Reding 	err = host1x_client_register(&dc->client);
2621dee8268fSThierry Reding 	if (err < 0) {
2622dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to register host1x client: %d\n",
2623dee8268fSThierry Reding 			err);
26240411ea89SDmitry Osipenko 		goto disable_pm;
2625dee8268fSThierry Reding 	}
2626dee8268fSThierry Reding 
2627dee8268fSThierry Reding 	return 0;
26280411ea89SDmitry Osipenko 
26290411ea89SDmitry Osipenko disable_pm:
26300411ea89SDmitry Osipenko 	pm_runtime_disable(&pdev->dev);
26310411ea89SDmitry Osipenko 	tegra_dc_rgb_remove(dc);
26320411ea89SDmitry Osipenko 
26330411ea89SDmitry Osipenko 	return err;
2634dee8268fSThierry Reding }
2635dee8268fSThierry Reding 
2636dee8268fSThierry Reding static int tegra_dc_remove(struct platform_device *pdev)
2637dee8268fSThierry Reding {
2638dee8268fSThierry Reding 	struct tegra_dc *dc = platform_get_drvdata(pdev);
2639dee8268fSThierry Reding 	int err;
2640dee8268fSThierry Reding 
2641dee8268fSThierry Reding 	err = host1x_client_unregister(&dc->client);
2642dee8268fSThierry Reding 	if (err < 0) {
2643dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to unregister host1x client: %d\n",
2644dee8268fSThierry Reding 			err);
2645dee8268fSThierry Reding 		return err;
2646dee8268fSThierry Reding 	}
2647dee8268fSThierry Reding 
264859d29c0eSThierry Reding 	err = tegra_dc_rgb_remove(dc);
264959d29c0eSThierry Reding 	if (err < 0) {
265059d29c0eSThierry Reding 		dev_err(&pdev->dev, "failed to remove RGB output: %d\n", err);
265159d29c0eSThierry Reding 		return err;
265259d29c0eSThierry Reding 	}
265359d29c0eSThierry Reding 
265433a8eb8dSThierry Reding 	pm_runtime_disable(&pdev->dev);
265533a8eb8dSThierry Reding 
265633a8eb8dSThierry Reding 	return 0;
265733a8eb8dSThierry Reding }
265833a8eb8dSThierry Reding 
2659dee8268fSThierry Reding struct platform_driver tegra_dc_driver = {
2660dee8268fSThierry Reding 	.driver = {
2661dee8268fSThierry Reding 		.name = "tegra-dc",
2662dee8268fSThierry Reding 		.of_match_table = tegra_dc_of_match,
2663dee8268fSThierry Reding 	},
2664dee8268fSThierry Reding 	.probe = tegra_dc_probe,
2665dee8268fSThierry Reding 	.remove = tegra_dc_remove,
2666dee8268fSThierry Reding };
2667