2 * Copyright (C) 2012 Russell King
3 * Written from the i915 driver.
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.
9 #include <linux/errno.h>
10 #include <linux/kernel.h>
11 #include <linux/module.h>
14 #include <drm/drm_fb_helper.h>
15 #include "armada_crtc.h"
16 #include "armada_drm.h"
17 #include "armada_fb.h"
18 #include "armada_gem.h"
20 static /*const*/ struct fb_ops armada_fb_ops
= {
22 DRM_FB_HELPER_DEFAULT_OPS
,
23 .fb_fillrect
= drm_fb_helper_cfb_fillrect
,
24 .fb_copyarea
= drm_fb_helper_cfb_copyarea
,
25 .fb_imageblit
= drm_fb_helper_cfb_imageblit
,
28 static int armada_fb_create(struct drm_fb_helper
*fbh
,
29 struct drm_fb_helper_surface_size
*sizes
)
31 struct drm_device
*dev
= fbh
->dev
;
32 struct drm_mode_fb_cmd2 mode
;
33 struct armada_framebuffer
*dfb
;
34 struct armada_gem_object
*obj
;
39 memset(&mode
, 0, sizeof(mode
));
40 mode
.width
= sizes
->surface_width
;
41 mode
.height
= sizes
->surface_height
;
42 mode
.pitches
[0] = armada_pitch(mode
.width
, sizes
->surface_bpp
);
43 mode
.pixel_format
= drm_mode_legacy_fb_format(sizes
->surface_bpp
,
44 sizes
->surface_depth
);
46 size
= mode
.pitches
[0] * mode
.height
;
47 obj
= armada_gem_alloc_private_object(dev
, size
);
49 DRM_ERROR("failed to allocate fb memory\n");
53 ret
= armada_gem_linear_back(dev
, obj
);
55 drm_gem_object_unreference_unlocked(&obj
->obj
);
59 ptr
= armada_gem_map_object(dev
, obj
);
61 drm_gem_object_unreference_unlocked(&obj
->obj
);
65 dfb
= armada_framebuffer_create(dev
, &mode
, obj
);
68 * A reference is now held by the framebuffer object if
69 * successful, otherwise this drops the ref for the error path.
71 drm_gem_object_unreference_unlocked(&obj
->obj
);
76 info
= drm_fb_helper_alloc_fbi(fbh
);
82 strlcpy(info
->fix
.id
, "armada-drmfb", sizeof(info
->fix
.id
));
84 info
->flags
= FBINFO_DEFAULT
| FBINFO_CAN_FORCE_OUTPUT
;
85 info
->fbops
= &armada_fb_ops
;
86 info
->fix
.smem_start
= obj
->phys_addr
;
87 info
->fix
.smem_len
= obj
->obj
.size
;
88 info
->screen_size
= obj
->obj
.size
;
89 info
->screen_base
= ptr
;
92 drm_fb_helper_fill_fix(info
, dfb
->fb
.pitches
[0],
93 dfb
->fb
.format
->depth
);
94 drm_fb_helper_fill_var(info
, fbh
, sizes
->fb_width
, sizes
->fb_height
);
96 DRM_DEBUG_KMS("allocated %dx%d %dbpp fb: 0x%08llx\n",
97 dfb
->fb
.width
, dfb
->fb
.height
, dfb
->fb
.format
->cpp
[0] * 8,
98 (unsigned long long)obj
->phys_addr
);
103 dfb
->fb
.funcs
->destroy(&dfb
->fb
);
107 static int armada_fb_probe(struct drm_fb_helper
*fbh
,
108 struct drm_fb_helper_surface_size
*sizes
)
113 ret
= armada_fb_create(fbh
, sizes
);
120 static const struct drm_fb_helper_funcs armada_fb_helper_funcs
= {
121 .gamma_set
= armada_drm_crtc_gamma_set
,
122 .gamma_get
= armada_drm_crtc_gamma_get
,
123 .fb_probe
= armada_fb_probe
,
126 int armada_fbdev_init(struct drm_device
*dev
)
128 struct armada_private
*priv
= dev
->dev_private
;
129 struct drm_fb_helper
*fbh
;
132 fbh
= devm_kzalloc(dev
->dev
, sizeof(*fbh
), GFP_KERNEL
);
138 drm_fb_helper_prepare(dev
, fbh
, &armada_fb_helper_funcs
);
140 ret
= drm_fb_helper_init(dev
, fbh
, 1);
142 DRM_ERROR("failed to initialize drm fb helper\n");
146 ret
= drm_fb_helper_single_add_all_connectors(fbh
);
148 DRM_ERROR("failed to add fb connectors\n");
152 ret
= drm_fb_helper_initial_config(fbh
, 32);
154 DRM_ERROR("failed to set initial config\n");
160 drm_fb_helper_fini(fbh
);
166 void armada_fbdev_lastclose(struct drm_device
*dev
)
168 struct armada_private
*priv
= dev
->dev_private
;
171 drm_fb_helper_restore_fbdev_mode_unlocked(priv
->fbdev
);
174 void armada_fbdev_fini(struct drm_device
*dev
)
176 struct armada_private
*priv
= dev
->dev_private
;
177 struct drm_fb_helper
*fbh
= priv
->fbdev
;
180 drm_fb_helper_unregister_fbi(fbh
);
182 drm_fb_helper_fini(fbh
);
185 fbh
->fb
->funcs
->destroy(fbh
->fb
);