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
rockchip_fbdev_mmap(struct fb_info * info,struct vm_area_struct * vma)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 const 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
rockchip_drm_fbdev_create(struct drm_fb_helper * helper,struct drm_fb_helper_surface_size * sizes)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
rockchip_drm_fbdev_init(struct drm_device * dev)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);
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_initial_config(helper, PREFERRED_BPP);
136 if (ret < 0) {
137 DRM_DEV_ERROR(dev->dev,
138 "Failed to set initial hw config - %d.\n",
139 ret);
140 goto err_drm_fb_helper_fini;
141 }
142
143 return 0;
144
145 err_drm_fb_helper_fini:
146 drm_fb_helper_fini(helper);
147 return ret;
148 }
149
rockchip_drm_fbdev_fini(struct drm_device * dev)150 void rockchip_drm_fbdev_fini(struct drm_device *dev)
151 {
152 struct rockchip_drm_private *private = dev->dev_private;
153 struct drm_fb_helper *helper;
154
155 helper = &private->fbdev_helper;
156
157 drm_fb_helper_unregister_fbi(helper);
158
159 if (helper->fb)
160 drm_framebuffer_put(helper->fb);
161
162 drm_fb_helper_fini(helper);
163 }
164