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 DEFINE_SPINLOCK(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 mutex_init(&power_mutex); 59 60 if (dev_priv->ops->init_pm) 61 dev_priv->ops->init_pm(dev); 62 } 63 64 /** 65 * gma_power_uninit - end power manager 66 * @dev: device to end for 67 * 68 * Undo the effects of gma_power_init 69 */ 70 void gma_power_uninit(struct drm_device *dev) 71 { 72 pm_runtime_disable(dev->dev); 73 pm_runtime_set_suspended(dev->dev); 74 } 75 76 /** 77 * gma_suspend_display - suspend the display logic 78 * @dev: our DRM device 79 * 80 * Suspend the display logic of the graphics interface 81 */ 82 static void gma_suspend_display(struct drm_device *dev) 83 { 84 struct drm_psb_private *dev_priv = dev->dev_private; 85 86 if (dev_priv->suspended) 87 return; 88 dev_priv->ops->save_regs(dev); 89 dev_priv->ops->power_down(dev); 90 dev_priv->display_power = false; 91 } 92 93 /** 94 * gma_resume_display - resume display side logic 95 * @pdev: PCI device 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 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 */ 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 * @pdev: 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); 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 * @_dev: our device 182 * 183 * Called back by the PCI layer during a suspend of the system. We 184 * perform the necessary shut down steps and save enough state that 185 * we can undo this when resume is called. 186 */ 187 int gma_power_suspend(struct device *_dev) 188 { 189 struct pci_dev *pdev = to_pci_dev(_dev); 190 struct drm_device *dev = pci_get_drvdata(pdev); 191 struct drm_psb_private *dev_priv = dev->dev_private; 192 193 mutex_lock(&power_mutex); 194 if (!dev_priv->suspended) { 195 if (dev_priv->display_count) { 196 mutex_unlock(&power_mutex); 197 dev_err(dev->dev, "GPU hardware busy, cannot suspend\n"); 198 return -EBUSY; 199 } 200 psb_irq_uninstall(dev); 201 gma_suspend_display(dev); 202 gma_suspend_pci(pdev); 203 } 204 mutex_unlock(&power_mutex); 205 return 0; 206 } 207 208 /** 209 * gma_power_resume - resume power 210 * @_dev: our device 211 * 212 * Resume the PCI side of the graphics and then the displays 213 */ 214 int gma_power_resume(struct device *_dev) 215 { 216 struct pci_dev *pdev = to_pci_dev(_dev); 217 struct drm_device *dev = pci_get_drvdata(pdev); 218 219 mutex_lock(&power_mutex); 220 gma_resume_pci(pdev); 221 gma_resume_display(pdev); 222 psb_irq_preinstall(dev); 223 psb_irq_postinstall(dev); 224 mutex_unlock(&power_mutex); 225 return 0; 226 } 227 228 /** 229 * gma_power_is_on - returne true if power is on 230 * @dev: our DRM device 231 * 232 * Returns true if the display island power is on at this moment 233 */ 234 bool gma_power_is_on(struct drm_device *dev) 235 { 236 struct drm_psb_private *dev_priv = dev->dev_private; 237 return dev_priv->display_power; 238 } 239 240 /** 241 * gma_power_begin - begin requiring power 242 * @dev: our DRM device 243 * @force_on: true to force power on 244 * 245 * Begin an action that requires the display power island is enabled. 246 * We refcount the islands. 247 */ 248 bool gma_power_begin(struct drm_device *dev, bool force_on) 249 { 250 struct drm_psb_private *dev_priv = dev->dev_private; 251 struct pci_dev *pdev = to_pci_dev(dev->dev); 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->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(pdev); 268 if (ret == 0) { 269 psb_irq_preinstall(dev); 270 psb_irq_postinstall(dev); 271 pm_runtime_get(dev->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->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 { 306 return gma_power_resume(dev); 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 } 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 } 333