1 /* 2 * Copyright © 2007 David Airlie 3 * 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: 10 * 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 13 * Software. 14 * 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. 22 * 23 * Authors: 24 * David Airlie 25 */ 26 27 #include <linux/pci.h> 28 #include <linux/pm_runtime.h> 29 #include <linux/vga_switcheroo.h> 30 31 #include <drm/drm_crtc_helper.h> 32 #include <drm/drm_drv.h> 33 #include <drm/drm_fb_helper.h> 34 #include <drm/drm_fourcc.h> 35 #include <drm/drm_framebuffer.h> 36 #include <drm/drm_gem_framebuffer_helper.h> 37 38 #include "radeon.h" 39 40 static void radeon_fbdev_destroy_pinned_object(struct drm_gem_object *gobj) 41 { 42 struct radeon_bo *rbo = gem_to_radeon_bo(gobj); 43 int ret; 44 45 ret = radeon_bo_reserve(rbo, false); 46 if (likely(ret == 0)) { 47 radeon_bo_kunmap(rbo); 48 radeon_bo_unpin(rbo); 49 radeon_bo_unreserve(rbo); 50 } 51 drm_gem_object_put(gobj); 52 } 53 54 static int radeon_fbdev_create_pinned_object(struct drm_fb_helper *fb_helper, 55 struct drm_mode_fb_cmd2 *mode_cmd, 56 struct drm_gem_object **gobj_p) 57 { 58 const struct drm_format_info *info; 59 struct radeon_device *rdev = fb_helper->dev->dev_private; 60 struct drm_gem_object *gobj = NULL; 61 struct radeon_bo *rbo = NULL; 62 bool fb_tiled = false; /* useful for testing */ 63 u32 tiling_flags = 0; 64 int ret; 65 int aligned_size, size; 66 int height = mode_cmd->height; 67 u32 cpp; 68 69 info = drm_get_format_info(rdev->ddev, mode_cmd); 70 cpp = info->cpp[0]; 71 72 /* need to align pitch with crtc limits */ 73 mode_cmd->pitches[0] = radeon_align_pitch(rdev, mode_cmd->width, cpp, 74 fb_tiled); 75 76 if (rdev->family >= CHIP_R600) 77 height = ALIGN(mode_cmd->height, 8); 78 size = mode_cmd->pitches[0] * height; 79 aligned_size = ALIGN(size, PAGE_SIZE); 80 ret = radeon_gem_object_create(rdev, aligned_size, 0, 81 RADEON_GEM_DOMAIN_VRAM, 82 0, true, &gobj); 83 if (ret) { 84 pr_err("failed to allocate framebuffer (%d)\n", aligned_size); 85 return -ENOMEM; 86 } 87 rbo = gem_to_radeon_bo(gobj); 88 89 if (fb_tiled) 90 tiling_flags = RADEON_TILING_MACRO; 91 92 #ifdef __BIG_ENDIAN 93 switch (cpp) { 94 case 4: 95 tiling_flags |= RADEON_TILING_SWAP_32BIT; 96 break; 97 case 2: 98 tiling_flags |= RADEON_TILING_SWAP_16BIT; 99 break; 100 default: 101 break; 102 } 103 #endif 104 105 if (tiling_flags) { 106 ret = radeon_bo_set_tiling_flags(rbo, 107 tiling_flags | RADEON_TILING_SURFACE, 108 mode_cmd->pitches[0]); 109 if (ret) 110 dev_err(rdev->dev, "FB failed to set tiling flags\n"); 111 } 112 113 ret = radeon_bo_reserve(rbo, false); 114 if (unlikely(ret != 0)) 115 goto err_radeon_fbdev_destroy_pinned_object; 116 /* Only 27 bit offset for legacy CRTC */ 117 ret = radeon_bo_pin_restricted(rbo, RADEON_GEM_DOMAIN_VRAM, 118 ASIC_IS_AVIVO(rdev) ? 0 : 1 << 27, 119 NULL); 120 if (ret) { 121 radeon_bo_unreserve(rbo); 122 goto err_radeon_fbdev_destroy_pinned_object; 123 } 124 if (fb_tiled) 125 radeon_bo_check_tiling(rbo, 0, 0); 126 ret = radeon_bo_kmap(rbo, NULL); 127 radeon_bo_unreserve(rbo); 128 if (ret) 129 goto err_radeon_fbdev_destroy_pinned_object; 130 131 *gobj_p = gobj; 132 return 0; 133 134 err_radeon_fbdev_destroy_pinned_object: 135 radeon_fbdev_destroy_pinned_object(gobj); 136 *gobj_p = NULL; 137 return ret; 138 } 139 140 /* 141 * Fbdev ops and struct fb_ops 142 */ 143 144 static int radeon_fbdev_fb_open(struct fb_info *info, int user) 145 { 146 struct drm_fb_helper *fb_helper = info->par; 147 struct radeon_device *rdev = fb_helper->dev->dev_private; 148 int ret; 149 150 ret = pm_runtime_get_sync(rdev->ddev->dev); 151 if (ret < 0 && ret != -EACCES) 152 goto err_pm_runtime_mark_last_busy; 153 154 return 0; 155 156 err_pm_runtime_mark_last_busy: 157 pm_runtime_mark_last_busy(rdev->ddev->dev); 158 pm_runtime_put_autosuspend(rdev->ddev->dev); 159 return ret; 160 } 161 162 static int radeon_fbdev_fb_release(struct fb_info *info, int user) 163 { 164 struct drm_fb_helper *fb_helper = info->par; 165 struct radeon_device *rdev = fb_helper->dev->dev_private; 166 167 pm_runtime_mark_last_busy(rdev->ddev->dev); 168 pm_runtime_put_autosuspend(rdev->ddev->dev); 169 170 return 0; 171 } 172 173 static void radeon_fbdev_fb_destroy(struct fb_info *info) 174 { 175 struct drm_fb_helper *fb_helper = info->par; 176 struct drm_framebuffer *fb = fb_helper->fb; 177 struct drm_gem_object *gobj = drm_gem_fb_get_obj(fb, 0); 178 179 drm_fb_helper_fini(fb_helper); 180 181 drm_framebuffer_unregister_private(fb); 182 drm_framebuffer_cleanup(fb); 183 kfree(fb); 184 radeon_fbdev_destroy_pinned_object(gobj); 185 186 drm_client_release(&fb_helper->client); 187 drm_fb_helper_unprepare(fb_helper); 188 kfree(fb_helper); 189 } 190 191 static const struct fb_ops radeon_fbdev_fb_ops = { 192 .owner = THIS_MODULE, 193 DRM_FB_HELPER_DEFAULT_OPS, 194 .fb_open = radeon_fbdev_fb_open, 195 .fb_release = radeon_fbdev_fb_release, 196 .fb_read = drm_fb_helper_cfb_read, 197 .fb_write = drm_fb_helper_cfb_write, 198 .fb_fillrect = drm_fb_helper_cfb_fillrect, 199 .fb_copyarea = drm_fb_helper_cfb_copyarea, 200 .fb_imageblit = drm_fb_helper_cfb_imageblit, 201 .fb_destroy = radeon_fbdev_fb_destroy, 202 }; 203 204 /* 205 * Fbdev helpers and struct drm_fb_helper_funcs 206 */ 207 208 static int radeon_fbdev_fb_helper_fb_probe(struct drm_fb_helper *fb_helper, 209 struct drm_fb_helper_surface_size *sizes) 210 { 211 struct radeon_device *rdev = fb_helper->dev->dev_private; 212 struct drm_mode_fb_cmd2 mode_cmd = { }; 213 struct fb_info *info; 214 struct drm_gem_object *gobj; 215 struct radeon_bo *rbo; 216 struct drm_framebuffer *fb; 217 int ret; 218 unsigned long tmp; 219 220 mode_cmd.width = sizes->surface_width; 221 mode_cmd.height = sizes->surface_height; 222 223 /* avivo can't scanout real 24bpp */ 224 if ((sizes->surface_bpp == 24) && ASIC_IS_AVIVO(rdev)) 225 sizes->surface_bpp = 32; 226 227 mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, 228 sizes->surface_depth); 229 230 ret = radeon_fbdev_create_pinned_object(fb_helper, &mode_cmd, &gobj); 231 if (ret) { 232 DRM_ERROR("failed to create fbcon object %d\n", ret); 233 return ret; 234 } 235 rbo = gem_to_radeon_bo(gobj); 236 237 fb = kzalloc(sizeof(*fb), GFP_KERNEL); 238 if (!fb) { 239 ret = -ENOMEM; 240 goto err_radeon_fbdev_destroy_pinned_object; 241 } 242 ret = radeon_framebuffer_init(rdev->ddev, fb, &mode_cmd, gobj); 243 if (ret) { 244 DRM_ERROR("failed to initialize framebuffer %d\n", ret); 245 goto err_kfree; 246 } 247 248 /* setup helper */ 249 fb_helper->fb = fb; 250 251 /* okay we have an object now allocate the framebuffer */ 252 info = drm_fb_helper_alloc_info(fb_helper); 253 if (IS_ERR(info)) { 254 ret = PTR_ERR(info); 255 goto err_drm_framebuffer_unregister_private; 256 } 257 258 info->fbops = &radeon_fbdev_fb_ops; 259 info->flags = FBINFO_DEFAULT; 260 /* radeon resume is fragile and needs a vt switch to help it along */ 261 info->skip_vt_switch = false; 262 263 drm_fb_helper_fill_info(info, fb_helper, sizes); 264 265 tmp = radeon_bo_gpu_offset(rbo) - rdev->mc.vram_start; 266 info->fix.smem_start = rdev->mc.aper_base + tmp; 267 info->fix.smem_len = radeon_bo_size(rbo); 268 info->screen_base = (__force void __iomem *)rbo->kptr; 269 info->screen_size = radeon_bo_size(rbo); 270 271 memset_io(info->screen_base, 0, info->screen_size); 272 273 /* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */ 274 275 DRM_INFO("fb mappable at 0x%lX\n", info->fix.smem_start); 276 DRM_INFO("vram apper at 0x%lX\n", (unsigned long)rdev->mc.aper_base); 277 DRM_INFO("size %lu\n", (unsigned long)radeon_bo_size(rbo)); 278 DRM_INFO("fb depth is %d\n", fb->format->depth); 279 DRM_INFO(" pitch is %d\n", fb->pitches[0]); 280 281 return 0; 282 283 err_drm_framebuffer_unregister_private: 284 fb_helper->fb = NULL; 285 drm_framebuffer_unregister_private(fb); 286 drm_framebuffer_cleanup(fb); 287 err_kfree: 288 kfree(fb); 289 err_radeon_fbdev_destroy_pinned_object: 290 radeon_fbdev_destroy_pinned_object(gobj); 291 return ret; 292 } 293 294 static const struct drm_fb_helper_funcs radeon_fbdev_fb_helper_funcs = { 295 .fb_probe = radeon_fbdev_fb_helper_fb_probe, 296 }; 297 298 /* 299 * Fbdev client and struct drm_client_funcs 300 */ 301 302 static void radeon_fbdev_client_unregister(struct drm_client_dev *client) 303 { 304 struct drm_fb_helper *fb_helper = drm_fb_helper_from_client(client); 305 struct drm_device *dev = fb_helper->dev; 306 struct radeon_device *rdev = dev->dev_private; 307 308 if (fb_helper->info) { 309 vga_switcheroo_client_fb_set(rdev->pdev, NULL); 310 drm_helper_force_disable_all(dev); 311 drm_fb_helper_unregister_info(fb_helper); 312 } else { 313 drm_client_release(&fb_helper->client); 314 drm_fb_helper_unprepare(fb_helper); 315 kfree(fb_helper); 316 } 317 } 318 319 static int radeon_fbdev_client_restore(struct drm_client_dev *client) 320 { 321 drm_fb_helper_lastclose(client->dev); 322 vga_switcheroo_process_delayed_switch(); 323 324 return 0; 325 } 326 327 static int radeon_fbdev_client_hotplug(struct drm_client_dev *client) 328 { 329 struct drm_fb_helper *fb_helper = drm_fb_helper_from_client(client); 330 struct drm_device *dev = client->dev; 331 struct radeon_device *rdev = dev->dev_private; 332 int ret; 333 334 if (dev->fb_helper) 335 return drm_fb_helper_hotplug_event(dev->fb_helper); 336 337 ret = drm_fb_helper_init(dev, fb_helper); 338 if (ret) 339 goto err_drm_err; 340 341 if (!drm_drv_uses_atomic_modeset(dev)) 342 drm_helper_disable_unused_functions(dev); 343 344 ret = drm_fb_helper_initial_config(fb_helper); 345 if (ret) 346 goto err_drm_fb_helper_fini; 347 348 vga_switcheroo_client_fb_set(rdev->pdev, fb_helper->info); 349 350 return 0; 351 352 err_drm_fb_helper_fini: 353 drm_fb_helper_fini(fb_helper); 354 err_drm_err: 355 drm_err(dev, "Failed to setup radeon fbdev emulation (ret=%d)\n", ret); 356 return ret; 357 } 358 359 static const struct drm_client_funcs radeon_fbdev_client_funcs = { 360 .owner = THIS_MODULE, 361 .unregister = radeon_fbdev_client_unregister, 362 .restore = radeon_fbdev_client_restore, 363 .hotplug = radeon_fbdev_client_hotplug, 364 }; 365 366 void radeon_fbdev_setup(struct radeon_device *rdev) 367 { 368 struct drm_fb_helper *fb_helper; 369 int bpp_sel = 32; 370 int ret; 371 372 if (rdev->mc.real_vram_size <= (8 * 1024 * 1024)) 373 bpp_sel = 8; 374 else if (ASIC_IS_RN50(rdev) || rdev->mc.real_vram_size <= (32 * 1024 * 1024)) 375 bpp_sel = 16; 376 377 fb_helper = kzalloc(sizeof(*fb_helper), GFP_KERNEL); 378 if (!fb_helper) 379 return; 380 drm_fb_helper_prepare(rdev->ddev, fb_helper, bpp_sel, &radeon_fbdev_fb_helper_funcs); 381 382 ret = drm_client_init(rdev->ddev, &fb_helper->client, "radeon-fbdev", 383 &radeon_fbdev_client_funcs); 384 if (ret) { 385 drm_err(rdev->ddev, "Failed to register client: %d\n", ret); 386 goto err_drm_client_init; 387 } 388 389 ret = radeon_fbdev_client_hotplug(&fb_helper->client); 390 if (ret) 391 drm_dbg_kms(rdev->ddev, "client hotplug ret=%d\n", ret); 392 393 drm_client_register(&fb_helper->client); 394 395 return; 396 397 err_drm_client_init: 398 drm_fb_helper_unprepare(fb_helper); 399 kfree(fb_helper); 400 } 401 402 void radeon_fbdev_set_suspend(struct radeon_device *rdev, int state) 403 { 404 if (rdev->ddev->fb_helper) 405 drm_fb_helper_set_suspend(rdev->ddev->fb_helper, state); 406 } 407 408 bool radeon_fbdev_robj_is_fb(struct radeon_device *rdev, struct radeon_bo *robj) 409 { 410 struct drm_fb_helper *fb_helper = rdev->ddev->fb_helper; 411 struct drm_gem_object *gobj; 412 413 if (!fb_helper) 414 return false; 415 416 gobj = drm_gem_fb_get_obj(fb_helper->fb, 0); 417 if (!gobj) 418 return false; 419 if (gobj != &robj->tbo.base) 420 return false; 421 422 return true; 423 } 424