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