intel_lvds.c 34 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168
  1. /*
  2. * Copyright © 2006-2007 Intel Corporation
  3. * Copyright (c) 2006 Dave Airlie <airlied@linux.ie>
  4. *
  5. * Permission is hereby granted, free of charge, to any person obtaining a
  6. * copy of this software and associated documentation files (the "Software"),
  7. * to deal in the Software without restriction, including without limitation
  8. * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  9. * and/or sell copies of the Software, and to permit persons to whom the
  10. * Software is furnished to do so, subject to the following conditions:
  11. *
  12. * The above copyright notice and this permission notice (including the next
  13. * paragraph) shall be included in all copies or substantial portions of the
  14. * Software.
  15. *
  16. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19. * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  21. * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  22. * DEALINGS IN THE SOFTWARE.
  23. *
  24. * Authors:
  25. * Eric Anholt <eric@anholt.net>
  26. * Dave Airlie <airlied@linux.ie>
  27. * Jesse Barnes <jesse.barnes@intel.com>
  28. */
  29. #include <acpi/button.h>
  30. #include <linux/dmi.h>
  31. #include <linux/i2c.h>
  32. #include "drmP.h"
  33. #include "drm.h"
  34. #include "drm_crtc.h"
  35. #include "drm_edid.h"
  36. #include "intel_drv.h"
  37. #include "i915_drm.h"
  38. #include "i915_drv.h"
  39. #include <linux/acpi.h>
  40. /* Private structure for the integrated LVDS support */
  41. struct intel_lvds_priv {
  42. int fitting_mode;
  43. u32 pfit_control;
  44. u32 pfit_pgm_ratios;
  45. };
  46. /**
  47. * Sets the backlight level.
  48. *
  49. * \param level backlight level, from 0 to intel_lvds_get_max_backlight().
  50. */
  51. static void intel_lvds_set_backlight(struct drm_device *dev, int level)
  52. {
  53. struct drm_i915_private *dev_priv = dev->dev_private;
  54. u32 blc_pwm_ctl, reg;
  55. if (IS_IRONLAKE(dev))
  56. reg = BLC_PWM_CPU_CTL;
  57. else
  58. reg = BLC_PWM_CTL;
  59. blc_pwm_ctl = I915_READ(reg) & ~BACKLIGHT_DUTY_CYCLE_MASK;
  60. I915_WRITE(reg, (blc_pwm_ctl |
  61. (level << BACKLIGHT_DUTY_CYCLE_SHIFT)));
  62. }
  63. /**
  64. * Returns the maximum level of the backlight duty cycle field.
  65. */
  66. static u32 intel_lvds_get_max_backlight(struct drm_device *dev)
  67. {
  68. struct drm_i915_private *dev_priv = dev->dev_private;
  69. u32 reg;
  70. if (IS_IRONLAKE(dev))
  71. reg = BLC_PWM_PCH_CTL2;
  72. else
  73. reg = BLC_PWM_CTL;
  74. return ((I915_READ(reg) & BACKLIGHT_MODULATION_FREQ_MASK) >>
  75. BACKLIGHT_MODULATION_FREQ_SHIFT) * 2;
  76. }
  77. /**
  78. * Sets the power state for the panel.
  79. */
  80. static void intel_lvds_set_power(struct drm_device *dev, bool on)
  81. {
  82. struct drm_i915_private *dev_priv = dev->dev_private;
  83. u32 pp_status, ctl_reg, status_reg;
  84. if (IS_IRONLAKE(dev)) {
  85. ctl_reg = PCH_PP_CONTROL;
  86. status_reg = PCH_PP_STATUS;
  87. } else {
  88. ctl_reg = PP_CONTROL;
  89. status_reg = PP_STATUS;
  90. }
  91. if (on) {
  92. I915_WRITE(ctl_reg, I915_READ(ctl_reg) |
  93. POWER_TARGET_ON);
  94. do {
  95. pp_status = I915_READ(status_reg);
  96. } while ((pp_status & PP_ON) == 0);
  97. intel_lvds_set_backlight(dev, dev_priv->backlight_duty_cycle);
  98. } else {
  99. intel_lvds_set_backlight(dev, 0);
  100. I915_WRITE(ctl_reg, I915_READ(ctl_reg) &
  101. ~POWER_TARGET_ON);
  102. do {
  103. pp_status = I915_READ(status_reg);
  104. } while (pp_status & PP_ON);
  105. }
  106. }
  107. static void intel_lvds_dpms(struct drm_encoder *encoder, int mode)
  108. {
  109. struct drm_device *dev = encoder->dev;
  110. if (mode == DRM_MODE_DPMS_ON)
  111. intel_lvds_set_power(dev, true);
  112. else
  113. intel_lvds_set_power(dev, false);
  114. /* XXX: We never power down the LVDS pairs. */
  115. }
  116. static void intel_lvds_save(struct drm_connector *connector)
  117. {
  118. struct drm_device *dev = connector->dev;
  119. struct drm_i915_private *dev_priv = dev->dev_private;
  120. u32 pp_on_reg, pp_off_reg, pp_ctl_reg, pp_div_reg;
  121. u32 pwm_ctl_reg;
  122. if (IS_IRONLAKE(dev)) {
  123. pp_on_reg = PCH_PP_ON_DELAYS;
  124. pp_off_reg = PCH_PP_OFF_DELAYS;
  125. pp_ctl_reg = PCH_PP_CONTROL;
  126. pp_div_reg = PCH_PP_DIVISOR;
  127. pwm_ctl_reg = BLC_PWM_CPU_CTL;
  128. } else {
  129. pp_on_reg = PP_ON_DELAYS;
  130. pp_off_reg = PP_OFF_DELAYS;
  131. pp_ctl_reg = PP_CONTROL;
  132. pp_div_reg = PP_DIVISOR;
  133. pwm_ctl_reg = BLC_PWM_CTL;
  134. }
  135. dev_priv->savePP_ON = I915_READ(pp_on_reg);
  136. dev_priv->savePP_OFF = I915_READ(pp_off_reg);
  137. dev_priv->savePP_CONTROL = I915_READ(pp_ctl_reg);
  138. dev_priv->savePP_DIVISOR = I915_READ(pp_div_reg);
  139. dev_priv->saveBLC_PWM_CTL = I915_READ(pwm_ctl_reg);
  140. dev_priv->backlight_duty_cycle = (dev_priv->saveBLC_PWM_CTL &
  141. BACKLIGHT_DUTY_CYCLE_MASK);
  142. /*
  143. * If the light is off at server startup, just make it full brightness
  144. */
  145. if (dev_priv->backlight_duty_cycle == 0)
  146. dev_priv->backlight_duty_cycle =
  147. intel_lvds_get_max_backlight(dev);
  148. }
  149. static void intel_lvds_restore(struct drm_connector *connector)
  150. {
  151. struct drm_device *dev = connector->dev;
  152. struct drm_i915_private *dev_priv = dev->dev_private;
  153. u32 pp_on_reg, pp_off_reg, pp_ctl_reg, pp_div_reg;
  154. u32 pwm_ctl_reg;
  155. if (IS_IRONLAKE(dev)) {
  156. pp_on_reg = PCH_PP_ON_DELAYS;
  157. pp_off_reg = PCH_PP_OFF_DELAYS;
  158. pp_ctl_reg = PCH_PP_CONTROL;
  159. pp_div_reg = PCH_PP_DIVISOR;
  160. pwm_ctl_reg = BLC_PWM_CPU_CTL;
  161. } else {
  162. pp_on_reg = PP_ON_DELAYS;
  163. pp_off_reg = PP_OFF_DELAYS;
  164. pp_ctl_reg = PP_CONTROL;
  165. pp_div_reg = PP_DIVISOR;
  166. pwm_ctl_reg = BLC_PWM_CTL;
  167. }
  168. I915_WRITE(pwm_ctl_reg, dev_priv->saveBLC_PWM_CTL);
  169. I915_WRITE(pp_on_reg, dev_priv->savePP_ON);
  170. I915_WRITE(pp_off_reg, dev_priv->savePP_OFF);
  171. I915_WRITE(pp_div_reg, dev_priv->savePP_DIVISOR);
  172. I915_WRITE(pp_ctl_reg, dev_priv->savePP_CONTROL);
  173. if (dev_priv->savePP_CONTROL & POWER_TARGET_ON)
  174. intel_lvds_set_power(dev, true);
  175. else
  176. intel_lvds_set_power(dev, false);
  177. }
  178. static int intel_lvds_mode_valid(struct drm_connector *connector,
  179. struct drm_display_mode *mode)
  180. {
  181. struct drm_device *dev = connector->dev;
  182. struct drm_i915_private *dev_priv = dev->dev_private;
  183. struct drm_display_mode *fixed_mode = dev_priv->panel_fixed_mode;
  184. if (fixed_mode) {
  185. if (mode->hdisplay > fixed_mode->hdisplay)
  186. return MODE_PANEL;
  187. if (mode->vdisplay > fixed_mode->vdisplay)
  188. return MODE_PANEL;
  189. }
  190. return MODE_OK;
  191. }
  192. static bool intel_lvds_mode_fixup(struct drm_encoder *encoder,
  193. struct drm_display_mode *mode,
  194. struct drm_display_mode *adjusted_mode)
  195. {
  196. /*
  197. * float point operation is not supported . So the PANEL_RATIO_FACTOR
  198. * is defined, which can avoid the float point computation when
  199. * calculating the panel ratio.
  200. */
  201. #define PANEL_RATIO_FACTOR 8192
  202. struct drm_device *dev = encoder->dev;
  203. struct drm_i915_private *dev_priv = dev->dev_private;
  204. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  205. struct drm_encoder *tmp_encoder;
  206. struct intel_output *intel_output = enc_to_intel_output(encoder);
  207. struct intel_lvds_priv *lvds_priv = intel_output->dev_priv;
  208. u32 pfit_control = 0, pfit_pgm_ratios = 0;
  209. int left_border = 0, right_border = 0, top_border = 0;
  210. int bottom_border = 0;
  211. bool border = 0;
  212. int panel_ratio, desired_ratio, vert_scale, horiz_scale;
  213. int horiz_ratio, vert_ratio;
  214. u32 hsync_width, vsync_width;
  215. u32 hblank_width, vblank_width;
  216. u32 hsync_pos, vsync_pos;
  217. /* Should never happen!! */
  218. if (!IS_I965G(dev) && intel_crtc->pipe == 0) {
  219. DRM_ERROR("Can't support LVDS on pipe A\n");
  220. return false;
  221. }
  222. /* Should never happen!! */
  223. list_for_each_entry(tmp_encoder, &dev->mode_config.encoder_list, head) {
  224. if (tmp_encoder != encoder && tmp_encoder->crtc == encoder->crtc) {
  225. DRM_ERROR("Can't enable LVDS and another "
  226. "encoder on the same pipe\n");
  227. return false;
  228. }
  229. }
  230. /* If we don't have a panel mode, there is nothing we can do */
  231. if (dev_priv->panel_fixed_mode == NULL)
  232. return true;
  233. /*
  234. * If we have timings from the BIOS for the panel, put them in
  235. * to the adjusted mode. The CRTC will be set up for this mode,
  236. * with the panel scaling set up to source from the H/VDisplay
  237. * of the original mode.
  238. */
  239. if (dev_priv->panel_fixed_mode != NULL) {
  240. adjusted_mode->hdisplay = dev_priv->panel_fixed_mode->hdisplay;
  241. adjusted_mode->hsync_start =
  242. dev_priv->panel_fixed_mode->hsync_start;
  243. adjusted_mode->hsync_end =
  244. dev_priv->panel_fixed_mode->hsync_end;
  245. adjusted_mode->htotal = dev_priv->panel_fixed_mode->htotal;
  246. adjusted_mode->vdisplay = dev_priv->panel_fixed_mode->vdisplay;
  247. adjusted_mode->vsync_start =
  248. dev_priv->panel_fixed_mode->vsync_start;
  249. adjusted_mode->vsync_end =
  250. dev_priv->panel_fixed_mode->vsync_end;
  251. adjusted_mode->vtotal = dev_priv->panel_fixed_mode->vtotal;
  252. adjusted_mode->clock = dev_priv->panel_fixed_mode->clock;
  253. drm_mode_set_crtcinfo(adjusted_mode, CRTC_INTERLACE_HALVE_V);
  254. }
  255. /* Make sure pre-965s set dither correctly */
  256. if (!IS_I965G(dev)) {
  257. if (dev_priv->panel_wants_dither || dev_priv->lvds_dither)
  258. pfit_control |= PANEL_8TO6_DITHER_ENABLE;
  259. }
  260. /* Native modes don't need fitting */
  261. if (adjusted_mode->hdisplay == mode->hdisplay &&
  262. adjusted_mode->vdisplay == mode->vdisplay) {
  263. pfit_pgm_ratios = 0;
  264. border = 0;
  265. goto out;
  266. }
  267. /* full screen scale for now */
  268. if (IS_IRONLAKE(dev))
  269. goto out;
  270. /* 965+ wants fuzzy fitting */
  271. if (IS_I965G(dev))
  272. pfit_control |= (intel_crtc->pipe << PFIT_PIPE_SHIFT) |
  273. PFIT_FILTER_FUZZY;
  274. hsync_width = adjusted_mode->crtc_hsync_end -
  275. adjusted_mode->crtc_hsync_start;
  276. vsync_width = adjusted_mode->crtc_vsync_end -
  277. adjusted_mode->crtc_vsync_start;
  278. hblank_width = adjusted_mode->crtc_hblank_end -
  279. adjusted_mode->crtc_hblank_start;
  280. vblank_width = adjusted_mode->crtc_vblank_end -
  281. adjusted_mode->crtc_vblank_start;
  282. /*
  283. * Deal with panel fitting options. Figure out how to stretch the
  284. * image based on its aspect ratio & the current panel fitting mode.
  285. */
  286. panel_ratio = adjusted_mode->hdisplay * PANEL_RATIO_FACTOR /
  287. adjusted_mode->vdisplay;
  288. desired_ratio = mode->hdisplay * PANEL_RATIO_FACTOR /
  289. mode->vdisplay;
  290. /*
  291. * Enable automatic panel scaling for non-native modes so that they fill
  292. * the screen. Should be enabled before the pipe is enabled, according
  293. * to register description and PRM.
  294. * Change the value here to see the borders for debugging
  295. */
  296. if (!IS_IRONLAKE(dev)) {
  297. I915_WRITE(BCLRPAT_A, 0);
  298. I915_WRITE(BCLRPAT_B, 0);
  299. }
  300. switch (lvds_priv->fitting_mode) {
  301. case DRM_MODE_SCALE_CENTER:
  302. /*
  303. * For centered modes, we have to calculate border widths &
  304. * heights and modify the values programmed into the CRTC.
  305. */
  306. left_border = (adjusted_mode->hdisplay - mode->hdisplay) / 2;
  307. right_border = left_border;
  308. if (mode->hdisplay & 1)
  309. right_border++;
  310. top_border = (adjusted_mode->vdisplay - mode->vdisplay) / 2;
  311. bottom_border = top_border;
  312. if (mode->vdisplay & 1)
  313. bottom_border++;
  314. /* Set active & border values */
  315. adjusted_mode->crtc_hdisplay = mode->hdisplay;
  316. /* Keep the boder be even */
  317. if (right_border & 1)
  318. right_border++;
  319. /* use the border directly instead of border minuse one */
  320. adjusted_mode->crtc_hblank_start = mode->hdisplay +
  321. right_border;
  322. /* keep the blank width constant */
  323. adjusted_mode->crtc_hblank_end =
  324. adjusted_mode->crtc_hblank_start + hblank_width;
  325. /* get the hsync pos relative to hblank start */
  326. hsync_pos = (hblank_width - hsync_width) / 2;
  327. /* keep the hsync pos be even */
  328. if (hsync_pos & 1)
  329. hsync_pos++;
  330. adjusted_mode->crtc_hsync_start =
  331. adjusted_mode->crtc_hblank_start + hsync_pos;
  332. /* keep the hsync width constant */
  333. adjusted_mode->crtc_hsync_end =
  334. adjusted_mode->crtc_hsync_start + hsync_width;
  335. adjusted_mode->crtc_vdisplay = mode->vdisplay;
  336. /* use the border instead of border minus one */
  337. adjusted_mode->crtc_vblank_start = mode->vdisplay +
  338. bottom_border;
  339. /* keep the vblank width constant */
  340. adjusted_mode->crtc_vblank_end =
  341. adjusted_mode->crtc_vblank_start + vblank_width;
  342. /* get the vsync start postion relative to vblank start */
  343. vsync_pos = (vblank_width - vsync_width) / 2;
  344. adjusted_mode->crtc_vsync_start =
  345. adjusted_mode->crtc_vblank_start + vsync_pos;
  346. /* keep the vsync width constant */
  347. adjusted_mode->crtc_vsync_end =
  348. adjusted_mode->crtc_vsync_start + vsync_width;
  349. border = 1;
  350. break;
  351. case DRM_MODE_SCALE_ASPECT:
  352. /* Scale but preserve the spect ratio */
  353. pfit_control |= PFIT_ENABLE;
  354. if (IS_I965G(dev)) {
  355. /* 965+ is easy, it does everything in hw */
  356. if (panel_ratio > desired_ratio)
  357. pfit_control |= PFIT_SCALING_PILLAR;
  358. else if (panel_ratio < desired_ratio)
  359. pfit_control |= PFIT_SCALING_LETTER;
  360. else
  361. pfit_control |= PFIT_SCALING_AUTO;
  362. } else {
  363. /*
  364. * For earlier chips we have to calculate the scaling
  365. * ratio by hand and program it into the
  366. * PFIT_PGM_RATIO register
  367. */
  368. u32 horiz_bits, vert_bits, bits = 12;
  369. horiz_ratio = mode->hdisplay * PANEL_RATIO_FACTOR/
  370. adjusted_mode->hdisplay;
  371. vert_ratio = mode->vdisplay * PANEL_RATIO_FACTOR/
  372. adjusted_mode->vdisplay;
  373. horiz_scale = adjusted_mode->hdisplay *
  374. PANEL_RATIO_FACTOR / mode->hdisplay;
  375. vert_scale = adjusted_mode->vdisplay *
  376. PANEL_RATIO_FACTOR / mode->vdisplay;
  377. /* retain aspect ratio */
  378. if (panel_ratio > desired_ratio) { /* Pillar */
  379. u32 scaled_width;
  380. scaled_width = mode->hdisplay * vert_scale /
  381. PANEL_RATIO_FACTOR;
  382. horiz_ratio = vert_ratio;
  383. pfit_control |= (VERT_AUTO_SCALE |
  384. VERT_INTERP_BILINEAR |
  385. HORIZ_INTERP_BILINEAR);
  386. /* Pillar will have left/right borders */
  387. left_border = (adjusted_mode->hdisplay -
  388. scaled_width) / 2;
  389. right_border = left_border;
  390. if (mode->hdisplay & 1) /* odd resolutions */
  391. right_border++;
  392. /* keep the border be even */
  393. if (right_border & 1)
  394. right_border++;
  395. adjusted_mode->crtc_hdisplay = scaled_width;
  396. /* use border instead of border minus one */
  397. adjusted_mode->crtc_hblank_start =
  398. scaled_width + right_border;
  399. /* keep the hblank width constant */
  400. adjusted_mode->crtc_hblank_end =
  401. adjusted_mode->crtc_hblank_start +
  402. hblank_width;
  403. /*
  404. * get the hsync start pos relative to
  405. * hblank start
  406. */
  407. hsync_pos = (hblank_width - hsync_width) / 2;
  408. /* keep the hsync_pos be even */
  409. if (hsync_pos & 1)
  410. hsync_pos++;
  411. adjusted_mode->crtc_hsync_start =
  412. adjusted_mode->crtc_hblank_start +
  413. hsync_pos;
  414. /* keept hsync width constant */
  415. adjusted_mode->crtc_hsync_end =
  416. adjusted_mode->crtc_hsync_start +
  417. hsync_width;
  418. border = 1;
  419. } else if (panel_ratio < desired_ratio) { /* letter */
  420. u32 scaled_height = mode->vdisplay *
  421. horiz_scale / PANEL_RATIO_FACTOR;
  422. vert_ratio = horiz_ratio;
  423. pfit_control |= (HORIZ_AUTO_SCALE |
  424. VERT_INTERP_BILINEAR |
  425. HORIZ_INTERP_BILINEAR);
  426. /* Letterbox will have top/bottom border */
  427. top_border = (adjusted_mode->vdisplay -
  428. scaled_height) / 2;
  429. bottom_border = top_border;
  430. if (mode->vdisplay & 1)
  431. bottom_border++;
  432. adjusted_mode->crtc_vdisplay = scaled_height;
  433. /* use border instead of border minus one */
  434. adjusted_mode->crtc_vblank_start =
  435. scaled_height + bottom_border;
  436. /* keep the vblank width constant */
  437. adjusted_mode->crtc_vblank_end =
  438. adjusted_mode->crtc_vblank_start +
  439. vblank_width;
  440. /*
  441. * get the vsync start pos relative to
  442. * vblank start
  443. */
  444. vsync_pos = (vblank_width - vsync_width) / 2;
  445. adjusted_mode->crtc_vsync_start =
  446. adjusted_mode->crtc_vblank_start +
  447. vsync_pos;
  448. /* keep the vsync width constant */
  449. adjusted_mode->crtc_vsync_end =
  450. adjusted_mode->crtc_vsync_start +
  451. vsync_width;
  452. border = 1;
  453. } else {
  454. /* Aspects match, Let hw scale both directions */
  455. pfit_control |= (VERT_AUTO_SCALE |
  456. HORIZ_AUTO_SCALE |
  457. VERT_INTERP_BILINEAR |
  458. HORIZ_INTERP_BILINEAR);
  459. }
  460. horiz_bits = (1 << bits) * horiz_ratio /
  461. PANEL_RATIO_FACTOR;
  462. vert_bits = (1 << bits) * vert_ratio /
  463. PANEL_RATIO_FACTOR;
  464. pfit_pgm_ratios =
  465. ((vert_bits << PFIT_VERT_SCALE_SHIFT) &
  466. PFIT_VERT_SCALE_MASK) |
  467. ((horiz_bits << PFIT_HORIZ_SCALE_SHIFT) &
  468. PFIT_HORIZ_SCALE_MASK);
  469. }
  470. break;
  471. case DRM_MODE_SCALE_FULLSCREEN:
  472. /*
  473. * Full scaling, even if it changes the aspect ratio.
  474. * Fortunately this is all done for us in hw.
  475. */
  476. pfit_control |= PFIT_ENABLE;
  477. if (IS_I965G(dev))
  478. pfit_control |= PFIT_SCALING_AUTO;
  479. else
  480. pfit_control |= (VERT_AUTO_SCALE | HORIZ_AUTO_SCALE |
  481. VERT_INTERP_BILINEAR |
  482. HORIZ_INTERP_BILINEAR);
  483. break;
  484. default:
  485. break;
  486. }
  487. out:
  488. lvds_priv->pfit_control = pfit_control;
  489. lvds_priv->pfit_pgm_ratios = pfit_pgm_ratios;
  490. /*
  491. * When there exists the border, it means that the LVDS_BORDR
  492. * should be enabled.
  493. */
  494. if (border)
  495. dev_priv->lvds_border_bits |= LVDS_BORDER_ENABLE;
  496. else
  497. dev_priv->lvds_border_bits &= ~(LVDS_BORDER_ENABLE);
  498. /*
  499. * XXX: It would be nice to support lower refresh rates on the
  500. * panels to reduce power consumption, and perhaps match the
  501. * user's requested refresh rate.
  502. */
  503. return true;
  504. }
  505. static void intel_lvds_prepare(struct drm_encoder *encoder)
  506. {
  507. struct drm_device *dev = encoder->dev;
  508. struct drm_i915_private *dev_priv = dev->dev_private;
  509. u32 reg;
  510. if (IS_IRONLAKE(dev))
  511. reg = BLC_PWM_CPU_CTL;
  512. else
  513. reg = BLC_PWM_CTL;
  514. dev_priv->saveBLC_PWM_CTL = I915_READ(reg);
  515. dev_priv->backlight_duty_cycle = (dev_priv->saveBLC_PWM_CTL &
  516. BACKLIGHT_DUTY_CYCLE_MASK);
  517. intel_lvds_set_power(dev, false);
  518. }
  519. static void intel_lvds_commit( struct drm_encoder *encoder)
  520. {
  521. struct drm_device *dev = encoder->dev;
  522. struct drm_i915_private *dev_priv = dev->dev_private;
  523. if (dev_priv->backlight_duty_cycle == 0)
  524. dev_priv->backlight_duty_cycle =
  525. intel_lvds_get_max_backlight(dev);
  526. intel_lvds_set_power(dev, true);
  527. }
  528. static void intel_lvds_mode_set(struct drm_encoder *encoder,
  529. struct drm_display_mode *mode,
  530. struct drm_display_mode *adjusted_mode)
  531. {
  532. struct drm_device *dev = encoder->dev;
  533. struct drm_i915_private *dev_priv = dev->dev_private;
  534. struct intel_output *intel_output = enc_to_intel_output(encoder);
  535. struct intel_lvds_priv *lvds_priv = intel_output->dev_priv;
  536. /*
  537. * The LVDS pin pair will already have been turned on in the
  538. * intel_crtc_mode_set since it has a large impact on the DPLL
  539. * settings.
  540. */
  541. if (IS_IRONLAKE(dev))
  542. return;
  543. /*
  544. * Enable automatic panel scaling so that non-native modes fill the
  545. * screen. Should be enabled before the pipe is enabled, according to
  546. * register description and PRM.
  547. */
  548. I915_WRITE(PFIT_PGM_RATIOS, lvds_priv->pfit_pgm_ratios);
  549. I915_WRITE(PFIT_CONTROL, lvds_priv->pfit_control);
  550. }
  551. /* Some lid devices report incorrect lid status, assume they're connected */
  552. static const struct dmi_system_id bad_lid_status[] = {
  553. {
  554. .ident = "Compaq nx9020",
  555. .matches = {
  556. DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
  557. DMI_MATCH(DMI_BOARD_NAME, "3084"),
  558. },
  559. },
  560. {
  561. .ident = "Samsung SX20S",
  562. .matches = {
  563. DMI_MATCH(DMI_SYS_VENDOR, "Samsung Electronics"),
  564. DMI_MATCH(DMI_BOARD_NAME, "SX20S"),
  565. },
  566. },
  567. {
  568. .ident = "Aspire One",
  569. .matches = {
  570. DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
  571. DMI_MATCH(DMI_PRODUCT_NAME, "Aspire one"),
  572. },
  573. },
  574. {
  575. .ident = "Aspire 1810T",
  576. .matches = {
  577. DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
  578. DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 1810T"),
  579. },
  580. },
  581. {
  582. .ident = "PC-81005",
  583. .matches = {
  584. DMI_MATCH(DMI_SYS_VENDOR, "MALATA"),
  585. DMI_MATCH(DMI_PRODUCT_NAME, "PC-81005"),
  586. },
  587. },
  588. { }
  589. };
  590. /**
  591. * Detect the LVDS connection.
  592. *
  593. * Since LVDS doesn't have hotlug, we use the lid as a proxy. Open means
  594. * connected and closed means disconnected. We also send hotplug events as
  595. * needed, using lid status notification from the input layer.
  596. */
  597. static enum drm_connector_status intel_lvds_detect(struct drm_connector *connector)
  598. {
  599. enum drm_connector_status status = connector_status_connected;
  600. if (!dmi_check_system(bad_lid_status) && !acpi_lid_open())
  601. status = connector_status_disconnected;
  602. return status;
  603. }
  604. /**
  605. * Return the list of DDC modes if available, or the BIOS fixed mode otherwise.
  606. */
  607. static int intel_lvds_get_modes(struct drm_connector *connector)
  608. {
  609. struct drm_device *dev = connector->dev;
  610. struct intel_output *intel_output = to_intel_output(connector);
  611. struct drm_i915_private *dev_priv = dev->dev_private;
  612. int ret = 0;
  613. ret = intel_ddc_get_modes(intel_output);
  614. if (ret)
  615. return ret;
  616. /* Didn't get an EDID, so
  617. * Set wide sync ranges so we get all modes
  618. * handed to valid_mode for checking
  619. */
  620. connector->display_info.min_vfreq = 0;
  621. connector->display_info.max_vfreq = 200;
  622. connector->display_info.min_hfreq = 0;
  623. connector->display_info.max_hfreq = 200;
  624. if (dev_priv->panel_fixed_mode != NULL) {
  625. struct drm_display_mode *mode;
  626. mode = drm_mode_duplicate(dev, dev_priv->panel_fixed_mode);
  627. drm_mode_probed_add(connector, mode);
  628. return 1;
  629. }
  630. return 0;
  631. }
  632. /*
  633. * Lid events. Note the use of 'modeset_on_lid':
  634. * - we set it on lid close, and reset it on open
  635. * - we use it as a "only once" bit (ie we ignore
  636. * duplicate events where it was already properly
  637. * set/reset)
  638. * - the suspend/resume paths will also set it to
  639. * zero, since they restore the mode ("lid open").
  640. */
  641. static int intel_lid_notify(struct notifier_block *nb, unsigned long val,
  642. void *unused)
  643. {
  644. struct drm_i915_private *dev_priv =
  645. container_of(nb, struct drm_i915_private, lid_notifier);
  646. struct drm_device *dev = dev_priv->dev;
  647. struct drm_connector *connector = dev_priv->int_lvds_connector;
  648. /*
  649. * check and update the status of LVDS connector after receiving
  650. * the LID nofication event.
  651. */
  652. if (connector)
  653. connector->status = connector->funcs->detect(connector);
  654. if (!acpi_lid_open()) {
  655. dev_priv->modeset_on_lid = 1;
  656. return NOTIFY_OK;
  657. }
  658. if (!dev_priv->modeset_on_lid)
  659. return NOTIFY_OK;
  660. dev_priv->modeset_on_lid = 0;
  661. mutex_lock(&dev->mode_config.mutex);
  662. drm_helper_resume_force_mode(dev);
  663. mutex_unlock(&dev->mode_config.mutex);
  664. return NOTIFY_OK;
  665. }
  666. /**
  667. * intel_lvds_destroy - unregister and free LVDS structures
  668. * @connector: connector to free
  669. *
  670. * Unregister the DDC bus for this connector then free the driver private
  671. * structure.
  672. */
  673. static void intel_lvds_destroy(struct drm_connector *connector)
  674. {
  675. struct drm_device *dev = connector->dev;
  676. struct intel_output *intel_output = to_intel_output(connector);
  677. struct drm_i915_private *dev_priv = dev->dev_private;
  678. if (intel_output->ddc_bus)
  679. intel_i2c_destroy(intel_output->ddc_bus);
  680. if (dev_priv->lid_notifier.notifier_call)
  681. acpi_lid_notifier_unregister(&dev_priv->lid_notifier);
  682. drm_sysfs_connector_remove(connector);
  683. drm_connector_cleanup(connector);
  684. kfree(connector);
  685. }
  686. static int intel_lvds_set_property(struct drm_connector *connector,
  687. struct drm_property *property,
  688. uint64_t value)
  689. {
  690. struct drm_device *dev = connector->dev;
  691. struct intel_output *intel_output =
  692. to_intel_output(connector);
  693. if (property == dev->mode_config.scaling_mode_property &&
  694. connector->encoder) {
  695. struct drm_crtc *crtc = connector->encoder->crtc;
  696. struct intel_lvds_priv *lvds_priv = intel_output->dev_priv;
  697. if (value == DRM_MODE_SCALE_NONE) {
  698. DRM_DEBUG_KMS("no scaling not supported\n");
  699. return 0;
  700. }
  701. if (lvds_priv->fitting_mode == value) {
  702. /* the LVDS scaling property is not changed */
  703. return 0;
  704. }
  705. lvds_priv->fitting_mode = value;
  706. if (crtc && crtc->enabled) {
  707. /*
  708. * If the CRTC is enabled, the display will be changed
  709. * according to the new panel fitting mode.
  710. */
  711. drm_crtc_helper_set_mode(crtc, &crtc->mode,
  712. crtc->x, crtc->y, crtc->fb);
  713. }
  714. }
  715. return 0;
  716. }
  717. static const struct drm_encoder_helper_funcs intel_lvds_helper_funcs = {
  718. .dpms = intel_lvds_dpms,
  719. .mode_fixup = intel_lvds_mode_fixup,
  720. .prepare = intel_lvds_prepare,
  721. .mode_set = intel_lvds_mode_set,
  722. .commit = intel_lvds_commit,
  723. };
  724. static const struct drm_connector_helper_funcs intel_lvds_connector_helper_funcs = {
  725. .get_modes = intel_lvds_get_modes,
  726. .mode_valid = intel_lvds_mode_valid,
  727. .best_encoder = intel_best_encoder,
  728. };
  729. static const struct drm_connector_funcs intel_lvds_connector_funcs = {
  730. .dpms = drm_helper_connector_dpms,
  731. .save = intel_lvds_save,
  732. .restore = intel_lvds_restore,
  733. .detect = intel_lvds_detect,
  734. .fill_modes = drm_helper_probe_single_connector_modes,
  735. .set_property = intel_lvds_set_property,
  736. .destroy = intel_lvds_destroy,
  737. };
  738. static void intel_lvds_enc_destroy(struct drm_encoder *encoder)
  739. {
  740. drm_encoder_cleanup(encoder);
  741. }
  742. static const struct drm_encoder_funcs intel_lvds_enc_funcs = {
  743. .destroy = intel_lvds_enc_destroy,
  744. };
  745. static int __init intel_no_lvds_dmi_callback(const struct dmi_system_id *id)
  746. {
  747. DRM_DEBUG_KMS("Skipping LVDS initialization for %s\n", id->ident);
  748. return 1;
  749. }
  750. /* These systems claim to have LVDS, but really don't */
  751. static const struct dmi_system_id intel_no_lvds[] = {
  752. {
  753. .callback = intel_no_lvds_dmi_callback,
  754. .ident = "Apple Mac Mini (Core series)",
  755. .matches = {
  756. DMI_MATCH(DMI_SYS_VENDOR, "Apple"),
  757. DMI_MATCH(DMI_PRODUCT_NAME, "Macmini1,1"),
  758. },
  759. },
  760. {
  761. .callback = intel_no_lvds_dmi_callback,
  762. .ident = "Apple Mac Mini (Core 2 series)",
  763. .matches = {
  764. DMI_MATCH(DMI_SYS_VENDOR, "Apple"),
  765. DMI_MATCH(DMI_PRODUCT_NAME, "Macmini2,1"),
  766. },
  767. },
  768. {
  769. .callback = intel_no_lvds_dmi_callback,
  770. .ident = "MSI IM-945GSE-A",
  771. .matches = {
  772. DMI_MATCH(DMI_SYS_VENDOR, "MSI"),
  773. DMI_MATCH(DMI_PRODUCT_NAME, "A9830IMS"),
  774. },
  775. },
  776. {
  777. .callback = intel_no_lvds_dmi_callback,
  778. .ident = "Dell Studio Hybrid",
  779. .matches = {
  780. DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
  781. DMI_MATCH(DMI_PRODUCT_NAME, "Studio Hybrid 140g"),
  782. },
  783. },
  784. {
  785. .callback = intel_no_lvds_dmi_callback,
  786. .ident = "AOpen Mini PC",
  787. .matches = {
  788. DMI_MATCH(DMI_SYS_VENDOR, "AOpen"),
  789. DMI_MATCH(DMI_PRODUCT_NAME, "i965GMx-IF"),
  790. },
  791. },
  792. {
  793. .callback = intel_no_lvds_dmi_callback,
  794. .ident = "AOpen Mini PC MP915",
  795. .matches = {
  796. DMI_MATCH(DMI_BOARD_VENDOR, "AOpen"),
  797. DMI_MATCH(DMI_BOARD_NAME, "i915GMx-F"),
  798. },
  799. },
  800. {
  801. .callback = intel_no_lvds_dmi_callback,
  802. .ident = "Aopen i945GTt-VFA",
  803. .matches = {
  804. DMI_MATCH(DMI_PRODUCT_VERSION, "AO00001JW"),
  805. },
  806. },
  807. { } /* terminating entry */
  808. };
  809. /**
  810. * intel_find_lvds_downclock - find the reduced downclock for LVDS in EDID
  811. * @dev: drm device
  812. * @connector: LVDS connector
  813. *
  814. * Find the reduced downclock for LVDS in EDID.
  815. */
  816. static void intel_find_lvds_downclock(struct drm_device *dev,
  817. struct drm_connector *connector)
  818. {
  819. struct drm_i915_private *dev_priv = dev->dev_private;
  820. struct drm_display_mode *scan, *panel_fixed_mode;
  821. int temp_downclock;
  822. panel_fixed_mode = dev_priv->panel_fixed_mode;
  823. temp_downclock = panel_fixed_mode->clock;
  824. mutex_lock(&dev->mode_config.mutex);
  825. list_for_each_entry(scan, &connector->probed_modes, head) {
  826. /*
  827. * If one mode has the same resolution with the fixed_panel
  828. * mode while they have the different refresh rate, it means
  829. * that the reduced downclock is found for the LVDS. In such
  830. * case we can set the different FPx0/1 to dynamically select
  831. * between low and high frequency.
  832. */
  833. if (scan->hdisplay == panel_fixed_mode->hdisplay &&
  834. scan->hsync_start == panel_fixed_mode->hsync_start &&
  835. scan->hsync_end == panel_fixed_mode->hsync_end &&
  836. scan->htotal == panel_fixed_mode->htotal &&
  837. scan->vdisplay == panel_fixed_mode->vdisplay &&
  838. scan->vsync_start == panel_fixed_mode->vsync_start &&
  839. scan->vsync_end == panel_fixed_mode->vsync_end &&
  840. scan->vtotal == panel_fixed_mode->vtotal) {
  841. if (scan->clock < temp_downclock) {
  842. /*
  843. * The downclock is already found. But we
  844. * expect to find the lower downclock.
  845. */
  846. temp_downclock = scan->clock;
  847. }
  848. }
  849. }
  850. mutex_unlock(&dev->mode_config.mutex);
  851. if (temp_downclock < panel_fixed_mode->clock &&
  852. i915_lvds_downclock) {
  853. /* We found the downclock for LVDS. */
  854. dev_priv->lvds_downclock_avail = 1;
  855. dev_priv->lvds_downclock = temp_downclock;
  856. DRM_DEBUG_KMS("LVDS downclock is found in EDID. "
  857. "Normal clock %dKhz, downclock %dKhz\n",
  858. panel_fixed_mode->clock, temp_downclock);
  859. }
  860. return;
  861. }
  862. /*
  863. * Enumerate the child dev array parsed from VBT to check whether
  864. * the LVDS is present.
  865. * If it is present, return 1.
  866. * If it is not present, return false.
  867. * If no child dev is parsed from VBT, it assumes that the LVDS is present.
  868. * Note: The addin_offset should also be checked for LVDS panel.
  869. * Only when it is non-zero, it is assumed that it is present.
  870. */
  871. static int lvds_is_present_in_vbt(struct drm_device *dev)
  872. {
  873. struct drm_i915_private *dev_priv = dev->dev_private;
  874. struct child_device_config *p_child;
  875. int i, ret;
  876. if (!dev_priv->child_dev_num)
  877. return 1;
  878. ret = 0;
  879. for (i = 0; i < dev_priv->child_dev_num; i++) {
  880. p_child = dev_priv->child_dev + i;
  881. /*
  882. * If the device type is not LFP, continue.
  883. * If the device type is 0x22, it is also regarded as LFP.
  884. */
  885. if (p_child->device_type != DEVICE_TYPE_INT_LFP &&
  886. p_child->device_type != DEVICE_TYPE_LFP)
  887. continue;
  888. /* The addin_offset should be checked. Only when it is
  889. * non-zero, it is regarded as present.
  890. */
  891. if (p_child->addin_offset) {
  892. ret = 1;
  893. break;
  894. }
  895. }
  896. return ret;
  897. }
  898. /**
  899. * intel_lvds_init - setup LVDS connectors on this device
  900. * @dev: drm device
  901. *
  902. * Create the connector, register the LVDS DDC bus, and try to figure out what
  903. * modes we can display on the LVDS panel (if present).
  904. */
  905. void intel_lvds_init(struct drm_device *dev)
  906. {
  907. struct drm_i915_private *dev_priv = dev->dev_private;
  908. struct intel_output *intel_output;
  909. struct drm_connector *connector;
  910. struct drm_encoder *encoder;
  911. struct drm_display_mode *scan; /* *modes, *bios_mode; */
  912. struct drm_crtc *crtc;
  913. struct intel_lvds_priv *lvds_priv;
  914. u32 lvds;
  915. int pipe, gpio = GPIOC;
  916. /* Skip init on machines we know falsely report LVDS */
  917. if (dmi_check_system(intel_no_lvds))
  918. return;
  919. if (!lvds_is_present_in_vbt(dev)) {
  920. DRM_DEBUG_KMS("LVDS is not present in VBT\n");
  921. return;
  922. }
  923. if (IS_IRONLAKE(dev)) {
  924. if ((I915_READ(PCH_LVDS) & LVDS_DETECTED) == 0)
  925. return;
  926. if (dev_priv->edp_support) {
  927. DRM_DEBUG_KMS("disable LVDS for eDP support\n");
  928. return;
  929. }
  930. gpio = PCH_GPIOC;
  931. }
  932. intel_output = kzalloc(sizeof(struct intel_output) +
  933. sizeof(struct intel_lvds_priv), GFP_KERNEL);
  934. if (!intel_output) {
  935. return;
  936. }
  937. connector = &intel_output->base;
  938. encoder = &intel_output->enc;
  939. drm_connector_init(dev, &intel_output->base, &intel_lvds_connector_funcs,
  940. DRM_MODE_CONNECTOR_LVDS);
  941. drm_encoder_init(dev, &intel_output->enc, &intel_lvds_enc_funcs,
  942. DRM_MODE_ENCODER_LVDS);
  943. drm_mode_connector_attach_encoder(&intel_output->base, &intel_output->enc);
  944. intel_output->type = INTEL_OUTPUT_LVDS;
  945. intel_output->clone_mask = (1 << INTEL_LVDS_CLONE_BIT);
  946. intel_output->crtc_mask = (1 << 1);
  947. drm_encoder_helper_add(encoder, &intel_lvds_helper_funcs);
  948. drm_connector_helper_add(connector, &intel_lvds_connector_helper_funcs);
  949. connector->display_info.subpixel_order = SubPixelHorizontalRGB;
  950. connector->interlace_allowed = false;
  951. connector->doublescan_allowed = false;
  952. lvds_priv = (struct intel_lvds_priv *)(intel_output + 1);
  953. intel_output->dev_priv = lvds_priv;
  954. /* create the scaling mode property */
  955. drm_mode_create_scaling_mode_property(dev);
  956. /*
  957. * the initial panel fitting mode will be FULL_SCREEN.
  958. */
  959. drm_connector_attach_property(&intel_output->base,
  960. dev->mode_config.scaling_mode_property,
  961. DRM_MODE_SCALE_FULLSCREEN);
  962. lvds_priv->fitting_mode = DRM_MODE_SCALE_FULLSCREEN;
  963. /*
  964. * LVDS discovery:
  965. * 1) check for EDID on DDC
  966. * 2) check for VBT data
  967. * 3) check to see if LVDS is already on
  968. * if none of the above, no panel
  969. * 4) make sure lid is open
  970. * if closed, act like it's not there for now
  971. */
  972. /* Set up the DDC bus. */
  973. intel_output->ddc_bus = intel_i2c_create(dev, gpio, "LVDSDDC_C");
  974. if (!intel_output->ddc_bus) {
  975. dev_printk(KERN_ERR, &dev->pdev->dev, "DDC bus registration "
  976. "failed.\n");
  977. goto failed;
  978. }
  979. /*
  980. * Attempt to get the fixed panel mode from DDC. Assume that the
  981. * preferred mode is the right one.
  982. */
  983. intel_ddc_get_modes(intel_output);
  984. list_for_each_entry(scan, &connector->probed_modes, head) {
  985. mutex_lock(&dev->mode_config.mutex);
  986. if (scan->type & DRM_MODE_TYPE_PREFERRED) {
  987. dev_priv->panel_fixed_mode =
  988. drm_mode_duplicate(dev, scan);
  989. mutex_unlock(&dev->mode_config.mutex);
  990. intel_find_lvds_downclock(dev, connector);
  991. goto out;
  992. }
  993. mutex_unlock(&dev->mode_config.mutex);
  994. }
  995. /* Failed to get EDID, what about VBT? */
  996. if (dev_priv->lfp_lvds_vbt_mode) {
  997. mutex_lock(&dev->mode_config.mutex);
  998. dev_priv->panel_fixed_mode =
  999. drm_mode_duplicate(dev, dev_priv->lfp_lvds_vbt_mode);
  1000. mutex_unlock(&dev->mode_config.mutex);
  1001. if (dev_priv->panel_fixed_mode) {
  1002. dev_priv->panel_fixed_mode->type |=
  1003. DRM_MODE_TYPE_PREFERRED;
  1004. goto out;
  1005. }
  1006. }
  1007. /*
  1008. * If we didn't get EDID, try checking if the panel is already turned
  1009. * on. If so, assume that whatever is currently programmed is the
  1010. * correct mode.
  1011. */
  1012. /* Ironlake: FIXME if still fail, not try pipe mode now */
  1013. if (IS_IRONLAKE(dev))
  1014. goto failed;
  1015. lvds = I915_READ(LVDS);
  1016. pipe = (lvds & LVDS_PIPEB_SELECT) ? 1 : 0;
  1017. crtc = intel_get_crtc_from_pipe(dev, pipe);
  1018. if (crtc && (lvds & LVDS_PORT_EN)) {
  1019. dev_priv->panel_fixed_mode = intel_crtc_mode_get(dev, crtc);
  1020. if (dev_priv->panel_fixed_mode) {
  1021. dev_priv->panel_fixed_mode->type |=
  1022. DRM_MODE_TYPE_PREFERRED;
  1023. goto out;
  1024. }
  1025. }
  1026. /* If we still don't have a mode after all that, give up. */
  1027. if (!dev_priv->panel_fixed_mode)
  1028. goto failed;
  1029. out:
  1030. if (IS_IRONLAKE(dev)) {
  1031. u32 pwm;
  1032. /* make sure PWM is enabled */
  1033. pwm = I915_READ(BLC_PWM_CPU_CTL2);
  1034. pwm |= (PWM_ENABLE | PWM_PIPE_B);
  1035. I915_WRITE(BLC_PWM_CPU_CTL2, pwm);
  1036. pwm = I915_READ(BLC_PWM_PCH_CTL1);
  1037. pwm |= PWM_PCH_ENABLE;
  1038. I915_WRITE(BLC_PWM_PCH_CTL1, pwm);
  1039. }
  1040. dev_priv->lid_notifier.notifier_call = intel_lid_notify;
  1041. if (acpi_lid_notifier_register(&dev_priv->lid_notifier)) {
  1042. DRM_DEBUG_KMS("lid notifier registration failed\n");
  1043. dev_priv->lid_notifier.notifier_call = NULL;
  1044. }
  1045. /* keep the LVDS connector */
  1046. dev_priv->int_lvds_connector = connector;
  1047. drm_sysfs_connector_add(connector);
  1048. return;
  1049. failed:
  1050. DRM_DEBUG_KMS("No LVDS modes found, disabling.\n");
  1051. if (intel_output->ddc_bus)
  1052. intel_i2c_destroy(intel_output->ddc_bus);
  1053. drm_connector_cleanup(connector);
  1054. drm_encoder_cleanup(encoder);
  1055. kfree(intel_output);
  1056. }