11c248b7dSInki Dae /* exynos_drm_crtc.c
21c248b7dSInki Dae  *
31c248b7dSInki Dae  * Copyright (c) 2011 Samsung Electronics Co., Ltd.
41c248b7dSInki Dae  * Authors:
51c248b7dSInki Dae  *	Inki Dae <inki.dae@samsung.com>
61c248b7dSInki Dae  *	Joonyoung Shim <jy0922.shim@samsung.com>
71c248b7dSInki Dae  *	Seung-Woo Kim <sw0312.kim@samsung.com>
81c248b7dSInki Dae  *
91c248b7dSInki Dae  * Permission is hereby granted, free of charge, to any person obtaining a
101c248b7dSInki Dae  * copy of this software and associated documentation files (the "Software"),
111c248b7dSInki Dae  * to deal in the Software without restriction, including without limitation
121c248b7dSInki Dae  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
131c248b7dSInki Dae  * and/or sell copies of the Software, and to permit persons to whom the
141c248b7dSInki Dae  * Software is furnished to do so, subject to the following conditions:
151c248b7dSInki Dae  *
161c248b7dSInki Dae  * The above copyright notice and this permission notice (including the next
171c248b7dSInki Dae  * paragraph) shall be included in all copies or substantial portions of the
181c248b7dSInki Dae  * Software.
191c248b7dSInki Dae  *
201c248b7dSInki Dae  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
211c248b7dSInki Dae  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
221c248b7dSInki Dae  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
231c248b7dSInki Dae  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
241c248b7dSInki Dae  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
251c248b7dSInki Dae  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
261c248b7dSInki Dae  * OTHER DEALINGS IN THE SOFTWARE.
271c248b7dSInki Dae  */
281c248b7dSInki Dae 
291c248b7dSInki Dae #include "drmP.h"
301c248b7dSInki Dae #include "drm_crtc_helper.h"
311c248b7dSInki Dae 
321c248b7dSInki Dae #include "exynos_drm_drv.h"
331c248b7dSInki Dae #include "exynos_drm_encoder.h"
34b5d2eb3bSJoonyoung Shim #include "exynos_drm_plane.h"
351c248b7dSInki Dae 
361c248b7dSInki Dae #define to_exynos_crtc(x)	container_of(x, struct exynos_drm_crtc,\
371c248b7dSInki Dae 				drm_crtc)
381c248b7dSInki Dae 
391c248b7dSInki Dae /*
401c248b7dSInki Dae  * Exynos specific crtc structure.
411c248b7dSInki Dae  *
421c248b7dSInki Dae  * @drm_crtc: crtc object.
43b5d2eb3bSJoonyoung Shim  * @drm_plane: pointer of private plane object for this crtc
441c248b7dSInki Dae  * @pipe: a crtc index created at load() with a new crtc object creation
451c248b7dSInki Dae  *	and the crtc object would be set to private->crtc array
461c248b7dSInki Dae  *	to get a crtc object corresponding to this pipe from private->crtc
471c248b7dSInki Dae  *	array when irq interrupt occured. the reason of using this pipe is that
481c248b7dSInki Dae  *	drm framework doesn't support multiple irq yet.
491c248b7dSInki Dae  *	we can refer to the crtc to current hardware interrupt occured through
501c248b7dSInki Dae  *	this pipe value.
51ec05da95SInki Dae  * @dpms: store the crtc dpms value
521c248b7dSInki Dae  */
531c248b7dSInki Dae struct exynos_drm_crtc {
541c248b7dSInki Dae 	struct drm_crtc			drm_crtc;
55b5d2eb3bSJoonyoung Shim 	struct drm_plane		*plane;
561c248b7dSInki Dae 	unsigned int			pipe;
57ec05da95SInki Dae 	unsigned int			dpms;
581c248b7dSInki Dae };
591c248b7dSInki Dae 
601c248b7dSInki Dae static void exynos_drm_crtc_dpms(struct drm_crtc *crtc, int mode)
611c248b7dSInki Dae {
62ec05da95SInki Dae 	struct drm_device *dev = crtc->dev;
63d2716c89SJoonyoung Shim 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
641c248b7dSInki Dae 
65d2716c89SJoonyoung Shim 	DRM_DEBUG_KMS("crtc[%d] mode[%d]\n", crtc->base.id, mode);
66d2716c89SJoonyoung Shim 
67ec05da95SInki Dae 	if (exynos_crtc->dpms == mode) {
68ec05da95SInki Dae 		DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
69ec05da95SInki Dae 		return;
70ec05da95SInki Dae 	}
71ec05da95SInki Dae 
72ec05da95SInki Dae 	mutex_lock(&dev->struct_mutex);
73ec05da95SInki Dae 
74cf5188acSJoonyoung Shim 	exynos_drm_fn_encoder(crtc, &mode, exynos_drm_encoder_crtc_dpms);
75ec05da95SInki Dae 	exynos_crtc->dpms = mode;
76ec05da95SInki Dae 
77ec05da95SInki Dae 	mutex_unlock(&dev->struct_mutex);
781c248b7dSInki Dae }
791c248b7dSInki Dae 
801c248b7dSInki Dae static void exynos_drm_crtc_prepare(struct drm_crtc *crtc)
811c248b7dSInki Dae {
821c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
831c248b7dSInki Dae 
841c248b7dSInki Dae 	/* drm framework doesn't check NULL. */
851c248b7dSInki Dae }
861c248b7dSInki Dae 
871c248b7dSInki Dae static void exynos_drm_crtc_commit(struct drm_crtc *crtc)
881c248b7dSInki Dae {
89d2716c89SJoonyoung Shim 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
90d2716c89SJoonyoung Shim 
911c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
921c248b7dSInki Dae 
934070d212SJoonyoung Shim 	exynos_plane_commit(exynos_crtc->plane);
94cf5188acSJoonyoung Shim 	exynos_plane_dpms(exynos_crtc->plane, DRM_MODE_DPMS_ON);
951c248b7dSInki Dae }
961c248b7dSInki Dae 
971c248b7dSInki Dae static bool
981c248b7dSInki Dae exynos_drm_crtc_mode_fixup(struct drm_crtc *crtc,
99e811f5aeSLaurent Pinchart 			    const struct drm_display_mode *mode,
1001c248b7dSInki Dae 			    struct drm_display_mode *adjusted_mode)
1011c248b7dSInki Dae {
1021c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
1031c248b7dSInki Dae 
1041c248b7dSInki Dae 	/* drm framework doesn't check NULL */
1051c248b7dSInki Dae 	return true;
1061c248b7dSInki Dae }
1071c248b7dSInki Dae 
1081c248b7dSInki Dae static int
1091c248b7dSInki Dae exynos_drm_crtc_mode_set(struct drm_crtc *crtc, struct drm_display_mode *mode,
1101c248b7dSInki Dae 			  struct drm_display_mode *adjusted_mode, int x, int y,
1111c248b7dSInki Dae 			  struct drm_framebuffer *old_fb)
1121c248b7dSInki Dae {
113aeb29224SJoonyoung Shim 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
1144070d212SJoonyoung Shim 	struct drm_plane *plane = exynos_crtc->plane;
1154070d212SJoonyoung Shim 	unsigned int crtc_w;
1164070d212SJoonyoung Shim 	unsigned int crtc_h;
117d249ce02SJoonyoung Shim 	int pipe = exynos_crtc->pipe;
118aeb29224SJoonyoung Shim 	int ret;
119aeb29224SJoonyoung Shim 
1201c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
1211c248b7dSInki Dae 
122bebab8ffSJoonyoung Shim 	exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
123bebab8ffSJoonyoung Shim 
1241de425b0SInki Dae 	/*
1251de425b0SInki Dae 	 * copy the mode data adjusted by mode_fixup() into crtc->mode
1261de425b0SInki Dae 	 * so that hardware can be seet to proper mode.
1271de425b0SInki Dae 	 */
1281de425b0SInki Dae 	memcpy(&crtc->mode, adjusted_mode, sizeof(*adjusted_mode));
1291c248b7dSInki Dae 
1304070d212SJoonyoung Shim 	crtc_w = crtc->fb->width - x;
1314070d212SJoonyoung Shim 	crtc_h = crtc->fb->height - y;
1324070d212SJoonyoung Shim 
1334070d212SJoonyoung Shim 	ret = exynos_plane_mode_set(plane, crtc, crtc->fb, 0, 0, crtc_w, crtc_h,
1344070d212SJoonyoung Shim 				    x, y, crtc_w, crtc_h);
135aeb29224SJoonyoung Shim 	if (ret)
136aeb29224SJoonyoung Shim 		return ret;
137aeb29224SJoonyoung Shim 
1384070d212SJoonyoung Shim 	plane->crtc = crtc;
1394070d212SJoonyoung Shim 	plane->fb = crtc->fb;
1404070d212SJoonyoung Shim 
141d249ce02SJoonyoung Shim 	exynos_drm_fn_encoder(crtc, &pipe, exynos_drm_encoder_crtc_pipe);
142aeb29224SJoonyoung Shim 
143aeb29224SJoonyoung Shim 	return 0;
1441c248b7dSInki Dae }
1451c248b7dSInki Dae 
1461c248b7dSInki Dae static int exynos_drm_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y,
1471c248b7dSInki Dae 					  struct drm_framebuffer *old_fb)
1481c248b7dSInki Dae {
1494070d212SJoonyoung Shim 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
1504070d212SJoonyoung Shim 	struct drm_plane *plane = exynos_crtc->plane;
1514070d212SJoonyoung Shim 	unsigned int crtc_w;
1524070d212SJoonyoung Shim 	unsigned int crtc_h;
1531c248b7dSInki Dae 	int ret;
1541c248b7dSInki Dae 
1551c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
1561c248b7dSInki Dae 
1574070d212SJoonyoung Shim 	crtc_w = crtc->fb->width - x;
1584070d212SJoonyoung Shim 	crtc_h = crtc->fb->height - y;
1594070d212SJoonyoung Shim 
1604070d212SJoonyoung Shim 	ret = exynos_plane_mode_set(plane, crtc, crtc->fb, 0, 0, crtc_w, crtc_h,
1614070d212SJoonyoung Shim 				    x, y, crtc_w, crtc_h);
1621c248b7dSInki Dae 	if (ret)
1631c248b7dSInki Dae 		return ret;
1641c248b7dSInki Dae 
165bebab8ffSJoonyoung Shim 	exynos_drm_crtc_commit(crtc);
1661c248b7dSInki Dae 
1674070d212SJoonyoung Shim 	return 0;
1681c248b7dSInki Dae }
1691c248b7dSInki Dae 
1701c248b7dSInki Dae static void exynos_drm_crtc_load_lut(struct drm_crtc *crtc)
1711c248b7dSInki Dae {
1721c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
1731c248b7dSInki Dae 	/* drm framework doesn't check NULL */
1741c248b7dSInki Dae }
1751c248b7dSInki Dae 
176a365d9ebSJoonyoung Shim static void exynos_drm_crtc_disable(struct drm_crtc *crtc)
177a365d9ebSJoonyoung Shim {
178a365d9ebSJoonyoung Shim 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
179a365d9ebSJoonyoung Shim 
180a365d9ebSJoonyoung Shim 	DRM_DEBUG_KMS("%s\n", __FILE__);
181a365d9ebSJoonyoung Shim 
182a365d9ebSJoonyoung Shim 	exynos_plane_dpms(exynos_crtc->plane, DRM_MODE_DPMS_OFF);
183a365d9ebSJoonyoung Shim 	exynos_drm_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
184a365d9ebSJoonyoung Shim }
185a365d9ebSJoonyoung Shim 
1861c248b7dSInki Dae static struct drm_crtc_helper_funcs exynos_crtc_helper_funcs = {
1871c248b7dSInki Dae 	.dpms		= exynos_drm_crtc_dpms,
1881c248b7dSInki Dae 	.prepare	= exynos_drm_crtc_prepare,
1891c248b7dSInki Dae 	.commit		= exynos_drm_crtc_commit,
1901c248b7dSInki Dae 	.mode_fixup	= exynos_drm_crtc_mode_fixup,
1911c248b7dSInki Dae 	.mode_set	= exynos_drm_crtc_mode_set,
1921c248b7dSInki Dae 	.mode_set_base	= exynos_drm_crtc_mode_set_base,
1931c248b7dSInki Dae 	.load_lut	= exynos_drm_crtc_load_lut,
194a365d9ebSJoonyoung Shim 	.disable	= exynos_drm_crtc_disable,
1951c248b7dSInki Dae };
1961c248b7dSInki Dae 
1971c248b7dSInki Dae static int exynos_drm_crtc_page_flip(struct drm_crtc *crtc,
1981c248b7dSInki Dae 				      struct drm_framebuffer *fb,
1991c248b7dSInki Dae 				      struct drm_pending_vblank_event *event)
2001c248b7dSInki Dae {
2011c248b7dSInki Dae 	struct drm_device *dev = crtc->dev;
2021c248b7dSInki Dae 	struct exynos_drm_private *dev_priv = dev->dev_private;
2031c248b7dSInki Dae 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
2041c248b7dSInki Dae 	struct drm_framebuffer *old_fb = crtc->fb;
2051c248b7dSInki Dae 	int ret = -EINVAL;
2061c248b7dSInki Dae 
2071c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
2081c248b7dSInki Dae 
2091c248b7dSInki Dae 	mutex_lock(&dev->struct_mutex);
2101c248b7dSInki Dae 
211ccf4d883SInki Dae 	if (event) {
212ccf4d883SInki Dae 		/*
213ccf4d883SInki Dae 		 * the pipe from user always is 0 so we can set pipe number
214ccf4d883SInki Dae 		 * of current owner to event.
215ccf4d883SInki Dae 		 */
216ccf4d883SInki Dae 		event->pipe = exynos_crtc->pipe;
217ccf4d883SInki Dae 
2181c248b7dSInki Dae 		ret = drm_vblank_get(dev, exynos_crtc->pipe);
2191c248b7dSInki Dae 		if (ret) {
2201c248b7dSInki Dae 			DRM_DEBUG("failed to acquire vblank counter\n");
221ccf4d883SInki Dae 			list_del(&event->base.link);
222ccf4d883SInki Dae 
2231c248b7dSInki Dae 			goto out;
2241c248b7dSInki Dae 		}
2251c248b7dSInki Dae 
226c5614ae3SInki Dae 		list_add_tail(&event->base.link,
227c5614ae3SInki Dae 				&dev_priv->pageflip_event_list);
228c5614ae3SInki Dae 
2291c248b7dSInki Dae 		crtc->fb = fb;
2304070d212SJoonyoung Shim 		ret = exynos_drm_crtc_mode_set_base(crtc, crtc->x, crtc->y,
2314070d212SJoonyoung Shim 						    NULL);
2321c248b7dSInki Dae 		if (ret) {
2331c248b7dSInki Dae 			crtc->fb = old_fb;
2341c248b7dSInki Dae 			drm_vblank_put(dev, exynos_crtc->pipe);
235ccf4d883SInki Dae 			list_del(&event->base.link);
2361c248b7dSInki Dae 
2371c248b7dSInki Dae 			goto out;
2381c248b7dSInki Dae 		}
2391c248b7dSInki Dae 	}
2401c248b7dSInki Dae out:
2411c248b7dSInki Dae 	mutex_unlock(&dev->struct_mutex);
2421c248b7dSInki Dae 	return ret;
2431c248b7dSInki Dae }
2441c248b7dSInki Dae 
2451c248b7dSInki Dae static void exynos_drm_crtc_destroy(struct drm_crtc *crtc)
2461c248b7dSInki Dae {
2471c248b7dSInki Dae 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
2481c248b7dSInki Dae 	struct exynos_drm_private *private = crtc->dev->dev_private;
2491c248b7dSInki Dae 
2501c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
2511c248b7dSInki Dae 
2521c248b7dSInki Dae 	private->crtc[exynos_crtc->pipe] = NULL;
2531c248b7dSInki Dae 
2541c248b7dSInki Dae 	drm_crtc_cleanup(crtc);
2551c248b7dSInki Dae 	kfree(exynos_crtc);
2561c248b7dSInki Dae }
2571c248b7dSInki Dae 
2581c248b7dSInki Dae static struct drm_crtc_funcs exynos_crtc_funcs = {
2591c248b7dSInki Dae 	.set_config	= drm_crtc_helper_set_config,
2601c248b7dSInki Dae 	.page_flip	= exynos_drm_crtc_page_flip,
2611c248b7dSInki Dae 	.destroy	= exynos_drm_crtc_destroy,
2621c248b7dSInki Dae };
2631c248b7dSInki Dae 
2641c248b7dSInki Dae int exynos_drm_crtc_create(struct drm_device *dev, unsigned int nr)
2651c248b7dSInki Dae {
2661c248b7dSInki Dae 	struct exynos_drm_crtc *exynos_crtc;
2671c248b7dSInki Dae 	struct exynos_drm_private *private = dev->dev_private;
2681c248b7dSInki Dae 	struct drm_crtc *crtc;
2691c248b7dSInki Dae 
2701c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
2711c248b7dSInki Dae 
2721c248b7dSInki Dae 	exynos_crtc = kzalloc(sizeof(*exynos_crtc), GFP_KERNEL);
2731c248b7dSInki Dae 	if (!exynos_crtc) {
2741c248b7dSInki Dae 		DRM_ERROR("failed to allocate exynos crtc\n");
2751c248b7dSInki Dae 		return -ENOMEM;
2761c248b7dSInki Dae 	}
2771c248b7dSInki Dae 
2781c248b7dSInki Dae 	exynos_crtc->pipe = nr;
279ec05da95SInki Dae 	exynos_crtc->dpms = DRM_MODE_DPMS_OFF;
280b5d2eb3bSJoonyoung Shim 	exynos_crtc->plane = exynos_plane_init(dev, 1 << nr, true);
281b5d2eb3bSJoonyoung Shim 	if (!exynos_crtc->plane) {
282b5d2eb3bSJoonyoung Shim 		kfree(exynos_crtc);
283b5d2eb3bSJoonyoung Shim 		return -ENOMEM;
284b5d2eb3bSJoonyoung Shim 	}
285b5d2eb3bSJoonyoung Shim 
2861c248b7dSInki Dae 	crtc = &exynos_crtc->drm_crtc;
2871c248b7dSInki Dae 
2881c248b7dSInki Dae 	private->crtc[nr] = crtc;
2891c248b7dSInki Dae 
2901c248b7dSInki Dae 	drm_crtc_init(dev, crtc, &exynos_crtc_funcs);
2911c248b7dSInki Dae 	drm_crtc_helper_add(crtc, &exynos_crtc_helper_funcs);
2921c248b7dSInki Dae 
2931c248b7dSInki Dae 	return 0;
2941c248b7dSInki Dae }
2951c248b7dSInki Dae 
2961c248b7dSInki Dae int exynos_drm_crtc_enable_vblank(struct drm_device *dev, int crtc)
2971c248b7dSInki Dae {
2981c248b7dSInki Dae 	struct exynos_drm_private *private = dev->dev_private;
299ec05da95SInki Dae 	struct exynos_drm_crtc *exynos_crtc =
300ec05da95SInki Dae 		to_exynos_crtc(private->crtc[crtc]);
3011c248b7dSInki Dae 
3021c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
3031c248b7dSInki Dae 
304ec05da95SInki Dae 	if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
305ec05da95SInki Dae 		return -EPERM;
306ec05da95SInki Dae 
3071c248b7dSInki Dae 	exynos_drm_fn_encoder(private->crtc[crtc], &crtc,
3081c248b7dSInki Dae 			exynos_drm_enable_vblank);
3091c248b7dSInki Dae 
3101c248b7dSInki Dae 	return 0;
3111c248b7dSInki Dae }
3121c248b7dSInki Dae 
3131c248b7dSInki Dae void exynos_drm_crtc_disable_vblank(struct drm_device *dev, int crtc)
3141c248b7dSInki Dae {
3151c248b7dSInki Dae 	struct exynos_drm_private *private = dev->dev_private;
316ec05da95SInki Dae 	struct exynos_drm_crtc *exynos_crtc =
317ec05da95SInki Dae 		to_exynos_crtc(private->crtc[crtc]);
3181c248b7dSInki Dae 
3191c248b7dSInki Dae 	DRM_DEBUG_KMS("%s\n", __FILE__);
3201c248b7dSInki Dae 
321ec05da95SInki Dae 	if (exynos_crtc->dpms != DRM_MODE_DPMS_ON)
322ec05da95SInki Dae 		return;
323ec05da95SInki Dae 
3241c248b7dSInki Dae 	exynos_drm_fn_encoder(private->crtc[crtc], &crtc,
3251c248b7dSInki Dae 			exynos_drm_disable_vblank);
3261c248b7dSInki Dae }
327