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/module.h> 28#include <linux/kernel.h> 29#include <linux/errno.h> 30#include <linux/string.h> 31#include <linux/mm.h> 32#include <linux/tty.h> 33#include <linux/sysrq.h> 34#include <linux/delay.h> 35#include <linux/fb.h> 36#include <linux/init.h> 37#include <linux/vga_switcheroo.h> 38 39#include "drmP.h" 40#include "drm.h" 41#include "drm_crtc.h" 42#include "drm_fb_helper.h" 43#include "intel_drv.h" 44#include "i915_drm.h" 45#include "i915_drv.h" 46 47static struct fb_ops intelfb_ops = { 48 .owner = THIS_MODULE, 49 .fb_check_var = drm_fb_helper_check_var, 50 .fb_set_par = drm_fb_helper_set_par, 51 .fb_fillrect = cfb_fillrect, 52 .fb_copyarea = cfb_copyarea, 53 .fb_imageblit = cfb_imageblit, 54 .fb_pan_display = drm_fb_helper_pan_display, 55 .fb_blank = drm_fb_helper_blank, 56 .fb_setcmap = drm_fb_helper_setcmap, 57 .fb_debug_enter = drm_fb_helper_debug_enter, 58 .fb_debug_leave = drm_fb_helper_debug_leave, 59}; 60 61static int intelfb_create(struct intel_fbdev *ifbdev, 62 struct drm_fb_helper_surface_size *sizes) 63{ 64 struct drm_device *dev = ifbdev->helper.dev; 65 struct drm_i915_private *dev_priv = dev->dev_private; 66 struct fb_info *info; 67 struct drm_framebuffer *fb; 68 struct drm_mode_fb_cmd2 mode_cmd; 69 struct drm_i915_gem_object *obj; 70 struct device *device = &dev->pdev->dev; 71 int size, ret; 72 73 /* we don't do packed 24bpp */ 74 if (sizes->surface_bpp == 24) 75 sizes->surface_bpp = 32; 76 77 mode_cmd.width = sizes->surface_width; 78 mode_cmd.height = sizes->surface_height; 79 80 mode_cmd.pitches[0] = ALIGN(mode_cmd.width * ((sizes->surface_bpp + 7) / 81 8), 64); 82 mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, 83 sizes->surface_depth); 84 85 size = mode_cmd.pitches[0] * mode_cmd.height; 86 size = ALIGN(size, PAGE_SIZE); 87 obj = i915_gem_alloc_object(dev, size); 88 if (!obj) { 89 DRM_ERROR("failed to allocate framebuffer\n"); 90 ret = -ENOMEM; 91 goto out; 92 } 93 94 mutex_lock(&dev->struct_mutex); 95 96 /* Flush everything out, we'll be doing GTT only from now on */ 97 ret = intel_pin_and_fence_fb_obj(dev, obj, false); 98 if (ret) { 99 DRM_ERROR("failed to pin fb: %d\n", ret); 100 goto out_unref; 101 } 102 103 info = framebuffer_alloc(0, device); 104 if (!info) { 105 ret = -ENOMEM; 106 goto out_unpin; 107 } 108 109 info->par = ifbdev; 110 111 ret = intel_framebuffer_init(dev, &ifbdev->ifb, &mode_cmd, obj); 112 if (ret) 113 goto out_unpin; 114 115 fb = &ifbdev->ifb.base; 116 117 ifbdev->helper.fb = fb; 118 ifbdev->helper.fbdev = info; 119 120 strcpy(info->fix.id, "inteldrmfb"); 121 122 info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT; 123 info->fbops = &intelfb_ops; 124 125 ret = fb_alloc_cmap(&info->cmap, 256, 0); 126 if (ret) { 127 ret = -ENOMEM; 128 goto out_unpin; 129 } 130 /* setup aperture base/size for vesafb takeover */ 131 info->apertures = alloc_apertures(1); 132 if (!info->apertures) { 133 ret = -ENOMEM; 134 goto out_unpin; 135 } 136 info->apertures->ranges[0].base = dev->mode_config.fb_base; 137 info->apertures->ranges[0].size = 138 dev_priv->mm.gtt->gtt_mappable_entries << PAGE_SHIFT; 139 140 info->fix.smem_start = dev->mode_config.fb_base + obj->gtt_offset; 141 info->fix.smem_len = size; 142 143 info->screen_base = ioremap_wc(dev->agp->base + obj->gtt_offset, size); 144 if (!info->screen_base) { 145 ret = -ENOSPC; 146 goto out_unpin; 147 } 148 info->screen_size = size; 149 150// memset(info->screen_base, 0, size); 151 152 drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth); 153 drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height); 154 155 /* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */ 156 157 DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08x, bo %p\n", 158 fb->width, fb->height, 159 obj->gtt_offset, obj); 160 161 162 mutex_unlock(&dev->struct_mutex); 163 vga_switcheroo_client_fb_set(dev->pdev, info); 164 return 0; 165 166out_unpin: 167 i915_gem_object_unpin(obj); 168out_unref: 169 drm_gem_object_unreference(&obj->base); 170 mutex_unlock(&dev->struct_mutex); 171out: 172 return ret; 173} 174 175static int intel_fb_find_or_create_single(struct drm_fb_helper *helper, 176 struct drm_fb_helper_surface_size *sizes) 177{ 178 struct intel_fbdev *ifbdev = (struct intel_fbdev *)helper; 179 int new_fb = 0; 180 int ret; 181 182 if (!helper->fb) { 183 ret = intelfb_create(ifbdev, sizes); 184 if (ret) 185 return ret; 186 new_fb = 1; 187 } 188 return new_fb; 189} 190 191static struct drm_fb_helper_funcs intel_fb_helper_funcs = { 192 .gamma_set = intel_crtc_fb_gamma_set, 193 .gamma_get = intel_crtc_fb_gamma_get, 194 .fb_probe = intel_fb_find_or_create_single, 195}; 196 197static void intel_fbdev_destroy(struct drm_device *dev, 198 struct intel_fbdev *ifbdev) 199{ 200 struct fb_info *info; 201 struct intel_framebuffer *ifb = &ifbdev->ifb; 202 203 if (ifbdev->helper.fbdev) { 204 info = ifbdev->helper.fbdev; 205 unregister_framebuffer(info); 206 iounmap(info->screen_base); 207 if (info->cmap.len) 208 fb_dealloc_cmap(&info->cmap); 209 framebuffer_release(info); 210 } 211 212 drm_fb_helper_fini(&ifbdev->helper); 213 214 drm_framebuffer_cleanup(&ifb->base); 215 if (ifb->obj) { 216 drm_gem_object_unreference_unlocked(&ifb->obj->base); 217 ifb->obj = NULL; 218 } 219} 220 221int intel_fbdev_init(struct drm_device *dev) 222{ 223 struct intel_fbdev *ifbdev; 224 drm_i915_private_t *dev_priv = dev->dev_private; 225 int ret; 226 227 ifbdev = kzalloc(sizeof(struct intel_fbdev), GFP_KERNEL); 228 if (!ifbdev) 229 return -ENOMEM; 230 231 dev_priv->fbdev = ifbdev; 232 ifbdev->helper.funcs = &intel_fb_helper_funcs; 233 234 ret = drm_fb_helper_init(dev, &ifbdev->helper, 235 dev_priv->num_pipe, 236 INTELFB_CONN_LIMIT); 237 if (ret) { 238 kfree(ifbdev); 239 return ret; 240 } 241 242 drm_fb_helper_single_add_all_connectors(&ifbdev->helper); 243 drm_fb_helper_initial_config(&ifbdev->helper, 32); 244 return 0; 245} 246 247void intel_fbdev_fini(struct drm_device *dev) 248{ 249 drm_i915_private_t *dev_priv = dev->dev_private; 250 if (!dev_priv->fbdev) 251 return; 252 253 intel_fbdev_destroy(dev, dev_priv->fbdev); 254 kfree(dev_priv->fbdev); 255 dev_priv->fbdev = NULL; 256} 257 258void intel_fbdev_set_suspend(struct drm_device *dev, int state) 259{ 260 drm_i915_private_t *dev_priv = dev->dev_private; 261 if (!dev_priv->fbdev) 262 return; 263 264 fb_set_suspend(dev_priv->fbdev->helper.fbdev, state); 265} 266 267MODULE_LICENSE("GPL and additional rights"); 268 269void intel_fb_output_poll_changed(struct drm_device *dev) 270{ 271 drm_i915_private_t *dev_priv = dev->dev_private; 272 drm_fb_helper_hotplug_event(&dev_priv->fbdev->helper); 273} 274 275void intel_fb_restore_mode(struct drm_device *dev) 276{ 277 int ret; 278 drm_i915_private_t *dev_priv = dev->dev_private; 279 struct drm_mode_config *config = &dev->mode_config; 280 struct drm_plane *plane; 281 282 mutex_lock(&dev->mode_config.mutex); 283 284 ret = drm_fb_helper_restore_fbdev_mode(&dev_priv->fbdev->helper); 285 if (ret) 286 DRM_DEBUG("failed to restore crtc mode\n"); 287 288 /* Be sure to shut off any planes that may be active */ 289 list_for_each_entry(plane, &config->plane_list, head) 290 plane->funcs->disable_plane(plane); 291 292 mutex_unlock(&dev->mode_config.mutex); 293} 294