Loading...
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
24#define PREFERRED_BPP 32
25#define to_drm_private(x) \
26 container_of(x, struct rockchip_drm_private, fbdev_helper)
27
28static int rockchip_fbdev_mmap(struct fb_info *info,
29 struct vm_area_struct *vma)
30{
31 struct drm_fb_helper *helper = info->par;
32 struct rockchip_drm_private *private = to_drm_private(helper);
33
34 return rockchip_gem_mmap_buf(private->fbdev_bo, vma);
35}
36
37static struct fb_ops rockchip_drm_fbdev_ops = {
38 .owner = THIS_MODULE,
39 .fb_mmap = rockchip_fbdev_mmap,
40 .fb_fillrect = drm_fb_helper_cfb_fillrect,
41 .fb_copyarea = drm_fb_helper_cfb_copyarea,
42 .fb_imageblit = drm_fb_helper_cfb_imageblit,
43 .fb_check_var = drm_fb_helper_check_var,
44 .fb_set_par = drm_fb_helper_set_par,
45 .fb_blank = drm_fb_helper_blank,
46 .fb_pan_display = drm_fb_helper_pan_display,
47 .fb_setcmap = drm_fb_helper_setcmap,
48};
49
50static int rockchip_drm_fbdev_create(struct drm_fb_helper *helper,
51 struct drm_fb_helper_surface_size *sizes)
52{
53 struct rockchip_drm_private *private = to_drm_private(helper);
54 struct drm_mode_fb_cmd2 mode_cmd = { 0 };
55 struct drm_device *dev = helper->dev;
56 struct rockchip_gem_object *rk_obj;
57 struct drm_framebuffer *fb;
58 unsigned int bytes_per_pixel;
59 unsigned long offset;
60 struct fb_info *fbi;
61 size_t size;
62 int ret;
63
64 bytes_per_pixel = DIV_ROUND_UP(sizes->surface_bpp, 8);
65
66 mode_cmd.width = sizes->surface_width;
67 mode_cmd.height = sizes->surface_height;
68 mode_cmd.pitches[0] = sizes->surface_width * bytes_per_pixel;
69 mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
70 sizes->surface_depth);
71
72 size = mode_cmd.pitches[0] * mode_cmd.height;
73
74 rk_obj = rockchip_gem_create_object(dev, size, true);
75 if (IS_ERR(rk_obj))
76 return -ENOMEM;
77
78 private->fbdev_bo = &rk_obj->base;
79
80 fbi = drm_fb_helper_alloc_fbi(helper);
81 if (IS_ERR(fbi)) {
82 dev_err(dev->dev, "Failed to create framebuffer info.\n");
83 ret = PTR_ERR(fbi);
84 goto err_rockchip_gem_free_object;
85 }
86
87 helper->fb = rockchip_drm_framebuffer_init(dev, &mode_cmd,
88 private->fbdev_bo);
89 if (IS_ERR(helper->fb)) {
90 dev_err(dev->dev, "Failed to allocate DRM framebuffer.\n");
91 ret = PTR_ERR(helper->fb);
92 goto err_release_fbi;
93 }
94
95 fbi->par = helper;
96 fbi->flags = FBINFO_FLAG_DEFAULT;
97 fbi->fbops = &rockchip_drm_fbdev_ops;
98
99 fb = helper->fb;
100 drm_fb_helper_fill_fix(fbi, fb->pitches[0], fb->depth);
101 drm_fb_helper_fill_var(fbi, helper, sizes->fb_width, sizes->fb_height);
102
103 offset = fbi->var.xoffset * bytes_per_pixel;
104 offset += fbi->var.yoffset * fb->pitches[0];
105
106 dev->mode_config.fb_base = 0;
107 fbi->screen_base = rk_obj->kvaddr + offset;
108 fbi->screen_size = rk_obj->base.size;
109 fbi->fix.smem_len = rk_obj->base.size;
110
111 DRM_DEBUG_KMS("FB [%dx%d]-%d kvaddr=%p offset=%ld size=%d\n",
112 fb->width, fb->height, fb->depth, rk_obj->kvaddr,
113 offset, size);
114
115 fbi->skip_vt_switch = true;
116
117 return 0;
118
119err_release_fbi:
120 drm_fb_helper_release_fbi(helper);
121err_rockchip_gem_free_object:
122 rockchip_gem_free_object(&rk_obj->base);
123 return ret;
124}
125
126static const struct drm_fb_helper_funcs rockchip_drm_fb_helper_funcs = {
127 .fb_probe = rockchip_drm_fbdev_create,
128};
129
130int rockchip_drm_fbdev_init(struct drm_device *dev)
131{
132 struct rockchip_drm_private *private = dev->dev_private;
133 struct drm_fb_helper *helper;
134 unsigned int num_crtc;
135 int ret;
136
137 if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector)
138 return -EINVAL;
139
140 num_crtc = dev->mode_config.num_crtc;
141
142 helper = &private->fbdev_helper;
143
144 drm_fb_helper_prepare(dev, helper, &rockchip_drm_fb_helper_funcs);
145
146 ret = drm_fb_helper_init(dev, helper, num_crtc, ROCKCHIP_MAX_CONNECTOR);
147 if (ret < 0) {
148 dev_err(dev->dev, "Failed to initialize drm fb helper - %d.\n",
149 ret);
150 return ret;
151 }
152
153 ret = drm_fb_helper_single_add_all_connectors(helper);
154 if (ret < 0) {
155 dev_err(dev->dev, "Failed to add connectors - %d.\n", ret);
156 goto err_drm_fb_helper_fini;
157 }
158
159 /* disable all the possible outputs/crtcs before entering KMS mode */
160 drm_helper_disable_unused_functions(dev);
161
162 ret = drm_fb_helper_initial_config(helper, PREFERRED_BPP);
163 if (ret < 0) {
164 dev_err(dev->dev, "Failed to set initial hw config - %d.\n",
165 ret);
166 goto err_drm_fb_helper_fini;
167 }
168
169 return 0;
170
171err_drm_fb_helper_fini:
172 drm_fb_helper_fini(helper);
173 return ret;
174}
175
176void rockchip_drm_fbdev_fini(struct drm_device *dev)
177{
178 struct rockchip_drm_private *private = dev->dev_private;
179 struct drm_fb_helper *helper;
180
181 helper = &private->fbdev_helper;
182
183 drm_fb_helper_unregister_fbi(helper);
184 drm_fb_helper_release_fbi(helper);
185
186 if (helper->fb)
187 drm_framebuffer_unreference(helper->fb);
188
189 drm_fb_helper_fini(helper);
190}
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
21static 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
30static 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
39static 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
105out:
106 rockchip_gem_free_object(&rk_obj->base);
107 return ret;
108}
109
110static const struct drm_fb_helper_funcs rockchip_drm_fb_helper_funcs = {
111 .fb_probe = rockchip_drm_fbdev_create,
112};
113
114int 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
152err_drm_fb_helper_fini:
153 drm_fb_helper_fini(helper);
154 return ret;
155}
156
157void 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}