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?
User | Revision | Line number | New 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 | } |