2 * Copyright 2012 Red Hat Inc.
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the
6 * "Software"), to deal in the Software without restriction, including
7 * without limitation the rights to use, copy, modify, merge, publish,
8 * distribute, sub license, and/or sell copies of the Software, and to
9 * permit persons to whom the Software is furnished to do so, subject to
10 * the following conditions:
12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
13 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
14 * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
15 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
16 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
17 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
18 * USE OR OTHER DEALINGS IN THE SOFTWARE.
20 * The above copyright notice and this permission notice (including the
21 * next paragraph) shall be included in all copies or substantial portions
26 * Authors: Dave Airlie <airlied@redhat.com>
28 #include <linux/module.h>
29 #include <linux/kernel.h>
30 #include <linux/errno.h>
31 #include <linux/string.h>
33 #include <linux/tty.h>
34 #include <linux/sysrq.h>
35 #include <linux/delay.h>
37 #include <linux/init.h>
41 #include <drm/drm_crtc.h>
42 #include <drm/drm_fb_helper.h>
43 #include <drm/drm_crtc_helper.h>
46 static void ast_dirty_update(struct ast_fbdev
*afbdev
,
47 int x
, int y
, int width
, int height
)
50 struct drm_gem_object
*obj
;
52 int src_offset
, dst_offset
;
53 int bpp
= (afbdev
->afb
.base
.bits_per_pixel
+ 7)/8;
56 bool store_for_later
= false;
60 obj
= afbdev
->afb
.obj
;
61 bo
= gem_to_ast_bo(obj
);
64 * try and reserve the BO, if we fail with busy
65 * then the BO is being moved and we should
66 * store up the damage until later.
69 ret
= ast_bo_reserve(bo
, true);
74 store_for_later
= true;
79 spin_lock_irqsave(&afbdev
->dirty_lock
, flags
);
90 if (store_for_later
) {
95 spin_unlock_irqrestore(&afbdev
->dirty_lock
, flags
);
99 afbdev
->x1
= afbdev
->y1
= INT_MAX
;
100 afbdev
->x2
= afbdev
->y2
= 0;
101 spin_unlock_irqrestore(&afbdev
->dirty_lock
, flags
);
103 if (!bo
->kmap
.virtual) {
104 ret
= ttm_bo_kmap(&bo
->bo
, 0, bo
->bo
.num_pages
, &bo
->kmap
);
106 DRM_ERROR("failed to kmap fb updates\n");
107 ast_bo_unreserve(bo
);
112 for (i
= y
; i
<= y2
; i
++) {
113 /* assume equal stride for now */
114 src_offset
= dst_offset
= i
* afbdev
->afb
.base
.pitches
[0] + (x
* bpp
);
115 memcpy_toio(bo
->kmap
.virtual + src_offset
, afbdev
->sysram
+ src_offset
, (x2
- x
+ 1) * bpp
);
119 ttm_bo_kunmap(&bo
->kmap
);
121 ast_bo_unreserve(bo
);
124 static void ast_fillrect(struct fb_info
*info
,
125 const struct fb_fillrect
*rect
)
127 struct ast_fbdev
*afbdev
= info
->par
;
128 sys_fillrect(info
, rect
);
129 ast_dirty_update(afbdev
, rect
->dx
, rect
->dy
, rect
->width
,
133 static void ast_copyarea(struct fb_info
*info
,
134 const struct fb_copyarea
*area
)
136 struct ast_fbdev
*afbdev
= info
->par
;
137 sys_copyarea(info
, area
);
138 ast_dirty_update(afbdev
, area
->dx
, area
->dy
, area
->width
,
142 static void ast_imageblit(struct fb_info
*info
,
143 const struct fb_image
*image
)
145 struct ast_fbdev
*afbdev
= info
->par
;
146 sys_imageblit(info
, image
);
147 ast_dirty_update(afbdev
, image
->dx
, image
->dy
, image
->width
,
151 static struct fb_ops astfb_ops
= {
152 .owner
= THIS_MODULE
,
153 .fb_check_var
= drm_fb_helper_check_var
,
154 .fb_set_par
= drm_fb_helper_set_par
,
155 .fb_fillrect
= ast_fillrect
,
156 .fb_copyarea
= ast_copyarea
,
157 .fb_imageblit
= ast_imageblit
,
158 .fb_pan_display
= drm_fb_helper_pan_display
,
159 .fb_blank
= drm_fb_helper_blank
,
160 .fb_setcmap
= drm_fb_helper_setcmap
,
161 .fb_debug_enter
= drm_fb_helper_debug_enter
,
162 .fb_debug_leave
= drm_fb_helper_debug_leave
,
165 static int astfb_create_object(struct ast_fbdev
*afbdev
,
166 struct drm_mode_fb_cmd2
*mode_cmd
,
167 struct drm_gem_object
**gobj_p
)
169 struct drm_device
*dev
= afbdev
->helper
.dev
;
172 struct drm_gem_object
*gobj
;
175 drm_fb_get_bpp_depth(mode_cmd
->pixel_format
, &depth
, &bpp
);
177 size
= mode_cmd
->pitches
[0] * mode_cmd
->height
;
178 ret
= ast_gem_create(dev
, size
, true, &gobj
);
186 static int astfb_create(struct drm_fb_helper
*helper
,
187 struct drm_fb_helper_surface_size
*sizes
)
189 struct ast_fbdev
*afbdev
=
190 container_of(helper
, struct ast_fbdev
, helper
);
191 struct drm_device
*dev
= afbdev
->helper
.dev
;
192 struct drm_mode_fb_cmd2 mode_cmd
;
193 struct drm_framebuffer
*fb
;
194 struct fb_info
*info
;
196 struct device
*device
= &dev
->pdev
->dev
;
198 struct drm_gem_object
*gobj
= NULL
;
199 struct ast_bo
*bo
= NULL
;
200 mode_cmd
.width
= sizes
->surface_width
;
201 mode_cmd
.height
= sizes
->surface_height
;
202 mode_cmd
.pitches
[0] = mode_cmd
.width
* ((sizes
->surface_bpp
+ 7)/8);
204 mode_cmd
.pixel_format
= drm_mode_legacy_fb_format(sizes
->surface_bpp
,
205 sizes
->surface_depth
);
207 size
= mode_cmd
.pitches
[0] * mode_cmd
.height
;
209 ret
= astfb_create_object(afbdev
, &mode_cmd
, &gobj
);
211 DRM_ERROR("failed to create fbcon backing object %d\n", ret
);
214 bo
= gem_to_ast_bo(gobj
);
216 sysram
= vmalloc(size
);
220 info
= framebuffer_alloc(0, device
);
227 ret
= ast_framebuffer_init(dev
, &afbdev
->afb
, &mode_cmd
, gobj
);
231 afbdev
->sysram
= sysram
;
234 fb
= &afbdev
->afb
.base
;
235 afbdev
->helper
.fb
= fb
;
236 afbdev
->helper
.fbdev
= info
;
238 strcpy(info
->fix
.id
, "astdrmfb");
240 info
->flags
= FBINFO_DEFAULT
| FBINFO_CAN_FORCE_OUTPUT
;
241 info
->fbops
= &astfb_ops
;
243 ret
= fb_alloc_cmap(&info
->cmap
, 256, 0);
249 info
->apertures
= alloc_apertures(1);
250 if (!info
->apertures
) {
254 info
->apertures
->ranges
[0].base
= pci_resource_start(dev
->pdev
, 0);
255 info
->apertures
->ranges
[0].size
= pci_resource_len(dev
->pdev
, 0);
257 drm_fb_helper_fill_fix(info
, fb
->pitches
[0], fb
->depth
);
258 drm_fb_helper_fill_var(info
, &afbdev
->helper
, sizes
->fb_width
, sizes
->fb_height
);
260 info
->screen_base
= sysram
;
261 info
->screen_size
= size
;
263 info
->pixmap
.flags
= FB_PIXMAP_SYSTEM
;
265 DRM_DEBUG_KMS("allocated %dx%d\n",
266 fb
->width
, fb
->height
);
273 static void ast_fb_gamma_set(struct drm_crtc
*crtc
, u16 red
, u16 green
,
276 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
277 ast_crtc
->lut_r
[regno
] = red
>> 8;
278 ast_crtc
->lut_g
[regno
] = green
>> 8;
279 ast_crtc
->lut_b
[regno
] = blue
>> 8;
282 static void ast_fb_gamma_get(struct drm_crtc
*crtc
, u16
*red
, u16
*green
,
283 u16
*blue
, int regno
)
285 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
286 *red
= ast_crtc
->lut_r
[regno
] << 8;
287 *green
= ast_crtc
->lut_g
[regno
] << 8;
288 *blue
= ast_crtc
->lut_b
[regno
] << 8;
291 static const struct drm_fb_helper_funcs ast_fb_helper_funcs
= {
292 .gamma_set
= ast_fb_gamma_set
,
293 .gamma_get
= ast_fb_gamma_get
,
294 .fb_probe
= astfb_create
,
297 static void ast_fbdev_destroy(struct drm_device
*dev
,
298 struct ast_fbdev
*afbdev
)
300 struct fb_info
*info
;
301 struct ast_framebuffer
*afb
= &afbdev
->afb
;
302 if (afbdev
->helper
.fbdev
) {
303 info
= afbdev
->helper
.fbdev
;
304 unregister_framebuffer(info
);
306 fb_dealloc_cmap(&info
->cmap
);
307 framebuffer_release(info
);
311 drm_gem_object_unreference_unlocked(afb
->obj
);
314 drm_fb_helper_fini(&afbdev
->helper
);
316 vfree(afbdev
->sysram
);
317 drm_framebuffer_unregister_private(&afb
->base
);
318 drm_framebuffer_cleanup(&afb
->base
);
321 int ast_fbdev_init(struct drm_device
*dev
)
323 struct ast_private
*ast
= dev
->dev_private
;
324 struct ast_fbdev
*afbdev
;
327 afbdev
= kzalloc(sizeof(struct ast_fbdev
), GFP_KERNEL
);
332 spin_lock_init(&afbdev
->dirty_lock
);
334 drm_fb_helper_prepare(dev
, &afbdev
->helper
, &ast_fb_helper_funcs
);
336 ret
= drm_fb_helper_init(dev
, &afbdev
->helper
,
341 ret
= drm_fb_helper_single_add_all_connectors(&afbdev
->helper
);
345 /* disable all the possible outputs/crtcs before entering KMS mode */
346 drm_helper_disable_unused_functions(dev
);
348 ret
= drm_fb_helper_initial_config(&afbdev
->helper
, 32);
355 drm_fb_helper_fini(&afbdev
->helper
);
361 void ast_fbdev_fini(struct drm_device
*dev
)
363 struct ast_private
*ast
= dev
->dev_private
;
368 ast_fbdev_destroy(dev
, ast
->fbdev
);
373 void ast_fbdev_set_suspend(struct drm_device
*dev
, int state
)
375 struct ast_private
*ast
= dev
->dev_private
;
380 fb_set_suspend(ast
->fbdev
->helper
.fbdev
, state
);