xref: /openbmc/linux/drivers/gpu/drm/tegra/dc.c (revision a8817489dc3e3b1910842958a3b9d9e4832e99b0)
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);
13810288eeaSThierry Reding 			/* 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 
37110288eeaSThierry Reding 	value = V_PRESCALED_SIZE(v_size) | H_PRESCALED_SIZE(h_size);
3721087fac1SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_PRESCALED_SIZE);
37310288eeaSThierry Reding 
37410288eeaSThierry Reding 	/*
37510288eeaSThierry Reding 	 * For DDA computations the number of bytes per pixel for YUV planar
37610288eeaSThierry Reding 	 * modes needs to take into account all Y, U and V components.
37710288eeaSThierry Reding 	 */
37810288eeaSThierry Reding 	if (yuv && planar)
37910288eeaSThierry Reding 		bpp = 2;
38010288eeaSThierry Reding 
38110288eeaSThierry Reding 	h_dda = compute_dda_inc(window->src.w, window->dst.w, false, bpp);
38210288eeaSThierry Reding 	v_dda = compute_dda_inc(window->src.h, window->dst.h, true, bpp);
38310288eeaSThierry Reding 
38410288eeaSThierry Reding 	value = V_DDA_INC(v_dda) | H_DDA_INC(h_dda);
3851087fac1SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_DDA_INC);
38610288eeaSThierry Reding 
38710288eeaSThierry Reding 	h_dda = compute_initial_dda(window->src.x);
38810288eeaSThierry Reding 	v_dda = compute_initial_dda(window->src.y);
38910288eeaSThierry Reding 
3901087fac1SThierry Reding 	tegra_plane_writel(plane, h_dda, DC_WIN_H_INITIAL_DDA);
3911087fac1SThierry Reding 	tegra_plane_writel(plane, v_dda, DC_WIN_V_INITIAL_DDA);
39210288eeaSThierry Reding 
3931087fac1SThierry Reding 	tegra_plane_writel(plane, 0, DC_WIN_UV_BUF_STRIDE);
3941087fac1SThierry Reding 	tegra_plane_writel(plane, 0, DC_WIN_BUF_STRIDE);
39510288eeaSThierry Reding 
3961087fac1SThierry Reding 	tegra_plane_writel(plane, window->base[0], DC_WINBUF_START_ADDR);
39710288eeaSThierry Reding 
39810288eeaSThierry Reding 	if (yuv && planar) {
3991087fac1SThierry Reding 		tegra_plane_writel(plane, window->base[1], DC_WINBUF_START_ADDR_U);
4001087fac1SThierry Reding 		tegra_plane_writel(plane, window->base[2], DC_WINBUF_START_ADDR_V);
40110288eeaSThierry Reding 		value = window->stride[1] << 16 | window->stride[0];
4021087fac1SThierry Reding 		tegra_plane_writel(plane, value, DC_WIN_LINE_STRIDE);
40310288eeaSThierry Reding 	} else {
4041087fac1SThierry Reding 		tegra_plane_writel(plane, window->stride[0], DC_WIN_LINE_STRIDE);
40510288eeaSThierry Reding 	}
40610288eeaSThierry Reding 
40710288eeaSThierry Reding 	if (window->bottom_up)
40810288eeaSThierry Reding 		v_offset += window->src.h - 1;
40910288eeaSThierry Reding 
4101087fac1SThierry Reding 	tegra_plane_writel(plane, h_offset, DC_WINBUF_ADDR_H_OFFSET);
4111087fac1SThierry Reding 	tegra_plane_writel(plane, v_offset, DC_WINBUF_ADDR_V_OFFSET);
41210288eeaSThierry Reding 
413c134f019SThierry Reding 	if (dc->soc->supports_block_linear) {
414c134f019SThierry Reding 		unsigned long height = window->tiling.value;
415c134f019SThierry Reding 
416c134f019SThierry Reding 		switch (window->tiling.mode) {
417c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_PITCH:
418c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_PITCH;
419c134f019SThierry Reding 			break;
420c134f019SThierry Reding 
421c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_TILED:
422c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_TILED;
423c134f019SThierry Reding 			break;
424c134f019SThierry Reding 
425c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_BLOCK:
426c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_BLOCK_HEIGHT(height) |
427c134f019SThierry Reding 				DC_WINBUF_SURFACE_KIND_BLOCK;
428c134f019SThierry Reding 			break;
429c134f019SThierry Reding 		}
430c134f019SThierry Reding 
4311087fac1SThierry Reding 		tegra_plane_writel(plane, value, DC_WINBUF_SURFACE_KIND);
43210288eeaSThierry Reding 	} else {
433c134f019SThierry Reding 		switch (window->tiling.mode) {
434c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_PITCH:
43510288eeaSThierry Reding 			value = DC_WIN_BUFFER_ADDR_MODE_LINEAR_UV |
43610288eeaSThierry Reding 				DC_WIN_BUFFER_ADDR_MODE_LINEAR;
437c134f019SThierry Reding 			break;
438c134f019SThierry Reding 
439c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_TILED:
440c134f019SThierry Reding 			value = DC_WIN_BUFFER_ADDR_MODE_TILE_UV |
441c134f019SThierry Reding 				DC_WIN_BUFFER_ADDR_MODE_TILE;
442c134f019SThierry Reding 			break;
443c134f019SThierry Reding 
444c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_BLOCK:
4454aa3df71SThierry Reding 			/*
4464aa3df71SThierry Reding 			 * No need to handle this here because ->atomic_check
4474aa3df71SThierry Reding 			 * will already have filtered it out.
4484aa3df71SThierry Reding 			 */
4494aa3df71SThierry Reding 			break;
45010288eeaSThierry Reding 		}
45110288eeaSThierry Reding 
4521087fac1SThierry Reding 		tegra_plane_writel(plane, value, DC_WIN_BUFFER_ADDR_MODE);
453c134f019SThierry Reding 	}
45410288eeaSThierry Reding 
45510288eeaSThierry Reding 	value = WIN_ENABLE;
45610288eeaSThierry Reding 
45710288eeaSThierry Reding 	if (yuv) {
45810288eeaSThierry Reding 		/* setup default colorspace conversion coefficients */
4591087fac1SThierry Reding 		tegra_plane_writel(plane, 0x00f0, DC_WIN_CSC_YOF);
4601087fac1SThierry Reding 		tegra_plane_writel(plane, 0x012a, DC_WIN_CSC_KYRGB);
4611087fac1SThierry Reding 		tegra_plane_writel(plane, 0x0000, DC_WIN_CSC_KUR);
4621087fac1SThierry Reding 		tegra_plane_writel(plane, 0x0198, DC_WIN_CSC_KVR);
4631087fac1SThierry Reding 		tegra_plane_writel(plane, 0x039b, DC_WIN_CSC_KUG);
4641087fac1SThierry Reding 		tegra_plane_writel(plane, 0x032f, DC_WIN_CSC_KVG);
4651087fac1SThierry Reding 		tegra_plane_writel(plane, 0x0204, DC_WIN_CSC_KUB);
4661087fac1SThierry Reding 		tegra_plane_writel(plane, 0x0000, DC_WIN_CSC_KVB);
46710288eeaSThierry Reding 
46810288eeaSThierry Reding 		value |= CSC_ENABLE;
46910288eeaSThierry Reding 	} else if (window->bits_per_pixel < 24) {
47010288eeaSThierry Reding 		value |= COLOR_EXPAND;
47110288eeaSThierry Reding 	}
47210288eeaSThierry Reding 
47310288eeaSThierry Reding 	if (window->bottom_up)
47410288eeaSThierry Reding 		value |= V_DIRECTION;
47510288eeaSThierry Reding 
476acc6a3a9SDmitry Osipenko 	if (tegra_plane_use_horizontal_filtering(plane, window)) {
477acc6a3a9SDmitry Osipenko 		/*
478acc6a3a9SDmitry Osipenko 		 * Enable horizontal 6-tap filter and set filtering
479acc6a3a9SDmitry Osipenko 		 * coefficients to the default values defined in TRM.
480acc6a3a9SDmitry Osipenko 		 */
481acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x00008000, DC_WIN_H_FILTER_P(0));
482acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x3e087ce1, DC_WIN_H_FILTER_P(1));
483acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x3b117ac1, DC_WIN_H_FILTER_P(2));
484acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x591b73aa, DC_WIN_H_FILTER_P(3));
485acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x57256d9a, DC_WIN_H_FILTER_P(4));
486acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x552f668b, DC_WIN_H_FILTER_P(5));
487acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x73385e8b, DC_WIN_H_FILTER_P(6));
488acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x72435583, DC_WIN_H_FILTER_P(7));
489acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x714c4c8b, DC_WIN_H_FILTER_P(8));
490acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x70554393, DC_WIN_H_FILTER_P(9));
491acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x715e389b, DC_WIN_H_FILTER_P(10));
492acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x71662faa, DC_WIN_H_FILTER_P(11));
493acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x536d25ba, DC_WIN_H_FILTER_P(12));
494acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x55731bca, DC_WIN_H_FILTER_P(13));
495acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x387a11d9, DC_WIN_H_FILTER_P(14));
496acc6a3a9SDmitry Osipenko 		tegra_plane_writel(plane, 0x3c7c08f1, DC_WIN_H_FILTER_P(15));
497acc6a3a9SDmitry Osipenko 
498acc6a3a9SDmitry Osipenko 		value |= H_FILTER;
499acc6a3a9SDmitry Osipenko 	}
500acc6a3a9SDmitry Osipenko 
501acc6a3a9SDmitry Osipenko 	if (tegra_plane_use_vertical_filtering(plane, window)) {
502acc6a3a9SDmitry Osipenko 		unsigned int i, k;
503acc6a3a9SDmitry Osipenko 
504acc6a3a9SDmitry Osipenko 		/*
505acc6a3a9SDmitry Osipenko 		 * Enable vertical 2-tap filter and set filtering
506acc6a3a9SDmitry Osipenko 		 * coefficients to the default values defined in TRM.
507acc6a3a9SDmitry Osipenko 		 */
508acc6a3a9SDmitry Osipenko 		for (i = 0, k = 128; i < 16; i++, k -= 8)
509acc6a3a9SDmitry Osipenko 			tegra_plane_writel(plane, k, DC_WIN_V_FILTER_P(i));
510acc6a3a9SDmitry Osipenko 
511acc6a3a9SDmitry Osipenko 		value |= V_FILTER;
512acc6a3a9SDmitry Osipenko 	}
513acc6a3a9SDmitry Osipenko 
5141087fac1SThierry Reding 	tegra_plane_writel(plane, value, DC_WIN_WIN_OPTIONS);
51510288eeaSThierry Reding 
516a43d0a00SDmitry Osipenko 	if (dc->soc->has_legacy_blending)
517ab7d3f58SThierry Reding 		tegra_plane_setup_blending_legacy(plane);
518a43d0a00SDmitry Osipenko 	else
519a43d0a00SDmitry Osipenko 		tegra_plane_setup_blending(plane, window);
520c7679306SThierry Reding }
521c7679306SThierry Reding 
522511c7023SThierry Reding static const u32 tegra20_primary_formats[] = {
523511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
524511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
525c7679306SThierry Reding 	DRM_FORMAT_RGB565,
526511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
527511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
528511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
529ebae8d07SThierry Reding 	/* non-native formats */
530ebae8d07SThierry Reding 	DRM_FORMAT_XRGB1555,
531ebae8d07SThierry Reding 	DRM_FORMAT_RGBX5551,
532ebae8d07SThierry Reding 	DRM_FORMAT_XBGR8888,
533ebae8d07SThierry Reding 	DRM_FORMAT_XRGB8888,
534511c7023SThierry Reding };
535511c7023SThierry Reding 
536e90124cbSThierry Reding static const u64 tegra20_modifiers[] = {
537e90124cbSThierry Reding 	DRM_FORMAT_MOD_LINEAR,
538e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_TEGRA_TILED,
539e90124cbSThierry Reding 	DRM_FORMAT_MOD_INVALID
540e90124cbSThierry Reding };
541e90124cbSThierry Reding 
542511c7023SThierry Reding static const u32 tegra114_primary_formats[] = {
543511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
544511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
545511c7023SThierry Reding 	DRM_FORMAT_RGB565,
546511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
547511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
548511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
549511c7023SThierry Reding 	/* new on Tegra114 */
550511c7023SThierry Reding 	DRM_FORMAT_ABGR4444,
551511c7023SThierry Reding 	DRM_FORMAT_ABGR1555,
552511c7023SThierry Reding 	DRM_FORMAT_BGRA5551,
553511c7023SThierry Reding 	DRM_FORMAT_XRGB1555,
554511c7023SThierry Reding 	DRM_FORMAT_RGBX5551,
555511c7023SThierry Reding 	DRM_FORMAT_XBGR1555,
556511c7023SThierry Reding 	DRM_FORMAT_BGRX5551,
557511c7023SThierry Reding 	DRM_FORMAT_BGR565,
558511c7023SThierry Reding 	DRM_FORMAT_BGRA8888,
559511c7023SThierry Reding 	DRM_FORMAT_RGBA8888,
560511c7023SThierry Reding 	DRM_FORMAT_XRGB8888,
561511c7023SThierry Reding 	DRM_FORMAT_XBGR8888,
562511c7023SThierry Reding };
563511c7023SThierry Reding 
564511c7023SThierry Reding static const u32 tegra124_primary_formats[] = {
565511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
566511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
567511c7023SThierry Reding 	DRM_FORMAT_RGB565,
568511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
569511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
570511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
571511c7023SThierry Reding 	/* new on Tegra114 */
572511c7023SThierry Reding 	DRM_FORMAT_ABGR4444,
573511c7023SThierry Reding 	DRM_FORMAT_ABGR1555,
574511c7023SThierry Reding 	DRM_FORMAT_BGRA5551,
575511c7023SThierry Reding 	DRM_FORMAT_XRGB1555,
576511c7023SThierry Reding 	DRM_FORMAT_RGBX5551,
577511c7023SThierry Reding 	DRM_FORMAT_XBGR1555,
578511c7023SThierry Reding 	DRM_FORMAT_BGRX5551,
579511c7023SThierry Reding 	DRM_FORMAT_BGR565,
580511c7023SThierry Reding 	DRM_FORMAT_BGRA8888,
581511c7023SThierry Reding 	DRM_FORMAT_RGBA8888,
582511c7023SThierry Reding 	DRM_FORMAT_XRGB8888,
583511c7023SThierry Reding 	DRM_FORMAT_XBGR8888,
584511c7023SThierry Reding 	/* new on Tegra124 */
585511c7023SThierry Reding 	DRM_FORMAT_RGBX8888,
586511c7023SThierry Reding 	DRM_FORMAT_BGRX8888,
587c7679306SThierry Reding };
588c7679306SThierry Reding 
589e90124cbSThierry Reding static const u64 tegra124_modifiers[] = {
590e90124cbSThierry Reding 	DRM_FORMAT_MOD_LINEAR,
591e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(0),
592e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(1),
593e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(2),
594e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(3),
595e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(4),
596e90124cbSThierry Reding 	DRM_FORMAT_MOD_NVIDIA_16BX2_BLOCK(5),
597e90124cbSThierry Reding 	DRM_FORMAT_MOD_INVALID
598e90124cbSThierry Reding };
599e90124cbSThierry Reding 
6004aa3df71SThierry Reding static int tegra_plane_atomic_check(struct drm_plane *plane,
6014aa3df71SThierry Reding 				    struct drm_plane_state *state)
6024aa3df71SThierry Reding {
6038f604f8cSThierry Reding 	struct tegra_plane_state *plane_state = to_tegra_plane_state(state);
604995c5a50SThierry Reding 	unsigned int rotation = DRM_MODE_ROTATE_0 | DRM_MODE_REFLECT_Y;
6058f604f8cSThierry Reding 	struct tegra_bo_tiling *tiling = &plane_state->tiling;
60647802b09SThierry Reding 	struct tegra_plane *tegra = to_tegra_plane(plane);
6074aa3df71SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(state->crtc);
608c7679306SThierry Reding 	int err;
609c7679306SThierry Reding 
6104aa3df71SThierry Reding 	/* no need for further checks if the plane is being disabled */
6114aa3df71SThierry Reding 	if (!state->crtc)
6124aa3df71SThierry Reding 		return 0;
6134aa3df71SThierry Reding 
6143dae08bcSDmitry Osipenko 	err = tegra_plane_format(state->fb->format->format,
6153dae08bcSDmitry Osipenko 				 &plane_state->format,
6168f604f8cSThierry Reding 				 &plane_state->swap);
6174aa3df71SThierry Reding 	if (err < 0)
6184aa3df71SThierry Reding 		return err;
6194aa3df71SThierry Reding 
620ebae8d07SThierry Reding 	/*
621ebae8d07SThierry Reding 	 * Tegra20 and Tegra30 are special cases here because they support
622ebae8d07SThierry Reding 	 * only variants of specific formats with an alpha component, but not
623ebae8d07SThierry Reding 	 * the corresponding opaque formats. However, the opaque formats can
624ebae8d07SThierry Reding 	 * be emulated by disabling alpha blending for the plane.
625ebae8d07SThierry Reding 	 */
626a43d0a00SDmitry Osipenko 	if (dc->soc->has_legacy_blending) {
6273dae08bcSDmitry Osipenko 		err = tegra_plane_setup_legacy_state(tegra, plane_state);
628ebae8d07SThierry Reding 		if (err < 0)
629ebae8d07SThierry Reding 			return err;
630ebae8d07SThierry Reding 	}
631ebae8d07SThierry Reding 
6328f604f8cSThierry Reding 	err = tegra_fb_get_tiling(state->fb, tiling);
6338f604f8cSThierry Reding 	if (err < 0)
6348f604f8cSThierry Reding 		return err;
6358f604f8cSThierry Reding 
6368f604f8cSThierry Reding 	if (tiling->mode == TEGRA_BO_TILING_MODE_BLOCK &&
6374aa3df71SThierry Reding 	    !dc->soc->supports_block_linear) {
6384aa3df71SThierry Reding 		DRM_ERROR("hardware doesn't support block linear mode\n");
6394aa3df71SThierry Reding 		return -EINVAL;
6404aa3df71SThierry Reding 	}
6414aa3df71SThierry Reding 
642995c5a50SThierry Reding 	rotation = drm_rotation_simplify(state->rotation, rotation);
643995c5a50SThierry Reding 
644995c5a50SThierry Reding 	if (rotation & DRM_MODE_REFLECT_Y)
645995c5a50SThierry Reding 		plane_state->bottom_up = true;
646995c5a50SThierry Reding 	else
647995c5a50SThierry Reding 		plane_state->bottom_up = false;
648995c5a50SThierry Reding 
6494aa3df71SThierry Reding 	/*
6504aa3df71SThierry Reding 	 * Tegra doesn't support different strides for U and V planes so we
6514aa3df71SThierry Reding 	 * error out if the user tries to display a framebuffer with such a
6524aa3df71SThierry Reding 	 * configuration.
6534aa3df71SThierry Reding 	 */
654bcb0b461SVille Syrjälä 	if (state->fb->format->num_planes > 2) {
6554aa3df71SThierry Reding 		if (state->fb->pitches[2] != state->fb->pitches[1]) {
6564aa3df71SThierry Reding 			DRM_ERROR("unsupported UV-plane configuration\n");
6574aa3df71SThierry Reding 			return -EINVAL;
6584aa3df71SThierry Reding 		}
6594aa3df71SThierry Reding 	}
6604aa3df71SThierry Reding 
66147802b09SThierry Reding 	err = tegra_plane_state_add(tegra, state);
66247802b09SThierry Reding 	if (err < 0)
66347802b09SThierry Reding 		return err;
66447802b09SThierry Reding 
6654aa3df71SThierry Reding 	return 0;
6664aa3df71SThierry Reding }
6674aa3df71SThierry Reding 
668a4bfa096SThierry Reding static void tegra_plane_atomic_disable(struct drm_plane *plane,
669a4bfa096SThierry Reding 				       struct drm_plane_state *old_state)
67080d3eef1SDmitry Osipenko {
671a4bfa096SThierry Reding 	struct tegra_plane *p = to_tegra_plane(plane);
67280d3eef1SDmitry Osipenko 	u32 value;
67380d3eef1SDmitry Osipenko 
674a4bfa096SThierry Reding 	/* rien ne va plus */
675a4bfa096SThierry Reding 	if (!old_state || !old_state->crtc)
676a4bfa096SThierry Reding 		return;
677a4bfa096SThierry Reding 
6781087fac1SThierry Reding 	value = tegra_plane_readl(p, DC_WIN_WIN_OPTIONS);
67980d3eef1SDmitry Osipenko 	value &= ~WIN_ENABLE;
6801087fac1SThierry Reding 	tegra_plane_writel(p, value, DC_WIN_WIN_OPTIONS);
68180d3eef1SDmitry Osipenko }
68280d3eef1SDmitry Osipenko 
6834aa3df71SThierry Reding static void tegra_plane_atomic_update(struct drm_plane *plane,
6844aa3df71SThierry Reding 				      struct drm_plane_state *old_state)
6854aa3df71SThierry Reding {
6868f604f8cSThierry Reding 	struct tegra_plane_state *state = to_tegra_plane_state(plane->state);
6874aa3df71SThierry Reding 	struct drm_framebuffer *fb = plane->state->fb;
6884aa3df71SThierry Reding 	struct tegra_plane *p = to_tegra_plane(plane);
6894aa3df71SThierry Reding 	struct tegra_dc_window window;
6904aa3df71SThierry Reding 	unsigned int i;
6914aa3df71SThierry Reding 
6924aa3df71SThierry Reding 	/* rien ne va plus */
6934aa3df71SThierry Reding 	if (!plane->state->crtc || !plane->state->fb)
6944aa3df71SThierry Reding 		return;
6954aa3df71SThierry Reding 
69680d3eef1SDmitry Osipenko 	if (!plane->state->visible)
697a4bfa096SThierry Reding 		return tegra_plane_atomic_disable(plane, old_state);
69880d3eef1SDmitry Osipenko 
699c7679306SThierry Reding 	memset(&window, 0, sizeof(window));
7007d205857SDmitry Osipenko 	window.src.x = plane->state->src.x1 >> 16;
7017d205857SDmitry Osipenko 	window.src.y = plane->state->src.y1 >> 16;
7027d205857SDmitry Osipenko 	window.src.w = drm_rect_width(&plane->state->src) >> 16;
7037d205857SDmitry Osipenko 	window.src.h = drm_rect_height(&plane->state->src) >> 16;
7047d205857SDmitry Osipenko 	window.dst.x = plane->state->dst.x1;
7057d205857SDmitry Osipenko 	window.dst.y = plane->state->dst.y1;
7067d205857SDmitry Osipenko 	window.dst.w = drm_rect_width(&plane->state->dst);
7077d205857SDmitry Osipenko 	window.dst.h = drm_rect_height(&plane->state->dst);
708272725c7SVille Syrjälä 	window.bits_per_pixel = fb->format->cpp[0] * 8;
709995c5a50SThierry Reding 	window.bottom_up = tegra_fb_is_bottom_up(fb) || state->bottom_up;
710c7679306SThierry Reding 
7118f604f8cSThierry Reding 	/* copy from state */
712ab7d3f58SThierry Reding 	window.zpos = plane->state->normalized_zpos;
7138f604f8cSThierry Reding 	window.tiling = state->tiling;
7148f604f8cSThierry Reding 	window.format = state->format;
7158f604f8cSThierry Reding 	window.swap = state->swap;
716c7679306SThierry Reding 
717bcb0b461SVille Syrjälä 	for (i = 0; i < fb->format->num_planes; i++) {
7182e8d8749SThierry Reding 		window.base[i] = state->iova[i] + fb->offsets[i];
71908ee0178SDmitry Osipenko 
72008ee0178SDmitry Osipenko 		/*
72108ee0178SDmitry Osipenko 		 * Tegra uses a shared stride for UV planes. Framebuffers are
72208ee0178SDmitry Osipenko 		 * already checked for this in the tegra_plane_atomic_check()
72308ee0178SDmitry Osipenko 		 * function, so it's safe to ignore the V-plane pitch here.
72408ee0178SDmitry Osipenko 		 */
72508ee0178SDmitry Osipenko 		if (i < 2)
7264aa3df71SThierry Reding 			window.stride[i] = fb->pitches[i];
727c7679306SThierry Reding 	}
728c7679306SThierry Reding 
7291087fac1SThierry Reding 	tegra_dc_setup_window(p, &window);
7304aa3df71SThierry Reding }
7314aa3df71SThierry Reding 
732a4bfa096SThierry Reding static const struct drm_plane_helper_funcs tegra_plane_helper_funcs = {
7332e8d8749SThierry Reding 	.prepare_fb = tegra_plane_prepare_fb,
7342e8d8749SThierry Reding 	.cleanup_fb = tegra_plane_cleanup_fb,
7354aa3df71SThierry Reding 	.atomic_check = tegra_plane_atomic_check,
7364aa3df71SThierry Reding 	.atomic_disable = tegra_plane_atomic_disable,
737a4bfa096SThierry Reding 	.atomic_update = tegra_plane_atomic_update,
738c7679306SThierry Reding };
739c7679306SThierry Reding 
74089f65018SThierry Reding static unsigned long tegra_plane_get_possible_crtcs(struct drm_device *drm)
741c7679306SThierry Reding {
742518e6227SThierry Reding 	/*
743518e6227SThierry Reding 	 * Ideally this would use drm_crtc_mask(), but that would require the
744518e6227SThierry Reding 	 * CRTC to already be in the mode_config's list of CRTCs. However, it
745518e6227SThierry Reding 	 * will only be added to that list in the drm_crtc_init_with_planes()
746518e6227SThierry Reding 	 * (in tegra_dc_init()), which in turn requires registration of these
747518e6227SThierry Reding 	 * planes. So we have ourselves a nice little chicken and egg problem
748518e6227SThierry Reding 	 * here.
749518e6227SThierry Reding 	 *
750518e6227SThierry Reding 	 * We work around this by manually creating the mask from the number
751518e6227SThierry Reding 	 * of CRTCs that have been registered, and should therefore always be
752518e6227SThierry Reding 	 * the same as drm_crtc_index() after registration.
753518e6227SThierry Reding 	 */
75489f65018SThierry Reding 	return 1 << drm->mode_config.num_crtc;
75589f65018SThierry Reding }
75689f65018SThierry Reding 
75789f65018SThierry Reding static struct drm_plane *tegra_primary_plane_create(struct drm_device *drm,
75889f65018SThierry Reding 						    struct tegra_dc *dc)
75989f65018SThierry Reding {
76089f65018SThierry Reding 	unsigned long possible_crtcs = tegra_plane_get_possible_crtcs(drm);
76147307954SThierry Reding 	enum drm_plane_type type = DRM_PLANE_TYPE_PRIMARY;
762c7679306SThierry Reding 	struct tegra_plane *plane;
763c7679306SThierry Reding 	unsigned int num_formats;
764e90124cbSThierry Reding 	const u64 *modifiers;
765c7679306SThierry Reding 	const u32 *formats;
766c7679306SThierry Reding 	int err;
767c7679306SThierry Reding 
768c7679306SThierry Reding 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
769c7679306SThierry Reding 	if (!plane)
770c7679306SThierry Reding 		return ERR_PTR(-ENOMEM);
771c7679306SThierry Reding 
7721087fac1SThierry Reding 	/* Always use window A as primary window */
7731087fac1SThierry Reding 	plane->offset = 0xa00;
774c4755fb9SThierry Reding 	plane->index = 0;
7751087fac1SThierry Reding 	plane->dc = dc;
7761087fac1SThierry Reding 
7771087fac1SThierry Reding 	num_formats = dc->soc->num_primary_formats;
7781087fac1SThierry Reding 	formats = dc->soc->primary_formats;
779e90124cbSThierry Reding 	modifiers = dc->soc->modifiers;
780c4755fb9SThierry Reding 
781518e6227SThierry Reding 	err = drm_universal_plane_init(drm, &plane->base, possible_crtcs,
782c1cb4b61SThierry Reding 				       &tegra_plane_funcs, formats,
783e90124cbSThierry Reding 				       num_formats, modifiers, type, NULL);
784c7679306SThierry Reding 	if (err < 0) {
785c7679306SThierry Reding 		kfree(plane);
786c7679306SThierry Reding 		return ERR_PTR(err);
787c7679306SThierry Reding 	}
788c7679306SThierry Reding 
789a4bfa096SThierry Reding 	drm_plane_helper_add(&plane->base, &tegra_plane_helper_funcs);
7903dae08bcSDmitry Osipenko 	drm_plane_create_zpos_property(&plane->base, plane->index, 0, 255);
791ab7d3f58SThierry Reding 
792995c5a50SThierry Reding 	err = drm_plane_create_rotation_property(&plane->base,
793995c5a50SThierry Reding 						 DRM_MODE_ROTATE_0,
794995c5a50SThierry Reding 						 DRM_MODE_ROTATE_0 |
795995c5a50SThierry Reding 						 DRM_MODE_REFLECT_Y);
796995c5a50SThierry Reding 	if (err < 0)
797995c5a50SThierry Reding 		dev_err(dc->dev, "failed to create rotation property: %d\n",
798995c5a50SThierry Reding 			err);
799995c5a50SThierry Reding 
800c7679306SThierry Reding 	return &plane->base;
801c7679306SThierry Reding }
802c7679306SThierry Reding 
803c7679306SThierry Reding static const u32 tegra_cursor_plane_formats[] = {
804c7679306SThierry Reding 	DRM_FORMAT_RGBA8888,
805c7679306SThierry Reding };
806c7679306SThierry Reding 
8074aa3df71SThierry Reding static int tegra_cursor_atomic_check(struct drm_plane *plane,
8084aa3df71SThierry Reding 				     struct drm_plane_state *state)
809c7679306SThierry Reding {
81047802b09SThierry Reding 	struct tegra_plane *tegra = to_tegra_plane(plane);
81147802b09SThierry Reding 	int err;
81247802b09SThierry Reding 
8134aa3df71SThierry Reding 	/* no need for further checks if the plane is being disabled */
8144aa3df71SThierry Reding 	if (!state->crtc)
8154aa3df71SThierry Reding 		return 0;
816c7679306SThierry Reding 
817c7679306SThierry Reding 	/* scaling not supported for cursor */
8184aa3df71SThierry Reding 	if ((state->src_w >> 16 != state->crtc_w) ||
8194aa3df71SThierry Reding 	    (state->src_h >> 16 != state->crtc_h))
820c7679306SThierry Reding 		return -EINVAL;
821c7679306SThierry Reding 
822c7679306SThierry Reding 	/* only square cursors supported */
8234aa3df71SThierry Reding 	if (state->src_w != state->src_h)
824c7679306SThierry Reding 		return -EINVAL;
825c7679306SThierry Reding 
8264aa3df71SThierry Reding 	if (state->crtc_w != 32 && state->crtc_w != 64 &&
8274aa3df71SThierry Reding 	    state->crtc_w != 128 && state->crtc_w != 256)
8284aa3df71SThierry Reding 		return -EINVAL;
8294aa3df71SThierry Reding 
83047802b09SThierry Reding 	err = tegra_plane_state_add(tegra, state);
83147802b09SThierry Reding 	if (err < 0)
83247802b09SThierry Reding 		return err;
83347802b09SThierry Reding 
8344aa3df71SThierry Reding 	return 0;
8354aa3df71SThierry Reding }
8364aa3df71SThierry Reding 
8374aa3df71SThierry Reding static void tegra_cursor_atomic_update(struct drm_plane *plane,
8384aa3df71SThierry Reding 				       struct drm_plane_state *old_state)
8394aa3df71SThierry Reding {
840c52e167bSThierry Reding 	struct tegra_plane_state *state = to_tegra_plane_state(plane->state);
8414aa3df71SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(plane->state->crtc);
8424aa3df71SThierry Reding 	u32 value = CURSOR_CLIP_DISPLAY;
8434aa3df71SThierry Reding 
8444aa3df71SThierry Reding 	/* rien ne va plus */
8454aa3df71SThierry Reding 	if (!plane->state->crtc || !plane->state->fb)
8464aa3df71SThierry Reding 		return;
8474aa3df71SThierry Reding 
848c52e167bSThierry Reding 	switch (plane->state->crtc_w) {
849c7679306SThierry Reding 	case 32:
850c7679306SThierry Reding 		value |= CURSOR_SIZE_32x32;
851c7679306SThierry Reding 		break;
852c7679306SThierry Reding 
853c7679306SThierry Reding 	case 64:
854c7679306SThierry Reding 		value |= CURSOR_SIZE_64x64;
855c7679306SThierry Reding 		break;
856c7679306SThierry Reding 
857c7679306SThierry Reding 	case 128:
858c7679306SThierry Reding 		value |= CURSOR_SIZE_128x128;
859c7679306SThierry Reding 		break;
860c7679306SThierry Reding 
861c7679306SThierry Reding 	case 256:
862c7679306SThierry Reding 		value |= CURSOR_SIZE_256x256;
863c7679306SThierry Reding 		break;
864c7679306SThierry Reding 
865c7679306SThierry Reding 	default:
866c52e167bSThierry Reding 		WARN(1, "cursor size %ux%u not supported\n",
867c52e167bSThierry Reding 		     plane->state->crtc_w, plane->state->crtc_h);
8684aa3df71SThierry Reding 		return;
869c7679306SThierry Reding 	}
870c7679306SThierry Reding 
871c52e167bSThierry Reding 	value |= (state->iova[0] >> 10) & 0x3fffff;
872c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_CURSOR_START_ADDR);
873c7679306SThierry Reding 
874c7679306SThierry Reding #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
875c52e167bSThierry Reding 	value = (state->iova[0] >> 32) & 0x3;
876c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_CURSOR_START_ADDR_HI);
877c7679306SThierry Reding #endif
878c7679306SThierry Reding 
879c7679306SThierry Reding 	/* enable cursor and set blend mode */
880c7679306SThierry Reding 	value = tegra_dc_readl(dc, DC_DISP_DISP_WIN_OPTIONS);
881c7679306SThierry Reding 	value |= CURSOR_ENABLE;
882c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_DISP_WIN_OPTIONS);
883c7679306SThierry Reding 
884c7679306SThierry Reding 	value = tegra_dc_readl(dc, DC_DISP_BLEND_CURSOR_CONTROL);
885c7679306SThierry Reding 	value &= ~CURSOR_DST_BLEND_MASK;
886c7679306SThierry Reding 	value &= ~CURSOR_SRC_BLEND_MASK;
887c7679306SThierry Reding 	value |= CURSOR_MODE_NORMAL;
888c7679306SThierry Reding 	value |= CURSOR_DST_BLEND_NEG_K1_TIMES_SRC;
889c7679306SThierry Reding 	value |= CURSOR_SRC_BLEND_K1_TIMES_SRC;
890c7679306SThierry Reding 	value |= CURSOR_ALPHA;
891c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_BLEND_CURSOR_CONTROL);
892c7679306SThierry Reding 
893c7679306SThierry Reding 	/* position the cursor */
894c52e167bSThierry Reding 	value = (plane->state->crtc_y & 0x3fff) << 16 |
895c52e167bSThierry Reding 		(plane->state->crtc_x & 0x3fff);
896c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_CURSOR_POSITION);
897c7679306SThierry Reding }
898c7679306SThierry Reding 
8994aa3df71SThierry Reding static void tegra_cursor_atomic_disable(struct drm_plane *plane,
9004aa3df71SThierry Reding 					struct drm_plane_state *old_state)
901c7679306SThierry Reding {
9024aa3df71SThierry Reding 	struct tegra_dc *dc;
903c7679306SThierry Reding 	u32 value;
904c7679306SThierry Reding 
9054aa3df71SThierry Reding 	/* rien ne va plus */
9064aa3df71SThierry Reding 	if (!old_state || !old_state->crtc)
9074aa3df71SThierry Reding 		return;
9084aa3df71SThierry Reding 
9094aa3df71SThierry Reding 	dc = to_tegra_dc(old_state->crtc);
910c7679306SThierry Reding 
911c7679306SThierry Reding 	value = tegra_dc_readl(dc, DC_DISP_DISP_WIN_OPTIONS);
912c7679306SThierry Reding 	value &= ~CURSOR_ENABLE;
913c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_DISP_WIN_OPTIONS);
914c7679306SThierry Reding }
915c7679306SThierry Reding 
9164aa3df71SThierry Reding static const struct drm_plane_helper_funcs tegra_cursor_plane_helper_funcs = {
9172e8d8749SThierry Reding 	.prepare_fb = tegra_plane_prepare_fb,
9182e8d8749SThierry Reding 	.cleanup_fb = tegra_plane_cleanup_fb,
9194aa3df71SThierry Reding 	.atomic_check = tegra_cursor_atomic_check,
9204aa3df71SThierry Reding 	.atomic_update = tegra_cursor_atomic_update,
9214aa3df71SThierry Reding 	.atomic_disable = tegra_cursor_atomic_disable,
922c7679306SThierry Reding };
923c7679306SThierry Reding 
924c7679306SThierry Reding static struct drm_plane *tegra_dc_cursor_plane_create(struct drm_device *drm,
925c7679306SThierry Reding 						      struct tegra_dc *dc)
926c7679306SThierry Reding {
92789f65018SThierry Reding 	unsigned long possible_crtcs = tegra_plane_get_possible_crtcs(drm);
928c7679306SThierry Reding 	struct tegra_plane *plane;
929c7679306SThierry Reding 	unsigned int num_formats;
930c7679306SThierry Reding 	const u32 *formats;
931c7679306SThierry Reding 	int err;
932c7679306SThierry Reding 
933c7679306SThierry Reding 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
934c7679306SThierry Reding 	if (!plane)
935c7679306SThierry Reding 		return ERR_PTR(-ENOMEM);
936c7679306SThierry Reding 
93747802b09SThierry Reding 	/*
938a1df3b24SThierry Reding 	 * This index is kind of fake. The cursor isn't a regular plane, but
939a1df3b24SThierry Reding 	 * its update and activation request bits in DC_CMD_STATE_CONTROL do
940a1df3b24SThierry Reding 	 * use the same programming. Setting this fake index here allows the
941a1df3b24SThierry Reding 	 * code in tegra_add_plane_state() to do the right thing without the
942a1df3b24SThierry Reding 	 * need to special-casing the cursor plane.
94347802b09SThierry Reding 	 */
94447802b09SThierry Reding 	plane->index = 6;
9451087fac1SThierry Reding 	plane->dc = dc;
94647802b09SThierry Reding 
947c7679306SThierry Reding 	num_formats = ARRAY_SIZE(tegra_cursor_plane_formats);
948c7679306SThierry Reding 	formats = tegra_cursor_plane_formats;
949c7679306SThierry Reding 
95089f65018SThierry Reding 	err = drm_universal_plane_init(drm, &plane->base, possible_crtcs,
951c1cb4b61SThierry Reding 				       &tegra_plane_funcs, formats,
952e6fc3b68SBen Widawsky 				       num_formats, NULL,
953e6fc3b68SBen Widawsky 				       DRM_PLANE_TYPE_CURSOR, NULL);
954c7679306SThierry Reding 	if (err < 0) {
955c7679306SThierry Reding 		kfree(plane);
956c7679306SThierry Reding 		return ERR_PTR(err);
957c7679306SThierry Reding 	}
958c7679306SThierry Reding 
9594aa3df71SThierry Reding 	drm_plane_helper_add(&plane->base, &tegra_cursor_plane_helper_funcs);
9604aa3df71SThierry Reding 
961c7679306SThierry Reding 	return &plane->base;
962c7679306SThierry Reding }
963c7679306SThierry Reding 
964511c7023SThierry Reding static const u32 tegra20_overlay_formats[] = {
965511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
966511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
967dee8268fSThierry Reding 	DRM_FORMAT_RGB565,
968511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
969511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
970511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
971ebae8d07SThierry Reding 	/* non-native formats */
972ebae8d07SThierry Reding 	DRM_FORMAT_XRGB1555,
973ebae8d07SThierry Reding 	DRM_FORMAT_RGBX5551,
974ebae8d07SThierry Reding 	DRM_FORMAT_XBGR8888,
975ebae8d07SThierry Reding 	DRM_FORMAT_XRGB8888,
976511c7023SThierry Reding 	/* planar formats */
977511c7023SThierry Reding 	DRM_FORMAT_UYVY,
978511c7023SThierry Reding 	DRM_FORMAT_YUYV,
979511c7023SThierry Reding 	DRM_FORMAT_YUV420,
980511c7023SThierry Reding 	DRM_FORMAT_YUV422,
981511c7023SThierry Reding };
982511c7023SThierry Reding 
983511c7023SThierry Reding static const u32 tegra114_overlay_formats[] = {
984511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
985511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
986511c7023SThierry Reding 	DRM_FORMAT_RGB565,
987511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
988511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
989511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
990511c7023SThierry Reding 	/* new on Tegra114 */
991511c7023SThierry Reding 	DRM_FORMAT_ABGR4444,
992511c7023SThierry Reding 	DRM_FORMAT_ABGR1555,
993511c7023SThierry Reding 	DRM_FORMAT_BGRA5551,
994511c7023SThierry Reding 	DRM_FORMAT_XRGB1555,
995511c7023SThierry Reding 	DRM_FORMAT_RGBX5551,
996511c7023SThierry Reding 	DRM_FORMAT_XBGR1555,
997511c7023SThierry Reding 	DRM_FORMAT_BGRX5551,
998511c7023SThierry Reding 	DRM_FORMAT_BGR565,
999511c7023SThierry Reding 	DRM_FORMAT_BGRA8888,
1000511c7023SThierry Reding 	DRM_FORMAT_RGBA8888,
1001511c7023SThierry Reding 	DRM_FORMAT_XRGB8888,
1002511c7023SThierry Reding 	DRM_FORMAT_XBGR8888,
1003511c7023SThierry Reding 	/* planar formats */
1004511c7023SThierry Reding 	DRM_FORMAT_UYVY,
1005511c7023SThierry Reding 	DRM_FORMAT_YUYV,
1006511c7023SThierry Reding 	DRM_FORMAT_YUV420,
1007511c7023SThierry Reding 	DRM_FORMAT_YUV422,
1008511c7023SThierry Reding };
1009511c7023SThierry Reding 
1010511c7023SThierry Reding static const u32 tegra124_overlay_formats[] = {
1011511c7023SThierry Reding 	DRM_FORMAT_ARGB4444,
1012511c7023SThierry Reding 	DRM_FORMAT_ARGB1555,
1013511c7023SThierry Reding 	DRM_FORMAT_RGB565,
1014511c7023SThierry Reding 	DRM_FORMAT_RGBA5551,
1015511c7023SThierry Reding 	DRM_FORMAT_ABGR8888,
1016511c7023SThierry Reding 	DRM_FORMAT_ARGB8888,
1017511c7023SThierry Reding 	/* new on Tegra114 */
1018511c7023SThierry Reding 	DRM_FORMAT_ABGR4444,
1019511c7023SThierry Reding 	DRM_FORMAT_ABGR1555,
1020511c7023SThierry Reding 	DRM_FORMAT_BGRA5551,
1021511c7023SThierry Reding 	DRM_FORMAT_XRGB1555,
1022511c7023SThierry Reding 	DRM_FORMAT_RGBX5551,
1023511c7023SThierry Reding 	DRM_FORMAT_XBGR1555,
1024511c7023SThierry Reding 	DRM_FORMAT_BGRX5551,
1025511c7023SThierry Reding 	DRM_FORMAT_BGR565,
1026511c7023SThierry Reding 	DRM_FORMAT_BGRA8888,
1027511c7023SThierry Reding 	DRM_FORMAT_RGBA8888,
1028511c7023SThierry Reding 	DRM_FORMAT_XRGB8888,
1029511c7023SThierry Reding 	DRM_FORMAT_XBGR8888,
1030511c7023SThierry Reding 	/* new on Tegra124 */
1031511c7023SThierry Reding 	DRM_FORMAT_RGBX8888,
1032511c7023SThierry Reding 	DRM_FORMAT_BGRX8888,
1033511c7023SThierry Reding 	/* planar formats */
1034dee8268fSThierry Reding 	DRM_FORMAT_UYVY,
1035f925390eSThierry Reding 	DRM_FORMAT_YUYV,
1036dee8268fSThierry Reding 	DRM_FORMAT_YUV420,
1037dee8268fSThierry Reding 	DRM_FORMAT_YUV422,
1038dee8268fSThierry Reding };
1039dee8268fSThierry Reding 
1040c7679306SThierry Reding static struct drm_plane *tegra_dc_overlay_plane_create(struct drm_device *drm,
1041c7679306SThierry Reding 						       struct tegra_dc *dc,
10429f446d83SDmitry Osipenko 						       unsigned int index,
10439f446d83SDmitry Osipenko 						       bool cursor)
1044dee8268fSThierry Reding {
104589f65018SThierry Reding 	unsigned long possible_crtcs = tegra_plane_get_possible_crtcs(drm);
1046dee8268fSThierry Reding 	struct tegra_plane *plane;
1047c7679306SThierry Reding 	unsigned int num_formats;
10489f446d83SDmitry Osipenko 	enum drm_plane_type type;
1049c7679306SThierry Reding 	const u32 *formats;
1050c7679306SThierry Reding 	int err;
1051dee8268fSThierry Reding 
1052f002abc1SThierry Reding 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
1053dee8268fSThierry Reding 	if (!plane)
1054c7679306SThierry Reding 		return ERR_PTR(-ENOMEM);
1055dee8268fSThierry Reding 
10561087fac1SThierry Reding 	plane->offset = 0xa00 + 0x200 * index;
1057c7679306SThierry Reding 	plane->index = index;
10581087fac1SThierry Reding 	plane->dc = dc;
1059dee8268fSThierry Reding 
1060511c7023SThierry Reding 	num_formats = dc->soc->num_overlay_formats;
1061511c7023SThierry Reding 	formats = dc->soc->overlay_formats;
1062c7679306SThierry Reding 
10639f446d83SDmitry Osipenko 	if (!cursor)
10649f446d83SDmitry Osipenko 		type = DRM_PLANE_TYPE_OVERLAY;
10659f446d83SDmitry Osipenko 	else
10669f446d83SDmitry Osipenko 		type = DRM_PLANE_TYPE_CURSOR;
10679f446d83SDmitry Osipenko 
106889f65018SThierry Reding 	err = drm_universal_plane_init(drm, &plane->base, possible_crtcs,
1069301e0ddbSThierry Reding 				       &tegra_plane_funcs, formats,
10709f446d83SDmitry Osipenko 				       num_formats, NULL, type, NULL);
1071f002abc1SThierry Reding 	if (err < 0) {
1072f002abc1SThierry Reding 		kfree(plane);
1073c7679306SThierry Reding 		return ERR_PTR(err);
1074dee8268fSThierry Reding 	}
1075c7679306SThierry Reding 
1076a4bfa096SThierry Reding 	drm_plane_helper_add(&plane->base, &tegra_plane_helper_funcs);
10773dae08bcSDmitry Osipenko 	drm_plane_create_zpos_property(&plane->base, plane->index, 0, 255);
1078ab7d3f58SThierry Reding 
1079995c5a50SThierry Reding 	err = drm_plane_create_rotation_property(&plane->base,
1080995c5a50SThierry Reding 						 DRM_MODE_ROTATE_0,
1081995c5a50SThierry Reding 						 DRM_MODE_ROTATE_0 |
1082995c5a50SThierry Reding 						 DRM_MODE_REFLECT_Y);
1083995c5a50SThierry Reding 	if (err < 0)
1084995c5a50SThierry Reding 		dev_err(dc->dev, "failed to create rotation property: %d\n",
1085995c5a50SThierry Reding 			err);
1086995c5a50SThierry Reding 
1087c7679306SThierry Reding 	return &plane->base;
1088c7679306SThierry Reding }
1089c7679306SThierry Reding 
109047307954SThierry Reding static struct drm_plane *tegra_dc_add_shared_planes(struct drm_device *drm,
109147307954SThierry Reding 						    struct tegra_dc *dc)
1092c7679306SThierry Reding {
109347307954SThierry Reding 	struct drm_plane *plane, *primary = NULL;
109447307954SThierry Reding 	unsigned int i, j;
109547307954SThierry Reding 
109647307954SThierry Reding 	for (i = 0; i < dc->soc->num_wgrps; i++) {
109747307954SThierry Reding 		const struct tegra_windowgroup_soc *wgrp = &dc->soc->wgrps[i];
109847307954SThierry Reding 
109947307954SThierry Reding 		if (wgrp->dc == dc->pipe) {
110047307954SThierry Reding 			for (j = 0; j < wgrp->num_windows; j++) {
110147307954SThierry Reding 				unsigned int index = wgrp->windows[j];
110247307954SThierry Reding 
110347307954SThierry Reding 				plane = tegra_shared_plane_create(drm, dc,
110447307954SThierry Reding 								  wgrp->index,
110547307954SThierry Reding 								  index);
110647307954SThierry Reding 				if (IS_ERR(plane))
110747307954SThierry Reding 					return plane;
110847307954SThierry Reding 
110947307954SThierry Reding 				/*
111047307954SThierry Reding 				 * Choose the first shared plane owned by this
111147307954SThierry Reding 				 * head as the primary plane.
111247307954SThierry Reding 				 */
111347307954SThierry Reding 				if (!primary) {
111447307954SThierry Reding 					plane->type = DRM_PLANE_TYPE_PRIMARY;
111547307954SThierry Reding 					primary = plane;
111647307954SThierry Reding 				}
111747307954SThierry Reding 			}
111847307954SThierry Reding 		}
111947307954SThierry Reding 	}
112047307954SThierry Reding 
112147307954SThierry Reding 	return primary;
112247307954SThierry Reding }
112347307954SThierry Reding 
112447307954SThierry Reding static struct drm_plane *tegra_dc_add_planes(struct drm_device *drm,
112547307954SThierry Reding 					     struct tegra_dc *dc)
112647307954SThierry Reding {
11278f62142eSThierry Reding 	struct drm_plane *planes[2], *primary;
11289f446d83SDmitry Osipenko 	unsigned int planes_num;
1129c7679306SThierry Reding 	unsigned int i;
11308f62142eSThierry Reding 	int err;
1131c7679306SThierry Reding 
113247307954SThierry Reding 	primary = tegra_primary_plane_create(drm, dc);
113347307954SThierry Reding 	if (IS_ERR(primary))
113447307954SThierry Reding 		return primary;
113547307954SThierry Reding 
11369f446d83SDmitry Osipenko 	if (dc->soc->supports_cursor)
11379f446d83SDmitry Osipenko 		planes_num = 2;
11389f446d83SDmitry Osipenko 	else
11399f446d83SDmitry Osipenko 		planes_num = 1;
11409f446d83SDmitry Osipenko 
11419f446d83SDmitry Osipenko 	for (i = 0; i < planes_num; i++) {
11429f446d83SDmitry Osipenko 		planes[i] = tegra_dc_overlay_plane_create(drm, dc, 1 + i,
11439f446d83SDmitry Osipenko 							  false);
11448f62142eSThierry Reding 		if (IS_ERR(planes[i])) {
11458f62142eSThierry Reding 			err = PTR_ERR(planes[i]);
11468f62142eSThierry Reding 
11478f62142eSThierry Reding 			while (i--)
11488f62142eSThierry Reding 				tegra_plane_funcs.destroy(planes[i]);
11498f62142eSThierry Reding 
11508f62142eSThierry Reding 			tegra_plane_funcs.destroy(primary);
11518f62142eSThierry Reding 			return ERR_PTR(err);
115247307954SThierry Reding 		}
1153f002abc1SThierry Reding 	}
1154dee8268fSThierry Reding 
115547307954SThierry Reding 	return primary;
1156dee8268fSThierry Reding }
1157dee8268fSThierry Reding 
1158f002abc1SThierry Reding static void tegra_dc_destroy(struct drm_crtc *crtc)
1159f002abc1SThierry Reding {
1160f002abc1SThierry Reding 	drm_crtc_cleanup(crtc);
1161f002abc1SThierry Reding }
1162f002abc1SThierry Reding 
1163ca915b10SThierry Reding static void tegra_crtc_reset(struct drm_crtc *crtc)
1164ca915b10SThierry Reding {
1165b7e0b04aSMaarten Lankhorst 	struct tegra_dc_state *state = kzalloc(sizeof(*state), GFP_KERNEL);
1166ca915b10SThierry Reding 
11673b59b7acSThierry Reding 	if (crtc->state)
1168b7e0b04aSMaarten Lankhorst 		tegra_crtc_atomic_destroy_state(crtc, crtc->state);
11693b59b7acSThierry Reding 
1170b7e0b04aSMaarten Lankhorst 	__drm_atomic_helper_crtc_reset(crtc, &state->base);
117131930d4dSThierry Reding 	drm_crtc_vblank_reset(crtc);
1172ca915b10SThierry Reding }
1173ca915b10SThierry Reding 
1174ca915b10SThierry Reding static struct drm_crtc_state *
1175ca915b10SThierry Reding tegra_crtc_atomic_duplicate_state(struct drm_crtc *crtc)
1176ca915b10SThierry Reding {
1177ca915b10SThierry Reding 	struct tegra_dc_state *state = to_dc_state(crtc->state);
1178ca915b10SThierry Reding 	struct tegra_dc_state *copy;
1179ca915b10SThierry Reding 
11803b59b7acSThierry Reding 	copy = kmalloc(sizeof(*copy), GFP_KERNEL);
1181ca915b10SThierry Reding 	if (!copy)
1182ca915b10SThierry Reding 		return NULL;
1183ca915b10SThierry Reding 
11843b59b7acSThierry Reding 	__drm_atomic_helper_crtc_duplicate_state(crtc, &copy->base);
11853b59b7acSThierry Reding 	copy->clk = state->clk;
11863b59b7acSThierry Reding 	copy->pclk = state->pclk;
11873b59b7acSThierry Reding 	copy->div = state->div;
11883b59b7acSThierry Reding 	copy->planes = state->planes;
1189ca915b10SThierry Reding 
1190ca915b10SThierry Reding 	return &copy->base;
1191ca915b10SThierry Reding }
1192ca915b10SThierry Reding 
1193ca915b10SThierry Reding static void tegra_crtc_atomic_destroy_state(struct drm_crtc *crtc,
1194ca915b10SThierry Reding 					    struct drm_crtc_state *state)
1195ca915b10SThierry Reding {
1196ec2dc6a0SDaniel Vetter 	__drm_atomic_helper_crtc_destroy_state(state);
1197ca915b10SThierry Reding 	kfree(state);
1198ca915b10SThierry Reding }
1199ca915b10SThierry Reding 
1200b95800eeSThierry Reding #define DEBUGFS_REG32(_name) { .name = #_name, .offset = _name }
1201b95800eeSThierry Reding 
1202b95800eeSThierry Reding static const struct debugfs_reg32 tegra_dc_regs[] = {
1203b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_GENERAL_INCR_SYNCPT),
1204b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_GENERAL_INCR_SYNCPT_CNTRL),
1205b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_GENERAL_INCR_SYNCPT_ERROR),
1206b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_A_INCR_SYNCPT),
1207b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_A_INCR_SYNCPT_CNTRL),
1208b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_A_INCR_SYNCPT_ERROR),
1209b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_B_INCR_SYNCPT),
1210b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_B_INCR_SYNCPT_CNTRL),
1211b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_B_INCR_SYNCPT_ERROR),
1212b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_C_INCR_SYNCPT),
1213b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_C_INCR_SYNCPT_CNTRL),
1214b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_WIN_C_INCR_SYNCPT_ERROR),
1215b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_CONT_SYNCPT_VSYNC),
1216b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_DISPLAY_COMMAND_OPTION0),
1217b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_DISPLAY_COMMAND),
1218b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_SIGNAL_RAISE),
1219b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_DISPLAY_POWER_CONTROL),
1220b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_STATUS),
1221b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_MASK),
1222b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_ENABLE),
1223b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_TYPE),
1224b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_INT_POLARITY),
1225b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_SIGNAL_RAISE1),
1226b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_SIGNAL_RAISE2),
1227b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_SIGNAL_RAISE3),
1228b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_STATE_ACCESS),
1229b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_STATE_CONTROL),
1230b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_DISPLAY_WINDOW_HEADER),
1231b95800eeSThierry Reding 	DEBUGFS_REG32(DC_CMD_REG_ACT_CONTROL),
1232b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_CRC_CONTROL),
1233b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_CRC_CHECKSUM),
1234b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_ENABLE(0)),
1235b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_ENABLE(1)),
1236b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_ENABLE(2)),
1237b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_ENABLE(3)),
1238b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_POLARITY(0)),
1239b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_POLARITY(1)),
1240b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_POLARITY(2)),
1241b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_POLARITY(3)),
1242b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_DATA(0)),
1243b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_DATA(1)),
1244b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_DATA(2)),
1245b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_DATA(3)),
1246b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_ENABLE(0)),
1247b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_ENABLE(1)),
1248b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_ENABLE(2)),
1249b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_ENABLE(3)),
1250b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_DATA(0)),
1251b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_INPUT_DATA(1)),
1252b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(0)),
1253b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(1)),
1254b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(2)),
1255b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(3)),
1256b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(4)),
1257b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(5)),
1258b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_OUTPUT_SELECT(6)),
1259b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_MISC_CONTROL),
1260b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_PM0_CONTROL),
1261b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_PM0_DUTY_CYCLE),
1262b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_PM1_CONTROL),
1263b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_PIN_PM1_DUTY_CYCLE),
1264b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_SPI_CONTROL),
1265b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_SPI_START_BYTE),
1266b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_HSPI_WRITE_DATA_AB),
1267b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_HSPI_WRITE_DATA_CD),
1268b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_HSPI_CS_DC),
1269b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_SCRATCH_REGISTER_A),
1270b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_SCRATCH_REGISTER_B),
1271b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_GPIO_CTRL),
1272b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_GPIO_DEBOUNCE_COUNTER),
1273b95800eeSThierry Reding 	DEBUGFS_REG32(DC_COM_CRC_CHECKSUM_LATCHED),
1274b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_SIGNAL_OPTIONS0),
1275b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_SIGNAL_OPTIONS1),
1276b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_WIN_OPTIONS),
1277b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_MEM_HIGH_PRIORITY),
1278b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER),
1279b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_TIMING_OPTIONS),
1280b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_REF_TO_SYNC),
1281b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SYNC_WIDTH),
1282b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_BACK_PORCH),
1283b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_ACTIVE),
1284b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_FRONT_PORCH),
1285b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_CONTROL),
1286b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_POSITION_A),
1287b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_POSITION_B),
1288b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_POSITION_C),
1289b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE0_POSITION_D),
1290b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_CONTROL),
1291b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_POSITION_A),
1292b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_POSITION_B),
1293b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_POSITION_C),
1294b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE1_POSITION_D),
1295b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_CONTROL),
1296b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_POSITION_A),
1297b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_POSITION_B),
1298b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_POSITION_C),
1299b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_H_PULSE2_POSITION_D),
1300b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE0_CONTROL),
1301b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE0_POSITION_A),
1302b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE0_POSITION_B),
1303b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE0_POSITION_C),
1304b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE1_CONTROL),
1305b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE1_POSITION_A),
1306b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE1_POSITION_B),
1307b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE1_POSITION_C),
1308b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE2_CONTROL),
1309b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE2_POSITION_A),
1310b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE3_CONTROL),
1311b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_V_PULSE3_POSITION_A),
1312b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_M0_CONTROL),
1313b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_M1_CONTROL),
1314b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DI_CONTROL),
1315b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_CONTROL),
1316b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_SELECT_A),
1317b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_SELECT_B),
1318b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_SELECT_C),
1319b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_PP_SELECT_D),
1320b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_CLOCK_CONTROL),
1321b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_INTERFACE_CONTROL),
1322b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_COLOR_CONTROL),
1323b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SHIFT_CLOCK_OPTIONS),
1324b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DATA_ENABLE_OPTIONS),
1325b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SERIAL_INTERFACE_OPTIONS),
1326b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_LCD_SPI_OPTIONS),
1327b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_BORDER_COLOR),
1328b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_COLOR_KEY0_LOWER),
1329b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_COLOR_KEY0_UPPER),
1330b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_COLOR_KEY1_LOWER),
1331b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_COLOR_KEY1_UPPER),
1332b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_FOREGROUND),
1333b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_BACKGROUND),
1334b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_START_ADDR),
1335b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_START_ADDR_NS),
1336b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_POSITION),
1337b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_POSITION_NS),
1338b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_INIT_SEQ_CONTROL),
1339b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SPI_INIT_SEQ_DATA_A),
1340b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SPI_INIT_SEQ_DATA_B),
1341b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SPI_INIT_SEQ_DATA_C),
1342b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SPI_INIT_SEQ_DATA_D),
1343b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DC_MCCIF_FIFOCTRL),
1344b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_MCCIF_DISPLAY0A_HYST),
1345b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_MCCIF_DISPLAY0B_HYST),
1346b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_MCCIF_DISPLAY1A_HYST),
1347b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_MCCIF_DISPLAY1B_HYST),
1348b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DAC_CRT_CTRL),
1349b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DISP_MISC_CONTROL),
1350b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_CONTROL),
1351b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_CSC_COEFF),
1352b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(0)),
1353b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(1)),
1354b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(2)),
1355b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(3)),
1356b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(4)),
1357b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(5)),
1358b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(6)),
1359b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(7)),
1360b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_LUT(8)),
1361b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_FLICKER_CONTROL),
1362b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_DC_PIXEL_COUNT),
1363b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(0)),
1364b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(1)),
1365b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(2)),
1366b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(3)),
1367b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(4)),
1368b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(5)),
1369b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(6)),
1370b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HISTOGRAM(7)),
1371b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_TF(0)),
1372b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_TF(1)),
1373b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_TF(2)),
1374b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_TF(3)),
1375b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_BL_CONTROL),
1376b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_HW_K_VALUES),
1377b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_SD_MAN_K_VALUES),
1378b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_CURSOR_START_ADDR_HI),
1379b95800eeSThierry Reding 	DEBUGFS_REG32(DC_DISP_BLEND_CURSOR_CONTROL),
1380b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_WIN_OPTIONS),
1381b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BYTE_SWAP),
1382b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BUFFER_CONTROL),
1383b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_COLOR_DEPTH),
1384b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_POSITION),
1385b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_SIZE),
1386b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_PRESCALED_SIZE),
1387b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_H_INITIAL_DDA),
1388b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_V_INITIAL_DDA),
1389b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_DDA_INC),
1390b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_LINE_STRIDE),
1391b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BUF_STRIDE),
1392b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_UV_BUF_STRIDE),
1393b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BUFFER_ADDR_MODE),
1394b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_DV_CONTROL),
1395b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_NOKEY),
1396b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_1WIN),
1397b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_2WIN_X),
1398b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_2WIN_Y),
1399b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_BLEND_3WIN_XY),
1400b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WIN_HP_FETCH_CONTROL),
1401b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR),
1402b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_NS),
1403b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_U),
1404b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_U_NS),
1405b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_V),
1406b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_START_ADDR_V_NS),
1407b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_ADDR_H_OFFSET),
1408b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_ADDR_H_OFFSET_NS),
1409b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_ADDR_V_OFFSET),
1410b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_ADDR_V_OFFSET_NS),
1411b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_UFLOW_STATUS),
1412b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_AD_UFLOW_STATUS),
1413b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_BD_UFLOW_STATUS),
1414b95800eeSThierry Reding 	DEBUGFS_REG32(DC_WINBUF_CD_UFLOW_STATUS),
1415b95800eeSThierry Reding };
1416b95800eeSThierry Reding 
1417b95800eeSThierry Reding static int tegra_dc_show_regs(struct seq_file *s, void *data)
1418b95800eeSThierry Reding {
1419b95800eeSThierry Reding 	struct drm_info_node *node = s->private;
1420b95800eeSThierry Reding 	struct tegra_dc *dc = node->info_ent->data;
1421b95800eeSThierry Reding 	unsigned int i;
1422b95800eeSThierry Reding 	int err = 0;
1423b95800eeSThierry Reding 
1424b95800eeSThierry Reding 	drm_modeset_lock(&dc->base.mutex, NULL);
1425b95800eeSThierry Reding 
1426b95800eeSThierry Reding 	if (!dc->base.state->active) {
1427b95800eeSThierry Reding 		err = -EBUSY;
1428b95800eeSThierry Reding 		goto unlock;
1429b95800eeSThierry Reding 	}
1430b95800eeSThierry Reding 
1431b95800eeSThierry Reding 	for (i = 0; i < ARRAY_SIZE(tegra_dc_regs); i++) {
1432b95800eeSThierry Reding 		unsigned int offset = tegra_dc_regs[i].offset;
1433b95800eeSThierry Reding 
1434b95800eeSThierry Reding 		seq_printf(s, "%-40s %#05x %08x\n", tegra_dc_regs[i].name,
1435b95800eeSThierry Reding 			   offset, tegra_dc_readl(dc, offset));
1436b95800eeSThierry Reding 	}
1437b95800eeSThierry Reding 
1438b95800eeSThierry Reding unlock:
1439b95800eeSThierry Reding 	drm_modeset_unlock(&dc->base.mutex);
1440b95800eeSThierry Reding 	return err;
1441b95800eeSThierry Reding }
1442b95800eeSThierry Reding 
1443b95800eeSThierry Reding static int tegra_dc_show_crc(struct seq_file *s, void *data)
1444b95800eeSThierry Reding {
1445b95800eeSThierry Reding 	struct drm_info_node *node = s->private;
1446b95800eeSThierry Reding 	struct tegra_dc *dc = node->info_ent->data;
1447b95800eeSThierry Reding 	int err = 0;
1448b95800eeSThierry Reding 	u32 value;
1449b95800eeSThierry Reding 
1450b95800eeSThierry Reding 	drm_modeset_lock(&dc->base.mutex, NULL);
1451b95800eeSThierry Reding 
1452b95800eeSThierry Reding 	if (!dc->base.state->active) {
1453b95800eeSThierry Reding 		err = -EBUSY;
1454b95800eeSThierry Reding 		goto unlock;
1455b95800eeSThierry Reding 	}
1456b95800eeSThierry Reding 
1457b95800eeSThierry Reding 	value = DC_COM_CRC_CONTROL_ACTIVE_DATA | DC_COM_CRC_CONTROL_ENABLE;
1458b95800eeSThierry Reding 	tegra_dc_writel(dc, value, DC_COM_CRC_CONTROL);
1459b95800eeSThierry Reding 	tegra_dc_commit(dc);
1460b95800eeSThierry Reding 
1461b95800eeSThierry Reding 	drm_crtc_wait_one_vblank(&dc->base);
1462b95800eeSThierry Reding 	drm_crtc_wait_one_vblank(&dc->base);
1463b95800eeSThierry Reding 
1464b95800eeSThierry Reding 	value = tegra_dc_readl(dc, DC_COM_CRC_CHECKSUM);
1465b95800eeSThierry Reding 	seq_printf(s, "%08x\n", value);
1466b95800eeSThierry Reding 
1467b95800eeSThierry Reding 	tegra_dc_writel(dc, 0, DC_COM_CRC_CONTROL);
1468b95800eeSThierry Reding 
1469b95800eeSThierry Reding unlock:
1470b95800eeSThierry Reding 	drm_modeset_unlock(&dc->base.mutex);
1471b95800eeSThierry Reding 	return err;
1472b95800eeSThierry Reding }
1473b95800eeSThierry Reding 
1474b95800eeSThierry Reding static int tegra_dc_show_stats(struct seq_file *s, void *data)
1475b95800eeSThierry Reding {
1476b95800eeSThierry Reding 	struct drm_info_node *node = s->private;
1477b95800eeSThierry Reding 	struct tegra_dc *dc = node->info_ent->data;
1478b95800eeSThierry Reding 
1479b95800eeSThierry Reding 	seq_printf(s, "frames: %lu\n", dc->stats.frames);
1480b95800eeSThierry Reding 	seq_printf(s, "vblank: %lu\n", dc->stats.vblank);
1481b95800eeSThierry Reding 	seq_printf(s, "underflow: %lu\n", dc->stats.underflow);
1482b95800eeSThierry Reding 	seq_printf(s, "overflow: %lu\n", dc->stats.overflow);
1483b95800eeSThierry Reding 
1484b95800eeSThierry Reding 	return 0;
1485b95800eeSThierry Reding }
1486b95800eeSThierry Reding 
1487b95800eeSThierry Reding static struct drm_info_list debugfs_files[] = {
1488b95800eeSThierry Reding 	{ "regs", tegra_dc_show_regs, 0, NULL },
1489b95800eeSThierry Reding 	{ "crc", tegra_dc_show_crc, 0, NULL },
1490b95800eeSThierry Reding 	{ "stats", tegra_dc_show_stats, 0, NULL },
1491b95800eeSThierry Reding };
1492b95800eeSThierry Reding 
1493b95800eeSThierry Reding static int tegra_dc_late_register(struct drm_crtc *crtc)
1494b95800eeSThierry Reding {
1495b95800eeSThierry Reding 	unsigned int i, count = ARRAY_SIZE(debugfs_files);
1496b95800eeSThierry Reding 	struct drm_minor *minor = crtc->dev->primary;
149739f55c61SArnd Bergmann 	struct dentry *root;
1498b95800eeSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1499b95800eeSThierry Reding 	int err;
1500b95800eeSThierry Reding 
150139f55c61SArnd Bergmann #ifdef CONFIG_DEBUG_FS
150239f55c61SArnd Bergmann 	root = crtc->debugfs_entry;
150339f55c61SArnd Bergmann #else
150439f55c61SArnd Bergmann 	root = NULL;
150539f55c61SArnd Bergmann #endif
150639f55c61SArnd Bergmann 
1507b95800eeSThierry Reding 	dc->debugfs_files = kmemdup(debugfs_files, sizeof(debugfs_files),
1508b95800eeSThierry Reding 				    GFP_KERNEL);
1509b95800eeSThierry Reding 	if (!dc->debugfs_files)
1510b95800eeSThierry Reding 		return -ENOMEM;
1511b95800eeSThierry Reding 
1512b95800eeSThierry Reding 	for (i = 0; i < count; i++)
1513b95800eeSThierry Reding 		dc->debugfs_files[i].data = dc;
1514b95800eeSThierry Reding 
1515b95800eeSThierry Reding 	err = drm_debugfs_create_files(dc->debugfs_files, count, root, minor);
1516b95800eeSThierry Reding 	if (err < 0)
1517b95800eeSThierry Reding 		goto free;
1518b95800eeSThierry Reding 
1519b95800eeSThierry Reding 	return 0;
1520b95800eeSThierry Reding 
1521b95800eeSThierry Reding free:
1522b95800eeSThierry Reding 	kfree(dc->debugfs_files);
1523b95800eeSThierry Reding 	dc->debugfs_files = NULL;
1524b95800eeSThierry Reding 
1525b95800eeSThierry Reding 	return err;
1526b95800eeSThierry Reding }
1527b95800eeSThierry Reding 
1528b95800eeSThierry Reding static void tegra_dc_early_unregister(struct drm_crtc *crtc)
1529b95800eeSThierry Reding {
1530b95800eeSThierry Reding 	unsigned int count = ARRAY_SIZE(debugfs_files);
1531b95800eeSThierry Reding 	struct drm_minor *minor = crtc->dev->primary;
1532b95800eeSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1533b95800eeSThierry Reding 
1534b95800eeSThierry Reding 	drm_debugfs_remove_files(dc->debugfs_files, count, minor);
1535b95800eeSThierry Reding 	kfree(dc->debugfs_files);
1536b95800eeSThierry Reding 	dc->debugfs_files = NULL;
1537b95800eeSThierry Reding }
1538b95800eeSThierry Reding 
1539c49c81e2SThierry Reding static u32 tegra_dc_get_vblank_counter(struct drm_crtc *crtc)
1540c49c81e2SThierry Reding {
1541c49c81e2SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1542c49c81e2SThierry Reding 
154347307954SThierry Reding 	/* XXX vblank syncpoints don't work with nvdisplay yet */
154447307954SThierry Reding 	if (dc->syncpt && !dc->soc->has_nvdisplay)
1545c49c81e2SThierry Reding 		return host1x_syncpt_read(dc->syncpt);
1546c49c81e2SThierry Reding 
1547c49c81e2SThierry Reding 	/* fallback to software emulated VBLANK counter */
15483abe2413SDhinakaran Pandiyan 	return (u32)drm_crtc_vblank_count(&dc->base);
1549c49c81e2SThierry Reding }
1550c49c81e2SThierry Reding 
1551c49c81e2SThierry Reding static int tegra_dc_enable_vblank(struct drm_crtc *crtc)
1552c49c81e2SThierry Reding {
1553c49c81e2SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1554363541e8SThierry Reding 	u32 value;
1555c49c81e2SThierry Reding 
1556c49c81e2SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_INT_MASK);
1557c49c81e2SThierry Reding 	value |= VBLANK_INT;
1558c49c81e2SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
1559c49c81e2SThierry Reding 
1560c49c81e2SThierry Reding 	return 0;
1561c49c81e2SThierry Reding }
1562c49c81e2SThierry Reding 
1563c49c81e2SThierry Reding static void tegra_dc_disable_vblank(struct drm_crtc *crtc)
1564c49c81e2SThierry Reding {
1565c49c81e2SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1566363541e8SThierry Reding 	u32 value;
1567c49c81e2SThierry Reding 
1568c49c81e2SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_INT_MASK);
1569c49c81e2SThierry Reding 	value &= ~VBLANK_INT;
1570c49c81e2SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
1571c49c81e2SThierry Reding }
1572c49c81e2SThierry Reding 
1573dee8268fSThierry Reding static const struct drm_crtc_funcs tegra_crtc_funcs = {
15741503ca47SThierry Reding 	.page_flip = drm_atomic_helper_page_flip,
157574f48791SThierry Reding 	.set_config = drm_atomic_helper_set_config,
1576f002abc1SThierry Reding 	.destroy = tegra_dc_destroy,
1577ca915b10SThierry Reding 	.reset = tegra_crtc_reset,
1578ca915b10SThierry Reding 	.atomic_duplicate_state = tegra_crtc_atomic_duplicate_state,
1579ca915b10SThierry Reding 	.atomic_destroy_state = tegra_crtc_atomic_destroy_state,
1580b95800eeSThierry Reding 	.late_register = tegra_dc_late_register,
1581b95800eeSThierry Reding 	.early_unregister = tegra_dc_early_unregister,
158210437d9bSShawn Guo 	.get_vblank_counter = tegra_dc_get_vblank_counter,
158310437d9bSShawn Guo 	.enable_vblank = tegra_dc_enable_vblank,
158410437d9bSShawn Guo 	.disable_vblank = tegra_dc_disable_vblank,
1585dee8268fSThierry Reding };
1586dee8268fSThierry Reding 
1587dee8268fSThierry Reding static int tegra_dc_set_timings(struct tegra_dc *dc,
1588dee8268fSThierry Reding 				struct drm_display_mode *mode)
1589dee8268fSThierry Reding {
15900444c0ffSThierry Reding 	unsigned int h_ref_to_sync = 1;
15910444c0ffSThierry Reding 	unsigned int v_ref_to_sync = 1;
1592dee8268fSThierry Reding 	unsigned long value;
1593dee8268fSThierry Reding 
159447307954SThierry Reding 	if (!dc->soc->has_nvdisplay) {
1595dee8268fSThierry Reding 		tegra_dc_writel(dc, 0x0, DC_DISP_DISP_TIMING_OPTIONS);
1596dee8268fSThierry Reding 
1597dee8268fSThierry Reding 		value = (v_ref_to_sync << 16) | h_ref_to_sync;
1598dee8268fSThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_REF_TO_SYNC);
159947307954SThierry Reding 	}
1600dee8268fSThierry Reding 
1601dee8268fSThierry Reding 	value = ((mode->vsync_end - mode->vsync_start) << 16) |
1602dee8268fSThierry Reding 		((mode->hsync_end - mode->hsync_start) <<  0);
1603dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_SYNC_WIDTH);
1604dee8268fSThierry Reding 
1605dee8268fSThierry Reding 	value = ((mode->vtotal - mode->vsync_end) << 16) |
1606dee8268fSThierry Reding 		((mode->htotal - mode->hsync_end) <<  0);
1607dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_BACK_PORCH);
1608dee8268fSThierry Reding 
1609dee8268fSThierry Reding 	value = ((mode->vsync_start - mode->vdisplay) << 16) |
1610dee8268fSThierry Reding 		((mode->hsync_start - mode->hdisplay) <<  0);
1611dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_FRONT_PORCH);
1612dee8268fSThierry Reding 
1613dee8268fSThierry Reding 	value = (mode->vdisplay << 16) | mode->hdisplay;
1614dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_ACTIVE);
1615dee8268fSThierry Reding 
1616dee8268fSThierry Reding 	return 0;
1617dee8268fSThierry Reding }
1618dee8268fSThierry Reding 
16199d910b60SThierry Reding /**
16209d910b60SThierry Reding  * tegra_dc_state_setup_clock - check clock settings and store them in atomic
16219d910b60SThierry Reding  *     state
16229d910b60SThierry Reding  * @dc: display controller
16239d910b60SThierry Reding  * @crtc_state: CRTC atomic state
16249d910b60SThierry Reding  * @clk: parent clock for display controller
16259d910b60SThierry Reding  * @pclk: pixel clock
16269d910b60SThierry Reding  * @div: shift clock divider
16279d910b60SThierry Reding  *
16289d910b60SThierry Reding  * Returns:
16299d910b60SThierry Reding  * 0 on success or a negative error-code on failure.
16309d910b60SThierry Reding  */
1631ca915b10SThierry Reding int tegra_dc_state_setup_clock(struct tegra_dc *dc,
1632ca915b10SThierry Reding 			       struct drm_crtc_state *crtc_state,
1633ca915b10SThierry Reding 			       struct clk *clk, unsigned long pclk,
1634ca915b10SThierry Reding 			       unsigned int div)
1635ca915b10SThierry Reding {
1636ca915b10SThierry Reding 	struct tegra_dc_state *state = to_dc_state(crtc_state);
1637ca915b10SThierry Reding 
1638d2982748SThierry Reding 	if (!clk_has_parent(dc->clk, clk))
1639d2982748SThierry Reding 		return -EINVAL;
1640d2982748SThierry Reding 
1641ca915b10SThierry Reding 	state->clk = clk;
1642ca915b10SThierry Reding 	state->pclk = pclk;
1643ca915b10SThierry Reding 	state->div = div;
1644ca915b10SThierry Reding 
1645ca915b10SThierry Reding 	return 0;
1646ca915b10SThierry Reding }
1647ca915b10SThierry Reding 
164876d59ed0SThierry Reding static void tegra_dc_commit_state(struct tegra_dc *dc,
164976d59ed0SThierry Reding 				  struct tegra_dc_state *state)
165076d59ed0SThierry Reding {
165176d59ed0SThierry Reding 	u32 value;
165276d59ed0SThierry Reding 	int err;
165376d59ed0SThierry Reding 
165476d59ed0SThierry Reding 	err = clk_set_parent(dc->clk, state->clk);
165576d59ed0SThierry Reding 	if (err < 0)
165676d59ed0SThierry Reding 		dev_err(dc->dev, "failed to set parent clock: %d\n", err);
165776d59ed0SThierry Reding 
165876d59ed0SThierry Reding 	/*
165976d59ed0SThierry Reding 	 * Outputs may not want to change the parent clock rate. This is only
166076d59ed0SThierry Reding 	 * relevant to Tegra20 where only a single display PLL is available.
166176d59ed0SThierry Reding 	 * Since that PLL would typically be used for HDMI, an internal LVDS
166276d59ed0SThierry Reding 	 * panel would need to be driven by some other clock such as PLL_P
166376d59ed0SThierry Reding 	 * which is shared with other peripherals. Changing the clock rate
166476d59ed0SThierry Reding 	 * should therefore be avoided.
166576d59ed0SThierry Reding 	 */
166676d59ed0SThierry Reding 	if (state->pclk > 0) {
166776d59ed0SThierry Reding 		err = clk_set_rate(state->clk, state->pclk);
166876d59ed0SThierry Reding 		if (err < 0)
166976d59ed0SThierry Reding 			dev_err(dc->dev,
167076d59ed0SThierry Reding 				"failed to set clock rate to %lu Hz\n",
167176d59ed0SThierry Reding 				state->pclk);
167276d59ed0SThierry Reding 	}
167376d59ed0SThierry Reding 
167476d59ed0SThierry Reding 	DRM_DEBUG_KMS("rate: %lu, div: %u\n", clk_get_rate(dc->clk),
167576d59ed0SThierry Reding 		      state->div);
167676d59ed0SThierry Reding 	DRM_DEBUG_KMS("pclk: %lu\n", state->pclk);
167776d59ed0SThierry Reding 
167847307954SThierry Reding 	if (!dc->soc->has_nvdisplay) {
167976d59ed0SThierry Reding 		value = SHIFT_CLK_DIVIDER(state->div) | PIXEL_CLK_DIVIDER_PCD1;
168076d59ed0SThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_DISP_CLOCK_CONTROL);
168147307954SThierry Reding 	}
168239e08affSThierry Reding 
168339e08affSThierry Reding 	err = clk_set_rate(dc->clk, state->pclk);
168439e08affSThierry Reding 	if (err < 0)
168539e08affSThierry Reding 		dev_err(dc->dev, "failed to set clock %pC to %lu Hz: %d\n",
168639e08affSThierry Reding 			dc->clk, state->pclk, err);
168776d59ed0SThierry Reding }
168876d59ed0SThierry Reding 
1689003fc848SThierry Reding static void tegra_dc_stop(struct tegra_dc *dc)
1690003fc848SThierry Reding {
1691003fc848SThierry Reding 	u32 value;
1692003fc848SThierry Reding 
1693003fc848SThierry Reding 	/* stop the display controller */
1694003fc848SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_DISPLAY_COMMAND);
1695003fc848SThierry Reding 	value &= ~DISP_CTRL_MODE_MASK;
1696003fc848SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_DISPLAY_COMMAND);
1697003fc848SThierry Reding 
1698003fc848SThierry Reding 	tegra_dc_commit(dc);
1699003fc848SThierry Reding }
1700003fc848SThierry Reding 
1701003fc848SThierry Reding static bool tegra_dc_idle(struct tegra_dc *dc)
1702003fc848SThierry Reding {
1703003fc848SThierry Reding 	u32 value;
1704003fc848SThierry Reding 
1705003fc848SThierry Reding 	value = tegra_dc_readl_active(dc, DC_CMD_DISPLAY_COMMAND);
1706003fc848SThierry Reding 
1707003fc848SThierry Reding 	return (value & DISP_CTRL_MODE_MASK) == 0;
1708003fc848SThierry Reding }
1709003fc848SThierry Reding 
1710003fc848SThierry Reding static int tegra_dc_wait_idle(struct tegra_dc *dc, unsigned long timeout)
1711003fc848SThierry Reding {
1712003fc848SThierry Reding 	timeout = jiffies + msecs_to_jiffies(timeout);
1713003fc848SThierry Reding 
1714003fc848SThierry Reding 	while (time_before(jiffies, timeout)) {
1715003fc848SThierry Reding 		if (tegra_dc_idle(dc))
1716003fc848SThierry Reding 			return 0;
1717003fc848SThierry Reding 
1718003fc848SThierry Reding 		usleep_range(1000, 2000);
1719003fc848SThierry Reding 	}
1720003fc848SThierry Reding 
1721003fc848SThierry Reding 	dev_dbg(dc->dev, "timeout waiting for DC to become idle\n");
1722003fc848SThierry Reding 	return -ETIMEDOUT;
1723003fc848SThierry Reding }
1724003fc848SThierry Reding 
172564581714SLaurent Pinchart static void tegra_crtc_atomic_disable(struct drm_crtc *crtc,
172664581714SLaurent Pinchart 				      struct drm_crtc_state *old_state)
1727003fc848SThierry Reding {
1728003fc848SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1729003fc848SThierry Reding 	u32 value;
1730003fc848SThierry Reding 
1731003fc848SThierry Reding 	if (!tegra_dc_idle(dc)) {
1732003fc848SThierry Reding 		tegra_dc_stop(dc);
1733003fc848SThierry Reding 
1734003fc848SThierry Reding 		/*
1735003fc848SThierry Reding 		 * Ignore the return value, there isn't anything useful to do
1736003fc848SThierry Reding 		 * in case this fails.
1737003fc848SThierry Reding 		 */
1738003fc848SThierry Reding 		tegra_dc_wait_idle(dc, 100);
1739003fc848SThierry Reding 	}
1740003fc848SThierry Reding 
1741003fc848SThierry Reding 	/*
1742003fc848SThierry Reding 	 * This should really be part of the RGB encoder driver, but clearing
1743003fc848SThierry Reding 	 * these bits has the side-effect of stopping the display controller.
1744003fc848SThierry Reding 	 * When that happens no VBLANK interrupts will be raised. At the same
1745003fc848SThierry Reding 	 * time the encoder is disabled before the display controller, so the
1746003fc848SThierry Reding 	 * above code is always going to timeout waiting for the controller
1747003fc848SThierry Reding 	 * to go idle.
1748003fc848SThierry Reding 	 *
1749003fc848SThierry Reding 	 * Given the close coupling between the RGB encoder and the display
1750003fc848SThierry Reding 	 * controller doing it here is still kind of okay. None of the other
1751003fc848SThierry Reding 	 * encoder drivers require these bits to be cleared.
1752003fc848SThierry Reding 	 *
1753003fc848SThierry Reding 	 * XXX: Perhaps given that the display controller is switched off at
1754003fc848SThierry Reding 	 * this point anyway maybe clearing these bits isn't even useful for
1755003fc848SThierry Reding 	 * the RGB encoder?
1756003fc848SThierry Reding 	 */
1757003fc848SThierry Reding 	if (dc->rgb) {
1758003fc848SThierry Reding 		value = tegra_dc_readl(dc, DC_CMD_DISPLAY_POWER_CONTROL);
1759003fc848SThierry Reding 		value &= ~(PW0_ENABLE | PW1_ENABLE | PW2_ENABLE | PW3_ENABLE |
1760003fc848SThierry Reding 			   PW4_ENABLE | PM0_ENABLE | PM1_ENABLE);
1761003fc848SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_DISPLAY_POWER_CONTROL);
1762003fc848SThierry Reding 	}
1763003fc848SThierry Reding 
1764003fc848SThierry Reding 	tegra_dc_stats_reset(&dc->stats);
1765003fc848SThierry Reding 	drm_crtc_vblank_off(crtc);
176633a8eb8dSThierry Reding 
17679d99ab6eSThierry Reding 	spin_lock_irq(&crtc->dev->event_lock);
17689d99ab6eSThierry Reding 
17699d99ab6eSThierry Reding 	if (crtc->state->event) {
17709d99ab6eSThierry Reding 		drm_crtc_send_vblank_event(crtc, crtc->state->event);
17719d99ab6eSThierry Reding 		crtc->state->event = NULL;
17729d99ab6eSThierry Reding 	}
17739d99ab6eSThierry Reding 
17749d99ab6eSThierry Reding 	spin_unlock_irq(&crtc->dev->event_lock);
17759d99ab6eSThierry Reding 
177633a8eb8dSThierry Reding 	pm_runtime_put_sync(dc->dev);
1777003fc848SThierry Reding }
1778003fc848SThierry Reding 
17790b20a0f8SLaurent Pinchart static void tegra_crtc_atomic_enable(struct drm_crtc *crtc,
17800b20a0f8SLaurent Pinchart 				     struct drm_crtc_state *old_state)
1781dee8268fSThierry Reding {
17824aa3df71SThierry Reding 	struct drm_display_mode *mode = &crtc->state->adjusted_mode;
178376d59ed0SThierry Reding 	struct tegra_dc_state *state = to_dc_state(crtc->state);
1784dee8268fSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1785dbb3f2f7SThierry Reding 	u32 value;
1786dee8268fSThierry Reding 
178733a8eb8dSThierry Reding 	pm_runtime_get_sync(dc->dev);
178833a8eb8dSThierry Reding 
178933a8eb8dSThierry Reding 	/* initialize display controller */
179033a8eb8dSThierry Reding 	if (dc->syncpt) {
179147307954SThierry Reding 		u32 syncpt = host1x_syncpt_id(dc->syncpt), enable;
179247307954SThierry Reding 
179347307954SThierry Reding 		if (dc->soc->has_nvdisplay)
179447307954SThierry Reding 			enable = 1 << 31;
179547307954SThierry Reding 		else
179647307954SThierry Reding 			enable = 1 << 8;
179733a8eb8dSThierry Reding 
179833a8eb8dSThierry Reding 		value = SYNCPT_CNTRL_NO_STALL;
179933a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_GENERAL_INCR_SYNCPT_CNTRL);
180033a8eb8dSThierry Reding 
180147307954SThierry Reding 		value = enable | syncpt;
180233a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_CONT_SYNCPT_VSYNC);
180333a8eb8dSThierry Reding 	}
180433a8eb8dSThierry Reding 
180547307954SThierry Reding 	if (dc->soc->has_nvdisplay) {
180647307954SThierry Reding 		value = DSC_TO_UF_INT | DSC_BBUF_UF_INT | DSC_RBUF_UF_INT |
180747307954SThierry Reding 			DSC_OBUF_UF_INT;
180847307954SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_TYPE);
180947307954SThierry Reding 
181047307954SThierry Reding 		value = DSC_TO_UF_INT | DSC_BBUF_UF_INT | DSC_RBUF_UF_INT |
181147307954SThierry Reding 			DSC_OBUF_UF_INT | SD3_BUCKET_WALK_DONE_INT |
181247307954SThierry Reding 			HEAD_UF_INT | MSF_INT | REG_TMOUT_INT |
181347307954SThierry Reding 			REGION_CRC_INT | V_PULSE2_INT | V_PULSE3_INT |
181447307954SThierry Reding 			VBLANK_INT | FRAME_END_INT;
181547307954SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_POLARITY);
181647307954SThierry Reding 
181747307954SThierry Reding 		value = SD3_BUCKET_WALK_DONE_INT | HEAD_UF_INT | VBLANK_INT |
181847307954SThierry Reding 			FRAME_END_INT;
181947307954SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_ENABLE);
182047307954SThierry Reding 
182147307954SThierry Reding 		value = HEAD_UF_INT | REG_TMOUT_INT | FRAME_END_INT;
182247307954SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
182347307954SThierry Reding 
182447307954SThierry Reding 		tegra_dc_writel(dc, READ_MUX, DC_CMD_STATE_ACCESS);
182547307954SThierry Reding 	} else {
182633a8eb8dSThierry Reding 		value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT |
182733a8eb8dSThierry Reding 			WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT;
182833a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_TYPE);
182933a8eb8dSThierry Reding 
183033a8eb8dSThierry Reding 		value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT |
183133a8eb8dSThierry Reding 			WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT;
183233a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_POLARITY);
183333a8eb8dSThierry Reding 
183433a8eb8dSThierry Reding 		/* initialize timer */
183533a8eb8dSThierry Reding 		value = CURSOR_THRESHOLD(0) | WINDOW_A_THRESHOLD(0x20) |
183633a8eb8dSThierry Reding 			WINDOW_B_THRESHOLD(0x20) | WINDOW_C_THRESHOLD(0x20);
183733a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_DISP_MEM_HIGH_PRIORITY);
183833a8eb8dSThierry Reding 
183933a8eb8dSThierry Reding 		value = CURSOR_THRESHOLD(0) | WINDOW_A_THRESHOLD(1) |
184033a8eb8dSThierry Reding 			WINDOW_B_THRESHOLD(1) | WINDOW_C_THRESHOLD(1);
184133a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER);
184233a8eb8dSThierry Reding 
184333a8eb8dSThierry Reding 		value = VBLANK_INT | WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT |
184433a8eb8dSThierry Reding 			WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT;
184533a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_ENABLE);
184633a8eb8dSThierry Reding 
184733a8eb8dSThierry Reding 		value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT |
184833a8eb8dSThierry Reding 			WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT;
184933a8eb8dSThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
185047307954SThierry Reding 	}
185133a8eb8dSThierry Reding 
18527116e9a8SThierry Reding 	if (dc->soc->supports_background_color)
18537116e9a8SThierry Reding 		tegra_dc_writel(dc, 0, DC_DISP_BLEND_BACKGROUND_COLOR);
18547116e9a8SThierry Reding 	else
185533a8eb8dSThierry Reding 		tegra_dc_writel(dc, 0, DC_DISP_BORDER_COLOR);
185633a8eb8dSThierry Reding 
185733a8eb8dSThierry Reding 	/* apply PLL and pixel clock changes */
185876d59ed0SThierry Reding 	tegra_dc_commit_state(dc, state);
185976d59ed0SThierry Reding 
1860dee8268fSThierry Reding 	/* program display mode */
1861dee8268fSThierry Reding 	tegra_dc_set_timings(dc, mode);
1862dee8268fSThierry Reding 
18638620fc62SThierry Reding 	/* interlacing isn't supported yet, so disable it */
18648620fc62SThierry Reding 	if (dc->soc->supports_interlacing) {
18658620fc62SThierry Reding 		value = tegra_dc_readl(dc, DC_DISP_INTERLACE_CONTROL);
18668620fc62SThierry Reding 		value &= ~INTERLACE_ENABLE;
18678620fc62SThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_INTERLACE_CONTROL);
18688620fc62SThierry Reding 	}
1869666cb873SThierry Reding 
1870666cb873SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_DISPLAY_COMMAND);
1871666cb873SThierry Reding 	value &= ~DISP_CTRL_MODE_MASK;
1872666cb873SThierry Reding 	value |= DISP_CTRL_MODE_C_DISPLAY;
1873666cb873SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_DISPLAY_COMMAND);
1874666cb873SThierry Reding 
187547307954SThierry Reding 	if (!dc->soc->has_nvdisplay) {
1876666cb873SThierry Reding 		value = tegra_dc_readl(dc, DC_CMD_DISPLAY_POWER_CONTROL);
1877666cb873SThierry Reding 		value |= PW0_ENABLE | PW1_ENABLE | PW2_ENABLE | PW3_ENABLE |
1878666cb873SThierry Reding 			 PW4_ENABLE | PM0_ENABLE | PM1_ENABLE;
1879666cb873SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_DISPLAY_POWER_CONTROL);
188047307954SThierry Reding 	}
188147307954SThierry Reding 
188247307954SThierry Reding 	/* enable underflow reporting and display red for missing pixels */
188347307954SThierry Reding 	if (dc->soc->has_nvdisplay) {
188447307954SThierry Reding 		value = UNDERFLOW_MODE_RED | UNDERFLOW_REPORT_ENABLE;
188547307954SThierry Reding 		tegra_dc_writel(dc, value, DC_COM_RG_UNDERFLOW);
188647307954SThierry Reding 	}
1887666cb873SThierry Reding 
1888666cb873SThierry Reding 	tegra_dc_commit(dc);
1889dee8268fSThierry Reding 
18908ff64c17SThierry Reding 	drm_crtc_vblank_on(crtc);
1891dee8268fSThierry Reding }
1892dee8268fSThierry Reding 
1893613d2b27SMaarten Lankhorst static void tegra_crtc_atomic_begin(struct drm_crtc *crtc,
1894613d2b27SMaarten Lankhorst 				    struct drm_crtc_state *old_crtc_state)
18954aa3df71SThierry Reding {
18969d99ab6eSThierry Reding 	unsigned long flags;
18971503ca47SThierry Reding 
18981503ca47SThierry Reding 	if (crtc->state->event) {
18999d99ab6eSThierry Reding 		spin_lock_irqsave(&crtc->dev->event_lock, flags);
19001503ca47SThierry Reding 
19019d99ab6eSThierry Reding 		if (drm_crtc_vblank_get(crtc) != 0)
19029d99ab6eSThierry Reding 			drm_crtc_send_vblank_event(crtc, crtc->state->event);
19039d99ab6eSThierry Reding 		else
19049d99ab6eSThierry Reding 			drm_crtc_arm_vblank_event(crtc, crtc->state->event);
19051503ca47SThierry Reding 
19069d99ab6eSThierry Reding 		spin_unlock_irqrestore(&crtc->dev->event_lock, flags);
19079d99ab6eSThierry Reding 
19081503ca47SThierry Reding 		crtc->state->event = NULL;
19091503ca47SThierry Reding 	}
19104aa3df71SThierry Reding }
19114aa3df71SThierry Reding 
1912613d2b27SMaarten Lankhorst static void tegra_crtc_atomic_flush(struct drm_crtc *crtc,
1913613d2b27SMaarten Lankhorst 				    struct drm_crtc_state *old_crtc_state)
19144aa3df71SThierry Reding {
191547802b09SThierry Reding 	struct tegra_dc_state *state = to_dc_state(crtc->state);
191647802b09SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
191747307954SThierry Reding 	u32 value;
191847802b09SThierry Reding 
191947307954SThierry Reding 	value = state->planes << 8 | GENERAL_UPDATE;
192047307954SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL);
192147307954SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_STATE_CONTROL);
192247307954SThierry Reding 
192347307954SThierry Reding 	value = state->planes | GENERAL_ACT_REQ;
192447307954SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL);
192547307954SThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_STATE_CONTROL);
19264aa3df71SThierry Reding }
19274aa3df71SThierry Reding 
1928dee8268fSThierry Reding static const struct drm_crtc_helper_funcs tegra_crtc_helper_funcs = {
19294aa3df71SThierry Reding 	.atomic_begin = tegra_crtc_atomic_begin,
19304aa3df71SThierry Reding 	.atomic_flush = tegra_crtc_atomic_flush,
19310b20a0f8SLaurent Pinchart 	.atomic_enable = tegra_crtc_atomic_enable,
193264581714SLaurent Pinchart 	.atomic_disable = tegra_crtc_atomic_disable,
1933dee8268fSThierry Reding };
1934dee8268fSThierry Reding 
1935dee8268fSThierry Reding static irqreturn_t tegra_dc_irq(int irq, void *data)
1936dee8268fSThierry Reding {
1937dee8268fSThierry Reding 	struct tegra_dc *dc = data;
1938dee8268fSThierry Reding 	unsigned long status;
1939dee8268fSThierry Reding 
1940dee8268fSThierry Reding 	status = tegra_dc_readl(dc, DC_CMD_INT_STATUS);
1941dee8268fSThierry Reding 	tegra_dc_writel(dc, status, DC_CMD_INT_STATUS);
1942dee8268fSThierry Reding 
1943dee8268fSThierry Reding 	if (status & FRAME_END_INT) {
1944dee8268fSThierry Reding 		/*
1945dee8268fSThierry Reding 		dev_dbg(dc->dev, "%s(): frame end\n", __func__);
1946dee8268fSThierry Reding 		*/
1947791ddb1eSThierry Reding 		dc->stats.frames++;
1948dee8268fSThierry Reding 	}
1949dee8268fSThierry Reding 
1950dee8268fSThierry Reding 	if (status & VBLANK_INT) {
1951dee8268fSThierry Reding 		/*
1952dee8268fSThierry Reding 		dev_dbg(dc->dev, "%s(): vertical blank\n", __func__);
1953dee8268fSThierry Reding 		*/
1954ed7dae58SThierry Reding 		drm_crtc_handle_vblank(&dc->base);
1955791ddb1eSThierry Reding 		dc->stats.vblank++;
1956dee8268fSThierry Reding 	}
1957dee8268fSThierry Reding 
1958dee8268fSThierry Reding 	if (status & (WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT)) {
1959dee8268fSThierry Reding 		/*
1960dee8268fSThierry Reding 		dev_dbg(dc->dev, "%s(): underflow\n", __func__);
1961dee8268fSThierry Reding 		*/
1962791ddb1eSThierry Reding 		dc->stats.underflow++;
1963791ddb1eSThierry Reding 	}
1964791ddb1eSThierry Reding 
1965791ddb1eSThierry Reding 	if (status & (WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT)) {
1966791ddb1eSThierry Reding 		/*
1967791ddb1eSThierry Reding 		dev_dbg(dc->dev, "%s(): overflow\n", __func__);
1968791ddb1eSThierry Reding 		*/
1969791ddb1eSThierry Reding 		dc->stats.overflow++;
1970dee8268fSThierry Reding 	}
1971dee8268fSThierry Reding 
197247307954SThierry Reding 	if (status & HEAD_UF_INT) {
197347307954SThierry Reding 		dev_dbg_ratelimited(dc->dev, "%s(): head underflow\n", __func__);
197447307954SThierry Reding 		dc->stats.underflow++;
197547307954SThierry Reding 	}
197647307954SThierry Reding 
1977dee8268fSThierry Reding 	return IRQ_HANDLED;
1978dee8268fSThierry Reding }
1979dee8268fSThierry Reding 
1980e75d0477SThierry Reding static bool tegra_dc_has_window_groups(struct tegra_dc *dc)
1981e75d0477SThierry Reding {
1982e75d0477SThierry Reding 	unsigned int i;
1983e75d0477SThierry Reding 
1984e75d0477SThierry Reding 	if (!dc->soc->wgrps)
1985e75d0477SThierry Reding 		return true;
1986e75d0477SThierry Reding 
1987e75d0477SThierry Reding 	for (i = 0; i < dc->soc->num_wgrps; i++) {
1988e75d0477SThierry Reding 		const struct tegra_windowgroup_soc *wgrp = &dc->soc->wgrps[i];
1989e75d0477SThierry Reding 
1990e75d0477SThierry Reding 		if (wgrp->dc == dc->pipe && wgrp->num_windows > 0)
1991e75d0477SThierry Reding 			return true;
1992e75d0477SThierry Reding 	}
1993e75d0477SThierry Reding 
1994e75d0477SThierry Reding 	return false;
1995e75d0477SThierry Reding }
1996e75d0477SThierry Reding 
1997dee8268fSThierry Reding static int tegra_dc_init(struct host1x_client *client)
1998dee8268fSThierry Reding {
19999910f5c4SThierry Reding 	struct drm_device *drm = dev_get_drvdata(client->parent);
20002bcdcbfaSThierry Reding 	unsigned long flags = HOST1X_SYNCPT_CLIENT_MANAGED;
2001dee8268fSThierry Reding 	struct tegra_dc *dc = host1x_client_to_dc(client);
2002d1f3e1e0SThierry Reding 	struct tegra_drm *tegra = drm->dev_private;
2003c7679306SThierry Reding 	struct drm_plane *primary = NULL;
2004c7679306SThierry Reding 	struct drm_plane *cursor = NULL;
2005dee8268fSThierry Reding 	int err;
2006dee8268fSThierry Reding 
2007759d706fSThierry Reding 	/*
2008759d706fSThierry Reding 	 * XXX do not register DCs with no window groups because we cannot
2009759d706fSThierry Reding 	 * assign a primary plane to them, which in turn will cause KMS to
2010759d706fSThierry Reding 	 * crash.
2011759d706fSThierry Reding 	 */
2012e75d0477SThierry Reding 	if (!tegra_dc_has_window_groups(dc))
2013759d706fSThierry Reding 		return 0;
2014759d706fSThierry Reding 
2015617dd7ccSThierry Reding 	dc->syncpt = host1x_syncpt_request(client, flags);
20162bcdcbfaSThierry Reding 	if (!dc->syncpt)
20172bcdcbfaSThierry Reding 		dev_warn(dc->dev, "failed to allocate syncpoint\n");
20182bcdcbfaSThierry Reding 
20197edd7961SThierry Reding 	err = host1x_client_iommu_attach(client);
2020*a8817489SThierry Reding 	if (err < 0 && err != -ENODEV) {
20210c407de5SThierry Reding 		dev_err(client->dev, "failed to attach to domain: %d\n", err);
2022df06b759SThierry Reding 		return err;
2023df06b759SThierry Reding 	}
2024df06b759SThierry Reding 
202547307954SThierry Reding 	if (dc->soc->wgrps)
202647307954SThierry Reding 		primary = tegra_dc_add_shared_planes(drm, dc);
202747307954SThierry Reding 	else
202847307954SThierry Reding 		primary = tegra_dc_add_planes(drm, dc);
202947307954SThierry Reding 
2030c7679306SThierry Reding 	if (IS_ERR(primary)) {
2031c7679306SThierry Reding 		err = PTR_ERR(primary);
2032c7679306SThierry Reding 		goto cleanup;
2033c7679306SThierry Reding 	}
2034c7679306SThierry Reding 
2035c7679306SThierry Reding 	if (dc->soc->supports_cursor) {
2036c7679306SThierry Reding 		cursor = tegra_dc_cursor_plane_create(drm, dc);
2037c7679306SThierry Reding 		if (IS_ERR(cursor)) {
2038c7679306SThierry Reding 			err = PTR_ERR(cursor);
2039c7679306SThierry Reding 			goto cleanup;
2040c7679306SThierry Reding 		}
20419f446d83SDmitry Osipenko 	} else {
20429f446d83SDmitry Osipenko 		/* dedicate one overlay to mouse cursor */
20439f446d83SDmitry Osipenko 		cursor = tegra_dc_overlay_plane_create(drm, dc, 2, true);
20449f446d83SDmitry Osipenko 		if (IS_ERR(cursor)) {
20459f446d83SDmitry Osipenko 			err = PTR_ERR(cursor);
20469f446d83SDmitry Osipenko 			goto cleanup;
20479f446d83SDmitry Osipenko 		}
2048c7679306SThierry Reding 	}
2049c7679306SThierry Reding 
2050c7679306SThierry Reding 	err = drm_crtc_init_with_planes(drm, &dc->base, primary, cursor,
2051f9882876SVille Syrjälä 					&tegra_crtc_funcs, NULL);
2052c7679306SThierry Reding 	if (err < 0)
2053c7679306SThierry Reding 		goto cleanup;
2054c7679306SThierry Reding 
2055dee8268fSThierry Reding 	drm_crtc_helper_add(&dc->base, &tegra_crtc_helper_funcs);
2056dee8268fSThierry Reding 
2057d1f3e1e0SThierry Reding 	/*
2058d1f3e1e0SThierry Reding 	 * Keep track of the minimum pitch alignment across all display
2059d1f3e1e0SThierry Reding 	 * controllers.
2060d1f3e1e0SThierry Reding 	 */
2061d1f3e1e0SThierry Reding 	if (dc->soc->pitch_align > tegra->pitch_align)
2062d1f3e1e0SThierry Reding 		tegra->pitch_align = dc->soc->pitch_align;
2063d1f3e1e0SThierry Reding 
20649910f5c4SThierry Reding 	err = tegra_dc_rgb_init(drm, dc);
2065dee8268fSThierry Reding 	if (err < 0 && err != -ENODEV) {
2066dee8268fSThierry Reding 		dev_err(dc->dev, "failed to initialize RGB output: %d\n", err);
2067c7679306SThierry Reding 		goto cleanup;
2068dee8268fSThierry Reding 	}
2069dee8268fSThierry Reding 
2070dee8268fSThierry Reding 	err = devm_request_irq(dc->dev, dc->irq, tegra_dc_irq, 0,
2071dee8268fSThierry Reding 			       dev_name(dc->dev), dc);
2072dee8268fSThierry Reding 	if (err < 0) {
2073dee8268fSThierry Reding 		dev_err(dc->dev, "failed to request IRQ#%u: %d\n", dc->irq,
2074dee8268fSThierry Reding 			err);
2075c7679306SThierry Reding 		goto cleanup;
2076dee8268fSThierry Reding 	}
2077dee8268fSThierry Reding 
207847b15779SThierry Reding 	/*
207947b15779SThierry Reding 	 * Inherit the DMA parameters (such as maximum segment size) from the
208047b15779SThierry Reding 	 * parent device.
208147b15779SThierry Reding 	 */
208247b15779SThierry Reding 	client->dev->dma_parms = client->parent->dma_parms;
208347b15779SThierry Reding 
2084dee8268fSThierry Reding 	return 0;
2085c7679306SThierry Reding 
2086c7679306SThierry Reding cleanup:
208747307954SThierry Reding 	if (!IS_ERR_OR_NULL(cursor))
2088c7679306SThierry Reding 		drm_plane_cleanup(cursor);
2089c7679306SThierry Reding 
209047307954SThierry Reding 	if (!IS_ERR(primary))
2091c7679306SThierry Reding 		drm_plane_cleanup(primary);
2092c7679306SThierry Reding 
2093aacdf198SThierry Reding 	host1x_client_iommu_detach(client);
2094fd5ec0dcSThierry Reding 	host1x_syncpt_free(dc->syncpt);
2095fd5ec0dcSThierry Reding 
2096c7679306SThierry Reding 	return err;
2097dee8268fSThierry Reding }
2098dee8268fSThierry Reding 
2099dee8268fSThierry Reding static int tegra_dc_exit(struct host1x_client *client)
2100dee8268fSThierry Reding {
2101dee8268fSThierry Reding 	struct tegra_dc *dc = host1x_client_to_dc(client);
2102dee8268fSThierry Reding 	int err;
2103dee8268fSThierry Reding 
2104e75d0477SThierry Reding 	if (!tegra_dc_has_window_groups(dc))
2105e75d0477SThierry Reding 		return 0;
2106e75d0477SThierry Reding 
210747b15779SThierry Reding 	/* avoid a dangling pointer just in case this disappears */
210847b15779SThierry Reding 	client->dev->dma_parms = NULL;
210947b15779SThierry Reding 
2110dee8268fSThierry Reding 	devm_free_irq(dc->dev, dc->irq, dc);
2111dee8268fSThierry Reding 
2112dee8268fSThierry Reding 	err = tegra_dc_rgb_exit(dc);
2113dee8268fSThierry Reding 	if (err) {
2114dee8268fSThierry Reding 		dev_err(dc->dev, "failed to shutdown RGB output: %d\n", err);
2115dee8268fSThierry Reding 		return err;
2116dee8268fSThierry Reding 	}
2117dee8268fSThierry Reding 
2118aacdf198SThierry Reding 	host1x_client_iommu_detach(client);
21192bcdcbfaSThierry Reding 	host1x_syncpt_free(dc->syncpt);
21202bcdcbfaSThierry Reding 
2121dee8268fSThierry Reding 	return 0;
2122dee8268fSThierry Reding }
2123dee8268fSThierry Reding 
2124dee8268fSThierry Reding static const struct host1x_client_ops dc_client_ops = {
2125dee8268fSThierry Reding 	.init = tegra_dc_init,
2126dee8268fSThierry Reding 	.exit = tegra_dc_exit,
2127dee8268fSThierry Reding };
2128dee8268fSThierry Reding 
21298620fc62SThierry Reding static const struct tegra_dc_soc_info tegra20_dc_soc_info = {
21307116e9a8SThierry Reding 	.supports_background_color = false,
21318620fc62SThierry Reding 	.supports_interlacing = false,
2132e687651bSThierry Reding 	.supports_cursor = false,
2133c134f019SThierry Reding 	.supports_block_linear = false,
2134a43d0a00SDmitry Osipenko 	.has_legacy_blending = true,
2135d1f3e1e0SThierry Reding 	.pitch_align = 8,
21369c012700SThierry Reding 	.has_powergate = false,
2137f68ba691SDmitry Osipenko 	.coupled_pm = true,
213847307954SThierry Reding 	.has_nvdisplay = false,
2139511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra20_primary_formats),
2140511c7023SThierry Reding 	.primary_formats = tegra20_primary_formats,
2141511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra20_overlay_formats),
2142511c7023SThierry Reding 	.overlay_formats = tegra20_overlay_formats,
2143e90124cbSThierry Reding 	.modifiers = tegra20_modifiers,
2144acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = true,
2145acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = true,
21468620fc62SThierry Reding };
21478620fc62SThierry Reding 
21488620fc62SThierry Reding static const struct tegra_dc_soc_info tegra30_dc_soc_info = {
21497116e9a8SThierry Reding 	.supports_background_color = false,
21508620fc62SThierry Reding 	.supports_interlacing = false,
2151e687651bSThierry Reding 	.supports_cursor = false,
2152c134f019SThierry Reding 	.supports_block_linear = false,
2153a43d0a00SDmitry Osipenko 	.has_legacy_blending = true,
2154d1f3e1e0SThierry Reding 	.pitch_align = 8,
21559c012700SThierry Reding 	.has_powergate = false,
2156f68ba691SDmitry Osipenko 	.coupled_pm = false,
215747307954SThierry Reding 	.has_nvdisplay = false,
2158511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra20_primary_formats),
2159511c7023SThierry Reding 	.primary_formats = tegra20_primary_formats,
2160511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra20_overlay_formats),
2161511c7023SThierry Reding 	.overlay_formats = tegra20_overlay_formats,
2162e90124cbSThierry Reding 	.modifiers = tegra20_modifiers,
2163acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = false,
2164acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = false,
2165d1f3e1e0SThierry Reding };
2166d1f3e1e0SThierry Reding 
2167d1f3e1e0SThierry Reding static const struct tegra_dc_soc_info tegra114_dc_soc_info = {
21687116e9a8SThierry Reding 	.supports_background_color = false,
2169d1f3e1e0SThierry Reding 	.supports_interlacing = false,
2170d1f3e1e0SThierry Reding 	.supports_cursor = false,
2171d1f3e1e0SThierry Reding 	.supports_block_linear = false,
2172a43d0a00SDmitry Osipenko 	.has_legacy_blending = true,
2173d1f3e1e0SThierry Reding 	.pitch_align = 64,
21749c012700SThierry Reding 	.has_powergate = true,
2175f68ba691SDmitry Osipenko 	.coupled_pm = false,
217647307954SThierry Reding 	.has_nvdisplay = false,
2177511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra114_primary_formats),
2178511c7023SThierry Reding 	.primary_formats = tegra114_primary_formats,
2179511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra114_overlay_formats),
2180511c7023SThierry Reding 	.overlay_formats = tegra114_overlay_formats,
2181e90124cbSThierry Reding 	.modifiers = tegra20_modifiers,
2182acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = false,
2183acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = false,
21848620fc62SThierry Reding };
21858620fc62SThierry Reding 
21868620fc62SThierry Reding static const struct tegra_dc_soc_info tegra124_dc_soc_info = {
21877116e9a8SThierry Reding 	.supports_background_color = true,
21888620fc62SThierry Reding 	.supports_interlacing = true,
2189e687651bSThierry Reding 	.supports_cursor = true,
2190c134f019SThierry Reding 	.supports_block_linear = true,
2191a43d0a00SDmitry Osipenko 	.has_legacy_blending = false,
2192d1f3e1e0SThierry Reding 	.pitch_align = 64,
21939c012700SThierry Reding 	.has_powergate = true,
2194f68ba691SDmitry Osipenko 	.coupled_pm = false,
219547307954SThierry Reding 	.has_nvdisplay = false,
2196511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra124_primary_formats),
21979a02d3afSStefan Agner 	.primary_formats = tegra124_primary_formats,
2198511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra124_overlay_formats),
21999a02d3afSStefan Agner 	.overlay_formats = tegra124_overlay_formats,
2200e90124cbSThierry Reding 	.modifiers = tegra124_modifiers,
2201acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = false,
2202acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = false,
22038620fc62SThierry Reding };
22048620fc62SThierry Reding 
22055b4f516fSThierry Reding static const struct tegra_dc_soc_info tegra210_dc_soc_info = {
22067116e9a8SThierry Reding 	.supports_background_color = true,
22075b4f516fSThierry Reding 	.supports_interlacing = true,
22085b4f516fSThierry Reding 	.supports_cursor = true,
22095b4f516fSThierry Reding 	.supports_block_linear = true,
2210a43d0a00SDmitry Osipenko 	.has_legacy_blending = false,
22115b4f516fSThierry Reding 	.pitch_align = 64,
22125b4f516fSThierry Reding 	.has_powergate = true,
2213f68ba691SDmitry Osipenko 	.coupled_pm = false,
221447307954SThierry Reding 	.has_nvdisplay = false,
2215511c7023SThierry Reding 	.num_primary_formats = ARRAY_SIZE(tegra114_primary_formats),
2216511c7023SThierry Reding 	.primary_formats = tegra114_primary_formats,
2217511c7023SThierry Reding 	.num_overlay_formats = ARRAY_SIZE(tegra114_overlay_formats),
2218511c7023SThierry Reding 	.overlay_formats = tegra114_overlay_formats,
2219e90124cbSThierry Reding 	.modifiers = tegra124_modifiers,
2220acc6a3a9SDmitry Osipenko 	.has_win_a_without_filters = false,
2221acc6a3a9SDmitry Osipenko 	.has_win_c_without_vert_filter = false,
222247307954SThierry Reding };
222347307954SThierry Reding 
222447307954SThierry Reding static const struct tegra_windowgroup_soc tegra186_dc_wgrps[] = {
222547307954SThierry Reding 	{
222647307954SThierry Reding 		.index = 0,
222747307954SThierry Reding 		.dc = 0,
222847307954SThierry Reding 		.windows = (const unsigned int[]) { 0 },
222947307954SThierry Reding 		.num_windows = 1,
223047307954SThierry Reding 	}, {
223147307954SThierry Reding 		.index = 1,
223247307954SThierry Reding 		.dc = 1,
223347307954SThierry Reding 		.windows = (const unsigned int[]) { 1 },
223447307954SThierry Reding 		.num_windows = 1,
223547307954SThierry Reding 	}, {
223647307954SThierry Reding 		.index = 2,
223747307954SThierry Reding 		.dc = 1,
223847307954SThierry Reding 		.windows = (const unsigned int[]) { 2 },
223947307954SThierry Reding 		.num_windows = 1,
224047307954SThierry Reding 	}, {
224147307954SThierry Reding 		.index = 3,
224247307954SThierry Reding 		.dc = 2,
224347307954SThierry Reding 		.windows = (const unsigned int[]) { 3 },
224447307954SThierry Reding 		.num_windows = 1,
224547307954SThierry Reding 	}, {
224647307954SThierry Reding 		.index = 4,
224747307954SThierry Reding 		.dc = 2,
224847307954SThierry Reding 		.windows = (const unsigned int[]) { 4 },
224947307954SThierry Reding 		.num_windows = 1,
225047307954SThierry Reding 	}, {
225147307954SThierry Reding 		.index = 5,
225247307954SThierry Reding 		.dc = 2,
225347307954SThierry Reding 		.windows = (const unsigned int[]) { 5 },
225447307954SThierry Reding 		.num_windows = 1,
225547307954SThierry Reding 	},
225647307954SThierry Reding };
225747307954SThierry Reding 
225847307954SThierry Reding static const struct tegra_dc_soc_info tegra186_dc_soc_info = {
225947307954SThierry Reding 	.supports_background_color = true,
226047307954SThierry Reding 	.supports_interlacing = true,
226147307954SThierry Reding 	.supports_cursor = true,
226247307954SThierry Reding 	.supports_block_linear = true,
2263a43d0a00SDmitry Osipenko 	.has_legacy_blending = false,
226447307954SThierry Reding 	.pitch_align = 64,
226547307954SThierry Reding 	.has_powergate = false,
2266f68ba691SDmitry Osipenko 	.coupled_pm = false,
226747307954SThierry Reding 	.has_nvdisplay = true,
226847307954SThierry Reding 	.wgrps = tegra186_dc_wgrps,
226947307954SThierry Reding 	.num_wgrps = ARRAY_SIZE(tegra186_dc_wgrps),
22705b4f516fSThierry Reding };
22715b4f516fSThierry Reding 
227247443196SThierry Reding static const struct tegra_windowgroup_soc tegra194_dc_wgrps[] = {
227347443196SThierry Reding 	{
227447443196SThierry Reding 		.index = 0,
227547443196SThierry Reding 		.dc = 0,
227647443196SThierry Reding 		.windows = (const unsigned int[]) { 0 },
227747443196SThierry Reding 		.num_windows = 1,
227847443196SThierry Reding 	}, {
227947443196SThierry Reding 		.index = 1,
228047443196SThierry Reding 		.dc = 1,
228147443196SThierry Reding 		.windows = (const unsigned int[]) { 1 },
228247443196SThierry Reding 		.num_windows = 1,
228347443196SThierry Reding 	}, {
228447443196SThierry Reding 		.index = 2,
228547443196SThierry Reding 		.dc = 1,
228647443196SThierry Reding 		.windows = (const unsigned int[]) { 2 },
228747443196SThierry Reding 		.num_windows = 1,
228847443196SThierry Reding 	}, {
228947443196SThierry Reding 		.index = 3,
229047443196SThierry Reding 		.dc = 2,
229147443196SThierry Reding 		.windows = (const unsigned int[]) { 3 },
229247443196SThierry Reding 		.num_windows = 1,
229347443196SThierry Reding 	}, {
229447443196SThierry Reding 		.index = 4,
229547443196SThierry Reding 		.dc = 2,
229647443196SThierry Reding 		.windows = (const unsigned int[]) { 4 },
229747443196SThierry Reding 		.num_windows = 1,
229847443196SThierry Reding 	}, {
229947443196SThierry Reding 		.index = 5,
230047443196SThierry Reding 		.dc = 2,
230147443196SThierry Reding 		.windows = (const unsigned int[]) { 5 },
230247443196SThierry Reding 		.num_windows = 1,
230347443196SThierry Reding 	},
230447443196SThierry Reding };
230547443196SThierry Reding 
230647443196SThierry Reding static const struct tegra_dc_soc_info tegra194_dc_soc_info = {
230747443196SThierry Reding 	.supports_background_color = true,
230847443196SThierry Reding 	.supports_interlacing = true,
230947443196SThierry Reding 	.supports_cursor = true,
231047443196SThierry Reding 	.supports_block_linear = true,
231147443196SThierry Reding 	.has_legacy_blending = false,
231247443196SThierry Reding 	.pitch_align = 64,
231347443196SThierry Reding 	.has_powergate = false,
231447443196SThierry Reding 	.coupled_pm = false,
231547443196SThierry Reding 	.has_nvdisplay = true,
231647443196SThierry Reding 	.wgrps = tegra194_dc_wgrps,
231747443196SThierry Reding 	.num_wgrps = ARRAY_SIZE(tegra194_dc_wgrps),
231847443196SThierry Reding };
231947443196SThierry Reding 
23208620fc62SThierry Reding static const struct of_device_id tegra_dc_of_match[] = {
23218620fc62SThierry Reding 	{
232247443196SThierry Reding 		.compatible = "nvidia,tegra194-dc",
232347443196SThierry Reding 		.data = &tegra194_dc_soc_info,
232447443196SThierry Reding 	}, {
232547307954SThierry Reding 		.compatible = "nvidia,tegra186-dc",
232647307954SThierry Reding 		.data = &tegra186_dc_soc_info,
232747307954SThierry Reding 	}, {
23285b4f516fSThierry Reding 		.compatible = "nvidia,tegra210-dc",
23295b4f516fSThierry Reding 		.data = &tegra210_dc_soc_info,
23305b4f516fSThierry Reding 	}, {
23318620fc62SThierry Reding 		.compatible = "nvidia,tegra124-dc",
23328620fc62SThierry Reding 		.data = &tegra124_dc_soc_info,
23338620fc62SThierry Reding 	}, {
23349c012700SThierry Reding 		.compatible = "nvidia,tegra114-dc",
23359c012700SThierry Reding 		.data = &tegra114_dc_soc_info,
23369c012700SThierry Reding 	}, {
23378620fc62SThierry Reding 		.compatible = "nvidia,tegra30-dc",
23388620fc62SThierry Reding 		.data = &tegra30_dc_soc_info,
23398620fc62SThierry Reding 	}, {
23408620fc62SThierry Reding 		.compatible = "nvidia,tegra20-dc",
23418620fc62SThierry Reding 		.data = &tegra20_dc_soc_info,
23428620fc62SThierry Reding 	}, {
23438620fc62SThierry Reding 		/* sentinel */
23448620fc62SThierry Reding 	}
23458620fc62SThierry Reding };
2346ef70728cSStephen Warren MODULE_DEVICE_TABLE(of, tegra_dc_of_match);
23478620fc62SThierry Reding 
234813411dddSThierry Reding static int tegra_dc_parse_dt(struct tegra_dc *dc)
234913411dddSThierry Reding {
235013411dddSThierry Reding 	struct device_node *np;
235113411dddSThierry Reding 	u32 value = 0;
235213411dddSThierry Reding 	int err;
235313411dddSThierry Reding 
235413411dddSThierry Reding 	err = of_property_read_u32(dc->dev->of_node, "nvidia,head", &value);
235513411dddSThierry Reding 	if (err < 0) {
235613411dddSThierry Reding 		dev_err(dc->dev, "missing \"nvidia,head\" property\n");
235713411dddSThierry Reding 
235813411dddSThierry Reding 		/*
235913411dddSThierry Reding 		 * If the nvidia,head property isn't present, try to find the
236013411dddSThierry Reding 		 * correct head number by looking up the position of this
236113411dddSThierry Reding 		 * display controller's node within the device tree. Assuming
236213411dddSThierry Reding 		 * that the nodes are ordered properly in the DTS file and
236313411dddSThierry Reding 		 * that the translation into a flattened device tree blob
236413411dddSThierry Reding 		 * preserves that ordering this will actually yield the right
236513411dddSThierry Reding 		 * head number.
236613411dddSThierry Reding 		 *
236713411dddSThierry Reding 		 * If those assumptions don't hold, this will still work for
236813411dddSThierry Reding 		 * cases where only a single display controller is used.
236913411dddSThierry Reding 		 */
237013411dddSThierry Reding 		for_each_matching_node(np, tegra_dc_of_match) {
2371cf6b1744SJulia Lawall 			if (np == dc->dev->of_node) {
2372cf6b1744SJulia Lawall 				of_node_put(np);
237313411dddSThierry Reding 				break;
2374cf6b1744SJulia Lawall 			}
237513411dddSThierry Reding 
237613411dddSThierry Reding 			value++;
237713411dddSThierry Reding 		}
237813411dddSThierry Reding 	}
237913411dddSThierry Reding 
238013411dddSThierry Reding 	dc->pipe = value;
238113411dddSThierry Reding 
238213411dddSThierry Reding 	return 0;
238313411dddSThierry Reding }
238413411dddSThierry Reding 
238592ce7e83SSuzuki K Poulose static int tegra_dc_match_by_pipe(struct device *dev, const void *data)
2386f68ba691SDmitry Osipenko {
2387f68ba691SDmitry Osipenko 	struct tegra_dc *dc = dev_get_drvdata(dev);
238892ce7e83SSuzuki K Poulose 	unsigned int pipe = (unsigned long)(void *)data;
2389f68ba691SDmitry Osipenko 
2390f68ba691SDmitry Osipenko 	return dc->pipe == pipe;
2391f68ba691SDmitry Osipenko }
2392f68ba691SDmitry Osipenko 
2393f68ba691SDmitry Osipenko static int tegra_dc_couple(struct tegra_dc *dc)
2394f68ba691SDmitry Osipenko {
2395f68ba691SDmitry Osipenko 	/*
2396f68ba691SDmitry Osipenko 	 * On Tegra20, DC1 requires DC0 to be taken out of reset in order to
2397f68ba691SDmitry Osipenko 	 * be enabled, otherwise CPU hangs on writing to CMD_DISPLAY_COMMAND /
2398f68ba691SDmitry Osipenko 	 * POWER_CONTROL registers during CRTC enabling.
2399f68ba691SDmitry Osipenko 	 */
2400f68ba691SDmitry Osipenko 	if (dc->soc->coupled_pm && dc->pipe == 1) {
2401e88728f4SVivek Gautam 		u32 flags = DL_FLAG_PM_RUNTIME | DL_FLAG_AUTOREMOVE_CONSUMER;
2402f68ba691SDmitry Osipenko 		struct device_link *link;
2403f68ba691SDmitry Osipenko 		struct device *partner;
2404f68ba691SDmitry Osipenko 
2405ef1b204aSWei Yongjun 		partner = driver_find_device(dc->dev->driver, NULL, NULL,
2406f68ba691SDmitry Osipenko 					     tegra_dc_match_by_pipe);
2407f68ba691SDmitry Osipenko 		if (!partner)
2408f68ba691SDmitry Osipenko 			return -EPROBE_DEFER;
2409f68ba691SDmitry Osipenko 
2410f68ba691SDmitry Osipenko 		link = device_link_add(dc->dev, partner, flags);
2411f68ba691SDmitry Osipenko 		if (!link) {
2412f68ba691SDmitry Osipenko 			dev_err(dc->dev, "failed to link controllers\n");
2413f68ba691SDmitry Osipenko 			return -EINVAL;
2414f68ba691SDmitry Osipenko 		}
2415f68ba691SDmitry Osipenko 
2416f68ba691SDmitry Osipenko 		dev_dbg(dc->dev, "coupled to %s\n", dev_name(partner));
2417f68ba691SDmitry Osipenko 	}
2418f68ba691SDmitry Osipenko 
2419f68ba691SDmitry Osipenko 	return 0;
2420f68ba691SDmitry Osipenko }
2421f68ba691SDmitry Osipenko 
2422dee8268fSThierry Reding static int tegra_dc_probe(struct platform_device *pdev)
2423dee8268fSThierry Reding {
2424dee8268fSThierry Reding 	struct resource *regs;
2425dee8268fSThierry Reding 	struct tegra_dc *dc;
2426dee8268fSThierry Reding 	int err;
2427dee8268fSThierry Reding 
2428dee8268fSThierry Reding 	dc = devm_kzalloc(&pdev->dev, sizeof(*dc), GFP_KERNEL);
2429dee8268fSThierry Reding 	if (!dc)
2430dee8268fSThierry Reding 		return -ENOMEM;
2431dee8268fSThierry Reding 
2432b9ff7aeaSThierry Reding 	dc->soc = of_device_get_match_data(&pdev->dev);
24338620fc62SThierry Reding 
2434dee8268fSThierry Reding 	INIT_LIST_HEAD(&dc->list);
2435dee8268fSThierry Reding 	dc->dev = &pdev->dev;
2436dee8268fSThierry Reding 
243713411dddSThierry Reding 	err = tegra_dc_parse_dt(dc);
243813411dddSThierry Reding 	if (err < 0)
243913411dddSThierry Reding 		return err;
244013411dddSThierry Reding 
2441f68ba691SDmitry Osipenko 	err = tegra_dc_couple(dc);
2442f68ba691SDmitry Osipenko 	if (err < 0)
2443f68ba691SDmitry Osipenko 		return err;
2444f68ba691SDmitry Osipenko 
2445dee8268fSThierry Reding 	dc->clk = devm_clk_get(&pdev->dev, NULL);
2446dee8268fSThierry Reding 	if (IS_ERR(dc->clk)) {
2447dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to get clock\n");
2448dee8268fSThierry Reding 		return PTR_ERR(dc->clk);
2449dee8268fSThierry Reding 	}
2450dee8268fSThierry Reding 
2451ca48080aSStephen Warren 	dc->rst = devm_reset_control_get(&pdev->dev, "dc");
2452ca48080aSStephen Warren 	if (IS_ERR(dc->rst)) {
2453ca48080aSStephen Warren 		dev_err(&pdev->dev, "failed to get reset\n");
2454ca48080aSStephen Warren 		return PTR_ERR(dc->rst);
2455ca48080aSStephen Warren 	}
2456ca48080aSStephen Warren 
2457a2f2f740SThierry Reding 	/* assert reset and disable clock */
2458a2f2f740SThierry Reding 	err = clk_prepare_enable(dc->clk);
2459a2f2f740SThierry Reding 	if (err < 0)
2460a2f2f740SThierry Reding 		return err;
2461a2f2f740SThierry Reding 
2462a2f2f740SThierry Reding 	usleep_range(2000, 4000);
2463a2f2f740SThierry Reding 
2464a2f2f740SThierry Reding 	err = reset_control_assert(dc->rst);
2465a2f2f740SThierry Reding 	if (err < 0)
2466a2f2f740SThierry Reding 		return err;
2467a2f2f740SThierry Reding 
2468a2f2f740SThierry Reding 	usleep_range(2000, 4000);
2469a2f2f740SThierry Reding 
2470a2f2f740SThierry Reding 	clk_disable_unprepare(dc->clk);
247133a8eb8dSThierry Reding 
24729c012700SThierry Reding 	if (dc->soc->has_powergate) {
24739c012700SThierry Reding 		if (dc->pipe == 0)
24749c012700SThierry Reding 			dc->powergate = TEGRA_POWERGATE_DIS;
24759c012700SThierry Reding 		else
24769c012700SThierry Reding 			dc->powergate = TEGRA_POWERGATE_DISB;
24779c012700SThierry Reding 
247833a8eb8dSThierry Reding 		tegra_powergate_power_off(dc->powergate);
24799c012700SThierry Reding 	}
2480dee8268fSThierry Reding 
2481dee8268fSThierry Reding 	regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2482dee8268fSThierry Reding 	dc->regs = devm_ioremap_resource(&pdev->dev, regs);
2483dee8268fSThierry Reding 	if (IS_ERR(dc->regs))
2484dee8268fSThierry Reding 		return PTR_ERR(dc->regs);
2485dee8268fSThierry Reding 
2486dee8268fSThierry Reding 	dc->irq = platform_get_irq(pdev, 0);
2487dee8268fSThierry Reding 	if (dc->irq < 0) {
2488dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to get IRQ\n");
2489dee8268fSThierry Reding 		return -ENXIO;
2490dee8268fSThierry Reding 	}
2491dee8268fSThierry Reding 
2492dee8268fSThierry Reding 	err = tegra_dc_rgb_probe(dc);
2493dee8268fSThierry Reding 	if (err < 0 && err != -ENODEV) {
2494dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to probe RGB output: %d\n", err);
2495dee8268fSThierry Reding 		return err;
2496dee8268fSThierry Reding 	}
2497dee8268fSThierry Reding 
249833a8eb8dSThierry Reding 	platform_set_drvdata(pdev, dc);
249933a8eb8dSThierry Reding 	pm_runtime_enable(&pdev->dev);
250033a8eb8dSThierry Reding 
250133a8eb8dSThierry Reding 	INIT_LIST_HEAD(&dc->client.list);
250233a8eb8dSThierry Reding 	dc->client.ops = &dc_client_ops;
250333a8eb8dSThierry Reding 	dc->client.dev = &pdev->dev;
250433a8eb8dSThierry Reding 
2505dee8268fSThierry Reding 	err = host1x_client_register(&dc->client);
2506dee8268fSThierry Reding 	if (err < 0) {
2507dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to register host1x client: %d\n",
2508dee8268fSThierry Reding 			err);
2509dee8268fSThierry Reding 		return err;
2510dee8268fSThierry Reding 	}
2511dee8268fSThierry Reding 
2512dee8268fSThierry Reding 	return 0;
2513dee8268fSThierry Reding }
2514dee8268fSThierry Reding 
2515dee8268fSThierry Reding static int tegra_dc_remove(struct platform_device *pdev)
2516dee8268fSThierry Reding {
2517dee8268fSThierry Reding 	struct tegra_dc *dc = platform_get_drvdata(pdev);
2518dee8268fSThierry Reding 	int err;
2519dee8268fSThierry Reding 
2520dee8268fSThierry Reding 	err = host1x_client_unregister(&dc->client);
2521dee8268fSThierry Reding 	if (err < 0) {
2522dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to unregister host1x client: %d\n",
2523dee8268fSThierry Reding 			err);
2524dee8268fSThierry Reding 		return err;
2525dee8268fSThierry Reding 	}
2526dee8268fSThierry Reding 
252759d29c0eSThierry Reding 	err = tegra_dc_rgb_remove(dc);
252859d29c0eSThierry Reding 	if (err < 0) {
252959d29c0eSThierry Reding 		dev_err(&pdev->dev, "failed to remove RGB output: %d\n", err);
253059d29c0eSThierry Reding 		return err;
253159d29c0eSThierry Reding 	}
253259d29c0eSThierry Reding 
253333a8eb8dSThierry Reding 	pm_runtime_disable(&pdev->dev);
253433a8eb8dSThierry Reding 
253533a8eb8dSThierry Reding 	return 0;
253633a8eb8dSThierry Reding }
253733a8eb8dSThierry Reding 
253833a8eb8dSThierry Reding #ifdef CONFIG_PM
253933a8eb8dSThierry Reding static int tegra_dc_suspend(struct device *dev)
254033a8eb8dSThierry Reding {
254133a8eb8dSThierry Reding 	struct tegra_dc *dc = dev_get_drvdata(dev);
254233a8eb8dSThierry Reding 	int err;
254333a8eb8dSThierry Reding 
254433a8eb8dSThierry Reding 	err = reset_control_assert(dc->rst);
254533a8eb8dSThierry Reding 	if (err < 0) {
254633a8eb8dSThierry Reding 		dev_err(dev, "failed to assert reset: %d\n", err);
254733a8eb8dSThierry Reding 		return err;
254833a8eb8dSThierry Reding 	}
25499c012700SThierry Reding 
25509c012700SThierry Reding 	if (dc->soc->has_powergate)
25519c012700SThierry Reding 		tegra_powergate_power_off(dc->powergate);
25529c012700SThierry Reding 
2553dee8268fSThierry Reding 	clk_disable_unprepare(dc->clk);
2554dee8268fSThierry Reding 
2555dee8268fSThierry Reding 	return 0;
2556dee8268fSThierry Reding }
2557dee8268fSThierry Reding 
255833a8eb8dSThierry Reding static int tegra_dc_resume(struct device *dev)
255933a8eb8dSThierry Reding {
256033a8eb8dSThierry Reding 	struct tegra_dc *dc = dev_get_drvdata(dev);
256133a8eb8dSThierry Reding 	int err;
256233a8eb8dSThierry Reding 
256333a8eb8dSThierry Reding 	if (dc->soc->has_powergate) {
256433a8eb8dSThierry Reding 		err = tegra_powergate_sequence_power_up(dc->powergate, dc->clk,
256533a8eb8dSThierry Reding 							dc->rst);
256633a8eb8dSThierry Reding 		if (err < 0) {
256733a8eb8dSThierry Reding 			dev_err(dev, "failed to power partition: %d\n", err);
256833a8eb8dSThierry Reding 			return err;
256933a8eb8dSThierry Reding 		}
257033a8eb8dSThierry Reding 	} else {
257133a8eb8dSThierry Reding 		err = clk_prepare_enable(dc->clk);
257233a8eb8dSThierry Reding 		if (err < 0) {
257333a8eb8dSThierry Reding 			dev_err(dev, "failed to enable clock: %d\n", err);
257433a8eb8dSThierry Reding 			return err;
257533a8eb8dSThierry Reding 		}
257633a8eb8dSThierry Reding 
257733a8eb8dSThierry Reding 		err = reset_control_deassert(dc->rst);
257833a8eb8dSThierry Reding 		if (err < 0) {
2579f68ba691SDmitry Osipenko 			dev_err(dev, "failed to deassert reset: %d\n", err);
258033a8eb8dSThierry Reding 			return err;
258133a8eb8dSThierry Reding 		}
258233a8eb8dSThierry Reding 	}
258333a8eb8dSThierry Reding 
258433a8eb8dSThierry Reding 	return 0;
258533a8eb8dSThierry Reding }
258633a8eb8dSThierry Reding #endif
258733a8eb8dSThierry Reding 
258833a8eb8dSThierry Reding static const struct dev_pm_ops tegra_dc_pm_ops = {
258933a8eb8dSThierry Reding 	SET_RUNTIME_PM_OPS(tegra_dc_suspend, tegra_dc_resume, NULL)
259033a8eb8dSThierry Reding };
259133a8eb8dSThierry Reding 
2592dee8268fSThierry Reding struct platform_driver tegra_dc_driver = {
2593dee8268fSThierry Reding 	.driver = {
2594dee8268fSThierry Reding 		.name = "tegra-dc",
2595dee8268fSThierry Reding 		.of_match_table = tegra_dc_of_match,
259633a8eb8dSThierry Reding 		.pm = &tegra_dc_pm_ops,
2597dee8268fSThierry Reding 	},
2598dee8268fSThierry Reding 	.probe = tegra_dc_probe,
2599dee8268fSThierry Reding 	.remove = tegra_dc_remove,
2600dee8268fSThierry Reding };
2601