intel_fbdev.c 23 KB

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