drivers/gpu/drm/i915/intel_lvds.c

   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
  30 #include <acpi/button.h>
  31 #include <linux/dmi.h>
  32 #include <linux/i2c.h>
  33 #include <linux/slab.h>
  34 #include "drmP.h"
  35 #include "drm.h"
  36 #include "drm_crtc.h"
  37 #include "drm_edid.h"
  38 #include "intel_drv.h"
  39 #include "i915_drm.h"
  40 #include "i915_drv.h"
  41 #include <linux/acpi.h>
  42
  43 /* Private structure for the integrated LVDS support */
  44 struct intel_lvds {
  45         struct intel_encoder base;
  46
  47         bool edid_good;
  48
  49         int fitting_mode;
  50         u32 pfit_control;
  51         u32 pfit_pgm_ratios;
  52         bool pfit_dirty;
  53
  54         struct drm_display_mode *fixed_mode;
  55 };
  56
  57 static struct intel_lvds *to_intel_lvds(struct drm_encoder *encoder)
  58 {
  59         return container_of(encoder, struct intel_lvds, base.base);
  60 }
  61
  62 static struct intel_lvds *intel_attached_lvds(struct drm_connector *connector)
  63 {
  64         return container_of(intel_attached_encoder(connector),
  65                             struct intel_lvds, base);
  66 }
  67
  68 /**
  69  * Sets the power state for the panel.
  70  */
  71 static void intel_lvds_set_power(struct intel_lvds *intel_lvds, bool on)
  72 {
  73         struct drm_device *dev = intel_lvds->base.base.dev;
  74         struct drm_i915_private *dev_priv = dev->dev_private;
  75         u32 ctl_reg, lvds_reg;
  76
  77         if (HAS_PCH_SPLIT(dev)) {
  78                 ctl_reg = PCH_PP_CONTROL;
  79                 lvds_reg = PCH_LVDS;
  80         } else {
  81                 ctl_reg = PP_CONTROL;
  82                 lvds_reg = LVDS;
  83         }
  84
  85         if (on) {
  86                 I915_WRITE(lvds_reg, I915_READ(lvds_reg) | LVDS_PORT_EN);
  87                 I915_WRITE(ctl_reg, I915_READ(ctl_reg) | POWER_TARGET_ON);
  88                 intel_panel_set_backlight(dev, dev_priv->backlight_level);
  89         } else {
  90                 dev_priv->backlight_level = intel_panel_get_backlight(dev);
  91
  92                 intel_panel_set_backlight(dev, 0);
  93                 I915_WRITE(ctl_reg, I915_READ(ctl_reg) & ~POWER_TARGET_ON);
  94
  95                 if (intel_lvds->pfit_control) {
  96                         if (wait_for((I915_READ(PP_STATUS) & PP_ON) == 0, 1000))
  97                                 DRM_ERROR("timed out waiting for panel to power off\n");
  98                         I915_WRITE(PFIT_CONTROL, 0);
  99                         intel_lvds->pfit_control = 0;
 100                 }
 101
 102                 I915_WRITE(lvds_reg, I915_READ(lvds_reg) & ~LVDS_PORT_EN);
 103         }
 104         POSTING_READ(lvds_reg);
 105 }
 106
 107 static void intel_lvds_dpms(struct drm_encoder *encoder, int mode)
 108 {
 109         struct intel_lvds *intel_lvds = to_intel_lvds(encoder);
 110
 111         if (mode == DRM_MODE_DPMS_ON)
 112                 intel_lvds_set_power(intel_lvds, true);
 113         else
 114                 intel_lvds_set_power(intel_lvds, false);
 115
 116         /* XXX: We never power down the LVDS pairs. */
 117 }
 118
 119 static int intel_lvds_mode_valid(struct drm_connector *connector,
 120                                  struct drm_display_mode *mode)
 121 {
 122         struct intel_lvds *intel_lvds = intel_attached_lvds(connector);
 123         struct drm_display_mode *fixed_mode = intel_lvds->fixed_mode;
 124
 125         if (mode->hdisplay > fixed_mode->hdisplay)
 126                 return MODE_PANEL;
 127         if (mode->vdisplay > fixed_mode->vdisplay)
 128                 return MODE_PANEL;
 129
 130         return MODE_OK;
 131 }
 132
 133 static void
 134 centre_horizontally(struct drm_display_mode *mode,
 135                     int width)
 136 {
 137         u32 border, sync_pos, blank_width, sync_width;
 138
 139         /* keep the hsync and hblank widths constant */
 140         sync_width = mode->crtc_hsync_end - mode->crtc_hsync_start;
 141         blank_width = mode->crtc_hblank_end - mode->crtc_hblank_start;
 142         sync_pos = (blank_width - sync_width + 1) / 2;
 143
 144         border = (mode->hdisplay - width + 1) / 2;
 145         border += border & 1; /* make the border even */
 146
 147         mode->crtc_hdisplay = width;
 148         mode->crtc_hblank_start = width + border;
 149         mode->crtc_hblank_end = mode->crtc_hblank_start + blank_width;
 150
 151         mode->crtc_hsync_start = mode->crtc_hblank_start + sync_pos;
 152         mode->crtc_hsync_end = mode->crtc_hsync_start + sync_width;
 153 }
 154
 155 static void
 156 centre_vertically(struct drm_display_mode *mode,
 157                   int height)
 158 {
 159         u32 border, sync_pos, blank_width, sync_width;
 160
 161         /* keep the vsync and vblank widths constant */
 162         sync_width = mode->crtc_vsync_end - mode->crtc_vsync_start;
 163         blank_width = mode->crtc_vblank_end - mode->crtc_vblank_start;
 164         sync_pos = (blank_width - sync_width + 1) / 2;
 165
 166         border = (mode->vdisplay - height + 1) / 2;
 167
 168         mode->crtc_vdisplay = height;
 169         mode->crtc_vblank_start = height + border;
 170         mode->crtc_vblank_end = mode->crtc_vblank_start + blank_width;
 171
 172         mode->crtc_vsync_start = mode->crtc_vblank_start + sync_pos;
 173         mode->crtc_vsync_end = mode->crtc_vsync_start + sync_width;
 174 }
 175
 176 static inline u32 panel_fitter_scaling(u32 source, u32 target)
 177 {
 178         /*
 179          * Floating point operation is not supported. So the FACTOR
 180          * is defined, which can avoid the floating point computation
 181          * when calculating the panel ratio.
 182          */
 183 #define ACCURACY 12
 184 #define FACTOR (1 << ACCURACY)
 185         u32 ratio = source * FACTOR / target;
 186         return (FACTOR * ratio + FACTOR/2) / FACTOR;
 187 }
 188
 189 static bool intel_lvds_mode_fixup(struct drm_encoder *encoder,
 190                                   struct drm_display_mode *mode,
 191                                   struct drm_display_mode *adjusted_mode)
 192 {
 193         struct drm_device *dev = encoder->dev;
 194         struct drm_i915_private *dev_priv = dev->dev_private;
 195         struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
 196         struct intel_lvds *intel_lvds = to_intel_lvds(encoder);
 197         struct drm_encoder *tmp_encoder;
 198         u32 pfit_control = 0, pfit_pgm_ratios = 0, border = 0;
 199
 200         /* Should never happen!! */
 201         if (!IS_I965G(dev) && intel_crtc->pipe == 0) {
 202                 DRM_ERROR("Can't support LVDS on pipe A\n");
 203                 return false;
 204         }
 205
 206         /* Should never happen!! */
 207         list_for_each_entry(tmp_encoder, &dev->mode_config.encoder_list, head) {
 208                 if (tmp_encoder != encoder && tmp_encoder->crtc == encoder->crtc) {
 209                         DRM_ERROR("Can't enable LVDS and another "
 210                                "encoder on the same pipe\n");
 211                         return false;
 212                 }
 213         }
 214
 215         /*
 216          * We have timings from the BIOS for the panel, put them in
 217          * to the adjusted mode.  The CRTC will be set up for this mode,
 218          * with the panel scaling set up to source from the H/VDisplay
 219          * of the original mode.
 220          */
 221         intel_fixed_panel_mode(intel_lvds->fixed_mode, adjusted_mode);
 222
 223         if (HAS_PCH_SPLIT(dev)) {
 224                 intel_pch_panel_fitting(dev, intel_lvds->fitting_mode,
 225                                         mode, adjusted_mode);
 226                 return true;
 227         }
 228
 229         /* Make sure pre-965s set dither correctly */
 230         if (!IS_I965G(dev)) {
 231                 if (dev_priv->panel_wants_dither || dev_priv->lvds_dither)
 232                         pfit_control |= PANEL_8TO6_DITHER_ENABLE;
 233         }
 234
 235         /* Native modes don't need fitting */
 236         if (adjusted_mode->hdisplay == mode->hdisplay &&
 237             adjusted_mode->vdisplay == mode->vdisplay)
 238                 goto out;
 239
 240         /* 965+ wants fuzzy fitting */
 241         if (IS_I965G(dev))
 242                 pfit_control |= ((intel_crtc->pipe << PFIT_PIPE_SHIFT) |
 243                                  PFIT_FILTER_FUZZY);
 244
 245         /*
 246          * Enable automatic panel scaling for non-native modes so that they fill
 247          * the screen.  Should be enabled before the pipe is enabled, according
 248          * to register description and PRM.
 249          * Change the value here to see the borders for debugging
 250          */
 251         I915_WRITE(BCLRPAT_A, 0);
 252         I915_WRITE(BCLRPAT_B, 0);
 253
 254         switch (intel_lvds->fitting_mode) {
 255         case DRM_MODE_SCALE_CENTER:
 256                 /*
 257                  * For centered modes, we have to calculate border widths &
 258                  * heights and modify the values programmed into the CRTC.
 259                  */
 260                 centre_horizontally(adjusted_mode, mode->hdisplay);
 261                 centre_vertically(adjusted_mode, mode->vdisplay);
 262                 border = LVDS_BORDER_ENABLE;
 263                 break;
 264
 265         case DRM_MODE_SCALE_ASPECT:
 266                 /* Scale but preserve the aspect ratio */
 267                 if (IS_I965G(dev)) {
 268                         u32 scaled_width = adjusted_mode->hdisplay * mode->vdisplay;
 269                         u32 scaled_height = mode->hdisplay * adjusted_mode->vdisplay;
 270
 271                         pfit_control |= PFIT_ENABLE;
 272                         /* 965+ is easy, it does everything in hw */
 273                         if (scaled_width > scaled_height)
 274                                 pfit_control |= PFIT_SCALING_PILLAR;
 275                         else if (scaled_width < scaled_height)
 276                                 pfit_control |= PFIT_SCALING_LETTER;
 277                         else
 278                                 pfit_control |= PFIT_SCALING_AUTO;
 279                 } else {
 280                         u32 scaled_width = adjusted_mode->hdisplay * mode->vdisplay;
 281                         u32 scaled_height = mode->hdisplay * adjusted_mode->vdisplay;
 282                         /*
 283                          * For earlier chips we have to calculate the scaling
 284                          * ratio by hand and program it into the
 285                          * PFIT_PGM_RATIO register
 286                          */
 287                         if (scaled_width > scaled_height) { /* pillar */
 288                                 centre_horizontally(adjusted_mode, scaled_height / mode->vdisplay);
 289
 290                                 border = LVDS_BORDER_ENABLE;
 291                                 if (mode->vdisplay != adjusted_mode->vdisplay) {
 292                                         u32 bits = panel_fitter_scaling(mode->vdisplay, adjusted_mode->vdisplay);
 293                                         pfit_pgm_ratios |= (bits << PFIT_HORIZ_SCALE_SHIFT |
 294                                                             bits << PFIT_VERT_SCALE_SHIFT);
 295                                         pfit_control |= (PFIT_ENABLE |
 296                                                          VERT_INTERP_BILINEAR |
 297                                                          HORIZ_INTERP_BILINEAR);
 298                                 }
 299                         } else if (scaled_width < scaled_height) { /* letter */
 300                                 centre_vertically(adjusted_mode, scaled_width / mode->hdisplay);
 301
 302                                 border = LVDS_BORDER_ENABLE;
 303                                 if (mode->hdisplay != adjusted_mode->hdisplay) {
 304                                         u32 bits = panel_fitter_scaling(mode->hdisplay, adjusted_mode->hdisplay);
 305                                         pfit_pgm_ratios |= (bits << PFIT_HORIZ_SCALE_SHIFT |
 306                                                             bits << PFIT_VERT_SCALE_SHIFT);
 307                                         pfit_control |= (PFIT_ENABLE |
 308                                                          VERT_INTERP_BILINEAR |
 309                                                          HORIZ_INTERP_BILINEAR);
 310                                 }
 311                         } else
 312                                 /* Aspects match, Let hw scale both directions */
 313                                 pfit_control |= (PFIT_ENABLE |
 314                                                  VERT_AUTO_SCALE | HORIZ_AUTO_SCALE |
 315                                                  VERT_INTERP_BILINEAR |
 316                                                  HORIZ_INTERP_BILINEAR);
 317                 }
 318                 break;
 319
 320         case DRM_MODE_SCALE_FULLSCREEN:
 321                 /*
 322                  * Full scaling, even if it changes the aspect ratio.
 323                  * Fortunately this is all done for us in hw.
 324                  */
 325                 pfit_control |= PFIT_ENABLE;
 326                 if (IS_I965G(dev))
 327                         pfit_control |= PFIT_SCALING_AUTO;
 328                 else
 329                         pfit_control |= (VERT_AUTO_SCALE | HORIZ_AUTO_SCALE |
 330                                          VERT_INTERP_BILINEAR |
 331                                          HORIZ_INTERP_BILINEAR);
 332                 break;
 333
 334         default:
 335                 break;
 336         }
 337
 338 out:
 339         if (pfit_control != intel_lvds->pfit_control ||
 340             pfit_pgm_ratios != intel_lvds->pfit_pgm_ratios) {
 341                 intel_lvds->pfit_control = pfit_control;
 342                 intel_lvds->pfit_pgm_ratios = pfit_pgm_ratios;
 343                 intel_lvds->pfit_dirty = true;
 344         }
 345         dev_priv->lvds_border_bits = border;
 346
 347         /*
 348          * XXX: It would be nice to support lower refresh rates on the
 349          * panels to reduce power consumption, and perhaps match the
 350          * user's requested refresh rate.
 351          */
 352
 353         return true;
 354 }
 355
 356 static void intel_lvds_prepare(struct drm_encoder *encoder)
 357 {
 358         struct drm_device *dev = encoder->dev;
 359         struct drm_i915_private *dev_priv = dev->dev_private;
 360         struct intel_lvds *intel_lvds = to_intel_lvds(encoder);
 361
 362         dev_priv->backlight_level = intel_panel_get_backlight(dev);
 363
 364         /* We try to do the minimum that is necessary in order to unlock
 365          * the registers for mode setting.
 366          *
 367          * On Ironlake, this is quite simple as we just set the unlock key
 368          * and ignore all subtleties. (This may cause some issues...)
 369          *
 370          * Prior to Ironlake, we must disable the pipe if we want to adjust
 371          * the panel fitter. However at all other times we can just reset
 372          * the registers regardless.
 373          */
 374
 375         if (HAS_PCH_SPLIT(dev)) {
 376                 I915_WRITE(PCH_PP_CONTROL,
 377                            I915_READ(PCH_PP_CONTROL) | PANEL_UNLOCK_REGS);
 378         } else if (intel_lvds->pfit_dirty) {
 379                 I915_WRITE(PP_CONTROL,
 380                            I915_READ(PP_CONTROL) & ~POWER_TARGET_ON);
 381                 I915_WRITE(LVDS, I915_READ(LVDS) & ~LVDS_PORT_EN);
 382         } else {
 383                 I915_WRITE(PP_CONTROL,
 384                            I915_READ(PP_CONTROL) | PANEL_UNLOCK_REGS);
 385         }
 386 }
 387
 388 static void intel_lvds_commit(struct drm_encoder *encoder)
 389 {
 390         struct drm_device *dev = encoder->dev;
 391         struct drm_i915_private *dev_priv = dev->dev_private;
 392         struct intel_lvds *intel_lvds = to_intel_lvds(encoder);
 393
 394         if (dev_priv->backlight_level == 0)
 395                 dev_priv->backlight_level = intel_panel_get_max_backlight(dev);
 396
 397         /* Undo any unlocking done in prepare to prevent accidental
 398          * adjustment of the registers.
 399          */
 400         if (HAS_PCH_SPLIT(dev)) {
 401                 u32 val = I915_READ(PCH_PP_CONTROL);
 402                 if ((val & PANEL_UNLOCK_REGS) == PANEL_UNLOCK_REGS)
 403                         I915_WRITE(PCH_PP_CONTROL, val & 0x3);
 404         } else {
 405                 u32 val = I915_READ(PP_CONTROL);
 406                 if ((val & PANEL_UNLOCK_REGS) == PANEL_UNLOCK_REGS)
 407                         I915_WRITE(PP_CONTROL, val & 0x3);
 408         }
 409
 410         /* Always do a full power on as we do not know what state
 411          * we were left in.
 412          */
 413         intel_lvds_set_power(intel_lvds, true);
 414 }
 415
 416 static void intel_lvds_mode_set(struct drm_encoder *encoder,
 417                                 struct drm_display_mode *mode,
 418                                 struct drm_display_mode *adjusted_mode)
 419 {
 420         struct drm_device *dev = encoder->dev;
 421         struct drm_i915_private *dev_priv = dev->dev_private;
 422         struct intel_lvds *intel_lvds = to_intel_lvds(encoder);
 423
 424         /*
 425          * The LVDS pin pair will already have been turned on in the
 426          * intel_crtc_mode_set since it has a large impact on the DPLL
 427          * settings.
 428          */
 429
 430         if (HAS_PCH_SPLIT(dev))
 431                 return;
 432
 433         if (!intel_lvds->pfit_dirty)
 434                 return;
 435
 436         /*
 437          * Enable automatic panel scaling so that non-native modes fill the
 438          * screen.  Should be enabled before the pipe is enabled, according to
 439          * register description and PRM.
 440          */
 441         if (wait_for((I915_READ(PP_STATUS) & PP_ON) == 0, 1000))
 442                 DRM_ERROR("timed out waiting for panel to power off\n");
 443
 444         I915_WRITE(PFIT_PGM_RATIOS, intel_lvds->pfit_pgm_ratios);
 445         I915_WRITE(PFIT_CONTROL, intel_lvds->pfit_control);
 446         intel_lvds->pfit_dirty = false;
 447 }
 448
 449 /**
 450  * Detect the LVDS connection.
 451  *
 452  * Since LVDS doesn't have hotlug, we use the lid as a proxy.  Open means
 453  * connected and closed means disconnected.  We also send hotplug events as
 454  * needed, using lid status notification from the input layer.
 455  */
 456 static enum drm_connector_status intel_lvds_detect(struct drm_connector *connector)
 457 {
 458         struct drm_device *dev = connector->dev;
 459         enum drm_connector_status status = connector_status_connected;
 460
 461         /* ACPI lid methods were generally unreliable in this generation, so
 462          * don't even bother.
 463          */
 464         if (IS_GEN2(dev) || IS_GEN3(dev))
 465                 return connector_status_connected;
 466
 467         return status;
 468 }
 469
 470 /**
 471  * Return the list of DDC modes if available, or the BIOS fixed mode otherwise.
 472  */
 473 static int intel_lvds_get_modes(struct drm_connector *connector)
 474 {
 475         struct intel_lvds *intel_lvds = intel_attached_lvds(connector);
 476         struct drm_device *dev = connector->dev;
 477         struct drm_display_mode *mode;
 478
 479         if (intel_lvds->edid_good) {
 480                 int ret = intel_ddc_get_modes(connector,
 481                                               intel_lvds->base.ddc_bus);
 482                 if (ret)
 483                         return ret;
 484         }
 485
 486         mode = drm_mode_duplicate(dev, intel_lvds->fixed_mode);
 487         if (mode == 0)
 488                 return 0;
 489
 490         drm_mode_probed_add(connector, mode);
 491         return 1;
 492 }
 493
 494 static int intel_no_modeset_on_lid_dmi_callback(const struct dmi_system_id *id)
 495 {
 496         DRM_DEBUG_KMS("Skipping forced modeset for %s\n", id->ident);
 497         return 1;
 498 }
 499
 500 /* The GPU hangs up on these systems if modeset is performed on LID open */
 501 static const struct dmi_system_id intel_no_modeset_on_lid[] = {
 502         {
 503                 .callback = intel_no_modeset_on_lid_dmi_callback,
 504                 .ident = "Toshiba Tecra A11",
 505                 .matches = {
 506                         DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
 507                         DMI_MATCH(DMI_PRODUCT_NAME, "TECRA A11"),
 508                 },
 509         },
 510
 511         { }     /* terminating entry */
 512 };
 513
 514 /*
 515  * Lid events. Note the use of 'modeset_on_lid':
 516  *  - we set it on lid close, and reset it on open
 517  *  - we use it as a "only once" bit (ie we ignore
 518  *    duplicate events where it was already properly
 519  *    set/reset)
 520  *  - the suspend/resume paths will also set it to
 521  *    zero, since they restore the mode ("lid open").
 522  */
 523 static int intel_lid_notify(struct notifier_block *nb, unsigned long val,
 524                             void *unused)
 525 {
 526         struct drm_i915_private *dev_priv =
 527                 container_of(nb, struct drm_i915_private, lid_notifier);
 528         struct drm_device *dev = dev_priv->dev;
 529         struct drm_connector *connector = dev_priv->int_lvds_connector;
 530
 531         /*
 532          * check and update the status of LVDS connector after receiving
 533          * the LID nofication event.
 534          */
 535         if (connector)
 536                 connector->status = connector->funcs->detect(connector);
 537         /* Don't force modeset on machines where it causes a GPU lockup */
 538         if (dmi_check_system(intel_no_modeset_on_lid))
 539                 return NOTIFY_OK;
 540         if (!acpi_lid_open()) {
 541                 dev_priv->modeset_on_lid = 1;
 542                 return NOTIFY_OK;
 543         }
 544
 545         if (!dev_priv->modeset_on_lid)
 546                 return NOTIFY_OK;
 547
 548         dev_priv->modeset_on_lid = 0;
 549
 550         mutex_lock(&dev->mode_config.mutex);
 551         drm_helper_resume_force_mode(dev);
 552         mutex_unlock(&dev->mode_config.mutex);
 553
 554         return NOTIFY_OK;
 555 }
 556
 557 /**
 558  * intel_lvds_destroy - unregister and free LVDS structures
 559  * @connector: connector to free
 560  *
 561  * Unregister the DDC bus for this connector then free the driver private
 562  * structure.
 563  */
 564 static void intel_lvds_destroy(struct drm_connector *connector)
 565 {
 566         struct drm_device *dev = connector->dev;
 567         struct drm_i915_private *dev_priv = dev->dev_private;
 568
 569         if (dev_priv->lid_notifier.notifier_call)
 570                 acpi_lid_notifier_unregister(&dev_priv->lid_notifier);
 571         drm_sysfs_connector_remove(connector);
 572         drm_connector_cleanup(connector);
 573         kfree(connector);
 574 }
 575
 576 static int intel_lvds_set_property(struct drm_connector *connector,
 577                                    struct drm_property *property,
 578                                    uint64_t value)
 579 {
 580         struct intel_lvds *intel_lvds = intel_attached_lvds(connector);
 581         struct drm_device *dev = connector->dev;
 582
 583         if (property == dev->mode_config.scaling_mode_property) {
 584                 struct drm_crtc *crtc = intel_lvds->base.base.crtc;
 585
 586                 if (value == DRM_MODE_SCALE_NONE) {
 587                         DRM_DEBUG_KMS("no scaling not supported\n");
 588                         return -EINVAL;
 589                 }
 590
 591                 if (intel_lvds->fitting_mode == value) {
 592                         /* the LVDS scaling property is not changed */
 593                         return 0;
 594                 }
 595                 intel_lvds->fitting_mode = value;
 596                 if (crtc && crtc->enabled) {
 597                         /*
 598                          * If the CRTC is enabled, the display will be changed
 599                          * according to the new panel fitting mode.
 600                          */
 601                         drm_crtc_helper_set_mode(crtc, &crtc->mode,
 602                                 crtc->x, crtc->y, crtc->fb);
 603                 }
 604         }
 605
 606         return 0;
 607 }
 608
 609 static const struct drm_encoder_helper_funcs intel_lvds_helper_funcs = {
 610         .dpms = intel_lvds_dpms,
 611         .mode_fixup = intel_lvds_mode_fixup,
 612         .prepare = intel_lvds_prepare,
 613         .mode_set = intel_lvds_mode_set,
 614         .commit = intel_lvds_commit,
 615 };
 616
 617 static const struct drm_connector_helper_funcs intel_lvds_connector_helper_funcs = {
 618         .get_modes = intel_lvds_get_modes,
 619         .mode_valid = intel_lvds_mode_valid,
 620         .best_encoder = intel_best_encoder,
 621 };
 622
 623 static const struct drm_connector_funcs intel_lvds_connector_funcs = {
 624         .dpms = drm_helper_connector_dpms,
 625         .detect = intel_lvds_detect,
 626         .fill_modes = drm_helper_probe_single_connector_modes,
 627         .set_property = intel_lvds_set_property,
 628         .destroy = intel_lvds_destroy,
 629 };
 630
 631 static const struct drm_encoder_funcs intel_lvds_enc_funcs = {
 632         .destroy = intel_encoder_destroy,
 633 };
 634
 635 static int __init intel_no_lvds_dmi_callback(const struct dmi_system_id *id)
 636 {
 637         DRM_DEBUG_KMS("Skipping LVDS initialization for %s\n", id->ident);
 638         return 1;
 639 }
 640
 641 /* These systems claim to have LVDS, but really don't */
 642 static const struct dmi_system_id intel_no_lvds[] = {
 643         {
 644                 .callback = intel_no_lvds_dmi_callback,
 645                 .ident = "Apple Mac Mini (Core series)",
 646                 .matches = {
 647                         DMI_MATCH(DMI_SYS_VENDOR, "Apple"),
 648                         DMI_MATCH(DMI_PRODUCT_NAME, "Macmini1,1"),
 649                 },
 650         },
 651         {
 652                 .callback = intel_no_lvds_dmi_callback,
 653                 .ident = "Apple Mac Mini (Core 2 series)",
 654                 .matches = {
 655                         DMI_MATCH(DMI_SYS_VENDOR, "Apple"),
 656                         DMI_MATCH(DMI_PRODUCT_NAME, "Macmini2,1"),
 657                 },
 658         },
 659         {
 660                 .callback = intel_no_lvds_dmi_callback,
 661                 .ident = "MSI IM-945GSE-A",
 662                 .matches = {
 663                         DMI_MATCH(DMI_SYS_VENDOR, "MSI"),
 664                         DMI_MATCH(DMI_PRODUCT_NAME, "A9830IMS"),
 665                 },
 666         },
 667         {
 668                 .callback = intel_no_lvds_dmi_callback,
 669                 .ident = "Dell Studio Hybrid",
 670                 .matches = {
 671                         DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
 672                         DMI_MATCH(DMI_PRODUCT_NAME, "Studio Hybrid 140g"),
 673                 },
 674         },
 675         {
 676                 .callback = intel_no_lvds_dmi_callback,
 677                 .ident = "AOpen Mini PC",
 678                 .matches = {
 679                         DMI_MATCH(DMI_SYS_VENDOR, "AOpen"),
 680                         DMI_MATCH(DMI_PRODUCT_NAME, "i965GMx-IF"),
 681                 },
 682         },
 683         {
 684                 .callback = intel_no_lvds_dmi_callback,
 685                 .ident = "AOpen Mini PC MP915",
 686                 .matches = {
 687                         DMI_MATCH(DMI_BOARD_VENDOR, "AOpen"),
 688                         DMI_MATCH(DMI_BOARD_NAME, "i915GMx-F"),
 689                 },
 690         },
 691         {
 692                 .callback = intel_no_lvds_dmi_callback,
 693                 .ident = "Aopen i945GTt-VFA",
 694                 .matches = {
 695                         DMI_MATCH(DMI_PRODUCT_VERSION, "AO00001JW"),
 696                 },
 697         },
 698         {
 699                 .callback = intel_no_lvds_dmi_callback,
 700                 .ident = "Clientron U800",
 701                 .matches = {
 702                         DMI_MATCH(DMI_SYS_VENDOR, "Clientron"),
 703                         DMI_MATCH(DMI_PRODUCT_NAME, "U800"),
 704                 },
 705         },
 706
 707         { }     /* terminating entry */
 708 };
 709
 710 /**
 711  * intel_find_lvds_downclock - find the reduced downclock for LVDS in EDID
 712  * @dev: drm device
 713  * @connector: LVDS connector
 714  *
 715  * Find the reduced downclock for LVDS in EDID.
 716  */
 717 static void intel_find_lvds_downclock(struct drm_device *dev,
 718                                       struct drm_display_mode *fixed_mode,
 719                                       struct drm_connector *connector)
 720 {
 721         struct drm_i915_private *dev_priv = dev->dev_private;
 722         struct drm_display_mode *scan;
 723         int temp_downclock;
 724
 725         temp_downclock = fixed_mode->clock;
 726         list_for_each_entry(scan, &connector->probed_modes, head) {
 727                 /*
 728                  * If one mode has the same resolution with the fixed_panel
 729                  * mode while they have the different refresh rate, it means
 730                  * that the reduced downclock is found for the LVDS. In such
 731                  * case we can set the different FPx0/1 to dynamically select
 732                  * between low and high frequency.
 733                  */
 734                 if (scan->hdisplay == fixed_mode->hdisplay &&
 735                     scan->hsync_start == fixed_mode->hsync_start &&
 736                     scan->hsync_end == fixed_mode->hsync_end &&
 737                     scan->htotal == fixed_mode->htotal &&
 738                     scan->vdisplay == fixed_mode->vdisplay &&
 739                     scan->vsync_start == fixed_mode->vsync_start &&
 740                     scan->vsync_end == fixed_mode->vsync_end &&
 741                     scan->vtotal == fixed_mode->vtotal) {
 742                         if (scan->clock < temp_downclock) {
 743                                 /*
 744                                  * The downclock is already found. But we
 745                                  * expect to find the lower downclock.
 746                                  */
 747                                 temp_downclock = scan->clock;
 748                         }
 749                 }
 750         }
 751         if (temp_downclock < fixed_mode->clock && i915_lvds_downclock) {
 752                 /* We found the downclock for LVDS. */
 753                 dev_priv->lvds_downclock_avail = 1;
 754                 dev_priv->lvds_downclock = temp_downclock;
 755                 DRM_DEBUG_KMS("LVDS downclock is found in EDID. "
 756                               "Normal clock %dKhz, downclock %dKhz\n",
 757                               fixed_mode->clock, temp_downclock);
 758         }
 759 }
 760
 761 /*
 762  * Enumerate the child dev array parsed from VBT to check whether
 763  * the LVDS is present.
 764  * If it is present, return 1.
 765  * If it is not present, return false.
 766  * If no child dev is parsed from VBT, it assumes that the LVDS is present.
 767  */
 768 static bool lvds_is_present_in_vbt(struct drm_device *dev)
 769 {
 770         struct drm_i915_private *dev_priv = dev->dev_private;
 771         int i;
 772
 773         if (!dev_priv->child_dev_num)
 774                 return true;
 775
 776         for (i = 0; i < dev_priv->child_dev_num; i++) {
 777                 struct child_device_config *child = dev_priv->child_dev + i;
 778
 779                 /* If the device type is not LFP, continue.
 780                  * We have to check both the new identifiers as well as the
 781                  * old for compatibility with some BIOSes.
 782                  */
 783                 if (child->device_type != DEVICE_TYPE_INT_LFP &&
 784                     child->device_type != DEVICE_TYPE_LFP)
 785                         continue;
 786
 787                 /* However, we cannot trust the BIOS writers to populate
 788                  * the VBT correctly.  Since LVDS requires additional
 789                  * information from AIM blocks, a non-zero addin offset is
 790                  * a good indicator that the LVDS is actually present.
 791                  */
 792                 if (child->addin_offset)
 793                         return true;
 794
 795                 /* But even then some BIOS writers perform some black magic
 796                  * and instantiate the device without reference to any
 797                  * additional data.  Trust that if the VBT was written into
 798                  * the OpRegion then they have validated the LVDS's existence.
 799                  */
 800                 if (dev_priv->opregion.vbt)
 801                         return true;
 802         }
 803
 804         return false;
 805 }
 806
 807 /**
 808  * intel_lvds_init - setup LVDS connectors on this device
 809  * @dev: drm device
 810  *
 811  * Create the connector, register the LVDS DDC bus, and try to figure out what
 812  * modes we can display on the LVDS panel (if present).
 813  */
 814 void intel_lvds_init(struct drm_device *dev)
 815 {
 816         struct drm_i915_private *dev_priv = dev->dev_private;
 817         struct intel_lvds *intel_lvds;
 818         struct intel_encoder *intel_encoder;
 819         struct intel_connector *intel_connector;
 820         struct drm_connector *connector;
 821         struct drm_encoder *encoder;
 822         struct drm_display_mode *scan; /* *modes, *bios_mode; */
 823         struct drm_crtc *crtc;
 824         u32 lvds;
 825         int pipe, gpio = GPIOC;
 826
 827         /* Skip init on machines we know falsely report LVDS */
 828         if (dmi_check_system(intel_no_lvds))
 829                 return;
 830
 831         if (!lvds_is_present_in_vbt(dev)) {
 832                 DRM_DEBUG_KMS("LVDS is not present in VBT\n");
 833                 return;
 834         }
 835
 836         if (HAS_PCH_SPLIT(dev)) {
 837                 if ((I915_READ(PCH_LVDS) & LVDS_DETECTED) == 0)
 838                         return;
 839                 if (dev_priv->edp_support) {
 840                         DRM_DEBUG_KMS("disable LVDS for eDP support\n");
 841                         return;
 842                 }
 843                 gpio = PCH_GPIOC;
 844         }
 845
 846         intel_lvds = kzalloc(sizeof(struct intel_lvds), GFP_KERNEL);
 847         if (!intel_lvds) {
 848                 return;
 849         }
 850
 851         intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
 852         if (!intel_connector) {
 853                 kfree(intel_lvds);
 854                 return;
 855         }
 856
 857         if (!HAS_PCH_SPLIT(dev)) {
 858                 intel_lvds->pfit_control = I915_READ(PFIT_CONTROL);
 859         }
 860
 861         intel_encoder = &intel_lvds->base;
 862         encoder = &intel_encoder->base;
 863         connector = &intel_connector->base;
 864         drm_connector_init(dev, &intel_connector->base, &intel_lvds_connector_funcs,
 865                            DRM_MODE_CONNECTOR_LVDS);
 866
 867         drm_encoder_init(dev, &intel_encoder->base, &intel_lvds_enc_funcs,
 868                          DRM_MODE_ENCODER_LVDS);
 869
 870         intel_connector_attach_encoder(intel_connector, intel_encoder);
 871         intel_encoder->type = INTEL_OUTPUT_LVDS;
 872
 873         intel_encoder->clone_mask = (1 << INTEL_LVDS_CLONE_BIT);
 874         intel_encoder->crtc_mask = (1 << 1);
 875         drm_encoder_helper_add(encoder, &intel_lvds_helper_funcs);
 876         drm_connector_helper_add(connector, &intel_lvds_connector_helper_funcs);
 877         connector->display_info.subpixel_order = SubPixelHorizontalRGB;
 878         connector->interlace_allowed = false;
 879         connector->doublescan_allowed = false;
 880
 881         /* create the scaling mode property */
 882         drm_mode_create_scaling_mode_property(dev);
 883         /*
 884          * the initial panel fitting mode will be FULL_SCREEN.
 885          */
 886
 887         drm_connector_attach_property(&intel_connector->base,
 888                                       dev->mode_config.scaling_mode_property,
 889                                       DRM_MODE_SCALE_ASPECT);
 890         intel_lvds->fitting_mode = DRM_MODE_SCALE_ASPECT;
 891         /*
 892          * LVDS discovery:
 893          * 1) check for EDID on DDC
 894          * 2) check for VBT data
 895          * 3) check to see if LVDS is already on
 896          *    if none of the above, no panel
 897          * 4) make sure lid is open
 898          *    if closed, act like it's not there for now
 899          */
 900
 901         /* Set up the DDC bus. */
 902         intel_encoder->ddc_bus = intel_i2c_create(dev, gpio, "LVDSDDC_C");
 903         if (!intel_encoder->ddc_bus) {
 904                 dev_printk(KERN_ERR, &dev->pdev->dev, "DDC bus registration "
 905                            "failed.\n");
 906                 goto failed;
 907         }
 908
 909         /*
 910          * Attempt to get the fixed panel mode from DDC.  Assume that the
 911          * preferred mode is the right one.
 912          */
 913         intel_lvds->edid_good = true;
 914         if (!intel_ddc_get_modes(connector, intel_encoder->ddc_bus))
 915                 intel_lvds->edid_good = false;
 916
 917         if (!intel_lvds->edid_good) {
 918                 /* Didn't get an EDID, so
 919                  * Set wide sync ranges so we get all modes
 920                  * handed to valid_mode for checking
 921                  */
 922                 connector->display_info.min_vfreq = 0;
 923                 connector->display_info.max_vfreq = 200;
 924                 connector->display_info.min_hfreq = 0;
 925                 connector->display_info.max_hfreq = 200;
 926         }
 927
 928         list_for_each_entry(scan, &connector->probed_modes, head) {
 929                 if (scan->type & DRM_MODE_TYPE_PREFERRED) {
 930                         intel_lvds->fixed_mode =
 931                                 drm_mode_duplicate(dev, scan);
 932                         intel_find_lvds_downclock(dev,
 933                                                   intel_lvds->fixed_mode,
 934                                                   connector);
 935                         goto out;
 936                 }
 937         }
 938
 939         /* Failed to get EDID, what about VBT? */
 940         if (dev_priv->lfp_lvds_vbt_mode) {
 941                 intel_lvds->fixed_mode =
 942                         drm_mode_duplicate(dev, dev_priv->lfp_lvds_vbt_mode);
 943                 if (intel_lvds->fixed_mode) {
 944                         intel_lvds->fixed_mode->type |=
 945                                 DRM_MODE_TYPE_PREFERRED;
 946                         goto out;
 947                 }
 948         }
 949
 950         /*
 951          * If we didn't get EDID, try checking if the panel is already turned
 952          * on.  If so, assume that whatever is currently programmed is the
 953          * correct mode.
 954          */
 955
 956         /* Ironlake: FIXME if still fail, not try pipe mode now */
 957         if (HAS_PCH_SPLIT(dev))
 958                 goto failed;
 959
 960         lvds = I915_READ(LVDS);
 961         pipe = (lvds & LVDS_PIPEB_SELECT) ? 1 : 0;
 962         crtc = intel_get_crtc_for_pipe(dev, pipe);
 963
 964         if (crtc && (lvds & LVDS_PORT_EN)) {
 965                 intel_lvds->fixed_mode = intel_crtc_mode_get(dev, crtc);
 966                 if (intel_lvds->fixed_mode) {
 967                         intel_lvds->fixed_mode->type |=
 968                                 DRM_MODE_TYPE_PREFERRED;
 969                         goto out;
 970                 }
 971         }
 972
 973         /* If we still don't have a mode after all that, give up. */
 974         if (!intel_lvds->fixed_mode)
 975                 goto failed;
 976
 977 out:
 978         if (HAS_PCH_SPLIT(dev)) {
 979                 u32 pwm;
 980                 /* make sure PWM is enabled */
 981                 pwm = I915_READ(BLC_PWM_CPU_CTL2);
 982                 pwm |= (PWM_ENABLE | PWM_PIPE_B);
 983                 I915_WRITE(BLC_PWM_CPU_CTL2, pwm);
 984
 985                 pwm = I915_READ(BLC_PWM_PCH_CTL1);
 986                 pwm |= PWM_PCH_ENABLE;
 987                 I915_WRITE(BLC_PWM_PCH_CTL1, pwm);
 988         }
 989         dev_priv->lid_notifier.notifier_call = intel_lid_notify;
 990         if (acpi_lid_notifier_register(&dev_priv->lid_notifier)) {
 991                 DRM_DEBUG_KMS("lid notifier registration failed\n");
 992                 dev_priv->lid_notifier.notifier_call = NULL;
 993         }
 994         /* keep the LVDS connector */
 995         dev_priv->int_lvds_connector = connector;
 996         drm_sysfs_connector_add(connector);
 997         return;
 998
 999 failed:
1000         DRM_DEBUG_KMS("No LVDS modes found, disabling.\n");
1001         if (intel_encoder->ddc_bus)
1002                 intel_i2c_destroy(intel_encoder->ddc_bus);
1003         drm_connector_cleanup(connector);
1004         drm_encoder_cleanup(encoder);
1005         kfree(intel_lvds);
1006         kfree(intel_connector);
1007 }