1 /*
2  * Copyright (C) 2011 Samsung Electronics Co.Ltd
3  * Authors: Joonyoung Shim <jy0922.shim@samsung.com>
4  *
5  * This program is free software; you can redistribute  it and/or modify it
6  * under  the terms of  the GNU General  Public License as published by the
7  * Free Software Foundation;  either version 2 of the  License, or (at your
8  * option) any later version.
9  *
10  */
11 
12 #include <drm/drmP.h>
13 
14 #include <drm/exynos_drm.h>
15 #include <drm/drm_plane_helper.h>
16 #include "exynos_drm_drv.h"
17 #include "exynos_drm_crtc.h"
18 #include "exynos_drm_fb.h"
19 #include "exynos_drm_gem.h"
20 #include "exynos_drm_plane.h"
21 
22 static const uint32_t formats[] = {
23 	DRM_FORMAT_XRGB8888,
24 	DRM_FORMAT_ARGB8888,
25 	DRM_FORMAT_NV12,
26 };
27 
28 /*
29  * This function is to get X or Y size shown via screen. This needs length and
30  * start position of CRTC.
31  *
32  *      <--- length --->
33  * CRTC ----------------
34  *      ^ start        ^ end
35  *
36  * There are six cases from a to f.
37  *
38  *             <----- SCREEN ----->
39  *             0                 last
40  *   ----------|------------------|----------
41  * CRTCs
42  * a -------
43  *        b -------
44  *        c --------------------------
45  *                 d --------
46  *                           e -------
47  *                                  f -------
48  */
49 static int exynos_plane_get_size(int start, unsigned length, unsigned last)
50 {
51 	int end = start + length;
52 	int size = 0;
53 
54 	if (start <= 0) {
55 		if (end > 0)
56 			size = min_t(unsigned, end, last);
57 	} else if (start <= last) {
58 		size = min_t(unsigned, last - start, length);
59 	}
60 
61 	return size;
62 }
63 
64 int exynos_check_plane(struct drm_plane *plane, struct drm_framebuffer *fb)
65 {
66 	struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane);
67 	int nr;
68 	int i;
69 
70 	nr = exynos_drm_fb_get_buf_cnt(fb);
71 	for (i = 0; i < nr; i++) {
72 		struct exynos_drm_gem_buf *buffer = exynos_drm_fb_buffer(fb, i);
73 
74 		if (!buffer) {
75 			DRM_DEBUG_KMS("buffer is null\n");
76 			return -EFAULT;
77 		}
78 
79 		exynos_plane->dma_addr[i] = buffer->dma_addr;
80 
81 		DRM_DEBUG_KMS("buffer: %d, dma_addr = 0x%lx\n",
82 				i, (unsigned long)exynos_plane->dma_addr[i]);
83 	}
84 
85 	return 0;
86 }
87 
88 void exynos_plane_mode_set(struct drm_plane *plane, struct drm_crtc *crtc,
89 			  struct drm_framebuffer *fb, int crtc_x, int crtc_y,
90 			  unsigned int crtc_w, unsigned int crtc_h,
91 			  uint32_t src_x, uint32_t src_y,
92 			  uint32_t src_w, uint32_t src_h)
93 {
94 	struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane);
95 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
96 	unsigned int actual_w;
97 	unsigned int actual_h;
98 
99 	actual_w = exynos_plane_get_size(crtc_x, crtc_w, crtc->mode.hdisplay);
100 	actual_h = exynos_plane_get_size(crtc_y, crtc_h, crtc->mode.vdisplay);
101 
102 	if (crtc_x < 0) {
103 		if (actual_w)
104 			src_x -= crtc_x;
105 		crtc_x = 0;
106 	}
107 
108 	if (crtc_y < 0) {
109 		if (actual_h)
110 			src_y -= crtc_y;
111 		crtc_y = 0;
112 	}
113 
114 	/* set drm framebuffer data. */
115 	exynos_plane->fb_x = src_x;
116 	exynos_plane->fb_y = src_y;
117 	exynos_plane->fb_width = fb->width;
118 	exynos_plane->fb_height = fb->height;
119 	exynos_plane->src_width = src_w;
120 	exynos_plane->src_height = src_h;
121 	exynos_plane->bpp = fb->bits_per_pixel;
122 	exynos_plane->pitch = fb->pitches[0];
123 	exynos_plane->pixel_format = fb->pixel_format;
124 
125 	/* set plane range to be displayed. */
126 	exynos_plane->crtc_x = crtc_x;
127 	exynos_plane->crtc_y = crtc_y;
128 	exynos_plane->crtc_width = actual_w;
129 	exynos_plane->crtc_height = actual_h;
130 
131 	/* set drm mode data. */
132 	exynos_plane->mode_width = crtc->mode.hdisplay;
133 	exynos_plane->mode_height = crtc->mode.vdisplay;
134 	exynos_plane->refresh = crtc->mode.vrefresh;
135 	exynos_plane->scan_flag = crtc->mode.flags;
136 
137 	DRM_DEBUG_KMS("plane : offset_x/y(%d,%d), width/height(%d,%d)",
138 			exynos_plane->crtc_x, exynos_plane->crtc_y,
139 			exynos_plane->crtc_width, exynos_plane->crtc_height);
140 
141 	plane->crtc = crtc;
142 
143 	if (exynos_crtc->ops->win_mode_set)
144 		exynos_crtc->ops->win_mode_set(exynos_crtc, exynos_plane);
145 }
146 
147 int
148 exynos_update_plane(struct drm_plane *plane, struct drm_crtc *crtc,
149 		     struct drm_framebuffer *fb, int crtc_x, int crtc_y,
150 		     unsigned int crtc_w, unsigned int crtc_h,
151 		     uint32_t src_x, uint32_t src_y,
152 		     uint32_t src_w, uint32_t src_h)
153 {
154 
155 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
156 	struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane);
157 	int ret;
158 
159 	ret = exynos_check_plane(plane, fb);
160 	if (ret < 0)
161 		return ret;
162 
163 	exynos_plane_mode_set(plane, crtc, fb, crtc_x, crtc_y,
164 			      crtc_w, crtc_h, src_x >> 16, src_y >> 16,
165 			      src_w >> 16, src_h >> 16);
166 
167 	if (exynos_crtc->ops->win_commit)
168 		exynos_crtc->ops->win_commit(exynos_crtc, exynos_plane->zpos);
169 
170 	return 0;
171 }
172 
173 static int exynos_disable_plane(struct drm_plane *plane)
174 {
175 	struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane);
176 	struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(plane->crtc);
177 
178 	if (exynos_crtc->ops->win_disable)
179 		exynos_crtc->ops->win_disable(exynos_crtc,
180 					      exynos_plane->zpos);
181 
182 	return 0;
183 }
184 
185 static void exynos_plane_destroy(struct drm_plane *plane)
186 {
187 	struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane);
188 
189 	exynos_disable_plane(plane);
190 	drm_plane_cleanup(plane);
191 	kfree(exynos_plane);
192 }
193 
194 static int exynos_plane_set_property(struct drm_plane *plane,
195 				     struct drm_property *property,
196 				     uint64_t val)
197 {
198 	struct drm_device *dev = plane->dev;
199 	struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane);
200 	struct exynos_drm_private *dev_priv = dev->dev_private;
201 
202 	if (property == dev_priv->plane_zpos_property) {
203 		exynos_plane->zpos = val;
204 		return 0;
205 	}
206 
207 	return -EINVAL;
208 }
209 
210 static struct drm_plane_funcs exynos_plane_funcs = {
211 	.update_plane	= exynos_update_plane,
212 	.disable_plane	= exynos_disable_plane,
213 	.destroy	= exynos_plane_destroy,
214 	.set_property	= exynos_plane_set_property,
215 };
216 
217 static void exynos_plane_attach_zpos_property(struct drm_plane *plane)
218 {
219 	struct drm_device *dev = plane->dev;
220 	struct exynos_drm_private *dev_priv = dev->dev_private;
221 	struct drm_property *prop;
222 
223 	prop = dev_priv->plane_zpos_property;
224 	if (!prop) {
225 		prop = drm_property_create_range(dev, 0, "zpos", 0,
226 						 MAX_PLANE - 1);
227 		if (!prop)
228 			return;
229 
230 		dev_priv->plane_zpos_property = prop;
231 	}
232 
233 	drm_object_attach_property(&plane->base, prop, 0);
234 }
235 
236 struct drm_plane *exynos_plane_init(struct drm_device *dev,
237 				    unsigned long possible_crtcs,
238 				    enum drm_plane_type type)
239 {
240 	struct exynos_drm_plane *exynos_plane;
241 	int err;
242 
243 	exynos_plane = kzalloc(sizeof(struct exynos_drm_plane), GFP_KERNEL);
244 	if (!exynos_plane)
245 		return ERR_PTR(-ENOMEM);
246 
247 	err = drm_universal_plane_init(dev, &exynos_plane->base, possible_crtcs,
248 				       &exynos_plane_funcs, formats,
249 				       ARRAY_SIZE(formats), type);
250 	if (err) {
251 		DRM_ERROR("failed to initialize plane\n");
252 		kfree(exynos_plane);
253 		return ERR_PTR(err);
254 	}
255 
256 	if (type == DRM_PLANE_TYPE_PRIMARY)
257 		exynos_plane->zpos = DEFAULT_ZPOS;
258 	else
259 		exynos_plane_attach_zpos_property(&exynos_plane->base);
260 
261 	return &exynos_plane->base;
262 }
263