1 /* exynos_drm_fb.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  * This program is free software; you can redistribute  it and/or modify it
10  * under  the terms of  the GNU General  Public License as published by the
11  * Free Software Foundation;  either version 2 of the  License, or (at your
12  * option) any later version.
13  */
14 
15 #include <drm/drmP.h>
16 #include <drm/drm_crtc.h>
17 #include <drm/drm_crtc_helper.h>
18 #include <drm/drm_fb_helper.h>
19 #include <uapi/drm/exynos_drm.h>
20 
21 #include "exynos_drm_drv.h"
22 #include "exynos_drm_fb.h"
23 #include "exynos_drm_gem.h"
24 #include "exynos_drm_iommu.h"
25 #include "exynos_drm_encoder.h"
26 
27 #define to_exynos_fb(x)	container_of(x, struct exynos_drm_fb, fb)
28 
29 /*
30  * exynos specific framebuffer structure.
31  *
32  * @fb: drm framebuffer obejct.
33  * @buf_cnt: a buffer count to drm framebuffer.
34  * @exynos_gem_obj: array of exynos specific gem object containing a gem object.
35  */
36 struct exynos_drm_fb {
37 	struct drm_framebuffer		fb;
38 	unsigned int			buf_cnt;
39 	struct exynos_drm_gem_obj	*exynos_gem_obj[MAX_FB_BUFFER];
40 };
41 
42 static int check_fb_gem_memory_type(struct drm_device *drm_dev,
43 				struct exynos_drm_gem_obj *exynos_gem_obj)
44 {
45 	unsigned int flags;
46 
47 	/*
48 	 * if exynos drm driver supports iommu then framebuffer can use
49 	 * all the buffer types.
50 	 */
51 	if (is_drm_iommu_supported(drm_dev))
52 		return 0;
53 
54 	flags = exynos_gem_obj->flags;
55 
56 	/*
57 	 * without iommu support, not support physically non-continuous memory
58 	 * for framebuffer.
59 	 */
60 	if (IS_NONCONTIG_BUFFER(flags)) {
61 		DRM_ERROR("cannot use this gem memory type for fb.\n");
62 		return -EINVAL;
63 	}
64 
65 	return 0;
66 }
67 
68 static void exynos_drm_fb_destroy(struct drm_framebuffer *fb)
69 {
70 	struct exynos_drm_fb *exynos_fb = to_exynos_fb(fb);
71 	unsigned int i;
72 
73 	/* make sure that overlay data are updated before relesing fb. */
74 	exynos_drm_encoder_complete_scanout(fb);
75 
76 	drm_framebuffer_cleanup(fb);
77 
78 	for (i = 0; i < ARRAY_SIZE(exynos_fb->exynos_gem_obj); i++) {
79 		struct drm_gem_object *obj;
80 
81 		if (exynos_fb->exynos_gem_obj[i] == NULL)
82 			continue;
83 
84 		obj = &exynos_fb->exynos_gem_obj[i]->base;
85 		drm_gem_object_unreference_unlocked(obj);
86 	}
87 
88 	kfree(exynos_fb);
89 	exynos_fb = NULL;
90 }
91 
92 static int exynos_drm_fb_create_handle(struct drm_framebuffer *fb,
93 					struct drm_file *file_priv,
94 					unsigned int *handle)
95 {
96 	struct exynos_drm_fb *exynos_fb = to_exynos_fb(fb);
97 
98 	/* This fb should have only one gem object. */
99 	if (WARN_ON(exynos_fb->buf_cnt != 1))
100 		return -EINVAL;
101 
102 	return drm_gem_handle_create(file_priv,
103 			&exynos_fb->exynos_gem_obj[0]->base, handle);
104 }
105 
106 static int exynos_drm_fb_dirty(struct drm_framebuffer *fb,
107 				struct drm_file *file_priv, unsigned flags,
108 				unsigned color, struct drm_clip_rect *clips,
109 				unsigned num_clips)
110 {
111 	/* TODO */
112 
113 	return 0;
114 }
115 
116 static struct drm_framebuffer_funcs exynos_drm_fb_funcs = {
117 	.destroy	= exynos_drm_fb_destroy,
118 	.create_handle	= exynos_drm_fb_create_handle,
119 	.dirty		= exynos_drm_fb_dirty,
120 };
121 
122 void exynos_drm_fb_set_buf_cnt(struct drm_framebuffer *fb,
123 						unsigned int cnt)
124 {
125 	struct exynos_drm_fb *exynos_fb;
126 
127 	exynos_fb = to_exynos_fb(fb);
128 
129 	exynos_fb->buf_cnt = cnt;
130 }
131 
132 unsigned int exynos_drm_fb_get_buf_cnt(struct drm_framebuffer *fb)
133 {
134 	struct exynos_drm_fb *exynos_fb;
135 
136 	exynos_fb = to_exynos_fb(fb);
137 
138 	return exynos_fb->buf_cnt;
139 }
140 
141 struct drm_framebuffer *
142 exynos_drm_framebuffer_init(struct drm_device *dev,
143 			    struct drm_mode_fb_cmd2 *mode_cmd,
144 			    struct drm_gem_object *obj)
145 {
146 	struct exynos_drm_fb *exynos_fb;
147 	struct exynos_drm_gem_obj *exynos_gem_obj;
148 	int ret;
149 
150 	exynos_gem_obj = to_exynos_gem_obj(obj);
151 
152 	ret = check_fb_gem_memory_type(dev, exynos_gem_obj);
153 	if (ret < 0) {
154 		DRM_ERROR("cannot use this gem memory type for fb.\n");
155 		return ERR_PTR(-EINVAL);
156 	}
157 
158 	exynos_fb = kzalloc(sizeof(*exynos_fb), GFP_KERNEL);
159 	if (!exynos_fb)
160 		return ERR_PTR(-ENOMEM);
161 
162 	drm_helper_mode_fill_fb_struct(&exynos_fb->fb, mode_cmd);
163 	exynos_fb->exynos_gem_obj[0] = exynos_gem_obj;
164 
165 	ret = drm_framebuffer_init(dev, &exynos_fb->fb, &exynos_drm_fb_funcs);
166 	if (ret) {
167 		DRM_ERROR("failed to initialize framebuffer\n");
168 		return ERR_PTR(ret);
169 	}
170 
171 	return &exynos_fb->fb;
172 }
173 
174 static u32 exynos_drm_format_num_buffers(struct drm_mode_fb_cmd2 *mode_cmd)
175 {
176 	unsigned int cnt = 0;
177 
178 	if (mode_cmd->pixel_format != DRM_FORMAT_NV12)
179 		return drm_format_num_planes(mode_cmd->pixel_format);
180 
181 	while (cnt != MAX_FB_BUFFER) {
182 		if (!mode_cmd->handles[cnt])
183 			break;
184 		cnt++;
185 	}
186 
187 	/*
188 	 * check if NV12 or NV12M.
189 	 *
190 	 * NV12
191 	 * handles[0] = base1, offsets[0] = 0
192 	 * handles[1] = base1, offsets[1] = Y_size
193 	 *
194 	 * NV12M
195 	 * handles[0] = base1, offsets[0] = 0
196 	 * handles[1] = base2, offsets[1] = 0
197 	 */
198 	if (cnt == 2) {
199 		/*
200 		 * in case of NV12 format, offsets[1] is not 0 and
201 		 * handles[0] is same as handles[1].
202 		 */
203 		if (mode_cmd->offsets[1] &&
204 			mode_cmd->handles[0] == mode_cmd->handles[1])
205 			cnt = 1;
206 	}
207 
208 	return cnt;
209 }
210 
211 static struct drm_framebuffer *
212 exynos_user_fb_create(struct drm_device *dev, struct drm_file *file_priv,
213 		      struct drm_mode_fb_cmd2 *mode_cmd)
214 {
215 	struct drm_gem_object *obj;
216 	struct exynos_drm_gem_obj *exynos_gem_obj;
217 	struct exynos_drm_fb *exynos_fb;
218 	int i, ret;
219 
220 	exynos_fb = kzalloc(sizeof(*exynos_fb), GFP_KERNEL);
221 	if (!exynos_fb)
222 		return ERR_PTR(-ENOMEM);
223 
224 	obj = drm_gem_object_lookup(dev, file_priv, mode_cmd->handles[0]);
225 	if (!obj) {
226 		DRM_ERROR("failed to lookup gem object\n");
227 		ret = -ENOENT;
228 		goto err_free;
229 	}
230 
231 	drm_helper_mode_fill_fb_struct(&exynos_fb->fb, mode_cmd);
232 	exynos_fb->exynos_gem_obj[0] = to_exynos_gem_obj(obj);
233 	exynos_fb->buf_cnt = exynos_drm_format_num_buffers(mode_cmd);
234 
235 	DRM_DEBUG_KMS("buf_cnt = %d\n", exynos_fb->buf_cnt);
236 
237 	for (i = 1; i < exynos_fb->buf_cnt; i++) {
238 		obj = drm_gem_object_lookup(dev, file_priv,
239 				mode_cmd->handles[i]);
240 		if (!obj) {
241 			DRM_ERROR("failed to lookup gem object\n");
242 			ret = -ENOENT;
243 			exynos_fb->buf_cnt = i;
244 			goto err_unreference;
245 		}
246 
247 		exynos_gem_obj = to_exynos_gem_obj(obj);
248 		exynos_fb->exynos_gem_obj[i] = exynos_gem_obj;
249 
250 		ret = check_fb_gem_memory_type(dev, exynos_gem_obj);
251 		if (ret < 0) {
252 			DRM_ERROR("cannot use this gem memory type for fb.\n");
253 			goto err_unreference;
254 		}
255 	}
256 
257 	ret = drm_framebuffer_init(dev, &exynos_fb->fb, &exynos_drm_fb_funcs);
258 	if (ret) {
259 		DRM_ERROR("failed to init framebuffer.\n");
260 		goto err_unreference;
261 	}
262 
263 	return &exynos_fb->fb;
264 
265 err_unreference:
266 	for (i = 0; i < exynos_fb->buf_cnt; i++) {
267 		struct drm_gem_object *obj;
268 
269 		obj = &exynos_fb->exynos_gem_obj[i]->base;
270 		if (obj)
271 			drm_gem_object_unreference_unlocked(obj);
272 	}
273 err_free:
274 	kfree(exynos_fb);
275 	return ERR_PTR(ret);
276 }
277 
278 struct exynos_drm_gem_buf *exynos_drm_fb_buffer(struct drm_framebuffer *fb,
279 						int index)
280 {
281 	struct exynos_drm_fb *exynos_fb = to_exynos_fb(fb);
282 	struct exynos_drm_gem_buf *buffer;
283 
284 	if (index >= MAX_FB_BUFFER)
285 		return NULL;
286 
287 	buffer = exynos_fb->exynos_gem_obj[index]->buffer;
288 	if (!buffer)
289 		return NULL;
290 
291 	DRM_DEBUG_KMS("dma_addr = 0x%lx\n", (unsigned long)buffer->dma_addr);
292 
293 	return buffer;
294 }
295 
296 static void exynos_drm_output_poll_changed(struct drm_device *dev)
297 {
298 	struct exynos_drm_private *private = dev->dev_private;
299 	struct drm_fb_helper *fb_helper = private->fb_helper;
300 
301 	if (fb_helper)
302 		drm_fb_helper_hotplug_event(fb_helper);
303 }
304 
305 static const struct drm_mode_config_funcs exynos_drm_mode_config_funcs = {
306 	.fb_create = exynos_user_fb_create,
307 	.output_poll_changed = exynos_drm_output_poll_changed,
308 };
309 
310 void exynos_drm_mode_config_init(struct drm_device *dev)
311 {
312 	dev->mode_config.min_width = 0;
313 	dev->mode_config.min_height = 0;
314 
315 	/*
316 	 * set max width and height as default value(4096x4096).
317 	 * this value would be used to check framebuffer size limitation
318 	 * at drm_mode_addfb().
319 	 */
320 	dev->mode_config.max_width = 4096;
321 	dev->mode_config.max_height = 4096;
322 
323 	dev->mode_config.funcs = &exynos_drm_mode_config_funcs;
324 }
325