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 } 52