intel_fbdev.c 23 KB

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