Commit | Line | Data |
---|---|---|
bbbb262d AC |
1 | /************************************************************************** |
2 | * Copyright (c) 2009-2011, Intel Corporation. | |
3 | * All Rights Reserved. | |
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 FROM, | |
21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | |
22 | * SOFTWARE. | |
23 | * | |
24 | * Authors: | |
25 | * Benjamin Defnet <benjamin.r.defnet@intel.com> | |
26 | * Rajesh Poornachandran <rajesh.poornachandran@intel.com> | |
27 | * Massively reworked | |
28 | * Alan Cox <alan@linux.intel.com> | |
29 | */ | |
30 | ||
31 | #include "power.h" | |
32 | #include "psb_drv.h" | |
33 | #include "psb_reg.h" | |
34 | #include "psb_intel_reg.h" | |
35 | #include <linux/mutex.h> | |
36 | #include <linux/pm_runtime.h> | |
37 | ||
38 | static struct mutex power_mutex; /* Serialize power ops */ | |
39 | static spinlock_t power_ctrl_lock; /* Serialize power claim */ | |
40 | ||
41 | /** | |
42 | * gma_power_init - initialise power manager | |
43 | * @dev: our device | |
44 | * | |
45 | * Set up for power management tracking of our hardware. | |
46 | */ | |
47 | void gma_power_init(struct drm_device *dev) | |
48 | { | |
49 | struct drm_psb_private *dev_priv = dev->dev_private; | |
50 | ||
51 | /* FIXME: Move APM/OSPM base into relevant device code */ | |
52 | dev_priv->apm_base = dev_priv->apm_reg & 0xffff; | |
53 | dev_priv->ospm_base &= 0xffff; | |
54 | ||
55 | dev_priv->display_power = true; /* We start active */ | |
56 | dev_priv->display_count = 0; /* Currently no users */ | |
57 | dev_priv->suspended = false; /* And not suspended */ | |
58 | spin_lock_init(&power_ctrl_lock); | |
59 | mutex_init(&power_mutex); | |
60 | ||
c715bc1b KS |
61 | if (dev_priv->ops->init_pm) |
62 | dev_priv->ops->init_pm(dev); | |
bbbb262d AC |
63 | } |
64 | ||
65 | /** | |
66 | * gma_power_uninit - end power manager | |
67 | * @dev: device to end for | |
68 | * | |
69 | * Undo the effects of gma_power_init | |
70 | */ | |
71 | void gma_power_uninit(struct drm_device *dev) | |
72 | { | |
73 | pm_runtime_disable(&dev->pdev->dev); | |
74 | pm_runtime_set_suspended(&dev->pdev->dev); | |
75 | } | |
76 | ||
77 | /** | |
78 | * gma_suspend_display - suspend the display logic | |
79 | * @dev: our DRM device | |
80 | * | |
81 | * Suspend the display logic of the graphics interface | |
82 | */ | |
83 | static void gma_suspend_display(struct drm_device *dev) | |
84 | { | |
85 | struct drm_psb_private *dev_priv = dev->dev_private; | |
86 | ||
87 | if (dev_priv->suspended) | |
88 | return; | |
89 | dev_priv->ops->save_regs(dev); | |
90 | dev_priv->ops->power_down(dev); | |
91 | dev_priv->display_power = false; | |
92 | } | |
93 | ||
94 | /** | |
95 | * gma_resume_display - resume display side logic | |
96 | * | |
97 | * Resume the display hardware restoring state and enabling | |
98 | * as necessary. | |
99 | */ | |
100 | static void gma_resume_display(struct pci_dev *pdev) | |
101 | { | |
102 | struct drm_device *dev = pci_get_drvdata(pdev); | |
103 | struct drm_psb_private *dev_priv = dev->dev_private; | |
104 | ||
bbbb262d AC |
105 | /* turn on the display power island */ |
106 | dev_priv->ops->power_up(dev); | |
107 | dev_priv->suspended = false; | |
108 | dev_priv->display_power = true; | |
109 | ||
110 | PSB_WVDC32(dev_priv->pge_ctl | _PSB_PGETBL_ENABLED, PSB_PGETBL_CTL); | |
111 | pci_write_config_word(pdev, PSB_GMCH_CTRL, | |
112 | dev_priv->gmch_ctrl | _PSB_GMCH_ENABLED); | |
8ba8209f PJ |
113 | |
114 | psb_gtt_restore(dev); /* Rebuild our GTT mappings */ | |
bbbb262d AC |
115 | dev_priv->ops->restore_regs(dev); |
116 | } | |
117 | ||
118 | /** | |
119 | * gma_suspend_pci - suspend PCI side | |
120 | * @pdev: PCI device | |
121 | * | |
122 | * Perform the suspend processing on our PCI device state | |
123 | */ | |
124 | static void gma_suspend_pci(struct pci_dev *pdev) | |
125 | { | |
126 | struct drm_device *dev = pci_get_drvdata(pdev); | |
127 | struct drm_psb_private *dev_priv = dev->dev_private; | |
128 | int bsm, vbt; | |
129 | ||
130 | if (dev_priv->suspended) | |
131 | return; | |
132 | ||
133 | pci_save_state(pdev); | |
134 | pci_read_config_dword(pdev, 0x5C, &bsm); | |
648a8e34 | 135 | dev_priv->regs.saveBSM = bsm; |
bbbb262d | 136 | pci_read_config_dword(pdev, 0xFC, &vbt); |
648a8e34 | 137 | dev_priv->regs.saveVBT = vbt; |
bbbb262d AC |
138 | pci_read_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, &dev_priv->msi_addr); |
139 | pci_read_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, &dev_priv->msi_data); | |
140 | ||
141 | pci_disable_device(pdev); | |
142 | pci_set_power_state(pdev, PCI_D3hot); | |
143 | ||
144 | dev_priv->suspended = true; | |
145 | } | |
146 | ||
147 | /** | |
148 | * gma_resume_pci - resume helper | |
149 | * @dev: our PCI device | |
150 | * | |
151 | * Perform the resume processing on our PCI device state - rewrite | |
152 | * register state and re-enable the PCI device | |
153 | */ | |
154 | static bool gma_resume_pci(struct pci_dev *pdev) | |
155 | { | |
156 | struct drm_device *dev = pci_get_drvdata(pdev); | |
157 | struct drm_psb_private *dev_priv = dev->dev_private; | |
158 | int ret; | |
159 | ||
160 | if (!dev_priv->suspended) | |
161 | return true; | |
162 | ||
163 | pci_set_power_state(pdev, PCI_D0); | |
164 | pci_restore_state(pdev); | |
648a8e34 AC |
165 | pci_write_config_dword(pdev, 0x5c, dev_priv->regs.saveBSM); |
166 | pci_write_config_dword(pdev, 0xFC, dev_priv->regs.saveVBT); | |
bbbb262d AC |
167 | /* restoring MSI address and data in PCIx space */ |
168 | pci_write_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, dev_priv->msi_addr); | |
169 | pci_write_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, dev_priv->msi_data); | |
170 | ret = pci_enable_device(pdev); | |
171 | ||
172 | if (ret != 0) | |
173 | dev_err(&pdev->dev, "pci_enable failed: %d\n", ret); | |
174 | else | |
175 | dev_priv->suspended = false; | |
176 | return !dev_priv->suspended; | |
177 | } | |
178 | ||
179 | /** | |
180 | * gma_power_suspend - bus callback for suspend | |
181 | * @pdev: our PCI device | |
182 | * @state: suspend type | |
183 | * | |
184 | * Called back by the PCI layer during a suspend of the system. We | |
185 | * perform the necessary shut down steps and save enough state that | |
186 | * we can undo this when resume is called. | |
187 | */ | |
188 | int gma_power_suspend(struct device *_dev) | |
189 | { | |
190 | struct pci_dev *pdev = container_of(_dev, struct pci_dev, dev); | |
191 | struct drm_device *dev = pci_get_drvdata(pdev); | |
192 | struct drm_psb_private *dev_priv = dev->dev_private; | |
193 | ||
194 | mutex_lock(&power_mutex); | |
195 | if (!dev_priv->suspended) { | |
196 | if (dev_priv->display_count) { | |
197 | mutex_unlock(&power_mutex); | |
09016a11 | 198 | dev_err(dev->dev, "GPU hardware busy, cannot suspend\n"); |
bbbb262d AC |
199 | return -EBUSY; |
200 | } | |
201 | psb_irq_uninstall(dev); | |
202 | gma_suspend_display(dev); | |
203 | gma_suspend_pci(pdev); | |
204 | } | |
205 | mutex_unlock(&power_mutex); | |
206 | return 0; | |
207 | } | |
208 | ||
209 | /** | |
210 | * gma_power_resume - resume power | |
211 | * @pdev: PCI device | |
212 | * | |
213 | * Resume the PCI side of the graphics and then the displays | |
214 | */ | |
215 | int gma_power_resume(struct device *_dev) | |
216 | { | |
217 | struct pci_dev *pdev = container_of(_dev, struct pci_dev, dev); | |
218 | struct drm_device *dev = pci_get_drvdata(pdev); | |
219 | ||
220 | mutex_lock(&power_mutex); | |
221 | gma_resume_pci(pdev); | |
222 | gma_resume_display(pdev); | |
223 | psb_irq_preinstall(dev); | |
224 | psb_irq_postinstall(dev); | |
225 | mutex_unlock(&power_mutex); | |
226 | return 0; | |
227 | } | |
228 | ||
229 | /** | |
230 | * gma_power_is_on - returne true if power is on | |
231 | * @dev: our DRM device | |
232 | * | |
233 | * Returns true if the display island power is on at this moment | |
234 | */ | |
235 | bool gma_power_is_on(struct drm_device *dev) | |
236 | { | |
237 | struct drm_psb_private *dev_priv = dev->dev_private; | |
238 | return dev_priv->display_power; | |
239 | } | |
240 | ||
241 | /** | |
242 | * gma_power_begin - begin requiring power | |
243 | * @dev: our DRM device | |
244 | * @force_on: true to force power on | |
245 | * | |
246 | * Begin an action that requires the display power island is enabled. | |
247 | * We refcount the islands. | |
248 | */ | |
249 | bool gma_power_begin(struct drm_device *dev, bool force_on) | |
250 | { | |
251 | struct drm_psb_private *dev_priv = dev->dev_private; | |
252 | int ret; | |
253 | unsigned long flags; | |
254 | ||
255 | spin_lock_irqsave(&power_ctrl_lock, flags); | |
256 | /* Power already on ? */ | |
257 | if (dev_priv->display_power) { | |
258 | dev_priv->display_count++; | |
259 | pm_runtime_get(&dev->pdev->dev); | |
260 | spin_unlock_irqrestore(&power_ctrl_lock, flags); | |
261 | return true; | |
262 | } | |
263 | if (force_on == false) | |
264 | goto out_false; | |
265 | ||
266 | /* Ok power up needed */ | |
267 | ret = gma_resume_pci(dev->pdev); | |
268 | if (ret == 0) { | |
269 | psb_irq_preinstall(dev); | |
270 | psb_irq_postinstall(dev); | |
271 | pm_runtime_get(&dev->pdev->dev); | |
272 | dev_priv->display_count++; | |
273 | spin_unlock_irqrestore(&power_ctrl_lock, flags); | |
274 | return true; | |
275 | } | |
276 | out_false: | |
277 | spin_unlock_irqrestore(&power_ctrl_lock, flags); | |
278 | return false; | |
279 | } | |
280 | ||
281 | /** | |
282 | * gma_power_end - end use of power | |
283 | * @dev: Our DRM device | |
284 | * | |
285 | * Indicate that one of our gma_power_begin() requested periods when | |
286 | * the diplay island power is needed has completed. | |
287 | */ | |
288 | void gma_power_end(struct drm_device *dev) | |
289 | { | |
290 | struct drm_psb_private *dev_priv = dev->dev_private; | |
291 | unsigned long flags; | |
292 | spin_lock_irqsave(&power_ctrl_lock, flags); | |
293 | dev_priv->display_count--; | |
294 | WARN_ON(dev_priv->display_count < 0); | |
295 | spin_unlock_irqrestore(&power_ctrl_lock, flags); | |
296 | pm_runtime_put(&dev->pdev->dev); | |
297 | } | |
298 | ||
299 | int psb_runtime_suspend(struct device *dev) | |
300 | { | |
301 | return gma_power_suspend(dev); | |
302 | } | |
303 | ||
304 | int psb_runtime_resume(struct device *dev) | |
305 | { | |
09016a11 | 306 | return gma_power_resume(dev); |
bbbb262d AC |
307 | } |
308 | ||
309 | int psb_runtime_idle(struct device *dev) | |
310 | { | |
311 | struct drm_device *drmdev = pci_get_drvdata(to_pci_dev(dev)); | |
312 | struct drm_psb_private *dev_priv = drmdev->dev_private; | |
313 | if (dev_priv->display_count) | |
314 | return 0; | |
315 | else | |
316 | return 1; | |
317 | } | |
888eef2e PJ |
318 | |
319 | int gma_power_thaw(struct device *_dev) | |
320 | { | |
321 | return gma_power_resume(_dev); | |
322 | } | |
323 | ||
324 | int gma_power_freeze(struct device *_dev) | |
325 | { | |
326 | return gma_power_suspend(_dev); | |
327 | } | |
328 | ||
329 | int gma_power_restore(struct device *_dev) | |
330 | { | |
331 | return gma_power_resume(_dev); | |
332 | } |