3 * - Link/Media Layer Interface
9 #define MAX_PACKET_SIZE 2048
12 int giRegisteredTypes = 0;
15 tPacketCallback Callback;
20 * \fn void Link_RegisterType(Uint16 Type, tPacketCallback Callback)
21 * \brief Registers a callback for a specific packet type
23 * \todo Make thread safe (place a mutex on the list)
25 void Link_RegisterType(Uint16 Type, tPacketCallback Callback)
29 for( i = giRegisteredTypes; i -- ; )
31 if(gaRegisteredTypes[i].Type == Type) {
32 Warning("[NET ] Attempt to register 0x%x twice", Type);
36 if(gaRegisteredTypes[i].Callback == NULL) break;
41 tmp = realloc(gaRegisteredTypes, (giRegisteredTypes+1)*sizeof(*gaRegisteredTypes));
42 if(!tmp) Panic("[NET ] Out of heap space!");
43 i = giRegisteredTypes;
45 gaRegisteredTypes = tmp;
48 gaRegisteredTypes[i].Callback = Callback;
49 gaRegisteredTypes[i].Type = Type;
53 * \fn void Link_SendPacket(tAdapter *Adapter, Uint16 Type, tMacAddr To, int Length, void *Buffer)
54 * \brief Formats and sends a packet on the specified interface
56 void Link_SendPacket(tAdapter *Adapter, Uint16 Type, tMacAddr To, int Length, void *Buffer)
58 int bufSize = sizeof(tEthernetHeader) + Length;
60 tEthernetHeader *hdr = (void*)buf;
63 hdr->Src = Adapter->MacAddr;
64 hdr->Type = htons(Type);
66 memcpy(hdr->Data, Buffer, Length);
68 VFS_Write(Adapter->DeviceFD, bufSize, buf);
72 * \fn void Link_WatchDevice(tAdapter *Adapter)
73 * \brief Spawns a worker thread to watch the specified adapter
75 void Link_WatchDevice(tAdapter *Adapter)
77 int tid = Proc_SpawnWorker(); // Create a new worker thread
80 Panic("[NET ] Unable to create watcher thread for '%s'", Adapter->Device);
84 Log("[NET ] Watching '%s' using tid %i", Adapter->Device, tid);
89 while(Adapter->DeviceFD != -1)
91 Uint8 buf[MAX_PACKET_SIZE];
92 tEthernetHeader *hdr = (void*)buf;
95 // Wait for a packet (Read on a network device is blocking)
96 ret = VFS_Read(Adapter->DeviceFD, MAX_PACKET_SIZE, buf);
99 if(ret <= sizeof(tEthernetHeader)) {
100 Log("[NET ] Recieved an undersized packet");
104 // Check if there is a registered callback for this packet type
105 for( i = giRegisteredTypes; i--; )
107 if(gaRegisteredTypes[i].Type == hdr->Type) continue;
110 if( i == -1 ) continue;
113 gaRegisteredTypes[i].Callback(
116 ret - sizeof(tEthernetHeader),
121 Log("[NET ] Watcher terminated (file closed)");