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
gma_get_core_freq(struct drm_device * dev)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 }
52