xref: /openbmc/linux/drivers/gpu/drm/tegra/dc.c (revision ca915b108a39081edff1206ec00ecdb4136408ac)
1dee8268fSThierry Reding /*
2dee8268fSThierry Reding  * Copyright (C) 2012 Avionic Design GmbH
3dee8268fSThierry Reding  * Copyright (C) 2012 NVIDIA CORPORATION.  All rights reserved.
4dee8268fSThierry Reding  *
5dee8268fSThierry Reding  * This program is free software; you can redistribute it and/or modify
6dee8268fSThierry Reding  * it under the terms of the GNU General Public License version 2 as
7dee8268fSThierry Reding  * published by the Free Software Foundation.
8dee8268fSThierry Reding  */
9dee8268fSThierry Reding 
10dee8268fSThierry Reding #include <linux/clk.h>
11dee8268fSThierry Reding #include <linux/debugfs.h>
12df06b759SThierry Reding #include <linux/iommu.h>
13ca48080aSStephen Warren #include <linux/reset.h>
14dee8268fSThierry Reding 
159c012700SThierry Reding #include <soc/tegra/pmc.h>
169c012700SThierry Reding 
17dee8268fSThierry Reding #include "dc.h"
18dee8268fSThierry Reding #include "drm.h"
19dee8268fSThierry Reding #include "gem.h"
20dee8268fSThierry Reding 
219d44189fSThierry Reding #include <drm/drm_atomic.h>
224aa3df71SThierry Reding #include <drm/drm_atomic_helper.h>
233cb9ae4fSDaniel Vetter #include <drm/drm_plane_helper.h>
243cb9ae4fSDaniel Vetter 
258620fc62SThierry Reding struct tegra_dc_soc_info {
2642d0659bSThierry Reding 	bool supports_border_color;
278620fc62SThierry Reding 	bool supports_interlacing;
28e687651bSThierry Reding 	bool supports_cursor;
29c134f019SThierry Reding 	bool supports_block_linear;
30d1f3e1e0SThierry Reding 	unsigned int pitch_align;
319c012700SThierry Reding 	bool has_powergate;
328620fc62SThierry Reding };
338620fc62SThierry Reding 
34dee8268fSThierry Reding struct tegra_plane {
35dee8268fSThierry Reding 	struct drm_plane base;
36dee8268fSThierry Reding 	unsigned int index;
37dee8268fSThierry Reding };
38dee8268fSThierry Reding 
39dee8268fSThierry Reding static inline struct tegra_plane *to_tegra_plane(struct drm_plane *plane)
40dee8268fSThierry Reding {
41dee8268fSThierry Reding 	return container_of(plane, struct tegra_plane, base);
42dee8268fSThierry Reding }
43dee8268fSThierry Reding 
44*ca915b10SThierry Reding struct tegra_dc_state {
45*ca915b10SThierry Reding 	struct drm_crtc_state base;
46*ca915b10SThierry Reding 
47*ca915b10SThierry Reding 	struct clk *clk;
48*ca915b10SThierry Reding 	unsigned long pclk;
49*ca915b10SThierry Reding 	unsigned int div;
50*ca915b10SThierry Reding };
51*ca915b10SThierry Reding 
52*ca915b10SThierry Reding static inline struct tegra_dc_state *to_dc_state(struct drm_crtc_state *state)
53*ca915b10SThierry Reding {
54*ca915b10SThierry Reding 	if (state)
55*ca915b10SThierry Reding 		return container_of(state, struct tegra_dc_state, base);
56*ca915b10SThierry Reding 
57*ca915b10SThierry Reding 	return NULL;
58*ca915b10SThierry Reding }
59*ca915b10SThierry Reding 
60205d48edSThierry Reding static void tegra_dc_window_commit(struct tegra_dc *dc, unsigned int index)
61205d48edSThierry Reding {
62205d48edSThierry Reding 	u32 value = WIN_A_ACT_REQ << index;
63205d48edSThierry Reding 
64205d48edSThierry Reding 	tegra_dc_writel(dc, value << 8, DC_CMD_STATE_CONTROL);
65205d48edSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL);
66205d48edSThierry Reding }
67205d48edSThierry Reding 
68205d48edSThierry Reding static void tegra_dc_cursor_commit(struct tegra_dc *dc)
69205d48edSThierry Reding {
70205d48edSThierry Reding 	tegra_dc_writel(dc, CURSOR_ACT_REQ << 8, DC_CMD_STATE_CONTROL);
71205d48edSThierry Reding 	tegra_dc_writel(dc, CURSOR_ACT_REQ, DC_CMD_STATE_CONTROL);
72205d48edSThierry Reding }
73205d48edSThierry Reding 
74d700ba7aSThierry Reding /*
7586df256fSThierry Reding  * Reads the active copy of a register. This takes the dc->lock spinlock to
7686df256fSThierry Reding  * prevent races with the VBLANK processing which also needs access to the
7786df256fSThierry Reding  * active copy of some registers.
7886df256fSThierry Reding  */
7986df256fSThierry Reding static u32 tegra_dc_readl_active(struct tegra_dc *dc, unsigned long offset)
8086df256fSThierry Reding {
8186df256fSThierry Reding 	unsigned long flags;
8286df256fSThierry Reding 	u32 value;
8386df256fSThierry Reding 
8486df256fSThierry Reding 	spin_lock_irqsave(&dc->lock, flags);
8586df256fSThierry Reding 
8686df256fSThierry Reding 	tegra_dc_writel(dc, READ_MUX, DC_CMD_STATE_ACCESS);
8786df256fSThierry Reding 	value = tegra_dc_readl(dc, offset);
8886df256fSThierry Reding 	tegra_dc_writel(dc, 0, DC_CMD_STATE_ACCESS);
8986df256fSThierry Reding 
9086df256fSThierry Reding 	spin_unlock_irqrestore(&dc->lock, flags);
9186df256fSThierry Reding 	return value;
9286df256fSThierry Reding }
9386df256fSThierry Reding 
9486df256fSThierry Reding /*
95d700ba7aSThierry Reding  * Double-buffered registers have two copies: ASSEMBLY and ACTIVE. When the
96d700ba7aSThierry Reding  * *_ACT_REQ bits are set the ASSEMBLY copy is latched into the ACTIVE copy.
97d700ba7aSThierry Reding  * Latching happens mmediately if the display controller is in STOP mode or
98d700ba7aSThierry Reding  * on the next frame boundary otherwise.
99d700ba7aSThierry Reding  *
100d700ba7aSThierry Reding  * Triple-buffered registers have three copies: ASSEMBLY, ARM and ACTIVE. The
101d700ba7aSThierry Reding  * ASSEMBLY copy is latched into the ARM copy immediately after *_UPDATE bits
102d700ba7aSThierry Reding  * are written. When the *_ACT_REQ bits are written, the ARM copy is latched
103d700ba7aSThierry Reding  * into the ACTIVE copy, either immediately if the display controller is in
104d700ba7aSThierry Reding  * STOP mode, or at the next frame boundary otherwise.
105d700ba7aSThierry Reding  */
10662b9e063SThierry Reding void tegra_dc_commit(struct tegra_dc *dc)
107205d48edSThierry Reding {
108205d48edSThierry Reding 	tegra_dc_writel(dc, GENERAL_ACT_REQ << 8, DC_CMD_STATE_CONTROL);
109205d48edSThierry Reding 	tegra_dc_writel(dc, GENERAL_ACT_REQ, DC_CMD_STATE_CONTROL);
110205d48edSThierry Reding }
111205d48edSThierry Reding 
11210288eeaSThierry Reding static unsigned int tegra_dc_format(uint32_t format, uint32_t *swap)
11310288eeaSThierry Reding {
11410288eeaSThierry Reding 	/* assume no swapping of fetched data */
11510288eeaSThierry Reding 	if (swap)
11610288eeaSThierry Reding 		*swap = BYTE_SWAP_NOSWAP;
11710288eeaSThierry Reding 
11810288eeaSThierry Reding 	switch (format) {
11910288eeaSThierry Reding 	case DRM_FORMAT_XBGR8888:
12010288eeaSThierry Reding 		return WIN_COLOR_DEPTH_R8G8B8A8;
12110288eeaSThierry Reding 
12210288eeaSThierry Reding 	case DRM_FORMAT_XRGB8888:
12310288eeaSThierry Reding 		return WIN_COLOR_DEPTH_B8G8R8A8;
12410288eeaSThierry Reding 
12510288eeaSThierry Reding 	case DRM_FORMAT_RGB565:
12610288eeaSThierry Reding 		return WIN_COLOR_DEPTH_B5G6R5;
12710288eeaSThierry Reding 
12810288eeaSThierry Reding 	case DRM_FORMAT_UYVY:
12910288eeaSThierry Reding 		return WIN_COLOR_DEPTH_YCbCr422;
13010288eeaSThierry Reding 
13110288eeaSThierry Reding 	case DRM_FORMAT_YUYV:
13210288eeaSThierry Reding 		if (swap)
13310288eeaSThierry Reding 			*swap = BYTE_SWAP_SWAP2;
13410288eeaSThierry Reding 
13510288eeaSThierry Reding 		return WIN_COLOR_DEPTH_YCbCr422;
13610288eeaSThierry Reding 
13710288eeaSThierry Reding 	case DRM_FORMAT_YUV420:
13810288eeaSThierry Reding 		return WIN_COLOR_DEPTH_YCbCr420P;
13910288eeaSThierry Reding 
14010288eeaSThierry Reding 	case DRM_FORMAT_YUV422:
14110288eeaSThierry Reding 		return WIN_COLOR_DEPTH_YCbCr422P;
14210288eeaSThierry Reding 
14310288eeaSThierry Reding 	default:
14410288eeaSThierry Reding 		break;
14510288eeaSThierry Reding 	}
14610288eeaSThierry Reding 
14710288eeaSThierry Reding 	WARN(1, "unsupported pixel format %u, using default\n", format);
14810288eeaSThierry Reding 	return WIN_COLOR_DEPTH_B8G8R8A8;
14910288eeaSThierry Reding }
15010288eeaSThierry Reding 
15110288eeaSThierry Reding static bool tegra_dc_format_is_yuv(unsigned int format, bool *planar)
15210288eeaSThierry Reding {
15310288eeaSThierry Reding 	switch (format) {
15410288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YCbCr422:
15510288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YUV422:
15610288eeaSThierry Reding 		if (planar)
15710288eeaSThierry Reding 			*planar = false;
15810288eeaSThierry Reding 
15910288eeaSThierry Reding 		return true;
16010288eeaSThierry Reding 
16110288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YCbCr420P:
16210288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YUV420P:
16310288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YCbCr422P:
16410288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YUV422P:
16510288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YCbCr422R:
16610288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YUV422R:
16710288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YCbCr422RA:
16810288eeaSThierry Reding 	case WIN_COLOR_DEPTH_YUV422RA:
16910288eeaSThierry Reding 		if (planar)
17010288eeaSThierry Reding 			*planar = true;
17110288eeaSThierry Reding 
17210288eeaSThierry Reding 		return true;
17310288eeaSThierry Reding 	}
17410288eeaSThierry Reding 
175fb35c6b6SThierry Reding 	if (planar)
176fb35c6b6SThierry Reding 		*planar = false;
177fb35c6b6SThierry Reding 
17810288eeaSThierry Reding 	return false;
17910288eeaSThierry Reding }
18010288eeaSThierry Reding 
18110288eeaSThierry Reding static inline u32 compute_dda_inc(unsigned int in, unsigned int out, bool v,
18210288eeaSThierry Reding 				  unsigned int bpp)
18310288eeaSThierry Reding {
18410288eeaSThierry Reding 	fixed20_12 outf = dfixed_init(out);
18510288eeaSThierry Reding 	fixed20_12 inf = dfixed_init(in);
18610288eeaSThierry Reding 	u32 dda_inc;
18710288eeaSThierry Reding 	int max;
18810288eeaSThierry Reding 
18910288eeaSThierry Reding 	if (v)
19010288eeaSThierry Reding 		max = 15;
19110288eeaSThierry Reding 	else {
19210288eeaSThierry Reding 		switch (bpp) {
19310288eeaSThierry Reding 		case 2:
19410288eeaSThierry Reding 			max = 8;
19510288eeaSThierry Reding 			break;
19610288eeaSThierry Reding 
19710288eeaSThierry Reding 		default:
19810288eeaSThierry Reding 			WARN_ON_ONCE(1);
19910288eeaSThierry Reding 			/* fallthrough */
20010288eeaSThierry Reding 		case 4:
20110288eeaSThierry Reding 			max = 4;
20210288eeaSThierry Reding 			break;
20310288eeaSThierry Reding 		}
20410288eeaSThierry Reding 	}
20510288eeaSThierry Reding 
20610288eeaSThierry Reding 	outf.full = max_t(u32, outf.full - dfixed_const(1), dfixed_const(1));
20710288eeaSThierry Reding 	inf.full -= dfixed_const(1);
20810288eeaSThierry Reding 
20910288eeaSThierry Reding 	dda_inc = dfixed_div(inf, outf);
21010288eeaSThierry Reding 	dda_inc = min_t(u32, dda_inc, dfixed_const(max));
21110288eeaSThierry Reding 
21210288eeaSThierry Reding 	return dda_inc;
21310288eeaSThierry Reding }
21410288eeaSThierry Reding 
21510288eeaSThierry Reding static inline u32 compute_initial_dda(unsigned int in)
21610288eeaSThierry Reding {
21710288eeaSThierry Reding 	fixed20_12 inf = dfixed_init(in);
21810288eeaSThierry Reding 	return dfixed_frac(inf);
21910288eeaSThierry Reding }
22010288eeaSThierry Reding 
2214aa3df71SThierry Reding static void tegra_dc_setup_window(struct tegra_dc *dc, unsigned int index,
22210288eeaSThierry Reding 				  const struct tegra_dc_window *window)
22310288eeaSThierry Reding {
22410288eeaSThierry Reding 	unsigned h_offset, v_offset, h_size, v_size, h_dda, v_dda, bpp;
22593396d0fSSean Paul 	unsigned long value, flags;
22610288eeaSThierry Reding 	bool yuv, planar;
22710288eeaSThierry Reding 
22810288eeaSThierry Reding 	/*
22910288eeaSThierry Reding 	 * For YUV planar modes, the number of bytes per pixel takes into
23010288eeaSThierry Reding 	 * account only the luma component and therefore is 1.
23110288eeaSThierry Reding 	 */
23210288eeaSThierry Reding 	yuv = tegra_dc_format_is_yuv(window->format, &planar);
23310288eeaSThierry Reding 	if (!yuv)
23410288eeaSThierry Reding 		bpp = window->bits_per_pixel / 8;
23510288eeaSThierry Reding 	else
23610288eeaSThierry Reding 		bpp = planar ? 1 : 2;
23710288eeaSThierry Reding 
23893396d0fSSean Paul 	spin_lock_irqsave(&dc->lock, flags);
23993396d0fSSean Paul 
24010288eeaSThierry Reding 	value = WINDOW_A_SELECT << index;
24110288eeaSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_DISPLAY_WINDOW_HEADER);
24210288eeaSThierry Reding 
24310288eeaSThierry Reding 	tegra_dc_writel(dc, window->format, DC_WIN_COLOR_DEPTH);
24410288eeaSThierry Reding 	tegra_dc_writel(dc, window->swap, DC_WIN_BYTE_SWAP);
24510288eeaSThierry Reding 
24610288eeaSThierry Reding 	value = V_POSITION(window->dst.y) | H_POSITION(window->dst.x);
24710288eeaSThierry Reding 	tegra_dc_writel(dc, value, DC_WIN_POSITION);
24810288eeaSThierry Reding 
24910288eeaSThierry Reding 	value = V_SIZE(window->dst.h) | H_SIZE(window->dst.w);
25010288eeaSThierry Reding 	tegra_dc_writel(dc, value, DC_WIN_SIZE);
25110288eeaSThierry Reding 
25210288eeaSThierry Reding 	h_offset = window->src.x * bpp;
25310288eeaSThierry Reding 	v_offset = window->src.y;
25410288eeaSThierry Reding 	h_size = window->src.w * bpp;
25510288eeaSThierry Reding 	v_size = window->src.h;
25610288eeaSThierry Reding 
25710288eeaSThierry Reding 	value = V_PRESCALED_SIZE(v_size) | H_PRESCALED_SIZE(h_size);
25810288eeaSThierry Reding 	tegra_dc_writel(dc, value, DC_WIN_PRESCALED_SIZE);
25910288eeaSThierry Reding 
26010288eeaSThierry Reding 	/*
26110288eeaSThierry Reding 	 * For DDA computations the number of bytes per pixel for YUV planar
26210288eeaSThierry Reding 	 * modes needs to take into account all Y, U and V components.
26310288eeaSThierry Reding 	 */
26410288eeaSThierry Reding 	if (yuv && planar)
26510288eeaSThierry Reding 		bpp = 2;
26610288eeaSThierry Reding 
26710288eeaSThierry Reding 	h_dda = compute_dda_inc(window->src.w, window->dst.w, false, bpp);
26810288eeaSThierry Reding 	v_dda = compute_dda_inc(window->src.h, window->dst.h, true, bpp);
26910288eeaSThierry Reding 
27010288eeaSThierry Reding 	value = V_DDA_INC(v_dda) | H_DDA_INC(h_dda);
27110288eeaSThierry Reding 	tegra_dc_writel(dc, value, DC_WIN_DDA_INC);
27210288eeaSThierry Reding 
27310288eeaSThierry Reding 	h_dda = compute_initial_dda(window->src.x);
27410288eeaSThierry Reding 	v_dda = compute_initial_dda(window->src.y);
27510288eeaSThierry Reding 
27610288eeaSThierry Reding 	tegra_dc_writel(dc, h_dda, DC_WIN_H_INITIAL_DDA);
27710288eeaSThierry Reding 	tegra_dc_writel(dc, v_dda, DC_WIN_V_INITIAL_DDA);
27810288eeaSThierry Reding 
27910288eeaSThierry Reding 	tegra_dc_writel(dc, 0, DC_WIN_UV_BUF_STRIDE);
28010288eeaSThierry Reding 	tegra_dc_writel(dc, 0, DC_WIN_BUF_STRIDE);
28110288eeaSThierry Reding 
28210288eeaSThierry Reding 	tegra_dc_writel(dc, window->base[0], DC_WINBUF_START_ADDR);
28310288eeaSThierry Reding 
28410288eeaSThierry Reding 	if (yuv && planar) {
28510288eeaSThierry Reding 		tegra_dc_writel(dc, window->base[1], DC_WINBUF_START_ADDR_U);
28610288eeaSThierry Reding 		tegra_dc_writel(dc, window->base[2], DC_WINBUF_START_ADDR_V);
28710288eeaSThierry Reding 		value = window->stride[1] << 16 | window->stride[0];
28810288eeaSThierry Reding 		tegra_dc_writel(dc, value, DC_WIN_LINE_STRIDE);
28910288eeaSThierry Reding 	} else {
29010288eeaSThierry Reding 		tegra_dc_writel(dc, window->stride[0], DC_WIN_LINE_STRIDE);
29110288eeaSThierry Reding 	}
29210288eeaSThierry Reding 
29310288eeaSThierry Reding 	if (window->bottom_up)
29410288eeaSThierry Reding 		v_offset += window->src.h - 1;
29510288eeaSThierry Reding 
29610288eeaSThierry Reding 	tegra_dc_writel(dc, h_offset, DC_WINBUF_ADDR_H_OFFSET);
29710288eeaSThierry Reding 	tegra_dc_writel(dc, v_offset, DC_WINBUF_ADDR_V_OFFSET);
29810288eeaSThierry Reding 
299c134f019SThierry Reding 	if (dc->soc->supports_block_linear) {
300c134f019SThierry Reding 		unsigned long height = window->tiling.value;
301c134f019SThierry Reding 
302c134f019SThierry Reding 		switch (window->tiling.mode) {
303c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_PITCH:
304c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_PITCH;
305c134f019SThierry Reding 			break;
306c134f019SThierry Reding 
307c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_TILED:
308c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_TILED;
309c134f019SThierry Reding 			break;
310c134f019SThierry Reding 
311c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_BLOCK:
312c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_BLOCK_HEIGHT(height) |
313c134f019SThierry Reding 				DC_WINBUF_SURFACE_KIND_BLOCK;
314c134f019SThierry Reding 			break;
315c134f019SThierry Reding 		}
316c134f019SThierry Reding 
317c134f019SThierry Reding 		tegra_dc_writel(dc, value, DC_WINBUF_SURFACE_KIND);
31810288eeaSThierry Reding 	} else {
319c134f019SThierry Reding 		switch (window->tiling.mode) {
320c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_PITCH:
32110288eeaSThierry Reding 			value = DC_WIN_BUFFER_ADDR_MODE_LINEAR_UV |
32210288eeaSThierry Reding 				DC_WIN_BUFFER_ADDR_MODE_LINEAR;
323c134f019SThierry Reding 			break;
324c134f019SThierry Reding 
325c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_TILED:
326c134f019SThierry Reding 			value = DC_WIN_BUFFER_ADDR_MODE_TILE_UV |
327c134f019SThierry Reding 				DC_WIN_BUFFER_ADDR_MODE_TILE;
328c134f019SThierry Reding 			break;
329c134f019SThierry Reding 
330c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_BLOCK:
3314aa3df71SThierry Reding 			/*
3324aa3df71SThierry Reding 			 * No need to handle this here because ->atomic_check
3334aa3df71SThierry Reding 			 * will already have filtered it out.
3344aa3df71SThierry Reding 			 */
3354aa3df71SThierry Reding 			break;
33610288eeaSThierry Reding 		}
33710288eeaSThierry Reding 
33810288eeaSThierry Reding 		tegra_dc_writel(dc, value, DC_WIN_BUFFER_ADDR_MODE);
339c134f019SThierry Reding 	}
34010288eeaSThierry Reding 
34110288eeaSThierry Reding 	value = WIN_ENABLE;
34210288eeaSThierry Reding 
34310288eeaSThierry Reding 	if (yuv) {
34410288eeaSThierry Reding 		/* setup default colorspace conversion coefficients */
34510288eeaSThierry Reding 		tegra_dc_writel(dc, 0x00f0, DC_WIN_CSC_YOF);
34610288eeaSThierry Reding 		tegra_dc_writel(dc, 0x012a, DC_WIN_CSC_KYRGB);
34710288eeaSThierry Reding 		tegra_dc_writel(dc, 0x0000, DC_WIN_CSC_KUR);
34810288eeaSThierry Reding 		tegra_dc_writel(dc, 0x0198, DC_WIN_CSC_KVR);
34910288eeaSThierry Reding 		tegra_dc_writel(dc, 0x039b, DC_WIN_CSC_KUG);
35010288eeaSThierry Reding 		tegra_dc_writel(dc, 0x032f, DC_WIN_CSC_KVG);
35110288eeaSThierry Reding 		tegra_dc_writel(dc, 0x0204, DC_WIN_CSC_KUB);
35210288eeaSThierry Reding 		tegra_dc_writel(dc, 0x0000, DC_WIN_CSC_KVB);
35310288eeaSThierry Reding 
35410288eeaSThierry Reding 		value |= CSC_ENABLE;
35510288eeaSThierry Reding 	} else if (window->bits_per_pixel < 24) {
35610288eeaSThierry Reding 		value |= COLOR_EXPAND;
35710288eeaSThierry Reding 	}
35810288eeaSThierry Reding 
35910288eeaSThierry Reding 	if (window->bottom_up)
36010288eeaSThierry Reding 		value |= V_DIRECTION;
36110288eeaSThierry Reding 
36210288eeaSThierry Reding 	tegra_dc_writel(dc, value, DC_WIN_WIN_OPTIONS);
36310288eeaSThierry Reding 
36410288eeaSThierry Reding 	/*
36510288eeaSThierry Reding 	 * Disable blending and assume Window A is the bottom-most window,
36610288eeaSThierry Reding 	 * Window C is the top-most window and Window B is in the middle.
36710288eeaSThierry Reding 	 */
36810288eeaSThierry Reding 	tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_NOKEY);
36910288eeaSThierry Reding 	tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_1WIN);
37010288eeaSThierry Reding 
37110288eeaSThierry Reding 	switch (index) {
37210288eeaSThierry Reding 	case 0:
37310288eeaSThierry Reding 		tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_2WIN_X);
37410288eeaSThierry Reding 		tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_2WIN_Y);
37510288eeaSThierry Reding 		tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_3WIN_XY);
37610288eeaSThierry Reding 		break;
37710288eeaSThierry Reding 
37810288eeaSThierry Reding 	case 1:
37910288eeaSThierry Reding 		tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_2WIN_X);
38010288eeaSThierry Reding 		tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_2WIN_Y);
38110288eeaSThierry Reding 		tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_3WIN_XY);
38210288eeaSThierry Reding 		break;
38310288eeaSThierry Reding 
38410288eeaSThierry Reding 	case 2:
38510288eeaSThierry Reding 		tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_2WIN_X);
38610288eeaSThierry Reding 		tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_2WIN_Y);
38710288eeaSThierry Reding 		tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_3WIN_XY);
38810288eeaSThierry Reding 		break;
38910288eeaSThierry Reding 	}
39010288eeaSThierry Reding 
391205d48edSThierry Reding 	tegra_dc_window_commit(dc, index);
39210288eeaSThierry Reding 
39393396d0fSSean Paul 	spin_unlock_irqrestore(&dc->lock, flags);
394c7679306SThierry Reding }
395c7679306SThierry Reding 
396c7679306SThierry Reding static void tegra_plane_destroy(struct drm_plane *plane)
397c7679306SThierry Reding {
398c7679306SThierry Reding 	struct tegra_plane *p = to_tegra_plane(plane);
399c7679306SThierry Reding 
400c7679306SThierry Reding 	drm_plane_cleanup(plane);
401c7679306SThierry Reding 	kfree(p);
402c7679306SThierry Reding }
403c7679306SThierry Reding 
404c7679306SThierry Reding static const u32 tegra_primary_plane_formats[] = {
405c7679306SThierry Reding 	DRM_FORMAT_XBGR8888,
406c7679306SThierry Reding 	DRM_FORMAT_XRGB8888,
407c7679306SThierry Reding 	DRM_FORMAT_RGB565,
408c7679306SThierry Reding };
409c7679306SThierry Reding 
4104aa3df71SThierry Reding static void tegra_primary_plane_destroy(struct drm_plane *plane)
411c7679306SThierry Reding {
4124aa3df71SThierry Reding 	tegra_plane_destroy(plane);
4134aa3df71SThierry Reding }
4144aa3df71SThierry Reding 
4154aa3df71SThierry Reding static const struct drm_plane_funcs tegra_primary_plane_funcs = {
41607866963SThierry Reding 	.update_plane = drm_atomic_helper_update_plane,
41707866963SThierry Reding 	.disable_plane = drm_atomic_helper_disable_plane,
4184aa3df71SThierry Reding 	.destroy = tegra_primary_plane_destroy,
4199d44189fSThierry Reding 	.reset = drm_atomic_helper_plane_reset,
4209d44189fSThierry Reding 	.atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
4214aa3df71SThierry Reding 	.atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
4224aa3df71SThierry Reding };
4234aa3df71SThierry Reding 
4244aa3df71SThierry Reding static int tegra_plane_prepare_fb(struct drm_plane *plane,
4254aa3df71SThierry Reding 				  struct drm_framebuffer *fb)
4264aa3df71SThierry Reding {
4274aa3df71SThierry Reding 	return 0;
4284aa3df71SThierry Reding }
4294aa3df71SThierry Reding 
4304aa3df71SThierry Reding static void tegra_plane_cleanup_fb(struct drm_plane *plane,
4314aa3df71SThierry Reding 				   struct drm_framebuffer *fb)
4324aa3df71SThierry Reding {
4334aa3df71SThierry Reding }
4344aa3df71SThierry Reding 
4354aa3df71SThierry Reding static int tegra_plane_atomic_check(struct drm_plane *plane,
4364aa3df71SThierry Reding 				    struct drm_plane_state *state)
4374aa3df71SThierry Reding {
4384aa3df71SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(state->crtc);
4394aa3df71SThierry Reding 	struct tegra_bo_tiling tiling;
440c7679306SThierry Reding 	int err;
441c7679306SThierry Reding 
4424aa3df71SThierry Reding 	/* no need for further checks if the plane is being disabled */
4434aa3df71SThierry Reding 	if (!state->crtc)
4444aa3df71SThierry Reding 		return 0;
4454aa3df71SThierry Reding 
4464aa3df71SThierry Reding 	err = tegra_fb_get_tiling(state->fb, &tiling);
4474aa3df71SThierry Reding 	if (err < 0)
4484aa3df71SThierry Reding 		return err;
4494aa3df71SThierry Reding 
4504aa3df71SThierry Reding 	if (tiling.mode == TEGRA_BO_TILING_MODE_BLOCK &&
4514aa3df71SThierry Reding 	    !dc->soc->supports_block_linear) {
4524aa3df71SThierry Reding 		DRM_ERROR("hardware doesn't support block linear mode\n");
4534aa3df71SThierry Reding 		return -EINVAL;
4544aa3df71SThierry Reding 	}
4554aa3df71SThierry Reding 
4564aa3df71SThierry Reding 	/*
4574aa3df71SThierry Reding 	 * Tegra doesn't support different strides for U and V planes so we
4584aa3df71SThierry Reding 	 * error out if the user tries to display a framebuffer with such a
4594aa3df71SThierry Reding 	 * configuration.
4604aa3df71SThierry Reding 	 */
4614aa3df71SThierry Reding 	if (drm_format_num_planes(state->fb->pixel_format) > 2) {
4624aa3df71SThierry Reding 		if (state->fb->pitches[2] != state->fb->pitches[1]) {
4634aa3df71SThierry Reding 			DRM_ERROR("unsupported UV-plane configuration\n");
4644aa3df71SThierry Reding 			return -EINVAL;
4654aa3df71SThierry Reding 		}
4664aa3df71SThierry Reding 	}
4674aa3df71SThierry Reding 
4684aa3df71SThierry Reding 	return 0;
4694aa3df71SThierry Reding }
4704aa3df71SThierry Reding 
4714aa3df71SThierry Reding static void tegra_plane_atomic_update(struct drm_plane *plane,
4724aa3df71SThierry Reding 				      struct drm_plane_state *old_state)
4734aa3df71SThierry Reding {
4744aa3df71SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(plane->state->crtc);
4754aa3df71SThierry Reding 	struct drm_framebuffer *fb = plane->state->fb;
4764aa3df71SThierry Reding 	struct tegra_plane *p = to_tegra_plane(plane);
4774aa3df71SThierry Reding 	struct tegra_dc_window window;
4784aa3df71SThierry Reding 	unsigned int i;
4794aa3df71SThierry Reding 	int err;
4804aa3df71SThierry Reding 
4814aa3df71SThierry Reding 	/* rien ne va plus */
4824aa3df71SThierry Reding 	if (!plane->state->crtc || !plane->state->fb)
4834aa3df71SThierry Reding 		return;
4844aa3df71SThierry Reding 
485c7679306SThierry Reding 	memset(&window, 0, sizeof(window));
4864aa3df71SThierry Reding 	window.src.x = plane->state->src_x >> 16;
4874aa3df71SThierry Reding 	window.src.y = plane->state->src_y >> 16;
4884aa3df71SThierry Reding 	window.src.w = plane->state->src_w >> 16;
4894aa3df71SThierry Reding 	window.src.h = plane->state->src_h >> 16;
4904aa3df71SThierry Reding 	window.dst.x = plane->state->crtc_x;
4914aa3df71SThierry Reding 	window.dst.y = plane->state->crtc_y;
4924aa3df71SThierry Reding 	window.dst.w = plane->state->crtc_w;
4934aa3df71SThierry Reding 	window.dst.h = plane->state->crtc_h;
494c7679306SThierry Reding 	window.format = tegra_dc_format(fb->pixel_format, &window.swap);
495c7679306SThierry Reding 	window.bits_per_pixel = fb->bits_per_pixel;
496c7679306SThierry Reding 	window.bottom_up = tegra_fb_is_bottom_up(fb);
497c7679306SThierry Reding 
498c7679306SThierry Reding 	err = tegra_fb_get_tiling(fb, &window.tiling);
4994aa3df71SThierry Reding 	WARN_ON(err < 0);
500c7679306SThierry Reding 
5014aa3df71SThierry Reding 	for (i = 0; i < drm_format_num_planes(fb->pixel_format); i++) {
5024aa3df71SThierry Reding 		struct tegra_bo *bo = tegra_fb_get_plane(fb, i);
503c7679306SThierry Reding 
5044aa3df71SThierry Reding 		window.base[i] = bo->paddr + fb->offsets[i];
5054aa3df71SThierry Reding 		window.stride[i] = fb->pitches[i];
506c7679306SThierry Reding 	}
507c7679306SThierry Reding 
5084aa3df71SThierry Reding 	tegra_dc_setup_window(dc, p->index, &window);
5094aa3df71SThierry Reding }
5104aa3df71SThierry Reding 
5114aa3df71SThierry Reding static void tegra_plane_atomic_disable(struct drm_plane *plane,
5124aa3df71SThierry Reding 				       struct drm_plane_state *old_state)
513c7679306SThierry Reding {
5144aa3df71SThierry Reding 	struct tegra_plane *p = to_tegra_plane(plane);
5154aa3df71SThierry Reding 	struct tegra_dc *dc;
5164aa3df71SThierry Reding 	unsigned long flags;
5174aa3df71SThierry Reding 	u32 value;
5184aa3df71SThierry Reding 
5194aa3df71SThierry Reding 	/* rien ne va plus */
5204aa3df71SThierry Reding 	if (!old_state || !old_state->crtc)
5214aa3df71SThierry Reding 		return;
5224aa3df71SThierry Reding 
5234aa3df71SThierry Reding 	dc = to_tegra_dc(old_state->crtc);
5244aa3df71SThierry Reding 
5254aa3df71SThierry Reding 	spin_lock_irqsave(&dc->lock, flags);
5264aa3df71SThierry Reding 
5274aa3df71SThierry Reding 	value = WINDOW_A_SELECT << p->index;
5284aa3df71SThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_DISPLAY_WINDOW_HEADER);
5294aa3df71SThierry Reding 
5304aa3df71SThierry Reding 	value = tegra_dc_readl(dc, DC_WIN_WIN_OPTIONS);
5314aa3df71SThierry Reding 	value &= ~WIN_ENABLE;
5324aa3df71SThierry Reding 	tegra_dc_writel(dc, value, DC_WIN_WIN_OPTIONS);
5334aa3df71SThierry Reding 
5344aa3df71SThierry Reding 	tegra_dc_window_commit(dc, p->index);
5354aa3df71SThierry Reding 
5364aa3df71SThierry Reding 	spin_unlock_irqrestore(&dc->lock, flags);
537c7679306SThierry Reding }
538c7679306SThierry Reding 
5394aa3df71SThierry Reding static const struct drm_plane_helper_funcs tegra_primary_plane_helper_funcs = {
5404aa3df71SThierry Reding 	.prepare_fb = tegra_plane_prepare_fb,
5414aa3df71SThierry Reding 	.cleanup_fb = tegra_plane_cleanup_fb,
5424aa3df71SThierry Reding 	.atomic_check = tegra_plane_atomic_check,
5434aa3df71SThierry Reding 	.atomic_update = tegra_plane_atomic_update,
5444aa3df71SThierry Reding 	.atomic_disable = tegra_plane_atomic_disable,
545c7679306SThierry Reding };
546c7679306SThierry Reding 
547c7679306SThierry Reding static struct drm_plane *tegra_dc_primary_plane_create(struct drm_device *drm,
548c7679306SThierry Reding 						       struct tegra_dc *dc)
549c7679306SThierry Reding {
550518e6227SThierry Reding 	/*
551518e6227SThierry Reding 	 * Ideally this would use drm_crtc_mask(), but that would require the
552518e6227SThierry Reding 	 * CRTC to already be in the mode_config's list of CRTCs. However, it
553518e6227SThierry Reding 	 * will only be added to that list in the drm_crtc_init_with_planes()
554518e6227SThierry Reding 	 * (in tegra_dc_init()), which in turn requires registration of these
555518e6227SThierry Reding 	 * planes. So we have ourselves a nice little chicken and egg problem
556518e6227SThierry Reding 	 * here.
557518e6227SThierry Reding 	 *
558518e6227SThierry Reding 	 * We work around this by manually creating the mask from the number
559518e6227SThierry Reding 	 * of CRTCs that have been registered, and should therefore always be
560518e6227SThierry Reding 	 * the same as drm_crtc_index() after registration.
561518e6227SThierry Reding 	 */
562518e6227SThierry Reding 	unsigned long possible_crtcs = 1 << drm->mode_config.num_crtc;
563c7679306SThierry Reding 	struct tegra_plane *plane;
564c7679306SThierry Reding 	unsigned int num_formats;
565c7679306SThierry Reding 	const u32 *formats;
566c7679306SThierry Reding 	int err;
567c7679306SThierry Reding 
568c7679306SThierry Reding 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
569c7679306SThierry Reding 	if (!plane)
570c7679306SThierry Reding 		return ERR_PTR(-ENOMEM);
571c7679306SThierry Reding 
572c7679306SThierry Reding 	num_formats = ARRAY_SIZE(tegra_primary_plane_formats);
573c7679306SThierry Reding 	formats = tegra_primary_plane_formats;
574c7679306SThierry Reding 
575518e6227SThierry Reding 	err = drm_universal_plane_init(drm, &plane->base, possible_crtcs,
576c7679306SThierry Reding 				       &tegra_primary_plane_funcs, formats,
577c7679306SThierry Reding 				       num_formats, DRM_PLANE_TYPE_PRIMARY);
578c7679306SThierry Reding 	if (err < 0) {
579c7679306SThierry Reding 		kfree(plane);
580c7679306SThierry Reding 		return ERR_PTR(err);
581c7679306SThierry Reding 	}
582c7679306SThierry Reding 
5834aa3df71SThierry Reding 	drm_plane_helper_add(&plane->base, &tegra_primary_plane_helper_funcs);
5844aa3df71SThierry Reding 
585c7679306SThierry Reding 	return &plane->base;
586c7679306SThierry Reding }
587c7679306SThierry Reding 
588c7679306SThierry Reding static const u32 tegra_cursor_plane_formats[] = {
589c7679306SThierry Reding 	DRM_FORMAT_RGBA8888,
590c7679306SThierry Reding };
591c7679306SThierry Reding 
5924aa3df71SThierry Reding static int tegra_cursor_atomic_check(struct drm_plane *plane,
5934aa3df71SThierry Reding 				     struct drm_plane_state *state)
594c7679306SThierry Reding {
5954aa3df71SThierry Reding 	/* no need for further checks if the plane is being disabled */
5964aa3df71SThierry Reding 	if (!state->crtc)
5974aa3df71SThierry Reding 		return 0;
598c7679306SThierry Reding 
599c7679306SThierry Reding 	/* scaling not supported for cursor */
6004aa3df71SThierry Reding 	if ((state->src_w >> 16 != state->crtc_w) ||
6014aa3df71SThierry Reding 	    (state->src_h >> 16 != state->crtc_h))
602c7679306SThierry Reding 		return -EINVAL;
603c7679306SThierry Reding 
604c7679306SThierry Reding 	/* only square cursors supported */
6054aa3df71SThierry Reding 	if (state->src_w != state->src_h)
606c7679306SThierry Reding 		return -EINVAL;
607c7679306SThierry Reding 
6084aa3df71SThierry Reding 	if (state->crtc_w != 32 && state->crtc_w != 64 &&
6094aa3df71SThierry Reding 	    state->crtc_w != 128 && state->crtc_w != 256)
6104aa3df71SThierry Reding 		return -EINVAL;
6114aa3df71SThierry Reding 
6124aa3df71SThierry Reding 	return 0;
6134aa3df71SThierry Reding }
6144aa3df71SThierry Reding 
6154aa3df71SThierry Reding static void tegra_cursor_atomic_update(struct drm_plane *plane,
6164aa3df71SThierry Reding 				       struct drm_plane_state *old_state)
6174aa3df71SThierry Reding {
6184aa3df71SThierry Reding 	struct tegra_bo *bo = tegra_fb_get_plane(plane->state->fb, 0);
6194aa3df71SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(plane->state->crtc);
6204aa3df71SThierry Reding 	struct drm_plane_state *state = plane->state;
6214aa3df71SThierry Reding 	u32 value = CURSOR_CLIP_DISPLAY;
6224aa3df71SThierry Reding 
6234aa3df71SThierry Reding 	/* rien ne va plus */
6244aa3df71SThierry Reding 	if (!plane->state->crtc || !plane->state->fb)
6254aa3df71SThierry Reding 		return;
6264aa3df71SThierry Reding 
6274aa3df71SThierry Reding 	switch (state->crtc_w) {
628c7679306SThierry Reding 	case 32:
629c7679306SThierry Reding 		value |= CURSOR_SIZE_32x32;
630c7679306SThierry Reding 		break;
631c7679306SThierry Reding 
632c7679306SThierry Reding 	case 64:
633c7679306SThierry Reding 		value |= CURSOR_SIZE_64x64;
634c7679306SThierry Reding 		break;
635c7679306SThierry Reding 
636c7679306SThierry Reding 	case 128:
637c7679306SThierry Reding 		value |= CURSOR_SIZE_128x128;
638c7679306SThierry Reding 		break;
639c7679306SThierry Reding 
640c7679306SThierry Reding 	case 256:
641c7679306SThierry Reding 		value |= CURSOR_SIZE_256x256;
642c7679306SThierry Reding 		break;
643c7679306SThierry Reding 
644c7679306SThierry Reding 	default:
6454aa3df71SThierry Reding 		WARN(1, "cursor size %ux%u not supported\n", state->crtc_w,
6464aa3df71SThierry Reding 		     state->crtc_h);
6474aa3df71SThierry Reding 		return;
648c7679306SThierry Reding 	}
649c7679306SThierry Reding 
650c7679306SThierry Reding 	value |= (bo->paddr >> 10) & 0x3fffff;
651c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_CURSOR_START_ADDR);
652c7679306SThierry Reding 
653c7679306SThierry Reding #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
654c7679306SThierry Reding 	value = (bo->paddr >> 32) & 0x3;
655c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_CURSOR_START_ADDR_HI);
656c7679306SThierry Reding #endif
657c7679306SThierry Reding 
658c7679306SThierry Reding 	/* enable cursor and set blend mode */
659c7679306SThierry Reding 	value = tegra_dc_readl(dc, DC_DISP_DISP_WIN_OPTIONS);
660c7679306SThierry Reding 	value |= CURSOR_ENABLE;
661c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_DISP_WIN_OPTIONS);
662c7679306SThierry Reding 
663c7679306SThierry Reding 	value = tegra_dc_readl(dc, DC_DISP_BLEND_CURSOR_CONTROL);
664c7679306SThierry Reding 	value &= ~CURSOR_DST_BLEND_MASK;
665c7679306SThierry Reding 	value &= ~CURSOR_SRC_BLEND_MASK;
666c7679306SThierry Reding 	value |= CURSOR_MODE_NORMAL;
667c7679306SThierry Reding 	value |= CURSOR_DST_BLEND_NEG_K1_TIMES_SRC;
668c7679306SThierry Reding 	value |= CURSOR_SRC_BLEND_K1_TIMES_SRC;
669c7679306SThierry Reding 	value |= CURSOR_ALPHA;
670c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_BLEND_CURSOR_CONTROL);
671c7679306SThierry Reding 
672c7679306SThierry Reding 	/* position the cursor */
6734aa3df71SThierry Reding 	value = (state->crtc_y & 0x3fff) << 16 | (state->crtc_x & 0x3fff);
674c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_CURSOR_POSITION);
675c7679306SThierry Reding 
676c7679306SThierry Reding 	/* apply changes */
677c7679306SThierry Reding 	tegra_dc_cursor_commit(dc);
678c7679306SThierry Reding 	tegra_dc_commit(dc);
679c7679306SThierry Reding }
680c7679306SThierry Reding 
6814aa3df71SThierry Reding static void tegra_cursor_atomic_disable(struct drm_plane *plane,
6824aa3df71SThierry Reding 					struct drm_plane_state *old_state)
683c7679306SThierry Reding {
6844aa3df71SThierry Reding 	struct tegra_dc *dc;
685c7679306SThierry Reding 	u32 value;
686c7679306SThierry Reding 
6874aa3df71SThierry Reding 	/* rien ne va plus */
6884aa3df71SThierry Reding 	if (!old_state || !old_state->crtc)
6894aa3df71SThierry Reding 		return;
6904aa3df71SThierry Reding 
6914aa3df71SThierry Reding 	dc = to_tegra_dc(old_state->crtc);
692c7679306SThierry Reding 
693c7679306SThierry Reding 	value = tegra_dc_readl(dc, DC_DISP_DISP_WIN_OPTIONS);
694c7679306SThierry Reding 	value &= ~CURSOR_ENABLE;
695c7679306SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_DISP_WIN_OPTIONS);
696c7679306SThierry Reding 
697c7679306SThierry Reding 	tegra_dc_cursor_commit(dc);
698c7679306SThierry Reding 	tegra_dc_commit(dc);
699c7679306SThierry Reding }
700c7679306SThierry Reding 
701c7679306SThierry Reding static const struct drm_plane_funcs tegra_cursor_plane_funcs = {
70207866963SThierry Reding 	.update_plane = drm_atomic_helper_update_plane,
70307866963SThierry Reding 	.disable_plane = drm_atomic_helper_disable_plane,
704c7679306SThierry Reding 	.destroy = tegra_plane_destroy,
7059d44189fSThierry Reding 	.reset = drm_atomic_helper_plane_reset,
7069d44189fSThierry Reding 	.atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
7074aa3df71SThierry Reding 	.atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
7084aa3df71SThierry Reding };
7094aa3df71SThierry Reding 
7104aa3df71SThierry Reding static const struct drm_plane_helper_funcs tegra_cursor_plane_helper_funcs = {
7114aa3df71SThierry Reding 	.prepare_fb = tegra_plane_prepare_fb,
7124aa3df71SThierry Reding 	.cleanup_fb = tegra_plane_cleanup_fb,
7134aa3df71SThierry Reding 	.atomic_check = tegra_cursor_atomic_check,
7144aa3df71SThierry Reding 	.atomic_update = tegra_cursor_atomic_update,
7154aa3df71SThierry Reding 	.atomic_disable = tegra_cursor_atomic_disable,
716c7679306SThierry Reding };
717c7679306SThierry Reding 
718c7679306SThierry Reding static struct drm_plane *tegra_dc_cursor_plane_create(struct drm_device *drm,
719c7679306SThierry Reding 						      struct tegra_dc *dc)
720c7679306SThierry Reding {
721c7679306SThierry Reding 	struct tegra_plane *plane;
722c7679306SThierry Reding 	unsigned int num_formats;
723c7679306SThierry Reding 	const u32 *formats;
724c7679306SThierry Reding 	int err;
725c7679306SThierry Reding 
726c7679306SThierry Reding 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
727c7679306SThierry Reding 	if (!plane)
728c7679306SThierry Reding 		return ERR_PTR(-ENOMEM);
729c7679306SThierry Reding 
730c7679306SThierry Reding 	num_formats = ARRAY_SIZE(tegra_cursor_plane_formats);
731c7679306SThierry Reding 	formats = tegra_cursor_plane_formats;
732c7679306SThierry Reding 
733c7679306SThierry Reding 	err = drm_universal_plane_init(drm, &plane->base, 1 << dc->pipe,
734c7679306SThierry Reding 				       &tegra_cursor_plane_funcs, formats,
735c7679306SThierry Reding 				       num_formats, DRM_PLANE_TYPE_CURSOR);
736c7679306SThierry Reding 	if (err < 0) {
737c7679306SThierry Reding 		kfree(plane);
738c7679306SThierry Reding 		return ERR_PTR(err);
739c7679306SThierry Reding 	}
740c7679306SThierry Reding 
7414aa3df71SThierry Reding 	drm_plane_helper_add(&plane->base, &tegra_cursor_plane_helper_funcs);
7424aa3df71SThierry Reding 
743c7679306SThierry Reding 	return &plane->base;
744c7679306SThierry Reding }
745c7679306SThierry Reding 
746c7679306SThierry Reding static void tegra_overlay_plane_destroy(struct drm_plane *plane)
747dee8268fSThierry Reding {
748c7679306SThierry Reding 	tegra_plane_destroy(plane);
749dee8268fSThierry Reding }
750dee8268fSThierry Reding 
751c7679306SThierry Reding static const struct drm_plane_funcs tegra_overlay_plane_funcs = {
75207866963SThierry Reding 	.update_plane = drm_atomic_helper_update_plane,
75307866963SThierry Reding 	.disable_plane = drm_atomic_helper_disable_plane,
754c7679306SThierry Reding 	.destroy = tegra_overlay_plane_destroy,
7559d44189fSThierry Reding 	.reset = drm_atomic_helper_plane_reset,
7569d44189fSThierry Reding 	.atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
7574aa3df71SThierry Reding 	.atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
758dee8268fSThierry Reding };
759dee8268fSThierry Reding 
760c7679306SThierry Reding static const uint32_t tegra_overlay_plane_formats[] = {
761dee8268fSThierry Reding 	DRM_FORMAT_XBGR8888,
762dee8268fSThierry Reding 	DRM_FORMAT_XRGB8888,
763dee8268fSThierry Reding 	DRM_FORMAT_RGB565,
764dee8268fSThierry Reding 	DRM_FORMAT_UYVY,
765f925390eSThierry Reding 	DRM_FORMAT_YUYV,
766dee8268fSThierry Reding 	DRM_FORMAT_YUV420,
767dee8268fSThierry Reding 	DRM_FORMAT_YUV422,
768dee8268fSThierry Reding };
769dee8268fSThierry Reding 
7704aa3df71SThierry Reding static const struct drm_plane_helper_funcs tegra_overlay_plane_helper_funcs = {
7714aa3df71SThierry Reding 	.prepare_fb = tegra_plane_prepare_fb,
7724aa3df71SThierry Reding 	.cleanup_fb = tegra_plane_cleanup_fb,
7734aa3df71SThierry Reding 	.atomic_check = tegra_plane_atomic_check,
7744aa3df71SThierry Reding 	.atomic_update = tegra_plane_atomic_update,
7754aa3df71SThierry Reding 	.atomic_disable = tegra_plane_atomic_disable,
7764aa3df71SThierry Reding };
7774aa3df71SThierry Reding 
778c7679306SThierry Reding static struct drm_plane *tegra_dc_overlay_plane_create(struct drm_device *drm,
779c7679306SThierry Reding 						       struct tegra_dc *dc,
780c7679306SThierry Reding 						       unsigned int index)
781dee8268fSThierry Reding {
782dee8268fSThierry Reding 	struct tegra_plane *plane;
783c7679306SThierry Reding 	unsigned int num_formats;
784c7679306SThierry Reding 	const u32 *formats;
785c7679306SThierry Reding 	int err;
786dee8268fSThierry Reding 
787f002abc1SThierry Reding 	plane = kzalloc(sizeof(*plane), GFP_KERNEL);
788dee8268fSThierry Reding 	if (!plane)
789c7679306SThierry Reding 		return ERR_PTR(-ENOMEM);
790dee8268fSThierry Reding 
791c7679306SThierry Reding 	plane->index = index;
792dee8268fSThierry Reding 
793c7679306SThierry Reding 	num_formats = ARRAY_SIZE(tegra_overlay_plane_formats);
794c7679306SThierry Reding 	formats = tegra_overlay_plane_formats;
795c7679306SThierry Reding 
796c7679306SThierry Reding 	err = drm_universal_plane_init(drm, &plane->base, 1 << dc->pipe,
797c7679306SThierry Reding 				       &tegra_overlay_plane_funcs, formats,
798c7679306SThierry Reding 				       num_formats, DRM_PLANE_TYPE_OVERLAY);
799f002abc1SThierry Reding 	if (err < 0) {
800f002abc1SThierry Reding 		kfree(plane);
801c7679306SThierry Reding 		return ERR_PTR(err);
802dee8268fSThierry Reding 	}
803c7679306SThierry Reding 
8044aa3df71SThierry Reding 	drm_plane_helper_add(&plane->base, &tegra_overlay_plane_helper_funcs);
8054aa3df71SThierry Reding 
806c7679306SThierry Reding 	return &plane->base;
807c7679306SThierry Reding }
808c7679306SThierry Reding 
809c7679306SThierry Reding static int tegra_dc_add_planes(struct drm_device *drm, struct tegra_dc *dc)
810c7679306SThierry Reding {
811c7679306SThierry Reding 	struct drm_plane *plane;
812c7679306SThierry Reding 	unsigned int i;
813c7679306SThierry Reding 
814c7679306SThierry Reding 	for (i = 0; i < 2; i++) {
815c7679306SThierry Reding 		plane = tegra_dc_overlay_plane_create(drm, dc, 1 + i);
816c7679306SThierry Reding 		if (IS_ERR(plane))
817c7679306SThierry Reding 			return PTR_ERR(plane);
818f002abc1SThierry Reding 	}
819dee8268fSThierry Reding 
820dee8268fSThierry Reding 	return 0;
821dee8268fSThierry Reding }
822dee8268fSThierry Reding 
823dee8268fSThierry Reding static int tegra_dc_set_base(struct tegra_dc *dc, int x, int y,
824dee8268fSThierry Reding 			     struct drm_framebuffer *fb)
825dee8268fSThierry Reding {
826dee8268fSThierry Reding 	struct tegra_bo *bo = tegra_fb_get_plane(fb, 0);
827db7fbdfdSThierry Reding 	unsigned int h_offset = 0, v_offset = 0;
828c134f019SThierry Reding 	struct tegra_bo_tiling tiling;
82993396d0fSSean Paul 	unsigned long value, flags;
830f925390eSThierry Reding 	unsigned int format, swap;
831c134f019SThierry Reding 	int err;
832c134f019SThierry Reding 
833c134f019SThierry Reding 	err = tegra_fb_get_tiling(fb, &tiling);
834c134f019SThierry Reding 	if (err < 0)
835c134f019SThierry Reding 		return err;
836dee8268fSThierry Reding 
83793396d0fSSean Paul 	spin_lock_irqsave(&dc->lock, flags);
83893396d0fSSean Paul 
839dee8268fSThierry Reding 	tegra_dc_writel(dc, WINDOW_A_SELECT, DC_CMD_DISPLAY_WINDOW_HEADER);
840dee8268fSThierry Reding 
841dee8268fSThierry Reding 	value = fb->offsets[0] + y * fb->pitches[0] +
842dee8268fSThierry Reding 		x * fb->bits_per_pixel / 8;
843dee8268fSThierry Reding 
844dee8268fSThierry Reding 	tegra_dc_writel(dc, bo->paddr + value, DC_WINBUF_START_ADDR);
845dee8268fSThierry Reding 	tegra_dc_writel(dc, fb->pitches[0], DC_WIN_LINE_STRIDE);
846f925390eSThierry Reding 
847f925390eSThierry Reding 	format = tegra_dc_format(fb->pixel_format, &swap);
848dee8268fSThierry Reding 	tegra_dc_writel(dc, format, DC_WIN_COLOR_DEPTH);
849f925390eSThierry Reding 	tegra_dc_writel(dc, swap, DC_WIN_BYTE_SWAP);
850dee8268fSThierry Reding 
851c134f019SThierry Reding 	if (dc->soc->supports_block_linear) {
852c134f019SThierry Reding 		unsigned long height = tiling.value;
853c134f019SThierry Reding 
854c134f019SThierry Reding 		switch (tiling.mode) {
855c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_PITCH:
856c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_PITCH;
857c134f019SThierry Reding 			break;
858c134f019SThierry Reding 
859c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_TILED:
860c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_TILED;
861c134f019SThierry Reding 			break;
862c134f019SThierry Reding 
863c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_BLOCK:
864c134f019SThierry Reding 			value = DC_WINBUF_SURFACE_KIND_BLOCK_HEIGHT(height) |
865c134f019SThierry Reding 				DC_WINBUF_SURFACE_KIND_BLOCK;
866c134f019SThierry Reding 			break;
867c134f019SThierry Reding 		}
868c134f019SThierry Reding 
869c134f019SThierry Reding 		tegra_dc_writel(dc, value, DC_WINBUF_SURFACE_KIND);
870773af77fSThierry Reding 	} else {
871c134f019SThierry Reding 		switch (tiling.mode) {
872c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_PITCH:
873773af77fSThierry Reding 			value = DC_WIN_BUFFER_ADDR_MODE_LINEAR_UV |
874773af77fSThierry Reding 				DC_WIN_BUFFER_ADDR_MODE_LINEAR;
875c134f019SThierry Reding 			break;
876c134f019SThierry Reding 
877c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_TILED:
878c134f019SThierry Reding 			value = DC_WIN_BUFFER_ADDR_MODE_TILE_UV |
879c134f019SThierry Reding 				DC_WIN_BUFFER_ADDR_MODE_TILE;
880c134f019SThierry Reding 			break;
881c134f019SThierry Reding 
882c134f019SThierry Reding 		case TEGRA_BO_TILING_MODE_BLOCK:
883c134f019SThierry Reding 			DRM_ERROR("hardware doesn't support block linear mode\n");
88493396d0fSSean Paul 			spin_unlock_irqrestore(&dc->lock, flags);
885c134f019SThierry Reding 			return -EINVAL;
886773af77fSThierry Reding 		}
887773af77fSThierry Reding 
888773af77fSThierry Reding 		tegra_dc_writel(dc, value, DC_WIN_BUFFER_ADDR_MODE);
889c134f019SThierry Reding 	}
890773af77fSThierry Reding 
891db7fbdfdSThierry Reding 	/* make sure bottom-up buffers are properly displayed */
892db7fbdfdSThierry Reding 	if (tegra_fb_is_bottom_up(fb)) {
893db7fbdfdSThierry Reding 		value = tegra_dc_readl(dc, DC_WIN_WIN_OPTIONS);
894eba66501SThierry Reding 		value |= V_DIRECTION;
895db7fbdfdSThierry Reding 		tegra_dc_writel(dc, value, DC_WIN_WIN_OPTIONS);
896db7fbdfdSThierry Reding 
897db7fbdfdSThierry Reding 		v_offset += fb->height - 1;
898db7fbdfdSThierry Reding 	} else {
899db7fbdfdSThierry Reding 		value = tegra_dc_readl(dc, DC_WIN_WIN_OPTIONS);
900eba66501SThierry Reding 		value &= ~V_DIRECTION;
901db7fbdfdSThierry Reding 		tegra_dc_writel(dc, value, DC_WIN_WIN_OPTIONS);
902db7fbdfdSThierry Reding 	}
903db7fbdfdSThierry Reding 
904db7fbdfdSThierry Reding 	tegra_dc_writel(dc, h_offset, DC_WINBUF_ADDR_H_OFFSET);
905db7fbdfdSThierry Reding 	tegra_dc_writel(dc, v_offset, DC_WINBUF_ADDR_V_OFFSET);
906db7fbdfdSThierry Reding 
907dee8268fSThierry Reding 	value = GENERAL_ACT_REQ | WIN_A_ACT_REQ;
908205d48edSThierry Reding 	tegra_dc_writel(dc, value << 8, DC_CMD_STATE_CONTROL);
909dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL);
910dee8268fSThierry Reding 
91193396d0fSSean Paul 	spin_unlock_irqrestore(&dc->lock, flags);
91293396d0fSSean Paul 
913dee8268fSThierry Reding 	return 0;
914dee8268fSThierry Reding }
915dee8268fSThierry Reding 
916dee8268fSThierry Reding void tegra_dc_enable_vblank(struct tegra_dc *dc)
917dee8268fSThierry Reding {
918dee8268fSThierry Reding 	unsigned long value, flags;
919dee8268fSThierry Reding 
920dee8268fSThierry Reding 	spin_lock_irqsave(&dc->lock, flags);
921dee8268fSThierry Reding 
922dee8268fSThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_INT_MASK);
923dee8268fSThierry Reding 	value |= VBLANK_INT;
924dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
925dee8268fSThierry Reding 
926dee8268fSThierry Reding 	spin_unlock_irqrestore(&dc->lock, flags);
927dee8268fSThierry Reding }
928dee8268fSThierry Reding 
929dee8268fSThierry Reding void tegra_dc_disable_vblank(struct tegra_dc *dc)
930dee8268fSThierry Reding {
931dee8268fSThierry Reding 	unsigned long value, flags;
932dee8268fSThierry Reding 
933dee8268fSThierry Reding 	spin_lock_irqsave(&dc->lock, flags);
934dee8268fSThierry Reding 
935dee8268fSThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_INT_MASK);
936dee8268fSThierry Reding 	value &= ~VBLANK_INT;
937dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
938dee8268fSThierry Reding 
939dee8268fSThierry Reding 	spin_unlock_irqrestore(&dc->lock, flags);
940dee8268fSThierry Reding }
941dee8268fSThierry Reding 
942dee8268fSThierry Reding static void tegra_dc_finish_page_flip(struct tegra_dc *dc)
943dee8268fSThierry Reding {
944dee8268fSThierry Reding 	struct drm_device *drm = dc->base.dev;
945dee8268fSThierry Reding 	struct drm_crtc *crtc = &dc->base;
946dee8268fSThierry Reding 	unsigned long flags, base;
947dee8268fSThierry Reding 	struct tegra_bo *bo;
948dee8268fSThierry Reding 
9496b59cc1cSThierry Reding 	spin_lock_irqsave(&drm->event_lock, flags);
9506b59cc1cSThierry Reding 
9516b59cc1cSThierry Reding 	if (!dc->event) {
9526b59cc1cSThierry Reding 		spin_unlock_irqrestore(&drm->event_lock, flags);
953dee8268fSThierry Reding 		return;
9546b59cc1cSThierry Reding 	}
955dee8268fSThierry Reding 
956f4510a27SMatt Roper 	bo = tegra_fb_get_plane(crtc->primary->fb, 0);
957dee8268fSThierry Reding 
9588643bc6dSDan Carpenter 	spin_lock(&dc->lock);
95993396d0fSSean Paul 
960dee8268fSThierry Reding 	/* check if new start address has been latched */
96193396d0fSSean Paul 	tegra_dc_writel(dc, WINDOW_A_SELECT, DC_CMD_DISPLAY_WINDOW_HEADER);
962dee8268fSThierry Reding 	tegra_dc_writel(dc, READ_MUX, DC_CMD_STATE_ACCESS);
963dee8268fSThierry Reding 	base = tegra_dc_readl(dc, DC_WINBUF_START_ADDR);
964dee8268fSThierry Reding 	tegra_dc_writel(dc, 0, DC_CMD_STATE_ACCESS);
965dee8268fSThierry Reding 
9668643bc6dSDan Carpenter 	spin_unlock(&dc->lock);
96793396d0fSSean Paul 
968f4510a27SMatt Roper 	if (base == bo->paddr + crtc->primary->fb->offsets[0]) {
969ed7dae58SThierry Reding 		drm_crtc_send_vblank_event(crtc, dc->event);
970ed7dae58SThierry Reding 		drm_crtc_vblank_put(crtc);
971dee8268fSThierry Reding 		dc->event = NULL;
972dee8268fSThierry Reding 	}
9736b59cc1cSThierry Reding 
9746b59cc1cSThierry Reding 	spin_unlock_irqrestore(&drm->event_lock, flags);
975dee8268fSThierry Reding }
976dee8268fSThierry Reding 
977dee8268fSThierry Reding void tegra_dc_cancel_page_flip(struct drm_crtc *crtc, struct drm_file *file)
978dee8268fSThierry Reding {
979dee8268fSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
980dee8268fSThierry Reding 	struct drm_device *drm = crtc->dev;
981dee8268fSThierry Reding 	unsigned long flags;
982dee8268fSThierry Reding 
983dee8268fSThierry Reding 	spin_lock_irqsave(&drm->event_lock, flags);
984dee8268fSThierry Reding 
985dee8268fSThierry Reding 	if (dc->event && dc->event->base.file_priv == file) {
986dee8268fSThierry Reding 		dc->event->base.destroy(&dc->event->base);
987ed7dae58SThierry Reding 		drm_crtc_vblank_put(crtc);
988dee8268fSThierry Reding 		dc->event = NULL;
989dee8268fSThierry Reding 	}
990dee8268fSThierry Reding 
991dee8268fSThierry Reding 	spin_unlock_irqrestore(&drm->event_lock, flags);
992dee8268fSThierry Reding }
993dee8268fSThierry Reding 
994dee8268fSThierry Reding static int tegra_dc_page_flip(struct drm_crtc *crtc, struct drm_framebuffer *fb,
995dee8268fSThierry Reding 			      struct drm_pending_vblank_event *event, uint32_t page_flip_flags)
996dee8268fSThierry Reding {
997ed7dae58SThierry Reding 	unsigned int pipe = drm_crtc_index(crtc);
998dee8268fSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
999dee8268fSThierry Reding 
1000dee8268fSThierry Reding 	if (dc->event)
1001dee8268fSThierry Reding 		return -EBUSY;
1002dee8268fSThierry Reding 
1003dee8268fSThierry Reding 	if (event) {
1004ed7dae58SThierry Reding 		event->pipe = pipe;
1005dee8268fSThierry Reding 		dc->event = event;
1006ed7dae58SThierry Reding 		drm_crtc_vblank_get(crtc);
1007dee8268fSThierry Reding 	}
1008dee8268fSThierry Reding 
10099d44189fSThierry Reding 	if (crtc->primary->state)
10109d44189fSThierry Reding 		drm_atomic_set_fb_for_plane(crtc->primary->state, fb);
10119d44189fSThierry Reding 
1012dee8268fSThierry Reding 	tegra_dc_set_base(dc, 0, 0, fb);
1013f4510a27SMatt Roper 	crtc->primary->fb = fb;
1014dee8268fSThierry Reding 
1015dee8268fSThierry Reding 	return 0;
1016dee8268fSThierry Reding }
1017dee8268fSThierry Reding 
1018f002abc1SThierry Reding static void tegra_dc_destroy(struct drm_crtc *crtc)
1019f002abc1SThierry Reding {
1020f002abc1SThierry Reding 	drm_crtc_cleanup(crtc);
1021f002abc1SThierry Reding }
1022f002abc1SThierry Reding 
1023*ca915b10SThierry Reding static void tegra_crtc_reset(struct drm_crtc *crtc)
1024*ca915b10SThierry Reding {
1025*ca915b10SThierry Reding 	struct tegra_dc_state *state;
1026*ca915b10SThierry Reding 
1027*ca915b10SThierry Reding 	kfree(crtc->state);
1028*ca915b10SThierry Reding 	crtc->state = NULL;
1029*ca915b10SThierry Reding 
1030*ca915b10SThierry Reding 	state = kzalloc(sizeof(*state), GFP_KERNEL);
1031*ca915b10SThierry Reding 	if (state)
1032*ca915b10SThierry Reding 		crtc->state = &state->base;
1033*ca915b10SThierry Reding }
1034*ca915b10SThierry Reding 
1035*ca915b10SThierry Reding static struct drm_crtc_state *
1036*ca915b10SThierry Reding tegra_crtc_atomic_duplicate_state(struct drm_crtc *crtc)
1037*ca915b10SThierry Reding {
1038*ca915b10SThierry Reding 	struct tegra_dc_state *state = to_dc_state(crtc->state);
1039*ca915b10SThierry Reding 	struct tegra_dc_state *copy;
1040*ca915b10SThierry Reding 
1041*ca915b10SThierry Reding 	copy = kmemdup(state, sizeof(*state), GFP_KERNEL);
1042*ca915b10SThierry Reding 	if (!copy)
1043*ca915b10SThierry Reding 		return NULL;
1044*ca915b10SThierry Reding 
1045*ca915b10SThierry Reding 	copy->base.mode_changed = false;
1046*ca915b10SThierry Reding 	copy->base.planes_changed = false;
1047*ca915b10SThierry Reding 	copy->base.event = NULL;
1048*ca915b10SThierry Reding 
1049*ca915b10SThierry Reding 	return &copy->base;
1050*ca915b10SThierry Reding }
1051*ca915b10SThierry Reding 
1052*ca915b10SThierry Reding static void tegra_crtc_atomic_destroy_state(struct drm_crtc *crtc,
1053*ca915b10SThierry Reding 					    struct drm_crtc_state *state)
1054*ca915b10SThierry Reding {
1055*ca915b10SThierry Reding 	kfree(state);
1056*ca915b10SThierry Reding }
1057*ca915b10SThierry Reding 
1058dee8268fSThierry Reding static const struct drm_crtc_funcs tegra_crtc_funcs = {
1059dee8268fSThierry Reding 	.page_flip = tegra_dc_page_flip,
1060dee8268fSThierry Reding 	.set_config = drm_crtc_helper_set_config,
1061f002abc1SThierry Reding 	.destroy = tegra_dc_destroy,
1062*ca915b10SThierry Reding 	.reset = tegra_crtc_reset,
1063*ca915b10SThierry Reding 	.atomic_duplicate_state = tegra_crtc_atomic_duplicate_state,
1064*ca915b10SThierry Reding 	.atomic_destroy_state = tegra_crtc_atomic_destroy_state,
1065dee8268fSThierry Reding };
1066dee8268fSThierry Reding 
106786df256fSThierry Reding static void tegra_dc_stop(struct tegra_dc *dc)
106886df256fSThierry Reding {
106986df256fSThierry Reding 	u32 value;
107086df256fSThierry Reding 
107186df256fSThierry Reding 	/* stop the display controller */
107286df256fSThierry Reding 	value = tegra_dc_readl(dc, DC_CMD_DISPLAY_COMMAND);
107386df256fSThierry Reding 	value &= ~DISP_CTRL_MODE_MASK;
107486df256fSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_DISPLAY_COMMAND);
107586df256fSThierry Reding 
107686df256fSThierry Reding 	tegra_dc_commit(dc);
107786df256fSThierry Reding }
107886df256fSThierry Reding 
107986df256fSThierry Reding static bool tegra_dc_idle(struct tegra_dc *dc)
108086df256fSThierry Reding {
108186df256fSThierry Reding 	u32 value;
108286df256fSThierry Reding 
108386df256fSThierry Reding 	value = tegra_dc_readl_active(dc, DC_CMD_DISPLAY_COMMAND);
108486df256fSThierry Reding 
108586df256fSThierry Reding 	return (value & DISP_CTRL_MODE_MASK) == 0;
108686df256fSThierry Reding }
108786df256fSThierry Reding 
108886df256fSThierry Reding static int tegra_dc_wait_idle(struct tegra_dc *dc, unsigned long timeout)
108986df256fSThierry Reding {
109086df256fSThierry Reding 	timeout = jiffies + msecs_to_jiffies(timeout);
109186df256fSThierry Reding 
109286df256fSThierry Reding 	while (time_before(jiffies, timeout)) {
109386df256fSThierry Reding 		if (tegra_dc_idle(dc))
109486df256fSThierry Reding 			return 0;
109586df256fSThierry Reding 
109686df256fSThierry Reding 		usleep_range(1000, 2000);
109786df256fSThierry Reding 	}
109886df256fSThierry Reding 
109986df256fSThierry Reding 	dev_dbg(dc->dev, "timeout waiting for DC to become idle\n");
110086df256fSThierry Reding 	return -ETIMEDOUT;
110186df256fSThierry Reding }
110286df256fSThierry Reding 
1103dee8268fSThierry Reding static void tegra_crtc_disable(struct drm_crtc *crtc)
1104dee8268fSThierry Reding {
1105f002abc1SThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
11063b0e5855SThierry Reding 	u32 value;
1107f002abc1SThierry Reding 
110886df256fSThierry Reding 	if (!tegra_dc_idle(dc)) {
110986df256fSThierry Reding 		tegra_dc_stop(dc);
111086df256fSThierry Reding 
111186df256fSThierry Reding 		/*
111286df256fSThierry Reding 		 * Ignore the return value, there isn't anything useful to do
111386df256fSThierry Reding 		 * in case this fails.
111486df256fSThierry Reding 		 */
111586df256fSThierry Reding 		tegra_dc_wait_idle(dc, 100);
111686df256fSThierry Reding 	}
111736904adfSThierry Reding 
11183b0e5855SThierry Reding 	/*
11193b0e5855SThierry Reding 	 * This should really be part of the RGB encoder driver, but clearing
11203b0e5855SThierry Reding 	 * these bits has the side-effect of stopping the display controller.
11213b0e5855SThierry Reding 	 * When that happens no VBLANK interrupts will be raised. At the same
11223b0e5855SThierry Reding 	 * time the encoder is disabled before the display controller, so the
11233b0e5855SThierry Reding 	 * above code is always going to timeout waiting for the controller
11243b0e5855SThierry Reding 	 * to go idle.
11253b0e5855SThierry Reding 	 *
11263b0e5855SThierry Reding 	 * Given the close coupling between the RGB encoder and the display
11273b0e5855SThierry Reding 	 * controller doing it here is still kind of okay. None of the other
11283b0e5855SThierry Reding 	 * encoder drivers require these bits to be cleared.
11293b0e5855SThierry Reding 	 *
11303b0e5855SThierry Reding 	 * XXX: Perhaps given that the display controller is switched off at
11313b0e5855SThierry Reding 	 * this point anyway maybe clearing these bits isn't even useful for
11323b0e5855SThierry Reding 	 * the RGB encoder?
11333b0e5855SThierry Reding 	 */
11343b0e5855SThierry Reding 	if (dc->rgb) {
11353b0e5855SThierry Reding 		value = tegra_dc_readl(dc, DC_CMD_DISPLAY_POWER_CONTROL);
11363b0e5855SThierry Reding 		value &= ~(PW0_ENABLE | PW1_ENABLE | PW2_ENABLE | PW3_ENABLE |
11373b0e5855SThierry Reding 			   PW4_ENABLE | PM0_ENABLE | PM1_ENABLE);
11383b0e5855SThierry Reding 		tegra_dc_writel(dc, value, DC_CMD_DISPLAY_POWER_CONTROL);
11393b0e5855SThierry Reding 	}
11403b0e5855SThierry Reding 
11418ff64c17SThierry Reding 	drm_crtc_vblank_off(crtc);
1142c7679306SThierry Reding 	tegra_dc_commit(dc);
1143dee8268fSThierry Reding }
1144dee8268fSThierry Reding 
1145dee8268fSThierry Reding static bool tegra_crtc_mode_fixup(struct drm_crtc *crtc,
1146dee8268fSThierry Reding 				  const struct drm_display_mode *mode,
1147dee8268fSThierry Reding 				  struct drm_display_mode *adjusted)
1148dee8268fSThierry Reding {
1149dee8268fSThierry Reding 	return true;
1150dee8268fSThierry Reding }
1151dee8268fSThierry Reding 
1152dee8268fSThierry Reding static int tegra_dc_set_timings(struct tegra_dc *dc,
1153dee8268fSThierry Reding 				struct drm_display_mode *mode)
1154dee8268fSThierry Reding {
11550444c0ffSThierry Reding 	unsigned int h_ref_to_sync = 1;
11560444c0ffSThierry Reding 	unsigned int v_ref_to_sync = 1;
1157dee8268fSThierry Reding 	unsigned long value;
1158dee8268fSThierry Reding 
1159dee8268fSThierry Reding 	tegra_dc_writel(dc, 0x0, DC_DISP_DISP_TIMING_OPTIONS);
1160dee8268fSThierry Reding 
1161dee8268fSThierry Reding 	value = (v_ref_to_sync << 16) | h_ref_to_sync;
1162dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_REF_TO_SYNC);
1163dee8268fSThierry Reding 
1164dee8268fSThierry Reding 	value = ((mode->vsync_end - mode->vsync_start) << 16) |
1165dee8268fSThierry Reding 		((mode->hsync_end - mode->hsync_start) <<  0);
1166dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_SYNC_WIDTH);
1167dee8268fSThierry Reding 
1168dee8268fSThierry Reding 	value = ((mode->vtotal - mode->vsync_end) << 16) |
1169dee8268fSThierry Reding 		((mode->htotal - mode->hsync_end) <<  0);
1170dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_BACK_PORCH);
1171dee8268fSThierry Reding 
1172dee8268fSThierry Reding 	value = ((mode->vsync_start - mode->vdisplay) << 16) |
1173dee8268fSThierry Reding 		((mode->hsync_start - mode->hdisplay) <<  0);
1174dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_FRONT_PORCH);
1175dee8268fSThierry Reding 
1176dee8268fSThierry Reding 	value = (mode->vdisplay << 16) | mode->hdisplay;
1177dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_ACTIVE);
1178dee8268fSThierry Reding 
1179dee8268fSThierry Reding 	return 0;
1180dee8268fSThierry Reding }
1181dee8268fSThierry Reding 
1182c5a107d3SThierry Reding int tegra_dc_setup_clock(struct tegra_dc *dc, struct clk *parent,
1183c5a107d3SThierry Reding 			 unsigned long pclk, unsigned int div)
1184c5a107d3SThierry Reding {
1185c5a107d3SThierry Reding 	u32 value;
1186c5a107d3SThierry Reding 	int err;
1187c5a107d3SThierry Reding 
1188c5a107d3SThierry Reding 	err = clk_set_parent(dc->clk, parent);
1189c5a107d3SThierry Reding 	if (err < 0) {
1190c5a107d3SThierry Reding 		dev_err(dc->dev, "failed to set parent clock: %d\n", err);
1191c5a107d3SThierry Reding 		return err;
1192c5a107d3SThierry Reding 	}
1193c5a107d3SThierry Reding 
1194c5a107d3SThierry Reding 	DRM_DEBUG_KMS("rate: %lu, div: %u\n", clk_get_rate(dc->clk), div);
1195c5a107d3SThierry Reding 
1196c5a107d3SThierry Reding 	value = SHIFT_CLK_DIVIDER(div) | PIXEL_CLK_DIVIDER_PCD1;
1197c5a107d3SThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_DISP_CLOCK_CONTROL);
1198c5a107d3SThierry Reding 
1199c5a107d3SThierry Reding 	return 0;
1200c5a107d3SThierry Reding }
1201c5a107d3SThierry Reding 
1202*ca915b10SThierry Reding int tegra_dc_state_setup_clock(struct tegra_dc *dc,
1203*ca915b10SThierry Reding 			       struct drm_crtc_state *crtc_state,
1204*ca915b10SThierry Reding 			       struct clk *clk, unsigned long pclk,
1205*ca915b10SThierry Reding 			       unsigned int div)
1206*ca915b10SThierry Reding {
1207*ca915b10SThierry Reding 	struct tegra_dc_state *state = to_dc_state(crtc_state);
1208*ca915b10SThierry Reding 
1209*ca915b10SThierry Reding 	state->clk = clk;
1210*ca915b10SThierry Reding 	state->pclk = pclk;
1211*ca915b10SThierry Reding 	state->div = div;
1212*ca915b10SThierry Reding 
1213*ca915b10SThierry Reding 	return 0;
1214*ca915b10SThierry Reding }
1215*ca915b10SThierry Reding 
12164aa3df71SThierry Reding static void tegra_crtc_mode_set_nofb(struct drm_crtc *crtc)
1217dee8268fSThierry Reding {
12184aa3df71SThierry Reding 	struct drm_display_mode *mode = &crtc->state->adjusted_mode;
1219dee8268fSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1220dbb3f2f7SThierry Reding 	u32 value;
1221dee8268fSThierry Reding 
1222dee8268fSThierry Reding 	/* program display mode */
1223dee8268fSThierry Reding 	tegra_dc_set_timings(dc, mode);
1224dee8268fSThierry Reding 
122542d0659bSThierry Reding 	if (dc->soc->supports_border_color)
122642d0659bSThierry Reding 		tegra_dc_writel(dc, 0, DC_DISP_BORDER_COLOR);
122742d0659bSThierry Reding 
12288620fc62SThierry Reding 	/* interlacing isn't supported yet, so disable it */
12298620fc62SThierry Reding 	if (dc->soc->supports_interlacing) {
12308620fc62SThierry Reding 		value = tegra_dc_readl(dc, DC_DISP_INTERLACE_CONTROL);
12318620fc62SThierry Reding 		value &= ~INTERLACE_ENABLE;
12328620fc62SThierry Reding 		tegra_dc_writel(dc, value, DC_DISP_INTERLACE_CONTROL);
12338620fc62SThierry Reding 	}
1234dee8268fSThierry Reding }
1235dee8268fSThierry Reding 
1236dee8268fSThierry Reding static void tegra_crtc_prepare(struct drm_crtc *crtc)
1237dee8268fSThierry Reding {
1238dee8268fSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1239dee8268fSThierry Reding 	unsigned int syncpt;
1240dee8268fSThierry Reding 	unsigned long value;
1241dee8268fSThierry Reding 
12428ff64c17SThierry Reding 	drm_crtc_vblank_off(crtc);
12438ff64c17SThierry Reding 
1244dee8268fSThierry Reding 	if (dc->pipe)
1245dee8268fSThierry Reding 		syncpt = SYNCPT_VBLANK1;
1246dee8268fSThierry Reding 	else
1247dee8268fSThierry Reding 		syncpt = SYNCPT_VBLANK0;
1248dee8268fSThierry Reding 
1249dee8268fSThierry Reding 	/* initialize display controller */
1250dee8268fSThierry Reding 	tegra_dc_writel(dc, 0x00000100, DC_CMD_GENERAL_INCR_SYNCPT_CNTRL);
1251dee8268fSThierry Reding 	tegra_dc_writel(dc, 0x100 | syncpt, DC_CMD_CONT_SYNCPT_VSYNC);
1252dee8268fSThierry Reding 
1253dee8268fSThierry Reding 	value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT | WIN_A_OF_INT;
1254dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_TYPE);
1255dee8268fSThierry Reding 
1256dee8268fSThierry Reding 	value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT |
1257dee8268fSThierry Reding 		WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT;
1258dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_POLARITY);
1259dee8268fSThierry Reding 
1260dee8268fSThierry Reding 	/* initialize timer */
1261dee8268fSThierry Reding 	value = CURSOR_THRESHOLD(0) | WINDOW_A_THRESHOLD(0x20) |
1262dee8268fSThierry Reding 		WINDOW_B_THRESHOLD(0x20) | WINDOW_C_THRESHOLD(0x20);
1263dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_DISP_MEM_HIGH_PRIORITY);
1264dee8268fSThierry Reding 
1265dee8268fSThierry Reding 	value = CURSOR_THRESHOLD(0) | WINDOW_A_THRESHOLD(1) |
1266dee8268fSThierry Reding 		WINDOW_B_THRESHOLD(1) | WINDOW_C_THRESHOLD(1);
1267dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER);
1268dee8268fSThierry Reding 
1269dee8268fSThierry Reding 	value = VBLANK_INT | WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT;
1270dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_ENABLE);
1271dee8268fSThierry Reding 
1272dee8268fSThierry Reding 	value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT;
1273dee8268fSThierry Reding 	tegra_dc_writel(dc, value, DC_CMD_INT_MASK);
1274dee8268fSThierry Reding }
1275dee8268fSThierry Reding 
1276dee8268fSThierry Reding static void tegra_crtc_commit(struct drm_crtc *crtc)
1277dee8268fSThierry Reding {
1278dee8268fSThierry Reding 	struct tegra_dc *dc = to_tegra_dc(crtc);
1279dee8268fSThierry Reding 
12808ff64c17SThierry Reding 	drm_crtc_vblank_on(crtc);
1281205d48edSThierry Reding 	tegra_dc_commit(dc);
1282dee8268fSThierry Reding }
1283dee8268fSThierry Reding 
12844aa3df71SThierry Reding static int tegra_crtc_atomic_check(struct drm_crtc *crtc,
12854aa3df71SThierry Reding 				   struct drm_crtc_state *state)
12864aa3df71SThierry Reding {
12874aa3df71SThierry Reding 	return 0;
12884aa3df71SThierry Reding }
12894aa3df71SThierry Reding 
12904aa3df71SThierry Reding static void tegra_crtc_atomic_begin(struct drm_crtc *crtc)
12914aa3df71SThierry Reding {
12924aa3df71SThierry Reding }
12934aa3df71SThierry Reding 
12944aa3df71SThierry Reding static void tegra_crtc_atomic_flush(struct drm_crtc *crtc)
12954aa3df71SThierry Reding {
12964aa3df71SThierry Reding }
12974aa3df71SThierry Reding 
1298dee8268fSThierry Reding static const struct drm_crtc_helper_funcs tegra_crtc_helper_funcs = {
1299dee8268fSThierry Reding 	.disable = tegra_crtc_disable,
1300dee8268fSThierry Reding 	.mode_fixup = tegra_crtc_mode_fixup,
13014aa3df71SThierry Reding 	.mode_set = drm_helper_crtc_mode_set,
13024aa3df71SThierry Reding 	.mode_set_nofb = tegra_crtc_mode_set_nofb,
13034aa3df71SThierry Reding 	.mode_set_base = drm_helper_crtc_mode_set_base,
1304dee8268fSThierry Reding 	.prepare = tegra_crtc_prepare,
1305dee8268fSThierry Reding 	.commit = tegra_crtc_commit,
13064aa3df71SThierry Reding 	.atomic_check = tegra_crtc_atomic_check,
13074aa3df71SThierry Reding 	.atomic_begin = tegra_crtc_atomic_begin,
13084aa3df71SThierry Reding 	.atomic_flush = tegra_crtc_atomic_flush,
1309dee8268fSThierry Reding };
1310dee8268fSThierry Reding 
1311dee8268fSThierry Reding static irqreturn_t tegra_dc_irq(int irq, void *data)
1312dee8268fSThierry Reding {
1313dee8268fSThierry Reding 	struct tegra_dc *dc = data;
1314dee8268fSThierry Reding 	unsigned long status;
1315dee8268fSThierry Reding 
1316dee8268fSThierry Reding 	status = tegra_dc_readl(dc, DC_CMD_INT_STATUS);
1317dee8268fSThierry Reding 	tegra_dc_writel(dc, status, DC_CMD_INT_STATUS);
1318dee8268fSThierry Reding 
1319dee8268fSThierry Reding 	if (status & FRAME_END_INT) {
1320dee8268fSThierry Reding 		/*
1321dee8268fSThierry Reding 		dev_dbg(dc->dev, "%s(): frame end\n", __func__);
1322dee8268fSThierry Reding 		*/
1323dee8268fSThierry Reding 	}
1324dee8268fSThierry Reding 
1325dee8268fSThierry Reding 	if (status & VBLANK_INT) {
1326dee8268fSThierry Reding 		/*
1327dee8268fSThierry Reding 		dev_dbg(dc->dev, "%s(): vertical blank\n", __func__);
1328dee8268fSThierry Reding 		*/
1329ed7dae58SThierry Reding 		drm_crtc_handle_vblank(&dc->base);
1330dee8268fSThierry Reding 		tegra_dc_finish_page_flip(dc);
1331dee8268fSThierry Reding 	}
1332dee8268fSThierry Reding 
1333dee8268fSThierry Reding 	if (status & (WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT)) {
1334dee8268fSThierry Reding 		/*
1335dee8268fSThierry Reding 		dev_dbg(dc->dev, "%s(): underflow\n", __func__);
1336dee8268fSThierry Reding 		*/
1337dee8268fSThierry Reding 	}
1338dee8268fSThierry Reding 
1339dee8268fSThierry Reding 	return IRQ_HANDLED;
1340dee8268fSThierry Reding }
1341dee8268fSThierry Reding 
1342dee8268fSThierry Reding static int tegra_dc_show_regs(struct seq_file *s, void *data)
1343dee8268fSThierry Reding {
1344dee8268fSThierry Reding 	struct drm_info_node *node = s->private;
1345dee8268fSThierry Reding 	struct tegra_dc *dc = node->info_ent->data;
1346dee8268fSThierry Reding 
1347dee8268fSThierry Reding #define DUMP_REG(name)						\
134803a60569SThierry Reding 	seq_printf(s, "%-40s %#05x %08x\n", #name, name,	\
1349dee8268fSThierry Reding 		   tegra_dc_readl(dc, name))
1350dee8268fSThierry Reding 
1351dee8268fSThierry Reding 	DUMP_REG(DC_CMD_GENERAL_INCR_SYNCPT);
1352dee8268fSThierry Reding 	DUMP_REG(DC_CMD_GENERAL_INCR_SYNCPT_CNTRL);
1353dee8268fSThierry Reding 	DUMP_REG(DC_CMD_GENERAL_INCR_SYNCPT_ERROR);
1354dee8268fSThierry Reding 	DUMP_REG(DC_CMD_WIN_A_INCR_SYNCPT);
1355dee8268fSThierry Reding 	DUMP_REG(DC_CMD_WIN_A_INCR_SYNCPT_CNTRL);
1356dee8268fSThierry Reding 	DUMP_REG(DC_CMD_WIN_A_INCR_SYNCPT_ERROR);
1357dee8268fSThierry Reding 	DUMP_REG(DC_CMD_WIN_B_INCR_SYNCPT);
1358dee8268fSThierry Reding 	DUMP_REG(DC_CMD_WIN_B_INCR_SYNCPT_CNTRL);
1359dee8268fSThierry Reding 	DUMP_REG(DC_CMD_WIN_B_INCR_SYNCPT_ERROR);
1360dee8268fSThierry Reding 	DUMP_REG(DC_CMD_WIN_C_INCR_SYNCPT);
1361dee8268fSThierry Reding 	DUMP_REG(DC_CMD_WIN_C_INCR_SYNCPT_CNTRL);
1362dee8268fSThierry Reding 	DUMP_REG(DC_CMD_WIN_C_INCR_SYNCPT_ERROR);
1363dee8268fSThierry Reding 	DUMP_REG(DC_CMD_CONT_SYNCPT_VSYNC);
1364dee8268fSThierry Reding 	DUMP_REG(DC_CMD_DISPLAY_COMMAND_OPTION0);
1365dee8268fSThierry Reding 	DUMP_REG(DC_CMD_DISPLAY_COMMAND);
1366dee8268fSThierry Reding 	DUMP_REG(DC_CMD_SIGNAL_RAISE);
1367dee8268fSThierry Reding 	DUMP_REG(DC_CMD_DISPLAY_POWER_CONTROL);
1368dee8268fSThierry Reding 	DUMP_REG(DC_CMD_INT_STATUS);
1369dee8268fSThierry Reding 	DUMP_REG(DC_CMD_INT_MASK);
1370dee8268fSThierry Reding 	DUMP_REG(DC_CMD_INT_ENABLE);
1371dee8268fSThierry Reding 	DUMP_REG(DC_CMD_INT_TYPE);
1372dee8268fSThierry Reding 	DUMP_REG(DC_CMD_INT_POLARITY);
1373dee8268fSThierry Reding 	DUMP_REG(DC_CMD_SIGNAL_RAISE1);
1374dee8268fSThierry Reding 	DUMP_REG(DC_CMD_SIGNAL_RAISE2);
1375dee8268fSThierry Reding 	DUMP_REG(DC_CMD_SIGNAL_RAISE3);
1376dee8268fSThierry Reding 	DUMP_REG(DC_CMD_STATE_ACCESS);
1377dee8268fSThierry Reding 	DUMP_REG(DC_CMD_STATE_CONTROL);
1378dee8268fSThierry Reding 	DUMP_REG(DC_CMD_DISPLAY_WINDOW_HEADER);
1379dee8268fSThierry Reding 	DUMP_REG(DC_CMD_REG_ACT_CONTROL);
1380dee8268fSThierry Reding 	DUMP_REG(DC_COM_CRC_CONTROL);
1381dee8268fSThierry Reding 	DUMP_REG(DC_COM_CRC_CHECKSUM);
1382dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_ENABLE(0));
1383dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_ENABLE(1));
1384dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_ENABLE(2));
1385dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_ENABLE(3));
1386dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_POLARITY(0));
1387dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_POLARITY(1));
1388dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_POLARITY(2));
1389dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_POLARITY(3));
1390dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_DATA(0));
1391dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_DATA(1));
1392dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_DATA(2));
1393dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_DATA(3));
1394dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_INPUT_ENABLE(0));
1395dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_INPUT_ENABLE(1));
1396dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_INPUT_ENABLE(2));
1397dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_INPUT_ENABLE(3));
1398dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_INPUT_DATA(0));
1399dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_INPUT_DATA(1));
1400dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(0));
1401dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(1));
1402dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(2));
1403dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(3));
1404dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(4));
1405dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(5));
1406dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(6));
1407dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_MISC_CONTROL);
1408dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_PM0_CONTROL);
1409dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_PM0_DUTY_CYCLE);
1410dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_PM1_CONTROL);
1411dee8268fSThierry Reding 	DUMP_REG(DC_COM_PIN_PM1_DUTY_CYCLE);
1412dee8268fSThierry Reding 	DUMP_REG(DC_COM_SPI_CONTROL);
1413dee8268fSThierry Reding 	DUMP_REG(DC_COM_SPI_START_BYTE);
1414dee8268fSThierry Reding 	DUMP_REG(DC_COM_HSPI_WRITE_DATA_AB);
1415dee8268fSThierry Reding 	DUMP_REG(DC_COM_HSPI_WRITE_DATA_CD);
1416dee8268fSThierry Reding 	DUMP_REG(DC_COM_HSPI_CS_DC);
1417dee8268fSThierry Reding 	DUMP_REG(DC_COM_SCRATCH_REGISTER_A);
1418dee8268fSThierry Reding 	DUMP_REG(DC_COM_SCRATCH_REGISTER_B);
1419dee8268fSThierry Reding 	DUMP_REG(DC_COM_GPIO_CTRL);
1420dee8268fSThierry Reding 	DUMP_REG(DC_COM_GPIO_DEBOUNCE_COUNTER);
1421dee8268fSThierry Reding 	DUMP_REG(DC_COM_CRC_CHECKSUM_LATCHED);
1422dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_SIGNAL_OPTIONS0);
1423dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_SIGNAL_OPTIONS1);
1424dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_WIN_OPTIONS);
1425dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_MEM_HIGH_PRIORITY);
1426dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER);
1427dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_TIMING_OPTIONS);
1428dee8268fSThierry Reding 	DUMP_REG(DC_DISP_REF_TO_SYNC);
1429dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SYNC_WIDTH);
1430dee8268fSThierry Reding 	DUMP_REG(DC_DISP_BACK_PORCH);
1431dee8268fSThierry Reding 	DUMP_REG(DC_DISP_ACTIVE);
1432dee8268fSThierry Reding 	DUMP_REG(DC_DISP_FRONT_PORCH);
1433dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE0_CONTROL);
1434dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE0_POSITION_A);
1435dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE0_POSITION_B);
1436dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE0_POSITION_C);
1437dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE0_POSITION_D);
1438dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE1_CONTROL);
1439dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE1_POSITION_A);
1440dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE1_POSITION_B);
1441dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE1_POSITION_C);
1442dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE1_POSITION_D);
1443dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE2_CONTROL);
1444dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE2_POSITION_A);
1445dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE2_POSITION_B);
1446dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE2_POSITION_C);
1447dee8268fSThierry Reding 	DUMP_REG(DC_DISP_H_PULSE2_POSITION_D);
1448dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE0_CONTROL);
1449dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE0_POSITION_A);
1450dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE0_POSITION_B);
1451dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE0_POSITION_C);
1452dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE1_CONTROL);
1453dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE1_POSITION_A);
1454dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE1_POSITION_B);
1455dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE1_POSITION_C);
1456dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE2_CONTROL);
1457dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE2_POSITION_A);
1458dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE3_CONTROL);
1459dee8268fSThierry Reding 	DUMP_REG(DC_DISP_V_PULSE3_POSITION_A);
1460dee8268fSThierry Reding 	DUMP_REG(DC_DISP_M0_CONTROL);
1461dee8268fSThierry Reding 	DUMP_REG(DC_DISP_M1_CONTROL);
1462dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DI_CONTROL);
1463dee8268fSThierry Reding 	DUMP_REG(DC_DISP_PP_CONTROL);
1464dee8268fSThierry Reding 	DUMP_REG(DC_DISP_PP_SELECT_A);
1465dee8268fSThierry Reding 	DUMP_REG(DC_DISP_PP_SELECT_B);
1466dee8268fSThierry Reding 	DUMP_REG(DC_DISP_PP_SELECT_C);
1467dee8268fSThierry Reding 	DUMP_REG(DC_DISP_PP_SELECT_D);
1468dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_CLOCK_CONTROL);
1469dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_INTERFACE_CONTROL);
1470dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_COLOR_CONTROL);
1471dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SHIFT_CLOCK_OPTIONS);
1472dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DATA_ENABLE_OPTIONS);
1473dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SERIAL_INTERFACE_OPTIONS);
1474dee8268fSThierry Reding 	DUMP_REG(DC_DISP_LCD_SPI_OPTIONS);
1475dee8268fSThierry Reding 	DUMP_REG(DC_DISP_BORDER_COLOR);
1476dee8268fSThierry Reding 	DUMP_REG(DC_DISP_COLOR_KEY0_LOWER);
1477dee8268fSThierry Reding 	DUMP_REG(DC_DISP_COLOR_KEY0_UPPER);
1478dee8268fSThierry Reding 	DUMP_REG(DC_DISP_COLOR_KEY1_LOWER);
1479dee8268fSThierry Reding 	DUMP_REG(DC_DISP_COLOR_KEY1_UPPER);
1480dee8268fSThierry Reding 	DUMP_REG(DC_DISP_CURSOR_FOREGROUND);
1481dee8268fSThierry Reding 	DUMP_REG(DC_DISP_CURSOR_BACKGROUND);
1482dee8268fSThierry Reding 	DUMP_REG(DC_DISP_CURSOR_START_ADDR);
1483dee8268fSThierry Reding 	DUMP_REG(DC_DISP_CURSOR_START_ADDR_NS);
1484dee8268fSThierry Reding 	DUMP_REG(DC_DISP_CURSOR_POSITION);
1485dee8268fSThierry Reding 	DUMP_REG(DC_DISP_CURSOR_POSITION_NS);
1486dee8268fSThierry Reding 	DUMP_REG(DC_DISP_INIT_SEQ_CONTROL);
1487dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SPI_INIT_SEQ_DATA_A);
1488dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SPI_INIT_SEQ_DATA_B);
1489dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SPI_INIT_SEQ_DATA_C);
1490dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SPI_INIT_SEQ_DATA_D);
1491dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DC_MCCIF_FIFOCTRL);
1492dee8268fSThierry Reding 	DUMP_REG(DC_DISP_MCCIF_DISPLAY0A_HYST);
1493dee8268fSThierry Reding 	DUMP_REG(DC_DISP_MCCIF_DISPLAY0B_HYST);
1494dee8268fSThierry Reding 	DUMP_REG(DC_DISP_MCCIF_DISPLAY1A_HYST);
1495dee8268fSThierry Reding 	DUMP_REG(DC_DISP_MCCIF_DISPLAY1B_HYST);
1496dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DAC_CRT_CTRL);
1497dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DISP_MISC_CONTROL);
1498dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_CONTROL);
1499dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_CSC_COEFF);
1500dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_LUT(0));
1501dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_LUT(1));
1502dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_LUT(2));
1503dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_LUT(3));
1504dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_LUT(4));
1505dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_LUT(5));
1506dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_LUT(6));
1507dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_LUT(7));
1508dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_LUT(8));
1509dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_FLICKER_CONTROL);
1510dee8268fSThierry Reding 	DUMP_REG(DC_DISP_DC_PIXEL_COUNT);
1511dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_HISTOGRAM(0));
1512dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_HISTOGRAM(1));
1513dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_HISTOGRAM(2));
1514dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_HISTOGRAM(3));
1515dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_HISTOGRAM(4));
1516dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_HISTOGRAM(5));
1517dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_HISTOGRAM(6));
1518dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_HISTOGRAM(7));
1519dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_BL_TF(0));
1520dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_BL_TF(1));
1521dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_BL_TF(2));
1522dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_BL_TF(3));
1523dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_BL_CONTROL);
1524dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_HW_K_VALUES);
1525dee8268fSThierry Reding 	DUMP_REG(DC_DISP_SD_MAN_K_VALUES);
1526e687651bSThierry Reding 	DUMP_REG(DC_DISP_CURSOR_START_ADDR_HI);
1527e687651bSThierry Reding 	DUMP_REG(DC_DISP_BLEND_CURSOR_CONTROL);
1528dee8268fSThierry Reding 	DUMP_REG(DC_WIN_WIN_OPTIONS);
1529dee8268fSThierry Reding 	DUMP_REG(DC_WIN_BYTE_SWAP);
1530dee8268fSThierry Reding 	DUMP_REG(DC_WIN_BUFFER_CONTROL);
1531dee8268fSThierry Reding 	DUMP_REG(DC_WIN_COLOR_DEPTH);
1532dee8268fSThierry Reding 	DUMP_REG(DC_WIN_POSITION);
1533dee8268fSThierry Reding 	DUMP_REG(DC_WIN_SIZE);
1534dee8268fSThierry Reding 	DUMP_REG(DC_WIN_PRESCALED_SIZE);
1535dee8268fSThierry Reding 	DUMP_REG(DC_WIN_H_INITIAL_DDA);
1536dee8268fSThierry Reding 	DUMP_REG(DC_WIN_V_INITIAL_DDA);
1537dee8268fSThierry Reding 	DUMP_REG(DC_WIN_DDA_INC);
1538dee8268fSThierry Reding 	DUMP_REG(DC_WIN_LINE_STRIDE);
1539dee8268fSThierry Reding 	DUMP_REG(DC_WIN_BUF_STRIDE);
1540dee8268fSThierry Reding 	DUMP_REG(DC_WIN_UV_BUF_STRIDE);
1541dee8268fSThierry Reding 	DUMP_REG(DC_WIN_BUFFER_ADDR_MODE);
1542dee8268fSThierry Reding 	DUMP_REG(DC_WIN_DV_CONTROL);
1543dee8268fSThierry Reding 	DUMP_REG(DC_WIN_BLEND_NOKEY);
1544dee8268fSThierry Reding 	DUMP_REG(DC_WIN_BLEND_1WIN);
1545dee8268fSThierry Reding 	DUMP_REG(DC_WIN_BLEND_2WIN_X);
1546dee8268fSThierry Reding 	DUMP_REG(DC_WIN_BLEND_2WIN_Y);
1547dee8268fSThierry Reding 	DUMP_REG(DC_WIN_BLEND_3WIN_XY);
1548dee8268fSThierry Reding 	DUMP_REG(DC_WIN_HP_FETCH_CONTROL);
1549dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_START_ADDR);
1550dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_START_ADDR_NS);
1551dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_START_ADDR_U);
1552dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_START_ADDR_U_NS);
1553dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_START_ADDR_V);
1554dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_START_ADDR_V_NS);
1555dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_ADDR_H_OFFSET);
1556dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_ADDR_H_OFFSET_NS);
1557dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_ADDR_V_OFFSET);
1558dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_ADDR_V_OFFSET_NS);
1559dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_UFLOW_STATUS);
1560dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_AD_UFLOW_STATUS);
1561dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_BD_UFLOW_STATUS);
1562dee8268fSThierry Reding 	DUMP_REG(DC_WINBUF_CD_UFLOW_STATUS);
1563dee8268fSThierry Reding 
1564dee8268fSThierry Reding #undef DUMP_REG
1565dee8268fSThierry Reding 
1566dee8268fSThierry Reding 	return 0;
1567dee8268fSThierry Reding }
1568dee8268fSThierry Reding 
1569dee8268fSThierry Reding static struct drm_info_list debugfs_files[] = {
1570dee8268fSThierry Reding 	{ "regs", tegra_dc_show_regs, 0, NULL },
1571dee8268fSThierry Reding };
1572dee8268fSThierry Reding 
1573dee8268fSThierry Reding static int tegra_dc_debugfs_init(struct tegra_dc *dc, struct drm_minor *minor)
1574dee8268fSThierry Reding {
1575dee8268fSThierry Reding 	unsigned int i;
1576dee8268fSThierry Reding 	char *name;
1577dee8268fSThierry Reding 	int err;
1578dee8268fSThierry Reding 
1579dee8268fSThierry Reding 	name = kasprintf(GFP_KERNEL, "dc.%d", dc->pipe);
1580dee8268fSThierry Reding 	dc->debugfs = debugfs_create_dir(name, minor->debugfs_root);
1581dee8268fSThierry Reding 	kfree(name);
1582dee8268fSThierry Reding 
1583dee8268fSThierry Reding 	if (!dc->debugfs)
1584dee8268fSThierry Reding 		return -ENOMEM;
1585dee8268fSThierry Reding 
1586dee8268fSThierry Reding 	dc->debugfs_files = kmemdup(debugfs_files, sizeof(debugfs_files),
1587dee8268fSThierry Reding 				    GFP_KERNEL);
1588dee8268fSThierry Reding 	if (!dc->debugfs_files) {
1589dee8268fSThierry Reding 		err = -ENOMEM;
1590dee8268fSThierry Reding 		goto remove;
1591dee8268fSThierry Reding 	}
1592dee8268fSThierry Reding 
1593dee8268fSThierry Reding 	for (i = 0; i < ARRAY_SIZE(debugfs_files); i++)
1594dee8268fSThierry Reding 		dc->debugfs_files[i].data = dc;
1595dee8268fSThierry Reding 
1596dee8268fSThierry Reding 	err = drm_debugfs_create_files(dc->debugfs_files,
1597dee8268fSThierry Reding 				       ARRAY_SIZE(debugfs_files),
1598dee8268fSThierry Reding 				       dc->debugfs, minor);
1599dee8268fSThierry Reding 	if (err < 0)
1600dee8268fSThierry Reding 		goto free;
1601dee8268fSThierry Reding 
1602dee8268fSThierry Reding 	dc->minor = minor;
1603dee8268fSThierry Reding 
1604dee8268fSThierry Reding 	return 0;
1605dee8268fSThierry Reding 
1606dee8268fSThierry Reding free:
1607dee8268fSThierry Reding 	kfree(dc->debugfs_files);
1608dee8268fSThierry Reding 	dc->debugfs_files = NULL;
1609dee8268fSThierry Reding remove:
1610dee8268fSThierry Reding 	debugfs_remove(dc->debugfs);
1611dee8268fSThierry Reding 	dc->debugfs = NULL;
1612dee8268fSThierry Reding 
1613dee8268fSThierry Reding 	return err;
1614dee8268fSThierry Reding }
1615dee8268fSThierry Reding 
1616dee8268fSThierry Reding static int tegra_dc_debugfs_exit(struct tegra_dc *dc)
1617dee8268fSThierry Reding {
1618dee8268fSThierry Reding 	drm_debugfs_remove_files(dc->debugfs_files, ARRAY_SIZE(debugfs_files),
1619dee8268fSThierry Reding 				 dc->minor);
1620dee8268fSThierry Reding 	dc->minor = NULL;
1621dee8268fSThierry Reding 
1622dee8268fSThierry Reding 	kfree(dc->debugfs_files);
1623dee8268fSThierry Reding 	dc->debugfs_files = NULL;
1624dee8268fSThierry Reding 
1625dee8268fSThierry Reding 	debugfs_remove(dc->debugfs);
1626dee8268fSThierry Reding 	dc->debugfs = NULL;
1627dee8268fSThierry Reding 
1628dee8268fSThierry Reding 	return 0;
1629dee8268fSThierry Reding }
1630dee8268fSThierry Reding 
1631dee8268fSThierry Reding static int tegra_dc_init(struct host1x_client *client)
1632dee8268fSThierry Reding {
16339910f5c4SThierry Reding 	struct drm_device *drm = dev_get_drvdata(client->parent);
1634dee8268fSThierry Reding 	struct tegra_dc *dc = host1x_client_to_dc(client);
1635d1f3e1e0SThierry Reding 	struct tegra_drm *tegra = drm->dev_private;
1636c7679306SThierry Reding 	struct drm_plane *primary = NULL;
1637c7679306SThierry Reding 	struct drm_plane *cursor = NULL;
1638dee8268fSThierry Reding 	int err;
1639dee8268fSThierry Reding 
1640df06b759SThierry Reding 	if (tegra->domain) {
1641df06b759SThierry Reding 		err = iommu_attach_device(tegra->domain, dc->dev);
1642df06b759SThierry Reding 		if (err < 0) {
1643df06b759SThierry Reding 			dev_err(dc->dev, "failed to attach to domain: %d\n",
1644df06b759SThierry Reding 				err);
1645df06b759SThierry Reding 			return err;
1646df06b759SThierry Reding 		}
1647df06b759SThierry Reding 
1648df06b759SThierry Reding 		dc->domain = tegra->domain;
1649df06b759SThierry Reding 	}
1650df06b759SThierry Reding 
1651c7679306SThierry Reding 	primary = tegra_dc_primary_plane_create(drm, dc);
1652c7679306SThierry Reding 	if (IS_ERR(primary)) {
1653c7679306SThierry Reding 		err = PTR_ERR(primary);
1654c7679306SThierry Reding 		goto cleanup;
1655c7679306SThierry Reding 	}
1656c7679306SThierry Reding 
1657c7679306SThierry Reding 	if (dc->soc->supports_cursor) {
1658c7679306SThierry Reding 		cursor = tegra_dc_cursor_plane_create(drm, dc);
1659c7679306SThierry Reding 		if (IS_ERR(cursor)) {
1660c7679306SThierry Reding 			err = PTR_ERR(cursor);
1661c7679306SThierry Reding 			goto cleanup;
1662c7679306SThierry Reding 		}
1663c7679306SThierry Reding 	}
1664c7679306SThierry Reding 
1665c7679306SThierry Reding 	err = drm_crtc_init_with_planes(drm, &dc->base, primary, cursor,
1666c7679306SThierry Reding 					&tegra_crtc_funcs);
1667c7679306SThierry Reding 	if (err < 0)
1668c7679306SThierry Reding 		goto cleanup;
1669c7679306SThierry Reding 
1670dee8268fSThierry Reding 	drm_mode_crtc_set_gamma_size(&dc->base, 256);
1671dee8268fSThierry Reding 	drm_crtc_helper_add(&dc->base, &tegra_crtc_helper_funcs);
1672dee8268fSThierry Reding 
1673d1f3e1e0SThierry Reding 	/*
1674d1f3e1e0SThierry Reding 	 * Keep track of the minimum pitch alignment across all display
1675d1f3e1e0SThierry Reding 	 * controllers.
1676d1f3e1e0SThierry Reding 	 */
1677d1f3e1e0SThierry Reding 	if (dc->soc->pitch_align > tegra->pitch_align)
1678d1f3e1e0SThierry Reding 		tegra->pitch_align = dc->soc->pitch_align;
1679d1f3e1e0SThierry Reding 
16809910f5c4SThierry Reding 	err = tegra_dc_rgb_init(drm, dc);
1681dee8268fSThierry Reding 	if (err < 0 && err != -ENODEV) {
1682dee8268fSThierry Reding 		dev_err(dc->dev, "failed to initialize RGB output: %d\n", err);
1683c7679306SThierry Reding 		goto cleanup;
1684dee8268fSThierry Reding 	}
1685dee8268fSThierry Reding 
16869910f5c4SThierry Reding 	err = tegra_dc_add_planes(drm, dc);
1687dee8268fSThierry Reding 	if (err < 0)
1688c7679306SThierry Reding 		goto cleanup;
1689dee8268fSThierry Reding 
1690dee8268fSThierry Reding 	if (IS_ENABLED(CONFIG_DEBUG_FS)) {
16919910f5c4SThierry Reding 		err = tegra_dc_debugfs_init(dc, drm->primary);
1692dee8268fSThierry Reding 		if (err < 0)
1693dee8268fSThierry Reding 			dev_err(dc->dev, "debugfs setup failed: %d\n", err);
1694dee8268fSThierry Reding 	}
1695dee8268fSThierry Reding 
1696dee8268fSThierry Reding 	err = devm_request_irq(dc->dev, dc->irq, tegra_dc_irq, 0,
1697dee8268fSThierry Reding 			       dev_name(dc->dev), dc);
1698dee8268fSThierry Reding 	if (err < 0) {
1699dee8268fSThierry Reding 		dev_err(dc->dev, "failed to request IRQ#%u: %d\n", dc->irq,
1700dee8268fSThierry Reding 			err);
1701c7679306SThierry Reding 		goto cleanup;
1702dee8268fSThierry Reding 	}
1703dee8268fSThierry Reding 
1704dee8268fSThierry Reding 	return 0;
1705c7679306SThierry Reding 
1706c7679306SThierry Reding cleanup:
1707c7679306SThierry Reding 	if (cursor)
1708c7679306SThierry Reding 		drm_plane_cleanup(cursor);
1709c7679306SThierry Reding 
1710c7679306SThierry Reding 	if (primary)
1711c7679306SThierry Reding 		drm_plane_cleanup(primary);
1712c7679306SThierry Reding 
1713c7679306SThierry Reding 	if (tegra->domain) {
1714c7679306SThierry Reding 		iommu_detach_device(tegra->domain, dc->dev);
1715c7679306SThierry Reding 		dc->domain = NULL;
1716c7679306SThierry Reding 	}
1717c7679306SThierry Reding 
1718c7679306SThierry Reding 	return err;
1719dee8268fSThierry Reding }
1720dee8268fSThierry Reding 
1721dee8268fSThierry Reding static int tegra_dc_exit(struct host1x_client *client)
1722dee8268fSThierry Reding {
1723dee8268fSThierry Reding 	struct tegra_dc *dc = host1x_client_to_dc(client);
1724dee8268fSThierry Reding 	int err;
1725dee8268fSThierry Reding 
1726dee8268fSThierry Reding 	devm_free_irq(dc->dev, dc->irq, dc);
1727dee8268fSThierry Reding 
1728dee8268fSThierry Reding 	if (IS_ENABLED(CONFIG_DEBUG_FS)) {
1729dee8268fSThierry Reding 		err = tegra_dc_debugfs_exit(dc);
1730dee8268fSThierry Reding 		if (err < 0)
1731dee8268fSThierry Reding 			dev_err(dc->dev, "debugfs cleanup failed: %d\n", err);
1732dee8268fSThierry Reding 	}
1733dee8268fSThierry Reding 
1734dee8268fSThierry Reding 	err = tegra_dc_rgb_exit(dc);
1735dee8268fSThierry Reding 	if (err) {
1736dee8268fSThierry Reding 		dev_err(dc->dev, "failed to shutdown RGB output: %d\n", err);
1737dee8268fSThierry Reding 		return err;
1738dee8268fSThierry Reding 	}
1739dee8268fSThierry Reding 
1740df06b759SThierry Reding 	if (dc->domain) {
1741df06b759SThierry Reding 		iommu_detach_device(dc->domain, dc->dev);
1742df06b759SThierry Reding 		dc->domain = NULL;
1743df06b759SThierry Reding 	}
1744df06b759SThierry Reding 
1745dee8268fSThierry Reding 	return 0;
1746dee8268fSThierry Reding }
1747dee8268fSThierry Reding 
1748dee8268fSThierry Reding static const struct host1x_client_ops dc_client_ops = {
1749dee8268fSThierry Reding 	.init = tegra_dc_init,
1750dee8268fSThierry Reding 	.exit = tegra_dc_exit,
1751dee8268fSThierry Reding };
1752dee8268fSThierry Reding 
17538620fc62SThierry Reding static const struct tegra_dc_soc_info tegra20_dc_soc_info = {
175442d0659bSThierry Reding 	.supports_border_color = true,
17558620fc62SThierry Reding 	.supports_interlacing = false,
1756e687651bSThierry Reding 	.supports_cursor = false,
1757c134f019SThierry Reding 	.supports_block_linear = false,
1758d1f3e1e0SThierry Reding 	.pitch_align = 8,
17599c012700SThierry Reding 	.has_powergate = false,
17608620fc62SThierry Reding };
17618620fc62SThierry Reding 
17628620fc62SThierry Reding static const struct tegra_dc_soc_info tegra30_dc_soc_info = {
176342d0659bSThierry Reding 	.supports_border_color = true,
17648620fc62SThierry Reding 	.supports_interlacing = false,
1765e687651bSThierry Reding 	.supports_cursor = false,
1766c134f019SThierry Reding 	.supports_block_linear = false,
1767d1f3e1e0SThierry Reding 	.pitch_align = 8,
17689c012700SThierry Reding 	.has_powergate = false,
1769d1f3e1e0SThierry Reding };
1770d1f3e1e0SThierry Reding 
1771d1f3e1e0SThierry Reding static const struct tegra_dc_soc_info tegra114_dc_soc_info = {
177242d0659bSThierry Reding 	.supports_border_color = true,
1773d1f3e1e0SThierry Reding 	.supports_interlacing = false,
1774d1f3e1e0SThierry Reding 	.supports_cursor = false,
1775d1f3e1e0SThierry Reding 	.supports_block_linear = false,
1776d1f3e1e0SThierry Reding 	.pitch_align = 64,
17779c012700SThierry Reding 	.has_powergate = true,
17788620fc62SThierry Reding };
17798620fc62SThierry Reding 
17808620fc62SThierry Reding static const struct tegra_dc_soc_info tegra124_dc_soc_info = {
178142d0659bSThierry Reding 	.supports_border_color = false,
17828620fc62SThierry Reding 	.supports_interlacing = true,
1783e687651bSThierry Reding 	.supports_cursor = true,
1784c134f019SThierry Reding 	.supports_block_linear = true,
1785d1f3e1e0SThierry Reding 	.pitch_align = 64,
17869c012700SThierry Reding 	.has_powergate = true,
17878620fc62SThierry Reding };
17888620fc62SThierry Reding 
17898620fc62SThierry Reding static const struct of_device_id tegra_dc_of_match[] = {
17908620fc62SThierry Reding 	{
17918620fc62SThierry Reding 		.compatible = "nvidia,tegra124-dc",
17928620fc62SThierry Reding 		.data = &tegra124_dc_soc_info,
17938620fc62SThierry Reding 	}, {
17949c012700SThierry Reding 		.compatible = "nvidia,tegra114-dc",
17959c012700SThierry Reding 		.data = &tegra114_dc_soc_info,
17969c012700SThierry Reding 	}, {
17978620fc62SThierry Reding 		.compatible = "nvidia,tegra30-dc",
17988620fc62SThierry Reding 		.data = &tegra30_dc_soc_info,
17998620fc62SThierry Reding 	}, {
18008620fc62SThierry Reding 		.compatible = "nvidia,tegra20-dc",
18018620fc62SThierry Reding 		.data = &tegra20_dc_soc_info,
18028620fc62SThierry Reding 	}, {
18038620fc62SThierry Reding 		/* sentinel */
18048620fc62SThierry Reding 	}
18058620fc62SThierry Reding };
1806ef70728cSStephen Warren MODULE_DEVICE_TABLE(of, tegra_dc_of_match);
18078620fc62SThierry Reding 
180813411dddSThierry Reding static int tegra_dc_parse_dt(struct tegra_dc *dc)
180913411dddSThierry Reding {
181013411dddSThierry Reding 	struct device_node *np;
181113411dddSThierry Reding 	u32 value = 0;
181213411dddSThierry Reding 	int err;
181313411dddSThierry Reding 
181413411dddSThierry Reding 	err = of_property_read_u32(dc->dev->of_node, "nvidia,head", &value);
181513411dddSThierry Reding 	if (err < 0) {
181613411dddSThierry Reding 		dev_err(dc->dev, "missing \"nvidia,head\" property\n");
181713411dddSThierry Reding 
181813411dddSThierry Reding 		/*
181913411dddSThierry Reding 		 * If the nvidia,head property isn't present, try to find the
182013411dddSThierry Reding 		 * correct head number by looking up the position of this
182113411dddSThierry Reding 		 * display controller's node within the device tree. Assuming
182213411dddSThierry Reding 		 * that the nodes are ordered properly in the DTS file and
182313411dddSThierry Reding 		 * that the translation into a flattened device tree blob
182413411dddSThierry Reding 		 * preserves that ordering this will actually yield the right
182513411dddSThierry Reding 		 * head number.
182613411dddSThierry Reding 		 *
182713411dddSThierry Reding 		 * If those assumptions don't hold, this will still work for
182813411dddSThierry Reding 		 * cases where only a single display controller is used.
182913411dddSThierry Reding 		 */
183013411dddSThierry Reding 		for_each_matching_node(np, tegra_dc_of_match) {
183113411dddSThierry Reding 			if (np == dc->dev->of_node)
183213411dddSThierry Reding 				break;
183313411dddSThierry Reding 
183413411dddSThierry Reding 			value++;
183513411dddSThierry Reding 		}
183613411dddSThierry Reding 	}
183713411dddSThierry Reding 
183813411dddSThierry Reding 	dc->pipe = value;
183913411dddSThierry Reding 
184013411dddSThierry Reding 	return 0;
184113411dddSThierry Reding }
184213411dddSThierry Reding 
1843dee8268fSThierry Reding static int tegra_dc_probe(struct platform_device *pdev)
1844dee8268fSThierry Reding {
18458620fc62SThierry Reding 	const struct of_device_id *id;
1846dee8268fSThierry Reding 	struct resource *regs;
1847dee8268fSThierry Reding 	struct tegra_dc *dc;
1848dee8268fSThierry Reding 	int err;
1849dee8268fSThierry Reding 
1850dee8268fSThierry Reding 	dc = devm_kzalloc(&pdev->dev, sizeof(*dc), GFP_KERNEL);
1851dee8268fSThierry Reding 	if (!dc)
1852dee8268fSThierry Reding 		return -ENOMEM;
1853dee8268fSThierry Reding 
18548620fc62SThierry Reding 	id = of_match_node(tegra_dc_of_match, pdev->dev.of_node);
18558620fc62SThierry Reding 	if (!id)
18568620fc62SThierry Reding 		return -ENODEV;
18578620fc62SThierry Reding 
1858dee8268fSThierry Reding 	spin_lock_init(&dc->lock);
1859dee8268fSThierry Reding 	INIT_LIST_HEAD(&dc->list);
1860dee8268fSThierry Reding 	dc->dev = &pdev->dev;
18618620fc62SThierry Reding 	dc->soc = id->data;
1862dee8268fSThierry Reding 
186313411dddSThierry Reding 	err = tegra_dc_parse_dt(dc);
186413411dddSThierry Reding 	if (err < 0)
186513411dddSThierry Reding 		return err;
186613411dddSThierry Reding 
1867dee8268fSThierry Reding 	dc->clk = devm_clk_get(&pdev->dev, NULL);
1868dee8268fSThierry Reding 	if (IS_ERR(dc->clk)) {
1869dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to get clock\n");
1870dee8268fSThierry Reding 		return PTR_ERR(dc->clk);
1871dee8268fSThierry Reding 	}
1872dee8268fSThierry Reding 
1873ca48080aSStephen Warren 	dc->rst = devm_reset_control_get(&pdev->dev, "dc");
1874ca48080aSStephen Warren 	if (IS_ERR(dc->rst)) {
1875ca48080aSStephen Warren 		dev_err(&pdev->dev, "failed to get reset\n");
1876ca48080aSStephen Warren 		return PTR_ERR(dc->rst);
1877ca48080aSStephen Warren 	}
1878ca48080aSStephen Warren 
18799c012700SThierry Reding 	if (dc->soc->has_powergate) {
18809c012700SThierry Reding 		if (dc->pipe == 0)
18819c012700SThierry Reding 			dc->powergate = TEGRA_POWERGATE_DIS;
18829c012700SThierry Reding 		else
18839c012700SThierry Reding 			dc->powergate = TEGRA_POWERGATE_DISB;
18849c012700SThierry Reding 
18859c012700SThierry Reding 		err = tegra_powergate_sequence_power_up(dc->powergate, dc->clk,
18869c012700SThierry Reding 							dc->rst);
18879c012700SThierry Reding 		if (err < 0) {
18889c012700SThierry Reding 			dev_err(&pdev->dev, "failed to power partition: %d\n",
18899c012700SThierry Reding 				err);
1890dee8268fSThierry Reding 			return err;
18919c012700SThierry Reding 		}
18929c012700SThierry Reding 	} else {
18939c012700SThierry Reding 		err = clk_prepare_enable(dc->clk);
18949c012700SThierry Reding 		if (err < 0) {
18959c012700SThierry Reding 			dev_err(&pdev->dev, "failed to enable clock: %d\n",
18969c012700SThierry Reding 				err);
18979c012700SThierry Reding 			return err;
18989c012700SThierry Reding 		}
18999c012700SThierry Reding 
19009c012700SThierry Reding 		err = reset_control_deassert(dc->rst);
19019c012700SThierry Reding 		if (err < 0) {
19029c012700SThierry Reding 			dev_err(&pdev->dev, "failed to deassert reset: %d\n",
19039c012700SThierry Reding 				err);
19049c012700SThierry Reding 			return err;
19059c012700SThierry Reding 		}
19069c012700SThierry Reding 	}
1907dee8268fSThierry Reding 
1908dee8268fSThierry Reding 	regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1909dee8268fSThierry Reding 	dc->regs = devm_ioremap_resource(&pdev->dev, regs);
1910dee8268fSThierry Reding 	if (IS_ERR(dc->regs))
1911dee8268fSThierry Reding 		return PTR_ERR(dc->regs);
1912dee8268fSThierry Reding 
1913dee8268fSThierry Reding 	dc->irq = platform_get_irq(pdev, 0);
1914dee8268fSThierry Reding 	if (dc->irq < 0) {
1915dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to get IRQ\n");
1916dee8268fSThierry Reding 		return -ENXIO;
1917dee8268fSThierry Reding 	}
1918dee8268fSThierry Reding 
1919dee8268fSThierry Reding 	INIT_LIST_HEAD(&dc->client.list);
1920dee8268fSThierry Reding 	dc->client.ops = &dc_client_ops;
1921dee8268fSThierry Reding 	dc->client.dev = &pdev->dev;
1922dee8268fSThierry Reding 
1923dee8268fSThierry Reding 	err = tegra_dc_rgb_probe(dc);
1924dee8268fSThierry Reding 	if (err < 0 && err != -ENODEV) {
1925dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to probe RGB output: %d\n", err);
1926dee8268fSThierry Reding 		return err;
1927dee8268fSThierry Reding 	}
1928dee8268fSThierry Reding 
1929dee8268fSThierry Reding 	err = host1x_client_register(&dc->client);
1930dee8268fSThierry Reding 	if (err < 0) {
1931dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to register host1x client: %d\n",
1932dee8268fSThierry Reding 			err);
1933dee8268fSThierry Reding 		return err;
1934dee8268fSThierry Reding 	}
1935dee8268fSThierry Reding 
1936dee8268fSThierry Reding 	platform_set_drvdata(pdev, dc);
1937dee8268fSThierry Reding 
1938dee8268fSThierry Reding 	return 0;
1939dee8268fSThierry Reding }
1940dee8268fSThierry Reding 
1941dee8268fSThierry Reding static int tegra_dc_remove(struct platform_device *pdev)
1942dee8268fSThierry Reding {
1943dee8268fSThierry Reding 	struct tegra_dc *dc = platform_get_drvdata(pdev);
1944dee8268fSThierry Reding 	int err;
1945dee8268fSThierry Reding 
1946dee8268fSThierry Reding 	err = host1x_client_unregister(&dc->client);
1947dee8268fSThierry Reding 	if (err < 0) {
1948dee8268fSThierry Reding 		dev_err(&pdev->dev, "failed to unregister host1x client: %d\n",
1949dee8268fSThierry Reding 			err);
1950dee8268fSThierry Reding 		return err;
1951dee8268fSThierry Reding 	}
1952dee8268fSThierry Reding 
195359d29c0eSThierry Reding 	err = tegra_dc_rgb_remove(dc);
195459d29c0eSThierry Reding 	if (err < 0) {
195559d29c0eSThierry Reding 		dev_err(&pdev->dev, "failed to remove RGB output: %d\n", err);
195659d29c0eSThierry Reding 		return err;
195759d29c0eSThierry Reding 	}
195859d29c0eSThierry Reding 
19595482d75aSThierry Reding 	reset_control_assert(dc->rst);
19609c012700SThierry Reding 
19619c012700SThierry Reding 	if (dc->soc->has_powergate)
19629c012700SThierry Reding 		tegra_powergate_power_off(dc->powergate);
19639c012700SThierry Reding 
1964dee8268fSThierry Reding 	clk_disable_unprepare(dc->clk);
1965dee8268fSThierry Reding 
1966dee8268fSThierry Reding 	return 0;
1967dee8268fSThierry Reding }
1968dee8268fSThierry Reding 
1969dee8268fSThierry Reding struct platform_driver tegra_dc_driver = {
1970dee8268fSThierry Reding 	.driver = {
1971dee8268fSThierry Reding 		.name = "tegra-dc",
1972dee8268fSThierry Reding 		.owner = THIS_MODULE,
1973dee8268fSThierry Reding 		.of_match_table = tegra_dc_of_match,
1974dee8268fSThierry Reding 	},
1975dee8268fSThierry Reding 	.probe = tegra_dc_probe,
1976dee8268fSThierry Reding 	.remove = tegra_dc_remove,
1977dee8268fSThierry Reding };
1978