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