1 | /**
|
---|
2 | * @file
|
---|
3 | * User Datagram Protocol module\n
|
---|
4 | * The code for the User Datagram Protocol UDP & UDPLite (RFC 3828).\n
|
---|
5 | * See also @ref udp_raw
|
---|
6 | *
|
---|
7 | * @defgroup udp_raw UDP
|
---|
8 | * @ingroup callbackstyle_api
|
---|
9 | * User Datagram Protocol module\n
|
---|
10 | * @see @ref api
|
---|
11 | */
|
---|
12 |
|
---|
13 | /*
|
---|
14 | * Copyright (c) 2001-2004 Swedish Institute of Computer Science.
|
---|
15 | * All rights reserved.
|
---|
16 | *
|
---|
17 | * Redistribution and use in source and binary forms, with or without modification,
|
---|
18 | * are permitted provided that the following conditions are met:
|
---|
19 | *
|
---|
20 | * 1. Redistributions of source code must retain the above copyright notice,
|
---|
21 | * this list of conditions and the following disclaimer.
|
---|
22 | * 2. Redistributions in binary form must reproduce the above copyright notice,
|
---|
23 | * this list of conditions and the following disclaimer in the documentation
|
---|
24 | * and/or other materials provided with the distribution.
|
---|
25 | * 3. The name of the author may not be used to endorse or promote products
|
---|
26 | * derived from this software without specific prior written permission.
|
---|
27 | *
|
---|
28 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
---|
29 | * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
---|
30 | * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
|
---|
31 | * SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
---|
32 | * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
|
---|
33 | * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
---|
34 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
---|
35 | * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
|
---|
36 | * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
|
---|
37 | * OF SUCH DAMAGE.
|
---|
38 | *
|
---|
39 | * This file is part of the lwIP TCP/IP stack.
|
---|
40 | *
|
---|
41 | * Author: Adam Dunkels <adam@sics.se>
|
---|
42 | *
|
---|
43 | */
|
---|
44 |
|
---|
45 | /* @todo Check the use of '(struct udp_pcb).chksum_len_rx'!
|
---|
46 | */
|
---|
47 |
|
---|
48 | #include "lwip/opt.h"
|
---|
49 |
|
---|
50 | #if LWIP_UDP /* don't build if not configured for use in lwipopts.h */
|
---|
51 |
|
---|
52 | #include "lwip/udp.h"
|
---|
53 | #include "lwip/def.h"
|
---|
54 | #include "lwip/memp.h"
|
---|
55 | #include "lwip/inet_chksum.h"
|
---|
56 | #include "lwip/ip_addr.h"
|
---|
57 | #include "lwip/ip6.h"
|
---|
58 | #include "lwip/ip6_addr.h"
|
---|
59 | #include "lwip/netif.h"
|
---|
60 | #include "lwip/icmp.h"
|
---|
61 | #include "lwip/icmp6.h"
|
---|
62 | #include "lwip/stats.h"
|
---|
63 | #include "lwip/snmp.h"
|
---|
64 | #include "lwip/dhcp.h"
|
---|
65 |
|
---|
66 | #include <string.h>
|
---|
67 |
|
---|
68 | #ifndef UDP_LOCAL_PORT_RANGE_START
|
---|
69 | /* From http://www.iana.org/assignments/port-numbers:
|
---|
70 | "The Dynamic and/or Private Ports are those from 49152 through 65535" */
|
---|
71 | #define UDP_LOCAL_PORT_RANGE_START 0xc000
|
---|
72 | #define UDP_LOCAL_PORT_RANGE_END 0xffff
|
---|
73 | #define UDP_ENSURE_LOCAL_PORT_RANGE(port) ((u16_t)(((port) & (u16_t)~UDP_LOCAL_PORT_RANGE_START) + UDP_LOCAL_PORT_RANGE_START))
|
---|
74 | #endif
|
---|
75 |
|
---|
76 | /* last local UDP port */
|
---|
77 | static u16_t udp_port = UDP_LOCAL_PORT_RANGE_START;
|
---|
78 |
|
---|
79 | /* The list of UDP PCBs */
|
---|
80 | /* exported in udp.h (was static) */
|
---|
81 | struct udp_pcb *udp_pcbs;
|
---|
82 |
|
---|
83 | /**
|
---|
84 | * Initialize this module.
|
---|
85 | */
|
---|
86 | void
|
---|
87 | udp_init(void)
|
---|
88 | {
|
---|
89 | #ifdef LWIP_RAND
|
---|
90 | udp_port = UDP_ENSURE_LOCAL_PORT_RANGE(LWIP_RAND());
|
---|
91 | #endif /* LWIP_RAND */
|
---|
92 | }
|
---|
93 |
|
---|
94 | /**
|
---|
95 | * Allocate a new local UDP port.
|
---|
96 | *
|
---|
97 | * @return a new (free) local UDP port number
|
---|
98 | */
|
---|
99 | static u16_t
|
---|
100 | udp_new_port(void)
|
---|
101 | {
|
---|
102 | u16_t n = 0;
|
---|
103 | struct udp_pcb *pcb;
|
---|
104 |
|
---|
105 | again:
|
---|
106 | if (udp_port++ == UDP_LOCAL_PORT_RANGE_END) {
|
---|
107 | udp_port = UDP_LOCAL_PORT_RANGE_START;
|
---|
108 | }
|
---|
109 | /* Check all PCBs. */
|
---|
110 | for (pcb = udp_pcbs; pcb != NULL; pcb = pcb->next) {
|
---|
111 | if (pcb->local_port == udp_port) {
|
---|
112 | if (++n > (UDP_LOCAL_PORT_RANGE_END - UDP_LOCAL_PORT_RANGE_START)) {
|
---|
113 | return 0;
|
---|
114 | }
|
---|
115 | goto again;
|
---|
116 | }
|
---|
117 | }
|
---|
118 | return udp_port;
|
---|
119 | }
|
---|
120 |
|
---|
121 | /** Common code to see if the current input packet matches the pcb
|
---|
122 | * (current input packet is accessed via ip(4/6)_current_* macros)
|
---|
123 | *
|
---|
124 | * @param pcb pcb to check
|
---|
125 | * @param inp network interface on which the datagram was received (only used for IPv4)
|
---|
126 | * @param broadcast 1 if his is an IPv4 broadcast (global or subnet-only), 0 otherwise (only used for IPv4)
|
---|
127 | * @return 1 on match, 0 otherwise
|
---|
128 | */
|
---|
129 | static u8_t
|
---|
130 | udp_input_local_match(struct udp_pcb *pcb, struct netif *inp, u8_t broadcast)
|
---|
131 | {
|
---|
132 | LWIP_UNUSED_ARG(inp); /* in IPv6 only case */
|
---|
133 | LWIP_UNUSED_ARG(broadcast); /* in IPv6 only case */
|
---|
134 |
|
---|
135 | LWIP_ASSERT("udp_input_local_match: invalid pcb", pcb != NULL);
|
---|
136 | LWIP_ASSERT("udp_input_local_match: invalid netif", inp != NULL);
|
---|
137 |
|
---|
138 | /* check if PCB is bound to specific netif */
|
---|
139 | if ((pcb->netif_idx != NETIF_NO_INDEX) &&
|
---|
140 | (pcb->netif_idx != netif_get_index(ip_data.current_input_netif))) {
|
---|
141 | return 0;
|
---|
142 | }
|
---|
143 |
|
---|
144 | /* Dual-stack: PCBs listening to any IP type also listen to any IP address */
|
---|
145 | if (IP_IS_ANY_TYPE_VAL(pcb->local_ip)) {
|
---|
146 | #if LWIP_IPV4 && IP_SOF_BROADCAST_RECV
|
---|
147 | if ((broadcast != 0) && !ip_get_option(pcb, SOF_BROADCAST)) {
|
---|
148 | return 0;
|
---|
149 | }
|
---|
150 | #endif /* LWIP_IPV4 && IP_SOF_BROADCAST_RECV */
|
---|
151 | return 1;
|
---|
152 | }
|
---|
153 |
|
---|
154 | /* Only need to check PCB if incoming IP version matches PCB IP version */
|
---|
155 | if (IP_ADDR_PCB_VERSION_MATCH_EXACT(pcb, ip_current_dest_addr())) {
|
---|
156 | #if LWIP_IPV4
|
---|
157 | /* Special case: IPv4 broadcast: all or broadcasts in my subnet
|
---|
158 | * Note: broadcast variable can only be 1 if it is an IPv4 broadcast */
|
---|
159 | if (broadcast != 0) {
|
---|
160 | #if IP_SOF_BROADCAST_RECV
|
---|
161 | if (ip_get_option(pcb, SOF_BROADCAST))
|
---|
162 | #endif /* IP_SOF_BROADCAST_RECV */
|
---|
163 | {
|
---|
164 | if (ip4_addr_isany(ip_2_ip4(&pcb->local_ip)) ||
|
---|
165 | ((ip4_current_dest_addr()->addr == IPADDR_BROADCAST)) ||
|
---|
166 | ip4_addr_netcmp(ip_2_ip4(&pcb->local_ip), ip4_current_dest_addr(), netif_ip4_netmask(inp))) {
|
---|
167 | return 1;
|
---|
168 | }
|
---|
169 | }
|
---|
170 | } else
|
---|
171 | #endif /* LWIP_IPV4 */
|
---|
172 | /* Handle IPv4 and IPv6: all or exact match */
|
---|
173 | if (ip_addr_isany(&pcb->local_ip) || ip_addr_cmp(&pcb->local_ip, ip_current_dest_addr())) {
|
---|
174 | return 1;
|
---|
175 | }
|
---|
176 | }
|
---|
177 |
|
---|
178 | return 0;
|
---|
179 | }
|
---|
180 |
|
---|
181 | /**
|
---|
182 | * Process an incoming UDP datagram.
|
---|
183 | *
|
---|
184 | * Given an incoming UDP datagram (as a chain of pbufs) this function
|
---|
185 | * finds a corresponding UDP PCB and hands over the pbuf to the pcbs
|
---|
186 | * recv function. If no pcb is found or the datagram is incorrect, the
|
---|
187 | * pbuf is freed.
|
---|
188 | *
|
---|
189 | * @param p pbuf to be demultiplexed to a UDP PCB (p->payload pointing to the UDP header)
|
---|
190 | * @param inp network interface on which the datagram was received.
|
---|
191 | *
|
---|
192 | */
|
---|
193 | void
|
---|
194 | udp_input(struct pbuf *p, struct netif *inp)
|
---|
195 | {
|
---|
196 | struct udp_hdr *udphdr;
|
---|
197 | struct udp_pcb *pcb, *prev;
|
---|
198 | struct udp_pcb *uncon_pcb;
|
---|
199 | u16_t src, dest;
|
---|
200 | u8_t broadcast;
|
---|
201 | u8_t for_us = 0;
|
---|
202 |
|
---|
203 | LWIP_UNUSED_ARG(inp);
|
---|
204 |
|
---|
205 | LWIP_ASSERT_CORE_LOCKED();
|
---|
206 |
|
---|
207 | LWIP_ASSERT("udp_input: invalid pbuf", p != NULL);
|
---|
208 | LWIP_ASSERT("udp_input: invalid netif", inp != NULL);
|
---|
209 |
|
---|
210 | PERF_START;
|
---|
211 |
|
---|
212 | UDP_STATS_INC(udp.recv);
|
---|
213 |
|
---|
214 | /* Check minimum length (UDP header) */
|
---|
215 | if (p->len < UDP_HLEN) {
|
---|
216 | /* drop short packets */
|
---|
217 | LWIP_DEBUGF(UDP_DEBUG,
|
---|
218 | ("udp_input: short UDP datagram (%"U16_F" bytes) discarded\n", p->tot_len));
|
---|
219 | UDP_STATS_INC(udp.lenerr);
|
---|
220 | UDP_STATS_INC(udp.drop);
|
---|
221 | MIB2_STATS_INC(mib2.udpinerrors);
|
---|
222 | pbuf_free(p);
|
---|
223 | goto end;
|
---|
224 | }
|
---|
225 |
|
---|
226 | udphdr = (struct udp_hdr *)p->payload;
|
---|
227 |
|
---|
228 | /* is broadcast packet ? */
|
---|
229 | broadcast = ip_addr_isbroadcast(ip_current_dest_addr(), ip_current_netif());
|
---|
230 |
|
---|
231 | LWIP_DEBUGF(UDP_DEBUG, ("udp_input: received datagram of length %"U16_F"\n", p->tot_len));
|
---|
232 |
|
---|
233 | /* convert src and dest ports to host byte order */
|
---|
234 | src = lwip_ntohs(udphdr->src);
|
---|
235 | dest = lwip_ntohs(udphdr->dest);
|
---|
236 |
|
---|
237 | udp_debug_print(udphdr);
|
---|
238 |
|
---|
239 | /* print the UDP source and destination */
|
---|
240 | LWIP_DEBUGF(UDP_DEBUG, ("udp ("));
|
---|
241 | ip_addr_debug_print_val(UDP_DEBUG, *ip_current_dest_addr());
|
---|
242 | LWIP_DEBUGF(UDP_DEBUG, (", %"U16_F") <-- (", lwip_ntohs(udphdr->dest)));
|
---|
243 | ip_addr_debug_print_val(UDP_DEBUG, *ip_current_src_addr());
|
---|
244 | LWIP_DEBUGF(UDP_DEBUG, (", %"U16_F")\n", lwip_ntohs(udphdr->src)));
|
---|
245 |
|
---|
246 | pcb = NULL;
|
---|
247 | prev = NULL;
|
---|
248 | uncon_pcb = NULL;
|
---|
249 | /* Iterate through the UDP pcb list for a matching pcb.
|
---|
250 | * 'Perfect match' pcbs (connected to the remote port & ip address) are
|
---|
251 | * preferred. If no perfect match is found, the first unconnected pcb that
|
---|
252 | * matches the local port and ip address gets the datagram. */
|
---|
253 | for (pcb = udp_pcbs; pcb != NULL; pcb = pcb->next) {
|
---|
254 | /* print the PCB local and remote address */
|
---|
255 | LWIP_DEBUGF(UDP_DEBUG, ("pcb ("));
|
---|
256 | ip_addr_debug_print_val(UDP_DEBUG, pcb->local_ip);
|
---|
257 | LWIP_DEBUGF(UDP_DEBUG, (", %"U16_F") <-- (", pcb->local_port));
|
---|
258 | ip_addr_debug_print_val(UDP_DEBUG, pcb->remote_ip);
|
---|
259 | LWIP_DEBUGF(UDP_DEBUG, (", %"U16_F")\n", pcb->remote_port));
|
---|
260 |
|
---|
261 | /* compare PCB local addr+port to UDP destination addr+port */
|
---|
262 | if ((pcb->local_port == dest) &&
|
---|
263 | (udp_input_local_match(pcb, inp, broadcast) != 0)) {
|
---|
264 | if ((pcb->flags & UDP_FLAGS_CONNECTED) == 0) {
|
---|
265 | if (uncon_pcb == NULL) {
|
---|
266 | /* the first unconnected matching PCB */
|
---|
267 | uncon_pcb = pcb;
|
---|
268 | #if LWIP_IPV4
|
---|
269 | } else if (broadcast && ip4_current_dest_addr()->addr == IPADDR_BROADCAST) {
|
---|
270 | /* global broadcast address (only valid for IPv4; match was checked before) */
|
---|
271 | if (!IP_IS_V4_VAL(uncon_pcb->local_ip) || !ip4_addr_cmp(ip_2_ip4(&uncon_pcb->local_ip), netif_ip4_addr(inp))) {
|
---|
272 | /* uncon_pcb does not match the input netif, check this pcb */
|
---|
273 | if (IP_IS_V4_VAL(pcb->local_ip) && ip4_addr_cmp(ip_2_ip4(&pcb->local_ip), netif_ip4_addr(inp))) {
|
---|
274 | /* better match */
|
---|
275 | uncon_pcb = pcb;
|
---|
276 | }
|
---|
277 | }
|
---|
278 | #endif /* LWIP_IPV4 */
|
---|
279 | }
|
---|
280 | #if SO_REUSE
|
---|
281 | else if (!ip_addr_isany(&pcb->local_ip)) {
|
---|
282 | /* prefer specific IPs over catch-all */
|
---|
283 | uncon_pcb = pcb;
|
---|
284 | }
|
---|
285 | #endif /* SO_REUSE */
|
---|
286 | }
|
---|
287 |
|
---|
288 | /* compare PCB remote addr+port to UDP source addr+port */
|
---|
289 | if ((pcb->remote_port == src) &&
|
---|
290 | (ip_addr_isany_val(pcb->remote_ip) ||
|
---|
291 | ip_addr_cmp(&pcb->remote_ip, ip_current_src_addr()))) {
|
---|
292 | /* the first fully matching PCB */
|
---|
293 | if (prev != NULL) {
|
---|
294 | /* move the pcb to the front of udp_pcbs so that is
|
---|
295 | found faster next time */
|
---|
296 | prev->next = pcb->next;
|
---|
297 | pcb->next = udp_pcbs;
|
---|
298 | udp_pcbs = pcb;
|
---|
299 | } else {
|
---|
300 | UDP_STATS_INC(udp.cachehit);
|
---|
301 | }
|
---|
302 | break;
|
---|
303 | }
|
---|
304 | }
|
---|
305 |
|
---|
306 | prev = pcb;
|
---|
307 | }
|
---|
308 | /* no fully matching pcb found? then look for an unconnected pcb */
|
---|
309 | if (pcb == NULL) {
|
---|
310 | pcb = uncon_pcb;
|
---|
311 | }
|
---|
312 |
|
---|
313 | /* Check checksum if this is a match or if it was directed at us. */
|
---|
314 | if (pcb != NULL) {
|
---|
315 | for_us = 1;
|
---|
316 | } else {
|
---|
317 | #if LWIP_IPV6
|
---|
318 | if (ip_current_is_v6()) {
|
---|
319 | for_us = netif_get_ip6_addr_match(inp, ip6_current_dest_addr()) >= 0;
|
---|
320 | }
|
---|
321 | #endif /* LWIP_IPV6 */
|
---|
322 | #if LWIP_IPV4
|
---|
323 | if (!ip_current_is_v6()) {
|
---|
324 | for_us = ip4_addr_cmp(netif_ip4_addr(inp), ip4_current_dest_addr());
|
---|
325 | }
|
---|
326 | #endif /* LWIP_IPV4 */
|
---|
327 | }
|
---|
328 |
|
---|
329 | if (for_us) {
|
---|
330 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE, ("udp_input: calculating checksum\n"));
|
---|
331 | #if CHECKSUM_CHECK_UDP
|
---|
332 | IF__NETIF_CHECKSUM_ENABLED(inp, NETIF_CHECKSUM_CHECK_UDP) {
|
---|
333 | #if LWIP_UDPLITE
|
---|
334 | if (ip_current_header_proto() == IP_PROTO_UDPLITE) {
|
---|
335 | /* Do the UDP Lite checksum */
|
---|
336 | u16_t chklen = lwip_ntohs(udphdr->len);
|
---|
337 | if (chklen < sizeof(struct udp_hdr)) {
|
---|
338 | if (chklen == 0) {
|
---|
339 | /* For UDP-Lite, checksum length of 0 means checksum
|
---|
340 | over the complete packet (See RFC 3828 chap. 3.1) */
|
---|
341 | chklen = p->tot_len;
|
---|
342 | } else {
|
---|
343 | /* At least the UDP-Lite header must be covered by the
|
---|
344 | checksum! (Again, see RFC 3828 chap. 3.1) */
|
---|
345 | goto chkerr;
|
---|
346 | }
|
---|
347 | }
|
---|
348 | if (ip_chksum_pseudo_partial(p, IP_PROTO_UDPLITE,
|
---|
349 | p->tot_len, chklen,
|
---|
350 | ip_current_src_addr(), ip_current_dest_addr()) != 0) {
|
---|
351 | goto chkerr;
|
---|
352 | }
|
---|
353 | } else
|
---|
354 | #endif /* LWIP_UDPLITE */
|
---|
355 | {
|
---|
356 | if (udphdr->chksum != 0) {
|
---|
357 | if (ip_chksum_pseudo(p, IP_PROTO_UDP, p->tot_len,
|
---|
358 | ip_current_src_addr(),
|
---|
359 | ip_current_dest_addr()) != 0) {
|
---|
360 | goto chkerr;
|
---|
361 | }
|
---|
362 | }
|
---|
363 | }
|
---|
364 | }
|
---|
365 | #endif /* CHECKSUM_CHECK_UDP */
|
---|
366 | if (pbuf_remove_header(p, UDP_HLEN)) {
|
---|
367 | /* Can we cope with this failing? Just assert for now */
|
---|
368 | LWIP_ASSERT("pbuf_remove_header failed\n", 0);
|
---|
369 | UDP_STATS_INC(udp.drop);
|
---|
370 | MIB2_STATS_INC(mib2.udpinerrors);
|
---|
371 | pbuf_free(p);
|
---|
372 | goto end;
|
---|
373 | }
|
---|
374 |
|
---|
375 | if (pcb != NULL) {
|
---|
376 | MIB2_STATS_INC(mib2.udpindatagrams);
|
---|
377 | #if SO_REUSE && SO_REUSE_RXTOALL
|
---|
378 | if (ip_get_option(pcb, SOF_REUSEADDR) &&
|
---|
379 | (broadcast || ip_addr_ismulticast(ip_current_dest_addr()))) {
|
---|
380 | /* pass broadcast- or multicast packets to all multicast pcbs
|
---|
381 | if SOF_REUSEADDR is set on the first match */
|
---|
382 | struct udp_pcb *mpcb;
|
---|
383 | for (mpcb = udp_pcbs; mpcb != NULL; mpcb = mpcb->next) {
|
---|
384 | if (mpcb != pcb) {
|
---|
385 | /* compare PCB local addr+port to UDP destination addr+port */
|
---|
386 | if ((mpcb->local_port == dest) &&
|
---|
387 | (udp_input_local_match(mpcb, inp, broadcast) != 0)) {
|
---|
388 | /* pass a copy of the packet to all local matches */
|
---|
389 | if (mpcb->recv != NULL) {
|
---|
390 | struct pbuf *q;
|
---|
391 | q = pbuf_clone(PBUF_RAW, PBUF_POOL, p);
|
---|
392 | if (q != NULL) {
|
---|
393 | mpcb->recv(mpcb->recv_arg, mpcb, q, ip_current_src_addr(), src);
|
---|
394 | }
|
---|
395 | }
|
---|
396 | }
|
---|
397 | }
|
---|
398 | }
|
---|
399 | }
|
---|
400 | #endif /* SO_REUSE && SO_REUSE_RXTOALL */
|
---|
401 | /* callback */
|
---|
402 | if (pcb->recv != NULL) {
|
---|
403 | /* now the recv function is responsible for freeing p */
|
---|
404 | pcb->recv(pcb->recv_arg, pcb, p, ip_current_src_addr(), src);
|
---|
405 | } else {
|
---|
406 | /* no recv function registered? then we have to free the pbuf! */
|
---|
407 | pbuf_free(p);
|
---|
408 | goto end;
|
---|
409 | }
|
---|
410 | } else {
|
---|
411 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE, ("udp_input: not for us.\n"));
|
---|
412 |
|
---|
413 | #if LWIP_ICMP || LWIP_ICMP6
|
---|
414 | /* No match was found, send ICMP destination port unreachable unless
|
---|
415 | destination address was broadcast/multicast. */
|
---|
416 | if (!broadcast && !ip_addr_ismulticast(ip_current_dest_addr())) {
|
---|
417 | /* move payload pointer back to ip header */
|
---|
418 | pbuf_header_force(p, (s16_t)(ip_current_header_tot_len() + UDP_HLEN));
|
---|
419 | icmp_port_unreach(ip_current_is_v6(), p);
|
---|
420 | }
|
---|
421 | #endif /* LWIP_ICMP || LWIP_ICMP6 */
|
---|
422 | UDP_STATS_INC(udp.proterr);
|
---|
423 | UDP_STATS_INC(udp.drop);
|
---|
424 | MIB2_STATS_INC(mib2.udpnoports);
|
---|
425 | pbuf_free(p);
|
---|
426 | }
|
---|
427 | } else {
|
---|
428 | pbuf_free(p);
|
---|
429 | }
|
---|
430 | end:
|
---|
431 | PERF_STOP("udp_input");
|
---|
432 | return;
|
---|
433 | #if CHECKSUM_CHECK_UDP
|
---|
434 | chkerr:
|
---|
435 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_LEVEL_SERIOUS,
|
---|
436 | ("udp_input: UDP (or UDP Lite) datagram discarded due to failing checksum\n"));
|
---|
437 | UDP_STATS_INC(udp.chkerr);
|
---|
438 | UDP_STATS_INC(udp.drop);
|
---|
439 | MIB2_STATS_INC(mib2.udpinerrors);
|
---|
440 | pbuf_free(p);
|
---|
441 | PERF_STOP("udp_input");
|
---|
442 | #endif /* CHECKSUM_CHECK_UDP */
|
---|
443 | }
|
---|
444 |
|
---|
445 | /**
|
---|
446 | * @ingroup udp_raw
|
---|
447 | * Sends the pbuf p using UDP. The pbuf is not deallocated.
|
---|
448 | *
|
---|
449 | *
|
---|
450 | * @param pcb UDP PCB used to send the data.
|
---|
451 | * @param p chain of pbuf's to be sent.
|
---|
452 | *
|
---|
453 | * The datagram will be sent to the current remote_ip & remote_port
|
---|
454 | * stored in pcb. If the pcb is not bound to a port, it will
|
---|
455 | * automatically be bound to a random port.
|
---|
456 | *
|
---|
457 | * @return lwIP error code.
|
---|
458 | * - ERR_OK. Successful. No error occurred.
|
---|
459 | * - ERR_MEM. Out of memory.
|
---|
460 | * - ERR_RTE. Could not find route to destination address.
|
---|
461 | * - ERR_VAL. No PCB or PCB is dual-stack
|
---|
462 | * - More errors could be returned by lower protocol layers.
|
---|
463 | *
|
---|
464 | * @see udp_disconnect() udp_sendto()
|
---|
465 | */
|
---|
466 | err_t
|
---|
467 | udp_send(struct udp_pcb *pcb, struct pbuf *p)
|
---|
468 | {
|
---|
469 | LWIP_ERROR("udp_send: invalid pcb", pcb != NULL, return ERR_ARG);
|
---|
470 | LWIP_ERROR("udp_send: invalid pbuf", p != NULL, return ERR_ARG);
|
---|
471 |
|
---|
472 | if (IP_IS_ANY_TYPE_VAL(pcb->remote_ip)) {
|
---|
473 | return ERR_VAL;
|
---|
474 | }
|
---|
475 |
|
---|
476 | /* send to the packet using remote ip and port stored in the pcb */
|
---|
477 | return udp_sendto(pcb, p, &pcb->remote_ip, pcb->remote_port);
|
---|
478 | }
|
---|
479 |
|
---|
480 | #if LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP
|
---|
481 | /** @ingroup udp_raw
|
---|
482 | * Same as udp_send() but with checksum
|
---|
483 | */
|
---|
484 | err_t
|
---|
485 | udp_send_chksum(struct udp_pcb *pcb, struct pbuf *p,
|
---|
486 | u8_t have_chksum, u16_t chksum)
|
---|
487 | {
|
---|
488 | LWIP_ERROR("udp_send_chksum: invalid pcb", pcb != NULL, return ERR_ARG);
|
---|
489 | LWIP_ERROR("udp_send_chksum: invalid pbuf", p != NULL, return ERR_ARG);
|
---|
490 |
|
---|
491 | if (IP_IS_ANY_TYPE_VAL(pcb->remote_ip)) {
|
---|
492 | return ERR_VAL;
|
---|
493 | }
|
---|
494 |
|
---|
495 | /* send to the packet using remote ip and port stored in the pcb */
|
---|
496 | return udp_sendto_chksum(pcb, p, &pcb->remote_ip, pcb->remote_port,
|
---|
497 | have_chksum, chksum);
|
---|
498 | }
|
---|
499 | #endif /* LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP */
|
---|
500 |
|
---|
501 | /**
|
---|
502 | * @ingroup udp_raw
|
---|
503 | * Send data to a specified address using UDP.
|
---|
504 | *
|
---|
505 | * @param pcb UDP PCB used to send the data.
|
---|
506 | * @param p chain of pbuf's to be sent.
|
---|
507 | * @param dst_ip Destination IP address.
|
---|
508 | * @param dst_port Destination UDP port.
|
---|
509 | *
|
---|
510 | * dst_ip & dst_port are expected to be in the same byte order as in the pcb.
|
---|
511 | *
|
---|
512 | * If the PCB already has a remote address association, it will
|
---|
513 | * be restored after the data is sent.
|
---|
514 | *
|
---|
515 | * @return lwIP error code (@see udp_send for possible error codes)
|
---|
516 | *
|
---|
517 | * @see udp_disconnect() udp_send()
|
---|
518 | */
|
---|
519 | err_t
|
---|
520 | udp_sendto(struct udp_pcb *pcb, struct pbuf *p,
|
---|
521 | const ip_addr_t *dst_ip, u16_t dst_port)
|
---|
522 | {
|
---|
523 | #if LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP
|
---|
524 | return udp_sendto_chksum(pcb, p, dst_ip, dst_port, 0, 0);
|
---|
525 | }
|
---|
526 |
|
---|
527 | /** @ingroup udp_raw
|
---|
528 | * Same as udp_sendto(), but with checksum */
|
---|
529 | err_t
|
---|
530 | udp_sendto_chksum(struct udp_pcb *pcb, struct pbuf *p, const ip_addr_t *dst_ip,
|
---|
531 | u16_t dst_port, u8_t have_chksum, u16_t chksum)
|
---|
532 | {
|
---|
533 | #endif /* LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP */
|
---|
534 | struct netif *netif;
|
---|
535 |
|
---|
536 | LWIP_ERROR("udp_sendto: invalid pcb", pcb != NULL, return ERR_ARG);
|
---|
537 | LWIP_ERROR("udp_sendto: invalid pbuf", p != NULL, return ERR_ARG);
|
---|
538 | LWIP_ERROR("udp_sendto: invalid dst_ip", dst_ip != NULL, return ERR_ARG);
|
---|
539 |
|
---|
540 | if (!IP_ADDR_PCB_VERSION_MATCH(pcb, dst_ip)) {
|
---|
541 | return ERR_VAL;
|
---|
542 | }
|
---|
543 |
|
---|
544 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE, ("udp_send\n"));
|
---|
545 |
|
---|
546 | if (pcb->netif_idx != NETIF_NO_INDEX) {
|
---|
547 | netif = netif_get_by_index(pcb->netif_idx);
|
---|
548 | } else {
|
---|
549 | #if LWIP_MULTICAST_TX_OPTIONS
|
---|
550 | netif = NULL;
|
---|
551 | if (ip_addr_ismulticast(dst_ip)) {
|
---|
552 | /* For IPv6, the interface to use for packets with a multicast destination
|
---|
553 | * is specified using an interface index. The same approach may be used for
|
---|
554 | * IPv4 as well, in which case it overrides the IPv4 multicast override
|
---|
555 | * address below. Here we have to look up the netif by going through the
|
---|
556 | * list, but by doing so we skip a route lookup. If the interface index has
|
---|
557 | * gone stale, we fall through and do the regular route lookup after all. */
|
---|
558 | if (pcb->mcast_ifindex != NETIF_NO_INDEX) {
|
---|
559 | netif = netif_get_by_index(pcb->mcast_ifindex);
|
---|
560 | }
|
---|
561 | #if LWIP_IPV4
|
---|
562 | else
|
---|
563 | #if LWIP_IPV6
|
---|
564 | if (IP_IS_V4(dst_ip))
|
---|
565 | #endif /* LWIP_IPV6 */
|
---|
566 | {
|
---|
567 | /* IPv4 does not use source-based routing by default, so we use an
|
---|
568 | administratively selected interface for multicast by default.
|
---|
569 | However, this can be overridden by setting an interface address
|
---|
570 | in pcb->mcast_ip4 that is used for routing. If this routing lookup
|
---|
571 | fails, we try regular routing as though no override was set. */
|
---|
572 | if (!ip4_addr_isany_val(pcb->mcast_ip4) &&
|
---|
573 | !ip4_addr_cmp(&pcb->mcast_ip4, IP4_ADDR_BROADCAST)) {
|
---|
574 | netif = ip4_route_src(ip_2_ip4(&pcb->local_ip), &pcb->mcast_ip4);
|
---|
575 | }
|
---|
576 | }
|
---|
577 | #endif /* LWIP_IPV4 */
|
---|
578 | }
|
---|
579 |
|
---|
580 | if (netif == NULL)
|
---|
581 | #endif /* LWIP_MULTICAST_TX_OPTIONS */
|
---|
582 | {
|
---|
583 | /* find the outgoing network interface for this packet */
|
---|
584 | netif = ip_route(&pcb->local_ip, dst_ip);
|
---|
585 | }
|
---|
586 | }
|
---|
587 |
|
---|
588 | /* no outgoing network interface could be found? */
|
---|
589 | if (netif == NULL) {
|
---|
590 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_LEVEL_SERIOUS, ("udp_send: No route to "));
|
---|
591 | ip_addr_debug_print(UDP_DEBUG | LWIP_DBG_LEVEL_SERIOUS, dst_ip);
|
---|
592 | LWIP_DEBUGF(UDP_DEBUG, ("\n"));
|
---|
593 | UDP_STATS_INC(udp.rterr);
|
---|
594 | return ERR_RTE;
|
---|
595 | }
|
---|
596 | #if LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP
|
---|
597 | return udp_sendto_if_chksum(pcb, p, dst_ip, dst_port, netif, have_chksum, chksum);
|
---|
598 | #else /* LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP */
|
---|
599 | return udp_sendto_if(pcb, p, dst_ip, dst_port, netif);
|
---|
600 | #endif /* LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP */
|
---|
601 | }
|
---|
602 |
|
---|
603 | /**
|
---|
604 | * @ingroup udp_raw
|
---|
605 | * Send data to a specified address using UDP.
|
---|
606 | * The netif used for sending can be specified.
|
---|
607 | *
|
---|
608 | * This function exists mainly for DHCP, to be able to send UDP packets
|
---|
609 | * on a netif that is still down.
|
---|
610 | *
|
---|
611 | * @param pcb UDP PCB used to send the data.
|
---|
612 | * @param p chain of pbuf's to be sent.
|
---|
613 | * @param dst_ip Destination IP address.
|
---|
614 | * @param dst_port Destination UDP port.
|
---|
615 | * @param netif the netif used for sending.
|
---|
616 | *
|
---|
617 | * dst_ip & dst_port are expected to be in the same byte order as in the pcb.
|
---|
618 | *
|
---|
619 | * @return lwIP error code (@see udp_send for possible error codes)
|
---|
620 | *
|
---|
621 | * @see udp_disconnect() udp_send()
|
---|
622 | */
|
---|
623 | err_t
|
---|
624 | udp_sendto_if(struct udp_pcb *pcb, struct pbuf *p,
|
---|
625 | const ip_addr_t *dst_ip, u16_t dst_port, struct netif *netif)
|
---|
626 | {
|
---|
627 | #if LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP
|
---|
628 | return udp_sendto_if_chksum(pcb, p, dst_ip, dst_port, netif, 0, 0);
|
---|
629 | }
|
---|
630 |
|
---|
631 | /** Same as udp_sendto_if(), but with checksum */
|
---|
632 | err_t
|
---|
633 | udp_sendto_if_chksum(struct udp_pcb *pcb, struct pbuf *p, const ip_addr_t *dst_ip,
|
---|
634 | u16_t dst_port, struct netif *netif, u8_t have_chksum,
|
---|
635 | u16_t chksum)
|
---|
636 | {
|
---|
637 | #endif /* LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP */
|
---|
638 | const ip_addr_t *src_ip;
|
---|
639 |
|
---|
640 | LWIP_ERROR("udp_sendto_if: invalid pcb", pcb != NULL, return ERR_ARG);
|
---|
641 | LWIP_ERROR("udp_sendto_if: invalid pbuf", p != NULL, return ERR_ARG);
|
---|
642 | LWIP_ERROR("udp_sendto_if: invalid dst_ip", dst_ip != NULL, return ERR_ARG);
|
---|
643 | LWIP_ERROR("udp_sendto_if: invalid netif", netif != NULL, return ERR_ARG);
|
---|
644 |
|
---|
645 | if (!IP_ADDR_PCB_VERSION_MATCH(pcb, dst_ip)) {
|
---|
646 | return ERR_VAL;
|
---|
647 | }
|
---|
648 |
|
---|
649 | /* PCB local address is IP_ANY_ADDR or multicast? */
|
---|
650 | #if LWIP_IPV6
|
---|
651 | if (IP_IS_V6(dst_ip)) {
|
---|
652 | if (ip6_addr_isany(ip_2_ip6(&pcb->local_ip)) ||
|
---|
653 | ip6_addr_ismulticast(ip_2_ip6(&pcb->local_ip))) {
|
---|
654 | src_ip = ip6_select_source_address(netif, ip_2_ip6(dst_ip));
|
---|
655 | if (src_ip == NULL) {
|
---|
656 | /* No suitable source address was found. */
|
---|
657 | return ERR_RTE;
|
---|
658 | }
|
---|
659 | } else {
|
---|
660 | /* use UDP PCB local IPv6 address as source address, if still valid. */
|
---|
661 | if (netif_get_ip6_addr_match(netif, ip_2_ip6(&pcb->local_ip)) < 0) {
|
---|
662 | /* Address isn't valid anymore. */
|
---|
663 | return ERR_RTE;
|
---|
664 | }
|
---|
665 | src_ip = &pcb->local_ip;
|
---|
666 | }
|
---|
667 | }
|
---|
668 | #endif /* LWIP_IPV6 */
|
---|
669 | #if LWIP_IPV4 && LWIP_IPV6
|
---|
670 | else
|
---|
671 | #endif /* LWIP_IPV4 && LWIP_IPV6 */
|
---|
672 | #if LWIP_IPV4
|
---|
673 | if (ip4_addr_isany(ip_2_ip4(&pcb->local_ip)) ||
|
---|
674 | ip4_addr_ismulticast(ip_2_ip4(&pcb->local_ip))) {
|
---|
675 | /* if the local_ip is any or multicast
|
---|
676 | * use the outgoing network interface IP address as source address */
|
---|
677 | src_ip = netif_ip_addr4(netif);
|
---|
678 | } else {
|
---|
679 | /* check if UDP PCB local IP address is correct
|
---|
680 | * this could be an old address if netif->ip_addr has changed */
|
---|
681 | if (!ip4_addr_cmp(ip_2_ip4(&(pcb->local_ip)), netif_ip4_addr(netif))) {
|
---|
682 | /* local_ip doesn't match, drop the packet */
|
---|
683 | return ERR_RTE;
|
---|
684 | }
|
---|
685 | /* use UDP PCB local IP address as source address */
|
---|
686 | src_ip = &pcb->local_ip;
|
---|
687 | }
|
---|
688 | #endif /* LWIP_IPV4 */
|
---|
689 | #if LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP
|
---|
690 | return udp_sendto_if_src_chksum(pcb, p, dst_ip, dst_port, netif, have_chksum, chksum, src_ip);
|
---|
691 | #else /* LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP */
|
---|
692 | return udp_sendto_if_src(pcb, p, dst_ip, dst_port, netif, src_ip);
|
---|
693 | #endif /* LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP */
|
---|
694 | }
|
---|
695 |
|
---|
696 | /** @ingroup udp_raw
|
---|
697 | * Same as @ref udp_sendto_if, but with source address */
|
---|
698 | err_t
|
---|
699 | udp_sendto_if_src(struct udp_pcb *pcb, struct pbuf *p,
|
---|
700 | const ip_addr_t *dst_ip, u16_t dst_port, struct netif *netif, const ip_addr_t *src_ip)
|
---|
701 | {
|
---|
702 | #if LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP
|
---|
703 | return udp_sendto_if_src_chksum(pcb, p, dst_ip, dst_port, netif, 0, 0, src_ip);
|
---|
704 | }
|
---|
705 |
|
---|
706 | /** Same as udp_sendto_if_src(), but with checksum */
|
---|
707 | err_t
|
---|
708 | udp_sendto_if_src_chksum(struct udp_pcb *pcb, struct pbuf *p, const ip_addr_t *dst_ip,
|
---|
709 | u16_t dst_port, struct netif *netif, u8_t have_chksum,
|
---|
710 | u16_t chksum, const ip_addr_t *src_ip)
|
---|
711 | {
|
---|
712 | #endif /* LWIP_CHECKSUM_ON_COPY && CHECKSUM_GEN_UDP */
|
---|
713 | struct udp_hdr *udphdr;
|
---|
714 | err_t err;
|
---|
715 | struct pbuf *q; /* q will be sent down the stack */
|
---|
716 | u8_t ip_proto;
|
---|
717 | u8_t ttl;
|
---|
718 |
|
---|
719 | LWIP_ASSERT_CORE_LOCKED();
|
---|
720 |
|
---|
721 | LWIP_ERROR("udp_sendto_if_src: invalid pcb", pcb != NULL, return ERR_ARG);
|
---|
722 | LWIP_ERROR("udp_sendto_if_src: invalid pbuf", p != NULL, return ERR_ARG);
|
---|
723 | LWIP_ERROR("udp_sendto_if_src: invalid dst_ip", dst_ip != NULL, return ERR_ARG);
|
---|
724 | LWIP_ERROR("udp_sendto_if_src: invalid src_ip", src_ip != NULL, return ERR_ARG);
|
---|
725 | LWIP_ERROR("udp_sendto_if_src: invalid netif", netif != NULL, return ERR_ARG);
|
---|
726 |
|
---|
727 | if (!IP_ADDR_PCB_VERSION_MATCH(pcb, src_ip) ||
|
---|
728 | !IP_ADDR_PCB_VERSION_MATCH(pcb, dst_ip)) {
|
---|
729 | return ERR_VAL;
|
---|
730 | }
|
---|
731 |
|
---|
732 | #if LWIP_IPV4 && IP_SOF_BROADCAST
|
---|
733 | /* broadcast filter? */
|
---|
734 | if (!ip_get_option(pcb, SOF_BROADCAST) &&
|
---|
735 | #if LWIP_IPV6
|
---|
736 | IP_IS_V4(dst_ip) &&
|
---|
737 | #endif /* LWIP_IPV6 */
|
---|
738 | ip_addr_isbroadcast(dst_ip, netif)) {
|
---|
739 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_LEVEL_SERIOUS,
|
---|
740 | ("udp_sendto_if: SOF_BROADCAST not enabled on pcb %p\n", (void *)pcb));
|
---|
741 | return ERR_VAL;
|
---|
742 | }
|
---|
743 | #endif /* LWIP_IPV4 && IP_SOF_BROADCAST */
|
---|
744 |
|
---|
745 | /* if the PCB is not yet bound to a port, bind it here */
|
---|
746 | if (pcb->local_port == 0) {
|
---|
747 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE, ("udp_send: not yet bound to a port, binding now\n"));
|
---|
748 | err = udp_bind(pcb, &pcb->local_ip, pcb->local_port);
|
---|
749 | if (err != ERR_OK) {
|
---|
750 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_LEVEL_SERIOUS, ("udp_send: forced port bind failed\n"));
|
---|
751 | return err;
|
---|
752 | }
|
---|
753 | }
|
---|
754 |
|
---|
755 | /* packet too large to add a UDP header without causing an overflow? */
|
---|
756 | if ((u16_t)(p->tot_len + UDP_HLEN) < p->tot_len) {
|
---|
757 | return ERR_MEM;
|
---|
758 | }
|
---|
759 | /* not enough space to add an UDP header to first pbuf in given p chain? */
|
---|
760 | if (pbuf_add_header(p, UDP_HLEN)) {
|
---|
761 | /* allocate header in a separate new pbuf */
|
---|
762 | q = pbuf_alloc(PBUF_IP, UDP_HLEN, PBUF_RAM);
|
---|
763 | /* new header pbuf could not be allocated? */
|
---|
764 | if (q == NULL) {
|
---|
765 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_LEVEL_SERIOUS, ("udp_send: could not allocate header\n"));
|
---|
766 | return ERR_MEM;
|
---|
767 | }
|
---|
768 | if (p->tot_len != 0) {
|
---|
769 | /* chain header q in front of given pbuf p (only if p contains data) */
|
---|
770 | pbuf_chain(q, p);
|
---|
771 | }
|
---|
772 | /* first pbuf q points to header pbuf */
|
---|
773 | LWIP_DEBUGF(UDP_DEBUG,
|
---|
774 | ("udp_send: added header pbuf %p before given pbuf %p\n", (void *)q, (void *)p));
|
---|
775 | } else {
|
---|
776 | /* adding space for header within p succeeded */
|
---|
777 | /* first pbuf q equals given pbuf */
|
---|
778 | q = p;
|
---|
779 | LWIP_DEBUGF(UDP_DEBUG, ("udp_send: added header in given pbuf %p\n", (void *)p));
|
---|
780 | }
|
---|
781 | LWIP_ASSERT("check that first pbuf can hold struct udp_hdr",
|
---|
782 | (q->len >= sizeof(struct udp_hdr)));
|
---|
783 | /* q now represents the packet to be sent */
|
---|
784 | udphdr = (struct udp_hdr *)q->payload;
|
---|
785 | udphdr->src = lwip_htons(pcb->local_port);
|
---|
786 | udphdr->dest = lwip_htons(dst_port);
|
---|
787 | /* in UDP, 0 checksum means 'no checksum' */
|
---|
788 | udphdr->chksum = 0x0000;
|
---|
789 |
|
---|
790 | /* Multicast Loop? */
|
---|
791 | #if LWIP_MULTICAST_TX_OPTIONS
|
---|
792 | if (((pcb->flags & UDP_FLAGS_MULTICAST_LOOP) != 0) && ip_addr_ismulticast(dst_ip)) {
|
---|
793 | q->flags |= PBUF_FLAG_MCASTLOOP;
|
---|
794 | }
|
---|
795 | #endif /* LWIP_MULTICAST_TX_OPTIONS */
|
---|
796 |
|
---|
797 | LWIP_DEBUGF(UDP_DEBUG, ("udp_send: sending datagram of length %"U16_F"\n", q->tot_len));
|
---|
798 |
|
---|
799 | #if LWIP_UDPLITE
|
---|
800 | /* UDP Lite protocol? */
|
---|
801 | if (pcb->flags & UDP_FLAGS_UDPLITE) {
|
---|
802 | u16_t chklen, chklen_hdr;
|
---|
803 | LWIP_DEBUGF(UDP_DEBUG, ("udp_send: UDP LITE packet length %"U16_F"\n", q->tot_len));
|
---|
804 | /* set UDP message length in UDP header */
|
---|
805 | chklen_hdr = chklen = pcb->chksum_len_tx;
|
---|
806 | if ((chklen < sizeof(struct udp_hdr)) || (chklen > q->tot_len)) {
|
---|
807 | if (chklen != 0) {
|
---|
808 | LWIP_DEBUGF(UDP_DEBUG, ("udp_send: UDP LITE pcb->chksum_len is illegal: %"U16_F"\n", chklen));
|
---|
809 | }
|
---|
810 | /* For UDP-Lite, checksum length of 0 means checksum
|
---|
811 | over the complete packet. (See RFC 3828 chap. 3.1)
|
---|
812 | At least the UDP-Lite header must be covered by the
|
---|
813 | checksum, therefore, if chksum_len has an illegal
|
---|
814 | value, we generate the checksum over the complete
|
---|
815 | packet to be safe. */
|
---|
816 | chklen_hdr = 0;
|
---|
817 | chklen = q->tot_len;
|
---|
818 | }
|
---|
819 | udphdr->len = lwip_htons(chklen_hdr);
|
---|
820 | /* calculate checksum */
|
---|
821 | #if CHECKSUM_GEN_UDP
|
---|
822 | IF__NETIF_CHECKSUM_ENABLED(netif, NETIF_CHECKSUM_GEN_UDP) {
|
---|
823 | #if LWIP_CHECKSUM_ON_COPY
|
---|
824 | if (have_chksum) {
|
---|
825 | chklen = UDP_HLEN;
|
---|
826 | }
|
---|
827 | #endif /* LWIP_CHECKSUM_ON_COPY */
|
---|
828 | udphdr->chksum = ip_chksum_pseudo_partial(q, IP_PROTO_UDPLITE,
|
---|
829 | q->tot_len, chklen, src_ip, dst_ip);
|
---|
830 | #if LWIP_CHECKSUM_ON_COPY
|
---|
831 | if (have_chksum) {
|
---|
832 | u32_t acc;
|
---|
833 | acc = udphdr->chksum + (u16_t)~(chksum);
|
---|
834 | udphdr->chksum = FOLD_U32T(acc);
|
---|
835 | }
|
---|
836 | #endif /* LWIP_CHECKSUM_ON_COPY */
|
---|
837 |
|
---|
838 | /* chksum zero must become 0xffff, as zero means 'no checksum' */
|
---|
839 | if (udphdr->chksum == 0x0000) {
|
---|
840 | udphdr->chksum = 0xffff;
|
---|
841 | }
|
---|
842 | }
|
---|
843 | #endif /* CHECKSUM_GEN_UDP */
|
---|
844 |
|
---|
845 | ip_proto = IP_PROTO_UDPLITE;
|
---|
846 | } else
|
---|
847 | #endif /* LWIP_UDPLITE */
|
---|
848 | { /* UDP */
|
---|
849 | LWIP_DEBUGF(UDP_DEBUG, ("udp_send: UDP packet length %"U16_F"\n", q->tot_len));
|
---|
850 | udphdr->len = lwip_htons(q->tot_len);
|
---|
851 | /* calculate checksum */
|
---|
852 | #if CHECKSUM_GEN_UDP
|
---|
853 | IF__NETIF_CHECKSUM_ENABLED(netif, NETIF_CHECKSUM_GEN_UDP) {
|
---|
854 | /* Checksum is mandatory over IPv6. */
|
---|
855 | if (IP_IS_V6(dst_ip) || (pcb->flags & UDP_FLAGS_NOCHKSUM) == 0) {
|
---|
856 | u16_t udpchksum;
|
---|
857 | #if LWIP_CHECKSUM_ON_COPY
|
---|
858 | if (have_chksum) {
|
---|
859 | u32_t acc;
|
---|
860 | udpchksum = ip_chksum_pseudo_partial(q, IP_PROTO_UDP,
|
---|
861 | q->tot_len, UDP_HLEN, src_ip, dst_ip);
|
---|
862 | acc = udpchksum + (u16_t)~(chksum);
|
---|
863 | udpchksum = FOLD_U32T(acc);
|
---|
864 | } else
|
---|
865 | #endif /* LWIP_CHECKSUM_ON_COPY */
|
---|
866 | {
|
---|
867 | udpchksum = ip_chksum_pseudo(q, IP_PROTO_UDP, q->tot_len,
|
---|
868 | src_ip, dst_ip);
|
---|
869 | }
|
---|
870 |
|
---|
871 | /* chksum zero must become 0xffff, as zero means 'no checksum' */
|
---|
872 | if (udpchksum == 0x0000) {
|
---|
873 | udpchksum = 0xffff;
|
---|
874 | }
|
---|
875 | udphdr->chksum = udpchksum;
|
---|
876 | }
|
---|
877 | }
|
---|
878 | #endif /* CHECKSUM_GEN_UDP */
|
---|
879 | ip_proto = IP_PROTO_UDP;
|
---|
880 | }
|
---|
881 |
|
---|
882 | /* Determine TTL to use */
|
---|
883 | #if LWIP_MULTICAST_TX_OPTIONS
|
---|
884 | ttl = (ip_addr_ismulticast(dst_ip) ? udp_get_multicast_ttl(pcb) : pcb->ttl);
|
---|
885 | #else /* LWIP_MULTICAST_TX_OPTIONS */
|
---|
886 | ttl = pcb->ttl;
|
---|
887 | #endif /* LWIP_MULTICAST_TX_OPTIONS */
|
---|
888 |
|
---|
889 | LWIP_DEBUGF(UDP_DEBUG, ("udp_send: UDP checksum 0x%04"X16_F"\n", udphdr->chksum));
|
---|
890 | LWIP_DEBUGF(UDP_DEBUG, ("udp_send: ip_output_if (,,,,0x%02"X16_F",)\n", (u16_t)ip_proto));
|
---|
891 | /* output to IP */
|
---|
892 | NETIF_SET_HINTS(netif, &(pcb->netif_hints));
|
---|
893 | err = ip_output_if_src(q, src_ip, dst_ip, ttl, pcb->tos, ip_proto, netif);
|
---|
894 | NETIF_RESET_HINTS(netif);
|
---|
895 |
|
---|
896 | /* @todo: must this be increased even if error occurred? */
|
---|
897 | MIB2_STATS_INC(mib2.udpoutdatagrams);
|
---|
898 |
|
---|
899 | /* did we chain a separate header pbuf earlier? */
|
---|
900 | if (q != p) {
|
---|
901 | /* free the header pbuf */
|
---|
902 | pbuf_free(q);
|
---|
903 | q = NULL;
|
---|
904 | /* p is still referenced by the caller, and will live on */
|
---|
905 | }
|
---|
906 |
|
---|
907 | UDP_STATS_INC(udp.xmit);
|
---|
908 | return err;
|
---|
909 | }
|
---|
910 |
|
---|
911 | /**
|
---|
912 | * @ingroup udp_raw
|
---|
913 | * Bind an UDP PCB.
|
---|
914 | *
|
---|
915 | * @param pcb UDP PCB to be bound with a local address ipaddr and port.
|
---|
916 | * @param ipaddr local IP address to bind with. Use IP_ANY_TYPE to
|
---|
917 | * bind to all local interfaces.
|
---|
918 | * @param port local UDP port to bind with. Use 0 to automatically bind
|
---|
919 | * to a random port between UDP_LOCAL_PORT_RANGE_START and
|
---|
920 | * UDP_LOCAL_PORT_RANGE_END.
|
---|
921 | *
|
---|
922 | * ipaddr & port are expected to be in the same byte order as in the pcb.
|
---|
923 | *
|
---|
924 | * @return lwIP error code.
|
---|
925 | * - ERR_OK. Successful. No error occurred.
|
---|
926 | * - ERR_USE. The specified ipaddr and port are already bound to by
|
---|
927 | * another UDP PCB.
|
---|
928 | *
|
---|
929 | * @see udp_disconnect()
|
---|
930 | */
|
---|
931 | err_t
|
---|
932 | udp_bind(struct udp_pcb *pcb, const ip_addr_t *ipaddr, u16_t port)
|
---|
933 | {
|
---|
934 | struct udp_pcb *ipcb;
|
---|
935 | u8_t rebind;
|
---|
936 | #if LWIP_IPV6 && LWIP_IPV6_SCOPES
|
---|
937 | ip_addr_t zoned_ipaddr;
|
---|
938 | #endif /* LWIP_IPV6 && LWIP_IPV6_SCOPES */
|
---|
939 |
|
---|
940 | LWIP_ASSERT_CORE_LOCKED();
|
---|
941 |
|
---|
942 | #if LWIP_IPV4
|
---|
943 | /* Don't propagate NULL pointer (IPv4 ANY) to subsequent functions */
|
---|
944 | if (ipaddr == NULL) {
|
---|
945 | ipaddr = IP4_ADDR_ANY;
|
---|
946 | }
|
---|
947 | #else /* LWIP_IPV4 */
|
---|
948 | LWIP_ERROR("udp_bind: invalid ipaddr", ipaddr != NULL, return ERR_ARG);
|
---|
949 | #endif /* LWIP_IPV4 */
|
---|
950 |
|
---|
951 | LWIP_ERROR("udp_bind: invalid pcb", pcb != NULL, return ERR_ARG);
|
---|
952 |
|
---|
953 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE, ("udp_bind(ipaddr = "));
|
---|
954 | ip_addr_debug_print(UDP_DEBUG | LWIP_DBG_TRACE, ipaddr);
|
---|
955 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE, (", port = %"U16_F")\n", port));
|
---|
956 |
|
---|
957 | rebind = 0;
|
---|
958 | /* Check for double bind and rebind of the same pcb */
|
---|
959 | for (ipcb = udp_pcbs; ipcb != NULL; ipcb = ipcb->next) {
|
---|
960 | /* is this UDP PCB already on active list? */
|
---|
961 | if (pcb == ipcb) {
|
---|
962 | rebind = 1;
|
---|
963 | break;
|
---|
964 | }
|
---|
965 | }
|
---|
966 |
|
---|
967 | #if LWIP_IPV6 && LWIP_IPV6_SCOPES
|
---|
968 | /* If the given IP address should have a zone but doesn't, assign one now.
|
---|
969 | * This is legacy support: scope-aware callers should always provide properly
|
---|
970 | * zoned source addresses. Do the zone selection before the address-in-use
|
---|
971 | * check below; as such we have to make a temporary copy of the address. */
|
---|
972 | if (IP_IS_V6(ipaddr) && ip6_addr_lacks_zone(ip_2_ip6(ipaddr), IP6_UNKNOWN)) {
|
---|
973 | ip_addr_copy(zoned_ipaddr, *ipaddr);
|
---|
974 | ip6_addr_select_zone(ip_2_ip6(&zoned_ipaddr), ip_2_ip6(&zoned_ipaddr));
|
---|
975 | ipaddr = &zoned_ipaddr;
|
---|
976 | }
|
---|
977 | #endif /* LWIP_IPV6 && LWIP_IPV6_SCOPES */
|
---|
978 |
|
---|
979 | /* no port specified? */
|
---|
980 | if (port == 0) {
|
---|
981 | port = udp_new_port();
|
---|
982 | if (port == 0) {
|
---|
983 | /* no more ports available in local range */
|
---|
984 | LWIP_DEBUGF(UDP_DEBUG, ("udp_bind: out of free UDP ports\n"));
|
---|
985 | return ERR_USE;
|
---|
986 | }
|
---|
987 | } else {
|
---|
988 | for (ipcb = udp_pcbs; ipcb != NULL; ipcb = ipcb->next) {
|
---|
989 | if (pcb != ipcb) {
|
---|
990 | /* By default, we don't allow to bind to a port that any other udp
|
---|
991 | PCB is already bound to, unless *all* PCBs with that port have tha
|
---|
992 | REUSEADDR flag set. */
|
---|
993 | #if SO_REUSE
|
---|
994 | if (!ip_get_option(pcb, SOF_REUSEADDR) ||
|
---|
995 | !ip_get_option(ipcb, SOF_REUSEADDR))
|
---|
996 | #endif /* SO_REUSE */
|
---|
997 | {
|
---|
998 | /* port matches that of PCB in list and REUSEADDR not set -> reject */
|
---|
999 | if ((ipcb->local_port == port) &&
|
---|
1000 | /* IP address matches or any IP used? */
|
---|
1001 | (ip_addr_cmp(&ipcb->local_ip, ipaddr) || ip_addr_isany(ipaddr) ||
|
---|
1002 | ip_addr_isany(&ipcb->local_ip))) {
|
---|
1003 | /* other PCB already binds to this local IP and port */
|
---|
1004 | LWIP_DEBUGF(UDP_DEBUG,
|
---|
1005 | ("udp_bind: local port %"U16_F" already bound by another pcb\n", port));
|
---|
1006 | return ERR_USE;
|
---|
1007 | }
|
---|
1008 | }
|
---|
1009 | }
|
---|
1010 | }
|
---|
1011 | }
|
---|
1012 |
|
---|
1013 | ip_addr_set_ipaddr(&pcb->local_ip, ipaddr);
|
---|
1014 |
|
---|
1015 | pcb->local_port = port;
|
---|
1016 | mib2_udp_bind(pcb);
|
---|
1017 | /* pcb not active yet? */
|
---|
1018 | if (rebind == 0) {
|
---|
1019 | /* place the PCB on the active list if not already there */
|
---|
1020 | pcb->next = udp_pcbs;
|
---|
1021 | udp_pcbs = pcb;
|
---|
1022 | }
|
---|
1023 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_STATE, ("udp_bind: bound to "));
|
---|
1024 | ip_addr_debug_print_val(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_STATE, pcb->local_ip);
|
---|
1025 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_STATE, (", port %"U16_F")\n", pcb->local_port));
|
---|
1026 | return ERR_OK;
|
---|
1027 | }
|
---|
1028 |
|
---|
1029 | /**
|
---|
1030 | * @ingroup udp_raw
|
---|
1031 | * Bind an UDP PCB to a specific netif.
|
---|
1032 | * After calling this function, all packets received via this PCB
|
---|
1033 | * are guaranteed to have come in via the specified netif, and all
|
---|
1034 | * outgoing packets will go out via the specified netif.
|
---|
1035 | *
|
---|
1036 | * @param pcb UDP PCB to be bound.
|
---|
1037 | * @param netif netif to bind udp pcb to. Can be NULL.
|
---|
1038 | *
|
---|
1039 | * @see udp_disconnect()
|
---|
1040 | */
|
---|
1041 | void
|
---|
1042 | udp_bind_netif(struct udp_pcb *pcb, const struct netif *netif)
|
---|
1043 | {
|
---|
1044 | LWIP_ASSERT_CORE_LOCKED();
|
---|
1045 |
|
---|
1046 | if (netif != NULL) {
|
---|
1047 | pcb->netif_idx = netif_get_index(netif);
|
---|
1048 | } else {
|
---|
1049 | pcb->netif_idx = NETIF_NO_INDEX;
|
---|
1050 | }
|
---|
1051 | }
|
---|
1052 |
|
---|
1053 | /**
|
---|
1054 | * @ingroup udp_raw
|
---|
1055 | * Sets the remote end of the pcb. This function does not generate any
|
---|
1056 | * network traffic, but only sets the remote address of the pcb.
|
---|
1057 | *
|
---|
1058 | * @param pcb UDP PCB to be connected with remote address ipaddr and port.
|
---|
1059 | * @param ipaddr remote IP address to connect with.
|
---|
1060 | * @param port remote UDP port to connect with.
|
---|
1061 | *
|
---|
1062 | * @return lwIP error code
|
---|
1063 | *
|
---|
1064 | * ipaddr & port are expected to be in the same byte order as in the pcb.
|
---|
1065 | *
|
---|
1066 | * The udp pcb is bound to a random local port if not already bound.
|
---|
1067 | *
|
---|
1068 | * @see udp_disconnect()
|
---|
1069 | */
|
---|
1070 | err_t
|
---|
1071 | udp_connect(struct udp_pcb *pcb, const ip_addr_t *ipaddr, u16_t port)
|
---|
1072 | {
|
---|
1073 | struct udp_pcb *ipcb;
|
---|
1074 |
|
---|
1075 | LWIP_ASSERT_CORE_LOCKED();
|
---|
1076 |
|
---|
1077 | LWIP_ERROR("udp_connect: invalid pcb", pcb != NULL, return ERR_ARG);
|
---|
1078 | LWIP_ERROR("udp_connect: invalid ipaddr", ipaddr != NULL, return ERR_ARG);
|
---|
1079 |
|
---|
1080 | if (pcb->local_port == 0) {
|
---|
1081 | err_t err = udp_bind(pcb, &pcb->local_ip, pcb->local_port);
|
---|
1082 | if (err != ERR_OK) {
|
---|
1083 | return err;
|
---|
1084 | }
|
---|
1085 | }
|
---|
1086 |
|
---|
1087 | ip_addr_set_ipaddr(&pcb->remote_ip, ipaddr);
|
---|
1088 | #if LWIP_IPV6 && LWIP_IPV6_SCOPES
|
---|
1089 | /* If the given IP address should have a zone but doesn't, assign one now,
|
---|
1090 | * using the bound address to make a more informed decision when possible. */
|
---|
1091 | if (IP_IS_V6(&pcb->remote_ip) &&
|
---|
1092 | ip6_addr_lacks_zone(ip_2_ip6(&pcb->remote_ip), IP6_UNKNOWN)) {
|
---|
1093 | ip6_addr_select_zone(ip_2_ip6(&pcb->remote_ip), ip_2_ip6(&pcb->local_ip));
|
---|
1094 | }
|
---|
1095 | #endif /* LWIP_IPV6 && LWIP_IPV6_SCOPES */
|
---|
1096 |
|
---|
1097 | pcb->remote_port = port;
|
---|
1098 | pcb->flags |= UDP_FLAGS_CONNECTED;
|
---|
1099 |
|
---|
1100 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_STATE, ("udp_connect: connected to "));
|
---|
1101 | ip_addr_debug_print_val(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_STATE,
|
---|
1102 | pcb->remote_ip);
|
---|
1103 | LWIP_DEBUGF(UDP_DEBUG | LWIP_DBG_TRACE | LWIP_DBG_STATE, (", port %"U16_F")\n", pcb->remote_port));
|
---|
1104 |
|
---|
1105 | /* Insert UDP PCB into the list of active UDP PCBs. */
|
---|
1106 | for (ipcb = udp_pcbs; ipcb != NULL; ipcb = ipcb->next) {
|
---|
1107 | if (pcb == ipcb) {
|
---|
1108 | /* already on the list, just return */
|
---|
1109 | return ERR_OK;
|
---|
1110 | }
|
---|
1111 | }
|
---|
1112 | /* PCB not yet on the list, add PCB now */
|
---|
1113 | pcb->next = udp_pcbs;
|
---|
1114 | udp_pcbs = pcb;
|
---|
1115 | return ERR_OK;
|
---|
1116 | }
|
---|
1117 |
|
---|
1118 | /**
|
---|
1119 | * @ingroup udp_raw
|
---|
1120 | * Remove the remote end of the pcb. This function does not generate
|
---|
1121 | * any network traffic, but only removes the remote address of the pcb.
|
---|
1122 | *
|
---|
1123 | * @param pcb the udp pcb to disconnect.
|
---|
1124 | */
|
---|
1125 | void
|
---|
1126 | udp_disconnect(struct udp_pcb *pcb)
|
---|
1127 | {
|
---|
1128 | LWIP_ASSERT_CORE_LOCKED();
|
---|
1129 |
|
---|
1130 | LWIP_ERROR("udp_disconnect: invalid pcb", pcb != NULL, return);
|
---|
1131 |
|
---|
1132 | /* reset remote address association */
|
---|
1133 | #if LWIP_IPV4 && LWIP_IPV6
|
---|
1134 | if (IP_IS_ANY_TYPE_VAL(pcb->local_ip)) {
|
---|
1135 | ip_addr_copy(pcb->remote_ip, *IP_ANY_TYPE);
|
---|
1136 | } else {
|
---|
1137 | #endif
|
---|
1138 | ip_addr_set_any(IP_IS_V6_VAL(pcb->remote_ip), &pcb->remote_ip);
|
---|
1139 | #if LWIP_IPV4 && LWIP_IPV6
|
---|
1140 | }
|
---|
1141 | #endif
|
---|
1142 | pcb->remote_port = 0;
|
---|
1143 | pcb->netif_idx = NETIF_NO_INDEX;
|
---|
1144 | /* mark PCB as unconnected */
|
---|
1145 | udp_clear_flags(pcb, UDP_FLAGS_CONNECTED);
|
---|
1146 | }
|
---|
1147 |
|
---|
1148 | /**
|
---|
1149 | * @ingroup udp_raw
|
---|
1150 | * Set a receive callback for a UDP PCB.
|
---|
1151 | * This callback will be called when receiving a datagram for the pcb.
|
---|
1152 | *
|
---|
1153 | * @param pcb the pcb for which to set the recv callback
|
---|
1154 | * @param recv function pointer of the callback function
|
---|
1155 | * @param recv_arg additional argument to pass to the callback function
|
---|
1156 | */
|
---|
1157 | void
|
---|
1158 | udp_recv(struct udp_pcb *pcb, udp_recv_fn recv, void *recv_arg)
|
---|
1159 | {
|
---|
1160 | LWIP_ASSERT_CORE_LOCKED();
|
---|
1161 |
|
---|
1162 | LWIP_ERROR("udp_recv: invalid pcb", pcb != NULL, return);
|
---|
1163 |
|
---|
1164 | /* remember recv() callback and user data */
|
---|
1165 | pcb->recv = recv;
|
---|
1166 | pcb->recv_arg = recv_arg;
|
---|
1167 | }
|
---|
1168 |
|
---|
1169 | /**
|
---|
1170 | * @ingroup udp_raw
|
---|
1171 | * Removes and deallocates the pcb.
|
---|
1172 | *
|
---|
1173 | * @param pcb UDP PCB to be removed. The PCB is removed from the list of
|
---|
1174 | * UDP PCB's and the data structure is freed from memory.
|
---|
1175 | *
|
---|
1176 | * @see udp_new()
|
---|
1177 | */
|
---|
1178 | void
|
---|
1179 | udp_remove(struct udp_pcb *pcb)
|
---|
1180 | {
|
---|
1181 | struct udp_pcb *pcb2;
|
---|
1182 |
|
---|
1183 | LWIP_ASSERT_CORE_LOCKED();
|
---|
1184 |
|
---|
1185 | LWIP_ERROR("udp_remove: invalid pcb", pcb != NULL, return);
|
---|
1186 |
|
---|
1187 | mib2_udp_unbind(pcb);
|
---|
1188 | /* pcb to be removed is first in list? */
|
---|
1189 | if (udp_pcbs == pcb) {
|
---|
1190 | /* make list start at 2nd pcb */
|
---|
1191 | udp_pcbs = udp_pcbs->next;
|
---|
1192 | /* pcb not 1st in list */
|
---|
1193 | } else {
|
---|
1194 | for (pcb2 = udp_pcbs; pcb2 != NULL; pcb2 = pcb2->next) {
|
---|
1195 | /* find pcb in udp_pcbs list */
|
---|
1196 | if (pcb2->next != NULL && pcb2->next == pcb) {
|
---|
1197 | /* remove pcb from list */
|
---|
1198 | pcb2->next = pcb->next;
|
---|
1199 | break;
|
---|
1200 | }
|
---|
1201 | }
|
---|
1202 | }
|
---|
1203 | memp_free(MEMP_UDP_PCB, pcb);
|
---|
1204 | }
|
---|
1205 |
|
---|
1206 | /**
|
---|
1207 | * @ingroup udp_raw
|
---|
1208 | * Creates a new UDP pcb which can be used for UDP communication. The
|
---|
1209 | * pcb is not active until it has either been bound to a local address
|
---|
1210 | * or connected to a remote address.
|
---|
1211 | *
|
---|
1212 | * @return The UDP PCB which was created. NULL if the PCB data structure
|
---|
1213 | * could not be allocated.
|
---|
1214 | *
|
---|
1215 | * @see udp_remove()
|
---|
1216 | */
|
---|
1217 | struct udp_pcb *
|
---|
1218 | udp_new(void)
|
---|
1219 | {
|
---|
1220 | struct udp_pcb *pcb;
|
---|
1221 |
|
---|
1222 | LWIP_ASSERT_CORE_LOCKED();
|
---|
1223 |
|
---|
1224 | pcb = (struct udp_pcb *)memp_malloc(MEMP_UDP_PCB);
|
---|
1225 | /* could allocate UDP PCB? */
|
---|
1226 | if (pcb != NULL) {
|
---|
1227 | /* UDP Lite: by initializing to all zeroes, chksum_len is set to 0
|
---|
1228 | * which means checksum is generated over the whole datagram per default
|
---|
1229 | * (recommended as default by RFC 3828). */
|
---|
1230 | /* initialize PCB to all zeroes */
|
---|
1231 | memset(pcb, 0, sizeof(struct udp_pcb));
|
---|
1232 | pcb->ttl = UDP_TTL;
|
---|
1233 | #if LWIP_MULTICAST_TX_OPTIONS
|
---|
1234 | udp_set_multicast_ttl(pcb, UDP_TTL);
|
---|
1235 | #endif /* LWIP_MULTICAST_TX_OPTIONS */
|
---|
1236 | }
|
---|
1237 | return pcb;
|
---|
1238 | }
|
---|
1239 |
|
---|
1240 | /**
|
---|
1241 | * @ingroup udp_raw
|
---|
1242 | * Create a UDP PCB for specific IP type.
|
---|
1243 | * The pcb is not active until it has either been bound to a local address
|
---|
1244 | * or connected to a remote address.
|
---|
1245 | *
|
---|
1246 | * @param type IP address type, see @ref lwip_ip_addr_type definitions.
|
---|
1247 | * If you want to listen to IPv4 and IPv6 (dual-stack) packets,
|
---|
1248 | * supply @ref IPADDR_TYPE_ANY as argument and bind to @ref IP_ANY_TYPE.
|
---|
1249 | * @return The UDP PCB which was created. NULL if the PCB data structure
|
---|
1250 | * could not be allocated.
|
---|
1251 | *
|
---|
1252 | * @see udp_remove()
|
---|
1253 | */
|
---|
1254 | struct udp_pcb *
|
---|
1255 | udp_new_ip_type(u8_t type)
|
---|
1256 | {
|
---|
1257 | struct udp_pcb *pcb;
|
---|
1258 |
|
---|
1259 | LWIP_ASSERT_CORE_LOCKED();
|
---|
1260 |
|
---|
1261 | pcb = udp_new();
|
---|
1262 | #if LWIP_IPV4 && LWIP_IPV6
|
---|
1263 | if (pcb != NULL) {
|
---|
1264 | IP_SET_TYPE_VAL(pcb->local_ip, type);
|
---|
1265 | IP_SET_TYPE_VAL(pcb->remote_ip, type);
|
---|
1266 | }
|
---|
1267 | #else
|
---|
1268 | LWIP_UNUSED_ARG(type);
|
---|
1269 | #endif /* LWIP_IPV4 && LWIP_IPV6 */
|
---|
1270 | return pcb;
|
---|
1271 | }
|
---|
1272 |
|
---|
1273 | /** This function is called from netif.c when address is changed
|
---|
1274 | *
|
---|
1275 | * @param old_addr IP address of the netif before change
|
---|
1276 | * @param new_addr IP address of the netif after change
|
---|
1277 | */
|
---|
1278 | void udp_netif_ip_addr_changed(const ip_addr_t *old_addr, const ip_addr_t *new_addr)
|
---|
1279 | {
|
---|
1280 | struct udp_pcb *upcb;
|
---|
1281 |
|
---|
1282 | if (!ip_addr_isany(old_addr) && !ip_addr_isany(new_addr)) {
|
---|
1283 | for (upcb = udp_pcbs; upcb != NULL; upcb = upcb->next) {
|
---|
1284 | /* PCB bound to current local interface address? */
|
---|
1285 | if (ip_addr_cmp(&upcb->local_ip, old_addr)) {
|
---|
1286 | /* The PCB is bound to the old ipaddr and
|
---|
1287 | * is set to bound to the new one instead */
|
---|
1288 | ip_addr_copy(upcb->local_ip, *new_addr);
|
---|
1289 | }
|
---|
1290 | }
|
---|
1291 | }
|
---|
1292 | }
|
---|
1293 |
|
---|
1294 | #if UDP_DEBUG
|
---|
1295 | /**
|
---|
1296 | * Print UDP header information for debug purposes.
|
---|
1297 | *
|
---|
1298 | * @param udphdr pointer to the udp header in memory.
|
---|
1299 | */
|
---|
1300 | void
|
---|
1301 | udp_debug_print(struct udp_hdr *udphdr)
|
---|
1302 | {
|
---|
1303 | LWIP_DEBUGF(UDP_DEBUG, ("UDP header:\n"));
|
---|
1304 | LWIP_DEBUGF(UDP_DEBUG, ("+-------------------------------+\n"));
|
---|
1305 | LWIP_DEBUGF(UDP_DEBUG, ("| %5"U16_F" | %5"U16_F" | (src port, dest port)\n",
|
---|
1306 | lwip_ntohs(udphdr->src), lwip_ntohs(udphdr->dest)));
|
---|
1307 | LWIP_DEBUGF(UDP_DEBUG, ("+-------------------------------+\n"));
|
---|
1308 | LWIP_DEBUGF(UDP_DEBUG, ("| %5"U16_F" | 0x%04"X16_F" | (len, chksum)\n",
|
---|
1309 | lwip_ntohs(udphdr->len), lwip_ntohs(udphdr->chksum)));
|
---|
1310 | LWIP_DEBUGF(UDP_DEBUG, ("+-------------------------------+\n"));
|
---|
1311 | }
|
---|
1312 | #endif /* UDP_DEBUG */
|
---|
1313 |
|
---|
1314 | #endif /* LWIP_UDP */
|
---|