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 .fb_check_var
= drm_fb_helper_check_var
,
23 .fb_set_par
= drm_fb_helper_set_par
,
24 .fb_fillrect
= drm_fb_helper_cfb_fillrect
,
25 .fb_copyarea
= drm_fb_helper_cfb_copyarea
,
26 .fb_imageblit
= drm_fb_helper_cfb_imageblit
,
27 .fb_pan_display
= drm_fb_helper_pan_display
,
28 .fb_blank
= drm_fb_helper_blank
,
29 .fb_setcmap
= drm_fb_helper_setcmap
,
30 .fb_debug_enter
= drm_fb_helper_debug_enter
,
31 .fb_debug_leave
= drm_fb_helper_debug_leave
,
34 static int armada_fb_create(struct drm_fb_helper
*fbh
,
35 struct drm_fb_helper_surface_size
*sizes
)
37 struct drm_device
*dev
= fbh
->dev
;
38 struct drm_mode_fb_cmd2 mode
;
39 struct armada_framebuffer
*dfb
;
40 struct armada_gem_object
*obj
;
45 memset(&mode
, 0, sizeof(mode
));
46 mode
.width
= sizes
->surface_width
;
47 mode
.height
= sizes
->surface_height
;
48 mode
.pitches
[0] = armada_pitch(mode
.width
, sizes
->surface_bpp
);
49 mode
.pixel_format
= drm_mode_legacy_fb_format(sizes
->surface_bpp
,
50 sizes
->surface_depth
);
52 size
= mode
.pitches
[0] * mode
.height
;
53 obj
= armada_gem_alloc_private_object(dev
, size
);
55 DRM_ERROR("failed to allocate fb memory\n");
59 ret
= armada_gem_linear_back(dev
, obj
);
61 drm_gem_object_unreference_unlocked(&obj
->obj
);
65 ptr
= armada_gem_map_object(dev
, obj
);
67 drm_gem_object_unreference_unlocked(&obj
->obj
);
71 dfb
= armada_framebuffer_create(dev
, &mode
, obj
);
74 * A reference is now held by the framebuffer object if
75 * successful, otherwise this drops the ref for the error path.
77 drm_gem_object_unreference_unlocked(&obj
->obj
);
82 info
= drm_fb_helper_alloc_fbi(fbh
);
88 strlcpy(info
->fix
.id
, "armada-drmfb", sizeof(info
->fix
.id
));
90 info
->flags
= FBINFO_DEFAULT
| FBINFO_CAN_FORCE_OUTPUT
;
91 info
->fbops
= &armada_fb_ops
;
92 info
->fix
.smem_start
= obj
->phys_addr
;
93 info
->fix
.smem_len
= obj
->obj
.size
;
94 info
->screen_size
= obj
->obj
.size
;
95 info
->screen_base
= ptr
;
98 drm_fb_helper_fill_fix(info
, dfb
->fb
.pitches
[0], dfb
->fb
.depth
);
99 drm_fb_helper_fill_var(info
, fbh
, sizes
->fb_width
, sizes
->fb_height
);
101 DRM_DEBUG_KMS("allocated %dx%d %dbpp fb: 0x%08llx\n",
102 dfb
->fb
.width
, dfb
->fb
.height
, dfb
->fb
.bits_per_pixel
,
103 (unsigned long long)obj
->phys_addr
);
108 dfb
->fb
.funcs
->destroy(&dfb
->fb
);
112 static int armada_fb_probe(struct drm_fb_helper
*fbh
,
113 struct drm_fb_helper_surface_size
*sizes
)
118 ret
= armada_fb_create(fbh
, sizes
);
125 static const struct drm_fb_helper_funcs armada_fb_helper_funcs
= {
126 .gamma_set
= armada_drm_crtc_gamma_set
,
127 .gamma_get
= armada_drm_crtc_gamma_get
,
128 .fb_probe
= armada_fb_probe
,
131 int armada_fbdev_init(struct drm_device
*dev
)
133 struct armada_private
*priv
= dev
->dev_private
;
134 struct drm_fb_helper
*fbh
;
137 fbh
= devm_kzalloc(dev
->dev
, sizeof(*fbh
), GFP_KERNEL
);
143 drm_fb_helper_prepare(dev
, fbh
, &armada_fb_helper_funcs
);
145 ret
= drm_fb_helper_init(dev
, fbh
, 1, 1);
147 DRM_ERROR("failed to initialize drm fb helper\n");
151 ret
= drm_fb_helper_single_add_all_connectors(fbh
);
153 DRM_ERROR("failed to add fb connectors\n");
157 ret
= drm_fb_helper_initial_config(fbh
, 32);
159 DRM_ERROR("failed to set initial config\n");
165 drm_fb_helper_release_fbi(fbh
);
166 drm_fb_helper_fini(fbh
);
172 void armada_fbdev_lastclose(struct drm_device
*dev
)
174 struct armada_private
*priv
= dev
->dev_private
;
177 drm_fb_helper_restore_fbdev_mode_unlocked(priv
->fbdev
);
180 void armada_fbdev_fini(struct drm_device
*dev
)
182 struct armada_private
*priv
= dev
->dev_private
;
183 struct drm_fb_helper
*fbh
= priv
->fbdev
;
186 drm_fb_helper_unregister_fbi(fbh
);
187 drm_fb_helper_release_fbi(fbh
);
189 drm_fb_helper_fini(fbh
);
192 fbh
->fb
->funcs
->destroy(fbh
->fb
);