[deliverable/linux.git] / drivers / gpu / drm / gma500 / power.c

/**************************************************************************
 * Copyright (c) 2009-2011, Intel Corporation.
 * All Rights Reserved.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the next
 * paragraph) shall be included in all copies or substantial portions of the
 * Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 *
 * Authors:
 *    Benjamin Defnet <benjamin.r.defnet@intel.com>
 *    Rajesh Poornachandran <rajesh.poornachandran@intel.com>
 * Massively reworked
 *    Alan Cox <alan@linux.intel.com>
 */

#include "power.h"
#include "psb_drv.h"
#include "psb_reg.h"
#include "psb_intel_reg.h"
#include <linux/mutex.h>
#include <linux/pm_runtime.h>

static struct mutex power_mutex;	/* Serialize power ops */
static spinlock_t power_ctrl_lock;	/* Serialize power claim */

/**
 *	gma_power_init		-	initialise power manager
 *	@dev: our device
 *
 *	Set up for power management tracking of our hardware.
 */
void gma_power_init(struct drm_device *dev)
{
	struct drm_psb_private *dev_priv = dev->dev_private;

	/* FIXME: Move APM/OSPM base into relevant device code */
	dev_priv->apm_base = dev_priv->apm_reg & 0xffff;
	dev_priv->ospm_base &= 0xffff;

	dev_priv->display_power = true;	/* We start active */
	dev_priv->display_count = 0;	/* Currently no users */
	dev_priv->suspended = false;	/* And not suspended */
	spin_lock_init(&power_ctrl_lock);
	mutex_init(&power_mutex);

	if (dev_priv->ops->init_pm)
		dev_priv->ops->init_pm(dev);
}

/**
 *	gma_power_uninit	-	end power manager
 *	@dev: device to end for
 *
 *	Undo the effects of gma_power_init
 */
void gma_power_uninit(struct drm_device *dev)
{
	pm_runtime_disable(&dev->pdev->dev);
	pm_runtime_set_suspended(&dev->pdev->dev);
}

/**
 *	gma_suspend_display	-	suspend the display logic
 *	@dev: our DRM device
 *
 *	Suspend the display logic of the graphics interface
 */
static void gma_suspend_display(struct drm_device *dev)
{
	struct drm_psb_private *dev_priv = dev->dev_private;

	if (dev_priv->suspended)
		return;
	dev_priv->ops->save_regs(dev);
	dev_priv->ops->power_down(dev);
	dev_priv->display_power = false;
}

/**
 *	gma_resume_display	-	resume display side logic
 *
 *	Resume the display hardware restoring state and enabling
 *	as necessary.
 */
static void gma_resume_display(struct pci_dev *pdev)
{
	struct drm_device *dev = pci_get_drvdata(pdev);
	struct drm_psb_private *dev_priv = dev->dev_private;

	/* turn on the display power island */
	dev_priv->ops->power_up(dev);
	dev_priv->suspended = false;
	dev_priv->display_power = true;

	PSB_WVDC32(dev_priv->pge_ctl | _PSB_PGETBL_ENABLED, PSB_PGETBL_CTL);
	pci_write_config_word(pdev, PSB_GMCH_CTRL,
			dev_priv->gmch_ctrl | _PSB_GMCH_ENABLED);

	psb_gtt_restore(dev); /* Rebuild our GTT mappings */
	dev_priv->ops->restore_regs(dev);
}

/**
 *	gma_suspend_pci		-	suspend PCI side
 *	@pdev: PCI device
 *
 *	Perform the suspend processing on our PCI device state
 */
static void gma_suspend_pci(struct pci_dev *pdev)
{
	struct drm_device *dev = pci_get_drvdata(pdev);
	struct drm_psb_private *dev_priv = dev->dev_private;
	int bsm, vbt;

	if (dev_priv->suspended)
		return;

	pci_save_state(pdev);
	pci_read_config_dword(pdev, 0x5C, &bsm);
	dev_priv->regs.saveBSM = bsm;
	pci_read_config_dword(pdev, 0xFC, &vbt);
	dev_priv->regs.saveVBT = vbt;
	pci_read_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, &dev_priv->msi_addr);
	pci_read_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, &dev_priv->msi_data);

	pci_disable_device(pdev);
	pci_set_power_state(pdev, PCI_D3hot);

	dev_priv->suspended = true;
}

/**
 *	gma_resume_pci		-	resume helper
 *	@dev: our PCI device
 *
 *	Perform the resume processing on our PCI device state - rewrite
 *	register state and re-enable the PCI device
 */
static bool gma_resume_pci(struct pci_dev *pdev)
{
	struct drm_device *dev = pci_get_drvdata(pdev);
	struct drm_psb_private *dev_priv = dev->dev_private;
	int ret;

	if (!dev_priv->suspended)
		return true;

	pci_set_power_state(pdev, PCI_D0);
	pci_restore_state(pdev);
	pci_write_config_dword(pdev, 0x5c, dev_priv->regs.saveBSM);
	pci_write_config_dword(pdev, 0xFC, dev_priv->regs.saveVBT);
	/* restoring MSI address and data in PCIx space */
	pci_write_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, dev_priv->msi_addr);
	pci_write_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, dev_priv->msi_data);
	ret = pci_enable_device(pdev);

	if (ret != 0)
		dev_err(&pdev->dev, "pci_enable failed: %d\n", ret);
	else
		dev_priv->suspended = false;
	return !dev_priv->suspended;
}

