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 <linux/console.h>
23 #include "exynos_drm_drv.h"
24 #include "exynos_drm_fb.h"
25 #include "exynos_drm_fbdev.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
*exynos_gem
;
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
*exynos_gem
= exynos_fbd
->exynos_gem
;
44 unsigned long vm_size
;
47 vma
->vm_flags
|= VM_IO
| VM_DONTEXPAND
| VM_DONTDUMP
;
49 vm_size
= vma
->vm_end
- vma
->vm_start
;
51 if (vm_size
> exynos_gem
->size
)
54 ret
= dma_mmap_attrs(to_dma_dev(helper
->dev
), vma
, exynos_gem
->cookie
,
55 exynos_gem
->dma_addr
, exynos_gem
->size
,
56 exynos_gem
->dma_attrs
);
58 DRM_ERROR("failed to mmap.\n");
65 static struct fb_ops exynos_drm_fb_ops
= {
67 DRM_FB_HELPER_DEFAULT_OPS
,
68 .fb_mmap
= exynos_drm_fb_mmap
,
69 .fb_fillrect
= drm_fb_helper_cfb_fillrect
,
70 .fb_copyarea
= drm_fb_helper_cfb_copyarea
,
71 .fb_imageblit
= drm_fb_helper_cfb_imageblit
,
74 static int exynos_drm_fbdev_update(struct drm_fb_helper
*helper
,
75 struct drm_fb_helper_surface_size
*sizes
,
76 struct exynos_drm_gem
*exynos_gem
)
79 struct drm_framebuffer
*fb
= helper
->fb
;
80 unsigned int size
= fb
->width
* fb
->height
* fb
->format
->cpp
[0];
81 unsigned int nr_pages
;
84 fbi
= drm_fb_helper_alloc_fbi(helper
);
86 DRM_ERROR("failed to allocate fb info.\n");
91 fbi
->flags
= FBINFO_FLAG_DEFAULT
;
92 fbi
->fbops
= &exynos_drm_fb_ops
;
94 drm_fb_helper_fill_fix(fbi
, fb
->pitches
[0], fb
->format
->depth
);
95 drm_fb_helper_fill_var(fbi
, helper
, sizes
->fb_width
, sizes
->fb_height
);
97 nr_pages
= exynos_gem
->size
>> PAGE_SHIFT
;
99 exynos_gem
->kvaddr
= (void __iomem
*) vmap(exynos_gem
->pages
, nr_pages
,
100 VM_MAP
, pgprot_writecombine(PAGE_KERNEL
));
101 if (!exynos_gem
->kvaddr
) {
102 DRM_ERROR("failed to map pages to kernel space.\n");
106 offset
= fbi
->var
.xoffset
* fb
->format
->cpp
[0];
107 offset
+= fbi
->var
.yoffset
* fb
->pitches
[0];
109 fbi
->screen_base
= exynos_gem
->kvaddr
+ offset
;
110 fbi
->screen_size
= size
;
111 fbi
->fix
.smem_len
= size
;
116 static int exynos_drm_fbdev_create(struct drm_fb_helper
*helper
,
117 struct drm_fb_helper_surface_size
*sizes
)
119 struct exynos_drm_fbdev
*exynos_fbdev
= to_exynos_fbdev(helper
);
120 struct exynos_drm_gem
*exynos_gem
;
121 struct drm_device
*dev
= helper
->dev
;
122 struct drm_mode_fb_cmd2 mode_cmd
= { 0 };
126 DRM_DEBUG_KMS("surface width(%d), height(%d) and bpp(%d\n",
127 sizes
->surface_width
, sizes
->surface_height
,
130 mode_cmd
.width
= sizes
->surface_width
;
131 mode_cmd
.height
= sizes
->surface_height
;
132 mode_cmd
.pitches
[0] = sizes
->surface_width
* (sizes
->surface_bpp
>> 3);
133 mode_cmd
.pixel_format
= drm_mode_legacy_fb_format(sizes
->surface_bpp
,
134 sizes
->surface_depth
);
136 size
= mode_cmd
.pitches
[0] * mode_cmd
.height
;
138 exynos_gem
= exynos_drm_gem_create(dev
, EXYNOS_BO_CONTIG
, size
);
140 * If physically contiguous memory allocation fails and if IOMMU is
141 * supported then try to get buffer from non physically contiguous
144 if (IS_ERR(exynos_gem
) && is_drm_iommu_supported(dev
)) {
145 dev_warn(dev
->dev
, "contiguous FB allocation failed, falling back to non-contiguous\n");
146 exynos_gem
= exynos_drm_gem_create(dev
, EXYNOS_BO_NONCONTIG
,
150 if (IS_ERR(exynos_gem
))
151 return PTR_ERR(exynos_gem
);
153 exynos_fbdev
->exynos_gem
= exynos_gem
;
156 exynos_drm_framebuffer_init(dev
, &mode_cmd
, &exynos_gem
, 1);
157 if (IS_ERR(helper
->fb
)) {
158 DRM_ERROR("failed to create drm framebuffer.\n");
159 ret
= PTR_ERR(helper
->fb
);
160 goto err_destroy_gem
;
163 ret
= exynos_drm_fbdev_update(helper
, sizes
, exynos_gem
);
165 goto err_destroy_framebuffer
;
169 err_destroy_framebuffer
:
170 drm_framebuffer_cleanup(helper
->fb
);
172 exynos_drm_gem_destroy(exynos_gem
);
175 * if failed, all resources allocated above would be released by
176 * drm_mode_config_cleanup() when drm_load() had been called prior
177 * to any specific driver such as fimd or hdmi driver.
183 static const struct drm_fb_helper_funcs exynos_drm_fb_helper_funcs
= {
184 .fb_probe
= exynos_drm_fbdev_create
,
187 int exynos_drm_fbdev_init(struct drm_device
*dev
)
189 struct exynos_drm_fbdev
*fbdev
;
190 struct exynos_drm_private
*private = dev
->dev_private
;
191 struct drm_fb_helper
*helper
;
194 if (!dev
->mode_config
.num_crtc
)
197 fbdev
= kzalloc(sizeof(*fbdev
), GFP_KERNEL
);
201 private->fb_helper
= helper
= &fbdev
->drm_fb_helper
;
203 drm_fb_helper_prepare(dev
, helper
, &exynos_drm_fb_helper_funcs
);
205 ret
= drm_fb_helper_init(dev
, helper
, MAX_CONNECTOR
);
207 DRM_ERROR("failed to initialize drm fb helper.\n");
211 ret
= drm_fb_helper_single_add_all_connectors(helper
);
213 DRM_ERROR("failed to register drm_fb_helper_connector.\n");
218 ret
= drm_fb_helper_initial_config(helper
, PREFERRED_BPP
);
220 DRM_ERROR("failed to set up hw configuration.\n");
227 drm_fb_helper_fini(helper
);
230 private->fb_helper
= NULL
;
236 static void exynos_drm_fbdev_destroy(struct drm_device
*dev
,
237 struct drm_fb_helper
*fb_helper
)
239 struct exynos_drm_fbdev
*exynos_fbd
= to_exynos_fbdev(fb_helper
);
240 struct exynos_drm_gem
*exynos_gem
= exynos_fbd
->exynos_gem
;
241 struct drm_framebuffer
*fb
;
243 vunmap(exynos_gem
->kvaddr
);
245 /* release drm framebuffer and real buffer */
246 if (fb_helper
->fb
&& fb_helper
->fb
->funcs
) {
249 drm_framebuffer_remove(fb
);
252 drm_fb_helper_unregister_fbi(fb_helper
);
254 drm_fb_helper_fini(fb_helper
);
257 void exynos_drm_fbdev_fini(struct drm_device
*dev
)
259 struct exynos_drm_private
*private = dev
->dev_private
;
260 struct exynos_drm_fbdev
*fbdev
;
262 if (!private || !private->fb_helper
)
265 fbdev
= to_exynos_fbdev(private->fb_helper
);
267 exynos_drm_fbdev_destroy(dev
, private->fb_helper
);
269 private->fb_helper
= NULL
;