1 files changed, 80 insertions, 0 deletions
diff --git a/src/southbridge/broadcom/bcm5785/bcm5785.c b/src/southbridge/broadcom/bcm5785/bcm5785.c
new file mode 100644
index 0000000000..ebb7e8e729
--- /dev/null
+++ b/src/southbridge/broadcom/bcm5785/bcm5785.c
@@ -0,0 +1,80 @@
+/*
+ * Copyright  2005 AMD
+ *  by yinghai.lu@amd.com
+ */
+#include <console/console.h>
+#include <device/device.h>
+#include <device/pci.h>
+#include <device/pci_ids.h>
+#include "bcm5785.h"
+
+void bcm5785_enable(device_t dev)
+{
+	device_t sb_pci_main_dev;
+	device_t bus_dev;
+	unsigned index;
+	unsigned reg_old, reg;
+
+	/* See if we are on the behind the pcix bridge */
+	bus_dev = dev->bus->dev;
+	if ((bus_dev->vendor == PCI_VENDOR_ID_SERVERWORKS) && 
+		(bus_dev->device == 0x0036 )) // device under PCI-X Bridge
+	{
+		unsigned devfn;
+		devfn = bus_dev->path.u.pci.devfn + (1 << 3);
+		sb_pci_main_dev = dev_find_slot(bus_dev->bus->secondary, devfn);
+//		index = ((dev->path.u.pci.devfn & ~7) >> 3) + 8;
+	} else if ((bus_dev->vendor == PCI_VENDOR_ID_SERVERWORKS) &&
+                (bus_dev->device == 0x0104)) // device under PCI Bridge( under PCI-X )
+        {
+                unsigned devfn;
+                devfn = bus_dev->bus->dev->path.u.pci.devfn + (1 << 3);
+                sb_pci_main_dev = dev_find_slot(bus_dev->bus->dev->bus->secondary, devfn);
+//                index = ((dev->path.u.pci.devfn & ~7) >> 3) + 8;
+        }
+	else { // same bus
+		unsigned devfn;
+		uint32_t id;
+		devfn = (dev->path.u.pci.devfn) & ~7;
+		if( dev->vendor == PCI_VENDOR_ID_SERVERWORKS ) { 
+			if(dev->device == 0x0036) //PCI-X Bridge
+			{ devfn += (1<<3); }
+			else if(dev->device == 0x0223) // USB
+			{ devfn -= (1<<3); }
+		}
+		sb_pci_main_dev = dev_find_slot(dev->bus->secondary, devfn);
+//		index = dev->path.u.pci.devfn & 7;
+	}
+	if (!sb_pci_main_dev) {
+		return;
+	}
+
+	// get index now
+#if 0
+	if (index < 16) {
+		reg = reg_old = pci_read_config16(sb_pci_main_dev, 0x48);
+		reg &= ~(1 << index);
+		if (dev->enabled) {
+			reg |= (1 << index);
+		}
+		if (reg != reg_old) {
+			pci_write_config16(sb_pci_main_dev, 0x48, reg);
+		}
+	}
+	else if (index == 16) {
+		reg = reg_old = pci_read_config8(sb_pci_main_dev, 0x47);
+		reg &= ~(1 << 7);
+		if (!dev->enabled) {
+			reg |= (1 << 7);
+		}
+		if (reg != reg_old) {
+			pci_write_config8(sb_pci_main_dev, 0x47, reg);
+		}
+	}
+#endif
+}
+
+struct chip_operations southbridge_broadcom_bcm5785_ops = {
+	CHIP_NAME("Serverworks bcm5785")
+	.enable_dev = bcm5785_enable,
+};