Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright © 2006-2007 Intel Corporation |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or modify it |
| 5 | * under the terms and conditions of the GNU General Public License, |
| 6 | * version 2, as published by the Free Software Foundation. |
| 7 | * |
| 8 | * This program is distributed in the hope it will be useful, but WITHOUT |
| 9 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 10 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 11 | * more details. |
| 12 | * |
| 13 | * You should have received a copy of the GNU General Public License along with |
| 14 | * this program; if not, write to the Free Software Foundation, Inc., |
| 15 | * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. |
| 16 | * |
| 17 | * Authors: |
| 18 | * Eric Anholt <eric@anholt.net> |
| 19 | * Dave Airlie <airlied@linux.ie> |
| 20 | * Jesse Barnes <jesse.barnes@intel.com> |
| 21 | */ |
| 22 | |
| 23 | #include <linux/i2c.h> |
| 24 | #include <drm/drmP.h> |
| 25 | |
| 26 | #include "intel_bios.h" |
| 27 | #include "psb_drv.h" |
| 28 | #include "psb_intel_drv.h" |
| 29 | #include "psb_intel_reg.h" |
| 30 | #include "power.h" |
| 31 | #include <linux/pm_runtime.h> |
| 32 | |
| 33 | /* |
| 34 | * LVDS I2C backlight control macros |
| 35 | */ |
| 36 | #define BRIGHTNESS_MAX_LEVEL 100 |
| 37 | #define BRIGHTNESS_MASK 0xFF |
| 38 | #define BLC_I2C_TYPE 0x01 |
| 39 | #define BLC_PWM_TYPT 0x02 |
| 40 | |
| 41 | #define BLC_POLARITY_NORMAL 0 |
| 42 | #define BLC_POLARITY_INVERSE 1 |
| 43 | |
| 44 | #define PSB_BLC_MAX_PWM_REG_FREQ (0xFFFE) |
| 45 | #define PSB_BLC_MIN_PWM_REG_FREQ (0x2) |
| 46 | #define PSB_BLC_PWM_PRECISION_FACTOR (10) |
| 47 | #define PSB_BACKLIGHT_PWM_CTL_SHIFT (16) |
| 48 | #define PSB_BACKLIGHT_PWM_POLARITY_BIT_CLEAR (0xFFFE) |
| 49 | |
| 50 | struct psb_intel_lvds_priv { |
| 51 | /* |
| 52 | * Saved LVDO output states |
| 53 | */ |
| 54 | uint32_t savePP_ON; |
| 55 | uint32_t savePP_OFF; |
| 56 | uint32_t saveLVDS; |
| 57 | uint32_t savePP_CONTROL; |
| 58 | uint32_t savePP_CYCLE; |
| 59 | uint32_t savePFIT_CONTROL; |
| 60 | uint32_t savePFIT_PGM_RATIOS; |
| 61 | uint32_t saveBLC_PWM_CTL; |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 62 | |
| 63 | struct psb_intel_i2c_chan *i2c_bus; |
| 64 | struct psb_intel_i2c_chan *ddc_bus; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 65 | }; |
| 66 | |
| 67 | |
| 68 | /* |
| 69 | * Returns the maximum level of the backlight duty cycle field. |
| 70 | */ |
| 71 | static u32 psb_intel_lvds_get_max_backlight(struct drm_device *dev) |
| 72 | { |
| 73 | struct drm_psb_private *dev_priv = dev->dev_private; |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 74 | u32 ret; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 75 | |
| 76 | if (gma_power_begin(dev, false)) { |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 77 | ret = REG_READ(BLC_PWM_CTL); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 78 | gma_power_end(dev); |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 79 | } else /* Powered off, use the saved value */ |
Alan Cox | 648a8e3 | 2012-03-08 16:00:31 +0000 | [diff] [blame] | 80 | ret = dev_priv->regs.saveBLC_PWM_CTL; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 81 | |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 82 | /* Top 15bits hold the frequency mask */ |
| 83 | ret = (ret & BACKLIGHT_MODULATION_FREQ_MASK) >> |
| 84 | BACKLIGHT_MODULATION_FREQ_SHIFT; |
| 85 | |
| 86 | ret *= 2; /* Return a 16bit range as needed for setting */ |
| 87 | if (ret == 0) |
| 88 | dev_err(dev->dev, "BL bug: Reg %08x save %08X\n", |
Alan Cox | 648a8e3 | 2012-03-08 16:00:31 +0000 | [diff] [blame] | 89 | REG_READ(BLC_PWM_CTL), dev_priv->regs.saveBLC_PWM_CTL); |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 90 | return ret; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 91 | } |
| 92 | |
| 93 | /* |
| 94 | * Set LVDS backlight level by I2C command |
| 95 | * |
| 96 | * FIXME: at some point we need to both track this for PM and also |
| 97 | * disable runtime pm on MRST if the brightness is nil (ie blanked) |
| 98 | */ |
| 99 | static int psb_lvds_i2c_set_brightness(struct drm_device *dev, |
| 100 | unsigned int level) |
| 101 | { |
| 102 | struct drm_psb_private *dev_priv = |
| 103 | (struct drm_psb_private *)dev->dev_private; |
| 104 | |
| 105 | struct psb_intel_i2c_chan *lvds_i2c_bus = dev_priv->lvds_i2c_bus; |
| 106 | u8 out_buf[2]; |
| 107 | unsigned int blc_i2c_brightness; |
| 108 | |
| 109 | struct i2c_msg msgs[] = { |
| 110 | { |
| 111 | .addr = lvds_i2c_bus->slave_addr, |
| 112 | .flags = 0, |
| 113 | .len = 2, |
| 114 | .buf = out_buf, |
| 115 | } |
| 116 | }; |
| 117 | |
| 118 | blc_i2c_brightness = BRIGHTNESS_MASK & ((unsigned int)level * |
| 119 | BRIGHTNESS_MASK / |
| 120 | BRIGHTNESS_MAX_LEVEL); |
| 121 | |
| 122 | if (dev_priv->lvds_bl->pol == BLC_POLARITY_INVERSE) |
| 123 | blc_i2c_brightness = BRIGHTNESS_MASK - blc_i2c_brightness; |
| 124 | |
| 125 | out_buf[0] = dev_priv->lvds_bl->brightnesscmd; |
| 126 | out_buf[1] = (u8)blc_i2c_brightness; |
| 127 | |
| 128 | if (i2c_transfer(&lvds_i2c_bus->adapter, msgs, 1) == 1) { |
| 129 | dev_dbg(dev->dev, "I2C set brightness.(command, value) (%d, %d)\n", |
| 130 | dev_priv->lvds_bl->brightnesscmd, |
| 131 | blc_i2c_brightness); |
| 132 | return 0; |
| 133 | } |
| 134 | |
| 135 | dev_err(dev->dev, "I2C transfer error\n"); |
| 136 | return -1; |
| 137 | } |
| 138 | |
| 139 | |
| 140 | static int psb_lvds_pwm_set_brightness(struct drm_device *dev, int level) |
| 141 | { |
| 142 | struct drm_psb_private *dev_priv = |
| 143 | (struct drm_psb_private *)dev->dev_private; |
| 144 | |
| 145 | u32 max_pwm_blc; |
| 146 | u32 blc_pwm_duty_cycle; |
| 147 | |
| 148 | max_pwm_blc = psb_intel_lvds_get_max_backlight(dev); |
| 149 | |
| 150 | /*BLC_PWM_CTL Should be initiated while backlight device init*/ |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 151 | BUG_ON(max_pwm_blc == 0); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 152 | |
| 153 | blc_pwm_duty_cycle = level * max_pwm_blc / BRIGHTNESS_MAX_LEVEL; |
| 154 | |
| 155 | if (dev_priv->lvds_bl->pol == BLC_POLARITY_INVERSE) |
| 156 | blc_pwm_duty_cycle = max_pwm_blc - blc_pwm_duty_cycle; |
| 157 | |
| 158 | blc_pwm_duty_cycle &= PSB_BACKLIGHT_PWM_POLARITY_BIT_CLEAR; |
| 159 | REG_WRITE(BLC_PWM_CTL, |
| 160 | (max_pwm_blc << PSB_BACKLIGHT_PWM_CTL_SHIFT) | |
| 161 | (blc_pwm_duty_cycle)); |
| 162 | |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 163 | dev_info(dev->dev, "Backlight lvds set brightness %08x\n", |
| 164 | (max_pwm_blc << PSB_BACKLIGHT_PWM_CTL_SHIFT) | |
| 165 | (blc_pwm_duty_cycle)); |
| 166 | |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 167 | return 0; |
| 168 | } |
| 169 | |
| 170 | /* |
| 171 | * Set LVDS backlight level either by I2C or PWM |
| 172 | */ |
| 173 | void psb_intel_lvds_set_brightness(struct drm_device *dev, int level) |
| 174 | { |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 175 | struct drm_psb_private *dev_priv = dev->dev_private; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 176 | |
| 177 | dev_dbg(dev->dev, "backlight level is %d\n", level); |
| 178 | |
| 179 | if (!dev_priv->lvds_bl) { |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 180 | dev_err(dev->dev, "NO LVDS backlight info\n"); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 181 | return; |
| 182 | } |
| 183 | |
| 184 | if (dev_priv->lvds_bl->type == BLC_I2C_TYPE) |
| 185 | psb_lvds_i2c_set_brightness(dev, level); |
| 186 | else |
| 187 | psb_lvds_pwm_set_brightness(dev, level); |
| 188 | } |
| 189 | |
| 190 | /* |
| 191 | * Sets the backlight level. |
| 192 | * |
| 193 | * level: backlight level, from 0 to psb_intel_lvds_get_max_backlight(). |
| 194 | */ |
| 195 | static void psb_intel_lvds_set_backlight(struct drm_device *dev, int level) |
| 196 | { |
| 197 | struct drm_psb_private *dev_priv = dev->dev_private; |
| 198 | u32 blc_pwm_ctl; |
| 199 | |
| 200 | if (gma_power_begin(dev, false)) { |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 201 | blc_pwm_ctl = REG_READ(BLC_PWM_CTL); |
| 202 | blc_pwm_ctl &= ~BACKLIGHT_DUTY_CYCLE_MASK; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 203 | REG_WRITE(BLC_PWM_CTL, |
| 204 | (blc_pwm_ctl | |
| 205 | (level << BACKLIGHT_DUTY_CYCLE_SHIFT))); |
Alan Cox | 648a8e3 | 2012-03-08 16:00:31 +0000 | [diff] [blame] | 206 | dev_priv->regs.saveBLC_PWM_CTL = (blc_pwm_ctl | |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 207 | (level << BACKLIGHT_DUTY_CYCLE_SHIFT)); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 208 | gma_power_end(dev); |
| 209 | } else { |
Alan Cox | 648a8e3 | 2012-03-08 16:00:31 +0000 | [diff] [blame] | 210 | blc_pwm_ctl = dev_priv->regs.saveBLC_PWM_CTL & |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 211 | ~BACKLIGHT_DUTY_CYCLE_MASK; |
Alan Cox | 648a8e3 | 2012-03-08 16:00:31 +0000 | [diff] [blame] | 212 | dev_priv->regs.saveBLC_PWM_CTL = (blc_pwm_ctl | |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 213 | (level << BACKLIGHT_DUTY_CYCLE_SHIFT)); |
| 214 | } |
| 215 | } |
| 216 | |
| 217 | /* |
| 218 | * Sets the power state for the panel. |
| 219 | */ |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 220 | static void psb_intel_lvds_set_power(struct drm_device *dev, bool on) |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 221 | { |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 222 | struct drm_psb_private *dev_priv = dev->dev_private; |
| 223 | struct psb_intel_mode_device *mode_dev = &dev_priv->mode_dev; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 224 | u32 pp_status; |
| 225 | |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 226 | if (!gma_power_begin(dev, true)) { |
| 227 | dev_err(dev->dev, "set power, chip off!\n"); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 228 | return; |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 229 | } |
| 230 | |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 231 | if (on) { |
| 232 | REG_WRITE(PP_CONTROL, REG_READ(PP_CONTROL) | |
| 233 | POWER_TARGET_ON); |
| 234 | do { |
| 235 | pp_status = REG_READ(PP_STATUS); |
| 236 | } while ((pp_status & PP_ON) == 0); |
| 237 | |
| 238 | psb_intel_lvds_set_backlight(dev, |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 239 | mode_dev->backlight_duty_cycle); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 240 | } else { |
| 241 | psb_intel_lvds_set_backlight(dev, 0); |
| 242 | |
| 243 | REG_WRITE(PP_CONTROL, REG_READ(PP_CONTROL) & |
| 244 | ~POWER_TARGET_ON); |
| 245 | do { |
| 246 | pp_status = REG_READ(PP_STATUS); |
| 247 | } while (pp_status & PP_ON); |
| 248 | } |
| 249 | |
| 250 | gma_power_end(dev); |
| 251 | } |
| 252 | |
| 253 | static void psb_intel_lvds_encoder_dpms(struct drm_encoder *encoder, int mode) |
| 254 | { |
| 255 | struct drm_device *dev = encoder->dev; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 256 | |
| 257 | if (mode == DRM_MODE_DPMS_ON) |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 258 | psb_intel_lvds_set_power(dev, true); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 259 | else |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 260 | psb_intel_lvds_set_power(dev, false); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 261 | |
| 262 | /* XXX: We never power down the LVDS pairs. */ |
| 263 | } |
| 264 | |
| 265 | static void psb_intel_lvds_save(struct drm_connector *connector) |
| 266 | { |
| 267 | struct drm_device *dev = connector->dev; |
| 268 | struct drm_psb_private *dev_priv = |
| 269 | (struct drm_psb_private *)dev->dev_private; |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 270 | struct gma_encoder *gma_encoder = gma_attached_encoder(connector); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 271 | struct psb_intel_lvds_priv *lvds_priv = |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 272 | (struct psb_intel_lvds_priv *)gma_encoder->dev_priv; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 273 | |
| 274 | lvds_priv->savePP_ON = REG_READ(LVDSPP_ON); |
| 275 | lvds_priv->savePP_OFF = REG_READ(LVDSPP_OFF); |
| 276 | lvds_priv->saveLVDS = REG_READ(LVDS); |
| 277 | lvds_priv->savePP_CONTROL = REG_READ(PP_CONTROL); |
| 278 | lvds_priv->savePP_CYCLE = REG_READ(PP_CYCLE); |
| 279 | /*lvds_priv->savePP_DIVISOR = REG_READ(PP_DIVISOR);*/ |
| 280 | lvds_priv->saveBLC_PWM_CTL = REG_READ(BLC_PWM_CTL); |
| 281 | lvds_priv->savePFIT_CONTROL = REG_READ(PFIT_CONTROL); |
| 282 | lvds_priv->savePFIT_PGM_RATIOS = REG_READ(PFIT_PGM_RATIOS); |
| 283 | |
| 284 | /*TODO: move backlight_duty_cycle to psb_intel_lvds_priv*/ |
Alan Cox | 648a8e3 | 2012-03-08 16:00:31 +0000 | [diff] [blame] | 285 | dev_priv->backlight_duty_cycle = (dev_priv->regs.saveBLC_PWM_CTL & |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 286 | BACKLIGHT_DUTY_CYCLE_MASK); |
| 287 | |
| 288 | /* |
| 289 | * If the light is off at server startup, |
| 290 | * just make it full brightness |
| 291 | */ |
| 292 | if (dev_priv->backlight_duty_cycle == 0) |
| 293 | dev_priv->backlight_duty_cycle = |
| 294 | psb_intel_lvds_get_max_backlight(dev); |
| 295 | |
| 296 | dev_dbg(dev->dev, "(0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x)\n", |
| 297 | lvds_priv->savePP_ON, |
| 298 | lvds_priv->savePP_OFF, |
| 299 | lvds_priv->saveLVDS, |
| 300 | lvds_priv->savePP_CONTROL, |
| 301 | lvds_priv->savePP_CYCLE, |
| 302 | lvds_priv->saveBLC_PWM_CTL); |
| 303 | } |
| 304 | |
| 305 | static void psb_intel_lvds_restore(struct drm_connector *connector) |
| 306 | { |
| 307 | struct drm_device *dev = connector->dev; |
| 308 | u32 pp_status; |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 309 | struct gma_encoder *gma_encoder = gma_attached_encoder(connector); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 310 | struct psb_intel_lvds_priv *lvds_priv = |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 311 | (struct psb_intel_lvds_priv *)gma_encoder->dev_priv; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 312 | |
| 313 | dev_dbg(dev->dev, "(0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x)\n", |
| 314 | lvds_priv->savePP_ON, |
| 315 | lvds_priv->savePP_OFF, |
| 316 | lvds_priv->saveLVDS, |
| 317 | lvds_priv->savePP_CONTROL, |
| 318 | lvds_priv->savePP_CYCLE, |
| 319 | lvds_priv->saveBLC_PWM_CTL); |
| 320 | |
| 321 | REG_WRITE(BLC_PWM_CTL, lvds_priv->saveBLC_PWM_CTL); |
| 322 | REG_WRITE(PFIT_CONTROL, lvds_priv->savePFIT_CONTROL); |
| 323 | REG_WRITE(PFIT_PGM_RATIOS, lvds_priv->savePFIT_PGM_RATIOS); |
| 324 | REG_WRITE(LVDSPP_ON, lvds_priv->savePP_ON); |
| 325 | REG_WRITE(LVDSPP_OFF, lvds_priv->savePP_OFF); |
| 326 | /*REG_WRITE(PP_DIVISOR, lvds_priv->savePP_DIVISOR);*/ |
| 327 | REG_WRITE(PP_CYCLE, lvds_priv->savePP_CYCLE); |
| 328 | REG_WRITE(PP_CONTROL, lvds_priv->savePP_CONTROL); |
| 329 | REG_WRITE(LVDS, lvds_priv->saveLVDS); |
| 330 | |
| 331 | if (lvds_priv->savePP_CONTROL & POWER_TARGET_ON) { |
| 332 | REG_WRITE(PP_CONTROL, REG_READ(PP_CONTROL) | |
| 333 | POWER_TARGET_ON); |
| 334 | do { |
| 335 | pp_status = REG_READ(PP_STATUS); |
| 336 | } while ((pp_status & PP_ON) == 0); |
| 337 | } else { |
| 338 | REG_WRITE(PP_CONTROL, REG_READ(PP_CONTROL) & |
| 339 | ~POWER_TARGET_ON); |
| 340 | do { |
| 341 | pp_status = REG_READ(PP_STATUS); |
| 342 | } while (pp_status & PP_ON); |
| 343 | } |
| 344 | } |
| 345 | |
| 346 | int psb_intel_lvds_mode_valid(struct drm_connector *connector, |
| 347 | struct drm_display_mode *mode) |
| 348 | { |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 349 | struct drm_psb_private *dev_priv = connector->dev->dev_private; |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 350 | struct gma_encoder *gma_encoder = gma_attached_encoder(connector); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 351 | struct drm_display_mode *fixed_mode = |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 352 | dev_priv->mode_dev.panel_fixed_mode; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 353 | |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 354 | if (gma_encoder->type == INTEL_OUTPUT_MIPI2) |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 355 | fixed_mode = dev_priv->mode_dev.panel_fixed_mode2; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 356 | |
| 357 | /* just in case */ |
| 358 | if (mode->flags & DRM_MODE_FLAG_DBLSCAN) |
| 359 | return MODE_NO_DBLESCAN; |
| 360 | |
| 361 | /* just in case */ |
| 362 | if (mode->flags & DRM_MODE_FLAG_INTERLACE) |
| 363 | return MODE_NO_INTERLACE; |
| 364 | |
| 365 | if (fixed_mode) { |
| 366 | if (mode->hdisplay > fixed_mode->hdisplay) |
| 367 | return MODE_PANEL; |
| 368 | if (mode->vdisplay > fixed_mode->vdisplay) |
| 369 | return MODE_PANEL; |
| 370 | } |
| 371 | return MODE_OK; |
| 372 | } |
| 373 | |
| 374 | bool psb_intel_lvds_mode_fixup(struct drm_encoder *encoder, |
Laurent Pinchart | e811f5a | 2012-07-17 17:56:50 +0200 | [diff] [blame] | 375 | const struct drm_display_mode *mode, |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 376 | struct drm_display_mode *adjusted_mode) |
| 377 | { |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 378 | struct drm_device *dev = encoder->dev; |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 379 | struct drm_psb_private *dev_priv = dev->dev_private; |
| 380 | struct psb_intel_mode_device *mode_dev = &dev_priv->mode_dev; |
Patrik Jakobsson | 6306865 | 2013-07-22 01:31:23 +0200 | [diff] [blame] | 381 | struct gma_crtc *gma_crtc = to_gma_crtc(encoder->crtc); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 382 | struct drm_encoder *tmp_encoder; |
| 383 | struct drm_display_mode *panel_fixed_mode = mode_dev->panel_fixed_mode; |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 384 | struct gma_encoder *gma_encoder = to_gma_encoder(encoder); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 385 | |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 386 | if (gma_encoder->type == INTEL_OUTPUT_MIPI2) |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 387 | panel_fixed_mode = mode_dev->panel_fixed_mode2; |
| 388 | |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 389 | /* PSB requires the LVDS is on pipe B, MRST has only one pipe anyway */ |
Patrik Jakobsson | 6306865 | 2013-07-22 01:31:23 +0200 | [diff] [blame] | 390 | if (!IS_MRST(dev) && gma_crtc->pipe == 0) { |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 391 | printk(KERN_ERR "Can't support LVDS on pipe A\n"); |
| 392 | return false; |
| 393 | } |
Patrik Jakobsson | 6306865 | 2013-07-22 01:31:23 +0200 | [diff] [blame] | 394 | if (IS_MRST(dev) && gma_crtc->pipe != 0) { |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 395 | printk(KERN_ERR "Must use PIPE A\n"); |
| 396 | return false; |
| 397 | } |
| 398 | /* Should never happen!! */ |
| 399 | list_for_each_entry(tmp_encoder, &dev->mode_config.encoder_list, |
| 400 | head) { |
| 401 | if (tmp_encoder != encoder |
| 402 | && tmp_encoder->crtc == encoder->crtc) { |
| 403 | printk(KERN_ERR "Can't enable LVDS and another " |
| 404 | "encoder on the same pipe\n"); |
| 405 | return false; |
| 406 | } |
| 407 | } |
| 408 | |
| 409 | /* |
| 410 | * If we have timings from the BIOS for the panel, put them in |
| 411 | * to the adjusted mode. The CRTC will be set up for this mode, |
| 412 | * with the panel scaling set up to source from the H/VDisplay |
| 413 | * of the original mode. |
| 414 | */ |
| 415 | if (panel_fixed_mode != NULL) { |
| 416 | adjusted_mode->hdisplay = panel_fixed_mode->hdisplay; |
| 417 | adjusted_mode->hsync_start = panel_fixed_mode->hsync_start; |
| 418 | adjusted_mode->hsync_end = panel_fixed_mode->hsync_end; |
| 419 | adjusted_mode->htotal = panel_fixed_mode->htotal; |
| 420 | adjusted_mode->vdisplay = panel_fixed_mode->vdisplay; |
| 421 | adjusted_mode->vsync_start = panel_fixed_mode->vsync_start; |
| 422 | adjusted_mode->vsync_end = panel_fixed_mode->vsync_end; |
| 423 | adjusted_mode->vtotal = panel_fixed_mode->vtotal; |
| 424 | adjusted_mode->clock = panel_fixed_mode->clock; |
| 425 | drm_mode_set_crtcinfo(adjusted_mode, |
| 426 | CRTC_INTERLACE_HALVE_V); |
| 427 | } |
| 428 | |
| 429 | /* |
| 430 | * XXX: It would be nice to support lower refresh rates on the |
| 431 | * panels to reduce power consumption, and perhaps match the |
| 432 | * user's requested refresh rate. |
| 433 | */ |
| 434 | |
| 435 | return true; |
| 436 | } |
| 437 | |
| 438 | static void psb_intel_lvds_prepare(struct drm_encoder *encoder) |
| 439 | { |
| 440 | struct drm_device *dev = encoder->dev; |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 441 | struct drm_psb_private *dev_priv = dev->dev_private; |
| 442 | struct psb_intel_mode_device *mode_dev = &dev_priv->mode_dev; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 443 | |
| 444 | if (!gma_power_begin(dev, true)) |
| 445 | return; |
| 446 | |
| 447 | mode_dev->saveBLC_PWM_CTL = REG_READ(BLC_PWM_CTL); |
| 448 | mode_dev->backlight_duty_cycle = (mode_dev->saveBLC_PWM_CTL & |
| 449 | BACKLIGHT_DUTY_CYCLE_MASK); |
| 450 | |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 451 | psb_intel_lvds_set_power(dev, false); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 452 | |
| 453 | gma_power_end(dev); |
| 454 | } |
| 455 | |
| 456 | static void psb_intel_lvds_commit(struct drm_encoder *encoder) |
| 457 | { |
| 458 | struct drm_device *dev = encoder->dev; |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 459 | struct drm_psb_private *dev_priv = dev->dev_private; |
| 460 | struct psb_intel_mode_device *mode_dev = &dev_priv->mode_dev; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 461 | |
| 462 | if (mode_dev->backlight_duty_cycle == 0) |
| 463 | mode_dev->backlight_duty_cycle = |
| 464 | psb_intel_lvds_get_max_backlight(dev); |
| 465 | |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 466 | psb_intel_lvds_set_power(dev, true); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 467 | } |
| 468 | |
| 469 | static void psb_intel_lvds_mode_set(struct drm_encoder *encoder, |
| 470 | struct drm_display_mode *mode, |
| 471 | struct drm_display_mode *adjusted_mode) |
| 472 | { |
| 473 | struct drm_device *dev = encoder->dev; |
| 474 | struct drm_psb_private *dev_priv = dev->dev_private; |
| 475 | u32 pfit_control; |
| 476 | |
| 477 | /* |
| 478 | * The LVDS pin pair will already have been turned on in the |
| 479 | * psb_intel_crtc_mode_set since it has a large impact on the DPLL |
| 480 | * settings. |
| 481 | */ |
| 482 | |
| 483 | /* |
| 484 | * Enable automatic panel scaling so that non-native modes fill the |
| 485 | * screen. Should be enabled before the pipe is enabled, according to |
| 486 | * register description and PRM. |
| 487 | */ |
| 488 | if (mode->hdisplay != adjusted_mode->hdisplay || |
| 489 | mode->vdisplay != adjusted_mode->vdisplay) |
| 490 | pfit_control = (PFIT_ENABLE | VERT_AUTO_SCALE | |
| 491 | HORIZ_AUTO_SCALE | VERT_INTERP_BILINEAR | |
| 492 | HORIZ_INTERP_BILINEAR); |
| 493 | else |
| 494 | pfit_control = 0; |
| 495 | |
| 496 | if (dev_priv->lvds_dither) |
| 497 | pfit_control |= PANEL_8TO6_DITHER_ENABLE; |
| 498 | |
| 499 | REG_WRITE(PFIT_CONTROL, pfit_control); |
| 500 | } |
| 501 | |
| 502 | /* |
| 503 | * Detect the LVDS connection. |
| 504 | * |
| 505 | * This always returns CONNECTOR_STATUS_CONNECTED. |
| 506 | * This connector should only have |
| 507 | * been set up if the LVDS was actually connected anyway. |
| 508 | */ |
| 509 | static enum drm_connector_status psb_intel_lvds_detect(struct drm_connector |
| 510 | *connector, bool force) |
| 511 | { |
| 512 | return connector_status_connected; |
| 513 | } |
| 514 | |
| 515 | /* |
| 516 | * Return the list of DDC modes if available, or the BIOS fixed mode otherwise. |
| 517 | */ |
| 518 | static int psb_intel_lvds_get_modes(struct drm_connector *connector) |
| 519 | { |
| 520 | struct drm_device *dev = connector->dev; |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 521 | struct drm_psb_private *dev_priv = dev->dev_private; |
| 522 | struct psb_intel_mode_device *mode_dev = &dev_priv->mode_dev; |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 523 | struct gma_encoder *gma_encoder = gma_attached_encoder(connector); |
| 524 | struct psb_intel_lvds_priv *lvds_priv = gma_encoder->dev_priv; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 525 | int ret = 0; |
| 526 | |
| 527 | if (!IS_MRST(dev)) |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 528 | ret = psb_intel_ddc_get_modes(connector, &lvds_priv->i2c_bus->adapter); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 529 | |
| 530 | if (ret) |
| 531 | return ret; |
| 532 | |
| 533 | /* Didn't get an EDID, so |
| 534 | * Set wide sync ranges so we get all modes |
| 535 | * handed to valid_mode for checking |
| 536 | */ |
| 537 | connector->display_info.min_vfreq = 0; |
| 538 | connector->display_info.max_vfreq = 200; |
| 539 | connector->display_info.min_hfreq = 0; |
| 540 | connector->display_info.max_hfreq = 200; |
| 541 | |
| 542 | if (mode_dev->panel_fixed_mode != NULL) { |
| 543 | struct drm_display_mode *mode = |
| 544 | drm_mode_duplicate(dev, mode_dev->panel_fixed_mode); |
| 545 | drm_mode_probed_add(connector, mode); |
| 546 | return 1; |
| 547 | } |
| 548 | |
| 549 | return 0; |
| 550 | } |
| 551 | |
| 552 | /** |
| 553 | * psb_intel_lvds_destroy - unregister and free LVDS structures |
| 554 | * @connector: connector to free |
| 555 | * |
| 556 | * Unregister the DDC bus for this connector then free the driver private |
| 557 | * structure. |
| 558 | */ |
| 559 | void psb_intel_lvds_destroy(struct drm_connector *connector) |
| 560 | { |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 561 | struct gma_encoder *gma_encoder = gma_attached_encoder(connector); |
| 562 | struct psb_intel_lvds_priv *lvds_priv = gma_encoder->dev_priv; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 563 | |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 564 | if (lvds_priv->ddc_bus) |
| 565 | psb_intel_i2c_destroy(lvds_priv->ddc_bus); |
Thomas Wood | 34ea3d3 | 2014-05-29 16:57:41 +0100 | [diff] [blame] | 566 | drm_connector_unregister(connector); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 567 | drm_connector_cleanup(connector); |
| 568 | kfree(connector); |
| 569 | } |
| 570 | |
| 571 | int psb_intel_lvds_set_property(struct drm_connector *connector, |
| 572 | struct drm_property *property, |
| 573 | uint64_t value) |
| 574 | { |
| 575 | struct drm_encoder *encoder = connector->encoder; |
| 576 | |
| 577 | if (!encoder) |
| 578 | return -1; |
| 579 | |
| 580 | if (!strcmp(property->name, "scaling mode")) { |
Patrik Jakobsson | 6306865 | 2013-07-22 01:31:23 +0200 | [diff] [blame] | 581 | struct gma_crtc *crtc = to_gma_crtc(encoder->crtc); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 582 | uint64_t curval; |
| 583 | |
| 584 | if (!crtc) |
| 585 | goto set_prop_error; |
| 586 | |
| 587 | switch (value) { |
| 588 | case DRM_MODE_SCALE_FULLSCREEN: |
| 589 | break; |
| 590 | case DRM_MODE_SCALE_NO_SCALE: |
| 591 | break; |
| 592 | case DRM_MODE_SCALE_ASPECT: |
| 593 | break; |
| 594 | default: |
| 595 | goto set_prop_error; |
| 596 | } |
| 597 | |
Rob Clark | a69ac9e | 2012-10-11 20:38:23 -0500 | [diff] [blame] | 598 | if (drm_object_property_get_value(&connector->base, |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 599 | property, |
| 600 | &curval)) |
| 601 | goto set_prop_error; |
| 602 | |
| 603 | if (curval == value) |
| 604 | goto set_prop_done; |
| 605 | |
Rob Clark | a69ac9e | 2012-10-11 20:38:23 -0500 | [diff] [blame] | 606 | if (drm_object_property_set_value(&connector->base, |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 607 | property, |
| 608 | value)) |
| 609 | goto set_prop_error; |
| 610 | |
| 611 | if (crtc->saved_mode.hdisplay != 0 && |
| 612 | crtc->saved_mode.vdisplay != 0) { |
| 613 | if (!drm_crtc_helper_set_mode(encoder->crtc, |
| 614 | &crtc->saved_mode, |
| 615 | encoder->crtc->x, |
| 616 | encoder->crtc->y, |
Matt Roper | f4510a2 | 2014-04-01 15:22:40 -0700 | [diff] [blame] | 617 | encoder->crtc->primary->fb)) |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 618 | goto set_prop_error; |
| 619 | } |
| 620 | } else if (!strcmp(property->name, "backlight")) { |
Rob Clark | a69ac9e | 2012-10-11 20:38:23 -0500 | [diff] [blame] | 621 | if (drm_object_property_set_value(&connector->base, |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 622 | property, |
| 623 | value)) |
| 624 | goto set_prop_error; |
Zhao Yakui | d112a81 | 2012-08-08 13:55:55 +0000 | [diff] [blame] | 625 | else |
| 626 | gma_backlight_set(encoder->dev, value); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 627 | } else if (!strcmp(property->name, "DPMS")) { |
Jani Nikula | 45fe734 | 2015-03-11 11:51:01 +0200 | [diff] [blame] | 628 | const struct drm_encoder_helper_funcs *hfuncs |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 629 | = encoder->helper_private; |
| 630 | hfuncs->dpms(encoder, value); |
| 631 | } |
| 632 | |
| 633 | set_prop_done: |
| 634 | return 0; |
| 635 | set_prop_error: |
| 636 | return -1; |
| 637 | } |
| 638 | |
| 639 | static const struct drm_encoder_helper_funcs psb_intel_lvds_helper_funcs = { |
| 640 | .dpms = psb_intel_lvds_encoder_dpms, |
| 641 | .mode_fixup = psb_intel_lvds_mode_fixup, |
| 642 | .prepare = psb_intel_lvds_prepare, |
| 643 | .mode_set = psb_intel_lvds_mode_set, |
| 644 | .commit = psb_intel_lvds_commit, |
| 645 | }; |
| 646 | |
| 647 | const struct drm_connector_helper_funcs |
| 648 | psb_intel_lvds_connector_helper_funcs = { |
| 649 | .get_modes = psb_intel_lvds_get_modes, |
| 650 | .mode_valid = psb_intel_lvds_mode_valid, |
Patrik Jakobsson | c9d4959 | 2013-07-11 01:02:01 +0200 | [diff] [blame] | 651 | .best_encoder = gma_best_encoder, |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 652 | }; |
| 653 | |
| 654 | const struct drm_connector_funcs psb_intel_lvds_connector_funcs = { |
| 655 | .dpms = drm_helper_connector_dpms, |
| 656 | .save = psb_intel_lvds_save, |
| 657 | .restore = psb_intel_lvds_restore, |
| 658 | .detect = psb_intel_lvds_detect, |
| 659 | .fill_modes = drm_helper_probe_single_connector_modes, |
| 660 | .set_property = psb_intel_lvds_set_property, |
| 661 | .destroy = psb_intel_lvds_destroy, |
| 662 | }; |
| 663 | |
| 664 | |
| 665 | static void psb_intel_lvds_enc_destroy(struct drm_encoder *encoder) |
| 666 | { |
| 667 | drm_encoder_cleanup(encoder); |
| 668 | } |
| 669 | |
| 670 | const struct drm_encoder_funcs psb_intel_lvds_enc_funcs = { |
| 671 | .destroy = psb_intel_lvds_enc_destroy, |
| 672 | }; |
| 673 | |
| 674 | |
| 675 | |
| 676 | /** |
| 677 | * psb_intel_lvds_init - setup LVDS connectors on this device |
| 678 | * @dev: drm device |
| 679 | * |
| 680 | * Create the connector, register the LVDS DDC bus, and try to figure out what |
| 681 | * modes we can display on the LVDS panel (if present). |
| 682 | */ |
| 683 | void psb_intel_lvds_init(struct drm_device *dev, |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 684 | struct psb_intel_mode_device *mode_dev) |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 685 | { |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 686 | struct gma_encoder *gma_encoder; |
Patrik Jakobsson | a3d5d75 | 2013-07-22 17:05:25 +0200 | [diff] [blame] | 687 | struct gma_connector *gma_connector; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 688 | struct psb_intel_lvds_priv *lvds_priv; |
| 689 | struct drm_connector *connector; |
| 690 | struct drm_encoder *encoder; |
| 691 | struct drm_display_mode *scan; /* *modes, *bios_mode; */ |
| 692 | struct drm_crtc *crtc; |
Alan Cox | 1f0d0b5 | 2011-11-29 22:26:58 +0000 | [diff] [blame] | 693 | struct drm_psb_private *dev_priv = dev->dev_private; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 694 | u32 lvds; |
| 695 | int pipe; |
| 696 | |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 697 | gma_encoder = kzalloc(sizeof(struct gma_encoder), GFP_KERNEL); |
| 698 | if (!gma_encoder) { |
| 699 | dev_err(dev->dev, "gma_encoder allocation error\n"); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 700 | return; |
| 701 | } |
| 702 | |
Patrik Jakobsson | a3d5d75 | 2013-07-22 17:05:25 +0200 | [diff] [blame] | 703 | gma_connector = kzalloc(sizeof(struct gma_connector), GFP_KERNEL); |
| 704 | if (!gma_connector) { |
| 705 | dev_err(dev->dev, "gma_connector allocation error\n"); |
Jesper Juhl | aa7c62a | 2012-03-08 16:00:58 +0000 | [diff] [blame] | 706 | goto failed_encoder; |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 707 | } |
| 708 | |
| 709 | lvds_priv = kzalloc(sizeof(struct psb_intel_lvds_priv), GFP_KERNEL); |
| 710 | if (!lvds_priv) { |
| 711 | dev_err(dev->dev, "LVDS private allocation error\n"); |
| 712 | goto failed_connector; |
| 713 | } |
| 714 | |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 715 | gma_encoder->dev_priv = lvds_priv; |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 716 | |
Patrik Jakobsson | a3d5d75 | 2013-07-22 17:05:25 +0200 | [diff] [blame] | 717 | connector = &gma_connector->base; |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 718 | encoder = &gma_encoder->base; |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 719 | drm_connector_init(dev, connector, |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 720 | &psb_intel_lvds_connector_funcs, |
| 721 | DRM_MODE_CONNECTOR_LVDS); |
| 722 | |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 723 | drm_encoder_init(dev, encoder, |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 724 | &psb_intel_lvds_enc_funcs, |
| 725 | DRM_MODE_ENCODER_LVDS); |
| 726 | |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 727 | gma_connector_attach_encoder(gma_connector, gma_encoder); |
| 728 | gma_encoder->type = INTEL_OUTPUT_LVDS; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 729 | |
| 730 | drm_encoder_helper_add(encoder, &psb_intel_lvds_helper_funcs); |
| 731 | drm_connector_helper_add(connector, |
| 732 | &psb_intel_lvds_connector_helper_funcs); |
| 733 | connector->display_info.subpixel_order = SubPixelHorizontalRGB; |
| 734 | connector->interlace_allowed = false; |
| 735 | connector->doublescan_allowed = false; |
| 736 | |
| 737 | /*Attach connector properties*/ |
Rob Clark | a69ac9e | 2012-10-11 20:38:23 -0500 | [diff] [blame] | 738 | drm_object_attach_property(&connector->base, |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 739 | dev->mode_config.scaling_mode_property, |
| 740 | DRM_MODE_SCALE_FULLSCREEN); |
Rob Clark | a69ac9e | 2012-10-11 20:38:23 -0500 | [diff] [blame] | 741 | drm_object_attach_property(&connector->base, |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 742 | dev_priv->backlight_property, |
| 743 | BRIGHTNESS_MAX_LEVEL); |
| 744 | |
| 745 | /* |
| 746 | * Set up I2C bus |
| 747 | * FIXME: distroy i2c_bus when exit |
| 748 | */ |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 749 | lvds_priv->i2c_bus = psb_intel_i2c_create(dev, GPIOB, "LVDSBLC_B"); |
| 750 | if (!lvds_priv->i2c_bus) { |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 751 | dev_printk(KERN_ERR, |
| 752 | &dev->pdev->dev, "I2C bus registration failed.\n"); |
| 753 | goto failed_blc_i2c; |
| 754 | } |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 755 | lvds_priv->i2c_bus->slave_addr = 0x2C; |
| 756 | dev_priv->lvds_i2c_bus = lvds_priv->i2c_bus; |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 757 | |
| 758 | /* |
| 759 | * LVDS discovery: |
| 760 | * 1) check for EDID on DDC |
| 761 | * 2) check for VBT data |
| 762 | * 3) check to see if LVDS is already on |
| 763 | * if none of the above, no panel |
| 764 | * 4) make sure lid is open |
| 765 | * if closed, act like it's not there for now |
| 766 | */ |
| 767 | |
| 768 | /* Set up the DDC bus. */ |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 769 | lvds_priv->ddc_bus = psb_intel_i2c_create(dev, GPIOC, "LVDSDDC_C"); |
| 770 | if (!lvds_priv->ddc_bus) { |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 771 | dev_printk(KERN_ERR, &dev->pdev->dev, |
| 772 | "DDC bus registration " "failed.\n"); |
| 773 | goto failed_ddc; |
| 774 | } |
| 775 | |
| 776 | /* |
| 777 | * Attempt to get the fixed panel mode from DDC. Assume that the |
| 778 | * preferred mode is the right one. |
| 779 | */ |
Daniel Vetter | c46145a | 2014-03-21 23:22:36 +0100 | [diff] [blame] | 780 | mutex_lock(&dev->mode_config.mutex); |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 781 | psb_intel_ddc_get_modes(connector, &lvds_priv->ddc_bus->adapter); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 782 | list_for_each_entry(scan, &connector->probed_modes, head) { |
| 783 | if (scan->type & DRM_MODE_TYPE_PREFERRED) { |
| 784 | mode_dev->panel_fixed_mode = |
| 785 | drm_mode_duplicate(dev, scan); |
| 786 | goto out; /* FIXME: check for quirks */ |
| 787 | } |
| 788 | } |
| 789 | |
| 790 | /* Failed to get EDID, what about VBT? do we need this? */ |
| 791 | if (mode_dev->vbt_mode) |
| 792 | mode_dev->panel_fixed_mode = |
| 793 | drm_mode_duplicate(dev, mode_dev->vbt_mode); |
| 794 | |
| 795 | if (!mode_dev->panel_fixed_mode) |
| 796 | if (dev_priv->lfp_lvds_vbt_mode) |
| 797 | mode_dev->panel_fixed_mode = |
| 798 | drm_mode_duplicate(dev, |
| 799 | dev_priv->lfp_lvds_vbt_mode); |
| 800 | |
| 801 | /* |
| 802 | * If we didn't get EDID, try checking if the panel is already turned |
| 803 | * on. If so, assume that whatever is currently programmed is the |
| 804 | * correct mode. |
| 805 | */ |
| 806 | lvds = REG_READ(LVDS); |
| 807 | pipe = (lvds & LVDS_PIPEB_SELECT) ? 1 : 0; |
| 808 | crtc = psb_intel_get_crtc_from_pipe(dev, pipe); |
| 809 | |
| 810 | if (crtc && (lvds & LVDS_PORT_EN)) { |
| 811 | mode_dev->panel_fixed_mode = |
| 812 | psb_intel_crtc_mode_get(dev, crtc); |
| 813 | if (mode_dev->panel_fixed_mode) { |
| 814 | mode_dev->panel_fixed_mode->type |= |
| 815 | DRM_MODE_TYPE_PREFERRED; |
| 816 | goto out; /* FIXME: check for quirks */ |
| 817 | } |
| 818 | } |
| 819 | |
| 820 | /* If we still don't have a mode after all that, give up. */ |
| 821 | if (!mode_dev->panel_fixed_mode) { |
| 822 | dev_err(dev->dev, "Found no modes on the lvds, ignoring the LVDS\n"); |
| 823 | goto failed_find; |
| 824 | } |
| 825 | |
| 826 | /* |
| 827 | * Blacklist machines with BIOSes that list an LVDS panel without |
| 828 | * actually having one. |
| 829 | */ |
| 830 | out: |
Daniel Vetter | c46145a | 2014-03-21 23:22:36 +0100 | [diff] [blame] | 831 | mutex_unlock(&dev->mode_config.mutex); |
Thomas Wood | 34ea3d3 | 2014-05-29 16:57:41 +0100 | [diff] [blame] | 832 | drm_connector_register(connector); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 833 | return; |
| 834 | |
| 835 | failed_find: |
Daniel Vetter | c46145a | 2014-03-21 23:22:36 +0100 | [diff] [blame] | 836 | mutex_unlock(&dev->mode_config.mutex); |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 837 | if (lvds_priv->ddc_bus) |
| 838 | psb_intel_i2c_destroy(lvds_priv->ddc_bus); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 839 | failed_ddc: |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 840 | if (lvds_priv->i2c_bus) |
| 841 | psb_intel_i2c_destroy(lvds_priv->i2c_bus); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 842 | failed_blc_i2c: |
| 843 | drm_encoder_cleanup(encoder); |
| 844 | drm_connector_cleanup(connector); |
Patrik Jakobsson | 9c8cee4 | 2011-12-19 21:40:45 +0000 | [diff] [blame] | 845 | failed_connector: |
Patrik Jakobsson | a3d5d75 | 2013-07-22 17:05:25 +0200 | [diff] [blame] | 846 | kfree(gma_connector); |
Jesper Juhl | aa7c62a | 2012-03-08 16:00:58 +0000 | [diff] [blame] | 847 | failed_encoder: |
Patrik Jakobsson | 367e440 | 2013-07-22 17:45:26 +0200 | [diff] [blame] | 848 | kfree(gma_encoder); |
Alan Cox | 89c7813 | 2011-11-03 18:22:15 +0000 | [diff] [blame] | 849 | } |
| 850 | |