intel_fbdev.c 22 KB

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