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 * 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:
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
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.
30 #include <drm/drm_crtc.h>
31 #include <drm/drm_fb_helper.h>
32 #include <drm/drm_crtc_helper.h>
34 #include "exynos_drm_drv.h"
35 #include "exynos_drm_fb.h"
36 #include "exynos_drm_gem.h"
38 #define MAX_CONNECTOR 4
39 #define PREFERRED_BPP 32
41 #define to_exynos_fbdev(x) container_of(x, struct exynos_drm_fbdev,\
44 struct exynos_drm_fbdev
{
45 struct drm_fb_helper drm_fb_helper
;
46 struct exynos_drm_gem_obj
*exynos_gem_obj
;
49 static struct fb_ops exynos_drm_fb_ops
= {
51 .fb_fillrect
= cfb_fillrect
,
52 .fb_copyarea
= cfb_copyarea
,
53 .fb_imageblit
= cfb_imageblit
,
54 .fb_check_var
= drm_fb_helper_check_var
,
55 .fb_set_par
= drm_fb_helper_set_par
,
56 .fb_blank
= drm_fb_helper_blank
,
57 .fb_pan_display
= drm_fb_helper_pan_display
,
58 .fb_setcmap
= drm_fb_helper_setcmap
,
61 static int exynos_drm_fbdev_update(struct drm_fb_helper
*helper
,
62 struct drm_framebuffer
*fb
)
64 struct fb_info
*fbi
= helper
->fbdev
;
65 struct drm_device
*dev
= helper
->dev
;
66 struct exynos_drm_gem_buf
*buffer
;
67 unsigned int size
= fb
->width
* fb
->height
* (fb
->bits_per_pixel
>> 3);
70 DRM_DEBUG_KMS("%s\n", __FILE__
);
72 drm_fb_helper_fill_fix(fbi
, fb
->pitches
[0], fb
->depth
);
73 drm_fb_helper_fill_var(fbi
, helper
, fb
->width
, fb
->height
);
75 /* RGB formats use only one buffer */
76 buffer
= exynos_drm_fb_buffer(fb
, 0);
78 DRM_LOG_KMS("buffer is null.\n");
82 /* buffer count to framebuffer always is 1 at booting time. */
83 exynos_drm_fb_set_buf_cnt(fb
, 1);
85 offset
= fbi
->var
.xoffset
* (fb
->bits_per_pixel
>> 3);
86 offset
+= fbi
->var
.yoffset
* fb
->pitches
[0];
88 dev
->mode_config
.fb_base
= (resource_size_t
)buffer
->dma_addr
;
89 fbi
->screen_base
= buffer
->kvaddr
+ offset
;
90 fbi
->fix
.smem_start
= (unsigned long)(page_to_phys(buffer
->pages
[0]) +
92 fbi
->screen_size
= size
;
93 fbi
->fix
.smem_len
= size
;
98 static int exynos_drm_fbdev_create(struct drm_fb_helper
*helper
,
99 struct drm_fb_helper_surface_size
*sizes
)
101 struct exynos_drm_fbdev
*exynos_fbdev
= to_exynos_fbdev(helper
);
102 struct exynos_drm_gem_obj
*exynos_gem_obj
;
103 struct drm_device
*dev
= helper
->dev
;
105 struct drm_mode_fb_cmd2 mode_cmd
= { 0 };
106 struct platform_device
*pdev
= dev
->platformdev
;
110 DRM_DEBUG_KMS("%s\n", __FILE__
);
112 DRM_DEBUG_KMS("surface width(%d), height(%d) and bpp(%d\n",
113 sizes
->surface_width
, sizes
->surface_height
,
116 mode_cmd
.width
= sizes
->surface_width
;
117 mode_cmd
.height
= sizes
->surface_height
;
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
);
122 mutex_lock(&dev
->struct_mutex
);
124 fbi
= framebuffer_alloc(0, &pdev
->dev
);
126 DRM_ERROR("failed to allocate fb info.\n");
131 size
= mode_cmd
.pitches
[0] * mode_cmd
.height
;
133 /* 0 means to allocate physically continuous memory */
134 exynos_gem_obj
= exynos_drm_gem_create(dev
, 0, size
);
135 if (IS_ERR(exynos_gem_obj
)) {
136 ret
= PTR_ERR(exynos_gem_obj
);
140 exynos_fbdev
->exynos_gem_obj
= exynos_gem_obj
;
142 helper
->fb
= exynos_drm_framebuffer_init(dev
, &mode_cmd
,
143 &exynos_gem_obj
->base
);
144 if (IS_ERR_OR_NULL(helper
->fb
)) {
145 DRM_ERROR("failed to create drm framebuffer.\n");
146 ret
= PTR_ERR(helper
->fb
);
153 fbi
->flags
= FBINFO_FLAG_DEFAULT
;
154 fbi
->fbops
= &exynos_drm_fb_ops
;
156 ret
= fb_alloc_cmap(&fbi
->cmap
, 256, 0);
158 DRM_ERROR("failed to allocate cmap.\n");
162 ret
= exynos_drm_fbdev_update(helper
, helper
->fb
);
164 fb_dealloc_cmap(&fbi
->cmap
);
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.
174 mutex_unlock(&dev
->struct_mutex
);
178 static int exynos_drm_fbdev_probe(struct drm_fb_helper
*helper
,
179 struct drm_fb_helper_surface_size
*sizes
)
183 DRM_DEBUG_KMS("%s\n", __FILE__
);
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.
190 ret
= exynos_drm_fbdev_create(helper
, sizes
);
192 DRM_ERROR("failed to create fbdev.\n");
197 * fb_helper expects a value more than 1 if succeed
198 * because register_framebuffer() should be called.
206 static struct drm_fb_helper_funcs exynos_drm_fb_helper_funcs
= {
207 .fb_probe
= exynos_drm_fbdev_probe
,
210 int exynos_drm_fbdev_init(struct drm_device
*dev
)
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
;
218 DRM_DEBUG_KMS("%s\n", __FILE__
);
220 if (!dev
->mode_config
.num_crtc
|| !dev
->mode_config
.num_connector
)
223 fbdev
= kzalloc(sizeof(*fbdev
), GFP_KERNEL
);
225 DRM_ERROR("failed to allocate drm fbdev.\n");
229 private->fb_helper
= helper
= &fbdev
->drm_fb_helper
;
230 helper
->funcs
= &exynos_drm_fb_helper_funcs
;
232 num_crtc
= dev
->mode_config
.num_crtc
;
234 ret
= drm_fb_helper_init(dev
, helper
, num_crtc
, MAX_CONNECTOR
);
236 DRM_ERROR("failed to initialize drm fb helper.\n");
240 ret
= drm_fb_helper_single_add_all_connectors(helper
);
242 DRM_ERROR("failed to register drm_fb_helper_connector.\n");
247 ret
= drm_fb_helper_initial_config(helper
, PREFERRED_BPP
);
249 DRM_ERROR("failed to set up hw configuration.\n");
256 drm_fb_helper_fini(helper
);
259 private->fb_helper
= NULL
;
265 static void exynos_drm_fbdev_destroy(struct drm_device
*dev
,
266 struct drm_fb_helper
*fb_helper
)
268 struct drm_framebuffer
*fb
;
270 /* release drm framebuffer and real buffer */
271 if (fb_helper
->fb
&& fb_helper
->fb
->funcs
) {
274 drm_framebuffer_remove(fb
);
277 /* release linux framebuffer */
278 if (fb_helper
->fbdev
) {
279 struct fb_info
*info
;
282 info
= fb_helper
->fbdev
;
283 ret
= unregister_framebuffer(info
);
285 DRM_DEBUG_KMS("failed unregister_framebuffer()\n");
288 fb_dealloc_cmap(&info
->cmap
);
290 framebuffer_release(info
);
293 drm_fb_helper_fini(fb_helper
);
296 void exynos_drm_fbdev_fini(struct drm_device
*dev
)
298 struct exynos_drm_private
*private = dev
->dev_private
;
299 struct exynos_drm_fbdev
*fbdev
;
301 if (!private || !private->fb_helper
)
304 fbdev
= to_exynos_fbdev(private->fb_helper
);
306 if (fbdev
->exynos_gem_obj
)
307 exynos_drm_gem_destroy(fbdev
->exynos_gem_obj
);
309 exynos_drm_fbdev_destroy(dev
, private->fb_helper
);
311 private->fb_helper
= NULL
;
314 void exynos_drm_fbdev_restore_mode(struct drm_device
*dev
)
316 struct exynos_drm_private
*private = dev
->dev_private
;
318 if (!private || !private->fb_helper
)
321 drm_fb_helper_restore_fbdev_mode(private->fb_helper
);