Linux Audio

Check our new training course

Loading...
  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/**
 41 *	gma_power_init		-	initialise power manager
 42 *	@dev: our device
 43 *
 44 *	Set up for power management tracking of our hardware.
 45 */
 46void gma_power_init(struct drm_device *dev)
 47{
 48	struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
 49
 50	/* FIXME: Move APM/OSPM base into relevant device code */
 51	dev_priv->apm_base = dev_priv->apm_reg & 0xffff;
 52	dev_priv->ospm_base &= 0xffff;
 53
 
 
 
 
 
 
 54	if (dev_priv->ops->init_pm)
 55		dev_priv->ops->init_pm(dev);
 56
 57	/*
 58	 * Runtime pm support is broken atm. So for now unconditionally
 59	 * call pm_runtime_get() here and put it again in psb_driver_unload()
 60	 *
 61	 * To fix this we need to call pm_runtime_get() once for each active
 62	 * pipe at boot and then put() / get() for each pipe disable / enable
 63	 * so that the device gets runtime suspended when no pipes are active.
 64	 * Once this is in place the pm_runtime_get() below should be replaced
 65	 * by a pm_runtime_allow() call to undo the pm_runtime_forbid() from
 66	 * pci_pm_init().
 67	 */
 68	pm_runtime_get(dev->dev);
 69
 70	dev_priv->pm_initialized = true;
 71}
 72
 73/**
 74 *	gma_power_uninit	-	end power manager
 75 *	@dev: device to end for
 76 *
 77 *	Undo the effects of gma_power_init
 78 */
 79void gma_power_uninit(struct drm_device *dev)
 80{
 81	struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
 82
 83	if (!dev_priv->pm_initialized)
 84		return;
 85
 86	pm_runtime_put_noidle(dev->dev);
 87}
 88
 89/**
 90 *	gma_suspend_display	-	suspend the display logic
 91 *	@dev: our DRM device
 92 *
 93 *	Suspend the display logic of the graphics interface
 94 */
 95static void gma_suspend_display(struct drm_device *dev)
 96{
 97	struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
 98
 
 
 99	dev_priv->ops->save_regs(dev);
100	dev_priv->ops->power_down(dev);
 
101}
102
103/**
104 *	gma_resume_display	-	resume display side logic
105 *	@pdev: PCI device
106 *
107 *	Resume the display hardware restoring state and enabling
108 *	as necessary.
109 */
110static void gma_resume_display(struct pci_dev *pdev)
111{
112	struct drm_device *dev = pci_get_drvdata(pdev);
113	struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
114
115	/* turn on the display power island */
116	dev_priv->ops->power_up(dev);
 
 
117
118	PSB_WVDC32(dev_priv->pge_ctl | _PSB_PGETBL_ENABLED, PSB_PGETBL_CTL);
119	pci_write_config_word(pdev, PSB_GMCH_CTRL,
120			dev_priv->gmch_ctrl | _PSB_GMCH_ENABLED);
121
122	/* Rebuild our GTT mappings */
123	psb_gtt_resume(dev);
124	psb_gem_mm_resume(dev);
125	dev_priv->ops->restore_regs(dev);
126}
127
128/**
129 *	gma_suspend_pci		-	suspend PCI side
130 *	@pdev: PCI device
131 *
132 *	Perform the suspend processing on our PCI device state
133 */
134static void gma_suspend_pci(struct pci_dev *pdev)
135{
136	struct drm_device *dev = pci_get_drvdata(pdev);
137	struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
138	int bsm, vbt;
139
 
 
 
140	pci_save_state(pdev);
141	pci_read_config_dword(pdev, 0x5C, &bsm);
142	dev_priv->regs.saveBSM = bsm;
143	pci_read_config_dword(pdev, 0xFC, &vbt);
144	dev_priv->regs.saveVBT = vbt;
 
 
145
146	pci_disable_device(pdev);
147	pci_set_power_state(pdev, PCI_D3hot);
 
 
148}
149
150/**
151 *	gma_resume_pci		-	resume helper
152 *	@pdev: our PCI device
153 *
154 *	Perform the resume processing on our PCI device state - rewrite
155 *	register state and re-enable the PCI device
156 */
157static int gma_resume_pci(struct pci_dev *pdev)
158{
159	struct drm_device *dev = pci_get_drvdata(pdev);
160	struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
 
 
 
 
161
162	pci_set_power_state(pdev, PCI_D0);
163	pci_restore_state(pdev);
164	pci_write_config_dword(pdev, 0x5c, dev_priv->regs.saveBSM);
165	pci_write_config_dword(pdev, 0xFC, dev_priv->regs.saveVBT);
 
 
 
 
166
167	return pci_enable_device(pdev);
 
 
 
 
168}
169
170/**
171 *	gma_power_suspend		-	bus callback for suspend
172 *	@_dev: our device
 
173 *
174 *	Called back by the PCI layer during a suspend of the system. We
175 *	perform the necessary shut down steps and save enough state that
176 *	we can undo this when resume is called.
177 */
178int gma_power_suspend(struct device *_dev)
179{
180	struct pci_dev *pdev = to_pci_dev(_dev);
181	struct drm_device *dev = pci_get_drvdata(pdev);
 
182
183	gma_irq_uninstall(dev);
184	gma_suspend_display(dev);
185	gma_suspend_pci(pdev);
 
 
 
 
 
 
 
 
 
186	return 0;
187}
188
189/**
190 *	gma_power_resume		-	resume power
191 *	@_dev: our device
192 *
193 *	Resume the PCI side of the graphics and then the displays
194 */
195int gma_power_resume(struct device *_dev)
196{
197	struct pci_dev *pdev = to_pci_dev(_dev);
198	struct drm_device *dev = pci_get_drvdata(pdev);
199
 
200	gma_resume_pci(pdev);
201	gma_resume_display(pdev);
202	gma_irq_install(dev);
 
 
203	return 0;
204}
205
206/**
 
 
 
 
 
 
 
 
 
 
 
 
207 *	gma_power_begin		-	begin requiring power
208 *	@dev: our DRM device
209 *	@force_on: true to force power on
210 *
211 *	Begin an action that requires the display power island is enabled.
212 *	We refcount the islands.
213 */
214bool gma_power_begin(struct drm_device *dev, bool force_on)
215{
216	if (force_on)
217		return pm_runtime_resume_and_get(dev->dev) == 0;
218	else
219		return pm_runtime_get_if_in_use(dev->dev) == 1;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
220}
221
222/**
223 *	gma_power_end		-	end use of power
224 *	@dev: Our DRM device
225 *
226 *	Indicate that one of our gma_power_begin() requested periods when
227 *	the diplay island power is needed has completed.
228 */
229void gma_power_end(struct drm_device *dev)
230{
231	pm_runtime_put(dev->dev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
232}
  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
 38static struct mutex power_mutex;	/* Serialize power ops */
 39static 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 */
 47void 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 */
 71void 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 */
 83static 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 */
100static 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 */
124static 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 */
154static 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 */
188int gma_power_suspend(struct device *_dev)
189{
190	struct pci_dev *pdev = to_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 */
215int gma_power_resume(struct device *_dev)
216{
217	struct pci_dev *pdev = to_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 */
235bool 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 */
249bool 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	}
276out_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 */
288void 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
299int psb_runtime_suspend(struct device *dev)
300{
301	return gma_power_suspend(dev);
302}
303
304int psb_runtime_resume(struct device *dev)
305{
306	return gma_power_resume(dev);
307}
308
309int 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
319int gma_power_thaw(struct device *_dev)
320{
321	return gma_power_resume(_dev);
322}
323
324int gma_power_freeze(struct device *_dev)
325{
326	return gma_power_suspend(_dev);
327}
328
329int gma_power_restore(struct device *_dev)
330{
331	return gma_power_resume(_dev);
332}