xref: /OK3568_Linux_fs/kernel/drivers/gpu/drm/exynos/exynos7_drm_decon.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /* drivers/gpu/drm/exynos/exynos7_drm_decon.c
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * Copyright (C) 2014 Samsung Electronics Co.Ltd
5*4882a593Smuzhiyun  * Authors:
6*4882a593Smuzhiyun  *	Akshu Agarwal <akshua@gmail.com>
7*4882a593Smuzhiyun  *	Ajay Kumar <ajaykumar.rs@samsung.com>
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #include <linux/clk.h>
11*4882a593Smuzhiyun #include <linux/component.h>
12*4882a593Smuzhiyun #include <linux/kernel.h>
13*4882a593Smuzhiyun #include <linux/of.h>
14*4882a593Smuzhiyun #include <linux/of_address.h>
15*4882a593Smuzhiyun #include <linux/of_device.h>
16*4882a593Smuzhiyun #include <linux/platform_device.h>
17*4882a593Smuzhiyun #include <linux/pm_runtime.h>
18*4882a593Smuzhiyun 
19*4882a593Smuzhiyun #include <video/of_display_timing.h>
20*4882a593Smuzhiyun #include <video/of_videomode.h>
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #include <drm/drm_fourcc.h>
23*4882a593Smuzhiyun #include <drm/drm_vblank.h>
24*4882a593Smuzhiyun #include <drm/exynos_drm.h>
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #include "exynos_drm_crtc.h"
27*4882a593Smuzhiyun #include "exynos_drm_drv.h"
28*4882a593Smuzhiyun #include "exynos_drm_fb.h"
29*4882a593Smuzhiyun #include "exynos_drm_plane.h"
30*4882a593Smuzhiyun #include "regs-decon7.h"
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun /*
33*4882a593Smuzhiyun  * DECON stands for Display and Enhancement controller.
34*4882a593Smuzhiyun  */
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #define MIN_FB_WIDTH_FOR_16WORD_BURST 128
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun #define WINDOWS_NR	2
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun struct decon_context {
41*4882a593Smuzhiyun 	struct device			*dev;
42*4882a593Smuzhiyun 	struct drm_device		*drm_dev;
43*4882a593Smuzhiyun 	void				*dma_priv;
44*4882a593Smuzhiyun 	struct exynos_drm_crtc		*crtc;
45*4882a593Smuzhiyun 	struct exynos_drm_plane		planes[WINDOWS_NR];
46*4882a593Smuzhiyun 	struct exynos_drm_plane_config	configs[WINDOWS_NR];
47*4882a593Smuzhiyun 	struct clk			*pclk;
48*4882a593Smuzhiyun 	struct clk			*aclk;
49*4882a593Smuzhiyun 	struct clk			*eclk;
50*4882a593Smuzhiyun 	struct clk			*vclk;
51*4882a593Smuzhiyun 	void __iomem			*regs;
52*4882a593Smuzhiyun 	unsigned long			irq_flags;
53*4882a593Smuzhiyun 	bool				i80_if;
54*4882a593Smuzhiyun 	bool				suspended;
55*4882a593Smuzhiyun 	wait_queue_head_t		wait_vsync_queue;
56*4882a593Smuzhiyun 	atomic_t			wait_vsync_event;
57*4882a593Smuzhiyun 
58*4882a593Smuzhiyun 	struct drm_encoder *encoder;
59*4882a593Smuzhiyun };
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun static const struct of_device_id decon_driver_dt_match[] = {
62*4882a593Smuzhiyun 	{.compatible = "samsung,exynos7-decon"},
63*4882a593Smuzhiyun 	{},
64*4882a593Smuzhiyun };
65*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, decon_driver_dt_match);
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun static const uint32_t decon_formats[] = {
68*4882a593Smuzhiyun 	DRM_FORMAT_RGB565,
69*4882a593Smuzhiyun 	DRM_FORMAT_XRGB8888,
70*4882a593Smuzhiyun 	DRM_FORMAT_XBGR8888,
71*4882a593Smuzhiyun 	DRM_FORMAT_RGBX8888,
72*4882a593Smuzhiyun 	DRM_FORMAT_BGRX8888,
73*4882a593Smuzhiyun 	DRM_FORMAT_ARGB8888,
74*4882a593Smuzhiyun 	DRM_FORMAT_ABGR8888,
75*4882a593Smuzhiyun 	DRM_FORMAT_RGBA8888,
76*4882a593Smuzhiyun 	DRM_FORMAT_BGRA8888,
77*4882a593Smuzhiyun };
78*4882a593Smuzhiyun 
79*4882a593Smuzhiyun static const enum drm_plane_type decon_win_types[WINDOWS_NR] = {
80*4882a593Smuzhiyun 	DRM_PLANE_TYPE_PRIMARY,
81*4882a593Smuzhiyun 	DRM_PLANE_TYPE_CURSOR,
82*4882a593Smuzhiyun };
83*4882a593Smuzhiyun 
decon_wait_for_vblank(struct exynos_drm_crtc * crtc)84*4882a593Smuzhiyun static void decon_wait_for_vblank(struct exynos_drm_crtc *crtc)
85*4882a593Smuzhiyun {
86*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun 	if (ctx->suspended)
89*4882a593Smuzhiyun 		return;
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun 	atomic_set(&ctx->wait_vsync_event, 1);
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun 	/*
94*4882a593Smuzhiyun 	 * wait for DECON to signal VSYNC interrupt or return after
95*4882a593Smuzhiyun 	 * timeout which is set to 50ms (refresh rate of 20).
96*4882a593Smuzhiyun 	 */
97*4882a593Smuzhiyun 	if (!wait_event_timeout(ctx->wait_vsync_queue,
98*4882a593Smuzhiyun 				!atomic_read(&ctx->wait_vsync_event),
99*4882a593Smuzhiyun 				HZ/20))
100*4882a593Smuzhiyun 		DRM_DEV_DEBUG_KMS(ctx->dev, "vblank wait timed out.\n");
101*4882a593Smuzhiyun }
102*4882a593Smuzhiyun 
decon_clear_channels(struct exynos_drm_crtc * crtc)103*4882a593Smuzhiyun static void decon_clear_channels(struct exynos_drm_crtc *crtc)
104*4882a593Smuzhiyun {
105*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
106*4882a593Smuzhiyun 	unsigned int win, ch_enabled = 0;
107*4882a593Smuzhiyun 
108*4882a593Smuzhiyun 	/* Check if any channel is enabled. */
109*4882a593Smuzhiyun 	for (win = 0; win < WINDOWS_NR; win++) {
110*4882a593Smuzhiyun 		u32 val = readl(ctx->regs + WINCON(win));
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun 		if (val & WINCONx_ENWIN) {
113*4882a593Smuzhiyun 			val &= ~WINCONx_ENWIN;
114*4882a593Smuzhiyun 			writel(val, ctx->regs + WINCON(win));
115*4882a593Smuzhiyun 			ch_enabled = 1;
116*4882a593Smuzhiyun 		}
117*4882a593Smuzhiyun 	}
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun 	/* Wait for vsync, as disable channel takes effect at next vsync */
120*4882a593Smuzhiyun 	if (ch_enabled)
121*4882a593Smuzhiyun 		decon_wait_for_vblank(ctx->crtc);
122*4882a593Smuzhiyun }
123*4882a593Smuzhiyun 
decon_ctx_initialize(struct decon_context * ctx,struct drm_device * drm_dev)124*4882a593Smuzhiyun static int decon_ctx_initialize(struct decon_context *ctx,
125*4882a593Smuzhiyun 			struct drm_device *drm_dev)
126*4882a593Smuzhiyun {
127*4882a593Smuzhiyun 	ctx->drm_dev = drm_dev;
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun 	decon_clear_channels(ctx->crtc);
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun 	return exynos_drm_register_dma(drm_dev, ctx->dev, &ctx->dma_priv);
132*4882a593Smuzhiyun }
133*4882a593Smuzhiyun 
decon_ctx_remove(struct decon_context * ctx)134*4882a593Smuzhiyun static void decon_ctx_remove(struct decon_context *ctx)
135*4882a593Smuzhiyun {
136*4882a593Smuzhiyun 	/* detach this sub driver from iommu mapping if supported. */
137*4882a593Smuzhiyun 	exynos_drm_unregister_dma(ctx->drm_dev, ctx->dev, &ctx->dma_priv);
138*4882a593Smuzhiyun }
139*4882a593Smuzhiyun 
decon_calc_clkdiv(struct decon_context * ctx,const struct drm_display_mode * mode)140*4882a593Smuzhiyun static u32 decon_calc_clkdiv(struct decon_context *ctx,
141*4882a593Smuzhiyun 		const struct drm_display_mode *mode)
142*4882a593Smuzhiyun {
143*4882a593Smuzhiyun 	unsigned long ideal_clk = mode->clock;
144*4882a593Smuzhiyun 	u32 clkdiv;
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun 	/* Find the clock divider value that gets us closest to ideal_clk */
147*4882a593Smuzhiyun 	clkdiv = DIV_ROUND_UP(clk_get_rate(ctx->vclk), ideal_clk);
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun 	return (clkdiv < 0x100) ? clkdiv : 0xff;
150*4882a593Smuzhiyun }
151*4882a593Smuzhiyun 
decon_commit(struct exynos_drm_crtc * crtc)152*4882a593Smuzhiyun static void decon_commit(struct exynos_drm_crtc *crtc)
153*4882a593Smuzhiyun {
154*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
155*4882a593Smuzhiyun 	struct drm_display_mode *mode = &crtc->base.state->adjusted_mode;
156*4882a593Smuzhiyun 	u32 val, clkdiv;
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun 	if (ctx->suspended)
159*4882a593Smuzhiyun 		return;
160*4882a593Smuzhiyun 
161*4882a593Smuzhiyun 	/* nothing to do if we haven't set the mode yet */
162*4882a593Smuzhiyun 	if (mode->htotal == 0 || mode->vtotal == 0)
163*4882a593Smuzhiyun 		return;
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 	if (!ctx->i80_if) {
166*4882a593Smuzhiyun 		int vsync_len, vbpd, vfpd, hsync_len, hbpd, hfpd;
167*4882a593Smuzhiyun 	      /* setup vertical timing values. */
168*4882a593Smuzhiyun 		vsync_len = mode->crtc_vsync_end - mode->crtc_vsync_start;
169*4882a593Smuzhiyun 		vbpd = mode->crtc_vtotal - mode->crtc_vsync_end;
170*4882a593Smuzhiyun 		vfpd = mode->crtc_vsync_start - mode->crtc_vdisplay;
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 		val = VIDTCON0_VBPD(vbpd - 1) | VIDTCON0_VFPD(vfpd - 1);
173*4882a593Smuzhiyun 		writel(val, ctx->regs + VIDTCON0);
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun 		val = VIDTCON1_VSPW(vsync_len - 1);
176*4882a593Smuzhiyun 		writel(val, ctx->regs + VIDTCON1);
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 		/* setup horizontal timing values.  */
179*4882a593Smuzhiyun 		hsync_len = mode->crtc_hsync_end - mode->crtc_hsync_start;
180*4882a593Smuzhiyun 		hbpd = mode->crtc_htotal - mode->crtc_hsync_end;
181*4882a593Smuzhiyun 		hfpd = mode->crtc_hsync_start - mode->crtc_hdisplay;
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 		/* setup horizontal timing values.  */
184*4882a593Smuzhiyun 		val = VIDTCON2_HBPD(hbpd - 1) | VIDTCON2_HFPD(hfpd - 1);
185*4882a593Smuzhiyun 		writel(val, ctx->regs + VIDTCON2);
186*4882a593Smuzhiyun 
187*4882a593Smuzhiyun 		val = VIDTCON3_HSPW(hsync_len - 1);
188*4882a593Smuzhiyun 		writel(val, ctx->regs + VIDTCON3);
189*4882a593Smuzhiyun 	}
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun 	/* setup horizontal and vertical display size. */
192*4882a593Smuzhiyun 	val = VIDTCON4_LINEVAL(mode->vdisplay - 1) |
193*4882a593Smuzhiyun 	       VIDTCON4_HOZVAL(mode->hdisplay - 1);
194*4882a593Smuzhiyun 	writel(val, ctx->regs + VIDTCON4);
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun 	writel(mode->vdisplay - 1, ctx->regs + LINECNT_OP_THRESHOLD);
197*4882a593Smuzhiyun 
198*4882a593Smuzhiyun 	/*
199*4882a593Smuzhiyun 	 * fields of register with prefix '_F' would be updated
200*4882a593Smuzhiyun 	 * at vsync(same as dma start)
201*4882a593Smuzhiyun 	 */
202*4882a593Smuzhiyun 	val = VIDCON0_ENVID | VIDCON0_ENVID_F;
203*4882a593Smuzhiyun 	writel(val, ctx->regs + VIDCON0);
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun 	clkdiv = decon_calc_clkdiv(ctx, mode);
206*4882a593Smuzhiyun 	if (clkdiv > 1) {
207*4882a593Smuzhiyun 		val = VCLKCON1_CLKVAL_NUM_VCLK(clkdiv - 1);
208*4882a593Smuzhiyun 		writel(val, ctx->regs + VCLKCON1);
209*4882a593Smuzhiyun 		writel(val, ctx->regs + VCLKCON2);
210*4882a593Smuzhiyun 	}
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	val = readl(ctx->regs + DECON_UPDATE);
213*4882a593Smuzhiyun 	val |= DECON_UPDATE_STANDALONE_F;
214*4882a593Smuzhiyun 	writel(val, ctx->regs + DECON_UPDATE);
215*4882a593Smuzhiyun }
216*4882a593Smuzhiyun 
decon_enable_vblank(struct exynos_drm_crtc * crtc)217*4882a593Smuzhiyun static int decon_enable_vblank(struct exynos_drm_crtc *crtc)
218*4882a593Smuzhiyun {
219*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
220*4882a593Smuzhiyun 	u32 val;
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 	if (ctx->suspended)
223*4882a593Smuzhiyun 		return -EPERM;
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	if (!test_and_set_bit(0, &ctx->irq_flags)) {
226*4882a593Smuzhiyun 		val = readl(ctx->regs + VIDINTCON0);
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 		val |= VIDINTCON0_INT_ENABLE;
229*4882a593Smuzhiyun 
230*4882a593Smuzhiyun 		if (!ctx->i80_if) {
231*4882a593Smuzhiyun 			val |= VIDINTCON0_INT_FRAME;
232*4882a593Smuzhiyun 			val &= ~VIDINTCON0_FRAMESEL0_MASK;
233*4882a593Smuzhiyun 			val |= VIDINTCON0_FRAMESEL0_VSYNC;
234*4882a593Smuzhiyun 		}
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 		writel(val, ctx->regs + VIDINTCON0);
237*4882a593Smuzhiyun 	}
238*4882a593Smuzhiyun 
239*4882a593Smuzhiyun 	return 0;
240*4882a593Smuzhiyun }
241*4882a593Smuzhiyun 
decon_disable_vblank(struct exynos_drm_crtc * crtc)242*4882a593Smuzhiyun static void decon_disable_vblank(struct exynos_drm_crtc *crtc)
243*4882a593Smuzhiyun {
244*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
245*4882a593Smuzhiyun 	u32 val;
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	if (ctx->suspended)
248*4882a593Smuzhiyun 		return;
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 	if (test_and_clear_bit(0, &ctx->irq_flags)) {
251*4882a593Smuzhiyun 		val = readl(ctx->regs + VIDINTCON0);
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun 		val &= ~VIDINTCON0_INT_ENABLE;
254*4882a593Smuzhiyun 		if (!ctx->i80_if)
255*4882a593Smuzhiyun 			val &= ~VIDINTCON0_INT_FRAME;
256*4882a593Smuzhiyun 
257*4882a593Smuzhiyun 		writel(val, ctx->regs + VIDINTCON0);
258*4882a593Smuzhiyun 	}
259*4882a593Smuzhiyun }
260*4882a593Smuzhiyun 
decon_win_set_pixfmt(struct decon_context * ctx,unsigned int win,struct drm_framebuffer * fb)261*4882a593Smuzhiyun static void decon_win_set_pixfmt(struct decon_context *ctx, unsigned int win,
262*4882a593Smuzhiyun 				 struct drm_framebuffer *fb)
263*4882a593Smuzhiyun {
264*4882a593Smuzhiyun 	unsigned long val;
265*4882a593Smuzhiyun 	int padding;
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 	val = readl(ctx->regs + WINCON(win));
268*4882a593Smuzhiyun 	val &= ~WINCONx_BPPMODE_MASK;
269*4882a593Smuzhiyun 
270*4882a593Smuzhiyun 	switch (fb->format->format) {
271*4882a593Smuzhiyun 	case DRM_FORMAT_RGB565:
272*4882a593Smuzhiyun 		val |= WINCONx_BPPMODE_16BPP_565;
273*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_16WORD;
274*4882a593Smuzhiyun 		break;
275*4882a593Smuzhiyun 	case DRM_FORMAT_XRGB8888:
276*4882a593Smuzhiyun 		val |= WINCONx_BPPMODE_24BPP_xRGB;
277*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_16WORD;
278*4882a593Smuzhiyun 		break;
279*4882a593Smuzhiyun 	case DRM_FORMAT_XBGR8888:
280*4882a593Smuzhiyun 		val |= WINCONx_BPPMODE_24BPP_xBGR;
281*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_16WORD;
282*4882a593Smuzhiyun 		break;
283*4882a593Smuzhiyun 	case DRM_FORMAT_RGBX8888:
284*4882a593Smuzhiyun 		val |= WINCONx_BPPMODE_24BPP_RGBx;
285*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_16WORD;
286*4882a593Smuzhiyun 		break;
287*4882a593Smuzhiyun 	case DRM_FORMAT_BGRX8888:
288*4882a593Smuzhiyun 		val |= WINCONx_BPPMODE_24BPP_BGRx;
289*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_16WORD;
290*4882a593Smuzhiyun 		break;
291*4882a593Smuzhiyun 	case DRM_FORMAT_ARGB8888:
292*4882a593Smuzhiyun 		val |= WINCONx_BPPMODE_32BPP_ARGB | WINCONx_BLD_PIX |
293*4882a593Smuzhiyun 			WINCONx_ALPHA_SEL;
294*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_16WORD;
295*4882a593Smuzhiyun 		break;
296*4882a593Smuzhiyun 	case DRM_FORMAT_ABGR8888:
297*4882a593Smuzhiyun 		val |= WINCONx_BPPMODE_32BPP_ABGR | WINCONx_BLD_PIX |
298*4882a593Smuzhiyun 			WINCONx_ALPHA_SEL;
299*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_16WORD;
300*4882a593Smuzhiyun 		break;
301*4882a593Smuzhiyun 	case DRM_FORMAT_RGBA8888:
302*4882a593Smuzhiyun 		val |= WINCONx_BPPMODE_32BPP_RGBA | WINCONx_BLD_PIX |
303*4882a593Smuzhiyun 			WINCONx_ALPHA_SEL;
304*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_16WORD;
305*4882a593Smuzhiyun 		break;
306*4882a593Smuzhiyun 	case DRM_FORMAT_BGRA8888:
307*4882a593Smuzhiyun 	default:
308*4882a593Smuzhiyun 		val |= WINCONx_BPPMODE_32BPP_BGRA | WINCONx_BLD_PIX |
309*4882a593Smuzhiyun 			WINCONx_ALPHA_SEL;
310*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_16WORD;
311*4882a593Smuzhiyun 		break;
312*4882a593Smuzhiyun 	}
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "cpp = %d\n", fb->format->cpp[0]);
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun 	/*
317*4882a593Smuzhiyun 	 * In case of exynos, setting dma-burst to 16Word causes permanent
318*4882a593Smuzhiyun 	 * tearing for very small buffers, e.g. cursor buffer. Burst Mode
319*4882a593Smuzhiyun 	 * switching which is based on plane size is not recommended as
320*4882a593Smuzhiyun 	 * plane size varies a lot towards the end of the screen and rapid
321*4882a593Smuzhiyun 	 * movement causes unstable DMA which results into iommu crash/tear.
322*4882a593Smuzhiyun 	 */
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 	padding = (fb->pitches[0] / fb->format->cpp[0]) - fb->width;
325*4882a593Smuzhiyun 	if (fb->width + padding < MIN_FB_WIDTH_FOR_16WORD_BURST) {
326*4882a593Smuzhiyun 		val &= ~WINCONx_BURSTLEN_MASK;
327*4882a593Smuzhiyun 		val |= WINCONx_BURSTLEN_8WORD;
328*4882a593Smuzhiyun 	}
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 	writel(val, ctx->regs + WINCON(win));
331*4882a593Smuzhiyun }
332*4882a593Smuzhiyun 
decon_win_set_colkey(struct decon_context * ctx,unsigned int win)333*4882a593Smuzhiyun static void decon_win_set_colkey(struct decon_context *ctx, unsigned int win)
334*4882a593Smuzhiyun {
335*4882a593Smuzhiyun 	unsigned int keycon0 = 0, keycon1 = 0;
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 	keycon0 = ~(WxKEYCON0_KEYBL_EN | WxKEYCON0_KEYEN_F |
338*4882a593Smuzhiyun 			WxKEYCON0_DIRCON) | WxKEYCON0_COMPKEY(0);
339*4882a593Smuzhiyun 
340*4882a593Smuzhiyun 	keycon1 = WxKEYCON1_COLVAL(0xffffffff);
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun 	writel(keycon0, ctx->regs + WKEYCON0_BASE(win));
343*4882a593Smuzhiyun 	writel(keycon1, ctx->regs + WKEYCON1_BASE(win));
344*4882a593Smuzhiyun }
345*4882a593Smuzhiyun 
346*4882a593Smuzhiyun /**
347*4882a593Smuzhiyun  * shadow_protect_win() - disable updating values from shadow registers at vsync
348*4882a593Smuzhiyun  *
349*4882a593Smuzhiyun  * @win: window to protect registers for
350*4882a593Smuzhiyun  * @protect: 1 to protect (disable updates)
351*4882a593Smuzhiyun  */
decon_shadow_protect_win(struct decon_context * ctx,unsigned int win,bool protect)352*4882a593Smuzhiyun static void decon_shadow_protect_win(struct decon_context *ctx,
353*4882a593Smuzhiyun 				     unsigned int win, bool protect)
354*4882a593Smuzhiyun {
355*4882a593Smuzhiyun 	u32 bits, val;
356*4882a593Smuzhiyun 
357*4882a593Smuzhiyun 	bits = SHADOWCON_WINx_PROTECT(win);
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	val = readl(ctx->regs + SHADOWCON);
360*4882a593Smuzhiyun 	if (protect)
361*4882a593Smuzhiyun 		val |= bits;
362*4882a593Smuzhiyun 	else
363*4882a593Smuzhiyun 		val &= ~bits;
364*4882a593Smuzhiyun 	writel(val, ctx->regs + SHADOWCON);
365*4882a593Smuzhiyun }
366*4882a593Smuzhiyun 
decon_atomic_begin(struct exynos_drm_crtc * crtc)367*4882a593Smuzhiyun static void decon_atomic_begin(struct exynos_drm_crtc *crtc)
368*4882a593Smuzhiyun {
369*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
370*4882a593Smuzhiyun 	int i;
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	if (ctx->suspended)
373*4882a593Smuzhiyun 		return;
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 	for (i = 0; i < WINDOWS_NR; i++)
376*4882a593Smuzhiyun 		decon_shadow_protect_win(ctx, i, true);
377*4882a593Smuzhiyun }
378*4882a593Smuzhiyun 
decon_update_plane(struct exynos_drm_crtc * crtc,struct exynos_drm_plane * plane)379*4882a593Smuzhiyun static void decon_update_plane(struct exynos_drm_crtc *crtc,
380*4882a593Smuzhiyun 			       struct exynos_drm_plane *plane)
381*4882a593Smuzhiyun {
382*4882a593Smuzhiyun 	struct exynos_drm_plane_state *state =
383*4882a593Smuzhiyun 				to_exynos_plane_state(plane->base.state);
384*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
385*4882a593Smuzhiyun 	struct drm_framebuffer *fb = state->base.fb;
386*4882a593Smuzhiyun 	int padding;
387*4882a593Smuzhiyun 	unsigned long val, alpha;
388*4882a593Smuzhiyun 	unsigned int last_x;
389*4882a593Smuzhiyun 	unsigned int last_y;
390*4882a593Smuzhiyun 	unsigned int win = plane->index;
391*4882a593Smuzhiyun 	unsigned int cpp = fb->format->cpp[0];
392*4882a593Smuzhiyun 	unsigned int pitch = fb->pitches[0];
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun 	if (ctx->suspended)
395*4882a593Smuzhiyun 		return;
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun 	/*
398*4882a593Smuzhiyun 	 * SHADOWCON/PRTCON register is used for enabling timing.
399*4882a593Smuzhiyun 	 *
400*4882a593Smuzhiyun 	 * for example, once only width value of a register is set,
401*4882a593Smuzhiyun 	 * if the dma is started then decon hardware could malfunction so
402*4882a593Smuzhiyun 	 * with protect window setting, the register fields with prefix '_F'
403*4882a593Smuzhiyun 	 * wouldn't be updated at vsync also but updated once unprotect window
404*4882a593Smuzhiyun 	 * is set.
405*4882a593Smuzhiyun 	 */
406*4882a593Smuzhiyun 
407*4882a593Smuzhiyun 	/* buffer start address */
408*4882a593Smuzhiyun 	val = (unsigned long)exynos_drm_fb_dma_addr(fb, 0);
409*4882a593Smuzhiyun 	writel(val, ctx->regs + VIDW_BUF_START(win));
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 	padding = (pitch / cpp) - fb->width;
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 	/* buffer size */
414*4882a593Smuzhiyun 	writel(fb->width + padding, ctx->regs + VIDW_WHOLE_X(win));
415*4882a593Smuzhiyun 	writel(fb->height, ctx->regs + VIDW_WHOLE_Y(win));
416*4882a593Smuzhiyun 
417*4882a593Smuzhiyun 	/* offset from the start of the buffer to read */
418*4882a593Smuzhiyun 	writel(state->src.x, ctx->regs + VIDW_OFFSET_X(win));
419*4882a593Smuzhiyun 	writel(state->src.y, ctx->regs + VIDW_OFFSET_Y(win));
420*4882a593Smuzhiyun 
421*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "start addr = 0x%lx\n",
422*4882a593Smuzhiyun 			(unsigned long)val);
423*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "ovl_width = %d, ovl_height = %d\n",
424*4882a593Smuzhiyun 			state->crtc.w, state->crtc.h);
425*4882a593Smuzhiyun 
426*4882a593Smuzhiyun 	val = VIDOSDxA_TOPLEFT_X(state->crtc.x) |
427*4882a593Smuzhiyun 		VIDOSDxA_TOPLEFT_Y(state->crtc.y);
428*4882a593Smuzhiyun 	writel(val, ctx->regs + VIDOSD_A(win));
429*4882a593Smuzhiyun 
430*4882a593Smuzhiyun 	last_x = state->crtc.x + state->crtc.w;
431*4882a593Smuzhiyun 	if (last_x)
432*4882a593Smuzhiyun 		last_x--;
433*4882a593Smuzhiyun 	last_y = state->crtc.y + state->crtc.h;
434*4882a593Smuzhiyun 	if (last_y)
435*4882a593Smuzhiyun 		last_y--;
436*4882a593Smuzhiyun 
437*4882a593Smuzhiyun 	val = VIDOSDxB_BOTRIGHT_X(last_x) | VIDOSDxB_BOTRIGHT_Y(last_y);
438*4882a593Smuzhiyun 
439*4882a593Smuzhiyun 	writel(val, ctx->regs + VIDOSD_B(win));
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "osd pos: tx = %d, ty = %d, bx = %d, by = %d\n",
442*4882a593Smuzhiyun 			state->crtc.x, state->crtc.y, last_x, last_y);
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun 	/* OSD alpha */
445*4882a593Smuzhiyun 	alpha = VIDOSDxC_ALPHA0_R_F(0x0) |
446*4882a593Smuzhiyun 			VIDOSDxC_ALPHA0_G_F(0x0) |
447*4882a593Smuzhiyun 			VIDOSDxC_ALPHA0_B_F(0x0);
448*4882a593Smuzhiyun 
449*4882a593Smuzhiyun 	writel(alpha, ctx->regs + VIDOSD_C(win));
450*4882a593Smuzhiyun 
451*4882a593Smuzhiyun 	alpha = VIDOSDxD_ALPHA1_R_F(0xff) |
452*4882a593Smuzhiyun 			VIDOSDxD_ALPHA1_G_F(0xff) |
453*4882a593Smuzhiyun 			VIDOSDxD_ALPHA1_B_F(0xff);
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 	writel(alpha, ctx->regs + VIDOSD_D(win));
456*4882a593Smuzhiyun 
457*4882a593Smuzhiyun 	decon_win_set_pixfmt(ctx, win, fb);
458*4882a593Smuzhiyun 
459*4882a593Smuzhiyun 	/* hardware window 0 doesn't support color key. */
460*4882a593Smuzhiyun 	if (win != 0)
461*4882a593Smuzhiyun 		decon_win_set_colkey(ctx, win);
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 	/* wincon */
464*4882a593Smuzhiyun 	val = readl(ctx->regs + WINCON(win));
465*4882a593Smuzhiyun 	val |= WINCONx_TRIPLE_BUF_MODE;
466*4882a593Smuzhiyun 	val |= WINCONx_ENWIN;
467*4882a593Smuzhiyun 	writel(val, ctx->regs + WINCON(win));
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun 	/* Enable DMA channel and unprotect windows */
470*4882a593Smuzhiyun 	decon_shadow_protect_win(ctx, win, false);
471*4882a593Smuzhiyun 
472*4882a593Smuzhiyun 	val = readl(ctx->regs + DECON_UPDATE);
473*4882a593Smuzhiyun 	val |= DECON_UPDATE_STANDALONE_F;
474*4882a593Smuzhiyun 	writel(val, ctx->regs + DECON_UPDATE);
475*4882a593Smuzhiyun }
476*4882a593Smuzhiyun 
decon_disable_plane(struct exynos_drm_crtc * crtc,struct exynos_drm_plane * plane)477*4882a593Smuzhiyun static void decon_disable_plane(struct exynos_drm_crtc *crtc,
478*4882a593Smuzhiyun 				struct exynos_drm_plane *plane)
479*4882a593Smuzhiyun {
480*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
481*4882a593Smuzhiyun 	unsigned int win = plane->index;
482*4882a593Smuzhiyun 	u32 val;
483*4882a593Smuzhiyun 
484*4882a593Smuzhiyun 	if (ctx->suspended)
485*4882a593Smuzhiyun 		return;
486*4882a593Smuzhiyun 
487*4882a593Smuzhiyun 	/* protect windows */
488*4882a593Smuzhiyun 	decon_shadow_protect_win(ctx, win, true);
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 	/* wincon */
491*4882a593Smuzhiyun 	val = readl(ctx->regs + WINCON(win));
492*4882a593Smuzhiyun 	val &= ~WINCONx_ENWIN;
493*4882a593Smuzhiyun 	writel(val, ctx->regs + WINCON(win));
494*4882a593Smuzhiyun 
495*4882a593Smuzhiyun 	val = readl(ctx->regs + DECON_UPDATE);
496*4882a593Smuzhiyun 	val |= DECON_UPDATE_STANDALONE_F;
497*4882a593Smuzhiyun 	writel(val, ctx->regs + DECON_UPDATE);
498*4882a593Smuzhiyun }
499*4882a593Smuzhiyun 
decon_atomic_flush(struct exynos_drm_crtc * crtc)500*4882a593Smuzhiyun static void decon_atomic_flush(struct exynos_drm_crtc *crtc)
501*4882a593Smuzhiyun {
502*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
503*4882a593Smuzhiyun 	int i;
504*4882a593Smuzhiyun 
505*4882a593Smuzhiyun 	if (ctx->suspended)
506*4882a593Smuzhiyun 		return;
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun 	for (i = 0; i < WINDOWS_NR; i++)
509*4882a593Smuzhiyun 		decon_shadow_protect_win(ctx, i, false);
510*4882a593Smuzhiyun 	exynos_crtc_handle_event(crtc);
511*4882a593Smuzhiyun }
512*4882a593Smuzhiyun 
decon_init(struct decon_context * ctx)513*4882a593Smuzhiyun static void decon_init(struct decon_context *ctx)
514*4882a593Smuzhiyun {
515*4882a593Smuzhiyun 	u32 val;
516*4882a593Smuzhiyun 
517*4882a593Smuzhiyun 	writel(VIDCON0_SWRESET, ctx->regs + VIDCON0);
518*4882a593Smuzhiyun 
519*4882a593Smuzhiyun 	val = VIDOUTCON0_DISP_IF_0_ON;
520*4882a593Smuzhiyun 	if (!ctx->i80_if)
521*4882a593Smuzhiyun 		val |= VIDOUTCON0_RGBIF;
522*4882a593Smuzhiyun 	writel(val, ctx->regs + VIDOUTCON0);
523*4882a593Smuzhiyun 
524*4882a593Smuzhiyun 	writel(VCLKCON0_CLKVALUP | VCLKCON0_VCLKFREE, ctx->regs + VCLKCON0);
525*4882a593Smuzhiyun 
526*4882a593Smuzhiyun 	if (!ctx->i80_if)
527*4882a593Smuzhiyun 		writel(VIDCON1_VCLK_HOLD, ctx->regs + VIDCON1(0));
528*4882a593Smuzhiyun }
529*4882a593Smuzhiyun 
decon_atomic_enable(struct exynos_drm_crtc * crtc)530*4882a593Smuzhiyun static void decon_atomic_enable(struct exynos_drm_crtc *crtc)
531*4882a593Smuzhiyun {
532*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
533*4882a593Smuzhiyun 
534*4882a593Smuzhiyun 	if (!ctx->suspended)
535*4882a593Smuzhiyun 		return;
536*4882a593Smuzhiyun 
537*4882a593Smuzhiyun 	pm_runtime_get_sync(ctx->dev);
538*4882a593Smuzhiyun 
539*4882a593Smuzhiyun 	decon_init(ctx);
540*4882a593Smuzhiyun 
541*4882a593Smuzhiyun 	/* if vblank was enabled status, enable it again. */
542*4882a593Smuzhiyun 	if (test_and_clear_bit(0, &ctx->irq_flags))
543*4882a593Smuzhiyun 		decon_enable_vblank(ctx->crtc);
544*4882a593Smuzhiyun 
545*4882a593Smuzhiyun 	decon_commit(ctx->crtc);
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	ctx->suspended = false;
548*4882a593Smuzhiyun }
549*4882a593Smuzhiyun 
decon_atomic_disable(struct exynos_drm_crtc * crtc)550*4882a593Smuzhiyun static void decon_atomic_disable(struct exynos_drm_crtc *crtc)
551*4882a593Smuzhiyun {
552*4882a593Smuzhiyun 	struct decon_context *ctx = crtc->ctx;
553*4882a593Smuzhiyun 	int i;
554*4882a593Smuzhiyun 
555*4882a593Smuzhiyun 	if (ctx->suspended)
556*4882a593Smuzhiyun 		return;
557*4882a593Smuzhiyun 
558*4882a593Smuzhiyun 	/*
559*4882a593Smuzhiyun 	 * We need to make sure that all windows are disabled before we
560*4882a593Smuzhiyun 	 * suspend that connector. Otherwise we might try to scan from
561*4882a593Smuzhiyun 	 * a destroyed buffer later.
562*4882a593Smuzhiyun 	 */
563*4882a593Smuzhiyun 	for (i = 0; i < WINDOWS_NR; i++)
564*4882a593Smuzhiyun 		decon_disable_plane(crtc, &ctx->planes[i]);
565*4882a593Smuzhiyun 
566*4882a593Smuzhiyun 	pm_runtime_put_sync(ctx->dev);
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 	ctx->suspended = true;
569*4882a593Smuzhiyun }
570*4882a593Smuzhiyun 
571*4882a593Smuzhiyun static const struct exynos_drm_crtc_ops decon_crtc_ops = {
572*4882a593Smuzhiyun 	.atomic_enable = decon_atomic_enable,
573*4882a593Smuzhiyun 	.atomic_disable = decon_atomic_disable,
574*4882a593Smuzhiyun 	.enable_vblank = decon_enable_vblank,
575*4882a593Smuzhiyun 	.disable_vblank = decon_disable_vblank,
576*4882a593Smuzhiyun 	.atomic_begin = decon_atomic_begin,
577*4882a593Smuzhiyun 	.update_plane = decon_update_plane,
578*4882a593Smuzhiyun 	.disable_plane = decon_disable_plane,
579*4882a593Smuzhiyun 	.atomic_flush = decon_atomic_flush,
580*4882a593Smuzhiyun };
581*4882a593Smuzhiyun 
582*4882a593Smuzhiyun 
decon_irq_handler(int irq,void * dev_id)583*4882a593Smuzhiyun static irqreturn_t decon_irq_handler(int irq, void *dev_id)
584*4882a593Smuzhiyun {
585*4882a593Smuzhiyun 	struct decon_context *ctx = (struct decon_context *)dev_id;
586*4882a593Smuzhiyun 	u32 val, clear_bit;
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun 	val = readl(ctx->regs + VIDINTCON1);
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun 	clear_bit = ctx->i80_if ? VIDINTCON1_INT_I80 : VIDINTCON1_INT_FRAME;
591*4882a593Smuzhiyun 	if (val & clear_bit)
592*4882a593Smuzhiyun 		writel(clear_bit, ctx->regs + VIDINTCON1);
593*4882a593Smuzhiyun 
594*4882a593Smuzhiyun 	/* check the crtc is detached already from encoder */
595*4882a593Smuzhiyun 	if (!ctx->drm_dev)
596*4882a593Smuzhiyun 		goto out;
597*4882a593Smuzhiyun 
598*4882a593Smuzhiyun 	if (!ctx->i80_if) {
599*4882a593Smuzhiyun 		drm_crtc_handle_vblank(&ctx->crtc->base);
600*4882a593Smuzhiyun 
601*4882a593Smuzhiyun 		/* set wait vsync event to zero and wake up queue. */
602*4882a593Smuzhiyun 		if (atomic_read(&ctx->wait_vsync_event)) {
603*4882a593Smuzhiyun 			atomic_set(&ctx->wait_vsync_event, 0);
604*4882a593Smuzhiyun 			wake_up(&ctx->wait_vsync_queue);
605*4882a593Smuzhiyun 		}
606*4882a593Smuzhiyun 	}
607*4882a593Smuzhiyun out:
608*4882a593Smuzhiyun 	return IRQ_HANDLED;
609*4882a593Smuzhiyun }
610*4882a593Smuzhiyun 
decon_bind(struct device * dev,struct device * master,void * data)611*4882a593Smuzhiyun static int decon_bind(struct device *dev, struct device *master, void *data)
612*4882a593Smuzhiyun {
613*4882a593Smuzhiyun 	struct decon_context *ctx = dev_get_drvdata(dev);
614*4882a593Smuzhiyun 	struct drm_device *drm_dev = data;
615*4882a593Smuzhiyun 	struct exynos_drm_plane *exynos_plane;
616*4882a593Smuzhiyun 	unsigned int i;
617*4882a593Smuzhiyun 	int ret;
618*4882a593Smuzhiyun 
619*4882a593Smuzhiyun 	ret = decon_ctx_initialize(ctx, drm_dev);
620*4882a593Smuzhiyun 	if (ret) {
621*4882a593Smuzhiyun 		DRM_DEV_ERROR(dev, "decon_ctx_initialize failed.\n");
622*4882a593Smuzhiyun 		return ret;
623*4882a593Smuzhiyun 	}
624*4882a593Smuzhiyun 
625*4882a593Smuzhiyun 	for (i = 0; i < WINDOWS_NR; i++) {
626*4882a593Smuzhiyun 		ctx->configs[i].pixel_formats = decon_formats;
627*4882a593Smuzhiyun 		ctx->configs[i].num_pixel_formats = ARRAY_SIZE(decon_formats);
628*4882a593Smuzhiyun 		ctx->configs[i].zpos = i;
629*4882a593Smuzhiyun 		ctx->configs[i].type = decon_win_types[i];
630*4882a593Smuzhiyun 
631*4882a593Smuzhiyun 		ret = exynos_plane_init(drm_dev, &ctx->planes[i], i,
632*4882a593Smuzhiyun 					&ctx->configs[i]);
633*4882a593Smuzhiyun 		if (ret)
634*4882a593Smuzhiyun 			return ret;
635*4882a593Smuzhiyun 	}
636*4882a593Smuzhiyun 
637*4882a593Smuzhiyun 	exynos_plane = &ctx->planes[DEFAULT_WIN];
638*4882a593Smuzhiyun 	ctx->crtc = exynos_drm_crtc_create(drm_dev, &exynos_plane->base,
639*4882a593Smuzhiyun 			EXYNOS_DISPLAY_TYPE_LCD, &decon_crtc_ops, ctx);
640*4882a593Smuzhiyun 	if (IS_ERR(ctx->crtc)) {
641*4882a593Smuzhiyun 		decon_ctx_remove(ctx);
642*4882a593Smuzhiyun 		return PTR_ERR(ctx->crtc);
643*4882a593Smuzhiyun 	}
644*4882a593Smuzhiyun 
645*4882a593Smuzhiyun 	if (ctx->encoder)
646*4882a593Smuzhiyun 		exynos_dpi_bind(drm_dev, ctx->encoder);
647*4882a593Smuzhiyun 
648*4882a593Smuzhiyun 	return 0;
649*4882a593Smuzhiyun 
650*4882a593Smuzhiyun }
651*4882a593Smuzhiyun 
decon_unbind(struct device * dev,struct device * master,void * data)652*4882a593Smuzhiyun static void decon_unbind(struct device *dev, struct device *master,
653*4882a593Smuzhiyun 			void *data)
654*4882a593Smuzhiyun {
655*4882a593Smuzhiyun 	struct decon_context *ctx = dev_get_drvdata(dev);
656*4882a593Smuzhiyun 
657*4882a593Smuzhiyun 	decon_atomic_disable(ctx->crtc);
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun 	if (ctx->encoder)
660*4882a593Smuzhiyun 		exynos_dpi_remove(ctx->encoder);
661*4882a593Smuzhiyun 
662*4882a593Smuzhiyun 	decon_ctx_remove(ctx);
663*4882a593Smuzhiyun }
664*4882a593Smuzhiyun 
665*4882a593Smuzhiyun static const struct component_ops decon_component_ops = {
666*4882a593Smuzhiyun 	.bind	= decon_bind,
667*4882a593Smuzhiyun 	.unbind = decon_unbind,
668*4882a593Smuzhiyun };
669*4882a593Smuzhiyun 
decon_probe(struct platform_device * pdev)670*4882a593Smuzhiyun static int decon_probe(struct platform_device *pdev)
671*4882a593Smuzhiyun {
672*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
673*4882a593Smuzhiyun 	struct decon_context *ctx;
674*4882a593Smuzhiyun 	struct device_node *i80_if_timings;
675*4882a593Smuzhiyun 	struct resource *res;
676*4882a593Smuzhiyun 	int ret;
677*4882a593Smuzhiyun 
678*4882a593Smuzhiyun 	if (!dev->of_node)
679*4882a593Smuzhiyun 		return -ENODEV;
680*4882a593Smuzhiyun 
681*4882a593Smuzhiyun 	ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
682*4882a593Smuzhiyun 	if (!ctx)
683*4882a593Smuzhiyun 		return -ENOMEM;
684*4882a593Smuzhiyun 
685*4882a593Smuzhiyun 	ctx->dev = dev;
686*4882a593Smuzhiyun 	ctx->suspended = true;
687*4882a593Smuzhiyun 
688*4882a593Smuzhiyun 	i80_if_timings = of_get_child_by_name(dev->of_node, "i80-if-timings");
689*4882a593Smuzhiyun 	if (i80_if_timings)
690*4882a593Smuzhiyun 		ctx->i80_if = true;
691*4882a593Smuzhiyun 	of_node_put(i80_if_timings);
692*4882a593Smuzhiyun 
693*4882a593Smuzhiyun 	ctx->regs = of_iomap(dev->of_node, 0);
694*4882a593Smuzhiyun 	if (!ctx->regs)
695*4882a593Smuzhiyun 		return -ENOMEM;
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun 	ctx->pclk = devm_clk_get(dev, "pclk_decon0");
698*4882a593Smuzhiyun 	if (IS_ERR(ctx->pclk)) {
699*4882a593Smuzhiyun 		dev_err(dev, "failed to get bus clock pclk\n");
700*4882a593Smuzhiyun 		ret = PTR_ERR(ctx->pclk);
701*4882a593Smuzhiyun 		goto err_iounmap;
702*4882a593Smuzhiyun 	}
703*4882a593Smuzhiyun 
704*4882a593Smuzhiyun 	ctx->aclk = devm_clk_get(dev, "aclk_decon0");
705*4882a593Smuzhiyun 	if (IS_ERR(ctx->aclk)) {
706*4882a593Smuzhiyun 		dev_err(dev, "failed to get bus clock aclk\n");
707*4882a593Smuzhiyun 		ret = PTR_ERR(ctx->aclk);
708*4882a593Smuzhiyun 		goto err_iounmap;
709*4882a593Smuzhiyun 	}
710*4882a593Smuzhiyun 
711*4882a593Smuzhiyun 	ctx->eclk = devm_clk_get(dev, "decon0_eclk");
712*4882a593Smuzhiyun 	if (IS_ERR(ctx->eclk)) {
713*4882a593Smuzhiyun 		dev_err(dev, "failed to get eclock\n");
714*4882a593Smuzhiyun 		ret = PTR_ERR(ctx->eclk);
715*4882a593Smuzhiyun 		goto err_iounmap;
716*4882a593Smuzhiyun 	}
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 	ctx->vclk = devm_clk_get(dev, "decon0_vclk");
719*4882a593Smuzhiyun 	if (IS_ERR(ctx->vclk)) {
720*4882a593Smuzhiyun 		dev_err(dev, "failed to get vclock\n");
721*4882a593Smuzhiyun 		ret = PTR_ERR(ctx->vclk);
722*4882a593Smuzhiyun 		goto err_iounmap;
723*4882a593Smuzhiyun 	}
724*4882a593Smuzhiyun 
725*4882a593Smuzhiyun 	res = platform_get_resource_byname(pdev, IORESOURCE_IRQ,
726*4882a593Smuzhiyun 					   ctx->i80_if ? "lcd_sys" : "vsync");
727*4882a593Smuzhiyun 	if (!res) {
728*4882a593Smuzhiyun 		dev_err(dev, "irq request failed.\n");
729*4882a593Smuzhiyun 		ret = -ENXIO;
730*4882a593Smuzhiyun 		goto err_iounmap;
731*4882a593Smuzhiyun 	}
732*4882a593Smuzhiyun 
733*4882a593Smuzhiyun 	ret = devm_request_irq(dev, res->start, decon_irq_handler,
734*4882a593Smuzhiyun 							0, "drm_decon", ctx);
735*4882a593Smuzhiyun 	if (ret) {
736*4882a593Smuzhiyun 		dev_err(dev, "irq request failed.\n");
737*4882a593Smuzhiyun 		goto err_iounmap;
738*4882a593Smuzhiyun 	}
739*4882a593Smuzhiyun 
740*4882a593Smuzhiyun 	init_waitqueue_head(&ctx->wait_vsync_queue);
741*4882a593Smuzhiyun 	atomic_set(&ctx->wait_vsync_event, 0);
742*4882a593Smuzhiyun 
743*4882a593Smuzhiyun 	platform_set_drvdata(pdev, ctx);
744*4882a593Smuzhiyun 
745*4882a593Smuzhiyun 	ctx->encoder = exynos_dpi_probe(dev);
746*4882a593Smuzhiyun 	if (IS_ERR(ctx->encoder)) {
747*4882a593Smuzhiyun 		ret = PTR_ERR(ctx->encoder);
748*4882a593Smuzhiyun 		goto err_iounmap;
749*4882a593Smuzhiyun 	}
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun 	pm_runtime_enable(dev);
752*4882a593Smuzhiyun 
753*4882a593Smuzhiyun 	ret = component_add(dev, &decon_component_ops);
754*4882a593Smuzhiyun 	if (ret)
755*4882a593Smuzhiyun 		goto err_disable_pm_runtime;
756*4882a593Smuzhiyun 
757*4882a593Smuzhiyun 	return ret;
758*4882a593Smuzhiyun 
759*4882a593Smuzhiyun err_disable_pm_runtime:
760*4882a593Smuzhiyun 	pm_runtime_disable(dev);
761*4882a593Smuzhiyun 
762*4882a593Smuzhiyun err_iounmap:
763*4882a593Smuzhiyun 	iounmap(ctx->regs);
764*4882a593Smuzhiyun 
765*4882a593Smuzhiyun 	return ret;
766*4882a593Smuzhiyun }
767*4882a593Smuzhiyun 
decon_remove(struct platform_device * pdev)768*4882a593Smuzhiyun static int decon_remove(struct platform_device *pdev)
769*4882a593Smuzhiyun {
770*4882a593Smuzhiyun 	struct decon_context *ctx = dev_get_drvdata(&pdev->dev);
771*4882a593Smuzhiyun 
772*4882a593Smuzhiyun 	pm_runtime_disable(&pdev->dev);
773*4882a593Smuzhiyun 
774*4882a593Smuzhiyun 	iounmap(ctx->regs);
775*4882a593Smuzhiyun 
776*4882a593Smuzhiyun 	component_del(&pdev->dev, &decon_component_ops);
777*4882a593Smuzhiyun 
778*4882a593Smuzhiyun 	return 0;
779*4882a593Smuzhiyun }
780*4882a593Smuzhiyun 
781*4882a593Smuzhiyun #ifdef CONFIG_PM
exynos7_decon_suspend(struct device * dev)782*4882a593Smuzhiyun static int exynos7_decon_suspend(struct device *dev)
783*4882a593Smuzhiyun {
784*4882a593Smuzhiyun 	struct decon_context *ctx = dev_get_drvdata(dev);
785*4882a593Smuzhiyun 
786*4882a593Smuzhiyun 	clk_disable_unprepare(ctx->vclk);
787*4882a593Smuzhiyun 	clk_disable_unprepare(ctx->eclk);
788*4882a593Smuzhiyun 	clk_disable_unprepare(ctx->aclk);
789*4882a593Smuzhiyun 	clk_disable_unprepare(ctx->pclk);
790*4882a593Smuzhiyun 
791*4882a593Smuzhiyun 	return 0;
792*4882a593Smuzhiyun }
793*4882a593Smuzhiyun 
exynos7_decon_resume(struct device * dev)794*4882a593Smuzhiyun static int exynos7_decon_resume(struct device *dev)
795*4882a593Smuzhiyun {
796*4882a593Smuzhiyun 	struct decon_context *ctx = dev_get_drvdata(dev);
797*4882a593Smuzhiyun 	int ret;
798*4882a593Smuzhiyun 
799*4882a593Smuzhiyun 	ret = clk_prepare_enable(ctx->pclk);
800*4882a593Smuzhiyun 	if (ret < 0) {
801*4882a593Smuzhiyun 		DRM_DEV_ERROR(dev, "Failed to prepare_enable the pclk [%d]\n",
802*4882a593Smuzhiyun 			      ret);
803*4882a593Smuzhiyun 		goto err_pclk_enable;
804*4882a593Smuzhiyun 	}
805*4882a593Smuzhiyun 
806*4882a593Smuzhiyun 	ret = clk_prepare_enable(ctx->aclk);
807*4882a593Smuzhiyun 	if (ret < 0) {
808*4882a593Smuzhiyun 		DRM_DEV_ERROR(dev, "Failed to prepare_enable the aclk [%d]\n",
809*4882a593Smuzhiyun 			      ret);
810*4882a593Smuzhiyun 		goto err_aclk_enable;
811*4882a593Smuzhiyun 	}
812*4882a593Smuzhiyun 
813*4882a593Smuzhiyun 	ret = clk_prepare_enable(ctx->eclk);
814*4882a593Smuzhiyun 	if  (ret < 0) {
815*4882a593Smuzhiyun 		DRM_DEV_ERROR(dev, "Failed to prepare_enable the eclk [%d]\n",
816*4882a593Smuzhiyun 			      ret);
817*4882a593Smuzhiyun 		goto err_eclk_enable;
818*4882a593Smuzhiyun 	}
819*4882a593Smuzhiyun 
820*4882a593Smuzhiyun 	ret = clk_prepare_enable(ctx->vclk);
821*4882a593Smuzhiyun 	if  (ret < 0) {
822*4882a593Smuzhiyun 		DRM_DEV_ERROR(dev, "Failed to prepare_enable the vclk [%d]\n",
823*4882a593Smuzhiyun 			      ret);
824*4882a593Smuzhiyun 		goto err_vclk_enable;
825*4882a593Smuzhiyun 	}
826*4882a593Smuzhiyun 
827*4882a593Smuzhiyun 	return 0;
828*4882a593Smuzhiyun 
829*4882a593Smuzhiyun err_vclk_enable:
830*4882a593Smuzhiyun 	clk_disable_unprepare(ctx->eclk);
831*4882a593Smuzhiyun err_eclk_enable:
832*4882a593Smuzhiyun 	clk_disable_unprepare(ctx->aclk);
833*4882a593Smuzhiyun err_aclk_enable:
834*4882a593Smuzhiyun 	clk_disable_unprepare(ctx->pclk);
835*4882a593Smuzhiyun err_pclk_enable:
836*4882a593Smuzhiyun 	return ret;
837*4882a593Smuzhiyun }
838*4882a593Smuzhiyun #endif
839*4882a593Smuzhiyun 
840*4882a593Smuzhiyun static const struct dev_pm_ops exynos7_decon_pm_ops = {
841*4882a593Smuzhiyun 	SET_RUNTIME_PM_OPS(exynos7_decon_suspend, exynos7_decon_resume,
842*4882a593Smuzhiyun 			   NULL)
843*4882a593Smuzhiyun 	SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
844*4882a593Smuzhiyun 				pm_runtime_force_resume)
845*4882a593Smuzhiyun };
846*4882a593Smuzhiyun 
847*4882a593Smuzhiyun struct platform_driver decon_driver = {
848*4882a593Smuzhiyun 	.probe		= decon_probe,
849*4882a593Smuzhiyun 	.remove		= decon_remove,
850*4882a593Smuzhiyun 	.driver		= {
851*4882a593Smuzhiyun 		.name	= "exynos-decon",
852*4882a593Smuzhiyun 		.pm	= &exynos7_decon_pm_ops,
853*4882a593Smuzhiyun 		.of_match_table = decon_driver_dt_match,
854*4882a593Smuzhiyun 	},
855*4882a593Smuzhiyun };
856