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.c@113:904b40231907, 2019-01-22 (annotated)

Committer:
andrewboyson
Date:
Tue Jan 22 15:41:12 2019 +0000
Revision:
113:904b40231907
Parent:
112:f8694d0b8858
Child:
115:5c003909bcf3
Incorporated ntp server module

Who changed what in which revision?

UserRevisionLine numberNew contents of line
andrewboyson 61:aad055f1b0d1 1 #include <stdint.h>
andrewboyson 61:aad055f1b0d1 2 #include <stdbool.h>
andrewboyson 61:aad055f1b0d1 3
andrewboyson 59:e0e556c8bd46 4 #include "link.h"
andrewboyson 7:b794780e33b4 5 #include "net.h"
andrewboyson 52:fbc5a46b5e16 6 #include "tcb.h"
andrewboyson 7:b794780e33b4 7 #include "dhcp.h"
andrewboyson 48:952dddb74b8b 8 #include "ar4.h"
andrewboyson 48:952dddb74b8b 9 #include "ar6.h"
andrewboyson 50:492f2d2954e4 10 #include "nr4.h"
andrewboyson 50:492f2d2954e4 11 #include "nr6.h"
andrewboyson 7:b794780e33b4 12 #include "dns.h"
andrewboyson 7:b794780e33b4 13 #include "slaac.h"
andrewboyson 47:73af5c0b0dc2 14 #include "ndp.h"
andrewboyson 22:914b970356f0 15 #include "ntp.h"
andrewboyson 113:904b40231907 16
andrewboyson 57:e0fb648acf48 17 #include "tftp.h"
andrewboyson 83:08c983006a6e 18 #include "led.h"
andrewboyson 97:d91f7db00235 19 #include "fault.h"
andrewboyson 37:793b39683406 20
andrewboyson 43:bc028d5a6424 21 bool NetTraceStack = false;
andrewboyson 43:bc028d5a6424 22 bool NetTraceNewLine = false;
andrewboyson 43:bc028d5a6424 23 bool NetTraceVerbose = false;
andrewboyson 59:e0e556c8bd46 24 const char* NetName4;
andrewboyson 59:e0e556c8bd46 25 const char* NetName6;
andrewboyson 57:e0fb648acf48 26
andrewboyson 57:e0fb648acf48 27 static bool hostMatched = false;
andrewboyson 57:e0fb648acf48 28 bool NetTraceHostGetMatched()
andrewboyson 57:e0fb648acf48 29 {
andrewboyson 57:e0fb648acf48 30 return hostMatched;
andrewboyson 57:e0fb648acf48 31 }
andrewboyson 57:e0fb648acf48 32 void NetTraceHostResetMatched()
andrewboyson 57:e0fb648acf48 33 {
andrewboyson 57:e0fb648acf48 34 hostMatched = false;
andrewboyson 57:e0fb648acf48 35 }
andrewboyson 59:e0e556c8bd46 36 char NetTraceHost[2];
andrewboyson 57:e0fb648acf48 37 void NetTraceHostCheckIp6(char* ip)
andrewboyson 57:e0fb648acf48 38 {
andrewboyson 57:e0fb648acf48 39 if (!ip[0]) return;
andrewboyson 57:e0fb648acf48 40 if (NetTraceHost[0] != ip[14]) return;
andrewboyson 57:e0fb648acf48 41 if (NetTraceHost[1] != ip[15]) return;
andrewboyson 57:e0fb648acf48 42 hostMatched = true;
andrewboyson 57:e0fb648acf48 43 }
andrewboyson 57:e0fb648acf48 44 void NetTraceHostCheckMac(char* mac)
andrewboyson 57:e0fb648acf48 45 {
andrewboyson 57:e0fb648acf48 46 if (NetTraceHost[0] != mac[4]) return;
andrewboyson 57:e0fb648acf48 47 if (NetTraceHost[1] != mac[5]) return;
andrewboyson 57:e0fb648acf48 48 hostMatched = true;
andrewboyson 57:e0fb648acf48 49 }
andrewboyson 0:faa09bd4e6bf 50 int16_t NetToHost16(int16_t n)
andrewboyson 0:faa09bd4e6bf 51 {
andrewboyson 0:faa09bd4e6bf 52 int16_t h;
andrewboyson 0:faa09bd4e6bf 53
andrewboyson 0:faa09bd4e6bf 54 char* pn = (char*)&n;
andrewboyson 0:faa09bd4e6bf 55 char* ph = (char*)&h + 1;
andrewboyson 0:faa09bd4e6bf 56
andrewboyson 0:faa09bd4e6bf 57 *ph = *pn; ph--; pn++; // 1<-0
andrewboyson 0:faa09bd4e6bf 58 *ph = *pn; // 0<-1
andrewboyson 0:faa09bd4e6bf 59
andrewboyson 0:faa09bd4e6bf 60 return h;
andrewboyson 0:faa09bd4e6bf 61 }
andrewboyson 0:faa09bd4e6bf 62
andrewboyson 0:faa09bd4e6bf 63 int32_t NetToHost32(int32_t n)
andrewboyson 0:faa09bd4e6bf 64 {
andrewboyson 0:faa09bd4e6bf 65 int32_t h;
andrewboyson 0:faa09bd4e6bf 66
andrewboyson 0:faa09bd4e6bf 67 char* pn = (char*)&n;
andrewboyson 0:faa09bd4e6bf 68 char* ph = (char*)&h + 3;
andrewboyson 0:faa09bd4e6bf 69
andrewboyson 0:faa09bd4e6bf 70 *ph = *pn; ph--; pn++; // 3<-0
andrewboyson 0:faa09bd4e6bf 71 *ph = *pn; ph--; pn++; // 2<-1
andrewboyson 0:faa09bd4e6bf 72 *ph = *pn; ph--; pn++; // 1<-2
andrewboyson 0:faa09bd4e6bf 73 *ph = *pn; // 0<-3
andrewboyson 0:faa09bd4e6bf 74
andrewboyson 0:faa09bd4e6bf 75 return h;
andrewboyson 0:faa09bd4e6bf 76 }
andrewboyson 0:faa09bd4e6bf 77 int64_t NetToHost64(int64_t n)
andrewboyson 0:faa09bd4e6bf 78 {
andrewboyson 0:faa09bd4e6bf 79 int64_t h;
andrewboyson 0:faa09bd4e6bf 80
andrewboyson 0:faa09bd4e6bf 81 char* pn = (char*)&n;
andrewboyson 0:faa09bd4e6bf 82 char* ph = (char*)&h + 7;
andrewboyson 0:faa09bd4e6bf 83
andrewboyson 0:faa09bd4e6bf 84 *ph = *pn; ph--; pn++; // 7<-0
andrewboyson 0:faa09bd4e6bf 85 *ph = *pn; ph--; pn++; // 6<-1
andrewboyson 0:faa09bd4e6bf 86 *ph = *pn; ph--; pn++; // 5<-2
andrewboyson 0:faa09bd4e6bf 87 *ph = *pn; ph--; pn++; // 4<-3
andrewboyson 0:faa09bd4e6bf 88 *ph = *pn; ph--; pn++; // 3<-4
andrewboyson 0:faa09bd4e6bf 89 *ph = *pn; ph--; pn++; // 2<-5
andrewboyson 0:faa09bd4e6bf 90 *ph = *pn; ph--; pn++; // 1<-6
andrewboyson 0:faa09bd4e6bf 91 *ph = *pn; // 0<-7
andrewboyson 0:faa09bd4e6bf 92
andrewboyson 0:faa09bd4e6bf 93 return h;
andrewboyson 0:faa09bd4e6bf 94 }
andrewboyson 0:faa09bd4e6bf 95 uint16_t onesComplement(uint16_t start, int count, void* pData)
andrewboyson 0:faa09bd4e6bf 96 {
andrewboyson 0:faa09bd4e6bf 97 uint32_t sum = start; //Initialise the 32 bit accumulator with the last sum
andrewboyson 0:faa09bd4e6bf 98 uint16_t* p = (uint16_t*)pData; //Set up a 16 bit pointer for the data
andrewboyson 0:faa09bd4e6bf 99
andrewboyson 0:faa09bd4e6bf 100 while(count > 1)
andrewboyson 0:faa09bd4e6bf 101 {
andrewboyson 0:faa09bd4e6bf 102 sum += *p++; // Add each pair of bytes into 32 bit accumulator
andrewboyson 0:faa09bd4e6bf 103 count -= 2;
andrewboyson 0:faa09bd4e6bf 104 }
andrewboyson 0:faa09bd4e6bf 105 if(count) sum += * (uint8_t*) p; // Add left-over byte, if any
andrewboyson 0:faa09bd4e6bf 106 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 107 return sum;
andrewboyson 0:faa09bd4e6bf 108 }
andrewboyson 0:faa09bd4e6bf 109 uint16_t NetCheckSumTwo(int count1, void* pData1, int count2, void* pData2)
andrewboyson 0:faa09bd4e6bf 110 {
andrewboyson 0:faa09bd4e6bf 111 uint16_t sum = onesComplement(0, count1, pData1);
andrewboyson 0:faa09bd4e6bf 112 return ~onesComplement(sum, count2, pData2);
andrewboyson 0:faa09bd4e6bf 113 }
andrewboyson 0:faa09bd4e6bf 114 uint16_t NetCheckSum(int count, void* pData)
andrewboyson 0:faa09bd4e6bf 115 {
andrewboyson 0:faa09bd4e6bf 116 return ~onesComplement(0, count, pData);
andrewboyson 0:faa09bd4e6bf 117 }
andrewboyson 2:849103b5a16d 118
andrewboyson 61:aad055f1b0d1 119 void NetInit(const char* name4, const char* name6)
andrewboyson 59:e0e556c8bd46 120 {
andrewboyson 44:83ce5ace337b 121 NetName4 = name4;
andrewboyson 44:83ce5ace337b 122 NetName6 = name6;
andrewboyson 59:e0e556c8bd46 123 LinkInit();
andrewboyson 52:fbc5a46b5e16 124 TcbInit();
andrewboyson 48:952dddb74b8b 125 Ar4Init();
andrewboyson 48:952dddb74b8b 126 Ar6Init();
andrewboyson 50:492f2d2954e4 127 Nr4Init();
andrewboyson 50:492f2d2954e4 128 Nr6Init();
andrewboyson 30:e34173b7585c 129 SlaacInit();
andrewboyson 113:904b40231907 130 NtpInit();
andrewboyson 2:849103b5a16d 131 }
andrewboyson 61:aad055f1b0d1 132 void NetMain()
andrewboyson 2:849103b5a16d 133 {
andrewboyson 98:b977424ec7f7 134 int lastFaultPoint = FaultPoint;
andrewboyson 97:d91f7db00235 135 FaultPoint = FAULT_POINT_NetMain;
andrewboyson 112:f8694d0b8858 136 LinkMain();
andrewboyson 112:f8694d0b8858 137 Ar4Main();
andrewboyson 112:f8694d0b8858 138 Ar6Main();
andrewboyson 112:f8694d0b8858 139 Nr4Main();
andrewboyson 112:f8694d0b8858 140 Nr6Main();
andrewboyson 112:f8694d0b8858 141 DnsMain();
andrewboyson 112:f8694d0b8858 142 NdpMain();
andrewboyson 112:f8694d0b8858 143 TftpMain();
andrewboyson 98:b977424ec7f7 144 FaultPoint = lastFaultPoint;
andrewboyson 2:849103b5a16d 145 }