/**
 *	gma_power_suspend		-	bus callback for suspend
 *	@pdev: our PCI device
 *	@state: suspend type
 *
 *	Called back by the PCI layer during a suspend of the system. We
 *	perform the necessary shut down steps and save enough state that
 *	we can undo this when resume is called.
 */
int gma_power_suspend(struct device *_dev)
{
	struct pci_dev *pdev = to_pci_dev(_dev);
	struct drm_device *dev = pci_get_drvdata(pdev);
	struct drm_psb_private *dev_priv = dev->dev_private;

	mutex_lock(&power_mutex);
	if (!dev_priv->suspended) {
		if (dev_priv->display_count) {
			mutex_unlock(&power_mutex);
			dev_err(dev->dev, "GPU hardware busy, cannot suspend\n");
			return -EBUSY;
		}
		psb_irq_uninstall(dev);
		gma_suspend_display(dev);
		gma_suspend_pci(pdev);
	}
	mutex_unlock(&power_mutex);
	return 0;
}

/**
 *	gma_power_resume		-	resume power
 *	@pdev: PCI device
 *
 *	Resume the PCI side of the graphics and then the displays
 */
int gma_power_resume(struct device *_dev)
{
	struct pci_dev *pdev = to_pci_dev(_dev);
	struct drm_device *dev = pci_get_drvdata(pdev);

	mutex_lock(&power_mutex);
	gma_resume_pci(pdev);
	gma_resume_display(pdev);
	psb_irq_preinstall(dev);
	psb_irq_postinstall(dev);
	mutex_unlock(&power_mutex);
	return 0;
}

/**
 *	gma_power_is_on		-	returne true if power is on
 *	@dev: our DRM device
 *
 *	Returns true if the display island power is on at this moment
 */
bool gma_power_is_on(struct drm_device *dev)
{
	struct drm_psb_private *dev_priv = dev->dev_private;
	return dev_priv->display_power;
}

/**
 *	gma_power_begin		-	begin requiring power
 *	@dev: our DRM device
 *	@force_on: true to force power on
 *
 *	Begin an action that requires the display power island is enabled.
 *	We refcount the islands.
 */
bool gma_power_begin(struct drm_device *dev, bool force_on)
{
	struct drm_psb_private *dev_priv = dev->dev_private;
	int ret;
	unsigned long flags;

	spin_lock_irqsave(&power_ctrl_lock, flags);
	/* Power already on ? */
	if (dev_priv->display_power) {
		dev_priv->display_count++;
		pm_runtime_get(&dev->pdev->dev);
		spin_unlock_irqrestore(&power_ctrl_lock, flags);
		return true;
	}
	if (force_on == false)
		goto out_false;

	/* Ok power up needed */
	ret = gma_resume_pci(dev->pdev);
	if (ret == 0) {
		psb_irq_preinstall(dev);
		psb_irq_postinstall(dev);
		pm_runtime_get(&dev->pdev->dev);
		dev_priv->display_count++;
		spin_unlock_irqrestore(&power_ctrl_lock, flags);
		return true;
	}
out_false:
	spin_unlock_irqrestore(&power_ctrl_lock, flags);
	return false;
}

/**
 *	gma_power_end		-	end use of power
 *	@dev: Our DRM device
 *
 *	Indicate that one of our gma_power_begin() requested periods when
 *	the diplay island power is needed has completed.
 */
void gma_power_end(struct drm_device *dev)
{
	struct drm_psb_private *dev_priv = dev->dev_private;
	unsigned long flags;
	spin_lock_irqsave(&power_ctrl_lock, flags);
	dev_priv->display_count--;
	WARN_ON(dev_priv->display_count < 0);
	spin_unlock_irqrestore(&power_ctrl_lock, flags);
	pm_runtime_put(&dev->pdev->dev);
}

int psb_runtime_suspend(struct device *dev)
{
	return gma_power_suspend(dev);
}

int psb_runtime_resume(struct device *dev)
{
	return gma_power_resume(dev);
}

int psb_runtime_idle(struct device *dev)
{
	struct drm_device *drmdev = pci_get_drvdata(to_pci_dev(dev));
	struct drm_psb_private *dev_priv = drmdev->dev_private;
	if (dev_priv->display_count)
		return 0;
	else
		return 1;
}

int gma_power_thaw(struct device *_dev)
{
	return gma_power_resume(_dev);
}

int gma_power_freeze(struct device *_dev)
{
	return gma_power_suspend(_dev);
}

int gma_power_restore(struct device *_dev)
{
	return gma_power_resume(_dev);
}
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)
c715bc1b KS	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
8ba8209f PJ	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);
648a8e34 AC	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	{
d21b02af	190	struct pci_dev *pdev = to_pci_dev(_dev);
bbbb262d AC	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	{
d21b02af	217	struct pci_dev *pdev = to_pci_dev(_dev);
bbbb262d AC	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	}