northbridge/intel/peg: Disable unused ports
Walk the bus and try to find enabled devices. Disable the PEG port if no devices are attached. Change-Id: I67fcc831fd78ecc6dba83f4e0662ec7549cc2591 Signed-off-by: Patrick Rudolph <siro@das-labor.org> Reviewed-on: https://review.coreboot.org/12894 Tested-by: build bot (Jenkins) Reviewed-by: Martin Roth <martinroth@google.com>
This commit is contained in:
parent
a1c3beddbb
commit
0e06f5bd70
|
@ -243,6 +243,17 @@ static void enable_dev(device_t dev)
|
|||
}
|
||||
}
|
||||
|
||||
static u8 scan_bus_unused(struct bus *link)
|
||||
{
|
||||
struct device *dev;
|
||||
|
||||
for (dev = link->children; dev; dev = dev->sibling) {
|
||||
if (dev->enabled)
|
||||
return 0;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
static void gm45_init(void *const chip_info)
|
||||
{
|
||||
int dev, fn, bit_base;
|
||||
|
@ -268,7 +279,8 @@ static void gm45_init(void *const chip_info)
|
|||
for (; fn >= 0; --fn) {
|
||||
const struct device *const d =
|
||||
dev_find_slot(0, PCI_DEVFN(dev, fn));
|
||||
if (!d || d->enabled) continue;
|
||||
if (d && d->enabled && d->link_list && !scan_bus_unused(d->link_list))
|
||||
continue;
|
||||
const u32 deven = pci_read_config32(d0f0, D0F0_DEVEN);
|
||||
pci_write_config32(d0f0, D0F0_DEVEN,
|
||||
deven & ~(1 << (bit_base + fn)));
|
||||
|
|
|
@ -368,6 +368,17 @@ static void northbridge_dmi_init(struct device *dev)
|
|||
DMIBAR32(0x88) = reg32;
|
||||
}
|
||||
|
||||
static u8 scan_bus_unused(struct bus *link)
|
||||
{
|
||||
struct device *dev;
|
||||
|
||||
for (dev = link->children; dev; dev = dev->sibling) {
|
||||
if (dev->enabled)
|
||||
return 0;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
/* Disable unused PEG devices based on devicetree */
|
||||
static void disable_peg(void)
|
||||
{
|
||||
|
@ -378,27 +389,32 @@ static void disable_peg(void)
|
|||
reg = pci_read_config32(dev, DEVEN);
|
||||
|
||||
dev = dev_find_slot(0, PCI_DEVFN(1, 2));
|
||||
if (!dev || !dev->enabled) {
|
||||
if (!dev || !dev->enabled ||
|
||||
(dev->link_list && scan_bus_unused(dev->link_list))) {
|
||||
printk(BIOS_DEBUG, "Disabling PEG12.\n");
|
||||
reg &= ~DEVEN_PEG12;
|
||||
}
|
||||
dev = dev_find_slot(0, PCI_DEVFN(1, 1));
|
||||
if (!dev || !dev->enabled) {
|
||||
if (!dev || !dev->enabled ||
|
||||
(dev->link_list && scan_bus_unused(dev->link_list))) {
|
||||
printk(BIOS_DEBUG, "Disabling PEG11.\n");
|
||||
reg &= ~DEVEN_PEG11;
|
||||
}
|
||||
dev = dev_find_slot(0, PCI_DEVFN(1, 0));
|
||||
if (!dev || !dev->enabled) {
|
||||
if (!dev || !dev->enabled ||
|
||||
(dev->link_list && scan_bus_unused(dev->link_list))) {
|
||||
printk(BIOS_DEBUG, "Disabling PEG10.\n");
|
||||
reg &= ~DEVEN_PEG10;
|
||||
}
|
||||
dev = dev_find_slot(0, PCI_DEVFN(2, 0));
|
||||
if (!dev || !dev->enabled) {
|
||||
if (!dev || !dev->enabled ||
|
||||
(dev->link_list && scan_bus_unused(dev->link_list))) {
|
||||
printk(BIOS_DEBUG, "Disabling IGD.\n");
|
||||
reg &= ~DEVEN_IGD;
|
||||
}
|
||||
dev = dev_find_slot(0, PCI_DEVFN(6, 0));
|
||||
if (!dev || !dev->enabled) {
|
||||
if (!dev || !dev->enabled ||
|
||||
(dev->link_list && scan_bus_unused(dev->link_list))) {
|
||||
printk(BIOS_DEBUG, "Disabling PEG60.\n");
|
||||
reg &= ~DEVEN_PEG60;
|
||||
}
|
||||
|
|
Loading…
Reference in New Issue