drm/i915: Fix blank panel at reopening lid
[pandora-kernel.git] / drivers / gpu / drm / i915 / intel_panel.c
1 /*
2  * Copyright © 2006-2010 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  *      Chris Wilson <chris@chris-wilson.co.uk>
29  */
30
31 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
32
33 #include <linux/moduleparam.h>
34 #include "intel_drv.h"
35
36 #define PCI_LBPC 0xf4 /* legacy/combination backlight modes */
37
38 void
39 intel_fixed_panel_mode(struct drm_display_mode *fixed_mode,
40                        struct drm_display_mode *adjusted_mode)
41 {
42         adjusted_mode->hdisplay = fixed_mode->hdisplay;
43         adjusted_mode->hsync_start = fixed_mode->hsync_start;
44         adjusted_mode->hsync_end = fixed_mode->hsync_end;
45         adjusted_mode->htotal = fixed_mode->htotal;
46
47         adjusted_mode->vdisplay = fixed_mode->vdisplay;
48         adjusted_mode->vsync_start = fixed_mode->vsync_start;
49         adjusted_mode->vsync_end = fixed_mode->vsync_end;
50         adjusted_mode->vtotal = fixed_mode->vtotal;
51
52         adjusted_mode->clock = fixed_mode->clock;
53 }
54
55 /* adjusted_mode has been preset to be the panel's fixed mode */
56 void
57 intel_pch_panel_fitting(struct drm_device *dev,
58                         int fitting_mode,
59                         const struct drm_display_mode *mode,
60                         struct drm_display_mode *adjusted_mode)
61 {
62         struct drm_i915_private *dev_priv = dev->dev_private;
63         int x, y, width, height;
64
65         x = y = width = height = 0;
66
67         /* Native modes don't need fitting */
68         if (adjusted_mode->hdisplay == mode->hdisplay &&
69             adjusted_mode->vdisplay == mode->vdisplay)
70                 goto done;
71
72         switch (fitting_mode) {
73         case DRM_MODE_SCALE_CENTER:
74                 width = mode->hdisplay;
75                 height = mode->vdisplay;
76                 x = (adjusted_mode->hdisplay - width + 1)/2;
77                 y = (adjusted_mode->vdisplay - height + 1)/2;
78                 break;
79
80         case DRM_MODE_SCALE_ASPECT:
81                 /* Scale but preserve the aspect ratio */
82                 {
83                         u32 scaled_width = adjusted_mode->hdisplay * mode->vdisplay;
84                         u32 scaled_height = mode->hdisplay * adjusted_mode->vdisplay;
85                         if (scaled_width > scaled_height) { /* pillar */
86                                 width = scaled_height / mode->vdisplay;
87                                 if (width & 1)
88                                         width++;
89                                 x = (adjusted_mode->hdisplay - width + 1) / 2;
90                                 y = 0;
91                                 height = adjusted_mode->vdisplay;
92                         } else if (scaled_width < scaled_height) { /* letter */
93                                 height = scaled_width / mode->hdisplay;
94                                 if (height & 1)
95                                     height++;
96                                 y = (adjusted_mode->vdisplay - height + 1) / 2;
97                                 x = 0;
98                                 width = adjusted_mode->hdisplay;
99                         } else {
100                                 x = y = 0;
101                                 width = adjusted_mode->hdisplay;
102                                 height = adjusted_mode->vdisplay;
103                         }
104                 }
105                 break;
106
107         default:
108         case DRM_MODE_SCALE_FULLSCREEN:
109                 x = y = 0;
110                 width = adjusted_mode->hdisplay;
111                 height = adjusted_mode->vdisplay;
112                 break;
113         }
114
115 done:
116         dev_priv->pch_pf_pos = (x << 16) | y;
117         dev_priv->pch_pf_size = (width << 16) | height;
118 }
119
120 static int is_backlight_combination_mode(struct drm_device *dev)
121 {
122         struct drm_i915_private *dev_priv = dev->dev_private;
123
124         if (INTEL_INFO(dev)->gen >= 4)
125                 return I915_READ(BLC_PWM_CTL2) & BLM_COMBINATION_MODE;
126
127         if (IS_GEN2(dev))
128                 return I915_READ(BLC_PWM_CTL) & BLM_LEGACY_MODE;
129
130         return 0;
131 }
132
133 static u32 i915_read_blc_pwm_ctl(struct drm_i915_private *dev_priv)
134 {
135         u32 val;
136
137         /* Restore the CTL value if it lost, e.g. GPU reset */
138
139         if (HAS_PCH_SPLIT(dev_priv->dev)) {
140                 val = I915_READ(BLC_PWM_PCH_CTL2);
141                 if (dev_priv->saveBLC_PWM_CTL2 == 0) {
142                         dev_priv->saveBLC_PWM_CTL2 = val;
143                 } else if (val == 0) {
144                         I915_WRITE(BLC_PWM_PCH_CTL2,
145                                    dev_priv->saveBLC_PWM_CTL2);
146                         val = dev_priv->saveBLC_PWM_CTL2;
147                 }
148         } else {
149                 val = I915_READ(BLC_PWM_CTL);
150                 if (dev_priv->saveBLC_PWM_CTL == 0) {
151                         dev_priv->saveBLC_PWM_CTL = val;
152                         dev_priv->saveBLC_PWM_CTL2 = I915_READ(BLC_PWM_CTL2);
153                 } else if (val == 0) {
154                         I915_WRITE(BLC_PWM_CTL,
155                                    dev_priv->saveBLC_PWM_CTL);
156                         I915_WRITE(BLC_PWM_CTL2,
157                                    dev_priv->saveBLC_PWM_CTL2);
158                         val = dev_priv->saveBLC_PWM_CTL;
159                 }
160         }
161
162         return val;
163 }
164
165 u32 intel_panel_get_max_backlight(struct drm_device *dev)
166 {
167         struct drm_i915_private *dev_priv = dev->dev_private;
168         u32 max;
169
170         max = i915_read_blc_pwm_ctl(dev_priv);
171         if (max == 0) {
172                 /* XXX add code here to query mode clock or hardware clock
173                  * and program max PWM appropriately.
174                  */
175                 pr_warn_once("fixme: max PWM is zero\n");
176                 return 1;
177         }
178
179         if (HAS_PCH_SPLIT(dev)) {
180                 max >>= 16;
181         } else {
182                 if (INTEL_INFO(dev)->gen < 4)
183                         max >>= 17;
184                 else
185                         max >>= 16;
186
187                 if (is_backlight_combination_mode(dev))
188                         max *= 0xff;
189         }
190
191         DRM_DEBUG_DRIVER("max backlight PWM = %d\n", max);
192         return max;
193 }
194
195 static int i915_panel_invert_brightness;
196 MODULE_PARM_DESC(invert_brightness, "Invert backlight brightness "
197         "(-1 force normal, 0 machine defaults, 1 force inversion), please "
198         "report PCI device ID, subsystem vendor and subsystem device ID "
199         "to dri-devel@lists.freedesktop.org, if your machine needs it. "
200         "It will then be included in an upcoming module version.");
201 module_param_named(invert_brightness, i915_panel_invert_brightness, int, 0600);
202 static u32 intel_panel_compute_brightness(struct drm_device *dev, u32 val)
203 {
204         struct drm_i915_private *dev_priv = dev->dev_private;
205
206         if (i915_panel_invert_brightness < 0)
207                 return val;
208
209         if (i915_panel_invert_brightness > 0 ||
210             dev_priv->quirks & QUIRK_INVERT_BRIGHTNESS)
211                 return intel_panel_get_max_backlight(dev) - val;
212
213         return val;
214 }
215
216 static u32 intel_panel_get_backlight(struct drm_device *dev)
217 {
218         struct drm_i915_private *dev_priv = dev->dev_private;
219         u32 val;
220
221         if (HAS_PCH_SPLIT(dev)) {
222                 val = I915_READ(BLC_PWM_CPU_CTL) & BACKLIGHT_DUTY_CYCLE_MASK;
223         } else {
224                 val = I915_READ(BLC_PWM_CTL) & BACKLIGHT_DUTY_CYCLE_MASK;
225                 if (INTEL_INFO(dev)->gen < 4)
226                         val >>= 1;
227
228                 if (is_backlight_combination_mode(dev)) {
229                         u8 lbpc;
230
231                         pci_read_config_byte(dev->pdev, PCI_LBPC, &lbpc);
232                         val *= lbpc;
233                 }
234         }
235
236         val = intel_panel_compute_brightness(dev, val);
237         DRM_DEBUG_DRIVER("get backlight PWM = %d\n", val);
238         return val;
239 }
240
241 static void intel_pch_panel_set_backlight(struct drm_device *dev, u32 level)
242 {
243         struct drm_i915_private *dev_priv = dev->dev_private;
244         u32 val = I915_READ(BLC_PWM_CPU_CTL) & ~BACKLIGHT_DUTY_CYCLE_MASK;
245         I915_WRITE(BLC_PWM_CPU_CTL, val | level);
246 }
247
248 static void intel_panel_actually_set_backlight(struct drm_device *dev, u32 level)
249 {
250         struct drm_i915_private *dev_priv = dev->dev_private;
251         u32 tmp;
252
253         DRM_DEBUG_DRIVER("set backlight PWM = %d\n", level);
254         level = intel_panel_compute_brightness(dev, level);
255
256         if (HAS_PCH_SPLIT(dev))
257                 return intel_pch_panel_set_backlight(dev, level);
258
259         if (is_backlight_combination_mode(dev)) {
260                 u32 max = intel_panel_get_max_backlight(dev);
261                 u8 lbpc;
262
263                 lbpc = level * 0xfe / max + 1;
264                 level /= lbpc;
265                 pci_write_config_byte(dev->pdev, PCI_LBPC, lbpc);
266         }
267
268         tmp = I915_READ(BLC_PWM_CTL);
269         if (INTEL_INFO(dev)->gen < 4) 
270                 level <<= 1;
271         tmp &= ~BACKLIGHT_DUTY_CYCLE_MASK;
272         I915_WRITE(BLC_PWM_CTL, tmp | level);
273 }
274
275 void intel_panel_set_backlight(struct drm_device *dev, u32 level)
276 {
277         struct drm_i915_private *dev_priv = dev->dev_private;
278
279         dev_priv->backlight_level = level;
280         if (dev_priv->backlight_enabled)
281                 intel_panel_actually_set_backlight(dev, level);
282 }
283
284 void intel_panel_disable_backlight(struct drm_device *dev)
285 {
286         struct drm_i915_private *dev_priv = dev->dev_private;
287
288         dev_priv->backlight_enabled = false;
289         intel_panel_actually_set_backlight(dev, 0);
290
291         if (INTEL_INFO(dev)->gen >= 4) {
292                 uint32_t reg, tmp;
293
294                 reg = HAS_PCH_SPLIT(dev) ? BLC_PWM_CPU_CTL2 : BLC_PWM_CTL2;
295
296                 I915_WRITE(reg, I915_READ(reg) & ~BLM_PWM_ENABLE);
297
298                 if (HAS_PCH_SPLIT(dev)) {
299                         tmp = I915_READ(BLC_PWM_PCH_CTL1);
300                         tmp &= ~BLM_PCH_PWM_ENABLE;
301                         I915_WRITE(BLC_PWM_PCH_CTL1, tmp);
302                 }
303         }
304 }
305
306 void intel_panel_enable_backlight(struct drm_device *dev,
307                                   enum pipe pipe)
308 {
309         struct drm_i915_private *dev_priv = dev->dev_private;
310
311         if (dev_priv->backlight_level == 0)
312                 dev_priv->backlight_level = intel_panel_get_max_backlight(dev);
313
314         if (INTEL_INFO(dev)->gen >= 4) {
315                 uint32_t reg, tmp;
316
317                 reg = HAS_PCH_SPLIT(dev) ? BLC_PWM_CPU_CTL2 : BLC_PWM_CTL2;
318
319
320                 tmp = I915_READ(reg);
321
322                 /* Note that this can also get called through dpms changes. And
323                  * we don't track the backlight dpms state, hence check whether
324                  * we have to do anything first. */
325                 if (tmp & BLM_PWM_ENABLE)
326                         goto set_level;
327
328                 if (dev_priv->num_pipe == 3)
329                         tmp &= ~BLM_PIPE_SELECT_IVB;
330                 else
331                         tmp &= ~BLM_PIPE_SELECT;
332
333                 tmp |= BLM_PIPE(pipe);
334                 tmp &= ~BLM_PWM_ENABLE;
335
336                 I915_WRITE(reg, tmp);
337                 POSTING_READ(reg);
338                 I915_WRITE(reg, tmp | BLM_PWM_ENABLE);
339
340                 if (HAS_PCH_SPLIT(dev)) {
341                         tmp = I915_READ(BLC_PWM_PCH_CTL1);
342                         tmp |= BLM_PCH_PWM_ENABLE;
343                         tmp &= ~BLM_PCH_OVERRIDE_ENABLE;
344                         I915_WRITE(BLC_PWM_PCH_CTL1, tmp);
345                 }
346         }
347
348 set_level:
349         /* Call below after setting BLC_PWM_CPU_CTL2 and BLC_PWM_PCH_CTL1.
350          * BLC_PWM_CPU_CTL may be cleared to zero automatically when these
351          * registers are set.
352          */
353         dev_priv->backlight_enabled = true;
354         intel_panel_actually_set_backlight(dev, dev_priv->backlight_level);
355 }
356
357 static void intel_panel_init_backlight(struct drm_device *dev)
358 {
359         struct drm_i915_private *dev_priv = dev->dev_private;
360
361         dev_priv->backlight_level = intel_panel_get_backlight(dev);
362         dev_priv->backlight_enabled = dev_priv->backlight_level != 0;
363 }
364
365 enum drm_connector_status
366 intel_panel_detect(struct drm_device *dev)
367 {
368 #if 0
369         struct drm_i915_private *dev_priv = dev->dev_private;
370 #endif
371
372         if (i915_panel_ignore_lid)
373                 return i915_panel_ignore_lid > 0 ?
374                         connector_status_connected :
375                         connector_status_disconnected;
376
377         /* opregion lid state on HP 2540p is wrong at boot up,
378          * appears to be either the BIOS or Linux ACPI fault */
379 #if 0
380         /* Assume that the BIOS does not lie through the OpRegion... */
381         if (dev_priv->opregion.lid_state)
382                 return ioread32(dev_priv->opregion.lid_state) & 0x1 ?
383                         connector_status_connected :
384                         connector_status_disconnected;
385 #endif
386
387         return connector_status_unknown;
388 }
389
390 #ifdef CONFIG_BACKLIGHT_CLASS_DEVICE
391 static int intel_panel_update_status(struct backlight_device *bd)
392 {
393         struct drm_device *dev = bl_get_data(bd);
394         intel_panel_set_backlight(dev, bd->props.brightness);
395         return 0;
396 }
397
398 static int intel_panel_get_brightness(struct backlight_device *bd)
399 {
400         struct drm_device *dev = bl_get_data(bd);
401         struct drm_i915_private *dev_priv = dev->dev_private;
402         return dev_priv->backlight_level;
403 }
404
405 static const struct backlight_ops intel_panel_bl_ops = {
406         .update_status = intel_panel_update_status,
407         .get_brightness = intel_panel_get_brightness,
408 };
409
410 int intel_panel_setup_backlight(struct drm_device *dev)
411 {
412         struct drm_i915_private *dev_priv = dev->dev_private;
413         struct backlight_properties props;
414         struct drm_connector *connector;
415
416         intel_panel_init_backlight(dev);
417
418         if (dev_priv->int_lvds_connector)
419                 connector = dev_priv->int_lvds_connector;
420         else if (dev_priv->int_edp_connector)
421                 connector = dev_priv->int_edp_connector;
422         else
423                 return -ENODEV;
424
425         memset(&props, 0, sizeof(props));
426         props.type = BACKLIGHT_RAW;
427         props.max_brightness = intel_panel_get_max_backlight(dev);
428         dev_priv->backlight =
429                 backlight_device_register("intel_backlight",
430                                           &connector->kdev, dev,
431                                           &intel_panel_bl_ops, &props);
432
433         if (IS_ERR(dev_priv->backlight)) {
434                 DRM_ERROR("Failed to register backlight: %ld\n",
435                           PTR_ERR(dev_priv->backlight));
436                 dev_priv->backlight = NULL;
437                 return -ENODEV;
438         }
439         dev_priv->backlight->props.brightness = intel_panel_get_backlight(dev);
440         return 0;
441 }
442
443 void intel_panel_destroy_backlight(struct drm_device *dev)
444 {
445         struct drm_i915_private *dev_priv = dev->dev_private;
446         if (dev_priv->backlight)
447                 backlight_device_unregister(dev_priv->backlight);
448 }
449 #else
450 int intel_panel_setup_backlight(struct drm_device *dev)
451 {
452         intel_panel_init_backlight(dev);
453         return 0;
454 }
455
456 void intel_panel_destroy_backlight(struct drm_device *dev)
457 {
458         return;
459 }
460 #endif