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
;
132 mutex_lock(&dev
->struct_mutex
);
134 if (!intel_fb
|| WARN_ON(!intel_fb
->obj
)) {
135 DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n");
136 ret
= intelfb_alloc(helper
, sizes
);
139 intel_fb
= ifbdev
->fb
;
141 DRM_DEBUG_KMS("re-using BIOS fb\n");
142 sizes
->fb_width
= intel_fb
->base
.width
;
143 sizes
->fb_height
= intel_fb
->base
.height
;
147 size
= obj
->base
.size
;
149 info
= framebuffer_alloc(0, &dev
->pdev
->dev
);
157 fb
= &ifbdev
->fb
->base
;
159 ifbdev
->helper
.fb
= fb
;
160 ifbdev
->helper
.fbdev
= info
;
162 strcpy(info
->fix
.id
, "inteldrmfb");
164 info
->flags
= FBINFO_DEFAULT
| FBINFO_CAN_FORCE_OUTPUT
;
165 info
->fbops
= &intelfb_ops
;
167 ret
= fb_alloc_cmap(&info
->cmap
, 256, 0);
172 /* setup aperture base/size for vesafb takeover */
173 info
->apertures
= alloc_apertures(1);
174 if (!info
->apertures
) {
178 info
->apertures
->ranges
[0].base
= dev
->mode_config
.fb_base
;
179 info
->apertures
->ranges
[0].size
= dev_priv
->gtt
.mappable_end
;
181 info
->fix
.smem_start
= dev
->mode_config
.fb_base
+ i915_gem_obj_ggtt_offset(obj
);
182 info
->fix
.smem_len
= size
;
185 ioremap_wc(dev_priv
->gtt
.mappable_base
+ i915_gem_obj_ggtt_offset(obj
),
187 if (!info
->screen_base
) {
191 info
->screen_size
= size
;
193 /* This driver doesn't need a VT switch to restore the mode on resume */
194 info
->skip_vt_switch
= true;
196 drm_fb_helper_fill_fix(info
, fb
->pitches
[0], fb
->depth
);
197 drm_fb_helper_fill_var(info
, &ifbdev
->helper
, sizes
->fb_width
, sizes
->fb_height
);
199 /* If the object is shmemfs backed, it will have given us zeroed pages.
200 * If the object is stolen however, it will be full of whatever
201 * garbage was left in there.
203 if (ifbdev
->fb
->obj
->stolen
)
204 memset_io(info
->screen_base
, 0, info
->screen_size
);
206 /* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
208 DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08lx, bo %p\n",
209 fb
->width
, fb
->height
,
210 i915_gem_obj_ggtt_offset(obj
), obj
);
212 mutex_unlock(&dev
->struct_mutex
);
213 vga_switcheroo_client_fb_set(dev
->pdev
, info
);
217 i915_gem_object_ggtt_unpin(obj
);
218 drm_gem_object_unreference(&obj
->base
);
220 mutex_unlock(&dev
->struct_mutex
);
224 /** Sets the color ramps on behalf of RandR */
225 static void intel_crtc_fb_gamma_set(struct drm_crtc
*crtc
, u16 red
, u16 green
,
228 struct intel_crtc
*intel_crtc
= to_intel_crtc(crtc
);
230 intel_crtc
->lut_r
[regno
] = red
>> 8;
231 intel_crtc
->lut_g
[regno
] = green
>> 8;
232 intel_crtc
->lut_b
[regno
] = blue
>> 8;
235 static void intel_crtc_fb_gamma_get(struct drm_crtc
*crtc
, u16
*red
, u16
*green
,
236 u16
*blue
, int regno
)
238 struct intel_crtc
*intel_crtc
= to_intel_crtc(crtc
);
240 *red
= intel_crtc
->lut_r
[regno
] << 8;
241 *green
= intel_crtc
->lut_g
[regno
] << 8;
242 *blue
= intel_crtc
->lut_b
[regno
] << 8;
245 static struct drm_fb_helper_crtc
*
246 intel_fb_helper_crtc(struct drm_fb_helper
*fb_helper
, struct drm_crtc
*crtc
)
250 for (i
= 0; i
< fb_helper
->crtc_count
; i
++)
251 if (fb_helper
->crtc_info
[i
].mode_set
.crtc
== crtc
)
252 return &fb_helper
->crtc_info
[i
];
258 * Try to read the BIOS display configuration and use it for the initial
261 * The BIOS or boot loader will generally create an initial display
262 * configuration for us that includes some set of active pipes and displays.
263 * This routine tries to figure out which pipes and connectors are active
264 * and stuffs them into the crtcs and modes array given to us by the
265 * drm_fb_helper code.
267 * The overall sequence is:
268 * intel_fbdev_init - from driver load
269 * intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data
270 * drm_fb_helper_init - build fb helper structs
271 * drm_fb_helper_single_add_all_connectors - more fb helper structs
272 * intel_fbdev_initial_config - apply the config
273 * drm_fb_helper_initial_config - call ->probe then register_framebuffer()
274 * drm_setup_crtcs - build crtc config for fbdev
275 * intel_fb_initial_config - find active connectors etc
276 * drm_fb_helper_single_fb_probe - set up fbdev
277 * intelfb_create - re-use or alloc fb, build out fbdev structs
279 * Note that we don't make special consideration whether we could actually
280 * switch to the selected modes without a full modeset. E.g. when the display
281 * is in VGA mode we need to recalculate watermarks and set a new high-res
282 * framebuffer anyway.
284 static bool intel_fb_initial_config(struct drm_fb_helper
*fb_helper
,
285 struct drm_fb_helper_crtc
**crtcs
,
286 struct drm_display_mode
**modes
,
287 bool *enabled
, int width
, int height
)
289 struct drm_device
*dev
= fb_helper
->dev
;
292 bool fallback
= true;
295 * If the user specified any force options, just bail here
296 * and use that config.
298 for (i
= 0; i
< fb_helper
->connector_count
; i
++) {
299 struct drm_fb_helper_connector
*fb_conn
;
300 struct drm_connector
*connector
;
302 fb_conn
= fb_helper
->connector_info
[i
];
303 connector
= fb_conn
->connector
;
308 if (connector
->force
!= DRM_FORCE_UNSPECIFIED
)
312 save_enabled
= kcalloc(dev
->mode_config
.num_connector
, sizeof(bool),
317 memcpy(save_enabled
, enabled
, dev
->mode_config
.num_connector
);
319 for (i
= 0; i
< fb_helper
->connector_count
; i
++) {
320 struct drm_fb_helper_connector
*fb_conn
;
321 struct drm_connector
*connector
;
322 struct drm_encoder
*encoder
;
323 struct drm_fb_helper_crtc
*new_crtc
;
325 fb_conn
= fb_helper
->connector_info
[i
];
326 connector
= fb_conn
->connector
;
328 DRM_DEBUG_KMS("connector %d not enabled, skipping\n",
333 encoder
= connector
->encoder
;
334 if (!encoder
|| WARN_ON(!encoder
->crtc
)) {
335 DRM_DEBUG_KMS("connector %d has no encoder or crtc, skipping\n",
341 new_crtc
= intel_fb_helper_crtc(fb_helper
, encoder
->crtc
);
344 * Make sure we're not trying to drive multiple connectors
345 * with a single CRTC, since our cloning support may not
348 for (j
= 0; j
< fb_helper
->connector_count
; j
++) {
349 if (crtcs
[j
] == new_crtc
) {
355 DRM_DEBUG_KMS("looking for cmdline mode on connector %d\n",
356 fb_conn
->connector
->base
.id
);
358 /* go for command line mode first */
359 modes
[i
] = drm_pick_cmdline_mode(fb_conn
, width
, height
);
361 /* try for preferred next */
363 DRM_DEBUG_KMS("looking for preferred mode on connector %d\n",
364 fb_conn
->connector
->base
.id
);
365 modes
[i
] = drm_has_preferred_mode(fb_conn
, width
,
369 /* last resort: use current mode */
372 * IMPORTANT: We want to use the adjusted mode (i.e.
373 * after the panel fitter upscaling) as the initial
374 * config, not the input mode, which is what crtc->mode
375 * usually contains. But since our current fastboot
376 * code puts a mode derived from the post-pfit timings
377 * into crtc->mode this works out correctly. We don't
378 * use hwmode anywhere right now, so use it for this
379 * since the fb helper layer wants a pointer to
382 intel_mode_from_pipe_config(&encoder
->crtc
->hwmode
,
383 &to_intel_crtc(encoder
->crtc
)->config
);
384 modes
[i
] = &encoder
->crtc
->hwmode
;
388 DRM_DEBUG_KMS("connector %s on crtc %d: %s\n",
389 drm_get_connector_name(connector
),
390 encoder
->crtc
->base
.id
,
398 memcpy(enabled
, save_enabled
, dev
->mode_config
.num_connector
);
407 static struct drm_fb_helper_funcs intel_fb_helper_funcs
= {
408 .initial_config
= intel_fb_initial_config
,
409 .gamma_set
= intel_crtc_fb_gamma_set
,
410 .gamma_get
= intel_crtc_fb_gamma_get
,
411 .fb_probe
= intelfb_create
,
414 static void intel_fbdev_destroy(struct drm_device
*dev
,
415 struct intel_fbdev
*ifbdev
)
417 if (ifbdev
->helper
.fbdev
) {
418 struct fb_info
*info
= ifbdev
->helper
.fbdev
;
420 unregister_framebuffer(info
);
421 iounmap(info
->screen_base
);
423 fb_dealloc_cmap(&info
->cmap
);
425 framebuffer_release(info
);
428 drm_fb_helper_fini(&ifbdev
->helper
);
430 drm_framebuffer_unregister_private(&ifbdev
->fb
->base
);
431 drm_framebuffer_remove(&ifbdev
->fb
->base
);
434 int intel_fbdev_init(struct drm_device
*dev
)
436 struct intel_fbdev
*ifbdev
;
437 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
440 ifbdev
= kzalloc(sizeof(*ifbdev
), GFP_KERNEL
);
444 dev_priv
->fbdev
= ifbdev
;
445 ifbdev
->helper
.funcs
= &intel_fb_helper_funcs
;
447 ret
= drm_fb_helper_init(dev
, &ifbdev
->helper
,
448 INTEL_INFO(dev
)->num_pipes
,
455 drm_fb_helper_single_add_all_connectors(&ifbdev
->helper
);
460 void intel_fbdev_initial_config(struct drm_device
*dev
)
462 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
464 /* Due to peculiar init order wrt to hpd handling this is separate. */
465 drm_fb_helper_initial_config(&dev_priv
->fbdev
->helper
, 32);
468 void intel_fbdev_fini(struct drm_device
*dev
)
470 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
471 if (!dev_priv
->fbdev
)
474 intel_fbdev_destroy(dev
, dev_priv
->fbdev
);
475 kfree(dev_priv
->fbdev
);
476 dev_priv
->fbdev
= NULL
;
479 void intel_fbdev_set_suspend(struct drm_device
*dev
, int state
)
481 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
482 struct intel_fbdev
*ifbdev
= dev_priv
->fbdev
;
483 struct fb_info
*info
;
488 info
= ifbdev
->helper
.fbdev
;
490 /* On resume from hibernation: If the object is shmemfs backed, it has
491 * been restored from swap. If the object is stolen however, it will be
492 * full of whatever garbage was left in there.
494 if (state
== FBINFO_STATE_RUNNING
&& ifbdev
->fb
->obj
->stolen
)
495 memset_io(info
->screen_base
, 0, info
->screen_size
);
497 fb_set_suspend(info
, state
);
500 void intel_fbdev_output_poll_changed(struct drm_device
*dev
)
502 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
503 drm_fb_helper_hotplug_event(&dev_priv
->fbdev
->helper
);
506 void intel_fbdev_restore_mode(struct drm_device
*dev
)
509 struct drm_i915_private
*dev_priv
= dev
->dev_private
;
511 if (INTEL_INFO(dev
)->num_pipes
== 0)
514 drm_modeset_lock_all(dev
);
516 ret
= drm_fb_helper_restore_fbdev_mode(&dev_priv
->fbdev
->helper
);
518 DRM_DEBUG("failed to restore crtc mode\n");
520 drm_modeset_unlock_all(dev
);