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_fbdev.h"
24 #include "exynos_drm_gem.h"
25 #include "exynos_drm_iommu.h"
26 #include "exynos_drm_crtc.h"
27 
28 #define to_exynos_fb(x)	container_of(x, struct exynos_drm_fb, fb)
29 
30 /*
31  * exynos specific framebuffer structure.
32  *
33  * @fb: drm framebuffer obejct.
34  * @buf_cnt: a buffer count to drm framebuffer.
35  * @exynos_gem_obj: array of exynos specific gem object containing a gem object.
36  */
37 struct exynos_drm_fb {
38 	struct drm_framebuffer		fb;
39 	unsigned int			buf_cnt;
40 	struct exynos_drm_gem_obj	*exynos_gem_obj[MAX_FB_BUFFER];
41 };
42 
43 static int check_fb_gem_memory_type(struct drm_device *drm_dev,
44 				struct exynos_drm_gem_obj *exynos_gem_obj)
45 {
46 	unsigned int flags;
47 
48 	/*
49 	 * if exynos drm driver supports iommu then framebuffer can use
50 	 * all the buffer types.
51 	 */
52 	if (is_drm_iommu_supported(drm_dev))
53 		return 0;
54 
55 	flags = exynos_gem_obj->flags;
56 
57 	/*
58 	 * without iommu support, not support physically non-continuous memory
59 	 * for framebuffer.
60 	 */
61 	if (IS_NONCONTIG_BUFFER(flags)) {
62 		DRM_ERROR("cannot use this gem memory type for fb.\n");
63 		return -EINVAL;
64 	}
65 
66 	return 0;
67 }
68 
69 static void exynos_drm_fb_destroy(struct drm_framebuffer *fb)
70 {
71 	struct exynos_drm_fb *exynos_fb = to_exynos_fb(fb);
72 	unsigned int i;
73 
74 	/* make sure that overlay data are updated before relesing fb. */
75 	exynos_drm_crtc_complete_scanout(fb);
76 
77 	drm_framebuffer_cleanup(fb);
78 
79 	for (i = 0; i < ARRAY_SIZE(exynos_fb->exynos_gem_obj); i++) {
80 		struct drm_gem_object *obj;
81 
82 		if (exynos_fb->exynos_gem_obj[i] == NULL)
83 			continue;
84 
85 		obj = &exynos_fb->exynos_gem_obj[i]->base;
86 		drm_gem_object_unreference_unlocked(obj);
87 	}
88 
89 	kfree(exynos_fb);
90 	exynos_fb = NULL;
91 }
92 
93 static int exynos_drm_fb_create_handle(struct drm_framebuffer *fb,
94 					struct drm_file *file_priv,
95 					unsigned int *handle)
96 {
97 	struct exynos_drm_fb *exynos_fb = to_exynos_fb(fb);
98 
99 	/* This fb should have only one gem object. */
100 	if (WARN_ON(exynos_fb->buf_cnt != 1))
101 		return -EINVAL;
102 
103 	return drm_gem_handle_create(file_priv,
104 			&exynos_fb->exynos_gem_obj[0]->base, handle);
105 }
106 
107 static int exynos_drm_fb_dirty(struct drm_framebuffer *fb,
108 				struct drm_file *file_priv, unsigned flags,
109 				unsigned color, struct drm_clip_rect *clips,
110 				unsigned num_clips)
111 {
112 	/* TODO */
113 
114 	return 0;
115 }
116 
117 static struct drm_framebuffer_funcs exynos_drm_fb_funcs = {
118 	.destroy	= exynos_drm_fb_destroy,
119 	.create_handle	= exynos_drm_fb_create_handle,
120 	.dirty		= exynos_drm_fb_dirty,
121 };
122 
123 void exynos_drm_fb_set_buf_cnt(struct drm_framebuffer *fb,
124 						unsigned int cnt)
125 {
126 	struct exynos_drm_fb *exynos_fb;
127 
128 	exynos_fb = to_exynos_fb(fb);
129 
130 	exynos_fb->buf_cnt = cnt;
131 }
132 
133 unsigned int exynos_drm_fb_get_buf_cnt(struct drm_framebuffer *fb)
134 {
135 	struct exynos_drm_fb *exynos_fb;
136 
137 	exynos_fb = to_exynos_fb(fb);
138 
139 	return exynos_fb->buf_cnt;
140 }
141 
142 struct drm_framebuffer *
143 exynos_drm_framebuffer_init(struct drm_device *dev,
144 			    struct drm_mode_fb_cmd2 *mode_cmd,
145 			    struct drm_gem_object *obj)
146 {
147 	struct exynos_drm_fb *exynos_fb;
148 	struct exynos_drm_gem_obj *exynos_gem_obj;
149 	int ret;
150 
151 	exynos_gem_obj = to_exynos_gem_obj(obj);
152 
153 	ret = check_fb_gem_memory_type(dev, exynos_gem_obj);
154 	if (ret < 0)
155 		return ERR_PTR(ret);
156 
157 	exynos_fb = kzalloc(sizeof(*exynos_fb), GFP_KERNEL);
158 	if (!exynos_fb)
159 		return ERR_PTR(-ENOMEM);
160 
161 	drm_helper_mode_fill_fb_struct(&exynos_fb->fb, mode_cmd);
162 	exynos_fb->exynos_gem_obj[0] = exynos_gem_obj;
163 
164 	ret = drm_framebuffer_init(dev, &exynos_fb->fb, &exynos_drm_fb_funcs);
165 	if (ret) {
166 		kfree(exynos_fb);
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 			goto err_unreference;
253 	}
254 
255 	ret = drm_framebuffer_init(dev, &exynos_fb->fb, &exynos_drm_fb_funcs);
256 	if (ret) {
257 		DRM_ERROR("failed to init framebuffer.\n");
258 		goto err_unreference;
259 	}
260 
261 	return &exynos_fb->fb;
262 
263 err_unreference:
264 	for (i = 0; i < exynos_fb->buf_cnt; i++) {
265 		struct drm_gem_object *obj;
266 
267 		obj = &exynos_fb->exynos_gem_obj[i]->base;
268 		if (obj)
269 			drm_gem_object_unreference_unlocked(obj);
270 	}
271 err_free:
272 	kfree(exynos_fb);
273 	return ERR_PTR(ret);
274 }
275 
276 struct exynos_drm_gem_buf *exynos_drm_fb_buffer(struct drm_framebuffer *fb,
277 						int index)
278 {
279 	struct exynos_drm_fb *exynos_fb = to_exynos_fb(fb);
280 	struct exynos_drm_gem_buf *buffer;
281 
282 	if (index >= MAX_FB_BUFFER)
283 		return NULL;
284 
285 	buffer = exynos_fb->exynos_gem_obj[index]->buffer;
286 	if (!buffer)
287 		return NULL;
288 
289 	DRM_DEBUG_KMS("dma_addr = 0x%lx\n", (unsigned long)buffer->dma_addr);
290 
291 	return buffer;
292 }
293 
294 static void exynos_drm_output_poll_changed(struct drm_device *dev)
295 {
296 	struct exynos_drm_private *private = dev->dev_private;
297 	struct drm_fb_helper *fb_helper = private->fb_helper;
298 
299 	if (fb_helper)
300 		drm_fb_helper_hotplug_event(fb_helper);
301 	else
302 		exynos_drm_fbdev_init(dev);
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