USBD: Implemented a new requirement where the order the usb drivers c…

…onnect function is called is the same independent of when it is called. Before the order was different depending on whether the USBD driver has finished discovering all connected devices.

iop/usb/usbd/src/driver.c

@@ -53,6 +53,19 @@ void probeDeviceTree(Device *tree, UsbDriver *drv) {
 		}
 }
 
+void probeDeviceConnectList(UsbDriver *drv) {
+	Device *curDevice;
+	for (curDevice = memPool.deviceConnectedListStart; curDevice != NULL; curDevice = curDevice->nextConnected)
+		if (curDevice->deviceStatus == DEVICE_READY) {
+			if (curDevice->devDriver == NULL) {
+				if (callUsbDriverFunc(drv->probe, curDevice->id, drv->gp) != 0) {
+					curDevice->devDriver = drv;
+					callUsbDriverFunc(drv->connect, curDevice->id, drv->gp);
+				}
+			}
+		}
+}
+
 int doRegisterDriver(UsbDriver *drv, void *drvGpSeg) {
 	if (drv->next || drv->prev)
 		return USB_RC_BUSY;
@@ -74,7 +87,7 @@ int doRegisterDriver(UsbDriver *drv, void *drvGpSeg) {
 	drvListEnd = drv;
 
 	if (drv->probe)
-		probeDeviceTree(memPool.deviceTreeRoot, drv);
+		probeDeviceConnectList(drv);
 
 	return 0;
 }

iop/usb/usbd/src/hub.c

@@ -353,6 +353,19 @@ void flushPort(Device *dev) {
 		while (dev->endpointListStart)
 			removeEndpointFromDevice(dev, dev->endpointListStart);
 
+		if (dev->nextConnected)
+			dev->nextConnected->prevConnected = dev->prevConnected;
+		else
+			memPool.deviceConnectedListEnd = dev->prevConnected;
+
+		if (dev->prevConnected)
+			dev->prevConnected->nextConnected = dev->nextConnected;
+		else
+			memPool.deviceConnectedListStart = dev->nextConnected;
+
+		dev->nextConnected = NULL;
+		dev->prevConnected = NULL;
+
 		while ((child = dev->childListStart)) {
 			if (child->next)
 				child->next->prev = child->prev;
@@ -407,8 +420,17 @@ void fetchConfigDescriptors(IoRequest *req) {
 			doControlTransfer(ep, &dev->ioRequest,
 				USB_DIR_IN | USB_RECIP_DEVICE, USB_REQ_GET_DESCRIPTOR, (USB_DT_CONFIG << 8) | curDescNum, 0, readLen,
 				dev->staticDeviceDescEndPtr, fetchConfigDescriptors);
-		} else
+		} else {
+			dev->prevConnected = memPool.deviceConnectedListEnd;
+			if (memPool.deviceConnectedListEnd)
+				memPool.deviceConnectedListEnd->nextConnected = dev;
+			else
+				memPool.deviceConnectedListStart = dev;
+			dev->nextConnected = NULL;
+			memPool.deviceConnectedListEnd = dev;
+
 			connectNewDevice(dev);
+		}
 	} else
 		killDevice(dev, ep);
 }

iop/usb/usbd/src/usbdpriv.h

@@ -81,6 +81,7 @@ typedef struct _ioRequest {
 typedef struct _device {
 	uint32 id;
 	struct _device *next, *prev;
+	struct _device *nextConnected, *prevConnected;
 	struct _endpoint *endpointListStart, *endpointListEnd;
 	UsbDriver  *devDriver;
 	uint8  deviceStatus;
@@ -222,6 +223,9 @@ typedef struct _memPool {
 
 	struct _device		*deviceTreeRoot;
 
+	struct _device		*deviceConnectedListStart;
+	struct _device		*deviceConnectedListEnd;
+
 	uint32 delayResets;
 } MemoryPool;