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 | * | |
d81aecb5 ID |
9 | * This program is free software; you can redistribute it and/or modify it |
10 | * under the terms of the GNU General Public License as published by the | |
11 | * Free Software Foundation; either version 2 of the License, or (at your | |
12 | * option) any later version. | |
1c248b7d ID |
13 | */ |
14 | ||
760285e7 DH |
15 | #include <drm/drmP.h> |
16 | #include <drm/drm_crtc.h> | |
17 | #include <drm/drm_fb_helper.h> | |
18 | #include <drm/drm_crtc_helper.h> | |
a1bfacf4 | 19 | #include <drm/exynos_drm.h> |
1c248b7d ID |
20 | |
21 | #include "exynos_drm_drv.h" | |
22 | #include "exynos_drm_fb.h" | |
e30655d0 | 23 | #include "exynos_drm_fbdev.h" |
c704f1b4 | 24 | #include "exynos_drm_iommu.h" |
1c248b7d ID |
25 | |
26 | #define MAX_CONNECTOR 4 | |
27 | #define PREFERRED_BPP 32 | |
28 | ||
29 | #define to_exynos_fbdev(x) container_of(x, struct exynos_drm_fbdev,\ | |
30 | drm_fb_helper) | |
31 | ||
32 | struct exynos_drm_fbdev { | |
813fd67b JS |
33 | struct drm_fb_helper drm_fb_helper; |
34 | struct exynos_drm_gem *exynos_gem; | |
1c248b7d ID |
35 | }; |
36 | ||
dd265850 P |
37 | static int exynos_drm_fb_mmap(struct fb_info *info, |
38 | struct vm_area_struct *vma) | |
39 | { | |
40 | struct drm_fb_helper *helper = info->par; | |
41 | struct exynos_drm_fbdev *exynos_fbd = to_exynos_fbdev(helper); | |
813fd67b | 42 | struct exynos_drm_gem *exynos_gem = exynos_fbd->exynos_gem; |
dd265850 P |
43 | unsigned long vm_size; |
44 | int ret; | |
45 | ||
dd265850 P |
46 | vma->vm_flags |= VM_IO | VM_DONTEXPAND | VM_DONTDUMP; |
47 | ||
48 | vm_size = vma->vm_end - vma->vm_start; | |
49 | ||
813fd67b | 50 | if (vm_size > exynos_gem->size) |
dd265850 P |
51 | return -EINVAL; |
52 | ||
f43c3596 | 53 | ret = dma_mmap_attrs(to_dma_dev(helper->dev), vma, exynos_gem->cookie, |
813fd67b | 54 | exynos_gem->dma_addr, exynos_gem->size, |
00085f1e | 55 | exynos_gem->dma_attrs); |
dd265850 P |
56 | if (ret < 0) { |
57 | DRM_ERROR("failed to mmap.\n"); | |
58 | return ret; | |
59 | } | |
60 | ||
61 | return 0; | |
62 | } | |
63 | ||
1c248b7d ID |
64 | static struct fb_ops exynos_drm_fb_ops = { |
65 | .owner = THIS_MODULE, | |
dd265850 | 66 | .fb_mmap = exynos_drm_fb_mmap, |
7c7d4507 AT |
67 | .fb_fillrect = drm_fb_helper_cfb_fillrect, |
68 | .fb_copyarea = drm_fb_helper_cfb_copyarea, | |
69 | .fb_imageblit = drm_fb_helper_cfb_imageblit, | |
1c248b7d | 70 | .fb_check_var = drm_fb_helper_check_var, |
83b316fd | 71 | .fb_set_par = drm_fb_helper_set_par, |
1c248b7d ID |
72 | .fb_blank = drm_fb_helper_blank, |
73 | .fb_pan_display = drm_fb_helper_pan_display, | |
74 | .fb_setcmap = drm_fb_helper_setcmap, | |
75 | }; | |
76 | ||
19c8b834 | 77 | static int exynos_drm_fbdev_update(struct drm_fb_helper *helper, |
d7619960 | 78 | struct drm_fb_helper_surface_size *sizes, |
813fd67b | 79 | struct exynos_drm_gem *exynos_gem) |
1c248b7d | 80 | { |
ee885ca5 | 81 | struct fb_info *fbi; |
d7619960 | 82 | struct drm_framebuffer *fb = helper->fb; |
aa6b2b6c | 83 | unsigned int size = fb->width * fb->height * (fb->bits_per_pixel >> 3); |
a5d7ac30 | 84 | unsigned int nr_pages; |
19c8b834 | 85 | unsigned long offset; |
1c248b7d | 86 | |
ee885ca5 JS |
87 | fbi = drm_fb_helper_alloc_fbi(helper); |
88 | if (IS_ERR(fbi)) { | |
89 | DRM_ERROR("failed to allocate fb info.\n"); | |
90 | return PTR_ERR(fbi); | |
91 | } | |
92 | ||
93 | fbi->par = helper; | |
94 | fbi->flags = FBINFO_FLAG_DEFAULT; | |
95 | fbi->fbops = &exynos_drm_fb_ops; | |
96 | ||
01f2c773 | 97 | drm_fb_helper_fill_fix(fbi, fb->pitches[0], fb->depth); |
ecbf1d5a | 98 | drm_fb_helper_fill_var(fbi, helper, sizes->fb_width, sizes->fb_height); |
1c248b7d | 99 | |
813fd67b | 100 | nr_pages = exynos_gem->size >> PAGE_SHIFT; |
a5d7ac30 | 101 | |
813fd67b JS |
102 | exynos_gem->kvaddr = (void __iomem *) vmap(exynos_gem->pages, nr_pages, |
103 | VM_MAP, pgprot_writecombine(PAGE_KERNEL)); | |
104 | if (!exynos_gem->kvaddr) { | |
a5d7ac30 | 105 | DRM_ERROR("failed to map pages to kernel space.\n"); |
ee885ca5 | 106 | drm_fb_helper_release_fbi(helper); |
a5d7ac30 | 107 | return -EIO; |
4744ad24 ID |
108 | } |
109 | ||
19c8b834 | 110 | offset = fbi->var.xoffset * (fb->bits_per_pixel >> 3); |
01f2c773 | 111 | offset += fbi->var.yoffset * fb->pitches[0]; |
1c248b7d | 112 | |
813fd67b | 113 | fbi->screen_base = exynos_gem->kvaddr + offset; |
1c248b7d | 114 | fbi->screen_size = size; |
71b1f195 | 115 | fbi->fix.smem_len = size; |
19c8b834 ID |
116 | |
117 | return 0; | |
1c248b7d ID |
118 | } |
119 | ||
120 | static int exynos_drm_fbdev_create(struct drm_fb_helper *helper, | |
121 | struct drm_fb_helper_surface_size *sizes) | |
122 | { | |
123 | struct exynos_drm_fbdev *exynos_fbdev = to_exynos_fbdev(helper); | |
813fd67b | 124 | struct exynos_drm_gem *exynos_gem; |
1c248b7d | 125 | struct drm_device *dev = helper->dev; |
a794d57d | 126 | struct drm_mode_fb_cmd2 mode_cmd = { 0 }; |
1c248b7d | 127 | struct platform_device *pdev = dev->platformdev; |
e1533c08 | 128 | unsigned long size; |
1c248b7d ID |
129 | int ret; |
130 | ||
1c248b7d ID |
131 | DRM_DEBUG_KMS("surface width(%d), height(%d) and bpp(%d\n", |
132 | sizes->surface_width, sizes->surface_height, | |
133 | sizes->surface_bpp); | |
134 | ||
135 | mode_cmd.width = sizes->surface_width; | |
136 | mode_cmd.height = sizes->surface_height; | |
a794d57d JS |
137 | mode_cmd.pitches[0] = sizes->surface_width * (sizes->surface_bpp >> 3); |
138 | mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, | |
139 | sizes->surface_depth); | |
1c248b7d | 140 | |
e1533c08 | 141 | size = mode_cmd.pitches[0] * mode_cmd.height; |
2b35892e | 142 | |
813fd67b | 143 | exynos_gem = exynos_drm_gem_create(dev, EXYNOS_BO_CONTIG, size); |
a1bfacf4 VS |
144 | /* |
145 | * If physically contiguous memory allocation fails and if IOMMU is | |
146 | * supported then try to get buffer from non physically contiguous | |
147 | * memory area. | |
148 | */ | |
813fd67b | 149 | if (IS_ERR(exynos_gem) && is_drm_iommu_supported(dev)) { |
a1bfacf4 | 150 | dev_warn(&pdev->dev, "contiguous FB allocation failed, falling back to non-contiguous\n"); |
813fd67b JS |
151 | exynos_gem = exynos_drm_gem_create(dev, EXYNOS_BO_NONCONTIG, |
152 | size); | |
a1bfacf4 VS |
153 | } |
154 | ||
2f424200 DV |
155 | if (IS_ERR(exynos_gem)) |
156 | return PTR_ERR(exynos_gem); | |
e1533c08 | 157 | |
813fd67b | 158 | exynos_fbdev->exynos_gem = exynos_gem; |
e1533c08 | 159 | |
813fd67b JS |
160 | helper->fb = |
161 | exynos_drm_framebuffer_init(dev, &mode_cmd, &exynos_gem, 1); | |
41eab402 | 162 | if (IS_ERR(helper->fb)) { |
1c248b7d | 163 | DRM_ERROR("failed to create drm framebuffer.\n"); |
e1533c08 | 164 | ret = PTR_ERR(helper->fb); |
662aa6d7 | 165 | goto err_destroy_gem; |
1c248b7d ID |
166 | } |
167 | ||
813fd67b | 168 | ret = exynos_drm_fbdev_update(helper, sizes, exynos_gem); |
662aa6d7 | 169 | if (ret < 0) |
7c7d4507 | 170 | goto err_destroy_framebuffer; |
662aa6d7 | 171 | |
662aa6d7 ID |
172 | return ret; |
173 | ||
662aa6d7 ID |
174 | err_destroy_framebuffer: |
175 | drm_framebuffer_cleanup(helper->fb); | |
176 | err_destroy_gem: | |
813fd67b | 177 | exynos_drm_gem_destroy(exynos_gem); |
1c248b7d | 178 | |
2f424200 DV |
179 | /* |
180 | * if failed, all resources allocated above would be released by | |
181 | * drm_mode_config_cleanup() when drm_load() had been called prior | |
182 | * to any specific driver such as fimd or hdmi driver. | |
183 | */ | |
184 | ||
1c248b7d ID |
185 | return ret; |
186 | } | |
187 | ||
3a493879 | 188 | static const struct drm_fb_helper_funcs exynos_drm_fb_helper_funcs = { |
cd5428a5 | 189 | .fb_probe = exynos_drm_fbdev_create, |
1c248b7d ID |
190 | }; |
191 | ||
9230ffc4 | 192 | static bool exynos_drm_fbdev_is_anything_connected(struct drm_device *dev) |
3eb578e2 AH |
193 | { |
194 | struct drm_connector *connector; | |
195 | bool ret = false; | |
196 | ||
197 | mutex_lock(&dev->mode_config.mutex); | |
198 | list_for_each_entry(connector, &dev->mode_config.connector_list, head) { | |
199 | if (connector->status != connector_status_connected) | |
200 | continue; | |
201 | ||
202 | ret = true; | |
203 | break; | |
204 | } | |
205 | mutex_unlock(&dev->mode_config.mutex); | |
206 | ||
207 | return ret; | |
208 | } | |
209 | ||
1c248b7d ID |
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 | ||
1c248b7d ID |
218 | if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector) |
219 | return 0; | |
220 | ||
3eb578e2 AH |
221 | if (!exynos_drm_fbdev_is_anything_connected(dev)) |
222 | return 0; | |
223 | ||
1c248b7d | 224 | fbdev = kzalloc(sizeof(*fbdev), GFP_KERNEL); |
38bb5253 | 225 | if (!fbdev) |
1c248b7d | 226 | return -ENOMEM; |
1c248b7d ID |
227 | |
228 | private->fb_helper = helper = &fbdev->drm_fb_helper; | |
10a23102 TR |
229 | |
230 | drm_fb_helper_prepare(dev, helper, &exynos_drm_fb_helper_funcs); | |
1c248b7d ID |
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 | { | |
4744ad24 | 268 | struct exynos_drm_fbdev *exynos_fbd = to_exynos_fbdev(fb_helper); |
813fd67b | 269 | struct exynos_drm_gem *exynos_gem = exynos_fbd->exynos_gem; |
1c248b7d ID |
270 | struct drm_framebuffer *fb; |
271 | ||
e8d3ef02 | 272 | vunmap(exynos_gem->kvaddr); |
4744ad24 | 273 | |
1c248b7d ID |
274 | /* release drm framebuffer and real buffer */ |
275 | if (fb_helper->fb && fb_helper->fb->funcs) { | |
276 | fb = fb_helper->fb; | |
36206361 DV |
277 | if (fb) { |
278 | drm_framebuffer_unregister_private(fb); | |
f7eff60e | 279 | drm_framebuffer_remove(fb); |
36206361 | 280 | } |
1c248b7d ID |
281 | } |
282 | ||
7c7d4507 AT |
283 | drm_fb_helper_unregister_fbi(fb_helper); |
284 | drm_fb_helper_release_fbi(fb_helper); | |
1c248b7d ID |
285 | |
286 | drm_fb_helper_fini(fb_helper); | |
287 | } | |
288 | ||
289 | void exynos_drm_fbdev_fini(struct drm_device *dev) | |
290 | { | |
291 | struct exynos_drm_private *private = dev->dev_private; | |
292 | struct exynos_drm_fbdev *fbdev; | |
293 | ||
294 | if (!private || !private->fb_helper) | |
295 | return; | |
296 | ||
297 | fbdev = to_exynos_fbdev(private->fb_helper); | |
298 | ||
299 | exynos_drm_fbdev_destroy(dev, private->fb_helper); | |
300 | kfree(fbdev); | |
301 | private->fb_helper = NULL; | |
302 | } | |
303 | ||
304 | void exynos_drm_fbdev_restore_mode(struct drm_device *dev) | |
305 | { | |
306 | struct exynos_drm_private *private = dev->dev_private; | |
307 | ||
308 | if (!private || !private->fb_helper) | |
309 | return; | |
310 | ||
5ea1f752 | 311 | drm_fb_helper_restore_fbdev_mode_unlocked(private->fb_helper); |
1c248b7d | 312 | } |
25c6a853 AH |
313 | |
314 | void exynos_drm_output_poll_changed(struct drm_device *dev) | |
315 | { | |
316 | struct exynos_drm_private *private = dev->dev_private; | |
317 | struct drm_fb_helper *fb_helper = private->fb_helper; | |
318 | ||
319 | if (fb_helper) | |
320 | drm_fb_helper_hotplug_event(fb_helper); | |
321 | else | |
322 | exynos_drm_fbdev_init(dev); | |
323 | } |