drivers/gpu/drm/gma500/gma_device.c

   1 /**************************************************************************
   2  * Copyright (c) 2011, Intel Corporation.
   3  * All Rights Reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms and conditions of the GNU General Public License,
   7  * version 2, as published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  **************************************************************************/
  15
  16 #include <drm/drmP.h>
  17 #include "psb_drv.h"
  18
  19 void gma_get_core_freq(struct drm_device *dev)
  20 {
  21         uint32_t clock;
  22         struct pci_dev *pci_root =
  23                 pci_get_domain_bus_and_slot(pci_domain_nr(dev->pdev->bus),
  24                                             0, 0);
  25         struct drm_psb_private *dev_priv = dev->dev_private;
  26
  27         /*pci_write_config_dword(pci_root, 0xD4, 0x00C32004);*/
  28         /*pci_write_config_dword(pci_root, 0xD0, 0xE0033000);*/
  29
  30         pci_write_config_dword(pci_root, 0xD0, 0xD0050300);
  31         pci_read_config_dword(pci_root, 0xD4, &clock);
  32         pci_dev_put(pci_root);
  33
  34         switch (clock & 0x07) {
  35         case 0:
  36                 dev_priv->core_freq = 100;
  37                 break;
  38         case 1:
  39                 dev_priv->core_freq = 133;
  40                 break;
  41         case 2:
  42                 dev_priv->core_freq = 150;
  43                 break;
  44         case 3:
  45                 dev_priv->core_freq = 178;
  46                 break;
  47         case 4:
  48                 dev_priv->core_freq = 200;
  49                 break;
  50         case 5:
  51         case 6:
  52         case 7:
  53                 dev_priv->core_freq = 266;
  54                 break;
  55         default:
  56                 dev_priv->core_freq = 0;
  57         }
  58 }