intel_fbdev.c 23 KB

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