2 * Copyright © 2007 David Airlie
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
11 * The above copyright notice and this permission notice (including the next
12 * paragraph) shall be included in all copies or substantial portions of the
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
18 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21 * DEALINGS IN THE SOFTWARE.
26 #include <linux/module.h>
27 #include <linux/slab.h>
30 #include <drm/drm_crtc.h>
31 #include <drm/drm_crtc_helper.h>
32 #include <drm/radeon_drm.h>
35 #include <drm/drm_fb_helper.h>
37 #include <linux/vga_switcheroo.h>
40 * this contains a helper + a radeon fb
41 * the helper contains a pointer to radeon framebuffer baseclass.
44 struct drm_fb_helper helper
;
45 struct radeon_framebuffer rfb
;
46 struct radeon_device
*rdev
;
49 static struct fb_ops radeonfb_ops
= {
51 .fb_check_var
= drm_fb_helper_check_var
,
52 .fb_set_par
= drm_fb_helper_set_par
,
53 .fb_fillrect
= drm_fb_helper_cfb_fillrect
,
54 .fb_copyarea
= drm_fb_helper_cfb_copyarea
,
55 .fb_imageblit
= drm_fb_helper_cfb_imageblit
,
56 .fb_pan_display
= drm_fb_helper_pan_display
,
57 .fb_blank
= drm_fb_helper_blank
,
58 .fb_setcmap
= drm_fb_helper_setcmap
,
59 .fb_debug_enter
= drm_fb_helper_debug_enter
,
60 .fb_debug_leave
= drm_fb_helper_debug_leave
,
64 int radeon_align_pitch(struct radeon_device
*rdev
, int width
, int bpp
, bool tiled
)
67 int align_large
= (ASIC_IS_AVIVO(rdev
)) || tiled
;
72 pitch_mask
= align_large
? 255 : 127;
75 pitch_mask
= align_large
? 127 : 31;
79 pitch_mask
= align_large
? 63 : 15;
83 aligned
+= pitch_mask
;
84 aligned
&= ~pitch_mask
;
88 static void radeonfb_destroy_pinned_object(struct drm_gem_object
*gobj
)
90 struct radeon_bo
*rbo
= gem_to_radeon_bo(gobj
);
93 ret
= radeon_bo_reserve(rbo
, false);
94 if (likely(ret
== 0)) {
95 radeon_bo_kunmap(rbo
);
97 radeon_bo_unreserve(rbo
);
99 drm_gem_object_unreference_unlocked(gobj
);
102 static int radeonfb_create_pinned_object(struct radeon_fbdev
*rfbdev
,
103 struct drm_mode_fb_cmd2
*mode_cmd
,
104 struct drm_gem_object
**gobj_p
)
106 struct radeon_device
*rdev
= rfbdev
->rdev
;
107 struct drm_gem_object
*gobj
= NULL
;
108 struct radeon_bo
*rbo
= NULL
;
109 bool fb_tiled
= false; /* useful for testing */
110 u32 tiling_flags
= 0;
112 int aligned_size
, size
;
113 int height
= mode_cmd
->height
;
116 drm_fb_get_bpp_depth(mode_cmd
->pixel_format
, &depth
, &bpp
);
118 /* need to align pitch with crtc limits */
119 mode_cmd
->pitches
[0] = radeon_align_pitch(rdev
, mode_cmd
->width
, bpp
,
120 fb_tiled
) * ((bpp
+ 1) / 8);
122 if (rdev
->family
>= CHIP_R600
)
123 height
= ALIGN(mode_cmd
->height
, 8);
124 size
= mode_cmd
->pitches
[0] * height
;
125 aligned_size
= ALIGN(size
, PAGE_SIZE
);
126 ret
= radeon_gem_object_create(rdev
, aligned_size
, 0,
127 RADEON_GEM_DOMAIN_VRAM
,
130 printk(KERN_ERR
"failed to allocate framebuffer (%d)\n",
134 rbo
= gem_to_radeon_bo(gobj
);
137 tiling_flags
= RADEON_TILING_MACRO
;
142 tiling_flags
|= RADEON_TILING_SWAP_32BIT
;
145 tiling_flags
|= RADEON_TILING_SWAP_16BIT
;
152 ret
= radeon_bo_set_tiling_flags(rbo
,
153 tiling_flags
| RADEON_TILING_SURFACE
,
154 mode_cmd
->pitches
[0]);
156 dev_err(rdev
->dev
, "FB failed to set tiling flags\n");
160 ret
= radeon_bo_reserve(rbo
, false);
161 if (unlikely(ret
!= 0))
163 /* Only 27 bit offset for legacy CRTC */
164 ret
= radeon_bo_pin_restricted(rbo
, RADEON_GEM_DOMAIN_VRAM
,
165 ASIC_IS_AVIVO(rdev
) ? 0 : 1 << 27,
168 radeon_bo_unreserve(rbo
);
172 radeon_bo_check_tiling(rbo
, 0, 0);
173 ret
= radeon_bo_kmap(rbo
, NULL
);
174 radeon_bo_unreserve(rbo
);
182 radeonfb_destroy_pinned_object(gobj
);
187 static int radeonfb_create(struct drm_fb_helper
*helper
,
188 struct drm_fb_helper_surface_size
*sizes
)
190 struct radeon_fbdev
*rfbdev
=
191 container_of(helper
, struct radeon_fbdev
, helper
);
192 struct radeon_device
*rdev
= rfbdev
->rdev
;
193 struct fb_info
*info
;
194 struct drm_framebuffer
*fb
= NULL
;
195 struct drm_mode_fb_cmd2 mode_cmd
;
196 struct drm_gem_object
*gobj
= NULL
;
197 struct radeon_bo
*rbo
= NULL
;
201 mode_cmd
.width
= sizes
->surface_width
;
202 mode_cmd
.height
= sizes
->surface_height
;
204 /* avivo can't scanout real 24bpp */
205 if ((sizes
->surface_bpp
== 24) && ASIC_IS_AVIVO(rdev
))
206 sizes
->surface_bpp
= 32;
208 mode_cmd
.pixel_format
= drm_mode_legacy_fb_format(sizes
->surface_bpp
,
209 sizes
->surface_depth
);
211 ret
= radeonfb_create_pinned_object(rfbdev
, &mode_cmd
, &gobj
);
213 DRM_ERROR("failed to create fbcon object %d\n", ret
);
217 rbo
= gem_to_radeon_bo(gobj
);
219 /* okay we have an object now allocate the framebuffer */
220 info
= drm_fb_helper_alloc_fbi(helper
);
227 info
->skip_vt_switch
= true;
229 ret
= radeon_framebuffer_init(rdev
->ddev
, &rfbdev
->rfb
, &mode_cmd
, gobj
);
231 DRM_ERROR("failed to initialize framebuffer %d\n", ret
);
232 goto out_destroy_fbi
;
235 fb
= &rfbdev
->rfb
.base
;
238 rfbdev
->helper
.fb
= fb
;
240 memset_io(rbo
->kptr
, 0x0, radeon_bo_size(rbo
));
242 strcpy(info
->fix
.id
, "radeondrmfb");
244 drm_fb_helper_fill_fix(info
, fb
->pitches
[0], fb
->depth
);
246 info
->flags
= FBINFO_DEFAULT
| FBINFO_CAN_FORCE_OUTPUT
;
247 info
->fbops
= &radeonfb_ops
;
249 tmp
= radeon_bo_gpu_offset(rbo
) - rdev
->mc
.vram_start
;
250 info
->fix
.smem_start
= rdev
->mc
.aper_base
+ tmp
;
251 info
->fix
.smem_len
= radeon_bo_size(rbo
);
252 info
->screen_base
= rbo
->kptr
;
253 info
->screen_size
= radeon_bo_size(rbo
);
255 drm_fb_helper_fill_var(info
, &rfbdev
->helper
, sizes
->fb_width
, sizes
->fb_height
);
257 /* setup aperture base/size for vesafb takeover */
258 info
->apertures
->ranges
[0].base
= rdev
->ddev
->mode_config
.fb_base
;
259 info
->apertures
->ranges
[0].size
= rdev
->mc
.aper_size
;
261 /* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
263 if (info
->screen_base
== NULL
) {
265 goto out_destroy_fbi
;
268 DRM_INFO("fb mappable at 0x%lX\n", info
->fix
.smem_start
);
269 DRM_INFO("vram apper at 0x%lX\n", (unsigned long)rdev
->mc
.aper_base
);
270 DRM_INFO("size %lu\n", (unsigned long)radeon_bo_size(rbo
));
271 DRM_INFO("fb depth is %d\n", fb
->depth
);
272 DRM_INFO(" pitch is %d\n", fb
->pitches
[0]);
274 vga_switcheroo_client_fb_set(rdev
->ddev
->pdev
, info
);
278 drm_fb_helper_release_fbi(helper
);
284 drm_gem_object_unreference_unlocked(gobj
);
285 drm_framebuffer_unregister_private(fb
);
286 drm_framebuffer_cleanup(fb
);
292 void radeon_fb_output_poll_changed(struct radeon_device
*rdev
)
294 if (rdev
->mode_info
.rfbdev
)
295 drm_fb_helper_hotplug_event(&rdev
->mode_info
.rfbdev
->helper
);
298 static int radeon_fbdev_destroy(struct drm_device
*dev
, struct radeon_fbdev
*rfbdev
)
300 struct radeon_framebuffer
*rfb
= &rfbdev
->rfb
;
302 drm_fb_helper_unregister_fbi(&rfbdev
->helper
);
303 drm_fb_helper_release_fbi(&rfbdev
->helper
);
306 radeonfb_destroy_pinned_object(rfb
->obj
);
309 drm_fb_helper_fini(&rfbdev
->helper
);
310 drm_framebuffer_unregister_private(&rfb
->base
);
311 drm_framebuffer_cleanup(&rfb
->base
);
316 static const struct drm_fb_helper_funcs radeon_fb_helper_funcs
= {
317 .gamma_set
= radeon_crtc_fb_gamma_set
,
318 .gamma_get
= radeon_crtc_fb_gamma_get
,
319 .fb_probe
= radeonfb_create
,
322 int radeon_fbdev_init(struct radeon_device
*rdev
)
324 struct radeon_fbdev
*rfbdev
;
328 /* don't enable fbdev if no connectors */
329 if (list_empty(&rdev
->ddev
->mode_config
.connector_list
))
332 /* select 8 bpp console on RN50 or 16MB cards */
333 if (ASIC_IS_RN50(rdev
) || rdev
->mc
.real_vram_size
<= (32*1024*1024))
336 rfbdev
= kzalloc(sizeof(struct radeon_fbdev
), GFP_KERNEL
);
341 rdev
->mode_info
.rfbdev
= rfbdev
;
343 drm_fb_helper_prepare(rdev
->ddev
, &rfbdev
->helper
,
344 &radeon_fb_helper_funcs
);
346 ret
= drm_fb_helper_init(rdev
->ddev
, &rfbdev
->helper
,
348 RADEONFB_CONN_LIMIT
);
352 ret
= drm_fb_helper_single_add_all_connectors(&rfbdev
->helper
);
356 /* disable all the possible outputs/crtcs before entering KMS mode */
357 drm_helper_disable_unused_functions(rdev
->ddev
);
359 ret
= drm_fb_helper_initial_config(&rfbdev
->helper
, bpp_sel
);
366 drm_fb_helper_fini(&rfbdev
->helper
);
372 void radeon_fbdev_fini(struct radeon_device
*rdev
)
374 if (!rdev
->mode_info
.rfbdev
)
377 radeon_fbdev_destroy(rdev
->ddev
, rdev
->mode_info
.rfbdev
);
378 kfree(rdev
->mode_info
.rfbdev
);
379 rdev
->mode_info
.rfbdev
= NULL
;
382 void radeon_fbdev_set_suspend(struct radeon_device
*rdev
, int state
)
384 if (rdev
->mode_info
.rfbdev
)
385 drm_fb_helper_set_suspend(&rdev
->mode_info
.rfbdev
->helper
, state
);
388 bool radeon_fbdev_robj_is_fb(struct radeon_device
*rdev
, struct radeon_bo
*robj
)
390 if (!rdev
->mode_info
.rfbdev
)
393 if (robj
== gem_to_radeon_bo(rdev
->mode_info
.rfbdev
->rfb
.obj
))
398 void radeon_fb_add_connector(struct radeon_device
*rdev
, struct drm_connector
*connector
)
400 if (rdev
->mode_info
.rfbdev
)
401 drm_fb_helper_add_one_connector(&rdev
->mode_info
.rfbdev
->helper
, connector
);
404 void radeon_fb_remove_connector(struct radeon_device
*rdev
, struct drm_connector
*connector
)
406 if (rdev
->mode_info
.rfbdev
)
407 drm_fb_helper_remove_one_connector(&rdev
->mode_info
.rfbdev
->helper
, connector
);
410 void radeon_fbdev_restore_mode(struct radeon_device
*rdev
)
412 struct radeon_fbdev
*rfbdev
= rdev
->mode_info
.rfbdev
;
413 struct drm_fb_helper
*fb_helper
;
419 fb_helper
= &rfbdev
->helper
;
421 ret
= drm_fb_helper_restore_fbdev_mode_unlocked(fb_helper
);
423 DRM_DEBUG("failed to restore crtc mode\n");