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
ip4/udptcp4.c@94:e2973a2c488e, 2018-12-05 (annotated)
- Committer:
- andrewboyson
- Date:
- Wed Dec 05 18:30:37 2018 +0000
- Revision:
- 94:e2973a2c488e
- Parent:
- 88:1ba13e6062a3
- Child:
- 96:43eb7a110f1a
Fixed bug - incorrect MSS being sent from a polled sync: expected 1440 but had -60. Traced to buffer datalength in EthPollForPacketToSend being set to zero instead of being calculated from the buffer length - headersize.
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 | |
andrewboyson | 37:793b39683406 | 3 | #include "log.h" |
andrewboyson | 37:793b39683406 | 4 | #include "net.h" |
andrewboyson | 37:793b39683406 | 5 | #include "action.h" |
andrewboyson | 37:793b39683406 | 6 | #include "dhcp.h" |
andrewboyson | 37:793b39683406 | 7 | #include "eth.h" |
andrewboyson | 37:793b39683406 | 8 | #include "ip.h" |
andrewboyson | 49:1a6336f2b3f9 | 9 | #include "ip4addr.h" |
andrewboyson | 74:c3756bfa960e | 10 | #include "tcp.h" |
andrewboyson | 74:c3756bfa960e | 11 | #include "tcprecv.h" |
andrewboyson | 74:c3756bfa960e | 12 | #include "tcpsend.h" |
andrewboyson | 74:c3756bfa960e | 13 | #include "tcphdr.h" |
andrewboyson | 74:c3756bfa960e | 14 | #include "udp.h" |
andrewboyson | 86:55bc5ddac16c | 15 | #include "ar4.h" |
andrewboyson | 86:55bc5ddac16c | 16 | #include "led.h" |
andrewboyson | 10:f0854784e960 | 17 | |
andrewboyson | 10:f0854784e960 | 18 | static uint16_t calculateChecksum(uint8_t pro, uint32_t srcIp, uint32_t dstIp, int size, void* pPacket) |
andrewboyson | 10:f0854784e960 | 19 | { |
andrewboyson | 10:f0854784e960 | 20 | __packed struct pseudo |
andrewboyson | 10:f0854784e960 | 21 | { |
andrewboyson | 10:f0854784e960 | 22 | uint32_t src; |
andrewboyson | 10:f0854784e960 | 23 | uint32_t dst; |
andrewboyson | 10:f0854784e960 | 24 | uint8_t zer; |
andrewboyson | 10:f0854784e960 | 25 | uint8_t pro; |
andrewboyson | 10:f0854784e960 | 26 | uint16_t len; |
andrewboyson | 10:f0854784e960 | 27 | } pseudo; |
andrewboyson | 10:f0854784e960 | 28 | |
andrewboyson | 10:f0854784e960 | 29 | pseudo.src = srcIp; |
andrewboyson | 10:f0854784e960 | 30 | pseudo.dst = dstIp; |
andrewboyson | 10:f0854784e960 | 31 | pseudo.zer = 0; |
andrewboyson | 10:f0854784e960 | 32 | pseudo.pro = pro; |
andrewboyson | 10:f0854784e960 | 33 | pseudo.len = NetToHost16(size); |
andrewboyson | 10:f0854784e960 | 34 | |
andrewboyson | 10:f0854784e960 | 35 | return NetCheckSumTwo(sizeof(pseudo), &pseudo, size, pPacket); |
andrewboyson | 10:f0854784e960 | 36 | } |
andrewboyson | 10:f0854784e960 | 37 | static void finalisePacket(uint8_t pro, int action, void* pPacket, int size, uint32_t* pSrcIp, uint32_t* pDstIp) |
andrewboyson | 10:f0854784e960 | 38 | { |
andrewboyson | 10:f0854784e960 | 39 | if (!action) return; |
andrewboyson | 10:f0854784e960 | 40 | |
andrewboyson | 49:1a6336f2b3f9 | 41 | Ip4AddressFromDest(ActionGetDestPart(action), pDstIp); |
andrewboyson | 10:f0854784e960 | 42 | *pSrcIp = DhcpLocalIp; |
andrewboyson | 10:f0854784e960 | 43 | |
andrewboyson | 10:f0854784e960 | 44 | switch (pro) |
andrewboyson | 10:f0854784e960 | 45 | { |
andrewboyson | 74:c3756bfa960e | 46 | case TCP: TcpHdrWriteToPacket(pPacket); break; |
andrewboyson | 10:f0854784e960 | 47 | case UDP: UdpMakeHeader(size, pPacket); break; |
andrewboyson | 10:f0854784e960 | 48 | } |
andrewboyson | 10:f0854784e960 | 49 | |
andrewboyson | 10:f0854784e960 | 50 | uint16_t checksum = calculateChecksum(pro, *pSrcIp, *pDstIp, size, pPacket); |
andrewboyson | 10:f0854784e960 | 51 | |
andrewboyson | 10:f0854784e960 | 52 | switch (pro) |
andrewboyson | 10:f0854784e960 | 53 | { |
andrewboyson | 74:c3756bfa960e | 54 | case TCP: TcpHdrAddChecksumToPacket(pPacket, checksum); break; |
andrewboyson | 10:f0854784e960 | 55 | case UDP: UdpAddChecksum(pPacket, checksum); break; |
andrewboyson | 10:f0854784e960 | 56 | } |
andrewboyson | 10:f0854784e960 | 57 | |
andrewboyson | 37:793b39683406 | 58 | if (ActionGetTracePart(action)) |
andrewboyson | 11:c051adb70c5a | 59 | { |
andrewboyson | 37:793b39683406 | 60 | switch (pro) |
andrewboyson | 37:793b39683406 | 61 | { |
andrewboyson | 73:43e3d7fb3d60 | 62 | case TCP: TcpHdrLog(0); break; |
andrewboyson | 56:35117a8b5c65 | 63 | case UDP: UdpLogHeader(0); break; |
andrewboyson | 37:793b39683406 | 64 | } |
andrewboyson | 11:c051adb70c5a | 65 | } |
andrewboyson | 10:f0854784e960 | 66 | } |
andrewboyson | 10:f0854784e960 | 67 | |
andrewboyson | 37:793b39683406 | 68 | static void (*pTraceBack)(void); |
andrewboyson | 37:793b39683406 | 69 | static int tracePacketProtocol; |
andrewboyson | 37:793b39683406 | 70 | static uint16_t calculatedChecksum; |
andrewboyson | 37:793b39683406 | 71 | static void trace() |
andrewboyson | 37:793b39683406 | 72 | { |
andrewboyson | 37:793b39683406 | 73 | pTraceBack(); |
andrewboyson | 37:793b39683406 | 74 | switch(tracePacketProtocol) |
andrewboyson | 37:793b39683406 | 75 | { |
andrewboyson | 56:35117a8b5c65 | 76 | case UDP: UdpLogHeader(calculatedChecksum); break; |
andrewboyson | 73:43e3d7fb3d60 | 77 | case TCP: TcpHdrLog(calculatedChecksum); break; |
andrewboyson | 37:793b39683406 | 78 | default: LogTimeF("UdpTcp4 - traceback unrecognised protocol %d\r\n", tracePacketProtocol); break; |
andrewboyson | 37:793b39683406 | 79 | } |
andrewboyson | 37:793b39683406 | 80 | } |
andrewboyson | 74:c3756bfa960e | 81 | int Tcp4HandleReceivedPacket(void (*traceback)(void), void* pPacketRx, int sizeRx, void* pPacketTx, int* pSizeTx, uint32_t* pSrcIp, uint32_t* pDstIp, int remArIndex) |
andrewboyson | 10:f0854784e960 | 82 | { |
andrewboyson | 88:1ba13e6062a3 | 83 | Led3Set(true); |
andrewboyson | 37:793b39683406 | 84 | pTraceBack = traceback; |
andrewboyson | 37:793b39683406 | 85 | tracePacketProtocol = TCP; |
andrewboyson | 59:e0e556c8bd46 | 86 | calculatedChecksum = calculateChecksum(TCP, *pSrcIp, *pDstIp, sizeRx, pPacketRx); |
andrewboyson | 10:f0854784e960 | 87 | |
andrewboyson | 80:4ef1500fca1d | 88 | int action = TcpHandleReceivedPacket(trace, sizeRx, pPacketRx, pSizeTx, pPacketTx, IPV4, remArIndex, 0); |
andrewboyson | 10:f0854784e960 | 89 | |
andrewboyson | 10:f0854784e960 | 90 | *pDstIp = *pSrcIp; |
andrewboyson | 10:f0854784e960 | 91 | |
andrewboyson | 59:e0e556c8bd46 | 92 | finalisePacket(TCP, action, pPacketTx, *pSizeTx, pSrcIp, pDstIp); |
andrewboyson | 10:f0854784e960 | 93 | |
andrewboyson | 88:1ba13e6062a3 | 94 | Led3Set(false); |
andrewboyson | 10:f0854784e960 | 95 | return action; |
andrewboyson | 10:f0854784e960 | 96 | } |
andrewboyson | 10:f0854784e960 | 97 | |
andrewboyson | 59:e0e556c8bd46 | 98 | int Udp4HandleReceivedPacket(void (*traceback)(void), void* pPacketRx, int sizeRx, void* pPacketTx, int* pSizeTx, uint32_t* pSrcIp, uint32_t* pDstIp) |
andrewboyson | 10:f0854784e960 | 99 | { |
andrewboyson | 37:793b39683406 | 100 | pTraceBack = traceback; |
andrewboyson | 37:793b39683406 | 101 | tracePacketProtocol = UDP; |
andrewboyson | 59:e0e556c8bd46 | 102 | calculatedChecksum = calculateChecksum(UDP, *pSrcIp, *pDstIp, sizeRx, pPacketRx); |
andrewboyson | 59:e0e556c8bd46 | 103 | |
andrewboyson | 59:e0e556c8bd46 | 104 | int action = UdpHandleReceivedPacket(trace, sizeRx, pPacketRx, pSizeTx, pPacketTx); |
andrewboyson | 10:f0854784e960 | 105 | |
andrewboyson | 10:f0854784e960 | 106 | *pDstIp = *pSrcIp; |
andrewboyson | 10:f0854784e960 | 107 | |
andrewboyson | 59:e0e556c8bd46 | 108 | finalisePacket(UDP, action, pPacketTx, *pSizeTx, pSrcIp, pDstIp); //Note that the ports are reversed here |
andrewboyson | 86:55bc5ddac16c | 109 | |
andrewboyson | 10:f0854784e960 | 110 | return action; |
andrewboyson | 10:f0854784e960 | 111 | } |
andrewboyson | 71:736a5747ade1 | 112 | int Tcp4PollForPacketToSend(void* pPacket, int* pSize, uint32_t* pSrcIp, uint32_t* pDstIp) |
andrewboyson | 71:736a5747ade1 | 113 | { |
andrewboyson | 74:c3756bfa960e | 114 | int remArIndex = -1; |
andrewboyson | 80:4ef1500fca1d | 115 | int action = TcpPollForPacketToSend(pSize, pPacket, IPV4, &remArIndex, NULL); |
andrewboyson | 74:c3756bfa960e | 116 | if (action && remArIndex >= 0) *pDstIp = Ar4IndexToIp(remArIndex); |
andrewboyson | 71:736a5747ade1 | 117 | |
andrewboyson | 71:736a5747ade1 | 118 | finalisePacket(TCP, action, pPacket, *pSize, pSrcIp, pDstIp); |
andrewboyson | 71:736a5747ade1 | 119 | |
andrewboyson | 71:736a5747ade1 | 120 | return action; |
andrewboyson | 71:736a5747ade1 | 121 | } |
andrewboyson | 10:f0854784e960 | 122 | int Udp4PollForPacketToSend(void* pPacket, int* pSize, uint32_t* pSrcIp, uint32_t* pDstIp) |
andrewboyson | 10:f0854784e960 | 123 | { |
andrewboyson | 10:f0854784e960 | 124 | int action = UdpPollForPacketToSend(IPV4, pSize, pPacket); |
andrewboyson | 10:f0854784e960 | 125 | |
andrewboyson | 10:f0854784e960 | 126 | finalisePacket(UDP, action, pPacket, *pSize, pSrcIp, pDstIp); |
andrewboyson | 10:f0854784e960 | 127 | |
andrewboyson | 10:f0854784e960 | 128 | return action; |
andrewboyson | 10:f0854784e960 | 129 | } |