src/southbridge/intel/bd82x6x/pch.c - coreboot - Gitiles

 /* SPDX-License-Identifier: GPL-2.0-only */

 #include <console/console.h>
 #include <delay.h>
 #include <device/device.h>
 #include <device/pci.h>
 #include <device/pci_ops.h>
 #include <string.h>
 #include <timer.h>

 #include "chip.h"
 #include "pch.h"

 /* Set bit in function disable register to hide this device */
 static void pch_hide_devfn(unsigned int devfn)
 {
 	struct device *dev = pcidev_path_on_root(devfn);
 	if (dev)
 		dev->hidden = true;

 	switch (devfn) {
 	case PCI_DEVFN(20, 0): /* xHCI */
 		if (pch_silicon_type() == PCH_TYPE_PPT) {
 			/* on CPT this bit is reserved */
 			RCBA32_OR(FD, PCH_DISABLE_XHCI);
 		}
 		break;
 	case PCI_DEVFN(22, 0): /* MEI #1 */
 		RCBA32_OR(FD2, PCH_DISABLE_MEI1);
 		break;
 	case PCI_DEVFN(22, 1): /* MEI #2 */
 		RCBA32_OR(FD2, PCH_DISABLE_MEI2);
 		break;
 	case PCI_DEVFN(22, 2): /* IDE-R */
 		RCBA32_OR(FD2, PCH_DISABLE_IDER);
 		break;
 	case PCI_DEVFN(22, 3): /* KT */
 		RCBA32_OR(FD2, PCH_DISABLE_KT);
 		break;
 	case PCI_DEVFN(25, 0): /* Gigabit Ethernet */
 		/* BUC is already handled in `early_pch.c`. */
 		break;
 	case PCI_DEVFN(26, 0): /* EHCI #2 */
 		RCBA32_OR(FD, PCH_DISABLE_EHCI2);
 		break;
 	case PCI_DEVFN(27, 0): /* HD Audio Controller */
 		RCBA32_OR(FD, PCH_DISABLE_HD_AUDIO);
 		break;
 	case PCI_DEVFN(28, 0): /* PCI Express Root Port 1 */
 	case PCI_DEVFN(28, 1): /* PCI Express Root Port 2 */
 	case PCI_DEVFN(28, 2): /* PCI Express Root Port 3 */
 	case PCI_DEVFN(28, 3): /* PCI Express Root Port 4 */
 	case PCI_DEVFN(28, 4): /* PCI Express Root Port 5 */
 	case PCI_DEVFN(28, 5): /* PCI Express Root Port 6 */
 	case PCI_DEVFN(28, 6): /* PCI Express Root Port 7 */
 	case PCI_DEVFN(28, 7): /* PCI Express Root Port 8 */
 		RCBA32_OR(FD, PCH_DISABLE_PCIE(PCI_FUNC(devfn)));
 		break;
 	case PCI_DEVFN(29, 0): /* EHCI #1 */
 		RCBA32_OR(FD, PCH_DISABLE_EHCI1);
 		break;
 	case PCI_DEVFN(30, 0): /* PCI-to-PCI Bridge */
 		RCBA32_OR(FD, PCH_DISABLE_P2P);
 		break;
 	case PCI_DEVFN(31, 0): /* LPC */
 		RCBA32_OR(FD, PCH_DISABLE_LPC);
 		break;
 	case PCI_DEVFN(31, 2): /* SATA #1 */
 		RCBA32_OR(FD, PCH_DISABLE_SATA1);
 		break;
 	case PCI_DEVFN(31, 3): /* SMBUS */
 		RCBA32_OR(FD, PCH_DISABLE_SMBUS);
 		break;
 	case PCI_DEVFN(31, 5): /* SATA #22 */
 		RCBA32_OR(FD, PCH_DISABLE_SATA2);
 		break;
 	case PCI_DEVFN(31, 6): /* Thermal Subsystem */
 		RCBA32_OR(FD, PCH_DISABLE_THERMAL);
 		break;
 	}
 }

 /* Check if any port in set X to X+3 is enabled */
 static int pch_pcie_check_set_enabled(struct device *dev)
 {
 	struct device *port;
 	int port_func;
 	int dev_func = PCI_FUNC(dev->path.pci.devfn);

 	printk(BIOS_DEBUG, "%s: check set enabled\n", dev_path(dev));

 	/* Go through static device tree list of devices
 	 * because enumeration is still in progress */
 	for (port = all_devices; port; port = port->next) {
 		/* Only care about PCIe root ports */
 		if (PCI_SLOT(port->path.pci.devfn) !=
 		    PCI_SLOT(dev->path.pci.devfn))
 			continue;

 		/* Check if port is in range and enabled */
 		port_func = PCI_FUNC(port->path.pci.devfn);
 		if (port_func >= dev_func &&
 		    port_func < (dev_func + 4) &&
 		    port->enabled)
 			return 1;
 	}

 	/* None of the ports in this set are enabled */
 	return 0;
 }

 /* RPFN is a write-once register so keep a copy until it is written */
 static u32 new_rpfn;

 /* Swap function numbers assigned to two PCIe Root Ports */
 static void pch_pcie_function_swap(u8 old_fn, u8 new_fn)
 {
 	u32 old_rpfn = new_rpfn;

 	printk(BIOS_DEBUG, "PCH: Remap PCIe function %d to %d\n",
 	       old_fn, new_fn);

 	new_rpfn &= ~(RPFN_FNMASK(old_fn) | RPFN_FNMASK(new_fn));

 	/* Old function set to new function and disabled */
 	new_rpfn |= RPFN_FNSET(old_fn, RPFN_FNGET(old_rpfn, new_fn));
 	new_rpfn |= RPFN_FNSET(new_fn, RPFN_FNGET(old_rpfn, old_fn));
 }

 /* Update devicetree with new Root Port function number assignment */
 static void pch_pcie_devicetree_update(
 		struct southbridge_intel_bd82x6x_config *config)
 {
 	struct device *dev;

 	/*
 	 * hotplug map should also be updated along with their
 	 * corresponding port
 	 */
 	u8 new_hotplug_map[sizeof(config->pcie_hotplug_map)];

 	/*
 	 * Slots that didn't move need the hotplug setting copied too,
 	 * so "new_hotplug_map" is initialized with the values of the old map.
 	 */
 	memcpy(new_hotplug_map, config->pcie_hotplug_map,
 	       sizeof(new_hotplug_map));

 	/* Update the function numbers in the static devicetree */
 	for (dev = all_devices; dev; dev = dev->next) {
 		u8 new_devfn;

 		/* Only care about PCH PCIe root ports */
 		if (PCI_SLOT(dev->path.pci.devfn) !=
 		    PCH_PCIE_DEV_SLOT)
 			continue;

 		/* Determine the new devfn for this port */
 		new_devfn = PCI_DEVFN(PCH_PCIE_DEV_SLOT,
 			      RPFN_FNGET(new_rpfn,
 				 PCI_FUNC(dev->path.pci.devfn)));

 		if (dev->path.pci.devfn != new_devfn) {
 			printk(BIOS_DEBUG,
 			       "PCH: PCIe map %02x.%1x -> %02x.%1x\n",
 			       PCI_SLOT(dev->path.pci.devfn),
 			       PCI_FUNC(dev->path.pci.devfn),
 			       PCI_SLOT(new_devfn), PCI_FUNC(new_devfn));

 			/*
 			 * Copy the flag to its new position along with
 			 * the corresponding port
 			 */
 			new_hotplug_map[PCI_FUNC(new_devfn)] =
 				config->pcie_hotplug_map
 				[PCI_FUNC(dev->path.pci.devfn)];

 			dev->path.pci.devfn = new_devfn;
 		}
 	}

 	/* Copy the updated map back to its place */
 	memcpy(config->pcie_hotplug_map, new_hotplug_map,
 	       sizeof(new_hotplug_map));
 }

 static void check_device_present(struct device *dev)
 {
 	struct southbridge_intel_bd82x6x_config *config = dev->chip_info;
 	struct stopwatch timeout;
 	bool present, hot_plugable;
 	uint32_t cap;

 	/* Set slot implemented. */
 	cap = pci_find_capability(dev, PCI_CAP_ID_PCIE);
 	pci_or_config16(dev, cap + PCI_EXP_FLAGS, PCI_EXP_FLAGS_SLOT);

 	/*
 	 * By setting the PCI_EXP_FLAGS_SLOT bit in register PCI_EXP_FLAGS the
 	 * PCI_EXP_SLTSTA_PDS bit will be updated with in band device
 	 * detection from the PCIe PHY. While this is primarly used for PCIe
 	 * hot-plug detection, it is more reliable than probing for downstream
 	 * devices by reading DID/VID PCI registers of such.
 	 *
 	 * Usually the PCI_EXP_FLAGS_SLOT isn't set for integrated devices,
 	 * but to simplify device detection it's set for all ports.
 	 *
 	 * It also allows to detect device before PCI enumeration has run.
 	 */
 	hot_plugable = config && config->pcie_hotplug_map[PCI_FUNC(dev->path.pci.devfn)];
 	present = !!(pci_read_config16(dev, cap + PCI_EXP_SLTSTA) & PCI_EXP_SLTSTA_PDS);

 	printk(BIOS_DEBUG, "%s: %s downstream device\n",
 	       dev_path(dev), present ? "Found a" : "No");

 	if (!present && !hot_plugable) {
 		/* No device present. */
 		stopwatch_init_usecs_expire(&timeout, 50 * 1000);
 		pci_or_config32(dev, 0x338, 1 << 26);

 		while (!stopwatch_expired(&timeout)) {
 			if ((pci_read_config32(dev, 0x328) & (0x1f << 23)) == 0)
 				break;
 			udelay(100);
 		}
 		dev->enabled = 0;
 	} else if (present && !hot_plugable && !dev->enabled) {
 		/* Port will be disabled, but device present. Disable link. */
 		pci_or_config32(dev, cap + PCI_EXP_LNKCTL, PCI_EXP_LNKCTL_LD);
 	}
 }

 /* Special handling for PCIe Root Port devices */
 static void pch_pcie_enable(struct device *dev)
 {
 	struct southbridge_intel_bd82x6x_config *config = dev->chip_info;

 	if (!config)
 		return;

 	check_device_present(dev);

 	/*
 	 * Save a copy of the Root Port Function Number map when
 	 * starting to walk the list of PCIe Root Ports so it can
 	 * be updated locally and written out when the last port
 	 * has been processed.
 	 */
 	if (PCI_FUNC(dev->path.pci.devfn) == 0) {
 		new_rpfn = RCBA32(RPFN);

 		/*
 		 * Enable Root Port coalescing if the first port is disabled
 		 * or the other devices will not be enumerated by the OS.
 		 */
 		if (!dev->enabled)
 			config->pcie_port_coalesce = true;

 		if (config->pcie_port_coalesce)
 			printk(BIOS_INFO,
 			       "PCH: PCIe Root Port coalescing is enabled\n");
 	}

 	if (!dev->enabled) {
 		printk(BIOS_DEBUG, "%s: Disabling device\n", dev_path(dev));

 		/*
 		 * PCIE Power Savings for PantherPoint and CougarPoint/B1+
 		 *
 		 * If PCIe 0-3 disabled set Function 0 0xE2[0] = 1
 		 * If PCIe 4-7 disabled set Function 4 0xE2[0] = 1
 		 *
 		 * This check is done here instead of PCIe driver
 		 * because the PCIe driver enable() handler is not
 		 * called unless the device is enabled.
 		 */
 		if ((PCI_FUNC(dev->path.pci.devfn) == 0 ||
 		     PCI_FUNC(dev->path.pci.devfn) == 4)) {
 			/* Handle workaround for PPT and CPT/B1+ */
 			if (pch_silicon_supported(PCH_TYPE_CPT, PCH_STEP_B1) &&
 			    !pch_pcie_check_set_enabled(dev)) {
 				pci_or_config8(dev, 0xe2, 1);
 			}

 			/*
 			 * Enable Clock Gating for shared PCIe resources
 			 * before disabling this particular port.
 			 */
 			pci_write_config8(dev, 0xe1, 0x3c);
 		}

 		/* Ensure memory, io, and bus master are all disabled */
 		pci_and_config16(dev, PCI_COMMAND,
 				 ~(PCI_COMMAND_MASTER | PCI_COMMAND_MEMORY | PCI_COMMAND_IO));

 		/* Do not claim downstream transactions for PCIe ports */
 		new_rpfn |= RPFN_HIDE(PCI_FUNC(dev->path.pci.devfn));

 		/* Hide this device if possible */
 		pch_hide_devfn(dev->path.pci.devfn);
 	} else {
 		int fn;

 		/*
 		 * Check if there is a lower disabled port to swap with this
 		 * port in order to maintain linear order starting at zero.
 		 */
 		if (config->pcie_port_coalesce) {
 			for (fn=0; fn < PCI_FUNC(dev->path.pci.devfn); fn++) {
 				if (!(new_rpfn & RPFN_HIDE(fn)))
 					continue;

 				/* Swap places with this function */
 				pch_pcie_function_swap(
 					PCI_FUNC(dev->path.pci.devfn), fn);
 				break;
 			}
 		}

 		/* Enable SERR */
 		pci_or_config16(dev, PCI_COMMAND, PCI_COMMAND_SERR);
 	}

 	/*
 	 * When processing the last PCIe root port we can now
 	 * update the Root Port Function Number and Hide register.
 	 */
 	if (PCI_FUNC(dev->path.pci.devfn) == 7) {
 		printk(BIOS_SPEW, "PCH: RPFN 0x%08x -> 0x%08x\n",
 		       RCBA32(RPFN), new_rpfn);
 		RCBA32(RPFN) = new_rpfn;

 		/* Update static devictree with new function numbers */
 		if (config->pcie_port_coalesce)
 			pch_pcie_devicetree_update(config);
 	}
 }

 void pch_enable(struct device *dev)
 {
 	/* PCH PCIe Root Ports get special handling */
 	if (PCI_SLOT(dev->path.pci.devfn) == PCH_PCIE_DEV_SLOT)
 		return pch_pcie_enable(dev);

 	if (!dev->enabled) {
 		printk(BIOS_DEBUG, "%s: Disabling device\n", dev_path(dev));

 		/* Ensure memory, io, and bus master are all disabled */
 		pci_and_config16(dev, PCI_COMMAND,
 				 ~(PCI_COMMAND_MASTER | PCI_COMMAND_MEMORY | PCI_COMMAND_IO));

 		/* Hide this device if possible */
 		pch_hide_devfn(dev->path.pci.devfn);
 	} else {
 		/* Enable SERR */
 		pci_or_config16(dev, PCI_COMMAND, PCI_COMMAND_SERR);
 	}
 }

 struct chip_operations southbridge_intel_bd82x6x_ops = {
 	.name = "Intel Series 6/7 (Cougar Point/Panther Point) Southbridge",
 	.enable_dev = pch_enable,
 };
	/* SPDX-License-Identifier: GPL-2.0-only */

	#include <console/console.h>
	#include <delay.h>
	#include <device/device.h>
	#include <device/pci.h>
	#include <device/pci_ops.h>
	#include <string.h>
	#include <timer.h>

	#include "chip.h"
	#include "pch.h"

	/* Set bit in function disable register to hide this device */
	static void pch_hide_devfn(unsigned int devfn)
	{
	struct device *dev = pcidev_path_on_root(devfn);
	if (dev)
	dev->hidden = true;

	switch (devfn) {
	case PCI_DEVFN(20, 0): /* xHCI */
	if (pch_silicon_type() == PCH_TYPE_PPT) {
	/* on CPT this bit is reserved */
	RCBA32_OR(FD, PCH_DISABLE_XHCI);
	}
	break;
	case PCI_DEVFN(22, 0): /* MEI #1 */
	RCBA32_OR(FD2, PCH_DISABLE_MEI1);
	break;
	case PCI_DEVFN(22, 1): /* MEI #2 */
	RCBA32_OR(FD2, PCH_DISABLE_MEI2);
	break;
	case PCI_DEVFN(22, 2): /* IDE-R */
	RCBA32_OR(FD2, PCH_DISABLE_IDER);
	break;
	case PCI_DEVFN(22, 3): /* KT */
	RCBA32_OR(FD2, PCH_DISABLE_KT);
	break;
	case PCI_DEVFN(25, 0): /* Gigabit Ethernet */
	/* BUC is already handled in `early_pch.c`. */
	break;
	case PCI_DEVFN(26, 0): /* EHCI #2 */
	RCBA32_OR(FD, PCH_DISABLE_EHCI2);
	break;
	case PCI_DEVFN(27, 0): /* HD Audio Controller */
	RCBA32_OR(FD, PCH_DISABLE_HD_AUDIO);
	break;
	case PCI_DEVFN(28, 0): /* PCI Express Root Port 1 */
	case PCI_DEVFN(28, 1): /* PCI Express Root Port 2 */
	case PCI_DEVFN(28, 2): /* PCI Express Root Port 3 */
	case PCI_DEVFN(28, 3): /* PCI Express Root Port 4 */
	case PCI_DEVFN(28, 4): /* PCI Express Root Port 5 */
	case PCI_DEVFN(28, 5): /* PCI Express Root Port 6 */
	case PCI_DEVFN(28, 6): /* PCI Express Root Port 7 */
	case PCI_DEVFN(28, 7): /* PCI Express Root Port 8 */
	RCBA32_OR(FD, PCH_DISABLE_PCIE(PCI_FUNC(devfn)));
	break;
	case PCI_DEVFN(29, 0): /* EHCI #1 */
	RCBA32_OR(FD, PCH_DISABLE_EHCI1);
	break;
	case PCI_DEVFN(30, 0): /* PCI-to-PCI Bridge */
	RCBA32_OR(FD, PCH_DISABLE_P2P);
	break;
	case PCI_DEVFN(31, 0): /* LPC */
	RCBA32_OR(FD, PCH_DISABLE_LPC);
	break;
	case PCI_DEVFN(31, 2): /* SATA #1 */
	RCBA32_OR(FD, PCH_DISABLE_SATA1);
	break;
	case PCI_DEVFN(31, 3): /* SMBUS */
	RCBA32_OR(FD, PCH_DISABLE_SMBUS);
	break;
	case PCI_DEVFN(31, 5): /* SATA #22 */
	RCBA32_OR(FD, PCH_DISABLE_SATA2);
	break;
	case PCI_DEVFN(31, 6): /* Thermal Subsystem */
	RCBA32_OR(FD, PCH_DISABLE_THERMAL);
	break;
	}
	}

	/* Check if any port in set X to X+3 is enabled */
	static int pch_pcie_check_set_enabled(struct device *dev)
	{
	struct device *port;
	int port_func;
	int dev_func = PCI_FUNC(dev->path.pci.devfn);

	printk(BIOS_DEBUG, "%s: check set enabled\n", dev_path(dev));

	/* Go through static device tree list of devices
	* because enumeration is still in progress */
	for (port = all_devices; port; port = port->next) {
	/* Only care about PCIe root ports */
	if (PCI_SLOT(port->path.pci.devfn) !=
	PCI_SLOT(dev->path.pci.devfn))
	continue;

	/* Check if port is in range and enabled */
	port_func = PCI_FUNC(port->path.pci.devfn);
	if (port_func >= dev_func &&
	port_func < (dev_func + 4) &&
	port->enabled)
	return 1;
	}

	/* None of the ports in this set are enabled */
	return 0;
	}

	/* RPFN is a write-once register so keep a copy until it is written */
	static u32 new_rpfn;

	/* Swap function numbers assigned to two PCIe Root Ports */
	static void pch_pcie_function_swap(u8 old_fn, u8 new_fn)
	{
	u32 old_rpfn = new_rpfn;

	printk(BIOS_DEBUG, "PCH: Remap PCIe function %d to %d\n",
	old_fn, new_fn);

	new_rpfn &= ~(RPFN_FNMASK(old_fn) \| RPFN_FNMASK(new_fn));

	/* Old function set to new function and disabled */
	new_rpfn \|= RPFN_FNSET(old_fn, RPFN_FNGET(old_rpfn, new_fn));
	new_rpfn \|= RPFN_FNSET(new_fn, RPFN_FNGET(old_rpfn, old_fn));
	}

	/* Update devicetree with new Root Port function number assignment */
	static void pch_pcie_devicetree_update(
	struct southbridge_intel_bd82x6x_config *config)
	{
	struct device *dev;

	/*
	* hotplug map should also be updated along with their
	* corresponding port
	*/
	u8 new_hotplug_map[sizeof(config->pcie_hotplug_map)];

	/*
	* Slots that didn't move need the hotplug setting copied too,
	* so "new_hotplug_map" is initialized with the values of the old map.
	*/
	memcpy(new_hotplug_map, config->pcie_hotplug_map,
	sizeof(new_hotplug_map));

	/* Update the function numbers in the static devicetree */
	for (dev = all_devices; dev; dev = dev->next) {
	u8 new_devfn;

	/* Only care about PCH PCIe root ports */
	if (PCI_SLOT(dev->path.pci.devfn) !=
	PCH_PCIE_DEV_SLOT)
	continue;

	/* Determine the new devfn for this port */
	new_devfn = PCI_DEVFN(PCH_PCIE_DEV_SLOT,
	RPFN_FNGET(new_rpfn,
	PCI_FUNC(dev->path.pci.devfn)));

	if (dev->path.pci.devfn != new_devfn) {
	printk(BIOS_DEBUG,
	"PCH: PCIe map %02x.%1x -> %02x.%1x\n",
	PCI_SLOT(dev->path.pci.devfn),
	PCI_FUNC(dev->path.pci.devfn),
	PCI_SLOT(new_devfn), PCI_FUNC(new_devfn));

	/*
	* Copy the flag to its new position along with
	* the corresponding port
	*/
	new_hotplug_map[PCI_FUNC(new_devfn)] =
	config->pcie_hotplug_map
	[PCI_FUNC(dev->path.pci.devfn)];

	dev->path.pci.devfn = new_devfn;
	}
	}

	/* Copy the updated map back to its place */
	memcpy(config->pcie_hotplug_map, new_hotplug_map,
	sizeof(new_hotplug_map));
	}

	static void check_device_present(struct device *dev)
	{
	struct southbridge_intel_bd82x6x_config *config = dev->chip_info;
	struct stopwatch timeout;
	bool present, hot_plugable;
	uint32_t cap;

	/* Set slot implemented. */
	cap = pci_find_capability(dev, PCI_CAP_ID_PCIE);
	pci_or_config16(dev, cap + PCI_EXP_FLAGS, PCI_EXP_FLAGS_SLOT);

	/*
	* By setting the PCI_EXP_FLAGS_SLOT bit in register PCI_EXP_FLAGS the
	* PCI_EXP_SLTSTA_PDS bit will be updated with in band device
	* detection from the PCIe PHY. While this is primarly used for PCIe
	* hot-plug detection, it is more reliable than probing for downstream
	* devices by reading DID/VID PCI registers of such.
	*
	* Usually the PCI_EXP_FLAGS_SLOT isn't set for integrated devices,
	* but to simplify device detection it's set for all ports.
	*
	* It also allows to detect device before PCI enumeration has run.
	*/
	hot_plugable = config && config->pcie_hotplug_map[PCI_FUNC(dev->path.pci.devfn)];
	present = !!(pci_read_config16(dev, cap + PCI_EXP_SLTSTA) & PCI_EXP_SLTSTA_PDS);

	printk(BIOS_DEBUG, "%s: %s downstream device\n",
	dev_path(dev), present ? "Found a" : "No");

	if (!present && !hot_plugable) {
	/* No device present. */
	stopwatch_init_usecs_expire(&timeout, 50 * 1000);
	pci_or_config32(dev, 0x338, 1 << 26);

	while (!stopwatch_expired(&timeout)) {
	if ((pci_read_config32(dev, 0x328) & (0x1f << 23)) == 0)
	break;
	udelay(100);
	}
	dev->enabled = 0;
	} else if (present && !hot_plugable && !dev->enabled) {
	/* Port will be disabled, but device present. Disable link. */
	pci_or_config32(dev, cap + PCI_EXP_LNKCTL, PCI_EXP_LNKCTL_LD);
	}
	}

	/* Special handling for PCIe Root Port devices */
	static void pch_pcie_enable(struct device *dev)
	{
	struct southbridge_intel_bd82x6x_config *config = dev->chip_info;

	if (!config)
	return;

	check_device_present(dev);

	/*
	* Save a copy of the Root Port Function Number map when
	* starting to walk the list of PCIe Root Ports so it can
	* be updated locally and written out when the last port
	* has been processed.
	*/
	if (PCI_FUNC(dev->path.pci.devfn) == 0) {
	new_rpfn = RCBA32(RPFN);

	/*
	* Enable Root Port coalescing if the first port is disabled
	* or the other devices will not be enumerated by the OS.
	*/
	if (!dev->enabled)
	config->pcie_port_coalesce = true;

	if (config->pcie_port_coalesce)
	printk(BIOS_INFO,
	"PCH: PCIe Root Port coalescing is enabled\n");
	}

	if (!dev->enabled) {
	printk(BIOS_DEBUG, "%s: Disabling device\n", dev_path(dev));

	/*
	* PCIE Power Savings for PantherPoint and CougarPoint/B1+
	*
	* If PCIe 0-3 disabled set Function 0 0xE2[0] = 1
	* If PCIe 4-7 disabled set Function 4 0xE2[0] = 1
	*
	* This check is done here instead of PCIe driver
	* because the PCIe driver enable() handler is not
	* called unless the device is enabled.
	*/
	if ((PCI_FUNC(dev->path.pci.devfn) == 0 \|\|
	PCI_FUNC(dev->path.pci.devfn) == 4)) {
	/* Handle workaround for PPT and CPT/B1+ */
	if (pch_silicon_supported(PCH_TYPE_CPT, PCH_STEP_B1) &&
	!pch_pcie_check_set_enabled(dev)) {
	pci_or_config8(dev, 0xe2, 1);
	}

	/*
	* Enable Clock Gating for shared PCIe resources
	* before disabling this particular port.
	*/
	pci_write_config8(dev, 0xe1, 0x3c);
	}

	/* Ensure memory, io, and bus master are all disabled */
	pci_and_config16(dev, PCI_COMMAND,
	~(PCI_COMMAND_MASTER \| PCI_COMMAND_MEMORY \| PCI_COMMAND_IO));

	/* Do not claim downstream transactions for PCIe ports */
	new_rpfn \|= RPFN_HIDE(PCI_FUNC(dev->path.pci.devfn));

	/* Hide this device if possible */
	pch_hide_devfn(dev->path.pci.devfn);
	} else {
	int fn;

	/*
	* Check if there is a lower disabled port to swap with this
	* port in order to maintain linear order starting at zero.
	*/
	if (config->pcie_port_coalesce) {
	for (fn=0; fn < PCI_FUNC(dev->path.pci.devfn); fn++) {
	if (!(new_rpfn & RPFN_HIDE(fn)))
	continue;

	/* Swap places with this function */
	pch_pcie_function_swap(
	PCI_FUNC(dev->path.pci.devfn), fn);
	break;
	}
	}

	/* Enable SERR */
	pci_or_config16(dev, PCI_COMMAND, PCI_COMMAND_SERR);
	}

	/*
	* When processing the last PCIe root port we can now
	* update the Root Port Function Number and Hide register.
	*/
	if (PCI_FUNC(dev->path.pci.devfn) == 7) {
	printk(BIOS_SPEW, "PCH: RPFN 0x%08x -> 0x%08x\n",
	RCBA32(RPFN), new_rpfn);
	RCBA32(RPFN) = new_rpfn;

	/* Update static devictree with new function numbers */
	if (config->pcie_port_coalesce)
	pch_pcie_devicetree_update(config);
	}
	}

	void pch_enable(struct device *dev)
	{
	/* PCH PCIe Root Ports get special handling */
	if (PCI_SLOT(dev->path.pci.devfn) == PCH_PCIE_DEV_SLOT)
	return pch_pcie_enable(dev);

	if (!dev->enabled) {
	printk(BIOS_DEBUG, "%s: Disabling device\n", dev_path(dev));

	/* Ensure memory, io, and bus master are all disabled */
	pci_and_config16(dev, PCI_COMMAND,
	~(PCI_COMMAND_MASTER \| PCI_COMMAND_MEMORY \| PCI_COMMAND_IO));

	/* Hide this device if possible */
	pch_hide_devfn(dev->path.pci.devfn);
	} else {
	/* Enable SERR */
	pci_or_config16(dev, PCI_COMMAND, PCI_COMMAND_SERR);
	}
	}

	struct chip_operations southbridge_intel_bd82x6x_ops = {
	.name = "Intel Series 6/7 (Cougar Point/Panther Point) Southbridge",
	.enable_dev = pch_enable,
	};