Commit | Line | Data |
---|---|---|
79e53945 JB |
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 | ||
d1d70677 | 27 | #include <linux/async.h> |
79e53945 JB |
28 | #include <linux/module.h> |
29 | #include <linux/kernel.h> | |
82e3b8c1 | 30 | #include <linux/console.h> |
79e53945 JB |
31 | #include <linux/errno.h> |
32 | #include <linux/string.h> | |
33 | #include <linux/mm.h> | |
34 | #include <linux/tty.h> | |
79e53945 JB |
35 | #include <linux/sysrq.h> |
36 | #include <linux/delay.h> | |
37 | #include <linux/fb.h> | |
38 | #include <linux/init.h> | |
6a9ee8af | 39 | #include <linux/vga_switcheroo.h> |
79e53945 | 40 | |
760285e7 DH |
41 | #include <drm/drmP.h> |
42 | #include <drm/drm_crtc.h> | |
43 | #include <drm/drm_fb_helper.h> | |
79e53945 | 44 | #include "intel_drv.h" |
760285e7 | 45 | #include <drm/i915_drm.h> |
79e53945 JB |
46 | #include "i915_drv.h" |
47 | ||
e991077e DV |
48 | static int intel_fbdev_set_par(struct fb_info *info) |
49 | { | |
50 | struct drm_fb_helper *fb_helper = info->par; | |
51 | struct intel_fbdev *ifbdev = | |
52 | container_of(fb_helper, struct intel_fbdev, helper); | |
53 | int ret; | |
54 | ||
55 | ret = drm_fb_helper_set_par(info); | |
56 | ||
57 | if (ret == 0) { | |
58 | /* | |
59 | * FIXME: fbdev presumes that all callbacks also work from | |
60 | * atomic contexts and relies on that for emergency oops | |
61 | * printing. KMS totally doesn't do that and the locking here is | |
62 | * by far not the only place this goes wrong. Ignore this for | |
63 | * now until we solve this for real. | |
64 | */ | |
65 | mutex_lock(&fb_helper->dev->struct_mutex); | |
66 | ret = i915_gem_object_set_to_gtt_domain(ifbdev->fb->obj, | |
67 | true); | |
68 | mutex_unlock(&fb_helper->dev->struct_mutex); | |
69 | } | |
70 | ||
71 | return ret; | |
72 | } | |
73 | ||
79e53945 JB |
74 | static struct fb_ops intelfb_ops = { |
75 | .owner = THIS_MODULE, | |
785b93ef | 76 | .fb_check_var = drm_fb_helper_check_var, |
e991077e | 77 | .fb_set_par = intel_fbdev_set_par, |
79e53945 JB |
78 | .fb_fillrect = cfb_fillrect, |
79 | .fb_copyarea = cfb_copyarea, | |
80 | .fb_imageblit = cfb_imageblit, | |
785b93ef DA |
81 | .fb_pan_display = drm_fb_helper_pan_display, |
82 | .fb_blank = drm_fb_helper_blank, | |
068143d3 | 83 | .fb_setcmap = drm_fb_helper_setcmap, |
81255565 JB |
84 | .fb_debug_enter = drm_fb_helper_debug_enter, |
85 | .fb_debug_leave = drm_fb_helper_debug_leave, | |
79e53945 JB |
86 | }; |
87 | ||
8b4f49e0 JB |
88 | static int intelfb_alloc(struct drm_fb_helper *helper, |
89 | struct drm_fb_helper_surface_size *sizes) | |
79e53945 | 90 | { |
3430824b VS |
91 | struct intel_fbdev *ifbdev = |
92 | container_of(helper, struct intel_fbdev, helper); | |
a8bb6818 | 93 | struct drm_framebuffer *fb; |
3430824b | 94 | struct drm_device *dev = helper->dev; |
3a7f2f6a | 95 | struct drm_mode_fb_cmd2 mode_cmd = {}; |
05394f39 | 96 | struct drm_i915_gem_object *obj; |
57084d05 | 97 | int size, ret; |
79e53945 | 98 | |
b8c00ac5 | 99 | /* we don't do packed 24bpp */ |
38651674 DA |
100 | if (sizes->surface_bpp == 24) |
101 | sizes->surface_bpp = 32; | |
b8c00ac5 | 102 | |
38651674 DA |
103 | mode_cmd.width = sizes->surface_width; |
104 | mode_cmd.height = sizes->surface_height; | |
79e53945 | 105 | |
de45eaf7 PZ |
106 | mode_cmd.pitches[0] = ALIGN(mode_cmd.width * |
107 | DIV_ROUND_UP(sizes->surface_bpp, 8), 64); | |
308e5bcb JB |
108 | mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, |
109 | sizes->surface_depth); | |
79e53945 | 110 | |
308e5bcb | 111 | size = mode_cmd.pitches[0] * mode_cmd.height; |
1267a26b | 112 | size = PAGE_ALIGN(size); |
0ffb0ff2 CW |
113 | obj = i915_gem_object_create_stolen(dev, size); |
114 | if (obj == NULL) | |
115 | obj = i915_gem_alloc_object(dev, size); | |
05394f39 | 116 | if (!obj) { |
1ae8c0a5 | 117 | DRM_ERROR("failed to allocate framebuffer\n"); |
79e53945 JB |
118 | ret = -ENOMEM; |
119 | goto out; | |
120 | } | |
79e53945 | 121 | |
a8bb6818 DV |
122 | fb = __intel_framebuffer_create(dev, &mode_cmd, obj); |
123 | if (IS_ERR(fb)) { | |
124 | ret = PTR_ERR(fb); | |
850c4cdc TU |
125 | goto out_unref; |
126 | } | |
127 | ||
128 | /* Flush everything out, we'll be doing GTT only from now on */ | |
129 | ret = intel_pin_and_fence_fb_obj(NULL, fb, NULL); | |
130 | if (ret) { | |
131 | DRM_ERROR("failed to pin obj: %d\n", ret); | |
132 | goto out_fb; | |
a8bb6818 DV |
133 | } |
134 | ||
135 | ifbdev->fb = to_intel_framebuffer(fb); | |
8b4f49e0 JB |
136 | |
137 | return 0; | |
138 | ||
850c4cdc TU |
139 | out_fb: |
140 | drm_framebuffer_remove(fb); | |
8b4f49e0 JB |
141 | out_unref: |
142 | drm_gem_object_unreference(&obj->base); | |
143 | out: | |
144 | return ret; | |
145 | } | |
146 | ||
147 | static int intelfb_create(struct drm_fb_helper *helper, | |
148 | struct drm_fb_helper_surface_size *sizes) | |
149 | { | |
150 | struct intel_fbdev *ifbdev = | |
151 | container_of(helper, struct intel_fbdev, helper); | |
8bcd4553 | 152 | struct intel_framebuffer *intel_fb = ifbdev->fb; |
8b4f49e0 JB |
153 | struct drm_device *dev = helper->dev; |
154 | struct drm_i915_private *dev_priv = dev->dev_private; | |
155 | struct fb_info *info; | |
156 | struct drm_framebuffer *fb; | |
157 | struct drm_i915_gem_object *obj; | |
158 | int size, ret; | |
d978ef14 | 159 | bool prealloc = false; |
8b4f49e0 JB |
160 | |
161 | mutex_lock(&dev->struct_mutex); | |
162 | ||
edd586fe CW |
163 | if (intel_fb && |
164 | (sizes->fb_width > intel_fb->base.width || | |
165 | sizes->fb_height > intel_fb->base.height)) { | |
166 | DRM_DEBUG_KMS("BIOS fb too small (%dx%d), we require (%dx%d)," | |
167 | " releasing it\n", | |
168 | intel_fb->base.width, intel_fb->base.height, | |
169 | sizes->fb_width, sizes->fb_height); | |
170 | drm_framebuffer_unreference(&intel_fb->base); | |
171 | intel_fb = ifbdev->fb = NULL; | |
172 | } | |
8bcd4553 | 173 | if (!intel_fb || WARN_ON(!intel_fb->obj)) { |
48e92120 | 174 | DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n"); |
8b4f49e0 JB |
175 | ret = intelfb_alloc(helper, sizes); |
176 | if (ret) | |
177 | goto out_unlock; | |
8bcd4553 | 178 | intel_fb = ifbdev->fb; |
8b4f49e0 | 179 | } else { |
48e92120 | 180 | DRM_DEBUG_KMS("re-using BIOS fb\n"); |
d978ef14 | 181 | prealloc = true; |
8b4f49e0 JB |
182 | sizes->fb_width = intel_fb->base.width; |
183 | sizes->fb_height = intel_fb->base.height; | |
184 | } | |
185 | ||
186 | obj = intel_fb->obj; | |
187 | size = obj->base.size; | |
188 | ||
189 | info = framebuffer_alloc(0, &dev->pdev->dev); | |
79e53945 JB |
190 | if (!info) { |
191 | ret = -ENOMEM; | |
b4476f52 | 192 | goto out_unpin; |
79e53945 JB |
193 | } |
194 | ||
3430824b | 195 | info->par = helper; |
79e53945 | 196 | |
8bcd4553 | 197 | fb = &ifbdev->fb->base; |
79e53945 | 198 | |
38651674 DA |
199 | ifbdev->helper.fb = fb; |
200 | ifbdev->helper.fbdev = info; | |
785b93ef | 201 | |
79e53945 | 202 | strcpy(info->fix.id, "inteldrmfb"); |
79e53945 | 203 | |
8fd4bd22 | 204 | info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT; |
79e53945 JB |
205 | info->fbops = &intelfb_ops; |
206 | ||
35c3047a CW |
207 | ret = fb_alloc_cmap(&info->cmap, 256, 0); |
208 | if (ret) { | |
209 | ret = -ENOMEM; | |
210 | goto out_unpin; | |
211 | } | |
4410f391 | 212 | /* setup aperture base/size for vesafb takeover */ |
1471ca9a MS |
213 | info->apertures = alloc_apertures(1); |
214 | if (!info->apertures) { | |
215 | ret = -ENOMEM; | |
216 | goto out_unpin; | |
217 | } | |
218 | info->apertures->ranges[0].base = dev->mode_config.fb_base; | |
93d18799 | 219 | info->apertures->ranges[0].size = dev_priv->gtt.mappable_end; |
4410f391 | 220 | |
f343c5f6 | 221 | info->fix.smem_start = dev->mode_config.fb_base + i915_gem_obj_ggtt_offset(obj); |
79e53945 JB |
222 | info->fix.smem_len = size; |
223 | ||
dd2757f8 | 224 | info->screen_base = |
f343c5f6 | 225 | ioremap_wc(dev_priv->gtt.mappable_base + i915_gem_obj_ggtt_offset(obj), |
dd2757f8 | 226 | size); |
79e53945 JB |
227 | if (!info->screen_base) { |
228 | ret = -ENOSPC; | |
b4476f52 | 229 | goto out_unpin; |
79e53945 JB |
230 | } |
231 | info->screen_size = size; | |
232 | ||
24576d23 JB |
233 | /* This driver doesn't need a VT switch to restore the mode on resume */ |
234 | info->skip_vt_switch = true; | |
235 | ||
01f2c773 | 236 | drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth); |
38651674 | 237 | drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height); |
79e53945 | 238 | |
88afe715 CW |
239 | /* If the object is shmemfs backed, it will have given us zeroed pages. |
240 | * If the object is stolen however, it will be full of whatever | |
241 | * garbage was left in there. | |
242 | */ | |
d978ef14 | 243 | if (ifbdev->fb->obj->stolen && !prealloc) |
88afe715 CW |
244 | memset_io(info->screen_base, 0, info->screen_size); |
245 | ||
fb2a99e1 | 246 | /* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */ |
79e53945 | 247 | |
f343c5f6 | 248 | DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08lx, bo %p\n", |
8be48d92 | 249 | fb->width, fb->height, |
f343c5f6 | 250 | i915_gem_obj_ggtt_offset(obj), obj); |
79e53945 JB |
251 | |
252 | mutex_unlock(&dev->struct_mutex); | |
6a9ee8af | 253 | vga_switcheroo_client_fb_set(dev->pdev, info); |
79e53945 JB |
254 | return 0; |
255 | ||
b4476f52 | 256 | out_unpin: |
d7f46fc4 | 257 | i915_gem_object_ggtt_unpin(obj); |
05394f39 | 258 | drm_gem_object_unreference(&obj->base); |
8b4f49e0 | 259 | out_unlock: |
79e53945 | 260 | mutex_unlock(&dev->struct_mutex); |
79e53945 JB |
261 | return ret; |
262 | } | |
263 | ||
67437680 PZ |
264 | /** Sets the color ramps on behalf of RandR */ |
265 | static void intel_crtc_fb_gamma_set(struct drm_crtc *crtc, u16 red, u16 green, | |
266 | u16 blue, int regno) | |
267 | { | |
268 | struct intel_crtc *intel_crtc = to_intel_crtc(crtc); | |
269 | ||
270 | intel_crtc->lut_r[regno] = red >> 8; | |
271 | intel_crtc->lut_g[regno] = green >> 8; | |
272 | intel_crtc->lut_b[regno] = blue >> 8; | |
273 | } | |
274 | ||
275 | static void intel_crtc_fb_gamma_get(struct drm_crtc *crtc, u16 *red, u16 *green, | |
276 | u16 *blue, int regno) | |
277 | { | |
278 | struct intel_crtc *intel_crtc = to_intel_crtc(crtc); | |
279 | ||
280 | *red = intel_crtc->lut_r[regno] << 8; | |
281 | *green = intel_crtc->lut_g[regno] << 8; | |
282 | *blue = intel_crtc->lut_b[regno] << 8; | |
283 | } | |
284 | ||
eb1bfe80 JB |
285 | static struct drm_fb_helper_crtc * |
286 | intel_fb_helper_crtc(struct drm_fb_helper *fb_helper, struct drm_crtc *crtc) | |
287 | { | |
288 | int i; | |
289 | ||
290 | for (i = 0; i < fb_helper->crtc_count; i++) | |
291 | if (fb_helper->crtc_info[i].mode_set.crtc == crtc) | |
292 | return &fb_helper->crtc_info[i]; | |
293 | ||
294 | return NULL; | |
295 | } | |
296 | ||
297 | /* | |
298 | * Try to read the BIOS display configuration and use it for the initial | |
299 | * fb configuration. | |
300 | * | |
301 | * The BIOS or boot loader will generally create an initial display | |
302 | * configuration for us that includes some set of active pipes and displays. | |
303 | * This routine tries to figure out which pipes and connectors are active | |
304 | * and stuffs them into the crtcs and modes array given to us by the | |
305 | * drm_fb_helper code. | |
306 | * | |
307 | * The overall sequence is: | |
308 | * intel_fbdev_init - from driver load | |
309 | * intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data | |
310 | * drm_fb_helper_init - build fb helper structs | |
311 | * drm_fb_helper_single_add_all_connectors - more fb helper structs | |
312 | * intel_fbdev_initial_config - apply the config | |
313 | * drm_fb_helper_initial_config - call ->probe then register_framebuffer() | |
314 | * drm_setup_crtcs - build crtc config for fbdev | |
315 | * intel_fb_initial_config - find active connectors etc | |
316 | * drm_fb_helper_single_fb_probe - set up fbdev | |
317 | * intelfb_create - re-use or alloc fb, build out fbdev structs | |
318 | * | |
319 | * Note that we don't make special consideration whether we could actually | |
320 | * switch to the selected modes without a full modeset. E.g. when the display | |
321 | * is in VGA mode we need to recalculate watermarks and set a new high-res | |
322 | * framebuffer anyway. | |
323 | */ | |
324 | static bool intel_fb_initial_config(struct drm_fb_helper *fb_helper, | |
325 | struct drm_fb_helper_crtc **crtcs, | |
326 | struct drm_display_mode **modes, | |
b0ee9e7f | 327 | struct drm_fb_offset *offsets, |
eb1bfe80 JB |
328 | bool *enabled, int width, int height) |
329 | { | |
02f5eebb | 330 | struct drm_device *dev = fb_helper->dev; |
eb1bfe80 | 331 | int i, j; |
02f5eebb | 332 | bool *save_enabled; |
7c2bb531 | 333 | bool fallback = true; |
7e696e4c DV |
334 | int num_connectors_enabled = 0; |
335 | int num_connectors_detected = 0; | |
b0ee9e7f DA |
336 | uint64_t conn_configured = 0, mask; |
337 | int pass = 0; | |
02f5eebb JB |
338 | |
339 | save_enabled = kcalloc(dev->mode_config.num_connector, sizeof(bool), | |
340 | GFP_KERNEL); | |
341 | if (!save_enabled) | |
342 | return false; | |
343 | ||
344 | memcpy(save_enabled, enabled, dev->mode_config.num_connector); | |
b0ee9e7f DA |
345 | mask = (1 << fb_helper->connector_count) - 1; |
346 | retry: | |
eb1bfe80 JB |
347 | for (i = 0; i < fb_helper->connector_count; i++) { |
348 | struct drm_fb_helper_connector *fb_conn; | |
349 | struct drm_connector *connector; | |
350 | struct drm_encoder *encoder; | |
351 | struct drm_fb_helper_crtc *new_crtc; | |
352 | ||
353 | fb_conn = fb_helper->connector_info[i]; | |
354 | connector = fb_conn->connector; | |
7e696e4c | 355 | |
b0ee9e7f DA |
356 | if (conn_configured & (1 << i)) |
357 | continue; | |
358 | ||
359 | if (pass == 0 && !connector->has_tile) | |
360 | continue; | |
361 | ||
7e696e4c DV |
362 | if (connector->status == connector_status_connected) |
363 | num_connectors_detected++; | |
364 | ||
eb1bfe80 | 365 | if (!enabled[i]) { |
c0c97622 | 366 | DRM_DEBUG_KMS("connector %s not enabled, skipping\n", |
c23cc417 | 367 | connector->name); |
b0ee9e7f | 368 | conn_configured |= (1 << i); |
eb1bfe80 JB |
369 | continue; |
370 | } | |
371 | ||
d84a0f32 CW |
372 | if (connector->force == DRM_FORCE_OFF) { |
373 | DRM_DEBUG_KMS("connector %s is disabled by user, skipping\n", | |
374 | connector->name); | |
375 | enabled[i] = false; | |
376 | continue; | |
377 | } | |
378 | ||
eb1bfe80 JB |
379 | encoder = connector->encoder; |
380 | if (!encoder || WARN_ON(!encoder->crtc)) { | |
d84a0f32 CW |
381 | if (connector->force > DRM_FORCE_OFF) |
382 | goto bail; | |
383 | ||
c0c97622 | 384 | DRM_DEBUG_KMS("connector %s has no encoder or crtc, skipping\n", |
c23cc417 | 385 | connector->name); |
eb1bfe80 | 386 | enabled[i] = false; |
b0ee9e7f | 387 | conn_configured |= (1 << i); |
eb1bfe80 JB |
388 | continue; |
389 | } | |
390 | ||
7e696e4c DV |
391 | num_connectors_enabled++; |
392 | ||
eb1bfe80 JB |
393 | new_crtc = intel_fb_helper_crtc(fb_helper, encoder->crtc); |
394 | ||
395 | /* | |
396 | * Make sure we're not trying to drive multiple connectors | |
397 | * with a single CRTC, since our cloning support may not | |
398 | * match the BIOS. | |
399 | */ | |
400 | for (j = 0; j < fb_helper->connector_count; j++) { | |
02f5eebb | 401 | if (crtcs[j] == new_crtc) { |
7e696e4c | 402 | DRM_DEBUG_KMS("fallback: cloned configuration\n"); |
d84a0f32 | 403 | goto bail; |
02f5eebb | 404 | } |
eb1bfe80 JB |
405 | } |
406 | ||
c0c97622 | 407 | DRM_DEBUG_KMS("looking for cmdline mode on connector %s\n", |
c23cc417 | 408 | connector->name); |
eb1bfe80 JB |
409 | |
410 | /* go for command line mode first */ | |
411 | modes[i] = drm_pick_cmdline_mode(fb_conn, width, height); | |
412 | ||
413 | /* try for preferred next */ | |
414 | if (!modes[i]) { | |
b0ee9e7f DA |
415 | DRM_DEBUG_KMS("looking for preferred mode on connector %s %d\n", |
416 | connector->name, connector->has_tile); | |
eb1bfe80 JB |
417 | modes[i] = drm_has_preferred_mode(fb_conn, width, |
418 | height); | |
419 | } | |
420 | ||
afba0b5a CW |
421 | /* No preferred mode marked by the EDID? Are there any modes? */ |
422 | if (!modes[i] && !list_empty(&connector->modes)) { | |
423 | DRM_DEBUG_KMS("using first mode listed on connector %s\n", | |
8d4ad9d4 | 424 | connector->name); |
afba0b5a CW |
425 | modes[i] = list_first_entry(&connector->modes, |
426 | struct drm_display_mode, | |
427 | head); | |
428 | } | |
429 | ||
eb1bfe80 JB |
430 | /* last resort: use current mode */ |
431 | if (!modes[i]) { | |
432 | /* | |
433 | * IMPORTANT: We want to use the adjusted mode (i.e. | |
434 | * after the panel fitter upscaling) as the initial | |
435 | * config, not the input mode, which is what crtc->mode | |
436 | * usually contains. But since our current fastboot | |
437 | * code puts a mode derived from the post-pfit timings | |
438 | * into crtc->mode this works out correctly. We don't | |
439 | * use hwmode anywhere right now, so use it for this | |
440 | * since the fb helper layer wants a pointer to | |
441 | * something we own. | |
442 | */ | |
c0c97622 | 443 | DRM_DEBUG_KMS("looking for current mode on connector %s\n", |
c23cc417 | 444 | connector->name); |
eb1bfe80 | 445 | intel_mode_from_pipe_config(&encoder->crtc->hwmode, |
6e3c9717 | 446 | to_intel_crtc(encoder->crtc)->config); |
eb1bfe80 JB |
447 | modes[i] = &encoder->crtc->hwmode; |
448 | } | |
449 | crtcs[i] = new_crtc; | |
450 | ||
fdaf66de | 451 | DRM_DEBUG_KMS("connector %s on pipe %c [CRTC:%d]: %dx%d%s\n", |
c23cc417 | 452 | connector->name, |
c0c97622 | 453 | pipe_name(to_intel_crtc(encoder->crtc)->pipe), |
eb1bfe80 | 454 | encoder->crtc->base.id, |
c0c97622 CW |
455 | modes[i]->hdisplay, modes[i]->vdisplay, |
456 | modes[i]->flags & DRM_MODE_FLAG_INTERLACE ? "i" :""); | |
02f5eebb | 457 | |
7c2bb531 | 458 | fallback = false; |
b0ee9e7f DA |
459 | conn_configured |= (1 << i); |
460 | } | |
461 | ||
462 | if ((conn_configured & mask) != mask) { | |
463 | pass++; | |
464 | goto retry; | |
02f5eebb JB |
465 | } |
466 | ||
7e696e4c DV |
467 | /* |
468 | * If the BIOS didn't enable everything it could, fall back to have the | |
469 | * same user experiencing of lighting up as much as possible like the | |
470 | * fbdev helper library. | |
471 | */ | |
472 | if (num_connectors_enabled != num_connectors_detected && | |
473 | num_connectors_enabled < INTEL_INFO(dev)->num_pipes) { | |
474 | DRM_DEBUG_KMS("fallback: Not all outputs enabled\n"); | |
475 | DRM_DEBUG_KMS("Enabled: %i, detected: %i\n", num_connectors_enabled, | |
476 | num_connectors_detected); | |
477 | fallback = true; | |
478 | } | |
479 | ||
7c2bb531 | 480 | if (fallback) { |
d84a0f32 | 481 | bail: |
7e696e4c | 482 | DRM_DEBUG_KMS("Not using firmware configuration\n"); |
02f5eebb JB |
483 | memcpy(enabled, save_enabled, dev->mode_config.num_connector); |
484 | kfree(save_enabled); | |
485 | return false; | |
eb1bfe80 JB |
486 | } |
487 | ||
02f5eebb | 488 | kfree(save_enabled); |
eb1bfe80 JB |
489 | return true; |
490 | } | |
491 | ||
3a493879 | 492 | static const struct drm_fb_helper_funcs intel_fb_helper_funcs = { |
eb1bfe80 | 493 | .initial_config = intel_fb_initial_config, |
4abe3520 DA |
494 | .gamma_set = intel_crtc_fb_gamma_set, |
495 | .gamma_get = intel_crtc_fb_gamma_get, | |
cd5428a5 | 496 | .fb_probe = intelfb_create, |
4abe3520 | 497 | }; |
79e53945 | 498 | |
7b4f3990 CW |
499 | static void intel_fbdev_destroy(struct drm_device *dev, |
500 | struct intel_fbdev *ifbdev) | |
79e53945 | 501 | { |
8be48d92 | 502 | if (ifbdev->helper.fbdev) { |
ddfe1567 CW |
503 | struct fb_info *info = ifbdev->helper.fbdev; |
504 | ||
79e53945 JB |
505 | unregister_framebuffer(info); |
506 | iounmap(info->screen_base); | |
4abe3520 DA |
507 | if (info->cmap.len) |
508 | fb_dealloc_cmap(&info->cmap); | |
ddfe1567 | 509 | |
79e53945 JB |
510 | framebuffer_release(info); |
511 | } | |
512 | ||
4abe3520 | 513 | drm_fb_helper_fini(&ifbdev->helper); |
79e53945 | 514 | |
8bcd4553 | 515 | drm_framebuffer_unregister_private(&ifbdev->fb->base); |
9d661251 | 516 | drm_framebuffer_remove(&ifbdev->fb->base); |
79e53945 | 517 | } |
38651674 | 518 | |
d978ef14 JB |
519 | /* |
520 | * Build an intel_fbdev struct using a BIOS allocated framebuffer, if possible. | |
521 | * The core display code will have read out the current plane configuration, | |
522 | * so we use that to figure out if there's an object for us to use as the | |
523 | * fb, and if so, we re-use it for the fbdev configuration. | |
524 | * | |
525 | * Note we only support a single fb shared across pipes for boot (mostly for | |
526 | * fbcon), so we just find the biggest and use that. | |
527 | */ | |
528 | static bool intel_fbdev_init_bios(struct drm_device *dev, | |
529 | struct intel_fbdev *ifbdev) | |
530 | { | |
531 | struct intel_framebuffer *fb = NULL; | |
532 | struct drm_crtc *crtc; | |
533 | struct intel_crtc *intel_crtc; | |
5724dbd1 | 534 | struct intel_initial_plane_config *plane_config = NULL; |
d978ef14 JB |
535 | unsigned int max_size = 0; |
536 | ||
537 | if (!i915.fastboot) | |
538 | return false; | |
539 | ||
540 | /* Find the largest fb */ | |
70e1e0ec | 541 | for_each_crtc(dev, crtc) { |
d978ef14 JB |
542 | intel_crtc = to_intel_crtc(crtc); |
543 | ||
66e514c1 | 544 | if (!intel_crtc->active || !crtc->primary->fb) { |
d978ef14 JB |
545 | DRM_DEBUG_KMS("pipe %c not active or no fb, skipping\n", |
546 | pipe_name(intel_crtc->pipe)); | |
547 | continue; | |
548 | } | |
549 | ||
550 | if (intel_crtc->plane_config.size > max_size) { | |
551 | DRM_DEBUG_KMS("found possible fb from plane %c\n", | |
552 | pipe_name(intel_crtc->pipe)); | |
553 | plane_config = &intel_crtc->plane_config; | |
66e514c1 | 554 | fb = to_intel_framebuffer(crtc->primary->fb); |
d978ef14 JB |
555 | max_size = plane_config->size; |
556 | } | |
557 | } | |
558 | ||
559 | if (!fb) { | |
560 | DRM_DEBUG_KMS("no active fbs found, not using BIOS config\n"); | |
561 | goto out; | |
562 | } | |
563 | ||
564 | /* Now make sure all the pipes will fit into it */ | |
70e1e0ec | 565 | for_each_crtc(dev, crtc) { |
d978ef14 JB |
566 | unsigned int cur_size; |
567 | ||
568 | intel_crtc = to_intel_crtc(crtc); | |
569 | ||
570 | if (!intel_crtc->active) { | |
571 | DRM_DEBUG_KMS("pipe %c not active, skipping\n", | |
572 | pipe_name(intel_crtc->pipe)); | |
573 | continue; | |
574 | } | |
575 | ||
576 | DRM_DEBUG_KMS("checking plane %c for BIOS fb\n", | |
577 | pipe_name(intel_crtc->pipe)); | |
578 | ||
579 | /* | |
580 | * See if the plane fb we found above will fit on this | |
bc104d1f CW |
581 | * pipe. Note we need to use the selected fb's pitch and bpp |
582 | * rather than the current pipe's, since they differ. | |
d978ef14 | 583 | */ |
6e3c9717 | 584 | cur_size = intel_crtc->config->base.adjusted_mode.crtc_hdisplay; |
bc104d1f CW |
585 | cur_size = cur_size * fb->base.bits_per_pixel / 8; |
586 | if (fb->base.pitches[0] < cur_size) { | |
587 | DRM_DEBUG_KMS("fb not wide enough for plane %c (%d vs %d)\n", | |
588 | pipe_name(intel_crtc->pipe), | |
589 | cur_size, fb->base.pitches[0]); | |
590 | plane_config = NULL; | |
591 | fb = NULL; | |
592 | break; | |
593 | } | |
594 | ||
6e3c9717 | 595 | cur_size = intel_crtc->config->base.adjusted_mode.crtc_vdisplay; |
ec2c981e DL |
596 | cur_size = intel_fb_align_height(dev, cur_size, |
597 | plane_config->tiling); | |
bc104d1f CW |
598 | cur_size *= fb->base.pitches[0]; |
599 | DRM_DEBUG_KMS("pipe %c area: %dx%d, bpp: %d, size: %d\n", | |
600 | pipe_name(intel_crtc->pipe), | |
6e3c9717 ACO |
601 | intel_crtc->config->base.adjusted_mode.crtc_hdisplay, |
602 | intel_crtc->config->base.adjusted_mode.crtc_vdisplay, | |
bc104d1f | 603 | fb->base.bits_per_pixel, |
d978ef14 | 604 | cur_size); |
d978ef14 JB |
605 | |
606 | if (cur_size > max_size) { | |
607 | DRM_DEBUG_KMS("fb not big enough for plane %c (%d vs %d)\n", | |
608 | pipe_name(intel_crtc->pipe), | |
609 | cur_size, max_size); | |
610 | plane_config = NULL; | |
611 | fb = NULL; | |
612 | break; | |
613 | } | |
614 | ||
615 | DRM_DEBUG_KMS("fb big enough for plane %c (%d >= %d)\n", | |
616 | pipe_name(intel_crtc->pipe), | |
617 | max_size, cur_size); | |
618 | } | |
619 | ||
d978ef14 JB |
620 | if (!fb) { |
621 | DRM_DEBUG_KMS("BIOS fb not suitable for all pipes, not using\n"); | |
622 | goto out; | |
623 | } | |
624 | ||
484b41dd | 625 | ifbdev->preferred_bpp = fb->base.bits_per_pixel; |
d978ef14 JB |
626 | ifbdev->fb = fb; |
627 | ||
484b41dd | 628 | drm_framebuffer_reference(&ifbdev->fb->base); |
d978ef14 JB |
629 | |
630 | /* Final pass to check if any active pipes don't have fbs */ | |
70e1e0ec | 631 | for_each_crtc(dev, crtc) { |
d978ef14 JB |
632 | intel_crtc = to_intel_crtc(crtc); |
633 | ||
634 | if (!intel_crtc->active) | |
635 | continue; | |
636 | ||
66e514c1 | 637 | WARN(!crtc->primary->fb, |
d978ef14 JB |
638 | "re-used BIOS config but lost an fb on crtc %d\n", |
639 | crtc->base.id); | |
640 | } | |
641 | ||
642 | ||
643 | DRM_DEBUG_KMS("using BIOS fb for initial console\n"); | |
644 | return true; | |
645 | ||
d978ef14 JB |
646 | out: |
647 | ||
648 | return false; | |
649 | } | |
650 | ||
82e3b8c1 CW |
651 | static void intel_fbdev_suspend_worker(struct work_struct *work) |
652 | { | |
653 | intel_fbdev_set_suspend(container_of(work, | |
654 | struct drm_i915_private, | |
655 | fbdev_suspend_work)->dev, | |
656 | FBINFO_STATE_RUNNING, | |
657 | true); | |
658 | } | |
659 | ||
38651674 DA |
660 | int intel_fbdev_init(struct drm_device *dev) |
661 | { | |
8be48d92 | 662 | struct intel_fbdev *ifbdev; |
b51b32cd | 663 | struct drm_i915_private *dev_priv = dev->dev_private; |
5a79395b | 664 | int ret; |
8be48d92 | 665 | |
d978ef14 JB |
666 | if (WARN_ON(INTEL_INFO(dev)->num_pipes == 0)) |
667 | return -ENODEV; | |
668 | ||
669 | ifbdev = kzalloc(sizeof(struct intel_fbdev), GFP_KERNEL); | |
670 | if (ifbdev == NULL) | |
8be48d92 DA |
671 | return -ENOMEM; |
672 | ||
10a23102 TR |
673 | drm_fb_helper_prepare(dev, &ifbdev->helper, &intel_fb_helper_funcs); |
674 | ||
d978ef14 JB |
675 | if (!intel_fbdev_init_bios(dev, ifbdev)) |
676 | ifbdev->preferred_bpp = 32; | |
4abe3520 | 677 | |
5a79395b | 678 | ret = drm_fb_helper_init(dev, &ifbdev->helper, |
d978ef14 | 679 | INTEL_INFO(dev)->num_pipes, 4); |
5a79395b CW |
680 | if (ret) { |
681 | kfree(ifbdev); | |
682 | return ret; | |
683 | } | |
8be48d92 | 684 | |
d978ef14 | 685 | dev_priv->fbdev = ifbdev; |
82e3b8c1 CW |
686 | INIT_WORK(&dev_priv->fbdev_suspend_work, intel_fbdev_suspend_worker); |
687 | ||
0b4c0f3f | 688 | drm_fb_helper_single_add_all_connectors(&ifbdev->helper); |
20afbda2 | 689 | |
79e53945 JB |
690 | return 0; |
691 | } | |
38651674 | 692 | |
d1d70677 | 693 | void intel_fbdev_initial_config(void *data, async_cookie_t cookie) |
20afbda2 | 694 | { |
d1d70677 | 695 | struct drm_i915_private *dev_priv = data; |
d978ef14 | 696 | struct intel_fbdev *ifbdev = dev_priv->fbdev; |
20afbda2 DV |
697 | |
698 | /* Due to peculiar init order wrt to hpd handling this is separate. */ | |
d978ef14 | 699 | drm_fb_helper_initial_config(&ifbdev->helper, ifbdev->preferred_bpp); |
20afbda2 DV |
700 | } |
701 | ||
38651674 DA |
702 | void intel_fbdev_fini(struct drm_device *dev) |
703 | { | |
b51b32cd | 704 | struct drm_i915_private *dev_priv = dev->dev_private; |
8be48d92 DA |
705 | if (!dev_priv->fbdev) |
706 | return; | |
707 | ||
82e3b8c1 CW |
708 | flush_work(&dev_priv->fbdev_suspend_work); |
709 | ||
d1d70677 | 710 | async_synchronize_full(); |
38651674 | 711 | intel_fbdev_destroy(dev, dev_priv->fbdev); |
8be48d92 | 712 | kfree(dev_priv->fbdev); |
38651674 DA |
713 | dev_priv->fbdev = NULL; |
714 | } | |
3fa016a0 | 715 | |
82e3b8c1 | 716 | void intel_fbdev_set_suspend(struct drm_device *dev, int state, bool synchronous) |
3fa016a0 | 717 | { |
b51b32cd | 718 | struct drm_i915_private *dev_priv = dev->dev_private; |
1ffc5289 JN |
719 | struct intel_fbdev *ifbdev = dev_priv->fbdev; |
720 | struct fb_info *info; | |
721 | ||
722 | if (!ifbdev) | |
3fa016a0 DA |
723 | return; |
724 | ||
1ffc5289 JN |
725 | info = ifbdev->helper.fbdev; |
726 | ||
82e3b8c1 CW |
727 | if (synchronous) { |
728 | /* Flush any pending work to turn the console on, and then | |
729 | * wait to turn it off. It must be synchronous as we are | |
730 | * about to suspend or unload the driver. | |
731 | * | |
732 | * Note that from within the work-handler, we cannot flush | |
733 | * ourselves, so only flush outstanding work upon suspend! | |
734 | */ | |
735 | if (state != FBINFO_STATE_RUNNING) | |
736 | flush_work(&dev_priv->fbdev_suspend_work); | |
737 | console_lock(); | |
738 | } else { | |
739 | /* | |
740 | * The console lock can be pretty contented on resume due | |
741 | * to all the printk activity. Try to keep it out of the hot | |
742 | * path of resume if possible. | |
743 | */ | |
744 | WARN_ON(state != FBINFO_STATE_RUNNING); | |
745 | if (!console_trylock()) { | |
746 | /* Don't block our own workqueue as this can | |
747 | * be run in parallel with other i915.ko tasks. | |
748 | */ | |
749 | schedule_work(&dev_priv->fbdev_suspend_work); | |
750 | return; | |
751 | } | |
752 | } | |
753 | ||
1ffc5289 JN |
754 | /* On resume from hibernation: If the object is shmemfs backed, it has |
755 | * been restored from swap. If the object is stolen however, it will be | |
756 | * full of whatever garbage was left in there. | |
757 | */ | |
8bcd4553 | 758 | if (state == FBINFO_STATE_RUNNING && ifbdev->fb->obj->stolen) |
1ffc5289 JN |
759 | memset_io(info->screen_base, 0, info->screen_size); |
760 | ||
761 | fb_set_suspend(info, state); | |
82e3b8c1 | 762 | console_unlock(); |
3fa016a0 DA |
763 | } |
764 | ||
0632fef6 | 765 | void intel_fbdev_output_poll_changed(struct drm_device *dev) |
eb1f8e4f | 766 | { |
b51b32cd | 767 | struct drm_i915_private *dev_priv = dev->dev_private; |
d978ef14 JB |
768 | if (dev_priv->fbdev) |
769 | drm_fb_helper_hotplug_event(&dev_priv->fbdev->helper); | |
eb1f8e4f | 770 | } |
e8e7a2b8 | 771 | |
0632fef6 | 772 | void intel_fbdev_restore_mode(struct drm_device *dev) |
e8e7a2b8 DA |
773 | { |
774 | int ret; | |
b51b32cd | 775 | struct drm_i915_private *dev_priv = dev->dev_private; |
e8e7a2b8 | 776 | |
d978ef14 | 777 | if (!dev_priv->fbdev) |
e3c74757 BW |
778 | return; |
779 | ||
5ea1f752 | 780 | ret = drm_fb_helper_restore_fbdev_mode_unlocked(&dev_priv->fbdev->helper); |
e8e7a2b8 DA |
781 | if (ret) |
782 | DRM_DEBUG("failed to restore crtc mode\n"); | |
783 | } |