mbed unsupported / lwip

A version of LWIP, provided for backwards compatibility.

Dependents:   AA_DemoBoard DemoBoard HelloServerDemo DemoBoard_RangeIndicator ... more

trunk/Core/lwIP/core/udp.c@0:5e1631496985, 2012-05-08 (annotated)

Committer:
root@mbed.org
Date:
Tue May 08 15:32:10 2012 +0100
Revision:
0:5e1631496985
initial commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
root@mbed.org 0:5e1631496985 1 /**
root@mbed.org 0:5e1631496985 2 * @file
root@mbed.org 0:5e1631496985 3 * User Datagram Protocol module
root@mbed.org 0:5e1631496985 4 *
root@mbed.org 0:5e1631496985 5 */
root@mbed.org 0:5e1631496985 6
root@mbed.org 0:5e1631496985 7 /*
root@mbed.org 0:5e1631496985 8 * Copyright (c) 2001-2004 Swedish Institute of Computer Science.
root@mbed.org 0:5e1631496985 9 * All rights reserved.
root@mbed.org 0:5e1631496985 10 *
root@mbed.org 0:5e1631496985 11 * Redistribution and use in source and binary forms, with or without modification,
root@mbed.org 0:5e1631496985 12 * are permitted provided that the following conditions are met:
root@mbed.org 0:5e1631496985 13 *
root@mbed.org 0:5e1631496985 14 * 1. Redistributions of source code must retain the above copyright notice,
root@mbed.org 0:5e1631496985 15 * this list of conditions and the following disclaimer.
root@mbed.org 0:5e1631496985 16 * 2. Redistributions in binary form must reproduce the above copyright notice,
root@mbed.org 0:5e1631496985 17 * this list of conditions and the following disclaimer in the documentation
root@mbed.org 0:5e1631496985 18 * and/or other materials provided with the distribution.
root@mbed.org 0:5e1631496985 19 * 3. The name of the author may not be used to endorse or promote products
root@mbed.org 0:5e1631496985 20 * derived from this software without specific prior written permission.
root@mbed.org 0:5e1631496985 21 *
root@mbed.org 0:5e1631496985 22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
root@mbed.org 0:5e1631496985 23 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
root@mbed.org 0:5e1631496985 24 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
root@mbed.org 0:5e1631496985 25 * SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
root@mbed.org 0:5e1631496985 26 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
root@mbed.org 0:5e1631496985 27 * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
root@mbed.org 0:5e1631496985 28 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
root@mbed.org 0:5e1631496985 29 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
root@mbed.org 0:5e1631496985 30 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
root@mbed.org 0:5e1631496985 31 * OF SUCH DAMAGE.
root@mbed.org 0:5e1631496985 32 *
root@mbed.org 0:5e1631496985 33 * This file is part of the lwIP TCP/IP stack.
root@mbed.org 0:5e1631496985 34 *
root@mbed.org 0:5e1631496985 35 * Author: Adam Dunkels <adam@sics.se>
root@mbed.org 0:5e1631496985 36 *
root@mbed.org 0:5e1631496985 37 */
root@mbed.org 0:5e1631496985 38
root@mbed.org 0:5e1631496985 39
root@mbed.org 0:5e1631496985 40 /* udp.c
root@mbed.org 0:5e1631496985 41 *
root@mbed.org 0:5e1631496985 42 * The code for the User Datagram Protocol UDP & UDPLite (RFC 3828).
root@mbed.org 0:5e1631496985 43 *
root@mbed.org 0:5e1631496985 44 */
root@mbed.org 0:5e1631496985 45
root@mbed.org 0:5e1631496985 46 /* @todo Check the use of '(struct udp_pcb).chksum_len_rx'!
root@mbed.org 0:5e1631496985 47 */
root@mbed.org 0:5e1631496985 48
root@mbed.org 0:5e1631496985 49 #include "lwip/opt.h"
root@mbed.org 0:5e1631496985 50
root@mbed.org 0:5e1631496985 51 #if LWIP_UDP /* don't build if not configured for use in lwipopts.h */
root@mbed.org 0:5e1631496985 52
root@mbed.org 0:5e1631496985 53 #include "lwip/udp.h"
root@mbed.org 0:5e1631496985 54 #include "lwip/def.h"
root@mbed.org 0:5e1631496985 55 #include "lwip/memp.h"
root@mbed.org 0:5e1631496985 56 #include "lwip/inet.h"
root@mbed.org 0:5e1631496985 57 #include "lwip/inet_chksum.h"
root@mbed.org 0:5e1631496985 58 #include "lwip/ip_addr.h"
root@mbed.org 0:5e1631496985 59 #include "lwip/netif.h"
root@mbed.org 0:5e1631496985 60 #include "lwip/icmp.h"
root@mbed.org 0:5e1631496985 61 #include "lwip/stats.h"
root@mbed.org 0:5e1631496985 62 #include "lwip/snmp.h"
root@mbed.org 0:5e1631496985 63 #include "arch/perf.h"
root@mbed.org 0:5e1631496985 64 #include "lwip/dhcp.h"
root@mbed.org 0:5e1631496985 65
root@mbed.org 0:5e1631496985 66 #include <string.h>
root@mbed.org 0:5e1631496985 67
root@mbed.org 0:5e1631496985 68 /* The list of UDP PCBs */
root@mbed.org 0:5e1631496985 69 /* exported in udp.h (was static) */
root@mbed.org 0:5e1631496985 70 struct udp_pcb *udp_pcbs;
root@mbed.org 0:5e1631496985 71
root@mbed.org 0:5e1631496985 72 /**
root@mbed.org 0:5e1631496985 73 * Process an incoming UDP datagram.
root@mbed.org 0:5e1631496985 74 *
root@mbed.org 0:5e1631496985 75 * Given an incoming UDP datagram (as a chain of pbufs) this function
root@mbed.org 0:5e1631496985 76 * finds a corresponding UDP PCB and hands over the pbuf to the pcbs
root@mbed.org 0:5e1631496985 77 * recv function. If no pcb is found or the datagram is incorrect, the
root@mbed.org 0:5e1631496985 78 * pbuf is freed.
root@mbed.org 0:5e1631496985 79 *
root@mbed.org 0:5e1631496985 80 * @param p pbuf to be demultiplexed to a UDP PCB.
root@mbed.org 0:5e1631496985 81 * @param inp network interface on which the datagram was received.
root@mbed.org 0:5e1631496985 82 *
root@mbed.org 0:5e1631496985 83 */
root@mbed.org 0:5e1631496985 84 void
root@mbed.org 0:5e1631496985 85 udp_input(struct pbuf *p, struct netif *inp)
root@mbed.org 0:5e1631496985 86 {
root@mbed.org 0:5e1631496985 87 struct udp_hdr *udphdr;
root@mbed.org 0:5e1631496985 88 struct udp_pcb *pcb, *prev;
root@mbed.org 0:5e1631496985 89 struct udp_pcb *uncon_pcb;
root@mbed.org 0:5e1631496985 90 struct ip_hdr *iphdr;
root@mbed.org 0:5e1631496985 91 u16_t src, dest;
root@mbed.org 0:5e1631496985 92 u8_t local_match;
root@mbed.org 0:5e1631496985 93 u8_t broadcast;
root@mbed.org 0:5e1631496985 94
root@mbed.org 0:5e1631496985 95 PERF_START;
root@mbed.org 0:5e1631496985 96
root@mbed.org 0:5e1631496985 97 UDP_STATS_INC(udp.recv);
root@mbed.org 0:5e1631496985 98
root@mbed.org 0:5e1631496985 99 iphdr = (struct ip_hdr *)p->payload;
root@mbed.org 0:5e1631496985 100
root@mbed.org 0:5e1631496985 101 /* Check minimum length (IP header + UDP header)
root@mbed.org 0:5e1631496985 102 * and move payload pointer to UDP header */
root@mbed.org 0:5e1631496985 103 if (p->tot_len < (IPH_HL(iphdr) * 4 + UDP_HLEN) || pbuf_header(p, -(s16_t)(IPH_HL(iphdr) * 4))) {
root@mbed.org 0:5e1631496985 104 /* drop short packets */
root@mbed.org 0:5e1631496985 105 LWIP_DEBUGF(UDP_DEBUG,
root@mbed.org 0:5e1631496985 106 ("udp_input: short UDP datagram (%"U16_F" bytes) discarded\n", p->tot_len));
root@mbed.org 0:5e1631496985 107 UDP_STATS_INC(udp.lenerr);
root@mbed.org 0:5e1631496985 108 UDP_STATS_INC(udp.drop);
root@mbed.org 0:5e1631496985 109 snmp_inc_udpinerrors();
root@mbed.org 0:5e1631496985 110 pbuf_free(p);
root@mbed.org 0:5e1631496985 111 goto end;
root@mbed.org 0:5e1631496985 112 }
root@mbed.org 0:5e1631496985 113
root@mbed.org 0:5e1631496985 114 udphdr = (struct udp_hdr *)p->payload;
root@mbed.org 0:5e1631496985 115
root@mbed.org 0:5e1631496985 116 /* is broadcast packet ? */
root@mbed.org 0:5e1631496985 117 broadcast = ip_addr_isbroadcast(&(iphdr->dest), inp);
root@mbed.org 0:5e1631496985 118
root@mbed.org 0:5e1631496985 119 LWIP_DEBUGF(UDP_DEBUG, ("udp_input: received datagram of length %"U16_F"\n", p->tot_len));
root@mbed.org 0:5e1631496985 120
root@mbed.org 0:5e1631496985 121 /* convert src and dest ports to host byte order */
root@mbed.org 0:5e1631496985 122 src = ntohs(udphdr->src);
root@mbed.org 0:5e1631496985 123 dest = ntohs(udphdr->dest);
root@mbed.org 0:5e1631496985 124
root@mbed.org 0:5e1631496985 125 udp_debug_print(udphdr);
root@mbed.org 0:5e1631496985 126
root@mbed.org 0:5e1631496985 127 /* print the UDP source and destination */
root@mbed.org 0:5e1631496985 128 LWIP_DEBUGF(UDP_DEBUG,
root@mbed.org 0:5e1631496985 129 ("udp (%"U16_F".%"U16_F".%"U16_F".%"U16_F", %"U16_F") <-- "
root@mbed.org 0:5e1631496985 130 "(%"U16_F".%"U16_F".%"U16_F".%"U16_F", %"U16_F")\n",
root@mbed.org 0:5e1631496985 131 ip4_addr1(&iphdr->dest), ip4_addr2(&iphdr->dest),
root@mbed.org 0:5e1631496985 132 ip4_addr3(&iphdr->dest), ip4_addr4(&iphdr->dest), ntohs(udphdr->dest),
root@mbed.org 0:5e1631496985 133 ip4_addr1(&iphdr->src), ip4_addr2(&iphdr->src),
root@mbed.org 0:5e1631496985 134 ip4_addr3(&iphdr->src), ip4_addr4(&iphdr->src), ntohs(udphdr->src)));
root@mbed.org 0:5e1631496985 135
root@mbed.org 0:5e1631496985 136 #if LWIP_DHCP
root@mbed.org 0:5e1631496985 137 pcb = NULL;
root@mbed.org 0:5e1631496985 138 /* when LWIP_DHCP is active, packets to DHCP_CLIENT_PORT may only be processed by
root@mbed.org 0:5e1631496985 139 the dhcp module, no other UDP pcb may use the local UDP port DHCP_CLIENT_PORT */
root@mbed.org 0:5e1631496985 140 if (dest == DHCP_CLIENT_PORT) {
root@mbed.org 0:5e1631496985 141 /* all packets for DHCP_CLIENT_PORT not coming from DHCP_SERVER_PORT are dropped! */
root@mbed.org 0:5e1631496985 142 if (src == DHCP_SERVER_PORT) {
root@mbed.org 0:5e1631496985 143 if ((inp->dhcp != NULL) && (inp->dhcp->pcb != NULL)) {
root@mbed.org 0:5e1631496985 144 /* accept the packe if
root@mbed.org 0:5e1631496985 145 (- broadcast or directed to us) -> DHCP is link-layer-addressed, local ip is always ANY!
root@mbed.org 0:5e1631496985 146 - inp->dhcp->pcb->remote == ANY or iphdr->src */
root@mbed.org 0:5e1631496985 147 if ((ip_addr_isany(&inp->dhcp->pcb->remote_ip) ||
root@mbed.org 0:5e1631496985 148 ip_addr_cmp(&(inp->dhcp->pcb->remote_ip), &(iphdr->src)))) {
root@mbed.org 0:5e1631496985 149 pcb = inp->dhcp->pcb;
root@mbed.org 0:5e1631496985 150 }
root@mbed.org 0:5e1631496985 151 }
root@mbed.org 0:5e1631496985 152 }
root@mbed.org 0:5e1631496985 153 } else
root@mbed.org 0:5e1631496985 154 #endif /* LWIP_DHCP */
root@mbed.org 0:5e1631496985 155 {
root@mbed.org 0:5e1631496985 156 prev = NULL;
root@mbed.org 0:5e1631496985 157 local_match = 0;
root@mbed.org 0:5e1631496985 158 uncon_pcb = NULL;
root@mbed.org 0:5e1631496985 159 /* Iterate through the UDP pcb list for a matching pcb.
root@mbed.org 0:5e1631496985 160 * 'Perfect match' pcbs (connected to the remote port & ip address) are
root@mbed.org 0:5e1631496985 161 * preferred. If no perfect match is found, the first unconnected pcb that
root@mbed.org 0:5e1631496985 162 * matches the local port and ip address gets the datagram. */
root@mbed.org 0:5e1631496985 163 for (pcb = udp_pcbs; pcb != NULL; pcb = pcb->next) {
root@mbed.org 0:5e1631496985 164 local_match = 0;
root@mbed.org 0:5e1631496985 165 /* print the PCB local and remote address */
root@mbed.org 0:5e1631496985 166 LWIP_DEBUGF(UDP_DEBUG,
root@mbed.org 0:5e1631496985 167 ("pcb (%"U16_F".%"U16_F".%"U16_F".%"U16_F", %"U16_F") --- "
root@mbed.org 0:5e1631496985 168 "(%"U16_F".%"U16_F".%"U16_F".%"U16_F", %"U16_F")\n",
root@mbed.org 0:5e1631496985 169 ip4_addr1(&pcb->local_ip), ip4_addr2(&pcb->local_ip),
root@mbed.org 0:5e1631496985 170 ip4_addr3(&pcb->local_ip), ip4_addr4(&pcb->local_ip), pcb->local_port,
root@mbed.org 0:5e1631496985 171 ip4_addr1(&pcb->remote_ip), ip4_addr2(&pcb->remote_ip),
root@mbed.org 0:5e1631496985 172 ip4_addr3(&pcb->remote_ip), ip4_addr4(&pcb->remote_ip), pcb->remote_port));
root@mbed.org 0:5e1631496985 173
root@mbed.org 0:5e1631496985 174 /* compare PCB local addr+port to UDP destination addr+port */
root@mbed.org 0:5e1631496985 175 if ((pcb->local_port == dest) &&
root@mbed.org 0:5e1631496985 176 ((!broadcast && ip_addr_isany(&pcb->local_ip)) ||
root@mbed.org 0:5e1631496985 177 ip_addr_cmp(&(pcb->local_ip), &(iphdr->dest)) ||
root@mbed.org 0:5e1631496985 178 #if LWIP_IGMP
root@mbed.org 0:5e1631496985 179 ip_addr_ismulticast(&(iphdr->dest)) ||
root@mbed.org 0:5e1631496985 180 #endif /* LWIP_IGMP */
root@mbed.org 0:5e1631496985 181 #if IP_SOF_BROADCAST_RECV
root@mbed.org 0:5e1631496985 182 (broadcast && (pcb->so_options & SOF_BROADCAST)))) {
root@mbed.org 0:5e1631496985 183 #else /* IP_SOF_BROADCAST_RECV */
root@mbed.org 0:5e1631496985 184 (broadcast))) {
root@mbed.org 0:5e1631496985 185 #endif /* IP_SOF_BROADCAST_RECV */
root@mbed.org 0:5e1631496985 186 local_match = 1;
root@mbed.org 0:5e1631496985 187 if ((uncon_pcb == NULL) &&
root@mbed.org 0:5e1631496985 188 ((pcb->flags & UDP_FLAGS_CONNECTED) == 0)) {
root@mbed.org 0:5e1631496985 189 /* the first unconnected matching PCB */
root@mbed.org 0:5e1631496985 190 uncon_pcb = pcb;
root@mbed.org 0:5e1631496985 191 }
root@mbed.org 0:5e1631496985 192 }
root@mbed.org 0:5e1631496985 193 /* compare PCB remote addr+port to UDP source addr+port */
root@mbed.org 0:5e1631496985 194 if ((local_match != 0) &&
root@mbed.org 0:5e1631496985 195 (pcb->remote_port == src) &&
root@mbed.org 0:5e1631496985 196 (ip_addr_isany(&pcb->remote_ip) ||
root@mbed.org 0:5e1631496985 197 ip_addr_cmp(&(pcb->remote_ip), &(iphdr->src)))) {
root@mbed.org 0:5e1631496985 198 /* the first fully matching PCB */
root@mbed.org 0:5e1631496985 199 if (prev != NULL) {
root@mbed.org 0:5e1631496985 200 /* move the pcb to the front of udp_pcbs so that is
root@mbed.org 0:5e1631496985 201 found faster next time */
root@mbed.org 0:5e1631496985 202 prev->next = pcb->next;
root@mbed.org 0:5e1631496985 203 pcb->next = udp_pcbs;
root@mbed.org 0:5e1631496985 204 udp_pcbs = pcb;
root@mbed.org 0:5e1631496985 205 } else {
root@mbed.org 0:5e1631496985 206 UDP_STATS_INC(udp.cachehit);
root@mbed.org 0:5e1631496985 207 }
root@mbed.org 0:5e1631496985 208 break;
root@mbed.org 0:5e1631496985 209 }
root@mbed.org 0:5e1631496985 210 prev = pcb;
root@mbed.org 0:5e1631496985 211 }
root@mbed.org 0:5e1631496985 212 /* no fully matching pcb found? then look for an unconnected pcb */
root@mbed.org 0:5e1631496985 213 if (pcb == NULL) {
root@mbed.org 0:5e1631496985 214 pcb = uncon_pcb;
root@mbed.org 0:5e1631496985 215 }
root@mbed.org 0:5e1631496985 216 }
root@mbed.org 0:5e1631496985 217
root@mbed.org 0:5e1631496985 218 /* Check checksum if this is a match or if it was directed at us. */
root@mbed.org 0:5e1631496985 219 if (pcb != NULL || ip_addr_cmp(&inp->ip_addr, &iphdr->dest)) {
root@mbed.org 0:5e1631496985 220 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE, ("udp_input: calculating checksum\n"));
root@mbed.org 0:5e1631496985 221 #if LWIP_UDPLITE
root@mbed.org 0:5e1631496985 222 if (IPH_PROTO(iphdr) == IP_PROTO_UDPLITE) {
root@mbed.org 0:5e1631496985 223 /* Do the UDP Lite checksum */
root@mbed.org 0:5e1631496985 224 #if CHECKSUM_CHECK_UDP
root@mbed.org 0:5e1631496985 225 u16_t chklen = ntohs(udphdr->len);
root@mbed.org 0:5e1631496985 226 if (chklen < sizeof(struct udp_hdr)) {
root@mbed.org 0:5e1631496985 227 if (chklen == 0) {
root@mbed.org 0:5e1631496985 228 /* For UDP-Lite, checksum length of 0 means checksum
root@mbed.org 0:5e1631496985 229 over the complete packet (See RFC 3828 chap. 3.1) */
root@mbed.org 0:5e1631496985 230 chklen = p->tot_len;
root@mbed.org 0:5e1631496985 231 } else {
root@mbed.org 0:5e1631496985 232 /* At least the UDP-Lite header must be covered by the
root@mbed.org 0:5e1631496985 233 checksum! (Again, see RFC 3828 chap. 3.1) */
root@mbed.org 0:5e1631496985 234 UDP_STATS_INC(udp.chkerr);
root@mbed.org 0:5e1631496985 235 UDP_STATS_INC(udp.drop);
root@mbed.org 0:5e1631496985 236 snmp_inc_udpinerrors();
root@mbed.org 0:5e1631496985 237 pbuf_free(p);
root@mbed.org 0:5e1631496985 238 goto end;
root@mbed.org 0:5e1631496985 239 }
root@mbed.org 0:5e1631496985 240 }
root@mbed.org 0:5e1631496985 241 if (inet_chksum_pseudo_partial(p, (struct ip_addr *)&(iphdr->src),
root@mbed.org 0:5e1631496985 242 (struct ip_addr *)&(iphdr->dest),
root@mbed.org 0:5e1631496985 243 IP_PROTO_UDPLITE, p->tot_len, chklen) != 0) {
root@mbed.org 0:5e1631496985 244 LWIP_DEBUGF(UDP_DEBUG | 2,
root@mbed.org 0:5e1631496985 245 ("udp_input: UDP Lite datagram discarded due to failing checksum\n"));
root@mbed.org 0:5e1631496985 246 UDP_STATS_INC(udp.chkerr);
root@mbed.org 0:5e1631496985 247 UDP_STATS_INC(udp.drop);
root@mbed.org 0:5e1631496985 248 snmp_inc_udpinerrors();
root@mbed.org 0:5e1631496985 249 pbuf_free(p);
root@mbed.org 0:5e1631496985 250 goto end;
root@mbed.org 0:5e1631496985 251 }
root@mbed.org 0:5e1631496985 252 #endif /* CHECKSUM_CHECK_UDP */
root@mbed.org 0:5e1631496985 253 } else
root@mbed.org 0:5e1631496985 254 #endif /* LWIP_UDPLITE */
root@mbed.org 0:5e1631496985 255 {
root@mbed.org 0:5e1631496985 256 #if CHECKSUM_CHECK_UDP
root@mbed.org 0:5e1631496985 257 if (udphdr->chksum != 0) {
root@mbed.org 0:5e1631496985 258 if (inet_chksum_pseudo(p, (struct ip_addr *)&(iphdr->src),
root@mbed.org 0:5e1631496985 259 (struct ip_addr *)&(iphdr->dest),
root@mbed.org 0:5e1631496985 260 IP_PROTO_UDP, p->tot_len) != 0) {
root@mbed.org 0:5e1631496985 261 LWIP_DEBUGF(UDP_DEBUG | 2,
root@mbed.org 0:5e1631496985 262 ("udp_input: UDP datagram discarded due to failing checksum\n"));
root@mbed.org 0:5e1631496985 263 UDP_STATS_INC(udp.chkerr);
root@mbed.org 0:5e1631496985 264 UDP_STATS_INC(udp.drop);
root@mbed.org 0:5e1631496985 265 snmp_inc_udpinerrors();
root@mbed.org 0:5e1631496985 266 pbuf_free(p);
root@mbed.org 0:5e1631496985 267 goto end;
root@mbed.org 0:5e1631496985 268 }
root@mbed.org 0:5e1631496985 269 }
root@mbed.org 0:5e1631496985 270 #endif /* CHECKSUM_CHECK_UDP */
root@mbed.org 0:5e1631496985 271 }
root@mbed.org 0:5e1631496985 272 if(pbuf_header(p, -UDP_HLEN)) {
root@mbed.org 0:5e1631496985 273 /* Can we cope with this failing? Just assert for now */
root@mbed.org 0:5e1631496985 274 LWIP_ASSERT("pbuf_header failed\n", 0);
root@mbed.org 0:5e1631496985 275 UDP_STATS_INC(udp.drop);
root@mbed.org 0:5e1631496985 276 snmp_inc_udpinerrors();
root@mbed.org 0:5e1631496985 277 pbuf_free(p);
root@mbed.org 0:5e1631496985 278 goto end;
root@mbed.org 0:5e1631496985 279 }
root@mbed.org 0:5e1631496985 280 if (pcb != NULL) {
root@mbed.org 0:5e1631496985 281 snmp_inc_udpindatagrams();
root@mbed.org 0:5e1631496985 282 /* callback */
root@mbed.org 0:5e1631496985 283 if (pcb->recv != NULL) {
root@mbed.org 0:5e1631496985 284 /* now the recv function is responsible for freeing p */
root@mbed.org 0:5e1631496985 285 pcb->recv(pcb->recv_arg, pcb, p, &iphdr->src, src);
root@mbed.org 0:5e1631496985 286 } else {
root@mbed.org 0:5e1631496985 287 /* no recv function registered? then we have to free the pbuf! */
root@mbed.org 0:5e1631496985 288 pbuf_free(p);
root@mbed.org 0:5e1631496985 289 goto end;
root@mbed.org 0:5e1631496985 290 }
root@mbed.org 0:5e1631496985 291 } else {
root@mbed.org 0:5e1631496985 292 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE, ("udp_input: not for us.\n"));
root@mbed.org 0:5e1631496985 293
root@mbed.org 0:5e1631496985 294 #if LWIP_ICMP
root@mbed.org 0:5e1631496985 295 /* No match was found, send ICMP destination port unreachable unless
root@mbed.org 0:5e1631496985 296 destination address was broadcast/multicast. */
root@mbed.org 0:5e1631496985 297 if (!broadcast &&
root@mbed.org 0:5e1631496985 298 !ip_addr_ismulticast(&iphdr->dest)) {
root@mbed.org 0:5e1631496985 299 /* move payload pointer back to ip header */
root@mbed.org 0:5e1631496985 300 pbuf_header(p, (IPH_HL(iphdr) * 4) + UDP_HLEN);
root@mbed.org 0:5e1631496985 301 LWIP_ASSERT("p->payload == iphdr", (p->payload == iphdr));
root@mbed.org 0:5e1631496985 302 icmp_dest_unreach(p, ICMP_DUR_PORT);
root@mbed.org 0:5e1631496985 303 }
root@mbed.org 0:5e1631496985 304 #endif /* LWIP_ICMP */
root@mbed.org 0:5e1631496985 305 UDP_STATS_INC(udp.proterr);
root@mbed.org 0:5e1631496985 306 UDP_STATS_INC(udp.drop);
root@mbed.org 0:5e1631496985 307 snmp_inc_udpnoports();
root@mbed.org 0:5e1631496985 308 pbuf_free(p);
root@mbed.org 0:5e1631496985 309 }
root@mbed.org 0:5e1631496985 310 } else {
root@mbed.org 0:5e1631496985 311 pbuf_free(p);
root@mbed.org 0:5e1631496985 312 }
root@mbed.org 0:5e1631496985 313 end:
root@mbed.org 0:5e1631496985 314 PERF_STOP("udp_input");
root@mbed.org 0:5e1631496985 315 }
root@mbed.org 0:5e1631496985 316
root@mbed.org 0:5e1631496985 317 /**
root@mbed.org 0:5e1631496985 318 * Send data using UDP.
root@mbed.org 0:5e1631496985 319 *
root@mbed.org 0:5e1631496985 320 * @param pcb UDP PCB used to send the data.
root@mbed.org 0:5e1631496985 321 * @param p chain of pbuf's to be sent.
root@mbed.org 0:5e1631496985 322 *
root@mbed.org 0:5e1631496985 323 * The datagram will be sent to the current remote_ip & remote_port
root@mbed.org 0:5e1631496985 324 * stored in pcb. If the pcb is not bound to a port, it will
root@mbed.org 0:5e1631496985 325 * automatically be bound to a random port.
root@mbed.org 0:5e1631496985 326 *
root@mbed.org 0:5e1631496985 327 * @return lwIP error code.
root@mbed.org 0:5e1631496985 328 * - ERR_OK. Successful. No error occured.
root@mbed.org 0:5e1631496985 329 * - ERR_MEM. Out of memory.
root@mbed.org 0:5e1631496985 330 * - ERR_RTE. Could not find route to destination address.
root@mbed.org 0:5e1631496985 331 * - More errors could be returned by lower protocol layers.
root@mbed.org 0:5e1631496985 332 *
root@mbed.org 0:5e1631496985 333 * @see udp_disconnect() udp_sendto()
root@mbed.org 0:5e1631496985 334 */
root@mbed.org 0:5e1631496985 335 err_t
root@mbed.org 0:5e1631496985 336 udp_send(struct udp_pcb *pcb, struct pbuf *p)
root@mbed.org 0:5e1631496985 337 {
root@mbed.org 0:5e1631496985 338 /* send to the packet using remote ip and port stored in the pcb */
root@mbed.org 0:5e1631496985 339 return udp_sendto(pcb, p, &pcb->remote_ip, pcb->remote_port);
root@mbed.org 0:5e1631496985 340 }
root@mbed.org 0:5e1631496985 341
root@mbed.org 0:5e1631496985 342 /**
root@mbed.org 0:5e1631496985 343 * Send data to a specified address using UDP.
root@mbed.org 0:5e1631496985 344 *
root@mbed.org 0:5e1631496985 345 * @param pcb UDP PCB used to send the data.
root@mbed.org 0:5e1631496985 346 * @param p chain of pbuf's to be sent.
root@mbed.org 0:5e1631496985 347 * @param dst_ip Destination IP address.
root@mbed.org 0:5e1631496985 348 * @param dst_port Destination UDP port.
root@mbed.org 0:5e1631496985 349 *
root@mbed.org 0:5e1631496985 350 * dst_ip & dst_port are expected to be in the same byte order as in the pcb.
root@mbed.org 0:5e1631496985 351 *
root@mbed.org 0:5e1631496985 352 * If the PCB already has a remote address association, it will
root@mbed.org 0:5e1631496985 353 * be restored after the data is sent.
root@mbed.org 0:5e1631496985 354 *
root@mbed.org 0:5e1631496985 355 * @return lwIP error code (@see udp_send for possible error codes)
root@mbed.org 0:5e1631496985 356 *
root@mbed.org 0:5e1631496985 357 * @see udp_disconnect() udp_send()
root@mbed.org 0:5e1631496985 358 */
root@mbed.org 0:5e1631496985 359 err_t
root@mbed.org 0:5e1631496985 360 udp_sendto(struct udp_pcb *pcb, struct pbuf *p,
root@mbed.org 0:5e1631496985 361 struct ip_addr *dst_ip, u16_t dst_port)
root@mbed.org 0:5e1631496985 362 {
root@mbed.org 0:5e1631496985 363 struct netif *netif;
root@mbed.org 0:5e1631496985 364
root@mbed.org 0:5e1631496985 365 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | 3, ("udp_send\n"));
root@mbed.org 0:5e1631496985 366
root@mbed.org 0:5e1631496985 367 /* find the outgoing network interface for this packet */
root@mbed.org 0:5e1631496985 368 #if LWIP_IGMP
root@mbed.org 0:5e1631496985 369 netif = ip_route((ip_addr_ismulticast(dst_ip))?(&(pcb->multicast_ip)):(dst_ip));
root@mbed.org 0:5e1631496985 370 #else
root@mbed.org 0:5e1631496985 371 netif = ip_route(dst_ip);
root@mbed.org 0:5e1631496985 372 #endif /* LWIP_IGMP */
root@mbed.org 0:5e1631496985 373
root@mbed.org 0:5e1631496985 374 /* no outgoing network interface could be found? */
root@mbed.org 0:5e1631496985 375 if (netif == NULL) {
root@mbed.org 0:5e1631496985 376 LWIP_DEBUGF(UDP_DEBUG | 1, ("udp_send: No route to 0x%"X32_F"\n", dst_ip->addr));
root@mbed.org 0:5e1631496985 377 UDP_STATS_INC(udp.rterr);
root@mbed.org 0:5e1631496985 378 return ERR_RTE;
root@mbed.org 0:5e1631496985 379 }
root@mbed.org 0:5e1631496985 380 return udp_sendto_if(pcb, p, dst_ip, dst_port, netif);
root@mbed.org 0:5e1631496985 381 }
root@mbed.org 0:5e1631496985 382
root@mbed.org 0:5e1631496985 383 /**
root@mbed.org 0:5e1631496985 384 * Send data to a specified address using UDP.
root@mbed.org 0:5e1631496985 385 * The netif used for sending can be specified.
root@mbed.org 0:5e1631496985 386 *
root@mbed.org 0:5e1631496985 387 * This function exists mainly for DHCP, to be able to send UDP packets
root@mbed.org 0:5e1631496985 388 * on a netif that is still down.
root@mbed.org 0:5e1631496985 389 *
root@mbed.org 0:5e1631496985 390 * @param pcb UDP PCB used to send the data.
root@mbed.org 0:5e1631496985 391 * @param p chain of pbuf's to be sent.
root@mbed.org 0:5e1631496985 392 * @param dst_ip Destination IP address.
root@mbed.org 0:5e1631496985 393 * @param dst_port Destination UDP port.
root@mbed.org 0:5e1631496985 394 * @param netif the netif used for sending.
root@mbed.org 0:5e1631496985 395 *
root@mbed.org 0:5e1631496985 396 * dst_ip & dst_port are expected to be in the same byte order as in the pcb.
root@mbed.org 0:5e1631496985 397 *
root@mbed.org 0:5e1631496985 398 * @return lwIP error code (@see udp_send for possible error codes)
root@mbed.org 0:5e1631496985 399 *
root@mbed.org 0:5e1631496985 400 * @see udp_disconnect() udp_send()
root@mbed.org 0:5e1631496985 401 */
root@mbed.org 0:5e1631496985 402 err_t
root@mbed.org 0:5e1631496985 403 udp_sendto_if(struct udp_pcb *pcb, struct pbuf *p,
root@mbed.org 0:5e1631496985 404 struct ip_addr *dst_ip, u16_t dst_port, struct netif *netif)
root@mbed.org 0:5e1631496985 405 {
root@mbed.org 0:5e1631496985 406 struct udp_hdr *udphdr;
root@mbed.org 0:5e1631496985 407 struct ip_addr *src_ip;
root@mbed.org 0:5e1631496985 408 err_t err;
root@mbed.org 0:5e1631496985 409 struct pbuf *q; /* q will be sent down the stack */
root@mbed.org 0:5e1631496985 410
root@mbed.org 0:5e1631496985 411 #if IP_SOF_BROADCAST
root@mbed.org 0:5e1631496985 412 /* broadcast filter? */
root@mbed.org 0:5e1631496985 413 if ( ((pcb->so_options & SOF_BROADCAST) == 0) && ip_addr_isbroadcast(dst_ip, netif) ) {
root@mbed.org 0:5e1631496985 414 LWIP_DEBUGF(UDP_DEBUG | 1, ("udp_sendto_if: SOF_BROADCAST not enabled on pcb %p\n", (void *)pcb));
root@mbed.org 0:5e1631496985 415 return ERR_VAL;
root@mbed.org 0:5e1631496985 416 }
root@mbed.org 0:5e1631496985 417 #endif /* IP_SOF_BROADCAST */
root@mbed.org 0:5e1631496985 418
root@mbed.org 0:5e1631496985 419 /* if the PCB is not yet bound to a port, bind it here */
root@mbed.org 0:5e1631496985 420 if (pcb->local_port == 0) {
root@mbed.org 0:5e1631496985 421 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | 2, ("udp_send: not yet bound to a port, binding now\n"));
root@mbed.org 0:5e1631496985 422 err = udp_bind(pcb, &pcb->local_ip, pcb->local_port);
root@mbed.org 0:5e1631496985 423 if (err != ERR_OK) {
root@mbed.org 0:5e1631496985 424 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | 2, ("udp_send: forced port bind failed\n"));
root@mbed.org 0:5e1631496985 425 return err;
root@mbed.org 0:5e1631496985 426 }
root@mbed.org 0:5e1631496985 427 }
root@mbed.org 0:5e1631496985 428
root@mbed.org 0:5e1631496985 429 /* not enough space to add an UDP header to first pbuf in given p chain? */
root@mbed.org 0:5e1631496985 430 if (pbuf_header(p, UDP_HLEN)) {
root@mbed.org 0:5e1631496985 431 /* allocate header in a separate new pbuf */
root@mbed.org 0:5e1631496985 432 q = pbuf_alloc(PBUF_IP, UDP_HLEN, PBUF_RAM);
root@mbed.org 0:5e1631496985 433 /* new header pbuf could not be allocated? */
root@mbed.org 0:5e1631496985 434 if (q == NULL) {
root@mbed.org 0:5e1631496985 435 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | 2, ("udp_send: could not allocate header\n"));
root@mbed.org 0:5e1631496985 436 return ERR_MEM;
root@mbed.org 0:5e1631496985 437 }
root@mbed.org 0:5e1631496985 438 /* chain header q in front of given pbuf p */
root@mbed.org 0:5e1631496985 439 pbuf_chain(q, p);
root@mbed.org 0:5e1631496985 440 /* first pbuf q points to header pbuf */
root@mbed.org 0:5e1631496985 441 LWIP_DEBUGF(UDP_DEBUG,
root@mbed.org 0:5e1631496985 442 ("udp_send: added header pbuf %p before given pbuf %p\n", (void *)q, (void *)p));
root@mbed.org 0:5e1631496985 443 } else {
root@mbed.org 0:5e1631496985 444 /* adding space for header within p succeeded */
root@mbed.org 0:5e1631496985 445 /* first pbuf q equals given pbuf */
root@mbed.org 0:5e1631496985 446 q = p;
root@mbed.org 0:5e1631496985 447 LWIP_DEBUGF(UDP_DEBUG, ("udp_send: added header in given pbuf %p\n", (void *)p));
root@mbed.org 0:5e1631496985 448 }
root@mbed.org 0:5e1631496985 449 LWIP_ASSERT("check that first pbuf can hold struct udp_hdr",
root@mbed.org 0:5e1631496985 450 (q->len >= sizeof(struct udp_hdr)));
root@mbed.org 0:5e1631496985 451 /* q now represents the packet to be sent */
root@mbed.org 0:5e1631496985 452 udphdr = (struct udp_hdr *)q->payload;
root@mbed.org 0:5e1631496985 453 udphdr->src = htons(pcb->local_port);
root@mbed.org 0:5e1631496985 454 udphdr->dest = htons(dst_port);
root@mbed.org 0:5e1631496985 455 /* in UDP, 0 checksum means 'no checksum' */
root@mbed.org 0:5e1631496985 456 udphdr->chksum = 0x0000;
root@mbed.org 0:5e1631496985 457
root@mbed.org 0:5e1631496985 458 /* PCB local address is IP_ANY_ADDR? */
root@mbed.org 0:5e1631496985 459 if (ip_addr_isany(&pcb->local_ip)) {
root@mbed.org 0:5e1631496985 460 /* use outgoing network interface IP address as source address */
root@mbed.org 0:5e1631496985 461 src_ip = &(netif->ip_addr);
root@mbed.org 0:5e1631496985 462 } else {
root@mbed.org 0:5e1631496985 463 /* check if UDP PCB local IP address is correct
root@mbed.org 0:5e1631496985 464 * this could be an old address if netif->ip_addr has changed */
root@mbed.org 0:5e1631496985 465 if (!ip_addr_cmp(&(pcb->local_ip), &(netif->ip_addr))) {
root@mbed.org 0:5e1631496985 466 /* local_ip doesn't match, drop the packet */
root@mbed.org 0:5e1631496985 467 if (q != p) {
root@mbed.org 0:5e1631496985 468 /* free the header pbuf */
root@mbed.org 0:5e1631496985 469 pbuf_free(q);
root@mbed.org 0:5e1631496985 470 q = NULL;
root@mbed.org 0:5e1631496985 471 /* p is still referenced by the caller, and will live on */
root@mbed.org 0:5e1631496985 472 }
root@mbed.org 0:5e1631496985 473 return ERR_VAL;
root@mbed.org 0:5e1631496985 474 }
root@mbed.org 0:5e1631496985 475 /* use UDP PCB local IP address as source address */
root@mbed.org 0:5e1631496985 476 src_ip = &(pcb->local_ip);
root@mbed.org 0:5e1631496985 477 }
root@mbed.org 0:5e1631496985 478
root@mbed.org 0:5e1631496985 479 LWIP_DEBUGF(UDP_DEBUG, ("udp_send: sending datagram of length %"U16_F"\n", q->tot_len));
root@mbed.org 0:5e1631496985 480
root@mbed.org 0:5e1631496985 481 #if LWIP_UDPLITE
root@mbed.org 0:5e1631496985 482 /* UDP Lite protocol? */
root@mbed.org 0:5e1631496985 483 if (pcb->flags & UDP_FLAGS_UDPLITE) {
root@mbed.org 0:5e1631496985 484 u16_t chklen, chklen_hdr;
root@mbed.org 0:5e1631496985 485 LWIP_DEBUGF(UDP_DEBUG, ("udp_send: UDP LITE packet length %"U16_F"\n", q->tot_len));
root@mbed.org 0:5e1631496985 486 /* set UDP message length in UDP header */
root@mbed.org 0:5e1631496985 487 chklen_hdr = chklen = pcb->chksum_len_tx;
root@mbed.org 0:5e1631496985 488 if ((chklen < sizeof(struct udp_hdr)) || (chklen > q->tot_len)) {
root@mbed.org 0:5e1631496985 489 if (chklen != 0) {
root@mbed.org 0:5e1631496985 490 LWIP_DEBUGF(UDP_DEBUG, ("udp_send: UDP LITE pcb->chksum_len is illegal: %"U16_F"\n", chklen));
root@mbed.org 0:5e1631496985 491 }
root@mbed.org 0:5e1631496985 492 /* For UDP-Lite, checksum length of 0 means checksum
root@mbed.org 0:5e1631496985 493 over the complete packet. (See RFC 3828 chap. 3.1)
root@mbed.org 0:5e1631496985 494 At least the UDP-Lite header must be covered by the
root@mbed.org 0:5e1631496985 495 checksum, therefore, if chksum_len has an illegal
root@mbed.org 0:5e1631496985 496 value, we generate the checksum over the complete
root@mbed.org 0:5e1631496985 497 packet to be safe. */
root@mbed.org 0:5e1631496985 498 chklen_hdr = 0;
root@mbed.org 0:5e1631496985 499 chklen = q->tot_len;
root@mbed.org 0:5e1631496985 500 }
root@mbed.org 0:5e1631496985 501 udphdr->len = htons(chklen_hdr);
root@mbed.org 0:5e1631496985 502 /* calculate checksum */
root@mbed.org 0:5e1631496985 503 #if CHECKSUM_GEN_UDP
root@mbed.org 0:5e1631496985 504 udphdr->chksum = inet_chksum_pseudo_partial(q, src_ip, dst_ip,
root@mbed.org 0:5e1631496985 505 IP_PROTO_UDPLITE, q->tot_len, chklen);
root@mbed.org 0:5e1631496985 506 /* chksum zero must become 0xffff, as zero means 'no checksum' */
root@mbed.org 0:5e1631496985 507 if (udphdr->chksum == 0x0000)
root@mbed.org 0:5e1631496985 508 udphdr->chksum = 0xffff;
root@mbed.org 0:5e1631496985 509 #endif /* CHECKSUM_CHECK_UDP */
root@mbed.org 0:5e1631496985 510 /* output to IP */
root@mbed.org 0:5e1631496985 511 LWIP_DEBUGF(UDP_DEBUG, ("udp_send: ip_output_if (,,,,IP_PROTO_UDPLITE,)\n"));
root@mbed.org 0:5e1631496985 512 #if LWIP_NETIF_HWADDRHINT
root@mbed.org 0:5e1631496985 513 netif->addr_hint = &(pcb->addr_hint);
root@mbed.org 0:5e1631496985 514 #endif /* LWIP_NETIF_HWADDRHINT*/
root@mbed.org 0:5e1631496985 515 err = ip_output_if(q, src_ip, dst_ip, pcb->ttl, pcb->tos, IP_PROTO_UDPLITE, netif);
root@mbed.org 0:5e1631496985 516 #if LWIP_NETIF_HWADDRHINT
root@mbed.org 0:5e1631496985 517 netif->addr_hint = NULL;
root@mbed.org 0:5e1631496985 518 #endif /* LWIP_NETIF_HWADDRHINT*/
root@mbed.org 0:5e1631496985 519 } else
root@mbed.org 0:5e1631496985 520 #endif /* LWIP_UDPLITE */
root@mbed.org 0:5e1631496985 521 { /* UDP */
root@mbed.org 0:5e1631496985 522 LWIP_DEBUGF(UDP_DEBUG, ("udp_send: UDP packet length %"U16_F"\n", q->tot_len));
root@mbed.org 0:5e1631496985 523 udphdr->len = htons(q->tot_len);
root@mbed.org 0:5e1631496985 524 /* calculate checksum */
root@mbed.org 0:5e1631496985 525 #if CHECKSUM_GEN_UDP
root@mbed.org 0:5e1631496985 526 if ((pcb->flags & UDP_FLAGS_NOCHKSUM) == 0) {
root@mbed.org 0:5e1631496985 527 udphdr->chksum = inet_chksum_pseudo(q, src_ip, dst_ip, IP_PROTO_UDP, q->tot_len);
root@mbed.org 0:5e1631496985 528 /* chksum zero must become 0xffff, as zero means 'no checksum' */
root@mbed.org 0:5e1631496985 529 if (udphdr->chksum == 0x0000) udphdr->chksum = 0xffff;
root@mbed.org 0:5e1631496985 530 }
root@mbed.org 0:5e1631496985 531 #endif /* CHECKSUM_CHECK_UDP */
root@mbed.org 0:5e1631496985 532 LWIP_DEBUGF(UDP_DEBUG, ("udp_send: UDP checksum 0x%04"X16_F"\n", udphdr->chksum));
root@mbed.org 0:5e1631496985 533 LWIP_DEBUGF(UDP_DEBUG, ("udp_send: ip_output_if (,,,,IP_PROTO_UDP,)\n"));
root@mbed.org 0:5e1631496985 534 /* output to IP */
root@mbed.org 0:5e1631496985 535 #if LWIP_NETIF_HWADDRHINT
root@mbed.org 0:5e1631496985 536 netif->addr_hint = &(pcb->addr_hint);
root@mbed.org 0:5e1631496985 537 #endif /* LWIP_NETIF_HWADDRHINT*/
root@mbed.org 0:5e1631496985 538 err = ip_output_if(q, src_ip, dst_ip, pcb->ttl, pcb->tos, IP_PROTO_UDP, netif);
root@mbed.org 0:5e1631496985 539 #if LWIP_NETIF_HWADDRHINT
root@mbed.org 0:5e1631496985 540 netif->addr_hint = NULL;
root@mbed.org 0:5e1631496985 541 #endif /* LWIP_NETIF_HWADDRHINT*/
root@mbed.org 0:5e1631496985 542 }
root@mbed.org 0:5e1631496985 543 /* TODO: must this be increased even if error occured? */
root@mbed.org 0:5e1631496985 544 snmp_inc_udpoutdatagrams();
root@mbed.org 0:5e1631496985 545
root@mbed.org 0:5e1631496985 546 /* did we chain a separate header pbuf earlier? */
root@mbed.org 0:5e1631496985 547 if (q != p) {
root@mbed.org 0:5e1631496985 548 /* free the header pbuf */
root@mbed.org 0:5e1631496985 549 pbuf_free(q);
root@mbed.org 0:5e1631496985 550 q = NULL;
root@mbed.org 0:5e1631496985 551 /* p is still referenced by the caller, and will live on */
root@mbed.org 0:5e1631496985 552 }
root@mbed.org 0:5e1631496985 553
root@mbed.org 0:5e1631496985 554 UDP_STATS_INC(udp.xmit);
root@mbed.org 0:5e1631496985 555 return err;
root@mbed.org 0:5e1631496985 556 }
root@mbed.org 0:5e1631496985 557
root@mbed.org 0:5e1631496985 558 /**
root@mbed.org 0:5e1631496985 559 * Bind an UDP PCB.
root@mbed.org 0:5e1631496985 560 *
root@mbed.org 0:5e1631496985 561 * @param pcb UDP PCB to be bound with a local address ipaddr and port.
root@mbed.org 0:5e1631496985 562 * @param ipaddr local IP address to bind with. Use IP_ADDR_ANY to
root@mbed.org 0:5e1631496985 563 * bind to all local interfaces.
root@mbed.org 0:5e1631496985 564 * @param port local UDP port to bind with. Use 0 to automatically bind
root@mbed.org 0:5e1631496985 565 * to a random port between UDP_LOCAL_PORT_RANGE_START and
root@mbed.org 0:5e1631496985 566 * UDP_LOCAL_PORT_RANGE_END.
root@mbed.org 0:5e1631496985 567 *
root@mbed.org 0:5e1631496985 568 * ipaddr & port are expected to be in the same byte order as in the pcb.
root@mbed.org 0:5e1631496985 569 *
root@mbed.org 0:5e1631496985 570 * @return lwIP error code.
root@mbed.org 0:5e1631496985 571 * - ERR_OK. Successful. No error occured.
root@mbed.org 0:5e1631496985 572 * - ERR_USE. The specified ipaddr and port are already bound to by
root@mbed.org 0:5e1631496985 573 * another UDP PCB.
root@mbed.org 0:5e1631496985 574 *
root@mbed.org 0:5e1631496985 575 * @see udp_disconnect()
root@mbed.org 0:5e1631496985 576 */
root@mbed.org 0:5e1631496985 577 err_t
root@mbed.org 0:5e1631496985 578 udp_bind(struct udp_pcb *pcb, struct ip_addr *ipaddr, u16_t port)
root@mbed.org 0:5e1631496985 579 {
root@mbed.org 0:5e1631496985 580 struct udp_pcb *ipcb;
root@mbed.org 0:5e1631496985 581 u8_t rebind;
root@mbed.org 0:5e1631496985 582
root@mbed.org 0:5e1631496985 583 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | 3, ("udp_bind(ipaddr = "));
root@mbed.org 0:5e1631496985 584 ip_addr_debug_print(UDP_DEBUG, ipaddr);
root@mbed.org 0:5e1631496985 585 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | 3, (", port = %"U16_F")\n", port));
root@mbed.org 0:5e1631496985 586
root@mbed.org 0:5e1631496985 587 rebind = 0;
root@mbed.org 0:5e1631496985 588 /* Check for double bind and rebind of the same pcb */
root@mbed.org 0:5e1631496985 589 for (ipcb = udp_pcbs; ipcb != NULL; ipcb = ipcb->next) {
root@mbed.org 0:5e1631496985 590 /* is this UDP PCB already on active list? */
root@mbed.org 0:5e1631496985 591 if (pcb == ipcb) {
root@mbed.org 0:5e1631496985 592 /* pcb may occur at most once in active list */
root@mbed.org 0:5e1631496985 593 LWIP_ASSERT("rebind == 0", rebind == 0);
root@mbed.org 0:5e1631496985 594 /* pcb already in list, just rebind */
root@mbed.org 0:5e1631496985 595 rebind = 1;
root@mbed.org 0:5e1631496985 596 }
root@mbed.org 0:5e1631496985 597
root@mbed.org 0:5e1631496985 598 /* this code does not allow upper layer to share a UDP port for
root@mbed.org 0:5e1631496985 599 listening to broadcast or multicast traffic (See SO_REUSE_ADDR and
root@mbed.org 0:5e1631496985 600 SO_REUSE_PORT under *BSD). TODO: See where it fits instead, OR
root@mbed.org 0:5e1631496985 601 combine with implementation of UDP PCB flags. Leon Woestenberg. */
root@mbed.org 0:5e1631496985 602 #ifdef LWIP_UDP_TODO
root@mbed.org 0:5e1631496985 603 /* port matches that of PCB in list? */
root@mbed.org 0:5e1631496985 604 else
root@mbed.org 0:5e1631496985 605 if ((ipcb->local_port == port) &&
root@mbed.org 0:5e1631496985 606 /* IP address matches, or one is IP_ADDR_ANY? */
root@mbed.org 0:5e1631496985 607 (ip_addr_isany(&(ipcb->local_ip)) ||
root@mbed.org 0:5e1631496985 608 ip_addr_isany(ipaddr) ||
root@mbed.org 0:5e1631496985 609 ip_addr_cmp(&(ipcb->local_ip), ipaddr))) {
root@mbed.org 0:5e1631496985 610 /* other PCB already binds to this local IP and port */
root@mbed.org 0:5e1631496985 611 LWIP_DEBUGF(UDP_DEBUG,
root@mbed.org 0:5e1631496985 612 ("udp_bind: local port %"U16_F" already bound by another pcb\n", port));
root@mbed.org 0:5e1631496985 613 return ERR_USE;
root@mbed.org 0:5e1631496985 614 }
root@mbed.org 0:5e1631496985 615 #endif
root@mbed.org 0:5e1631496985 616 }
root@mbed.org 0:5e1631496985 617
root@mbed.org 0:5e1631496985 618 ip_addr_set(&pcb->local_ip, ipaddr);
root@mbed.org 0:5e1631496985 619
root@mbed.org 0:5e1631496985 620 /* no port specified? */
root@mbed.org 0:5e1631496985 621 if (port == 0) {
root@mbed.org 0:5e1631496985 622 #ifndef UDP_LOCAL_PORT_RANGE_START
root@mbed.org 0:5e1631496985 623 #define UDP_LOCAL_PORT_RANGE_START 4096
root@mbed.org 0:5e1631496985 624 #define UDP_LOCAL_PORT_RANGE_END 0x7fff
root@mbed.org 0:5e1631496985 625 #endif
root@mbed.org 0:5e1631496985 626 port = UDP_LOCAL_PORT_RANGE_START;
root@mbed.org 0:5e1631496985 627 ipcb = udp_pcbs;
root@mbed.org 0:5e1631496985 628 while ((ipcb != NULL) && (port != UDP_LOCAL_PORT_RANGE_END)) {
root@mbed.org 0:5e1631496985 629 if (ipcb->local_port == port) {
root@mbed.org 0:5e1631496985 630 /* port is already used by another udp_pcb */
root@mbed.org 0:5e1631496985 631 port++;
root@mbed.org 0:5e1631496985 632 /* restart scanning all udp pcbs */
root@mbed.org 0:5e1631496985 633 ipcb = udp_pcbs;
root@mbed.org 0:5e1631496985 634 } else
root@mbed.org 0:5e1631496985 635 /* go on with next udp pcb */
root@mbed.org 0:5e1631496985 636 ipcb = ipcb->next;
root@mbed.org 0:5e1631496985 637 }
root@mbed.org 0:5e1631496985 638 if (ipcb != NULL) {
root@mbed.org 0:5e1631496985 639 /* no more ports available in local range */
root@mbed.org 0:5e1631496985 640 LWIP_DEBUGF(UDP_DEBUG, ("udp_bind: out of free UDP ports\n"));
root@mbed.org 0:5e1631496985 641 return ERR_USE;
root@mbed.org 0:5e1631496985 642 }
root@mbed.org 0:5e1631496985 643 }
root@mbed.org 0:5e1631496985 644 pcb->local_port = port;
root@mbed.org 0:5e1631496985 645 snmp_insert_udpidx_tree(pcb);
root@mbed.org 0:5e1631496985 646 /* pcb not active yet? */
root@mbed.org 0:5e1631496985 647 if (rebind == 0) {
root@mbed.org 0:5e1631496985 648 /* place the PCB on the active list if not already there */
root@mbed.org 0:5e1631496985 649 pcb->next = udp_pcbs;
root@mbed.org 0:5e1631496985 650 udp_pcbs = pcb;
root@mbed.org 0:5e1631496985 651 }
root@mbed.org 0:5e1631496985 652 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_STATE,
root@mbed.org 0:5e1631496985 653 ("udp_bind: bound to %"U16_F".%"U16_F".%"U16_F".%"U16_F", port %"U16_F"\n",
root@mbed.org 0:5e1631496985 654 (u16_t)((ntohl(pcb->local_ip.addr) >> 24) & 0xff),
root@mbed.org 0:5e1631496985 655 (u16_t)((ntohl(pcb->local_ip.addr) >> 16) & 0xff),
root@mbed.org 0:5e1631496985 656 (u16_t)((ntohl(pcb->local_ip.addr) >> 8) & 0xff),
root@mbed.org 0:5e1631496985 657 (u16_t)(ntohl(pcb->local_ip.addr) & 0xff), pcb->local_port));
root@mbed.org 0:5e1631496985 658 return ERR_OK;
root@mbed.org 0:5e1631496985 659 }
root@mbed.org 0:5e1631496985 660 /**
root@mbed.org 0:5e1631496985 661 * Connect an UDP PCB.
root@mbed.org 0:5e1631496985 662 *
root@mbed.org 0:5e1631496985 663 * This will associate the UDP PCB with the remote address.
root@mbed.org 0:5e1631496985 664 *
root@mbed.org 0:5e1631496985 665 * @param pcb UDP PCB to be connected with remote address ipaddr and port.
root@mbed.org 0:5e1631496985 666 * @param ipaddr remote IP address to connect with.
root@mbed.org 0:5e1631496985 667 * @param port remote UDP port to connect with.
root@mbed.org 0:5e1631496985 668 *
root@mbed.org 0:5e1631496985 669 * @return lwIP error code
root@mbed.org 0:5e1631496985 670 *
root@mbed.org 0:5e1631496985 671 * ipaddr & port are expected to be in the same byte order as in the pcb.
root@mbed.org 0:5e1631496985 672 *
root@mbed.org 0:5e1631496985 673 * The udp pcb is bound to a random local port if not already bound.
root@mbed.org 0:5e1631496985 674 *
root@mbed.org 0:5e1631496985 675 * @see udp_disconnect()
root@mbed.org 0:5e1631496985 676 */
root@mbed.org 0:5e1631496985 677 err_t
root@mbed.org 0:5e1631496985 678 udp_connect(struct udp_pcb *pcb, struct ip_addr *ipaddr, u16_t port)
root@mbed.org 0:5e1631496985 679 {
root@mbed.org 0:5e1631496985 680 struct udp_pcb *ipcb;
root@mbed.org 0:5e1631496985 681
root@mbed.org 0:5e1631496985 682 if (pcb->local_port == 0) {
root@mbed.org 0:5e1631496985 683 err_t err = udp_bind(pcb, &pcb->local_ip, pcb->local_port);
root@mbed.org 0:5e1631496985 684 if (err != ERR_OK)
root@mbed.org 0:5e1631496985 685 return err;
root@mbed.org 0:5e1631496985 686 }
root@mbed.org 0:5e1631496985 687
root@mbed.org 0:5e1631496985 688 ip_addr_set(&pcb->remote_ip, ipaddr);
root@mbed.org 0:5e1631496985 689 pcb->remote_port = port;
root@mbed.org 0:5e1631496985 690 pcb->flags |= UDP_FLAGS_CONNECTED;
root@mbed.org 0:5e1631496985 691 /** TODO: this functionality belongs in upper layers */
root@mbed.org 0:5e1631496985 692 #ifdef LWIP_UDP_TODO
root@mbed.org 0:5e1631496985 693 /* Nail down local IP for netconn_addr()/getsockname() */
root@mbed.org 0:5e1631496985 694 if (ip_addr_isany(&pcb->local_ip) && !ip_addr_isany(&pcb->remote_ip)) {
root@mbed.org 0:5e1631496985 695 struct netif *netif;
root@mbed.org 0:5e1631496985 696
root@mbed.org 0:5e1631496985 697 if ((netif = ip_route(&(pcb->remote_ip))) == NULL) {
root@mbed.org 0:5e1631496985 698 LWIP_DEBUGF(UDP_DEBUG, ("udp_connect: No route to 0x%lx\n", pcb->remote_ip.addr));
root@mbed.org 0:5e1631496985 699 UDP_STATS_INC(udp.rterr);
root@mbed.org 0:5e1631496985 700 return ERR_RTE;
root@mbed.org 0:5e1631496985 701 }
root@mbed.org 0:5e1631496985 702 /** TODO: this will bind the udp pcb locally, to the interface which
root@mbed.org 0:5e1631496985 703 is used to route output packets to the remote address. However, we
root@mbed.org 0:5e1631496985 704 might want to accept incoming packets on any interface! */
root@mbed.org 0:5e1631496985 705 pcb->local_ip = netif->ip_addr;
root@mbed.org 0:5e1631496985 706 } else if (ip_addr_isany(&pcb->remote_ip)) {
root@mbed.org 0:5e1631496985 707 pcb->local_ip.addr = 0;
root@mbed.org 0:5e1631496985 708 }
root@mbed.org 0:5e1631496985 709 #endif
root@mbed.org 0:5e1631496985 710 LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_STATE,
root@mbed.org 0:5e1631496985 711 ("udp_connect: connected to %"U16_F".%"U16_F".%"U16_F".%"U16_F",port %"U16_F"\n",
root@mbed.org 0:5e1631496985 712 (u16_t)((ntohl(pcb->remote_ip.addr) >> 24) & 0xff),
root@mbed.org 0:5e1631496985 713 (u16_t)((ntohl(pcb->remote_ip.addr) >> 16) & 0xff),
root@mbed.org 0:5e1631496985 714 (u16_t)((ntohl(pcb->remote_ip.addr) >> 8) & 0xff),
root@mbed.org 0:5e1631496985 715 (u16_t)(ntohl(pcb->remote_ip.addr) & 0xff), pcb->remote_port));
root@mbed.org 0:5e1631496985 716
root@mbed.org 0:5e1631496985 717 /* Insert UDP PCB into the list of active UDP PCBs. */
root@mbed.org 0:5e1631496985 718 for (ipcb = udp_pcbs; ipcb != NULL; ipcb = ipcb->next) {
root@mbed.org 0:5e1631496985 719 if (pcb == ipcb) {
root@mbed.org 0:5e1631496985 720 /* already on the list, just return */
root@mbed.org 0:5e1631496985 721 return ERR_OK;
root@mbed.org 0:5e1631496985 722 }
root@mbed.org 0:5e1631496985 723 }
root@mbed.org 0:5e1631496985 724 /* PCB not yet on the list, add PCB now */
root@mbed.org 0:5e1631496985 725 pcb->next = udp_pcbs;
root@mbed.org 0:5e1631496985 726 udp_pcbs = pcb;
root@mbed.org 0:5e1631496985 727 return ERR_OK;
root@mbed.org 0:5e1631496985 728 }
root@mbed.org 0:5e1631496985 729
root@mbed.org 0:5e1631496985 730 /**
root@mbed.org 0:5e1631496985 731 * Disconnect a UDP PCB
root@mbed.org 0:5e1631496985 732 *
root@mbed.org 0:5e1631496985 733 * @param pcb the udp pcb to disconnect.
root@mbed.org 0:5e1631496985 734 */
root@mbed.org 0:5e1631496985 735 void
root@mbed.org 0:5e1631496985 736 udp_disconnect(struct udp_pcb *pcb)
root@mbed.org 0:5e1631496985 737 {
root@mbed.org 0:5e1631496985 738 /* reset remote address association */
root@mbed.org 0:5e1631496985 739 ip_addr_set(&pcb->remote_ip, IP_ADDR_ANY);
root@mbed.org 0:5e1631496985 740 pcb->remote_port = 0;
root@mbed.org 0:5e1631496985 741 /* mark PCB as unconnected */
root@mbed.org 0:5e1631496985 742 pcb->flags &= ~UDP_FLAGS_CONNECTED;
root@mbed.org 0:5e1631496985 743 }
root@mbed.org 0:5e1631496985 744
root@mbed.org 0:5e1631496985 745 /**
root@mbed.org 0:5e1631496985 746 * Set a receive callback for a UDP PCB
root@mbed.org 0:5e1631496985 747 *
root@mbed.org 0:5e1631496985 748 * This callback will be called when receiving a datagram for the pcb.
root@mbed.org 0:5e1631496985 749 *
root@mbed.org 0:5e1631496985 750 * @param pcb the pcb for wich to set the recv callback
root@mbed.org 0:5e1631496985 751 * @param recv function pointer of the callback function
root@mbed.org 0:5e1631496985 752 * @param recv_arg additional argument to pass to the callback function
root@mbed.org 0:5e1631496985 753 */
root@mbed.org 0:5e1631496985 754 void
root@mbed.org 0:5e1631496985 755 udp_recv(struct udp_pcb *pcb,
root@mbed.org 0:5e1631496985 756 void (* recv)(void *arg, struct udp_pcb *upcb, struct pbuf *p,
root@mbed.org 0:5e1631496985 757 struct ip_addr *addr, u16_t port),
root@mbed.org 0:5e1631496985 758 void *recv_arg)
root@mbed.org 0:5e1631496985 759 {
root@mbed.org 0:5e1631496985 760 /* remember recv() callback and user data */
root@mbed.org 0:5e1631496985 761 pcb->recv = recv;
root@mbed.org 0:5e1631496985 762 pcb->recv_arg = recv_arg;
root@mbed.org 0:5e1631496985 763 }
root@mbed.org 0:5e1631496985 764
root@mbed.org 0:5e1631496985 765 /**
root@mbed.org 0:5e1631496985 766 * Remove an UDP PCB.
root@mbed.org 0:5e1631496985 767 *
root@mbed.org 0:5e1631496985 768 * @param pcb UDP PCB to be removed. The PCB is removed from the list of
root@mbed.org 0:5e1631496985 769 * UDP PCB's and the data structure is freed from memory.
root@mbed.org 0:5e1631496985 770 *
root@mbed.org 0:5e1631496985 771 * @see udp_new()
root@mbed.org 0:5e1631496985 772 */
root@mbed.org 0:5e1631496985 773 void
root@mbed.org 0:5e1631496985 774 udp_remove(struct udp_pcb *pcb)
root@mbed.org 0:5e1631496985 775 {
root@mbed.org 0:5e1631496985 776 struct udp_pcb *pcb2;
root@mbed.org 0:5e1631496985 777
root@mbed.org 0:5e1631496985 778 snmp_delete_udpidx_tree(pcb);
root@mbed.org 0:5e1631496985 779 /* pcb to be removed is first in list? */
root@mbed.org 0:5e1631496985 780 if (udp_pcbs == pcb) {
root@mbed.org 0:5e1631496985 781 /* make list start at 2nd pcb */
root@mbed.org 0:5e1631496985 782 udp_pcbs = udp_pcbs->next;
root@mbed.org 0:5e1631496985 783 /* pcb not 1st in list */
root@mbed.org 0:5e1631496985 784 } else
root@mbed.org 0:5e1631496985 785 for (pcb2 = udp_pcbs; pcb2 != NULL; pcb2 = pcb2->next) {
root@mbed.org 0:5e1631496985 786 /* find pcb in udp_pcbs list */
root@mbed.org 0:5e1631496985 787 if (pcb2->next != NULL && pcb2->next == pcb) {
root@mbed.org 0:5e1631496985 788 /* remove pcb from list */
root@mbed.org 0:5e1631496985 789 pcb2->next = pcb->next;
root@mbed.org 0:5e1631496985 790 }
root@mbed.org 0:5e1631496985 791 }
root@mbed.org 0:5e1631496985 792 memp_free(MEMP_UDP_PCB, pcb);
root@mbed.org 0:5e1631496985 793 }
root@mbed.org 0:5e1631496985 794
root@mbed.org 0:5e1631496985 795 /**
root@mbed.org 0:5e1631496985 796 * Create a UDP PCB.
root@mbed.org 0:5e1631496985 797 *
root@mbed.org 0:5e1631496985 798 * @return The UDP PCB which was created. NULL if the PCB data structure
root@mbed.org 0:5e1631496985 799 * could not be allocated.
root@mbed.org 0:5e1631496985 800 *
root@mbed.org 0:5e1631496985 801 * @see udp_remove()
root@mbed.org 0:5e1631496985 802 */
root@mbed.org 0:5e1631496985 803 struct udp_pcb *
root@mbed.org 0:5e1631496985 804 udp_new(void)
root@mbed.org 0:5e1631496985 805 {
root@mbed.org 0:5e1631496985 806 struct udp_pcb *pcb;
root@mbed.org 0:5e1631496985 807 pcb = (struct udp_pcb *)memp_malloc(MEMP_UDP_PCB);
root@mbed.org 0:5e1631496985 808 /* could allocate UDP PCB? */
root@mbed.org 0:5e1631496985 809 if (pcb != NULL) {
root@mbed.org 0:5e1631496985 810 /* UDP Lite: by initializing to all zeroes, chksum_len is set to 0
root@mbed.org 0:5e1631496985 811 * which means checksum is generated over the whole datagram per default
root@mbed.org 0:5e1631496985 812 * (recommended as default by RFC 3828). */
root@mbed.org 0:5e1631496985 813 /* initialize PCB to all zeroes */
root@mbed.org 0:5e1631496985 814 memset(pcb, 0, sizeof(struct udp_pcb));
root@mbed.org 0:5e1631496985 815 pcb->ttl = UDP_TTL;
root@mbed.org 0:5e1631496985 816 }
root@mbed.org 0:5e1631496985 817 return pcb;
root@mbed.org 0:5e1631496985 818 }
root@mbed.org 0:5e1631496985 819
root@mbed.org 0:5e1631496985 820 #if UDP_DEBUG
root@mbed.org 0:5e1631496985 821 /**
root@mbed.org 0:5e1631496985 822 * Print UDP header information for debug purposes.
root@mbed.org 0:5e1631496985 823 *
root@mbed.org 0:5e1631496985 824 * @param udphdr pointer to the udp header in memory.
root@mbed.org 0:5e1631496985 825 */
root@mbed.org 0:5e1631496985 826 void
root@mbed.org 0:5e1631496985 827 udp_debug_print(struct udp_hdr *udphdr)
root@mbed.org 0:5e1631496985 828 {
root@mbed.org 0:5e1631496985 829 LWIP_DEBUGF(UDP_DEBUG, ("UDP header:\n"));
root@mbed.org 0:5e1631496985 830 LWIP_DEBUGF(UDP_DEBUG, ("+-------------------------------+\n"));
root@mbed.org 0:5e1631496985 831 LWIP_DEBUGF(UDP_DEBUG, ("| %5"U16_F" | %5"U16_F" | (src port, dest port)\n",
root@mbed.org 0:5e1631496985 832 ntohs(udphdr->src), ntohs(udphdr->dest)));
root@mbed.org 0:5e1631496985 833 LWIP_DEBUGF(UDP_DEBUG, ("+-------------------------------+\n"));
root@mbed.org 0:5e1631496985 834 LWIP_DEBUGF(UDP_DEBUG, ("| %5"U16_F" | 0x%04"X16_F" | (len, chksum)\n",
root@mbed.org 0:5e1631496985 835 ntohs(udphdr->len), ntohs(udphdr->chksum)));
root@mbed.org 0:5e1631496985 836 LWIP_DEBUGF(UDP_DEBUG, ("+-------------------------------+\n"));
root@mbed.org 0:5e1631496985 837 }
root@mbed.org 0:5e1631496985 838 #endif /* UDP_DEBUG */
root@mbed.org 0:5e1631496985 839
root@mbed.org 0:5e1631496985 840 #endif /* LWIP_UDP */