3 * Copyright (c) 2011 Samsung Electronics Co., Ltd.
5 * Inki Dae <inki.dae@samsung.com>
6 * Joonyoung Shim <jy0922.shim@samsung.com>
7 * Seung-Woo Kim <sw0312.kim@samsung.com>
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.
16 #include <drm/drm_crtc.h>
17 #include <drm/drm_fb_helper.h>
18 #include <drm/drm_crtc_helper.h>
19 #include <drm/exynos_drm.h>
21 #include "exynos_drm_drv.h"
22 #include "exynos_drm_fb.h"
23 #include "exynos_drm_fbdev.h"
24 #include "exynos_drm_gem.h"
25 #include "exynos_drm_iommu.h"
27 #define MAX_CONNECTOR 4
28 #define PREFERRED_BPP 32
30 #define to_exynos_fbdev(x) container_of(x, struct exynos_drm_fbdev,\
33 struct exynos_drm_fbdev
{
34 struct drm_fb_helper drm_fb_helper
;
35 struct exynos_drm_gem_obj
*exynos_gem_obj
;
38 static int exynos_drm_fb_mmap(struct fb_info
*info
,
39 struct vm_area_struct
*vma
)
41 struct drm_fb_helper
*helper
= info
->par
;
42 struct exynos_drm_fbdev
*exynos_fbd
= to_exynos_fbdev(helper
);
43 struct exynos_drm_gem_obj
*exynos_gem_obj
= exynos_fbd
->exynos_gem_obj
;
44 struct exynos_drm_gem_buf
*buffer
= exynos_gem_obj
->buffer
;
45 unsigned long vm_size
;
48 vma
->vm_flags
|= VM_IO
| VM_DONTEXPAND
| VM_DONTDUMP
;
50 vm_size
= vma
->vm_end
- vma
->vm_start
;
52 if (vm_size
> buffer
->size
)
55 ret
= dma_mmap_attrs(helper
->dev
->dev
, vma
, buffer
->pages
,
56 buffer
->dma_addr
, buffer
->size
, &buffer
->dma_attrs
);
58 DRM_ERROR("failed to mmap.\n");
65 static struct fb_ops exynos_drm_fb_ops
= {
67 .fb_mmap
= exynos_drm_fb_mmap
,
68 .fb_fillrect
= cfb_fillrect
,
69 .fb_copyarea
= cfb_copyarea
,
70 .fb_imageblit
= cfb_imageblit
,
71 .fb_check_var
= drm_fb_helper_check_var
,
72 .fb_set_par
= drm_fb_helper_set_par
,
73 .fb_blank
= drm_fb_helper_blank
,
74 .fb_pan_display
= drm_fb_helper_pan_display
,
75 .fb_setcmap
= drm_fb_helper_setcmap
,
78 static int exynos_drm_fbdev_update(struct drm_fb_helper
*helper
,
79 struct drm_framebuffer
*fb
)
81 struct fb_info
*fbi
= helper
->fbdev
;
82 struct exynos_drm_gem_buf
*buffer
;
83 unsigned int size
= fb
->width
* fb
->height
* (fb
->bits_per_pixel
>> 3);
84 unsigned int nr_pages
;
87 drm_fb_helper_fill_fix(fbi
, fb
->pitches
[0], fb
->depth
);
88 drm_fb_helper_fill_var(fbi
, helper
, fb
->width
, fb
->height
);
90 /* RGB formats use only one buffer */
91 buffer
= exynos_drm_fb_buffer(fb
, 0);
93 DRM_DEBUG_KMS("buffer is null.\n");
97 nr_pages
= buffer
->size
>> PAGE_SHIFT
;
99 buffer
->kvaddr
= (void __iomem
*) vmap(buffer
->pages
,
101 pgprot_writecombine(PAGE_KERNEL
));
102 if (!buffer
->kvaddr
) {
103 DRM_ERROR("failed to map pages to kernel space.\n");
107 /* buffer count to framebuffer always is 1 at booting time. */
108 exynos_drm_fb_set_buf_cnt(fb
, 1);
110 offset
= fbi
->var
.xoffset
* (fb
->bits_per_pixel
>> 3);
111 offset
+= fbi
->var
.yoffset
* fb
->pitches
[0];
113 fbi
->screen_base
= buffer
->kvaddr
+ offset
;
114 fbi
->screen_size
= size
;
115 fbi
->fix
.smem_len
= size
;
120 static int exynos_drm_fbdev_create(struct drm_fb_helper
*helper
,
121 struct drm_fb_helper_surface_size
*sizes
)
123 struct exynos_drm_fbdev
*exynos_fbdev
= to_exynos_fbdev(helper
);
124 struct exynos_drm_gem_obj
*exynos_gem_obj
;
125 struct drm_device
*dev
= helper
->dev
;
127 struct drm_mode_fb_cmd2 mode_cmd
= { 0 };
128 struct platform_device
*pdev
= dev
->platformdev
;
132 DRM_DEBUG_KMS("surface width(%d), height(%d) and bpp(%d\n",
133 sizes
->surface_width
, sizes
->surface_height
,
136 mode_cmd
.width
= sizes
->surface_width
;
137 mode_cmd
.height
= sizes
->surface_height
;
138 mode_cmd
.pitches
[0] = sizes
->surface_width
* (sizes
->surface_bpp
>> 3);
139 mode_cmd
.pixel_format
= drm_mode_legacy_fb_format(sizes
->surface_bpp
,
140 sizes
->surface_depth
);
142 mutex_lock(&dev
->struct_mutex
);
144 fbi
= framebuffer_alloc(0, &pdev
->dev
);
146 DRM_ERROR("failed to allocate fb info.\n");
151 size
= mode_cmd
.pitches
[0] * mode_cmd
.height
;
153 exynos_gem_obj
= exynos_drm_gem_create(dev
, EXYNOS_BO_CONTIG
, size
);
155 * If physically contiguous memory allocation fails and if IOMMU is
156 * supported then try to get buffer from non physically contiguous
159 if (IS_ERR(exynos_gem_obj
) && is_drm_iommu_supported(dev
)) {
160 dev_warn(&pdev
->dev
, "contiguous FB allocation failed, falling back to non-contiguous\n");
161 exynos_gem_obj
= exynos_drm_gem_create(dev
, EXYNOS_BO_NONCONTIG
,
165 if (IS_ERR(exynos_gem_obj
)) {
166 ret
= PTR_ERR(exynos_gem_obj
);
167 goto err_release_framebuffer
;
170 exynos_fbdev
->exynos_gem_obj
= exynos_gem_obj
;
172 helper
->fb
= exynos_drm_framebuffer_init(dev
, &mode_cmd
,
173 &exynos_gem_obj
->base
);
174 if (IS_ERR(helper
->fb
)) {
175 DRM_ERROR("failed to create drm framebuffer.\n");
176 ret
= PTR_ERR(helper
->fb
);
177 goto err_destroy_gem
;
183 fbi
->flags
= FBINFO_FLAG_DEFAULT
;
184 fbi
->fbops
= &exynos_drm_fb_ops
;
186 ret
= fb_alloc_cmap(&fbi
->cmap
, 256, 0);
188 DRM_ERROR("failed to allocate cmap.\n");
189 goto err_destroy_framebuffer
;
192 ret
= exynos_drm_fbdev_update(helper
, helper
->fb
);
194 goto err_dealloc_cmap
;
196 mutex_unlock(&dev
->struct_mutex
);
200 fb_dealloc_cmap(&fbi
->cmap
);
201 err_destroy_framebuffer
:
202 drm_framebuffer_cleanup(helper
->fb
);
204 exynos_drm_gem_destroy(exynos_gem_obj
);
205 err_release_framebuffer
:
206 framebuffer_release(fbi
);
209 * if failed, all resources allocated above would be released by
210 * drm_mode_config_cleanup() when drm_load() had been called prior
211 * to any specific driver such as fimd or hdmi driver.
214 mutex_unlock(&dev
->struct_mutex
);
218 static const struct drm_fb_helper_funcs exynos_drm_fb_helper_funcs
= {
219 .fb_probe
= exynos_drm_fbdev_create
,
222 static bool exynos_drm_fbdev_is_anything_connected(struct drm_device
*dev
)
224 struct drm_connector
*connector
;
227 mutex_lock(&dev
->mode_config
.mutex
);
228 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
229 if (connector
->status
!= connector_status_connected
)
235 mutex_unlock(&dev
->mode_config
.mutex
);
240 int exynos_drm_fbdev_init(struct drm_device
*dev
)
242 struct exynos_drm_fbdev
*fbdev
;
243 struct exynos_drm_private
*private = dev
->dev_private
;
244 struct drm_fb_helper
*helper
;
245 unsigned int num_crtc
;
248 if (!dev
->mode_config
.num_crtc
|| !dev
->mode_config
.num_connector
)
251 if (!exynos_drm_fbdev_is_anything_connected(dev
))
254 fbdev
= kzalloc(sizeof(*fbdev
), GFP_KERNEL
);
258 private->fb_helper
= helper
= &fbdev
->drm_fb_helper
;
260 drm_fb_helper_prepare(dev
, helper
, &exynos_drm_fb_helper_funcs
);
262 num_crtc
= dev
->mode_config
.num_crtc
;
264 ret
= drm_fb_helper_init(dev
, helper
, num_crtc
, MAX_CONNECTOR
);
266 DRM_ERROR("failed to initialize drm fb helper.\n");
270 ret
= drm_fb_helper_single_add_all_connectors(helper
);
272 DRM_ERROR("failed to register drm_fb_helper_connector.\n");
277 /* disable all the possible outputs/crtcs before entering KMS mode */
278 drm_helper_disable_unused_functions(dev
);
280 ret
= drm_fb_helper_initial_config(helper
, PREFERRED_BPP
);
282 DRM_ERROR("failed to set up hw configuration.\n");
289 drm_fb_helper_fini(helper
);
292 private->fb_helper
= NULL
;
298 static void exynos_drm_fbdev_destroy(struct drm_device
*dev
,
299 struct drm_fb_helper
*fb_helper
)
301 struct exynos_drm_fbdev
*exynos_fbd
= to_exynos_fbdev(fb_helper
);
302 struct exynos_drm_gem_obj
*exynos_gem_obj
= exynos_fbd
->exynos_gem_obj
;
303 struct drm_framebuffer
*fb
;
305 if (exynos_gem_obj
->buffer
->kvaddr
)
306 vunmap(exynos_gem_obj
->buffer
->kvaddr
);
308 /* release drm framebuffer and real buffer */
309 if (fb_helper
->fb
&& fb_helper
->fb
->funcs
) {
312 drm_framebuffer_unregister_private(fb
);
313 drm_framebuffer_remove(fb
);
317 /* release linux framebuffer */
318 if (fb_helper
->fbdev
) {
319 struct fb_info
*info
;
322 info
= fb_helper
->fbdev
;
323 ret
= unregister_framebuffer(info
);
325 DRM_DEBUG_KMS("failed unregister_framebuffer()\n");
328 fb_dealloc_cmap(&info
->cmap
);
330 framebuffer_release(info
);
333 drm_fb_helper_fini(fb_helper
);
336 void exynos_drm_fbdev_fini(struct drm_device
*dev
)
338 struct exynos_drm_private
*private = dev
->dev_private
;
339 struct exynos_drm_fbdev
*fbdev
;
341 if (!private || !private->fb_helper
)
344 fbdev
= to_exynos_fbdev(private->fb_helper
);
346 exynos_drm_fbdev_destroy(dev
, private->fb_helper
);
348 private->fb_helper
= NULL
;
351 void exynos_drm_fbdev_restore_mode(struct drm_device
*dev
)
353 struct exynos_drm_private
*private = dev
->dev_private
;
355 if (!private || !private->fb_helper
)
358 drm_fb_helper_restore_fbdev_mode_unlocked(private->fb_helper
);