1 /* 2 * Copyright (C) 2012 Russell King 3 * 4 * This program is free software; you can redistribute it and/or modify 5 * it under the terms of the GNU General Public License version 2 as 6 * published by the Free Software Foundation. 7 */ 8 #include <drm/drm_modeset_helper.h> 9 #include <drm/drm_fb_helper.h> 10 #include <drm/drm_gem_framebuffer_helper.h> 11 #include "armada_drm.h" 12 #include "armada_fb.h" 13 #include "armada_gem.h" 14 #include "armada_hw.h" 15 16 static const struct drm_framebuffer_funcs armada_fb_funcs = { 17 .destroy = drm_gem_fb_destroy, 18 .create_handle = drm_gem_fb_create_handle, 19 }; 20 21 struct armada_framebuffer *armada_framebuffer_create(struct drm_device *dev, 22 const struct drm_mode_fb_cmd2 *mode, struct armada_gem_object *obj) 23 { 24 struct armada_framebuffer *dfb; 25 uint8_t format, config; 26 int ret; 27 28 switch (mode->pixel_format) { 29 #define FMT(drm, fmt, mod) \ 30 case DRM_FORMAT_##drm: \ 31 format = CFG_##fmt; \ 32 config = mod; \ 33 break 34 FMT(RGB565, 565, CFG_SWAPRB); 35 FMT(BGR565, 565, 0); 36 FMT(ARGB1555, 1555, CFG_SWAPRB); 37 FMT(ABGR1555, 1555, 0); 38 FMT(RGB888, 888PACK, CFG_SWAPRB); 39 FMT(BGR888, 888PACK, 0); 40 FMT(XRGB8888, X888, CFG_SWAPRB); 41 FMT(XBGR8888, X888, 0); 42 FMT(ARGB8888, 8888, CFG_SWAPRB); 43 FMT(ABGR8888, 8888, 0); 44 FMT(YUYV, 422PACK, CFG_YUV2RGB | CFG_SWAPYU | CFG_SWAPUV); 45 FMT(UYVY, 422PACK, CFG_YUV2RGB); 46 FMT(VYUY, 422PACK, CFG_YUV2RGB | CFG_SWAPUV); 47 FMT(YVYU, 422PACK, CFG_YUV2RGB | CFG_SWAPYU); 48 FMT(YUV422, 422, CFG_YUV2RGB); 49 FMT(YVU422, 422, CFG_YUV2RGB | CFG_SWAPUV); 50 FMT(YUV420, 420, CFG_YUV2RGB); 51 FMT(YVU420, 420, CFG_YUV2RGB | CFG_SWAPUV); 52 FMT(C8, PSEUDO8, 0); 53 #undef FMT 54 default: 55 return ERR_PTR(-EINVAL); 56 } 57 58 dfb = kzalloc(sizeof(*dfb), GFP_KERNEL); 59 if (!dfb) { 60 DRM_ERROR("failed to allocate Armada fb object\n"); 61 return ERR_PTR(-ENOMEM); 62 } 63 64 dfb->fmt = format; 65 dfb->mod = config; 66 dfb->fb.obj[0] = &obj->obj; 67 68 drm_helper_mode_fill_fb_struct(dev, &dfb->fb, mode); 69 70 ret = drm_framebuffer_init(dev, &dfb->fb, &armada_fb_funcs); 71 if (ret) { 72 kfree(dfb); 73 return ERR_PTR(ret); 74 } 75 76 /* 77 * Take a reference on our object as we're successful - the 78 * caller already holds a reference, which keeps us safe for 79 * the above call, but the caller will drop their reference 80 * to it. Hence we need to take our own reference. 81 */ 82 drm_gem_object_get(&obj->obj); 83 84 return dfb; 85 } 86 87 struct drm_framebuffer *armada_fb_create(struct drm_device *dev, 88 struct drm_file *dfile, const struct drm_mode_fb_cmd2 *mode) 89 { 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 (drm_format_num_planes(mode->pixel_format) > 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_unlocked(&obj->obj); 132 133 return &dfb->fb; 134 135 err_unref: 136 drm_gem_object_put_unlocked(&obj->obj); 137 err: 138 DRM_ERROR("failed to initialize framebuffer: %d\n", ret); 139 return ERR_PTR(ret); 140 } 141