This source file includes following definitions.
- tve200_irq
- tve200_display_check
- tve200_display_enable
- tve200_display_disable
- tve200_display_update
- tve200_display_enable_vblank
- tve200_display_disable_vblank
- tve200_display_init
1
2
3
4
5
6
7
8
9
10
11
12
13 #include <linux/clk.h>
14 #include <linux/version.h>
15 #include <linux/dma-buf.h>
16 #include <linux/of_graph.h>
17
18 #include <drm/drm_fb_cma_helper.h>
19 #include <drm/drm_fourcc.h>
20 #include <drm/drm_gem_cma_helper.h>
21 #include <drm/drm_gem_framebuffer_helper.h>
22 #include <drm/drm_panel.h>
23 #include <drm/drm_vblank.h>
24
25 #include "tve200_drm.h"
26
27 irqreturn_t tve200_irq(int irq, void *data)
28 {
29 struct tve200_drm_dev_private *priv = data;
30 u32 stat;
31 u32 val;
32
33 stat = readl(priv->regs + TVE200_INT_STAT);
34
35 if (!stat)
36 return IRQ_NONE;
37
38
39
40
41
42
43
44
45
46
47
48
49 if (stat & TVE200_INT_V_STATUS) {
50 val = readl(priv->regs + TVE200_CTRL);
51
52 if (!(val & TVE200_VSTSTYPE_BITS)) {
53 drm_crtc_handle_vblank(&priv->pipe.crtc);
54
55 val |= TVE200_VSTSTYPE_VAI;
56 } else {
57
58 val &= ~TVE200_VSTSTYPE_BITS;
59 }
60 writel(val, priv->regs + TVE200_CTRL);
61 } else
62 dev_err(priv->drm->dev, "stray IRQ %08x\n", stat);
63
64
65 writel(stat, priv->regs + TVE200_INT_CLR);
66
67 return IRQ_HANDLED;
68 }
69
70 static int tve200_display_check(struct drm_simple_display_pipe *pipe,
71 struct drm_plane_state *pstate,
72 struct drm_crtc_state *cstate)
73 {
74 const struct drm_display_mode *mode = &cstate->mode;
75 struct drm_framebuffer *old_fb = pipe->plane.state->fb;
76 struct drm_framebuffer *fb = pstate->fb;
77
78
79
80
81 if (!(mode->hdisplay == 352 && mode->vdisplay == 240) &&
82 !(mode->hdisplay == 352 && mode->vdisplay == 288) &&
83 !(mode->hdisplay == 640 && mode->vdisplay == 480) &&
84 !(mode->hdisplay == 720 && mode->vdisplay == 480) &&
85 !(mode->hdisplay == 720 && mode->vdisplay == 576)) {
86 DRM_DEBUG_KMS("unsupported display mode (%u x %u)\n",
87 mode->hdisplay, mode->vdisplay);
88 return -EINVAL;
89 }
90
91 if (fb) {
92 u32 offset = drm_fb_cma_get_gem_addr(fb, pstate, 0);
93
94
95 if (offset & 3) {
96 DRM_DEBUG_KMS("FB not 32-bit aligned\n");
97 return -EINVAL;
98 }
99
100
101
102
103
104 if (fb->pitches[0] != mode->hdisplay * fb->format->cpp[0]) {
105 DRM_DEBUG_KMS("can't handle pitches\n");
106 return -EINVAL;
107 }
108
109
110
111
112
113 if (old_fb && old_fb->format != fb->format)
114 cstate->mode_changed = true;
115 }
116
117 return 0;
118 }
119
120 static void tve200_display_enable(struct drm_simple_display_pipe *pipe,
121 struct drm_crtc_state *cstate,
122 struct drm_plane_state *plane_state)
123 {
124 struct drm_crtc *crtc = &pipe->crtc;
125 struct drm_plane *plane = &pipe->plane;
126 struct drm_device *drm = crtc->dev;
127 struct tve200_drm_dev_private *priv = drm->dev_private;
128 const struct drm_display_mode *mode = &cstate->mode;
129 struct drm_framebuffer *fb = plane->state->fb;
130 struct drm_connector *connector = priv->connector;
131 u32 format = fb->format->format;
132 u32 ctrl1 = 0;
133
134 clk_prepare_enable(priv->clk);
135
136
137 ctrl1 |= TVE200_CTRL_CSMODE;
138
139 ctrl1 |= TVE200_CTRL_NONINTERLACE;
140
141 ctrl1 |= TVE200_CTRL_BURST_32_WORDS;
142
143 ctrl1 |= TVE200_CTRL_RETRYCNT_16;
144
145 ctrl1 |= TVE200_CTRL_NTSC;
146
147
148 ctrl1 |= TVE200_VSTSTYPE_VSYNC;
149
150 if (connector->display_info.bus_flags &
151 DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE)
152 ctrl1 |= TVE200_CTRL_TVCLKP;
153
154 if ((mode->hdisplay == 352 && mode->vdisplay == 240) ||
155 (mode->hdisplay == 352 && mode->vdisplay == 288)) {
156 ctrl1 |= TVE200_CTRL_IPRESOL_CIF;
157 dev_info(drm->dev, "CIF mode\n");
158 } else if (mode->hdisplay == 640 && mode->vdisplay == 480) {
159 ctrl1 |= TVE200_CTRL_IPRESOL_VGA;
160 dev_info(drm->dev, "VGA mode\n");
161 } else if ((mode->hdisplay == 720 && mode->vdisplay == 480) ||
162 (mode->hdisplay == 720 && mode->vdisplay == 576)) {
163 ctrl1 |= TVE200_CTRL_IPRESOL_D1;
164 dev_info(drm->dev, "D1 mode\n");
165 }
166
167 if (format & DRM_FORMAT_BIG_ENDIAN) {
168 ctrl1 |= TVE200_CTRL_BBBP;
169 format &= ~DRM_FORMAT_BIG_ENDIAN;
170 }
171
172 switch (format) {
173 case DRM_FORMAT_XRGB8888:
174 ctrl1 |= TVE200_IPDMOD_RGB888;
175 break;
176 case DRM_FORMAT_RGB565:
177 ctrl1 |= TVE200_IPDMOD_RGB565;
178 break;
179 case DRM_FORMAT_XRGB1555:
180 ctrl1 |= TVE200_IPDMOD_RGB555;
181 break;
182 case DRM_FORMAT_XBGR8888:
183 ctrl1 |= TVE200_IPDMOD_RGB888 | TVE200_BGR;
184 break;
185 case DRM_FORMAT_BGR565:
186 ctrl1 |= TVE200_IPDMOD_RGB565 | TVE200_BGR;
187 break;
188 case DRM_FORMAT_XBGR1555:
189 ctrl1 |= TVE200_IPDMOD_RGB555 | TVE200_BGR;
190 break;
191 case DRM_FORMAT_YUYV:
192 ctrl1 |= TVE200_IPDMOD_YUV422;
193 ctrl1 |= TVE200_CTRL_YCBCRODR_CR0Y1CB0Y0;
194 break;
195 case DRM_FORMAT_YVYU:
196 ctrl1 |= TVE200_IPDMOD_YUV422;
197 ctrl1 |= TVE200_CTRL_YCBCRODR_CB0Y1CR0Y0;
198 break;
199 case DRM_FORMAT_UYVY:
200 ctrl1 |= TVE200_IPDMOD_YUV422;
201 ctrl1 |= TVE200_CTRL_YCBCRODR_Y1CR0Y0CB0;
202 break;
203 case DRM_FORMAT_VYUY:
204 ctrl1 |= TVE200_IPDMOD_YUV422;
205 ctrl1 |= TVE200_CTRL_YCBCRODR_Y1CB0Y0CR0;
206 break;
207 case DRM_FORMAT_YUV420:
208 ctrl1 |= TVE200_CTRL_YUV420;
209 ctrl1 |= TVE200_IPDMOD_YUV420;
210 break;
211 default:
212 dev_err(drm->dev, "Unknown FB format 0x%08x\n",
213 fb->format->format);
214 break;
215 }
216
217 ctrl1 |= TVE200_TVEEN;
218
219
220 writel(ctrl1, priv->regs + TVE200_CTRL);
221
222 drm_crtc_vblank_on(crtc);
223 }
224
225 static void tve200_display_disable(struct drm_simple_display_pipe *pipe)
226 {
227 struct drm_crtc *crtc = &pipe->crtc;
228 struct drm_device *drm = crtc->dev;
229 struct tve200_drm_dev_private *priv = drm->dev_private;
230
231 drm_crtc_vblank_off(crtc);
232
233
234 writel(0, priv->regs + TVE200_CTRL);
235
236 clk_disable_unprepare(priv->clk);
237 }
238
239 static void tve200_display_update(struct drm_simple_display_pipe *pipe,
240 struct drm_plane_state *old_pstate)
241 {
242 struct drm_crtc *crtc = &pipe->crtc;
243 struct drm_device *drm = crtc->dev;
244 struct tve200_drm_dev_private *priv = drm->dev_private;
245 struct drm_pending_vblank_event *event = crtc->state->event;
246 struct drm_plane *plane = &pipe->plane;
247 struct drm_plane_state *pstate = plane->state;
248 struct drm_framebuffer *fb = pstate->fb;
249
250 if (fb) {
251
252 writel(drm_fb_cma_get_gem_addr(fb, pstate, 0),
253 priv->regs + TVE200_Y_FRAME_BASE_ADDR);
254
255
256 if (fb->format->format == DRM_FORMAT_YUV420) {
257 writel(drm_fb_cma_get_gem_addr(fb, pstate, 1),
258 priv->regs + TVE200_U_FRAME_BASE_ADDR);
259 writel(drm_fb_cma_get_gem_addr(fb, pstate, 2),
260 priv->regs + TVE200_V_FRAME_BASE_ADDR);
261 }
262 }
263
264 if (event) {
265 crtc->state->event = NULL;
266
267 spin_lock_irq(&crtc->dev->event_lock);
268 if (crtc->state->active && drm_crtc_vblank_get(crtc) == 0)
269 drm_crtc_arm_vblank_event(crtc, event);
270 else
271 drm_crtc_send_vblank_event(crtc, event);
272 spin_unlock_irq(&crtc->dev->event_lock);
273 }
274 }
275
276 static int tve200_display_enable_vblank(struct drm_simple_display_pipe *pipe)
277 {
278 struct drm_crtc *crtc = &pipe->crtc;
279 struct drm_device *drm = crtc->dev;
280 struct tve200_drm_dev_private *priv = drm->dev_private;
281
282 writel(TVE200_INT_V_STATUS, priv->regs + TVE200_INT_EN);
283 return 0;
284 }
285
286 static void tve200_display_disable_vblank(struct drm_simple_display_pipe *pipe)
287 {
288 struct drm_crtc *crtc = &pipe->crtc;
289 struct drm_device *drm = crtc->dev;
290 struct tve200_drm_dev_private *priv = drm->dev_private;
291
292 writel(0, priv->regs + TVE200_INT_EN);
293 }
294
295 static const struct drm_simple_display_pipe_funcs tve200_display_funcs = {
296 .check = tve200_display_check,
297 .enable = tve200_display_enable,
298 .disable = tve200_display_disable,
299 .update = tve200_display_update,
300 .prepare_fb = drm_gem_fb_simple_display_pipe_prepare_fb,
301 .enable_vblank = tve200_display_enable_vblank,
302 .disable_vblank = tve200_display_disable_vblank,
303 };
304
305 int tve200_display_init(struct drm_device *drm)
306 {
307 struct tve200_drm_dev_private *priv = drm->dev_private;
308 int ret;
309 static const u32 formats[] = {
310 DRM_FORMAT_XRGB8888,
311 DRM_FORMAT_XBGR8888,
312 DRM_FORMAT_RGB565,
313 DRM_FORMAT_BGR565,
314 DRM_FORMAT_XRGB1555,
315 DRM_FORMAT_XBGR1555,
316
317
318
319
320
321 DRM_FORMAT_YUYV,
322 DRM_FORMAT_YVYU,
323 DRM_FORMAT_UYVY,
324 DRM_FORMAT_VYUY,
325
326 DRM_FORMAT_YUV420,
327 };
328
329 ret = drm_simple_display_pipe_init(drm, &priv->pipe,
330 &tve200_display_funcs,
331 formats, ARRAY_SIZE(formats),
332 NULL,
333 priv->connector);
334 if (ret)
335 return ret;
336
337 return 0;
338 }