142 lines
3.4 KiB
C
142 lines
3.4 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Copyright (C) 2012 Russell King
|
|
*/
|
|
|
|
#include <drm/drm_modeset_helper.h>
|
|
#include <drm/drm_fb_helper.h>
|
|
#include <drm/drm_fourcc.h>
|
|
#include <drm/drm_gem_framebuffer_helper.h>
|
|
|
|
#include "armada_drm.h"
|
|
#include "armada_fb.h"
|
|
#include "armada_gem.h"
|
|
#include "armada_hw.h"
|
|
|
|
static const struct drm_framebuffer_funcs armada_fb_funcs = {
|
|
.destroy = drm_gem_fb_destroy,
|
|
.create_handle = drm_gem_fb_create_handle,
|
|
};
|
|
|
|
struct armada_framebuffer *armada_framebuffer_create(struct drm_device *dev,
|
|
const struct drm_mode_fb_cmd2 *mode, struct armada_gem_object *obj)
|
|
{
|
|
struct armada_framebuffer *dfb;
|
|
uint8_t format, config;
|
|
int ret;
|
|
|
|
switch (mode->pixel_format) {
|
|
#define FMT(drm, fmt, mod) \
|
|
case DRM_FORMAT_##drm: \
|
|
format = CFG_##fmt; \
|
|
config = mod; \
|
|
break
|
|
FMT(RGB565, 565, CFG_SWAPRB);
|
|
FMT(BGR565, 565, 0);
|
|
FMT(ARGB1555, 1555, CFG_SWAPRB);
|
|
FMT(ABGR1555, 1555, 0);
|
|
FMT(RGB888, 888PACK, CFG_SWAPRB);
|
|
FMT(BGR888, 888PACK, 0);
|
|
FMT(XRGB8888, X888, CFG_SWAPRB);
|
|
FMT(XBGR8888, X888, 0);
|
|
FMT(ARGB8888, 8888, CFG_SWAPRB);
|
|
FMT(ABGR8888, 8888, 0);
|
|
FMT(YUYV, 422PACK, CFG_YUV2RGB | CFG_SWAPYU | CFG_SWAPUV);
|
|
FMT(UYVY, 422PACK, CFG_YUV2RGB);
|
|
FMT(VYUY, 422PACK, CFG_YUV2RGB | CFG_SWAPUV);
|
|
FMT(YVYU, 422PACK, CFG_YUV2RGB | CFG_SWAPYU);
|
|
FMT(YUV422, 422, CFG_YUV2RGB);
|
|
FMT(YVU422, 422, CFG_YUV2RGB | CFG_SWAPUV);
|
|
FMT(YUV420, 420, CFG_YUV2RGB);
|
|
FMT(YVU420, 420, CFG_YUV2RGB | CFG_SWAPUV);
|
|
FMT(C8, PSEUDO8, 0);
|
|
#undef FMT
|
|
default:
|
|
return ERR_PTR(-EINVAL);
|
|
}
|
|
|
|
dfb = kzalloc(sizeof(*dfb), GFP_KERNEL);
|
|
if (!dfb) {
|
|
DRM_ERROR("failed to allocate Armada fb object\n");
|
|
return ERR_PTR(-ENOMEM);
|
|
}
|
|
|
|
dfb->fmt = format;
|
|
dfb->mod = config;
|
|
dfb->fb.obj[0] = &obj->obj;
|
|
|
|
drm_helper_mode_fill_fb_struct(dev, &dfb->fb, mode);
|
|
|
|
ret = drm_framebuffer_init(dev, &dfb->fb, &armada_fb_funcs);
|
|
if (ret) {
|
|
kfree(dfb);
|
|
return ERR_PTR(ret);
|
|
}
|
|
|
|
/*
|
|
* Take a reference on our object as we're successful - the
|
|
* caller already holds a reference, which keeps us safe for
|
|
* the above call, but the caller will drop their reference
|
|
* to it. Hence we need to take our own reference.
|
|
*/
|
|
drm_gem_object_get(&obj->obj);
|
|
|
|
return dfb;
|
|
}
|
|
|
|
struct drm_framebuffer *armada_fb_create(struct drm_device *dev,
|
|
struct drm_file *dfile, const struct drm_mode_fb_cmd2 *mode)
|
|
{
|
|
const struct drm_format_info *info = drm_get_format_info(dev, mode);
|
|
struct armada_gem_object *obj;
|
|
struct armada_framebuffer *dfb;
|
|
int ret;
|
|
|
|
DRM_DEBUG_DRIVER("w%u h%u pf%08x f%u p%u,%u,%u\n",
|
|
mode->width, mode->height, mode->pixel_format,
|
|
mode->flags, mode->pitches[0], mode->pitches[1],
|
|
mode->pitches[2]);
|
|
|
|
/* We can only handle a single plane at the moment */
|
|
if (info->num_planes > 1 &&
|
|
(mode->handles[0] != mode->handles[1] ||
|
|
mode->handles[0] != mode->handles[2])) {
|
|
ret = -EINVAL;
|
|
goto err;
|
|
}
|
|
|
|
obj = armada_gem_object_lookup(dfile, mode->handles[0]);
|
|
if (!obj) {
|
|
ret = -ENOENT;
|
|
goto err;
|
|
}
|
|
|
|
if (obj->obj.import_attach && !obj->sgt) {
|
|
ret = armada_gem_map_import(obj);
|
|
if (ret)
|
|
goto err_unref;
|
|
}
|
|
|
|
/* Framebuffer objects must have a valid device address for scanout */
|
|
if (!obj->mapped) {
|
|
ret = -EINVAL;
|
|
goto err_unref;
|
|
}
|
|
|
|
dfb = armada_framebuffer_create(dev, mode, obj);
|
|
if (IS_ERR(dfb)) {
|
|
ret = PTR_ERR(dfb);
|
|
goto err;
|
|
}
|
|
|
|
drm_gem_object_put(&obj->obj);
|
|
|
|
return &dfb->fb;
|
|
|
|
err_unref:
|
|
drm_gem_object_put(&obj->obj);
|
|
err:
|
|
DRM_ERROR("failed to initialize framebuffer: %d\n", ret);
|
|
return ERR_PTR(ret);
|
|
}
|