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