1
2
3
4
5
6
7
8
9
10
11
12
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
31
32
33
34
35
36struct 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
42static 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
49
50
51 if (is_drm_iommu_supported(drm_dev))
52 return 0;
53
54 flags = exynos_gem_obj->flags;
55
56
57
58
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
68static 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
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
92static 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
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
106static 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
112
113 return 0;
114}
115
116static 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
122void 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
132unsigned 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
141struct drm_framebuffer *
142exynos_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
174static 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
189
190
191
192
193
194
195
196
197
198 if (cnt == 2) {
199
200
201
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
211static struct drm_framebuffer *
212exynos_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
265err_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 }
273err_free:
274 kfree(exynos_fb);
275 return ERR_PTR(ret);
276}
277
278struct 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
296static 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
305static 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
310void 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
317
318
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