Daniele Lacamera / PicoTCP Featured

Free (GPLv2) TCP/IP stack developed by TASS Belgium

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 RTOS
  • generic mbed Ethernet driver
  • high performance NXP LPC1768 specific Ethernet driver
  • Multi-threading support for mbed RTOS
  • Berkeley sockets and integration with the New Socket API
  • Fork of the apps running on top of the New Socket API
  • Scheduling 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.

Last commit 17 May 2013 by TASS Belgium

modules/pico_udp.c@51:ab4529a384a6, 2013-09-02 (annotated)

Committer:
tass
Date:
Mon Sep 02 08:02:21 2013 +0000
Revision:
51:ab4529a384a6
Parent:
3:b4047e8a0123
Child:
63:97f481e33cb2
Updated from masterbranch

Who changed what in which revision?

UserRevisionLine numberNew contents of line
daniele 3:b4047e8a0123 1 /*********************************************************************
daniele 3:b4047e8a0123 2 PicoTCP. Copyright (c) 2012 TASS Belgium NV. Some rights reserved.
daniele 3:b4047e8a0123 3 See LICENSE and COPYING for usage.
daniele 3:b4047e8a0123 4
daniele 3:b4047e8a0123 5 .
daniele 3:b4047e8a0123 6
daniele 3:b4047e8a0123 7 Authors: Daniele Lacamera
daniele 3:b4047e8a0123 8 *********************************************************************/
daniele 3:b4047e8a0123 9
daniele 3:b4047e8a0123 10
daniele 3:b4047e8a0123 11 #include "pico_udp.h"
daniele 3:b4047e8a0123 12 #include "pico_config.h"
daniele 3:b4047e8a0123 13 #include "pico_eth.h"
daniele 3:b4047e8a0123 14 #include "pico_socket.h"
daniele 3:b4047e8a0123 15 #include "pico_stack.h"
daniele 3:b4047e8a0123 16
daniele 3:b4047e8a0123 17
daniele 3:b4047e8a0123 18 /* Queues */
tass 51:ab4529a384a6 19 static struct pico_queue udp_in = {0};
tass 51:ab4529a384a6 20 static struct pico_queue udp_out = {0};
daniele 3:b4047e8a0123 21
daniele 3:b4047e8a0123 22
daniele 3:b4047e8a0123 23 /* Functions */
daniele 3:b4047e8a0123 24
daniele 3:b4047e8a0123 25 uint16_t pico_udp_checksum_ipv4(struct pico_frame *f)
daniele 3:b4047e8a0123 26 {
daniele 3:b4047e8a0123 27 struct pico_ipv4_hdr *hdr = (struct pico_ipv4_hdr *) f->net_hdr;
daniele 3:b4047e8a0123 28 struct pico_udp_hdr *udp_hdr = (struct pico_udp_hdr *) f->transport_hdr;
daniele 3:b4047e8a0123 29 struct pico_socket *s = f->sock;
daniele 3:b4047e8a0123 30 struct pico_ipv4_pseudo_hdr pseudo;
daniele 3:b4047e8a0123 31
daniele 3:b4047e8a0123 32 if (s) {
daniele 3:b4047e8a0123 33 /* Case of outgoing frame */
daniele 3:b4047e8a0123 34 //dbg("UDP CRC: on outgoing frame\n");
daniele 3:b4047e8a0123 35 pseudo.src.addr = s->local_addr.ip4.addr;
daniele 3:b4047e8a0123 36 pseudo.dst.addr = s->remote_addr.ip4.addr;
daniele 3:b4047e8a0123 37 } else {
daniele 3:b4047e8a0123 38 /* Case of incomming frame */
daniele 3:b4047e8a0123 39 //dbg("UDP CRC: on incomming frame\n");
daniele 3:b4047e8a0123 40 pseudo.src.addr = hdr->src.addr;
daniele 3:b4047e8a0123 41 pseudo.dst.addr = hdr->dst.addr;
daniele 3:b4047e8a0123 42 }
daniele 3:b4047e8a0123 43 pseudo.zeros = 0;
daniele 3:b4047e8a0123 44 pseudo.proto = PICO_PROTO_UDP;
daniele 3:b4047e8a0123 45 pseudo.len = short_be(f->transport_len);
daniele 3:b4047e8a0123 46
daniele 3:b4047e8a0123 47 return pico_dualbuffer_checksum(&pseudo, sizeof(struct pico_ipv4_pseudo_hdr), udp_hdr, f->transport_len);
daniele 3:b4047e8a0123 48 }
daniele 3:b4047e8a0123 49
daniele 3:b4047e8a0123 50
daniele 3:b4047e8a0123 51 static int pico_udp_process_out(struct pico_protocol *self, struct pico_frame *f)
daniele 3:b4047e8a0123 52 {
tass 51:ab4529a384a6 53 IGNORE_PARAMETER(self);
tass 51:ab4529a384a6 54 return pico_network_send(f);
daniele 3:b4047e8a0123 55 }
daniele 3:b4047e8a0123 56
daniele 3:b4047e8a0123 57 static int pico_udp_push(struct pico_protocol *self, struct pico_frame *f)
daniele 3:b4047e8a0123 58 {
daniele 3:b4047e8a0123 59 struct pico_udp_hdr *hdr = (struct pico_udp_hdr *) f->transport_hdr;
daniele 3:b4047e8a0123 60 struct pico_remote_duple *remote_duple = (struct pico_remote_duple *) f->info;
daniele 3:b4047e8a0123 61
daniele 3:b4047e8a0123 62 /* this (fragmented) frame should contain a transport header */
daniele 3:b4047e8a0123 63 if (f->transport_hdr != f->payload) {
daniele 3:b4047e8a0123 64 hdr->trans.sport = f->sock->local_port;
daniele 3:b4047e8a0123 65 if (remote_duple) {
daniele 3:b4047e8a0123 66 hdr->trans.dport = remote_duple->remote_port;
daniele 3:b4047e8a0123 67 } else {
daniele 3:b4047e8a0123 68 hdr->trans.dport = f->sock->remote_port;
daniele 3:b4047e8a0123 69 }
daniele 3:b4047e8a0123 70 hdr->len = short_be(f->transport_len);
daniele 3:b4047e8a0123 71 /* do not perform CRC validation. If you want to, a system needs to be
daniele 3:b4047e8a0123 72 implemented to calculate the CRC over the total payload of a
daniele 3:b4047e8a0123 73 fragmented payload */
daniele 3:b4047e8a0123 74 hdr->crc = 0;
daniele 3:b4047e8a0123 75 }
daniele 3:b4047e8a0123 76
daniele 3:b4047e8a0123 77 if (pico_enqueue(self->q_out, f) > 0) {
daniele 3:b4047e8a0123 78 return f->payload_len;
daniele 3:b4047e8a0123 79 } else {
daniele 3:b4047e8a0123 80 return 0;
tass 51:ab4529a384a6 81 }
daniele 3:b4047e8a0123 82 }
daniele 3:b4047e8a0123 83
daniele 3:b4047e8a0123 84 /* Interface: protocol definition */
daniele 3:b4047e8a0123 85 struct pico_protocol pico_proto_udp = {
daniele 3:b4047e8a0123 86 .name = "udp",
daniele 3:b4047e8a0123 87 .proto_number = PICO_PROTO_UDP,
daniele 3:b4047e8a0123 88 .layer = PICO_LAYER_TRANSPORT,
daniele 3:b4047e8a0123 89 .process_in = pico_transport_process_in,
daniele 3:b4047e8a0123 90 .process_out = pico_udp_process_out,
daniele 3:b4047e8a0123 91 .push = pico_udp_push,
daniele 3:b4047e8a0123 92 .q_in = &udp_in,
daniele 3:b4047e8a0123 93 .q_out = &udp_out,
daniele 3:b4047e8a0123 94 };
daniele 3:b4047e8a0123 95
daniele 3:b4047e8a0123 96
daniele 3:b4047e8a0123 97 #define PICO_UDP_MODE_UNICAST 0x01
daniele 3:b4047e8a0123 98 #define PICO_UDP_MODE_MULTICAST 0x02
daniele 3:b4047e8a0123 99 #define PICO_UDP_MODE_BROADCAST 0xFF
daniele 3:b4047e8a0123 100
daniele 3:b4047e8a0123 101 struct pico_socket_udp
daniele 3:b4047e8a0123 102 {
daniele 3:b4047e8a0123 103 struct pico_socket sock;
daniele 3:b4047e8a0123 104 int mode;
daniele 3:b4047e8a0123 105 #ifdef PICO_SUPPORT_MCAST
daniele 3:b4047e8a0123 106 uint8_t mc_ttl; /* Multicasting TTL */
daniele 3:b4047e8a0123 107 #endif
daniele 3:b4047e8a0123 108 };
daniele 3:b4047e8a0123 109
daniele 3:b4047e8a0123 110 #ifdef PICO_SUPPORT_MCAST
daniele 3:b4047e8a0123 111 int pico_udp_set_mc_ttl(struct pico_socket *s, uint8_t ttl)
daniele 3:b4047e8a0123 112 {
daniele 3:b4047e8a0123 113 struct pico_socket_udp *u;
daniele 3:b4047e8a0123 114 if(!s) {
daniele 3:b4047e8a0123 115 pico_err = PICO_ERR_EINVAL;
daniele 3:b4047e8a0123 116 return -1;
daniele 3:b4047e8a0123 117 }
daniele 3:b4047e8a0123 118 u = (struct pico_socket_udp *) s;
daniele 3:b4047e8a0123 119 u->mc_ttl = ttl;
daniele 3:b4047e8a0123 120 return 0;
daniele 3:b4047e8a0123 121 }
daniele 3:b4047e8a0123 122
daniele 3:b4047e8a0123 123 int pico_udp_get_mc_ttl(struct pico_socket *s, uint8_t *ttl)
daniele 3:b4047e8a0123 124 {
daniele 3:b4047e8a0123 125 struct pico_socket_udp *u;
daniele 3:b4047e8a0123 126 if(!s)
daniele 3:b4047e8a0123 127 return -1;
daniele 3:b4047e8a0123 128 u = (struct pico_socket_udp *) s;
daniele 3:b4047e8a0123 129 *ttl = u->mc_ttl;
daniele 3:b4047e8a0123 130 return 0;
daniele 3:b4047e8a0123 131 }
daniele 3:b4047e8a0123 132 #endif /* PICO_SUPPORT_MCAST */
daniele 3:b4047e8a0123 133
daniele 3:b4047e8a0123 134 struct pico_socket *pico_udp_open(void)
daniele 3:b4047e8a0123 135 {
daniele 3:b4047e8a0123 136 struct pico_socket_udp *u = pico_zalloc(sizeof(struct pico_socket_udp));
daniele 3:b4047e8a0123 137 if (!u)
daniele 3:b4047e8a0123 138 return NULL;
daniele 3:b4047e8a0123 139 u->mode = PICO_UDP_MODE_UNICAST;
daniele 3:b4047e8a0123 140
daniele 3:b4047e8a0123 141 #ifdef PICO_SUPPORT_MCAST
daniele 3:b4047e8a0123 142 u->mc_ttl = PICO_IP_DEFAULT_MULTICAST_TTL;
daniele 3:b4047e8a0123 143 /* enable multicast loopback by default */
daniele 3:b4047e8a0123 144 u->sock.opt_flags |= (1 << PICO_SOCKET_OPT_MULTICAST_LOOP);
daniele 3:b4047e8a0123 145 #endif
daniele 3:b4047e8a0123 146
daniele 3:b4047e8a0123 147 return &u->sock;
daniele 3:b4047e8a0123 148 }
daniele 3:b4047e8a0123 149
daniele 3:b4047e8a0123 150 int pico_udp_recv(struct pico_socket *s, void *buf, int len, void *src, uint16_t *port)
daniele 3:b4047e8a0123 151 {
daniele 3:b4047e8a0123 152 struct pico_frame *f = pico_queue_peek(&s->q_in);
daniele 3:b4047e8a0123 153 if (f) {
daniele 3:b4047e8a0123 154 f->payload = f->transport_hdr + sizeof(struct pico_udp_hdr);
daniele 3:b4047e8a0123 155 f->payload_len = f->transport_len - sizeof(struct pico_udp_hdr);
daniele 3:b4047e8a0123 156 // dbg("expected: %d, got: %d\n", len, f->payload_len);
daniele 3:b4047e8a0123 157 if (src)
daniele 3:b4047e8a0123 158 pico_store_network_origin(src, f);
daniele 3:b4047e8a0123 159 if (port) {
daniele 3:b4047e8a0123 160 struct pico_trans *hdr = (struct pico_trans *)f->transport_hdr;
daniele 3:b4047e8a0123 161 *port = hdr->sport;
daniele 3:b4047e8a0123 162 }
daniele 3:b4047e8a0123 163 if (f->payload_len > len) {
daniele 3:b4047e8a0123 164 memcpy(buf, f->payload, len);
daniele 3:b4047e8a0123 165 f->payload += len;
daniele 3:b4047e8a0123 166 f->payload_len -= len;
daniele 3:b4047e8a0123 167 return len;
daniele 3:b4047e8a0123 168 } else {
daniele 3:b4047e8a0123 169 int ret = f->payload_len;
daniele 3:b4047e8a0123 170 memcpy(buf, f->payload, f->payload_len);
daniele 3:b4047e8a0123 171 f = pico_dequeue(&s->q_in);
daniele 3:b4047e8a0123 172 pico_frame_discard(f);
daniele 3:b4047e8a0123 173 return ret;
daniele 3:b4047e8a0123 174 }
daniele 3:b4047e8a0123 175 } else return 0;
daniele 3:b4047e8a0123 176 }
daniele 3:b4047e8a0123 177