X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=Modules%2FUSB%2FCore%2Fhub.c;fp=Modules%2FUSB%2FCore%2Fhub.c;h=4afde693d868e97b374e492a9131ea8e6cc1e162;hb=3ab2857efdcb81ce34dabf4d07b39ad6f5ab0b4a;hp=0000000000000000000000000000000000000000;hpb=79089cf3bb4828329d224c1d1cac9250bc57f932;p=tpg%2Facess2.git

diff --git a/Modules/USB/Core/hub.c b/Modules/USB/Core/hub.c
new file mode 100644
index 00000000..4afde693
--- /dev/null
+++ b/Modules/USB/Core/hub.c
@@ -0,0 +1,66 @@
+/*
+ * Acess2 USB Stack
+ * - By John Hodge (thePowersGang)
+ *
+ * hub.c
+ * - Basic hub driver
+ */
+#include <usb_hub.h>
+
+struct sHubInfo
+{
+	 int	nPorts;
+};
+
+// === PROTOTYPES ===
+void	Hub_Connected(tUSBInterface *Dev);
+void	Hub_Disconnected(tUSBInterface *Dev);
+void	Hub_PortStatusChange(tUSBInterface *Dev, int Length, void *Data);
+
+// === GLOBALS ===
+tUSBDriver	gUSBHub_Driver = {
+	.Name = "Hub",
+	.Match = {.Class = {0x090000, 0xFF0000}},
+	.Connected = Hub_Connected,
+	.Disconnected = Hub_Disconnected,
+	.MaxEndpoints = 1,
+	.Endpoints = {
+		{0x83, Hub_PortStatusChange}
+	};
+};
+
+// === CODE ===
+void Hub_Connected(tUSBInterface *Dev)
+{
+	// Register poll on endpoint
+	USB_PollEndpoint(Dev, 0);
+	
+	USB_RegisterHub(Dev, nPorts);
+}
+
+void Hub_Disconnected(tUSBInterface *Dev)
+{
+}
+
+void Hub_PortStatusChange(tUSBInterface *Dev, int Length, void *Data)
+{
+	 int	i;
+	Uint8	*status = Data;
+	for( i = 0; i < info->nPorts; i += 8, status ++ )
+	{
+		if( i/8 >= Length )	break;
+		if( *status == 0 )	continue;
+	
+		for( int j = 0; j < 8; j ++ )
+			if( *status & (1 << j) )
+				Hub_int_HandleChange(Dev, i+j);
+	}
+}
+
+void Hub_int_HandleChange(tUSBInterface *Dev, int Port)
+{
+	Uint16	status[2];	// Status, Change
+	// Get change status
+	USB_Request(Dev, 0, 0xA3, 0, 0, Port, 4, status);
+}
+