1bbbb262dSAlan Cox /************************************************************************** 2bbbb262dSAlan Cox * Copyright (c) 2009-2011, Intel Corporation. 3bbbb262dSAlan Cox * All Rights Reserved. 4bbbb262dSAlan Cox * 5bbbb262dSAlan Cox * Permission is hereby granted, free of charge, to any person obtaining a 6bbbb262dSAlan Cox * copy of this software and associated documentation files (the "Software"), 7bbbb262dSAlan Cox * to deal in the Software without restriction, including without limitation 8bbbb262dSAlan Cox * the rights to use, copy, modify, merge, publish, distribute, sublicense, 9bbbb262dSAlan Cox * and/or sell copies of the Software, and to permit persons to whom the 10bbbb262dSAlan Cox * Software is furnished to do so, subject to the following conditions: 11bbbb262dSAlan Cox * 12bbbb262dSAlan Cox * The above copyright notice and this permission notice (including the next 13bbbb262dSAlan Cox * paragraph) shall be included in all copies or substantial portions of the 14bbbb262dSAlan Cox * Software. 15bbbb262dSAlan Cox * 16bbbb262dSAlan Cox * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 17bbbb262dSAlan Cox * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 18bbbb262dSAlan Cox * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 19bbbb262dSAlan Cox * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 20bbbb262dSAlan Cox * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 21bbbb262dSAlan Cox * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 22bbbb262dSAlan Cox * SOFTWARE. 23bbbb262dSAlan Cox * 24bbbb262dSAlan Cox * Authors: 25bbbb262dSAlan Cox * Benjamin Defnet <benjamin.r.defnet@intel.com> 26bbbb262dSAlan Cox * Rajesh Poornachandran <rajesh.poornachandran@intel.com> 27bbbb262dSAlan Cox * Massively reworked 28bbbb262dSAlan Cox * Alan Cox <alan@linux.intel.com> 29bbbb262dSAlan Cox */ 30bbbb262dSAlan Cox 31d339386cSThomas Zimmermann #include "gem.h" 32bbbb262dSAlan Cox #include "power.h" 33bbbb262dSAlan Cox #include "psb_drv.h" 34bbbb262dSAlan Cox #include "psb_reg.h" 35bbbb262dSAlan Cox #include "psb_intel_reg.h" 3622908507SThomas Zimmermann #include "psb_irq.h" 37bbbb262dSAlan Cox #include <linux/mutex.h> 38bbbb262dSAlan Cox #include <linux/pm_runtime.h> 39bbbb262dSAlan Cox 40bbbb262dSAlan Cox static struct mutex power_mutex; /* Serialize power ops */ 4113e133eaSGuobin Huang static DEFINE_SPINLOCK(power_ctrl_lock); /* Serialize power claim */ 42bbbb262dSAlan Cox 43bbbb262dSAlan Cox /** 44bbbb262dSAlan Cox * gma_power_init - initialise power manager 45bbbb262dSAlan Cox * @dev: our device 46bbbb262dSAlan Cox * 47bbbb262dSAlan Cox * Set up for power management tracking of our hardware. 48bbbb262dSAlan Cox */ 49bbbb262dSAlan Cox void gma_power_init(struct drm_device *dev) 50bbbb262dSAlan Cox { 51f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(dev); 52bbbb262dSAlan Cox 53bbbb262dSAlan Cox /* FIXME: Move APM/OSPM base into relevant device code */ 54bbbb262dSAlan Cox dev_priv->apm_base = dev_priv->apm_reg & 0xffff; 55bbbb262dSAlan Cox dev_priv->ospm_base &= 0xffff; 56bbbb262dSAlan Cox 57bbbb262dSAlan Cox dev_priv->display_power = true; /* We start active */ 58bbbb262dSAlan Cox dev_priv->display_count = 0; /* Currently no users */ 59bbbb262dSAlan Cox dev_priv->suspended = false; /* And not suspended */ 60bbbb262dSAlan Cox mutex_init(&power_mutex); 61bbbb262dSAlan Cox 62c715bc1bSKirill A. Shutemov if (dev_priv->ops->init_pm) 63bbbb262dSAlan Cox dev_priv->ops->init_pm(dev); 64bbbb262dSAlan Cox } 65bbbb262dSAlan Cox 66bbbb262dSAlan Cox /** 67bbbb262dSAlan Cox * gma_power_uninit - end power manager 68bbbb262dSAlan Cox * @dev: device to end for 69bbbb262dSAlan Cox * 70bbbb262dSAlan Cox * Undo the effects of gma_power_init 71bbbb262dSAlan Cox */ 72bbbb262dSAlan Cox void gma_power_uninit(struct drm_device *dev) 73bbbb262dSAlan Cox { 74a2c68495SThomas Zimmermann pm_runtime_disable(dev->dev); 75a2c68495SThomas Zimmermann pm_runtime_set_suspended(dev->dev); 76bbbb262dSAlan Cox } 77bbbb262dSAlan Cox 78bbbb262dSAlan Cox /** 79bbbb262dSAlan Cox * gma_suspend_display - suspend the display logic 80bbbb262dSAlan Cox * @dev: our DRM device 81bbbb262dSAlan Cox * 82bbbb262dSAlan Cox * Suspend the display logic of the graphics interface 83bbbb262dSAlan Cox */ 84bbbb262dSAlan Cox static void gma_suspend_display(struct drm_device *dev) 85bbbb262dSAlan Cox { 86f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(dev); 87bbbb262dSAlan Cox 88bbbb262dSAlan Cox if (dev_priv->suspended) 89bbbb262dSAlan Cox return; 90bbbb262dSAlan Cox dev_priv->ops->save_regs(dev); 91bbbb262dSAlan Cox dev_priv->ops->power_down(dev); 92bbbb262dSAlan Cox dev_priv->display_power = false; 93bbbb262dSAlan Cox } 94bbbb262dSAlan Cox 95bbbb262dSAlan Cox /** 96bbbb262dSAlan Cox * gma_resume_display - resume display side logic 9763ad2a97SLee Jones * @pdev: PCI device 98bbbb262dSAlan Cox * 99bbbb262dSAlan Cox * Resume the display hardware restoring state and enabling 100bbbb262dSAlan Cox * as necessary. 101bbbb262dSAlan Cox */ 102bbbb262dSAlan Cox static void gma_resume_display(struct pci_dev *pdev) 103bbbb262dSAlan Cox { 104bbbb262dSAlan Cox struct drm_device *dev = pci_get_drvdata(pdev); 105f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(dev); 106bbbb262dSAlan Cox 107bbbb262dSAlan Cox /* turn on the display power island */ 108bbbb262dSAlan Cox dev_priv->ops->power_up(dev); 109bbbb262dSAlan Cox dev_priv->suspended = false; 110bbbb262dSAlan Cox dev_priv->display_power = true; 111bbbb262dSAlan Cox 112bbbb262dSAlan Cox PSB_WVDC32(dev_priv->pge_ctl | _PSB_PGETBL_ENABLED, PSB_PGETBL_CTL); 113bbbb262dSAlan Cox pci_write_config_word(pdev, PSB_GMCH_CTRL, 114bbbb262dSAlan Cox dev_priv->gmch_ctrl | _PSB_GMCH_ENABLED); 1158ba8209fSPatrik Jakobsson 11642ceddb6SThomas Zimmermann /* Rebuild our GTT mappings */ 11742ceddb6SThomas Zimmermann psb_gtt_resume(dev); 11842ceddb6SThomas Zimmermann psb_gem_mm_resume(dev); 119bbbb262dSAlan Cox dev_priv->ops->restore_regs(dev); 120bbbb262dSAlan Cox } 121bbbb262dSAlan Cox 122bbbb262dSAlan Cox /** 123bbbb262dSAlan Cox * gma_suspend_pci - suspend PCI side 124bbbb262dSAlan Cox * @pdev: PCI device 125bbbb262dSAlan Cox * 126bbbb262dSAlan Cox * Perform the suspend processing on our PCI device state 127bbbb262dSAlan Cox */ 128bbbb262dSAlan Cox static void gma_suspend_pci(struct pci_dev *pdev) 129bbbb262dSAlan Cox { 130bbbb262dSAlan Cox struct drm_device *dev = pci_get_drvdata(pdev); 131f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(dev); 132bbbb262dSAlan Cox int bsm, vbt; 133bbbb262dSAlan Cox 134bbbb262dSAlan Cox if (dev_priv->suspended) 135bbbb262dSAlan Cox return; 136bbbb262dSAlan Cox 137bbbb262dSAlan Cox pci_save_state(pdev); 138bbbb262dSAlan Cox pci_read_config_dword(pdev, 0x5C, &bsm); 139648a8e34SAlan Cox dev_priv->regs.saveBSM = bsm; 140bbbb262dSAlan Cox pci_read_config_dword(pdev, 0xFC, &vbt); 141648a8e34SAlan Cox dev_priv->regs.saveVBT = vbt; 142bbbb262dSAlan Cox pci_read_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, &dev_priv->msi_addr); 143bbbb262dSAlan Cox pci_read_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, &dev_priv->msi_data); 144bbbb262dSAlan Cox 145bbbb262dSAlan Cox pci_disable_device(pdev); 146bbbb262dSAlan Cox pci_set_power_state(pdev, PCI_D3hot); 147bbbb262dSAlan Cox 148bbbb262dSAlan Cox dev_priv->suspended = true; 149bbbb262dSAlan Cox } 150bbbb262dSAlan Cox 151bbbb262dSAlan Cox /** 152bbbb262dSAlan Cox * gma_resume_pci - resume helper 15363ad2a97SLee Jones * @pdev: our PCI device 154bbbb262dSAlan Cox * 155bbbb262dSAlan Cox * Perform the resume processing on our PCI device state - rewrite 156bbbb262dSAlan Cox * register state and re-enable the PCI device 157bbbb262dSAlan Cox */ 158bbbb262dSAlan Cox static bool gma_resume_pci(struct pci_dev *pdev) 159bbbb262dSAlan Cox { 160bbbb262dSAlan Cox struct drm_device *dev = pci_get_drvdata(pdev); 161f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(dev); 162bbbb262dSAlan Cox int ret; 163bbbb262dSAlan Cox 164bbbb262dSAlan Cox if (!dev_priv->suspended) 165bbbb262dSAlan Cox return true; 166bbbb262dSAlan Cox 167bbbb262dSAlan Cox pci_set_power_state(pdev, PCI_D0); 168bbbb262dSAlan Cox pci_restore_state(pdev); 169648a8e34SAlan Cox pci_write_config_dword(pdev, 0x5c, dev_priv->regs.saveBSM); 170648a8e34SAlan Cox pci_write_config_dword(pdev, 0xFC, dev_priv->regs.saveVBT); 171bbbb262dSAlan Cox /* restoring MSI address and data in PCIx space */ 172bbbb262dSAlan Cox pci_write_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, dev_priv->msi_addr); 173bbbb262dSAlan Cox pci_write_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, dev_priv->msi_data); 174bbbb262dSAlan Cox ret = pci_enable_device(pdev); 175bbbb262dSAlan Cox 176bbbb262dSAlan Cox if (ret != 0) 177bbbb262dSAlan Cox dev_err(&pdev->dev, "pci_enable failed: %d\n", ret); 178bbbb262dSAlan Cox else 179bbbb262dSAlan Cox dev_priv->suspended = false; 180bbbb262dSAlan Cox return !dev_priv->suspended; 181bbbb262dSAlan Cox } 182bbbb262dSAlan Cox 183bbbb262dSAlan Cox /** 184bbbb262dSAlan Cox * gma_power_suspend - bus callback for suspend 18563ad2a97SLee Jones * @_dev: our device 186bbbb262dSAlan Cox * 187bbbb262dSAlan Cox * Called back by the PCI layer during a suspend of the system. We 188bbbb262dSAlan Cox * perform the necessary shut down steps and save enough state that 189bbbb262dSAlan Cox * we can undo this when resume is called. 190bbbb262dSAlan Cox */ 191bbbb262dSAlan Cox int gma_power_suspend(struct device *_dev) 192bbbb262dSAlan Cox { 193d21b02afSGeliang Tang struct pci_dev *pdev = to_pci_dev(_dev); 194bbbb262dSAlan Cox struct drm_device *dev = pci_get_drvdata(pdev); 195f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(dev); 196bbbb262dSAlan Cox 197bbbb262dSAlan Cox mutex_lock(&power_mutex); 198bbbb262dSAlan Cox if (!dev_priv->suspended) { 199bbbb262dSAlan Cox if (dev_priv->display_count) { 200bbbb262dSAlan Cox mutex_unlock(&power_mutex); 20109016a11SAlan Cox dev_err(dev->dev, "GPU hardware busy, cannot suspend\n"); 202bbbb262dSAlan Cox return -EBUSY; 203bbbb262dSAlan Cox } 204*5d5fb746SPatrik Jakobsson gma_irq_uninstall(dev); 205bbbb262dSAlan Cox gma_suspend_display(dev); 206bbbb262dSAlan Cox gma_suspend_pci(pdev); 207bbbb262dSAlan Cox } 208bbbb262dSAlan Cox mutex_unlock(&power_mutex); 209bbbb262dSAlan Cox return 0; 210bbbb262dSAlan Cox } 211bbbb262dSAlan Cox 212bbbb262dSAlan Cox /** 213bbbb262dSAlan Cox * gma_power_resume - resume power 21463ad2a97SLee Jones * @_dev: our device 215bbbb262dSAlan Cox * 216bbbb262dSAlan Cox * Resume the PCI side of the graphics and then the displays 217bbbb262dSAlan Cox */ 218bbbb262dSAlan Cox int gma_power_resume(struct device *_dev) 219bbbb262dSAlan Cox { 220d21b02afSGeliang Tang struct pci_dev *pdev = to_pci_dev(_dev); 221bbbb262dSAlan Cox struct drm_device *dev = pci_get_drvdata(pdev); 222bbbb262dSAlan Cox 223bbbb262dSAlan Cox mutex_lock(&power_mutex); 224bbbb262dSAlan Cox gma_resume_pci(pdev); 225bbbb262dSAlan Cox gma_resume_display(pdev); 226*5d5fb746SPatrik Jakobsson gma_irq_preinstall(dev); 227*5d5fb746SPatrik Jakobsson gma_irq_postinstall(dev); 228bbbb262dSAlan Cox mutex_unlock(&power_mutex); 229bbbb262dSAlan Cox return 0; 230bbbb262dSAlan Cox } 231bbbb262dSAlan Cox 232bbbb262dSAlan Cox /** 233bbbb262dSAlan Cox * gma_power_is_on - returne true if power is on 234bbbb262dSAlan Cox * @dev: our DRM device 235bbbb262dSAlan Cox * 236bbbb262dSAlan Cox * Returns true if the display island power is on at this moment 237bbbb262dSAlan Cox */ 238bbbb262dSAlan Cox bool gma_power_is_on(struct drm_device *dev) 239bbbb262dSAlan Cox { 240f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(dev); 241bbbb262dSAlan Cox return dev_priv->display_power; 242bbbb262dSAlan Cox } 243bbbb262dSAlan Cox 244bbbb262dSAlan Cox /** 245bbbb262dSAlan Cox * gma_power_begin - begin requiring power 246bbbb262dSAlan Cox * @dev: our DRM device 247bbbb262dSAlan Cox * @force_on: true to force power on 248bbbb262dSAlan Cox * 249bbbb262dSAlan Cox * Begin an action that requires the display power island is enabled. 250bbbb262dSAlan Cox * We refcount the islands. 251bbbb262dSAlan Cox */ 252bbbb262dSAlan Cox bool gma_power_begin(struct drm_device *dev, bool force_on) 253bbbb262dSAlan Cox { 254f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(dev); 255a2c68495SThomas Zimmermann struct pci_dev *pdev = to_pci_dev(dev->dev); 256bbbb262dSAlan Cox int ret; 257bbbb262dSAlan Cox unsigned long flags; 258bbbb262dSAlan Cox 259bbbb262dSAlan Cox spin_lock_irqsave(&power_ctrl_lock, flags); 260bbbb262dSAlan Cox /* Power already on ? */ 261bbbb262dSAlan Cox if (dev_priv->display_power) { 262bbbb262dSAlan Cox dev_priv->display_count++; 263a2c68495SThomas Zimmermann pm_runtime_get(dev->dev); 264bbbb262dSAlan Cox spin_unlock_irqrestore(&power_ctrl_lock, flags); 265bbbb262dSAlan Cox return true; 266bbbb262dSAlan Cox } 267bbbb262dSAlan Cox if (force_on == false) 268bbbb262dSAlan Cox goto out_false; 269bbbb262dSAlan Cox 270bbbb262dSAlan Cox /* Ok power up needed */ 271a2c68495SThomas Zimmermann ret = gma_resume_pci(pdev); 272bbbb262dSAlan Cox if (ret == 0) { 273*5d5fb746SPatrik Jakobsson gma_irq_preinstall(dev); 274*5d5fb746SPatrik Jakobsson gma_irq_postinstall(dev); 275a2c68495SThomas Zimmermann pm_runtime_get(dev->dev); 276bbbb262dSAlan Cox dev_priv->display_count++; 277bbbb262dSAlan Cox spin_unlock_irqrestore(&power_ctrl_lock, flags); 278bbbb262dSAlan Cox return true; 279bbbb262dSAlan Cox } 280bbbb262dSAlan Cox out_false: 281bbbb262dSAlan Cox spin_unlock_irqrestore(&power_ctrl_lock, flags); 282bbbb262dSAlan Cox return false; 283bbbb262dSAlan Cox } 284bbbb262dSAlan Cox 285bbbb262dSAlan Cox /** 286bbbb262dSAlan Cox * gma_power_end - end use of power 287bbbb262dSAlan Cox * @dev: Our DRM device 288bbbb262dSAlan Cox * 289bbbb262dSAlan Cox * Indicate that one of our gma_power_begin() requested periods when 290bbbb262dSAlan Cox * the diplay island power is needed has completed. 291bbbb262dSAlan Cox */ 292bbbb262dSAlan Cox void gma_power_end(struct drm_device *dev) 293bbbb262dSAlan Cox { 294f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(dev); 295bbbb262dSAlan Cox unsigned long flags; 296bbbb262dSAlan Cox spin_lock_irqsave(&power_ctrl_lock, flags); 297bbbb262dSAlan Cox dev_priv->display_count--; 298bbbb262dSAlan Cox WARN_ON(dev_priv->display_count < 0); 299bbbb262dSAlan Cox spin_unlock_irqrestore(&power_ctrl_lock, flags); 300a2c68495SThomas Zimmermann pm_runtime_put(dev->dev); 301bbbb262dSAlan Cox } 302bbbb262dSAlan Cox 303bbbb262dSAlan Cox int psb_runtime_suspend(struct device *dev) 304bbbb262dSAlan Cox { 305bbbb262dSAlan Cox return gma_power_suspend(dev); 306bbbb262dSAlan Cox } 307bbbb262dSAlan Cox 308bbbb262dSAlan Cox int psb_runtime_resume(struct device *dev) 309bbbb262dSAlan Cox { 31009016a11SAlan Cox return gma_power_resume(dev); 311bbbb262dSAlan Cox } 312bbbb262dSAlan Cox 313bbbb262dSAlan Cox int psb_runtime_idle(struct device *dev) 314bbbb262dSAlan Cox { 315bbbb262dSAlan Cox struct drm_device *drmdev = pci_get_drvdata(to_pci_dev(dev)); 316f71635e8SThomas Zimmermann struct drm_psb_private *dev_priv = to_drm_psb_private(drmdev); 317bbbb262dSAlan Cox if (dev_priv->display_count) 318bbbb262dSAlan Cox return 0; 319bbbb262dSAlan Cox else 320bbbb262dSAlan Cox return 1; 321bbbb262dSAlan Cox } 322888eef2eSPatrik Jakobsson 323888eef2eSPatrik Jakobsson int gma_power_thaw(struct device *_dev) 324888eef2eSPatrik Jakobsson { 325888eef2eSPatrik Jakobsson return gma_power_resume(_dev); 326888eef2eSPatrik Jakobsson } 327888eef2eSPatrik Jakobsson 328888eef2eSPatrik Jakobsson int gma_power_freeze(struct device *_dev) 329888eef2eSPatrik Jakobsson { 330888eef2eSPatrik Jakobsson return gma_power_suspend(_dev); 331888eef2eSPatrik Jakobsson } 332888eef2eSPatrik Jakobsson 333888eef2eSPatrik Jakobsson int gma_power_restore(struct device *_dev) 334888eef2eSPatrik Jakobsson { 335888eef2eSPatrik Jakobsson return gma_power_resume(_dev); 336888eef2eSPatrik Jakobsson } 337