Commit | Line | Data |
---|---|---|
1c248b7d ID |
1 | /* exynos_drm_fbdev.c |
2 | * | |
3 | * Copyright (c) 2011 Samsung Electronics Co., Ltd. | |
4 | * Authors: | |
5 | * Inki Dae <inki.dae@samsung.com> | |
6 | * Joonyoung Shim <jy0922.shim@samsung.com> | |
7 | * Seung-Woo Kim <sw0312.kim@samsung.com> | |
8 | * | |
9 | * Permission is hereby granted, free of charge, to any person obtaining a | |
10 | * copy of this software and associated documentation files (the "Software"), | |
11 | * to deal in the Software without restriction, including without limitation | |
12 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, | |
13 | * and/or sell copies of the Software, and to permit persons to whom the | |
14 | * Software is furnished to do so, subject to the following conditions: | |
15 | * | |
16 | * The above copyright notice and this permission notice (including the next | |
17 | * paragraph) shall be included in all copies or substantial portions of the | |
18 | * Software. | |
19 | * | |
20 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
21 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
22 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
23 | * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR | |
24 | * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, | |
25 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR | |
26 | * OTHER DEALINGS IN THE SOFTWARE. | |
27 | */ | |
28 | ||
760285e7 DH |
29 | #include <drm/drmP.h> |
30 | #include <drm/drm_crtc.h> | |
31 | #include <drm/drm_fb_helper.h> | |
32 | #include <drm/drm_crtc_helper.h> | |
1c248b7d ID |
33 | |
34 | #include "exynos_drm_drv.h" | |
35 | #include "exynos_drm_fb.h" | |
2c871127 | 36 | #include "exynos_drm_gem.h" |
1c248b7d ID |
37 | |
38 | #define MAX_CONNECTOR 4 | |
39 | #define PREFERRED_BPP 32 | |
40 | ||
41 | #define to_exynos_fbdev(x) container_of(x, struct exynos_drm_fbdev,\ | |
42 | drm_fb_helper) | |
43 | ||
44 | struct exynos_drm_fbdev { | |
e1533c08 JS |
45 | struct drm_fb_helper drm_fb_helper; |
46 | struct exynos_drm_gem_obj *exynos_gem_obj; | |
1c248b7d ID |
47 | }; |
48 | ||
1c248b7d ID |
49 | static struct fb_ops exynos_drm_fb_ops = { |
50 | .owner = THIS_MODULE, | |
51 | .fb_fillrect = cfb_fillrect, | |
52 | .fb_copyarea = cfb_copyarea, | |
53 | .fb_imageblit = cfb_imageblit, | |
54 | .fb_check_var = drm_fb_helper_check_var, | |
83b316fd | 55 | .fb_set_par = drm_fb_helper_set_par, |
1c248b7d ID |
56 | .fb_blank = drm_fb_helper_blank, |
57 | .fb_pan_display = drm_fb_helper_pan_display, | |
58 | .fb_setcmap = drm_fb_helper_setcmap, | |
59 | }; | |
60 | ||
19c8b834 | 61 | static int exynos_drm_fbdev_update(struct drm_fb_helper *helper, |
aa6b2b6c | 62 | struct drm_framebuffer *fb) |
1c248b7d ID |
63 | { |
64 | struct fb_info *fbi = helper->fbdev; | |
65 | struct drm_device *dev = helper->dev; | |
2c871127 | 66 | struct exynos_drm_gem_buf *buffer; |
aa6b2b6c | 67 | unsigned int size = fb->width * fb->height * (fb->bits_per_pixel >> 3); |
19c8b834 | 68 | unsigned long offset; |
1c248b7d ID |
69 | |
70 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
71 | ||
01f2c773 | 72 | drm_fb_helper_fill_fix(fbi, fb->pitches[0], fb->depth); |
aa6b2b6c | 73 | drm_fb_helper_fill_var(fbi, helper, fb->width, fb->height); |
1c248b7d | 74 | |
229d3534 SWK |
75 | /* RGB formats use only one buffer */ |
76 | buffer = exynos_drm_fb_buffer(fb, 0); | |
2c871127 ID |
77 | if (!buffer) { |
78 | DRM_LOG_KMS("buffer is null.\n"); | |
19c8b834 ID |
79 | return -EFAULT; |
80 | } | |
1c248b7d | 81 | |
01ed8126 ID |
82 | /* buffer count to framebuffer always is 1 at booting time. */ |
83 | exynos_drm_fb_set_buf_cnt(fb, 1); | |
84 | ||
19c8b834 | 85 | offset = fbi->var.xoffset * (fb->bits_per_pixel >> 3); |
01f2c773 | 86 | offset += fbi->var.yoffset * fb->pitches[0]; |
1c248b7d | 87 | |
2c871127 ID |
88 | dev->mode_config.fb_base = (resource_size_t)buffer->dma_addr; |
89 | fbi->screen_base = buffer->kvaddr + offset; | |
129495de ID |
90 | fbi->fix.smem_start = (unsigned long)(page_to_phys(buffer->pages[0]) + |
91 | offset); | |
1c248b7d | 92 | fbi->screen_size = size; |
1c248b7d | 93 | fbi->fix.smem_len = size; |
19c8b834 ID |
94 | |
95 | return 0; | |
1c248b7d ID |
96 | } |
97 | ||
98 | static int exynos_drm_fbdev_create(struct drm_fb_helper *helper, | |
99 | struct drm_fb_helper_surface_size *sizes) | |
100 | { | |
101 | struct exynos_drm_fbdev *exynos_fbdev = to_exynos_fbdev(helper); | |
e1533c08 | 102 | struct exynos_drm_gem_obj *exynos_gem_obj; |
1c248b7d ID |
103 | struct drm_device *dev = helper->dev; |
104 | struct fb_info *fbi; | |
a794d57d | 105 | struct drm_mode_fb_cmd2 mode_cmd = { 0 }; |
1c248b7d | 106 | struct platform_device *pdev = dev->platformdev; |
e1533c08 | 107 | unsigned long size; |
1c248b7d ID |
108 | int ret; |
109 | ||
110 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
111 | ||
112 | DRM_DEBUG_KMS("surface width(%d), height(%d) and bpp(%d\n", | |
113 | sizes->surface_width, sizes->surface_height, | |
114 | sizes->surface_bpp); | |
115 | ||
116 | mode_cmd.width = sizes->surface_width; | |
117 | mode_cmd.height = sizes->surface_height; | |
a794d57d JS |
118 | mode_cmd.pitches[0] = sizes->surface_width * (sizes->surface_bpp >> 3); |
119 | mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, | |
120 | sizes->surface_depth); | |
1c248b7d ID |
121 | |
122 | mutex_lock(&dev->struct_mutex); | |
123 | ||
124 | fbi = framebuffer_alloc(0, &pdev->dev); | |
125 | if (!fbi) { | |
126 | DRM_ERROR("failed to allocate fb info.\n"); | |
127 | ret = -ENOMEM; | |
128 | goto out; | |
129 | } | |
130 | ||
e1533c08 | 131 | size = mode_cmd.pitches[0] * mode_cmd.height; |
2b35892e ID |
132 | |
133 | /* 0 means to allocate physically continuous memory */ | |
134 | exynos_gem_obj = exynos_drm_gem_create(dev, 0, size); | |
e1533c08 JS |
135 | if (IS_ERR(exynos_gem_obj)) { |
136 | ret = PTR_ERR(exynos_gem_obj); | |
137 | goto out; | |
138 | } | |
139 | ||
140 | exynos_fbdev->exynos_gem_obj = exynos_gem_obj; | |
141 | ||
142 | helper->fb = exynos_drm_framebuffer_init(dev, &mode_cmd, | |
143 | &exynos_gem_obj->base); | |
144 | if (IS_ERR_OR_NULL(helper->fb)) { | |
1c248b7d | 145 | DRM_ERROR("failed to create drm framebuffer.\n"); |
e1533c08 | 146 | ret = PTR_ERR(helper->fb); |
1c248b7d ID |
147 | goto out; |
148 | } | |
149 | ||
1c248b7d ID |
150 | helper->fbdev = fbi; |
151 | ||
152 | fbi->par = helper; | |
153 | fbi->flags = FBINFO_FLAG_DEFAULT; | |
154 | fbi->fbops = &exynos_drm_fb_ops; | |
155 | ||
156 | ret = fb_alloc_cmap(&fbi->cmap, 256, 0); | |
157 | if (ret) { | |
158 | DRM_ERROR("failed to allocate cmap.\n"); | |
159 | goto out; | |
160 | } | |
161 | ||
aa6b2b6c | 162 | ret = exynos_drm_fbdev_update(helper, helper->fb); |
e1533c08 | 163 | if (ret < 0) { |
19c8b834 | 164 | fb_dealloc_cmap(&fbi->cmap); |
e1533c08 JS |
165 | goto out; |
166 | } | |
1c248b7d ID |
167 | |
168 | /* | |
169 | * if failed, all resources allocated above would be released by | |
170 | * drm_mode_config_cleanup() when drm_load() had been called prior | |
171 | * to any specific driver such as fimd or hdmi driver. | |
172 | */ | |
173 | out: | |
174 | mutex_unlock(&dev->struct_mutex); | |
175 | return ret; | |
176 | } | |
177 | ||
1c248b7d ID |
178 | static int exynos_drm_fbdev_probe(struct drm_fb_helper *helper, |
179 | struct drm_fb_helper_surface_size *sizes) | |
180 | { | |
181 | int ret = 0; | |
182 | ||
183 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
184 | ||
bc41eae2 ID |
185 | /* |
186 | * with !helper->fb, it means that this funcion is called first time | |
187 | * and after that, the helper->fb would be used as clone mode. | |
188 | */ | |
1c248b7d ID |
189 | if (!helper->fb) { |
190 | ret = exynos_drm_fbdev_create(helper, sizes); | |
191 | if (ret < 0) { | |
192 | DRM_ERROR("failed to create fbdev.\n"); | |
193 | return ret; | |
194 | } | |
195 | ||
196 | /* | |
197 | * fb_helper expects a value more than 1 if succeed | |
198 | * because register_framebuffer() should be called. | |
199 | */ | |
200 | ret = 1; | |
1c248b7d ID |
201 | } |
202 | ||
203 | return ret; | |
204 | } | |
205 | ||
206 | static struct drm_fb_helper_funcs exynos_drm_fb_helper_funcs = { | |
207 | .fb_probe = exynos_drm_fbdev_probe, | |
208 | }; | |
209 | ||
210 | int exynos_drm_fbdev_init(struct drm_device *dev) | |
211 | { | |
212 | struct exynos_drm_fbdev *fbdev; | |
213 | struct exynos_drm_private *private = dev->dev_private; | |
214 | struct drm_fb_helper *helper; | |
215 | unsigned int num_crtc; | |
216 | int ret; | |
217 | ||
218 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
219 | ||
220 | if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector) | |
221 | return 0; | |
222 | ||
223 | fbdev = kzalloc(sizeof(*fbdev), GFP_KERNEL); | |
224 | if (!fbdev) { | |
225 | DRM_ERROR("failed to allocate drm fbdev.\n"); | |
226 | return -ENOMEM; | |
227 | } | |
228 | ||
229 | private->fb_helper = helper = &fbdev->drm_fb_helper; | |
230 | helper->funcs = &exynos_drm_fb_helper_funcs; | |
231 | ||
232 | num_crtc = dev->mode_config.num_crtc; | |
233 | ||
234 | ret = drm_fb_helper_init(dev, helper, num_crtc, MAX_CONNECTOR); | |
235 | if (ret < 0) { | |
236 | DRM_ERROR("failed to initialize drm fb helper.\n"); | |
237 | goto err_init; | |
238 | } | |
239 | ||
240 | ret = drm_fb_helper_single_add_all_connectors(helper); | |
241 | if (ret < 0) { | |
242 | DRM_ERROR("failed to register drm_fb_helper_connector.\n"); | |
243 | goto err_setup; | |
244 | ||
245 | } | |
246 | ||
247 | ret = drm_fb_helper_initial_config(helper, PREFERRED_BPP); | |
248 | if (ret < 0) { | |
249 | DRM_ERROR("failed to set up hw configuration.\n"); | |
250 | goto err_setup; | |
251 | } | |
252 | ||
253 | return 0; | |
254 | ||
255 | err_setup: | |
256 | drm_fb_helper_fini(helper); | |
257 | ||
258 | err_init: | |
259 | private->fb_helper = NULL; | |
260 | kfree(fbdev); | |
261 | ||
262 | return ret; | |
263 | } | |
264 | ||
265 | static void exynos_drm_fbdev_destroy(struct drm_device *dev, | |
266 | struct drm_fb_helper *fb_helper) | |
267 | { | |
268 | struct drm_framebuffer *fb; | |
269 | ||
270 | /* release drm framebuffer and real buffer */ | |
271 | if (fb_helper->fb && fb_helper->fb->funcs) { | |
272 | fb = fb_helper->fb; | |
f7eff60e RC |
273 | if (fb) |
274 | drm_framebuffer_remove(fb); | |
1c248b7d ID |
275 | } |
276 | ||
277 | /* release linux framebuffer */ | |
278 | if (fb_helper->fbdev) { | |
279 | struct fb_info *info; | |
280 | int ret; | |
281 | ||
282 | info = fb_helper->fbdev; | |
283 | ret = unregister_framebuffer(info); | |
284 | if (ret < 0) | |
285 | DRM_DEBUG_KMS("failed unregister_framebuffer()\n"); | |
286 | ||
287 | if (info->cmap.len) | |
288 | fb_dealloc_cmap(&info->cmap); | |
289 | ||
290 | framebuffer_release(info); | |
291 | } | |
292 | ||
293 | drm_fb_helper_fini(fb_helper); | |
294 | } | |
295 | ||
296 | void exynos_drm_fbdev_fini(struct drm_device *dev) | |
297 | { | |
298 | struct exynos_drm_private *private = dev->dev_private; | |
299 | struct exynos_drm_fbdev *fbdev; | |
300 | ||
301 | if (!private || !private->fb_helper) | |
302 | return; | |
303 | ||
304 | fbdev = to_exynos_fbdev(private->fb_helper); | |
305 | ||
e1533c08 JS |
306 | if (fbdev->exynos_gem_obj) |
307 | exynos_drm_gem_destroy(fbdev->exynos_gem_obj); | |
308 | ||
1c248b7d ID |
309 | exynos_drm_fbdev_destroy(dev, private->fb_helper); |
310 | kfree(fbdev); | |
311 | private->fb_helper = NULL; | |
312 | } | |
313 | ||
314 | void exynos_drm_fbdev_restore_mode(struct drm_device *dev) | |
315 | { | |
316 | struct exynos_drm_private *private = dev->dev_private; | |
317 | ||
318 | if (!private || !private->fb_helper) | |
319 | return; | |
320 | ||
321 | drm_fb_helper_restore_fbdev_mode(private->fb_helper); | |
322 | } |