2 * FreeRTOS+TCP V2.0.11
\r
3 * Copyright (C) 2017 Amazon.com, Inc. or its affiliates. All Rights Reserved.
\r
5 * Permission is hereby granted, free of charge, to any person obtaining a copy of
\r
6 * this software and associated documentation files (the "Software"), to deal in
\r
7 * the Software without restriction, including without limitation the rights to
\r
8 * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
\r
9 * the Software, and to permit persons to whom the Software is furnished to do so,
\r
10 * subject to the following conditions:
\r
12 * The above copyright notice and this permission notice shall be included in all
\r
13 * copies or substantial portions of the Software.
\r
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
\r
16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
\r
17 * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
\r
18 * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
\r
19 * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
\r
20 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
\r
22 * http://aws.amazon.com/freertos
\r
23 * http://www.FreeRTOS.org
\r
26 /* Standard includes. */
\r
30 /* FreeRTOS includes. */
\r
31 #include "FreeRTOS.h"
\r
36 /* FreeRTOS+TCP includes. */
\r
37 #include "FreeRTOS_IP.h"
\r
38 #include "FreeRTOS_Sockets.h"
\r
39 #include "FreeRTOS_IP_Private.h"
\r
40 #include "FreeRTOS_UDP_IP.h"
\r
41 #include "FreeRTOS_ARP.h"
\r
42 #include "FreeRTOS_DHCP.h"
\r
43 #include "NetworkInterface.h"
\r
44 #include "NetworkBufferManagement.h"
\r
46 #if( ipconfigUSE_DNS == 1 )
\r
47 #include "FreeRTOS_DNS.h"
\r
50 /* The expected IP version and header length coded into the IP header itself. */
\r
51 #define ipIP_VERSION_AND_HEADER_LENGTH_BYTE ( ( uint8_t ) 0x45 )
\r
53 /* Part of the Ethernet and IP headers are always constant when sending an IPv4
\r
54 UDP packet. This array defines the constant parts, allowing this part of the
\r
55 packet to be filled in using a simple memcpy() instead of individual writes. */
\r
56 UDPPacketHeader_t xDefaultPartUDPPacketHeader =
\r
60 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* Ethernet source MAC address. */
\r
61 0x08, 0x00, /* Ethernet frame type. */
\r
62 ipIP_VERSION_AND_HEADER_LENGTH_BYTE, /* ucVersionHeaderLength. */
\r
63 0x00, /* ucDifferentiatedServicesCode. */
\r
64 0x00, 0x00, /* usLength. */
\r
65 0x00, 0x00, /* usIdentification. */
\r
66 0x00, 0x00, /* usFragmentOffset. */
\r
67 ipconfigUDP_TIME_TO_LIVE, /* ucTimeToLive */
\r
68 ipPROTOCOL_UDP, /* ucProtocol. */
\r
69 0x00, 0x00, /* usHeaderChecksum. */
\r
70 0x00, 0x00, 0x00, 0x00 /* Source IP address. */
\r
73 /*-----------------------------------------------------------*/
\r
75 void vProcessGeneratedUDPPacket( NetworkBufferDescriptor_t * const pxNetworkBuffer )
\r
77 UDPPacket_t *pxUDPPacket;
\r
78 IPHeader_t *pxIPHeader;
\r
79 eARPLookupResult_t eReturned;
\r
80 uint32_t ulIPAddress = pxNetworkBuffer->ulIPAddress;
\r
82 /* Map the UDP packet onto the start of the frame. */
\r
83 pxUDPPacket = ( UDPPacket_t * ) pxNetworkBuffer->pucEthernetBuffer;
\r
85 /* Determine the ARP cache status for the requested IP address. */
\r
86 eReturned = eARPGetCacheEntry( &( ulIPAddress ), &( pxUDPPacket->xEthernetHeader.xDestinationAddress ) );
\r
88 if( eReturned != eCantSendPacket )
\r
90 if( eReturned == eARPCacheHit )
\r
92 #if( ipconfigDRIVER_INCLUDED_TX_IP_CHECKSUM == 0 )
\r
93 uint8_t ucSocketOptions;
\r
95 iptraceSENDING_UDP_PACKET( pxNetworkBuffer->ulIPAddress );
\r
97 /* Create short cuts to the data within the packet. */
\r
98 pxIPHeader = &( pxUDPPacket->xIPHeader );
\r
100 #if ( ipconfigSUPPORT_OUTGOING_PINGS == 1 )
\r
101 /* Is it possible that the packet is not actually a UDP packet
\r
102 after all, but an ICMP packet. */
\r
103 if( pxNetworkBuffer->usPort != ipPACKET_CONTAINS_ICMP_DATA )
\r
104 #endif /* ipconfigSUPPORT_OUTGOING_PINGS */
\r
106 UDPHeader_t *pxUDPHeader;
\r
108 pxUDPHeader = &( pxUDPPacket->xUDPHeader );
\r
110 pxUDPHeader->usDestinationPort = pxNetworkBuffer->usPort;
\r
111 pxUDPHeader->usSourcePort = pxNetworkBuffer->usBoundPort;
\r
112 pxUDPHeader->usLength = ( uint16_t ) ( pxNetworkBuffer->xDataLength + sizeof( UDPHeader_t ) );
\r
113 pxUDPHeader->usLength = FreeRTOS_htons( pxUDPHeader->usLength );
\r
114 pxUDPHeader->usChecksum = 0u;
\r
117 /* memcpy() the constant parts of the header information into
\r
118 the correct location within the packet. This fills in:
\r
119 xEthernetHeader.xSourceAddress
\r
120 xEthernetHeader.usFrameType
\r
121 xIPHeader.ucVersionHeaderLength
\r
122 xIPHeader.ucDifferentiatedServicesCode
\r
124 xIPHeader.usIdentification
\r
125 xIPHeader.usFragmentOffset
\r
126 xIPHeader.ucTimeToLive
\r
127 xIPHeader.ucProtocol
\r
129 xIPHeader.usHeaderChecksum
\r
131 /* Save options now, as they will be overwritten by memcpy */
\r
132 #if( ipconfigDRIVER_INCLUDED_TX_IP_CHECKSUM == 0 )
\r
133 ucSocketOptions = pxNetworkBuffer->pucEthernetBuffer[ ipSOCKET_OPTIONS_OFFSET ];
\r
136 * Offset the memcpy by the size of a MAC address to start at the packet's
\r
137 * Ethernet header 'source' MAC address; the preceding 'destination' should not be altered.
\r
139 char *pxUdpSrcAddrOffset = ( char *) pxUDPPacket + sizeof( MACAddress_t );
\r
140 memcpy( pxUdpSrcAddrOffset, xDefaultPartUDPPacketHeader.ucBytes, sizeof( xDefaultPartUDPPacketHeader ) );
\r
142 #if ipconfigSUPPORT_OUTGOING_PINGS == 1
\r
143 if( pxNetworkBuffer->usPort == ipPACKET_CONTAINS_ICMP_DATA )
\r
145 pxIPHeader->ucProtocol = ipPROTOCOL_ICMP;
\r
146 pxIPHeader->usLength = ( uint16_t ) ( pxNetworkBuffer->xDataLength + sizeof( IPHeader_t ) );
\r
149 #endif /* ipconfigSUPPORT_OUTGOING_PINGS */
\r
151 pxIPHeader->usLength = ( uint16_t ) ( pxNetworkBuffer->xDataLength + sizeof( IPHeader_t ) + sizeof( UDPHeader_t ) );
\r
154 /* The total transmit size adds on the Ethernet header. */
\r
155 pxNetworkBuffer->xDataLength = pxIPHeader->usLength + sizeof( EthernetHeader_t );
\r
156 pxIPHeader->usLength = FreeRTOS_htons( pxIPHeader->usLength );
\r
157 /* HT:endian: changed back to network endian */
\r
158 pxIPHeader->ulDestinationIPAddress = pxNetworkBuffer->ulIPAddress;
\r
160 #if( ipconfigUSE_LLMNR == 1 )
\r
162 /* LLMNR messages are typically used on a LAN and they're
\r
163 * not supposed to cross routers */
\r
164 if( pxNetworkBuffer->ulIPAddress == ipLLMNR_IP_ADDR )
\r
166 pxIPHeader->ucTimeToLive = 0x01;
\r
171 #if( ipconfigDRIVER_INCLUDED_TX_IP_CHECKSUM == 0 )
\r
173 pxIPHeader->usHeaderChecksum = 0u;
\r
174 pxIPHeader->usHeaderChecksum = usGenerateChecksum( 0UL, ( uint8_t * ) &( pxIPHeader->ucVersionHeaderLength ), ipSIZE_OF_IPv4_HEADER );
\r
175 pxIPHeader->usHeaderChecksum = ~FreeRTOS_htons( pxIPHeader->usHeaderChecksum );
\r
177 if( ( ucSocketOptions & ( uint8_t ) FREERTOS_SO_UDPCKSUM_OUT ) != 0u )
\r
179 usGenerateProtocolChecksum( (uint8_t*)pxUDPPacket, pxNetworkBuffer->xDataLength, pdTRUE );
\r
183 pxUDPPacket->xUDPHeader.usChecksum = 0u;
\r
188 else if( eReturned == eARPCacheMiss )
\r
190 /* Add an entry to the ARP table with a null hardware address.
\r
191 This allows the ARP timer to know that an ARP reply is
\r
192 outstanding, and perform retransmissions if necessary. */
\r
193 vARPRefreshCacheEntry( NULL, ulIPAddress );
\r
195 /* Generate an ARP for the required IP address. */
\r
196 iptracePACKET_DROPPED_TO_GENERATE_ARP( pxNetworkBuffer->ulIPAddress );
\r
197 pxNetworkBuffer->ulIPAddress = ulIPAddress;
\r
198 vARPGenerateRequestPacket( pxNetworkBuffer );
\r
202 /* The lookup indicated that an ARP request has already been
\r
203 sent out for the queried IP address. */
\r
204 eReturned = eCantSendPacket;
\r
208 if( eReturned != eCantSendPacket )
\r
210 /* The network driver is responsible for freeing the network buffer
\r
211 after the packet has been sent. */
\r
213 #if defined( ipconfigETHERNET_MINIMUM_PACKET_BYTES )
\r
215 if( pxNetworkBuffer->xDataLength < ( size_t ) ipconfigETHERNET_MINIMUM_PACKET_BYTES )
\r
219 for( xIndex = ( BaseType_t ) pxNetworkBuffer->xDataLength; xIndex < ( BaseType_t ) ipconfigETHERNET_MINIMUM_PACKET_BYTES; xIndex++ )
\r
221 pxNetworkBuffer->pucEthernetBuffer[ xIndex ] = 0u;
\r
223 pxNetworkBuffer->xDataLength = ( size_t ) ipconfigETHERNET_MINIMUM_PACKET_BYTES;
\r
228 xNetworkInterfaceOutput( pxNetworkBuffer, pdTRUE );
\r
232 /* The packet can't be sent (DHCP not completed?). Just drop the
\r
234 vReleaseNetworkBufferAndDescriptor( pxNetworkBuffer );
\r
237 /*-----------------------------------------------------------*/
\r
239 BaseType_t xProcessReceivedUDPPacket( NetworkBufferDescriptor_t *pxNetworkBuffer, uint16_t usPort )
\r
241 BaseType_t xReturn = pdPASS;
\r
242 FreeRTOS_Socket_t *pxSocket;
\r
244 UDPPacket_t *pxUDPPacket = (UDPPacket_t *) pxNetworkBuffer->pucEthernetBuffer;
\r
246 /* Caller must check for minimum packet size. */
\r
247 pxSocket = pxUDPSocketLookup( usPort );
\r
252 /* When refreshing the ARP cache with received UDP packets we must be
\r
253 careful; hundreds of broadcast messages may pass and if we're not
\r
254 handling them, no use to fill the ARP cache with those IP addresses. */
\r
255 vARPRefreshCacheEntry( &( pxUDPPacket->xEthernetHeader.xSourceAddress ), pxUDPPacket->xIPHeader.ulSourceIPAddress );
\r
257 #if( ipconfigUSE_CALLBACKS == 1 )
\r
259 /* Did the owner of this socket register a reception handler ? */
\r
260 if( ipconfigIS_VALID_PROG_ADDRESS( pxSocket->u.xUDP.pxHandleReceive ) )
\r
262 struct freertos_sockaddr xSourceAddress, destinationAddress;
\r
263 void *pcData = ( void * ) &( pxNetworkBuffer->pucEthernetBuffer[ ipUDP_PAYLOAD_OFFSET_IPv4 ] );
\r
264 FOnUDPReceive_t xHandler = ( FOnUDPReceive_t ) pxSocket->u.xUDP.pxHandleReceive;
\r
265 xSourceAddress.sin_port = pxNetworkBuffer->usPort;
\r
266 xSourceAddress.sin_addr = pxNetworkBuffer->ulIPAddress;
\r
267 destinationAddress.sin_port = usPort;
\r
268 destinationAddress.sin_addr = pxUDPPacket->xIPHeader.ulDestinationIPAddress;
\r
270 if( xHandler( ( Socket_t * ) pxSocket, ( void* ) pcData, ( size_t ) pxNetworkBuffer->xDataLength,
\r
271 &xSourceAddress, &destinationAddress ) )
\r
273 xReturn = pdFAIL; /* FAIL means that we did not consume or release the buffer */
\r
277 #endif /* ipconfigUSE_CALLBACKS */
\r
279 #if( ipconfigUDP_MAX_RX_PACKETS > 0 )
\r
281 if( xReturn == pdPASS )
\r
283 if ( listCURRENT_LIST_LENGTH( &( pxSocket->u.xUDP.xWaitingPacketsList ) ) >= pxSocket->u.xUDP.uxMaxPackets )
\r
285 FreeRTOS_debug_printf( ( "xProcessReceivedUDPPacket: buffer full %ld >= %ld port %u\n",
\r
286 listCURRENT_LIST_LENGTH( &( pxSocket->u.xUDP.xWaitingPacketsList ) ),
\r
287 pxSocket->u.xUDP.uxMaxPackets, pxSocket->usLocalPort ) );
\r
288 xReturn = pdFAIL; /* we did not consume or release the buffer */
\r
294 if( xReturn == pdPASS )
\r
298 if( xReturn == pdPASS )
\r
300 taskENTER_CRITICAL();
\r
302 /* Add the network packet to the list of packets to be
\r
303 processed by the socket. */
\r
304 vListInsertEnd( &( pxSocket->u.xUDP.xWaitingPacketsList ), &( pxNetworkBuffer->xBufferListItem ) );
\r
306 taskEXIT_CRITICAL();
\r
311 /* Set the socket's receive event */
\r
312 if( pxSocket->xEventGroup != NULL )
\r
314 xEventGroupSetBits( pxSocket->xEventGroup, eSOCKET_RECEIVE );
\r
317 #if( ipconfigSUPPORT_SELECT_FUNCTION == 1 )
\r
319 if( ( pxSocket->pxSocketSet != NULL ) && ( ( pxSocket->xSelectBits & eSELECT_READ ) != 0 ) )
\r
321 xEventGroupSetBits( pxSocket->pxSocketSet->xSelectGroup, eSELECT_READ );
\r
326 #if( ipconfigSOCKET_HAS_USER_SEMAPHORE == 1 )
\r
328 if( pxSocket->pxUserSemaphore != NULL )
\r
330 xSemaphoreGive( pxSocket->pxUserSemaphore );
\r
335 #if( ipconfigUSE_DHCP == 1 )
\r
337 if( xIsDHCPSocket( pxSocket ) )
\r
339 xSendEventToIPTask( eDHCPEvent );
\r
347 /* There is no socket listening to the target port, but still it might
\r
348 be for this node. */
\r
350 #if( ipconfigUSE_LLMNR == 1 )
\r
351 /* a LLMNR request, check for the destination port. */
\r
352 if( ( usPort == FreeRTOS_ntohs( ipLLMNR_PORT ) ) ||
\r
353 ( pxUDPPacket->xUDPHeader.usSourcePort == FreeRTOS_ntohs( ipLLMNR_PORT ) ) )
\r
355 vARPRefreshCacheEntry( &( pxUDPPacket->xEthernetHeader.xSourceAddress ), pxUDPPacket->xIPHeader.ulSourceIPAddress );
\r
356 xReturn = ( BaseType_t )ulDNSHandlePacket( pxNetworkBuffer );
\r
359 #endif /* ipconfigUSE_LLMNR */
\r
361 #if( ipconfigUSE_NBNS == 1 )
\r
362 /* a NetBIOS request, check for the destination port */
\r
363 if( ( usPort == FreeRTOS_ntohs( ipNBNS_PORT ) ) ||
\r
364 ( pxUDPPacket->xUDPHeader.usSourcePort == FreeRTOS_ntohs( ipNBNS_PORT ) ) )
\r
366 vARPRefreshCacheEntry( &( pxUDPPacket->xEthernetHeader.xSourceAddress ), pxUDPPacket->xIPHeader.ulSourceIPAddress );
\r
367 xReturn = ( BaseType_t )ulNBNSHandlePacket( pxNetworkBuffer );
\r
370 #endif /* ipconfigUSE_NBNS */
\r
378 /*-----------------------------------------------------------*/
\r