141 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Copyright (C) 2012 Russell King4 */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 break33 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 FMT53 default:54 return ERR_PTR(-EINVAL);55 }56 57 dfb = kzalloc(sizeof(*dfb), GFP_KERNEL);58 if (!dfb) {59 DRM_ERROR("failed to allocate Armada fb object\n");60 return ERR_PTR(-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, &dfb->fb, mode);68 69 ret = drm_framebuffer_init(dev, &dfb->fb, &armada_fb_funcs);70 if (ret) {71 kfree(dfb);72 return ERR_PTR(ret);73 }74 75 /*76 * Take a reference on our object as we're successful - the77 * caller already holds a reference, which keeps us safe for78 * the above call, but the caller will drop their reference79 * to it. Hence we need to take our own reference.80 */81 drm_gem_object_get(&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);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, 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(dfb)) {127 ret = PTR_ERR(dfb);128 goto err;129 }130 131 drm_gem_object_put(&obj->obj);132 133 return &dfb->fb;134 135 err_unref:136 drm_gem_object_put(&obj->obj);137 err:138 DRM_ERROR("failed to initialize framebuffer: %d\n", ret);139 return ERR_PTR(ret);140}141