1 /* exynos_drm_crtc.c
2  *
3  * Copyright (c) 2011 Samsung Electronics Co., Ltd.
4  * Authors:
5  *	Inki Dae <inki.dae@samsung.com>
6  *	Joonyoung Shim <jy0922.shim@samsung.com>
7  *	Seung-Woo Kim <sw0312.kim@samsung.com>
8  *
9  * Permission is hereby granted, free of charge, to any person obtaining a
10  * copy of this software and associated documentation files (the "Software"),
11  * to deal in the Software without restriction, including without limitation
12  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
13  * and/or sell copies of the Software, and to permit persons to whom the
14  * Software is furnished to do so, subject to the following conditions:
15  *
16  * The above copyright notice and this permission notice (including the next
17  * paragraph) shall be included in all copies or substantial portions of the
18  * Software.
19  *
20  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
21  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
22  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
23  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
24  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
25  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
26  * OTHER DEALINGS IN THE SOFTWARE.
27  */
28 
29 #include "drmP.h"
30 #include "drm_crtc_helper.h"
31 
32 #include "exynos_drm_drv.h"
33 #include "exynos_drm_encoder.h"
34 #include "exynos_drm_plane.h"
35 
36 #define to_exynos_crtc(x)	container_of(x, struct exynos_drm_crtc,\
37 				drm_crtc)
38 
39 enum exynos_crtc_mode {
40 	CRTC_MODE_NORMAL,	/* normal mode */
41 	CRTC_MODE_BLANK,	/* The private plane of crtc is blank */
42 };
43 
44 /*
45  * Exynos specific crtc structure.
46  *
47  * @drm_crtc: crtc object.
48  * @drm_plane: pointer of private plane object for this crtc
49  * @pipe: a crtc index created at load() with a new crtc object creation
50  *	and the crtc object would be set to private->crtc array
51  *	to get a crtc object corresponding to this pipe from private->crtc
52  *	array when irq interrupt occured. the reason of using this pipe is that
53  *	drm framework doesn't support multiple irq yet.
54  *	we can refer to the crtc to current hardware interrupt occured through
55  *	this pipe value.
56  * @dpms: store the crtc dpms value
57  * @mode: store the crtc mode value
58  */
59 struct exynos_drm_crtc {
60 	struct drm_crtc			drm_crtc;
61 	struct drm_plane		*plane;
62 	unsigned int			pipe;
63 	unsigned int			dpms;
64 	enum exynos_crtc_mode		mode;
65 };
66 
67 static void exynos_drm_crtc_dpms(struct drm_crtc *crtc, int mode)
68 {
69 	struct drm_device *dev = crtc->dev;
70 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
71 
72 	DRM_DEBUG_KMS("crtc[%d] mode[%d]\n", crtc->base.id, mode);
73 
74 	if (exynos_crtc->dpms == mode) {
75 		DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
76 		return;
77 	}
78 
79 	mutex_lock(&dev->struct_mutex);
80 
81 	exynos_drm_fn_encoder(crtc, &mode, exynos_drm_encoder_crtc_dpms);
82 	exynos_crtc->dpms = mode;
83 
84 	mutex_unlock(&dev->struct_mutex);
85 }
86 
87 static void exynos_drm_crtc_prepare(struct drm_crtc *crtc)
88 {
89 	DRM_DEBUG_KMS("%s\n", __FILE__);
90 
91 	/* drm framework doesn't check NULL. */
92 }
93 
94 static void exynos_drm_crtc_commit(struct drm_crtc *crtc)
95 {
96 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
97 
98 	DRM_DEBUG_KMS("%s\n", __FILE__);
99 
100 	exynos_plane_commit(exynos_crtc->plane);
101 	exynos_plane_dpms(exynos_crtc->plane, DRM_MODE_DPMS_ON);
102 }
103 
104 static bool
105 exynos_drm_crtc_mode_fixup(struct drm_crtc *crtc,
106 			    const struct drm_display_mode *mode,
107 			    struct drm_display_mode *adjusted_mode)
108 {
109 	DRM_DEBUG_KMS("%s\n", __FILE__);
110 
111 	/* drm framework doesn't check NULL */
112 	return true;
113 }
114 
115 static int
116 exynos_drm_crtc_mode_set(struct drm_crtc *crtc, struct drm_display_mode *mode,
117 			  struct drm_display_mode *adjusted_mode, int x, int y,
118 			  struct drm_framebuffer *old_fb)
119 {
120 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
121 	struct drm_plane *plane = exynos_crtc->plane;
122 	unsigned int crtc_w;
123 	unsigned int crtc_h;
124 	int pipe = exynos_crtc->pipe;
125 	int ret;
126 
127 	DRM_DEBUG_KMS("%s\n", __FILE__);
128 
129 	exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
130 
131 	/*
132 	 * copy the mode data adjusted by mode_fixup() into crtc->mode
133 	 * so that hardware can be seet to proper mode.
134 	 */
135 	memcpy(&crtc->mode, adjusted_mode, sizeof(*adjusted_mode));
136 
137 	crtc_w = crtc->fb->width - x;
138 	crtc_h = crtc->fb->height - y;
139 
140 	ret = exynos_plane_mode_set(plane, crtc, crtc->fb, 0, 0, crtc_w, crtc_h,
141 				    x, y, crtc_w, crtc_h);
142 	if (ret)
143 		return ret;
144 
145 	plane->crtc = crtc;
146 	plane->fb = crtc->fb;
147 
148 	exynos_drm_fn_encoder(crtc, &pipe, exynos_drm_encoder_crtc_pipe);
149 
150 	return 0;
151 }
152 
153 static int exynos_drm_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y,
154 					  struct drm_framebuffer *old_fb)
155 {
156 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
157 	struct drm_plane *plane = exynos_crtc->plane;
158 	unsigned int crtc_w;
159 	unsigned int crtc_h;
160 	int ret;
161 
162 	DRM_DEBUG_KMS("%s\n", __FILE__);
163 
164 	crtc_w = crtc->fb->width - x;
165 	crtc_h = crtc->fb->height - y;
166 
167 	ret = exynos_plane_mode_set(plane, crtc, crtc->fb, 0, 0, crtc_w, crtc_h,
168 				    x, y, crtc_w, crtc_h);
169 	if (ret)
170 		return ret;
171 
172 	exynos_drm_crtc_commit(crtc);
173 
174 	return 0;
175 }
176 
177 static void exynos_drm_crtc_load_lut(struct drm_crtc *crtc)
178 {
179 	DRM_DEBUG_KMS("%s\n", __FILE__);
180 	/* drm framework doesn't check NULL */
181 }
182 
183 static void exynos_drm_crtc_disable(struct drm_crtc *crtc)
184 {
185 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
186 
187 	DRM_DEBUG_KMS("%s\n", __FILE__);
188 
189 	exynos_plane_dpms(exynos_crtc->plane, DRM_MODE_DPMS_OFF);
190 	exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
191 }
192 
193 static struct drm_crtc_helper_funcs exynos_crtc_helper_funcs = {
194 	.dpms		= exynos_drm_crtc_dpms,
195 	.prepare	= exynos_drm_crtc_prepare,
196 	.commit		= exynos_drm_crtc_commit,
197 	.mode_fixup	= exynos_drm_crtc_mode_fixup,
198 	.mode_set	= exynos_drm_crtc_mode_set,
199 	.mode_set_base	= exynos_drm_crtc_mode_set_base,
200 	.load_lut	= exynos_drm_crtc_load_lut,
201 	.disable	= exynos_drm_crtc_disable,
202 };
203 
204 static int exynos_drm_crtc_page_flip(struct drm_crtc *crtc,
205 				      struct drm_framebuffer *fb,
206 				      struct drm_pending_vblank_event *event)
207 {
208 	struct drm_device *dev = crtc->dev;
209 	struct exynos_drm_private *dev_priv = dev->dev_private;
210 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
211 	struct drm_framebuffer *old_fb = crtc->fb;
212 	int ret = -EINVAL;
213 
214 	DRM_DEBUG_KMS("%s\n", __FILE__);
215 
216 	mutex_lock(&dev->struct_mutex);
217 
218 	if (event) {
219 		/*
220 		 * the pipe from user always is 0 so we can set pipe number
221 		 * of current owner to event.
222 		 */
223 		event->pipe = exynos_crtc->pipe;
224 
225 		ret = drm_vblank_get(dev, exynos_crtc->pipe);
226 		if (ret) {
227 			DRM_DEBUG("failed to acquire vblank counter\n");
228 			list_del(&event->base.link);
229 
230 			goto out;
231 		}
232 
233 		list_add_tail(&event->base.link,
234 				&dev_priv->pageflip_event_list);
235 
236 		crtc->fb = fb;
237 		ret = exynos_drm_crtc_mode_set_base(crtc, crtc->x, crtc->y,
238 						    NULL);
239 		if (ret) {
240 			crtc->fb = old_fb;
241 			drm_vblank_put(dev, exynos_crtc->pipe);
242 			list_del(&event->base.link);
243 
244 			goto out;
245 		}
246 	}
247 out:
248 	mutex_unlock(&dev->struct_mutex);
249 	return ret;
250 }
251 
252 static void exynos_drm_crtc_destroy(struct drm_crtc *crtc)
253 {
254 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
255 	struct exynos_drm_private *private = crtc->dev->dev_private;
256 
257 	DRM_DEBUG_KMS("%s\n", __FILE__);
258 
259 	private->crtc[exynos_crtc->pipe] = NULL;
260 
261 	drm_crtc_cleanup(crtc);
262 	kfree(exynos_crtc);
263 }
264 
265 static int exynos_drm_crtc_set_property(struct drm_crtc *crtc,
266 					struct drm_property *property,
267 					uint64_t val)
268 {
269 	struct drm_device *dev = crtc->dev;
270 	struct exynos_drm_private *dev_priv = dev->dev_private;
271 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
272 
273 	DRM_DEBUG_KMS("%s\n", __func__);
274 
275 	if (property == dev_priv->crtc_mode_property) {
276 		enum exynos_crtc_mode mode = val;
277 
278 		if (mode == exynos_crtc->mode)
279 			return 0;
280 
281 		exynos_crtc->mode = mode;
282 
283 		switch (mode) {
284 		case CRTC_MODE_NORMAL:
285 			exynos_drm_crtc_commit(crtc);
286 			break;
287 		case CRTC_MODE_BLANK:
288 			exynos_plane_dpms(exynos_crtc->plane,
289 					  DRM_MODE_DPMS_OFF);
290 			break;
291 		default:
292 			break;
293 		}
294 
295 		return 0;
296 	}
297 
298 	return -EINVAL;
299 }
300 
301 static struct drm_crtc_funcs exynos_crtc_funcs = {
302 	.set_config	= drm_crtc_helper_set_config,
303 	.page_flip	= exynos_drm_crtc_page_flip,
304 	.destroy	= exynos_drm_crtc_destroy,
305 	.set_property	= exynos_drm_crtc_set_property,
306 };
307 
308 static const struct drm_prop_enum_list mode_names[] = {
309 	{ CRTC_MODE_NORMAL, "normal" },
310 	{ CRTC_MODE_BLANK, "blank" },
311 };
312 
313 static void exynos_drm_crtc_attach_mode_property(struct drm_crtc *crtc)
314 {
315 	struct drm_device *dev = crtc->dev;
316 	struct exynos_drm_private *dev_priv = dev->dev_private;
317 	struct drm_property *prop;
318 
319 	DRM_DEBUG_KMS("%s\n", __func__);
320 
321 	prop = dev_priv->crtc_mode_property;
322 	if (!prop) {
323 		prop = drm_property_create_enum(dev, 0, "mode", mode_names,
324 						ARRAY_SIZE(mode_names));
325 		if (!prop)
326 			return;
327 
328 		dev_priv->crtc_mode_property = prop;
329 	}
330 
331 	drm_object_attach_property(&crtc->base, prop, 0);
332 }
333 
334 int exynos_drm_crtc_create(struct drm_device *dev, unsigned int nr)
335 {
336 	struct exynos_drm_crtc *exynos_crtc;
337 	struct exynos_drm_private *private = dev->dev_private;
338 	struct drm_crtc *crtc;
339 
340 	DRM_DEBUG_KMS("%s\n", __FILE__);
341 
342 	exynos_crtc = kzalloc(sizeof(*exynos_crtc), GFP_KERNEL);
343 	if (!exynos_crtc) {
344 		DRM_ERROR("failed to allocate exynos crtc\n");
345 		return -ENOMEM;
346 	}
347 
348 	exynos_crtc->pipe = nr;
349 	exynos_crtc->dpms = DRM_MODE_DPMS_OFF;
350 	exynos_crtc->plane = exynos_plane_init(dev, 1 << nr, true);
351 	if (!exynos_crtc->plane) {
352 		kfree(exynos_crtc);
353 		return -ENOMEM;
354 	}
355 
356 	crtc = &exynos_crtc->drm_crtc;
357 
358 	private->crtc[nr] = crtc;
359 
360 	drm_crtc_init(dev, crtc, &exynos_crtc_funcs);
361 	drm_crtc_helper_add(crtc, &exynos_crtc_helper_funcs);
362 
363 	exynos_drm_crtc_attach_mode_property(crtc);
364 
365 	return 0;
366 }
367 
368 int exynos_drm_crtc_enable_vblank(struct drm_device *dev, int crtc)
369 {
370 	struct exynos_drm_private *private = dev->dev_private;
371 	struct exynos_drm_crtc *exynos_crtc =
372 		to_exynos_crtc(private->crtc[crtc]);
373 
374 	DRM_DEBUG_KMS("%s\n", __FILE__);
375 
376 	if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
377 		return -EPERM;
378 
379 	exynos_drm_fn_encoder(private->crtc[crtc], &crtc,
380 			exynos_drm_enable_vblank);
381 
382 	return 0;
383 }
384 
385 void exynos_drm_crtc_disable_vblank(struct drm_device *dev, int crtc)
386 {
387 	struct exynos_drm_private *private = dev->dev_private;
388 	struct exynos_drm_crtc *exynos_crtc =
389 		to_exynos_crtc(private->crtc[crtc]);
390 
391 	DRM_DEBUG_KMS("%s\n", __FILE__);
392 
393 	if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
394 		return;
395 
396 	exynos_drm_fn_encoder(private->crtc[crtc], &crtc,
397 			exynos_drm_disable_vblank);
398 }
399