X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=KernelLand%2FModules%2FIPStack%2Fadapters.c;h=90c0b24510d3a47ac7522cc29089f49ad650a9de;hb=5fad99e7c76b4974a45c6c1880ee63eb2839d324;hp=f4b99beb0bbb532618ef15f7da1842e8bc56bb01;hpb=33495f1efd207f0af4f804858f247db0983fcb8f;p=tpg%2Facess2.git

diff --git a/KernelLand/Modules/IPStack/adapters.c b/KernelLand/Modules/IPStack/adapters.c
index f4b99beb..90c0b245 100644
--- a/KernelLand/Modules/IPStack/adapters.c
+++ b/KernelLand/Modules/IPStack/adapters.c
@@ -79,9 +79,10 @@ void *IPStack_Adapter_Add(const tIPStack_AdapterType *Type, void *Ptr, const voi
 	ret->Node.Type = &gIP_AdapterType;
 	ret->Node.ImplPtr = ret;
 
-	// TODO: Locking
+	Mutex_Acquire( &glIP_Adapters );
 	gpIP_AdapterList_Last->Next = ret;
 	gpIP_AdapterList_Last = ret;
+	Mutex_Release( &glIP_Adapters );
 	
 	// Watch the adapter for incoming packets
 	tTID tid = Proc_SpawnWorker(Adapter_int_WatchThread, ret);
@@ -119,7 +120,7 @@ void *IPStack_Adapter_AddVFS(const char *Path)
 	// Get MAC Address
 	VFS_IOCtl(fd, NET_IOCTL_GETMAC, mac);
 
-	return IPStack_Adapter_Add(NULL, (void*)fd, mac);
+	return IPStack_Adapter_Add(NULL, (void*)(tVAddr)fd, mac);
 }
 
 void IPStack_Adapter_Del(void *Handle)
@@ -143,9 +144,7 @@ char *Adapter_ReadDir(tVFS_Node *Node, int Pos)
 		tAdapter *a;  int i;\
 		for(i=0,a=list; i < Pos && a; i ++, a = a->Next ); \
 		if( a ) { \
-			char	buf[sizeof(type)+10]; \
-			sprintf(buf, type"%i", a->Index); \
-			return strdup(buf); \
+			return Adapter_GetName(a);\
 		} \
 		Pos -= i; \
 	} while(0);
@@ -229,6 +228,21 @@ tAdapter *Adapter_GetByName(const char *Name)
 	return NULL;
 }
 
+char *Adapter_GetName(tAdapter *Adapter)
+{
+	if( Adapter == &gIP_LoopAdapter )
+	{
+		return strdup("lo");
+	}
+	else
+	{
+		// TODO: Support multiple adapter types
+		char	buf[sizeof("eth")+10];
+		sprintf(buf, "eth%i", Adapter->Index);
+		return strdup(buf);
+	}
+}
+
 void Adapter_SendPacket(tAdapter *Handle, tIPStackBuffer *Buffer)
 {
 	if( Handle->Type == NULL )
@@ -301,3 +315,83 @@ int Adapter_int_LoopbackSendPacket(void *Unused, tIPStackBuffer *Buffer)
 	return 0;
 }
 
+// --- Broadcast Debugging ---
+extern Uint16	IPv4_Checksum(const void *Buf, size_t Length);
+void IPStack_SendDebugText(const char *Text)
+{
+	const Uint8	pkt_hdr[] = {
+		0xFF,0xFF, 0xFF,0xFF, 0xFF,0xFF,
+		0x00,0x00, 0x00,0x00, 0x00,0x00,
+		0x08,0x00,
+		
+		0x45,0x00,	// Version/Length, DiffServices
+		0xFF,0xFF,	// Total Length
+		0x00,0x00,	// Identifcation
+		0x00,0x00, 0xFF,0x11,	// Flags,Fragment, TTL=255,proto=UDP
+		0x00,0x00,	// Header checksum
+		0x00,0x00,0x00,0x00,	// Source
+		0xFF,0xFF,0xFF,0xFF,	// Destination
+		
+		0x80,0x00, 0x80,0x00,
+		0xFF,0xFF, 0xFF,0xFF,
+	};
+	static tShortSpinlock	lLock;
+
+	// Fast return if there's no avaliable adapters
+	if( !gpIP_AdapterList )
+		return ;
+
+	if( CPU_HAS_LOCK(&lLock) )
+		return ;	// Nested!
+	SHORTLOCK(&lLock);
+	__asm__ __volatile__ ("sti");	// Start interrupts (x86 specific)
+
+	// Cache packets until a newline
+	static char	cache[1500 - (sizeof(pkt_hdr) + 4)];
+	static int	cache_len;
+	
+	 int	len = strlen(Text);
+
+	// Append to cache
+	strncpy(cache + cache_len, Text, sizeof(cache) - cache_len);
+	cache_len += len;
+	// TODO: Detect overflows.
+	
+	// If there's no newline, only buffer
+	if( strpos(Text, '\n') == -1 ) {
+		SHORTREL(&lLock);
+		return ;
+	}
+
+	// Build packet
+	 int	link_checksum_ofs = sizeof(pkt_hdr) + cache_len;
+	char	buffer[sizeof(pkt_hdr) + cache_len + 4];
+
+	memcpy(buffer, pkt_hdr, sizeof(pkt_hdr));
+	memcpy(buffer + sizeof(pkt_hdr), cache, cache_len);
+	
+	((Uint16*)buffer)[(14+2)/2] = BigEndian16( sizeof(pkt_hdr)-14 + cache_len );	// IP Size
+	((Uint16*)buffer)[(14+10)/2] = BigEndian16( 0 );	// IP Header
+	((Uint16*)buffer)[(14+20+4)/2] = BigEndian16( 8+cache_len );	// UDP Size
+	((Uint16*)buffer)[(14+20+6)/2] = BigEndian16( 0 );	// UDP Checksum
+//	*(Uint32*)&buffer[link_checksum_ofs] = BigEndian32( 0 );	// 802.3 checksum?
+	// TODO: Calculate checksums
+	((Uint16*)buffer)[(14+10)/2] = BigEndian16( IPv4_Checksum(buffer+14,20) );	// IP Header
+	
+	// Create buffer
+	tIPStackBuffer	*buf = IPStack_Buffer_CreateBuffer(1);
+	IPStack_Buffer_AppendSubBuffer(buf, link_checksum_ofs+4, 0, buffer, NULL, NULL);
+
+	// Send 'er off
+	for( tAdapter *a = gpIP_AdapterList; a; a = a->Next )
+	{
+		a->Type->SendPacket( a->CardHandle, buf );
+	}
+
+	IPStack_Buffer_DestroyBuffer(buf);
+
+	cache_len = 0;
+
+	SHORTREL(&lLock);
+}
+