Andrew Boyson / net

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

net.cpp@7:b794780e33b4, 2017-03-12 (annotated)

Committer:
andrewboyson
Date:
Sun Mar 12 13:56:08 2017 +0000
Revision:
7:b794780e33b4
Parent:
5:5fc4ca9fbf17
Child:
9:91dae5300a4d
Added IPv6 support which is partially working

Who changed what in which revision?

UserRevisionLine numberNew contents of line
andrewboyson 7:b794780e33b4 1 #include "mbed.h"
andrewboyson 7:b794780e33b4 2 #include "phy.h"
andrewboyson 7:b794780e33b4 3 #include "net.h"
andrewboyson 7:b794780e33b4 4 #include "tcp.h"
andrewboyson 7:b794780e33b4 5 #include "dhcp.h"
andrewboyson 7:b794780e33b4 6 #include "arp.h"
andrewboyson 7:b794780e33b4 7 #include "dns.h"
andrewboyson 7:b794780e33b4 8 #include "slaac.h"
andrewboyson 2:849103b5a16d 9
andrewboyson 7:b794780e33b4 10 static void addHexNibble(bool* pAdded, int number, int index, char** pp)
andrewboyson 7:b794780e33b4 11 {
andrewboyson 7:b794780e33b4 12 int nibble = number;
andrewboyson 7:b794780e33b4 13 if (index) nibble >>= 4;
andrewboyson 7:b794780e33b4 14 nibble &= 0xF;
andrewboyson 7:b794780e33b4 15
andrewboyson 7:b794780e33b4 16 if (nibble || *pAdded)
andrewboyson 7:b794780e33b4 17 {
andrewboyson 7:b794780e33b4 18 **pp = nibble < 10 ? nibble + '0' : nibble - 10 + 'a';
andrewboyson 7:b794780e33b4 19 *pp += 1;
andrewboyson 7:b794780e33b4 20 *pAdded = true;
andrewboyson 7:b794780e33b4 21 }
andrewboyson 7:b794780e33b4 22 }
andrewboyson 7:b794780e33b4 23 int NetIp6AddressToString(char* pIp, int size, char* pText)
andrewboyson 7:b794780e33b4 24 {
andrewboyson 7:b794780e33b4 25 char* pIpE = pIp + 16;
andrewboyson 7:b794780e33b4 26 char* p = pText;
andrewboyson 7:b794780e33b4 27 while (true)
andrewboyson 7:b794780e33b4 28 {
andrewboyson 7:b794780e33b4 29 bool added = false;
andrewboyson 7:b794780e33b4 30 if (*pIp || *(pIp + 1))
andrewboyson 7:b794780e33b4 31 {
andrewboyson 7:b794780e33b4 32 if (p > pText + size - 2) break; addHexNibble(&added, *(pIp + 0), 1, &p);
andrewboyson 7:b794780e33b4 33 if (p > pText + size - 2) break; addHexNibble(&added, *(pIp + 0), 0, &p);
andrewboyson 7:b794780e33b4 34 if (p > pText + size - 2) break; addHexNibble(&added, *(pIp + 1), 1, &p);
andrewboyson 7:b794780e33b4 35 if (p > pText + size - 2) break; addHexNibble(&added, *(pIp + 1), 0, &p);
andrewboyson 7:b794780e33b4 36 }
andrewboyson 7:b794780e33b4 37
andrewboyson 7:b794780e33b4 38 pIp += 2;
andrewboyson 7:b794780e33b4 39 if (pIp >= pIpE) break;
andrewboyson 7:b794780e33b4 40
andrewboyson 7:b794780e33b4 41 if (p > pText + size - 2) break; *p++ = ':';
andrewboyson 7:b794780e33b4 42 }
andrewboyson 7:b794780e33b4 43 *p = 0;
andrewboyson 7:b794780e33b4 44 return p - pText;
andrewboyson 7:b794780e33b4 45 }
andrewboyson 7:b794780e33b4 46 int NetIp4AddressToString(uint32_t ip, int size, char* text)
andrewboyson 2:849103b5a16d 47 {
andrewboyson 2:849103b5a16d 48 int a0 = (ip & 0xFF000000) >> 24;
andrewboyson 2:849103b5a16d 49 int a1 = (ip & 0x00FF0000) >> 16;
andrewboyson 2:849103b5a16d 50 int a2 = (ip & 0x0000FF00) >> 8;
andrewboyson 2:849103b5a16d 51 int a3 = (ip & 0x000000FF);
andrewboyson 7:b794780e33b4 52 return snprintf(text, size, "%d.%d.%d.%d", a3, a2, a1, a0);
andrewboyson 7:b794780e33b4 53 }
andrewboyson 7:b794780e33b4 54 int NetMacToString(char* mac, int size, char* text)
andrewboyson 7:b794780e33b4 55 {
andrewboyson 7:b794780e33b4 56 return snprintf(text, size, "%02X:%02X:%02X:%02X:%02X:%02X", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
andrewboyson 2:849103b5a16d 57 }
andrewboyson 7:b794780e33b4 58 void NetProtocolToString(uint16_t protocol, int size, char* text)
andrewboyson 2:849103b5a16d 59 {
andrewboyson 7:b794780e33b4 60 switch (protocol)
andrewboyson 7:b794780e33b4 61 {
andrewboyson 7:b794780e33b4 62 case ICMP6_PROTOCOL: strncpy (text, "ICMP6", size); break;
andrewboyson 7:b794780e33b4 63 case TCP_PROTOCOL: strncpy (text, "TCP" , size); break;
andrewboyson 7:b794780e33b4 64 case UDP_PROTOCOL: strncpy (text, "UDP" , size); break;
andrewboyson 7:b794780e33b4 65 default: snprintf(text, size, "%d", protocol); break;
andrewboyson 7:b794780e33b4 66 }
andrewboyson 2:849103b5a16d 67 }
andrewboyson 0:faa09bd4e6bf 68
andrewboyson 0:faa09bd4e6bf 69 int16_t NetToHost16(int16_t n)
andrewboyson 0:faa09bd4e6bf 70 {
andrewboyson 0:faa09bd4e6bf 71 int16_t h;
andrewboyson 0:faa09bd4e6bf 72
andrewboyson 0:faa09bd4e6bf 73 char* pn = (char*)&n;
andrewboyson 0:faa09bd4e6bf 74 char* ph = (char*)&h + 1;
andrewboyson 0:faa09bd4e6bf 75
andrewboyson 0:faa09bd4e6bf 76 *ph = *pn; ph--; pn++; // 1<-0
andrewboyson 0:faa09bd4e6bf 77 *ph = *pn; // 0<-1
andrewboyson 0:faa09bd4e6bf 78
andrewboyson 0:faa09bd4e6bf 79 return h;
andrewboyson 0:faa09bd4e6bf 80 }
andrewboyson 0:faa09bd4e6bf 81
andrewboyson 0:faa09bd4e6bf 82 int32_t NetToHost32(int32_t n)
andrewboyson 0:faa09bd4e6bf 83 {
andrewboyson 0:faa09bd4e6bf 84 int32_t h;
andrewboyson 0:faa09bd4e6bf 85
andrewboyson 0:faa09bd4e6bf 86 char* pn = (char*)&n;
andrewboyson 0:faa09bd4e6bf 87 char* ph = (char*)&h + 3;
andrewboyson 0:faa09bd4e6bf 88
andrewboyson 0:faa09bd4e6bf 89 *ph = *pn; ph--; pn++; // 3<-0
andrewboyson 0:faa09bd4e6bf 90 *ph = *pn; ph--; pn++; // 2<-1
andrewboyson 0:faa09bd4e6bf 91 *ph = *pn; ph--; pn++; // 1<-2
andrewboyson 0:faa09bd4e6bf 92 *ph = *pn; // 0<-3
andrewboyson 0:faa09bd4e6bf 93
andrewboyson 0:faa09bd4e6bf 94 return h;
andrewboyson 0:faa09bd4e6bf 95 }
andrewboyson 0:faa09bd4e6bf 96 int64_t NetToHost64(int64_t n)
andrewboyson 0:faa09bd4e6bf 97 {
andrewboyson 0:faa09bd4e6bf 98 int64_t h;
andrewboyson 0:faa09bd4e6bf 99
andrewboyson 0:faa09bd4e6bf 100 char* pn = (char*)&n;
andrewboyson 0:faa09bd4e6bf 101 char* ph = (char*)&h + 7;
andrewboyson 0:faa09bd4e6bf 102
andrewboyson 0:faa09bd4e6bf 103 *ph = *pn; ph--; pn++; // 7<-0
andrewboyson 0:faa09bd4e6bf 104 *ph = *pn; ph--; pn++; // 6<-1
andrewboyson 0:faa09bd4e6bf 105 *ph = *pn; ph--; pn++; // 5<-2
andrewboyson 0:faa09bd4e6bf 106 *ph = *pn; ph--; pn++; // 4<-3
andrewboyson 0:faa09bd4e6bf 107 *ph = *pn; ph--; pn++; // 3<-4
andrewboyson 0:faa09bd4e6bf 108 *ph = *pn; ph--; pn++; // 2<-5
andrewboyson 0:faa09bd4e6bf 109 *ph = *pn; ph--; pn++; // 1<-6
andrewboyson 0:faa09bd4e6bf 110 *ph = *pn; // 0<-7
andrewboyson 0:faa09bd4e6bf 111
andrewboyson 0:faa09bd4e6bf 112 return h;
andrewboyson 0:faa09bd4e6bf 113 }
andrewboyson 0:faa09bd4e6bf 114 uint16_t onesComplement(uint16_t start, int count, void* pData)
andrewboyson 0:faa09bd4e6bf 115 {
andrewboyson 0:faa09bd4e6bf 116 uint32_t sum = start; //Initialise the 32 bit accumulator with the last sum
andrewboyson 0:faa09bd4e6bf 117 uint16_t* p = (uint16_t*)pData; //Set up a 16 bit pointer for the data
andrewboyson 0:faa09bd4e6bf 118
andrewboyson 0:faa09bd4e6bf 119 while(count > 1)
andrewboyson 0:faa09bd4e6bf 120 {
andrewboyson 0:faa09bd4e6bf 121 sum += *p++; // Add each pair of bytes into 32 bit accumulator
andrewboyson 0:faa09bd4e6bf 122 count -= 2;
andrewboyson 0:faa09bd4e6bf 123 }
andrewboyson 0:faa09bd4e6bf 124 if(count) sum += * (uint8_t*) p; // Add left-over byte, if any
andrewboyson 0:faa09bd4e6bf 125 while (sum>>16) sum = (sum & 0xffff) + (sum >> 16); // Add any carries from the sum back into the sum to make it ones complement
andrewboyson 0:faa09bd4e6bf 126 return sum;
andrewboyson 0:faa09bd4e6bf 127 }
andrewboyson 0:faa09bd4e6bf 128 uint16_t NetCheckSumTwo(int count1, void* pData1, int count2, void* pData2)
andrewboyson 0:faa09bd4e6bf 129 {
andrewboyson 0:faa09bd4e6bf 130 uint16_t sum = onesComplement(0, count1, pData1);
andrewboyson 0:faa09bd4e6bf 131 return ~onesComplement(sum, count2, pData2);
andrewboyson 0:faa09bd4e6bf 132 }
andrewboyson 0:faa09bd4e6bf 133 uint16_t NetCheckSum(int count, void* pData)
andrewboyson 0:faa09bd4e6bf 134 {
andrewboyson 0:faa09bd4e6bf 135 return ~onesComplement(0, count, pData);
andrewboyson 0:faa09bd4e6bf 136 }
andrewboyson 2:849103b5a16d 137
andrewboyson 2:849103b5a16d 138 static bool ticked()
andrewboyson 2:849103b5a16d 139 {
andrewboyson 2:849103b5a16d 140 static time_t lastT = 0;
andrewboyson 2:849103b5a16d 141 time_t thisT = time(NULL);
andrewboyson 2:849103b5a16d 142 bool oneshot = lastT != thisT;
andrewboyson 2:849103b5a16d 143 lastT = thisT;
andrewboyson 2:849103b5a16d 144 return oneshot;
andrewboyson 2:849103b5a16d 145 }
andrewboyson 2:849103b5a16d 146
andrewboyson 2:849103b5a16d 147 int NetInit()
andrewboyson 2:849103b5a16d 148 {
andrewboyson 2:849103b5a16d 149 PhyInit();
andrewboyson 2:849103b5a16d 150 TcpInit();
andrewboyson 2:849103b5a16d 151 ArpInit();
andrewboyson 7:b794780e33b4 152 SlaacInit();
andrewboyson 2:849103b5a16d 153 return 0;
andrewboyson 2:849103b5a16d 154 }
andrewboyson 2:849103b5a16d 155 int NetMain()
andrewboyson 2:849103b5a16d 156 {
andrewboyson 2:849103b5a16d 157 PhyMain();
andrewboyson 5:5fc4ca9fbf17 158 ArpMain();
andrewboyson 2:849103b5a16d 159 if (ticked())
andrewboyson 2:849103b5a16d 160 {
andrewboyson 2:849103b5a16d 161 DhcpTick();
andrewboyson 2:849103b5a16d 162 ArpTick();
andrewboyson 7:b794780e33b4 163 DnsTick();
andrewboyson 2:849103b5a16d 164 }
andrewboyson 2:849103b5a16d 165 return 0;
andrewboyson 2:849103b5a16d 166 }