CK Sin / Mbed 2 deprecated Ethernetwebsocket

Ethernetwebsoc

Dependencies:   C12832_lcd LM75B WebSocketClient mbed-rtos mbed Socket lwip-eth lwip-sys lwip

EthernetInterface/lwip/api/sockets.c@0:0ed2a7c7190c, 2013-05-31 (annotated)

Committer:
GordonSin
Date:
Fri May 31 04:09:54 2013 +0000
Revision:
0:0ed2a7c7190c
31/5/2013;

Who changed what in which revision?

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