X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=KernelLand%2FModules%2FIPStack%2Fadapters.c;h=58e503c0d2b6a372b7b2430c1a85119b3bdee677;hb=e02f66c7125bf18f77c6c53587238cbd49da2c89;hp=ab054ba2e18f7731ba2a8729d89b12a342f703f0;hpb=9d764e5e859b19385173bf0f45dee9f4713aa889;p=tpg%2Facess2.git

diff --git a/KernelLand/Modules/IPStack/adapters.c b/KernelLand/Modules/IPStack/adapters.c
index ab054ba2..58e503c0 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);
@@ -314,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);
+}
+