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
10void gma_get_core_freq(struct drm_device *dev)
11{
12	uint32_t clock;
13	struct pci_dev *pci_root =
14		pci_get_domain_bus_and_slot(pci_domain_nr(dev->pdev->bus),
15					    0, 0);
16	struct drm_psb_private *dev_priv = dev->dev_private;
17
18	/*pci_write_config_dword(pci_root, 0xD4, 0x00C32004);*/
19	/*pci_write_config_dword(pci_root, 0xD0, 0xE0033000);*/
20
21	pci_write_config_dword(pci_root, 0xD0, 0xD0050300);
22	pci_read_config_dword(pci_root, 0xD4, &clock);
23	pci_dev_put(pci_root);
24
25	switch (clock & 0x07) {
26	case 0:
27		dev_priv->core_freq = 100;
28		break;
29	case 1:
30		dev_priv->core_freq = 133;
31		break;
32	case 2:
33		dev_priv->core_freq = 150;
34		break;
35	case 3:
36		dev_priv->core_freq = 178;
37		break;
38	case 4:
39		dev_priv->core_freq = 200;
40		break;
41	case 5:
42	case 6:
43	case 7:
44		dev_priv->core_freq = 266;
45		break;
46	default:
47		dev_priv->core_freq = 0;
48	}
49}
50