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
udp/udp.cpp@29:39277bf2003d, 2017-08-07 (annotated)
- Committer:
- andrewboyson
- Date:
- Mon Aug 07 12:13:52 2017 +0000
- Revision:
- 29:39277bf2003d
- Parent:
- 22:914b970356f0
- Child:
- 33:714a0345e59b
Split Neighbour Discovery Protocol (ndp) module into Router Advertisement (ra) and Neighour Solicitation (ns) modules.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
andrewboyson | 10:f0854784e960 | 1 | #include "mbed.h" |
andrewboyson | 10:f0854784e960 | 2 | #include "log.h" |
andrewboyson | 10:f0854784e960 | 3 | #include "net.h" |
andrewboyson | 10:f0854784e960 | 4 | #include "udp.h" |
andrewboyson | 10:f0854784e960 | 5 | #include "ntp.h" |
andrewboyson | 10:f0854784e960 | 6 | #include "dhcp.h" |
andrewboyson | 10:f0854784e960 | 7 | #include "dns.h" |
andrewboyson | 15:6ca6778168b1 | 8 | #include "eth.h" |
andrewboyson | 10:f0854784e960 | 9 | #include "ip4.h" |
andrewboyson | 10:f0854784e960 | 10 | #include "ip6.h" |
andrewboyson | 10:f0854784e960 | 11 | #include "slaac.h" |
andrewboyson | 29:39277bf2003d | 12 | #include "ns.h" |
andrewboyson | 13:9cd54f7db57a | 13 | #include "io.h" |
andrewboyson | 10:f0854784e960 | 14 | |
andrewboyson | 15:6ca6778168b1 | 15 | #define UNKNOWN true |
andrewboyson | 10:f0854784e960 | 16 | |
andrewboyson | 10:f0854784e960 | 17 | #define HEADER_SIZE 8 |
andrewboyson | 10:f0854784e960 | 18 | __packed struct header |
andrewboyson | 10:f0854784e960 | 19 | { |
andrewboyson | 10:f0854784e960 | 20 | uint16_t srcPort; |
andrewboyson | 10:f0854784e960 | 21 | uint16_t dstPort; |
andrewboyson | 10:f0854784e960 | 22 | uint16_t totalLength; |
andrewboyson | 10:f0854784e960 | 23 | uint16_t checksum; |
andrewboyson | 10:f0854784e960 | 24 | }; |
andrewboyson | 14:e75a59c1123d | 25 | uint16_t UdpSrcPort; |
andrewboyson | 14:e75a59c1123d | 26 | uint16_t UdpDstPort; |
andrewboyson | 10:f0854784e960 | 27 | static uint16_t checksum; |
andrewboyson | 10:f0854784e960 | 28 | static uint16_t totalLength; |
andrewboyson | 10:f0854784e960 | 29 | |
andrewboyson | 10:f0854784e960 | 30 | static int handlePort(int* pDataLength, void* pData) |
andrewboyson | 10:f0854784e960 | 31 | { |
andrewboyson | 14:e75a59c1123d | 32 | switch (UdpDstPort) |
andrewboyson | 10:f0854784e960 | 33 | { |
andrewboyson | 10:f0854784e960 | 34 | //Handle these |
andrewboyson | 13:9cd54f7db57a | 35 | case DHCP_CLIENT_PORT: return DhcpHandleResponse ( pDataLength, pData); // 68 |
andrewboyson | 22:914b970356f0 | 36 | case NTP_PORT: return NtpHandlePacketReceived( pDataLength, pData); // 123 |
andrewboyson | 14:e75a59c1123d | 37 | case DNS_UNICAST_CLIENT_PORT: return DnsHandlePacketReceived(DNS_PROTOCOL_UDNS, pDataLength, pData); //53053 |
andrewboyson | 14:e75a59c1123d | 38 | case DNS_MDNS_PORT: return DnsHandlePacketReceived(DNS_PROTOCOL_MDNS, pDataLength, pData); // 5353 |
andrewboyson | 15:6ca6778168b1 | 39 | case DNS_LLMNR_CLIENT_PORT: return DnsHandlePacketReceived(DNS_PROTOCOL_LLMNR, pDataLength, pData); //53055 |
andrewboyson | 15:6ca6778168b1 | 40 | case DNS_LLMNR_SERVER_PORT: return DnsHandlePacketReceived(DNS_PROTOCOL_LLMNR, pDataLength, pData); // 5355 |
andrewboyson | 10:f0854784e960 | 41 | |
andrewboyson | 10:f0854784e960 | 42 | //Quietly drop these |
andrewboyson | 10:f0854784e960 | 43 | case DHCP_SERVER_PORT: //67 |
andrewboyson | 15:6ca6778168b1 | 44 | case 137: //NETBIOS name service |
andrewboyson | 15:6ca6778168b1 | 45 | case 138: //NETBIOS datagram service |
andrewboyson | 15:6ca6778168b1 | 46 | case 139: //NETBIOS session service |
andrewboyson | 10:f0854784e960 | 47 | case 1900: //SSDP Simple Service Discovery Protocol (uPnP) |
andrewboyson | 10:f0854784e960 | 48 | case 3076: //Call of Duty - Xbox |
andrewboyson | 15:6ca6778168b1 | 49 | case 9956: //Alljoyn part af Allseen IoT services |
andrewboyson | 10:f0854784e960 | 50 | case 9997: //VLC |
andrewboyson | 10:f0854784e960 | 51 | case 9998: //VLC |
andrewboyson | 10:f0854784e960 | 52 | case 9999: //VLC |
andrewboyson | 10:f0854784e960 | 53 | case 17500: //Dropbox LAN sync |
andrewboyson | 10:f0854784e960 | 54 | return DO_NOTHING; |
andrewboyson | 10:f0854784e960 | 55 | |
andrewboyson | 10:f0854784e960 | 56 | //Report anything else |
andrewboyson | 10:f0854784e960 | 57 | default: |
andrewboyson | 14:e75a59c1123d | 58 | if (UNKNOWN) LogTimeF("UDP unknown port %d\r\n", UdpDstPort); |
andrewboyson | 10:f0854784e960 | 59 | return DO_NOTHING; |
andrewboyson | 10:f0854784e960 | 60 | } |
andrewboyson | 10:f0854784e960 | 61 | } |
andrewboyson | 10:f0854784e960 | 62 | int UdpHandleReceivedPacket(int* pSize, void* pPacket) |
andrewboyson | 10:f0854784e960 | 63 | { |
andrewboyson | 10:f0854784e960 | 64 | void* pData = (char*)pPacket + HEADER_SIZE; |
andrewboyson | 10:f0854784e960 | 65 | int dataLength = *pSize - HEADER_SIZE; |
andrewboyson | 10:f0854784e960 | 66 | |
andrewboyson | 10:f0854784e960 | 67 | int action = handlePort(&dataLength, pData); |
andrewboyson | 10:f0854784e960 | 68 | |
andrewboyson | 10:f0854784e960 | 69 | *pSize = dataLength + HEADER_SIZE; |
andrewboyson | 10:f0854784e960 | 70 | |
andrewboyson | 14:e75a59c1123d | 71 | uint16_t tmpPort = UdpDstPort; |
andrewboyson | 14:e75a59c1123d | 72 | UdpDstPort = UdpSrcPort; |
andrewboyson | 14:e75a59c1123d | 73 | UdpSrcPort = tmpPort; |
andrewboyson | 10:f0854784e960 | 74 | |
andrewboyson | 10:f0854784e960 | 75 | return action; |
andrewboyson | 10:f0854784e960 | 76 | } |
andrewboyson | 10:f0854784e960 | 77 | static int pollForPacketToSend(int type, int* pDataLength, void* pData) |
andrewboyson | 10:f0854784e960 | 78 | { |
andrewboyson | 10:f0854784e960 | 79 | int action = 0; |
andrewboyson | 10:f0854784e960 | 80 | |
andrewboyson | 10:f0854784e960 | 81 | if (!action && type == IPV4) //DHCP only works under IPv4 |
andrewboyson | 10:f0854784e960 | 82 | { |
andrewboyson | 10:f0854784e960 | 83 | action = DhcpPollForRequestToSend(pData, pDataLength); |
andrewboyson | 10:f0854784e960 | 84 | if (action) |
andrewboyson | 10:f0854784e960 | 85 | { |
andrewboyson | 14:e75a59c1123d | 86 | UdpSrcPort = DHCP_CLIENT_PORT; |
andrewboyson | 14:e75a59c1123d | 87 | UdpDstPort = DHCP_SERVER_PORT; |
andrewboyson | 10:f0854784e960 | 88 | } |
andrewboyson | 10:f0854784e960 | 89 | } |
andrewboyson | 10:f0854784e960 | 90 | |
andrewboyson | 10:f0854784e960 | 91 | if (!action) //DNS is agnostic |
andrewboyson | 10:f0854784e960 | 92 | { |
andrewboyson | 13:9cd54f7db57a | 93 | action = DnsPollForPacketToSend(pData, pDataLength); |
andrewboyson | 10:f0854784e960 | 94 | if (action) |
andrewboyson | 10:f0854784e960 | 95 | { |
andrewboyson | 10:f0854784e960 | 96 | switch (action) |
andrewboyson | 10:f0854784e960 | 97 | { |
andrewboyson | 14:e75a59c1123d | 98 | case UNICAST_DNS: UdpSrcPort = DNS_UNICAST_CLIENT_PORT; UdpDstPort = DNS_UNICAST_SERVER_PORT; break; //53053, 53 |
andrewboyson | 14:e75a59c1123d | 99 | case MULTICAST_MDNS: UdpSrcPort = DNS_MDNS_PORT; UdpDstPort = DNS_MDNS_PORT; break; // 5353, 5353 |
andrewboyson | 14:e75a59c1123d | 100 | case MULTICAST_LLMNR: UdpSrcPort = DNS_LLMNR_CLIENT_PORT; UdpDstPort = DNS_LLMNR_SERVER_PORT; break; //53055, 5355 |
andrewboyson | 10:f0854784e960 | 101 | |
andrewboyson | 10:f0854784e960 | 102 | //Report anything else |
andrewboyson | 10:f0854784e960 | 103 | default: |
andrewboyson | 10:f0854784e960 | 104 | LogTimeF("DNS unknown action %d\r\n", action); |
andrewboyson | 10:f0854784e960 | 105 | return DO_NOTHING; |
andrewboyson | 10:f0854784e960 | 106 | } |
andrewboyson | 10:f0854784e960 | 107 | } |
andrewboyson | 10:f0854784e960 | 108 | } |
andrewboyson | 22:914b970356f0 | 109 | if (!action) //NTP needs to choose depending of what address is specified |
andrewboyson | 22:914b970356f0 | 110 | { |
andrewboyson | 22:914b970356f0 | 111 | action = NtpPollForPacketToSend(type, pData, pDataLength); |
andrewboyson | 22:914b970356f0 | 112 | if (action) |
andrewboyson | 22:914b970356f0 | 113 | { |
andrewboyson | 22:914b970356f0 | 114 | UdpSrcPort = NTP_PORT; |
andrewboyson | 22:914b970356f0 | 115 | UdpDstPort = NTP_PORT; |
andrewboyson | 22:914b970356f0 | 116 | } |
andrewboyson | 22:914b970356f0 | 117 | } |
andrewboyson | 10:f0854784e960 | 118 | return action; |
andrewboyson | 10:f0854784e960 | 119 | } |
andrewboyson | 10:f0854784e960 | 120 | int UdpPollForPacketToSend(int type, int* pSize, void* pPacket) |
andrewboyson | 10:f0854784e960 | 121 | { |
andrewboyson | 10:f0854784e960 | 122 | void* pData = (char*)pPacket + HEADER_SIZE; |
andrewboyson | 10:f0854784e960 | 123 | int dataLength = *pSize - HEADER_SIZE; |
andrewboyson | 10:f0854784e960 | 124 | |
andrewboyson | 10:f0854784e960 | 125 | int action = pollForPacketToSend(type, &dataLength, pData); |
andrewboyson | 10:f0854784e960 | 126 | |
andrewboyson | 10:f0854784e960 | 127 | *pSize = dataLength + HEADER_SIZE; |
andrewboyson | 10:f0854784e960 | 128 | return action; |
andrewboyson | 10:f0854784e960 | 129 | } |
andrewboyson | 10:f0854784e960 | 130 | |
andrewboyson | 10:f0854784e960 | 131 | void UdpLogHeader(char* title, void* pPacket, uint16_t calculatedChecksum) |
andrewboyson | 10:f0854784e960 | 132 | { |
andrewboyson | 10:f0854784e960 | 133 | LogTimeF("UDP %s\r\n", title); |
andrewboyson | 14:e75a59c1123d | 134 | LogF(" Source port %hu\r\n", UdpSrcPort); |
andrewboyson | 14:e75a59c1123d | 135 | LogF(" Destination port %hu\r\n", UdpDstPort); |
andrewboyson | 10:f0854784e960 | 136 | LogF(" Total length %hu\r\n", totalLength); |
andrewboyson | 10:f0854784e960 | 137 | LogF(" Checksum (hex) %04hX\r\n", checksum); |
andrewboyson | 10:f0854784e960 | 138 | LogF(" Calculated %04hX\r\n", calculatedChecksum); |
andrewboyson | 10:f0854784e960 | 139 | } |
andrewboyson | 10:f0854784e960 | 140 | |
andrewboyson | 10:f0854784e960 | 141 | void UdpMakeHeader(int size, void* pPacket) |
andrewboyson | 10:f0854784e960 | 142 | { |
andrewboyson | 10:f0854784e960 | 143 | struct header* pHeader = (header*)pPacket; |
andrewboyson | 10:f0854784e960 | 144 | |
andrewboyson | 14:e75a59c1123d | 145 | pHeader->dstPort = NetToHost16(UdpDstPort); |
andrewboyson | 14:e75a59c1123d | 146 | pHeader->srcPort = NetToHost16(UdpSrcPort); |
andrewboyson | 10:f0854784e960 | 147 | pHeader->totalLength = NetToHost16(size); |
andrewboyson | 10:f0854784e960 | 148 | pHeader->checksum = 0; |
andrewboyson | 10:f0854784e960 | 149 | |
andrewboyson | 10:f0854784e960 | 150 | } |
andrewboyson | 10:f0854784e960 | 151 | void UdpAddChecksum(void* pPacket, uint16_t checksum) |
andrewboyson | 10:f0854784e960 | 152 | { |
andrewboyson | 10:f0854784e960 | 153 | struct header* pHeader = (header*)pPacket; |
andrewboyson | 10:f0854784e960 | 154 | pHeader->checksum = checksum; |
andrewboyson | 10:f0854784e960 | 155 | } |
andrewboyson | 10:f0854784e960 | 156 | void UdpReadHeader(void* pPacket, uint16_t size) |
andrewboyson | 10:f0854784e960 | 157 | { |
andrewboyson | 10:f0854784e960 | 158 | struct header* pHeader = (header*)pPacket; |
andrewboyson | 10:f0854784e960 | 159 | |
andrewboyson | 14:e75a59c1123d | 160 | UdpSrcPort = NetToHost16(pHeader->srcPort); |
andrewboyson | 14:e75a59c1123d | 161 | UdpDstPort = NetToHost16(pHeader->dstPort); |
andrewboyson | 10:f0854784e960 | 162 | totalLength = NetToHost16(pHeader->totalLength); |
andrewboyson | 10:f0854784e960 | 163 | checksum = NetToHost16(pHeader->checksum); |
andrewboyson | 10:f0854784e960 | 164 | } |