1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * drm gem framebuffer helper functions
4 *
5 * Copyright (C) 2017 Noralf Trønnes
6 */
7
8#include <linux/slab.h>
9#include <linux/module.h>
10
11#include <drm/drm_damage_helper.h>
12#include <drm/drm_drv.h>
13#include <drm/drm_fourcc.h>
14#include <drm/drm_framebuffer.h>
15#include <drm/drm_gem.h>
16#include <drm/drm_gem_framebuffer_helper.h>
17#include <drm/drm_modeset_helper.h>
18
19#include "drm_internal.h"
20
21MODULE_IMPORT_NS(DMA_BUF);
22
23#define AFBC_HEADER_SIZE 16
24#define AFBC_TH_LAYOUT_ALIGNMENT 8
25#define AFBC_HDR_ALIGN 64
26#define AFBC_SUPERBLOCK_PIXELS 256
27#define AFBC_SUPERBLOCK_ALIGNMENT 128
28#define AFBC_TH_BODY_START_ALIGNMENT 4096
29
30/**
31 * DOC: overview
32 *
33 * This library provides helpers for drivers that don't subclass
34 * &drm_framebuffer and use &drm_gem_object for their backing storage.
35 *
36 * Drivers without additional needs to validate framebuffers can simply use
37 * drm_gem_fb_create() and everything is wired up automatically. Other drivers
38 * can use all parts independently.
39 */
40
41/**
42 * drm_gem_fb_get_obj() - Get GEM object backing the framebuffer
43 * @fb: Framebuffer
44 * @plane: Plane index
45 *
46 * No additional reference is taken beyond the one that the &drm_frambuffer
47 * already holds.
48 *
49 * Returns:
50 * Pointer to &drm_gem_object for the given framebuffer and plane index or NULL
51 * if it does not exist.
52 */
53struct drm_gem_object *drm_gem_fb_get_obj(struct drm_framebuffer *fb,
54 unsigned int plane)
55{
56 struct drm_device *dev = fb->dev;
57
58 if (drm_WARN_ON_ONCE(dev, plane >= ARRAY_SIZE(fb->obj)))
59 return NULL;
60 else if (drm_WARN_ON_ONCE(dev, !fb->obj[plane]))
61 return NULL;
62
63 return fb->obj[plane];
64}
65EXPORT_SYMBOL_GPL(drm_gem_fb_get_obj);
66
67static int
68drm_gem_fb_init(struct drm_device *dev,
69 struct drm_framebuffer *fb,
70 const struct drm_mode_fb_cmd2 *mode_cmd,
71 struct drm_gem_object **obj, unsigned int num_planes,
72 const struct drm_framebuffer_funcs *funcs)
73{
74 unsigned int i;
75 int ret;
76
77 drm_helper_mode_fill_fb_struct(dev, fb, mode_cmd);
78
79 for (i = 0; i < num_planes; i++)
80 fb->obj[i] = obj[i];
81
82 ret = drm_framebuffer_init(dev, fb, funcs);
83 if (ret)
84 drm_err(dev, "Failed to init framebuffer: %d\n", ret);
85
86 return ret;
87}
88
89/**
90 * drm_gem_fb_destroy - Free GEM backed framebuffer
91 * @fb: Framebuffer
92 *
93 * Frees a GEM backed framebuffer with its backing buffer(s) and the structure
94 * itself. Drivers can use this as their &drm_framebuffer_funcs->destroy
95 * callback.
96 */
97void drm_gem_fb_destroy(struct drm_framebuffer *fb)
98{
99 unsigned int i;
100
101 for (i = 0; i < fb->format->num_planes; i++)
102 drm_gem_object_put(obj: fb->obj[i]);
103
104 drm_framebuffer_cleanup(fb);
105 kfree(objp: fb);
106}
107EXPORT_SYMBOL(drm_gem_fb_destroy);
108
109/**
110 * drm_gem_fb_create_handle - Create handle for GEM backed framebuffer
111 * @fb: Framebuffer
112 * @file: DRM file to register the handle for
113 * @handle: Pointer to return the created handle
114 *
115 * This function creates a handle for the GEM object backing the framebuffer.
116 * Drivers can use this as their &drm_framebuffer_funcs->create_handle
117 * callback. The GETFB IOCTL calls into this callback.
118 *
119 * Returns:
120 * 0 on success or a negative error code on failure.
121 */
122int drm_gem_fb_create_handle(struct drm_framebuffer *fb, struct drm_file *file,
123 unsigned int *handle)
124{
125 return drm_gem_handle_create(file_priv: file, obj: fb->obj[0], handlep: handle);
126}
127EXPORT_SYMBOL(drm_gem_fb_create_handle);
128
129/**
130 * drm_gem_fb_init_with_funcs() - Helper function for implementing
131 * &drm_mode_config_funcs.fb_create
132 * callback in cases when the driver
133 * allocates a subclass of
134 * struct drm_framebuffer
135 * @dev: DRM device
136 * @fb: framebuffer object
137 * @file: DRM file that holds the GEM handle(s) backing the framebuffer
138 * @mode_cmd: Metadata from the userspace framebuffer creation request
139 * @funcs: vtable to be used for the new framebuffer object
140 *
141 * This function can be used to set &drm_framebuffer_funcs for drivers that need
142 * custom framebuffer callbacks. Use drm_gem_fb_create() if you don't need to
143 * change &drm_framebuffer_funcs. The function does buffer size validation.
144 * The buffer size validation is for a general case, though, so users should
145 * pay attention to the checks being appropriate for them or, at least,
146 * non-conflicting.
147 *
148 * Returns:
149 * Zero or a negative error code.
150 */
151int drm_gem_fb_init_with_funcs(struct drm_device *dev,
152 struct drm_framebuffer *fb,
153 struct drm_file *file,
154 const struct drm_mode_fb_cmd2 *mode_cmd,
155 const struct drm_framebuffer_funcs *funcs)
156{
157 const struct drm_format_info *info;
158 struct drm_gem_object *objs[DRM_FORMAT_MAX_PLANES];
159 unsigned int i;
160 int ret;
161
162 info = drm_get_format_info(dev, mode_cmd);
163 if (!info) {
164 drm_dbg_kms(dev, "Failed to get FB format info\n");
165 return -EINVAL;
166 }
167
168 if (drm_drv_uses_atomic_modeset(dev) &&
169 !drm_any_plane_has_format(dev, format: mode_cmd->pixel_format,
170 modifier: mode_cmd->modifier[0])) {
171 drm_dbg_kms(dev, "Unsupported pixel format %p4cc / modifier 0x%llx\n",
172 &mode_cmd->pixel_format, mode_cmd->modifier[0]);
173 return -EINVAL;
174 }
175
176 for (i = 0; i < info->num_planes; i++) {
177 unsigned int width = mode_cmd->width / (i ? info->hsub : 1);
178 unsigned int height = mode_cmd->height / (i ? info->vsub : 1);
179 unsigned int min_size;
180
181 objs[i] = drm_gem_object_lookup(filp: file, handle: mode_cmd->handles[i]);
182 if (!objs[i]) {
183 drm_dbg_kms(dev, "Failed to lookup GEM object\n");
184 ret = -ENOENT;
185 goto err_gem_object_put;
186 }
187
188 min_size = (height - 1) * mode_cmd->pitches[i]
189 + drm_format_info_min_pitch(info, plane: i, buffer_width: width)
190 + mode_cmd->offsets[i];
191
192 if (objs[i]->size < min_size) {
193 drm_dbg_kms(dev,
194 "GEM object size (%zu) smaller than minimum size (%u) for plane %d\n",
195 objs[i]->size, min_size, i);
196 drm_gem_object_put(obj: objs[i]);
197 ret = -EINVAL;
198 goto err_gem_object_put;
199 }
200 }
201
202 ret = drm_gem_fb_init(dev, fb, mode_cmd, obj: objs, num_planes: i, funcs);
203 if (ret)
204 goto err_gem_object_put;
205
206 return 0;
207
208err_gem_object_put:
209 while (i > 0) {
210 --i;
211 drm_gem_object_put(obj: objs[i]);
212 }
213 return ret;
214}
215EXPORT_SYMBOL_GPL(drm_gem_fb_init_with_funcs);
216
217/**
218 * drm_gem_fb_create_with_funcs() - Helper function for the
219 * &drm_mode_config_funcs.fb_create
220 * callback
221 * @dev: DRM device
222 * @file: DRM file that holds the GEM handle(s) backing the framebuffer
223 * @mode_cmd: Metadata from the userspace framebuffer creation request
224 * @funcs: vtable to be used for the new framebuffer object
225 *
226 * This function can be used to set &drm_framebuffer_funcs for drivers that need
227 * custom framebuffer callbacks. Use drm_gem_fb_create() if you don't need to
228 * change &drm_framebuffer_funcs. The function does buffer size validation.
229 *
230 * Returns:
231 * Pointer to a &drm_framebuffer on success or an error pointer on failure.
232 */
233struct drm_framebuffer *
234drm_gem_fb_create_with_funcs(struct drm_device *dev, struct drm_file *file,
235 const struct drm_mode_fb_cmd2 *mode_cmd,
236 const struct drm_framebuffer_funcs *funcs)
237{
238 struct drm_framebuffer *fb;
239 int ret;
240
241 fb = kzalloc(size: sizeof(*fb), GFP_KERNEL);
242 if (!fb)
243 return ERR_PTR(error: -ENOMEM);
244
245 ret = drm_gem_fb_init_with_funcs(dev, fb, file, mode_cmd, funcs);
246 if (ret) {
247 kfree(objp: fb);
248 return ERR_PTR(error: ret);
249 }
250
251 return fb;
252}
253EXPORT_SYMBOL_GPL(drm_gem_fb_create_with_funcs);
254
255static const struct drm_framebuffer_funcs drm_gem_fb_funcs = {
256 .destroy = drm_gem_fb_destroy,
257 .create_handle = drm_gem_fb_create_handle,
258};
259
260/**
261 * drm_gem_fb_create() - Helper function for the
262 * &drm_mode_config_funcs.fb_create callback
263 * @dev: DRM device
264 * @file: DRM file that holds the GEM handle(s) backing the framebuffer
265 * @mode_cmd: Metadata from the userspace framebuffer creation request
266 *
267 * This function creates a new framebuffer object described by
268 * &drm_mode_fb_cmd2. This description includes handles for the buffer(s)
269 * backing the framebuffer.
270 *
271 * If your hardware has special alignment or pitch requirements these should be
272 * checked before calling this function. The function does buffer size
273 * validation. Use drm_gem_fb_create_with_dirty() if you need framebuffer
274 * flushing.
275 *
276 * Drivers can use this as their &drm_mode_config_funcs.fb_create callback.
277 * The ADDFB2 IOCTL calls into this callback.
278 *
279 * Returns:
280 * Pointer to a &drm_framebuffer on success or an error pointer on failure.
281 */
282struct drm_framebuffer *
283drm_gem_fb_create(struct drm_device *dev, struct drm_file *file,
284 const struct drm_mode_fb_cmd2 *mode_cmd)
285{
286 return drm_gem_fb_create_with_funcs(dev, file, mode_cmd,
287 &drm_gem_fb_funcs);
288}
289EXPORT_SYMBOL_GPL(drm_gem_fb_create);
290
291static const struct drm_framebuffer_funcs drm_gem_fb_funcs_dirtyfb = {
292 .destroy = drm_gem_fb_destroy,
293 .create_handle = drm_gem_fb_create_handle,
294 .dirty = drm_atomic_helper_dirtyfb,
295};
296
297/**
298 * drm_gem_fb_create_with_dirty() - Helper function for the
299 * &drm_mode_config_funcs.fb_create callback
300 * @dev: DRM device
301 * @file: DRM file that holds the GEM handle(s) backing the framebuffer
302 * @mode_cmd: Metadata from the userspace framebuffer creation request
303 *
304 * This function creates a new framebuffer object described by
305 * &drm_mode_fb_cmd2. This description includes handles for the buffer(s)
306 * backing the framebuffer. drm_atomic_helper_dirtyfb() is used for the dirty
307 * callback giving framebuffer flushing through the atomic machinery. Use
308 * drm_gem_fb_create() if you don't need the dirty callback.
309 * The function does buffer size validation.
310 *
311 * Drivers should also call drm_plane_enable_fb_damage_clips() on all planes
312 * to enable userspace to use damage clips also with the ATOMIC IOCTL.
313 *
314 * Drivers can use this as their &drm_mode_config_funcs.fb_create callback.
315 * The ADDFB2 IOCTL calls into this callback.
316 *
317 * Returns:
318 * Pointer to a &drm_framebuffer on success or an error pointer on failure.
319 */
320struct drm_framebuffer *
321drm_gem_fb_create_with_dirty(struct drm_device *dev, struct drm_file *file,
322 const struct drm_mode_fb_cmd2 *mode_cmd)
323{
324 return drm_gem_fb_create_with_funcs(dev, file, mode_cmd,
325 &drm_gem_fb_funcs_dirtyfb);
326}
327EXPORT_SYMBOL_GPL(drm_gem_fb_create_with_dirty);
328
329/**
330 * drm_gem_fb_vmap - maps all framebuffer BOs into kernel address space
331 * @fb: the framebuffer
332 * @map: returns the mapping's address for each BO
333 * @data: returns the data address for each BO, can be NULL
334 *
335 * This function maps all buffer objects of the given framebuffer into
336 * kernel address space and stores them in struct iosys_map. If the
337 * mapping operation fails for one of the BOs, the function unmaps the
338 * already established mappings automatically.
339 *
340 * Callers that want to access a BO's stored data should pass @data.
341 * The argument returns the addresses of the data stored in each BO. This
342 * is different from @map if the framebuffer's offsets field is non-zero.
343 *
344 * Both, @map and @data, must each refer to arrays with at least
345 * fb->format->num_planes elements.
346 *
347 * See drm_gem_fb_vunmap() for unmapping.
348 *
349 * Returns:
350 * 0 on success, or a negative errno code otherwise.
351 */
352int drm_gem_fb_vmap(struct drm_framebuffer *fb, struct iosys_map *map,
353 struct iosys_map *data)
354{
355 struct drm_gem_object *obj;
356 unsigned int i;
357 int ret;
358
359 for (i = 0; i < fb->format->num_planes; ++i) {
360 obj = drm_gem_fb_get_obj(fb, i);
361 if (!obj) {
362 ret = -EINVAL;
363 goto err_drm_gem_vunmap;
364 }
365 ret = drm_gem_vmap_unlocked(obj, map: &map[i]);
366 if (ret)
367 goto err_drm_gem_vunmap;
368 }
369
370 if (data) {
371 for (i = 0; i < fb->format->num_planes; ++i) {
372 memcpy(&data[i], &map[i], sizeof(data[i]));
373 if (iosys_map_is_null(map: &data[i]))
374 continue;
375 iosys_map_incr(map: &data[i], incr: fb->offsets[i]);
376 }
377 }
378
379 return 0;
380
381err_drm_gem_vunmap:
382 while (i) {
383 --i;
384 obj = drm_gem_fb_get_obj(fb, i);
385 if (!obj)
386 continue;
387 drm_gem_vunmap_unlocked(obj, map: &map[i]);
388 }
389 return ret;
390}
391EXPORT_SYMBOL(drm_gem_fb_vmap);
392
393/**
394 * drm_gem_fb_vunmap - unmaps framebuffer BOs from kernel address space
395 * @fb: the framebuffer
396 * @map: mapping addresses as returned by drm_gem_fb_vmap()
397 *
398 * This function unmaps all buffer objects of the given framebuffer.
399 *
400 * See drm_gem_fb_vmap() for more information.
401 */
402void drm_gem_fb_vunmap(struct drm_framebuffer *fb, struct iosys_map *map)
403{
404 unsigned int i = fb->format->num_planes;
405 struct drm_gem_object *obj;
406
407 while (i) {
408 --i;
409 obj = drm_gem_fb_get_obj(fb, i);
410 if (!obj)
411 continue;
412 if (iosys_map_is_null(map: &map[i]))
413 continue;
414 drm_gem_vunmap_unlocked(obj, map: &map[i]);
415 }
416}
417EXPORT_SYMBOL(drm_gem_fb_vunmap);
418
419static void __drm_gem_fb_end_cpu_access(struct drm_framebuffer *fb, enum dma_data_direction dir,
420 unsigned int num_planes)
421{
422 struct dma_buf_attachment *import_attach;
423 struct drm_gem_object *obj;
424 int ret;
425
426 while (num_planes) {
427 --num_planes;
428 obj = drm_gem_fb_get_obj(fb, num_planes);
429 if (!obj)
430 continue;
431 import_attach = obj->import_attach;
432 if (!import_attach)
433 continue;
434 ret = dma_buf_end_cpu_access(dma_buf: import_attach->dmabuf, dir);
435 if (ret)
436 drm_err(fb->dev, "dma_buf_end_cpu_access(%u, %d) failed: %d\n",
437 ret, num_planes, dir);
438 }
439}
440
441/**
442 * drm_gem_fb_begin_cpu_access - prepares GEM buffer objects for CPU access
443 * @fb: the framebuffer
444 * @dir: access mode
445 *
446 * Prepares a framebuffer's GEM buffer objects for CPU access. This function
447 * must be called before accessing the BO data within the kernel. For imported
448 * BOs, the function calls dma_buf_begin_cpu_access().
449 *
450 * See drm_gem_fb_end_cpu_access() for signalling the end of CPU access.
451 *
452 * Returns:
453 * 0 on success, or a negative errno code otherwise.
454 */
455int drm_gem_fb_begin_cpu_access(struct drm_framebuffer *fb, enum dma_data_direction dir)
456{
457 struct dma_buf_attachment *import_attach;
458 struct drm_gem_object *obj;
459 unsigned int i;
460 int ret;
461
462 for (i = 0; i < fb->format->num_planes; ++i) {
463 obj = drm_gem_fb_get_obj(fb, i);
464 if (!obj) {
465 ret = -EINVAL;
466 goto err___drm_gem_fb_end_cpu_access;
467 }
468 import_attach = obj->import_attach;
469 if (!import_attach)
470 continue;
471 ret = dma_buf_begin_cpu_access(dma_buf: import_attach->dmabuf, dir);
472 if (ret)
473 goto err___drm_gem_fb_end_cpu_access;
474 }
475
476 return 0;
477
478err___drm_gem_fb_end_cpu_access:
479 __drm_gem_fb_end_cpu_access(fb, dir, num_planes: i);
480 return ret;
481}
482EXPORT_SYMBOL(drm_gem_fb_begin_cpu_access);
483
484/**
485 * drm_gem_fb_end_cpu_access - signals end of CPU access to GEM buffer objects
486 * @fb: the framebuffer
487 * @dir: access mode
488 *
489 * Signals the end of CPU access to the given framebuffer's GEM buffer objects. This
490 * function must be paired with a corresponding call to drm_gem_fb_begin_cpu_access().
491 * For imported BOs, the function calls dma_buf_end_cpu_access().
492 *
493 * See also drm_gem_fb_begin_cpu_access().
494 */
495void drm_gem_fb_end_cpu_access(struct drm_framebuffer *fb, enum dma_data_direction dir)
496{
497 __drm_gem_fb_end_cpu_access(fb, dir, num_planes: fb->format->num_planes);
498}
499EXPORT_SYMBOL(drm_gem_fb_end_cpu_access);
500
501// TODO Drop this function and replace by drm_format_info_bpp() once all
502// DRM_FORMAT_* provide proper block info in drivers/gpu/drm/drm_fourcc.c
503static __u32 drm_gem_afbc_get_bpp(struct drm_device *dev,
504 const struct drm_mode_fb_cmd2 *mode_cmd)
505{
506 const struct drm_format_info *info;
507
508 info = drm_get_format_info(dev, mode_cmd);
509
510 switch (info->format) {
511 case DRM_FORMAT_YUV420_8BIT:
512 return 12;
513 case DRM_FORMAT_YUV420_10BIT:
514 return 15;
515 case DRM_FORMAT_VUY101010:
516 return 30;
517 default:
518 return drm_format_info_bpp(info, plane: 0);
519 }
520}
521
522static int drm_gem_afbc_min_size(struct drm_device *dev,
523 const struct drm_mode_fb_cmd2 *mode_cmd,
524 struct drm_afbc_framebuffer *afbc_fb)
525{
526 __u32 n_blocks, w_alignment, h_alignment, hdr_alignment;
527 /* remove bpp when all users properly encode cpp in drm_format_info */
528 __u32 bpp;
529
530 switch (mode_cmd->modifier[0] & AFBC_FORMAT_MOD_BLOCK_SIZE_MASK) {
531 case AFBC_FORMAT_MOD_BLOCK_SIZE_16x16:
532 afbc_fb->block_width = 16;
533 afbc_fb->block_height = 16;
534 break;
535 case AFBC_FORMAT_MOD_BLOCK_SIZE_32x8:
536 afbc_fb->block_width = 32;
537 afbc_fb->block_height = 8;
538 break;
539 /* no user exists yet - fall through */
540 case AFBC_FORMAT_MOD_BLOCK_SIZE_64x4:
541 case AFBC_FORMAT_MOD_BLOCK_SIZE_32x8_64x4:
542 default:
543 drm_dbg_kms(dev, "Invalid AFBC_FORMAT_MOD_BLOCK_SIZE: %lld.\n",
544 mode_cmd->modifier[0]
545 & AFBC_FORMAT_MOD_BLOCK_SIZE_MASK);
546 return -EINVAL;
547 }
548
549 /* tiled header afbc */
550 w_alignment = afbc_fb->block_width;
551 h_alignment = afbc_fb->block_height;
552 hdr_alignment = AFBC_HDR_ALIGN;
553 if (mode_cmd->modifier[0] & AFBC_FORMAT_MOD_TILED) {
554 w_alignment *= AFBC_TH_LAYOUT_ALIGNMENT;
555 h_alignment *= AFBC_TH_LAYOUT_ALIGNMENT;
556 hdr_alignment = AFBC_TH_BODY_START_ALIGNMENT;
557 }
558
559 afbc_fb->aligned_width = ALIGN(mode_cmd->width, w_alignment);
560 afbc_fb->aligned_height = ALIGN(mode_cmd->height, h_alignment);
561 afbc_fb->offset = mode_cmd->offsets[0];
562
563 bpp = drm_gem_afbc_get_bpp(dev, mode_cmd);
564 if (!bpp) {
565 drm_dbg_kms(dev, "Invalid AFBC bpp value: %d\n", bpp);
566 return -EINVAL;
567 }
568
569 n_blocks = (afbc_fb->aligned_width * afbc_fb->aligned_height)
570 / AFBC_SUPERBLOCK_PIXELS;
571 afbc_fb->afbc_size = ALIGN(n_blocks * AFBC_HEADER_SIZE, hdr_alignment);
572 afbc_fb->afbc_size += n_blocks * ALIGN(bpp * AFBC_SUPERBLOCK_PIXELS / 8,
573 AFBC_SUPERBLOCK_ALIGNMENT);
574
575 return 0;
576}
577
578/**
579 * drm_gem_fb_afbc_init() - Helper function for drivers using afbc to
580 * fill and validate all the afbc-specific
581 * struct drm_afbc_framebuffer members
582 *
583 * @dev: DRM device
584 * @afbc_fb: afbc-specific framebuffer
585 * @mode_cmd: Metadata from the userspace framebuffer creation request
586 * @afbc_fb: afbc framebuffer
587 *
588 * This function can be used by drivers which support afbc to complete
589 * the preparation of struct drm_afbc_framebuffer. It must be called after
590 * allocating the said struct and calling drm_gem_fb_init_with_funcs().
591 * It is caller's responsibility to put afbc_fb->base.obj objects in case
592 * the call is unsuccessful.
593 *
594 * Returns:
595 * Zero on success or a negative error value on failure.
596 */
597int drm_gem_fb_afbc_init(struct drm_device *dev,
598 const struct drm_mode_fb_cmd2 *mode_cmd,
599 struct drm_afbc_framebuffer *afbc_fb)
600{
601 const struct drm_format_info *info;
602 struct drm_gem_object **objs;
603 int ret;
604
605 objs = afbc_fb->base.obj;
606 info = drm_get_format_info(dev, mode_cmd);
607 if (!info)
608 return -EINVAL;
609
610 ret = drm_gem_afbc_min_size(dev, mode_cmd, afbc_fb);
611 if (ret < 0)
612 return ret;
613
614 if (objs[0]->size < afbc_fb->afbc_size)
615 return -EINVAL;
616
617 return 0;
618}
619EXPORT_SYMBOL_GPL(drm_gem_fb_afbc_init);
620

source code of linux/drivers/gpu/drm/drm_gem_framebuffer_helper.c