2 * Copyright (C) 2017 Linus Walleij <linus.walleij@linaro.org>
3 * Parts of this file were based on sources as follows:
5 * Copyright (C) 2006-2008 Intel Corporation
6 * Copyright (C) 2007 Amos Lee <amos_lee@storlinksemi.com>
7 * Copyright (C) 2007 Dave Airlie <airlied@linux.ie>
8 * Copyright (C) 2011 Texas Instruments
9 * Copyright (C) 2017 Eric Anholt
11 * This program is free software and is provided to you under the terms of the
12 * GNU General Public License version 2 as published by the Free Software
13 * Foundation, and any use by you of this program is subject to the terms of
16 #include <linux/clk.h>
17 #include <linux/version.h>
18 #include <linux/dma-buf.h>
19 #include <linux/of_graph.h>
22 #include <drm/drm_panel.h>
23 #include <drm/drm_gem_cma_helper.h>
24 #include <drm/drm_gem_framebuffer_helper.h>
25 #include <drm/drm_fb_cma_helper.h>
27 #include "tve200_drm.h"
29 irqreturn_t tve200_irq(int irq, void *data)
31 struct tve200_drm_dev_private *priv = data;
35 stat = readl(priv->regs + TVE200_INT_STAT);
43 * The hardware is a bit tilted: the line stays high after clearing
44 * the vblank IRQ, firing many more interrupts. We counter this
45 * by toggling the IRQ back and forth from firing at vblank and
46 * firing at start of active image, which works around the problem
47 * since those occur strictly in sequence, and we get two IRQs for each
48 * frame, one at start of Vblank (that we make call into the CRTC) and
49 * another one at the start of the image (that we discard).
51 if (stat & TVE200_INT_V_STATUS) {
52 val = readl(priv->regs + TVE200_CTRL);
53 /* We have an actual start of vsync */
54 if (!(val & TVE200_VSTSTYPE_BITS)) {
55 drm_crtc_handle_vblank(&priv->pipe.crtc);
56 /* Toggle trigger to start of active image */
57 val |= TVE200_VSTSTYPE_VAI;
59 /* Toggle trigger back to start of vsync */
60 val &= ~TVE200_VSTSTYPE_BITS;
62 writel(val, priv->regs + TVE200_CTRL);
64 dev_err(priv->drm->dev, "stray IRQ %08x\n", stat);
66 /* Clear the interrupt once done */
67 writel(stat, priv->regs + TVE200_INT_CLR);
72 static int tve200_display_check(struct drm_simple_display_pipe *pipe,
73 struct drm_plane_state *pstate,
74 struct drm_crtc_state *cstate)
76 const struct drm_display_mode *mode = &cstate->mode;
77 struct drm_framebuffer *old_fb = pipe->plane.state->fb;
78 struct drm_framebuffer *fb = pstate->fb;
81 * We support these specific resolutions and nothing else.
83 if (!(mode->hdisplay == 352 && mode->vdisplay == 240) && /* SIF(525) */
84 !(mode->hdisplay == 352 && mode->vdisplay == 288) && /* CIF(625) */
85 !(mode->hdisplay == 640 && mode->vdisplay == 480) && /* VGA */
86 !(mode->hdisplay == 720 && mode->vdisplay == 480) && /* D1 */
87 !(mode->hdisplay == 720 && mode->vdisplay == 576)) { /* D1 */
88 DRM_DEBUG_KMS("unsupported display mode (%u x %u)\n",
89 mode->hdisplay, mode->vdisplay);
94 u32 offset = drm_fb_cma_get_gem_addr(fb, pstate, 0);
96 /* FB base address must be dword aligned. */
98 DRM_DEBUG_KMS("FB not 32-bit aligned\n");
103 * There's no pitch register, the mode's hdisplay
106 if (fb->pitches[0] != mode->hdisplay * fb->format->cpp[0]) {
107 DRM_DEBUG_KMS("can't handle pitches\n");
112 * We can't change the FB format in a flicker-free
113 * manner (and only update it during CRTC enable).
115 if (old_fb && old_fb->format != fb->format)
116 cstate->mode_changed = true;
122 static void tve200_display_enable(struct drm_simple_display_pipe *pipe,
123 struct drm_crtc_state *cstate,
124 struct drm_plane_state *plane_state)
126 struct drm_crtc *crtc = &pipe->crtc;
127 struct drm_plane *plane = &pipe->plane;
128 struct drm_device *drm = crtc->dev;
129 struct tve200_drm_dev_private *priv = drm->dev_private;
130 const struct drm_display_mode *mode = &cstate->mode;
131 struct drm_framebuffer *fb = plane->state->fb;
132 struct drm_connector *connector = priv->connector;
133 u32 format = fb->format->format;
136 clk_prepare_enable(priv->clk);
139 ctrl1 |= TVE200_CTRL_CSMODE;
140 /* Interlace mode for CCIR656: parameterize? */
141 ctrl1 |= TVE200_CTRL_NONINTERLACE;
142 /* 32 words per burst */
143 ctrl1 |= TVE200_CTRL_BURST_32_WORDS;
145 ctrl1 |= TVE200_CTRL_RETRYCNT_16;
146 /* NTSC mode: parametrize? */
147 ctrl1 |= TVE200_CTRL_NTSC;
149 /* Vsync IRQ at start of Vsync at first */
150 ctrl1 |= TVE200_VSTSTYPE_VSYNC;
152 if (connector->display_info.bus_flags &
153 DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE)
154 ctrl1 |= TVE200_CTRL_TVCLKP;
156 if ((mode->hdisplay == 352 && mode->vdisplay == 240) || /* SIF(525) */
157 (mode->hdisplay == 352 && mode->vdisplay == 288)) { /* CIF(625) */
158 ctrl1 |= TVE200_CTRL_IPRESOL_CIF;
159 dev_info(drm->dev, "CIF mode\n");
160 } else if (mode->hdisplay == 640 && mode->vdisplay == 480) {
161 ctrl1 |= TVE200_CTRL_IPRESOL_VGA;
162 dev_info(drm->dev, "VGA mode\n");
163 } else if ((mode->hdisplay == 720 && mode->vdisplay == 480) ||
164 (mode->hdisplay == 720 && mode->vdisplay == 576)) {
165 ctrl1 |= TVE200_CTRL_IPRESOL_D1;
166 dev_info(drm->dev, "D1 mode\n");
169 if (format & DRM_FORMAT_BIG_ENDIAN) {
170 ctrl1 |= TVE200_CTRL_BBBP;
171 format &= ~DRM_FORMAT_BIG_ENDIAN;
175 case DRM_FORMAT_XRGB8888:
176 ctrl1 |= TVE200_IPDMOD_RGB888;
178 case DRM_FORMAT_RGB565:
179 ctrl1 |= TVE200_IPDMOD_RGB565;
181 case DRM_FORMAT_XRGB1555:
182 ctrl1 |= TVE200_IPDMOD_RGB555;
184 case DRM_FORMAT_XBGR8888:
185 ctrl1 |= TVE200_IPDMOD_RGB888 | TVE200_BGR;
187 case DRM_FORMAT_BGR565:
188 ctrl1 |= TVE200_IPDMOD_RGB565 | TVE200_BGR;
190 case DRM_FORMAT_XBGR1555:
191 ctrl1 |= TVE200_IPDMOD_RGB555 | TVE200_BGR;
193 case DRM_FORMAT_YUYV:
194 ctrl1 |= TVE200_IPDMOD_YUV422;
195 ctrl1 |= TVE200_CTRL_YCBCRODR_CR0Y1CB0Y0;
197 case DRM_FORMAT_YVYU:
198 ctrl1 |= TVE200_IPDMOD_YUV422;
199 ctrl1 |= TVE200_CTRL_YCBCRODR_CB0Y1CR0Y0;
201 case DRM_FORMAT_UYVY:
202 ctrl1 |= TVE200_IPDMOD_YUV422;
203 ctrl1 |= TVE200_CTRL_YCBCRODR_Y1CR0Y0CB0;
205 case DRM_FORMAT_VYUY:
206 ctrl1 |= TVE200_IPDMOD_YUV422;
207 ctrl1 |= TVE200_CTRL_YCBCRODR_Y1CB0Y0CR0;
209 case DRM_FORMAT_YUV420:
210 ctrl1 |= TVE200_CTRL_YUV420;
211 ctrl1 |= TVE200_IPDMOD_YUV420;
214 dev_err(drm->dev, "Unknown FB format 0x%08x\n",
219 ctrl1 |= TVE200_TVEEN;
222 writel(ctrl1, priv->regs + TVE200_CTRL);
224 drm_crtc_vblank_on(crtc);
227 static void tve200_display_disable(struct drm_simple_display_pipe *pipe)
229 struct drm_crtc *crtc = &pipe->crtc;
230 struct drm_device *drm = crtc->dev;
231 struct tve200_drm_dev_private *priv = drm->dev_private;
233 drm_crtc_vblank_off(crtc);
235 /* Disable and Power Down */
236 writel(0, priv->regs + TVE200_CTRL);
238 clk_disable_unprepare(priv->clk);
241 static void tve200_display_update(struct drm_simple_display_pipe *pipe,
242 struct drm_plane_state *old_pstate)
244 struct drm_crtc *crtc = &pipe->crtc;
245 struct drm_device *drm = crtc->dev;
246 struct tve200_drm_dev_private *priv = drm->dev_private;
247 struct drm_pending_vblank_event *event = crtc->state->event;
248 struct drm_plane *plane = &pipe->plane;
249 struct drm_plane_state *pstate = plane->state;
250 struct drm_framebuffer *fb = pstate->fb;
253 /* For RGB, the Y component is used as base address */
254 writel(drm_fb_cma_get_gem_addr(fb, pstate, 0),
255 priv->regs + TVE200_Y_FRAME_BASE_ADDR);
257 /* For three plane YUV we need two more addresses */
258 if (fb->format->format == DRM_FORMAT_YUV420) {
259 writel(drm_fb_cma_get_gem_addr(fb, pstate, 1),
260 priv->regs + TVE200_U_FRAME_BASE_ADDR);
261 writel(drm_fb_cma_get_gem_addr(fb, pstate, 2),
262 priv->regs + TVE200_V_FRAME_BASE_ADDR);
267 crtc->state->event = NULL;
269 spin_lock_irq(&crtc->dev->event_lock);
270 if (crtc->state->active && drm_crtc_vblank_get(crtc) == 0)
271 drm_crtc_arm_vblank_event(crtc, event);
273 drm_crtc_send_vblank_event(crtc, event);
274 spin_unlock_irq(&crtc->dev->event_lock);
278 static int tve200_display_enable_vblank(struct drm_simple_display_pipe *pipe)
280 struct drm_crtc *crtc = &pipe->crtc;
281 struct drm_device *drm = crtc->dev;
282 struct tve200_drm_dev_private *priv = drm->dev_private;
284 writel(TVE200_INT_V_STATUS, priv->regs + TVE200_INT_EN);
288 static void tve200_display_disable_vblank(struct drm_simple_display_pipe *pipe)
290 struct drm_crtc *crtc = &pipe->crtc;
291 struct drm_device *drm = crtc->dev;
292 struct tve200_drm_dev_private *priv = drm->dev_private;
294 writel(0, priv->regs + TVE200_INT_EN);
297 static const struct drm_simple_display_pipe_funcs tve200_display_funcs = {
298 .check = tve200_display_check,
299 .enable = tve200_display_enable,
300 .disable = tve200_display_disable,
301 .update = tve200_display_update,
302 .prepare_fb = drm_gem_fb_simple_display_pipe_prepare_fb,
303 .enable_vblank = tve200_display_enable_vblank,
304 .disable_vblank = tve200_display_disable_vblank,
307 int tve200_display_init(struct drm_device *drm)
309 struct tve200_drm_dev_private *priv = drm->dev_private;
311 static const u32 formats[] = {
319 * The controller actually supports any YCbCr ordering,
320 * for packed YCbCr. This just lists the orderings that
327 /* This uses three planes */
331 ret = drm_simple_display_pipe_init(drm, &priv->pipe,
332 &tve200_display_funcs,
333 formats, ARRAY_SIZE(formats),