git.itanic.dy.fi Git - linux-stable/blob - drivers/gpu/drm/gma500/power.c

   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         pci_read_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, &dev_priv->msi_addr);
 143         pci_read_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, &dev_priv->msi_data);
 144
 145         pci_disable_device(pdev);
 146         pci_set_power_state(pdev, PCI_D3hot);
 147
 148         dev_priv->suspended = true;
 149 }
 150
 151 /**
 152  *      gma_resume_pci          -       resume helper
 153  *      @pdev: our PCI device
 154  *
 155  *      Perform the resume processing on our PCI device state - rewrite
 156  *      register state and re-enable the PCI device
 157  */
 158 static bool gma_resume_pci(struct pci_dev *pdev)
 159 {
 160         struct drm_device *dev = pci_get_drvdata(pdev);
 161         struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
 162         int ret;
 163
 164         if (!dev_priv->suspended)
 165                 return true;
 166
 167         pci_set_power_state(pdev, PCI_D0);
 168         pci_restore_state(pdev);
 169         pci_write_config_dword(pdev, 0x5c, dev_priv->regs.saveBSM);
 170         pci_write_config_dword(pdev, 0xFC, dev_priv->regs.saveVBT);
 171         /* restoring MSI address and data in PCIx space */
 172         pci_write_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, dev_priv->msi_addr);
 173         pci_write_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, dev_priv->msi_data);
 174         ret = pci_enable_device(pdev);
 175
 176         if (ret != 0)
 177                 dev_err(&pdev->dev, "pci_enable failed: %d\n", ret);
 178         else
 179                 dev_priv->suspended = false;
 180         return !dev_priv->suspended;
 181 }
 182
 183 /**
 184  *      gma_power_suspend               -       bus callback for suspend
 185  *      @_dev: our device
 186  *
 187  *      Called back by the PCI layer during a suspend of the system. We
 188  *      perform the necessary shut down steps and save enough state that
 189  *      we can undo this when resume is called.
 190  */
 191 int gma_power_suspend(struct device *_dev)
 192 {
 193         struct pci_dev *pdev = to_pci_dev(_dev);
 194         struct drm_device *dev = pci_get_drvdata(pdev);
 195         struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
 196
 197         mutex_lock(&power_mutex);
 198         if (!dev_priv->suspended) {
 199                 if (dev_priv->display_count) {
 200                         mutex_unlock(&power_mutex);
 201                         dev_err(dev->dev, "GPU hardware busy, cannot suspend\n");
 202                         return -EBUSY;
 203                 }
 204                 gma_irq_uninstall(dev);
 205                 gma_suspend_display(dev);
 206                 gma_suspend_pci(pdev);
 207         }
 208         mutex_unlock(&power_mutex);
 209         return 0;
 210 }
 211
 212 /**
 213  *      gma_power_resume                -       resume power
 214  *      @_dev: our device
 215  *
 216  *      Resume the PCI side of the graphics and then the displays
 217  */
 218 int gma_power_resume(struct device *_dev)
 219 {
 220         struct pci_dev *pdev = to_pci_dev(_dev);
 221         struct drm_device *dev = pci_get_drvdata(pdev);
 222
 223         mutex_lock(&power_mutex);
 224         gma_resume_pci(pdev);
 225         gma_resume_display(pdev);
 226         gma_irq_preinstall(dev);
 227         gma_irq_postinstall(dev);
 228         mutex_unlock(&power_mutex);
 229         return 0;
 230 }
 231
 232 /**
 233  *      gma_power_is_on         -       returne true if power is on
 234  *      @dev: our DRM device
 235  *
 236  *      Returns true if the display island power is on at this moment
 237  */
 238 bool gma_power_is_on(struct drm_device *dev)
 239 {
 240         struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
 241         return dev_priv->display_power;
 242 }
 243
 244 /**
 245  *      gma_power_begin         -       begin requiring power
 246  *      @dev: our DRM device
 247  *      @force_on: true to force power on
 248  *
 249  *      Begin an action that requires the display power island is enabled.
 250  *      We refcount the islands.
 251  */
 252 bool gma_power_begin(struct drm_device *dev, bool force_on)
 253 {
 254         struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
 255         struct pci_dev *pdev = to_pci_dev(dev->dev);
 256         int ret;
 257         unsigned long flags;
 258
 259         spin_lock_irqsave(&power_ctrl_lock, flags);
 260         /* Power already on ? */
 261         if (dev_priv->display_power) {
 262                 dev_priv->display_count++;
 263                 pm_runtime_get(dev->dev);
 264                 spin_unlock_irqrestore(&power_ctrl_lock, flags);
 265                 return true;
 266         }
 267         if (force_on == false)
 268                 goto out_false;
 269
 270         /* Ok power up needed */
 271         ret = gma_resume_pci(pdev);
 272         if (ret == 0) {
 273                 gma_irq_preinstall(dev);
 274                 gma_irq_postinstall(dev);
 275                 pm_runtime_get(dev->dev);
 276                 dev_priv->display_count++;
 277                 spin_unlock_irqrestore(&power_ctrl_lock, flags);
 278                 return true;
 279         }
 280 out_false:
 281         spin_unlock_irqrestore(&power_ctrl_lock, flags);
 282         return false;
 283 }
 284
 285 /**
 286  *      gma_power_end           -       end use of power
 287  *      @dev: Our DRM device
 288  *
 289  *      Indicate that one of our gma_power_begin() requested periods when
 290  *      the diplay island power is needed has completed.
 291  */
 292 void gma_power_end(struct drm_device *dev)
 293 {
 294         struct drm_psb_private *dev_priv = to_drm_psb_private(dev);
 295         unsigned long flags;
 296         spin_lock_irqsave(&power_ctrl_lock, flags);
 297         dev_priv->display_count--;
 298         WARN_ON(dev_priv->display_count < 0);
 299         spin_unlock_irqrestore(&power_ctrl_lock, flags);
 300         pm_runtime_put(dev->dev);
 301 }
 302
 303 int psb_runtime_suspend(struct device *dev)
 304 {
 305         return gma_power_suspend(dev);
 306 }
 307
 308 int psb_runtime_resume(struct device *dev)
 309 {
 310         return gma_power_resume(dev);
 311 }
 312
 313 int psb_runtime_idle(struct device *dev)
 314 {
 315         struct drm_device *drmdev = pci_get_drvdata(to_pci_dev(dev));
 316         struct drm_psb_private *dev_priv = to_drm_psb_private(drmdev);
 317         if (dev_priv->display_count)
 318                 return 0;
 319         else
 320                 return 1;
 321 }
 322
 323 int gma_power_thaw(struct device *_dev)
 324 {
 325         return gma_power_resume(_dev);
 326 }
 327
 328 int gma_power_freeze(struct device *_dev)
 329 {
 330         return gma_power_suspend(_dev);
 331 }
 332
 333 int gma_power_restore(struct device *_dev)
 334 {
 335         return gma_power_resume(_dev);
 336 }