Donatien Garnier / lwip_ppp_ethernet

LwIP with PPP & Ethernet integration

Dependents:   NetworkingCoreLib

This is the mbed port of the LwIP stack: http://savannah.nongnu.org/projects/lwip/

It includes contributed content from NXP's port for LPCxxxx devices: http://www.lpcware.com/content/project/lightweight-ip-lwip-networking-stack

Licence

LwIP is licenced under the BSD licence: 

Copyright (c) 2001-2004 Swedish Institute of Computer Science. 
All rights reserved. 
Redistribution and use in source and binary forms, with or without modification, 
are permitted provided that the following conditions are met: 
1. Redistributions of source code must retain the above copyright notice, 
this list of conditions and the following disclaimer. 
2. Redistributions in binary form must reproduce the above copyright notice, 
this list of conditions and the following disclaimer in the documentation 
and/or other materials provided with the distribution. 
3. The name of the author may not be used to endorse or promote products 
derived from this software without specific prior written permission. 
THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED 
WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 
MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT 
SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 
EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT 
OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING 
IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY 
OF SUCH DAMAGE.

src/api/sockets.c@2:1a87f74b8e3b, 2012-05-25 (annotated)

Committer:
donatien
Date:
Fri May 25 08:56:35 2012 +0000
Revision:
2:1a87f74b8e3b
Parent:
0:8e01dca41002 
Removed compilation of EMAC driver when using PPP

Who changed what in which revision?

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