1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
296f60e37SRussell King /*
396f60e37SRussell King * Copyright (C) 2012 Russell King
496f60e37SRussell King */
525e28ef2SSam Ravnborg
6fcd70cd3SDaniel Vetter #include <drm/drm_modeset_helper.h>
725e28ef2SSam Ravnborg #include <drm/drm_fourcc.h>
8ecb8a947SDaniel Stone #include <drm/drm_gem_framebuffer_helper.h>
925e28ef2SSam Ravnborg
1096f60e37SRussell King #include "armada_drm.h"
1196f60e37SRussell King #include "armada_fb.h"
1296f60e37SRussell King #include "armada_gem.h"
1396f60e37SRussell King #include "armada_hw.h"
1496f60e37SRussell King
1596f60e37SRussell King static const struct drm_framebuffer_funcs armada_fb_funcs = {
16ecb8a947SDaniel Stone .destroy = drm_gem_fb_destroy,
17ecb8a947SDaniel Stone .create_handle = drm_gem_fb_create_handle,
1896f60e37SRussell King };
1996f60e37SRussell King
armada_framebuffer_create(struct drm_device * dev,const struct drm_mode_fb_cmd2 * mode,struct armada_gem_object * obj)2096f60e37SRussell King struct armada_framebuffer *armada_framebuffer_create(struct drm_device *dev,
211eb83451SVille Syrjälä const struct drm_mode_fb_cmd2 *mode, struct armada_gem_object *obj)
2296f60e37SRussell King {
2396f60e37SRussell King struct armada_framebuffer *dfb;
2496f60e37SRussell King uint8_t format, config;
2596f60e37SRussell King int ret;
2696f60e37SRussell King
2796f60e37SRussell King switch (mode->pixel_format) {
2896f60e37SRussell King #define FMT(drm, fmt, mod) \
2996f60e37SRussell King case DRM_FORMAT_##drm: \
3096f60e37SRussell King format = CFG_##fmt; \
3196f60e37SRussell King config = mod; \
3296f60e37SRussell King break
3396f60e37SRussell King FMT(RGB565, 565, CFG_SWAPRB);
3496f60e37SRussell King FMT(BGR565, 565, 0);
3596f60e37SRussell King FMT(ARGB1555, 1555, CFG_SWAPRB);
3696f60e37SRussell King FMT(ABGR1555, 1555, 0);
3796f60e37SRussell King FMT(RGB888, 888PACK, CFG_SWAPRB);
3896f60e37SRussell King FMT(BGR888, 888PACK, 0);
3996f60e37SRussell King FMT(XRGB8888, X888, CFG_SWAPRB);
4096f60e37SRussell King FMT(XBGR8888, X888, 0);
4196f60e37SRussell King FMT(ARGB8888, 8888, CFG_SWAPRB);
4296f60e37SRussell King FMT(ABGR8888, 8888, 0);
4396f60e37SRussell King FMT(YUYV, 422PACK, CFG_YUV2RGB | CFG_SWAPYU | CFG_SWAPUV);
4496f60e37SRussell King FMT(UYVY, 422PACK, CFG_YUV2RGB);
4596f60e37SRussell King FMT(VYUY, 422PACK, CFG_YUV2RGB | CFG_SWAPUV);
4696f60e37SRussell King FMT(YVYU, 422PACK, CFG_YUV2RGB | CFG_SWAPYU);
4796f60e37SRussell King FMT(YUV422, 422, CFG_YUV2RGB);
4896f60e37SRussell King FMT(YVU422, 422, CFG_YUV2RGB | CFG_SWAPUV);
4996f60e37SRussell King FMT(YUV420, 420, CFG_YUV2RGB);
5096f60e37SRussell King FMT(YVU420, 420, CFG_YUV2RGB | CFG_SWAPUV);
5196f60e37SRussell King FMT(C8, PSEUDO8, 0);
5296f60e37SRussell King #undef FMT
5396f60e37SRussell King default:
5496f60e37SRussell King return ERR_PTR(-EINVAL);
5596f60e37SRussell King }
5696f60e37SRussell King
5796f60e37SRussell King dfb = kzalloc(sizeof(*dfb), GFP_KERNEL);
5896f60e37SRussell King if (!dfb) {
5996f60e37SRussell King DRM_ERROR("failed to allocate Armada fb object\n");
6096f60e37SRussell King return ERR_PTR(-ENOMEM);
6196f60e37SRussell King }
6296f60e37SRussell King
6396f60e37SRussell King dfb->fmt = format;
6496f60e37SRussell King dfb->mod = config;
65ecb8a947SDaniel Stone dfb->fb.obj[0] = &obj->obj;
6696f60e37SRussell King
67a3f913caSVille Syrjälä drm_helper_mode_fill_fb_struct(dev, &dfb->fb, mode);
6896f60e37SRussell King
6996f60e37SRussell King ret = drm_framebuffer_init(dev, &dfb->fb, &armada_fb_funcs);
7096f60e37SRussell King if (ret) {
7196f60e37SRussell King kfree(dfb);
7296f60e37SRussell King return ERR_PTR(ret);
7396f60e37SRussell King }
7496f60e37SRussell King
7596f60e37SRussell King /*
7696f60e37SRussell King * Take a reference on our object as we're successful - the
7796f60e37SRussell King * caller already holds a reference, which keeps us safe for
7896f60e37SRussell King * the above call, but the caller will drop their reference
7996f60e37SRussell King * to it. Hence we need to take our own reference.
8096f60e37SRussell King */
814c3cf375SHaneen Mohammed drm_gem_object_get(&obj->obj);
8296f60e37SRussell King
8396f60e37SRussell King return dfb;
8496f60e37SRussell King }
8596f60e37SRussell King
armada_fb_create(struct drm_device * dev,struct drm_file * dfile,const struct drm_mode_fb_cmd2 * mode)863382a6b9SRussell King struct drm_framebuffer *armada_fb_create(struct drm_device *dev,
871eb83451SVille Syrjälä struct drm_file *dfile, const struct drm_mode_fb_cmd2 *mode)
8896f60e37SRussell King {
8905c452c1SMaxime Ripard const struct drm_format_info *info = drm_get_format_info(dev, mode);
9096f60e37SRussell King struct armada_gem_object *obj;
9196f60e37SRussell King struct armada_framebuffer *dfb;
9296f60e37SRussell King int ret;
9396f60e37SRussell King
9496f60e37SRussell King DRM_DEBUG_DRIVER("w%u h%u pf%08x f%u p%u,%u,%u\n",
9596f60e37SRussell King mode->width, mode->height, mode->pixel_format,
9696f60e37SRussell King mode->flags, mode->pitches[0], mode->pitches[1],
9796f60e37SRussell King mode->pitches[2]);
9896f60e37SRussell King
9996f60e37SRussell King /* We can only handle a single plane at the moment */
10005c452c1SMaxime Ripard if (info->num_planes > 1 &&
10196f60e37SRussell King (mode->handles[0] != mode->handles[1] ||
10296f60e37SRussell King mode->handles[0] != mode->handles[2])) {
10396f60e37SRussell King ret = -EINVAL;
10496f60e37SRussell King goto err;
10596f60e37SRussell King }
10696f60e37SRussell King
107a8ad0bd8SChris Wilson obj = armada_gem_object_lookup(dfile, mode->handles[0]);
10896f60e37SRussell King if (!obj) {
10996f60e37SRussell King ret = -ENOENT;
11096f60e37SRussell King goto err;
11196f60e37SRussell King }
11296f60e37SRussell King
11396f60e37SRussell King if (obj->obj.import_attach && !obj->sgt) {
11496f60e37SRussell King ret = armada_gem_map_import(obj);
11596f60e37SRussell King if (ret)
11696f60e37SRussell King goto err_unref;
11796f60e37SRussell King }
11896f60e37SRussell King
11996f60e37SRussell King /* Framebuffer objects must have a valid device address for scanout */
120b4005857SChristoph Hellwig if (!obj->mapped) {
12196f60e37SRussell King ret = -EINVAL;
12296f60e37SRussell King goto err_unref;
12396f60e37SRussell King }
12496f60e37SRussell King
12596f60e37SRussell King dfb = armada_framebuffer_create(dev, mode, obj);
12696f60e37SRussell King if (IS_ERR(dfb)) {
12796f60e37SRussell King ret = PTR_ERR(dfb);
12896f60e37SRussell King goto err;
12996f60e37SRussell King }
13096f60e37SRussell King
131dda156cfSEmil Velikov drm_gem_object_put(&obj->obj);
13296f60e37SRussell King
13396f60e37SRussell King return &dfb->fb;
13496f60e37SRussell King
13596f60e37SRussell King err_unref:
136dda156cfSEmil Velikov drm_gem_object_put(&obj->obj);
13796f60e37SRussell King err:
13896f60e37SRussell King DRM_ERROR("failed to initialize framebuffer: %d\n", ret);
13996f60e37SRussell King return ERR_PTR(ret);
14096f60e37SRussell King }
141