X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=KernelLand%2FModules%2FUSB%2FCore%2Fusb_devinit.c;h=06efd217f46935c7c18d901d61cf9231b87bade0;hb=d8bf9f747a87c3c1d23461c155ef90b7fc148a21;hp=d01d7d1cba3243e67ce5ae8e1454601980c2dfd7;hpb=51ab5f489bc356940c95cc936fd0508e8f07ea97;p=tpg%2Facess2.git

diff --git a/KernelLand/Modules/USB/Core/usb_devinit.c b/KernelLand/Modules/USB/Core/usb_devinit.c
index d01d7d1c..06efd217 100644
--- a/KernelLand/Modules/USB/Core/usb_devinit.c
+++ b/KernelLand/Modules/USB/Core/usb_devinit.c
@@ -72,7 +72,8 @@ void USB_DeviceConnected(tUSBHub *Hub, int Port)
 		LOG(" .SerialNumberStr = Str %i", desc.SerialNumberStr);
 		LOG(" .NumConfigurations = %i", desc.SerialNumberStr);
 		LOG("}");
-		
+	
+		#if DEBUG	
 		if( desc.ManufacturerStr )
 		{
 			char	*tmp = USB_int_GetDeviceString(dev, 0, desc.ManufacturerStr);
@@ -91,6 +92,7 @@ void USB_DeviceConnected(tUSBHub *Hub, int Port)
 			LOG("SerialNumbertStr = '%s'", tmp);
 			free(tmp);
 		}
+		#endif
 	}
 
 	// TODO: Support alternate configurations
@@ -99,8 +101,9 @@ void USB_DeviceConnected(tUSBHub *Hub, int Port)
 	for( int i = 0; i < 1; i ++ )
 	{
 		struct sDescriptor_Configuration	desc;
-		void	*full_buf;
-		char	*cur_ptr;
+		Uint8	*full_buf;
+		size_t	ptr_ofs = 0;
+		size_t	total_length;
 	
 		USB_int_ReadDescriptor(dev, 0, 2, i, sizeof(desc), &desc);
 		LOG("Configuration Descriptor %i = {", i);
@@ -127,19 +130,36 @@ void USB_DeviceConnected(tUSBHub *Hub, int Port)
 		dev->nInterfaces = desc.NumInterfaces;
 	
 		// Allocate a temp buffer for config info
-		cur_ptr = full_buf = malloc( LittleEndian16(desc.TotalLength) );
-		USB_int_ReadDescriptor(dev, 0, 2, i, desc.TotalLength, full_buf);
+		total_length = LittleEndian16(desc.TotalLength);
+		full_buf = malloc( total_length );
+		USB_int_ReadDescriptor(dev, 0, 2, i, total_length, full_buf);
 
-		cur_ptr += desc.Length;
+		ptr_ofs += desc.Length;
 
 		// TODO: Interfaces
-		for( int j = 0; j < desc.NumInterfaces; j ++ )
+		for( int j = 0; ptr_ofs < total_length && j < desc.NumInterfaces; j ++ )
 		{
 			struct sDescriptor_Interface *iface;
 			tUSBInterface	*dev_if;
-			iface = (void*)cur_ptr;
-			// TODO: Sanity check with remaining space
-			cur_ptr += sizeof(*iface);
+			size_t	iface_base_ofs;
+
+			iface = (void*)(full_buf + ptr_ofs);
+			if( iface->Length == 0 ) {
+				Log_Warning("USB", "Bad USB descriptor (length = 0)");
+				break ;
+			}
+			ptr_ofs += iface->Length;
+			if( ptr_ofs > total_length ) {
+				// Sanity fail
+				break;
+			}
+			iface_base_ofs = ptr_ofs;
+			// Check type
+			if( iface->Type != 4 ) {
+				LOG("Not an interface (type = %i)", iface->Type);
+				j --;	// Counteract j++ in loop
+				continue ;
+			}
 
 			LOG("Interface %i/%i = {", i, j);
 			LOG(" .InterfaceNum = %i", iface->InterfaceNum);
@@ -147,12 +167,13 @@ void USB_DeviceConnected(tUSBHub *Hub, int Port)
 			LOG(" .InterfaceClass = 0x%x", iface->InterfaceClass);
 			LOG(" .InterfaceSubClass = 0x%x", iface->InterfaceSubClass);
 			LOG(" .InterfaceProcol = 0x%x", iface->InterfaceProtocol);
-
+			#if DEBUG	
 			if( iface->InterfaceStr ) {
 				char	*tmp = USB_int_GetDeviceString(dev, 0, iface->InterfaceStr);
 				LOG(" .InterfaceStr = %i '%s'", iface->InterfaceStr, tmp);
 				free(tmp);
 			}
+			#endif
 			LOG("}");
 
 			dev_if = malloc(sizeof(tUSBInterface) + iface->NumEndpoints*sizeof(dev_if->Endpoints[0]));
@@ -163,13 +184,25 @@ void USB_DeviceConnected(tUSBHub *Hub, int Port)
 			dev->Interfaces[j] = dev_if;
 
 			// Copy interface data
-			for( int k = 0; k < iface->NumEndpoints; k ++ )
+			for( int k = 0; ptr_ofs < total_length && k < iface->NumEndpoints; k ++ )
 			{
 				struct sDescriptor_Endpoint *endpt;
-				endpt = (void*)cur_ptr;
-				// TODO: Sanity check with remaining space
-				cur_ptr += sizeof(*endpt);
 				
+				endpt = (void*)(full_buf + ptr_ofs);
+				ptr_ofs += endpt->Length;
+				if( ptr_ofs > total_length ) {
+					// Sanity fail
+					break;
+				}
+
+				// Check type
+				if( endpt->Type != 5 ) {
+					// Oops?
+					LOG("Not endpoint, Type = %i", endpt->Type);
+					k --;
+					continue ;
+				}
+
 				LOG("Endpoint %i/%i/%i = {", i, j, k);
 				LOG(" .Address = 0x%2x", endpt->Address);
 				LOG(" .Attributes = 0b%8b", endpt->Attributes);
@@ -200,7 +233,11 @@ void USB_DeviceConnected(tUSBHub *Hub, int Port)
 					);
 			}
 			else {
-				dev_if->Driver->Connected( dev_if );
+				dev_if->Driver->Connected(
+					dev_if,
+					full_buf + iface_base_ofs, ptr_ofs - iface_base_ofs
+					);
+			//	dev_if->Driver->Connected( dev_if );
 			}
 		}