Andrew Boyson / net

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependents:   oldheating gps motorhome heating

ip6/icmp/icmp6.cpp@44:83ce5ace337b, 2017-10-22 (annotated)

Committer:
andrewboyson
Date:
Sun Oct 22 17:19:17 2017 +0000
Revision:
44:83ce5ace337b
Parent:
43:bc028d5a6424
Child:
46:40d33e9037e4
Fixed DnsServer

Who changed what in which revision?

UserRevisionLine numberNew contents of line
andrewboyson 43:bc028d5a6424 1 #include "mbed.h"
andrewboyson 43:bc028d5a6424 2 #include "log.h"
andrewboyson 43:bc028d5a6424 3 #include "net.h"
andrewboyson 43:bc028d5a6424 4 #include "action.h"
andrewboyson 43:bc028d5a6424 5 #include "ns.h"
andrewboyson 43:bc028d5a6424 6 #include "ra.h"
andrewboyson 43:bc028d5a6424 7 #include "ip.h"
andrewboyson 43:bc028d5a6424 8 #include "ip6.h"
andrewboyson 43:bc028d5a6424 9 #include "slaac.h"
andrewboyson 43:bc028d5a6424 10 #include "echo6.h"
andrewboyson 43:bc028d5a6424 11
andrewboyson 43:bc028d5a6424 12 #define HEADER_LENGTH 4
andrewboyson 43:bc028d5a6424 13 __packed struct header
andrewboyson 43:bc028d5a6424 14 {
andrewboyson 43:bc028d5a6424 15 uint8_t type;
andrewboyson 43:bc028d5a6424 16 uint8_t code;
andrewboyson 43:bc028d5a6424 17 uint16_t checksum;
andrewboyson 43:bc028d5a6424 18 };
andrewboyson 43:bc028d5a6424 19 static uint8_t type;
andrewboyson 43:bc028d5a6424 20 static uint8_t code;
andrewboyson 43:bc028d5a6424 21 static uint16_t checksum;
andrewboyson 43:bc028d5a6424 22 static uint16_t calculatedChecksum;
andrewboyson 43:bc028d5a6424 23 static int dataLength;
andrewboyson 43:bc028d5a6424 24 static void* pData;
andrewboyson 43:bc028d5a6424 25
andrewboyson 43:bc028d5a6424 26 static void typeToString(uint8_t type, int size, char* text)
andrewboyson 43:bc028d5a6424 27 {
andrewboyson 43:bc028d5a6424 28 switch (type)
andrewboyson 43:bc028d5a6424 29 {
andrewboyson 43:bc028d5a6424 30 case 128: strncpy (text, "Echo Request" , size); break;
andrewboyson 43:bc028d5a6424 31 case 129: strncpy (text, "Echo Reply" , size); break;
andrewboyson 43:bc028d5a6424 32 case 133: strncpy (text, "Router solicit" , size); break;
andrewboyson 43:bc028d5a6424 33 case 134: strncpy (text, "Router advertisement" , size); break;
andrewboyson 43:bc028d5a6424 34 case 135: strncpy (text, "Neighbour solicit" , size); break;
andrewboyson 43:bc028d5a6424 35 case 136: strncpy (text, "Neighbour advertisement", size); break;
andrewboyson 43:bc028d5a6424 36 case 137: strncpy (text, "Redirect" , size); break;
andrewboyson 43:bc028d5a6424 37 default: snprintf(text, size, "unknown type %u", type); break;
andrewboyson 43:bc028d5a6424 38 }
andrewboyson 43:bc028d5a6424 39 }
andrewboyson 43:bc028d5a6424 40 static uint16_t calculateChecksum(char* pSrcIp, char* pDstIp, int size, void* pPacket)
andrewboyson 43:bc028d5a6424 41 {
andrewboyson 43:bc028d5a6424 42 __packed struct pseudo
andrewboyson 43:bc028d5a6424 43 {
andrewboyson 43:bc028d5a6424 44 char src[16];
andrewboyson 43:bc028d5a6424 45 char dst[16];
andrewboyson 43:bc028d5a6424 46 uint32_t len;
andrewboyson 43:bc028d5a6424 47 uint8_t zer[3];
andrewboyson 43:bc028d5a6424 48 uint8_t pro;
andrewboyson 43:bc028d5a6424 49 } pseudo;
andrewboyson 43:bc028d5a6424 50
andrewboyson 43:bc028d5a6424 51 Ip6Copy(pseudo.src, pSrcIp);
andrewboyson 43:bc028d5a6424 52 Ip6Copy(pseudo.dst, pDstIp);
andrewboyson 43:bc028d5a6424 53 pseudo.len = NetToHost32(size);
andrewboyson 43:bc028d5a6424 54 pseudo.zer[0] = 0;
andrewboyson 43:bc028d5a6424 55 pseudo.zer[1] = 0;
andrewboyson 43:bc028d5a6424 56 pseudo.zer[2] = 0;
andrewboyson 43:bc028d5a6424 57 pseudo.pro = ICMP6;
andrewboyson 43:bc028d5a6424 58
andrewboyson 43:bc028d5a6424 59 return NetCheckSumTwo(sizeof(pseudo), &pseudo, size, pPacket);
andrewboyson 43:bc028d5a6424 60 }
andrewboyson 43:bc028d5a6424 61 static void logHeader()
andrewboyson 43:bc028d5a6424 62 {
andrewboyson 43:bc028d5a6424 63 char text[100];
andrewboyson 43:bc028d5a6424 64 if (NetTraceVerbose)
andrewboyson 43:bc028d5a6424 65 {
andrewboyson 43:bc028d5a6424 66 Log ("ICMP6 header\r\n");
andrewboyson 43:bc028d5a6424 67 typeToString(type, sizeof(text), text);
andrewboyson 43:bc028d5a6424 68 LogF(" Type %s\r\n", text);
andrewboyson 43:bc028d5a6424 69 LogF(" Code %u\r\n", code);
andrewboyson 43:bc028d5a6424 70 LogF(" Checksum (hex) %04hX\r\n", checksum);
andrewboyson 43:bc028d5a6424 71 LogF(" Calculated %04hX\r\n", calculatedChecksum);
andrewboyson 43:bc028d5a6424 72 LogF(" Data length %d\r\n", dataLength);
andrewboyson 43:bc028d5a6424 73 }
andrewboyson 43:bc028d5a6424 74 else
andrewboyson 43:bc028d5a6424 75 {
andrewboyson 43:bc028d5a6424 76 Log ("ICMP6 header ");
andrewboyson 43:bc028d5a6424 77 typeToString(type, sizeof(text), text);
andrewboyson 43:bc028d5a6424 78 Log(text);
andrewboyson 43:bc028d5a6424 79 Log("\r\n");
andrewboyson 43:bc028d5a6424 80 }
andrewboyson 43:bc028d5a6424 81 }
andrewboyson 43:bc028d5a6424 82 static void readHeader(char* pSrcIp, char* pDstIp, void* pPacket, int size)
andrewboyson 43:bc028d5a6424 83 {
andrewboyson 43:bc028d5a6424 84 struct header* pHeader = (header*)pPacket;
andrewboyson 43:bc028d5a6424 85 type = pHeader->type;
andrewboyson 43:bc028d5a6424 86 code = pHeader->code;
andrewboyson 43:bc028d5a6424 87 checksum = NetToHost16(pHeader->checksum);
andrewboyson 43:bc028d5a6424 88 calculatedChecksum = calculateChecksum(pSrcIp, pDstIp, size, pPacket);
andrewboyson 43:bc028d5a6424 89 pData = (char*)pPacket + HEADER_LENGTH;
andrewboyson 43:bc028d5a6424 90 dataLength = size - HEADER_LENGTH;
andrewboyson 43:bc028d5a6424 91 }
andrewboyson 43:bc028d5a6424 92 static void writeHeader(void* pPacket, int size, char* pSrcIp, char* pDstIp)
andrewboyson 43:bc028d5a6424 93 {
andrewboyson 43:bc028d5a6424 94 struct header* pHeader = (header*)pPacket;
andrewboyson 43:bc028d5a6424 95 pHeader->type = type;
andrewboyson 43:bc028d5a6424 96 pHeader->code = code;
andrewboyson 43:bc028d5a6424 97 pHeader->checksum = 0;
andrewboyson 43:bc028d5a6424 98 pHeader->checksum = calculateChecksum(pSrcIp, pDstIp, size, pPacket);
andrewboyson 43:bc028d5a6424 99 calculatedChecksum = 0;
andrewboyson 43:bc028d5a6424 100 }
andrewboyson 43:bc028d5a6424 101 static void (*pTraceBack)(void);
andrewboyson 43:bc028d5a6424 102 static void trace()
andrewboyson 43:bc028d5a6424 103 {
andrewboyson 43:bc028d5a6424 104 pTraceBack();
andrewboyson 43:bc028d5a6424 105 logHeader();
andrewboyson 43:bc028d5a6424 106 }
andrewboyson 44:83ce5ace337b 107 int Icmp6HandleReceivedPacket(void (*traceback)(void), int scope, char* pSrcIp, char* pDstIp, int* pSize, void* pPacket)
andrewboyson 43:bc028d5a6424 108 {
andrewboyson 43:bc028d5a6424 109 pTraceBack = traceback;
andrewboyson 43:bc028d5a6424 110
andrewboyson 43:bc028d5a6424 111 readHeader(pSrcIp, pDstIp, pPacket, *pSize);
andrewboyson 43:bc028d5a6424 112
andrewboyson 43:bc028d5a6424 113 int action = DO_NOTHING;
andrewboyson 43:bc028d5a6424 114 switch (type)
andrewboyson 43:bc028d5a6424 115 {
andrewboyson 43:bc028d5a6424 116 case 128: //Echo request - Ping
andrewboyson 43:bc028d5a6424 117 action = Echo6HandleRequest(trace, &type, &code);
andrewboyson 43:bc028d5a6424 118 break;
andrewboyson 43:bc028d5a6424 119 case 133: //Router solicit
andrewboyson 43:bc028d5a6424 120 return DO_NOTHING; //We are not a router so quietly drop this
andrewboyson 43:bc028d5a6424 121 case 134: //Router advertisement
andrewboyson 43:bc028d5a6424 122 action = RaHandleReceivedAdvertisement(trace, pData, &dataLength);
andrewboyson 43:bc028d5a6424 123 break;
andrewboyson 43:bc028d5a6424 124 case 135: //Neighbour solicit
andrewboyson 43:bc028d5a6424 125 action = NsHandleReceivedSolicitation(trace, pData, &dataLength, &type, &code);
andrewboyson 43:bc028d5a6424 126 break;
andrewboyson 43:bc028d5a6424 127 case 136: //Neighbour advertisement
andrewboyson 43:bc028d5a6424 128 action = NsHandleReceivedAdvertisement(trace, pData, &dataLength);
andrewboyson 43:bc028d5a6424 129 break;
andrewboyson 43:bc028d5a6424 130 default:
andrewboyson 43:bc028d5a6424 131 LogTimeF("ICMP6 unknown packet type %d", type);
andrewboyson 43:bc028d5a6424 132 return DO_NOTHING;
andrewboyson 43:bc028d5a6424 133 }
andrewboyson 43:bc028d5a6424 134 if (!action) return DO_NOTHING;
andrewboyson 43:bc028d5a6424 135
andrewboyson 43:bc028d5a6424 136 Ip6Copy(pDstIp, pSrcIp);
andrewboyson 44:83ce5ace337b 137 Ip6SrcIpFromScope(scope, pSrcIp);
andrewboyson 44:83ce5ace337b 138 Ip6DstIpFromDest(ActionGetDestPart(action), pDstIp);
andrewboyson 43:bc028d5a6424 139
andrewboyson 43:bc028d5a6424 140 *pSize = HEADER_LENGTH + dataLength;
andrewboyson 43:bc028d5a6424 141
andrewboyson 43:bc028d5a6424 142 writeHeader(pPacket, *pSize, pSrcIp, pDstIp);
andrewboyson 43:bc028d5a6424 143
andrewboyson 43:bc028d5a6424 144 if (ActionGetTracePart(action)) logHeader();
andrewboyson 43:bc028d5a6424 145
andrewboyson 43:bc028d5a6424 146 return action;
andrewboyson 43:bc028d5a6424 147 }
andrewboyson 43:bc028d5a6424 148 int Icmp6PollForPacketToSend(void* pPacket, int* pSize, char* pSrcIp, char* pDstIp)
andrewboyson 43:bc028d5a6424 149 {
andrewboyson 43:bc028d5a6424 150 pData = (char*)pPacket + HEADER_LENGTH;
andrewboyson 43:bc028d5a6424 151 int action = DO_NOTHING;
andrewboyson 43:bc028d5a6424 152 if (!action) action = RaGetWaitingSolicitation(pData, &dataLength, &type, &code);
andrewboyson 43:bc028d5a6424 153 if (!action) action = NsGetWaitingSolicitation(pData, &dataLength, &type, &code);
andrewboyson 43:bc028d5a6424 154 if (!action) return DO_NOTHING;
andrewboyson 43:bc028d5a6424 155
andrewboyson 44:83ce5ace337b 156 int scope = SCOPE_LOCAL;
andrewboyson 44:83ce5ace337b 157 Ip6SrcIpFromScope(scope, pSrcIp);
andrewboyson 44:83ce5ace337b 158 Ip6DstIpFromDest(ActionGetDestPart(action), pDstIp);
andrewboyson 43:bc028d5a6424 159
andrewboyson 43:bc028d5a6424 160 *pSize = HEADER_LENGTH + dataLength;
andrewboyson 43:bc028d5a6424 161
andrewboyson 43:bc028d5a6424 162 writeHeader(pPacket, *pSize, pSrcIp, pDstIp);
andrewboyson 43:bc028d5a6424 163
andrewboyson 43:bc028d5a6424 164 if (ActionGetTracePart(action)) logHeader();
andrewboyson 43:bc028d5a6424 165
andrewboyson 43:bc028d5a6424 166 return action;
andrewboyson 43:bc028d5a6424 167
andrewboyson 43:bc028d5a6424 168 }