2 * Acess2 Networking Stack
3 * - By John Hodge (thePowersGang)
6 * - Network Adapter Management
9 #define VERSION VER2(0,1)
11 #include "include/buffer.h"
12 #include "include/adapters.h"
13 #include "include/adapters_int.h"
15 #include <api_drv_common.h> // For the VFS hack
16 #include <api_drv_network.h>
19 // --- "External" (NIC) API ---
20 void *IPStack_Adapter_Add(const tIPStack_AdapterType *Type, void *Ptr, const void *HWAddr);
21 void IPStack_Adapter_Del(void *Handle);
23 char *Adapter_ReadDir(tVFS_Node *Node, int Pos);
24 tVFS_Node *Adapter_FindDir(tVFS_Node *Node, const char *Name);
25 int Adapter_DirIOCtl(tVFS_Node *Node, int Num, void *Data);
26 int Adapter_IOCtl(tVFS_Node *Node, int Num, void *Data);
27 // --- "Internal" (IPStack) API ---
28 tAdapter *Adapter_GetByName(const char *Name);
29 void Adapter_SendPacket(tAdapter *Handle, tIPStackBuffer *Buffer);
31 void Adapter_int_WatchThread(void *Ptr);
32 tIPStackBuffer *Adapter_int_LoopbackWaitPacket(void *Unused);
33 int Adapter_int_LoopbackSendPacket(void *Unused, tIPStackBuffer *Buffer);
37 tVFS_NodeType gIP_AdaptersDirType = {
38 .ReadDir = Adapter_ReadDir,
39 .FindDir = Adapter_FindDir,
40 .IOCtl = Adapter_DirIOCtl
42 tVFS_NodeType gIP_AdapterType = {
43 // TODO: Should direct IO be allowed?
44 .IOCtl = Adapter_IOCtl
46 tVFS_Node gIP_AdaptersNode = {
47 .Type = &gIP_AdaptersDirType,
48 .Flags = VFS_FFLAG_DIRECTORY,
51 // --- Loopback Adapter ---
52 tIPStack_AdapterType gIP_LoopAdapterType = {
54 .WaitForPacket = Adapter_int_LoopbackWaitPacket,
55 .SendPacket = Adapter_int_LoopbackSendPacket
57 tAdapter gIP_LoopAdapter;
58 // --- Main adapter list ---
60 tAdapter *gpIP_AdapterList;
61 tAdapter *gpIP_AdapterList_Last = (void*)&gpIP_AdapterList; // HACK!
62 int giIP_NextAdapterIndex;
65 // --- "External" (NIC) API ---
66 void *IPStack_Adapter_Add(const tIPStack_AdapterType *Type, void *Ptr, const void *HWAddr)
70 ret = malloc(sizeof(tAdapter) + 6); // TODO: Don't assume 6-byte MAC addresses
73 ret->CardHandle = Ptr;
75 ret->Index = giIP_NextAdapterIndex++;
76 memcpy(ret->HWAddr, HWAddr, 6);
78 memset(&ret->Node, 0, sizeof(ret->Node));
79 ret->Node.Type = &gIP_AdapterType;
80 ret->Node.ImplPtr = ret;
82 Mutex_Acquire( &glIP_Adapters );
83 gpIP_AdapterList_Last->Next = ret;
84 gpIP_AdapterList_Last = ret;
85 Mutex_Release( &glIP_Adapters );
87 // Watch the adapter for incoming packets
88 tTID tid = Proc_SpawnWorker(Adapter_int_WatchThread, ret);
90 Log_Warning("IPStack", "Unable to create watcher thread for %p", ret);
96 void *IPStack_Adapter_AddVFS(const char *Path)
101 ENTER("sPath", Path);
104 fd = VFS_Open( Path, VFS_OPENFLAG_READ|VFS_OPENFLAG_WRITE );
110 // Check that it is a network interface
111 tmp = VFS_IOCtl(fd, 0, NULL);
112 LOG("Device type = %i", tmp);
113 if( tmp != DRV_TYPE_NETWORK ) {
114 Log_Warning("IPStack", "IPStack_Adapter_AddVFS: '%s' is not a network interface", Path);
121 VFS_IOCtl(fd, NET_IOCTL_GETMAC, mac);
123 return IPStack_Adapter_Add(NULL, (void*)(tVAddr)fd, mac);
126 void IPStack_Adapter_Del(void *Handle)
128 Log_Error("IPStack", "TODO: Implement IPStack_Adapter_Del");
129 // TODO: Allow removing adapters during system operation
133 char *Adapter_ReadDir(tVFS_Node *Node, int Pos)
135 if( Pos < 0 ) return NULL;
143 #define CHECK_LIST(list, type) do{ \
145 for(i=0,a=list; i < Pos && a; i ++, a = a->Next ); \
147 return Adapter_GetName(a);\
152 CHECK_LIST(gpIP_AdapterList, "eth");
153 // TODO: Support other types of adapters (wifi, tap, ...)
158 tVFS_Node *Adapter_FindDir(tVFS_Node *Node, const char *Name)
160 tAdapter *a = Adapter_GetByName(Name);
167 static const char *casIOCtls_Root[] = { DRV_IOCTLNAMES, "add_vfs_adapter", NULL };
168 int Adapter_DirIOCtl(tVFS_Node *Node, int Num, void *Data)
172 BASE_IOCTLS(DRV_TYPE_MISC, "IPStack-AdapterList", VERSION, casIOCtls_Root)
175 if( !CheckString(Data) )
178 // Return non-zero if add fails
179 return IPStack_Adapter_AddVFS(Data) == NULL;
184 static const char *casIOCtls_Dev[] = { DRV_IOCTLNAMES, "get_hwaddr", NULL };
185 int Adapter_IOCtl(tVFS_Node *Node, int Num, void *Data)
187 tAdapter *adapter = Node->ImplPtr;
190 BASE_IOCTLS(DRV_TYPE_MISC, "IPStack-Adapter", VERSION, casIOCtls_Dev)
193 if( !CheckMem(Data, 6) )
196 memcpy(Data, adapter->HWAddr, 6);
202 // --- "Internal" (IPStack) API ---
203 tAdapter *Adapter_GetByName(const char *Name)
205 if( strcmp(Name, "lo") == 0 ) {
206 return &gIP_LoopAdapter;
209 if( strncmp(Name, "eth", 3) == 0 )
211 // Possibly an ethX interface
214 // Get the index at the end
215 ofs = ParseInt(Name + 3, &index);
216 if( ofs == 0 || Name[3+ofs] != '\0' )
219 // Find the adapter with that index
220 for( tAdapter *a = gpIP_AdapterList; a && a->Index <= index; a = a->Next ) {
221 if( a->Index == index )
231 char *Adapter_GetName(tAdapter *Adapter)
233 if( Adapter == &gIP_LoopAdapter )
239 // TODO: Support multiple adapter types
240 char buf[sizeof("eth")+10];
241 sprintf(buf, "eth%i", Adapter->Index);
246 void Adapter_SendPacket(tAdapter *Handle, tIPStackBuffer *Buffer)
248 if( Handle->Type == NULL )
251 void *data = IPStack_Buffer_CompactBuffer(Buffer, &outlen);
252 VFS_Write((tVAddr)Handle->CardHandle, outlen, data);
257 Handle->Type->SendPacket( Handle->CardHandle, Buffer );
262 void Adapter_int_WatchThread(void *Ptr)
264 tAdapter *Adapter = Ptr;
265 const int MTU = 1520;
266 tIPStackBuffer *buf = NULL;
269 if( Adapter->Type == NULL )
271 data = malloc( MTU );
272 buf = IPStack_Buffer_CreateBuffer(1);
276 Threads_SetName("Adapter Watcher");
277 Log_Log("IPStack", "Thread %i watching eth%i '%s'", Threads_GetTID(), Adapter->Index,
278 Adapter->Type?Adapter->Type->Name:"VFS");
282 if( Adapter->Type == NULL )
284 int len = VFS_Read((tVAddr)Adapter->CardHandle, MTU, data);
285 IPStack_Buffer_AppendSubBuffer(buf, len, 0, buf, NULL, NULL);
289 buf = Adapter->Type->WaitForPacket( Adapter->CardHandle );
292 Link_HandlePacket(Adapter, buf);
294 if( Adapter->Type == NULL )
296 IPStack_Buffer_ClearBuffer(buf);
300 IPStack_Buffer_DestroyBuffer(buf);
305 tIPStackBuffer *Adapter_int_LoopbackWaitPacket(void *Unused)
311 int Adapter_int_LoopbackSendPacket(void *Unused, tIPStackBuffer *Buffer)
313 // This is a little hacky :)
314 Link_HandlePacket(&gIP_LoopAdapter, Buffer);
318 // --- Broadcast Debugging ---
319 extern Uint16 IPv4_Checksum(const void *Buf, size_t Length);
320 void IPStack_SendDebugText(const char *Text)
322 const Uint8 pkt_hdr[] = {
323 0xFF,0xFF, 0xFF,0xFF, 0xFF,0xFF,
324 0x00,0x00, 0x00,0x00, 0x00,0x00,
327 0x45,0x00, // Version/Length, DiffServices
328 0xFF,0xFF, // Total Length
329 0x00,0x00, // Identifcation
330 0x00,0x00, 0xFF,0x11, // Flags,Fragment, TTL=255,proto=UDP
331 0x00,0x00, // Header checksum
332 0x00,0x00,0x00,0x00, // Source
333 0xFF,0xFF,0xFF,0xFF, // Destination
335 0x80,0x00, 0x80,0x00,
336 0xFF,0xFF, 0xFF,0xFF,
338 static tShortSpinlock lLock;
340 // Fast return if there's no avaliable adapters
341 if( !gpIP_AdapterList )
344 if( CPU_HAS_LOCK(&lLock) )
348 __asm__ __volatile__ ("sti"); // Start interrupts (x86 specific)
351 // Cache packets until a newline
352 static char cache[1500 - (sizeof(pkt_hdr) + 4)];
353 static int cache_len;
355 int len = strlen(Text);
358 strncpy(cache + cache_len, Text, sizeof(cache) - cache_len);
360 // TODO: Detect overflows.
362 // If there's no newline, only buffer
363 if( strpos(Text, '\n') == -1 ) {
369 int link_checksum_ofs = sizeof(pkt_hdr) + cache_len;
370 char buffer[sizeof(pkt_hdr) + cache_len + 4];
372 memcpy(buffer, pkt_hdr, sizeof(pkt_hdr));
373 memcpy(buffer + sizeof(pkt_hdr), cache, cache_len);
375 ((Uint16*)buffer)[(14+2)/2] = BigEndian16( sizeof(pkt_hdr)-14 + cache_len ); // IP Size
376 ((Uint16*)buffer)[(14+10)/2] = BigEndian16( 0 ); // IP Header
377 ((Uint16*)buffer)[(14+20+4)/2] = BigEndian16( 8+cache_len ); // UDP Size
378 ((Uint16*)buffer)[(14+20+6)/2] = BigEndian16( 0 ); // UDP Checksum
379 // *(Uint32*)&buffer[link_checksum_ofs] = BigEndian32( 0 ); // 802.3 checksum?
380 // TODO: Calculate checksums
381 ((Uint16*)buffer)[(14+10)/2] = BigEndian16( IPv4_Checksum(buffer+14,20) ); // IP Header
384 tIPStackBuffer *buf = IPStack_Buffer_CreateBuffer(1);
385 IPStack_Buffer_AppendSubBuffer(buf, link_checksum_ofs+4, 0, buffer, NULL, NULL);
388 for( tAdapter *a = gpIP_AdapterList; a; a = a->Next )
390 a->Type->SendPacket( a->CardHandle, buf );
393 IPStack_Buffer_DestroyBuffer(buf);