]> Pileus Git - ~andy/linux/blob - drivers/gpu/drm/i915/intel_opregion.c
drm/i915: add plumbing for SWSCI
[~andy/linux] / drivers / gpu / drm / i915 / intel_opregion.c
1 /*
2  * Copyright 2008 Intel Corporation <hong.liu@intel.com>
3  * Copyright 2008 Red Hat <mjg@redhat.com>
4  *
5  * Permission is hereby granted, free of charge, to any person obtaining
6  * a copy of this software and associated documentation files (the
7  * "Software"), to deal in the Software without restriction, including
8  * without limitation the rights to use, copy, modify, merge, publish,
9  * distribute, sub license, and/or sell copies of the Software, and to
10  * permit persons to whom the Software is furnished to do so, subject to
11  * the following conditions:
12  *
13  * The above copyright notice and this permission notice (including the
14  * next paragraph) shall be included in all copies or substantial
15  * portions of the Software.
16  *
17  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
18  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
19  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
20  * NON-INFRINGEMENT.  IN NO EVENT SHALL INTEL AND/OR ITS SUPPLIERS BE
21  * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
22  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
23  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
24  * SOFTWARE.
25  *
26  */
27
28 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
29
30 #include <linux/acpi.h>
31 #include <linux/acpi_io.h>
32 #include <acpi/video.h>
33
34 #include <drm/drmP.h>
35 #include <drm/i915_drm.h>
36 #include "i915_drv.h"
37 #include "intel_drv.h"
38
39 #define PCI_ASLE                0xe4
40 #define PCI_ASLS                0xfc
41 #define PCI_SWSCI               0xe8
42 #define PCI_SWSCI_SCISEL        (1 << 15)
43 #define PCI_SWSCI_GSSCIE        (1 << 0)
44
45 #define OPREGION_HEADER_OFFSET 0
46 #define OPREGION_ACPI_OFFSET   0x100
47 #define   ACPI_CLID 0x01ac /* current lid state indicator */
48 #define   ACPI_CDCK 0x01b0 /* current docking state indicator */
49 #define OPREGION_SWSCI_OFFSET  0x200
50 #define OPREGION_ASLE_OFFSET   0x300
51 #define OPREGION_VBT_OFFSET    0x400
52
53 #define OPREGION_SIGNATURE "IntelGraphicsMem"
54 #define MBOX_ACPI      (1<<0)
55 #define MBOX_SWSCI     (1<<1)
56 #define MBOX_ASLE      (1<<2)
57
58 struct opregion_header {
59         u8 signature[16];
60         u32 size;
61         u32 opregion_ver;
62         u8 bios_ver[32];
63         u8 vbios_ver[16];
64         u8 driver_ver[16];
65         u32 mboxes;
66         u8 reserved[164];
67 } __attribute__((packed));
68
69 /* OpRegion mailbox #1: public ACPI methods */
70 struct opregion_acpi {
71         u32 drdy;       /* driver readiness */
72         u32 csts;       /* notification status */
73         u32 cevt;       /* current event */
74         u8 rsvd1[20];
75         u32 didl[8];    /* supported display devices ID list */
76         u32 cpdl[8];    /* currently presented display list */
77         u32 cadl[8];    /* currently active display list */
78         u32 nadl[8];    /* next active devices list */
79         u32 aslp;       /* ASL sleep time-out */
80         u32 tidx;       /* toggle table index */
81         u32 chpd;       /* current hotplug enable indicator */
82         u32 clid;       /* current lid state*/
83         u32 cdck;       /* current docking state */
84         u32 sxsw;       /* Sx state resume */
85         u32 evts;       /* ASL supported events */
86         u32 cnot;       /* current OS notification */
87         u32 nrdy;       /* driver status */
88         u8 rsvd2[60];
89 } __attribute__((packed));
90
91 /* OpRegion mailbox #2: SWSCI */
92 struct opregion_swsci {
93         u32 scic;       /* SWSCI command|status|data */
94         u32 parm;       /* command parameters */
95         u32 dslp;       /* driver sleep time-out */
96         u8 rsvd[244];
97 } __attribute__((packed));
98
99 /* OpRegion mailbox #3: ASLE */
100 struct opregion_asle {
101         u32 ardy;       /* driver readiness */
102         u32 aslc;       /* ASLE interrupt command */
103         u32 tche;       /* technology enabled indicator */
104         u32 alsi;       /* current ALS illuminance reading */
105         u32 bclp;       /* backlight brightness to set */
106         u32 pfit;       /* panel fitting state */
107         u32 cblv;       /* current brightness level */
108         u16 bclm[20];   /* backlight level duty cycle mapping table */
109         u32 cpfm;       /* current panel fitting mode */
110         u32 epfm;       /* enabled panel fitting modes */
111         u8 plut[74];    /* panel LUT and identifier */
112         u32 pfmb;       /* PWM freq and min brightness */
113         u8 rsvd[102];
114 } __attribute__((packed));
115
116 /* Driver readiness indicator */
117 #define ASLE_ARDY_READY         (1 << 0)
118 #define ASLE_ARDY_NOT_READY     (0 << 0)
119
120 /* ASLE irq request bits */
121 #define ASLE_SET_ALS_ILLUM     (1 << 0)
122 #define ASLE_SET_BACKLIGHT     (1 << 1)
123 #define ASLE_SET_PFIT          (1 << 2)
124 #define ASLE_SET_PWM_FREQ      (1 << 3)
125 #define ASLE_REQ_MSK           0xf
126
127 /* response bits of ASLE irq request */
128 #define ASLE_ALS_ILLUM_FAILED   (1<<10)
129 #define ASLE_BACKLIGHT_FAILED   (1<<12)
130 #define ASLE_PFIT_FAILED        (1<<14)
131 #define ASLE_PWM_FREQ_FAILED    (1<<16)
132
133 /* Technology enabled indicator */
134 #define ASLE_TCHE_ALS_EN        (1 << 0)
135 #define ASLE_TCHE_BLC_EN        (1 << 1)
136 #define ASLE_TCHE_PFIT_EN       (1 << 2)
137 #define ASLE_TCHE_PFMB_EN       (1 << 3)
138
139 /* ASLE backlight brightness to set */
140 #define ASLE_BCLP_VALID                (1<<31)
141 #define ASLE_BCLP_MSK          (~(1<<31))
142
143 /* ASLE panel fitting request */
144 #define ASLE_PFIT_VALID         (1<<31)
145 #define ASLE_PFIT_CENTER (1<<0)
146 #define ASLE_PFIT_STRETCH_TEXT (1<<1)
147 #define ASLE_PFIT_STRETCH_GFX (1<<2)
148
149 /* PWM frequency and minimum brightness */
150 #define ASLE_PFMB_BRIGHTNESS_MASK (0xff)
151 #define ASLE_PFMB_BRIGHTNESS_VALID (1<<8)
152 #define ASLE_PFMB_PWM_MASK (0x7ffffe00)
153 #define ASLE_PFMB_PWM_VALID (1<<31)
154
155 #define ASLE_CBLV_VALID         (1<<31)
156
157 /* Software System Control Interrupt (SWSCI) */
158 #define SWSCI_SCIC_INDICATOR            (1 << 0)
159 #define SWSCI_SCIC_MAIN_FUNCTION_SHIFT  1
160 #define SWSCI_SCIC_MAIN_FUNCTION_MASK   (0xf << 1)
161 #define SWSCI_SCIC_SUB_FUNCTION_SHIFT   8
162 #define SWSCI_SCIC_SUB_FUNCTION_MASK    (0xff << 8)
163 #define SWSCI_SCIC_EXIT_PARAMETER_SHIFT 8
164 #define SWSCI_SCIC_EXIT_PARAMETER_MASK  (0xff << 8)
165 #define SWSCI_SCIC_EXIT_STATUS_SHIFT    5
166 #define SWSCI_SCIC_EXIT_STATUS_MASK     (7 << 5)
167 #define SWSCI_SCIC_EXIT_STATUS_SUCCESS  1
168
169 #define SWSCI_FUNCTION_CODE(main, sub) \
170         ((main) << SWSCI_SCIC_MAIN_FUNCTION_SHIFT | \
171          (sub) << SWSCI_SCIC_SUB_FUNCTION_SHIFT)
172
173 /* SWSCI: Get BIOS Data (GBDA) */
174 #define SWSCI_GBDA                      4
175 #define SWSCI_GBDA_SUPPORTED_CALLS      SWSCI_FUNCTION_CODE(SWSCI_GBDA, 0)
176 #define SWSCI_GBDA_REQUESTED_CALLBACKS  SWSCI_FUNCTION_CODE(SWSCI_GBDA, 1)
177 #define SWSCI_GBDA_BOOT_DISPLAY_PREF    SWSCI_FUNCTION_CODE(SWSCI_GBDA, 4)
178 #define SWSCI_GBDA_PANEL_DETAILS        SWSCI_FUNCTION_CODE(SWSCI_GBDA, 5)
179 #define SWSCI_GBDA_TV_STANDARD          SWSCI_FUNCTION_CODE(SWSCI_GBDA, 6)
180 #define SWSCI_GBDA_INTERNAL_GRAPHICS    SWSCI_FUNCTION_CODE(SWSCI_GBDA, 7)
181 #define SWSCI_GBDA_SPREAD_SPECTRUM      SWSCI_FUNCTION_CODE(SWSCI_GBDA, 10)
182
183 /* SWSCI: System BIOS Callbacks (SBCB) */
184 #define SWSCI_SBCB                      6
185 #define SWSCI_SBCB_SUPPORTED_CALLBACKS  SWSCI_FUNCTION_CODE(SWSCI_SBCB, 0)
186 #define SWSCI_SBCB_INIT_COMPLETION      SWSCI_FUNCTION_CODE(SWSCI_SBCB, 1)
187 #define SWSCI_SBCB_PRE_HIRES_SET_MODE   SWSCI_FUNCTION_CODE(SWSCI_SBCB, 3)
188 #define SWSCI_SBCB_POST_HIRES_SET_MODE  SWSCI_FUNCTION_CODE(SWSCI_SBCB, 4)
189 #define SWSCI_SBCB_DISPLAY_SWITCH       SWSCI_FUNCTION_CODE(SWSCI_SBCB, 5)
190 #define SWSCI_SBCB_SET_TV_FORMAT        SWSCI_FUNCTION_CODE(SWSCI_SBCB, 6)
191 #define SWSCI_SBCB_ADAPTER_POWER_STATE  SWSCI_FUNCTION_CODE(SWSCI_SBCB, 7)
192 #define SWSCI_SBCB_DISPLAY_POWER_STATE  SWSCI_FUNCTION_CODE(SWSCI_SBCB, 8)
193 #define SWSCI_SBCB_SET_BOOT_DISPLAY     SWSCI_FUNCTION_CODE(SWSCI_SBCB, 9)
194 #define SWSCI_SBCB_SET_PANEL_DETAILS    SWSCI_FUNCTION_CODE(SWSCI_SBCB, 10)
195 #define SWSCI_SBCB_SET_INTERNAL_GFX     SWSCI_FUNCTION_CODE(SWSCI_SBCB, 11)
196 #define SWSCI_SBCB_POST_HIRES_TO_DOS_FS SWSCI_FUNCTION_CODE(SWSCI_SBCB, 16)
197 #define SWSCI_SBCB_SUSPEND_RESUME       SWSCI_FUNCTION_CODE(SWSCI_SBCB, 17)
198 #define SWSCI_SBCB_SET_SPREAD_SPECTRUM  SWSCI_FUNCTION_CODE(SWSCI_SBCB, 18)
199 #define SWSCI_SBCB_POST_VBE_PM          SWSCI_FUNCTION_CODE(SWSCI_SBCB, 19)
200 #define SWSCI_SBCB_ENABLE_DISABLE_AUDIO SWSCI_FUNCTION_CODE(SWSCI_SBCB, 21)
201
202 #define ACPI_OTHER_OUTPUT (0<<8)
203 #define ACPI_VGA_OUTPUT (1<<8)
204 #define ACPI_TV_OUTPUT (2<<8)
205 #define ACPI_DIGITAL_OUTPUT (3<<8)
206 #define ACPI_LVDS_OUTPUT (4<<8)
207
208 #ifdef CONFIG_ACPI
209 static int swsci(struct drm_device *dev, u32 function, u32 parm, u32 *parm_out)
210 {
211         struct drm_i915_private *dev_priv = dev->dev_private;
212         struct opregion_swsci __iomem *swsci = dev_priv->opregion.swsci;
213         u32 main_function, sub_function, scic;
214         u16 pci_swsci;
215         u32 dslp;
216
217         if (!swsci)
218                 return -ENODEV;
219
220         main_function = (function & SWSCI_SCIC_MAIN_FUNCTION_MASK) >>
221                 SWSCI_SCIC_MAIN_FUNCTION_SHIFT;
222         sub_function = (function & SWSCI_SCIC_SUB_FUNCTION_MASK) >>
223                 SWSCI_SCIC_SUB_FUNCTION_SHIFT;
224
225         /* Check if we can call the function. See swsci_setup for details. */
226         if (main_function == SWSCI_SBCB) {
227                 if ((dev_priv->opregion.swsci_sbcb_sub_functions &
228                      (1 << sub_function)) == 0)
229                         return -EINVAL;
230         } else if (main_function == SWSCI_GBDA) {
231                 if ((dev_priv->opregion.swsci_gbda_sub_functions &
232                      (1 << sub_function)) == 0)
233                         return -EINVAL;
234         }
235
236         /* Driver sleep timeout in ms. */
237         dslp = ioread32(&swsci->dslp);
238         if (!dslp) {
239                 dslp = 2;
240         } else if (dslp > 500) {
241                 /* Hey bios, trust must be earned. */
242                 WARN_ONCE(1, "excessive driver sleep timeout (DSPL) %u\n", dslp);
243                 dslp = 500;
244         }
245
246         /* The spec tells us to do this, but we are the only user... */
247         scic = ioread32(&swsci->scic);
248         if (scic & SWSCI_SCIC_INDICATOR) {
249                 DRM_DEBUG_DRIVER("SWSCI request already in progress\n");
250                 return -EBUSY;
251         }
252
253         scic = function | SWSCI_SCIC_INDICATOR;
254
255         iowrite32(parm, &swsci->parm);
256         iowrite32(scic, &swsci->scic);
257
258         /* Ensure SCI event is selected and event trigger is cleared. */
259         pci_read_config_word(dev->pdev, PCI_SWSCI, &pci_swsci);
260         if (!(pci_swsci & PCI_SWSCI_SCISEL) || (pci_swsci & PCI_SWSCI_GSSCIE)) {
261                 pci_swsci |= PCI_SWSCI_SCISEL;
262                 pci_swsci &= ~PCI_SWSCI_GSSCIE;
263                 pci_write_config_word(dev->pdev, PCI_SWSCI, pci_swsci);
264         }
265
266         /* Use event trigger to tell bios to check the mail. */
267         pci_swsci |= PCI_SWSCI_GSSCIE;
268         pci_write_config_word(dev->pdev, PCI_SWSCI, pci_swsci);
269
270         /* Poll for the result. */
271 #define C (((scic = ioread32(&swsci->scic)) & SWSCI_SCIC_INDICATOR) == 0)
272         if (wait_for(C, dslp)) {
273                 DRM_DEBUG_DRIVER("SWSCI request timed out\n");
274                 return -ETIMEDOUT;
275         }
276
277         scic = (scic & SWSCI_SCIC_EXIT_STATUS_MASK) >>
278                 SWSCI_SCIC_EXIT_STATUS_SHIFT;
279
280         /* Note: scic == 0 is an error! */
281         if (scic != SWSCI_SCIC_EXIT_STATUS_SUCCESS) {
282                 DRM_DEBUG_DRIVER("SWSCI request error %u\n", scic);
283                 return -EIO;
284         }
285
286         if (parm_out)
287                 *parm_out = ioread32(&swsci->parm);
288
289         return 0;
290
291 #undef C
292 }
293
294 static u32 asle_set_backlight(struct drm_device *dev, u32 bclp)
295 {
296         struct drm_i915_private *dev_priv = dev->dev_private;
297         struct opregion_asle __iomem *asle = dev_priv->opregion.asle;
298
299         DRM_DEBUG_DRIVER("bclp = 0x%08x\n", bclp);
300
301         if (!(bclp & ASLE_BCLP_VALID))
302                 return ASLE_BACKLIGHT_FAILED;
303
304         bclp &= ASLE_BCLP_MSK;
305         if (bclp > 255)
306                 return ASLE_BACKLIGHT_FAILED;
307
308         intel_panel_set_backlight(dev, bclp, 255);
309         iowrite32((bclp*0x64)/0xff | ASLE_CBLV_VALID, &asle->cblv);
310
311         return 0;
312 }
313
314 static u32 asle_set_als_illum(struct drm_device *dev, u32 alsi)
315 {
316         /* alsi is the current ALS reading in lux. 0 indicates below sensor
317            range, 0xffff indicates above sensor range. 1-0xfffe are valid */
318         DRM_DEBUG_DRIVER("Illum is not supported\n");
319         return ASLE_ALS_ILLUM_FAILED;
320 }
321
322 static u32 asle_set_pwm_freq(struct drm_device *dev, u32 pfmb)
323 {
324         DRM_DEBUG_DRIVER("PWM freq is not supported\n");
325         return ASLE_PWM_FREQ_FAILED;
326 }
327
328 static u32 asle_set_pfit(struct drm_device *dev, u32 pfit)
329 {
330         /* Panel fitting is currently controlled by the X code, so this is a
331            noop until modesetting support works fully */
332         DRM_DEBUG_DRIVER("Pfit is not supported\n");
333         return ASLE_PFIT_FAILED;
334 }
335
336 void intel_opregion_asle_intr(struct drm_device *dev)
337 {
338         struct drm_i915_private *dev_priv = dev->dev_private;
339         struct opregion_asle __iomem *asle = dev_priv->opregion.asle;
340         u32 asle_stat = 0;
341         u32 asle_req;
342
343         if (!asle)
344                 return;
345
346         asle_req = ioread32(&asle->aslc) & ASLE_REQ_MSK;
347
348         if (!asle_req) {
349                 DRM_DEBUG_DRIVER("non asle set request??\n");
350                 return;
351         }
352
353         if (asle_req & ASLE_SET_ALS_ILLUM)
354                 asle_stat |= asle_set_als_illum(dev, ioread32(&asle->alsi));
355
356         if (asle_req & ASLE_SET_BACKLIGHT)
357                 asle_stat |= asle_set_backlight(dev, ioread32(&asle->bclp));
358
359         if (asle_req & ASLE_SET_PFIT)
360                 asle_stat |= asle_set_pfit(dev, ioread32(&asle->pfit));
361
362         if (asle_req & ASLE_SET_PWM_FREQ)
363                 asle_stat |= asle_set_pwm_freq(dev, ioread32(&asle->pfmb));
364
365         iowrite32(asle_stat, &asle->aslc);
366 }
367
368 #define ACPI_EV_DISPLAY_SWITCH (1<<0)
369 #define ACPI_EV_LID            (1<<1)
370 #define ACPI_EV_DOCK           (1<<2)
371
372 static struct intel_opregion *system_opregion;
373
374 static int intel_opregion_video_event(struct notifier_block *nb,
375                                       unsigned long val, void *data)
376 {
377         /* The only video events relevant to opregion are 0x80. These indicate
378            either a docking event, lid switch or display switch request. In
379            Linux, these are handled by the dock, button and video drivers.
380         */
381
382         struct opregion_acpi __iomem *acpi;
383         struct acpi_bus_event *event = data;
384         int ret = NOTIFY_OK;
385
386         if (strcmp(event->device_class, ACPI_VIDEO_CLASS) != 0)
387                 return NOTIFY_DONE;
388
389         if (!system_opregion)
390                 return NOTIFY_DONE;
391
392         acpi = system_opregion->acpi;
393
394         if (event->type == 0x80 &&
395             (ioread32(&acpi->cevt) & 1) == 0)
396                 ret = NOTIFY_BAD;
397
398         iowrite32(0, &acpi->csts);
399
400         return ret;
401 }
402
403 static struct notifier_block intel_opregion_notifier = {
404         .notifier_call = intel_opregion_video_event,
405 };
406
407 /*
408  * Initialise the DIDL field in opregion. This passes a list of devices to
409  * the firmware. Values are defined by section B.4.2 of the ACPI specification
410  * (version 3)
411  */
412
413 static void intel_didl_outputs(struct drm_device *dev)
414 {
415         struct drm_i915_private *dev_priv = dev->dev_private;
416         struct intel_opregion *opregion = &dev_priv->opregion;
417         struct drm_connector *connector;
418         acpi_handle handle;
419         struct acpi_device *acpi_dev, *acpi_cdev, *acpi_video_bus = NULL;
420         unsigned long long device_id;
421         acpi_status status;
422         u32 temp;
423         int i = 0;
424
425         handle = DEVICE_ACPI_HANDLE(&dev->pdev->dev);
426         if (!handle || acpi_bus_get_device(handle, &acpi_dev))
427                 return;
428
429         if (acpi_is_video_device(handle))
430                 acpi_video_bus = acpi_dev;
431         else {
432                 list_for_each_entry(acpi_cdev, &acpi_dev->children, node) {
433                         if (acpi_is_video_device(acpi_cdev->handle)) {
434                                 acpi_video_bus = acpi_cdev;
435                                 break;
436                         }
437                 }
438         }
439
440         if (!acpi_video_bus) {
441                 pr_warn("No ACPI video bus found\n");
442                 return;
443         }
444
445         list_for_each_entry(acpi_cdev, &acpi_video_bus->children, node) {
446                 if (i >= 8) {
447                         dev_dbg(&dev->pdev->dev,
448                                 "More than 8 outputs detected via ACPI\n");
449                         return;
450                 }
451                 status =
452                         acpi_evaluate_integer(acpi_cdev->handle, "_ADR",
453                                                 NULL, &device_id);
454                 if (ACPI_SUCCESS(status)) {
455                         if (!device_id)
456                                 goto blind_set;
457                         iowrite32((u32)(device_id & 0x0f0f),
458                                   &opregion->acpi->didl[i]);
459                         i++;
460                 }
461         }
462
463 end:
464         /* If fewer than 8 outputs, the list must be null terminated */
465         if (i < 8)
466                 iowrite32(0, &opregion->acpi->didl[i]);
467         return;
468
469 blind_set:
470         i = 0;
471         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
472                 int output_type = ACPI_OTHER_OUTPUT;
473                 if (i >= 8) {
474                         dev_dbg(&dev->pdev->dev,
475                                 "More than 8 outputs in connector list\n");
476                         return;
477                 }
478                 switch (connector->connector_type) {
479                 case DRM_MODE_CONNECTOR_VGA:
480                 case DRM_MODE_CONNECTOR_DVIA:
481                         output_type = ACPI_VGA_OUTPUT;
482                         break;
483                 case DRM_MODE_CONNECTOR_Composite:
484                 case DRM_MODE_CONNECTOR_SVIDEO:
485                 case DRM_MODE_CONNECTOR_Component:
486                 case DRM_MODE_CONNECTOR_9PinDIN:
487                         output_type = ACPI_TV_OUTPUT;
488                         break;
489                 case DRM_MODE_CONNECTOR_DVII:
490                 case DRM_MODE_CONNECTOR_DVID:
491                 case DRM_MODE_CONNECTOR_DisplayPort:
492                 case DRM_MODE_CONNECTOR_HDMIA:
493                 case DRM_MODE_CONNECTOR_HDMIB:
494                         output_type = ACPI_DIGITAL_OUTPUT;
495                         break;
496                 case DRM_MODE_CONNECTOR_LVDS:
497                         output_type = ACPI_LVDS_OUTPUT;
498                         break;
499                 }
500                 temp = ioread32(&opregion->acpi->didl[i]);
501                 iowrite32(temp | (1<<31) | output_type | i,
502                           &opregion->acpi->didl[i]);
503                 i++;
504         }
505         goto end;
506 }
507
508 static void intel_setup_cadls(struct drm_device *dev)
509 {
510         struct drm_i915_private *dev_priv = dev->dev_private;
511         struct intel_opregion *opregion = &dev_priv->opregion;
512         int i = 0;
513         u32 disp_id;
514
515         /* Initialize the CADL field by duplicating the DIDL values.
516          * Technically, this is not always correct as display outputs may exist,
517          * but not active. This initialization is necessary for some Clevo
518          * laptops that check this field before processing the brightness and
519          * display switching hotkeys. Just like DIDL, CADL is NULL-terminated if
520          * there are less than eight devices. */
521         do {
522                 disp_id = ioread32(&opregion->acpi->didl[i]);
523                 iowrite32(disp_id, &opregion->acpi->cadl[i]);
524         } while (++i < 8 && disp_id != 0);
525 }
526
527 void intel_opregion_init(struct drm_device *dev)
528 {
529         struct drm_i915_private *dev_priv = dev->dev_private;
530         struct intel_opregion *opregion = &dev_priv->opregion;
531
532         if (!opregion->header)
533                 return;
534
535         if (opregion->acpi) {
536                 if (drm_core_check_feature(dev, DRIVER_MODESET)) {
537                         intel_didl_outputs(dev);
538                         intel_setup_cadls(dev);
539                 }
540
541                 /* Notify BIOS we are ready to handle ACPI video ext notifs.
542                  * Right now, all the events are handled by the ACPI video module.
543                  * We don't actually need to do anything with them. */
544                 iowrite32(0, &opregion->acpi->csts);
545                 iowrite32(1, &opregion->acpi->drdy);
546
547                 system_opregion = opregion;
548                 register_acpi_notifier(&intel_opregion_notifier);
549         }
550
551         if (opregion->asle) {
552                 iowrite32(ASLE_TCHE_BLC_EN, &opregion->asle->tche);
553                 iowrite32(ASLE_ARDY_READY, &opregion->asle->ardy);
554         }
555 }
556
557 void intel_opregion_fini(struct drm_device *dev)
558 {
559         struct drm_i915_private *dev_priv = dev->dev_private;
560         struct intel_opregion *opregion = &dev_priv->opregion;
561
562         if (!opregion->header)
563                 return;
564
565         if (opregion->asle)
566                 iowrite32(ASLE_ARDY_NOT_READY, &opregion->asle->ardy);
567
568         if (opregion->acpi) {
569                 iowrite32(0, &opregion->acpi->drdy);
570
571                 system_opregion = NULL;
572                 unregister_acpi_notifier(&intel_opregion_notifier);
573         }
574
575         /* just clear all opregion memory pointers now */
576         iounmap(opregion->header);
577         opregion->header = NULL;
578         opregion->acpi = NULL;
579         opregion->swsci = NULL;
580         opregion->asle = NULL;
581         opregion->vbt = NULL;
582 }
583
584 static void swsci_setup(struct drm_device *dev)
585 {
586         struct drm_i915_private *dev_priv = dev->dev_private;
587         struct intel_opregion *opregion = &dev_priv->opregion;
588         bool requested_callbacks = false;
589         u32 tmp;
590
591         /* Sub-function code 0 is okay, let's allow them. */
592         opregion->swsci_gbda_sub_functions = 1;
593         opregion->swsci_sbcb_sub_functions = 1;
594
595         /* We use GBDA to ask for supported GBDA calls. */
596         if (swsci(dev, SWSCI_GBDA_SUPPORTED_CALLS, 0, &tmp) == 0) {
597                 /* make the bits match the sub-function codes */
598                 tmp <<= 1;
599                 opregion->swsci_gbda_sub_functions |= tmp;
600         }
601
602         /*
603          * We also use GBDA to ask for _requested_ SBCB callbacks. The driver
604          * must not call interfaces that are not specifically requested by the
605          * bios.
606          */
607         if (swsci(dev, SWSCI_GBDA_REQUESTED_CALLBACKS, 0, &tmp) == 0) {
608                 /* here, the bits already match sub-function codes */
609                 opregion->swsci_sbcb_sub_functions |= tmp;
610                 requested_callbacks = true;
611         }
612
613         /*
614          * But we use SBCB to ask for _supported_ SBCB calls. This does not mean
615          * the callback is _requested_. But we still can't call interfaces that
616          * are not requested.
617          */
618         if (swsci(dev, SWSCI_SBCB_SUPPORTED_CALLBACKS, 0, &tmp) == 0) {
619                 /* make the bits match the sub-function codes */
620                 u32 low = tmp & 0x7ff;
621                 u32 high = tmp & ~0xfff; /* bit 11 is reserved */
622                 tmp = (high << 4) | (low << 1) | 1;
623
624                 /* best guess what to do with supported wrt requested */
625                 if (requested_callbacks) {
626                         u32 req = opregion->swsci_sbcb_sub_functions;
627                         if ((req & tmp) != req)
628                                 DRM_DEBUG_DRIVER("SWSCI BIOS requested (%08x) SBCB callbacks that are not supported (%08x)\n", req, tmp);
629                         /* XXX: for now, trust the requested callbacks */
630                         /* opregion->swsci_sbcb_sub_functions &= tmp; */
631                 } else {
632                         opregion->swsci_sbcb_sub_functions |= tmp;
633                 }
634         }
635
636         DRM_DEBUG_DRIVER("SWSCI GBDA callbacks %08x, SBCB callbacks %08x\n",
637                          opregion->swsci_gbda_sub_functions,
638                          opregion->swsci_sbcb_sub_functions);
639 }
640 #else /* CONFIG_ACPI */
641 static inline void swsci_setup(struct drm_device *dev) {}
642 #endif  /* CONFIG_ACPI */
643
644 int intel_opregion_setup(struct drm_device *dev)
645 {
646         struct drm_i915_private *dev_priv = dev->dev_private;
647         struct intel_opregion *opregion = &dev_priv->opregion;
648         void __iomem *base;
649         u32 asls, mboxes;
650         char buf[sizeof(OPREGION_SIGNATURE)];
651         int err = 0;
652
653         pci_read_config_dword(dev->pdev, PCI_ASLS, &asls);
654         DRM_DEBUG_DRIVER("graphic opregion physical addr: 0x%x\n", asls);
655         if (asls == 0) {
656                 DRM_DEBUG_DRIVER("ACPI OpRegion not supported!\n");
657                 return -ENOTSUPP;
658         }
659
660         base = acpi_os_ioremap(asls, OPREGION_SIZE);
661         if (!base)
662                 return -ENOMEM;
663
664         memcpy_fromio(buf, base, sizeof(buf));
665
666         if (memcmp(buf, OPREGION_SIGNATURE, 16)) {
667                 DRM_DEBUG_DRIVER("opregion signature mismatch\n");
668                 err = -EINVAL;
669                 goto err_out;
670         }
671         opregion->header = base;
672         opregion->vbt = base + OPREGION_VBT_OFFSET;
673
674         opregion->lid_state = base + ACPI_CLID;
675
676         mboxes = ioread32(&opregion->header->mboxes);
677         if (mboxes & MBOX_ACPI) {
678                 DRM_DEBUG_DRIVER("Public ACPI methods supported\n");
679                 opregion->acpi = base + OPREGION_ACPI_OFFSET;
680         }
681
682         if (mboxes & MBOX_SWSCI) {
683                 DRM_DEBUG_DRIVER("SWSCI supported\n");
684                 opregion->swsci = base + OPREGION_SWSCI_OFFSET;
685                 swsci_setup(dev);
686         }
687         if (mboxes & MBOX_ASLE) {
688                 DRM_DEBUG_DRIVER("ASLE supported\n");
689                 opregion->asle = base + OPREGION_ASLE_OFFSET;
690
691                 iowrite32(ASLE_ARDY_NOT_READY, &opregion->asle->ardy);
692         }
693
694         return 0;
695
696 err_out:
697         iounmap(base);
698         return err;
699 }