2 * Acess2 Networking Stack
3 * - By John Hodge (thePowersGang)
6 * - Ethernet/802.3 Handling code
11 #include "include/buffer.h"
12 #include "include/adapters_int.h"
15 #define LINK_LOGPACKETS 0
16 #define VALIDATE_CHECKSUM 0
17 #define MAX_PACKET_SIZE 2048
20 void Link_RegisterType(Uint16 Type, tPacketCallback Callback);
21 void Link_SendPacket(tAdapter *Adapter, Uint16 Type, tMacAddr To, tIPStackBuffer *Buffer);
22 int Link_HandlePacket(tAdapter *Adapter, tIPStackBuffer *Buffer);
24 void Link_InitCRC(void);
25 Uint32 Link_CalculateCRC(tIPStackBuffer *Buffer);
26 Uint32 Link_CalculatePartialCRC(Uint32 CRC, const void *Data, int Length);
29 int giRegisteredTypes = 0;
30 int giRegisteredTypeSpace = 0;
33 tPacketCallback Callback;
35 int gbLink_CRCTableGenerated = 0;
36 Uint32 gaiLink_CRCTable[256];
40 * \fn void Link_RegisterType(Uint16 Type, tPacketCallback Callback)
41 * \brief Registers a callback for a specific packet type
43 * \todo Make thread safe (place a mutex on the list)
45 void Link_RegisterType(Uint16 Type, tPacketCallback Callback)
50 for( i = giRegisteredTypes; i -- ; )
52 if(gaRegisteredTypes[i].Type == Type) {
53 Log_Warning("Net Link", "Attempt to register 0x%x twice", Type);
57 if(gaRegisteredTypes[i].Callback == NULL) break;
62 giRegisteredTypeSpace += 5;
63 tmp = realloc(gaRegisteredTypes, giRegisteredTypeSpace*sizeof(*gaRegisteredTypes));
65 Log_Warning("Net Link",
66 "Out of heap space! (Attempted to allocate %i)",
67 giRegisteredTypeSpace*sizeof(*gaRegisteredTypes)
71 gaRegisteredTypes = tmp;
72 i = giRegisteredTypes;
76 gaRegisteredTypes[i].Callback = Callback;
77 gaRegisteredTypes[i].Type = Type;
81 * \fn void Link_SendPacket(tAdapter *Adapter, Uint16 Type, tMacAddr To, int Length, void *Buffer)
82 * \brief Formats and sends a packet on the specified interface
84 void Link_SendPacket(tAdapter *Adapter, Uint16 Type, tMacAddr To, tIPStackBuffer *Buffer)
86 int length = IPStack_Buffer_GetLength(Buffer);
87 int ofs = (4 - (length & 3)) & 3;
88 Uint8 buf[sizeof(tEthernetHeader) + ofs + 4];
89 //Uint32 *checksum = (void*)(buf + sizeof(tEthernetHeader) + ofs);
90 tEthernetHeader *hdr = (void*)buf;
92 Log_Log("Net Link", "Sending %i bytes to %02x:%02x:%02x:%02x:%02x:%02x (Type 0x%x)",
93 length, To.B[0], To.B[1], To.B[2], To.B[3], To.B[4], To.B[5], Type);
96 memcpy(&hdr->Src, Adapter->HWAddr, 6); // TODO: Remove hard coded 6
97 hdr->Type = htons(Type);
98 memset(hdr+1, 0, ofs+4); // zero padding and checksum
100 //if( (Adapter->Type->Flags & ADAPTERFLAG_OFFLOAD_MAC) )
101 IPStack_Buffer_AppendSubBuffer(Buffer, sizeof(tEthernetHeader), ofs, hdr, NULL, NULL);
104 // IPStack_Buffer_AppendSubBuffer(Buffer, sizeof(tEthernetHeader), ofs + 4, hdr, NULL, NULL);
105 // *checksum = htonl( Link_CalculateCRC(Buffer) );
106 // Log_Debug("Net Link", "Non-Offloaded: 0x%x, 0x%x", *checksum, ntohl(*checksum));
109 Log_Log("Net Link", " from %02x:%02x:%02x:%02x:%02x:%02x",
110 hdr->Src.B[0], hdr->Src.B[1], hdr->Src.B[2],
111 hdr->Src.B[3], hdr->Src.B[4], hdr->Src.B[5]
114 Adapter_SendPacket(Adapter, Buffer);
117 int Link_HandlePacket(tAdapter *Adapter, tIPStackBuffer *Buffer)
120 void *data = IPStack_Buffer_CompactBuffer(Buffer, &len);
122 tEthernetHeader *hdr = (void*)data;
124 if(len < sizeof(tEthernetHeader)) {
125 Log_Log("Net Link", "Recieved an undersized packet (%i < %i)",
126 len, sizeof(tEthernetHeader));
133 "Packet from %02x:%02x:%02x:%02x:%02x:%02x"
134 " to %02x:%02x:%02x:%02x:%02x:%02x (Type=%04x)",
135 hdr->Src.B[0], hdr->Src.B[1], hdr->Src.B[2],
136 hdr->Src.B[3], hdr->Src.B[4], hdr->Src.B[5],
137 hdr->Dest.B[0], hdr->Dest.B[1], hdr->Dest.B[2],
138 hdr->Dest.B[3], hdr->Dest.B[4], hdr->Dest.B[5],
143 #if VALIDATE_CHECKSUM
144 Uint32 checksum = *(Uint32*)(data + len + 4);
145 Log_Log("NET Link", "Checksum 0x%08x", checksum);
146 Uint32 calculated = Link_CalculateCRC(Buffer);
147 // TODO: Check checksum
150 // Check if there is a registered callback for this packet type
152 for( i = giRegisteredTypes; i--; )
154 if(gaRegisteredTypes[i].Type == ntohs(hdr->Type)) break;
158 Log_Log("Net Link", "Unregistered type 0x%x", ntohs(hdr->Type));
165 gaRegisteredTypes[i].Callback(
168 len - sizeof(tEthernetHeader),
177 // From http://www.cl.cam.ac.uk/research/srg/bluebook/21/crc/node6.html
178 #define QUOTIENT 0x04c11db7
179 void Link_InitCRC(void)
181 for( int i = 0; i < 256; i++ )
183 Uint32 crc = i << 24;
184 for( int j = 0; j < 8; j++ )
187 crc = (crc << 1) ^ QUOTIENT;
191 gaiLink_CRCTable[i] = crc;
194 gbLink_CRCTableGenerated = 1;
197 Uint32 Link_CalculateCRC(tIPStackBuffer *Buffer)
199 Uint32 ret = 0xFFFFFFFF;
204 while( (id = IPStack_Buffer_GetBuffer(Buffer, id, &length, &data)) != -1 )
206 ret = Link_CalculatePartialCRC(ret, data, length);
212 Uint32 Link_CalculatePartialCRC(Uint32 CRC, const void *Data, int Length)
214 // x32 + x26 + x23 + x22 + x16 + x12 + x11 + x10 + x8 + x7 + x5 + x4 + x2 + x + 1
215 const Uint32 *data = Data;
217 for( int i = 0; i < Length/4; i++ )
219 CRC = (CRC << 8 | *data++) ^ gaiLink_CRCTable[CRC >> 24];