forked from Minki/linux
ba99d83488
pci_get_bus_and_slot() is restrictive such that it assumes domain=0 as where a PCI device is present. This restricts the device drivers to be reused for other domain numbers. Getting ready to remove pci_get_bus_and_slot() function in favor of pci_get_domain_bus_and_slot(). Add domain parameter to CDV_MSG_READ32, CDV_MSG_WRITE32, MRST_MSG_READ32, MRST_MSG_WRITE32, MDFLD_MSG_READ32, MDFLD_MSG_WRITE32. Extract pci_dev from struct drm_device and use pdev to find the domain number while calling pci_get_domain_bus_and_slot(). Signed-off-by: Sinan Kaya <okaya@codeaurora.org> Signed-off-by: Bjorn Helgaas <helgaas@kernel.org>
59 lines
1.5 KiB
C
59 lines
1.5 KiB
C
/**************************************************************************
|
|
* Copyright (c) 2011, Intel Corporation.
|
|
* All Rights Reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2, as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
**************************************************************************/
|
|
|
|
#include <drm/drmP.h>
|
|
#include "psb_drv.h"
|
|
|
|
void gma_get_core_freq(struct drm_device *dev)
|
|
{
|
|
uint32_t clock;
|
|
struct pci_dev *pci_root =
|
|
pci_get_domain_bus_and_slot(pci_domain_nr(dev->pdev->bus),
|
|
0, 0);
|
|
struct drm_psb_private *dev_priv = dev->dev_private;
|
|
|
|
/*pci_write_config_dword(pci_root, 0xD4, 0x00C32004);*/
|
|
/*pci_write_config_dword(pci_root, 0xD0, 0xE0033000);*/
|
|
|
|
pci_write_config_dword(pci_root, 0xD0, 0xD0050300);
|
|
pci_read_config_dword(pci_root, 0xD4, &clock);
|
|
pci_dev_put(pci_root);
|
|
|
|
switch (clock & 0x07) {
|
|
case 0:
|
|
dev_priv->core_freq = 100;
|
|
break;
|
|
case 1:
|
|
dev_priv->core_freq = 133;
|
|
break;
|
|
case 2:
|
|
dev_priv->core_freq = 150;
|
|
break;
|
|
case 3:
|
|
dev_priv->core_freq = 178;
|
|
break;
|
|
case 4:
|
|
dev_priv->core_freq = 200;
|
|
break;
|
|
case 5:
|
|
case 6:
|
|
case 7:
|
|
dev_priv->core_freq = 266;
|
|
break;
|
|
default:
|
|
dev_priv->core_freq = 0;
|
|
}
|
|
}
|