Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependents: lpc1768-picotcp-demo ZeroMQ_PicoTCP_Publisher_demo TCPSocket_HelloWorld_PicoTCP Pico_TCP_UDP_Test ... more
PicoTCP. Copyright (c) 2013 TASS Belgium NV.
Released under the GNU General Public License, version 2.
Different licensing models may exist, at the sole discretion of the Copyright holders.
Official homepage: http://www.picotcp.com
Bug tracker: https://github.com/tass-belgium/picotcp/issues
Development steps:
initial integration with mbed RTOSgeneric mbed Ethernet driverhigh performance NXP LPC1768 specific Ethernet driverMulti-threading support for mbed RTOSBerkeley sockets and integration with the New Socket APIFork of the apps running on top of the New Socket APIScheduling optimizations- Debugging/benchmarking/testing
Demo application (measuring TCP sender performance):
Import programlpc1768-picotcp-demo
A PicoTCP demo app testing the ethernet throughput on the lpc1768 mbed board.
modules/pico_socket_udp.c@149:5f4cb161cec3, 2014-04-09 (annotated)
- Committer:
- tass picotcp@tass.be
- Date:
- Wed Apr 09 14:31:41 2014 +0200
- Revision:
- 149:5f4cb161cec3
- Child:
- 152:a3d286bf94e5
Update from git masterbranch
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| tass picotcp@tass.be | 149:5f4cb161cec3 | 1 | #include <stdint.h> |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 2 | #include "pico_socket.h" |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 3 | #include "pico_udp.h" |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 4 | #include "pico_socket_multicast.h" |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 5 | #include "pico_ipv4.h" |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 6 | #include "pico_ipv6.h" |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 7 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 8 | #define UDP_FRAME_OVERHEAD (sizeof(struct pico_frame)) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 9 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 10 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 11 | struct pico_socket *pico_socket_udp_open(void) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 12 | { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 13 | struct pico_socket *s = NULL; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 14 | #ifdef PICO_SUPPORT_UDP |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 15 | s = pico_udp_open(); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 16 | if (!s) { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 17 | pico_err = PICO_ERR_ENOMEM; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 18 | return NULL; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 19 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 20 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 21 | s->proto = &pico_proto_udp; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 22 | s->q_in.overhead = s->q_out.overhead = UDP_FRAME_OVERHEAD; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 23 | #endif |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 24 | return s; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 25 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 26 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 27 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 28 | #ifdef PICO_SUPPORT_IPV4 |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 29 | static int pico_socket_udp_deliver_ipv4(struct pico_socket *s, struct pico_frame *f) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 30 | { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 31 | struct pico_ip4 s_local, p_dst; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 32 | struct pico_ipv4_hdr *ip4hdr; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 33 | struct pico_frame *cpy; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 34 | ip4hdr = (struct pico_ipv4_hdr*)(f->net_hdr); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 35 | s_local.addr = s->local_addr.ip4.addr; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 36 | p_dst.addr = ip4hdr->dst.addr; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 37 | if ((pico_ipv4_is_broadcast(p_dst.addr)) || pico_ipv4_is_multicast(p_dst.addr)) { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 38 | struct pico_device *dev = pico_ipv4_link_find(&s->local_addr.ip4); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 39 | if (pico_ipv4_is_multicast(p_dst.addr) && (pico_socket_mcast_filter(s, (union pico_address *)&ip4hdr->dst, (union pico_address *)&ip4hdr->src) < 0)) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 40 | return -1; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 41 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 42 | if ((s_local.addr == PICO_IPV4_INADDR_ANY) || /* If our local ip is ANY, or.. */ |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 43 | (dev == f->dev)) { /* the source of the bcast packet is a neighbor... */ |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 44 | cpy = pico_frame_copy(f); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 45 | if (!cpy) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 46 | return -1; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 47 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 48 | if (pico_enqueue(&s->q_in, cpy) > 0) { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 49 | if (s->wakeup) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 50 | s->wakeup(PICO_SOCK_EV_RD, s); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 51 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 52 | else |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 53 | pico_frame_discard(cpy); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 54 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 55 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 56 | } else if ((s_local.addr == PICO_IPV4_INADDR_ANY) || (s_local.addr == p_dst.addr)) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 57 | { /* Either local socket is ANY, or matches dst */ |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 58 | cpy = pico_frame_copy(f); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 59 | if (!cpy) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 60 | return -1; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 61 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 62 | if (pico_enqueue(&s->q_in, cpy) > 0) { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 63 | if (s->wakeup) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 64 | s->wakeup(PICO_SOCK_EV_RD, s); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 65 | } else { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 66 | pico_frame_discard(cpy); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 67 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 68 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 69 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 70 | pico_frame_discard(f); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 71 | return 0; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 72 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 73 | #endif |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 74 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 75 | #ifdef PICO_SUPPORT_IPV6 |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 76 | static int pico_socket_udp_deliver_ipv6(struct pico_socket *s, struct pico_frame *f) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 77 | { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 78 | struct pico_ip6 s_local, p_dst; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 79 | struct pico_ipv6_hdr *ip6hdr; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 80 | struct pico_frame *cpy; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 81 | ip6hdr = (struct pico_ipv6_hdr*)(f->net_hdr); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 82 | s_local = s->local_addr.ip6; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 83 | p_dst = ip6hdr->dst; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 84 | if ((pico_ipv6_is_multicast(p_dst.addr))) { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 85 | cpy = pico_frame_copy(f); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 86 | if (!cpy) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 87 | return -1; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 88 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 89 | if (pico_enqueue(&s->q_in, cpy) > 0) { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 90 | if (s->wakeup) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 91 | s->wakeup(PICO_SOCK_EV_RD, s); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 92 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 93 | else |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 94 | pico_frame_discard(cpy); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 95 | } else if (pico_ipv6_is_unspecified(s->local_addr.ip6.addr) || (pico_ipv6_compare(&s_local, &p_dst) == 0)) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 96 | { /* Either local socket is ANY, or matches dst */ |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 97 | cpy = pico_frame_copy(f); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 98 | if (!cpy) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 99 | return -1; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 100 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 101 | if (pico_enqueue(&s->q_in, cpy) > 0) { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 102 | if (s->wakeup) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 103 | s->wakeup(PICO_SOCK_EV_RD, s); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 104 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 105 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 106 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 107 | pico_frame_discard(f); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 108 | return 0; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 109 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 110 | #endif |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 111 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 112 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 113 | int pico_socket_udp_deliver(struct pico_sockport *sp, struct pico_frame *f) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 114 | { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 115 | struct pico_tree_node *index = NULL; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 116 | struct pico_tree_node *_tmp; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 117 | struct pico_socket *s = NULL; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 118 | pico_err = PICO_ERR_EPROTONOSUPPORT; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 119 | #ifdef PICO_SUPPORT_UDP |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 120 | pico_err = PICO_ERR_NOERR; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 121 | pico_tree_foreach_safe(index, &sp->socks, _tmp){ |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 122 | s = index->keyValue; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 123 | if (IS_IPV4(f)) { /* IPV4 */ |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 124 | #ifdef PICO_SUPPORT_IPV4 |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 125 | return pico_socket_udp_deliver_ipv4(s, f); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 126 | #endif |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 127 | } else { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 128 | #ifdef PICO_SUPPORT_IPV6 |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 129 | return pico_socket_udp_deliver_ipv6(s, f); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 130 | #endif |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 131 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 132 | } /* FOREACH */ |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 133 | pico_frame_discard(f); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 134 | if (s) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 135 | return 0; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 136 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 137 | pico_err = PICO_ERR_ENXIO; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 138 | #endif |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 139 | return -1; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 140 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 141 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 142 | int pico_setsockopt_udp(struct pico_socket *s, int option, void *value) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 143 | { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 144 | switch(option) { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 145 | case PICO_SOCKET_OPT_RCVBUF: |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 146 | s->q_in.max_size = (*(uint32_t*)value); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 147 | return 0; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 148 | case PICO_SOCKET_OPT_SNDBUF: |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 149 | s->q_out.max_size = (*(uint32_t*)value); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 150 | return 0; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 151 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 152 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 153 | /* switch's default */ |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 154 | #ifdef PICO_SUPPORT_MCAST |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 155 | return pico_setsockopt_mcast(s, option, value); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 156 | #else |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 157 | pico_err = PICO_ERR_EINVAL; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 158 | return -1; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 159 | #endif |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 160 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 161 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 162 | int pico_getsockopt_udp(struct pico_socket *s, int option, void *value) |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 163 | { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 164 | uint32_t *val = (uint32_t *)value; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 165 | switch(option) { |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 166 | case PICO_SOCKET_OPT_RCVBUF: |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 167 | *val = s->q_in.max_size; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 168 | return 0; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 169 | case PICO_SOCKET_OPT_SNDBUF: |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 170 | *val = s->q_out.max_size; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 171 | return 0; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 172 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 173 | |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 174 | /* switch's default */ |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 175 | #ifdef PICO_SUPPORT_MCAST |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 176 | return pico_getsockopt_mcast(s, option, value); |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 177 | #else |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 178 | pico_err = PICO_ERR_EINVAL; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 179 | return -1; |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 180 | #endif |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 181 | } |
| tass picotcp@tass.be | 149:5f4cb161cec3 | 182 |
