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 | |
15 | static const struct drm_framebuffer_funcs armada_fb_funcs = { |
16 | .destroy = drm_gem_fb_destroy, |
17 | .create_handle = drm_gem_fb_create_handle, |
18 | }; |
19 | |
20 | struct 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 | |
86 | struct 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 | |