Dieter Graef / F7_Ethernet

Ethernet for Nucleo and Disco board STM32F746 works with gcc and arm. IAC is untested

Dependents:   STM32F746_iothub_client_sample_mqtt DISCO-F746NG_Ethernet Nucleo_F746ZG_Ethernet thethingsiO-DISCO_F746NG-mqtt ... more

lwip/api/sockets.c@1:28ba13dd96f7, 2016-06-23 (annotated)

Committer:
DieterGraef
Date:
Thu Jun 23 09:04:23 2016 +0000
Revision:
1:28ba13dd96f7
Parent:
0:d26c1b55cfca 
corrected MAC issue. The MAC is now 02:00:00:xx:xx:xx where xx is the sum over the unique device register

Who changed what in which revision?

UserRevisionLine numberNew contents of line
DieterGraef 0:d26c1b55cfca 1 /**
DieterGraef 0:d26c1b55cfca 2 * @file
DieterGraef 0:d26c1b55cfca 3 * Sockets BSD-Like API module
DieterGraef 0:d26c1b55cfca 4 *
DieterGraef 0:d26c1b55cfca 5 */
DieterGraef 0:d26c1b55cfca 6
DieterGraef 0:d26c1b55cfca 7 /*
DieterGraef 0:d26c1b55cfca 8 * Copyright (c) 2001-2004 Swedish Institute of Computer Science.
DieterGraef 0:d26c1b55cfca 9 * All rights reserved.
DieterGraef 0:d26c1b55cfca 10 *
DieterGraef 0:d26c1b55cfca 11 * Redistribution and use in source and binary forms, with or without modification,
DieterGraef 0:d26c1b55cfca 12 * are permitted provided that the following conditions are met:
DieterGraef 0:d26c1b55cfca 13 *
DieterGraef 0:d26c1b55cfca 14 * 1. Redistributions of source code must retain the above copyright notice,
DieterGraef 0:d26c1b55cfca 15 * this list of conditions and the following disclaimer.
DieterGraef 0:d26c1b55cfca 16 * 2. Redistributions in binary form must reproduce the above copyright notice,
DieterGraef 0:d26c1b55cfca 17 * this list of conditions and the following disclaimer in the documentation
DieterGraef 0:d26c1b55cfca 18 * and/or other materials provided with the distribution.
DieterGraef 0:d26c1b55cfca 19 * 3. The name of the author may not be used to endorse or promote products
DieterGraef 0:d26c1b55cfca 20 * derived from this software without specific prior written permission.
DieterGraef 0:d26c1b55cfca 21 *
DieterGraef 0:d26c1b55cfca 22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
DieterGraef 0:d26c1b55cfca 23 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
DieterGraef 0:d26c1b55cfca 24 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
DieterGraef 0:d26c1b55cfca 25 * SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
DieterGraef 0:d26c1b55cfca 26 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
DieterGraef 0:d26c1b55cfca 27 * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
DieterGraef 0:d26c1b55cfca 28 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
DieterGraef 0:d26c1b55cfca 29 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
DieterGraef 0:d26c1b55cfca 30 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
DieterGraef 0:d26c1b55cfca 31 * OF SUCH DAMAGE.
DieterGraef 0:d26c1b55cfca 32 *
DieterGraef 0:d26c1b55cfca 33 * This file is part of the lwIP TCP/IP stack.
DieterGraef 0:d26c1b55cfca 34 *
DieterGraef 0:d26c1b55cfca 35 * Author: Adam Dunkels <adam@sics.se>
DieterGraef 0:d26c1b55cfca 36 *
DieterGraef 0:d26c1b55cfca 37 * Improved by Marc Boucher <marc@mbsi.ca> and David Haas <dhaas@alum.rpi.edu>
DieterGraef 0:d26c1b55cfca 38 *
DieterGraef 0:d26c1b55cfca 39 */
DieterGraef 0:d26c1b55cfca 40
DieterGraef 0:d26c1b55cfca 41 #include "lwip/opt.h"
DieterGraef 0:d26c1b55cfca 42
DieterGraef 0:d26c1b55cfca 43 #if LWIP_SOCKET /* don't build if not configured for use in lwipopts.h */
DieterGraef 0:d26c1b55cfca 44
DieterGraef 0:d26c1b55cfca 45 #include "lwip/sockets.h"
DieterGraef 0:d26c1b55cfca 46 #include "lwip/api.h"
DieterGraef 0:d26c1b55cfca 47 #include "lwip/sys.h"
DieterGraef 0:d26c1b55cfca 48 #include "lwip/igmp.h"
DieterGraef 0:d26c1b55cfca 49 #include "lwip/inet.h"
DieterGraef 0:d26c1b55cfca 50 #include "lwip/tcp.h"
DieterGraef 0:d26c1b55cfca 51 #include "lwip/raw.h"
DieterGraef 0:d26c1b55cfca 52 #include "lwip/udp.h"
DieterGraef 0:d26c1b55cfca 53 #include "lwip/tcpip.h"
DieterGraef 0:d26c1b55cfca 54 #include "lwip/pbuf.h"
DieterGraef 0:d26c1b55cfca 55 #if LWIP_CHECKSUM_ON_COPY
DieterGraef 0:d26c1b55cfca 56 #include "lwip/inet_chksum.h"
DieterGraef 0:d26c1b55cfca 57 #endif
DieterGraef 0:d26c1b55cfca 58
DieterGraef 0:d26c1b55cfca 59 #include <string.h>
DieterGraef 0:d26c1b55cfca 60
DieterGraef 0:d26c1b55cfca 61 #define NUM_SOCKETS MEMP_NUM_NETCONN
DieterGraef 0:d26c1b55cfca 62
DieterGraef 0:d26c1b55cfca 63 /** Contains all internal pointers and states used for a socket */
DieterGraef 0:d26c1b55cfca 64 struct lwip_sock {
DieterGraef 0:d26c1b55cfca 65 /** sockets currently are built on netconns, each socket has one netconn */
DieterGraef 0:d26c1b55cfca 66 struct netconn *conn;
DieterGraef 0:d26c1b55cfca 67 /** data that was left from the previous read */
DieterGraef 0:d26c1b55cfca 68 void *lastdata;
DieterGraef 0:d26c1b55cfca 69 /** offset in the data that was left from the previous read */
DieterGraef 0:d26c1b55cfca 70 u16_t lastoffset;
DieterGraef 0:d26c1b55cfca 71 /** number of times data was received, set by event_callback(),
DieterGraef 0:d26c1b55cfca 72 tested by the receive and select functions */
DieterGraef 0:d26c1b55cfca 73 s16_t rcvevent;
DieterGraef 0:d26c1b55cfca 74 /** number of times data was ACKed (free send buffer), set by event_callback(),
DieterGraef 0:d26c1b55cfca 75 tested by select */
DieterGraef 0:d26c1b55cfca 76 u16_t sendevent;
DieterGraef 0:d26c1b55cfca 77 /** error happened for this socket, set by event_callback(), tested by select */
DieterGraef 0:d26c1b55cfca 78 u16_t errevent;
DieterGraef 0:d26c1b55cfca 79 /** last error that occurred on this socket */
DieterGraef 0:d26c1b55cfca 80 int err;
DieterGraef 0:d26c1b55cfca 81 /** counter of how many threads are waiting for this socket using select */
DieterGraef 0:d26c1b55cfca 82 int select_waiting;
DieterGraef 0:d26c1b55cfca 83 };
DieterGraef 0:d26c1b55cfca 84
DieterGraef 0:d26c1b55cfca 85 /** Description for a task waiting in select */
DieterGraef 0:d26c1b55cfca 86 struct lwip_select_cb {
DieterGraef 0:d26c1b55cfca 87 /** Pointer to the next waiting task */
DieterGraef 0:d26c1b55cfca 88 struct lwip_select_cb *next;
DieterGraef 0:d26c1b55cfca 89 /** Pointer to the previous waiting task */
DieterGraef 0:d26c1b55cfca 90 struct lwip_select_cb *prev;
DieterGraef 0:d26c1b55cfca 91 /** readset passed to select */
DieterGraef 0:d26c1b55cfca 92 fd_set *readset;
DieterGraef 0:d26c1b55cfca 93 /** writeset passed to select */
DieterGraef 0:d26c1b55cfca 94 fd_set *writeset;
DieterGraef 0:d26c1b55cfca 95 /** unimplemented: exceptset passed to select */
DieterGraef 0:d26c1b55cfca 96 fd_set *exceptset;
DieterGraef 0:d26c1b55cfca 97 /** don't signal the same semaphore twice: set to 1 when signalled */
DieterGraef 0:d26c1b55cfca 98 int sem_signalled;
DieterGraef 0:d26c1b55cfca 99 /** semaphore to wake up a task waiting for select */
DieterGraef 0:d26c1b55cfca 100 sys_sem_t sem;
DieterGraef 0:d26c1b55cfca 101 };
DieterGraef 0:d26c1b55cfca 102
DieterGraef 0:d26c1b55cfca 103 /** This struct is used to pass data to the set/getsockopt_internal
DieterGraef 0:d26c1b55cfca 104 * functions running in tcpip_thread context (only a void* is allowed) */
DieterGraef 0:d26c1b55cfca 105 struct lwip_setgetsockopt_data {
DieterGraef 0:d26c1b55cfca 106 /** socket struct for which to change options */
DieterGraef 0:d26c1b55cfca 107 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 108 #ifdef LWIP_DEBUG
DieterGraef 0:d26c1b55cfca 109 /** socket index for which to change options */
DieterGraef 0:d26c1b55cfca 110 int s;
DieterGraef 0:d26c1b55cfca 111 #endif /* LWIP_DEBUG */
DieterGraef 0:d26c1b55cfca 112 /** level of the option to process */
DieterGraef 0:d26c1b55cfca 113 int level;
DieterGraef 0:d26c1b55cfca 114 /** name of the option to process */
DieterGraef 0:d26c1b55cfca 115 int optname;
DieterGraef 0:d26c1b55cfca 116 /** set: value to set the option to
DieterGraef 0:d26c1b55cfca 117 * get: value of the option is stored here */
DieterGraef 0:d26c1b55cfca 118 void *optval;
DieterGraef 0:d26c1b55cfca 119 /** size of *optval */
DieterGraef 0:d26c1b55cfca 120 socklen_t *optlen;
DieterGraef 0:d26c1b55cfca 121 /** if an error occures, it is temporarily stored here */
DieterGraef 0:d26c1b55cfca 122 err_t err;
DieterGraef 0:d26c1b55cfca 123 };
DieterGraef 0:d26c1b55cfca 124
DieterGraef 0:d26c1b55cfca 125 /** The global array of available sockets */
DieterGraef 0:d26c1b55cfca 126 static struct lwip_sock sockets[NUM_SOCKETS];
DieterGraef 0:d26c1b55cfca 127 /** The global list of tasks waiting for select */
DieterGraef 0:d26c1b55cfca 128 static struct lwip_select_cb *select_cb_list;
DieterGraef 0:d26c1b55cfca 129 /** This counter is increased from lwip_select when the list is chagned
DieterGraef 0:d26c1b55cfca 130 and checked in event_callback to see if it has changed. */
DieterGraef 0:d26c1b55cfca 131 static volatile int select_cb_ctr;
DieterGraef 0:d26c1b55cfca 132
DieterGraef 0:d26c1b55cfca 133 /** Table to quickly map an lwIP error (err_t) to a socket error
DieterGraef 0:d26c1b55cfca 134 * by using -err as an index */
DieterGraef 0:d26c1b55cfca 135 static const int err_to_errno_table[] = {
DieterGraef 0:d26c1b55cfca 136 0, /* ERR_OK 0 No error, everything OK. */
DieterGraef 0:d26c1b55cfca 137 ENOMEM, /* ERR_MEM -1 Out of memory error. */
DieterGraef 0:d26c1b55cfca 138 ENOBUFS, /* ERR_BUF -2 Buffer error. */
DieterGraef 0:d26c1b55cfca 139 EWOULDBLOCK, /* ERR_TIMEOUT -3 Timeout */
DieterGraef 0:d26c1b55cfca 140 EHOSTUNREACH, /* ERR_RTE -4 Routing problem. */
DieterGraef 0:d26c1b55cfca 141 EINPROGRESS, /* ERR_INPROGRESS -5 Operation in progress */
DieterGraef 0:d26c1b55cfca 142 EINVAL, /* ERR_VAL -6 Illegal value. */
DieterGraef 0:d26c1b55cfca 143 EWOULDBLOCK, /* ERR_WOULDBLOCK -7 Operation would block. */
DieterGraef 0:d26c1b55cfca 144 EADDRINUSE, /* ERR_USE -8 Address in use. */
DieterGraef 0:d26c1b55cfca 145 EALREADY, /* ERR_ISCONN -9 Already connected. */
DieterGraef 0:d26c1b55cfca 146 ECONNABORTED, /* ERR_ABRT -10 Connection aborted. */
DieterGraef 0:d26c1b55cfca 147 ECONNRESET, /* ERR_RST -11 Connection reset. */
DieterGraef 0:d26c1b55cfca 148 ENOTCONN, /* ERR_CLSD -12 Connection closed. */
DieterGraef 0:d26c1b55cfca 149 ENOTCONN, /* ERR_CONN -13 Not connected. */
DieterGraef 0:d26c1b55cfca 150 EIO, /* ERR_ARG -14 Illegal argument. */
DieterGraef 0:d26c1b55cfca 151 -1, /* ERR_IF -15 Low-level netif error */
DieterGraef 0:d26c1b55cfca 152 };
DieterGraef 0:d26c1b55cfca 153
DieterGraef 0:d26c1b55cfca 154 #define ERR_TO_ERRNO_TABLE_SIZE \
DieterGraef 0:d26c1b55cfca 155 (sizeof(err_to_errno_table)/sizeof(err_to_errno_table[0]))
DieterGraef 0:d26c1b55cfca 156
DieterGraef 0:d26c1b55cfca 157 #define err_to_errno(err) \
DieterGraef 0:d26c1b55cfca 158 ((unsigned)(-(err)) < ERR_TO_ERRNO_TABLE_SIZE ? \
DieterGraef 0:d26c1b55cfca 159 err_to_errno_table[-(err)] : EIO)
DieterGraef 0:d26c1b55cfca 160
DieterGraef 0:d26c1b55cfca 161 #ifdef ERRNO
DieterGraef 0:d26c1b55cfca 162 #if defined(TOOLCHAIN_ARM_STD)
DieterGraef 0:d26c1b55cfca 163 static int errno;
DieterGraef 0:d26c1b55cfca 164 #endif
DieterGraef 0:d26c1b55cfca 165 #ifndef set_errno
DieterGraef 0:d26c1b55cfca 166 #define set_errno(err) errno = (err)
DieterGraef 0:d26c1b55cfca 167 #endif
DieterGraef 0:d26c1b55cfca 168 #else /* ERRNO */
DieterGraef 0:d26c1b55cfca 169 #define set_errno(err)
DieterGraef 0:d26c1b55cfca 170 #endif /* ERRNO */
DieterGraef 0:d26c1b55cfca 171
DieterGraef 0:d26c1b55cfca 172 #define sock_set_errno(sk, e) do { \
DieterGraef 0:d26c1b55cfca 173 sk->err = (e); \
DieterGraef 0:d26c1b55cfca 174 set_errno(sk->err); \
DieterGraef 0:d26c1b55cfca 175 } while (0)
DieterGraef 0:d26c1b55cfca 176
DieterGraef 0:d26c1b55cfca 177 /* Forward delcaration of some functions */
DieterGraef 0:d26c1b55cfca 178 static void event_callback(struct netconn *conn, enum netconn_evt evt, u16_t len);
DieterGraef 0:d26c1b55cfca 179 static void lwip_getsockopt_internal(void *arg);
DieterGraef 0:d26c1b55cfca 180 static void lwip_setsockopt_internal(void *arg);
DieterGraef 0:d26c1b55cfca 181
DieterGraef 0:d26c1b55cfca 182 /**
DieterGraef 0:d26c1b55cfca 183 * Initialize this module. This function has to be called before any other
DieterGraef 0:d26c1b55cfca 184 * functions in this module!
DieterGraef 0:d26c1b55cfca 185 */
DieterGraef 0:d26c1b55cfca 186 void
DieterGraef 0:d26c1b55cfca 187 lwip_socket_init(void)
DieterGraef 0:d26c1b55cfca 188 {
DieterGraef 0:d26c1b55cfca 189 }
DieterGraef 0:d26c1b55cfca 190
DieterGraef 0:d26c1b55cfca 191 /**
DieterGraef 0:d26c1b55cfca 192 * Map a externally used socket index to the internal socket representation.
DieterGraef 0:d26c1b55cfca 193 *
DieterGraef 0:d26c1b55cfca 194 * @param s externally used socket index
DieterGraef 0:d26c1b55cfca 195 * @return struct lwip_sock for the socket or NULL if not found
DieterGraef 0:d26c1b55cfca 196 */
DieterGraef 0:d26c1b55cfca 197 static struct lwip_sock *
DieterGraef 0:d26c1b55cfca 198 get_socket(int s)
DieterGraef 0:d26c1b55cfca 199 {
DieterGraef 0:d26c1b55cfca 200 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 201
DieterGraef 0:d26c1b55cfca 202 if ((s < 0) || (s >= NUM_SOCKETS)) {
DieterGraef 0:d26c1b55cfca 203 LWIP_DEBUGF(SOCKETS_DEBUG, ("get_socket(%d): invalid\n", s));
DieterGraef 0:d26c1b55cfca 204 set_errno(EBADF);
DieterGraef 0:d26c1b55cfca 205 return NULL;
DieterGraef 0:d26c1b55cfca 206 }
DieterGraef 0:d26c1b55cfca 207
DieterGraef 0:d26c1b55cfca 208 sock = &sockets[s];
DieterGraef 0:d26c1b55cfca 209
DieterGraef 0:d26c1b55cfca 210 if (!sock->conn) {
DieterGraef 0:d26c1b55cfca 211 LWIP_DEBUGF(SOCKETS_DEBUG, ("get_socket(%d): not active\n", s));
DieterGraef 0:d26c1b55cfca 212 set_errno(EBADF);
DieterGraef 0:d26c1b55cfca 213 return NULL;
DieterGraef 0:d26c1b55cfca 214 }
DieterGraef 0:d26c1b55cfca 215
DieterGraef 0:d26c1b55cfca 216 return sock;
DieterGraef 0:d26c1b55cfca 217 }
DieterGraef 0:d26c1b55cfca 218
DieterGraef 0:d26c1b55cfca 219 /**
DieterGraef 0:d26c1b55cfca 220 * Same as get_socket but doesn't set errno
DieterGraef 0:d26c1b55cfca 221 *
DieterGraef 0:d26c1b55cfca 222 * @param s externally used socket index
DieterGraef 0:d26c1b55cfca 223 * @return struct lwip_sock for the socket or NULL if not found
DieterGraef 0:d26c1b55cfca 224 */
DieterGraef 0:d26c1b55cfca 225 static struct lwip_sock *
DieterGraef 0:d26c1b55cfca 226 tryget_socket(int s)
DieterGraef 0:d26c1b55cfca 227 {
DieterGraef 0:d26c1b55cfca 228 if ((s < 0) || (s >= NUM_SOCKETS)) {
DieterGraef 0:d26c1b55cfca 229 return NULL;
DieterGraef 0:d26c1b55cfca 230 }
DieterGraef 0:d26c1b55cfca 231 if (!sockets[s].conn) {
DieterGraef 0:d26c1b55cfca 232 return NULL;
DieterGraef 0:d26c1b55cfca 233 }
DieterGraef 0:d26c1b55cfca 234 return &sockets[s];
DieterGraef 0:d26c1b55cfca 235 }
DieterGraef 0:d26c1b55cfca 236
DieterGraef 0:d26c1b55cfca 237 /**
DieterGraef 0:d26c1b55cfca 238 * Allocate a new socket for a given netconn.
DieterGraef 0:d26c1b55cfca 239 *
DieterGraef 0:d26c1b55cfca 240 * @param newconn the netconn for which to allocate a socket
DieterGraef 0:d26c1b55cfca 241 * @param accepted 1 if socket has been created by accept(),
DieterGraef 0:d26c1b55cfca 242 * 0 if socket has been created by socket()
DieterGraef 0:d26c1b55cfca 243 * @return the index of the new socket; -1 on error
DieterGraef 0:d26c1b55cfca 244 */
DieterGraef 0:d26c1b55cfca 245 static int
DieterGraef 0:d26c1b55cfca 246 alloc_socket(struct netconn *newconn, int accepted)
DieterGraef 0:d26c1b55cfca 247 {
DieterGraef 0:d26c1b55cfca 248 int i;
DieterGraef 0:d26c1b55cfca 249 SYS_ARCH_DECL_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 250
DieterGraef 0:d26c1b55cfca 251 /* allocate a new socket identifier */
DieterGraef 0:d26c1b55cfca 252 for (i = 0; i < NUM_SOCKETS; ++i) {
DieterGraef 0:d26c1b55cfca 253 /* Protect socket array */
DieterGraef 0:d26c1b55cfca 254 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 255 if (!sockets[i].conn) {
DieterGraef 0:d26c1b55cfca 256 sockets[i].conn = newconn;
DieterGraef 0:d26c1b55cfca 257 /* The socket is not yet known to anyone, so no need to protect
DieterGraef 0:d26c1b55cfca 258 after having marked it as used. */
DieterGraef 0:d26c1b55cfca 259 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 260 sockets[i].lastdata = NULL;
DieterGraef 0:d26c1b55cfca 261 sockets[i].lastoffset = 0;
DieterGraef 0:d26c1b55cfca 262 sockets[i].rcvevent = 0;
DieterGraef 0:d26c1b55cfca 263 /* TCP sendbuf is empty, but the socket is not yet writable until connected
DieterGraef 0:d26c1b55cfca 264 * (unless it has been created by accept()). */
DieterGraef 0:d26c1b55cfca 265 sockets[i].sendevent = (newconn->type == NETCONN_TCP ? (accepted != 0) : 1);
DieterGraef 0:d26c1b55cfca 266 sockets[i].errevent = 0;
DieterGraef 0:d26c1b55cfca 267 sockets[i].err = 0;
DieterGraef 0:d26c1b55cfca 268 sockets[i].select_waiting = 0;
DieterGraef 0:d26c1b55cfca 269 return i;
DieterGraef 0:d26c1b55cfca 270 }
DieterGraef 0:d26c1b55cfca 271 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 272 }
DieterGraef 0:d26c1b55cfca 273 return -1;
DieterGraef 0:d26c1b55cfca 274 }
DieterGraef 0:d26c1b55cfca 275
DieterGraef 0:d26c1b55cfca 276 /** Free a socket. The socket's netconn must have been
DieterGraef 0:d26c1b55cfca 277 * delete before!
DieterGraef 0:d26c1b55cfca 278 *
DieterGraef 0:d26c1b55cfca 279 * @param sock the socket to free
DieterGraef 0:d26c1b55cfca 280 * @param is_tcp != 0 for TCP sockets, used to free lastdata
DieterGraef 0:d26c1b55cfca 281 */
DieterGraef 0:d26c1b55cfca 282 static void
DieterGraef 0:d26c1b55cfca 283 free_socket(struct lwip_sock *sock, int is_tcp)
DieterGraef 0:d26c1b55cfca 284 {
DieterGraef 0:d26c1b55cfca 285 void *lastdata;
DieterGraef 0:d26c1b55cfca 286 SYS_ARCH_DECL_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 287
DieterGraef 0:d26c1b55cfca 288 lastdata = sock->lastdata;
DieterGraef 0:d26c1b55cfca 289 sock->lastdata = NULL;
DieterGraef 0:d26c1b55cfca 290 sock->lastoffset = 0;
DieterGraef 0:d26c1b55cfca 291 sock->err = 0;
DieterGraef 0:d26c1b55cfca 292
DieterGraef 0:d26c1b55cfca 293 /* Protect socket array */
DieterGraef 0:d26c1b55cfca 294 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 295 sock->conn = NULL;
DieterGraef 0:d26c1b55cfca 296 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 297 /* don't use 'sock' after this line, as another task might have allocated it */
DieterGraef 0:d26c1b55cfca 298
DieterGraef 0:d26c1b55cfca 299 if (lastdata != NULL) {
DieterGraef 0:d26c1b55cfca 300 if (is_tcp) {
DieterGraef 0:d26c1b55cfca 301 pbuf_free((struct pbuf *)lastdata);
DieterGraef 0:d26c1b55cfca 302 } else {
DieterGraef 0:d26c1b55cfca 303 netbuf_delete((struct netbuf *)lastdata);
DieterGraef 0:d26c1b55cfca 304 }
DieterGraef 0:d26c1b55cfca 305 }
DieterGraef 0:d26c1b55cfca 306 }
DieterGraef 0:d26c1b55cfca 307
DieterGraef 0:d26c1b55cfca 308 /* Below this, the well-known socket functions are implemented.
DieterGraef 0:d26c1b55cfca 309 * Use google.com or opengroup.org to get a good description :-)
DieterGraef 0:d26c1b55cfca 310 *
DieterGraef 0:d26c1b55cfca 311 * Exceptions are documented!
DieterGraef 0:d26c1b55cfca 312 */
DieterGraef 0:d26c1b55cfca 313
DieterGraef 0:d26c1b55cfca 314 int
DieterGraef 0:d26c1b55cfca 315 lwip_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
DieterGraef 0:d26c1b55cfca 316 {
DieterGraef 0:d26c1b55cfca 317 struct lwip_sock *sock, *nsock;
DieterGraef 0:d26c1b55cfca 318 struct netconn *newconn;
DieterGraef 0:d26c1b55cfca 319 ip_addr_t naddr;
DieterGraef 0:d26c1b55cfca 320 u16_t port;
DieterGraef 0:d26c1b55cfca 321 int newsock;
DieterGraef 0:d26c1b55cfca 322 struct sockaddr_in sin;
DieterGraef 0:d26c1b55cfca 323 err_t err;
DieterGraef 0:d26c1b55cfca 324 SYS_ARCH_DECL_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 325
DieterGraef 0:d26c1b55cfca 326 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_accept(%d)...\n", s));
DieterGraef 0:d26c1b55cfca 327 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 328 if (!sock) {
DieterGraef 0:d26c1b55cfca 329 return -1;
DieterGraef 0:d26c1b55cfca 330 }
DieterGraef 0:d26c1b55cfca 331
DieterGraef 0:d26c1b55cfca 332 if (netconn_is_nonblocking(sock->conn) && (sock->rcvevent <= 0)) {
DieterGraef 0:d26c1b55cfca 333 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_accept(%d): returning EWOULDBLOCK\n", s));
DieterGraef 0:d26c1b55cfca 334 sock_set_errno(sock, EWOULDBLOCK);
DieterGraef 0:d26c1b55cfca 335 return -1;
DieterGraef 0:d26c1b55cfca 336 }
DieterGraef 0:d26c1b55cfca 337
DieterGraef 0:d26c1b55cfca 338 /* wait for a new connection */
DieterGraef 0:d26c1b55cfca 339 err = netconn_accept(sock->conn, &newconn);
DieterGraef 0:d26c1b55cfca 340 if (err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 341 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_accept(%d): netconn_acept failed, err=%d\n", s, err));
DieterGraef 0:d26c1b55cfca 342 if (netconn_type(sock->conn) != NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 343 sock_set_errno(sock, EOPNOTSUPP);
DieterGraef 0:d26c1b55cfca 344 return EOPNOTSUPP;
DieterGraef 0:d26c1b55cfca 345 }
DieterGraef 0:d26c1b55cfca 346 sock_set_errno(sock, err_to_errno(err));
DieterGraef 0:d26c1b55cfca 347 return -1;
DieterGraef 0:d26c1b55cfca 348 }
DieterGraef 0:d26c1b55cfca 349
DieterGraef 0:d26c1b55cfca 350 LWIP_ASSERT("newconn != NULL", newconn != NULL);
DieterGraef 0:d26c1b55cfca 351 /* Prevent automatic window updates, we do this on our own! */
DieterGraef 0:d26c1b55cfca 352 netconn_set_noautorecved(newconn, 1);
DieterGraef 0:d26c1b55cfca 353
DieterGraef 0:d26c1b55cfca 354 /* get the IP address and port of the remote host */
DieterGraef 0:d26c1b55cfca 355 err = netconn_peer(newconn, &naddr, &port);
DieterGraef 0:d26c1b55cfca 356 if (err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 357 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_accept(%d): netconn_peer failed, err=%d\n", s, err));
DieterGraef 0:d26c1b55cfca 358 netconn_delete(newconn);
DieterGraef 0:d26c1b55cfca 359 sock_set_errno(sock, err_to_errno(err));
DieterGraef 0:d26c1b55cfca 360 return -1;
DieterGraef 0:d26c1b55cfca 361 }
DieterGraef 0:d26c1b55cfca 362
DieterGraef 0:d26c1b55cfca 363 /* Note that POSIX only requires us to check addr is non-NULL. addrlen must
DieterGraef 0:d26c1b55cfca 364 * not be NULL if addr is valid.
DieterGraef 0:d26c1b55cfca 365 */
DieterGraef 0:d26c1b55cfca 366 if (NULL != addr) {
DieterGraef 0:d26c1b55cfca 367 LWIP_ASSERT("addr valid but addrlen NULL", addrlen != NULL);
DieterGraef 0:d26c1b55cfca 368 memset(&sin, 0, sizeof(sin));
DieterGraef 0:d26c1b55cfca 369 sin.sin_len = sizeof(sin);
DieterGraef 0:d26c1b55cfca 370 sin.sin_family = AF_INET;
DieterGraef 0:d26c1b55cfca 371 sin.sin_port = htons(port);
DieterGraef 0:d26c1b55cfca 372 inet_addr_from_ipaddr(&sin.sin_addr, &naddr);
DieterGraef 0:d26c1b55cfca 373
DieterGraef 0:d26c1b55cfca 374 if (*addrlen > sizeof(sin))
DieterGraef 0:d26c1b55cfca 375 *addrlen = sizeof(sin);
DieterGraef 0:d26c1b55cfca 376
DieterGraef 0:d26c1b55cfca 377 MEMCPY(addr, &sin, *addrlen);
DieterGraef 0:d26c1b55cfca 378 }
DieterGraef 0:d26c1b55cfca 379
DieterGraef 0:d26c1b55cfca 380 newsock = alloc_socket(newconn, 1);
DieterGraef 0:d26c1b55cfca 381 if (newsock == -1) {
DieterGraef 0:d26c1b55cfca 382 LWIP_DEBUGF(SOCKETS_DEBUG, ("socket: alloc socket failed\n"));
DieterGraef 0:d26c1b55cfca 383 netconn_delete(newconn);
DieterGraef 0:d26c1b55cfca 384 sock_set_errno(sock, ENFILE);
DieterGraef 0:d26c1b55cfca 385 return -1;
DieterGraef 0:d26c1b55cfca 386 }
DieterGraef 0:d26c1b55cfca 387 LWIP_ASSERT("invalid socket index", (newsock >= 0) && (newsock < NUM_SOCKETS));
DieterGraef 0:d26c1b55cfca 388 LWIP_ASSERT("newconn->callback == event_callback", newconn->callback == event_callback);
DieterGraef 0:d26c1b55cfca 389 nsock = &sockets[newsock];
DieterGraef 0:d26c1b55cfca 390
DieterGraef 0:d26c1b55cfca 391 /* See event_callback: If data comes in right away after an accept, even
DieterGraef 0:d26c1b55cfca 392 * though the server task might not have created a new socket yet.
DieterGraef 0:d26c1b55cfca 393 * In that case, newconn->socket is counted down (newconn->socket--),
DieterGraef 0:d26c1b55cfca 394 * so nsock->rcvevent is >= 1 here!
DieterGraef 0:d26c1b55cfca 395 */
DieterGraef 0:d26c1b55cfca 396 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 397 nsock->rcvevent += (s16_t)(-1 - newconn->socket);
DieterGraef 0:d26c1b55cfca 398 newconn->socket = newsock;
DieterGraef 0:d26c1b55cfca 399 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 400
DieterGraef 0:d26c1b55cfca 401 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_accept(%d) returning new sock=%d addr= 0x%x\r\n", s, newsock,newconn));
DieterGraef 0:d26c1b55cfca 402 ip_addr_debug_print(SOCKETS_DEBUG, &naddr);
DieterGraef 0:d26c1b55cfca 403 LWIP_DEBUGF(SOCKETS_DEBUG, (" port=%"U16_F"\n", port));
DieterGraef 0:d26c1b55cfca 404
DieterGraef 0:d26c1b55cfca 405 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 406 return newsock;
DieterGraef 0:d26c1b55cfca 407 }
DieterGraef 0:d26c1b55cfca 408
DieterGraef 0:d26c1b55cfca 409 int
DieterGraef 0:d26c1b55cfca 410 lwip_bind(int s, const struct sockaddr *name, socklen_t namelen)
DieterGraef 0:d26c1b55cfca 411 {
DieterGraef 0:d26c1b55cfca 412 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 413 ip_addr_t local_addr;
DieterGraef 0:d26c1b55cfca 414 u16_t local_port;
DieterGraef 0:d26c1b55cfca 415 err_t err;
DieterGraef 0:d26c1b55cfca 416 const struct sockaddr_in *name_in;
DieterGraef 0:d26c1b55cfca 417
DieterGraef 0:d26c1b55cfca 418 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 419 if (!sock) {
DieterGraef 0:d26c1b55cfca 420 return -1;
DieterGraef 0:d26c1b55cfca 421 }
DieterGraef 0:d26c1b55cfca 422
DieterGraef 0:d26c1b55cfca 423 /* check size, familiy and alignment of 'name' */
DieterGraef 0:d26c1b55cfca 424 LWIP_ERROR("lwip_bind: invalid address", ((namelen == sizeof(struct sockaddr_in)) &&
DieterGraef 0:d26c1b55cfca 425 ((name->sa_family) == AF_INET) && ((((mem_ptr_t)name) % 4) == 0)),
DieterGraef 0:d26c1b55cfca 426 sock_set_errno(sock, err_to_errno(ERR_ARG)); return -1;);
DieterGraef 0:d26c1b55cfca 427 name_in = (const struct sockaddr_in *)(void*)name;
DieterGraef 0:d26c1b55cfca 428
DieterGraef 0:d26c1b55cfca 429 inet_addr_to_ipaddr(&local_addr, &name_in->sin_addr);
DieterGraef 0:d26c1b55cfca 430 local_port = name_in->sin_port;
DieterGraef 0:d26c1b55cfca 431
DieterGraef 0:d26c1b55cfca 432 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_bind(%d, addr=", s));
DieterGraef 0:d26c1b55cfca 433 ip_addr_debug_print(SOCKETS_DEBUG, &local_addr);
DieterGraef 0:d26c1b55cfca 434 LWIP_DEBUGF(SOCKETS_DEBUG, (" port=%"U16_F")\n", ntohs(local_port)));
DieterGraef 0:d26c1b55cfca 435
DieterGraef 0:d26c1b55cfca 436 err = netconn_bind(sock->conn, &local_addr, ntohs(local_port));
DieterGraef 0:d26c1b55cfca 437
DieterGraef 0:d26c1b55cfca 438 if (err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 439 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_bind(%d) failed, err=%d\n", s, err));
DieterGraef 0:d26c1b55cfca 440 sock_set_errno(sock, err_to_errno(err));
DieterGraef 0:d26c1b55cfca 441 return -1;
DieterGraef 0:d26c1b55cfca 442 }
DieterGraef 0:d26c1b55cfca 443
DieterGraef 0:d26c1b55cfca 444 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_bind(%d) succeeded\n", s));
DieterGraef 0:d26c1b55cfca 445 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 446 return 0;
DieterGraef 0:d26c1b55cfca 447 }
DieterGraef 0:d26c1b55cfca 448
DieterGraef 0:d26c1b55cfca 449 int
DieterGraef 0:d26c1b55cfca 450 lwip_close(int s)
DieterGraef 0:d26c1b55cfca 451 {
DieterGraef 0:d26c1b55cfca 452 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 453 int is_tcp = 0;
DieterGraef 0:d26c1b55cfca 454
DieterGraef 0:d26c1b55cfca 455 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_close(%d)\n", s));
DieterGraef 0:d26c1b55cfca 456
DieterGraef 0:d26c1b55cfca 457 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 458 if (!sock) {
DieterGraef 0:d26c1b55cfca 459 return -1;
DieterGraef 0:d26c1b55cfca 460 }
DieterGraef 0:d26c1b55cfca 461
DieterGraef 0:d26c1b55cfca 462 if(sock->conn != NULL) {
DieterGraef 0:d26c1b55cfca 463 is_tcp = netconn_type(sock->conn) == NETCONN_TCP;
DieterGraef 0:d26c1b55cfca 464 } else {
DieterGraef 0:d26c1b55cfca 465 LWIP_ASSERT("sock->lastdata == NULL", sock->lastdata == NULL);
DieterGraef 0:d26c1b55cfca 466 }
DieterGraef 0:d26c1b55cfca 467
DieterGraef 0:d26c1b55cfca 468 netconn_delete(sock->conn);
DieterGraef 0:d26c1b55cfca 469
DieterGraef 0:d26c1b55cfca 470 free_socket(sock, is_tcp);
DieterGraef 0:d26c1b55cfca 471 set_errno(0);
DieterGraef 0:d26c1b55cfca 472 return 0;
DieterGraef 0:d26c1b55cfca 473 }
DieterGraef 0:d26c1b55cfca 474
DieterGraef 0:d26c1b55cfca 475 int
DieterGraef 0:d26c1b55cfca 476 lwip_connect(int s, const struct sockaddr *name, socklen_t namelen)
DieterGraef 0:d26c1b55cfca 477 {
DieterGraef 0:d26c1b55cfca 478 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 479 err_t err;
DieterGraef 0:d26c1b55cfca 480 const struct sockaddr_in *name_in;
DieterGraef 0:d26c1b55cfca 481
DieterGraef 0:d26c1b55cfca 482 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 483 if (!sock) {
DieterGraef 0:d26c1b55cfca 484 return -1;
DieterGraef 0:d26c1b55cfca 485 }
DieterGraef 0:d26c1b55cfca 486
DieterGraef 0:d26c1b55cfca 487 /* check size, familiy and alignment of 'name' */
DieterGraef 0:d26c1b55cfca 488 LWIP_ERROR("lwip_connect: invalid address", ((namelen == sizeof(struct sockaddr_in)) &&
DieterGraef 0:d26c1b55cfca 489 ((name->sa_family) == AF_INET) && ((((mem_ptr_t)name) % 4) == 0)),
DieterGraef 0:d26c1b55cfca 490 sock_set_errno(sock, err_to_errno(ERR_ARG)); return -1;);
DieterGraef 0:d26c1b55cfca 491 name_in = (const struct sockaddr_in *)(void*)name;
DieterGraef 0:d26c1b55cfca 492
DieterGraef 0:d26c1b55cfca 493 if (name_in->sin_family == AF_UNSPEC) {
DieterGraef 0:d26c1b55cfca 494 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_connect(%d, AF_UNSPEC)\n", s));
DieterGraef 0:d26c1b55cfca 495 err = netconn_disconnect(sock->conn);
DieterGraef 0:d26c1b55cfca 496 } else {
DieterGraef 0:d26c1b55cfca 497 ip_addr_t remote_addr;
DieterGraef 0:d26c1b55cfca 498 u16_t remote_port;
DieterGraef 0:d26c1b55cfca 499
DieterGraef 0:d26c1b55cfca 500 inet_addr_to_ipaddr(&remote_addr, &name_in->sin_addr);
DieterGraef 0:d26c1b55cfca 501 remote_port = name_in->sin_port;
DieterGraef 0:d26c1b55cfca 502
DieterGraef 0:d26c1b55cfca 503 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_connect(%d, addr=", s));
DieterGraef 0:d26c1b55cfca 504 ip_addr_debug_print(SOCKETS_DEBUG, &remote_addr);
DieterGraef 0:d26c1b55cfca 505 LWIP_DEBUGF(SOCKETS_DEBUG, (" port=%"U16_F")\n", ntohs(remote_port)));
DieterGraef 0:d26c1b55cfca 506
DieterGraef 0:d26c1b55cfca 507 err = netconn_connect(sock->conn, &remote_addr, ntohs(remote_port));
DieterGraef 0:d26c1b55cfca 508 }
DieterGraef 0:d26c1b55cfca 509
DieterGraef 0:d26c1b55cfca 510 if (err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 511 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_connect(%d) failed, err=%d\n", s, err));
DieterGraef 0:d26c1b55cfca 512 sock_set_errno(sock, err_to_errno(err));
DieterGraef 0:d26c1b55cfca 513 return -1;
DieterGraef 0:d26c1b55cfca 514 }
DieterGraef 0:d26c1b55cfca 515
DieterGraef 0:d26c1b55cfca 516 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_connect(%d) succeeded\n", s));
DieterGraef 0:d26c1b55cfca 517 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 518 return 0;
DieterGraef 0:d26c1b55cfca 519 }
DieterGraef 0:d26c1b55cfca 520
DieterGraef 0:d26c1b55cfca 521 /**
DieterGraef 0:d26c1b55cfca 522 * Set a socket into listen mode.
DieterGraef 0:d26c1b55cfca 523 * The socket may not have been used for another connection previously.
DieterGraef 0:d26c1b55cfca 524 *
DieterGraef 0:d26c1b55cfca 525 * @param s the socket to set to listening mode
DieterGraef 0:d26c1b55cfca 526 * @param backlog (ATTENTION: needs TCP_LISTEN_BACKLOG=1)
DieterGraef 0:d26c1b55cfca 527 * @return 0 on success, non-zero on failure
DieterGraef 0:d26c1b55cfca 528 */
DieterGraef 0:d26c1b55cfca 529 int
DieterGraef 0:d26c1b55cfca 530 lwip_listen(int s, int backlog)
DieterGraef 0:d26c1b55cfca 531 {
DieterGraef 0:d26c1b55cfca 532 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 533 err_t err;
DieterGraef 0:d26c1b55cfca 534
DieterGraef 0:d26c1b55cfca 535 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_listen(%d, backlog=%d)\n", s, backlog));
DieterGraef 0:d26c1b55cfca 536
DieterGraef 0:d26c1b55cfca 537 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 538 if (!sock) {
DieterGraef 0:d26c1b55cfca 539 return -1;
DieterGraef 0:d26c1b55cfca 540 }
DieterGraef 0:d26c1b55cfca 541
DieterGraef 0:d26c1b55cfca 542 /* limit the "backlog" parameter to fit in an u8_t */
DieterGraef 0:d26c1b55cfca 543 backlog = LWIP_MIN(LWIP_MAX(backlog, 0), 0xff);
DieterGraef 0:d26c1b55cfca 544
DieterGraef 0:d26c1b55cfca 545 err = netconn_listen_with_backlog(sock->conn, (u8_t)backlog);
DieterGraef 0:d26c1b55cfca 546
DieterGraef 0:d26c1b55cfca 547 if (err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 548 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_listen(%d) failed, err=%d\n", s, err));
DieterGraef 0:d26c1b55cfca 549 if (netconn_type(sock->conn) != NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 550 sock_set_errno(sock, EOPNOTSUPP);
DieterGraef 0:d26c1b55cfca 551 return EOPNOTSUPP;
DieterGraef 0:d26c1b55cfca 552 }
DieterGraef 0:d26c1b55cfca 553 sock_set_errno(sock, err_to_errno(err));
DieterGraef 0:d26c1b55cfca 554 return -1;
DieterGraef 0:d26c1b55cfca 555 }
DieterGraef 0:d26c1b55cfca 556
DieterGraef 0:d26c1b55cfca 557 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 558 return 0;
DieterGraef 0:d26c1b55cfca 559 }
DieterGraef 0:d26c1b55cfca 560
DieterGraef 0:d26c1b55cfca 561 int
DieterGraef 0:d26c1b55cfca 562 lwip_recvfrom(int s, void *mem, size_t len, int flags,
DieterGraef 0:d26c1b55cfca 563 struct sockaddr *from, socklen_t *fromlen)
DieterGraef 0:d26c1b55cfca 564 {
DieterGraef 0:d26c1b55cfca 565 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 566 void *buf = NULL;
DieterGraef 0:d26c1b55cfca 567 struct pbuf *p;
DieterGraef 0:d26c1b55cfca 568 u16_t buflen, copylen;
DieterGraef 0:d26c1b55cfca 569 int off = 0;
DieterGraef 0:d26c1b55cfca 570 ip_addr_t *addr;
DieterGraef 0:d26c1b55cfca 571 u16_t port;
DieterGraef 0:d26c1b55cfca 572 u8_t done = 0;
DieterGraef 0:d26c1b55cfca 573 err_t err;
DieterGraef 0:d26c1b55cfca 574 sys_prot_t lev;
DieterGraef 0:d26c1b55cfca 575
DieterGraef 0:d26c1b55cfca 576 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom(%d, %p, %"SZT_F", 0x%x, ..)\n", s, mem, len, flags));
DieterGraef 0:d26c1b55cfca 577 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 578 if (!sock) {
DieterGraef 0:d26c1b55cfca 579 return -1;
DieterGraef 0:d26c1b55cfca 580 }
DieterGraef 0:d26c1b55cfca 581
DieterGraef 0:d26c1b55cfca 582 do {
DieterGraef 0:d26c1b55cfca 583 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom: top while sock->lastdata=%p\n", sock->lastdata));
DieterGraef 0:d26c1b55cfca 584 /* Check if there is data left from the last recv operation. */
DieterGraef 0:d26c1b55cfca 585 if (sock->lastdata) {
DieterGraef 0:d26c1b55cfca 586 buf = sock->lastdata;
DieterGraef 0:d26c1b55cfca 587 } else {
DieterGraef 0:d26c1b55cfca 588 /* If this is non-blocking call, then check first */
DieterGraef 0:d26c1b55cfca 589 if (((flags & MSG_DONTWAIT) || netconn_is_nonblocking(sock->conn)) &&
DieterGraef 0:d26c1b55cfca 590 (sock->rcvevent <= 0)) {
DieterGraef 0:d26c1b55cfca 591 if (off > 0) {
DieterGraef 0:d26c1b55cfca 592 /* update receive window */
DieterGraef 0:d26c1b55cfca 593 LWIP_DEBUGF(SOCKETS_DEBUG, ("-lwip_recvfrom: from mailbox 0x%x\n", &sock->conn->recvmbox));
DieterGraef 0:d26c1b55cfca 594 netconn_recved(sock->conn, (u32_t)off);
DieterGraef 0:d26c1b55cfca 595 /* already received data, return that */
DieterGraef 0:d26c1b55cfca 596 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 597 return off;
DieterGraef 0:d26c1b55cfca 598 }
DieterGraef 0:d26c1b55cfca 599 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom(%d): returning EWOULDBLOCK\n", s));
DieterGraef 0:d26c1b55cfca 600 sock_set_errno(sock, EWOULDBLOCK);
DieterGraef 0:d26c1b55cfca 601 return -1;
DieterGraef 0:d26c1b55cfca 602 }
DieterGraef 0:d26c1b55cfca 603
DieterGraef 0:d26c1b55cfca 604 /* No data was left from the previous operation, so we try to get
DieterGraef 0:d26c1b55cfca 605 some from the network. */
DieterGraef 0:d26c1b55cfca 606 if (netconn_type(sock->conn) == NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 607 LWIP_DEBUGF(SOCKETS_DEBUG, ("--lwip_recvfrom: from mailbox 0x%x\n", &sock->conn->recvmbox));
DieterGraef 0:d26c1b55cfca 608 err = netconn_recv_tcp_pbuf(sock->conn, (struct pbuf **)&buf);
DieterGraef 0:d26c1b55cfca 609 } else {
DieterGraef 0:d26c1b55cfca 610 LWIP_DEBUGF(SOCKETS_DEBUG, ("---lwip_recvfrom: from mailbox 0x%x\n", &sock->conn->recvmbox));
DieterGraef 0:d26c1b55cfca 611 err = netconn_recv(sock->conn, (struct netbuf **)&buf);
DieterGraef 0:d26c1b55cfca 612 }
DieterGraef 0:d26c1b55cfca 613 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom: netconn_recv err=%d, netbuf=%p\n",
DieterGraef 0:d26c1b55cfca 614 err, buf));
DieterGraef 0:d26c1b55cfca 615
DieterGraef 0:d26c1b55cfca 616 if (err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 617 if (off > 0) {
DieterGraef 0:d26c1b55cfca 618 /* update receive window */
DieterGraef 0:d26c1b55cfca 619 LWIP_DEBUGF(SOCKETS_DEBUG, ("----lwip_recvfrom: from mailbox 0x%x\n", &sock->conn->recvmbox));
DieterGraef 0:d26c1b55cfca 620 netconn_recved(sock->conn, (u32_t)off);
DieterGraef 0:d26c1b55cfca 621 /* already received data, return that */
DieterGraef 0:d26c1b55cfca 622 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 623 // workaround begin
DieterGraef 0:d26c1b55cfca 624 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 625 sock->rcvevent++; /* signal one more receive event for NULL */
DieterGraef 0:d26c1b55cfca 626 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 627 // workaround end
DieterGraef 0:d26c1b55cfca 628 return off;
DieterGraef 0:d26c1b55cfca 629 }
DieterGraef 0:d26c1b55cfca 630 /* We should really do some error checking here. */
DieterGraef 0:d26c1b55cfca 631 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom(%d): buf == NULL, error is \"%s\"!\n",
DieterGraef 0:d26c1b55cfca 632 s, lwip_strerr(err)));
DieterGraef 0:d26c1b55cfca 633 sock_set_errno(sock, err_to_errno(err));
DieterGraef 0:d26c1b55cfca 634 if (err == ERR_CLSD) {
DieterGraef 0:d26c1b55cfca 635 return 0;
DieterGraef 0:d26c1b55cfca 636 } else {
DieterGraef 0:d26c1b55cfca 637 return -1;
DieterGraef 0:d26c1b55cfca 638 }
DieterGraef 0:d26c1b55cfca 639 }
DieterGraef 0:d26c1b55cfca 640 LWIP_ASSERT("buf != NULL", buf != NULL);
DieterGraef 0:d26c1b55cfca 641 sock->lastdata = buf;
DieterGraef 0:d26c1b55cfca 642 }
DieterGraef 0:d26c1b55cfca 643
DieterGraef 0:d26c1b55cfca 644 if (netconn_type(sock->conn) == NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 645 p = (struct pbuf *)buf;
DieterGraef 0:d26c1b55cfca 646 } else {
DieterGraef 0:d26c1b55cfca 647 p = ((struct netbuf *)buf)->p;
DieterGraef 0:d26c1b55cfca 648 }
DieterGraef 0:d26c1b55cfca 649 buflen = p->tot_len;
DieterGraef 0:d26c1b55cfca 650 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom: buflen=%"U16_F" len=%"SZT_F" off=%d sock->lastoffset=%"U16_F"\n",
DieterGraef 0:d26c1b55cfca 651 buflen, len, off, sock->lastoffset));
DieterGraef 0:d26c1b55cfca 652
DieterGraef 0:d26c1b55cfca 653 buflen -= sock->lastoffset;
DieterGraef 0:d26c1b55cfca 654
DieterGraef 0:d26c1b55cfca 655 if (len > buflen) {
DieterGraef 0:d26c1b55cfca 656 copylen = buflen;
DieterGraef 0:d26c1b55cfca 657 } else {
DieterGraef 0:d26c1b55cfca 658 copylen = (u16_t)len;
DieterGraef 0:d26c1b55cfca 659 }
DieterGraef 0:d26c1b55cfca 660
DieterGraef 0:d26c1b55cfca 661 /* copy the contents of the received buffer into
DieterGraef 0:d26c1b55cfca 662 the supplied memory pointer mem */
DieterGraef 0:d26c1b55cfca 663 pbuf_copy_partial(p, (u8_t*)mem + off, copylen, sock->lastoffset);
DieterGraef 0:d26c1b55cfca 664
DieterGraef 0:d26c1b55cfca 665 off += copylen;
DieterGraef 0:d26c1b55cfca 666
DieterGraef 0:d26c1b55cfca 667 if (netconn_type(sock->conn) == NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 668 LWIP_ASSERT("invalid copylen, len would underflow", len >= copylen);
DieterGraef 0:d26c1b55cfca 669 len -= copylen;
DieterGraef 0:d26c1b55cfca 670 if ( (len <= 0) ||
DieterGraef 0:d26c1b55cfca 671 (p->flags & PBUF_FLAG_PUSH) ||
DieterGraef 0:d26c1b55cfca 672 (sock->rcvevent <= 0) ||
DieterGraef 0:d26c1b55cfca 673 ((flags & MSG_PEEK)!=0)) {
DieterGraef 0:d26c1b55cfca 674 done = 1;
DieterGraef 0:d26c1b55cfca 675 }
DieterGraef 0:d26c1b55cfca 676 } else {
DieterGraef 0:d26c1b55cfca 677 done = 1;
DieterGraef 0:d26c1b55cfca 678 }
DieterGraef 0:d26c1b55cfca 679
DieterGraef 0:d26c1b55cfca 680 /* Check to see from where the data was.*/
DieterGraef 0:d26c1b55cfca 681 if (done) {
DieterGraef 0:d26c1b55cfca 682 ip_addr_t fromaddr;
DieterGraef 0:d26c1b55cfca 683 if (from && fromlen) {
DieterGraef 0:d26c1b55cfca 684 struct sockaddr_in sin;
DieterGraef 0:d26c1b55cfca 685
DieterGraef 0:d26c1b55cfca 686 if (netconn_type(sock->conn) == NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 687 addr = &fromaddr;
DieterGraef 0:d26c1b55cfca 688 netconn_getaddr(sock->conn, addr, &port, 0);
DieterGraef 0:d26c1b55cfca 689 } else {
DieterGraef 0:d26c1b55cfca 690 addr = netbuf_fromaddr((struct netbuf *)buf);
DieterGraef 0:d26c1b55cfca 691 port = netbuf_fromport((struct netbuf *)buf);
DieterGraef 0:d26c1b55cfca 692 }
DieterGraef 0:d26c1b55cfca 693
DieterGraef 0:d26c1b55cfca 694 memset(&sin, 0, sizeof(sin));
DieterGraef 0:d26c1b55cfca 695 sin.sin_len = sizeof(sin);
DieterGraef 0:d26c1b55cfca 696 sin.sin_family = AF_INET;
DieterGraef 0:d26c1b55cfca 697 sin.sin_port = htons(port);
DieterGraef 0:d26c1b55cfca 698 inet_addr_from_ipaddr(&sin.sin_addr, addr);
DieterGraef 0:d26c1b55cfca 699
DieterGraef 0:d26c1b55cfca 700 if (*fromlen > sizeof(sin)) {
DieterGraef 0:d26c1b55cfca 701 *fromlen = sizeof(sin);
DieterGraef 0:d26c1b55cfca 702 }
DieterGraef 0:d26c1b55cfca 703
DieterGraef 0:d26c1b55cfca 704 MEMCPY(from, &sin, *fromlen);
DieterGraef 0:d26c1b55cfca 705
DieterGraef 0:d26c1b55cfca 706 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom(%d): addr=", s));
DieterGraef 0:d26c1b55cfca 707 ip_addr_debug_print(SOCKETS_DEBUG, addr);
DieterGraef 0:d26c1b55cfca 708 LWIP_DEBUGF(SOCKETS_DEBUG, (" port=%"U16_F" len=%d\n", port, off));
DieterGraef 0:d26c1b55cfca 709 } else {
DieterGraef 0:d26c1b55cfca 710 #if SOCKETS_DEBUG
DieterGraef 0:d26c1b55cfca 711 if (netconn_type(sock->conn) == NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 712 addr = &fromaddr;
DieterGraef 0:d26c1b55cfca 713 netconn_getaddr(sock->conn, addr, &port, 0);
DieterGraef 0:d26c1b55cfca 714 } else {
DieterGraef 0:d26c1b55cfca 715 addr = netbuf_fromaddr((struct netbuf *)buf);
DieterGraef 0:d26c1b55cfca 716 port = netbuf_fromport((struct netbuf *)buf);
DieterGraef 0:d26c1b55cfca 717 }
DieterGraef 0:d26c1b55cfca 718
DieterGraef 0:d26c1b55cfca 719 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom(%d): addr=", s));
DieterGraef 0:d26c1b55cfca 720 ip_addr_debug_print(SOCKETS_DEBUG, addr);
DieterGraef 0:d26c1b55cfca 721 LWIP_DEBUGF(SOCKETS_DEBUG, (" port=%"U16_F" len=%d\n", port, off));
DieterGraef 0:d26c1b55cfca 722 #endif /* SOCKETS_DEBUG */
DieterGraef 0:d26c1b55cfca 723 }
DieterGraef 0:d26c1b55cfca 724 }
DieterGraef 0:d26c1b55cfca 725
DieterGraef 0:d26c1b55cfca 726 /* If we don't peek the incoming message... */
DieterGraef 0:d26c1b55cfca 727 if ((flags & MSG_PEEK) == 0) {
DieterGraef 0:d26c1b55cfca 728 /* If this is a TCP socket, check if there is data left in the
DieterGraef 0:d26c1b55cfca 729 buffer. If so, it should be saved in the sock structure for next
DieterGraef 0:d26c1b55cfca 730 time around. */
DieterGraef 0:d26c1b55cfca 731 if ((netconn_type(sock->conn) == NETCONN_TCP) && (buflen - copylen > 0)) {
DieterGraef 0:d26c1b55cfca 732 sock->lastdata = buf;
DieterGraef 0:d26c1b55cfca 733 sock->lastoffset += copylen;
DieterGraef 0:d26c1b55cfca 734 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom: lastdata now netbuf=%p\n", buf));
DieterGraef 0:d26c1b55cfca 735 } else {
DieterGraef 0:d26c1b55cfca 736 sock->lastdata = NULL;
DieterGraef 0:d26c1b55cfca 737 sock->lastoffset = 0;
DieterGraef 0:d26c1b55cfca 738 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_recvfrom: deleting netbuf=%p\n", buf));
DieterGraef 0:d26c1b55cfca 739 if (netconn_type(sock->conn) == NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 740 pbuf_free((struct pbuf *)buf);
DieterGraef 0:d26c1b55cfca 741 } else {
DieterGraef 0:d26c1b55cfca 742 netbuf_delete((struct netbuf *)buf);
DieterGraef 0:d26c1b55cfca 743 }
DieterGraef 0:d26c1b55cfca 744 }
DieterGraef 0:d26c1b55cfca 745 }
DieterGraef 0:d26c1b55cfca 746 } while (!done);
DieterGraef 0:d26c1b55cfca 747
DieterGraef 0:d26c1b55cfca 748 if (off > 0) {
DieterGraef 0:d26c1b55cfca 749 /* update receive window */
DieterGraef 0:d26c1b55cfca 750 LWIP_DEBUGF(SOCKETS_DEBUG, ("-----lwip_recvfrom: from mailbox 0x%x\n", &sock->conn->recvmbox));
DieterGraef 0:d26c1b55cfca 751 netconn_recved(sock->conn, (u32_t)off);
DieterGraef 0:d26c1b55cfca 752 }
DieterGraef 0:d26c1b55cfca 753 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 754 return off;
DieterGraef 0:d26c1b55cfca 755 }
DieterGraef 0:d26c1b55cfca 756
DieterGraef 0:d26c1b55cfca 757 int
DieterGraef 0:d26c1b55cfca 758 lwip_read(int s, void *mem, size_t len)
DieterGraef 0:d26c1b55cfca 759 {
DieterGraef 0:d26c1b55cfca 760 return lwip_recvfrom(s, mem, len, 0, NULL, NULL);
DieterGraef 0:d26c1b55cfca 761 }
DieterGraef 0:d26c1b55cfca 762
DieterGraef 0:d26c1b55cfca 763 int
DieterGraef 0:d26c1b55cfca 764 lwip_recv(int s, void *mem, size_t len, int flags)
DieterGraef 0:d26c1b55cfca 765 {
DieterGraef 0:d26c1b55cfca 766 return lwip_recvfrom(s, mem, len, flags, NULL, NULL);
DieterGraef 0:d26c1b55cfca 767 }
DieterGraef 0:d26c1b55cfca 768
DieterGraef 0:d26c1b55cfca 769 int
DieterGraef 0:d26c1b55cfca 770 lwip_send(int s, const void *data, size_t size, int flags)
DieterGraef 0:d26c1b55cfca 771 {
DieterGraef 0:d26c1b55cfca 772 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 773 err_t err;
DieterGraef 0:d26c1b55cfca 774 u8_t write_flags;
DieterGraef 0:d26c1b55cfca 775 size_t written;
DieterGraef 0:d26c1b55cfca 776
DieterGraef 0:d26c1b55cfca 777 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_send(%d, data=%p, size=%"SZT_F", flags=0x%x)\n",
DieterGraef 0:d26c1b55cfca 778 s, data, size, flags));
DieterGraef 0:d26c1b55cfca 779
DieterGraef 0:d26c1b55cfca 780 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 781 if (!sock) {
DieterGraef 0:d26c1b55cfca 782 return -1;
DieterGraef 0:d26c1b55cfca 783 }
DieterGraef 0:d26c1b55cfca 784
DieterGraef 0:d26c1b55cfca 785 if (sock->conn->type != NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 786 #if (LWIP_UDP || LWIP_RAW)
DieterGraef 0:d26c1b55cfca 787 return lwip_sendto(s, data, size, flags, NULL, 0);
DieterGraef 0:d26c1b55cfca 788 #else /* (LWIP_UDP || LWIP_RAW) */
DieterGraef 0:d26c1b55cfca 789 sock_set_errno(sock, err_to_errno(ERR_ARG));
DieterGraef 0:d26c1b55cfca 790 return -1;
DieterGraef 0:d26c1b55cfca 791 #endif /* (LWIP_UDP || LWIP_RAW) */
DieterGraef 0:d26c1b55cfca 792 }
DieterGraef 0:d26c1b55cfca 793
DieterGraef 0:d26c1b55cfca 794 write_flags = NETCONN_COPY |
DieterGraef 0:d26c1b55cfca 795 ((flags & MSG_MORE) ? NETCONN_MORE : 0) |
DieterGraef 0:d26c1b55cfca 796 ((flags & MSG_DONTWAIT) ? NETCONN_DONTBLOCK : 0);
DieterGraef 0:d26c1b55cfca 797 written = 0;
DieterGraef 0:d26c1b55cfca 798 err = netconn_write_partly(sock->conn, data, size, write_flags, &written);
DieterGraef 0:d26c1b55cfca 799
DieterGraef 0:d26c1b55cfca 800 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_send(%d) err=%d written=%"SZT_F"\n", s, err, written));
DieterGraef 0:d26c1b55cfca 801 sock_set_errno(sock, err_to_errno(err));
DieterGraef 0:d26c1b55cfca 802 return (err == ERR_OK ? (int)written : -1);
DieterGraef 0:d26c1b55cfca 803 }
DieterGraef 0:d26c1b55cfca 804
DieterGraef 0:d26c1b55cfca 805 int
DieterGraef 0:d26c1b55cfca 806 lwip_sendto(int s, const void *data, size_t size, int flags,
DieterGraef 0:d26c1b55cfca 807 const struct sockaddr *to, socklen_t tolen)
DieterGraef 0:d26c1b55cfca 808 {
DieterGraef 0:d26c1b55cfca 809 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 810 err_t err;
DieterGraef 0:d26c1b55cfca 811 u16_t short_size;
DieterGraef 0:d26c1b55cfca 812 const struct sockaddr_in *to_in;
DieterGraef 0:d26c1b55cfca 813 u16_t remote_port;
DieterGraef 0:d26c1b55cfca 814 #if !LWIP_TCPIP_CORE_LOCKING
DieterGraef 0:d26c1b55cfca 815 struct netbuf buf;
DieterGraef 0:d26c1b55cfca 816 #endif
DieterGraef 0:d26c1b55cfca 817
DieterGraef 0:d26c1b55cfca 818 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 819 if (!sock) {
DieterGraef 0:d26c1b55cfca 820 return -1;
DieterGraef 0:d26c1b55cfca 821 }
DieterGraef 0:d26c1b55cfca 822
DieterGraef 0:d26c1b55cfca 823 if (sock->conn->type == NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 824 #if LWIP_TCP
DieterGraef 0:d26c1b55cfca 825 return lwip_send(s, data, size, flags);
DieterGraef 0:d26c1b55cfca 826 #else /* LWIP_TCP */
DieterGraef 0:d26c1b55cfca 827 LWIP_UNUSED_ARG(flags);
DieterGraef 0:d26c1b55cfca 828 sock_set_errno(sock, err_to_errno(ERR_ARG));
DieterGraef 0:d26c1b55cfca 829 return -1;
DieterGraef 0:d26c1b55cfca 830 #endif /* LWIP_TCP */
DieterGraef 0:d26c1b55cfca 831 }
DieterGraef 0:d26c1b55cfca 832
DieterGraef 0:d26c1b55cfca 833 /* @todo: split into multiple sendto's? */
DieterGraef 0:d26c1b55cfca 834 LWIP_ASSERT("lwip_sendto: size must fit in u16_t", size <= 0xffff);
DieterGraef 0:d26c1b55cfca 835 short_size = (u16_t)size;
DieterGraef 0:d26c1b55cfca 836 LWIP_ERROR("lwip_sendto: invalid address", (((to == NULL) && (tolen == 0)) ||
DieterGraef 0:d26c1b55cfca 837 ((tolen == sizeof(struct sockaddr_in)) &&
DieterGraef 0:d26c1b55cfca 838 ((to->sa_family) == AF_INET) && ((((mem_ptr_t)to) % 4) == 0))),
DieterGraef 0:d26c1b55cfca 839 sock_set_errno(sock, err_to_errno(ERR_ARG)); return -1;);
DieterGraef 0:d26c1b55cfca 840 to_in = (const struct sockaddr_in *)(void*)to;
DieterGraef 0:d26c1b55cfca 841
DieterGraef 0:d26c1b55cfca 842 #if LWIP_TCPIP_CORE_LOCKING
DieterGraef 0:d26c1b55cfca 843 /* Should only be consider like a sample or a simple way to experiment this option (no check of "to" field...) */
DieterGraef 0:d26c1b55cfca 844 {
DieterGraef 0:d26c1b55cfca 845 struct pbuf* p;
DieterGraef 0:d26c1b55cfca 846 ip_addr_t *remote_addr;
DieterGraef 0:d26c1b55cfca 847
DieterGraef 0:d26c1b55cfca 848 #if LWIP_NETIF_TX_SINGLE_PBUF
DieterGraef 0:d26c1b55cfca 849 p = pbuf_alloc(PBUF_TRANSPORT, short_size, PBUF_RAM);
DieterGraef 0:d26c1b55cfca 850 if (p != NULL) {
DieterGraef 0:d26c1b55cfca 851 #if LWIP_CHECKSUM_ON_COPY
DieterGraef 0:d26c1b55cfca 852 u16_t chksum = 0;
DieterGraef 0:d26c1b55cfca 853 if (sock->conn->type != NETCONN_RAW) {
DieterGraef 0:d26c1b55cfca 854 chksum = LWIP_CHKSUM_COPY(p->payload, data, short_size);
DieterGraef 0:d26c1b55cfca 855 } else
DieterGraef 0:d26c1b55cfca 856 #endif /* LWIP_CHECKSUM_ON_COPY */
DieterGraef 0:d26c1b55cfca 857 MEMCPY(p->payload, data, size);
DieterGraef 0:d26c1b55cfca 858 #else /* LWIP_NETIF_TX_SINGLE_PBUF */
DieterGraef 0:d26c1b55cfca 859 p = pbuf_alloc(PBUF_TRANSPORT, short_size, PBUF_REF);
DieterGraef 0:d26c1b55cfca 860 if (p != NULL) {
DieterGraef 0:d26c1b55cfca 861 p->payload = (void*)data;
DieterGraef 0:d26c1b55cfca 862 #endif /* LWIP_NETIF_TX_SINGLE_PBUF */
DieterGraef 0:d26c1b55cfca 863
DieterGraef 0:d26c1b55cfca 864 if (to_in != NULL) {
DieterGraef 0:d26c1b55cfca 865 inet_addr_to_ipaddr_p(remote_addr, &to_in->sin_addr);
DieterGraef 0:d26c1b55cfca 866 remote_port = ntohs(to_in->sin_port);
DieterGraef 0:d26c1b55cfca 867 } else {
DieterGraef 0:d26c1b55cfca 868 remote_addr = &sock->conn->pcb.ip->remote_ip;
DieterGraef 0:d26c1b55cfca 869 #if LWIP_UDP
DieterGraef 0:d26c1b55cfca 870 if (NETCONNTYPE_GROUP(sock->conn->type) == NETCONN_UDP) {
DieterGraef 0:d26c1b55cfca 871 remote_port = sock->conn->pcb.udp->remote_port;
DieterGraef 0:d26c1b55cfca 872 } else
DieterGraef 0:d26c1b55cfca 873 #endif /* LWIP_UDP */
DieterGraef 0:d26c1b55cfca 874 {
DieterGraef 0:d26c1b55cfca 875 remote_port = 0;
DieterGraef 0:d26c1b55cfca 876 }
DieterGraef 0:d26c1b55cfca 877 }
DieterGraef 0:d26c1b55cfca 878
DieterGraef 0:d26c1b55cfca 879 LOCK_TCPIP_CORE();
DieterGraef 0:d26c1b55cfca 880 if (netconn_type(sock->conn) == NETCONN_RAW) {
DieterGraef 0:d26c1b55cfca 881 #if LWIP_RAW
DieterGraef 0:d26c1b55cfca 882 err = sock->conn->last_err = raw_sendto(sock->conn->pcb.raw, p, remote_addr);
DieterGraef 0:d26c1b55cfca 883 #else /* LWIP_RAW */
DieterGraef 0:d26c1b55cfca 884 err = ERR_ARG;
DieterGraef 0:d26c1b55cfca 885 #endif /* LWIP_RAW */
DieterGraef 0:d26c1b55cfca 886 }
DieterGraef 0:d26c1b55cfca 887 #if LWIP_UDP && LWIP_RAW
DieterGraef 0:d26c1b55cfca 888 else
DieterGraef 0:d26c1b55cfca 889 #endif /* LWIP_UDP && LWIP_RAW */
DieterGraef 0:d26c1b55cfca 890 {
DieterGraef 0:d26c1b55cfca 891 #if LWIP_UDP
DieterGraef 0:d26c1b55cfca 892 #if LWIP_CHECKSUM_ON_COPY && LWIP_NETIF_TX_SINGLE_PBUF
DieterGraef 0:d26c1b55cfca 893 err = sock->conn->last_err = udp_sendto_chksum(sock->conn->pcb.udp, p,
DieterGraef 0:d26c1b55cfca 894 remote_addr, remote_port, 1, chksum);
DieterGraef 0:d26c1b55cfca 895 #else /* LWIP_CHECKSUM_ON_COPY && LWIP_NETIF_TX_SINGLE_PBUF */
DieterGraef 0:d26c1b55cfca 896 err = sock->conn->last_err = udp_sendto(sock->conn->pcb.udp, p,
DieterGraef 0:d26c1b55cfca 897 remote_addr, remote_port);
DieterGraef 0:d26c1b55cfca 898 #endif /* LWIP_CHECKSUM_ON_COPY && LWIP_NETIF_TX_SINGLE_PBUF */
DieterGraef 0:d26c1b55cfca 899 #else /* LWIP_UDP */
DieterGraef 0:d26c1b55cfca 900 err = ERR_ARG;
DieterGraef 0:d26c1b55cfca 901 #endif /* LWIP_UDP */
DieterGraef 0:d26c1b55cfca 902 }
DieterGraef 0:d26c1b55cfca 903 UNLOCK_TCPIP_CORE();
DieterGraef 0:d26c1b55cfca 904
DieterGraef 0:d26c1b55cfca 905 pbuf_free(p);
DieterGraef 0:d26c1b55cfca 906 } else {
DieterGraef 0:d26c1b55cfca 907 err = ERR_MEM;
DieterGraef 0:d26c1b55cfca 908 }
DieterGraef 0:d26c1b55cfca 909 }
DieterGraef 0:d26c1b55cfca 910 #else /* LWIP_TCPIP_CORE_LOCKING */
DieterGraef 0:d26c1b55cfca 911 /* initialize a buffer */
DieterGraef 0:d26c1b55cfca 912 buf.p = buf.ptr = NULL;
DieterGraef 0:d26c1b55cfca 913 #if LWIP_CHECKSUM_ON_COPY
DieterGraef 0:d26c1b55cfca 914 buf.flags = 0;
DieterGraef 0:d26c1b55cfca 915 #endif /* LWIP_CHECKSUM_ON_COPY */
DieterGraef 0:d26c1b55cfca 916 if (to) {
DieterGraef 0:d26c1b55cfca 917 inet_addr_to_ipaddr(&buf.addr, &to_in->sin_addr);
DieterGraef 0:d26c1b55cfca 918 remote_port = ntohs(to_in->sin_port);
DieterGraef 0:d26c1b55cfca 919 netbuf_fromport(&buf) = remote_port;
DieterGraef 0:d26c1b55cfca 920 } else {
DieterGraef 0:d26c1b55cfca 921 remote_port = 0;
DieterGraef 0:d26c1b55cfca 922 ip_addr_set_any(&buf.addr);
DieterGraef 0:d26c1b55cfca 923 netbuf_fromport(&buf) = 0;
DieterGraef 0:d26c1b55cfca 924 }
DieterGraef 0:d26c1b55cfca 925
DieterGraef 0:d26c1b55cfca 926 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_sendto(%d, data=%p, short_size=%"U16_F", flags=0x%x to=",
DieterGraef 0:d26c1b55cfca 927 s, data, short_size, flags));
DieterGraef 0:d26c1b55cfca 928 ip_addr_debug_print(SOCKETS_DEBUG, &buf.addr);
DieterGraef 0:d26c1b55cfca 929 LWIP_DEBUGF(SOCKETS_DEBUG, (" port=%"U16_F"\n", remote_port));
DieterGraef 0:d26c1b55cfca 930
DieterGraef 0:d26c1b55cfca 931 /* make the buffer point to the data that should be sent */
DieterGraef 0:d26c1b55cfca 932 #if LWIP_NETIF_TX_SINGLE_PBUF
DieterGraef 0:d26c1b55cfca 933 /* Allocate a new netbuf and copy the data into it. */
DieterGraef 0:d26c1b55cfca 934 if (netbuf_alloc(&buf, short_size) == NULL) {
DieterGraef 0:d26c1b55cfca 935 err = ERR_MEM;
DieterGraef 0:d26c1b55cfca 936 } else {
DieterGraef 0:d26c1b55cfca 937 #if LWIP_CHECKSUM_ON_COPY
DieterGraef 0:d26c1b55cfca 938 if (sock->conn->type != NETCONN_RAW) {
DieterGraef 0:d26c1b55cfca 939 u16_t chksum = LWIP_CHKSUM_COPY(buf.p->payload, data, short_size);
DieterGraef 0:d26c1b55cfca 940 netbuf_set_chksum(&buf, chksum);
DieterGraef 0:d26c1b55cfca 941 err = ERR_OK;
DieterGraef 0:d26c1b55cfca 942 } else
DieterGraef 0:d26c1b55cfca 943 #endif /* LWIP_CHECKSUM_ON_COPY */
DieterGraef 0:d26c1b55cfca 944 {
DieterGraef 0:d26c1b55cfca 945 err = netbuf_take(&buf, data, short_size);
DieterGraef 0:d26c1b55cfca 946 }
DieterGraef 0:d26c1b55cfca 947 }
DieterGraef 0:d26c1b55cfca 948 #else /* LWIP_NETIF_TX_SINGLE_PBUF */
DieterGraef 0:d26c1b55cfca 949 err = netbuf_ref(&buf, data, short_size);
DieterGraef 0:d26c1b55cfca 950 #endif /* LWIP_NETIF_TX_SINGLE_PBUF */
DieterGraef 0:d26c1b55cfca 951 if (err == ERR_OK) {
DieterGraef 0:d26c1b55cfca 952 /* send the data */
DieterGraef 0:d26c1b55cfca 953 err = netconn_send(sock->conn, &buf);
DieterGraef 0:d26c1b55cfca 954 }
DieterGraef 0:d26c1b55cfca 955
DieterGraef 0:d26c1b55cfca 956 /* deallocated the buffer */
DieterGraef 0:d26c1b55cfca 957 netbuf_free(&buf);
DieterGraef 0:d26c1b55cfca 958 #endif /* LWIP_TCPIP_CORE_LOCKING */
DieterGraef 0:d26c1b55cfca 959 sock_set_errno(sock, err_to_errno(err));
DieterGraef 0:d26c1b55cfca 960 return (err == ERR_OK ? short_size : -1);
DieterGraef 0:d26c1b55cfca 961 }
DieterGraef 0:d26c1b55cfca 962
DieterGraef 0:d26c1b55cfca 963 int
DieterGraef 0:d26c1b55cfca 964 lwip_socket(int domain, int type, int protocol)
DieterGraef 0:d26c1b55cfca 965 {
DieterGraef 0:d26c1b55cfca 966 struct netconn *conn;
DieterGraef 0:d26c1b55cfca 967 int i;
DieterGraef 0:d26c1b55cfca 968
DieterGraef 0:d26c1b55cfca 969 LWIP_UNUSED_ARG(domain);
DieterGraef 0:d26c1b55cfca 970
DieterGraef 0:d26c1b55cfca 971 /* create a netconn */
DieterGraef 0:d26c1b55cfca 972 switch (type) {
DieterGraef 0:d26c1b55cfca 973 case SOCK_RAW:
DieterGraef 0:d26c1b55cfca 974 conn = netconn_new_with_proto_and_callback(NETCONN_RAW, (u8_t)protocol, event_callback);
DieterGraef 0:d26c1b55cfca 975 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_socket(%s, SOCK_RAW, %d) = ",
DieterGraef 0:d26c1b55cfca 976 domain == PF_INET ? "PF_INET" : "UNKNOWN", protocol));
DieterGraef 0:d26c1b55cfca 977 break;
DieterGraef 0:d26c1b55cfca 978 case SOCK_DGRAM:
DieterGraef 0:d26c1b55cfca 979 conn = netconn_new_with_callback( (protocol == IPPROTO_UDPLITE) ?
DieterGraef 0:d26c1b55cfca 980 NETCONN_UDPLITE : NETCONN_UDP, event_callback);
DieterGraef 0:d26c1b55cfca 981 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_socket(%s, SOCK_DGRAM, %d) = ",
DieterGraef 0:d26c1b55cfca 982 domain == PF_INET ? "PF_INET" : "UNKNOWN", protocol));
DieterGraef 0:d26c1b55cfca 983 break;
DieterGraef 0:d26c1b55cfca 984 case SOCK_STREAM:
DieterGraef 0:d26c1b55cfca 985 conn = netconn_new_with_callback(NETCONN_TCP, event_callback);
DieterGraef 0:d26c1b55cfca 986 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_socket(%s, SOCK_STREAM, %d) = ",
DieterGraef 0:d26c1b55cfca 987 domain == PF_INET ? "PF_INET" : "UNKNOWN", protocol));
DieterGraef 0:d26c1b55cfca 988 if (conn != NULL) {
DieterGraef 0:d26c1b55cfca 989 /* Prevent automatic window updates, we do this on our own! */
DieterGraef 0:d26c1b55cfca 990 netconn_set_noautorecved(conn, 1);
DieterGraef 0:d26c1b55cfca 991 }
DieterGraef 0:d26c1b55cfca 992 break;
DieterGraef 0:d26c1b55cfca 993 default:
DieterGraef 0:d26c1b55cfca 994 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_socket(%d, %d/UNKNOWN, %d) = -1\n",
DieterGraef 0:d26c1b55cfca 995 domain, type, protocol));
DieterGraef 0:d26c1b55cfca 996 set_errno(EINVAL);
DieterGraef 0:d26c1b55cfca 997 return -1;
DieterGraef 0:d26c1b55cfca 998 }
DieterGraef 0:d26c1b55cfca 999
DieterGraef 0:d26c1b55cfca 1000 if (!conn) {
DieterGraef 0:d26c1b55cfca 1001 LWIP_DEBUGF(SOCKETS_DEBUG, ("-1 / ENOBUFS (could not create netconn)\n"));
DieterGraef 0:d26c1b55cfca 1002 set_errno(ENOBUFS);
DieterGraef 0:d26c1b55cfca 1003 return -1;
DieterGraef 0:d26c1b55cfca 1004 }
DieterGraef 0:d26c1b55cfca 1005
DieterGraef 0:d26c1b55cfca 1006 i = alloc_socket(conn, 0);
DieterGraef 0:d26c1b55cfca 1007
DieterGraef 0:d26c1b55cfca 1008 if (i == -1) {
DieterGraef 0:d26c1b55cfca 1009 netconn_delete(conn);
DieterGraef 0:d26c1b55cfca 1010 set_errno(ENFILE);
DieterGraef 0:d26c1b55cfca 1011 return -1;
DieterGraef 0:d26c1b55cfca 1012 }
DieterGraef 0:d26c1b55cfca 1013 conn->socket = i;
DieterGraef 0:d26c1b55cfca 1014 LWIP_DEBUGF(SOCKETS_DEBUG, ("%d\n", i));
DieterGraef 0:d26c1b55cfca 1015 set_errno(0);
DieterGraef 0:d26c1b55cfca 1016 return i;
DieterGraef 0:d26c1b55cfca 1017 }
DieterGraef 0:d26c1b55cfca 1018
DieterGraef 0:d26c1b55cfca 1019 int
DieterGraef 0:d26c1b55cfca 1020 lwip_write(int s, const void *data, size_t size)
DieterGraef 0:d26c1b55cfca 1021 {
DieterGraef 0:d26c1b55cfca 1022 return lwip_send(s, data, size, 0);
DieterGraef 0:d26c1b55cfca 1023 }
DieterGraef 0:d26c1b55cfca 1024
DieterGraef 0:d26c1b55cfca 1025 /**
DieterGraef 0:d26c1b55cfca 1026 * Go through the readset and writeset lists and see which socket of the sockets
DieterGraef 0:d26c1b55cfca 1027 * set in the sets has events. On return, readset, writeset and exceptset have
DieterGraef 0:d26c1b55cfca 1028 * the sockets enabled that had events.
DieterGraef 0:d26c1b55cfca 1029 *
DieterGraef 0:d26c1b55cfca 1030 * exceptset is not used for now!!!
DieterGraef 0:d26c1b55cfca 1031 *
DieterGraef 0:d26c1b55cfca 1032 * @param maxfdp1 the highest socket index in the sets
DieterGraef 0:d26c1b55cfca 1033 * @param readset_in: set of sockets to check for read events
DieterGraef 0:d26c1b55cfca 1034 * @param writeset_in: set of sockets to check for write events
DieterGraef 0:d26c1b55cfca 1035 * @param exceptset_in: set of sockets to check for error events
DieterGraef 0:d26c1b55cfca 1036 * @param readset_out: set of sockets that had read events
DieterGraef 0:d26c1b55cfca 1037 * @param writeset_out: set of sockets that had write events
DieterGraef 0:d26c1b55cfca 1038 * @param exceptset_out: set os sockets that had error events
DieterGraef 0:d26c1b55cfca 1039 * @return number of sockets that had events (read/write/exception) (>= 0)
DieterGraef 0:d26c1b55cfca 1040 */
DieterGraef 0:d26c1b55cfca 1041 static int
DieterGraef 0:d26c1b55cfca 1042 lwip_selscan(int maxfdp1, fd_set *readset_in, fd_set *writeset_in, fd_set *exceptset_in,
DieterGraef 0:d26c1b55cfca 1043 fd_set *readset_out, fd_set *writeset_out, fd_set *exceptset_out)
DieterGraef 0:d26c1b55cfca 1044 {
DieterGraef 0:d26c1b55cfca 1045 int i, nready = 0;
DieterGraef 0:d26c1b55cfca 1046 fd_set lreadset, lwriteset, lexceptset;
DieterGraef 0:d26c1b55cfca 1047 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 1048 SYS_ARCH_DECL_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1049
DieterGraef 0:d26c1b55cfca 1050 FD_ZERO(&lreadset);
DieterGraef 0:d26c1b55cfca 1051 FD_ZERO(&lwriteset);
DieterGraef 0:d26c1b55cfca 1052 FD_ZERO(&lexceptset);
DieterGraef 0:d26c1b55cfca 1053
DieterGraef 0:d26c1b55cfca 1054 /* Go through each socket in each list to count number of sockets which
DieterGraef 0:d26c1b55cfca 1055 currently match */
DieterGraef 0:d26c1b55cfca 1056 for(i = 0; i < maxfdp1; i++) {
DieterGraef 0:d26c1b55cfca 1057 void* lastdata = NULL;
DieterGraef 0:d26c1b55cfca 1058 s16_t rcvevent = 0;
DieterGraef 0:d26c1b55cfca 1059 u16_t sendevent = 0;
DieterGraef 0:d26c1b55cfca 1060 u16_t errevent = 0;
DieterGraef 0:d26c1b55cfca 1061 /* First get the socket's status (protected)... */
DieterGraef 0:d26c1b55cfca 1062 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1063 sock = tryget_socket(i);
DieterGraef 0:d26c1b55cfca 1064 if (sock != NULL) {
DieterGraef 0:d26c1b55cfca 1065 lastdata = sock->lastdata;
DieterGraef 0:d26c1b55cfca 1066 rcvevent = sock->rcvevent;
DieterGraef 0:d26c1b55cfca 1067 sendevent = sock->sendevent;
DieterGraef 0:d26c1b55cfca 1068 errevent = sock->errevent;
DieterGraef 0:d26c1b55cfca 1069 }
DieterGraef 0:d26c1b55cfca 1070 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1071 /* ... then examine it: */
DieterGraef 0:d26c1b55cfca 1072 /* See if netconn of this socket is ready for read */
DieterGraef 0:d26c1b55cfca 1073 if (readset_in && FD_ISSET(i, readset_in) && ((lastdata != NULL) || (rcvevent > 0))) {
DieterGraef 0:d26c1b55cfca 1074 FD_SET(i, &lreadset);
DieterGraef 0:d26c1b55cfca 1075 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_selscan: fd=%d ready for reading\n", i));
DieterGraef 0:d26c1b55cfca 1076 nready++;
DieterGraef 0:d26c1b55cfca 1077 }
DieterGraef 0:d26c1b55cfca 1078 /* See if netconn of this socket is ready for write */
DieterGraef 0:d26c1b55cfca 1079 if (writeset_in && FD_ISSET(i, writeset_in) && (sendevent != 0)) {
DieterGraef 0:d26c1b55cfca 1080 FD_SET(i, &lwriteset);
DieterGraef 0:d26c1b55cfca 1081 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_selscan: fd=%d ready for writing\n", i));
DieterGraef 0:d26c1b55cfca 1082 nready++;
DieterGraef 0:d26c1b55cfca 1083 }
DieterGraef 0:d26c1b55cfca 1084 /* See if netconn of this socket had an error */
DieterGraef 0:d26c1b55cfca 1085 if (exceptset_in && FD_ISSET(i, exceptset_in) && (errevent != 0)) {
DieterGraef 0:d26c1b55cfca 1086 FD_SET(i, &lexceptset);
DieterGraef 0:d26c1b55cfca 1087 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_selscan: fd=%d ready for exception\n", i));
DieterGraef 0:d26c1b55cfca 1088 nready++;
DieterGraef 0:d26c1b55cfca 1089 }
DieterGraef 0:d26c1b55cfca 1090 }
DieterGraef 0:d26c1b55cfca 1091 /* copy local sets to the ones provided as arguments */
DieterGraef 0:d26c1b55cfca 1092 *readset_out = lreadset;
DieterGraef 0:d26c1b55cfca 1093 *writeset_out = lwriteset;
DieterGraef 0:d26c1b55cfca 1094 *exceptset_out = lexceptset;
DieterGraef 0:d26c1b55cfca 1095
DieterGraef 0:d26c1b55cfca 1096 LWIP_ASSERT("nready >= 0", nready >= 0);
DieterGraef 0:d26c1b55cfca 1097 return nready;
DieterGraef 0:d26c1b55cfca 1098 }
DieterGraef 0:d26c1b55cfca 1099
DieterGraef 0:d26c1b55cfca 1100 /**
DieterGraef 0:d26c1b55cfca 1101 * Processing exceptset is not yet implemented.
DieterGraef 0:d26c1b55cfca 1102 */
DieterGraef 0:d26c1b55cfca 1103 int
DieterGraef 0:d26c1b55cfca 1104 lwip_select(int maxfdp1, fd_set *readset, fd_set *writeset, fd_set *exceptset,
DieterGraef 0:d26c1b55cfca 1105 struct timeval *timeout)
DieterGraef 0:d26c1b55cfca 1106 {
DieterGraef 0:d26c1b55cfca 1107 u32_t waitres = 0;
DieterGraef 0:d26c1b55cfca 1108 int nready;
DieterGraef 0:d26c1b55cfca 1109 fd_set lreadset, lwriteset, lexceptset;
DieterGraef 0:d26c1b55cfca 1110 u32_t msectimeout;
DieterGraef 0:d26c1b55cfca 1111 struct lwip_select_cb select_cb;
DieterGraef 0:d26c1b55cfca 1112 err_t err;
DieterGraef 0:d26c1b55cfca 1113 int i;
DieterGraef 0:d26c1b55cfca 1114 SYS_ARCH_DECL_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1115
DieterGraef 0:d26c1b55cfca 1116 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_select(%d, %p, %p, %p, tvsec=%"S32_F" tvusec=%"S32_F")\n",
DieterGraef 0:d26c1b55cfca 1117 maxfdp1, (void *)readset, (void *) writeset, (void *) exceptset,
DieterGraef 0:d26c1b55cfca 1118 timeout ? (s32_t)timeout->tv_sec : (s32_t)-1,
DieterGraef 0:d26c1b55cfca 1119 timeout ? (s32_t)timeout->tv_usec : (s32_t)-1));
DieterGraef 0:d26c1b55cfca 1120
DieterGraef 0:d26c1b55cfca 1121 /* Go through each socket in each list to count number of sockets which
DieterGraef 0:d26c1b55cfca 1122 currently match */
DieterGraef 0:d26c1b55cfca 1123 nready = lwip_selscan(maxfdp1, readset, writeset, exceptset, &lreadset, &lwriteset, &lexceptset);
DieterGraef 0:d26c1b55cfca 1124
DieterGraef 0:d26c1b55cfca 1125 /* If we don't have any current events, then suspend if we are supposed to */
DieterGraef 0:d26c1b55cfca 1126 if (!nready) {
DieterGraef 0:d26c1b55cfca 1127 if (timeout && timeout->tv_sec == 0 && timeout->tv_usec == 0) {
DieterGraef 0:d26c1b55cfca 1128 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_select: no timeout, returning 0\n"));
DieterGraef 0:d26c1b55cfca 1129 /* This is OK as the local fdsets are empty and nready is zero,
DieterGraef 0:d26c1b55cfca 1130 or we would have returned earlier. */
DieterGraef 0:d26c1b55cfca 1131 goto return_copy_fdsets;
DieterGraef 0:d26c1b55cfca 1132 }
DieterGraef 0:d26c1b55cfca 1133
DieterGraef 0:d26c1b55cfca 1134 /* None ready: add our semaphore to list:
DieterGraef 0:d26c1b55cfca 1135 We don't actually need any dynamic memory. Our entry on the
DieterGraef 0:d26c1b55cfca 1136 list is only valid while we are in this function, so it's ok
DieterGraef 0:d26c1b55cfca 1137 to use local variables. */
DieterGraef 0:d26c1b55cfca 1138
DieterGraef 0:d26c1b55cfca 1139 select_cb.next = NULL;
DieterGraef 0:d26c1b55cfca 1140 select_cb.prev = NULL;
DieterGraef 0:d26c1b55cfca 1141 select_cb.readset = readset;
DieterGraef 0:d26c1b55cfca 1142 select_cb.writeset = writeset;
DieterGraef 0:d26c1b55cfca 1143 select_cb.exceptset = exceptset;
DieterGraef 0:d26c1b55cfca 1144 select_cb.sem_signalled = 0;
DieterGraef 0:d26c1b55cfca 1145 err = sys_sem_new(&select_cb.sem, 0);
DieterGraef 0:d26c1b55cfca 1146 if (err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 1147 /* failed to create semaphore */
DieterGraef 0:d26c1b55cfca 1148 set_errno(ENOMEM);
DieterGraef 0:d26c1b55cfca 1149 return -1;
DieterGraef 0:d26c1b55cfca 1150 }
DieterGraef 0:d26c1b55cfca 1151
DieterGraef 0:d26c1b55cfca 1152 /* Protect the select_cb_list */
DieterGraef 0:d26c1b55cfca 1153 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1154
DieterGraef 0:d26c1b55cfca 1155 /* Put this select_cb on top of list */
DieterGraef 0:d26c1b55cfca 1156 select_cb.next = select_cb_list;
DieterGraef 0:d26c1b55cfca 1157 if (select_cb_list != NULL) {
DieterGraef 0:d26c1b55cfca 1158 select_cb_list->prev = &select_cb;
DieterGraef 0:d26c1b55cfca 1159 }
DieterGraef 0:d26c1b55cfca 1160 select_cb_list = &select_cb;
DieterGraef 0:d26c1b55cfca 1161 /* Increasing this counter tells even_callback that the list has changed. */
DieterGraef 0:d26c1b55cfca 1162 select_cb_ctr++;
DieterGraef 0:d26c1b55cfca 1163
DieterGraef 0:d26c1b55cfca 1164 /* Now we can safely unprotect */
DieterGraef 0:d26c1b55cfca 1165 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1166
DieterGraef 0:d26c1b55cfca 1167 /* Increase select_waiting for each socket we are interested in */
DieterGraef 0:d26c1b55cfca 1168 for(i = 0; i < maxfdp1; i++) {
DieterGraef 0:d26c1b55cfca 1169 if ((readset && FD_ISSET(i, readset)) ||
DieterGraef 0:d26c1b55cfca 1170 (writeset && FD_ISSET(i, writeset)) ||
DieterGraef 0:d26c1b55cfca 1171 (exceptset && FD_ISSET(i, exceptset))) {
DieterGraef 0:d26c1b55cfca 1172 struct lwip_sock *sock = tryget_socket(i);
DieterGraef 0:d26c1b55cfca 1173 LWIP_ASSERT("sock != NULL", sock != NULL);
DieterGraef 0:d26c1b55cfca 1174 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1175 sock->select_waiting++;
DieterGraef 0:d26c1b55cfca 1176 LWIP_ASSERT("sock->select_waiting > 0", sock->select_waiting > 0);
DieterGraef 0:d26c1b55cfca 1177 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1178 }
DieterGraef 0:d26c1b55cfca 1179 }
DieterGraef 0:d26c1b55cfca 1180
DieterGraef 0:d26c1b55cfca 1181 /* Call lwip_selscan again: there could have been events between
DieterGraef 0:d26c1b55cfca 1182 the last scan (whithout us on the list) and putting us on the list! */
DieterGraef 0:d26c1b55cfca 1183 nready = lwip_selscan(maxfdp1, readset, writeset, exceptset, &lreadset, &lwriteset, &lexceptset);
DieterGraef 0:d26c1b55cfca 1184 if (!nready) {
DieterGraef 0:d26c1b55cfca 1185 /* Still none ready, just wait to be woken */
DieterGraef 0:d26c1b55cfca 1186 if (timeout == 0) {
DieterGraef 0:d26c1b55cfca 1187 /* Wait forever */
DieterGraef 0:d26c1b55cfca 1188 msectimeout = 0;
DieterGraef 0:d26c1b55cfca 1189 } else {
DieterGraef 0:d26c1b55cfca 1190 msectimeout = ((timeout->tv_sec * 1000) + ((timeout->tv_usec + 500)/1000));
DieterGraef 0:d26c1b55cfca 1191 if (msectimeout == 0) {
DieterGraef 0:d26c1b55cfca 1192 /* Wait 1ms at least (0 means wait forever) */
DieterGraef 0:d26c1b55cfca 1193 msectimeout = 1;
DieterGraef 0:d26c1b55cfca 1194 }
DieterGraef 0:d26c1b55cfca 1195 }
DieterGraef 0:d26c1b55cfca 1196
DieterGraef 0:d26c1b55cfca 1197 waitres = sys_arch_sem_wait(&select_cb.sem, msectimeout);
DieterGraef 0:d26c1b55cfca 1198 }
DieterGraef 0:d26c1b55cfca 1199 /* Increase select_waiting for each socket we are interested in */
DieterGraef 0:d26c1b55cfca 1200 for(i = 0; i < maxfdp1; i++) {
DieterGraef 0:d26c1b55cfca 1201 if ((readset && FD_ISSET(i, readset)) ||
DieterGraef 0:d26c1b55cfca 1202 (writeset && FD_ISSET(i, writeset)) ||
DieterGraef 0:d26c1b55cfca 1203 (exceptset && FD_ISSET(i, exceptset))) {
DieterGraef 0:d26c1b55cfca 1204 struct lwip_sock *sock = tryget_socket(i);
DieterGraef 0:d26c1b55cfca 1205 LWIP_ASSERT("sock != NULL", sock != NULL);
DieterGraef 0:d26c1b55cfca 1206 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1207 sock->select_waiting--;
DieterGraef 0:d26c1b55cfca 1208 LWIP_ASSERT("sock->select_waiting >= 0", sock->select_waiting >= 0);
DieterGraef 0:d26c1b55cfca 1209 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1210 }
DieterGraef 0:d26c1b55cfca 1211 }
DieterGraef 0:d26c1b55cfca 1212 /* Take us off the list */
DieterGraef 0:d26c1b55cfca 1213 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1214 if (select_cb.next != NULL) {
DieterGraef 0:d26c1b55cfca 1215 select_cb.next->prev = select_cb.prev;
DieterGraef 0:d26c1b55cfca 1216 }
DieterGraef 0:d26c1b55cfca 1217 if (select_cb_list == &select_cb) {
DieterGraef 0:d26c1b55cfca 1218 LWIP_ASSERT("select_cb.prev == NULL", select_cb.prev == NULL);
DieterGraef 0:d26c1b55cfca 1219 select_cb_list = select_cb.next;
DieterGraef 0:d26c1b55cfca 1220 } else {
DieterGraef 0:d26c1b55cfca 1221 LWIP_ASSERT("select_cb.prev != NULL", select_cb.prev != NULL);
DieterGraef 0:d26c1b55cfca 1222 select_cb.prev->next = select_cb.next;
DieterGraef 0:d26c1b55cfca 1223 }
DieterGraef 0:d26c1b55cfca 1224 /* Increasing this counter tells even_callback that the list has changed. */
DieterGraef 0:d26c1b55cfca 1225 select_cb_ctr++;
DieterGraef 0:d26c1b55cfca 1226 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1227
DieterGraef 0:d26c1b55cfca 1228 sys_sem_free(&select_cb.sem);
DieterGraef 0:d26c1b55cfca 1229 if (waitres == SYS_ARCH_TIMEOUT) {
DieterGraef 0:d26c1b55cfca 1230 /* Timeout */
DieterGraef 0:d26c1b55cfca 1231 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_select: timeout expired\n"));
DieterGraef 0:d26c1b55cfca 1232 /* This is OK as the local fdsets are empty and nready is zero,
DieterGraef 0:d26c1b55cfca 1233 or we would have returned earlier. */
DieterGraef 0:d26c1b55cfca 1234 goto return_copy_fdsets;
DieterGraef 0:d26c1b55cfca 1235 }
DieterGraef 0:d26c1b55cfca 1236
DieterGraef 0:d26c1b55cfca 1237 /* See what's set */
DieterGraef 0:d26c1b55cfca 1238 nready = lwip_selscan(maxfdp1, readset, writeset, exceptset, &lreadset, &lwriteset, &lexceptset);
DieterGraef 0:d26c1b55cfca 1239 }
DieterGraef 0:d26c1b55cfca 1240
DieterGraef 0:d26c1b55cfca 1241 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_select: nready=%d\n", nready));
DieterGraef 0:d26c1b55cfca 1242 return_copy_fdsets:
DieterGraef 0:d26c1b55cfca 1243 set_errno(0);
DieterGraef 0:d26c1b55cfca 1244 if (readset) {
DieterGraef 0:d26c1b55cfca 1245 *readset = lreadset;
DieterGraef 0:d26c1b55cfca 1246 }
DieterGraef 0:d26c1b55cfca 1247 if (writeset) {
DieterGraef 0:d26c1b55cfca 1248 *writeset = lwriteset;
DieterGraef 0:d26c1b55cfca 1249 }
DieterGraef 0:d26c1b55cfca 1250 if (exceptset) {
DieterGraef 0:d26c1b55cfca 1251 *exceptset = lexceptset;
DieterGraef 0:d26c1b55cfca 1252 }
DieterGraef 0:d26c1b55cfca 1253
DieterGraef 0:d26c1b55cfca 1254
DieterGraef 0:d26c1b55cfca 1255 return nready;
DieterGraef 0:d26c1b55cfca 1256 }
DieterGraef 0:d26c1b55cfca 1257
DieterGraef 0:d26c1b55cfca 1258 /**
DieterGraef 0:d26c1b55cfca 1259 * Callback registered in the netconn layer for each socket-netconn.
DieterGraef 0:d26c1b55cfca 1260 * Processes recvevent (data available) and wakes up tasks waiting for select.
DieterGraef 0:d26c1b55cfca 1261 */
DieterGraef 0:d26c1b55cfca 1262 static void
DieterGraef 0:d26c1b55cfca 1263 event_callback(struct netconn *conn, enum netconn_evt evt, u16_t len)
DieterGraef 0:d26c1b55cfca 1264 {
DieterGraef 0:d26c1b55cfca 1265 int s;
DieterGraef 0:d26c1b55cfca 1266 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 1267 struct lwip_select_cb *scb;
DieterGraef 0:d26c1b55cfca 1268 int last_select_cb_ctr;
DieterGraef 0:d26c1b55cfca 1269 SYS_ARCH_DECL_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1270
DieterGraef 0:d26c1b55cfca 1271 LWIP_UNUSED_ARG(len);
DieterGraef 0:d26c1b55cfca 1272
DieterGraef 0:d26c1b55cfca 1273 /* Get socket */
DieterGraef 0:d26c1b55cfca 1274 if (conn) {
DieterGraef 0:d26c1b55cfca 1275 s = conn->socket;
DieterGraef 0:d26c1b55cfca 1276 if (s < 0) {
DieterGraef 0:d26c1b55cfca 1277 /* Data comes in right away after an accept, even though
DieterGraef 0:d26c1b55cfca 1278 * the server task might not have created a new socket yet.
DieterGraef 0:d26c1b55cfca 1279 * Just count down (or up) if that's the case and we
DieterGraef 0:d26c1b55cfca 1280 * will use the data later. Note that only receive events
DieterGraef 0:d26c1b55cfca 1281 * can happen before the new socket is set up. */
DieterGraef 0:d26c1b55cfca 1282 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1283 if (conn->socket < 0) {
DieterGraef 0:d26c1b55cfca 1284 if (evt == NETCONN_EVT_RCVPLUS) {
DieterGraef 0:d26c1b55cfca 1285 conn->socket--;
DieterGraef 0:d26c1b55cfca 1286 }
DieterGraef 0:d26c1b55cfca 1287 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1288 return;
DieterGraef 0:d26c1b55cfca 1289 }
DieterGraef 0:d26c1b55cfca 1290 s = conn->socket;
DieterGraef 0:d26c1b55cfca 1291 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1292 }
DieterGraef 0:d26c1b55cfca 1293
DieterGraef 0:d26c1b55cfca 1294 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 1295 if (!sock) {
DieterGraef 0:d26c1b55cfca 1296 return;
DieterGraef 0:d26c1b55cfca 1297 }
DieterGraef 0:d26c1b55cfca 1298 } else {
DieterGraef 0:d26c1b55cfca 1299 return;
DieterGraef 0:d26c1b55cfca 1300 }
DieterGraef 0:d26c1b55cfca 1301
DieterGraef 0:d26c1b55cfca 1302 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1303 /* Set event as required */
DieterGraef 0:d26c1b55cfca 1304 switch (evt) {
DieterGraef 0:d26c1b55cfca 1305 case NETCONN_EVT_RCVPLUS:
DieterGraef 0:d26c1b55cfca 1306 sock->rcvevent++;
DieterGraef 0:d26c1b55cfca 1307 break;
DieterGraef 0:d26c1b55cfca 1308 case NETCONN_EVT_RCVMINUS:
DieterGraef 0:d26c1b55cfca 1309 sock->rcvevent--;
DieterGraef 0:d26c1b55cfca 1310 break;
DieterGraef 0:d26c1b55cfca 1311 case NETCONN_EVT_SENDPLUS:
DieterGraef 0:d26c1b55cfca 1312 sock->sendevent = 1;
DieterGraef 0:d26c1b55cfca 1313 break;
DieterGraef 0:d26c1b55cfca 1314 case NETCONN_EVT_SENDMINUS:
DieterGraef 0:d26c1b55cfca 1315 sock->sendevent = 0;
DieterGraef 0:d26c1b55cfca 1316 break;
DieterGraef 0:d26c1b55cfca 1317 case NETCONN_EVT_ERROR:
DieterGraef 0:d26c1b55cfca 1318 sock->errevent = 1;
DieterGraef 0:d26c1b55cfca 1319 break;
DieterGraef 0:d26c1b55cfca 1320 default:
DieterGraef 0:d26c1b55cfca 1321 LWIP_ASSERT("unknown event", 0);
DieterGraef 0:d26c1b55cfca 1322 break;
DieterGraef 0:d26c1b55cfca 1323 }
DieterGraef 0:d26c1b55cfca 1324
DieterGraef 0:d26c1b55cfca 1325 if (sock->select_waiting == 0) {
DieterGraef 0:d26c1b55cfca 1326 /* noone is waiting for this socket, no need to check select_cb_list */
DieterGraef 0:d26c1b55cfca 1327 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1328 return;
DieterGraef 0:d26c1b55cfca 1329 }
DieterGraef 0:d26c1b55cfca 1330
DieterGraef 0:d26c1b55cfca 1331 /* Now decide if anyone is waiting for this socket */
DieterGraef 0:d26c1b55cfca 1332 /* NOTE: This code goes through the select_cb_list list multiple times
DieterGraef 0:d26c1b55cfca 1333 ONLY IF a select was actually waiting. We go through the list the number
DieterGraef 0:d26c1b55cfca 1334 of waiting select calls + 1. This list is expected to be small. */
DieterGraef 0:d26c1b55cfca 1335
DieterGraef 0:d26c1b55cfca 1336 /* At this point, SYS_ARCH is still protected! */
DieterGraef 0:d26c1b55cfca 1337 again:
DieterGraef 0:d26c1b55cfca 1338 for (scb = select_cb_list; scb != NULL; scb = scb->next) {
DieterGraef 0:d26c1b55cfca 1339 if (scb->sem_signalled == 0) {
DieterGraef 0:d26c1b55cfca 1340 /* semaphore not signalled yet */
DieterGraef 0:d26c1b55cfca 1341 int do_signal = 0;
DieterGraef 0:d26c1b55cfca 1342 /* Test this select call for our socket */
DieterGraef 0:d26c1b55cfca 1343 if (sock->rcvevent > 0) {
DieterGraef 0:d26c1b55cfca 1344 if (scb->readset && FD_ISSET(s, scb->readset)) {
DieterGraef 0:d26c1b55cfca 1345 do_signal = 1;
DieterGraef 0:d26c1b55cfca 1346 }
DieterGraef 0:d26c1b55cfca 1347 }
DieterGraef 0:d26c1b55cfca 1348 if (sock->sendevent != 0) {
DieterGraef 0:d26c1b55cfca 1349 if (!do_signal && scb->writeset && FD_ISSET(s, scb->writeset)) {
DieterGraef 0:d26c1b55cfca 1350 do_signal = 1;
DieterGraef 0:d26c1b55cfca 1351 }
DieterGraef 0:d26c1b55cfca 1352 }
DieterGraef 0:d26c1b55cfca 1353 if (sock->errevent != 0) {
DieterGraef 0:d26c1b55cfca 1354 if (!do_signal && scb->exceptset && FD_ISSET(s, scb->exceptset)) {
DieterGraef 0:d26c1b55cfca 1355 do_signal = 1;
DieterGraef 0:d26c1b55cfca 1356 }
DieterGraef 0:d26c1b55cfca 1357 }
DieterGraef 0:d26c1b55cfca 1358 if (do_signal) {
DieterGraef 0:d26c1b55cfca 1359 scb->sem_signalled = 1;
DieterGraef 0:d26c1b55cfca 1360 /* Don't call SYS_ARCH_UNPROTECT() before signaling the semaphore, as this might
DieterGraef 0:d26c1b55cfca 1361 lead to the select thread taking itself off the list, invalidagin the semaphore. */
DieterGraef 0:d26c1b55cfca 1362 sys_sem_signal(&scb->sem);
DieterGraef 0:d26c1b55cfca 1363 }
DieterGraef 0:d26c1b55cfca 1364 }
DieterGraef 0:d26c1b55cfca 1365 /* unlock interrupts with each step */
DieterGraef 0:d26c1b55cfca 1366 last_select_cb_ctr = select_cb_ctr;
DieterGraef 0:d26c1b55cfca 1367 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1368 /* this makes sure interrupt protection time is short */
DieterGraef 0:d26c1b55cfca 1369 SYS_ARCH_PROTECT(lev);
DieterGraef 0:d26c1b55cfca 1370 if (last_select_cb_ctr != select_cb_ctr) {
DieterGraef 0:d26c1b55cfca 1371 /* someone has changed select_cb_list, restart at the beginning */
DieterGraef 0:d26c1b55cfca 1372 goto again;
DieterGraef 0:d26c1b55cfca 1373 }
DieterGraef 0:d26c1b55cfca 1374 }
DieterGraef 0:d26c1b55cfca 1375 SYS_ARCH_UNPROTECT(lev);
DieterGraef 0:d26c1b55cfca 1376 }
DieterGraef 0:d26c1b55cfca 1377
DieterGraef 0:d26c1b55cfca 1378 /**
DieterGraef 0:d26c1b55cfca 1379 * Unimplemented: Close one end of a full-duplex connection.
DieterGraef 0:d26c1b55cfca 1380 * Currently, the full connection is closed.
DieterGraef 0:d26c1b55cfca 1381 */
DieterGraef 0:d26c1b55cfca 1382 int
DieterGraef 0:d26c1b55cfca 1383 lwip_shutdown(int s, int how)
DieterGraef 0:d26c1b55cfca 1384 {
DieterGraef 0:d26c1b55cfca 1385 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 1386 err_t err;
DieterGraef 0:d26c1b55cfca 1387 u8_t shut_rx = 0, shut_tx = 0;
DieterGraef 0:d26c1b55cfca 1388
DieterGraef 0:d26c1b55cfca 1389 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_shutdown(%d, how=%d)\n", s, how));
DieterGraef 0:d26c1b55cfca 1390
DieterGraef 0:d26c1b55cfca 1391 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 1392 if (!sock) {
DieterGraef 0:d26c1b55cfca 1393 return -1;
DieterGraef 0:d26c1b55cfca 1394 }
DieterGraef 0:d26c1b55cfca 1395
DieterGraef 0:d26c1b55cfca 1396 if (sock->conn != NULL) {
DieterGraef 0:d26c1b55cfca 1397 if (netconn_type(sock->conn) != NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 1398 sock_set_errno(sock, EOPNOTSUPP);
DieterGraef 0:d26c1b55cfca 1399 return EOPNOTSUPP;
DieterGraef 0:d26c1b55cfca 1400 }
DieterGraef 0:d26c1b55cfca 1401 } else {
DieterGraef 0:d26c1b55cfca 1402 sock_set_errno(sock, ENOTCONN);
DieterGraef 0:d26c1b55cfca 1403 return ENOTCONN;
DieterGraef 0:d26c1b55cfca 1404 }
DieterGraef 0:d26c1b55cfca 1405
DieterGraef 0:d26c1b55cfca 1406 if (how == SHUT_RD) {
DieterGraef 0:d26c1b55cfca 1407 shut_rx = 1;
DieterGraef 0:d26c1b55cfca 1408 } else if (how == SHUT_WR) {
DieterGraef 0:d26c1b55cfca 1409 shut_tx = 1;
DieterGraef 0:d26c1b55cfca 1410 } else if(how == SHUT_RDWR) {
DieterGraef 0:d26c1b55cfca 1411 shut_rx = 1;
DieterGraef 0:d26c1b55cfca 1412 shut_tx = 1;
DieterGraef 0:d26c1b55cfca 1413 } else {
DieterGraef 0:d26c1b55cfca 1414 sock_set_errno(sock, EINVAL);
DieterGraef 0:d26c1b55cfca 1415 return EINVAL;
DieterGraef 0:d26c1b55cfca 1416 }
DieterGraef 0:d26c1b55cfca 1417 err = netconn_shutdown(sock->conn, shut_rx, shut_tx);
DieterGraef 0:d26c1b55cfca 1418
DieterGraef 0:d26c1b55cfca 1419 sock_set_errno(sock, err_to_errno(err));
DieterGraef 0:d26c1b55cfca 1420 return (err == ERR_OK ? 0 : -1);
DieterGraef 0:d26c1b55cfca 1421 }
DieterGraef 0:d26c1b55cfca 1422
DieterGraef 0:d26c1b55cfca 1423 static int
DieterGraef 0:d26c1b55cfca 1424 lwip_getaddrname(int s, struct sockaddr *name, socklen_t *namelen, u8_t local)
DieterGraef 0:d26c1b55cfca 1425 {
DieterGraef 0:d26c1b55cfca 1426 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 1427 struct sockaddr_in sin;
DieterGraef 0:d26c1b55cfca 1428 ip_addr_t naddr;
DieterGraef 0:d26c1b55cfca 1429
DieterGraef 0:d26c1b55cfca 1430 sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 1431 if (!sock) {
DieterGraef 0:d26c1b55cfca 1432 return -1;
DieterGraef 0:d26c1b55cfca 1433 }
DieterGraef 0:d26c1b55cfca 1434
DieterGraef 0:d26c1b55cfca 1435 memset(&sin, 0, sizeof(sin));
DieterGraef 0:d26c1b55cfca 1436 sin.sin_len = sizeof(sin);
DieterGraef 0:d26c1b55cfca 1437 sin.sin_family = AF_INET;
DieterGraef 0:d26c1b55cfca 1438
DieterGraef 0:d26c1b55cfca 1439 /* get the IP address and port */
DieterGraef 0:d26c1b55cfca 1440 netconn_getaddr(sock->conn, &naddr, &sin.sin_port, local);
DieterGraef 0:d26c1b55cfca 1441
DieterGraef 0:d26c1b55cfca 1442 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getaddrname(%d, addr=", s));
DieterGraef 0:d26c1b55cfca 1443 ip_addr_debug_print(SOCKETS_DEBUG, &naddr);
DieterGraef 0:d26c1b55cfca 1444 LWIP_DEBUGF(SOCKETS_DEBUG, (" port=%"U16_F")\n", sin.sin_port));
DieterGraef 0:d26c1b55cfca 1445
DieterGraef 0:d26c1b55cfca 1446 sin.sin_port = htons(sin.sin_port);
DieterGraef 0:d26c1b55cfca 1447 inet_addr_from_ipaddr(&sin.sin_addr, &naddr);
DieterGraef 0:d26c1b55cfca 1448
DieterGraef 0:d26c1b55cfca 1449 if (*namelen > sizeof(sin)) {
DieterGraef 0:d26c1b55cfca 1450 *namelen = sizeof(sin);
DieterGraef 0:d26c1b55cfca 1451 }
DieterGraef 0:d26c1b55cfca 1452
DieterGraef 0:d26c1b55cfca 1453 MEMCPY(name, &sin, *namelen);
DieterGraef 0:d26c1b55cfca 1454 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 1455 return 0;
DieterGraef 0:d26c1b55cfca 1456 }
DieterGraef 0:d26c1b55cfca 1457
DieterGraef 0:d26c1b55cfca 1458 int
DieterGraef 0:d26c1b55cfca 1459 lwip_getpeername(int s, struct sockaddr *name, socklen_t *namelen)
DieterGraef 0:d26c1b55cfca 1460 {
DieterGraef 0:d26c1b55cfca 1461 return lwip_getaddrname(s, name, namelen, 0);
DieterGraef 0:d26c1b55cfca 1462 }
DieterGraef 0:d26c1b55cfca 1463
DieterGraef 0:d26c1b55cfca 1464 int
DieterGraef 0:d26c1b55cfca 1465 lwip_getsockname(int s, struct sockaddr *name, socklen_t *namelen)
DieterGraef 0:d26c1b55cfca 1466 {
DieterGraef 0:d26c1b55cfca 1467 return lwip_getaddrname(s, name, namelen, 1);
DieterGraef 0:d26c1b55cfca 1468 }
DieterGraef 0:d26c1b55cfca 1469
DieterGraef 0:d26c1b55cfca 1470 int
DieterGraef 0:d26c1b55cfca 1471 lwip_getsockopt(int s, int level, int optname, void *optval, socklen_t *optlen)
DieterGraef 0:d26c1b55cfca 1472 {
DieterGraef 0:d26c1b55cfca 1473 err_t err = ERR_OK;
DieterGraef 0:d26c1b55cfca 1474 struct lwip_sock *sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 1475 struct lwip_setgetsockopt_data data;
DieterGraef 0:d26c1b55cfca 1476
DieterGraef 0:d26c1b55cfca 1477 if (!sock) {
DieterGraef 0:d26c1b55cfca 1478 return -1;
DieterGraef 0:d26c1b55cfca 1479 }
DieterGraef 0:d26c1b55cfca 1480
DieterGraef 0:d26c1b55cfca 1481 if ((NULL == optval) || (NULL == optlen)) {
DieterGraef 0:d26c1b55cfca 1482 sock_set_errno(sock, EFAULT);
DieterGraef 0:d26c1b55cfca 1483 return -1;
DieterGraef 0:d26c1b55cfca 1484 }
DieterGraef 0:d26c1b55cfca 1485
DieterGraef 0:d26c1b55cfca 1486 /* Do length and type checks for the various options first, to keep it readable. */
DieterGraef 0:d26c1b55cfca 1487 switch (level) {
DieterGraef 0:d26c1b55cfca 1488
DieterGraef 0:d26c1b55cfca 1489 /* Level: SOL_SOCKET */
DieterGraef 0:d26c1b55cfca 1490 case SOL_SOCKET:
DieterGraef 0:d26c1b55cfca 1491 switch (optname) {
DieterGraef 0:d26c1b55cfca 1492
DieterGraef 0:d26c1b55cfca 1493 case SO_ACCEPTCONN:
DieterGraef 0:d26c1b55cfca 1494 case SO_BROADCAST:
DieterGraef 0:d26c1b55cfca 1495 /* UNIMPL case SO_DEBUG: */
DieterGraef 0:d26c1b55cfca 1496 /* UNIMPL case SO_DONTROUTE: */
DieterGraef 0:d26c1b55cfca 1497 case SO_ERROR:
DieterGraef 0:d26c1b55cfca 1498 case SO_KEEPALIVE:
DieterGraef 0:d26c1b55cfca 1499 /* UNIMPL case SO_CONTIMEO: */
DieterGraef 0:d26c1b55cfca 1500 #if LWIP_SO_SNDTIMEO
DieterGraef 0:d26c1b55cfca 1501 case SO_SNDTIMEO:
DieterGraef 0:d26c1b55cfca 1502 #endif /* LWIP_SO_SNDTIMEO */
DieterGraef 0:d26c1b55cfca 1503 #if LWIP_SO_RCVTIMEO
DieterGraef 0:d26c1b55cfca 1504 case SO_RCVTIMEO:
DieterGraef 0:d26c1b55cfca 1505 #endif /* LWIP_SO_RCVTIMEO */
DieterGraef 0:d26c1b55cfca 1506 #if LWIP_SO_RCVBUF
DieterGraef 0:d26c1b55cfca 1507 case SO_RCVBUF:
DieterGraef 0:d26c1b55cfca 1508 #endif /* LWIP_SO_RCVBUF */
DieterGraef 0:d26c1b55cfca 1509 /* UNIMPL case SO_OOBINLINE: */
DieterGraef 0:d26c1b55cfca 1510 /* UNIMPL case SO_SNDBUF: */
DieterGraef 0:d26c1b55cfca 1511 /* UNIMPL case SO_RCVLOWAT: */
DieterGraef 0:d26c1b55cfca 1512 /* UNIMPL case SO_SNDLOWAT: */
DieterGraef 0:d26c1b55cfca 1513 #if SO_REUSE
DieterGraef 0:d26c1b55cfca 1514 case SO_REUSEADDR:
DieterGraef 0:d26c1b55cfca 1515 case SO_REUSEPORT:
DieterGraef 0:d26c1b55cfca 1516 #endif /* SO_REUSE */
DieterGraef 0:d26c1b55cfca 1517 case SO_TYPE:
DieterGraef 0:d26c1b55cfca 1518 /* UNIMPL case SO_USELOOPBACK: */
DieterGraef 0:d26c1b55cfca 1519 if (*optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 1520 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1521 }
DieterGraef 0:d26c1b55cfca 1522 break;
DieterGraef 0:d26c1b55cfca 1523
DieterGraef 0:d26c1b55cfca 1524 case SO_NO_CHECK:
DieterGraef 0:d26c1b55cfca 1525 if (*optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 1526 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1527 }
DieterGraef 0:d26c1b55cfca 1528 #if LWIP_UDP
DieterGraef 0:d26c1b55cfca 1529 if ((sock->conn->type != NETCONN_UDP) ||
DieterGraef 0:d26c1b55cfca 1530 ((udp_flags(sock->conn->pcb.udp) & UDP_FLAGS_UDPLITE) != 0)) {
DieterGraef 0:d26c1b55cfca 1531 /* this flag is only available for UDP, not for UDP lite */
DieterGraef 0:d26c1b55cfca 1532 err = EAFNOSUPPORT;
DieterGraef 0:d26c1b55cfca 1533 }
DieterGraef 0:d26c1b55cfca 1534 #endif /* LWIP_UDP */
DieterGraef 0:d26c1b55cfca 1535 break;
DieterGraef 0:d26c1b55cfca 1536
DieterGraef 0:d26c1b55cfca 1537 default:
DieterGraef 0:d26c1b55cfca 1538 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, SOL_SOCKET, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 1539 s, optname));
DieterGraef 0:d26c1b55cfca 1540 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 1541 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1542 break;
DieterGraef 0:d26c1b55cfca 1543
DieterGraef 0:d26c1b55cfca 1544 /* Level: IPPROTO_IP */
DieterGraef 0:d26c1b55cfca 1545 case IPPROTO_IP:
DieterGraef 0:d26c1b55cfca 1546 switch (optname) {
DieterGraef 0:d26c1b55cfca 1547 /* UNIMPL case IP_HDRINCL: */
DieterGraef 0:d26c1b55cfca 1548 /* UNIMPL case IP_RCVDSTADDR: */
DieterGraef 0:d26c1b55cfca 1549 /* UNIMPL case IP_RCVIF: */
DieterGraef 0:d26c1b55cfca 1550 case IP_TTL:
DieterGraef 0:d26c1b55cfca 1551 case IP_TOS:
DieterGraef 0:d26c1b55cfca 1552 if (*optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 1553 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1554 }
DieterGraef 0:d26c1b55cfca 1555 break;
DieterGraef 0:d26c1b55cfca 1556 #if LWIP_IGMP
DieterGraef 0:d26c1b55cfca 1557 case IP_MULTICAST_TTL:
DieterGraef 0:d26c1b55cfca 1558 if (*optlen < sizeof(u8_t)) {
DieterGraef 0:d26c1b55cfca 1559 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1560 }
DieterGraef 0:d26c1b55cfca 1561 break;
DieterGraef 0:d26c1b55cfca 1562 case IP_MULTICAST_IF:
DieterGraef 0:d26c1b55cfca 1563 if (*optlen < sizeof(struct in_addr)) {
DieterGraef 0:d26c1b55cfca 1564 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1565 }
DieterGraef 0:d26c1b55cfca 1566 break;
DieterGraef 0:d26c1b55cfca 1567 case IP_MULTICAST_LOOP:
DieterGraef 0:d26c1b55cfca 1568 if (*optlen < sizeof(u8_t)) {
DieterGraef 0:d26c1b55cfca 1569 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1570 }
DieterGraef 0:d26c1b55cfca 1571 if (NETCONNTYPE_GROUP(sock->conn->type) != NETCONN_UDP) {
DieterGraef 0:d26c1b55cfca 1572 err = EAFNOSUPPORT;
DieterGraef 0:d26c1b55cfca 1573 }
DieterGraef 0:d26c1b55cfca 1574 break;
DieterGraef 0:d26c1b55cfca 1575 #endif /* LWIP_IGMP */
DieterGraef 0:d26c1b55cfca 1576
DieterGraef 0:d26c1b55cfca 1577 default:
DieterGraef 0:d26c1b55cfca 1578 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 1579 s, optname));
DieterGraef 0:d26c1b55cfca 1580 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 1581 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1582 break;
DieterGraef 0:d26c1b55cfca 1583
DieterGraef 0:d26c1b55cfca 1584 #if LWIP_TCP
DieterGraef 0:d26c1b55cfca 1585 /* Level: IPPROTO_TCP */
DieterGraef 0:d26c1b55cfca 1586 case IPPROTO_TCP:
DieterGraef 0:d26c1b55cfca 1587 if (*optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 1588 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1589 break;
DieterGraef 0:d26c1b55cfca 1590 }
DieterGraef 0:d26c1b55cfca 1591
DieterGraef 0:d26c1b55cfca 1592 /* If this is no TCP socket, ignore any options. */
DieterGraef 0:d26c1b55cfca 1593 if (sock->conn->type != NETCONN_TCP)
DieterGraef 0:d26c1b55cfca 1594 return 0;
DieterGraef 0:d26c1b55cfca 1595
DieterGraef 0:d26c1b55cfca 1596 switch (optname) {
DieterGraef 0:d26c1b55cfca 1597 case TCP_NODELAY:
DieterGraef 0:d26c1b55cfca 1598 case TCP_KEEPALIVE:
DieterGraef 0:d26c1b55cfca 1599 #if LWIP_TCP_KEEPALIVE
DieterGraef 0:d26c1b55cfca 1600 case TCP_KEEPIDLE:
DieterGraef 0:d26c1b55cfca 1601 case TCP_KEEPINTVL:
DieterGraef 0:d26c1b55cfca 1602 case TCP_KEEPCNT:
DieterGraef 0:d26c1b55cfca 1603 #endif /* LWIP_TCP_KEEPALIVE */
DieterGraef 0:d26c1b55cfca 1604 break;
DieterGraef 0:d26c1b55cfca 1605
DieterGraef 0:d26c1b55cfca 1606 default:
DieterGraef 0:d26c1b55cfca 1607 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_TCP, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 1608 s, optname));
DieterGraef 0:d26c1b55cfca 1609 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 1610 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1611 break;
DieterGraef 0:d26c1b55cfca 1612 #endif /* LWIP_TCP */
DieterGraef 0:d26c1b55cfca 1613 #if LWIP_UDP && LWIP_UDPLITE
DieterGraef 0:d26c1b55cfca 1614 /* Level: IPPROTO_UDPLITE */
DieterGraef 0:d26c1b55cfca 1615 case IPPROTO_UDPLITE:
DieterGraef 0:d26c1b55cfca 1616 if (*optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 1617 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1618 break;
DieterGraef 0:d26c1b55cfca 1619 }
DieterGraef 0:d26c1b55cfca 1620
DieterGraef 0:d26c1b55cfca 1621 /* If this is no UDP lite socket, ignore any options. */
DieterGraef 0:d26c1b55cfca 1622 if (sock->conn->type != NETCONN_UDPLITE) {
DieterGraef 0:d26c1b55cfca 1623 return 0;
DieterGraef 0:d26c1b55cfca 1624 }
DieterGraef 0:d26c1b55cfca 1625
DieterGraef 0:d26c1b55cfca 1626 switch (optname) {
DieterGraef 0:d26c1b55cfca 1627 case UDPLITE_SEND_CSCOV:
DieterGraef 0:d26c1b55cfca 1628 case UDPLITE_RECV_CSCOV:
DieterGraef 0:d26c1b55cfca 1629 break;
DieterGraef 0:d26c1b55cfca 1630
DieterGraef 0:d26c1b55cfca 1631 default:
DieterGraef 0:d26c1b55cfca 1632 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_UDPLITE, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 1633 s, optname));
DieterGraef 0:d26c1b55cfca 1634 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 1635 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1636 break;
DieterGraef 0:d26c1b55cfca 1637 #endif /* LWIP_UDP && LWIP_UDPLITE*/
DieterGraef 0:d26c1b55cfca 1638 /* UNDEFINED LEVEL */
DieterGraef 0:d26c1b55cfca 1639 default:
DieterGraef 0:d26c1b55cfca 1640 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, level=0x%x, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 1641 s, level, optname));
DieterGraef 0:d26c1b55cfca 1642 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 1643 } /* switch */
DieterGraef 0:d26c1b55cfca 1644
DieterGraef 0:d26c1b55cfca 1645
DieterGraef 0:d26c1b55cfca 1646 if (err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 1647 sock_set_errno(sock, err);
DieterGraef 0:d26c1b55cfca 1648 return -1;
DieterGraef 0:d26c1b55cfca 1649 }
DieterGraef 0:d26c1b55cfca 1650
DieterGraef 0:d26c1b55cfca 1651 /* Now do the actual option processing */
DieterGraef 0:d26c1b55cfca 1652 data.sock = sock;
DieterGraef 0:d26c1b55cfca 1653 #ifdef LWIP_DEBUG
DieterGraef 0:d26c1b55cfca 1654 data.s = s;
DieterGraef 0:d26c1b55cfca 1655 #endif /* LWIP_DEBUG */
DieterGraef 0:d26c1b55cfca 1656 data.level = level;
DieterGraef 0:d26c1b55cfca 1657 data.optname = optname;
DieterGraef 0:d26c1b55cfca 1658 data.optval = optval;
DieterGraef 0:d26c1b55cfca 1659 data.optlen = optlen;
DieterGraef 0:d26c1b55cfca 1660 data.err = err;
DieterGraef 0:d26c1b55cfca 1661 tcpip_callback(lwip_getsockopt_internal, &data);
DieterGraef 0:d26c1b55cfca 1662 sys_arch_sem_wait(&sock->conn->op_completed, 0);
DieterGraef 0:d26c1b55cfca 1663 /* maybe lwip_getsockopt_internal has changed err */
DieterGraef 0:d26c1b55cfca 1664 err = data.err;
DieterGraef 0:d26c1b55cfca 1665
DieterGraef 0:d26c1b55cfca 1666 sock_set_errno(sock, err);
DieterGraef 0:d26c1b55cfca 1667 return err ? -1 : 0;
DieterGraef 0:d26c1b55cfca 1668 }
DieterGraef 0:d26c1b55cfca 1669
DieterGraef 0:d26c1b55cfca 1670 static void
DieterGraef 0:d26c1b55cfca 1671 lwip_getsockopt_internal(void *arg)
DieterGraef 0:d26c1b55cfca 1672 {
DieterGraef 0:d26c1b55cfca 1673 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 1674 #ifdef LWIP_DEBUG
DieterGraef 0:d26c1b55cfca 1675 int s;
DieterGraef 0:d26c1b55cfca 1676 #endif /* LWIP_DEBUG */
DieterGraef 0:d26c1b55cfca 1677 int level, optname;
DieterGraef 0:d26c1b55cfca 1678 void *optval;
DieterGraef 0:d26c1b55cfca 1679 struct lwip_setgetsockopt_data *data;
DieterGraef 0:d26c1b55cfca 1680
DieterGraef 0:d26c1b55cfca 1681 LWIP_ASSERT("arg != NULL", arg != NULL);
DieterGraef 0:d26c1b55cfca 1682
DieterGraef 0:d26c1b55cfca 1683 data = (struct lwip_setgetsockopt_data*)arg;
DieterGraef 0:d26c1b55cfca 1684 sock = data->sock;
DieterGraef 0:d26c1b55cfca 1685 #ifdef LWIP_DEBUG
DieterGraef 0:d26c1b55cfca 1686 s = data->s;
DieterGraef 0:d26c1b55cfca 1687 #endif /* LWIP_DEBUG */
DieterGraef 0:d26c1b55cfca 1688 level = data->level;
DieterGraef 0:d26c1b55cfca 1689 optname = data->optname;
DieterGraef 0:d26c1b55cfca 1690 optval = data->optval;
DieterGraef 0:d26c1b55cfca 1691
DieterGraef 0:d26c1b55cfca 1692 switch (level) {
DieterGraef 0:d26c1b55cfca 1693
DieterGraef 0:d26c1b55cfca 1694 /* Level: SOL_SOCKET */
DieterGraef 0:d26c1b55cfca 1695 case SOL_SOCKET:
DieterGraef 0:d26c1b55cfca 1696 switch (optname) {
DieterGraef 0:d26c1b55cfca 1697
DieterGraef 0:d26c1b55cfca 1698 /* The option flags */
DieterGraef 0:d26c1b55cfca 1699 case SO_ACCEPTCONN:
DieterGraef 0:d26c1b55cfca 1700 case SO_BROADCAST:
DieterGraef 0:d26c1b55cfca 1701 /* UNIMPL case SO_DEBUG: */
DieterGraef 0:d26c1b55cfca 1702 /* UNIMPL case SO_DONTROUTE: */
DieterGraef 0:d26c1b55cfca 1703 case SO_KEEPALIVE:
DieterGraef 0:d26c1b55cfca 1704 /* UNIMPL case SO_OOBINCLUDE: */
DieterGraef 0:d26c1b55cfca 1705 #if SO_REUSE
DieterGraef 0:d26c1b55cfca 1706 case SO_REUSEADDR:
DieterGraef 0:d26c1b55cfca 1707 case SO_REUSEPORT:
DieterGraef 0:d26c1b55cfca 1708 #endif /* SO_REUSE */
DieterGraef 0:d26c1b55cfca 1709 /*case SO_USELOOPBACK: UNIMPL */
DieterGraef 0:d26c1b55cfca 1710 *(int*)optval = ip_get_option(sock->conn->pcb.ip, optname);
DieterGraef 0:d26c1b55cfca 1711 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, SOL_SOCKET, optname=0x%x, ..) = %s\n",
DieterGraef 0:d26c1b55cfca 1712 s, optname, (*(int*)optval?"on":"off")));
DieterGraef 0:d26c1b55cfca 1713 break;
DieterGraef 0:d26c1b55cfca 1714
DieterGraef 0:d26c1b55cfca 1715 case SO_TYPE:
DieterGraef 0:d26c1b55cfca 1716 switch (NETCONNTYPE_GROUP(sock->conn->type)) {
DieterGraef 0:d26c1b55cfca 1717 case NETCONN_RAW:
DieterGraef 0:d26c1b55cfca 1718 *(int*)optval = SOCK_RAW;
DieterGraef 0:d26c1b55cfca 1719 break;
DieterGraef 0:d26c1b55cfca 1720 case NETCONN_TCP:
DieterGraef 0:d26c1b55cfca 1721 *(int*)optval = SOCK_STREAM;
DieterGraef 0:d26c1b55cfca 1722 break;
DieterGraef 0:d26c1b55cfca 1723 case NETCONN_UDP:
DieterGraef 0:d26c1b55cfca 1724 *(int*)optval = SOCK_DGRAM;
DieterGraef 0:d26c1b55cfca 1725 break;
DieterGraef 0:d26c1b55cfca 1726 default: /* unrecognized socket type */
DieterGraef 0:d26c1b55cfca 1727 *(int*)optval = sock->conn->type;
DieterGraef 0:d26c1b55cfca 1728 LWIP_DEBUGF(SOCKETS_DEBUG,
DieterGraef 0:d26c1b55cfca 1729 ("lwip_getsockopt(%d, SOL_SOCKET, SO_TYPE): unrecognized socket type %d\n",
DieterGraef 0:d26c1b55cfca 1730 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1731 } /* switch (sock->conn->type) */
DieterGraef 0:d26c1b55cfca 1732 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, SOL_SOCKET, SO_TYPE) = %d\n",
DieterGraef 0:d26c1b55cfca 1733 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1734 break;
DieterGraef 0:d26c1b55cfca 1735
DieterGraef 0:d26c1b55cfca 1736 case SO_ERROR:
DieterGraef 0:d26c1b55cfca 1737 /* only overwrite ERR_OK or tempoary errors */
DieterGraef 0:d26c1b55cfca 1738 if ((sock->err == 0) || (sock->err == EINPROGRESS)) {
DieterGraef 0:d26c1b55cfca 1739 sock_set_errno(sock, err_to_errno(sock->conn->last_err));
DieterGraef 0:d26c1b55cfca 1740 }
DieterGraef 0:d26c1b55cfca 1741 *(int *)optval = sock->err;
DieterGraef 0:d26c1b55cfca 1742 sock->err = 0;
DieterGraef 0:d26c1b55cfca 1743 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, SOL_SOCKET, SO_ERROR) = %d\n",
DieterGraef 0:d26c1b55cfca 1744 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1745 break;
DieterGraef 0:d26c1b55cfca 1746
DieterGraef 0:d26c1b55cfca 1747 #if LWIP_SO_SNDTIMEO
DieterGraef 0:d26c1b55cfca 1748 case SO_SNDTIMEO:
DieterGraef 0:d26c1b55cfca 1749 *(int *)optval = netconn_get_sendtimeout(sock->conn);
DieterGraef 0:d26c1b55cfca 1750 break;
DieterGraef 0:d26c1b55cfca 1751 #endif /* LWIP_SO_SNDTIMEO */
DieterGraef 0:d26c1b55cfca 1752 #if LWIP_SO_RCVTIMEO
DieterGraef 0:d26c1b55cfca 1753 case SO_RCVTIMEO:
DieterGraef 0:d26c1b55cfca 1754 *(int *)optval = netconn_get_recvtimeout(sock->conn);
DieterGraef 0:d26c1b55cfca 1755 break;
DieterGraef 0:d26c1b55cfca 1756 #endif /* LWIP_SO_RCVTIMEO */
DieterGraef 0:d26c1b55cfca 1757 #if LWIP_SO_RCVBUF
DieterGraef 0:d26c1b55cfca 1758 case SO_RCVBUF:
DieterGraef 0:d26c1b55cfca 1759 *(int *)optval = netconn_get_recvbufsize(sock->conn);
DieterGraef 0:d26c1b55cfca 1760 break;
DieterGraef 0:d26c1b55cfca 1761 #endif /* LWIP_SO_RCVBUF */
DieterGraef 0:d26c1b55cfca 1762 #if LWIP_UDP
DieterGraef 0:d26c1b55cfca 1763 case SO_NO_CHECK:
DieterGraef 0:d26c1b55cfca 1764 *(int*)optval = (udp_flags(sock->conn->pcb.udp) & UDP_FLAGS_NOCHKSUM) ? 1 : 0;
DieterGraef 0:d26c1b55cfca 1765 break;
DieterGraef 0:d26c1b55cfca 1766 #endif /* LWIP_UDP*/
DieterGraef 0:d26c1b55cfca 1767 default:
DieterGraef 0:d26c1b55cfca 1768 LWIP_ASSERT("unhandled optname", 0);
DieterGraef 0:d26c1b55cfca 1769 break;
DieterGraef 0:d26c1b55cfca 1770 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1771 break;
DieterGraef 0:d26c1b55cfca 1772
DieterGraef 0:d26c1b55cfca 1773 /* Level: IPPROTO_IP */
DieterGraef 0:d26c1b55cfca 1774 case IPPROTO_IP:
DieterGraef 0:d26c1b55cfca 1775 switch (optname) {
DieterGraef 0:d26c1b55cfca 1776 case IP_TTL:
DieterGraef 0:d26c1b55cfca 1777 *(int*)optval = sock->conn->pcb.ip->ttl;
DieterGraef 0:d26c1b55cfca 1778 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, IP_TTL) = %d\n",
DieterGraef 0:d26c1b55cfca 1779 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1780 break;
DieterGraef 0:d26c1b55cfca 1781 case IP_TOS:
DieterGraef 0:d26c1b55cfca 1782 *(int*)optval = sock->conn->pcb.ip->tos;
DieterGraef 0:d26c1b55cfca 1783 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, IP_TOS) = %d\n",
DieterGraef 0:d26c1b55cfca 1784 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1785 break;
DieterGraef 0:d26c1b55cfca 1786 #if LWIP_IGMP
DieterGraef 0:d26c1b55cfca 1787 case IP_MULTICAST_TTL:
DieterGraef 0:d26c1b55cfca 1788 *(u8_t*)optval = sock->conn->pcb.ip->ttl;
DieterGraef 0:d26c1b55cfca 1789 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, IP_MULTICAST_TTL) = %d\n",
DieterGraef 0:d26c1b55cfca 1790 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1791 break;
DieterGraef 0:d26c1b55cfca 1792 case IP_MULTICAST_IF:
DieterGraef 0:d26c1b55cfca 1793 inet_addr_from_ipaddr((struct in_addr*)optval, &sock->conn->pcb.udp->multicast_ip);
DieterGraef 0:d26c1b55cfca 1794 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, IP_MULTICAST_IF) = 0x%"X32_F"\n",
DieterGraef 0:d26c1b55cfca 1795 s, *(u32_t *)optval));
DieterGraef 0:d26c1b55cfca 1796 break;
DieterGraef 0:d26c1b55cfca 1797 case IP_MULTICAST_LOOP:
DieterGraef 0:d26c1b55cfca 1798 if ((sock->conn->pcb.udp->flags & UDP_FLAGS_MULTICAST_LOOP) != 0) {
DieterGraef 0:d26c1b55cfca 1799 *(u8_t*)optval = 1;
DieterGraef 0:d26c1b55cfca 1800 } else {
DieterGraef 0:d26c1b55cfca 1801 *(u8_t*)optval = 0;
DieterGraef 0:d26c1b55cfca 1802 }
DieterGraef 0:d26c1b55cfca 1803 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, IP_MULTICAST_LOOP) = %d\n",
DieterGraef 0:d26c1b55cfca 1804 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1805 break;
DieterGraef 0:d26c1b55cfca 1806 #endif /* LWIP_IGMP */
DieterGraef 0:d26c1b55cfca 1807 default:
DieterGraef 0:d26c1b55cfca 1808 LWIP_ASSERT("unhandled optname", 0);
DieterGraef 0:d26c1b55cfca 1809 break;
DieterGraef 0:d26c1b55cfca 1810 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1811 break;
DieterGraef 0:d26c1b55cfca 1812
DieterGraef 0:d26c1b55cfca 1813 #if LWIP_TCP
DieterGraef 0:d26c1b55cfca 1814 /* Level: IPPROTO_TCP */
DieterGraef 0:d26c1b55cfca 1815 case IPPROTO_TCP:
DieterGraef 0:d26c1b55cfca 1816 switch (optname) {
DieterGraef 0:d26c1b55cfca 1817 case TCP_NODELAY:
DieterGraef 0:d26c1b55cfca 1818 *(int*)optval = tcp_nagle_disabled(sock->conn->pcb.tcp);
DieterGraef 0:d26c1b55cfca 1819 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_TCP, TCP_NODELAY) = %s\n",
DieterGraef 0:d26c1b55cfca 1820 s, (*(int*)optval)?"on":"off") );
DieterGraef 0:d26c1b55cfca 1821 break;
DieterGraef 0:d26c1b55cfca 1822 case TCP_KEEPALIVE:
DieterGraef 0:d26c1b55cfca 1823 *(int*)optval = (int)sock->conn->pcb.tcp->keep_idle;
DieterGraef 0:d26c1b55cfca 1824 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, TCP_KEEPALIVE) = %d\n",
DieterGraef 0:d26c1b55cfca 1825 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1826 break;
DieterGraef 0:d26c1b55cfca 1827
DieterGraef 0:d26c1b55cfca 1828 #if LWIP_TCP_KEEPALIVE
DieterGraef 0:d26c1b55cfca 1829 case TCP_KEEPIDLE:
DieterGraef 0:d26c1b55cfca 1830 *(int*)optval = (int)(sock->conn->pcb.tcp->keep_idle/1000);
DieterGraef 0:d26c1b55cfca 1831 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, TCP_KEEPIDLE) = %d\n",
DieterGraef 0:d26c1b55cfca 1832 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1833 break;
DieterGraef 0:d26c1b55cfca 1834 case TCP_KEEPINTVL:
DieterGraef 0:d26c1b55cfca 1835 *(int*)optval = (int)(sock->conn->pcb.tcp->keep_intvl/1000);
DieterGraef 0:d26c1b55cfca 1836 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, TCP_KEEPINTVL) = %d\n",
DieterGraef 0:d26c1b55cfca 1837 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1838 break;
DieterGraef 0:d26c1b55cfca 1839 case TCP_KEEPCNT:
DieterGraef 0:d26c1b55cfca 1840 *(int*)optval = (int)sock->conn->pcb.tcp->keep_cnt;
DieterGraef 0:d26c1b55cfca 1841 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_IP, TCP_KEEPCNT) = %d\n",
DieterGraef 0:d26c1b55cfca 1842 s, *(int *)optval));
DieterGraef 0:d26c1b55cfca 1843 break;
DieterGraef 0:d26c1b55cfca 1844 #endif /* LWIP_TCP_KEEPALIVE */
DieterGraef 0:d26c1b55cfca 1845 default:
DieterGraef 0:d26c1b55cfca 1846 LWIP_ASSERT("unhandled optname", 0);
DieterGraef 0:d26c1b55cfca 1847 break;
DieterGraef 0:d26c1b55cfca 1848 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1849 break;
DieterGraef 0:d26c1b55cfca 1850 #endif /* LWIP_TCP */
DieterGraef 0:d26c1b55cfca 1851 #if LWIP_UDP && LWIP_UDPLITE
DieterGraef 0:d26c1b55cfca 1852 /* Level: IPPROTO_UDPLITE */
DieterGraef 0:d26c1b55cfca 1853 case IPPROTO_UDPLITE:
DieterGraef 0:d26c1b55cfca 1854 switch (optname) {
DieterGraef 0:d26c1b55cfca 1855 case UDPLITE_SEND_CSCOV:
DieterGraef 0:d26c1b55cfca 1856 *(int*)optval = sock->conn->pcb.udp->chksum_len_tx;
DieterGraef 0:d26c1b55cfca 1857 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_UDPLITE, UDPLITE_SEND_CSCOV) = %d\n",
DieterGraef 0:d26c1b55cfca 1858 s, (*(int*)optval)) );
DieterGraef 0:d26c1b55cfca 1859 break;
DieterGraef 0:d26c1b55cfca 1860 case UDPLITE_RECV_CSCOV:
DieterGraef 0:d26c1b55cfca 1861 *(int*)optval = sock->conn->pcb.udp->chksum_len_rx;
DieterGraef 0:d26c1b55cfca 1862 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_getsockopt(%d, IPPROTO_UDPLITE, UDPLITE_RECV_CSCOV) = %d\n",
DieterGraef 0:d26c1b55cfca 1863 s, (*(int*)optval)) );
DieterGraef 0:d26c1b55cfca 1864 break;
DieterGraef 0:d26c1b55cfca 1865 default:
DieterGraef 0:d26c1b55cfca 1866 LWIP_ASSERT("unhandled optname", 0);
DieterGraef 0:d26c1b55cfca 1867 break;
DieterGraef 0:d26c1b55cfca 1868 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1869 break;
DieterGraef 0:d26c1b55cfca 1870 #endif /* LWIP_UDP */
DieterGraef 0:d26c1b55cfca 1871 default:
DieterGraef 0:d26c1b55cfca 1872 LWIP_ASSERT("unhandled level", 0);
DieterGraef 0:d26c1b55cfca 1873 break;
DieterGraef 0:d26c1b55cfca 1874 } /* switch (level) */
DieterGraef 0:d26c1b55cfca 1875 sys_sem_signal(&sock->conn->op_completed);
DieterGraef 0:d26c1b55cfca 1876 }
DieterGraef 0:d26c1b55cfca 1877
DieterGraef 0:d26c1b55cfca 1878 int
DieterGraef 0:d26c1b55cfca 1879 lwip_setsockopt(int s, int level, int optname, const void *optval, socklen_t optlen)
DieterGraef 0:d26c1b55cfca 1880 {
DieterGraef 0:d26c1b55cfca 1881 struct lwip_sock *sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 1882 err_t err = ERR_OK;
DieterGraef 0:d26c1b55cfca 1883 struct lwip_setgetsockopt_data data;
DieterGraef 0:d26c1b55cfca 1884
DieterGraef 0:d26c1b55cfca 1885 if (!sock) {
DieterGraef 0:d26c1b55cfca 1886 return -1;
DieterGraef 0:d26c1b55cfca 1887 }
DieterGraef 0:d26c1b55cfca 1888
DieterGraef 0:d26c1b55cfca 1889 if (NULL == optval) {
DieterGraef 0:d26c1b55cfca 1890 sock_set_errno(sock, EFAULT);
DieterGraef 0:d26c1b55cfca 1891 return -1;
DieterGraef 0:d26c1b55cfca 1892 }
DieterGraef 0:d26c1b55cfca 1893
DieterGraef 0:d26c1b55cfca 1894 /* Do length and type checks for the various options first, to keep it readable. */
DieterGraef 0:d26c1b55cfca 1895 switch (level) {
DieterGraef 0:d26c1b55cfca 1896
DieterGraef 0:d26c1b55cfca 1897 /* Level: SOL_SOCKET */
DieterGraef 0:d26c1b55cfca 1898 case SOL_SOCKET:
DieterGraef 0:d26c1b55cfca 1899 switch (optname) {
DieterGraef 0:d26c1b55cfca 1900
DieterGraef 0:d26c1b55cfca 1901 case SO_BROADCAST:
DieterGraef 0:d26c1b55cfca 1902 /* UNIMPL case SO_DEBUG: */
DieterGraef 0:d26c1b55cfca 1903 /* UNIMPL case SO_DONTROUTE: */
DieterGraef 0:d26c1b55cfca 1904 case SO_KEEPALIVE:
DieterGraef 0:d26c1b55cfca 1905 /* UNIMPL case case SO_CONTIMEO: */
DieterGraef 0:d26c1b55cfca 1906 #if LWIP_SO_SNDTIMEO
DieterGraef 0:d26c1b55cfca 1907 case SO_SNDTIMEO:
DieterGraef 0:d26c1b55cfca 1908 #endif /* LWIP_SO_SNDTIMEO */
DieterGraef 0:d26c1b55cfca 1909 #if LWIP_SO_RCVTIMEO
DieterGraef 0:d26c1b55cfca 1910 case SO_RCVTIMEO:
DieterGraef 0:d26c1b55cfca 1911 #endif /* LWIP_SO_RCVTIMEO */
DieterGraef 0:d26c1b55cfca 1912 #if LWIP_SO_RCVBUF
DieterGraef 0:d26c1b55cfca 1913 case SO_RCVBUF:
DieterGraef 0:d26c1b55cfca 1914 #endif /* LWIP_SO_RCVBUF */
DieterGraef 0:d26c1b55cfca 1915 /* UNIMPL case SO_OOBINLINE: */
DieterGraef 0:d26c1b55cfca 1916 /* UNIMPL case SO_SNDBUF: */
DieterGraef 0:d26c1b55cfca 1917 /* UNIMPL case SO_RCVLOWAT: */
DieterGraef 0:d26c1b55cfca 1918 /* UNIMPL case SO_SNDLOWAT: */
DieterGraef 0:d26c1b55cfca 1919 #if SO_REUSE
DieterGraef 0:d26c1b55cfca 1920 case SO_REUSEADDR:
DieterGraef 0:d26c1b55cfca 1921 case SO_REUSEPORT:
DieterGraef 0:d26c1b55cfca 1922 #endif /* SO_REUSE */
DieterGraef 0:d26c1b55cfca 1923 /* UNIMPL case SO_USELOOPBACK: */
DieterGraef 0:d26c1b55cfca 1924 if (optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 1925 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1926 }
DieterGraef 0:d26c1b55cfca 1927 break;
DieterGraef 0:d26c1b55cfca 1928 case SO_NO_CHECK:
DieterGraef 0:d26c1b55cfca 1929 if (optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 1930 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1931 }
DieterGraef 0:d26c1b55cfca 1932 #if LWIP_UDP
DieterGraef 0:d26c1b55cfca 1933 if ((sock->conn->type != NETCONN_UDP) ||
DieterGraef 0:d26c1b55cfca 1934 ((udp_flags(sock->conn->pcb.udp) & UDP_FLAGS_UDPLITE) != 0)) {
DieterGraef 0:d26c1b55cfca 1935 /* this flag is only available for UDP, not for UDP lite */
DieterGraef 0:d26c1b55cfca 1936 err = EAFNOSUPPORT;
DieterGraef 0:d26c1b55cfca 1937 }
DieterGraef 0:d26c1b55cfca 1938 #endif /* LWIP_UDP */
DieterGraef 0:d26c1b55cfca 1939 break;
DieterGraef 0:d26c1b55cfca 1940 default:
DieterGraef 0:d26c1b55cfca 1941 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, SOL_SOCKET, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 1942 s, optname));
DieterGraef 0:d26c1b55cfca 1943 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 1944 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1945 break;
DieterGraef 0:d26c1b55cfca 1946
DieterGraef 0:d26c1b55cfca 1947 /* Level: IPPROTO_IP */
DieterGraef 0:d26c1b55cfca 1948 case IPPROTO_IP:
DieterGraef 0:d26c1b55cfca 1949 switch (optname) {
DieterGraef 0:d26c1b55cfca 1950 /* UNIMPL case IP_HDRINCL: */
DieterGraef 0:d26c1b55cfca 1951 /* UNIMPL case IP_RCVDSTADDR: */
DieterGraef 0:d26c1b55cfca 1952 /* UNIMPL case IP_RCVIF: */
DieterGraef 0:d26c1b55cfca 1953 case IP_TTL:
DieterGraef 0:d26c1b55cfca 1954 case IP_TOS:
DieterGraef 0:d26c1b55cfca 1955 if (optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 1956 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1957 }
DieterGraef 0:d26c1b55cfca 1958 break;
DieterGraef 0:d26c1b55cfca 1959 #if LWIP_IGMP
DieterGraef 0:d26c1b55cfca 1960 case IP_MULTICAST_TTL:
DieterGraef 0:d26c1b55cfca 1961 if (optlen < sizeof(u8_t)) {
DieterGraef 0:d26c1b55cfca 1962 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1963 }
DieterGraef 0:d26c1b55cfca 1964 if (NETCONNTYPE_GROUP(sock->conn->type) != NETCONN_UDP) {
DieterGraef 0:d26c1b55cfca 1965 err = EAFNOSUPPORT;
DieterGraef 0:d26c1b55cfca 1966 }
DieterGraef 0:d26c1b55cfca 1967 break;
DieterGraef 0:d26c1b55cfca 1968 case IP_MULTICAST_IF:
DieterGraef 0:d26c1b55cfca 1969 if (optlen < sizeof(struct in_addr)) {
DieterGraef 0:d26c1b55cfca 1970 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1971 }
DieterGraef 0:d26c1b55cfca 1972 if (NETCONNTYPE_GROUP(sock->conn->type) != NETCONN_UDP) {
DieterGraef 0:d26c1b55cfca 1973 err = EAFNOSUPPORT;
DieterGraef 0:d26c1b55cfca 1974 }
DieterGraef 0:d26c1b55cfca 1975 break;
DieterGraef 0:d26c1b55cfca 1976 case IP_MULTICAST_LOOP:
DieterGraef 0:d26c1b55cfca 1977 if (optlen < sizeof(u8_t)) {
DieterGraef 0:d26c1b55cfca 1978 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1979 }
DieterGraef 0:d26c1b55cfca 1980 if (NETCONNTYPE_GROUP(sock->conn->type) != NETCONN_UDP) {
DieterGraef 0:d26c1b55cfca 1981 err = EAFNOSUPPORT;
DieterGraef 0:d26c1b55cfca 1982 }
DieterGraef 0:d26c1b55cfca 1983 break;
DieterGraef 0:d26c1b55cfca 1984 case IP_ADD_MEMBERSHIP:
DieterGraef 0:d26c1b55cfca 1985 case IP_DROP_MEMBERSHIP:
DieterGraef 0:d26c1b55cfca 1986 if (optlen < sizeof(struct ip_mreq)) {
DieterGraef 0:d26c1b55cfca 1987 err = EINVAL;
DieterGraef 0:d26c1b55cfca 1988 }
DieterGraef 0:d26c1b55cfca 1989 if (NETCONNTYPE_GROUP(sock->conn->type) != NETCONN_UDP) {
DieterGraef 0:d26c1b55cfca 1990 err = EAFNOSUPPORT;
DieterGraef 0:d26c1b55cfca 1991 }
DieterGraef 0:d26c1b55cfca 1992 break;
DieterGraef 0:d26c1b55cfca 1993 #endif /* LWIP_IGMP */
DieterGraef 0:d26c1b55cfca 1994 default:
DieterGraef 0:d26c1b55cfca 1995 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_IP, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 1996 s, optname));
DieterGraef 0:d26c1b55cfca 1997 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 1998 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 1999 break;
DieterGraef 0:d26c1b55cfca 2000
DieterGraef 0:d26c1b55cfca 2001 #if LWIP_TCP
DieterGraef 0:d26c1b55cfca 2002 /* Level: IPPROTO_TCP */
DieterGraef 0:d26c1b55cfca 2003 case IPPROTO_TCP:
DieterGraef 0:d26c1b55cfca 2004 if (optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 2005 err = EINVAL;
DieterGraef 0:d26c1b55cfca 2006 break;
DieterGraef 0:d26c1b55cfca 2007 }
DieterGraef 0:d26c1b55cfca 2008
DieterGraef 0:d26c1b55cfca 2009 /* If this is no TCP socket, ignore any options. */
DieterGraef 0:d26c1b55cfca 2010 if (sock->conn->type != NETCONN_TCP)
DieterGraef 0:d26c1b55cfca 2011 return 0;
DieterGraef 0:d26c1b55cfca 2012
DieterGraef 0:d26c1b55cfca 2013 switch (optname) {
DieterGraef 0:d26c1b55cfca 2014 case TCP_NODELAY:
DieterGraef 0:d26c1b55cfca 2015 case TCP_KEEPALIVE:
DieterGraef 0:d26c1b55cfca 2016 #if LWIP_TCP_KEEPALIVE
DieterGraef 0:d26c1b55cfca 2017 case TCP_KEEPIDLE:
DieterGraef 0:d26c1b55cfca 2018 case TCP_KEEPINTVL:
DieterGraef 0:d26c1b55cfca 2019 case TCP_KEEPCNT:
DieterGraef 0:d26c1b55cfca 2020 #endif /* LWIP_TCP_KEEPALIVE */
DieterGraef 0:d26c1b55cfca 2021 break;
DieterGraef 0:d26c1b55cfca 2022
DieterGraef 0:d26c1b55cfca 2023 default:
DieterGraef 0:d26c1b55cfca 2024 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_TCP, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 2025 s, optname));
DieterGraef 0:d26c1b55cfca 2026 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 2027 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 2028 break;
DieterGraef 0:d26c1b55cfca 2029 #endif /* LWIP_TCP */
DieterGraef 0:d26c1b55cfca 2030 #if LWIP_UDP && LWIP_UDPLITE
DieterGraef 0:d26c1b55cfca 2031 /* Level: IPPROTO_UDPLITE */
DieterGraef 0:d26c1b55cfca 2032 case IPPROTO_UDPLITE:
DieterGraef 0:d26c1b55cfca 2033 if (optlen < sizeof(int)) {
DieterGraef 0:d26c1b55cfca 2034 err = EINVAL;
DieterGraef 0:d26c1b55cfca 2035 break;
DieterGraef 0:d26c1b55cfca 2036 }
DieterGraef 0:d26c1b55cfca 2037
DieterGraef 0:d26c1b55cfca 2038 /* If this is no UDP lite socket, ignore any options. */
DieterGraef 0:d26c1b55cfca 2039 if (sock->conn->type != NETCONN_UDPLITE)
DieterGraef 0:d26c1b55cfca 2040 return 0;
DieterGraef 0:d26c1b55cfca 2041
DieterGraef 0:d26c1b55cfca 2042 switch (optname) {
DieterGraef 0:d26c1b55cfca 2043 case UDPLITE_SEND_CSCOV:
DieterGraef 0:d26c1b55cfca 2044 case UDPLITE_RECV_CSCOV:
DieterGraef 0:d26c1b55cfca 2045 break;
DieterGraef 0:d26c1b55cfca 2046
DieterGraef 0:d26c1b55cfca 2047 default:
DieterGraef 0:d26c1b55cfca 2048 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_UDPLITE, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 2049 s, optname));
DieterGraef 0:d26c1b55cfca 2050 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 2051 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 2052 break;
DieterGraef 0:d26c1b55cfca 2053 #endif /* LWIP_UDP && LWIP_UDPLITE */
DieterGraef 0:d26c1b55cfca 2054 /* UNDEFINED LEVEL */
DieterGraef 0:d26c1b55cfca 2055 default:
DieterGraef 0:d26c1b55cfca 2056 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, level=0x%x, UNIMPL: optname=0x%x, ..)\n",
DieterGraef 0:d26c1b55cfca 2057 s, level, optname));
DieterGraef 0:d26c1b55cfca 2058 err = ENOPROTOOPT;
DieterGraef 0:d26c1b55cfca 2059 } /* switch (level) */
DieterGraef 0:d26c1b55cfca 2060
DieterGraef 0:d26c1b55cfca 2061
DieterGraef 0:d26c1b55cfca 2062 if (err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 2063 sock_set_errno(sock, err);
DieterGraef 0:d26c1b55cfca 2064 return -1;
DieterGraef 0:d26c1b55cfca 2065 }
DieterGraef 0:d26c1b55cfca 2066
DieterGraef 0:d26c1b55cfca 2067
DieterGraef 0:d26c1b55cfca 2068 /* Now do the actual option processing */
DieterGraef 0:d26c1b55cfca 2069 data.sock = sock;
DieterGraef 0:d26c1b55cfca 2070 #ifdef LWIP_DEBUG
DieterGraef 0:d26c1b55cfca 2071 data.s = s;
DieterGraef 0:d26c1b55cfca 2072 #endif /* LWIP_DEBUG */
DieterGraef 0:d26c1b55cfca 2073 data.level = level;
DieterGraef 0:d26c1b55cfca 2074 data.optname = optname;
DieterGraef 0:d26c1b55cfca 2075 data.optval = (void*)optval;
DieterGraef 0:d26c1b55cfca 2076 data.optlen = &optlen;
DieterGraef 0:d26c1b55cfca 2077 data.err = err;
DieterGraef 0:d26c1b55cfca 2078 tcpip_callback(lwip_setsockopt_internal, &data);
DieterGraef 0:d26c1b55cfca 2079 sys_arch_sem_wait(&sock->conn->op_completed, 0);
DieterGraef 0:d26c1b55cfca 2080 /* maybe lwip_setsockopt_internal has changed err */
DieterGraef 0:d26c1b55cfca 2081 err = data.err;
DieterGraef 0:d26c1b55cfca 2082
DieterGraef 0:d26c1b55cfca 2083 sock_set_errno(sock, err);
DieterGraef 0:d26c1b55cfca 2084 return err ? -1 : 0;
DieterGraef 0:d26c1b55cfca 2085 }
DieterGraef 0:d26c1b55cfca 2086
DieterGraef 0:d26c1b55cfca 2087 static void
DieterGraef 0:d26c1b55cfca 2088 lwip_setsockopt_internal(void *arg)
DieterGraef 0:d26c1b55cfca 2089 {
DieterGraef 0:d26c1b55cfca 2090 struct lwip_sock *sock;
DieterGraef 0:d26c1b55cfca 2091 #ifdef LWIP_DEBUG
DieterGraef 0:d26c1b55cfca 2092 int s;
DieterGraef 0:d26c1b55cfca 2093 #endif /* LWIP_DEBUG */
DieterGraef 0:d26c1b55cfca 2094 int level, optname;
DieterGraef 0:d26c1b55cfca 2095 const void *optval;
DieterGraef 0:d26c1b55cfca 2096 struct lwip_setgetsockopt_data *data;
DieterGraef 0:d26c1b55cfca 2097
DieterGraef 0:d26c1b55cfca 2098 LWIP_ASSERT("arg != NULL", arg != NULL);
DieterGraef 0:d26c1b55cfca 2099
DieterGraef 0:d26c1b55cfca 2100 data = (struct lwip_setgetsockopt_data*)arg;
DieterGraef 0:d26c1b55cfca 2101 sock = data->sock;
DieterGraef 0:d26c1b55cfca 2102 #ifdef LWIP_DEBUG
DieterGraef 0:d26c1b55cfca 2103 s = data->s;
DieterGraef 0:d26c1b55cfca 2104 #endif /* LWIP_DEBUG */
DieterGraef 0:d26c1b55cfca 2105 level = data->level;
DieterGraef 0:d26c1b55cfca 2106 optname = data->optname;
DieterGraef 0:d26c1b55cfca 2107 optval = data->optval;
DieterGraef 0:d26c1b55cfca 2108
DieterGraef 0:d26c1b55cfca 2109 switch (level) {
DieterGraef 0:d26c1b55cfca 2110
DieterGraef 0:d26c1b55cfca 2111 /* Level: SOL_SOCKET */
DieterGraef 0:d26c1b55cfca 2112 case SOL_SOCKET:
DieterGraef 0:d26c1b55cfca 2113 switch (optname) {
DieterGraef 0:d26c1b55cfca 2114
DieterGraef 0:d26c1b55cfca 2115 /* The option flags */
DieterGraef 0:d26c1b55cfca 2116 case SO_BROADCAST:
DieterGraef 0:d26c1b55cfca 2117 /* UNIMPL case SO_DEBUG: */
DieterGraef 0:d26c1b55cfca 2118 /* UNIMPL case SO_DONTROUTE: */
DieterGraef 0:d26c1b55cfca 2119 case SO_KEEPALIVE:
DieterGraef 0:d26c1b55cfca 2120 /* UNIMPL case SO_OOBINCLUDE: */
DieterGraef 0:d26c1b55cfca 2121 #if SO_REUSE
DieterGraef 0:d26c1b55cfca 2122 case SO_REUSEADDR:
DieterGraef 0:d26c1b55cfca 2123 case SO_REUSEPORT:
DieterGraef 0:d26c1b55cfca 2124 #endif /* SO_REUSE */
DieterGraef 0:d26c1b55cfca 2125 /* UNIMPL case SO_USELOOPBACK: */
DieterGraef 0:d26c1b55cfca 2126 if (*(int*)optval) {
DieterGraef 0:d26c1b55cfca 2127 ip_set_option(sock->conn->pcb.ip, optname);
DieterGraef 0:d26c1b55cfca 2128 } else {
DieterGraef 0:d26c1b55cfca 2129 ip_reset_option(sock->conn->pcb.ip, optname);
DieterGraef 0:d26c1b55cfca 2130 }
DieterGraef 0:d26c1b55cfca 2131 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, SOL_SOCKET, optname=0x%x, ..) -> %s\n",
DieterGraef 0:d26c1b55cfca 2132 s, optname, (*(int*)optval?"on":"off")));
DieterGraef 0:d26c1b55cfca 2133 break;
DieterGraef 0:d26c1b55cfca 2134 #if LWIP_SO_SNDTIMEO
DieterGraef 0:d26c1b55cfca 2135 case SO_SNDTIMEO:
DieterGraef 0:d26c1b55cfca 2136 netconn_set_sendtimeout(sock->conn, (s32_t)*(int*)optval);
DieterGraef 0:d26c1b55cfca 2137 break;
DieterGraef 0:d26c1b55cfca 2138 #endif /* LWIP_SO_SNDTIMEO */
DieterGraef 0:d26c1b55cfca 2139 #if LWIP_SO_RCVTIMEO
DieterGraef 0:d26c1b55cfca 2140 case SO_RCVTIMEO:
DieterGraef 0:d26c1b55cfca 2141 netconn_set_recvtimeout(sock->conn, *(int*)optval);
DieterGraef 0:d26c1b55cfca 2142 break;
DieterGraef 0:d26c1b55cfca 2143 #endif /* LWIP_SO_RCVTIMEO */
DieterGraef 0:d26c1b55cfca 2144 #if LWIP_SO_RCVBUF
DieterGraef 0:d26c1b55cfca 2145 case SO_RCVBUF:
DieterGraef 0:d26c1b55cfca 2146 netconn_set_recvbufsize(sock->conn, *(int*)optval);
DieterGraef 0:d26c1b55cfca 2147 break;
DieterGraef 0:d26c1b55cfca 2148 #endif /* LWIP_SO_RCVBUF */
DieterGraef 0:d26c1b55cfca 2149 #if LWIP_UDP
DieterGraef 0:d26c1b55cfca 2150 case SO_NO_CHECK:
DieterGraef 0:d26c1b55cfca 2151 if (*(int*)optval) {
DieterGraef 0:d26c1b55cfca 2152 udp_setflags(sock->conn->pcb.udp, udp_flags(sock->conn->pcb.udp) | UDP_FLAGS_NOCHKSUM);
DieterGraef 0:d26c1b55cfca 2153 } else {
DieterGraef 0:d26c1b55cfca 2154 udp_setflags(sock->conn->pcb.udp, udp_flags(sock->conn->pcb.udp) & ~UDP_FLAGS_NOCHKSUM);
DieterGraef 0:d26c1b55cfca 2155 }
DieterGraef 0:d26c1b55cfca 2156 break;
DieterGraef 0:d26c1b55cfca 2157 #endif /* LWIP_UDP */
DieterGraef 0:d26c1b55cfca 2158 default:
DieterGraef 0:d26c1b55cfca 2159 LWIP_ASSERT("unhandled optname", 0);
DieterGraef 0:d26c1b55cfca 2160 break;
DieterGraef 0:d26c1b55cfca 2161 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 2162 break;
DieterGraef 0:d26c1b55cfca 2163
DieterGraef 0:d26c1b55cfca 2164 /* Level: IPPROTO_IP */
DieterGraef 0:d26c1b55cfca 2165 case IPPROTO_IP:
DieterGraef 0:d26c1b55cfca 2166 switch (optname) {
DieterGraef 0:d26c1b55cfca 2167 case IP_TTL:
DieterGraef 0:d26c1b55cfca 2168 sock->conn->pcb.ip->ttl = (u8_t)(*(int*)optval);
DieterGraef 0:d26c1b55cfca 2169 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_IP, IP_TTL, ..) -> %d\n",
DieterGraef 0:d26c1b55cfca 2170 s, sock->conn->pcb.ip->ttl));
DieterGraef 0:d26c1b55cfca 2171 break;
DieterGraef 0:d26c1b55cfca 2172 case IP_TOS:
DieterGraef 0:d26c1b55cfca 2173 sock->conn->pcb.ip->tos = (u8_t)(*(int*)optval);
DieterGraef 0:d26c1b55cfca 2174 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_IP, IP_TOS, ..)-> %d\n",
DieterGraef 0:d26c1b55cfca 2175 s, sock->conn->pcb.ip->tos));
DieterGraef 0:d26c1b55cfca 2176 break;
DieterGraef 0:d26c1b55cfca 2177 #if LWIP_IGMP
DieterGraef 0:d26c1b55cfca 2178 case IP_MULTICAST_TTL:
DieterGraef 0:d26c1b55cfca 2179 sock->conn->pcb.udp->ttl = (u8_t)(*(u8_t*)optval);
DieterGraef 0:d26c1b55cfca 2180 break;
DieterGraef 0:d26c1b55cfca 2181 case IP_MULTICAST_IF:
DieterGraef 0:d26c1b55cfca 2182 inet_addr_to_ipaddr(&sock->conn->pcb.udp->multicast_ip, (struct in_addr*)optval);
DieterGraef 0:d26c1b55cfca 2183 break;
DieterGraef 0:d26c1b55cfca 2184 case IP_MULTICAST_LOOP:
DieterGraef 0:d26c1b55cfca 2185 if (*(u8_t*)optval) {
DieterGraef 0:d26c1b55cfca 2186 udp_setflags(sock->conn->pcb.udp, udp_flags(sock->conn->pcb.udp) | UDP_FLAGS_MULTICAST_LOOP);
DieterGraef 0:d26c1b55cfca 2187 } else {
DieterGraef 0:d26c1b55cfca 2188 udp_setflags(sock->conn->pcb.udp, udp_flags(sock->conn->pcb.udp) & ~UDP_FLAGS_MULTICAST_LOOP);
DieterGraef 0:d26c1b55cfca 2189 }
DieterGraef 0:d26c1b55cfca 2190 break;
DieterGraef 0:d26c1b55cfca 2191 case IP_ADD_MEMBERSHIP:
DieterGraef 0:d26c1b55cfca 2192 case IP_DROP_MEMBERSHIP:
DieterGraef 0:d26c1b55cfca 2193 {
DieterGraef 0:d26c1b55cfca 2194 /* If this is a TCP or a RAW socket, ignore these options. */
DieterGraef 0:d26c1b55cfca 2195 struct ip_mreq *imr = (struct ip_mreq *)optval;
DieterGraef 0:d26c1b55cfca 2196 ip_addr_t if_addr;
DieterGraef 0:d26c1b55cfca 2197 ip_addr_t multi_addr;
DieterGraef 0:d26c1b55cfca 2198 inet_addr_to_ipaddr(&if_addr, &imr->imr_interface);
DieterGraef 0:d26c1b55cfca 2199 inet_addr_to_ipaddr(&multi_addr, &imr->imr_multiaddr);
DieterGraef 0:d26c1b55cfca 2200 if(optname == IP_ADD_MEMBERSHIP){
DieterGraef 0:d26c1b55cfca 2201 data->err = igmp_joingroup(&if_addr, &multi_addr);
DieterGraef 0:d26c1b55cfca 2202 } else {
DieterGraef 0:d26c1b55cfca 2203 data->err = igmp_leavegroup(&if_addr, &multi_addr);
DieterGraef 0:d26c1b55cfca 2204 }
DieterGraef 0:d26c1b55cfca 2205 if(data->err != ERR_OK) {
DieterGraef 0:d26c1b55cfca 2206 data->err = EADDRNOTAVAIL;
DieterGraef 0:d26c1b55cfca 2207 }
DieterGraef 0:d26c1b55cfca 2208 }
DieterGraef 0:d26c1b55cfca 2209 break;
DieterGraef 0:d26c1b55cfca 2210 #endif /* LWIP_IGMP */
DieterGraef 0:d26c1b55cfca 2211 default:
DieterGraef 0:d26c1b55cfca 2212 LWIP_ASSERT("unhandled optname", 0);
DieterGraef 0:d26c1b55cfca 2213 break;
DieterGraef 0:d26c1b55cfca 2214 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 2215 break;
DieterGraef 0:d26c1b55cfca 2216
DieterGraef 0:d26c1b55cfca 2217 #if LWIP_TCP
DieterGraef 0:d26c1b55cfca 2218 /* Level: IPPROTO_TCP */
DieterGraef 0:d26c1b55cfca 2219 case IPPROTO_TCP:
DieterGraef 0:d26c1b55cfca 2220 switch (optname) {
DieterGraef 0:d26c1b55cfca 2221 case TCP_NODELAY:
DieterGraef 0:d26c1b55cfca 2222 if (*(int*)optval) {
DieterGraef 0:d26c1b55cfca 2223 tcp_nagle_disable(sock->conn->pcb.tcp);
DieterGraef 0:d26c1b55cfca 2224 } else {
DieterGraef 0:d26c1b55cfca 2225 tcp_nagle_enable(sock->conn->pcb.tcp);
DieterGraef 0:d26c1b55cfca 2226 }
DieterGraef 0:d26c1b55cfca 2227 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_TCP, TCP_NODELAY) -> %s\n",
DieterGraef 0:d26c1b55cfca 2228 s, (*(int *)optval)?"on":"off") );
DieterGraef 0:d26c1b55cfca 2229 break;
DieterGraef 0:d26c1b55cfca 2230 case TCP_KEEPALIVE:
DieterGraef 0:d26c1b55cfca 2231 sock->conn->pcb.tcp->keep_idle = (u32_t)(*(int*)optval);
DieterGraef 0:d26c1b55cfca 2232 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_TCP, TCP_KEEPALIVE) -> %"U32_F"\n",
DieterGraef 0:d26c1b55cfca 2233 s, sock->conn->pcb.tcp->keep_idle));
DieterGraef 0:d26c1b55cfca 2234 break;
DieterGraef 0:d26c1b55cfca 2235
DieterGraef 0:d26c1b55cfca 2236 #if LWIP_TCP_KEEPALIVE
DieterGraef 0:d26c1b55cfca 2237 case TCP_KEEPIDLE:
DieterGraef 0:d26c1b55cfca 2238 sock->conn->pcb.tcp->keep_idle = 1000*(u32_t)(*(int*)optval);
DieterGraef 0:d26c1b55cfca 2239 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_TCP, TCP_KEEPIDLE) -> %"U32_F"\n",
DieterGraef 0:d26c1b55cfca 2240 s, sock->conn->pcb.tcp->keep_idle));
DieterGraef 0:d26c1b55cfca 2241 break;
DieterGraef 0:d26c1b55cfca 2242 case TCP_KEEPINTVL:
DieterGraef 0:d26c1b55cfca 2243 sock->conn->pcb.tcp->keep_intvl = 1000*(u32_t)(*(int*)optval);
DieterGraef 0:d26c1b55cfca 2244 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_TCP, TCP_KEEPINTVL) -> %"U32_F"\n",
DieterGraef 0:d26c1b55cfca 2245 s, sock->conn->pcb.tcp->keep_intvl));
DieterGraef 0:d26c1b55cfca 2246 break;
DieterGraef 0:d26c1b55cfca 2247 case TCP_KEEPCNT:
DieterGraef 0:d26c1b55cfca 2248 sock->conn->pcb.tcp->keep_cnt = (u32_t)(*(int*)optval);
DieterGraef 0:d26c1b55cfca 2249 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_TCP, TCP_KEEPCNT) -> %"U32_F"\n",
DieterGraef 0:d26c1b55cfca 2250 s, sock->conn->pcb.tcp->keep_cnt));
DieterGraef 0:d26c1b55cfca 2251 break;
DieterGraef 0:d26c1b55cfca 2252 #endif /* LWIP_TCP_KEEPALIVE */
DieterGraef 0:d26c1b55cfca 2253 default:
DieterGraef 0:d26c1b55cfca 2254 LWIP_ASSERT("unhandled optname", 0);
DieterGraef 0:d26c1b55cfca 2255 break;
DieterGraef 0:d26c1b55cfca 2256 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 2257 break;
DieterGraef 0:d26c1b55cfca 2258 #endif /* LWIP_TCP*/
DieterGraef 0:d26c1b55cfca 2259 #if LWIP_UDP && LWIP_UDPLITE
DieterGraef 0:d26c1b55cfca 2260 /* Level: IPPROTO_UDPLITE */
DieterGraef 0:d26c1b55cfca 2261 case IPPROTO_UDPLITE:
DieterGraef 0:d26c1b55cfca 2262 switch (optname) {
DieterGraef 0:d26c1b55cfca 2263 case UDPLITE_SEND_CSCOV:
DieterGraef 0:d26c1b55cfca 2264 if ((*(int*)optval != 0) && ((*(int*)optval < 8) || (*(int*)optval > 0xffff))) {
DieterGraef 0:d26c1b55cfca 2265 /* don't allow illegal values! */
DieterGraef 0:d26c1b55cfca 2266 sock->conn->pcb.udp->chksum_len_tx = 8;
DieterGraef 0:d26c1b55cfca 2267 } else {
DieterGraef 0:d26c1b55cfca 2268 sock->conn->pcb.udp->chksum_len_tx = (u16_t)*(int*)optval;
DieterGraef 0:d26c1b55cfca 2269 }
DieterGraef 0:d26c1b55cfca 2270 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_UDPLITE, UDPLITE_SEND_CSCOV) -> %d\n",
DieterGraef 0:d26c1b55cfca 2271 s, (*(int*)optval)) );
DieterGraef 0:d26c1b55cfca 2272 break;
DieterGraef 0:d26c1b55cfca 2273 case UDPLITE_RECV_CSCOV:
DieterGraef 0:d26c1b55cfca 2274 if ((*(int*)optval != 0) && ((*(int*)optval < 8) || (*(int*)optval > 0xffff))) {
DieterGraef 0:d26c1b55cfca 2275 /* don't allow illegal values! */
DieterGraef 0:d26c1b55cfca 2276 sock->conn->pcb.udp->chksum_len_rx = 8;
DieterGraef 0:d26c1b55cfca 2277 } else {
DieterGraef 0:d26c1b55cfca 2278 sock->conn->pcb.udp->chksum_len_rx = (u16_t)*(int*)optval;
DieterGraef 0:d26c1b55cfca 2279 }
DieterGraef 0:d26c1b55cfca 2280 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_setsockopt(%d, IPPROTO_UDPLITE, UDPLITE_RECV_CSCOV) -> %d\n",
DieterGraef 0:d26c1b55cfca 2281 s, (*(int*)optval)) );
DieterGraef 0:d26c1b55cfca 2282 break;
DieterGraef 0:d26c1b55cfca 2283 default:
DieterGraef 0:d26c1b55cfca 2284 LWIP_ASSERT("unhandled optname", 0);
DieterGraef 0:d26c1b55cfca 2285 break;
DieterGraef 0:d26c1b55cfca 2286 } /* switch (optname) */
DieterGraef 0:d26c1b55cfca 2287 break;
DieterGraef 0:d26c1b55cfca 2288 #endif /* LWIP_UDP */
DieterGraef 0:d26c1b55cfca 2289 default:
DieterGraef 0:d26c1b55cfca 2290 LWIP_ASSERT("unhandled level", 0);
DieterGraef 0:d26c1b55cfca 2291 break;
DieterGraef 0:d26c1b55cfca 2292 } /* switch (level) */
DieterGraef 0:d26c1b55cfca 2293 sys_sem_signal(&sock->conn->op_completed);
DieterGraef 0:d26c1b55cfca 2294 }
DieterGraef 0:d26c1b55cfca 2295
DieterGraef 0:d26c1b55cfca 2296 int
DieterGraef 0:d26c1b55cfca 2297 lwip_ioctl(int s, long cmd, void *argp)
DieterGraef 0:d26c1b55cfca 2298 {
DieterGraef 0:d26c1b55cfca 2299 struct lwip_sock *sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 2300 u8_t val;
DieterGraef 0:d26c1b55cfca 2301 #if LWIP_SO_RCVBUF
DieterGraef 0:d26c1b55cfca 2302 u16_t buflen = 0;
DieterGraef 0:d26c1b55cfca 2303 s16_t recv_avail;
DieterGraef 0:d26c1b55cfca 2304 #endif /* LWIP_SO_RCVBUF */
DieterGraef 0:d26c1b55cfca 2305
DieterGraef 0:d26c1b55cfca 2306 if (!sock) {
DieterGraef 0:d26c1b55cfca 2307 return -1;
DieterGraef 0:d26c1b55cfca 2308 }
DieterGraef 0:d26c1b55cfca 2309
DieterGraef 0:d26c1b55cfca 2310 switch (cmd) {
DieterGraef 0:d26c1b55cfca 2311 #if LWIP_SO_RCVBUF
DieterGraef 0:d26c1b55cfca 2312 case FIONREAD:
DieterGraef 0:d26c1b55cfca 2313 if (!argp) {
DieterGraef 0:d26c1b55cfca 2314 sock_set_errno(sock, EINVAL);
DieterGraef 0:d26c1b55cfca 2315 return -1;
DieterGraef 0:d26c1b55cfca 2316 }
DieterGraef 0:d26c1b55cfca 2317
DieterGraef 0:d26c1b55cfca 2318 SYS_ARCH_GET(sock->conn->recv_avail, recv_avail);
DieterGraef 0:d26c1b55cfca 2319 if (recv_avail < 0) {
DieterGraef 0:d26c1b55cfca 2320 recv_avail = 0;
DieterGraef 0:d26c1b55cfca 2321 }
DieterGraef 0:d26c1b55cfca 2322 *((u16_t*)argp) = (u16_t)recv_avail;
DieterGraef 0:d26c1b55cfca 2323
DieterGraef 0:d26c1b55cfca 2324 /* Check if there is data left from the last recv operation. /maq 041215 */
DieterGraef 0:d26c1b55cfca 2325 if (sock->lastdata) {
DieterGraef 0:d26c1b55cfca 2326 struct pbuf *p = (struct pbuf *)sock->lastdata;
DieterGraef 0:d26c1b55cfca 2327 if (netconn_type(sock->conn) != NETCONN_TCP) {
DieterGraef 0:d26c1b55cfca 2328 p = ((struct netbuf *)p)->p;
DieterGraef 0:d26c1b55cfca 2329 }
DieterGraef 0:d26c1b55cfca 2330 buflen = p->tot_len;
DieterGraef 0:d26c1b55cfca 2331 buflen -= sock->lastoffset;
DieterGraef 0:d26c1b55cfca 2332
DieterGraef 0:d26c1b55cfca 2333 *((u16_t*)argp) += buflen;
DieterGraef 0:d26c1b55cfca 2334 }
DieterGraef 0:d26c1b55cfca 2335
DieterGraef 0:d26c1b55cfca 2336 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_ioctl(%d, FIONREAD, %p) = %"U16_F"\n", s, argp, *((u16_t*)argp)));
DieterGraef 0:d26c1b55cfca 2337 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 2338 return 0;
DieterGraef 0:d26c1b55cfca 2339 #endif /* LWIP_SO_RCVBUF */
DieterGraef 0:d26c1b55cfca 2340
DieterGraef 0:d26c1b55cfca 2341 case FIONBIO:
DieterGraef 0:d26c1b55cfca 2342 val = 0;
DieterGraef 0:d26c1b55cfca 2343 if (argp && *(u32_t*)argp) {
DieterGraef 0:d26c1b55cfca 2344 val = 1;
DieterGraef 0:d26c1b55cfca 2345 }
DieterGraef 0:d26c1b55cfca 2346 netconn_set_nonblocking(sock->conn, val);
DieterGraef 0:d26c1b55cfca 2347 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_ioctl(%d, FIONBIO, %d)\n", s, val));
DieterGraef 0:d26c1b55cfca 2348 sock_set_errno(sock, 0);
DieterGraef 0:d26c1b55cfca 2349 return 0;
DieterGraef 0:d26c1b55cfca 2350
DieterGraef 0:d26c1b55cfca 2351 default:
DieterGraef 0:d26c1b55cfca 2352 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_ioctl(%d, UNIMPL: 0x%lx, %p)\n", s, cmd, argp));
DieterGraef 0:d26c1b55cfca 2353 sock_set_errno(sock, ENOSYS); /* not yet implemented */
DieterGraef 0:d26c1b55cfca 2354 return -1;
DieterGraef 0:d26c1b55cfca 2355 } /* switch (cmd) */
DieterGraef 0:d26c1b55cfca 2356 }
DieterGraef 0:d26c1b55cfca 2357
DieterGraef 0:d26c1b55cfca 2358 /** A minimal implementation of fcntl.
DieterGraef 0:d26c1b55cfca 2359 * Currently only the commands F_GETFL and F_SETFL are implemented.
DieterGraef 0:d26c1b55cfca 2360 * Only the flag O_NONBLOCK is implemented.
DieterGraef 0:d26c1b55cfca 2361 */
DieterGraef 0:d26c1b55cfca 2362 int
DieterGraef 0:d26c1b55cfca 2363 lwip_fcntl(int s, int cmd, int val)
DieterGraef 0:d26c1b55cfca 2364 {
DieterGraef 0:d26c1b55cfca 2365 struct lwip_sock *sock = get_socket(s);
DieterGraef 0:d26c1b55cfca 2366 int ret = -1;
DieterGraef 0:d26c1b55cfca 2367
DieterGraef 0:d26c1b55cfca 2368 if (!sock || !sock->conn) {
DieterGraef 0:d26c1b55cfca 2369 return -1;
DieterGraef 0:d26c1b55cfca 2370 }
DieterGraef 0:d26c1b55cfca 2371
DieterGraef 0:d26c1b55cfca 2372 switch (cmd) {
DieterGraef 0:d26c1b55cfca 2373 case F_GETFL:
DieterGraef 0:d26c1b55cfca 2374 ret = netconn_is_nonblocking(sock->conn) ? O_NONBLOCK : 0;
DieterGraef 0:d26c1b55cfca 2375 break;
DieterGraef 0:d26c1b55cfca 2376 case F_SETFL:
DieterGraef 0:d26c1b55cfca 2377 if ((val & ~O_NONBLOCK) == 0) {
DieterGraef 0:d26c1b55cfca 2378 /* only O_NONBLOCK, all other bits are zero */
DieterGraef 0:d26c1b55cfca 2379 netconn_set_nonblocking(sock->conn, val & O_NONBLOCK);
DieterGraef 0:d26c1b55cfca 2380 ret = 0;
DieterGraef 0:d26c1b55cfca 2381 }
DieterGraef 0:d26c1b55cfca 2382 break;
DieterGraef 0:d26c1b55cfca 2383 default:
DieterGraef 0:d26c1b55cfca 2384 LWIP_DEBUGF(SOCKETS_DEBUG, ("lwip_fcntl(%d, UNIMPL: %d, %d)\n", s, cmd, val));
DieterGraef 0:d26c1b55cfca 2385 break;
DieterGraef 0:d26c1b55cfca 2386 }
DieterGraef 0:d26c1b55cfca 2387 return ret;
DieterGraef 0:d26c1b55cfca 2388 }
DieterGraef 0:d26c1b55cfca 2389
DieterGraef 0:d26c1b55cfca 2390 #endif /* LWIP_SOCKET */