Commit | Line | Data |
---|---|---|
8ee1c3db MG |
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 | ||
a70491cc JP |
28 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
29 | ||
8ee1c3db | 30 | #include <linux/acpi.h> |
b705120e | 31 | #include <linux/acpi_io.h> |
74a365b3 | 32 | #include <acpi/video.h> |
8ee1c3db MG |
33 | |
34 | #include "drmP.h" | |
35 | #include "i915_drm.h" | |
36 | #include "i915_drv.h" | |
a9573556 | 37 | #include "intel_drv.h" |
8ee1c3db MG |
38 | |
39 | #define PCI_ASLE 0xe4 | |
8ee1c3db MG |
40 | #define PCI_ASLS 0xfc |
41 | ||
8ee1c3db MG |
42 | #define OPREGION_HEADER_OFFSET 0 |
43 | #define OPREGION_ACPI_OFFSET 0x100 | |
82d3c90c CW |
44 | #define ACPI_CLID 0x01ac /* current lid state indicator */ |
45 | #define ACPI_CDCK 0x01b0 /* current docking state indicator */ | |
8ee1c3db MG |
46 | #define OPREGION_SWSCI_OFFSET 0x200 |
47 | #define OPREGION_ASLE_OFFSET 0x300 | |
44834a67 | 48 | #define OPREGION_VBT_OFFSET 0x400 |
8ee1c3db MG |
49 | |
50 | #define OPREGION_SIGNATURE "IntelGraphicsMem" | |
51 | #define MBOX_ACPI (1<<0) | |
52 | #define MBOX_SWSCI (1<<1) | |
53 | #define MBOX_ASLE (1<<2) | |
54 | ||
55 | struct opregion_header { | |
0206e353 AJ |
56 | u8 signature[16]; |
57 | u32 size; | |
58 | u32 opregion_ver; | |
59 | u8 bios_ver[32]; | |
60 | u8 vbios_ver[16]; | |
61 | u8 driver_ver[16]; | |
62 | u32 mboxes; | |
63 | u8 reserved[164]; | |
8ee1c3db MG |
64 | } __attribute__((packed)); |
65 | ||
66 | /* OpRegion mailbox #1: public ACPI methods */ | |
67 | struct opregion_acpi { | |
0206e353 AJ |
68 | u32 drdy; /* driver readiness */ |
69 | u32 csts; /* notification status */ | |
70 | u32 cevt; /* current event */ | |
71 | u8 rsvd1[20]; | |
72 | u32 didl[8]; /* supported display devices ID list */ | |
73 | u32 cpdl[8]; /* currently presented display list */ | |
74 | u32 cadl[8]; /* currently active display list */ | |
75 | u32 nadl[8]; /* next active devices list */ | |
76 | u32 aslp; /* ASL sleep time-out */ | |
77 | u32 tidx; /* toggle table index */ | |
78 | u32 chpd; /* current hotplug enable indicator */ | |
79 | u32 clid; /* current lid state*/ | |
80 | u32 cdck; /* current docking state */ | |
81 | u32 sxsw; /* Sx state resume */ | |
82 | u32 evts; /* ASL supported events */ | |
83 | u32 cnot; /* current OS notification */ | |
84 | u32 nrdy; /* driver status */ | |
85 | u8 rsvd2[60]; | |
8ee1c3db MG |
86 | } __attribute__((packed)); |
87 | ||
88 | /* OpRegion mailbox #2: SWSCI */ | |
89 | struct opregion_swsci { | |
0206e353 AJ |
90 | u32 scic; /* SWSCI command|status|data */ |
91 | u32 parm; /* command parameters */ | |
92 | u32 dslp; /* driver sleep time-out */ | |
93 | u8 rsvd[244]; | |
8ee1c3db MG |
94 | } __attribute__((packed)); |
95 | ||
96 | /* OpRegion mailbox #3: ASLE */ | |
97 | struct opregion_asle { | |
0206e353 AJ |
98 | u32 ardy; /* driver readiness */ |
99 | u32 aslc; /* ASLE interrupt command */ | |
100 | u32 tche; /* technology enabled indicator */ | |
101 | u32 alsi; /* current ALS illuminance reading */ | |
102 | u32 bclp; /* backlight brightness to set */ | |
103 | u32 pfit; /* panel fitting state */ | |
104 | u32 cblv; /* current brightness level */ | |
105 | u16 bclm[20]; /* backlight level duty cycle mapping table */ | |
106 | u32 cpfm; /* current panel fitting mode */ | |
107 | u32 epfm; /* enabled panel fitting modes */ | |
108 | u8 plut[74]; /* panel LUT and identifier */ | |
109 | u32 pfmb; /* PWM freq and min brightness */ | |
110 | u8 rsvd[102]; | |
8ee1c3db MG |
111 | } __attribute__((packed)); |
112 | ||
113 | /* ASLE irq request bits */ | |
114 | #define ASLE_SET_ALS_ILLUM (1 << 0) | |
115 | #define ASLE_SET_BACKLIGHT (1 << 1) | |
116 | #define ASLE_SET_PFIT (1 << 2) | |
117 | #define ASLE_SET_PWM_FREQ (1 << 3) | |
118 | #define ASLE_REQ_MSK 0xf | |
119 | ||
120 | /* response bits of ASLE irq request */ | |
01c66889 ZY |
121 | #define ASLE_ALS_ILLUM_FAILED (1<<10) |
122 | #define ASLE_BACKLIGHT_FAILED (1<<12) | |
123 | #define ASLE_PFIT_FAILED (1<<14) | |
124 | #define ASLE_PWM_FREQ_FAILED (1<<16) | |
8ee1c3db MG |
125 | |
126 | /* ASLE backlight brightness to set */ | |
127 | #define ASLE_BCLP_VALID (1<<31) | |
128 | #define ASLE_BCLP_MSK (~(1<<31)) | |
129 | ||
130 | /* ASLE panel fitting request */ | |
131 | #define ASLE_PFIT_VALID (1<<31) | |
132 | #define ASLE_PFIT_CENTER (1<<0) | |
133 | #define ASLE_PFIT_STRETCH_TEXT (1<<1) | |
134 | #define ASLE_PFIT_STRETCH_GFX (1<<2) | |
135 | ||
136 | /* PWM frequency and minimum brightness */ | |
137 | #define ASLE_PFMB_BRIGHTNESS_MASK (0xff) | |
138 | #define ASLE_PFMB_BRIGHTNESS_VALID (1<<8) | |
139 | #define ASLE_PFMB_PWM_MASK (0x7ffffe00) | |
140 | #define ASLE_PFMB_PWM_VALID (1<<31) | |
141 | ||
142 | #define ASLE_CBLV_VALID (1<<31) | |
143 | ||
74a365b3 MG |
144 | #define ACPI_OTHER_OUTPUT (0<<8) |
145 | #define ACPI_VGA_OUTPUT (1<<8) | |
146 | #define ACPI_TV_OUTPUT (2<<8) | |
147 | #define ACPI_DIGITAL_OUTPUT (3<<8) | |
148 | #define ACPI_LVDS_OUTPUT (4<<8) | |
149 | ||
44834a67 | 150 | #ifdef CONFIG_ACPI |
8ee1c3db MG |
151 | static u32 asle_set_backlight(struct drm_device *dev, u32 bclp) |
152 | { | |
153 | struct drm_i915_private *dev_priv = dev->dev_private; | |
5bc4418b | 154 | struct opregion_asle __iomem *asle = dev_priv->opregion.asle; |
a9573556 | 155 | u32 max; |
8ee1c3db MG |
156 | |
157 | if (!(bclp & ASLE_BCLP_VALID)) | |
862daefc | 158 | return ASLE_BACKLIGHT_FAILED; |
8ee1c3db MG |
159 | |
160 | bclp &= ASLE_BCLP_MSK; | |
a9573556 | 161 | if (bclp > 255) |
862daefc | 162 | return ASLE_BACKLIGHT_FAILED; |
8ee1c3db | 163 | |
a9573556 CW |
164 | max = intel_panel_get_max_backlight(dev); |
165 | intel_panel_set_backlight(dev, bclp * max / 255); | |
5bc4418b | 166 | iowrite32((bclp*0x64)/0xff | ASLE_CBLV_VALID, &asle->cblv); |
8ee1c3db MG |
167 | |
168 | return 0; | |
169 | } | |
170 | ||
171 | static u32 asle_set_als_illum(struct drm_device *dev, u32 alsi) | |
172 | { | |
173 | /* alsi is the current ALS reading in lux. 0 indicates below sensor | |
174 | range, 0xffff indicates above sensor range. 1-0xfffe are valid */ | |
175 | return 0; | |
176 | } | |
177 | ||
178 | static u32 asle_set_pwm_freq(struct drm_device *dev, u32 pfmb) | |
179 | { | |
180 | struct drm_i915_private *dev_priv = dev->dev_private; | |
181 | if (pfmb & ASLE_PFMB_PWM_VALID) { | |
182 | u32 blc_pwm_ctl = I915_READ(BLC_PWM_CTL); | |
183 | u32 pwm = pfmb & ASLE_PFMB_PWM_MASK; | |
184 | blc_pwm_ctl &= BACKLIGHT_DUTY_CYCLE_MASK; | |
185 | pwm = pwm >> 9; | |
186 | /* FIXME - what do we do with the PWM? */ | |
187 | } | |
188 | return 0; | |
189 | } | |
190 | ||
191 | static u32 asle_set_pfit(struct drm_device *dev, u32 pfit) | |
192 | { | |
193 | /* Panel fitting is currently controlled by the X code, so this is a | |
194 | noop until modesetting support works fully */ | |
195 | if (!(pfit & ASLE_PFIT_VALID)) | |
862daefc | 196 | return ASLE_PFIT_FAILED; |
8ee1c3db MG |
197 | return 0; |
198 | } | |
199 | ||
3b617967 | 200 | void intel_opregion_asle_intr(struct drm_device *dev) |
8ee1c3db MG |
201 | { |
202 | struct drm_i915_private *dev_priv = dev->dev_private; | |
5bc4418b | 203 | struct opregion_asle __iomem *asle = dev_priv->opregion.asle; |
8ee1c3db MG |
204 | u32 asle_stat = 0; |
205 | u32 asle_req; | |
206 | ||
207 | if (!asle) | |
208 | return; | |
209 | ||
5bc4418b | 210 | asle_req = ioread32(&asle->aslc) & ASLE_REQ_MSK; |
8ee1c3db MG |
211 | |
212 | if (!asle_req) { | |
44d98a61 | 213 | DRM_DEBUG_DRIVER("non asle set request??\n"); |
8ee1c3db MG |
214 | return; |
215 | } | |
216 | ||
217 | if (asle_req & ASLE_SET_ALS_ILLUM) | |
5bc4418b | 218 | asle_stat |= asle_set_als_illum(dev, ioread32(&asle->alsi)); |
8ee1c3db MG |
219 | |
220 | if (asle_req & ASLE_SET_BACKLIGHT) | |
5bc4418b | 221 | asle_stat |= asle_set_backlight(dev, ioread32(&asle->bclp)); |
8ee1c3db MG |
222 | |
223 | if (asle_req & ASLE_SET_PFIT) | |
5bc4418b | 224 | asle_stat |= asle_set_pfit(dev, ioread32(&asle->pfit)); |
8ee1c3db MG |
225 | |
226 | if (asle_req & ASLE_SET_PWM_FREQ) | |
5bc4418b | 227 | asle_stat |= asle_set_pwm_freq(dev, ioread32(&asle->pfmb)); |
8ee1c3db | 228 | |
5bc4418b | 229 | iowrite32(asle_stat, &asle->aslc); |
8ee1c3db MG |
230 | } |
231 | ||
3b617967 | 232 | void intel_opregion_gse_intr(struct drm_device *dev) |
01c66889 ZY |
233 | { |
234 | struct drm_i915_private *dev_priv = dev->dev_private; | |
5bc4418b | 235 | struct opregion_asle __iomem *asle = dev_priv->opregion.asle; |
01c66889 ZY |
236 | u32 asle_stat = 0; |
237 | u32 asle_req; | |
238 | ||
239 | if (!asle) | |
240 | return; | |
241 | ||
5bc4418b | 242 | asle_req = ioread32(&asle->aslc) & ASLE_REQ_MSK; |
01c66889 ZY |
243 | |
244 | if (!asle_req) { | |
245 | DRM_DEBUG_DRIVER("non asle set request??\n"); | |
246 | return; | |
247 | } | |
248 | ||
249 | if (asle_req & ASLE_SET_ALS_ILLUM) { | |
250 | DRM_DEBUG_DRIVER("Illum is not supported\n"); | |
251 | asle_stat |= ASLE_ALS_ILLUM_FAILED; | |
252 | } | |
253 | ||
254 | if (asle_req & ASLE_SET_BACKLIGHT) | |
5bc4418b | 255 | asle_stat |= asle_set_backlight(dev, ioread32(&asle->bclp)); |
01c66889 ZY |
256 | |
257 | if (asle_req & ASLE_SET_PFIT) { | |
258 | DRM_DEBUG_DRIVER("Pfit is not supported\n"); | |
259 | asle_stat |= ASLE_PFIT_FAILED; | |
260 | } | |
261 | ||
262 | if (asle_req & ASLE_SET_PWM_FREQ) { | |
263 | DRM_DEBUG_DRIVER("PWM freq is not supported\n"); | |
264 | asle_stat |= ASLE_PWM_FREQ_FAILED; | |
265 | } | |
266 | ||
5bc4418b | 267 | iowrite32(asle_stat, &asle->aslc); |
01c66889 | 268 | } |
8ee1c3db MG |
269 | #define ASLE_ALS_EN (1<<0) |
270 | #define ASLE_BLC_EN (1<<1) | |
271 | #define ASLE_PFIT_EN (1<<2) | |
272 | #define ASLE_PFMB_EN (1<<3) | |
273 | ||
3b617967 | 274 | void intel_opregion_enable_asle(struct drm_device *dev) |
8ee1c3db MG |
275 | { |
276 | struct drm_i915_private *dev_priv = dev->dev_private; | |
5bc4418b | 277 | struct opregion_asle __iomem *asle = dev_priv->opregion.asle; |
8ee1c3db MG |
278 | |
279 | if (asle) { | |
1ec14ad3 | 280 | if (IS_MOBILE(dev)) |
01c66889 | 281 | intel_enable_asle(dev); |
8ee1c3db | 282 | |
5bc4418b BW |
283 | iowrite32(ASLE_ALS_EN | ASLE_BLC_EN | ASLE_PFIT_EN | |
284 | ASLE_PFMB_EN, | |
285 | &asle->tche); | |
286 | iowrite32(1, &asle->ardy); | |
8ee1c3db MG |
287 | } |
288 | } | |
289 | ||
290 | #define ACPI_EV_DISPLAY_SWITCH (1<<0) | |
291 | #define ACPI_EV_LID (1<<1) | |
292 | #define ACPI_EV_DOCK (1<<2) | |
293 | ||
294 | static struct intel_opregion *system_opregion; | |
295 | ||
b358d0a6 HE |
296 | static int intel_opregion_video_event(struct notifier_block *nb, |
297 | unsigned long val, void *data) | |
8ee1c3db MG |
298 | { |
299 | /* The only video events relevant to opregion are 0x80. These indicate | |
300 | either a docking event, lid switch or display switch request. In | |
301 | Linux, these are handled by the dock, button and video drivers. | |
f5a3d0c4 | 302 | */ |
8ee1c3db | 303 | |
5bc4418b | 304 | struct opregion_acpi __iomem *acpi; |
f5a3d0c4 MG |
305 | struct acpi_bus_event *event = data; |
306 | int ret = NOTIFY_OK; | |
307 | ||
308 | if (strcmp(event->device_class, ACPI_VIDEO_CLASS) != 0) | |
309 | return NOTIFY_DONE; | |
8ee1c3db MG |
310 | |
311 | if (!system_opregion) | |
312 | return NOTIFY_DONE; | |
313 | ||
314 | acpi = system_opregion->acpi; | |
f5a3d0c4 | 315 | |
5bc4418b BW |
316 | if (event->type == 0x80 && |
317 | (ioread32(&acpi->cevt) & 1) == 0) | |
f5a3d0c4 MG |
318 | ret = NOTIFY_BAD; |
319 | ||
5bc4418b | 320 | iowrite32(0, &acpi->csts); |
8ee1c3db | 321 | |
f5a3d0c4 | 322 | return ret; |
8ee1c3db MG |
323 | } |
324 | ||
325 | static struct notifier_block intel_opregion_notifier = { | |
326 | .notifier_call = intel_opregion_video_event, | |
327 | }; | |
328 | ||
74a365b3 MG |
329 | /* |
330 | * Initialise the DIDL field in opregion. This passes a list of devices to | |
331 | * the firmware. Values are defined by section B.4.2 of the ACPI specification | |
332 | * (version 3) | |
333 | */ | |
334 | ||
335 | static void intel_didl_outputs(struct drm_device *dev) | |
336 | { | |
337 | struct drm_i915_private *dev_priv = dev->dev_private; | |
338 | struct intel_opregion *opregion = &dev_priv->opregion; | |
339 | struct drm_connector *connector; | |
3143751f ZR |
340 | acpi_handle handle; |
341 | struct acpi_device *acpi_dev, *acpi_cdev, *acpi_video_bus = NULL; | |
342 | unsigned long long device_id; | |
343 | acpi_status status; | |
5bc4418b | 344 | u32 temp; |
74a365b3 MG |
345 | int i = 0; |
346 | ||
3143751f ZR |
347 | handle = DEVICE_ACPI_HANDLE(&dev->pdev->dev); |
348 | if (!handle || ACPI_FAILURE(acpi_bus_get_device(handle, &acpi_dev))) | |
349 | return; | |
350 | ||
351 | if (acpi_is_video_device(acpi_dev)) | |
352 | acpi_video_bus = acpi_dev; | |
353 | else { | |
354 | list_for_each_entry(acpi_cdev, &acpi_dev->children, node) { | |
355 | if (acpi_is_video_device(acpi_cdev)) { | |
356 | acpi_video_bus = acpi_cdev; | |
357 | break; | |
358 | } | |
359 | } | |
360 | } | |
361 | ||
362 | if (!acpi_video_bus) { | |
a70491cc | 363 | pr_warn("No ACPI video bus found\n"); |
3143751f ZR |
364 | return; |
365 | } | |
366 | ||
367 | list_for_each_entry(acpi_cdev, &acpi_video_bus->children, node) { | |
368 | if (i >= 8) { | |
0206e353 | 369 | dev_printk(KERN_ERR, &dev->pdev->dev, |
3143751f ZR |
370 | "More than 8 outputs detected\n"); |
371 | return; | |
372 | } | |
373 | status = | |
374 | acpi_evaluate_integer(acpi_cdev->handle, "_ADR", | |
375 | NULL, &device_id); | |
376 | if (ACPI_SUCCESS(status)) { | |
377 | if (!device_id) | |
378 | goto blind_set; | |
5bc4418b BW |
379 | iowrite32((u32)(device_id & 0x0f0f), |
380 | &opregion->acpi->didl[i]); | |
3143751f ZR |
381 | i++; |
382 | } | |
383 | } | |
384 | ||
385 | end: | |
386 | /* If fewer than 8 outputs, the list must be null terminated */ | |
387 | if (i < 8) | |
5bc4418b | 388 | iowrite32(0, &opregion->acpi->didl[i]); |
3143751f ZR |
389 | return; |
390 | ||
391 | blind_set: | |
392 | i = 0; | |
74a365b3 MG |
393 | list_for_each_entry(connector, &dev->mode_config.connector_list, head) { |
394 | int output_type = ACPI_OTHER_OUTPUT; | |
395 | if (i >= 8) { | |
0206e353 | 396 | dev_printk(KERN_ERR, &dev->pdev->dev, |
74a365b3 MG |
397 | "More than 8 outputs detected\n"); |
398 | return; | |
399 | } | |
400 | switch (connector->connector_type) { | |
401 | case DRM_MODE_CONNECTOR_VGA: | |
402 | case DRM_MODE_CONNECTOR_DVIA: | |
403 | output_type = ACPI_VGA_OUTPUT; | |
404 | break; | |
405 | case DRM_MODE_CONNECTOR_Composite: | |
406 | case DRM_MODE_CONNECTOR_SVIDEO: | |
407 | case DRM_MODE_CONNECTOR_Component: | |
408 | case DRM_MODE_CONNECTOR_9PinDIN: | |
409 | output_type = ACPI_TV_OUTPUT; | |
410 | break; | |
411 | case DRM_MODE_CONNECTOR_DVII: | |
412 | case DRM_MODE_CONNECTOR_DVID: | |
413 | case DRM_MODE_CONNECTOR_DisplayPort: | |
414 | case DRM_MODE_CONNECTOR_HDMIA: | |
415 | case DRM_MODE_CONNECTOR_HDMIB: | |
416 | output_type = ACPI_DIGITAL_OUTPUT; | |
417 | break; | |
418 | case DRM_MODE_CONNECTOR_LVDS: | |
419 | output_type = ACPI_LVDS_OUTPUT; | |
420 | break; | |
421 | } | |
5bc4418b BW |
422 | temp = ioread32(&opregion->acpi->didl[i]); |
423 | iowrite32(temp | (1<<31) | output_type | i, | |
424 | &opregion->acpi->didl[i]); | |
74a365b3 MG |
425 | i++; |
426 | } | |
3143751f | 427 | goto end; |
74a365b3 MG |
428 | } |
429 | ||
44834a67 CW |
430 | void intel_opregion_init(struct drm_device *dev) |
431 | { | |
432 | struct drm_i915_private *dev_priv = dev->dev_private; | |
433 | struct intel_opregion *opregion = &dev_priv->opregion; | |
434 | ||
435 | if (!opregion->header) | |
436 | return; | |
437 | ||
438 | if (opregion->acpi) { | |
439 | if (drm_core_check_feature(dev, DRIVER_MODESET)) | |
440 | intel_didl_outputs(dev); | |
441 | ||
442 | /* Notify BIOS we are ready to handle ACPI video ext notifs. | |
443 | * Right now, all the events are handled by the ACPI video module. | |
444 | * We don't actually need to do anything with them. */ | |
5bc4418b BW |
445 | iowrite32(0, &opregion->acpi->csts); |
446 | iowrite32(1, &opregion->acpi->drdy); | |
44834a67 CW |
447 | |
448 | system_opregion = opregion; | |
449 | register_acpi_notifier(&intel_opregion_notifier); | |
450 | } | |
451 | ||
452 | if (opregion->asle) | |
453 | intel_opregion_enable_asle(dev); | |
454 | } | |
455 | ||
456 | void intel_opregion_fini(struct drm_device *dev) | |
457 | { | |
458 | struct drm_i915_private *dev_priv = dev->dev_private; | |
459 | struct intel_opregion *opregion = &dev_priv->opregion; | |
460 | ||
461 | if (!opregion->header) | |
462 | return; | |
463 | ||
464 | if (opregion->acpi) { | |
5bc4418b | 465 | iowrite32(0, &opregion->acpi->drdy); |
44834a67 CW |
466 | |
467 | system_opregion = NULL; | |
468 | unregister_acpi_notifier(&intel_opregion_notifier); | |
469 | } | |
470 | ||
471 | /* just clear all opregion memory pointers now */ | |
472 | iounmap(opregion->header); | |
473 | opregion->header = NULL; | |
474 | opregion->acpi = NULL; | |
475 | opregion->swsci = NULL; | |
476 | opregion->asle = NULL; | |
477 | opregion->vbt = NULL; | |
478 | } | |
479 | #endif | |
480 | ||
481 | int intel_opregion_setup(struct drm_device *dev) | |
8ee1c3db MG |
482 | { |
483 | struct drm_i915_private *dev_priv = dev->dev_private; | |
484 | struct intel_opregion *opregion = &dev_priv->opregion; | |
5bc4418b | 485 | void __iomem *base; |
8ee1c3db | 486 | u32 asls, mboxes; |
5bc4418b | 487 | char buf[sizeof(OPREGION_SIGNATURE)]; |
8ee1c3db MG |
488 | int err = 0; |
489 | ||
490 | pci_read_config_dword(dev->pdev, PCI_ASLS, &asls); | |
44d98a61 | 491 | DRM_DEBUG_DRIVER("graphic opregion physical addr: 0x%x\n", asls); |
8ee1c3db | 492 | if (asls == 0) { |
44d98a61 | 493 | DRM_DEBUG_DRIVER("ACPI OpRegion not supported!\n"); |
8ee1c3db MG |
494 | return -ENOTSUPP; |
495 | } | |
496 | ||
b705120e | 497 | base = acpi_os_ioremap(asls, OPREGION_SIZE); |
8ee1c3db MG |
498 | if (!base) |
499 | return -ENOMEM; | |
500 | ||
5bc4418b BW |
501 | memcpy_fromio(buf, base, sizeof(buf)); |
502 | ||
503 | if (memcmp(buf, OPREGION_SIGNATURE, 16)) { | |
44d98a61 | 504 | DRM_DEBUG_DRIVER("opregion signature mismatch\n"); |
8ee1c3db MG |
505 | err = -EINVAL; |
506 | goto err_out; | |
507 | } | |
44834a67 CW |
508 | opregion->header = base; |
509 | opregion->vbt = base + OPREGION_VBT_OFFSET; | |
8ee1c3db | 510 | |
82d3c90c | 511 | opregion->lid_state = base + ACPI_CLID; |
01fe9dbd | 512 | |
5bc4418b | 513 | mboxes = ioread32(&opregion->header->mboxes); |
8ee1c3db | 514 | if (mboxes & MBOX_ACPI) { |
44d98a61 | 515 | DRM_DEBUG_DRIVER("Public ACPI methods supported\n"); |
8ee1c3db | 516 | opregion->acpi = base + OPREGION_ACPI_OFFSET; |
8ee1c3db | 517 | } |
8ee1c3db MG |
518 | |
519 | if (mboxes & MBOX_SWSCI) { | |
44d98a61 | 520 | DRM_DEBUG_DRIVER("SWSCI supported\n"); |
8ee1c3db MG |
521 | opregion->swsci = base + OPREGION_SWSCI_OFFSET; |
522 | } | |
523 | if (mboxes & MBOX_ASLE) { | |
44d98a61 | 524 | DRM_DEBUG_DRIVER("ASLE supported\n"); |
8ee1c3db MG |
525 | opregion->asle = base + OPREGION_ASLE_OFFSET; |
526 | } | |
527 | ||
8ee1c3db MG |
528 | return 0; |
529 | ||
530 | err_out: | |
30c56660 | 531 | iounmap(base); |
8ee1c3db MG |
532 | return err; |
533 | } |