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
ip6/ip6.cpp@30:e34173b7585c, 2017-08-10 (annotated)
- Committer:
- andrewboyson
- Date:
- Thu Aug 10 17:45:37 2017 +0000
- Revision:
- 30:e34173b7585c
- Parent:
- 29:39277bf2003d
- Child:
- 34:e3a7bff69bfc
Added dns address request - only name requests was there before.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
andrewboyson | 30:e34173b7585c | 1 | #include "mbed.h" |
andrewboyson | 30:e34173b7585c | 2 | #include "log.h" |
andrewboyson | 30:e34173b7585c | 3 | #include "net.h" |
andrewboyson | 30:e34173b7585c | 4 | #include "icmp6.h" |
andrewboyson | 30:e34173b7585c | 5 | #include "udptcp6.h" |
andrewboyson | 30:e34173b7585c | 6 | #include "ar.h" |
andrewboyson | 30:e34173b7585c | 7 | #include "dnscache.h" |
andrewboyson | 30:e34173b7585c | 8 | #include "slaac.h" |
andrewboyson | 30:e34173b7585c | 9 | #include "eth.h" |
andrewboyson | 30:e34173b7585c | 10 | #include "ip.h" |
andrewboyson | 30:e34173b7585c | 11 | #include "ip6.h" |
andrewboyson | 30:e34173b7585c | 12 | #include "ra.h" |
andrewboyson | 30:e34173b7585c | 13 | #include "io.h" |
andrewboyson | 11:c051adb70c5a | 14 | |
andrewboyson | 11:c051adb70c5a | 15 | #define DEBUG false |
andrewboyson | 11:c051adb70c5a | 16 | |
andrewboyson | 14:e75a59c1123d | 17 | |
andrewboyson | 14:e75a59c1123d | 18 | static void addHexNibble(bool* pAdded, int number, int index, char** pp) |
andrewboyson | 14:e75a59c1123d | 19 | { |
andrewboyson | 14:e75a59c1123d | 20 | int nibble = number; |
andrewboyson | 14:e75a59c1123d | 21 | if (index) nibble >>= 4; |
andrewboyson | 14:e75a59c1123d | 22 | nibble &= 0xF; |
andrewboyson | 14:e75a59c1123d | 23 | |
andrewboyson | 14:e75a59c1123d | 24 | if (nibble || *pAdded) |
andrewboyson | 14:e75a59c1123d | 25 | { |
andrewboyson | 14:e75a59c1123d | 26 | **pp = nibble < 10 ? nibble + '0' : nibble - 10 + 'a'; |
andrewboyson | 14:e75a59c1123d | 27 | *pp += 1; |
andrewboyson | 14:e75a59c1123d | 28 | *pAdded = true; |
andrewboyson | 14:e75a59c1123d | 29 | } |
andrewboyson | 14:e75a59c1123d | 30 | } |
andrewboyson | 14:e75a59c1123d | 31 | int Ip6AddressToString(char* pIp, int size, char* pText) |
andrewboyson | 14:e75a59c1123d | 32 | { |
andrewboyson | 14:e75a59c1123d | 33 | char* pIpE = pIp + 16; |
andrewboyson | 14:e75a59c1123d | 34 | char* p = pText; |
andrewboyson | 14:e75a59c1123d | 35 | while (true) |
andrewboyson | 14:e75a59c1123d | 36 | { |
andrewboyson | 14:e75a59c1123d | 37 | bool added = false; |
andrewboyson | 14:e75a59c1123d | 38 | if (*pIp || *(pIp + 1)) |
andrewboyson | 14:e75a59c1123d | 39 | { |
andrewboyson | 14:e75a59c1123d | 40 | if (p > pText + size - 2) break; addHexNibble(&added, *(pIp + 0), 1, &p); |
andrewboyson | 14:e75a59c1123d | 41 | if (p > pText + size - 2) break; addHexNibble(&added, *(pIp + 0), 0, &p); |
andrewboyson | 14:e75a59c1123d | 42 | if (p > pText + size - 2) break; addHexNibble(&added, *(pIp + 1), 1, &p); |
andrewboyson | 14:e75a59c1123d | 43 | if (p > pText + size - 2) break; addHexNibble(&added, *(pIp + 1), 0, &p); |
andrewboyson | 14:e75a59c1123d | 44 | } |
andrewboyson | 14:e75a59c1123d | 45 | |
andrewboyson | 14:e75a59c1123d | 46 | pIp += 2; |
andrewboyson | 14:e75a59c1123d | 47 | if (pIp >= pIpE) break; |
andrewboyson | 14:e75a59c1123d | 48 | |
andrewboyson | 14:e75a59c1123d | 49 | if (p > pText + size - 2) break; *p++ = ':'; |
andrewboyson | 14:e75a59c1123d | 50 | } |
andrewboyson | 14:e75a59c1123d | 51 | *p = 0; |
andrewboyson | 14:e75a59c1123d | 52 | return p - pText; |
andrewboyson | 14:e75a59c1123d | 53 | } |
andrewboyson | 14:e75a59c1123d | 54 | |
andrewboyson | 11:c051adb70c5a | 55 | char Ip6AllNodes [] = {0xff, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01}; |
andrewboyson | 11:c051adb70c5a | 56 | char Ip6AllRouters[] = {0xff, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02}; |
andrewboyson | 11:c051adb70c5a | 57 | char Ip6Mdns [] = {0xff, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfb}; |
andrewboyson | 11:c051adb70c5a | 58 | char Ip6Llmnr [] = {0xff, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x03}; |
andrewboyson | 11:c051adb70c5a | 59 | |
andrewboyson | 11:c051adb70c5a | 60 | void Ip6DestIpFromAction(int action, char* pDstIp) |
andrewboyson | 11:c051adb70c5a | 61 | { |
andrewboyson | 11:c051adb70c5a | 62 | switch (action) |
andrewboyson | 11:c051adb70c5a | 63 | { |
andrewboyson | 11:c051adb70c5a | 64 | case UNICAST: break; |
andrewboyson | 29:39277bf2003d | 65 | case UNICAST_DNS: memcpy(pDstIp, RaDnsServer, 16); break; |
andrewboyson | 11:c051adb70c5a | 66 | case MULTICAST_NODE: memcpy(pDstIp, Ip6AllNodes, 16); break; |
andrewboyson | 11:c051adb70c5a | 67 | case MULTICAST_ROUTER: memcpy(pDstIp, Ip6AllRouters, 16); break; |
andrewboyson | 11:c051adb70c5a | 68 | case MULTICAST_MDNS: memcpy(pDstIp, Ip6Mdns, 16); break; |
andrewboyson | 11:c051adb70c5a | 69 | case MULTICAST_LLMNR: memcpy(pDstIp, Ip6Llmnr, 16); break; |
andrewboyson | 11:c051adb70c5a | 70 | default: |
andrewboyson | 11:c051adb70c5a | 71 | LogTimeF("Ip6 DestIpFromAction unknown action %d\r\n", action); |
andrewboyson | 11:c051adb70c5a | 72 | break; |
andrewboyson | 11:c051adb70c5a | 73 | } |
andrewboyson | 11:c051adb70c5a | 74 | } |
andrewboyson | 10:f0854784e960 | 75 | |
andrewboyson | 10:f0854784e960 | 76 | #define HEADER_LENGTH 40 |
andrewboyson | 10:f0854784e960 | 77 | __packed struct header |
andrewboyson | 10:f0854784e960 | 78 | { |
andrewboyson | 10:f0854784e960 | 79 | uint32_t versionTrafficFlow; |
andrewboyson | 10:f0854784e960 | 80 | uint16_t dataLength; |
andrewboyson | 10:f0854784e960 | 81 | uint8_t protocol; |
andrewboyson | 10:f0854784e960 | 82 | uint8_t hoplimit; |
andrewboyson | 10:f0854784e960 | 83 | char src[16]; |
andrewboyson | 10:f0854784e960 | 84 | char dst[16]; |
andrewboyson | 10:f0854784e960 | 85 | }; |
andrewboyson | 11:c051adb70c5a | 86 | |
andrewboyson | 11:c051adb70c5a | 87 | static uint8_t version; |
andrewboyson | 11:c051adb70c5a | 88 | static int dataLength; |
andrewboyson | 11:c051adb70c5a | 89 | static uint8_t protocol; |
andrewboyson | 11:c051adb70c5a | 90 | static uint8_t hoplimit; |
andrewboyson | 14:e75a59c1123d | 91 | char Ip6Src[16]; |
andrewboyson | 14:e75a59c1123d | 92 | char Ip6Dst[16]; |
andrewboyson | 11:c051adb70c5a | 93 | static void* pData; |
andrewboyson | 11:c051adb70c5a | 94 | |
andrewboyson | 11:c051adb70c5a | 95 | static void readHeader(struct header * pHeader) |
andrewboyson | 11:c051adb70c5a | 96 | { |
andrewboyson | 11:c051adb70c5a | 97 | version = (pHeader->versionTrafficFlow >> 4) & 0xF; |
andrewboyson | 11:c051adb70c5a | 98 | dataLength = NetToHost16(pHeader->dataLength); |
andrewboyson | 11:c051adb70c5a | 99 | protocol = pHeader->protocol; |
andrewboyson | 11:c051adb70c5a | 100 | hoplimit = pHeader->hoplimit; |
andrewboyson | 14:e75a59c1123d | 101 | memcpy(Ip6Src, pHeader->src, 16); |
andrewboyson | 14:e75a59c1123d | 102 | memcpy(Ip6Dst, pHeader->dst, 16); |
andrewboyson | 11:c051adb70c5a | 103 | pData = (char*)pHeader + HEADER_LENGTH; |
andrewboyson | 11:c051adb70c5a | 104 | } |
andrewboyson | 11:c051adb70c5a | 105 | static void writeHeader(struct header * pHeader) |
andrewboyson | 11:c051adb70c5a | 106 | { |
andrewboyson | 11:c051adb70c5a | 107 | pHeader->versionTrafficFlow = version << 4; |
andrewboyson | 11:c051adb70c5a | 108 | pHeader->protocol = protocol; |
andrewboyson | 11:c051adb70c5a | 109 | pHeader->hoplimit = 255; |
andrewboyson | 14:e75a59c1123d | 110 | memcpy(pHeader->dst, Ip6Dst, 16); |
andrewboyson | 14:e75a59c1123d | 111 | memcpy(pHeader->src, Ip6Src, 16); |
andrewboyson | 11:c051adb70c5a | 112 | pHeader->dataLength = NetToHost16(dataLength); |
andrewboyson | 11:c051adb70c5a | 113 | } |
andrewboyson | 11:c051adb70c5a | 114 | |
andrewboyson | 11:c051adb70c5a | 115 | static void logHeader(char* title) |
andrewboyson | 11:c051adb70c5a | 116 | { |
andrewboyson | 11:c051adb70c5a | 117 | char text[100]; |
andrewboyson | 11:c051adb70c5a | 118 | LogTimeF("%s\r\n", title); |
andrewboyson | 11:c051adb70c5a | 119 | LogF(" Version %d\r\n", version); |
andrewboyson | 11:c051adb70c5a | 120 | LogF(" Payload length %d\r\n", dataLength); |
andrewboyson | 11:c051adb70c5a | 121 | LogF(" Hop limit %d\r\n", hoplimit); |
andrewboyson | 14:e75a59c1123d | 122 | IpProtocolToString(protocol, sizeof(text), text); |
andrewboyson | 11:c051adb70c5a | 123 | LogF(" Protocol %s\r\n", text); |
andrewboyson | 14:e75a59c1123d | 124 | Ip6AddressToString(Ip6Src, sizeof(text), text); |
andrewboyson | 11:c051adb70c5a | 125 | LogF(" Source IP %s\r\n", text); |
andrewboyson | 14:e75a59c1123d | 126 | Ip6AddressToString(Ip6Dst, sizeof(text), text); |
andrewboyson | 11:c051adb70c5a | 127 | LogF(" Destination IP %s\r\n", text); |
andrewboyson | 11:c051adb70c5a | 128 | } |
andrewboyson | 11:c051adb70c5a | 129 | |
andrewboyson | 10:f0854784e960 | 130 | static bool getIsSolicited(char* p) |
andrewboyson | 10:f0854784e960 | 131 | { |
andrewboyson | 10:f0854784e960 | 132 | if (*p++ != 0xff) return false; |
andrewboyson | 10:f0854784e960 | 133 | if (*p++ != 0x02) return false; |
andrewboyson | 10:f0854784e960 | 134 | |
andrewboyson | 10:f0854784e960 | 135 | if (*p++ != 0x00) return false; |
andrewboyson | 10:f0854784e960 | 136 | if (*p++ != 0x00) return false; |
andrewboyson | 10:f0854784e960 | 137 | |
andrewboyson | 10:f0854784e960 | 138 | if (*p++ != 0x00) return false; |
andrewboyson | 10:f0854784e960 | 139 | if (*p++ != 0x00) return false; |
andrewboyson | 10:f0854784e960 | 140 | |
andrewboyson | 10:f0854784e960 | 141 | if (*p++ != 0x00) return false; |
andrewboyson | 10:f0854784e960 | 142 | if (*p++ != 0x00) return false; |
andrewboyson | 10:f0854784e960 | 143 | |
andrewboyson | 10:f0854784e960 | 144 | if (*p++ != 0x00) return false; |
andrewboyson | 10:f0854784e960 | 145 | if (*p++ != 0x00) return false; |
andrewboyson | 10:f0854784e960 | 146 | |
andrewboyson | 10:f0854784e960 | 147 | if (*p++ != 0x00) return false; |
andrewboyson | 10:f0854784e960 | 148 | if (*p++ != 0x01) return false; |
andrewboyson | 10:f0854784e960 | 149 | |
andrewboyson | 10:f0854784e960 | 150 | if (*p++ != 0xff) return false; |
andrewboyson | 10:f0854784e960 | 151 | |
andrewboyson | 10:f0854784e960 | 152 | return true; |
andrewboyson | 10:f0854784e960 | 153 | } |
andrewboyson | 10:f0854784e960 | 154 | static bool getIsSame(char* pA, char* pB) |
andrewboyson | 10:f0854784e960 | 155 | { |
andrewboyson | 10:f0854784e960 | 156 | return memcmp(pA, pB, 16) == 0; |
andrewboyson | 10:f0854784e960 | 157 | } |
andrewboyson | 10:f0854784e960 | 158 | static bool getIsSameGroup(char* pA, char* pB) |
andrewboyson | 10:f0854784e960 | 159 | { |
andrewboyson | 10:f0854784e960 | 160 | pA += 13; |
andrewboyson | 10:f0854784e960 | 161 | pB += 13; |
andrewboyson | 10:f0854784e960 | 162 | if (*pA++ != *pB++) return false; |
andrewboyson | 10:f0854784e960 | 163 | if (*pA++ != *pB++) return false; |
andrewboyson | 10:f0854784e960 | 164 | return *pA == *pB; |
andrewboyson | 10:f0854784e960 | 165 | } |
andrewboyson | 10:f0854784e960 | 166 | int Ip6HandleReceivedPacket(char* pSrcMac, void* pPacket, int* pSize, char* pDstMac) |
andrewboyson | 10:f0854784e960 | 167 | { |
andrewboyson | 10:f0854784e960 | 168 | struct header * pHeader = (header*)pPacket; |
andrewboyson | 11:c051adb70c5a | 169 | readHeader(pHeader); |
andrewboyson | 10:f0854784e960 | 170 | |
andrewboyson | 15:6ca6778168b1 | 171 | bool isMe = getIsSame(Ip6Dst, SlaacLinkLocalIp) || getIsSame(Ip6Dst, SlaacGlobalIp); |
andrewboyson | 14:e75a59c1123d | 172 | bool isMulticast = Ip6Dst[0] == 0xFF; |
andrewboyson | 14:e75a59c1123d | 173 | bool isSolicited = getIsSolicited(Ip6Dst); |
andrewboyson | 14:e75a59c1123d | 174 | bool isGroup = isSolicited && getIsSameGroup(Ip6Dst, SlaacLinkLocalIp); |
andrewboyson | 10:f0854784e960 | 175 | |
andrewboyson | 10:f0854784e960 | 176 | bool doIt = isMe || (isMulticast && !isSolicited) || isGroup; |
andrewboyson | 10:f0854784e960 | 177 | |
andrewboyson | 14:e75a59c1123d | 178 | if (!doIt) |
andrewboyson | 14:e75a59c1123d | 179 | { |
andrewboyson | 15:6ca6778168b1 | 180 | if (DEBUG) |
andrewboyson | 15:6ca6778168b1 | 181 | { |
andrewboyson | 15:6ca6778168b1 | 182 | char text[100]; |
andrewboyson | 15:6ca6778168b1 | 183 | Ip6AddressToString(Ip6Dst, sizeof(text), text); |
andrewboyson | 15:6ca6778168b1 | 184 | LogTimeF("IP6 filtered out ip %s ", text); |
andrewboyson | 15:6ca6778168b1 | 185 | Ip6AddressToString(Ip6Src, sizeof(text), text); |
andrewboyson | 15:6ca6778168b1 | 186 | LogF("from %s \r\n", text); |
andrewboyson | 15:6ca6778168b1 | 187 | } |
andrewboyson | 14:e75a59c1123d | 188 | return DO_NOTHING; |
andrewboyson | 14:e75a59c1123d | 189 | } |
andrewboyson | 10:f0854784e960 | 190 | |
andrewboyson | 14:e75a59c1123d | 191 | ArAdd6(pSrcMac, Ip6Src); |
andrewboyson | 30:e34173b7585c | 192 | DnsCacheMakeRequestForNameFromIp6(Ip6Src); |
andrewboyson | 11:c051adb70c5a | 193 | |
andrewboyson | 11:c051adb70c5a | 194 | if (DEBUG) logHeader("IP6 packet received"); |
andrewboyson | 11:c051adb70c5a | 195 | |
andrewboyson | 10:f0854784e960 | 196 | int action = DO_NOTHING; |
andrewboyson | 10:f0854784e960 | 197 | switch (protocol) |
andrewboyson | 10:f0854784e960 | 198 | { |
andrewboyson | 30:e34173b7585c | 199 | case HOPOPT: action = DO_NOTHING; break; |
andrewboyson | 14:e75a59c1123d | 200 | case ICMP6: action = Icmp6HandleReceivedPacket(Ip6Src, Ip6Dst, &dataLength, pData); break; |
andrewboyson | 14:e75a59c1123d | 201 | case UDP: action = Udp6HandleReceivedPacket(Ip6Src, Ip6Dst, &dataLength, pData); break; |
andrewboyson | 14:e75a59c1123d | 202 | case TCP: action = Tcp6HandleReceivedPacket(Ip6Src, Ip6Dst, &dataLength, pData); break; |
andrewboyson | 10:f0854784e960 | 203 | default: |
andrewboyson | 11:c051adb70c5a | 204 | logHeader("IP6 packet unhandled"); |
andrewboyson | 10:f0854784e960 | 205 | return DO_NOTHING; |
andrewboyson | 10:f0854784e960 | 206 | } |
andrewboyson | 11:c051adb70c5a | 207 | if (!action) return DO_NOTHING; |
andrewboyson | 11:c051adb70c5a | 208 | |
andrewboyson | 11:c051adb70c5a | 209 | memcpy(pDstMac, pSrcMac, 6); |
andrewboyson | 11:c051adb70c5a | 210 | |
andrewboyson | 11:c051adb70c5a | 211 | if (DEBUG) logHeader("IP6 packet replied to"); |
andrewboyson | 10:f0854784e960 | 212 | |
andrewboyson | 11:c051adb70c5a | 213 | writeHeader(pHeader); |
andrewboyson | 11:c051adb70c5a | 214 | |
andrewboyson | 10:f0854784e960 | 215 | *pSize = HEADER_LENGTH + dataLength; |
andrewboyson | 10:f0854784e960 | 216 | |
andrewboyson | 10:f0854784e960 | 217 | return action; |
andrewboyson | 10:f0854784e960 | 218 | } |
andrewboyson | 10:f0854784e960 | 219 | int Ip6PollForPacketToSend(void* pPacket, int* pSize, char* pDstMac) |
andrewboyson | 10:f0854784e960 | 220 | { |
andrewboyson | 11:c051adb70c5a | 221 | pData = (char*)pPacket + HEADER_LENGTH; |
andrewboyson | 11:c051adb70c5a | 222 | dataLength = 0; |
andrewboyson | 11:c051adb70c5a | 223 | version = 6; |
andrewboyson | 11:c051adb70c5a | 224 | hoplimit = 255; |
andrewboyson | 10:f0854784e960 | 225 | |
andrewboyson | 10:f0854784e960 | 226 | int action = DO_NOTHING; |
andrewboyson | 10:f0854784e960 | 227 | if (action == DO_NOTHING) |
andrewboyson | 10:f0854784e960 | 228 | { |
andrewboyson | 14:e75a59c1123d | 229 | action = Icmp6PollForPacketToSend(pData, &dataLength, Ip6Src, Ip6Dst); |
andrewboyson | 10:f0854784e960 | 230 | protocol = ICMP6; |
andrewboyson | 10:f0854784e960 | 231 | } |
andrewboyson | 10:f0854784e960 | 232 | |
andrewboyson | 10:f0854784e960 | 233 | if (action == DO_NOTHING) |
andrewboyson | 10:f0854784e960 | 234 | { |
andrewboyson | 14:e75a59c1123d | 235 | action = Udp6PollForPacketToSend(pData, &dataLength, Ip6Src, Ip6Dst); |
andrewboyson | 10:f0854784e960 | 236 | protocol = UDP; |
andrewboyson | 10:f0854784e960 | 237 | } |
andrewboyson | 11:c051adb70c5a | 238 | if (!action) return DO_NOTHING; |
andrewboyson | 11:c051adb70c5a | 239 | switch (action) |
andrewboyson | 11:c051adb70c5a | 240 | { |
andrewboyson | 11:c051adb70c5a | 241 | case UNICAST: |
andrewboyson | 11:c051adb70c5a | 242 | case UNICAST_DNS: |
andrewboyson | 11:c051adb70c5a | 243 | case UNICAST_DHCP: |
andrewboyson | 22:914b970356f0 | 244 | case UNICAST_NTP: |
andrewboyson | 14:e75a59c1123d | 245 | ArRev6(Ip6Dst, pDstMac); //Make the remote MAC from NP |
andrewboyson | 11:c051adb70c5a | 246 | break; |
andrewboyson | 22:914b970356f0 | 247 | case MULTICAST_NODE: |
andrewboyson | 22:914b970356f0 | 248 | case MULTICAST_ROUTER: |
andrewboyson | 22:914b970356f0 | 249 | case MULTICAST_MDNS: |
andrewboyson | 22:914b970356f0 | 250 | case MULTICAST_LLMNR: |
andrewboyson | 22:914b970356f0 | 251 | case SOLICITED_NODE: |
andrewboyson | 22:914b970356f0 | 252 | break; |
andrewboyson | 22:914b970356f0 | 253 | default: |
andrewboyson | 22:914b970356f0 | 254 | LogTimeF("Ip6PollForPacketToSend - undefined action %d\r\n", action); |
andrewboyson | 22:914b970356f0 | 255 | break; |
andrewboyson | 22:914b970356f0 | 256 | |
andrewboyson | 11:c051adb70c5a | 257 | } |
andrewboyson | 11:c051adb70c5a | 258 | |
andrewboyson | 11:c051adb70c5a | 259 | if (DEBUG) logHeader("IP6 polled packet sent"); |
andrewboyson | 10:f0854784e960 | 260 | |
andrewboyson | 11:c051adb70c5a | 261 | writeHeader((header*)pPacket); |
andrewboyson | 11:c051adb70c5a | 262 | |
andrewboyson | 10:f0854784e960 | 263 | *pSize = HEADER_LENGTH + dataLength; |
andrewboyson | 10:f0854784e960 | 264 | |
andrewboyson | 10:f0854784e960 | 265 | return action; |
andrewboyson | 10:f0854784e960 | 266 | } |