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
29#include "drmP.h"
30#include "drm_crtc.h"
31#include "drm_fb_helper.h"
32#include "drm_crtc_helper.h"
33
34#include "exynos_drm_drv.h"
35#include "exynos_drm_fb.h"
36#include "exynos_drm_gem.h"
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
44struct exynos_drm_fbdev {
45	struct drm_fb_helper		drm_fb_helper;
46	struct exynos_drm_gem_obj	*exynos_gem_obj;
47};
48
49static 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,
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,
59};
60
61static int exynos_drm_fbdev_update(struct drm_fb_helper *helper,
62				     struct drm_framebuffer *fb)
63{
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);
68	unsigned long offset;
69
70	DRM_DEBUG_KMS("%s\n", __FILE__);
71
72	drm_fb_helper_fill_fix(fbi, fb->pitches[0], fb->depth);
73	drm_fb_helper_fill_var(fbi, helper, fb->width, fb->height);
74
75	/* RGB formats use only one buffer */
76	buffer = exynos_drm_fb_buffer(fb, 0);
77	if (!buffer) {
78		DRM_LOG_KMS("buffer is null.\n");
79		return -EFAULT;
80	}
81
82	offset = fbi->var.xoffset * (fb->bits_per_pixel >> 3);
83	offset += fbi->var.yoffset * fb->pitches[0];
84
85	dev->mode_config.fb_base = (resource_size_t)buffer->dma_addr;
86	fbi->screen_base = buffer->kvaddr + offset;
87	fbi->fix.smem_start = (unsigned long)(buffer->dma_addr + offset);
88	fbi->screen_size = size;
89	fbi->fix.smem_len = size;
90
91	return 0;
92}
93
94static int exynos_drm_fbdev_create(struct drm_fb_helper *helper,
95				    struct drm_fb_helper_surface_size *sizes)
96{
97	struct exynos_drm_fbdev *exynos_fbdev = to_exynos_fbdev(helper);
98	struct exynos_drm_gem_obj *exynos_gem_obj;
99	struct drm_device *dev = helper->dev;
100	struct fb_info *fbi;
101	struct drm_mode_fb_cmd2 mode_cmd = { 0 };
102	struct platform_device *pdev = dev->platformdev;
103	unsigned long size;
104	int ret;
105
106	DRM_DEBUG_KMS("%s\n", __FILE__);
107
108	DRM_DEBUG_KMS("surface width(%d), height(%d) and bpp(%d\n",
109			sizes->surface_width, sizes->surface_height,
110			sizes->surface_bpp);
111
112	mode_cmd.width = sizes->surface_width;
113	mode_cmd.height = sizes->surface_height;
114	mode_cmd.pitches[0] = sizes->surface_width * (sizes->surface_bpp >> 3);
115	mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
116							  sizes->surface_depth);
117
118	mutex_lock(&dev->struct_mutex);
119
120	fbi = framebuffer_alloc(0, &pdev->dev);
121	if (!fbi) {
122		DRM_ERROR("failed to allocate fb info.\n");
123		ret = -ENOMEM;
124		goto out;
125	}
126
127	size = mode_cmd.pitches[0] * mode_cmd.height;
128
129	/* 0 means to allocate physically continuous memory */
130	exynos_gem_obj = exynos_drm_gem_create(dev, 0, size);
131	if (IS_ERR(exynos_gem_obj)) {
132		ret = PTR_ERR(exynos_gem_obj);
133		goto out;
134	}
135
136	exynos_fbdev->exynos_gem_obj = exynos_gem_obj;
137
138	helper->fb = exynos_drm_framebuffer_init(dev, &mode_cmd,
139			&exynos_gem_obj->base);
140	if (IS_ERR_OR_NULL(helper->fb)) {
141		DRM_ERROR("failed to create drm framebuffer.\n");
142		ret = PTR_ERR(helper->fb);
143		goto out;
144	}
145
146	helper->fbdev = fbi;
147
148	fbi->par = helper;
149	fbi->flags = FBINFO_FLAG_DEFAULT;
150	fbi->fbops = &exynos_drm_fb_ops;
151
152	ret = fb_alloc_cmap(&fbi->cmap, 256, 0);
153	if (ret) {
154		DRM_ERROR("failed to allocate cmap.\n");
155		goto out;
156	}
157
158	ret = exynos_drm_fbdev_update(helper, helper->fb);
159	if (ret < 0) {
160		fb_dealloc_cmap(&fbi->cmap);
161		goto out;
162	}
163
164/*
165 * if failed, all resources allocated above would be released by
166 * drm_mode_config_cleanup() when drm_load() had been called prior
167 * to any specific driver such as fimd or hdmi driver.
168 */
169out:
170	mutex_unlock(&dev->struct_mutex);
171	return ret;
172}
173
174static int exynos_drm_fbdev_probe(struct drm_fb_helper *helper,
175				   struct drm_fb_helper_surface_size *sizes)
176{
177	int ret = 0;
178
179	DRM_DEBUG_KMS("%s\n", __FILE__);
180
181	/*
182	 * with !helper->fb, it means that this funcion is called first time
183	 * and after that, the helper->fb would be used as clone mode.
184	 */
185	if (!helper->fb) {
186		ret = exynos_drm_fbdev_create(helper, sizes);
187		if (ret < 0) {
188			DRM_ERROR("failed to create fbdev.\n");
189			return ret;
190		}
191
192		/*
193		 * fb_helper expects a value more than 1 if succeed
194		 * because register_framebuffer() should be called.
195		 */
196		ret = 1;
197	}
198
199	return ret;
200}
201
202static struct drm_fb_helper_funcs exynos_drm_fb_helper_funcs = {
203	.fb_probe =	exynos_drm_fbdev_probe,
204};
205
206int exynos_drm_fbdev_init(struct drm_device *dev)
207{
208	struct exynos_drm_fbdev *fbdev;
209	struct exynos_drm_private *private = dev->dev_private;
210	struct drm_fb_helper *helper;
211	unsigned int num_crtc;
212	int ret;
213
214	DRM_DEBUG_KMS("%s\n", __FILE__);
215
216	if (!dev->mode_config.num_crtc || !dev->mode_config.num_connector)
217		return 0;
218
219	fbdev = kzalloc(sizeof(*fbdev), GFP_KERNEL);
220	if (!fbdev) {
221		DRM_ERROR("failed to allocate drm fbdev.\n");
222		return -ENOMEM;
223	}
224
225	private->fb_helper = helper = &fbdev->drm_fb_helper;
226	helper->funcs = &exynos_drm_fb_helper_funcs;
227
228	num_crtc = dev->mode_config.num_crtc;
229
230	ret = drm_fb_helper_init(dev, helper, num_crtc, MAX_CONNECTOR);
231	if (ret < 0) {
232		DRM_ERROR("failed to initialize drm fb helper.\n");
233		goto err_init;
234	}
235
236	ret = drm_fb_helper_single_add_all_connectors(helper);
237	if (ret < 0) {
238		DRM_ERROR("failed to register drm_fb_helper_connector.\n");
239		goto err_setup;
240
241	}
242
243	ret = drm_fb_helper_initial_config(helper, PREFERRED_BPP);
244	if (ret < 0) {
245		DRM_ERROR("failed to set up hw configuration.\n");
246		goto err_setup;
247	}
248
249	return 0;
250
251err_setup:
252	drm_fb_helper_fini(helper);
253
254err_init:
255	private->fb_helper = NULL;
256	kfree(fbdev);
257
258	return ret;
259}
260
261static void exynos_drm_fbdev_destroy(struct drm_device *dev,
262				      struct drm_fb_helper *fb_helper)
263{
264	struct drm_framebuffer *fb;
265
266	/* release drm framebuffer and real buffer */
267	if (fb_helper->fb && fb_helper->fb->funcs) {
268		fb = fb_helper->fb;
269		if (fb && fb->funcs->destroy)
270			fb->funcs->destroy(fb);
271	}
272
273	/* release linux framebuffer */
274	if (fb_helper->fbdev) {
275		struct fb_info *info;
276		int ret;
277
278		info = fb_helper->fbdev;
279		ret = unregister_framebuffer(info);
280		if (ret < 0)
281			DRM_DEBUG_KMS("failed unregister_framebuffer()\n");
282
283		if (info->cmap.len)
284			fb_dealloc_cmap(&info->cmap);
285
286		framebuffer_release(info);
287	}
288
289	drm_fb_helper_fini(fb_helper);
290}
291
292void exynos_drm_fbdev_fini(struct drm_device *dev)
293{
294	struct exynos_drm_private *private = dev->dev_private;
295	struct exynos_drm_fbdev *fbdev;
296
297	if (!private || !private->fb_helper)
298		return;
299
300	fbdev = to_exynos_fbdev(private->fb_helper);
301
302	if (fbdev->exynos_gem_obj)
303		exynos_drm_gem_destroy(fbdev->exynos_gem_obj);
304
305	exynos_drm_fbdev_destroy(dev, private->fb_helper);
306	kfree(fbdev);
307	private->fb_helper = NULL;
308}
309
310void exynos_drm_fbdev_restore_mode(struct drm_device *dev)
311{
312	struct exynos_drm_private *private = dev->dev_private;
313
314	if (!private || !private->fb_helper)
315		return;
316
317	drm_fb_helper_restore_fbdev_mode(private->fb_helper);
318}
319