A stack which works with or without an Mbed os library. Provides IPv4 or IPv6 with a full 1500 byte buffer.
Dependents: oldheating gps motorhome heating
eth/eth.cpp
- Committer:
- andrewboyson
- Date:
- 2017-10-15
- Revision:
- 42:222a4f45f916
- Parent:
- 37:793b39683406
- Child:
- 43:bc028d5a6424
File content as of revision 42:222a4f45f916:
#include "mbed.h" #include "io.h" #include "log.h" #include "net.h" #include "action.h" #include "arp.h" #include "ip4.h" #include "ip6.h" #include "phy.h" #include "eth.h" #include "mac.h" #define HEADER_SIZE 14 //header variables __packed struct header { char dst[6]; char src[6]; uint16_t typ; }; static uint16_t protocol; void EthProtocolToString(uint16_t prototype, int size, char* text) { switch (prototype) { case ARP: strncpy (text, "ARP" , size); break; case IPV4: strncpy (text, "IPV4", size); break; case IPV6: strncpy (text, "IPV6", size); break; default: snprintf(text, size, "%04hX", prototype); break; } } static void finalisePacket(int action, int dataLength, void* pPacket, int* pSize) { if (!action) return; struct header * pHeader = (header*)pPacket; MacMake(action, protocol, pHeader->dst); MacCopy(pHeader->src, MacLocal); //Put our MAC into the source pHeader->typ = NetToHost16(protocol); *pSize = HEADER_SIZE + dataLength; } void LogHeader(struct header* pHeader) { char text[20]; Log("ETH header\r\n"); MacToString(pHeader->dst, sizeof(text), text); LogF(" Destination: %s\r\n", text); MacToString(pHeader->src, sizeof(text), text); LogF(" Source: %s\r\n", text); EthProtocolToString(NetToHost16(pHeader->typ), sizeof(text), text); LogF(" EtherType: %s\r\n", text); } static void (*pTraceBack)(void); static void* tracePacket; static void trace() { pTraceBack(); struct header * pHeader = (header*)tracePacket; LogHeader(pHeader); } int EthHandlePacket(void (*traceback)(void), void* pPacket, int* pSize) { pTraceBack = traceback; tracePacket = pPacket; struct header * pHeader = (header*)pPacket; int dataLength = *pSize - HEADER_SIZE; void* pData = (char*)pPacket + HEADER_SIZE; if (!MacAccept(pHeader->dst)) return DO_NOTHING; protocol = NetToHost16(pHeader->typ); if (protocol < 1500) return DO_NOTHING; //drop 802.3 messages int action = DO_NOTHING; switch (protocol) { case ARP: action = ArpHandleReceivedPacket(trace, pHeader->src, pData, &dataLength, pHeader->dst); break; case IPV4: action = Ip4HandleReceivedPacket(trace, pHeader->src, pData, &dataLength, pHeader->dst); break; case IPV6: action = Ip6HandleReceivedPacket(trace, pHeader->src, pData, &dataLength, pHeader->dst); break; case 0x6970: break; //Drop Sonos group membership packet case 0x7374: break; //Drop Sky Q packet case 0x7475: break; //Drop Sky Q packet case 0x7380: break; //Drop Sky Q packet case 0x8100: break; //Drop Sky Q VLAN 802.1Q packet case 0x887b: break; //Drop Sky Q packet default: LogTimeF("ETH protocol %d not handled", protocol); break; } finalisePacket(action, dataLength, pPacket, pSize); if (ActionGetTracePart(action)) LogHeader(pHeader); return action; } int EthPollForPacketToSend(void* pPacket, int* pSize) { struct header * pHeader = (header*)pPacket; void* pData = (char*)pPacket + HEADER_SIZE; int dataLength = 0; protocol = 0; int action = DO_NOTHING; if (action == DO_NOTHING) { action = ArpPollForPacketToSend(pData, &dataLength); protocol = ARP; } if (action == DO_NOTHING) { action = Ip6PollForPacketToSend(pData, &dataLength, pHeader->dst); protocol = IPV6; } if (action == DO_NOTHING) { action = Ip4PollForPacketToSend(pData, &dataLength, pHeader->dst); protocol = IPV4; } finalisePacket(action, dataLength, pPacket, pSize); if (ActionGetTracePart(action)) LogHeader(pHeader); return action; }