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