drivers/staging/gma500/psb_powermgmt.c

   1 /**************************************************************************
   2  * Copyright (c) 2009, 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  *
  28  */
  29 #include "psb_powermgmt.h"
  30 #include "psb_drv.h"
  31 #include "psb_intel_reg.h"
  32 #include <linux/mutex.h>
  33 #include <linux/pm_runtime.h>
  34
  35 #undef OSPM_GFX_DPK
  36
  37 extern u32 gui32SGXDeviceID;
  38 extern u32 gui32MRSTDisplayDeviceID;
  39 extern u32 gui32MRSTMSVDXDeviceID;
  40 extern u32 gui32MRSTTOPAZDeviceID;
  41
  42 struct drm_device *gpDrmDevice = NULL;
  43 static struct mutex power_mutex;
  44 static bool gbSuspendInProgress = false;
  45 static bool gbResumeInProgress = false;
  46 static int g_hw_power_status_mask;
  47 static atomic_t g_display_access_count;
  48 static atomic_t g_graphics_access_count;
  49 static atomic_t g_videoenc_access_count;
  50 static atomic_t g_videodec_access_count;
  51 int allow_runtime_pm = 0;
  52
  53 void ospm_power_island_up(int hw_islands);
  54 void ospm_power_island_down(int hw_islands);
  55 static bool gbSuspended = false;
  56 bool gbgfxsuspended = false;
  57
  58 /*
  59  * ospm_power_init
  60  *
  61  * Description: Initialize this ospm power management module
  62  */
  63 void ospm_power_init(struct drm_device *dev)
  64 {
  65         struct drm_psb_private *dev_priv = (struct drm_psb_private *)dev->dev_private;
  66
  67         gpDrmDevice = dev;
  68
  69         dev_priv->apm_base = dev_priv->apm_reg & 0xffff;
  70         dev_priv->ospm_base &= 0xffff;
  71
  72         mutex_init(&power_mutex);
  73         g_hw_power_status_mask = OSPM_ALL_ISLANDS;
  74         atomic_set(&g_display_access_count, 0);
  75         atomic_set(&g_graphics_access_count, 0);
  76         atomic_set(&g_videoenc_access_count, 0);
  77         atomic_set(&g_videodec_access_count, 0);
  78 }
  79
  80 /*
  81  * ospm_power_uninit
  82  *
  83  * Description: Uninitialize this ospm power management module
  84  */
  85 void ospm_power_uninit(void)
  86 {
  87         mutex_destroy(&power_mutex);
  88         pm_runtime_disable(&gpDrmDevice->pdev->dev);
  89         pm_runtime_set_suspended(&gpDrmDevice->pdev->dev);
  90 }
  91
  92
  93 /*
  94  * save_display_registers
  95  *
  96  * Description: We are going to suspend so save current display
  97  * register state.
  98  */
  99 static int save_display_registers(struct drm_device *dev)
 100 {
 101         struct drm_psb_private *dev_priv = dev->dev_private;
 102         struct drm_crtc * crtc;
 103         struct drm_connector * connector;
 104
 105         /* Display arbitration control + watermarks */
 106         dev_priv->saveDSPARB = PSB_RVDC32(DSPARB);
 107         dev_priv->saveDSPFW1 = PSB_RVDC32(DSPFW1);
 108         dev_priv->saveDSPFW2 = PSB_RVDC32(DSPFW2);
 109         dev_priv->saveDSPFW3 = PSB_RVDC32(DSPFW3);
 110         dev_priv->saveDSPFW4 = PSB_RVDC32(DSPFW4);
 111         dev_priv->saveDSPFW5 = PSB_RVDC32(DSPFW5);
 112         dev_priv->saveDSPFW6 = PSB_RVDC32(DSPFW6);
 113         dev_priv->saveCHICKENBIT = PSB_RVDC32(DSPCHICKENBIT);
 114
 115         /*save crtc and output state*/
 116         mutex_lock(&dev->mode_config.mutex);
 117         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 118                 if(drm_helper_crtc_in_use(crtc)) {
 119                         crtc->funcs->save(crtc);
 120                 }
 121         }
 122
 123         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 124                 connector->funcs->save(connector);
 125         }
 126         mutex_unlock(&dev->mode_config.mutex);
 127
 128         /* Interrupt state */
 129         /*
 130          * Handled in psb_irq.c
 131          */
 132
 133         return 0;
 134 }
 135
 136 /*
 137  * restore_display_registers
 138  *
 139  * Description: We are going to resume so restore display register state.
 140  */
 141 static int restore_display_registers(struct drm_device *dev)
 142 {
 143         struct drm_psb_private *dev_priv = dev->dev_private;
 144         struct drm_crtc * crtc;
 145         struct drm_connector * connector;
 146
 147         /* Display arbitration + watermarks */
 148         PSB_WVDC32(dev_priv->saveDSPARB, DSPARB);
 149         PSB_WVDC32(dev_priv->saveDSPFW1, DSPFW1);
 150         PSB_WVDC32(dev_priv->saveDSPFW2, DSPFW2);
 151         PSB_WVDC32(dev_priv->saveDSPFW3, DSPFW3);
 152         PSB_WVDC32(dev_priv->saveDSPFW4, DSPFW4);
 153         PSB_WVDC32(dev_priv->saveDSPFW5, DSPFW5);
 154         PSB_WVDC32(dev_priv->saveDSPFW6, DSPFW6);
 155         PSB_WVDC32(dev_priv->saveCHICKENBIT, DSPCHICKENBIT);
 156
 157         /*make sure VGA plane is off. it initializes to on after reset!*/
 158         PSB_WVDC32(0x80000000, VGACNTRL);
 159
 160         mutex_lock(&dev->mode_config.mutex);
 161         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 162                 if(drm_helper_crtc_in_use(crtc))
 163                         crtc->funcs->restore(crtc);
 164         }
 165         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 166                 connector->funcs->restore(connector);
 167         }
 168         mutex_unlock(&dev->mode_config.mutex);
 169
 170         /*Interrupt state*/
 171         /*
 172          * Handled in psb_irq.c
 173          */
 174
 175         return 0;
 176 }
 177 /*
 178  * powermgmt_suspend_display
 179  *
 180  * Description: Suspend the display hardware saving state and disabling
 181  * as necessary.
 182  */
 183 void ospm_suspend_display(struct drm_device *dev)
 184 {
 185         struct drm_psb_private *dev_priv = dev->dev_private;
 186         int pp_stat, ret=0;
 187
 188         printk(KERN_ALERT "%s \n", __func__);
 189
 190 #ifdef OSPM_GFX_DPK
 191         printk(KERN_ALERT "%s \n", __func__);
 192 #endif
 193         if (!(g_hw_power_status_mask & OSPM_DISPLAY_ISLAND))
 194                 return;
 195
 196         save_display_registers(dev);
 197
 198         if (dev_priv->iLVDS_enable) {
 199                 /*shutdown the panel*/
 200                 PSB_WVDC32(0, PP_CONTROL);
 201
 202                 do {
 203                         pp_stat = PSB_RVDC32(PP_STATUS);
 204                 } while (pp_stat & 0x80000000);
 205
 206                 /*turn off the plane*/
 207                 PSB_WVDC32(0x58000000, DSPACNTR);
 208                 PSB_WVDC32(0, DSPASURF);/*trigger the plane disable*/
 209                 /*wait ~4 ticks*/
 210                 msleep(4);
 211
 212                 /*turn off pipe*/
 213                 PSB_WVDC32(0x0, PIPEACONF);
 214                 /*wait ~8 ticks*/
 215                 msleep(8);
 216
 217                 /*turn off PLLs*/
 218                 PSB_WVDC32(0, MRST_DPLL_A);
 219         } else {
 220                 PSB_WVDC32(DPI_SHUT_DOWN, DPI_CONTROL_REG);
 221                 PSB_WVDC32(0x0, PIPEACONF);
 222                 PSB_WVDC32(0x2faf0000, BLC_PWM_CTL);
 223                 while (REG_READ(0x70008) & 0x40000000);
 224                 while ((PSB_RVDC32(GEN_FIFO_STAT_REG) & DPI_FIFO_EMPTY)
 225                         != DPI_FIFO_EMPTY);
 226                 PSB_WVDC32(0, DEVICE_READY_REG);
 227                         /* turn off panel power */
 228                 ret = 0;
 229         }
 230         ospm_power_island_down(OSPM_DISPLAY_ISLAND);
 231 }
 232
 233 /*
 234  * ospm_resume_display
 235  *
 236  * Description: Resume the display hardware restoring state and enabling
 237  * as necessary.
 238  */
 239 void ospm_resume_display(struct pci_dev *pdev)
 240 {
 241         struct drm_device *dev = pci_get_drvdata(pdev);
 242         struct drm_psb_private *dev_priv = dev->dev_private;
 243         struct psb_gtt *pg = dev_priv->pg;
 244
 245         printk(KERN_ALERT "%s \n", __func__);
 246
 247 #ifdef OSPM_GFX_DPK
 248         printk(KERN_ALERT "%s \n", __func__);
 249 #endif
 250         if (g_hw_power_status_mask & OSPM_DISPLAY_ISLAND)
 251                 return;
 252
 253         /* turn on the display power island */
 254         ospm_power_island_up(OSPM_DISPLAY_ISLAND);
 255
 256         PSB_WVDC32(pg->pge_ctl | _PSB_PGETBL_ENABLED, PSB_PGETBL_CTL);
 257         pci_write_config_word(pdev, PSB_GMCH_CTRL,
 258                         pg->gmch_ctrl | _PSB_GMCH_ENABLED);
 259
 260         /* Don't reinitialize the GTT as it is unnecessary.  The gtt is
 261          * stored in memory so it will automatically be restored.  All
 262          * we need to do is restore the PGETBL_CTL which we already do
 263          * above.
 264          */
 265         /*psb_gtt_init(dev_priv->pg, 1);*/
 266
 267         restore_display_registers(dev);
 268 }
 269
 270 #if 1
 271 /*
 272  * ospm_suspend_pci
 273  *
 274  * Description: Suspend the pci device saving state and disabling
 275  * as necessary.
 276  */
 277 static void ospm_suspend_pci(struct pci_dev *pdev)
 278 {
 279         struct drm_device *dev = pci_get_drvdata(pdev);
 280         struct drm_psb_private *dev_priv = dev->dev_private;
 281         int bsm, vbt;
 282
 283         if (gbSuspended)
 284                 return;
 285
 286 #ifdef OSPM_GFX_DPK
 287         printk(KERN_ALERT "ospm_suspend_pci\n");
 288 #endif
 289
 290 #ifdef CONFIG_MDFD_GL3
 291         // Power off GL3 after all GFX sub-systems are powered off.
 292         ospm_power_island_down(OSPM_GL3_CACHE_ISLAND);
 293 #endif
 294
 295         pci_save_state(pdev);
 296         pci_read_config_dword(pdev, 0x5C, &bsm);
 297         dev_priv->saveBSM = bsm;
 298         pci_read_config_dword(pdev, 0xFC, &vbt);
 299         dev_priv->saveVBT = vbt;
 300         pci_read_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, &dev_priv->msi_addr);
 301         pci_read_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, &dev_priv->msi_data);
 302
 303         pci_disable_device(pdev);
 304         pci_set_power_state(pdev, PCI_D3hot);
 305
 306         gbSuspended = true;
 307         gbgfxsuspended = true;
 308 }
 309
 310 /*
 311  * ospm_resume_pci
 312  *
 313  * Description: Resume the pci device restoring state and enabling
 314  * as necessary.
 315  */
 316 static bool ospm_resume_pci(struct pci_dev *pdev)
 317 {
 318         struct drm_device *dev = pci_get_drvdata(pdev);
 319         struct drm_psb_private *dev_priv = dev->dev_private;
 320         int ret = 0;
 321
 322         if (!gbSuspended)
 323                 return true;
 324
 325 #ifdef OSPM_GFX_DPK
 326         printk(KERN_ALERT "ospm_resume_pci\n");
 327 #endif
 328
 329         pci_set_power_state(pdev, PCI_D0);
 330         pci_restore_state(pdev);
 331         pci_write_config_dword(pdev, 0x5c, dev_priv->saveBSM);
 332         pci_write_config_dword(pdev, 0xFC, dev_priv->saveVBT);
 333         /* retoring MSI address and data in PCIx space */
 334         pci_write_config_dword(pdev, PSB_PCIx_MSI_ADDR_LOC, dev_priv->msi_addr);
 335         pci_write_config_dword(pdev, PSB_PCIx_MSI_DATA_LOC, dev_priv->msi_data);
 336         ret = pci_enable_device(pdev);
 337
 338         if (ret != 0)
 339                 printk(KERN_ALERT "ospm_resume_pci: pci_enable_device failed: %d\n", ret);
 340         else
 341                 gbSuspended = false;
 342
 343         return !gbSuspended;
 344 }
 345 #endif
 346 /*
 347  * ospm_power_suspend
 348  *
 349  * Description: OSPM is telling our driver to suspend so save state
 350  * and power down all hardware.
 351  */
 352 int ospm_power_suspend(struct pci_dev *pdev, pm_message_t state)
 353 {
 354         int ret = 0;
 355         int graphics_access_count;
 356         int videoenc_access_count;
 357         int videodec_access_count;
 358         int display_access_count;
 359         bool suspend_pci = true;
 360
 361         if(gbSuspendInProgress || gbResumeInProgress)
 362         {
 363 #ifdef OSPM_GFX_DPK
 364                 printk(KERN_ALERT "OSPM_GFX_DPK: %s system BUSY \n", __func__);
 365 #endif
 366                 return  -EBUSY;
 367         }
 368
 369         mutex_lock(&power_mutex);
 370
 371         if (!gbSuspended) {
 372                 graphics_access_count = atomic_read(&g_graphics_access_count);
 373                 videoenc_access_count = atomic_read(&g_videoenc_access_count);
 374                 videodec_access_count = atomic_read(&g_videodec_access_count);
 375                 display_access_count = atomic_read(&g_display_access_count);
 376
 377                 if (graphics_access_count ||
 378                         videoenc_access_count ||
 379                         videodec_access_count ||
 380                         display_access_count)
 381                         ret = -EBUSY;
 382
 383                 if (!ret) {
 384                         gbSuspendInProgress = true;
 385
 386                         psb_irq_uninstall_islands(gpDrmDevice, OSPM_DISPLAY_ISLAND);
 387                         ospm_suspend_display(gpDrmDevice);
 388                         if (suspend_pci == true) {
 389                                 ospm_suspend_pci(pdev);
 390                         }
 391                         gbSuspendInProgress = false;
 392                 } else {
 393                         printk(KERN_ALERT "ospm_power_suspend: device busy: graphics %d videoenc %d videodec %d display %d\n", graphics_access_count, videoenc_access_count, videodec_access_count, display_access_count);
 394                 }
 395         }
 396
 397
 398         mutex_unlock(&power_mutex);
 399         return ret;
 400 }
 401
 402 /*
 403  * ospm_power_island_up
 404  *
 405  * Description: Restore power to the specified island(s) (powergating)
 406  */
 407 void ospm_power_island_up(int hw_islands)
 408 {
 409         u32 pwr_cnt = 0;
 410         u32 pwr_sts = 0;
 411         u32 pwr_mask = 0;
 412
 413         struct drm_psb_private *dev_priv =
 414                 (struct drm_psb_private *) gpDrmDevice->dev_private;
 415
 416
 417         if (hw_islands & OSPM_DISPLAY_ISLAND) {
 418                 pwr_mask = PSB_PWRGT_DISPLAY_MASK;
 419
 420                 pwr_cnt = inl(dev_priv->ospm_base + PSB_PM_SSC);
 421                 pwr_cnt &= ~pwr_mask;
 422                 outl(pwr_cnt, (dev_priv->ospm_base + PSB_PM_SSC));
 423
 424                 while (true) {
 425                         pwr_sts = inl(dev_priv->ospm_base + PSB_PM_SSS);
 426                         if ((pwr_sts & pwr_mask) == 0)
 427                                 break;
 428                         else
 429                                 udelay(10);
 430                 }
 431         }
 432
 433         g_hw_power_status_mask |= hw_islands;
 434 }
 435
 436 /*
 437  * ospm_power_resume
 438  */
 439 int ospm_power_resume(struct pci_dev *pdev)
 440 {
 441         if(gbSuspendInProgress || gbResumeInProgress)
 442         {
 443 #ifdef OSPM_GFX_DPK
 444                 printk(KERN_ALERT "OSPM_GFX_DPK: %s hw_island: Suspend || gbResumeInProgress!!!! \n", __func__);
 445 #endif
 446                 return 0;
 447         }
 448
 449         mutex_lock(&power_mutex);
 450
 451 #ifdef OSPM_GFX_DPK
 452         printk(KERN_ALERT "OSPM_GFX_DPK: ospm_power_resume \n");
 453 #endif
 454
 455         gbResumeInProgress = true;
 456
 457         ospm_resume_pci(pdev);
 458
 459         ospm_resume_display(gpDrmDevice->pdev);
 460         psb_irq_preinstall_islands(gpDrmDevice, OSPM_DISPLAY_ISLAND);
 461         psb_irq_postinstall_islands(gpDrmDevice, OSPM_DISPLAY_ISLAND);
 462
 463         gbResumeInProgress = false;
 464
 465         mutex_unlock(&power_mutex);
 466
 467         return 0;
 468 }
 469
 470
 471 /*
 472  * ospm_power_island_down
 473  *
 474  * Description: Cut power to the specified island(s) (powergating)
 475  */
 476 void ospm_power_island_down(int islands)
 477 {
 478 #if 0
 479         u32 pwr_cnt = 0;
 480         u32 pwr_mask = 0;
 481         u32 pwr_sts = 0;
 482
 483         struct drm_psb_private *dev_priv =
 484                 (struct drm_psb_private *) gpDrmDevice->dev_private;
 485
 486         g_hw_power_status_mask &= ~islands;
 487
 488         if (islands & OSPM_GRAPHICS_ISLAND) {
 489                 pwr_cnt |= PSB_PWRGT_GFX_MASK;
 490                 pwr_mask |= PSB_PWRGT_GFX_MASK;
 491                 if (dev_priv->graphics_state == PSB_PWR_STATE_ON) {
 492                         dev_priv->gfx_on_time += (jiffies - dev_priv->gfx_last_mode_change) * 1000 / HZ;
 493                         dev_priv->gfx_last_mode_change = jiffies;
 494                         dev_priv->graphics_state = PSB_PWR_STATE_OFF;
 495                         dev_priv->gfx_off_cnt++;
 496                 }
 497         }
 498         if (islands & OSPM_VIDEO_ENC_ISLAND) {
 499                 pwr_cnt |= PSB_PWRGT_VID_ENC_MASK;
 500                 pwr_mask |= PSB_PWRGT_VID_ENC_MASK;
 501         }
 502         if (islands & OSPM_VIDEO_DEC_ISLAND) {
 503                 pwr_cnt |= PSB_PWRGT_VID_DEC_MASK;
 504                 pwr_mask |= PSB_PWRGT_VID_DEC_MASK;
 505         }
 506         if (pwr_cnt) {
 507                 pwr_cnt |= inl(dev_priv->apm_base);
 508                 outl(pwr_cnt, dev_priv->apm_base  + PSB_APM_CMD);
 509                 while (true) {
 510                         pwr_sts = inl(dev_priv->apm_base + PSB_APM_STS);
 511
 512                         if ((pwr_sts & pwr_mask) == pwr_mask)
 513                                 break;
 514                         else
 515                                 udelay(10);
 516                 }
 517         }
 518
 519         if (islands & OSPM_DISPLAY_ISLAND) {
 520                 pwr_mask = PSB_PWRGT_DISPLAY_MASK;
 521
 522                 outl(pwr_mask, (dev_priv->ospm_base + PSB_PM_SSC));
 523
 524                 while (true) {
 525                         pwr_sts = inl(dev_priv->ospm_base + PSB_PM_SSS);
 526                         if ((pwr_sts & pwr_mask) == pwr_mask)
 527                                 break;
 528                         else
 529                                 udelay(10);
 530                 }
 531         }
 532 #endif
 533 }
 534
 535
 536 /*
 537  * ospm_power_is_hw_on
 538  *
 539  * Description: do an instantaneous check for if the specified islands
 540  * are on.  Only use this in cases where you know the g_state_change_mutex
 541  * is already held such as in irq install/uninstall.  Otherwise, use
 542  * ospm_power_using_hw_begin().
 543  */
 544 bool ospm_power_is_hw_on(int hw_islands)
 545 {
 546         return ((g_hw_power_status_mask & hw_islands) == hw_islands) ? true:false;
 547 }
 548
 549 /*
 550  * ospm_power_using_hw_begin
 551  *
 552  * Description: Notify PowerMgmt module that you will be accessing the
 553  * specified island's hw so don't power it off.  If force_on is true,
 554  * this will power on the specified island if it is off.
 555  * Otherwise, this will return false and the caller is expected to not
 556  * access the hw.
 557  *
 558  * NOTE *** If this is called from and interrupt handler or other atomic
 559  * context, then it will return false if we are in the middle of a
 560  * power state transition and the caller will be expected to handle that
 561  * even if force_on is set to true.
 562  */
 563 bool ospm_power_using_hw_begin(int hw_island, UHBUsage usage)
 564 {
 565         return 1;       /*FIXMEAC */
 566 #if 0
 567         bool ret = true;
 568         bool island_is_off = false;
 569         bool b_atomic = (in_interrupt() || in_atomic());
 570         bool locked = true;
 571         struct pci_dev *pdev = gpDrmDevice->pdev;
 572         u32 deviceID = 0;
 573         bool force_on = usage ? true: false;
 574         /*quick path, not 100% race safe, but should be enough comapre to current other code in this file */
 575         if (!force_on) {
 576                 if (hw_island & (OSPM_ALL_ISLANDS & ~g_hw_power_status_mask))
 577                         return false;
 578                 else {
 579                         locked = false;
 580 #ifdef CONFIG_PM_RUNTIME
 581                         /* increment pm_runtime_refcount */
 582                         pm_runtime_get(&pdev->dev);
 583 #endif
 584                         goto increase_count;
 585                 }
 586         }
 587
 588
 589         if (!b_atomic)
 590                 mutex_lock(&power_mutex);
 591
 592         island_is_off = hw_island & (OSPM_ALL_ISLANDS & ~g_hw_power_status_mask);
 593
 594         if (b_atomic && (gbSuspendInProgress || gbResumeInProgress || gbSuspended) && force_on && island_is_off)
 595                 ret = false;
 596
 597         if (ret && island_is_off && !force_on)
 598                 ret = false;
 599
 600         if (ret && island_is_off && force_on) {
 601                 gbResumeInProgress = true;
 602
 603                 ret = ospm_resume_pci(pdev);
 604
 605                 if (ret) {
 606                         switch(hw_island)
 607                         {
 608                         case OSPM_DISPLAY_ISLAND:
 609                                 deviceID = gui32MRSTDisplayDeviceID;
 610                                 ospm_resume_display(pdev);
 611                                 psb_irq_preinstall_islands(gpDrmDevice, OSPM_DISPLAY_ISLAND);
 612                                 psb_irq_postinstall_islands(gpDrmDevice, OSPM_DISPLAY_ISLAND);
 613                                 break;
 614                         case OSPM_GRAPHICS_ISLAND:
 615                                 deviceID = gui32SGXDeviceID;
 616                                 ospm_power_island_up(OSPM_GRAPHICS_ISLAND);
 617                                 psb_irq_preinstall_islands(gpDrmDevice, OSPM_GRAPHICS_ISLAND);
 618                                 psb_irq_postinstall_islands(gpDrmDevice, OSPM_GRAPHICS_ISLAND);
 619                                 break;
 620 #if 1
 621                         case OSPM_VIDEO_DEC_ISLAND:
 622                                 if(!ospm_power_is_hw_on(OSPM_DISPLAY_ISLAND)) {
 623                                         //printk(KERN_ALERT "%s power on display for video decode use\n", __func__);
 624                                         deviceID = gui32MRSTDisplayDeviceID;
 625                                         ospm_resume_display(pdev);
 626                                         psb_irq_preinstall_islands(gpDrmDevice, OSPM_DISPLAY_ISLAND);
 627                                         psb_irq_postinstall_islands(gpDrmDevice, OSPM_DISPLAY_ISLAND);
 628                                 }
 629                                 else{
 630                                         //printk(KERN_ALERT "%s display is already on for video decode use\n", __func__);
 631                                 }
 632
 633                                 if(!ospm_power_is_hw_on(OSPM_VIDEO_DEC_ISLAND)) {
 634                                         //printk(KERN_ALERT "%s power on video decode\n", __func__);
 635                                         deviceID = gui32MRSTMSVDXDeviceID;
 636                                         ospm_power_island_up(OSPM_VIDEO_DEC_ISLAND);
 637                                         psb_irq_preinstall_islands(gpDrmDevice, OSPM_VIDEO_DEC_ISLAND);
 638                                         psb_irq_postinstall_islands(gpDrmDevice, OSPM_VIDEO_DEC_ISLAND);
 639                                 }
 640                                 else{
 641                                         //printk(KERN_ALERT "%s video decode is already on\n", __func__);
 642                                 }
 643
 644                                 break;
 645                         case OSPM_VIDEO_ENC_ISLAND:
 646                                 if(!ospm_power_is_hw_on(OSPM_DISPLAY_ISLAND)) {
 647                                         //printk(KERN_ALERT "%s power on display for video encode\n", __func__);
 648                                         deviceID = gui32MRSTDisplayDeviceID;
 649                                         ospm_resume_display(pdev);
 650                                         psb_irq_preinstall_islands(gpDrmDevice, OSPM_DISPLAY_ISLAND);
 651                                         psb_irq_postinstall_islands(gpDrmDevice, OSPM_DISPLAY_ISLAND);
 652                                 }
 653                                 else{
 654                                         //printk(KERN_ALERT "%s display is already on for video encode use\n", __func__);
 655                                 }
 656
 657                                 if(!ospm_power_is_hw_on(OSPM_VIDEO_ENC_ISLAND)) {
 658                                         //printk(KERN_ALERT "%s power on video encode\n", __func__);
 659                                         deviceID = gui32MRSTTOPAZDeviceID;
 660                                         ospm_power_island_up(OSPM_VIDEO_ENC_ISLAND);
 661                                         psb_irq_preinstall_islands(gpDrmDevice, OSPM_VIDEO_ENC_ISLAND);
 662                                         psb_irq_postinstall_islands(gpDrmDevice, OSPM_VIDEO_ENC_ISLAND);
 663                                 }
 664                                 else{
 665                                         //printk(KERN_ALERT "%s video decode is already on\n", __func__);
 666                                 }
 667 #endif
 668                                 break;
 669
 670                         default:
 671                                 printk(KERN_ALERT "%s unknown island !!!! \n", __func__);
 672                                 break;
 673                         }
 674
 675                 }
 676
 677                 if (!ret)
 678                         printk(KERN_ALERT "ospm_power_using_hw_begin: forcing on %d failed\n", hw_island);
 679
 680                 gbResumeInProgress = false;
 681         }
 682 increase_count:
 683         if (ret) {
 684                 switch(hw_island)
 685                 {
 686                 case OSPM_GRAPHICS_ISLAND:
 687                         atomic_inc(&g_graphics_access_count);
 688                         break;
 689                 case OSPM_VIDEO_ENC_ISLAND:
 690                         atomic_inc(&g_videoenc_access_count);
 691                         break;
 692                 case OSPM_VIDEO_DEC_ISLAND:
 693                         atomic_inc(&g_videodec_access_count);
 694                         break;
 695                 case OSPM_DISPLAY_ISLAND:
 696                         atomic_inc(&g_display_access_count);
 697                         break;
 698                 }
 699         }
 700
 701         if (!b_atomic && locked)
 702                 mutex_unlock(&power_mutex);
 703
 704         return ret;
 705 #endif
 706 }
 707
 708
 709 /*
 710  * ospm_power_using_hw_end
 711  *
 712  * Description: Notify PowerMgmt module that you are done accessing the
 713  * specified island's hw so feel free to power it off.  Note that this
 714  * function doesn't actually power off the islands.
 715  */
 716 void ospm_power_using_hw_end(int hw_island)
 717 {
 718 #if 0 /* FIXMEAC */
 719         switch(hw_island)
 720         {
 721         case OSPM_GRAPHICS_ISLAND:
 722                 atomic_dec(&g_graphics_access_count);
 723                 break;
 724         case OSPM_VIDEO_ENC_ISLAND:
 725                 atomic_dec(&g_videoenc_access_count);
 726                 break;
 727         case OSPM_VIDEO_DEC_ISLAND:
 728                 atomic_dec(&g_videodec_access_count);
 729                 break;
 730         case OSPM_DISPLAY_ISLAND:
 731                 atomic_dec(&g_display_access_count);
 732                 break;
 733         }
 734
 735         //decrement runtime pm ref count
 736         pm_runtime_put(&gpDrmDevice->pdev->dev);
 737
 738         WARN_ON(atomic_read(&g_graphics_access_count) < 0);
 739         WARN_ON(atomic_read(&g_videoenc_access_count) < 0);
 740         WARN_ON(atomic_read(&g_videodec_access_count) < 0);
 741         WARN_ON(atomic_read(&g_display_access_count) < 0);
 742 #endif
 743 }
 744
 745 int ospm_runtime_pm_allow(struct drm_device * dev)
 746 {
 747         return 0;
 748 }
 749
 750 void ospm_runtime_pm_forbid(struct drm_device * dev)
 751 {
 752         struct drm_psb_private * dev_priv = dev->dev_private;
 753
 754         DRM_INFO("%s\n", __FUNCTION__);
 755
 756         pm_runtime_forbid(&dev->pdev->dev);
 757         dev_priv->rpm_enabled = 0;
 758 }
 759
 760 int psb_runtime_suspend(struct device *dev)
 761 {
 762         pm_message_t state;
 763         int ret = 0;
 764         state.event = 0;
 765
 766 #ifdef OSPM_GFX_DPK
 767         printk(KERN_ALERT "OSPM_GFX_DPK: %s \n", __func__);
 768 #endif
 769         if (atomic_read(&g_graphics_access_count) || atomic_read(&g_videoenc_access_count)
 770                 || atomic_read(&g_videodec_access_count) || atomic_read(&g_display_access_count)){
 771 #ifdef OSPM_GFX_DPK
 772                 printk(KERN_ALERT "OSPM_GFX_DPK: GFX: %d VEC: %d VED: %d DC: %d DSR: %d \n", atomic_read(&g_graphics_access_count),
 773                         atomic_read(&g_videoenc_access_count), atomic_read(&g_videodec_access_count), atomic_read(&g_display_access_count));
 774 #endif
 775                 return -EBUSY;
 776         }
 777         else
 778                 ret = ospm_power_suspend(gpDrmDevice->pdev, state);
 779
 780         return ret;
 781 }
 782
 783 int psb_runtime_resume(struct device *dev)
 784 {
 785         return 0;
 786 }
 787
 788 int psb_runtime_idle(struct device *dev)
 789 {
 790         /*printk (KERN_ALERT "lvds:%d,mipi:%d\n", dev_priv->is_lvds_on, dev_priv->is_mipi_on);*/
 791         if (atomic_read(&g_graphics_access_count) || atomic_read(&g_videoenc_access_count)
 792                 || atomic_read(&g_videodec_access_count) || atomic_read(&g_display_access_count))
 793                 return 1;
 794         else
 795                 return 0;
 796 }
 797