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
);
135 if (!intel_fb
|| WARN_ON(!intel_fb
->obj
)) {
136 DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n");
137 ret
= intelfb_alloc(helper
, sizes
);
140 intel_fb
= ifbdev
->fb
;
142 DRM_DEBUG_KMS("re-using BIOS fb\n");
144 sizes
->fb_width
= intel_fb
->base
.width
;
145 sizes
->fb_height
= intel_fb
->base
.height
;
149 size
= obj
->base
.size
;
151 info
= framebuffer_alloc(0, &dev
->pdev
->dev
);
159 fb
= &ifbdev
->fb
->base
;
161 ifbdev
->helper
.fb
= fb
;
162 ifbdev
->helper
.fbdev
= info
;
164 strcpy(info
->fix
.id
, "inteldrmfb");
166 info
->flags
= FBINFO_DEFAULT
| FBINFO_CAN_FORCE_OUTPUT
;
167 info
->fbops
= &intelfb_ops
;
169 ret
= fb_alloc_cmap(&info
->cmap
, 256, 0);
174 /* setup aperture base/size for vesafb takeover */
175 info
->apertures
= alloc_apertures(1);
176 if (!info
->apertures
) {
180 info
->apertures
->ranges
[0].base
= dev
->mode_config
.fb_base
;
181 info
->apertures
->ranges
[0].size
= dev_priv
->gtt
.mappable_end
;
183 info
->fix
.smem_start
= dev
->mode_config
.fb_base
+ i915_gem_obj_ggtt_offset(obj
);
184 info
->fix
.smem_len
= size
;
187 ioremap_wc(dev_priv
->gtt
.mappable_base
+ i915_gem_obj_ggtt_offset(obj
),
189 if (!info
->screen_base
) {
193 info
->screen_size
= size
;
195 /* This driver doesn't need a VT switch to restore the mode on resume */
196 info
->skip_vt_switch
= true;
198 drm_fb_helper_fill_fix(info
, fb
->pitches
[0], fb
->depth
);
199 drm_fb_helper_fill_var(info
, &ifbdev
->helper
, sizes
->fb_width
, sizes
->fb_height
);
201 /* If the object is shmemfs backed, it will have given us zeroed pages.
202 * If the object is stolen however, it will be full of whatever
203 * garbage was left in there.
205 if (ifbdev
->fb
->obj
->stolen
&& !prealloc
)
206 memset_io(info
->screen_base
, 0, info
->screen_size
);
208 /* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
210 DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08lx, bo %p\n",
211 fb
->width
, fb
->height
,
212 i915_gem_obj_ggtt_offset(obj
), obj
);
214 mutex_unlock(&dev
->struct_mutex
);
215 vga_switcheroo_client_fb_set(dev
->pdev
, info
);
219 i915_gem_object_ggtt_unpin(obj
);
220 drm_gem_object_unreference(&obj
->base
);
222 mutex_unlock(&dev
->struct_mutex
);
226 /** Sets the color ramps on behalf of RandR */
227 static void intel_crtc_fb_gamma_set(struct drm_crtc
*crtc
, u16 red
, u16 green
,
230 struct intel_crtc
*intel_crtc
= to_intel_crtc(crtc
);
232 intel_crtc
->lut_r
[regno
] = red
>> 8;
233 intel_crtc
->lut_g
[regno
] = green
>> 8;
234 intel_crtc
->lut_b
[regno
] = blue
>> 8;
237 static void intel_crtc_fb_gamma_get(struct drm_crtc
*crtc
, u16
*red
, u16
*green
,
238 u16
*blue
, int regno
)
240 struct intel_crtc
*intel_crtc
= to_intel_crtc(crtc
);
242 *red
= intel_crtc
->lut_r
[regno
] << 8;
243 *green
= intel_crtc
->lut_g
[regno
] << 8;
244 *blue
= intel_crtc
->lut_b
[regno
] << 8;
247 static struct drm_fb_helper_crtc
*
248 intel_fb_helper_crtc(struct drm_fb_helper
*fb_helper
, struct drm_crtc
*crtc
)
252 for (i
= 0; i
< fb_helper
->crtc_count
; i
++)
253 if (fb_helper
->crtc_info
[i
].mode_set
.crtc
== crtc
)
254 return &fb_helper
->crtc_info
[i
];
260 * Try to read the BIOS display configuration and use it for the initial
263 * The BIOS or boot loader will generally create an initial display
264 * configuration for us that includes some set of active pipes and displays.
265 * This routine tries to figure out which pipes and connectors are active
266 * and stuffs them into the crtcs and modes array given to us by the
267 * drm_fb_helper code.
269 * The overall sequence is:
270 * intel_fbdev_init - from driver load
271 * intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data
272 * drm_fb_helper_init - build fb helper structs
273 * drm_fb_helper_single_add_all_connectors - more fb helper structs
274 * intel_fbdev_initial_config - apply the config
275 * drm_fb_helper_initial_config - call ->probe then register_framebuffer()
276 * drm_setup_crtcs - build crtc config for fbdev
277 * intel_fb_initial_config - find active connectors etc
278 * drm_fb_helper_single_fb_probe - set up fbdev
279 * intelfb_create - re-use or alloc fb, build out fbdev structs
281 * Note that we don't make special consideration whether we could actually
282 * switch to the selected modes without a full modeset. E.g. when the display
283 * is in VGA mode we need to recalculate watermarks and set a new high-res
284 * framebuffer anyway.
286 static bool intel_fb_initial_config(struct drm_fb_helper
*fb_helper
,
287 struct drm_fb_helper_crtc
**crtcs
,
288 struct drm_display_mode
**modes
,
289 bool *enabled
, int width
, int height
)
291 struct drm_device
*dev
= fb_helper
->dev
;
294 bool fallback
= true;
295 int num_connectors_enabled
= 0;
296 int num_connectors_detected
= 0;
299 * If the user specified any force options, just bail here
300 * and use that config.
302 for (i
= 0; i
< fb_helper
->connector_count
; i
++) {
303 struct drm_fb_helper_connector
*fb_conn
;
304 struct drm_connector
*connector
;
306 fb_conn
= fb_helper
->connector_info
[i
];
307 connector
= fb_conn
->connector
;
312 if (connector
->force
!= DRM_FORCE_UNSPECIFIED
)
316 save_enabled
= kcalloc(dev
->mode_config
.num_connector
, sizeof(bool),
321 memcpy(save_enabled
, enabled
, dev
->mode_config
.num_connector
);
323 for (i
= 0; i
< fb_helper
->connector_count
; i
++) {
324 struct drm_fb_helper_connector
*fb_conn
;
325 struct drm_connector
*connector
;
326 struct drm_encoder
*encoder
;
327 struct drm_fb_helper_crtc
*new_crtc
;
329 fb_conn
= fb_helper
->connector_info
[i
];
330 connector
= fb_conn
->connector
;
332 if (connector
->status
== connector_status_connected
)
333 num_connectors_detected
++;
336 DRM_DEBUG_KMS("connector %d not enabled, skipping\n",
341 encoder
= connector
->encoder
;
342 if (!encoder
|| WARN_ON(!encoder
->crtc
)) {
343 DRM_DEBUG_KMS("connector %d has no encoder or crtc, skipping\n",
349 num_connectors_enabled
++;
351 new_crtc
= intel_fb_helper_crtc(fb_helper
, encoder
->crtc
);
354 * Make sure we're not trying to drive multiple connectors
355 * with a single CRTC, since our cloning support may not
358 for (j
= 0; j
< fb_helper
->connector_count
; j
++) {
359 if (crtcs
[j
] == new_crtc
) {
360 DRM_DEBUG_KMS("fallback: cloned configuration\n");
366 DRM_DEBUG_KMS("looking for cmdline mode on connector %d\n",
367 fb_conn
->connector
->base
.id
);
369 /* go for command line mode first */
370 modes
[i
] = drm_pick_cmdline_mode(fb_conn
, width
, height
);
372 /* try for preferred next */
374 DRM_DEBUG_KMS("looking for preferred mode on connector %d\n",
375 fb_conn
->connector
->base
.id
);
376 modes
[i
] = drm_has_preferred_mode(fb_conn
, width
,
380 /* last resort: use current mode */
383 * IMPORTANT: We want to use the adjusted mode (i.e.
384 * after the panel fitter upscaling) as the initial
385 * config, not the input mode, which is what crtc->mode
386 * usually contains. But since our current fastboot
387 * code puts a mode derived from the post-pfit timings
388 * into crtc->mode this works out correctly. We don't
389 * use hwmode anywhere right now, so use it for this
390 * since the fb helper layer wants a pointer to
393 intel_mode_from_pipe_config(&encoder
->crtc
->hwmode
,
394 &to_intel_crtc(encoder
->crtc
)->config
);
395 modes
[i
] = &encoder
->crtc
->hwmode
;
399 DRM_DEBUG_KMS("connector %s on crtc %d: %s\n",
400 drm_get_connector_name(connector
),
401 encoder
->crtc
->base
.id
,
408 * If the BIOS didn't enable everything it could, fall back to have the
409 * same user experiencing of lighting up as much as possible like the
410 * fbdev helper library.
412 if (num_connectors_enabled
!= num_connectors_detected
&&
413 num_connectors_enabled
< INTEL_INFO(dev
)->num_pipes
) {
414 DRM_DEBUG_KMS("fallback: Not all outputs enabled\n");
415 DRM_DEBUG_KMS("Enabled: %i, detected: %i\n", num_connectors_enabled
,
416 num_connectors_detected
);
422 DRM_DEBUG_KMS("Not using firmware configuration\n");
423 memcpy(enabled
, save_enabled
, dev
->mode_config
.num_connector
);
432 static struct drm_fb_helper_funcs intel_fb_helper_funcs
= {
433 .initial_config
= intel_fb_initial_config
,
434 .gamma_set
= intel_crtc_fb_gamma_set
,
435 .gamma_get
= intel_crtc_fb_gamma_get
,
436 .fb_probe
= intelfb_create
,
439 static void intel_fbdev_destroy(struct drm_device
*dev
,
440 struct intel_fbdev
*ifbdev
)
442 if (ifbdev
->helper
.fbdev
) {
443 struct fb_info
*info
= ifbdev
->helper
.fbdev
;
445 unregister_framebuffer(info
);
446 iounmap(info
->screen_base
);
448 fb_dealloc_cmap(&info
->cmap
);
450 framebuffer_release(info
);
453 drm_fb_helper_fini(&ifbdev
->helper
);
455 drm_framebuffer_unregister_private(&ifbdev
->fb
->base
);
456 drm_framebuffer_remove(&ifbdev
->fb
->base
);
460 * Build an intel_fbdev struct using a BIOS allocated framebuffer, if possible.
461 * The core display code will have read out the current plane configuration,
462 * so we use that to figure out if there's an object for us to use as the
463 * fb, and if so, we re-use it for the fbdev configuration.
465 * Note we only support a single fb shared across pipes for boot (mostly for
466 * fbcon), so we just find the biggest and use that.
468 static bool intel_fbdev_init_bios(struct drm_device
*dev
,
469 struct intel_fbdev
*ifbdev
)
471 struct intel_framebuffer
*fb
= NULL
;
472 struct drm_crtc
*crtc
;
473 struct intel_crtc
*intel_crtc
;
474 struct intel_plane_config
*plane_config
= NULL
;
475 unsigned int max_size
= 0;
480 /* Find the largest fb */
481 list_for_each_entry(crtc
, &dev
->mode_config
.crtc_list
, head
) {
482 intel_crtc
= to_intel_crtc(crtc
);
484 if (!intel_crtc
->active
|| !crtc
->fb
) {
485 DRM_DEBUG_KMS("pipe %c not active or no fb, skipping\n",
486 pipe_name(intel_crtc
->pipe
));
490 if (intel_crtc
->plane_config
.size
> max_size
) {
491 DRM_DEBUG_KMS("found possible fb from plane %c\n",
492 pipe_name(intel_crtc
->pipe
));
493 plane_config
= &intel_crtc
->plane_config
;
494 fb
= to_intel_framebuffer(crtc
->fb
);
495 max_size
= plane_config
->size
;
500 DRM_DEBUG_KMS("no active fbs found, not using BIOS config\n");
504 /* Now make sure all the pipes will fit into it */
505 list_for_each_entry(crtc
, &dev
->mode_config
.crtc_list
, head
) {
506 unsigned int cur_size
;
508 intel_crtc
= to_intel_crtc(crtc
);
510 if (!intel_crtc
->active
) {
511 DRM_DEBUG_KMS("pipe %c not active, skipping\n",
512 pipe_name(intel_crtc
->pipe
));
516 DRM_DEBUG_KMS("checking plane %c for BIOS fb\n",
517 pipe_name(intel_crtc
->pipe
));
520 * See if the plane fb we found above will fit on this
521 * pipe. Note we need to use the selected fb's bpp rather
522 * than the current pipe's, since they could be different.
524 cur_size
= intel_crtc
->config
.adjusted_mode
.crtc_hdisplay
*
525 intel_crtc
->config
.adjusted_mode
.crtc_vdisplay
;
526 DRM_DEBUG_KMS("pipe %c area: %d\n", pipe_name(intel_crtc
->pipe
),
528 cur_size
*= fb
->base
.bits_per_pixel
/ 8;
529 DRM_DEBUG_KMS("total size %d (bpp %d)\n", cur_size
,
530 fb
->base
.bits_per_pixel
/ 8);
532 if (cur_size
> max_size
) {
533 DRM_DEBUG_KMS("fb not big enough for plane %c (%d vs %d)\n",
534 pipe_name(intel_crtc
->pipe
),
541 DRM_DEBUG_KMS("fb big enough for plane %c (%d >= %d)\n",
542 pipe_name(intel_crtc
->pipe
),
547 DRM_DEBUG_KMS("BIOS fb not suitable for all pipes, not using\n");
551 ifbdev
->preferred_bpp
= fb
->base
.bits_per_pixel
;
554 drm_framebuffer_reference(&ifbdev
->fb
->base
);
556 /* Final pass to check if any active pipes don't have fbs */
557 list_for_each_entry(crtc
, &dev
->mode_config
.crtc_list
, head
) {
558 intel_crtc
= to_intel_crtc(crtc
);
560 if (!intel_crtc
->active
)
564 "re-used BIOS config but lost an fb on crtc %d\n",
569 DRM_DEBUG_KMS("using BIOS fb for initial console\n");
577 int intel_fbdev_init(struct drm_device
*dev
)
579 struct intel_fbdev
*ifbdev
;
580 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
583 if (WARN_ON(INTEL_INFO(dev
)->num_pipes
== 0))
586 ifbdev
= kzalloc(sizeof(struct intel_fbdev
), GFP_KERNEL
);
590 ifbdev
->helper
.funcs
= &intel_fb_helper_funcs
;
591 if (!intel_fbdev_init_bios(dev
, ifbdev
))
592 ifbdev
->preferred_bpp
= 32;
594 ret
= drm_fb_helper_init(dev
, &ifbdev
->helper
,
595 INTEL_INFO(dev
)->num_pipes
, 4);
601 dev_priv
->fbdev
= ifbdev
;
602 drm_fb_helper_single_add_all_connectors(&ifbdev
->helper
);
607 void intel_fbdev_initial_config(struct drm_device
*dev
)
609 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
610 struct intel_fbdev
*ifbdev
= dev_priv
->fbdev
;
612 /* Due to peculiar init order wrt to hpd handling this is separate. */
613 drm_fb_helper_initial_config(&ifbdev
->helper
, ifbdev
->preferred_bpp
);
616 void intel_fbdev_fini(struct drm_device
*dev
)
618 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
619 if (!dev_priv
->fbdev
)
622 intel_fbdev_destroy(dev
, dev_priv
->fbdev
);
623 kfree(dev_priv
->fbdev
);
624 dev_priv
->fbdev
= NULL
;
627 void intel_fbdev_set_suspend(struct drm_device
*dev
, int state
)
629 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
630 struct intel_fbdev
*ifbdev
= dev_priv
->fbdev
;
631 struct fb_info
*info
;
636 info
= ifbdev
->helper
.fbdev
;
638 /* On resume from hibernation: If the object is shmemfs backed, it has
639 * been restored from swap. If the object is stolen however, it will be
640 * full of whatever garbage was left in there.
642 if (state
== FBINFO_STATE_RUNNING
&& ifbdev
->fb
->obj
->stolen
)
643 memset_io(info
->screen_base
, 0, info
->screen_size
);
645 fb_set_suspend(info
, state
);
648 void intel_fbdev_output_poll_changed(struct drm_device
*dev
)
650 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
652 drm_fb_helper_hotplug_event(&dev_priv
->fbdev
->helper
);
655 void intel_fbdev_restore_mode(struct drm_device
*dev
)
658 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
660 if (!dev_priv
->fbdev
)
663 drm_modeset_lock_all(dev
);
665 ret
= drm_fb_helper_restore_fbdev_mode(&dev_priv
->fbdev
->helper
);
667 DRM_DEBUG("failed to restore crtc mode\n");
669 drm_modeset_unlock_all(dev
);