1/*
2 * Copyright (C) 2012 Russell King
3 *  Written from the i915 driver.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 */
9#include <linux/errno.h>
10#include <linux/fb.h>
11#include <linux/kernel.h>
12#include <linux/module.h>
13
14#include <drm/drmP.h>
15#include <drm/drm_fb_helper.h>
16#include "armada_crtc.h"
17#include "armada_drm.h"
18#include "armada_fb.h"
19#include "armada_gem.h"
20
21static /*const*/ struct fb_ops armada_fb_ops = {
22	.owner		= THIS_MODULE,
23	.fb_check_var	= drm_fb_helper_check_var,
24	.fb_set_par	= drm_fb_helper_set_par,
25	.fb_fillrect	= drm_fb_helper_cfb_fillrect,
26	.fb_copyarea	= drm_fb_helper_cfb_copyarea,
27	.fb_imageblit	= drm_fb_helper_cfb_imageblit,
28	.fb_pan_display	= drm_fb_helper_pan_display,
29	.fb_blank	= drm_fb_helper_blank,
30	.fb_setcmap	= drm_fb_helper_setcmap,
31	.fb_debug_enter	= drm_fb_helper_debug_enter,
32	.fb_debug_leave	= drm_fb_helper_debug_leave,
33};
34
35static int armada_fb_create(struct drm_fb_helper *fbh,
36	struct drm_fb_helper_surface_size *sizes)
37{
38	struct drm_device *dev = fbh->dev;
39	struct drm_mode_fb_cmd2 mode;
40	struct armada_framebuffer *dfb;
41	struct armada_gem_object *obj;
42	struct fb_info *info;
43	int size, ret;
44	void *ptr;
45
46	memset(&mode, 0, sizeof(mode));
47	mode.width = sizes->surface_width;
48	mode.height = sizes->surface_height;
49	mode.pitches[0] = armada_pitch(mode.width, sizes->surface_bpp);
50	mode.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
51					sizes->surface_depth);
52
53	size = mode.pitches[0] * mode.height;
54	obj = armada_gem_alloc_private_object(dev, size);
55	if (!obj) {
56		DRM_ERROR("failed to allocate fb memory\n");
57		return -ENOMEM;
58	}
59
60	ret = armada_gem_linear_back(dev, obj);
61	if (ret) {
62		drm_gem_object_unreference_unlocked(&obj->obj);
63		return ret;
64	}
65
66	ptr = armada_gem_map_object(dev, obj);
67	if (!ptr) {
68		drm_gem_object_unreference_unlocked(&obj->obj);
69		return -ENOMEM;
70	}
71
72	dfb = armada_framebuffer_create(dev, &mode, obj);
73
74	/*
75	 * A reference is now held by the framebuffer object if
76	 * successful, otherwise this drops the ref for the error path.
77	 */
78	drm_gem_object_unreference_unlocked(&obj->obj);
79
80	if (IS_ERR(dfb))
81		return PTR_ERR(dfb);
82
83	info = drm_fb_helper_alloc_fbi(fbh);
84	if (IS_ERR(info)) {
85		ret = PTR_ERR(info);
86		goto err_fballoc;
87	}
88
89	strlcpy(info->fix.id, "armada-drmfb", sizeof(info->fix.id));
90	info->par = fbh;
91	info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT;
92	info->fbops = &armada_fb_ops;
93	info->fix.smem_start = obj->phys_addr;
94	info->fix.smem_len = obj->obj.size;
95	info->screen_size = obj->obj.size;
96	info->screen_base = ptr;
97	fbh->fb = &dfb->fb;
98
99	drm_fb_helper_fill_fix(info, dfb->fb.pitches[0], dfb->fb.depth);
100	drm_fb_helper_fill_var(info, fbh, sizes->fb_width, sizes->fb_height);
101
102	DRM_DEBUG_KMS("allocated %dx%d %dbpp fb: 0x%08llx\n",
103		dfb->fb.width, dfb->fb.height, dfb->fb.bits_per_pixel,
104		(unsigned long long)obj->phys_addr);
105
106	return 0;
107
108 err_fballoc:
109	dfb->fb.funcs->destroy(&dfb->fb);
110	return ret;
111}
112
113static int armada_fb_probe(struct drm_fb_helper *fbh,
114	struct drm_fb_helper_surface_size *sizes)
115{
116	int ret = 0;
117
118	if (!fbh->fb) {
119		ret = armada_fb_create(fbh, sizes);
120		if (ret == 0)
121			ret = 1;
122	}
123	return ret;
124}
125
126static const struct drm_fb_helper_funcs armada_fb_helper_funcs = {
127	.gamma_set	= armada_drm_crtc_gamma_set,
128	.gamma_get	= armada_drm_crtc_gamma_get,
129	.fb_probe	= armada_fb_probe,
130};
131
132int armada_fbdev_init(struct drm_device *dev)
133{
134	struct armada_private *priv = dev->dev_private;
135	struct drm_fb_helper *fbh;
136	int ret;
137
138	fbh = devm_kzalloc(dev->dev, sizeof(*fbh), GFP_KERNEL);
139	if (!fbh)
140		return -ENOMEM;
141
142	priv->fbdev = fbh;
143
144	drm_fb_helper_prepare(dev, fbh, &armada_fb_helper_funcs);
145
146	ret = drm_fb_helper_init(dev, fbh, 1, 1);
147	if (ret) {
148		DRM_ERROR("failed to initialize drm fb helper\n");
149		goto err_fb_helper;
150	}
151
152	ret = drm_fb_helper_single_add_all_connectors(fbh);
153	if (ret) {
154		DRM_ERROR("failed to add fb connectors\n");
155		goto err_fb_setup;
156	}
157
158	ret = drm_fb_helper_initial_config(fbh, 32);
159	if (ret) {
160		DRM_ERROR("failed to set initial config\n");
161		goto err_fb_setup;
162	}
163
164	return 0;
165 err_fb_setup:
166	drm_fb_helper_release_fbi(fbh);
167	drm_fb_helper_fini(fbh);
168 err_fb_helper:
169	priv->fbdev = NULL;
170	return ret;
171}
172
173void armada_fbdev_lastclose(struct drm_device *dev)
174{
175	struct armada_private *priv = dev->dev_private;
176
177	if (priv->fbdev)
178		drm_fb_helper_restore_fbdev_mode_unlocked(priv->fbdev);
179}
180
181void armada_fbdev_fini(struct drm_device *dev)
182{
183	struct armada_private *priv = dev->dev_private;
184	struct drm_fb_helper *fbh = priv->fbdev;
185
186	if (fbh) {
187		drm_fb_helper_unregister_fbi(fbh);
188		drm_fb_helper_release_fbi(fbh);
189
190		drm_fb_helper_fini(fbh);
191
192		if (fbh->fb)
193			fbh->fb->funcs->destroy(fbh->fb);
194
195		priv->fbdev = NULL;
196	}
197}
198