kernel/2.6.29.6-aldebaran-rt/drivers/gpu/drm/i915/intel_crt.c

   1 /*
   2  * Copyright © 2006-2007 Intel Corporation
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice (including the next
  12  * paragraph) shall be included in all copies or substantial portions of the
  13  * Software.
  14  *
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  18  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  20  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  21  * DEALINGS IN THE SOFTWARE.
  22  *
  23  * Authors:
  24  *      Eric Anholt <eric@anholt.net>
  25  */
  26
  27 #include <linux/i2c.h>
  28 #include "drmP.h"
  29 #include "drm.h"
  30 #include "drm_crtc.h"
  31 #include "drm_crtc_helper.h"
  32 #include "intel_drv.h"
  33 #include "i915_drm.h"
  34 #include "i915_drv.h"
  35
  36 static void intel_crt_dpms(struct drm_encoder *encoder, int mode)
  37 {
  38         struct drm_device *dev = encoder->dev;
  39         struct drm_i915_private *dev_priv = dev->dev_private;
  40         u32 temp;
  41
  42         temp = I915_READ(ADPA);
  43         temp &= ~(ADPA_HSYNC_CNTL_DISABLE | ADPA_VSYNC_CNTL_DISABLE);
  44         temp &= ~ADPA_DAC_ENABLE;
  45
  46         switch(mode) {
  47         case DRM_MODE_DPMS_ON:
  48                 temp |= ADPA_DAC_ENABLE;
  49                 break;
  50         case DRM_MODE_DPMS_STANDBY:
  51                 temp |= ADPA_DAC_ENABLE | ADPA_HSYNC_CNTL_DISABLE;
  52                 break;
  53         case DRM_MODE_DPMS_SUSPEND:
  54                 temp |= ADPA_DAC_ENABLE | ADPA_VSYNC_CNTL_DISABLE;
  55                 break;
  56         case DRM_MODE_DPMS_OFF:
  57                 temp |= ADPA_HSYNC_CNTL_DISABLE | ADPA_VSYNC_CNTL_DISABLE;
  58                 break;
  59         }
  60
  61         I915_WRITE(ADPA, temp);
  62 }
  63
  64 static int intel_crt_mode_valid(struct drm_connector *connector,
  65                                 struct drm_display_mode *mode)
  66 {
  67         if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
  68                 return MODE_NO_DBLESCAN;
  69
  70         if (mode->clock > 400000 || mode->clock < 25000)
  71                 return MODE_CLOCK_RANGE;
  72
  73         return MODE_OK;
  74 }
  75
  76 static bool intel_crt_mode_fixup(struct drm_encoder *encoder,
  77                                  struct drm_display_mode *mode,
  78                                  struct drm_display_mode *adjusted_mode)
  79 {
  80         return true;
  81 }
  82
  83 static void intel_crt_mode_set(struct drm_encoder *encoder,
  84                                struct drm_display_mode *mode,
  85                                struct drm_display_mode *adjusted_mode)
  86 {
  87
  88         struct drm_device *dev = encoder->dev;
  89         struct drm_crtc *crtc = encoder->crtc;
  90         struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
  91         struct drm_i915_private *dev_priv = dev->dev_private;
  92         int dpll_md_reg;
  93         u32 adpa, dpll_md;
  94
  95         if (intel_crtc->pipe == 0)
  96                 dpll_md_reg = DPLL_A_MD;
  97         else
  98                 dpll_md_reg = DPLL_B_MD;
  99
 100         /*
 101          * Disable separate mode multiplier used when cloning SDVO to CRT
 102          * XXX this needs to be adjusted when we really are cloning
 103          */
 104         if (IS_I965G(dev)) {
 105                 dpll_md = I915_READ(dpll_md_reg);
 106                 I915_WRITE(dpll_md_reg,
 107                            dpll_md & ~DPLL_MD_UDI_MULTIPLIER_MASK);
 108         }
 109
 110         adpa = 0;
 111         if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
 112                 adpa |= ADPA_HSYNC_ACTIVE_HIGH;
 113         if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
 114                 adpa |= ADPA_VSYNC_ACTIVE_HIGH;
 115
 116         if (intel_crtc->pipe == 0)
 117                 adpa |= ADPA_PIPE_A_SELECT;
 118         else
 119                 adpa |= ADPA_PIPE_B_SELECT;
 120
 121         I915_WRITE(ADPA, adpa);
 122 }
 123
 124 /**
 125  * Uses CRT_HOTPLUG_EN and CRT_HOTPLUG_STAT to detect CRT presence.
 126  *
 127  * Not for i915G/i915GM
 128  *
 129  * \return true if CRT is connected.
 130  * \return false if CRT is disconnected.
 131  */
 132 static bool intel_crt_detect_hotplug(struct drm_connector *connector)
 133 {
 134         struct drm_device *dev = connector->dev;
 135         struct drm_i915_private *dev_priv = dev->dev_private;
 136         u32 hotplug_en;
 137         int i, tries = 0;
 138         /*
 139          * On 4 series desktop, CRT detect sequence need to be done twice
 140          * to get a reliable result.
 141          */
 142
 143         if (IS_G4X(dev) && !IS_GM45(dev))
 144                 tries = 2;
 145         else
 146                 tries = 1;
 147         hotplug_en = I915_READ(PORT_HOTPLUG_EN);
 148         hotplug_en &= ~(CRT_HOTPLUG_MASK);
 149         hotplug_en |= CRT_HOTPLUG_FORCE_DETECT;
 150
 151         if (IS_GM45(dev))
 152                 hotplug_en |= CRT_HOTPLUG_ACTIVATION_PERIOD_64;
 153
 154         hotplug_en |= CRT_HOTPLUG_VOLTAGE_COMPARE_50;
 155
 156         for (i = 0; i < tries ; i++) {
 157                 unsigned long timeout;
 158                 /* turn on the FORCE_DETECT */
 159                 I915_WRITE(PORT_HOTPLUG_EN, hotplug_en);
 160                 timeout = jiffies + msecs_to_jiffies(1000);
 161                 /* wait for FORCE_DETECT to go off */
 162                 do {
 163                         if (!(I915_READ(PORT_HOTPLUG_EN) &
 164                                         CRT_HOTPLUG_FORCE_DETECT))
 165                                 break;
 166                         msleep(1);
 167                 } while (time_after(timeout, jiffies));
 168         }
 169
 170         if ((I915_READ(PORT_HOTPLUG_STAT) & CRT_HOTPLUG_MONITOR_MASK) ==
 171             CRT_HOTPLUG_MONITOR_COLOR)
 172                 return true;
 173
 174         return false;
 175 }
 176
 177 static bool intel_crt_detect_ddc(struct drm_connector *connector)
 178 {
 179         struct intel_output *intel_output = to_intel_output(connector);
 180
 181         /* CRT should always be at 0, but check anyway */
 182         if (intel_output->type != INTEL_OUTPUT_ANALOG)
 183                 return false;
 184
 185         return intel_ddc_probe(intel_output);
 186 }
 187
 188 static enum drm_connector_status intel_crt_detect(struct drm_connector *connector)
 189 {
 190         struct drm_device *dev = connector->dev;
 191
 192         if (IS_I9XX(dev) && !IS_I915G(dev) && !IS_I915GM(dev)) {
 193                 if (intel_crt_detect_hotplug(connector))
 194                         return connector_status_connected;
 195                 else
 196                         return connector_status_disconnected;
 197         }
 198
 199         if (intel_crt_detect_ddc(connector))
 200                 return connector_status_connected;
 201
 202         /* TODO use load detect */
 203         return connector_status_unknown;
 204 }
 205
 206 static void intel_crt_destroy(struct drm_connector *connector)
 207 {
 208         struct intel_output *intel_output = to_intel_output(connector);
 209
 210         intel_i2c_destroy(intel_output->ddc_bus);
 211         drm_sysfs_connector_remove(connector);
 212         drm_connector_cleanup(connector);
 213         kfree(connector);
 214 }
 215
 216 static int intel_crt_get_modes(struct drm_connector *connector)
 217 {
 218         struct intel_output *intel_output = to_intel_output(connector);
 219         return intel_ddc_get_modes(intel_output);
 220 }
 221
 222 static int intel_crt_set_property(struct drm_connector *connector,
 223                                   struct drm_property *property,
 224                                   uint64_t value)
 225 {
 226         struct drm_device *dev = connector->dev;
 227
 228         if (property == dev->mode_config.dpms_property && connector->encoder)
 229                 intel_crt_dpms(connector->encoder, (uint32_t)(value & 0xf));
 230
 231         return 0;
 232 }
 233
 234 /*
 235  * Routines for controlling stuff on the analog port
 236  */
 237
 238 static const struct drm_encoder_helper_funcs intel_crt_helper_funcs = {
 239         .dpms = intel_crt_dpms,
 240         .mode_fixup = intel_crt_mode_fixup,
 241         .prepare = intel_encoder_prepare,
 242         .commit = intel_encoder_commit,
 243         .mode_set = intel_crt_mode_set,
 244 };
 245
 246 static const struct drm_connector_funcs intel_crt_connector_funcs = {
 247         .detect = intel_crt_detect,
 248         .fill_modes = drm_helper_probe_single_connector_modes,
 249         .destroy = intel_crt_destroy,
 250         .set_property = intel_crt_set_property,
 251 };
 252
 253 static const struct drm_connector_helper_funcs intel_crt_connector_helper_funcs = {
 254         .mode_valid = intel_crt_mode_valid,
 255         .get_modes = intel_crt_get_modes,
 256         .best_encoder = intel_best_encoder,
 257 };
 258
 259 static void intel_crt_enc_destroy(struct drm_encoder *encoder)
 260 {
 261         drm_encoder_cleanup(encoder);
 262 }
 263
 264 static const struct drm_encoder_funcs intel_crt_enc_funcs = {
 265         .destroy = intel_crt_enc_destroy,
 266 };
 267
 268 void intel_crt_init(struct drm_device *dev)
 269 {
 270         struct drm_connector *connector;
 271         struct intel_output *intel_output;
 272
 273         intel_output = kzalloc(sizeof(struct intel_output), GFP_KERNEL);
 274         if (!intel_output)
 275                 return;
 276
 277         connector = &intel_output->base;
 278         drm_connector_init(dev, &intel_output->base,
 279                            &intel_crt_connector_funcs, DRM_MODE_CONNECTOR_VGA);
 280
 281         drm_encoder_init(dev, &intel_output->enc, &intel_crt_enc_funcs,
 282                          DRM_MODE_ENCODER_DAC);
 283
 284         drm_mode_connector_attach_encoder(&intel_output->base,
 285                                           &intel_output->enc);
 286
 287         /* Set up the DDC bus. */
 288         intel_output->ddc_bus = intel_i2c_create(dev, GPIOA, "CRTDDC_A");
 289         if (!intel_output->ddc_bus) {
 290                 dev_printk(KERN_ERR, &dev->pdev->dev, "DDC bus registration "
 291                            "failed.\n");
 292                 return;
 293         }
 294
 295         intel_output->type = INTEL_OUTPUT_ANALOG;
 296         connector->interlace_allowed = 0;
 297         connector->doublescan_allowed = 0;
 298
 299         drm_encoder_helper_add(&intel_output->enc, &intel_crt_helper_funcs);
 300         drm_connector_helper_add(connector, &intel_crt_connector_helper_funcs);
 301
 302         drm_sysfs_connector_add(connector);
 303 }