Added PCI bus (re-)enumeration for all domains, but disabled by default.

git-svn-id: file:///srv/svn/repos/haiku/haiku/trunk@16158 a95241bf-73f2-0310-859d-f6bbb57e9c96

src/add-ons/kernel/bus_managers/pci/pci.cpp

@@ -108,7 +108,6 @@ void
 PCI::InitBus()
 {
 	PCIBus **ppnext = &fRootBus;
-	
 	for (int i = 0; i < fDomainCount; i++) {
 		PCIBus *bus = new PCIBus;
 		bus->next = NULL;
@@ -120,6 +119,14 @@ PCI::InitBus()
 		ppnext = &bus->next;
 	}
 	
+	bool bus_enumeration = false;
+
+	if (bus_enumeration) {
+		for (int i = 0; i < fDomainCount; i++) {
+			EnumerateBus(i, 0);
+		}
+	}
+	
 	if (fRootBus) {
 		DiscoverBus(fRootBus);
 		RefreshDeviceInfo(fRootBus);
@@ -229,6 +236,108 @@ PCI::GetNthPciInfo(PCIBus *bus, long *curindex, long wantindex, pci_info *outInf
 	return B_ERROR;
 }
 
+void
+PCI::EnumerateBus(int domain, uint8 bus, uint8 *subordinate_bus)
+{
+	TRACE(("PCI: EnumerateBus, domain %u, bus %u\n", domain, bus));
+	
+	int max_bus_devices = GetDomainData(domain)->max_bus_devices;
+
+	// step 1: disable all bridges on this bus
+	for (int dev = 0; dev < max_bus_devices; dev++) {
+		uint16 vendor_id = ReadPciConfig(domain, bus, dev, 0, PCI_vendor_id, 2);
+		if (vendor_id == 0xffff)
+			continue;
+		
+		uint8 type = ReadPciConfig(domain, bus, dev, 0, PCI_header_type, 1);
+		int nfunc = (type & PCI_multifunction) ? 8 : 1;
+		for (int func = 0; func < nfunc; func++) {
+			uint16 device_id = ReadPciConfig(domain, bus, dev, func, PCI_device_id, 2);
+			if (device_id == 0xffff)
+				continue;
+
+			uint8 base_class = ReadPciConfig(domain, bus, dev, func, PCI_class_base, 1);
+			uint8 sub_class	 = ReadPciConfig(domain, bus, dev, func, PCI_class_sub, 1);
+			if (base_class != PCI_bridge || sub_class != PCI_pci)
+				continue;
+			
+			TRACE(("PCI:   found PCI-PCI bridge, domain %u, bus %u, dev %u, func %u\n", domain, bus, dev, func));
+			TRACE(("PCI:   pcicmd %04lx, primary-bus %lu, secondary-bus %lu, subordinate-bus %lu\n",
+				ReadPciConfig(domain, bus, dev, func, PCI_command, 2),
+				ReadPciConfig(domain, bus, dev, func, PCI_primary_bus, 1),
+				ReadPciConfig(domain, bus, dev, func, PCI_secondary_bus, 1),
+				ReadPciConfig(domain, bus, dev, func, PCI_subordinate_bus, 1)));
+			
+			// disable decoding
+			uint16 pcicmd;
+			pcicmd = ReadPciConfig(domain, bus, dev, func, PCI_command, 2);
+			pcicmd &= ~(PCI_command_io | PCI_command_memory | PCI_command_master);
+			WritePciConfig(domain, bus, dev, func, PCI_command, 2, pcicmd);
+
+			// disable busses
+			WritePciConfig(domain, bus, dev, func, PCI_primary_bus, 1, 0);
+			WritePciConfig(domain, bus, dev, func, PCI_secondary_bus, 1, 0);
+			WritePciConfig(domain, bus, dev, func, PCI_subordinate_bus, 1, 0);
+		}
+	}
+	
+	uint8 last_used_bus_number = bus;
+	
+	// testing:
+	if (last_used_bus_number == 0)
+		last_used_bus_number = 3;
+
+	// step 2: assign busses to all bridges, and enable them again
+	for (int dev = 0; dev < max_bus_devices; dev++) {
+		uint16 vendor_id = ReadPciConfig(domain, bus, dev, 0, PCI_vendor_id, 2);
+		if (vendor_id == 0xffff)
+			continue;
+		
+		uint8 type = ReadPciConfig(domain, bus, dev, 0, PCI_header_type, 1);
+		int nfunc = (type & PCI_multifunction) ? 8 : 1;
+		for (int func = 0; func < nfunc; func++) {
+			uint16 device_id = ReadPciConfig(domain, bus, dev, func, PCI_device_id, 2);
+			if (device_id == 0xffff)
+				continue;
+
+			uint8 base_class = ReadPciConfig(domain, bus, dev, func, PCI_class_base, 1);
+			uint8 sub_class	 = ReadPciConfig(domain, bus, dev, func, PCI_class_sub, 1);
+			if (base_class != PCI_bridge || sub_class != PCI_pci)
+				continue;
+			
+			TRACE(("PCI:   configuring PCI-PCI bridge, domain %u, bus %u, dev %u, func %u\n", domain, bus, dev, func));
+			
+			// open Scheunentor for enumerating the bus behind the bridge
+			WritePciConfig(domain, bus, dev, func, PCI_primary_bus, 1, bus);
+			WritePciConfig(domain, bus, dev, func, PCI_secondary_bus, 1, last_used_bus_number + 1);
+			WritePciConfig(domain, bus, dev, func, PCI_subordinate_bus, 1, 255);
+			
+			// enable decoding (too early here?)
+			uint16 pcicmd;
+			pcicmd = ReadPciConfig(domain, bus, dev, func, PCI_command, 2);
+			pcicmd |= PCI_command_io | PCI_command_memory | PCI_command_master;
+			WritePciConfig(domain, bus, dev, func, PCI_command, 2, pcicmd);
+			
+			// enumarate bus
+			EnumerateBus(domain, last_used_bus_number + 1, &last_used_bus_number);
+
+			// close Scheunentor
+			WritePciConfig(domain, bus, dev, func, PCI_subordinate_bus, 1, last_used_bus_number);
+			
+			TRACE(("PCI:   pcicmd %04lx, primary-bus %lu, secondary-bus %lu, subordinate-bus %lu\n",
+				ReadPciConfig(domain, bus, dev, func, PCI_command, 2),
+				ReadPciConfig(domain, bus, dev, func, PCI_primary_bus, 1),
+				ReadPciConfig(domain, bus, dev, func, PCI_secondary_bus, 1),
+				ReadPciConfig(domain, bus, dev, func, PCI_subordinate_bus, 1)));
+			}
+	}
+	if (subordinate_bus)
+		*subordinate_bus = last_used_bus_number;
+
+	TRACE(("PCI: EnumerateBus done, domain %u, bus %u, last_used_bus_number %u\n", domain, bus, last_used_bus_number));
+}
+
+
 
 void
 PCI::DiscoverBus(PCIBus *bus)

src/add-ons/kernel/bus_managers/pci/pci.h

@@ -77,7 +77,9 @@ class PCI {
 
 		status_t			GetVirtBus(uint8 virt_bus, int *domain, uint8 *bus);
 		
-	private:	
+	private:
+
+		void EnumerateBus(int domain, uint8 bus, uint8 *subordinate_bus = NULL);
 
 		void DiscoverBus(PCIBus *bus);
 		void DiscoverDevice(PCIBus *bus, uint8 dev, uint8 func);