drivers/gpu/drm/gma500/gma_device.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /**************************************************************************
   3  * Copyright (c) 2011, Intel Corporation.
   4  * All Rights Reserved.
   5  *
   6  **************************************************************************/
   7
   8 #include "psb_drv.h"
   9 #include "gma_device.h"
  10
  11 void gma_get_core_freq(struct drm_device *dev)
  12 {
  13         uint32_t clock;
  14         struct pci_dev *pdev = to_pci_dev(dev->dev);
  15         struct pci_dev *pci_root =
  16                 pci_get_domain_bus_and_slot(pci_domain_nr(pdev->bus),
  17                                             0, 0);
  18         struct drm_psb_private *dev_priv = dev->dev_private;
  19
  20         /*pci_write_config_dword(pci_root, 0xD4, 0x00C32004);*/
  21         /*pci_write_config_dword(pci_root, 0xD0, 0xE0033000);*/
  22
  23         pci_write_config_dword(pci_root, 0xD0, 0xD0050300);
  24         pci_read_config_dword(pci_root, 0xD4, &clock);
  25         pci_dev_put(pci_root);
  26
  27         switch (clock & 0x07) {
  28         case 0:
  29                 dev_priv->core_freq = 100;
  30                 break;
  31         case 1:
  32                 dev_priv->core_freq = 133;
  33                 break;
  34         case 2:
  35                 dev_priv->core_freq = 150;
  36                 break;
  37         case 3:
  38                 dev_priv->core_freq = 178;
  39                 break;
  40         case 4:
  41                 dev_priv->core_freq = 200;
  42                 break;
  43         case 5:
  44         case 6:
  45         case 7:
  46                 dev_priv->core_freq = 266;
  47                 break;
  48         default:
  49                 dev_priv->core_freq = 0;
  50         }
  51 }