root/drivers/gpu/drm/rockchip/rockchip_drm_fbdev.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. rockchip_fbdev_mmap
  2. rockchip_drm_fbdev_create
  3. rockchip_drm_fbdev_init
  4. rockchip_drm_fbdev_fini

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
   4  * Author:Mark Yao <mark.yao@rock-chips.com>
   5  */
   6 
   7 #include <drm/drm.h>
   8 #include <drm/drm_fb_helper.h>
   9 #include <drm/drm_fourcc.h>
  10 #include <drm/drm_probe_helper.h>
  11 
  12 #include "rockchip_drm_drv.h"
  13 #include "rockchip_drm_gem.h"
  14 #include "rockchip_drm_fb.h"
  15 #include "rockchip_drm_fbdev.h"
  16 
  17 #define PREFERRED_BPP           32
  18 #define to_drm_private(x) \
  19                 container_of(x, struct rockchip_drm_private, fbdev_helper)
  20 
  21 static int rockchip_fbdev_mmap(struct fb_info *info,
  22                                struct vm_area_struct *vma)
  23 {
  24         struct drm_fb_helper *helper = info->par;
  25         struct rockchip_drm_private *private = to_drm_private(helper);
  26 
  27         return rockchip_gem_mmap_buf(private->fbdev_bo, vma);
  28 }
  29 
  30 static struct fb_ops rockchip_drm_fbdev_ops = {
  31         .owner          = THIS_MODULE,
  32         DRM_FB_HELPER_DEFAULT_OPS,
  33         .fb_mmap        = rockchip_fbdev_mmap,
  34         .fb_fillrect    = drm_fb_helper_cfb_fillrect,
  35         .fb_copyarea    = drm_fb_helper_cfb_copyarea,
  36         .fb_imageblit   = drm_fb_helper_cfb_imageblit,
  37 };
  38 
  39 static int rockchip_drm_fbdev_create(struct drm_fb_helper *helper,
  40                                      struct drm_fb_helper_surface_size *sizes)
  41 {
  42         struct rockchip_drm_private *private = to_drm_private(helper);
  43         struct drm_mode_fb_cmd2 mode_cmd = { 0 };
  44         struct drm_device *dev = helper->dev;
  45         struct rockchip_gem_object *rk_obj;
  46         struct drm_framebuffer *fb;
  47         unsigned int bytes_per_pixel;
  48         unsigned long offset;
  49         struct fb_info *fbi;
  50         size_t size;
  51         int ret;
  52 
  53         bytes_per_pixel = DIV_ROUND_UP(sizes->surface_bpp, 8);
  54 
  55         mode_cmd.width = sizes->surface_width;
  56         mode_cmd.height = sizes->surface_height;
  57         mode_cmd.pitches[0] = sizes->surface_width * bytes_per_pixel;
  58         mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
  59                 sizes->surface_depth);
  60 
  61         size = mode_cmd.pitches[0] * mode_cmd.height;
  62 
  63         rk_obj = rockchip_gem_create_object(dev, size, true);
  64         if (IS_ERR(rk_obj))
  65                 return -ENOMEM;
  66 
  67         private->fbdev_bo = &rk_obj->base;
  68 
  69         fbi = drm_fb_helper_alloc_fbi(helper);
  70         if (IS_ERR(fbi)) {
  71                 DRM_DEV_ERROR(dev->dev, "Failed to create framebuffer info.\n");
  72                 ret = PTR_ERR(fbi);
  73                 goto out;
  74         }
  75 
  76         helper->fb = rockchip_drm_framebuffer_init(dev, &mode_cmd,
  77                                                    private->fbdev_bo);
  78         if (IS_ERR(helper->fb)) {
  79                 DRM_DEV_ERROR(dev->dev,
  80                               "Failed to allocate DRM framebuffer.\n");
  81                 ret = PTR_ERR(helper->fb);
  82                 goto out;
  83         }
  84 
  85         fbi->fbops = &rockchip_drm_fbdev_ops;
  86 
  87         fb = helper->fb;
  88         drm_fb_helper_fill_info(fbi, helper, sizes);
  89 
  90         offset = fbi->var.xoffset * bytes_per_pixel;
  91         offset += fbi->var.yoffset * fb->pitches[0];
  92 
  93         dev->mode_config.fb_base = 0;
  94         fbi->screen_base = rk_obj->kvaddr + offset;
  95         fbi->screen_size = rk_obj->base.size;
  96         fbi->fix.smem_len = rk_obj->base.size;
  97 
  98         DRM_DEBUG_KMS("FB [%dx%d]-%d kvaddr=%p offset=%ld size=%zu\n",
  99                       fb->width, fb->height, fb->format->depth,
 100                       rk_obj->kvaddr,
 101                       offset, size);
 102 
 103         return 0;
 104 
 105 out:
 106         rockchip_gem_free_object(&rk_obj->base);
 107         return ret;
 108 }
 109 
 110 static const struct drm_fb_helper_funcs rockchip_drm_fb_helper_funcs = {
 111         .fb_probe = rockchip_drm_fbdev_create,
 112 };
 113 
 114 int rockchip_drm_fbdev_init(struct drm_device *dev)
 115 {
 116         struct rockchip_drm_private *private = dev->dev_private;
 117         struct drm_fb_helper *helper;
 118         int ret;
 119 
 120         if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector)
 121                 return -EINVAL;
 122 
 123         helper = &private->fbdev_helper;
 124 
 125         drm_fb_helper_prepare(dev, helper, &rockchip_drm_fb_helper_funcs);
 126 
 127         ret = drm_fb_helper_init(dev, helper, ROCKCHIP_MAX_CONNECTOR);
 128         if (ret < 0) {
 129                 DRM_DEV_ERROR(dev->dev,
 130                               "Failed to initialize drm fb helper - %d.\n",
 131                               ret);
 132                 return ret;
 133         }
 134 
 135         ret = drm_fb_helper_single_add_all_connectors(helper);
 136         if (ret < 0) {
 137                 DRM_DEV_ERROR(dev->dev,
 138                               "Failed to add connectors - %d.\n", ret);
 139                 goto err_drm_fb_helper_fini;
 140         }
 141 
 142         ret = drm_fb_helper_initial_config(helper, PREFERRED_BPP);
 143         if (ret < 0) {
 144                 DRM_DEV_ERROR(dev->dev,
 145                               "Failed to set initial hw config - %d.\n",
 146                               ret);
 147                 goto err_drm_fb_helper_fini;
 148         }
 149 
 150         return 0;
 151 
 152 err_drm_fb_helper_fini:
 153         drm_fb_helper_fini(helper);
 154         return ret;
 155 }
 156 
 157 void rockchip_drm_fbdev_fini(struct drm_device *dev)
 158 {
 159         struct rockchip_drm_private *private = dev->dev_private;
 160         struct drm_fb_helper *helper;
 161 
 162         helper = &private->fbdev_helper;
 163 
 164         drm_fb_helper_unregister_fbi(helper);
 165 
 166         if (helper->fb)
 167                 drm_framebuffer_put(helper->fb);
 168 
 169         drm_fb_helper_fini(helper);
 170 }

/* [<][>][^][v][top][bottom][index][help] */