514 lines
13 KiB
C
514 lines
13 KiB
C
/*
|
|
* TCP/IP or UDP/IP networking functions
|
|
* modified for LWIP support on ESP8266
|
|
*
|
|
* Copyright (C) 2006-2015, ARM Limited, All Rights Reserved
|
|
* Additions Copyright (C) 2015 Angus Gratton
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License"); you may
|
|
* not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*
|
|
* This file is part of mbed TLS (https://tls.mbed.org)
|
|
*/
|
|
|
|
#if !defined(MBEDTLS_CONFIG_FILE)
|
|
#include "mbedtls/config.h"
|
|
#else
|
|
#include MBEDTLS_CONFIG_FILE
|
|
#endif
|
|
|
|
#if defined(MBEDTLS_NET_C)
|
|
|
|
#include "mbedtls/net.h"
|
|
|
|
#include <string.h>
|
|
|
|
#include <sys/types.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/time.h>
|
|
#include <unistd.h>
|
|
#include <netdb.h>
|
|
#include <errno.h>
|
|
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
|
|
#include <time.h>
|
|
|
|
#include <stdint.h>
|
|
|
|
/*
|
|
* Prepare for using the sockets interface
|
|
*/
|
|
static int net_prepare( void )
|
|
{
|
|
#if ( defined(_WIN32) || defined(_WIN32_WCE) ) && !defined(EFIX64) && \
|
|
!defined(EFI32)
|
|
WSADATA wsaData;
|
|
|
|
if( wsa_init_done == 0 )
|
|
{
|
|
if( WSAStartup( MAKEWORD(2,0), &wsaData ) != 0 )
|
|
return( MBEDTLS_ERR_NET_SOCKET_FAILED );
|
|
|
|
wsa_init_done = 1;
|
|
}
|
|
#else
|
|
#endif
|
|
return( 0 );
|
|
}
|
|
|
|
/*
|
|
* Initialize a context
|
|
*/
|
|
void mbedtls_net_init( mbedtls_net_context *ctx )
|
|
{
|
|
ctx->fd = -1;
|
|
}
|
|
|
|
/*
|
|
* Initiate a TCP connection with host:port and the given protocol
|
|
*/
|
|
int mbedtls_net_connect( mbedtls_net_context *ctx, const char *host, const char *port, int proto )
|
|
{
|
|
int ret;
|
|
struct addrinfo hints, *addr_list, *cur;
|
|
|
|
if( ( ret = net_prepare() ) != 0 )
|
|
return( ret );
|
|
|
|
/* Do name resolution with both IPv6 and IPv4 */
|
|
memset( &hints, 0, sizeof( hints ) );
|
|
hints.ai_family = AF_UNSPEC;
|
|
hints.ai_socktype = proto == MBEDTLS_NET_PROTO_UDP ? SOCK_DGRAM : SOCK_STREAM;
|
|
hints.ai_protocol = proto == MBEDTLS_NET_PROTO_UDP ? IPPROTO_UDP : IPPROTO_TCP;
|
|
|
|
if( getaddrinfo( host, port, &hints, &addr_list ) != 0 )
|
|
return( MBEDTLS_ERR_NET_UNKNOWN_HOST );
|
|
|
|
/* Try the sockaddrs until a connection succeeds */
|
|
ret = MBEDTLS_ERR_NET_UNKNOWN_HOST;
|
|
for( cur = addr_list; cur != NULL; cur = cur->ai_next )
|
|
{
|
|
ctx->fd = (int) socket( cur->ai_family, cur->ai_socktype,
|
|
cur->ai_protocol );
|
|
if( ctx->fd < 0 )
|
|
{
|
|
ret = MBEDTLS_ERR_NET_SOCKET_FAILED;
|
|
continue;
|
|
}
|
|
|
|
if( connect( ctx->fd, cur->ai_addr, cur->ai_addrlen ) == 0 )
|
|
{
|
|
ret = 0;
|
|
break;
|
|
}
|
|
|
|
close( ctx->fd );
|
|
ret = MBEDTLS_ERR_NET_CONNECT_FAILED;
|
|
}
|
|
|
|
freeaddrinfo( addr_list );
|
|
|
|
return( ret );
|
|
}
|
|
|
|
/*
|
|
* Create a listening socket on bind_ip:port
|
|
*/
|
|
int mbedtls_net_bind( mbedtls_net_context *ctx, const char *bind_ip, const char *port, int proto )
|
|
{
|
|
int n, ret;
|
|
struct addrinfo *addr_list, *cur;
|
|
|
|
/* Only request desired protocol */
|
|
const struct addrinfo hints = {
|
|
.ai_family = AF_UNSPEC,
|
|
.ai_socktype = (proto == MBEDTLS_NET_PROTO_UDP ? SOCK_DGRAM : SOCK_STREAM),
|
|
.ai_protocol = (proto == MBEDTLS_NET_PROTO_UDP ? IPPROTO_UDP : IPPROTO_TCP),
|
|
};
|
|
|
|
struct sockaddr_in sockaddr_ipaddr_any = {
|
|
.sin_len = sizeof(struct sockaddr_in),
|
|
.sin_family = AF_INET,
|
|
.sin_port = htons(atoi(port)),
|
|
.sin_addr = { IPADDR_ANY },
|
|
};
|
|
|
|
struct addrinfo all_interfaces_addr = {
|
|
.ai_family = AF_INET,
|
|
.ai_socktype = hints.ai_socktype,
|
|
.ai_protocol = hints.ai_protocol,
|
|
.ai_addrlen = sizeof(struct sockaddr_in),
|
|
.ai_addr = (struct sockaddr *)&sockaddr_ipaddr_any,
|
|
};
|
|
|
|
if( ( ret = net_prepare() ) != 0 )
|
|
return( ret );
|
|
|
|
if(bind_ip == NULL) {
|
|
/* mbedTLS docs specify bind_ip == NULL means all interfaces, but lwip getaddrinfo() assumes NULL
|
|
means localhost. So we swap in a precreated IPADDR_ANY addrinfo result here. */
|
|
addr_list = &all_interfaces_addr;
|
|
}
|
|
else if( getaddrinfo( bind_ip, port, &hints, &addr_list ) != 0 ) {
|
|
return( MBEDTLS_ERR_NET_UNKNOWN_HOST );
|
|
}
|
|
|
|
/* Try the sockaddrs until a binding succeeds */
|
|
ret = MBEDTLS_ERR_NET_UNKNOWN_HOST;
|
|
for( cur = addr_list; cur != NULL; cur = cur->ai_next )
|
|
{
|
|
ctx->fd = (int) socket( cur->ai_family, cur->ai_socktype,
|
|
cur->ai_protocol );
|
|
if( ctx->fd < 0 )
|
|
{
|
|
ret = MBEDTLS_ERR_NET_SOCKET_FAILED;
|
|
continue;
|
|
}
|
|
|
|
n = 1;
|
|
if( setsockopt( ctx->fd, SOL_SOCKET, SO_REUSEADDR,
|
|
(const char *) &n, sizeof( n ) ) != 0 )
|
|
{
|
|
close( ctx->fd );
|
|
ret = MBEDTLS_ERR_NET_SOCKET_FAILED;
|
|
continue;
|
|
}
|
|
|
|
if( bind( ctx->fd, cur->ai_addr, cur->ai_addrlen ) != 0 )
|
|
{
|
|
close( ctx->fd );
|
|
ret = MBEDTLS_ERR_NET_BIND_FAILED;
|
|
continue;
|
|
}
|
|
|
|
/* Listen only makes sense for TCP */
|
|
if( proto == MBEDTLS_NET_PROTO_TCP )
|
|
{
|
|
if( listen( ctx->fd, MBEDTLS_NET_LISTEN_BACKLOG ) != 0 )
|
|
{
|
|
close( ctx->fd );
|
|
ret = MBEDTLS_ERR_NET_LISTEN_FAILED;
|
|
continue;
|
|
}
|
|
}
|
|
|
|
/* I we ever get there, it's a success */
|
|
ret = 0;
|
|
break;
|
|
}
|
|
|
|
if(bind_ip != NULL) {
|
|
freeaddrinfo( addr_list );
|
|
}
|
|
|
|
return( ret );
|
|
|
|
}
|
|
|
|
static int socket_errno( const mbedtls_net_context *ctx )
|
|
{
|
|
int sock_errno = 0;
|
|
u32_t optlen = sizeof(sock_errno);
|
|
lwip_getsockopt(ctx->fd, SOL_SOCKET, SO_ERROR, &sock_errno, &optlen);
|
|
return sock_errno;
|
|
}
|
|
|
|
/*
|
|
* Check if the requested operation would be blocking on a non-blocking socket
|
|
* and thus 'failed' with a negative return value.
|
|
*
|
|
* Note: on a blocking socket this function always returns 0!
|
|
*/
|
|
static int net_would_block( const mbedtls_net_context *ctx )
|
|
{
|
|
/*
|
|
* Never return 'WOULD BLOCK' on a non-blocking socket
|
|
*/
|
|
if( ( fcntl( ctx->fd, F_GETFL, 0) & O_NONBLOCK ) != O_NONBLOCK )
|
|
return( 0 );
|
|
|
|
|
|
switch( socket_errno(ctx) )
|
|
{
|
|
#if defined EAGAIN
|
|
case EAGAIN:
|
|
#endif
|
|
#if defined EWOULDBLOCK && EWOULDBLOCK != EAGAIN
|
|
case EWOULDBLOCK:
|
|
#endif
|
|
return( 1 );
|
|
}
|
|
return( 0 );
|
|
}
|
|
|
|
/*
|
|
* Accept a connection from a remote client
|
|
*/
|
|
int mbedtls_net_accept( mbedtls_net_context *bind_ctx,
|
|
mbedtls_net_context *client_ctx,
|
|
void *client_ip, size_t buf_size, size_t *ip_len )
|
|
{
|
|
int ret;
|
|
int type;
|
|
|
|
struct sockaddr_in client_addr;
|
|
|
|
socklen_t n = (socklen_t) sizeof( client_addr );
|
|
socklen_t type_len = (socklen_t) sizeof( type );
|
|
|
|
/* Is this a TCP or UDP socket? */
|
|
if( getsockopt( bind_ctx->fd, SOL_SOCKET, SO_TYPE,
|
|
(void *) &type, (socklen_t *) &type_len ) != 0 ||
|
|
( type != SOCK_STREAM && type != SOCK_DGRAM ) )
|
|
{
|
|
return( MBEDTLS_ERR_NET_ACCEPT_FAILED );
|
|
}
|
|
|
|
if( type == SOCK_STREAM )
|
|
{
|
|
/* TCP: actual accept() */
|
|
ret = client_ctx->fd = (int) accept( bind_ctx->fd,
|
|
(struct sockaddr *) &client_addr, &n );
|
|
}
|
|
else
|
|
{
|
|
/* UDP: wait for a message, but keep it in the queue */
|
|
char buf[1] = { 0 };
|
|
|
|
ret = recvfrom( bind_ctx->fd, buf, sizeof( buf ), MSG_PEEK,
|
|
(struct sockaddr *) &client_addr, &n );
|
|
|
|
#if defined(_WIN32)
|
|
if( ret == SOCKET_ERROR &&
|
|
WSAGetLastError() == WSAEMSGSIZE )
|
|
{
|
|
/* We know buf is too small, thanks, just peeking here */
|
|
ret = 0;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
if( ret < 0 )
|
|
{
|
|
if( net_would_block( bind_ctx ) != 0 )
|
|
return( MBEDTLS_ERR_SSL_WANT_READ );
|
|
|
|
return( MBEDTLS_ERR_NET_ACCEPT_FAILED );
|
|
}
|
|
|
|
/* UDP: hijack the listening socket to communicate with the client,
|
|
* then bind a new socket to accept new connections */
|
|
if( type != SOCK_STREAM )
|
|
{
|
|
struct sockaddr_in local_addr;
|
|
int one = 1;
|
|
|
|
if( connect( bind_ctx->fd, (struct sockaddr *) &client_addr, n ) != 0 )
|
|
return( MBEDTLS_ERR_NET_ACCEPT_FAILED );
|
|
|
|
client_ctx->fd = bind_ctx->fd;
|
|
bind_ctx->fd = -1; /* In case we exit early */
|
|
|
|
n = sizeof( struct sockaddr_in );
|
|
if( getsockname( client_ctx->fd,
|
|
(struct sockaddr *) &local_addr, &n ) != 0 ||
|
|
( bind_ctx->fd = (int) socket( AF_INET,
|
|
SOCK_DGRAM, IPPROTO_UDP ) ) < 0 ||
|
|
setsockopt( bind_ctx->fd, SOL_SOCKET, SO_REUSEADDR,
|
|
(const char *) &one, sizeof( one ) ) != 0 )
|
|
{
|
|
return( MBEDTLS_ERR_NET_SOCKET_FAILED );
|
|
}
|
|
|
|
if( bind( bind_ctx->fd, (struct sockaddr *) &local_addr, n ) != 0 )
|
|
{
|
|
return( MBEDTLS_ERR_NET_BIND_FAILED );
|
|
}
|
|
}
|
|
|
|
if( client_ip != NULL )
|
|
{
|
|
struct sockaddr_in *addr4 = (struct sockaddr_in *) &client_addr;
|
|
*ip_len = sizeof( addr4->sin_addr.s_addr );
|
|
|
|
if( buf_size < *ip_len )
|
|
return( MBEDTLS_ERR_NET_BUFFER_TOO_SMALL );
|
|
|
|
memcpy( client_ip, &addr4->sin_addr.s_addr, *ip_len );
|
|
}
|
|
|
|
return( 0 );
|
|
}
|
|
|
|
/*
|
|
* Set the socket blocking or non-blocking
|
|
*/
|
|
int mbedtls_net_set_block( mbedtls_net_context *ctx )
|
|
{
|
|
#if ( defined(_WIN32) || defined(_WIN32_WCE) ) && !defined(EFIX64) && \
|
|
!defined(EFI32)
|
|
u_long n = 0;
|
|
return( ioctlsocket( ctx->fd, FIONBIO, &n ) );
|
|
#else
|
|
return( fcntl( ctx->fd, F_SETFL, fcntl( ctx->fd, F_GETFL, 0 ) & ~O_NONBLOCK ) );
|
|
#endif
|
|
}
|
|
|
|
int mbedtls_net_set_nonblock( mbedtls_net_context *ctx )
|
|
{
|
|
#if ( defined(_WIN32) || defined(_WIN32_WCE) ) && !defined(EFIX64) && \
|
|
!defined(EFI32)
|
|
u_long n = 1;
|
|
return( ioctlsocket( ctx->fd, FIONBIO, &n ) );
|
|
#else
|
|
return( fcntl( ctx->fd, F_SETFL, fcntl( ctx->fd, F_GETFL, 0 ) | O_NONBLOCK ) );
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Portable usleep helper
|
|
*/
|
|
void mbedtls_net_usleep( unsigned long usec )
|
|
{
|
|
#if defined(_WIN32)
|
|
Sleep( ( usec + 999 ) / 1000 );
|
|
#else
|
|
struct timeval tv;
|
|
tv.tv_sec = usec / 1000000;
|
|
#if defined(__unix__) || defined(__unix) || \
|
|
( defined(__APPLE__) && defined(__MACH__) )
|
|
tv.tv_usec = (suseconds_t) usec % 1000000;
|
|
#else
|
|
tv.tv_usec = usec % 1000000;
|
|
#endif
|
|
select( 0, NULL, NULL, NULL, &tv );
|
|
#endif
|
|
}
|
|
|
|
/* Read at most 'len' characters */
|
|
int mbedtls_net_recv( void *ctx, unsigned char *buf, size_t len )
|
|
{
|
|
int ret;
|
|
int fd = ((mbedtls_net_context *) ctx)->fd;
|
|
|
|
if( fd < 0 )
|
|
return( MBEDTLS_ERR_NET_INVALID_CONTEXT );
|
|
|
|
ret = (int) read( fd, buf, len );
|
|
|
|
if( ret < 0 )
|
|
{
|
|
if( net_would_block( ctx ) != 0 )
|
|
return( MBEDTLS_ERR_SSL_WANT_READ );
|
|
|
|
int sock_errno = socket_errno(ctx);
|
|
|
|
if( sock_errno == EPIPE || sock_errno == ECONNRESET )
|
|
return( MBEDTLS_ERR_NET_CONN_RESET );
|
|
|
|
if( sock_errno == EINTR )
|
|
return( MBEDTLS_ERR_SSL_WANT_READ );
|
|
|
|
return( MBEDTLS_ERR_NET_RECV_FAILED );
|
|
}
|
|
|
|
return( ret );
|
|
}
|
|
|
|
/*
|
|
* Read at most 'len' characters, blocking for at most 'timeout' ms
|
|
*/
|
|
int mbedtls_net_recv_timeout( void *ctx, unsigned char *buf, size_t len,
|
|
uint32_t timeout )
|
|
{
|
|
int ret;
|
|
struct timeval tv;
|
|
fd_set read_fds;
|
|
int fd = ((mbedtls_net_context *) ctx)->fd;
|
|
|
|
if( fd < 0 )
|
|
return( MBEDTLS_ERR_NET_INVALID_CONTEXT );
|
|
|
|
FD_ZERO( &read_fds );
|
|
FD_SET( fd, &read_fds );
|
|
|
|
tv.tv_sec = timeout / 1000;
|
|
tv.tv_usec = ( timeout % 1000 ) * 1000;
|
|
|
|
ret = select( fd + 1, &read_fds, NULL, NULL, timeout == 0 ? NULL : &tv );
|
|
|
|
/* Zero fds ready means we timed out */
|
|
if( ret == 0 )
|
|
return( MBEDTLS_ERR_SSL_TIMEOUT );
|
|
|
|
if( ret < 0 )
|
|
{
|
|
if( errno == EINTR )
|
|
return( MBEDTLS_ERR_SSL_WANT_READ );
|
|
|
|
return( MBEDTLS_ERR_NET_RECV_FAILED );
|
|
}
|
|
|
|
/* This call will not block */
|
|
return( mbedtls_net_recv( ctx, buf, len ) );
|
|
}
|
|
|
|
/*
|
|
* Write at most 'len' characters
|
|
*/
|
|
int mbedtls_net_send( void *ctx, const unsigned char *buf, size_t len )
|
|
{
|
|
int ret;
|
|
int fd = ((mbedtls_net_context *) ctx)->fd;
|
|
|
|
if( fd < 0 )
|
|
return( MBEDTLS_ERR_NET_INVALID_CONTEXT );
|
|
|
|
ret = (int) write( fd, buf, len );
|
|
|
|
if( ret < 0 )
|
|
{
|
|
if( net_would_block( ctx ) != 0 )
|
|
return( MBEDTLS_ERR_SSL_WANT_WRITE );
|
|
|
|
int sock_errno = socket_errno(ctx);
|
|
|
|
if( sock_errno == EPIPE || sock_errno == ECONNRESET )
|
|
return( MBEDTLS_ERR_NET_CONN_RESET );
|
|
|
|
if( sock_errno == EINTR )
|
|
return( MBEDTLS_ERR_SSL_WANT_WRITE );
|
|
|
|
return( MBEDTLS_ERR_NET_SEND_FAILED );
|
|
}
|
|
|
|
return( ret );
|
|
}
|
|
|
|
/*
|
|
* Gracefully close the connection
|
|
*/
|
|
void mbedtls_net_free( mbedtls_net_context *ctx )
|
|
{
|
|
if( ctx->fd == -1 )
|
|
return;
|
|
|
|
shutdown( ctx->fd, 2 );
|
|
close( ctx->fd );
|
|
|
|
ctx->fd = -1;
|
|
}
|
|
|
|
#endif /* MBEDTLS_NET_C */
|