intel_lvds.c 33 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146
  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 = "Aspire One",
  555. .matches = {
  556. DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
  557. DMI_MATCH(DMI_PRODUCT_NAME, "Aspire one"),
  558. },
  559. },
  560. {
  561. .ident = "PC-81005",
  562. .matches = {
  563. DMI_MATCH(DMI_SYS_VENDOR, "MALATA"),
  564. DMI_MATCH(DMI_PRODUCT_NAME, "PC-81005"),
  565. },
  566. },
  567. { }
  568. };
  569. /**
  570. * Detect the LVDS connection.
  571. *
  572. * Since LVDS doesn't have hotlug, we use the lid as a proxy. Open means
  573. * connected and closed means disconnected. We also send hotplug events as
  574. * needed, using lid status notification from the input layer.
  575. */
  576. static enum drm_connector_status intel_lvds_detect(struct drm_connector *connector)
  577. {
  578. enum drm_connector_status status = connector_status_connected;
  579. if (!acpi_lid_open() && !dmi_check_system(bad_lid_status))
  580. status = connector_status_disconnected;
  581. return status;
  582. }
  583. /**
  584. * Return the list of DDC modes if available, or the BIOS fixed mode otherwise.
  585. */
  586. static int intel_lvds_get_modes(struct drm_connector *connector)
  587. {
  588. struct drm_device *dev = connector->dev;
  589. struct intel_output *intel_output = to_intel_output(connector);
  590. struct drm_i915_private *dev_priv = dev->dev_private;
  591. int ret = 0;
  592. ret = intel_ddc_get_modes(intel_output);
  593. if (ret)
  594. return ret;
  595. /* Didn't get an EDID, so
  596. * Set wide sync ranges so we get all modes
  597. * handed to valid_mode for checking
  598. */
  599. connector->display_info.min_vfreq = 0;
  600. connector->display_info.max_vfreq = 200;
  601. connector->display_info.min_hfreq = 0;
  602. connector->display_info.max_hfreq = 200;
  603. if (dev_priv->panel_fixed_mode != NULL) {
  604. struct drm_display_mode *mode;
  605. mode = drm_mode_duplicate(dev, dev_priv->panel_fixed_mode);
  606. drm_mode_probed_add(connector, mode);
  607. return 1;
  608. }
  609. return 0;
  610. }
  611. /*
  612. * Lid events. Note the use of 'modeset_on_lid':
  613. * - we set it on lid close, and reset it on open
  614. * - we use it as a "only once" bit (ie we ignore
  615. * duplicate events where it was already properly
  616. * set/reset)
  617. * - the suspend/resume paths will also set it to
  618. * zero, since they restore the mode ("lid open").
  619. */
  620. static int intel_lid_notify(struct notifier_block *nb, unsigned long val,
  621. void *unused)
  622. {
  623. struct drm_i915_private *dev_priv =
  624. container_of(nb, struct drm_i915_private, lid_notifier);
  625. struct drm_device *dev = dev_priv->dev;
  626. struct drm_connector *connector = dev_priv->int_lvds_connector;
  627. /*
  628. * check and update the status of LVDS connector after receiving
  629. * the LID nofication event.
  630. */
  631. if (connector)
  632. connector->status = connector->funcs->detect(connector);
  633. if (!acpi_lid_open()) {
  634. dev_priv->modeset_on_lid = 1;
  635. return NOTIFY_OK;
  636. }
  637. if (!dev_priv->modeset_on_lid)
  638. return NOTIFY_OK;
  639. dev_priv->modeset_on_lid = 0;
  640. mutex_lock(&dev->mode_config.mutex);
  641. drm_helper_resume_force_mode(dev);
  642. mutex_unlock(&dev->mode_config.mutex);
  643. return NOTIFY_OK;
  644. }
  645. /**
  646. * intel_lvds_destroy - unregister and free LVDS structures
  647. * @connector: connector to free
  648. *
  649. * Unregister the DDC bus for this connector then free the driver private
  650. * structure.
  651. */
  652. static void intel_lvds_destroy(struct drm_connector *connector)
  653. {
  654. struct drm_device *dev = connector->dev;
  655. struct intel_output *intel_output = to_intel_output(connector);
  656. struct drm_i915_private *dev_priv = dev->dev_private;
  657. if (intel_output->ddc_bus)
  658. intel_i2c_destroy(intel_output->ddc_bus);
  659. if (dev_priv->lid_notifier.notifier_call)
  660. acpi_lid_notifier_unregister(&dev_priv->lid_notifier);
  661. drm_sysfs_connector_remove(connector);
  662. drm_connector_cleanup(connector);
  663. kfree(connector);
  664. }
  665. static int intel_lvds_set_property(struct drm_connector *connector,
  666. struct drm_property *property,
  667. uint64_t value)
  668. {
  669. struct drm_device *dev = connector->dev;
  670. struct intel_output *intel_output =
  671. to_intel_output(connector);
  672. if (property == dev->mode_config.scaling_mode_property &&
  673. connector->encoder) {
  674. struct drm_crtc *crtc = connector->encoder->crtc;
  675. struct intel_lvds_priv *lvds_priv = intel_output->dev_priv;
  676. if (value == DRM_MODE_SCALE_NONE) {
  677. DRM_DEBUG_KMS("no scaling not supported\n");
  678. return 0;
  679. }
  680. if (lvds_priv->fitting_mode == value) {
  681. /* the LVDS scaling property is not changed */
  682. return 0;
  683. }
  684. lvds_priv->fitting_mode = value;
  685. if (crtc && crtc->enabled) {
  686. /*
  687. * If the CRTC is enabled, the display will be changed
  688. * according to the new panel fitting mode.
  689. */
  690. drm_crtc_helper_set_mode(crtc, &crtc->mode,
  691. crtc->x, crtc->y, crtc->fb);
  692. }
  693. }
  694. return 0;
  695. }
  696. static const struct drm_encoder_helper_funcs intel_lvds_helper_funcs = {
  697. .dpms = intel_lvds_dpms,
  698. .mode_fixup = intel_lvds_mode_fixup,
  699. .prepare = intel_lvds_prepare,
  700. .mode_set = intel_lvds_mode_set,
  701. .commit = intel_lvds_commit,
  702. };
  703. static const struct drm_connector_helper_funcs intel_lvds_connector_helper_funcs = {
  704. .get_modes = intel_lvds_get_modes,
  705. .mode_valid = intel_lvds_mode_valid,
  706. .best_encoder = intel_best_encoder,
  707. };
  708. static const struct drm_connector_funcs intel_lvds_connector_funcs = {
  709. .dpms = drm_helper_connector_dpms,
  710. .save = intel_lvds_save,
  711. .restore = intel_lvds_restore,
  712. .detect = intel_lvds_detect,
  713. .fill_modes = drm_helper_probe_single_connector_modes,
  714. .set_property = intel_lvds_set_property,
  715. .destroy = intel_lvds_destroy,
  716. };
  717. static void intel_lvds_enc_destroy(struct drm_encoder *encoder)
  718. {
  719. drm_encoder_cleanup(encoder);
  720. }
  721. static const struct drm_encoder_funcs intel_lvds_enc_funcs = {
  722. .destroy = intel_lvds_enc_destroy,
  723. };
  724. static int __init intel_no_lvds_dmi_callback(const struct dmi_system_id *id)
  725. {
  726. DRM_DEBUG_KMS("Skipping LVDS initialization for %s\n", id->ident);
  727. return 1;
  728. }
  729. /* These systems claim to have LVDS, but really don't */
  730. static const struct dmi_system_id intel_no_lvds[] = {
  731. {
  732. .callback = intel_no_lvds_dmi_callback,
  733. .ident = "Apple Mac Mini (Core series)",
  734. .matches = {
  735. DMI_MATCH(DMI_SYS_VENDOR, "Apple"),
  736. DMI_MATCH(DMI_PRODUCT_NAME, "Macmini1,1"),
  737. },
  738. },
  739. {
  740. .callback = intel_no_lvds_dmi_callback,
  741. .ident = "Apple Mac Mini (Core 2 series)",
  742. .matches = {
  743. DMI_MATCH(DMI_SYS_VENDOR, "Apple"),
  744. DMI_MATCH(DMI_PRODUCT_NAME, "Macmini2,1"),
  745. },
  746. },
  747. {
  748. .callback = intel_no_lvds_dmi_callback,
  749. .ident = "MSI IM-945GSE-A",
  750. .matches = {
  751. DMI_MATCH(DMI_SYS_VENDOR, "MSI"),
  752. DMI_MATCH(DMI_PRODUCT_NAME, "A9830IMS"),
  753. },
  754. },
  755. {
  756. .callback = intel_no_lvds_dmi_callback,
  757. .ident = "Dell Studio Hybrid",
  758. .matches = {
  759. DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
  760. DMI_MATCH(DMI_PRODUCT_NAME, "Studio Hybrid 140g"),
  761. },
  762. },
  763. {
  764. .callback = intel_no_lvds_dmi_callback,
  765. .ident = "AOpen Mini PC",
  766. .matches = {
  767. DMI_MATCH(DMI_SYS_VENDOR, "AOpen"),
  768. DMI_MATCH(DMI_PRODUCT_NAME, "i965GMx-IF"),
  769. },
  770. },
  771. {
  772. .callback = intel_no_lvds_dmi_callback,
  773. .ident = "AOpen Mini PC MP915",
  774. .matches = {
  775. DMI_MATCH(DMI_BOARD_VENDOR, "AOpen"),
  776. DMI_MATCH(DMI_BOARD_NAME, "i915GMx-F"),
  777. },
  778. },
  779. {
  780. .callback = intel_no_lvds_dmi_callback,
  781. .ident = "Aopen i945GTt-VFA",
  782. .matches = {
  783. DMI_MATCH(DMI_PRODUCT_VERSION, "AO00001JW"),
  784. },
  785. },
  786. { } /* terminating entry */
  787. };
  788. /**
  789. * intel_find_lvds_downclock - find the reduced downclock for LVDS in EDID
  790. * @dev: drm device
  791. * @connector: LVDS connector
  792. *
  793. * Find the reduced downclock for LVDS in EDID.
  794. */
  795. static void intel_find_lvds_downclock(struct drm_device *dev,
  796. struct drm_connector *connector)
  797. {
  798. struct drm_i915_private *dev_priv = dev->dev_private;
  799. struct drm_display_mode *scan, *panel_fixed_mode;
  800. int temp_downclock;
  801. panel_fixed_mode = dev_priv->panel_fixed_mode;
  802. temp_downclock = panel_fixed_mode->clock;
  803. mutex_lock(&dev->mode_config.mutex);
  804. list_for_each_entry(scan, &connector->probed_modes, head) {
  805. /*
  806. * If one mode has the same resolution with the fixed_panel
  807. * mode while they have the different refresh rate, it means
  808. * that the reduced downclock is found for the LVDS. In such
  809. * case we can set the different FPx0/1 to dynamically select
  810. * between low and high frequency.
  811. */
  812. if (scan->hdisplay == panel_fixed_mode->hdisplay &&
  813. scan->hsync_start == panel_fixed_mode->hsync_start &&
  814. scan->hsync_end == panel_fixed_mode->hsync_end &&
  815. scan->htotal == panel_fixed_mode->htotal &&
  816. scan->vdisplay == panel_fixed_mode->vdisplay &&
  817. scan->vsync_start == panel_fixed_mode->vsync_start &&
  818. scan->vsync_end == panel_fixed_mode->vsync_end &&
  819. scan->vtotal == panel_fixed_mode->vtotal) {
  820. if (scan->clock < temp_downclock) {
  821. /*
  822. * The downclock is already found. But we
  823. * expect to find the lower downclock.
  824. */
  825. temp_downclock = scan->clock;
  826. }
  827. }
  828. }
  829. mutex_unlock(&dev->mode_config.mutex);
  830. if (temp_downclock < panel_fixed_mode->clock) {
  831. /* We found the downclock for LVDS. */
  832. dev_priv->lvds_downclock_avail = 1;
  833. dev_priv->lvds_downclock = temp_downclock;
  834. DRM_DEBUG_KMS("LVDS downclock is found in EDID. "
  835. "Normal clock %dKhz, downclock %dKhz\n",
  836. panel_fixed_mode->clock, temp_downclock);
  837. }
  838. return;
  839. }
  840. /*
  841. * Enumerate the child dev array parsed from VBT to check whether
  842. * the LVDS is present.
  843. * If it is present, return 1.
  844. * If it is not present, return false.
  845. * If no child dev is parsed from VBT, it assumes that the LVDS is present.
  846. * Note: The addin_offset should also be checked for LVDS panel.
  847. * Only when it is non-zero, it is assumed that it is present.
  848. */
  849. static int lvds_is_present_in_vbt(struct drm_device *dev)
  850. {
  851. struct drm_i915_private *dev_priv = dev->dev_private;
  852. struct child_device_config *p_child;
  853. int i, ret;
  854. if (!dev_priv->child_dev_num)
  855. return 1;
  856. ret = 0;
  857. for (i = 0; i < dev_priv->child_dev_num; i++) {
  858. p_child = dev_priv->child_dev + i;
  859. /*
  860. * If the device type is not LFP, continue.
  861. * If the device type is 0x22, it is also regarded as LFP.
  862. */
  863. if (p_child->device_type != DEVICE_TYPE_INT_LFP &&
  864. p_child->device_type != DEVICE_TYPE_LFP)
  865. continue;
  866. /* The addin_offset should be checked. Only when it is
  867. * non-zero, it is regarded as present.
  868. */
  869. if (p_child->addin_offset) {
  870. ret = 1;
  871. break;
  872. }
  873. }
  874. return ret;
  875. }
  876. /**
  877. * intel_lvds_init - setup LVDS connectors on this device
  878. * @dev: drm device
  879. *
  880. * Create the connector, register the LVDS DDC bus, and try to figure out what
  881. * modes we can display on the LVDS panel (if present).
  882. */
  883. void intel_lvds_init(struct drm_device *dev)
  884. {
  885. struct drm_i915_private *dev_priv = dev->dev_private;
  886. struct intel_output *intel_output;
  887. struct drm_connector *connector;
  888. struct drm_encoder *encoder;
  889. struct drm_display_mode *scan; /* *modes, *bios_mode; */
  890. struct drm_crtc *crtc;
  891. struct intel_lvds_priv *lvds_priv;
  892. u32 lvds;
  893. int pipe, gpio = GPIOC;
  894. /* Skip init on machines we know falsely report LVDS */
  895. if (dmi_check_system(intel_no_lvds))
  896. return;
  897. if (!lvds_is_present_in_vbt(dev)) {
  898. DRM_DEBUG_KMS("LVDS is not present in VBT\n");
  899. return;
  900. }
  901. if (IS_IRONLAKE(dev)) {
  902. if ((I915_READ(PCH_LVDS) & LVDS_DETECTED) == 0)
  903. return;
  904. if (dev_priv->edp_support) {
  905. DRM_DEBUG_KMS("disable LVDS for eDP support\n");
  906. return;
  907. }
  908. gpio = PCH_GPIOC;
  909. }
  910. intel_output = kzalloc(sizeof(struct intel_output) +
  911. sizeof(struct intel_lvds_priv), GFP_KERNEL);
  912. if (!intel_output) {
  913. return;
  914. }
  915. connector = &intel_output->base;
  916. encoder = &intel_output->enc;
  917. drm_connector_init(dev, &intel_output->base, &intel_lvds_connector_funcs,
  918. DRM_MODE_CONNECTOR_LVDS);
  919. drm_encoder_init(dev, &intel_output->enc, &intel_lvds_enc_funcs,
  920. DRM_MODE_ENCODER_LVDS);
  921. drm_mode_connector_attach_encoder(&intel_output->base, &intel_output->enc);
  922. intel_output->type = INTEL_OUTPUT_LVDS;
  923. intel_output->clone_mask = (1 << INTEL_LVDS_CLONE_BIT);
  924. intel_output->crtc_mask = (1 << 1);
  925. drm_encoder_helper_add(encoder, &intel_lvds_helper_funcs);
  926. drm_connector_helper_add(connector, &intel_lvds_connector_helper_funcs);
  927. connector->display_info.subpixel_order = SubPixelHorizontalRGB;
  928. connector->interlace_allowed = false;
  929. connector->doublescan_allowed = false;
  930. lvds_priv = (struct intel_lvds_priv *)(intel_output + 1);
  931. intel_output->dev_priv = lvds_priv;
  932. /* create the scaling mode property */
  933. drm_mode_create_scaling_mode_property(dev);
  934. /*
  935. * the initial panel fitting mode will be FULL_SCREEN.
  936. */
  937. drm_connector_attach_property(&intel_output->base,
  938. dev->mode_config.scaling_mode_property,
  939. DRM_MODE_SCALE_FULLSCREEN);
  940. lvds_priv->fitting_mode = DRM_MODE_SCALE_FULLSCREEN;
  941. /*
  942. * LVDS discovery:
  943. * 1) check for EDID on DDC
  944. * 2) check for VBT data
  945. * 3) check to see if LVDS is already on
  946. * if none of the above, no panel
  947. * 4) make sure lid is open
  948. * if closed, act like it's not there for now
  949. */
  950. /* Set up the DDC bus. */
  951. intel_output->ddc_bus = intel_i2c_create(dev, gpio, "LVDSDDC_C");
  952. if (!intel_output->ddc_bus) {
  953. dev_printk(KERN_ERR, &dev->pdev->dev, "DDC bus registration "
  954. "failed.\n");
  955. goto failed;
  956. }
  957. /*
  958. * Attempt to get the fixed panel mode from DDC. Assume that the
  959. * preferred mode is the right one.
  960. */
  961. intel_ddc_get_modes(intel_output);
  962. list_for_each_entry(scan, &connector->probed_modes, head) {
  963. mutex_lock(&dev->mode_config.mutex);
  964. if (scan->type & DRM_MODE_TYPE_PREFERRED) {
  965. dev_priv->panel_fixed_mode =
  966. drm_mode_duplicate(dev, scan);
  967. mutex_unlock(&dev->mode_config.mutex);
  968. intel_find_lvds_downclock(dev, connector);
  969. goto out;
  970. }
  971. mutex_unlock(&dev->mode_config.mutex);
  972. }
  973. /* Failed to get EDID, what about VBT? */
  974. if (dev_priv->lfp_lvds_vbt_mode) {
  975. mutex_lock(&dev->mode_config.mutex);
  976. dev_priv->panel_fixed_mode =
  977. drm_mode_duplicate(dev, dev_priv->lfp_lvds_vbt_mode);
  978. mutex_unlock(&dev->mode_config.mutex);
  979. if (dev_priv->panel_fixed_mode) {
  980. dev_priv->panel_fixed_mode->type |=
  981. DRM_MODE_TYPE_PREFERRED;
  982. goto out;
  983. }
  984. }
  985. /*
  986. * If we didn't get EDID, try checking if the panel is already turned
  987. * on. If so, assume that whatever is currently programmed is the
  988. * correct mode.
  989. */
  990. /* Ironlake: FIXME if still fail, not try pipe mode now */
  991. if (IS_IRONLAKE(dev))
  992. goto failed;
  993. lvds = I915_READ(LVDS);
  994. pipe = (lvds & LVDS_PIPEB_SELECT) ? 1 : 0;
  995. crtc = intel_get_crtc_from_pipe(dev, pipe);
  996. if (crtc && (lvds & LVDS_PORT_EN)) {
  997. dev_priv->panel_fixed_mode = intel_crtc_mode_get(dev, crtc);
  998. if (dev_priv->panel_fixed_mode) {
  999. dev_priv->panel_fixed_mode->type |=
  1000. DRM_MODE_TYPE_PREFERRED;
  1001. goto out;
  1002. }
  1003. }
  1004. /* If we still don't have a mode after all that, give up. */
  1005. if (!dev_priv->panel_fixed_mode)
  1006. goto failed;
  1007. out:
  1008. if (IS_IRONLAKE(dev)) {
  1009. u32 pwm;
  1010. /* make sure PWM is enabled */
  1011. pwm = I915_READ(BLC_PWM_CPU_CTL2);
  1012. pwm |= (PWM_ENABLE | PWM_PIPE_B);
  1013. I915_WRITE(BLC_PWM_CPU_CTL2, pwm);
  1014. pwm = I915_READ(BLC_PWM_PCH_CTL1);
  1015. pwm |= PWM_PCH_ENABLE;
  1016. I915_WRITE(BLC_PWM_PCH_CTL1, pwm);
  1017. }
  1018. dev_priv->lid_notifier.notifier_call = intel_lid_notify;
  1019. if (acpi_lid_notifier_register(&dev_priv->lid_notifier)) {
  1020. DRM_DEBUG_KMS("lid notifier registration failed\n");
  1021. dev_priv->lid_notifier.notifier_call = NULL;
  1022. }
  1023. /* keep the LVDS connector */
  1024. dev_priv->int_lvds_connector = connector;
  1025. drm_sysfs_connector_add(connector);
  1026. return;
  1027. failed:
  1028. DRM_DEBUG_KMS("No LVDS modes found, disabling.\n");
  1029. if (intel_output->ddc_bus)
  1030. intel_i2c_destroy(intel_output->ddc_bus);
  1031. drm_connector_cleanup(connector);
  1032. drm_encoder_cleanup(encoder);
  1033. kfree(intel_output);
  1034. }