1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (C) 2012 Russell King
4 */
5
6#include <drm/drm_modeset_helper.h>
7#include <drm/drm_fourcc.h>
8#include <drm/drm_gem_framebuffer_helper.h>
9
10#include "armada_drm.h"
11#include "armada_fb.h"
12#include "armada_gem.h"
13#include "armada_hw.h"
14
15static const struct drm_framebuffer_funcs armada_fb_funcs = {
16 .destroy = drm_gem_fb_destroy,
17 .create_handle = drm_gem_fb_create_handle,
18};
19
20struct armada_framebuffer *armada_framebuffer_create(struct drm_device *dev,
21 const struct drm_mode_fb_cmd2 *mode, struct armada_gem_object *obj)
22{
23 struct armada_framebuffer *dfb;
24 uint8_t format, config;
25 int ret;
26
27 switch (mode->pixel_format) {
28#define FMT(drm, fmt, mod) \
29 case DRM_FORMAT_##drm: \
30 format = CFG_##fmt; \
31 config = mod; \
32 break
33 FMT(RGB565, 565, CFG_SWAPRB);
34 FMT(BGR565, 565, 0);
35 FMT(ARGB1555, 1555, CFG_SWAPRB);
36 FMT(ABGR1555, 1555, 0);
37 FMT(RGB888, 888PACK, CFG_SWAPRB);
38 FMT(BGR888, 888PACK, 0);
39 FMT(XRGB8888, X888, CFG_SWAPRB);
40 FMT(XBGR8888, X888, 0);
41 FMT(ARGB8888, 8888, CFG_SWAPRB);
42 FMT(ABGR8888, 8888, 0);
43 FMT(YUYV, 422PACK, CFG_YUV2RGB | CFG_SWAPYU | CFG_SWAPUV);
44 FMT(UYVY, 422PACK, CFG_YUV2RGB);
45 FMT(VYUY, 422PACK, CFG_YUV2RGB | CFG_SWAPUV);
46 FMT(YVYU, 422PACK, CFG_YUV2RGB | CFG_SWAPYU);
47 FMT(YUV422, 422, CFG_YUV2RGB);
48 FMT(YVU422, 422, CFG_YUV2RGB | CFG_SWAPUV);
49 FMT(YUV420, 420, CFG_YUV2RGB);
50 FMT(YVU420, 420, CFG_YUV2RGB | CFG_SWAPUV);
51 FMT(C8, PSEUDO8, 0);
52#undef FMT
53 default:
54 return ERR_PTR(error: -EINVAL);
55 }
56
57 dfb = kzalloc(size: sizeof(*dfb), GFP_KERNEL);
58 if (!dfb) {
59 DRM_ERROR("failed to allocate Armada fb object\n");
60 return ERR_PTR(error: -ENOMEM);
61 }
62
63 dfb->fmt = format;
64 dfb->mod = config;
65 dfb->fb.obj[0] = &obj->obj;
66
67 drm_helper_mode_fill_fb_struct(dev, fb: &dfb->fb, mode_cmd: mode);
68
69 ret = drm_framebuffer_init(dev, fb: &dfb->fb, funcs: &armada_fb_funcs);
70 if (ret) {
71 kfree(objp: dfb);
72 return ERR_PTR(error: ret);
73 }
74
75 /*
76 * Take a reference on our object as we're successful - the
77 * caller already holds a reference, which keeps us safe for
78 * the above call, but the caller will drop their reference
79 * to it. Hence we need to take our own reference.
80 */
81 drm_gem_object_get(obj: &obj->obj);
82
83 return dfb;
84}
85
86struct drm_framebuffer *armada_fb_create(struct drm_device *dev,
87 struct drm_file *dfile, const struct drm_mode_fb_cmd2 *mode)
88{
89 const struct drm_format_info *info = drm_get_format_info(dev, mode_cmd: mode);
90 struct armada_gem_object *obj;
91 struct armada_framebuffer *dfb;
92 int ret;
93
94 DRM_DEBUG_DRIVER("w%u h%u pf%08x f%u p%u,%u,%u\n",
95 mode->width, mode->height, mode->pixel_format,
96 mode->flags, mode->pitches[0], mode->pitches[1],
97 mode->pitches[2]);
98
99 /* We can only handle a single plane at the moment */
100 if (info->num_planes > 1 &&
101 (mode->handles[0] != mode->handles[1] ||
102 mode->handles[0] != mode->handles[2])) {
103 ret = -EINVAL;
104 goto err;
105 }
106
107 obj = armada_gem_object_lookup(dfile, handle: mode->handles[0]);
108 if (!obj) {
109 ret = -ENOENT;
110 goto err;
111 }
112
113 if (obj->obj.import_attach && !obj->sgt) {
114 ret = armada_gem_map_import(obj);
115 if (ret)
116 goto err_unref;
117 }
118
119 /* Framebuffer objects must have a valid device address for scanout */
120 if (!obj->mapped) {
121 ret = -EINVAL;
122 goto err_unref;
123 }
124
125 dfb = armada_framebuffer_create(dev, mode, obj);
126 if (IS_ERR(ptr: dfb)) {
127 ret = PTR_ERR(ptr: dfb);
128 goto err;
129 }
130
131 drm_gem_object_put(obj: &obj->obj);
132
133 return &dfb->fb;
134
135 err_unref:
136 drm_gem_object_put(obj: &obj->obj);
137 err:
138 DRM_ERROR("failed to initialize framebuffer: %d\n", ret);
139 return ERR_PTR(error: ret);
140}
141

source code of linux/drivers/gpu/drm/armada/armada_fb.c