Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
tjh.dev
kernel
os
linux
1/*
2 * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
3 * Author:Mark Yao <mark.yao@rock-chips.com>
4 *
5 * This software is licensed under the terms of the GNU General Public
6 * License version 2, as published by the Free Software Foundation, and
7 * may be copied, distributed, and modified under those terms.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 */
14
15#include <drm/drm.h>
16#include <drm/drmP.h>
17#include <drm/drm_fb_helper.h>
18#include <drm/drm_crtc_helper.h>
19
20#include "rockchip_drm_drv.h"
21#include "rockchip_drm_gem.h"
22#include "rockchip_drm_fb.h"
23#include "rockchip_drm_fbdev.h"
24
25#define PREFERRED_BPP 32
26#define to_drm_private(x) \
27 container_of(x, struct rockchip_drm_private, fbdev_helper)
28
29static int rockchip_fbdev_mmap(struct fb_info *info,
30 struct vm_area_struct *vma)
31{
32 struct drm_fb_helper *helper = info->par;
33 struct rockchip_drm_private *private = to_drm_private(helper);
34
35 return rockchip_gem_mmap_buf(private->fbdev_bo, vma);
36}
37
38static struct fb_ops rockchip_drm_fbdev_ops = {
39 .owner = THIS_MODULE,
40 DRM_FB_HELPER_DEFAULT_OPS,
41 .fb_mmap = rockchip_fbdev_mmap,
42 .fb_fillrect = drm_fb_helper_cfb_fillrect,
43 .fb_copyarea = drm_fb_helper_cfb_copyarea,
44 .fb_imageblit = drm_fb_helper_cfb_imageblit,
45};
46
47static int rockchip_drm_fbdev_create(struct drm_fb_helper *helper,
48 struct drm_fb_helper_surface_size *sizes)
49{
50 struct rockchip_drm_private *private = to_drm_private(helper);
51 struct drm_mode_fb_cmd2 mode_cmd = { 0 };
52 struct drm_device *dev = helper->dev;
53 struct rockchip_gem_object *rk_obj;
54 struct drm_framebuffer *fb;
55 unsigned int bytes_per_pixel;
56 unsigned long offset;
57 struct fb_info *fbi;
58 size_t size;
59 int ret;
60
61 bytes_per_pixel = DIV_ROUND_UP(sizes->surface_bpp, 8);
62
63 mode_cmd.width = sizes->surface_width;
64 mode_cmd.height = sizes->surface_height;
65 mode_cmd.pitches[0] = sizes->surface_width * bytes_per_pixel;
66 mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
67 sizes->surface_depth);
68
69 size = mode_cmd.pitches[0] * mode_cmd.height;
70
71 rk_obj = rockchip_gem_create_object(dev, size, true);
72 if (IS_ERR(rk_obj))
73 return -ENOMEM;
74
75 private->fbdev_bo = &rk_obj->base;
76
77 fbi = drm_fb_helper_alloc_fbi(helper);
78 if (IS_ERR(fbi)) {
79 dev_err(dev->dev, "Failed to create framebuffer info.\n");
80 ret = PTR_ERR(fbi);
81 goto err_rockchip_gem_free_object;
82 }
83
84 helper->fb = rockchip_drm_framebuffer_init(dev, &mode_cmd,
85 private->fbdev_bo);
86 if (IS_ERR(helper->fb)) {
87 dev_err(dev->dev, "Failed to allocate DRM framebuffer.\n");
88 ret = PTR_ERR(helper->fb);
89 goto err_release_fbi;
90 }
91
92 fbi->par = helper;
93 fbi->flags = FBINFO_FLAG_DEFAULT;
94 fbi->fbops = &rockchip_drm_fbdev_ops;
95
96 fb = helper->fb;
97 drm_fb_helper_fill_fix(fbi, fb->pitches[0], fb->format->depth);
98 drm_fb_helper_fill_var(fbi, helper, sizes->fb_width, sizes->fb_height);
99
100 offset = fbi->var.xoffset * bytes_per_pixel;
101 offset += fbi->var.yoffset * fb->pitches[0];
102
103 dev->mode_config.fb_base = 0;
104 fbi->screen_base = rk_obj->kvaddr + offset;
105 fbi->screen_size = rk_obj->base.size;
106 fbi->fix.smem_len = rk_obj->base.size;
107
108 DRM_DEBUG_KMS("FB [%dx%d]-%d kvaddr=%p offset=%ld size=%zu\n",
109 fb->width, fb->height, fb->format->depth,
110 rk_obj->kvaddr,
111 offset, size);
112
113 fbi->skip_vt_switch = true;
114
115 return 0;
116
117err_release_fbi:
118 drm_fb_helper_release_fbi(helper);
119err_rockchip_gem_free_object:
120 rockchip_gem_free_object(&rk_obj->base);
121 return ret;
122}
123
124static const struct drm_fb_helper_funcs rockchip_drm_fb_helper_funcs = {
125 .fb_probe = rockchip_drm_fbdev_create,
126};
127
128int rockchip_drm_fbdev_init(struct drm_device *dev)
129{
130 struct rockchip_drm_private *private = dev->dev_private;
131 struct drm_fb_helper *helper;
132 int ret;
133
134 if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector)
135 return -EINVAL;
136
137 helper = &private->fbdev_helper;
138
139 drm_fb_helper_prepare(dev, helper, &rockchip_drm_fb_helper_funcs);
140
141 ret = drm_fb_helper_init(dev, helper, ROCKCHIP_MAX_CONNECTOR);
142 if (ret < 0) {
143 dev_err(dev->dev, "Failed to initialize drm fb helper - %d.\n",
144 ret);
145 return ret;
146 }
147
148 ret = drm_fb_helper_single_add_all_connectors(helper);
149 if (ret < 0) {
150 dev_err(dev->dev, "Failed to add connectors - %d.\n", ret);
151 goto err_drm_fb_helper_fini;
152 }
153
154 ret = drm_fb_helper_initial_config(helper, PREFERRED_BPP);
155 if (ret < 0) {
156 dev_err(dev->dev, "Failed to set initial hw config - %d.\n",
157 ret);
158 goto err_drm_fb_helper_fini;
159 }
160
161 return 0;
162
163err_drm_fb_helper_fini:
164 drm_fb_helper_fini(helper);
165 return ret;
166}
167
168void rockchip_drm_fbdev_fini(struct drm_device *dev)
169{
170 struct rockchip_drm_private *private = dev->dev_private;
171 struct drm_fb_helper *helper;
172
173 helper = &private->fbdev_helper;
174
175 drm_fb_helper_unregister_fbi(helper);
176 drm_fb_helper_release_fbi(helper);
177
178 if (helper->fb)
179 drm_framebuffer_unreference(helper->fb);
180
181 drm_fb_helper_fini(helper);
182}