1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* exynos_drm_fbdev.c 3 * 4 * Copyright (c) 2011 Samsung Electronics Co., Ltd. 5 * Authors: 6 * Inki Dae <inki.dae@samsung.com> 7 * Joonyoung Shim <jy0922.shim@samsung.com> 8 * Seung-Woo Kim <sw0312.kim@samsung.com> 9 */ 10 11 #include <linux/console.h> 12 #include <linux/dma-mapping.h> 13 #include <linux/vmalloc.h> 14 15 #include <drm/drm_crtc.h> 16 #include <drm/drm_fb_helper.h> 17 #include <drm/drm_fourcc.h> 18 #include <drm/drm_framebuffer.h> 19 #include <drm/drm_prime.h> 20 #include <drm/drm_probe_helper.h> 21 #include <drm/exynos_drm.h> 22 23 #include "exynos_drm_drv.h" 24 #include "exynos_drm_fb.h" 25 #include "exynos_drm_fbdev.h" 26 27 #define MAX_CONNECTOR 4 28 #define PREFERRED_BPP 32 29 30 #define to_exynos_fbdev(x) container_of(x, struct exynos_drm_fbdev,\ 31 drm_fb_helper) 32 33 struct exynos_drm_fbdev { 34 struct drm_fb_helper drm_fb_helper; 35 struct exynos_drm_gem *exynos_gem; 36 }; 37 38 static int exynos_drm_fb_mmap(struct fb_info *info, 39 struct vm_area_struct *vma) 40 { 41 struct drm_fb_helper *helper = info->par; 42 struct exynos_drm_fbdev *exynos_fbd = to_exynos_fbdev(helper); 43 struct exynos_drm_gem *exynos_gem = exynos_fbd->exynos_gem; 44 45 return drm_gem_prime_mmap(&exynos_gem->base, vma); 46 } 47 48 static const struct fb_ops exynos_drm_fb_ops = { 49 .owner = THIS_MODULE, 50 DRM_FB_HELPER_DEFAULT_OPS, 51 .fb_mmap = exynos_drm_fb_mmap, 52 .fb_read = drm_fb_helper_cfb_read, 53 .fb_write = drm_fb_helper_cfb_write, 54 .fb_fillrect = drm_fb_helper_cfb_fillrect, 55 .fb_copyarea = drm_fb_helper_cfb_copyarea, 56 .fb_imageblit = drm_fb_helper_cfb_imageblit, 57 }; 58 59 static int exynos_drm_fbdev_update(struct drm_fb_helper *helper, 60 struct drm_fb_helper_surface_size *sizes, 61 struct exynos_drm_gem *exynos_gem) 62 { 63 struct fb_info *fbi; 64 struct drm_framebuffer *fb = helper->fb; 65 unsigned int size = fb->width * fb->height * fb->format->cpp[0]; 66 unsigned long offset; 67 68 fbi = drm_fb_helper_alloc_info(helper); 69 if (IS_ERR(fbi)) { 70 DRM_DEV_ERROR(to_dma_dev(helper->dev), 71 "failed to allocate fb info.\n"); 72 return PTR_ERR(fbi); 73 } 74 75 fbi->fbops = &exynos_drm_fb_ops; 76 77 drm_fb_helper_fill_info(fbi, helper, sizes); 78 79 offset = fbi->var.xoffset * fb->format->cpp[0]; 80 offset += fbi->var.yoffset * fb->pitches[0]; 81 82 fbi->screen_buffer = exynos_gem->kvaddr + offset; 83 fbi->screen_size = size; 84 fbi->fix.smem_len = size; 85 86 return 0; 87 } 88 89 static int exynos_drm_fbdev_create(struct drm_fb_helper *helper, 90 struct drm_fb_helper_surface_size *sizes) 91 { 92 struct exynos_drm_fbdev *exynos_fbdev = to_exynos_fbdev(helper); 93 struct exynos_drm_gem *exynos_gem; 94 struct drm_device *dev = helper->dev; 95 struct drm_mode_fb_cmd2 mode_cmd = { 0 }; 96 unsigned long size; 97 int ret; 98 99 DRM_DEV_DEBUG_KMS(dev->dev, 100 "surface width(%d), height(%d) and bpp(%d\n", 101 sizes->surface_width, sizes->surface_height, 102 sizes->surface_bpp); 103 104 mode_cmd.width = sizes->surface_width; 105 mode_cmd.height = sizes->surface_height; 106 mode_cmd.pitches[0] = sizes->surface_width * (sizes->surface_bpp >> 3); 107 mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, 108 sizes->surface_depth); 109 110 size = mode_cmd.pitches[0] * mode_cmd.height; 111 112 exynos_gem = exynos_drm_gem_create(dev, EXYNOS_BO_WC, size, true); 113 if (IS_ERR(exynos_gem)) 114 return PTR_ERR(exynos_gem); 115 116 exynos_fbdev->exynos_gem = exynos_gem; 117 118 helper->fb = 119 exynos_drm_framebuffer_init(dev, &mode_cmd, &exynos_gem, 1); 120 if (IS_ERR(helper->fb)) { 121 DRM_DEV_ERROR(dev->dev, "failed to create drm framebuffer.\n"); 122 ret = PTR_ERR(helper->fb); 123 goto err_destroy_gem; 124 } 125 126 ret = exynos_drm_fbdev_update(helper, sizes, exynos_gem); 127 if (ret < 0) 128 goto err_destroy_framebuffer; 129 130 return ret; 131 132 err_destroy_framebuffer: 133 drm_framebuffer_cleanup(helper->fb); 134 err_destroy_gem: 135 exynos_drm_gem_destroy(exynos_gem); 136 137 /* 138 * if failed, all resources allocated above would be released by 139 * drm_mode_config_cleanup() when drm_load() had been called prior 140 * to any specific driver such as fimd or hdmi driver. 141 */ 142 143 return ret; 144 } 145 146 static const struct drm_fb_helper_funcs exynos_drm_fb_helper_funcs = { 147 .fb_probe = exynos_drm_fbdev_create, 148 }; 149 150 int exynos_drm_fbdev_init(struct drm_device *dev) 151 { 152 struct exynos_drm_fbdev *fbdev; 153 struct exynos_drm_private *private = dev->dev_private; 154 struct drm_fb_helper *helper; 155 int ret; 156 157 if (!dev->mode_config.num_crtc) 158 return 0; 159 160 fbdev = kzalloc(sizeof(*fbdev), GFP_KERNEL); 161 if (!fbdev) 162 return -ENOMEM; 163 164 private->fb_helper = helper = &fbdev->drm_fb_helper; 165 166 drm_fb_helper_prepare(dev, helper, &exynos_drm_fb_helper_funcs); 167 168 ret = drm_fb_helper_init(dev, helper); 169 if (ret < 0) { 170 DRM_DEV_ERROR(dev->dev, 171 "failed to initialize drm fb helper.\n"); 172 goto err_init; 173 } 174 175 ret = drm_fb_helper_initial_config(helper, PREFERRED_BPP); 176 if (ret < 0) { 177 DRM_DEV_ERROR(dev->dev, 178 "failed to set up hw configuration.\n"); 179 goto err_setup; 180 } 181 182 return 0; 183 184 err_setup: 185 drm_fb_helper_fini(helper); 186 187 err_init: 188 private->fb_helper = NULL; 189 kfree(fbdev); 190 191 return ret; 192 } 193 194 static void exynos_drm_fbdev_destroy(struct drm_device *dev, 195 struct drm_fb_helper *fb_helper) 196 { 197 struct drm_framebuffer *fb; 198 199 /* release drm framebuffer and real buffer */ 200 if (fb_helper->fb && fb_helper->fb->funcs) { 201 fb = fb_helper->fb; 202 if (fb) 203 drm_framebuffer_remove(fb); 204 } 205 206 drm_fb_helper_unregister_info(fb_helper); 207 208 drm_fb_helper_fini(fb_helper); 209 } 210 211 void exynos_drm_fbdev_fini(struct drm_device *dev) 212 { 213 struct exynos_drm_private *private = dev->dev_private; 214 struct exynos_drm_fbdev *fbdev; 215 216 if (!private || !private->fb_helper) 217 return; 218 219 fbdev = to_exynos_fbdev(private->fb_helper); 220 221 exynos_drm_fbdev_destroy(dev, private->fb_helper); 222 kfree(fbdev); 223 private->fb_helper = NULL; 224 } 225 226