3 * - Link/Media Layer Interface
9 #define MAX_PACKET_SIZE 2048
12 void Link_RegisterType(Uint16 Type, tPacketCallback Callback);
14 Uint32 Link_CalculateCRC(void *Data, int Length);
15 void Link_SendPacket(tAdapter *Adapter, Uint16 Type, tMacAddr To, int Length, void *Buffer);
16 void Link_WatchDevice(tAdapter *Adapter);
19 int giRegisteredTypes = 0;
20 int giRegisteredTypeSpace = 0;
23 tPacketCallback Callback;
25 int gbLink_CRCTableGenerated = 0;
26 Uint32 gaiLink_CRCTable[256];
30 * \fn void Link_RegisterType(Uint16 Type, tPacketCallback Callback)
31 * \brief Registers a callback for a specific packet type
33 * \todo Make thread safe (place a mutex on the list)
35 void Link_RegisterType(Uint16 Type, tPacketCallback Callback)
40 for( i = giRegisteredTypes; i -- ; )
42 if(gaRegisteredTypes[i].Type == Type) {
43 Log_Warning("Net Link", "Attempt to register 0x%x twice", Type);
47 if(gaRegisteredTypes[i].Callback == NULL) break;
52 giRegisteredTypeSpace += 5;
53 tmp = realloc(gaRegisteredTypes, giRegisteredTypeSpace*sizeof(*gaRegisteredTypes));
55 Log_Warning("Net Link",
56 "Out of heap space! (Attempted to allocate %i)",
57 giRegisteredTypeSpace*sizeof(*gaRegisteredTypes)
61 gaRegisteredTypes = tmp;
62 i = giRegisteredTypes;
66 gaRegisteredTypes[i].Callback = Callback;
67 gaRegisteredTypes[i].Type = Type;
71 * \fn void Link_SendPacket(tAdapter *Adapter, Uint16 Type, tMacAddr To, int Length, void *Buffer)
72 * \brief Formats and sends a packet on the specified interface
74 void Link_SendPacket(tAdapter *Adapter, Uint16 Type, tMacAddr To, int Length, void *Buffer)
76 int bufSize = sizeof(tEthernetHeader) + ((Length+3)&~3) + 4;
77 Uint8 buf[bufSize]; // dynamic stack arrays ftw!
78 tEthernetHeader *hdr = (void*)buf;
80 Log_Log("Net Link", "Sending %i bytes to %02x:%02x:%02x:%02x:%02x:%02x (Type 0x%x)",
81 Length, To.B[0], To.B[1], To.B[2], To.B[3], To.B[4], To.B[5], Type);
84 hdr->Src = Adapter->MacAddr;
85 hdr->Type = htons(Type);
87 memcpy(hdr->Data, Buffer, Length);
89 *(Uint32*) &hdr->Data[bufSize-4] = 0;
90 *(Uint32*) &hdr->Data[bufSize-4] = htonl( Link_CalculateCRC(buf, bufSize) );
92 VFS_Write(Adapter->DeviceFD, bufSize, buf);
96 * \fn void Link_WatchDevice(tAdapter *Adapter)
97 * \brief Spawns a worker thread to watch the specified adapter
99 void Link_WatchDevice(tAdapter *Adapter)
101 int tid = Proc_SpawnWorker(); // Create a new worker thread
104 Log_Warning("NET", "Unable to create watcher thread for '%s'", Adapter->Device);
109 Log_Log("Net Link", "Watching '%s' using tid %i", Adapter->Device, tid);
113 if( !gbLink_CRCTableGenerated )
116 Threads_SetName(Adapter->Device);
117 Log_Log("Net Link", "Thread %i watching '%s'", Threads_GetTID(), Adapter->Device);
120 while(Adapter->DeviceFD != -1)
122 Uint8 buf[MAX_PACKET_SIZE];
123 tEthernetHeader *hdr = (void*)buf;
127 // Wait for a packet (Read on a network device is blocking)
128 //Log_Debug("NET", "Waiting on adapter FD#0x%x", Adapter->DeviceFD);
129 ret = VFS_Read(Adapter->DeviceFD, MAX_PACKET_SIZE, buf);
132 if(ret <= (int)sizeof(tEthernetHeader)) {
133 Log_Log("NET", "Recieved an undersized packet");
138 "Packet from %02x:%02x:%02x:%02x:%02x:%02x"
139 " to %02x:%02x:%02x:%02x:%02x:%02x (Type=%04x)",
140 hdr->Src.B[0], hdr->Src.B[1], hdr->Src.B[2],
141 hdr->Src.B[3], hdr->Src.B[4], hdr->Src.B[5],
142 hdr->Dest.B[0], hdr->Dest.B[1], hdr->Dest.B[2],
143 hdr->Dest.B[3], hdr->Dest.B[4], hdr->Dest.B[5],
146 checksum = *(Uint32*)&hdr->Data[ret-sizeof(tEthernetHeader)-4];
147 //Log_Log("NET", "Checksum 0x%08x", checksum);
148 // TODO: Check checksum
150 // Check if there is a registered callback for this packet type
151 for( i = giRegisteredTypes; i--; )
153 if(gaRegisteredTypes[i].Type == ntohs(hdr->Type)) break;
157 Log_Log("Net Link", "Unregistered type 0x%x", ntohs(hdr->Type));
162 gaRegisteredTypes[i].Callback(
165 ret - sizeof(tEthernetHeader),
170 Log_Log("NET", "Watcher terminated (file closed)");
175 // From http://www.cl.cam.ac.uk/research/srg/bluebook/21/crc/node6.html
176 #define QUOTIENT 0x04c11db7
177 void Link_InitCRC(void)
182 for (i = 0; i < 256; i++)
185 for (j = 0; j < 8; j++)
187 if (crc & 0x80000000)
188 crc = (crc << 1) ^ QUOTIENT;
192 gaiLink_CRCTable[i] = crc;
195 gbLink_CRCTableGenerated = 1;
198 Uint32 Link_CalculateCRC(void *Data, int Length)
200 // x32 + x26 + x23 + x22 + x16 + x12 + x11 + x10 + x8 + x7 + x5 + x4 + x2 + x + 1
205 if(Length < 4) return 0;
207 result = *data++ << 24;
208 result |= *data++ << 16;
209 result |= *data++ << 8;
214 for( i = 0; i < Length; i++ )
216 result = (result << 8 | *data++) ^ gaiLink_CRCTable[result >> 24];