2 * Copyright © 2007 David Airlie
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:
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
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.
27 #include <linux/module.h>
28 #include <linux/kernel.h>
29 #include <linux/errno.h>
30 #include <linux/string.h>
32 #include <linux/tty.h>
33 #include <linux/sysrq.h>
34 #include <linux/delay.h>
36 #include <linux/init.h>
37 #include <linux/vga_switcheroo.h>
40 #include <drm/drm_crtc.h>
41 #include <drm/drm_fb_helper.h>
42 #include "intel_drv.h"
43 #include <drm/i915_drm.h>
46 static struct fb_ops intelfb_ops
= {
48 .fb_check_var
= drm_fb_helper_check_var
,
49 .fb_set_par
= drm_fb_helper_set_par
,
50 .fb_fillrect
= cfb_fillrect
,
51 .fb_copyarea
= cfb_copyarea
,
52 .fb_imageblit
= cfb_imageblit
,
53 .fb_pan_display
= drm_fb_helper_pan_display
,
54 .fb_blank
= drm_fb_helper_blank
,
55 .fb_setcmap
= drm_fb_helper_setcmap
,
56 .fb_debug_enter
= drm_fb_helper_debug_enter
,
57 .fb_debug_leave
= drm_fb_helper_debug_leave
,
60 static int intelfb_alloc(struct drm_fb_helper
*helper
,
61 struct drm_fb_helper_surface_size
*sizes
)
63 struct intel_fbdev
*ifbdev
=
64 container_of(helper
, struct intel_fbdev
, helper
);
65 struct drm_framebuffer
*fb
;
66 struct drm_device
*dev
= helper
->dev
;
67 struct drm_mode_fb_cmd2 mode_cmd
= {};
68 struct drm_i915_gem_object
*obj
;
71 /* we don't do packed 24bpp */
72 if (sizes
->surface_bpp
== 24)
73 sizes
->surface_bpp
= 32;
75 mode_cmd
.width
= sizes
->surface_width
;
76 mode_cmd
.height
= sizes
->surface_height
;
78 mode_cmd
.pitches
[0] = ALIGN(mode_cmd
.width
*
79 DIV_ROUND_UP(sizes
->surface_bpp
, 8), 64);
80 mode_cmd
.pixel_format
= drm_mode_legacy_fb_format(sizes
->surface_bpp
,
81 sizes
->surface_depth
);
83 size
= mode_cmd
.pitches
[0] * mode_cmd
.height
;
84 size
= ALIGN(size
, PAGE_SIZE
);
85 obj
= i915_gem_object_create_stolen(dev
, size
);
87 obj
= i915_gem_alloc_object(dev
, size
);
89 DRM_ERROR("failed to allocate framebuffer\n");
94 /* Flush everything out, we'll be doing GTT only from now on */
95 ret
= intel_pin_and_fence_fb_obj(dev
, obj
, NULL
);
97 DRM_ERROR("failed to pin obj: %d\n", ret
);
101 fb
= __intel_framebuffer_create(dev
, &mode_cmd
, obj
);
107 ifbdev
->fb
= to_intel_framebuffer(fb
);
112 i915_gem_object_ggtt_unpin(obj
);
114 drm_gem_object_unreference(&obj
->base
);
119 static int intelfb_create(struct drm_fb_helper
*helper
,
120 struct drm_fb_helper_surface_size
*sizes
)
122 struct intel_fbdev
*ifbdev
=
123 container_of(helper
, struct intel_fbdev
, helper
);
124 struct intel_framebuffer
*intel_fb
= ifbdev
->fb
;
125 struct drm_device
*dev
= helper
->dev
;
126 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
127 struct fb_info
*info
;
128 struct drm_framebuffer
*fb
;
129 struct drm_i915_gem_object
*obj
;
131 bool prealloc
= false;
133 mutex_lock(&dev
->struct_mutex
);
136 (sizes
->fb_width
> intel_fb
->base
.width
||
137 sizes
->fb_height
> intel_fb
->base
.height
)) {
138 DRM_DEBUG_KMS("BIOS fb too small (%dx%d), we require (%dx%d),"
140 intel_fb
->base
.width
, intel_fb
->base
.height
,
141 sizes
->fb_width
, sizes
->fb_height
);
142 drm_framebuffer_unreference(&intel_fb
->base
);
143 intel_fb
= ifbdev
->fb
= NULL
;
145 if (!intel_fb
|| WARN_ON(!intel_fb
->obj
)) {
146 DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n");
147 ret
= intelfb_alloc(helper
, sizes
);
150 intel_fb
= ifbdev
->fb
;
152 DRM_DEBUG_KMS("re-using BIOS fb\n");
154 sizes
->fb_width
= intel_fb
->base
.width
;
155 sizes
->fb_height
= intel_fb
->base
.height
;
159 size
= obj
->base
.size
;
161 info
= framebuffer_alloc(0, &dev
->pdev
->dev
);
169 fb
= &ifbdev
->fb
->base
;
171 ifbdev
->helper
.fb
= fb
;
172 ifbdev
->helper
.fbdev
= info
;
174 strcpy(info
->fix
.id
, "inteldrmfb");
176 info
->flags
= FBINFO_DEFAULT
| FBINFO_CAN_FORCE_OUTPUT
;
177 info
->fbops
= &intelfb_ops
;
179 ret
= fb_alloc_cmap(&info
->cmap
, 256, 0);
184 /* setup aperture base/size for vesafb takeover */
185 info
->apertures
= alloc_apertures(1);
186 if (!info
->apertures
) {
190 info
->apertures
->ranges
[0].base
= dev
->mode_config
.fb_base
;
191 info
->apertures
->ranges
[0].size
= dev_priv
->gtt
.mappable_end
;
193 info
->fix
.smem_start
= dev
->mode_config
.fb_base
+ i915_gem_obj_ggtt_offset(obj
);
194 info
->fix
.smem_len
= size
;
197 ioremap_wc(dev_priv
->gtt
.mappable_base
+ i915_gem_obj_ggtt_offset(obj
),
199 if (!info
->screen_base
) {
203 info
->screen_size
= size
;
205 /* This driver doesn't need a VT switch to restore the mode on resume */
206 info
->skip_vt_switch
= true;
208 drm_fb_helper_fill_fix(info
, fb
->pitches
[0], fb
->depth
);
209 drm_fb_helper_fill_var(info
, &ifbdev
->helper
, sizes
->fb_width
, sizes
->fb_height
);
211 /* If the object is shmemfs backed, it will have given us zeroed pages.
212 * If the object is stolen however, it will be full of whatever
213 * garbage was left in there.
215 if (ifbdev
->fb
->obj
->stolen
&& !prealloc
)
216 memset_io(info
->screen_base
, 0, info
->screen_size
);
218 /* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
220 DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08lx, bo %p\n",
221 fb
->width
, fb
->height
,
222 i915_gem_obj_ggtt_offset(obj
), obj
);
224 mutex_unlock(&dev
->struct_mutex
);
225 vga_switcheroo_client_fb_set(dev
->pdev
, info
);
229 i915_gem_object_ggtt_unpin(obj
);
230 drm_gem_object_unreference(&obj
->base
);
232 mutex_unlock(&dev
->struct_mutex
);
236 /** Sets the color ramps on behalf of RandR */
237 static void intel_crtc_fb_gamma_set(struct drm_crtc
*crtc
, u16 red
, u16 green
,
240 struct intel_crtc
*intel_crtc
= to_intel_crtc(crtc
);
242 intel_crtc
->lut_r
[regno
] = red
>> 8;
243 intel_crtc
->lut_g
[regno
] = green
>> 8;
244 intel_crtc
->lut_b
[regno
] = blue
>> 8;
247 static void intel_crtc_fb_gamma_get(struct drm_crtc
*crtc
, u16
*red
, u16
*green
,
248 u16
*blue
, int regno
)
250 struct intel_crtc
*intel_crtc
= to_intel_crtc(crtc
);
252 *red
= intel_crtc
->lut_r
[regno
] << 8;
253 *green
= intel_crtc
->lut_g
[regno
] << 8;
254 *blue
= intel_crtc
->lut_b
[regno
] << 8;
257 static struct drm_fb_helper_crtc
*
258 intel_fb_helper_crtc(struct drm_fb_helper
*fb_helper
, struct drm_crtc
*crtc
)
262 for (i
= 0; i
< fb_helper
->crtc_count
; i
++)
263 if (fb_helper
->crtc_info
[i
].mode_set
.crtc
== crtc
)
264 return &fb_helper
->crtc_info
[i
];
270 * Try to read the BIOS display configuration and use it for the initial
273 * The BIOS or boot loader will generally create an initial display
274 * configuration for us that includes some set of active pipes and displays.
275 * This routine tries to figure out which pipes and connectors are active
276 * and stuffs them into the crtcs and modes array given to us by the
277 * drm_fb_helper code.
279 * The overall sequence is:
280 * intel_fbdev_init - from driver load
281 * intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data
282 * drm_fb_helper_init - build fb helper structs
283 * drm_fb_helper_single_add_all_connectors - more fb helper structs
284 * intel_fbdev_initial_config - apply the config
285 * drm_fb_helper_initial_config - call ->probe then register_framebuffer()
286 * drm_setup_crtcs - build crtc config for fbdev
287 * intel_fb_initial_config - find active connectors etc
288 * drm_fb_helper_single_fb_probe - set up fbdev
289 * intelfb_create - re-use or alloc fb, build out fbdev structs
291 * Note that we don't make special consideration whether we could actually
292 * switch to the selected modes without a full modeset. E.g. when the display
293 * is in VGA mode we need to recalculate watermarks and set a new high-res
294 * framebuffer anyway.
296 static bool intel_fb_initial_config(struct drm_fb_helper
*fb_helper
,
297 struct drm_fb_helper_crtc
**crtcs
,
298 struct drm_display_mode
**modes
,
299 bool *enabled
, int width
, int height
)
301 struct drm_device
*dev
= fb_helper
->dev
;
304 bool fallback
= true;
305 int num_connectors_enabled
= 0;
306 int num_connectors_detected
= 0;
309 * If the user specified any force options, just bail here
310 * and use that config.
312 for (i
= 0; i
< fb_helper
->connector_count
; i
++) {
313 struct drm_fb_helper_connector
*fb_conn
;
314 struct drm_connector
*connector
;
316 fb_conn
= fb_helper
->connector_info
[i
];
317 connector
= fb_conn
->connector
;
322 if (connector
->force
!= DRM_FORCE_UNSPECIFIED
)
326 save_enabled
= kcalloc(dev
->mode_config
.num_connector
, sizeof(bool),
331 memcpy(save_enabled
, enabled
, dev
->mode_config
.num_connector
);
333 for (i
= 0; i
< fb_helper
->connector_count
; i
++) {
334 struct drm_fb_helper_connector
*fb_conn
;
335 struct drm_connector
*connector
;
336 struct drm_encoder
*encoder
;
337 struct drm_fb_helper_crtc
*new_crtc
;
339 fb_conn
= fb_helper
->connector_info
[i
];
340 connector
= fb_conn
->connector
;
342 if (connector
->status
== connector_status_connected
)
343 num_connectors_detected
++;
346 DRM_DEBUG_KMS("connector %s not enabled, skipping\n",
347 drm_get_connector_name(connector
));
351 encoder
= connector
->encoder
;
352 if (!encoder
|| WARN_ON(!encoder
->crtc
)) {
353 DRM_DEBUG_KMS("connector %s has no encoder or crtc, skipping\n",
354 drm_get_connector_name(connector
));
359 num_connectors_enabled
++;
361 new_crtc
= intel_fb_helper_crtc(fb_helper
, encoder
->crtc
);
364 * Make sure we're not trying to drive multiple connectors
365 * with a single CRTC, since our cloning support may not
368 for (j
= 0; j
< fb_helper
->connector_count
; j
++) {
369 if (crtcs
[j
] == new_crtc
) {
370 DRM_DEBUG_KMS("fallback: cloned configuration\n");
376 DRM_DEBUG_KMS("looking for cmdline mode on connector %s\n",
377 drm_get_connector_name(connector
));
379 /* go for command line mode first */
380 modes
[i
] = drm_pick_cmdline_mode(fb_conn
, width
, height
);
382 /* try for preferred next */
384 DRM_DEBUG_KMS("looking for preferred mode on connector %s\n",
385 drm_get_connector_name(connector
));
386 modes
[i
] = drm_has_preferred_mode(fb_conn
, width
,
390 /* last resort: use current mode */
393 * IMPORTANT: We want to use the adjusted mode (i.e.
394 * after the panel fitter upscaling) as the initial
395 * config, not the input mode, which is what crtc->mode
396 * usually contains. But since our current fastboot
397 * code puts a mode derived from the post-pfit timings
398 * into crtc->mode this works out correctly. We don't
399 * use hwmode anywhere right now, so use it for this
400 * since the fb helper layer wants a pointer to
403 DRM_DEBUG_KMS("looking for current mode on connector %s\n",
404 drm_get_connector_name(connector
));
405 intel_mode_from_pipe_config(&encoder
->crtc
->hwmode
,
406 &to_intel_crtc(encoder
->crtc
)->config
);
407 modes
[i
] = &encoder
->crtc
->hwmode
;
411 DRM_DEBUG_KMS("connector %s on pipe %d [CRTC:%d]: %dx%d%s\n",
412 drm_get_connector_name(connector
),
413 pipe_name(to_intel_crtc(encoder
->crtc
)->pipe
),
414 encoder
->crtc
->base
.id
,
415 modes
[i
]->hdisplay
, modes
[i
]->vdisplay
,
416 modes
[i
]->flags
& DRM_MODE_FLAG_INTERLACE
? "i" :"");
422 * If the BIOS didn't enable everything it could, fall back to have the
423 * same user experiencing of lighting up as much as possible like the
424 * fbdev helper library.
426 if (num_connectors_enabled
!= num_connectors_detected
&&
427 num_connectors_enabled
< INTEL_INFO(dev
)->num_pipes
) {
428 DRM_DEBUG_KMS("fallback: Not all outputs enabled\n");
429 DRM_DEBUG_KMS("Enabled: %i, detected: %i\n", num_connectors_enabled
,
430 num_connectors_detected
);
436 DRM_DEBUG_KMS("Not using firmware configuration\n");
437 memcpy(enabled
, save_enabled
, dev
->mode_config
.num_connector
);
446 static struct drm_fb_helper_funcs intel_fb_helper_funcs
= {
447 .initial_config
= intel_fb_initial_config
,
448 .gamma_set
= intel_crtc_fb_gamma_set
,
449 .gamma_get
= intel_crtc_fb_gamma_get
,
450 .fb_probe
= intelfb_create
,
453 static void intel_fbdev_destroy(struct drm_device
*dev
,
454 struct intel_fbdev
*ifbdev
)
456 if (ifbdev
->helper
.fbdev
) {
457 struct fb_info
*info
= ifbdev
->helper
.fbdev
;
459 unregister_framebuffer(info
);
460 iounmap(info
->screen_base
);
462 fb_dealloc_cmap(&info
->cmap
);
464 framebuffer_release(info
);
467 drm_fb_helper_fini(&ifbdev
->helper
);
469 drm_framebuffer_unregister_private(&ifbdev
->fb
->base
);
470 drm_framebuffer_remove(&ifbdev
->fb
->base
);
474 * Build an intel_fbdev struct using a BIOS allocated framebuffer, if possible.
475 * The core display code will have read out the current plane configuration,
476 * so we use that to figure out if there's an object for us to use as the
477 * fb, and if so, we re-use it for the fbdev configuration.
479 * Note we only support a single fb shared across pipes for boot (mostly for
480 * fbcon), so we just find the biggest and use that.
482 static bool intel_fbdev_init_bios(struct drm_device
*dev
,
483 struct intel_fbdev
*ifbdev
)
485 struct intel_framebuffer
*fb
= NULL
;
486 struct drm_crtc
*crtc
;
487 struct intel_crtc
*intel_crtc
;
488 struct intel_plane_config
*plane_config
= NULL
;
489 unsigned int max_size
= 0;
494 /* Find the largest fb */
495 for_each_crtc(dev
, crtc
) {
496 intel_crtc
= to_intel_crtc(crtc
);
498 if (!intel_crtc
->active
|| !crtc
->primary
->fb
) {
499 DRM_DEBUG_KMS("pipe %c not active or no fb, skipping\n",
500 pipe_name(intel_crtc
->pipe
));
504 if (intel_crtc
->plane_config
.size
> max_size
) {
505 DRM_DEBUG_KMS("found possible fb from plane %c\n",
506 pipe_name(intel_crtc
->pipe
));
507 plane_config
= &intel_crtc
->plane_config
;
508 fb
= to_intel_framebuffer(crtc
->primary
->fb
);
509 max_size
= plane_config
->size
;
514 DRM_DEBUG_KMS("no active fbs found, not using BIOS config\n");
518 /* Now make sure all the pipes will fit into it */
519 for_each_crtc(dev
, crtc
) {
520 unsigned int cur_size
;
522 intel_crtc
= to_intel_crtc(crtc
);
524 if (!intel_crtc
->active
) {
525 DRM_DEBUG_KMS("pipe %c not active, skipping\n",
526 pipe_name(intel_crtc
->pipe
));
530 DRM_DEBUG_KMS("checking plane %c for BIOS fb\n",
531 pipe_name(intel_crtc
->pipe
));
534 * See if the plane fb we found above will fit on this
535 * pipe. Note we need to use the selected fb's pitch and bpp
536 * rather than the current pipe's, since they differ.
538 cur_size
= intel_crtc
->config
.adjusted_mode
.crtc_hdisplay
;
539 cur_size
= cur_size
* fb
->base
.bits_per_pixel
/ 8;
540 if (fb
->base
.pitches
[0] < cur_size
) {
541 DRM_DEBUG_KMS("fb not wide enough for plane %c (%d vs %d)\n",
542 pipe_name(intel_crtc
->pipe
),
543 cur_size
, fb
->base
.pitches
[0]);
549 cur_size
= intel_crtc
->config
.adjusted_mode
.crtc_vdisplay
;
550 cur_size
= ALIGN(cur_size
, plane_config
->tiled
? (IS_GEN2(dev
) ? 16 : 8) : 1);
551 cur_size
*= fb
->base
.pitches
[0];
552 DRM_DEBUG_KMS("pipe %c area: %dx%d, bpp: %d, size: %d\n",
553 pipe_name(intel_crtc
->pipe
),
554 intel_crtc
->config
.adjusted_mode
.crtc_hdisplay
,
555 intel_crtc
->config
.adjusted_mode
.crtc_vdisplay
,
556 fb
->base
.bits_per_pixel
,
559 if (cur_size
> max_size
) {
560 DRM_DEBUG_KMS("fb not big enough for plane %c (%d vs %d)\n",
561 pipe_name(intel_crtc
->pipe
),
568 DRM_DEBUG_KMS("fb big enough for plane %c (%d >= %d)\n",
569 pipe_name(intel_crtc
->pipe
),
574 DRM_DEBUG_KMS("BIOS fb not suitable for all pipes, not using\n");
578 ifbdev
->preferred_bpp
= fb
->base
.bits_per_pixel
;
581 drm_framebuffer_reference(&ifbdev
->fb
->base
);
583 /* Final pass to check if any active pipes don't have fbs */
584 for_each_crtc(dev
, crtc
) {
585 intel_crtc
= to_intel_crtc(crtc
);
587 if (!intel_crtc
->active
)
590 WARN(!crtc
->primary
->fb
,
591 "re-used BIOS config but lost an fb on crtc %d\n",
596 DRM_DEBUG_KMS("using BIOS fb for initial console\n");
604 int intel_fbdev_init(struct drm_device
*dev
)
606 struct intel_fbdev
*ifbdev
;
607 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
610 if (WARN_ON(INTEL_INFO(dev
)->num_pipes
== 0))
613 ifbdev
= kzalloc(sizeof(struct intel_fbdev
), GFP_KERNEL
);
617 ifbdev
->helper
.funcs
= &intel_fb_helper_funcs
;
618 if (!intel_fbdev_init_bios(dev
, ifbdev
))
619 ifbdev
->preferred_bpp
= 32;
621 ret
= drm_fb_helper_init(dev
, &ifbdev
->helper
,
622 INTEL_INFO(dev
)->num_pipes
, 4);
628 dev_priv
->fbdev
= ifbdev
;
629 drm_fb_helper_single_add_all_connectors(&ifbdev
->helper
);
634 void intel_fbdev_initial_config(struct drm_device
*dev
)
636 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
637 struct intel_fbdev
*ifbdev
= dev_priv
->fbdev
;
639 /* Due to peculiar init order wrt to hpd handling this is separate. */
640 drm_fb_helper_initial_config(&ifbdev
->helper
, ifbdev
->preferred_bpp
);
643 void intel_fbdev_fini(struct drm_device
*dev
)
645 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
646 if (!dev_priv
->fbdev
)
649 intel_fbdev_destroy(dev
, dev_priv
->fbdev
);
650 kfree(dev_priv
->fbdev
);
651 dev_priv
->fbdev
= NULL
;
654 void intel_fbdev_set_suspend(struct drm_device
*dev
, int state
)
656 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
657 struct intel_fbdev
*ifbdev
= dev_priv
->fbdev
;
658 struct fb_info
*info
;
663 info
= ifbdev
->helper
.fbdev
;
665 /* On resume from hibernation: If the object is shmemfs backed, it has
666 * been restored from swap. If the object is stolen however, it will be
667 * full of whatever garbage was left in there.
669 if (state
== FBINFO_STATE_RUNNING
&& ifbdev
->fb
->obj
->stolen
)
670 memset_io(info
->screen_base
, 0, info
->screen_size
);
672 fb_set_suspend(info
, state
);
675 void intel_fbdev_output_poll_changed(struct drm_device
*dev
)
677 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
679 drm_fb_helper_hotplug_event(&dev_priv
->fbdev
->helper
);
682 void intel_fbdev_restore_mode(struct drm_device
*dev
)
685 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
687 if (!dev_priv
->fbdev
)
690 drm_modeset_lock_all(dev
);
692 ret
= drm_fb_helper_restore_fbdev_mode(&dev_priv
->fbdev
->helper
);
694 DRM_DEBUG("failed to restore crtc mode\n");
696 drm_modeset_unlock_all(dev
);