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 
47 static 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 
intelfb_create(struct intel_fbdev * ifbdev,struct drm_fb_helper_surface_size * sizes)61 static 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_cmd 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.bpp = sizes->surface_bpp;
81 	mode_cmd.pitch = ALIGN(mode_cmd.width * ((mode_cmd.bpp + 7) / 8), 64);
82 	mode_cmd.depth = sizes->surface_depth;
83 
84 	size = mode_cmd.pitch * mode_cmd.height;
85 	size = ALIGN(size, PAGE_SIZE);
86 	obj = i915_gem_alloc_object(dev, size);
87 	if (!obj) {
88 		DRM_ERROR("failed to allocate framebuffer\n");
89 		ret = -ENOMEM;
90 		goto out;
91 	}
92 
93 	mutex_lock(&dev->struct_mutex);
94 
95 	/* Flush everything out, we'll be doing GTT only from now on */
96 	ret = intel_pin_and_fence_fb_obj(dev, obj, false);
97 	if (ret) {
98 		DRM_ERROR("failed to pin fb: %d\n", ret);
99 		goto out_unref;
100 	}
101 
102 	info = framebuffer_alloc(0, device);
103 	if (!info) {
104 		ret = -ENOMEM;
105 		goto out_unpin;
106 	}
107 
108 	info->par = ifbdev;
109 
110 	ret = intel_framebuffer_init(dev, &ifbdev->ifb, &mode_cmd, obj);
111 	if (ret)
112 		goto out_unpin;
113 
114 	fb = &ifbdev->ifb.base;
115 
116 	ifbdev->helper.fb = fb;
117 	ifbdev->helper.fbdev = info;
118 
119 	strcpy(info->fix.id, "inteldrmfb");
120 
121 	info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT;
122 	info->fbops = &intelfb_ops;
123 
124 	ret = fb_alloc_cmap(&info->cmap, 256, 0);
125 	if (ret) {
126 		ret = -ENOMEM;
127 		goto out_unpin;
128 	}
129 	/* setup aperture base/size for vesafb takeover */
130 	info->apertures = alloc_apertures(1);
131 	if (!info->apertures) {
132 		ret = -ENOMEM;
133 		goto out_unpin;
134 	}
135 	info->apertures->ranges[0].base = dev->mode_config.fb_base;
136 	info->apertures->ranges[0].size =
137 		dev_priv->mm.gtt->gtt_mappable_entries << PAGE_SHIFT;
138 
139 	info->fix.smem_start = dev->mode_config.fb_base + obj->gtt_offset;
140 	info->fix.smem_len = size;
141 
142 	info->screen_base = ioremap_wc(dev->agp->base + obj->gtt_offset, size);
143 	if (!info->screen_base) {
144 		ret = -ENOSPC;
145 		goto out_unpin;
146 	}
147 	info->screen_size = size;
148 
149 //	memset(info->screen_base, 0, size);
150 
151 	drm_fb_helper_fill_fix(info, fb->pitch, fb->depth);
152 	drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height);
153 
154 	info->pixmap.size = 64*1024;
155 	info->pixmap.buf_align = 8;
156 	info->pixmap.access_align = 32;
157 	info->pixmap.flags = FB_PIXMAP_SYSTEM;
158 	info->pixmap.scan_align = 1;
159 
160 	DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08x, bo %p\n",
161 		      fb->width, fb->height,
162 		      obj->gtt_offset, obj);
163 
164 
165 	mutex_unlock(&dev->struct_mutex);
166 	vga_switcheroo_client_fb_set(dev->pdev, info);
167 	return 0;
168 
169 out_unpin:
170 	i915_gem_object_unpin(obj);
171 out_unref:
172 	drm_gem_object_unreference(&obj->base);
173 	mutex_unlock(&dev->struct_mutex);
174 out:
175 	return ret;
176 }
177 
intel_fb_find_or_create_single(struct drm_fb_helper * helper,struct drm_fb_helper_surface_size * sizes)178 static int intel_fb_find_or_create_single(struct drm_fb_helper *helper,
179 					  struct drm_fb_helper_surface_size *sizes)
180 {
181 	struct intel_fbdev *ifbdev = (struct intel_fbdev *)helper;
182 	int new_fb = 0;
183 	int ret;
184 
185 	if (!helper->fb) {
186 		ret = intelfb_create(ifbdev, sizes);
187 		if (ret)
188 			return ret;
189 		new_fb = 1;
190 	}
191 	return new_fb;
192 }
193 
194 static struct drm_fb_helper_funcs intel_fb_helper_funcs = {
195 	.gamma_set = intel_crtc_fb_gamma_set,
196 	.gamma_get = intel_crtc_fb_gamma_get,
197 	.fb_probe = intel_fb_find_or_create_single,
198 };
199 
intel_fbdev_destroy(struct drm_device * dev,struct intel_fbdev * ifbdev)200 static void intel_fbdev_destroy(struct drm_device *dev,
201 				struct intel_fbdev *ifbdev)
202 {
203 	struct fb_info *info;
204 	struct intel_framebuffer *ifb = &ifbdev->ifb;
205 
206 	if (ifbdev->helper.fbdev) {
207 		info = ifbdev->helper.fbdev;
208 		unregister_framebuffer(info);
209 		iounmap(info->screen_base);
210 		if (info->cmap.len)
211 			fb_dealloc_cmap(&info->cmap);
212 		framebuffer_release(info);
213 	}
214 
215 	drm_fb_helper_fini(&ifbdev->helper);
216 
217 	drm_framebuffer_cleanup(&ifb->base);
218 	if (ifb->obj) {
219 		drm_gem_object_unreference_unlocked(&ifb->obj->base);
220 		ifb->obj = NULL;
221 	}
222 }
223 
intel_fbdev_init(struct drm_device * dev)224 int intel_fbdev_init(struct drm_device *dev)
225 {
226 	struct intel_fbdev *ifbdev;
227 	drm_i915_private_t *dev_priv = dev->dev_private;
228 	int ret;
229 
230 	ifbdev = kzalloc(sizeof(struct intel_fbdev), GFP_KERNEL);
231 	if (!ifbdev)
232 		return -ENOMEM;
233 
234 	dev_priv->fbdev = ifbdev;
235 	ifbdev->helper.funcs = &intel_fb_helper_funcs;
236 
237 	ret = drm_fb_helper_init(dev, &ifbdev->helper,
238 				 dev_priv->num_pipe,
239 				 INTELFB_CONN_LIMIT);
240 	if (ret) {
241 		kfree(ifbdev);
242 		return ret;
243 	}
244 
245 	drm_fb_helper_single_add_all_connectors(&ifbdev->helper);
246 	drm_fb_helper_initial_config(&ifbdev->helper, 32);
247 	return 0;
248 }
249 
intel_fbdev_fini(struct drm_device * dev)250 void intel_fbdev_fini(struct drm_device *dev)
251 {
252 	drm_i915_private_t *dev_priv = dev->dev_private;
253 	if (!dev_priv->fbdev)
254 		return;
255 
256 	intel_fbdev_destroy(dev, dev_priv->fbdev);
257 	kfree(dev_priv->fbdev);
258 	dev_priv->fbdev = NULL;
259 }
260 MODULE_LICENSE("GPL and additional rights");
261 
intel_fb_output_poll_changed(struct drm_device * dev)262 void intel_fb_output_poll_changed(struct drm_device *dev)
263 {
264 	drm_i915_private_t *dev_priv = dev->dev_private;
265 	drm_fb_helper_hotplug_event(&dev_priv->fbdev->helper);
266 }
267 
intel_fb_restore_mode(struct drm_device * dev)268 void intel_fb_restore_mode(struct drm_device *dev)
269 {
270 	int ret;
271 	drm_i915_private_t *dev_priv = dev->dev_private;
272 
273 	ret = drm_fb_helper_restore_fbdev_mode(&dev_priv->fbdev->helper);
274 	if (ret)
275 		DRM_DEBUG("failed to restore crtc mode\n");
276 }
277