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 */
gma_power_init(struct drm_device * dev)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
61 if (dev_priv->ops->init_pm)
62 dev_priv->ops->init_pm(dev);
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 */
gma_power_uninit(struct drm_device * dev)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 */
gma_suspend_display(struct drm_device * dev)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 */
gma_resume_display(struct pci_dev * pdev)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
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);
113
114 psb_gtt_restore(dev); /* Rebuild our GTT mappings */
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 */
gma_suspend_pci(struct pci_dev * pdev)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);
135 dev_priv->regs.saveBSM = bsm;
136 pci_read_config_dword(pdev, 0xFC, &vbt);
137 dev_priv->regs.saveVBT = vbt;
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 */
gma_resume_pci(struct pci_dev * pdev)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);
165 pci_write_config_dword(pdev, 0x5c, dev_priv->regs.saveBSM);
166 pci_write_config_dword(pdev, 0xFC, dev_priv->regs.saveVBT);
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 */
gma_power_suspend(struct device * _dev)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);
198 dev_err(dev->dev, "GPU hardware busy, cannot suspend\n");
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 */
gma_power_resume(struct device * _dev)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 */
gma_power_is_on(struct drm_device * dev)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 */
gma_power_begin(struct drm_device * dev,bool force_on)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 */
gma_power_end(struct drm_device * dev)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
psb_runtime_suspend(struct device * dev)299 int psb_runtime_suspend(struct device *dev)
300 {
301 return gma_power_suspend(dev);
302 }
303
psb_runtime_resume(struct device * dev)304 int psb_runtime_resume(struct device *dev)
305 {
306 return gma_power_resume(dev);
307 }
308
psb_runtime_idle(struct device * dev)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 }
318
gma_power_thaw(struct device * _dev)319 int gma_power_thaw(struct device *_dev)
320 {
321 return gma_power_resume(_dev);
322 }
323
gma_power_freeze(struct device * _dev)324 int gma_power_freeze(struct device *_dev)
325 {
326 return gma_power_suspend(_dev);
327 }
328
gma_power_restore(struct device * _dev)329 int gma_power_restore(struct device *_dev)
330 {
331 return gma_power_resume(_dev);
332 }
333