Andrew Boyson
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
Diff: eth/mac.cpp
- Revision:
- 14:e75a59c1123d
- Parent:
- 13:9cd54f7db57a
- Child:
- 35:93c39d260a83
--- a/eth/mac.cpp Mon May 01 18:20:55 2017 +0000
+++ b/eth/mac.cpp Fri May 05 17:44:16 2017 +0000
@@ -1,197 +1,125 @@
#include "mbed.h"
-#include "eth.h"
+#include "net.h"
+#include "eth.h"
char MacLocal[6];
-bool MacCompareBroadcast(char* p)
-{
- if (*p++ != 0xff) return false;
- if (*p++ != 0xff) return false;
- if (*p++ != 0xff) return false;
- if (*p++ != 0xff) return false;
- if (*p++ != 0xff) return false;
- if (*p != 0xff) return false;
- return true;
-}
-bool MacCompareUnicastLocal(char* p)
-{
- return memcmp(p, MacLocal, 6) == 0;
-}
-bool MacCompareMulticastLocal4(char* p)
-{
- if (*p++ != 0x01) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x5e) return false;
- char* q = MacLocal + 3;
- if (*p++ != *q++) return false;
- if (*p++ != *q++) return false;
- if (*p != *q ) return false;
- return true;
-}
-bool MacCompareMulticastLocal6(char* p)
-{
- if (*p++ != 0x33) return false;
- if (*p++ != 0x33) return false;
- if (*p++ != 0xff) return false;
- char* q = MacLocal + 3;
- if (*p++ != *q++) return false;
- if (*p++ != *q++) return false;
- if (*p != *q ) return false;
- return true;
-}
-bool MacCompareMulticastAllNodes4(char* p)
-{
- if (*p++ != 0x01) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x5e) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p != 0x01) return false;
- return true;
-}
-bool MacCompareMulticastAllNodes6(char* p)
+int MacToString(char* mac, int size, char* text)
{
- if (*p++ != 0x33) return false;
- if (*p++ != 0x33) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p != 0x01) return false;
- return true;
-}
-bool MacCompareMulticastAllRouters4(char* p)
-{
- if (*p++ != 0x01) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x5e) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p != 0x02) return false;
- return true;
-}
-bool MacCompareMulticastAllRouters6(char* p)
-{
- if (*p++ != 0x33) return false;
- if (*p++ != 0x33) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p != 0x02) return false;
- return true;
-}
-bool MacCompareMulticastMdns4(char* p)
-{
- if (*p++ != 0x01) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x5e) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p != 0xfb) return false;
- return true;
-}
-bool MacCompareMulticastMdns6(char* p)
-{
- if (*p++ != 0x33) return false;
- if (*p++ != 0x33) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p != 0xfb) return false;
- return true;
+ return snprintf(text, size, "%02x:%02x:%02x:%02x:%02x:%02x", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
}
-bool MacCompareMulticastLlmnr4(char* p)
-{
- if (*p++ != 0x01) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x5e) return false;
- if (*p++ != 0x01) return false;
- if (*p++ != 0x00) return false;
- if (*p != 0x03) return false;
- return true;
-}
-bool MacCompareMulticastLlmnr6(char* p)
-{
- if (*p++ != 0x33) return false;
- if (*p++ != 0x33) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p++ != 0x00) return false;
- if (*p != 0xfc) return false;
- return true;
-}
-void MacMakeMulticastNode4(char* p)
+
+int MacAccept(char* p)
{
- *p++ = 0x01;
- *p++ = 0x00;
- *p++ = 0x5e;
- *p++ = 0x00;
- *p++ = 0x00;
- *p = 0x01;
-}
-void MacMakeMulticastNode6(char* p)
-{
- *p++ = 0x33;
- *p++ = 0x33;
- *p++ = 0x00;
- *p++ = 0x00;
- *p++ = 0x00;
- *p = 0x01;
-}
-void MacMakeMulticastRouter4(char* p)
-{
- *p++ = 0x01;
- *p++ = 0x00;
- *p++ = 0x5e;
- *p++ = 0x00;
- *p++ = 0x00;
- *p = 0x02;
+ switch (*p)
+ {
+ case 0xff: //Broadcast
+ {
+ p++; if (*p != 0xff) return DO_NOTHING;
+ p++; if (*p != 0xff) return DO_NOTHING;
+ p++; if (*p != 0xff) return DO_NOTHING;
+ p++; if (*p != 0xff) return DO_NOTHING;
+ p++; if (*p != 0xff) return DO_NOTHING;
+ return BROADCAST;
+ }
+ case 0x01: //Multicast IP4
+ {
+ p++; if (*p != 0x00) return DO_NOTHING;
+ p++; if (*p != 0x5e) return DO_NOTHING;
+ p++; if (*p != 0x00) return DO_NOTHING;
+ p++; if (*p != 0x00) return DO_NOTHING;
+ p++;
+ switch (*p) //01 00 5E 00 00 xx
+ {
+ case 0x01: return MULTICAST_NODE;
+ case 0x02: return MULTICAST_ROUTER;
+ case 0xfb: return MULTICAST_MDNS;
+ case 0xfc: return MULTICAST_LLMNR;
+ default: return DO_NOTHING;
+ }
+ }
+ case 0x33: //Multicast IP6
+ {
+ p++; if (*p != 0x33) return DO_NOTHING;
+ p++;
+ switch (*p) //33 33
+ {
+ case 0x00: //33 33 00 Special address
+ {
+ p++;
+ switch (*p)
+ {
+ case 0x00: //33 33 00 00
+ {
+ p++; if (*p != 0x00) return DO_NOTHING;
+ p++;
+ switch (*p) //33 33 00 00 00 xx
+ {
+ case 0x01: return MULTICAST_NODE;
+ case 0x02: return MULTICAST_ROUTER;
+ case 0xfb: return MULTICAST_MDNS;
+ default: return DO_NOTHING;
+ }
+ }
+ case 0x01: //33 33 00 01
+ {
+ p++; if (*p != 0x00) return DO_NOTHING;
+ p++;
+ switch (*p) //33 33 00 01 00 xx
+ {
+ case 0x03: return MULTICAST_LLMNR;
+ default: return DO_NOTHING;
+ }
+ }
+ default: return DO_NOTHING;
+ }
+ }
+ case 0xff: //33 33 FF LL LL LL Solicited address
+ {
+ char* q = MacLocal + 3;
+ p++; if (*p != *q++) return DO_NOTHING;
+ p++; if (*p != *q++) return DO_NOTHING;
+ p++; if (*p != *q++) return DO_NOTHING;
+ return SOLICITED_NODE;
+ }
+ default: return DO_NOTHING;
+ }
+ }
+ default: //Unicast to me
+ {
+ char* q = MacLocal;
+ if (*p != *q++) return DO_NOTHING;
+ p++; if (*p != *q++) return DO_NOTHING;
+ p++; if (*p != *q++) return DO_NOTHING;
+ p++; if (*p != *q++) return DO_NOTHING;
+ p++; if (*p != *q++) return DO_NOTHING;
+ p++; if (*p != *q) return DO_NOTHING;
+ return UNICAST;
+ }
+ }
}
-void MacMakeMulticastRouter6(char* p)
-{
- *p++ = 0x33;
- *p++ = 0x33;
- *p++ = 0x00;
- *p++ = 0x00;
- *p++ = 0x00;
- *p = 0x02;
-}
-void MacMakeMulticastMdns4(char* p)
-{
- *p++ = 0x01;
- *p++ = 0x00;
- *p++ = 0x5e;
- *p++ = 0x00;
- *p++ = 0x00;
- *p = 0xfb;
-}
-void MacMakeMulticastMdns6(char* p)
+
+void MacMake(int action, int pro, char* p)
{
- *p++ = 0x33;
- *p++ = 0x33;
- *p++ = 0x00;
- *p++ = 0x00;
- *p++ = 0x00;
- *p = 0xfb;
+ if (action == BROADCAST) { *p++ = 0xff; *p++ = 0xff; *p++ = 0xff; *p++ = 0xff; *p++ = 0xff; *p = 0xff; return; }
+ if (pro == IPV4)
+ {
+ switch (action)
+ {
+ case MULTICAST_NODE: *p++ = 0x01; *p++ = 0x00; *p++ = 0x5e; *p++ = 0x00; *p++ = 0x00; *p = 0x01; break;
+ case MULTICAST_ROUTER: *p++ = 0x01; *p++ = 0x00; *p++ = 0x5e; *p++ = 0x00; *p++ = 0x00; *p = 0x02; break;
+ case MULTICAST_MDNS: *p++ = 0x01; *p++ = 0x00; *p++ = 0x5e; *p++ = 0x00; *p++ = 0x00; *p = 0xfb; break;
+ case MULTICAST_LLMNR: *p++ = 0x01; *p++ = 0x00; *p++ = 0x5e; *p++ = 0x00; *p++ = 0x00; *p = 0xfc; break;
+ }
+ }
+ else
+ {
+ switch (action)
+ {
+ case MULTICAST_NODE: *p++ = 0x33; *p++ = 0x33; *p++ = 0x00; *p++ = 0x00; *p++ = 0x00; *p = 0x01; break;
+ case MULTICAST_ROUTER: *p++ = 0x33; *p++ = 0x33; *p++ = 0x00; *p++ = 0x00; *p++ = 0x00; *p = 0x02; break;
+ case MULTICAST_MDNS: *p++ = 0x33; *p++ = 0x33; *p++ = 0x00; *p++ = 0x00; *p++ = 0x00; *p = 0xfb; break;
+ case MULTICAST_LLMNR: *p++ = 0x33; *p++ = 0x33; *p++ = 0x00; *p++ = 0x01; *p++ = 0x00; *p = 0x03; break;
+ }
+ }
}
-void MacMakeMulticastLlmnr4(char* p)
-{
- *p++ = 0x01;
- *p++ = 0x00;
- *p++ = 0x5e;
- *p++ = 0x00;
- *p++ = 0x00;
- *p = 0xfc;
-}
-void MacMakeMulticastLlmnr6(char* p)
-{
- *p++ = 0x33;
- *p++ = 0x33;
- *p++ = 0x00;
- *p++ = 0x01;
- *p++ = 0x00;
- *p = 0x03;
-}
-void MacMakeBroadcast(char* p)
-{
- memset(p, 0xFF, 6);
-}