mirror of https://github.com/ARMmbed/mbed-os.git
				
				
				
			
		
			
				
	
	
		
			1477 lines
		
	
	
		
			42 KiB
		
	
	
	
		
			C
		
	
	
			
		
		
	
	
			1477 lines
		
	
	
		
			42 KiB
		
	
	
	
		
			C
		
	
	
/* LWIP implementation of NetworkInterfaceAPI
 | 
						|
 * Copyright (c) 2015 ARM Limited
 | 
						|
 *
 | 
						|
 * 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.
 | 
						|
 */
 | 
						|
 | 
						|
#include "nsapi.h"
 | 
						|
#include "mbed_interface.h"
 | 
						|
#include "mbed_assert.h"
 | 
						|
#include <stdio.h>
 | 
						|
#include <stdbool.h>
 | 
						|
#include <string.h>
 | 
						|
#include "lwip_stack.h"
 | 
						|
 | 
						|
#include "eth_arch.h"
 | 
						|
#include "lwip/opt.h"
 | 
						|
#include "lwip/api.h"
 | 
						|
#include "lwip/inet.h"
 | 
						|
#include "lwip/netif.h"
 | 
						|
#include "lwip/dhcp.h"
 | 
						|
#include "lwip/tcpip.h"
 | 
						|
#include "lwip/tcp.h"
 | 
						|
#include "lwip/ip.h"
 | 
						|
#include "lwip/mld6.h"
 | 
						|
#include "lwip/igmp.h"
 | 
						|
#include "lwip/dns.h"
 | 
						|
#include "lwip/udp.h"
 | 
						|
#include "lwip_errno.h"
 | 
						|
#include "netif/lwip_ethernet.h"
 | 
						|
#include "emac_api.h"
 | 
						|
#include "ppp_lwip.h"
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_err_remap(err_t err);
 | 
						|
 | 
						|
#if DEVICE_EMAC
 | 
						|
    #define MBED_NETIF_INIT_FN emac_lwip_if_init
 | 
						|
#else
 | 
						|
    #define MBED_NETIF_INIT_FN eth_arch_enetif_init
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef LWIP_SOCKET_MAX_MEMBERSHIPS
 | 
						|
    #define LWIP_SOCKET_MAX_MEMBERSHIPS 4
 | 
						|
#endif
 | 
						|
 | 
						|
/* Static arena of sockets */
 | 
						|
static struct lwip_socket {
 | 
						|
    bool in_use;
 | 
						|
 | 
						|
    struct netconn *conn;
 | 
						|
    struct netbuf *buf;
 | 
						|
    u16_t offset;
 | 
						|
 | 
						|
    void (*cb)(void *);
 | 
						|
    void *data;
 | 
						|
 | 
						|
    // Track multicast addresses subscribed to by this socket
 | 
						|
    nsapi_ip_mreq_t *multicast_memberships;
 | 
						|
    uint32_t         multicast_memberships_count;
 | 
						|
    uint32_t         multicast_memberships_registry;
 | 
						|
 | 
						|
} lwip_arena[MEMP_NUM_NETCONN];
 | 
						|
 | 
						|
static bool lwip_inited = false;
 | 
						|
static nsapi_connection_status_t lwip_connected = NSAPI_STATUS_DISCONNECTED;
 | 
						|
static bool netif_inited = false;
 | 
						|
static bool netif_is_ppp = false;
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_setsockopt(nsapi_stack_t *stack, nsapi_socket_t handle, int level, int optname, const void *optval, unsigned optlen);
 | 
						|
 | 
						|
static inline uint32_t next_registered_multicast_member(const struct lwip_socket *s, uint32_t index) {
 | 
						|
    while (!(s->multicast_memberships_registry & (0x0001 << index))) { index++; }
 | 
						|
    return index;
 | 
						|
}
 | 
						|
 | 
						|
static inline uint32_t next_free_multicast_member(const struct lwip_socket *s, uint32_t index) {
 | 
						|
    while ((s->multicast_memberships_registry & (0x0001 << index))) { index++; }
 | 
						|
    return index;
 | 
						|
}
 | 
						|
 | 
						|
static inline void set_multicast_member_registry_bit(struct lwip_socket *s, uint32_t index) {
 | 
						|
    s->multicast_memberships_registry |= (0x0001 << index);
 | 
						|
}
 | 
						|
 | 
						|
static inline void clear_multicast_member_registry_bit(struct lwip_socket *s, uint32_t index) {
 | 
						|
    s->multicast_memberships_registry &= ~(0x0001 << index);
 | 
						|
}
 | 
						|
 | 
						|
static struct lwip_socket *mbed_lwip_arena_alloc(void)
 | 
						|
{
 | 
						|
    sys_prot_t prot = sys_arch_protect();
 | 
						|
 | 
						|
    for (int i = 0; i < MEMP_NUM_NETCONN; i++) {
 | 
						|
        if (!lwip_arena[i].in_use) {
 | 
						|
            struct lwip_socket *s = &lwip_arena[i];
 | 
						|
            memset(s, 0, sizeof *s);
 | 
						|
            s->in_use = true;
 | 
						|
            sys_arch_unprotect(prot);
 | 
						|
            return s;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    sys_arch_unprotect(prot);
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static void mbed_lwip_arena_dealloc(struct lwip_socket *s)
 | 
						|
{
 | 
						|
    s->in_use = false;
 | 
						|
 | 
						|
    while (s->multicast_memberships_count > 0) {
 | 
						|
        uint32_t index = 0;
 | 
						|
        index = next_registered_multicast_member(s, index);
 | 
						|
 | 
						|
        mbed_lwip_setsockopt(NULL, s, NSAPI_SOCKET, NSAPI_DROP_MEMBERSHIP, &s->multicast_memberships[index],
 | 
						|
            sizeof(s->multicast_memberships[index]));
 | 
						|
        index++;
 | 
						|
    }
 | 
						|
 | 
						|
    free(s->multicast_memberships);
 | 
						|
    s->multicast_memberships = NULL;
 | 
						|
}
 | 
						|
 | 
						|
static void mbed_lwip_socket_callback(struct netconn *nc, enum netconn_evt eh, u16_t len)
 | 
						|
{
 | 
						|
    // Filter send minus events
 | 
						|
    if (eh == NETCONN_EVT_SENDMINUS && nc->state == NETCONN_WRITE) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    sys_prot_t prot = sys_arch_protect();
 | 
						|
 | 
						|
    for (int i = 0; i < MEMP_NUM_NETCONN; i++) {
 | 
						|
        if (lwip_arena[i].in_use
 | 
						|
            && lwip_arena[i].conn == nc
 | 
						|
            && lwip_arena[i].cb) {
 | 
						|
            lwip_arena[i].cb(lwip_arena[i].data);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    sys_arch_unprotect(prot);
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
/* TCP/IP and Network Interface Initialisation */
 | 
						|
static struct netif lwip_netif;
 | 
						|
#if LWIP_DHCP
 | 
						|
static bool lwip_dhcp = false;
 | 
						|
static bool lwip_dhcp_has_to_be_set = false;
 | 
						|
#endif
 | 
						|
static char lwip_mac_address[NSAPI_MAC_SIZE];
 | 
						|
 | 
						|
#if !LWIP_IPV4 || !LWIP_IPV6
 | 
						|
static bool all_zeros(const uint8_t *p, int len)
 | 
						|
{
 | 
						|
    for (int i = 0; i < len; i++) {
 | 
						|
        if (p[i]) {
 | 
						|
            return false;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    return true;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
static bool convert_mbed_addr_to_lwip(ip_addr_t *out, const nsapi_addr_t *in)
 | 
						|
{
 | 
						|
#if LWIP_IPV6
 | 
						|
    if (in->version == NSAPI_IPv6) {
 | 
						|
         IP_SET_TYPE(out, IPADDR_TYPE_V6);
 | 
						|
         MEMCPY(ip_2_ip6(out), in->bytes, sizeof(ip6_addr_t));
 | 
						|
         return true;
 | 
						|
    }
 | 
						|
#if !LWIP_IPV4
 | 
						|
    /* For bind() and other purposes, need to accept "null" of other type */
 | 
						|
    /* (People use IPv4 0.0.0.0 as a general null) */
 | 
						|
    if (in->version == NSAPI_UNSPEC ||
 | 
						|
        (in->version == NSAPI_IPv4 && all_zeros(in->bytes, 4))) {
 | 
						|
        ip_addr_set_zero_ip6(out);
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#endif
 | 
						|
 | 
						|
#if LWIP_IPV4
 | 
						|
    if (in->version == NSAPI_IPv4) {
 | 
						|
         IP_SET_TYPE(out, IPADDR_TYPE_V4);
 | 
						|
         MEMCPY(ip_2_ip4(out), in->bytes, sizeof(ip4_addr_t));
 | 
						|
         return true;
 | 
						|
    }
 | 
						|
#if !LWIP_IPV6
 | 
						|
    /* For symmetry with above, accept IPv6 :: as a general null */
 | 
						|
    if (in->version == NSAPI_UNSPEC ||
 | 
						|
        (in->version == NSAPI_IPv6 && all_zeros(in->bytes, 16))) {
 | 
						|
        ip_addr_set_zero_ip4(out);
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#endif
 | 
						|
 | 
						|
#if LWIP_IPV4 && LWIP_IPV6
 | 
						|
    if (in->version == NSAPI_UNSPEC) {
 | 
						|
#if IP_VERSION_PREF == PREF_IPV4
 | 
						|
        ip_addr_set_zero_ip4(out);
 | 
						|
#else
 | 
						|
        ip_addr_set_zero_ip6(out);
 | 
						|
#endif
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
#endif
 | 
						|
 | 
						|
    return false;
 | 
						|
}
 | 
						|
 | 
						|
static bool convert_lwip_addr_to_mbed(nsapi_addr_t *out, const ip_addr_t *in)
 | 
						|
{
 | 
						|
#if LWIP_IPV6
 | 
						|
    if (IP_IS_V6(in)) {
 | 
						|
        out->version = NSAPI_IPv6;
 | 
						|
        MEMCPY(out->bytes, ip_2_ip6(in), sizeof(ip6_addr_t));
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#if LWIP_IPV4
 | 
						|
    if (IP_IS_V4(in)) {
 | 
						|
        out->version = NSAPI_IPv4;
 | 
						|
        MEMCPY(out->bytes, ip_2_ip4(in), sizeof(ip4_addr_t));
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#if LWIP_IPV6 && LWIP_IPV4
 | 
						|
    return false;
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
#if LWIP_IPV4
 | 
						|
static const ip_addr_t *mbed_lwip_get_ipv4_addr(const struct netif *netif)
 | 
						|
{
 | 
						|
    if (!netif_is_up(netif)) {
 | 
						|
        return NULL;
 | 
						|
    }
 | 
						|
 | 
						|
    if (!ip4_addr_isany(netif_ip4_addr(netif))) {
 | 
						|
        return netif_ip_addr4(netif);
 | 
						|
    }
 | 
						|
 | 
						|
    return NULL;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#if LWIP_IPV6
 | 
						|
static const ip_addr_t *mbed_lwip_get_ipv6_addr(const struct netif *netif)
 | 
						|
{
 | 
						|
 | 
						|
    if (!netif_is_up(netif)) {
 | 
						|
        return NULL;
 | 
						|
    }
 | 
						|
 | 
						|
    for (int i = 0; i < LWIP_IPV6_NUM_ADDRESSES; i++) {
 | 
						|
        if (ip6_addr_isvalid(netif_ip6_addr_state(netif, i)) &&
 | 
						|
                !ip6_addr_islinklocal(netif_ip6_addr(netif, i))) {
 | 
						|
            return netif_ip_addr6(netif, i);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    return NULL;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
static bool mbed_lwip_is_local_addr(const ip_addr_t *ip_addr)
 | 
						|
{
 | 
						|
    struct netif *netif;
 | 
						|
 | 
						|
    for (netif = netif_list; netif != NULL; netif = netif->next) {
 | 
						|
        if (!netif_is_up(netif)) {
 | 
						|
            continue;
 | 
						|
        }
 | 
						|
#if LWIP_IPV6
 | 
						|
        if (IP_IS_V6(ip_addr)) {
 | 
						|
            for (int i = 0; i < LWIP_IPV6_NUM_ADDRESSES; i++) {
 | 
						|
                if (ip6_addr_isvalid(netif_ip6_addr_state(netif, i)) &&
 | 
						|
                    ip6_addr_cmp(netif_ip6_addr(netif, i), ip_2_ip6(ip_addr))) {
 | 
						|
                    return true;
 | 
						|
                }
 | 
						|
            }
 | 
						|
        }
 | 
						|
#endif
 | 
						|
 | 
						|
#if LWIP_IPV4
 | 
						|
        if (IP_IS_V4(ip_addr)) {
 | 
						|
            if (!ip4_addr_isany(netif_ip4_addr(netif)) &&
 | 
						|
                ip4_addr_cmp(netif_ip4_addr(netif), ip_2_ip4(ip_addr))) {
 | 
						|
                return true;
 | 
						|
            }
 | 
						|
        }
 | 
						|
#endif
 | 
						|
    }
 | 
						|
    return false;
 | 
						|
}
 | 
						|
 | 
						|
const ip_addr_t *mbed_lwip_get_ip_addr(bool any_addr, const struct netif *netif)
 | 
						|
{
 | 
						|
    const ip_addr_t *pref_ip_addr = 0;
 | 
						|
    const ip_addr_t *npref_ip_addr = 0;
 | 
						|
 | 
						|
#if LWIP_IPV4 && LWIP_IPV6
 | 
						|
#if IP_VERSION_PREF == PREF_IPV4
 | 
						|
    pref_ip_addr = mbed_lwip_get_ipv4_addr(netif);
 | 
						|
    npref_ip_addr = mbed_lwip_get_ipv6_addr(netif);
 | 
						|
#else
 | 
						|
    pref_ip_addr = mbed_lwip_get_ipv6_addr(netif);
 | 
						|
    npref_ip_addr = mbed_lwip_get_ipv4_addr(netif);
 | 
						|
#endif
 | 
						|
#elif LWIP_IPV6
 | 
						|
    pref_ip_addr = mbed_lwip_get_ipv6_addr(netif);
 | 
						|
#elif LWIP_IPV4
 | 
						|
    pref_ip_addr = mbed_lwip_get_ipv4_addr(netif);
 | 
						|
#endif
 | 
						|
 | 
						|
    if (pref_ip_addr) {
 | 
						|
        return pref_ip_addr;
 | 
						|
    } else if (npref_ip_addr && any_addr) {
 | 
						|
        return npref_ip_addr;
 | 
						|
    }
 | 
						|
 | 
						|
    return NULL;
 | 
						|
}
 | 
						|
 | 
						|
static void add_dns_addr_to_dns_list_index(const u8_t addr_type, const u8_t index)
 | 
						|
{
 | 
						|
#if LWIP_IPV6
 | 
						|
    if (addr_type == IPADDR_TYPE_V6) {
 | 
						|
        /* 2001:4860:4860::8888 google */
 | 
						|
        ip_addr_t ipv6_dns_addr = IPADDR6_INIT(
 | 
						|
                PP_HTONL(0x20014860UL),
 | 
						|
                PP_HTONL(0x48600000UL),
 | 
						|
                PP_HTONL(0x00000000UL),
 | 
						|
                PP_HTONL(0x00008888UL));
 | 
						|
        dns_setserver(index, &ipv6_dns_addr);
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#if LWIP_IPV4
 | 
						|
    if (addr_type == IPADDR_TYPE_V4) {
 | 
						|
        /* 8.8.8.8 google */
 | 
						|
        ip_addr_t ipv4_dns_addr = IPADDR4_INIT(0x08080808);
 | 
						|
        dns_setserver(index, &ipv4_dns_addr);
 | 
						|
    }
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
static int get_ip_addr_type(const ip_addr_t *ip_addr)
 | 
						|
{
 | 
						|
#if LWIP_IPV6
 | 
						|
    if (IP_IS_V6(ip_addr)) {
 | 
						|
        return IPADDR_TYPE_V6;
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#if LWIP_IPV4
 | 
						|
    if (IP_IS_V4(ip_addr)) {
 | 
						|
        return IPADDR_TYPE_V4;
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#if LWIP_IPV6 && LWIP_IPV4
 | 
						|
    return IPADDR_TYPE_ANY;
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
void add_dns_addr(struct netif *lwip_netif)
 | 
						|
{
 | 
						|
    // Check for existing dns address
 | 
						|
    for (char numdns = 0; numdns < DNS_MAX_SERVERS; numdns++) {
 | 
						|
        const ip_addr_t *dns_ip_addr = dns_getserver(numdns);
 | 
						|
        if (!ip_addr_isany(dns_ip_addr)) {
 | 
						|
            return;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    // Get preferred ip version
 | 
						|
    const ip_addr_t *ip_addr = mbed_lwip_get_ip_addr(false, lwip_netif);
 | 
						|
    u8_t addr_type = IPADDR_TYPE_ANY;
 | 
						|
 | 
						|
    // Add preferred ip version dns address to index 0
 | 
						|
    if (ip_addr) {
 | 
						|
        addr_type = get_ip_addr_type(ip_addr);
 | 
						|
        add_dns_addr_to_dns_list_index(addr_type, 0);
 | 
						|
    }
 | 
						|
 | 
						|
#if LWIP_IPV4 && LWIP_IPV6
 | 
						|
    if (!ip_addr) {
 | 
						|
        // Get address for any ip version
 | 
						|
        ip_addr = mbed_lwip_get_ip_addr(true, lwip_netif);
 | 
						|
        if (!ip_addr) {
 | 
						|
            return;
 | 
						|
        }
 | 
						|
        addr_type = get_ip_addr_type(ip_addr);
 | 
						|
        // Add the dns address to index 0
 | 
						|
        add_dns_addr_to_dns_list_index(addr_type, 0);
 | 
						|
    }
 | 
						|
 | 
						|
    if (addr_type == IPADDR_TYPE_V4) {
 | 
						|
        // If ipv4 is preferred and ipv6 is available add ipv6 dns address to index 1
 | 
						|
        ip_addr = mbed_lwip_get_ipv6_addr(lwip_netif);
 | 
						|
    } else if (addr_type == IPADDR_TYPE_V6) {
 | 
						|
        // If ipv6 is preferred and ipv4 is available add ipv4 dns address to index 1
 | 
						|
        ip_addr = mbed_lwip_get_ipv4_addr(lwip_netif);
 | 
						|
    } else {
 | 
						|
        ip_addr = NULL;
 | 
						|
    }
 | 
						|
 | 
						|
    if (ip_addr) {
 | 
						|
        addr_type = get_ip_addr_type(ip_addr);
 | 
						|
        add_dns_addr_to_dns_list_index(addr_type, 1);
 | 
						|
    }
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
static sys_sem_t lwip_tcpip_inited;
 | 
						|
static void mbed_lwip_tcpip_init_irq(void *eh)
 | 
						|
{
 | 
						|
    sys_sem_signal(&lwip_tcpip_inited);
 | 
						|
}
 | 
						|
 | 
						|
/** This is a pointer to an Ethernet IF, whose callback will be called in case
 | 
						|
 *  of network connection status changes
 | 
						|
 */
 | 
						|
static void *lwip_status_cb_handle = NULL;
 | 
						|
/** This function is called when the netif state is set to up or down
 | 
						|
 */
 | 
						|
static mbed_lwip_client_callback lwip_client_callback = NULL;
 | 
						|
/** The blocking status of the if
 | 
						|
 */
 | 
						|
static bool lwip_blocking = true; 
 | 
						|
static bool lwip_ppp = false;
 | 
						|
 | 
						|
 | 
						|
static nsapi_error_t mbed_set_dhcp(struct netif *lwip_netif)
 | 
						|
{
 | 
						|
    netif_set_up(lwip_netif);
 | 
						|
 | 
						|
#if LWIP_DHCP
 | 
						|
    if (lwip_dhcp && lwip_dhcp_has_to_be_set) {
 | 
						|
        err_t err = dhcp_start(lwip_netif);
 | 
						|
        lwip_dhcp_has_to_be_set = false;
 | 
						|
        if (err) {
 | 
						|
            lwip_connected = NSAPI_STATUS_DISCONNECTED;
 | 
						|
            if (lwip_client_callback) {
 | 
						|
                lwip_client_callback(lwip_status_cb_handle, NSAPI_EVENT_CONNECTION_STATUS_CHANGE, NSAPI_STATUS_DISCONNECTED);
 | 
						|
            }
 | 
						|
            return NSAPI_ERROR_DHCP_FAILURE;
 | 
						|
        }
 | 
						|
    }
 | 
						|
#endif
 | 
						|
 | 
						|
    return NSAPI_ERROR_OK;
 | 
						|
}
 | 
						|
 | 
						|
static sys_sem_t lwip_netif_linked;
 | 
						|
static sys_sem_t lwip_netif_unlinked;
 | 
						|
static void mbed_lwip_netif_link_irq(struct netif *lwip_netif)
 | 
						|
{
 | 
						|
    if (netif_is_link_up(lwip_netif)) {
 | 
						|
 | 
						|
        nsapi_error_t dhcp_status = mbed_set_dhcp(lwip_netif);
 | 
						|
 | 
						|
        if (lwip_blocking && dhcp_status == NSAPI_ERROR_OK) {
 | 
						|
            sys_sem_signal(&lwip_netif_linked);
 | 
						|
        } else if (dhcp_status != NSAPI_ERROR_OK) {
 | 
						|
            netif_set_down(lwip_netif);
 | 
						|
        }
 | 
						|
 | 
						|
 | 
						|
    } else {
 | 
						|
        sys_sem_signal(&lwip_netif_unlinked);
 | 
						|
        netif_set_down(lwip_netif);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
 | 
						|
 | 
						|
static char lwip_has_addr_state = 0;
 | 
						|
 | 
						|
#define HAS_ANY_ADDR  1
 | 
						|
static sys_sem_t lwip_netif_has_any_addr;
 | 
						|
#if PREF_ADDR_TIMEOUT
 | 
						|
#define HAS_PREF_ADDR 2
 | 
						|
static sys_sem_t lwip_netif_has_pref_addr;
 | 
						|
#endif
 | 
						|
#if BOTH_ADDR_TIMEOUT
 | 
						|
#define HAS_BOTH_ADDR 4
 | 
						|
static sys_sem_t lwip_netif_has_both_addr;
 | 
						|
#endif
 | 
						|
 | 
						|
 | 
						|
static void mbed_lwip_netif_status_irq(struct netif *lwip_netif)
 | 
						|
{
 | 
						|
    if (netif_is_up(lwip_netif)) {
 | 
						|
        bool dns_addr_has_to_be_added = false;
 | 
						|
        if (!(lwip_has_addr_state & HAS_ANY_ADDR) && mbed_lwip_get_ip_addr(true, lwip_netif)) {
 | 
						|
            if (lwip_blocking) {
 | 
						|
                sys_sem_signal(&lwip_netif_has_any_addr);
 | 
						|
            }
 | 
						|
            lwip_has_addr_state |= HAS_ANY_ADDR;
 | 
						|
            dns_addr_has_to_be_added = true;
 | 
						|
        }
 | 
						|
#if PREF_ADDR_TIMEOUT
 | 
						|
        if (!(lwip_has_addr_state & HAS_PREF_ADDR) && mbed_lwip_get_ip_addr(false, lwip_netif)) {
 | 
						|
            if (lwip_blocking) {
 | 
						|
                sys_sem_signal(&lwip_netif_has_pref_addr);
 | 
						|
            }
 | 
						|
            lwip_has_addr_state |= HAS_PREF_ADDR;
 | 
						|
            dns_addr_has_to_be_added = true;
 | 
						|
        }
 | 
						|
#endif
 | 
						|
#if BOTH_ADDR_TIMEOUT
 | 
						|
        if (!(lwip_has_addr_state & HAS_BOTH_ADDR) && mbed_lwip_get_ipv4_addr(lwip_netif) && mbed_lwip_get_ipv6_addr(lwip_netif)) {
 | 
						|
            if (lwip_blocking) {
 | 
						|
                sys_sem_signal(&lwip_netif_has_both_addr);
 | 
						|
            }
 | 
						|
            lwip_has_addr_state |= HAS_BOTH_ADDR;
 | 
						|
            dns_addr_has_to_be_added = true;
 | 
						|
        }
 | 
						|
#endif
 | 
						|
 | 
						|
        if (dns_addr_has_to_be_added && !lwip_blocking) {
 | 
						|
            add_dns_addr(lwip_netif);
 | 
						|
        }
 | 
						|
 | 
						|
    
 | 
						|
        if (lwip_has_addr_state & HAS_ANY_ADDR) {
 | 
						|
            lwip_connected = NSAPI_STATUS_GLOBAL_UP;
 | 
						|
        }
 | 
						|
    } else {
 | 
						|
        lwip_connected = NSAPI_STATUS_DISCONNECTED;
 | 
						|
    }
 | 
						|
 | 
						|
    if (lwip_client_callback) {
 | 
						|
        lwip_client_callback(lwip_status_cb_handle, NSAPI_EVENT_CONNECTION_STATUS_CHANGE, lwip_connected);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void mbed_lwip_set_blocking(bool blocking)
 | 
						|
{
 | 
						|
    lwip_blocking = blocking;
 | 
						|
}
 | 
						|
 | 
						|
void mbed_lwip_attach(mbed_lwip_client_callback client_callback, void *status_cb_handle)
 | 
						|
{
 | 
						|
    lwip_client_callback = client_callback;
 | 
						|
    lwip_status_cb_handle = status_cb_handle;
 | 
						|
}
 | 
						|
 | 
						|
nsapi_connection_status_t mbed_lwip_netif_status_check(void)
 | 
						|
{
 | 
						|
    return lwip_connected;
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
#if LWIP_ETHERNET
 | 
						|
static void mbed_lwip_set_mac_address(struct netif *netif)
 | 
						|
{
 | 
						|
#if (MBED_MAC_ADDRESS_SUM != MBED_MAC_ADDR_INTERFACE)
 | 
						|
    netif->hwaddr[0] = MBED_MAC_ADDR_0;
 | 
						|
    netif->hwaddr[1] = MBED_MAC_ADDR_1;
 | 
						|
    netif->hwaddr[2] = MBED_MAC_ADDR_2;
 | 
						|
    netif->hwaddr[3] = MBED_MAC_ADDR_3;
 | 
						|
    netif->hwaddr[4] = MBED_MAC_ADDR_4;
 | 
						|
    netif->hwaddr[5] = MBED_MAC_ADDR_5;
 | 
						|
#else
 | 
						|
    mbed_mac_address((char *)netif->hwaddr);
 | 
						|
#endif
 | 
						|
 | 
						|
    netif->hwaddr_len = ETH_HWADDR_LEN;
 | 
						|
 | 
						|
    /* Use mac address as additional seed to random number generator */
 | 
						|
    uint64_t seed = netif->hwaddr[0];
 | 
						|
    for (uint8_t i = 1; i < 8; i++) {
 | 
						|
        seed <<= 8;
 | 
						|
        seed |= netif->hwaddr[i % 6];
 | 
						|
    }
 | 
						|
    lwip_add_random_seed(seed);
 | 
						|
}
 | 
						|
 | 
						|
static void mbed_lwip_record_mac_address(const struct netif *netif)
 | 
						|
{
 | 
						|
    const u8_t *mac = netif->hwaddr;
 | 
						|
    snprintf(lwip_mac_address, NSAPI_MAC_SIZE, "%02x:%02x:%02x:%02x:%02x:%02x",
 | 
						|
             mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
 | 
						|
}
 | 
						|
#endif // LWIP_ETHERNET
 | 
						|
 | 
						|
/* LWIP interface implementation */
 | 
						|
const char *mbed_lwip_get_mac_address(void)
 | 
						|
{
 | 
						|
    return lwip_mac_address[0] ? lwip_mac_address : NULL;
 | 
						|
}
 | 
						|
 | 
						|
char *mbed_lwip_get_ip_address(char *buf, nsapi_size_t buflen)
 | 
						|
{
 | 
						|
    const ip_addr_t *addr = mbed_lwip_get_ip_addr(true, &lwip_netif);
 | 
						|
    if (!addr) {
 | 
						|
        return NULL;
 | 
						|
    }
 | 
						|
#if LWIP_IPV6
 | 
						|
    if (IP_IS_V6(addr)) {
 | 
						|
        return ip6addr_ntoa_r(ip_2_ip6(addr), buf, buflen);
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#if LWIP_IPV4
 | 
						|
    if (IP_IS_V4(addr)) {
 | 
						|
        return ip4addr_ntoa_r(ip_2_ip4(addr), buf, buflen);
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#if LWIP_IPV6 && LWIP_IPV4
 | 
						|
    return NULL;
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
char *mbed_lwip_get_netmask(char *buf, nsapi_size_t buflen)
 | 
						|
{
 | 
						|
#if LWIP_IPV4
 | 
						|
    const ip4_addr_t *addr = netif_ip4_netmask(&lwip_netif);
 | 
						|
    if (!ip4_addr_isany(addr)) {
 | 
						|
        return ip4addr_ntoa_r(addr, buf, buflen);
 | 
						|
    } else {
 | 
						|
        return NULL;
 | 
						|
    }
 | 
						|
#else
 | 
						|
    return NULL;
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
char *mbed_lwip_get_gateway(char *buf, nsapi_size_t buflen)
 | 
						|
{
 | 
						|
#if LWIP_IPV4
 | 
						|
    const ip4_addr_t *addr = netif_ip4_gw(&lwip_netif);
 | 
						|
    if (!ip4_addr_isany(addr)) {
 | 
						|
        return ip4addr_ntoa_r(addr, buf, buflen);
 | 
						|
    } else {
 | 
						|
        return NULL;
 | 
						|
    }
 | 
						|
#else
 | 
						|
    return NULL;
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
static void mbed_lwip_core_init(void)
 | 
						|
{
 | 
						|
 | 
						|
    // Check if we've already brought up lwip
 | 
						|
    if (!lwip_inited) {
 | 
						|
	// Seed lwip random
 | 
						|
        lwip_seed_random();
 | 
						|
 | 
						|
        // Initialise TCP sequence number
 | 
						|
        uint32_t tcp_isn_secret[4];
 | 
						|
        for (int i = 0; i < 4; i++) {
 | 
						|
            tcp_isn_secret[i] = LWIP_RAND();
 | 
						|
        }
 | 
						|
        lwip_init_tcp_isn(0, (u8_t *) &tcp_isn_secret);
 | 
						|
 | 
						|
        sys_sem_new(&lwip_tcpip_inited, 0);
 | 
						|
        sys_sem_new(&lwip_netif_linked, 0);
 | 
						|
        sys_sem_new(&lwip_netif_unlinked, 0);
 | 
						|
        sys_sem_new(&lwip_netif_has_any_addr, 0);
 | 
						|
#if PREF_ADDR_TIMEOUT
 | 
						|
        sys_sem_new(&lwip_netif_has_pref_addr, 0);
 | 
						|
#endif
 | 
						|
#if BOTH_ADDR_TIMEOUT
 | 
						|
        sys_sem_new(&lwip_netif_has_both_addr, 0);
 | 
						|
#endif
 | 
						|
        tcpip_init(mbed_lwip_tcpip_init_irq, NULL);
 | 
						|
        sys_arch_sem_wait(&lwip_tcpip_inited, 0);
 | 
						|
 | 
						|
        lwip_inited = true;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
nsapi_error_t mbed_lwip_emac_init(emac_interface_t *emac)
 | 
						|
{
 | 
						|
#if LWIP_ETHERNET
 | 
						|
    // Choose a MAC address - driver can override
 | 
						|
    mbed_lwip_set_mac_address(&lwip_netif);
 | 
						|
    // Set up network
 | 
						|
    if (!netif_add(&lwip_netif,
 | 
						|
#if LWIP_IPV4
 | 
						|
                   0, 0, 0,
 | 
						|
#endif
 | 
						|
                   emac, MBED_NETIF_INIT_FN, tcpip_input)) {
 | 
						|
        return NSAPI_ERROR_DEVICE_ERROR;
 | 
						|
    }
 | 
						|
    // Note the MAC address actually in use
 | 
						|
    mbed_lwip_record_mac_address(&lwip_netif);
 | 
						|
#if !DEVICE_EMAC
 | 
						|
    eth_arch_enable_interrupts();
 | 
						|
#endif
 | 
						|
 | 
						|
    return NSAPI_ERROR_OK;
 | 
						|
#else
 | 
						|
    return NSAPI_ERROR_UNSUPPORTED;
 | 
						|
#endif //LWIP_ETHERNET
 | 
						|
}
 | 
						|
 | 
						|
// Backwards compatibility with people using DEVICE_EMAC
 | 
						|
nsapi_error_t mbed_lwip_init(emac_interface_t *emac)
 | 
						|
{
 | 
						|
    nsapi_error_t ret;
 | 
						|
    mbed_lwip_core_init();
 | 
						|
    ret = mbed_lwip_emac_init(emac);
 | 
						|
    if (ret == NSAPI_ERROR_OK) {
 | 
						|
        netif_inited = true;
 | 
						|
    }
 | 
						|
    return ret;
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
// Backwards compatibility with people using DEVICE_EMAC
 | 
						|
nsapi_error_t mbed_lwip_bringup(bool dhcp, const char *ip, const char *netmask, const char *gw)
 | 
						|
{
 | 
						|
    return mbed_lwip_bringup_2(dhcp, false, ip, netmask, gw, DEFAULT_STACK);
 | 
						|
}
 | 
						|
 | 
						|
nsapi_error_t mbed_lwip_bringup_2(bool dhcp, bool ppp, const char *ip, const char *netmask, const char *gw, 
 | 
						|
    const nsapi_ip_stack_t stack)
 | 
						|
{
 | 
						|
    // Check if we've already connected
 | 
						|
 
 | 
						|
    if (lwip_connected == NSAPI_STATUS_GLOBAL_UP) {
 | 
						|
        return NSAPI_ERROR_IS_CONNECTED;
 | 
						|
    } else if (lwip_connected == NSAPI_STATUS_CONNECTING) {
 | 
						|
        return NSAPI_ERROR_ALREADY;
 | 
						|
    }
 | 
						|
 | 
						|
    lwip_connected = NSAPI_STATUS_CONNECTING;
 | 
						|
    lwip_ppp = ppp;
 | 
						|
#if LWIP_DHCP
 | 
						|
    lwip_dhcp_has_to_be_set = true;
 | 
						|
    if (stack != IPV6_STACK) {
 | 
						|
        lwip_dhcp = dhcp;
 | 
						|
    } else {
 | 
						|
        lwip_dhcp = false;
 | 
						|
    }
 | 
						|
#endif
 | 
						|
    mbed_lwip_core_init();
 | 
						|
 | 
						|
    nsapi_error_t ret;
 | 
						|
    if (netif_inited) {
 | 
						|
        /* Can't cope with changing mode */
 | 
						|
        if (netif_is_ppp == ppp) {
 | 
						|
            ret = NSAPI_ERROR_OK;
 | 
						|
        } else {
 | 
						|
            ret = NSAPI_ERROR_PARAMETER;
 | 
						|
        }
 | 
						|
    } else {
 | 
						|
        if (ppp) {
 | 
						|
            ret = ppp_lwip_if_init(&lwip_netif, stack);
 | 
						|
        } else {
 | 
						|
            ret = mbed_lwip_emac_init(NULL);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    if (ret != NSAPI_ERROR_OK) {
 | 
						|
        lwip_connected = NSAPI_STATUS_DISCONNECTED;
 | 
						|
        return ret;
 | 
						|
    }
 | 
						|
 | 
						|
    
 | 
						|
    if (lwip_client_callback) {
 | 
						|
        lwip_client_callback(lwip_status_cb_handle, NSAPI_EVENT_CONNECTION_STATUS_CHANGE, NSAPI_STATUS_CONNECTING);
 | 
						|
    }
 | 
						|
 | 
						|
    netif_inited = true;
 | 
						|
    if (ppp) {
 | 
						|
        netif_is_ppp = ppp;
 | 
						|
    }
 | 
						|
 | 
						|
    netif_set_default(&lwip_netif);
 | 
						|
    netif_set_link_callback(&lwip_netif, mbed_lwip_netif_link_irq);
 | 
						|
    netif_set_status_callback(&lwip_netif, mbed_lwip_netif_status_irq);
 | 
						|
 | 
						|
#if LWIP_IPV6
 | 
						|
    if (stack != IPV4_STACK) {
 | 
						|
        if (lwip_netif.hwaddr_len == ETH_HWADDR_LEN) {
 | 
						|
            netif_create_ip6_linklocal_address(&lwip_netif, 1/*from MAC*/);
 | 
						|
        }
 | 
						|
 | 
						|
#if LWIP_IPV6_MLD
 | 
						|
        /*
 | 
						|
         * For hardware/netifs that implement MAC filtering.
 | 
						|
         * All-nodes link-local is handled by default, so we must let the hardware know
 | 
						|
         * to allow multicast packets in.
 | 
						|
         * Should set mld_mac_filter previously. */
 | 
						|
        if (lwip_netif.mld_mac_filter != NULL) {
 | 
						|
            ip6_addr_t ip6_allnodes_ll;
 | 
						|
            ip6_addr_set_allnodes_linklocal(&ip6_allnodes_ll);
 | 
						|
            lwip_netif.mld_mac_filter(&lwip_netif, &ip6_allnodes_ll, NETIF_ADD_MAC_FILTER);
 | 
						|
        }
 | 
						|
#endif /* LWIP_IPV6_MLD */
 | 
						|
 | 
						|
#if LWIP_IPV6_AUTOCONFIG
 | 
						|
        /* IPv6 address autoconfiguration not enabled by default */
 | 
						|
        lwip_netif.ip6_autoconfig_enabled = 1;
 | 
						|
    } else {
 | 
						|
        // Disable router solidifications
 | 
						|
        lwip_netif.rs_count = 0;
 | 
						|
    }
 | 
						|
#endif /* LWIP_IPV6_AUTOCONFIG */
 | 
						|
#endif // LWIP_IPV6
 | 
						|
 | 
						|
#if LWIP_IPV4
 | 
						|
    if (stack != IPV6_STACK) {
 | 
						|
        if (!dhcp && !ppp) {
 | 
						|
            ip4_addr_t ip_addr;
 | 
						|
            ip4_addr_t netmask_addr;
 | 
						|
            ip4_addr_t gw_addr;
 | 
						|
 | 
						|
            if (!inet_aton(ip, &ip_addr) ||
 | 
						|
                !inet_aton(netmask, &netmask_addr) ||
 | 
						|
                !inet_aton(gw, &gw_addr)) {
 | 
						|
                lwip_connected = NSAPI_STATUS_DISCONNECTED;
 | 
						|
                if (lwip_client_callback) {
 | 
						|
                    lwip_client_callback(lwip_status_cb_handle, NSAPI_EVENT_CONNECTION_STATUS_CHANGE, NSAPI_STATUS_DISCONNECTED);
 | 
						|
                }
 | 
						|
                return NSAPI_ERROR_PARAMETER;
 | 
						|
            }
 | 
						|
 | 
						|
            netif_set_addr(&lwip_netif, &ip_addr, &netmask_addr, &gw_addr);
 | 
						|
        }
 | 
						|
    }
 | 
						|
#endif
 | 
						|
 | 
						|
    if (ppp) {
 | 
						|
       err_t err = ppp_lwip_connect();
 | 
						|
       if (err) {
 | 
						|
           lwip_connected = NSAPI_STATUS_DISCONNECTED;
 | 
						|
           if (lwip_client_callback) {
 | 
						|
               lwip_client_callback(lwip_status_cb_handle, NSAPI_EVENT_CONNECTION_STATUS_CHANGE, NSAPI_STATUS_DISCONNECTED);
 | 
						|
           }
 | 
						|
           return mbed_lwip_err_remap(err);
 | 
						|
       }
 | 
						|
    }
 | 
						|
 | 
						|
 | 
						|
 | 
						|
    if (!netif_is_link_up(&lwip_netif)) {
 | 
						|
        if (lwip_blocking) {
 | 
						|
            if (sys_arch_sem_wait(&lwip_netif_linked, 15000) == SYS_ARCH_TIMEOUT) {
 | 
						|
                if (ppp) {
 | 
						|
                    ppp_lwip_disconnect();
 | 
						|
                }
 | 
						|
                return NSAPI_ERROR_NO_CONNECTION;
 | 
						|
            }
 | 
						|
        }
 | 
						|
    } else {
 | 
						|
        ret = mbed_set_dhcp(&lwip_netif);
 | 
						|
        if (ret != NSAPI_ERROR_OK) {
 | 
						|
            return ret;
 | 
						|
        }
 | 
						|
    }
 | 
						|
        
 | 
						|
    if (lwip_blocking) {
 | 
						|
        // If doesn't have address
 | 
						|
        if (!mbed_lwip_get_ip_addr(true, &lwip_netif)) {
 | 
						|
            if (sys_arch_sem_wait(&lwip_netif_has_any_addr, DHCP_TIMEOUT * 1000) == SYS_ARCH_TIMEOUT) {
 | 
						|
                if (ppp) {
 | 
						|
                    ppp_lwip_disconnect();
 | 
						|
                }
 | 
						|
                return NSAPI_ERROR_DHCP_FAILURE;
 | 
						|
            }
 | 
						|
        }
 | 
						|
    } else {
 | 
						|
        return NSAPI_ERROR_OK;
 | 
						|
    }
 | 
						|
 | 
						|
#if PREF_ADDR_TIMEOUT
 | 
						|
    if (stack != IPV4_STACK && stack != IPV6_STACK) {
 | 
						|
        // If address is not for preferred stack waits a while to see
 | 
						|
        // if preferred stack address is acquired
 | 
						|
        if (!mbed_lwip_get_ip_addr(false, &lwip_netif)) {
 | 
						|
            sys_arch_sem_wait(&lwip_netif_has_pref_addr, PREF_ADDR_TIMEOUT * 1000);
 | 
						|
        }
 | 
						|
    }
 | 
						|
#endif
 | 
						|
#if BOTH_ADDR_TIMEOUT
 | 
						|
    if (stack != IPV4_STACK && stack != IPV6_STACK) {
 | 
						|
        // If addresses for both stacks are not available waits a while to
 | 
						|
        // see if address for both stacks are acquired
 | 
						|
        if (!(mbed_lwip_get_ipv4_addr(&lwip_netif) && mbed_lwip_get_ipv6_addr(&lwip_netif))) {
 | 
						|
            sys_arch_sem_wait(&lwip_netif_has_both_addr, BOTH_ADDR_TIMEOUT * 1000);
 | 
						|
        }
 | 
						|
    }
 | 
						|
#endif
 | 
						|
 | 
						|
    add_dns_addr(&lwip_netif);
 | 
						|
 | 
						|
    return NSAPI_ERROR_OK;
 | 
						|
}
 | 
						|
 | 
						|
#if LWIP_IPV6
 | 
						|
void mbed_lwip_clear_ipv6_addresses(struct netif *lwip_netif)
 | 
						|
{
 | 
						|
    for (u8_t i = 0; i < LWIP_IPV6_NUM_ADDRESSES; i++) {
 | 
						|
        netif_ip6_addr_set_state(lwip_netif, i, IP6_ADDR_INVALID);
 | 
						|
    }
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
// Backwards compatibility with people using DEVICE_EMAC
 | 
						|
nsapi_error_t mbed_lwip_bringdown(void)
 | 
						|
{
 | 
						|
    return mbed_lwip_bringdown_2(false);
 | 
						|
}
 | 
						|
 | 
						|
nsapi_error_t mbed_lwip_bringdown_2(bool ppp)
 | 
						|
{
 | 
						|
    // Check if we've connected
 | 
						|
    if (lwip_connected == NSAPI_STATUS_DISCONNECTED) {
 | 
						|
        return NSAPI_ERROR_PARAMETER;
 | 
						|
    }
 | 
						|
 | 
						|
#if LWIP_DHCP
 | 
						|
    // Disconnect from the network
 | 
						|
    if (lwip_dhcp) {
 | 
						|
        dhcp_release(&lwip_netif);
 | 
						|
        dhcp_stop(&lwip_netif);
 | 
						|
        lwip_dhcp = false;
 | 
						|
        lwip_dhcp_has_to_be_set = false;
 | 
						|
    }
 | 
						|
#endif
 | 
						|
 | 
						|
    if (ppp) {
 | 
						|
        /* this is a blocking call, returns when PPP is properly closed */
 | 
						|
       err_t err = ppp_lwip_disconnect();
 | 
						|
       if (err) {
 | 
						|
           return mbed_lwip_err_remap(err);
 | 
						|
       }
 | 
						|
       MBED_ASSERT(!netif_is_link_up(&lwip_netif));
 | 
						|
       /*if (netif_is_link_up(&lwip_netif)) {
 | 
						|
           if (sys_arch_sem_wait(&lwip_netif_unlinked, 15000) == SYS_ARCH_TIMEOUT) {
 | 
						|
               return NSAPI_ERROR_DEVICE_ERROR;
 | 
						|
           }
 | 
						|
       }*/
 | 
						|
    } else {
 | 
						|
        netif_set_down(&lwip_netif);
 | 
						|
    }
 | 
						|
 | 
						|
#if LWIP_IPV6
 | 
						|
    mbed_lwip_clear_ipv6_addresses(&lwip_netif);
 | 
						|
#endif
 | 
						|
 | 
						|
    sys_sem_free(&lwip_netif_has_any_addr);
 | 
						|
    sys_sem_new(&lwip_netif_has_any_addr, 0);
 | 
						|
#if PREF_ADDR_TIMEOUT
 | 
						|
    sys_sem_free(&lwip_netif_has_pref_addr);
 | 
						|
    sys_sem_new(&lwip_netif_has_pref_addr, 0);
 | 
						|
#endif
 | 
						|
#if BOTH_ADDR_TIMEOUT
 | 
						|
    sys_sem_free(&lwip_netif_has_both_addr);
 | 
						|
    sys_sem_new(&lwip_netif_has_both_addr, 0);
 | 
						|
#endif
 | 
						|
    lwip_has_addr_state = 0;
 | 
						|
    lwip_connected = NSAPI_STATUS_DISCONNECTED;
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
/* LWIP error remapping */
 | 
						|
static nsapi_error_t mbed_lwip_err_remap(err_t err) {
 | 
						|
    switch (err) {
 | 
						|
        case ERR_OK:
 | 
						|
        case ERR_CLSD:
 | 
						|
            return 0;
 | 
						|
        case ERR_MEM:
 | 
						|
        case ERR_BUF:
 | 
						|
            return NSAPI_ERROR_NO_MEMORY;
 | 
						|
        case ERR_CONN:
 | 
						|
        case ERR_RST:
 | 
						|
        case ERR_ABRT:
 | 
						|
            return NSAPI_ERROR_NO_CONNECTION;
 | 
						|
        case ERR_TIMEOUT:
 | 
						|
        case ERR_RTE:
 | 
						|
        case ERR_WOULDBLOCK:
 | 
						|
            return NSAPI_ERROR_WOULD_BLOCK;
 | 
						|
        case ERR_VAL:
 | 
						|
        case ERR_USE:
 | 
						|
        case ERR_ARG:
 | 
						|
            return NSAPI_ERROR_PARAMETER;
 | 
						|
        case ERR_INPROGRESS:
 | 
						|
            return NSAPI_ERROR_IN_PROGRESS;
 | 
						|
        case ERR_ALREADY:
 | 
						|
            return NSAPI_ERROR_ALREADY;
 | 
						|
        case ERR_ISCONN:
 | 
						|
            return NSAPI_ERROR_IS_CONNECTED;
 | 
						|
        default:
 | 
						|
            return NSAPI_ERROR_DEVICE_ERROR;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
/* LWIP network stack implementation */
 | 
						|
static nsapi_error_t mbed_lwip_gethostbyname(nsapi_stack_t *stack, const char *host, nsapi_addr_t *addr, nsapi_version_t version)
 | 
						|
{
 | 
						|
    ip_addr_t lwip_addr;
 | 
						|
 | 
						|
#if LWIP_IPV4 && LWIP_IPV6
 | 
						|
    u8_t addr_type;
 | 
						|
    if (version == NSAPI_UNSPEC) {
 | 
						|
        const ip_addr_t *ip_addr;
 | 
						|
        ip_addr = mbed_lwip_get_ip_addr(true, &lwip_netif);
 | 
						|
        // Prefer IPv6
 | 
						|
        if (IP_IS_V6(ip_addr)) {
 | 
						|
            // If IPv4 is available use it as backup
 | 
						|
            if (mbed_lwip_get_ipv4_addr(&lwip_netif)) {
 | 
						|
                addr_type = NETCONN_DNS_IPV6_IPV4;
 | 
						|
            } else {
 | 
						|
                addr_type = NETCONN_DNS_IPV6;
 | 
						|
            }
 | 
						|
        // Prefer IPv4
 | 
						|
        } else {
 | 
						|
            // If IPv6 is available use it as backup
 | 
						|
            if (mbed_lwip_get_ipv6_addr(&lwip_netif)) {
 | 
						|
                addr_type = NETCONN_DNS_IPV4_IPV6;
 | 
						|
            } else {
 | 
						|
                addr_type = NETCONN_DNS_IPV4;
 | 
						|
            }
 | 
						|
        }
 | 
						|
    } else if (version == NSAPI_IPv4) {
 | 
						|
        addr_type = NETCONN_DNS_IPV4;
 | 
						|
    } else if (version == NSAPI_IPv6) {
 | 
						|
        addr_type = NETCONN_DNS_IPV6;
 | 
						|
    } else {
 | 
						|
        return NSAPI_ERROR_DNS_FAILURE;
 | 
						|
    }
 | 
						|
    err_t err = netconn_gethostbyname_addrtype(host, &lwip_addr, addr_type);
 | 
						|
#elif LWIP_IPV4
 | 
						|
    if (version != NSAPI_IPv4 && version != NSAPI_UNSPEC) {
 | 
						|
        return NSAPI_ERROR_DNS_FAILURE;
 | 
						|
    }
 | 
						|
    err_t err = netconn_gethostbyname(host, &lwip_addr);
 | 
						|
#elif LWIP_IPV6
 | 
						|
    if (version != NSAPI_IPv6 && version != NSAPI_UNSPEC) {
 | 
						|
        return NSAPI_ERROR_DNS_FAILURE;
 | 
						|
    }
 | 
						|
    err_t err = netconn_gethostbyname(host, &lwip_addr);
 | 
						|
#endif
 | 
						|
 | 
						|
    if (err != ERR_OK) {
 | 
						|
        return NSAPI_ERROR_DNS_FAILURE;
 | 
						|
    }
 | 
						|
 | 
						|
    convert_lwip_addr_to_mbed(addr, &lwip_addr);
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_add_dns_server(nsapi_stack_t *stack, nsapi_addr_t addr)
 | 
						|
{
 | 
						|
    // Shift all dns servers down to give precedence to new server
 | 
						|
    for (int i = DNS_MAX_SERVERS-1; i > 0; i--) {
 | 
						|
        dns_setserver(i, dns_getserver(i-1));
 | 
						|
    }
 | 
						|
 | 
						|
    ip_addr_t ip_addr;
 | 
						|
    if (!convert_mbed_addr_to_lwip(&ip_addr, &addr)) {
 | 
						|
        return NSAPI_ERROR_PARAMETER;
 | 
						|
    }
 | 
						|
 | 
						|
    dns_setserver(0, &ip_addr);
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_socket_open(nsapi_stack_t *stack, nsapi_socket_t *handle, nsapi_protocol_t proto)
 | 
						|
{
 | 
						|
    // check if network is connected
 | 
						|
    if (lwip_connected == NSAPI_STATUS_DISCONNECTED) {
 | 
						|
        return NSAPI_ERROR_NO_CONNECTION;
 | 
						|
    }
 | 
						|
 | 
						|
    // allocate a socket
 | 
						|
    struct lwip_socket *s = mbed_lwip_arena_alloc();
 | 
						|
    if (!s) {
 | 
						|
        return NSAPI_ERROR_NO_SOCKET;
 | 
						|
    }
 | 
						|
 | 
						|
    enum netconn_type lwip_proto = proto == NSAPI_TCP ? NETCONN_TCP : NETCONN_UDP;
 | 
						|
 | 
						|
#if LWIP_IPV6
 | 
						|
    // Enable IPv6 (or dual-stack)
 | 
						|
    lwip_proto |= NETCONN_TYPE_IPV6;
 | 
						|
#endif
 | 
						|
 | 
						|
    s->conn = netconn_new_with_callback(lwip_proto, mbed_lwip_socket_callback);
 | 
						|
 | 
						|
    if (!s->conn) {
 | 
						|
        mbed_lwip_arena_dealloc(s);
 | 
						|
        return NSAPI_ERROR_NO_SOCKET;
 | 
						|
    }
 | 
						|
 | 
						|
    netconn_set_recvtimeout(s->conn, 1);
 | 
						|
    *(struct lwip_socket **)handle = s;
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_socket_close(nsapi_stack_t *stack, nsapi_socket_t handle)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
 | 
						|
    netbuf_delete(s->buf);
 | 
						|
    err_t err = netconn_delete(s->conn);
 | 
						|
    mbed_lwip_arena_dealloc(s);
 | 
						|
    return mbed_lwip_err_remap(err);
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_socket_bind(nsapi_stack_t *stack, nsapi_socket_t handle, nsapi_addr_t addr, uint16_t port)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
    ip_addr_t ip_addr;
 | 
						|
 | 
						|
    if (
 | 
						|
#if LWIP_TCP
 | 
						|
        (s->conn->type == NETCONN_TCP && s->conn->pcb.tcp->local_port != 0) ||
 | 
						|
#endif
 | 
						|
        (s->conn->type == NETCONN_UDP && s->conn->pcb.udp->local_port != 0)) {
 | 
						|
        return NSAPI_ERROR_PARAMETER;
 | 
						|
    }
 | 
						|
 | 
						|
    if (!convert_mbed_addr_to_lwip(&ip_addr, &addr)) {
 | 
						|
        return NSAPI_ERROR_PARAMETER;
 | 
						|
    }
 | 
						|
 | 
						|
    if (!ip_addr_isany(&ip_addr) && !mbed_lwip_is_local_addr(&ip_addr)) {
 | 
						|
        return NSAPI_ERROR_PARAMETER;
 | 
						|
    }
 | 
						|
 | 
						|
    err_t err = netconn_bind(s->conn, &ip_addr, port);
 | 
						|
    return mbed_lwip_err_remap(err);
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_socket_listen(nsapi_stack_t *stack, nsapi_socket_t handle, int backlog)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
 | 
						|
    if (s->conn->pcb.tcp->local_port == 0) {
 | 
						|
        return NSAPI_ERROR_PARAMETER;
 | 
						|
    }
 | 
						|
 | 
						|
    err_t err = netconn_listen_with_backlog(s->conn, backlog);
 | 
						|
    return mbed_lwip_err_remap(err);
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_socket_connect(nsapi_stack_t *stack, nsapi_socket_t handle, nsapi_addr_t addr, uint16_t port)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
    ip_addr_t ip_addr;
 | 
						|
 | 
						|
    if (!convert_mbed_addr_to_lwip(&ip_addr, &addr)) {
 | 
						|
        return NSAPI_ERROR_PARAMETER;
 | 
						|
    }
 | 
						|
 | 
						|
    netconn_set_nonblocking(s->conn, false);
 | 
						|
    err_t err = netconn_connect(s->conn, &ip_addr, port);
 | 
						|
    netconn_set_nonblocking(s->conn, true);
 | 
						|
 | 
						|
    return mbed_lwip_err_remap(err);
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_socket_accept(nsapi_stack_t *stack, nsapi_socket_t server, nsapi_socket_t *handle, nsapi_addr_t *addr, uint16_t *port)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)server;
 | 
						|
    struct lwip_socket *ns = mbed_lwip_arena_alloc();
 | 
						|
    if (!ns) {
 | 
						|
        return NSAPI_ERROR_NO_SOCKET;
 | 
						|
    }
 | 
						|
 | 
						|
    if (s->conn->pcb.tcp->state != LISTEN) {
 | 
						|
        return NSAPI_ERROR_PARAMETER;
 | 
						|
    }
 | 
						|
 | 
						|
    err_t err = netconn_accept(s->conn, &ns->conn);
 | 
						|
    if (err != ERR_OK) {
 | 
						|
        mbed_lwip_arena_dealloc(ns);
 | 
						|
        return mbed_lwip_err_remap(err);
 | 
						|
    }
 | 
						|
 | 
						|
    netconn_set_recvtimeout(ns->conn, 1);
 | 
						|
    *(struct lwip_socket **)handle = ns;
 | 
						|
 | 
						|
    ip_addr_t peer_addr;
 | 
						|
    (void) netconn_peer(ns->conn, &peer_addr, port);
 | 
						|
    convert_lwip_addr_to_mbed(addr, &peer_addr);
 | 
						|
 | 
						|
    netconn_set_nonblocking(ns->conn, true);
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_size_or_error_t mbed_lwip_socket_send(nsapi_stack_t *stack, nsapi_socket_t handle, const void *data, nsapi_size_t size)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
    size_t bytes_written = 0;
 | 
						|
 | 
						|
    err_t err = netconn_write_partly(s->conn, data, size, NETCONN_COPY, &bytes_written);
 | 
						|
    if (err != ERR_OK) {
 | 
						|
        return mbed_lwip_err_remap(err);
 | 
						|
    }
 | 
						|
 | 
						|
    return (nsapi_size_or_error_t)bytes_written;
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_size_or_error_t mbed_lwip_socket_recv(nsapi_stack_t *stack, nsapi_socket_t handle, void *data, nsapi_size_t size)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
 | 
						|
    if (!s->buf) {
 | 
						|
        err_t err = netconn_recv(s->conn, &s->buf);
 | 
						|
        s->offset = 0;
 | 
						|
 | 
						|
        if (err != ERR_OK) {
 | 
						|
            return mbed_lwip_err_remap(err);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    u16_t recv = netbuf_copy_partial(s->buf, data, (u16_t)size, s->offset);
 | 
						|
    s->offset += recv;
 | 
						|
 | 
						|
    if (s->offset >= netbuf_len(s->buf)) {
 | 
						|
        netbuf_delete(s->buf);
 | 
						|
        s->buf = 0;
 | 
						|
    }
 | 
						|
 | 
						|
    return recv;
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_size_or_error_t mbed_lwip_socket_sendto(nsapi_stack_t *stack, nsapi_socket_t handle, nsapi_addr_t addr, uint16_t port, const void *data, nsapi_size_t size)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
    ip_addr_t ip_addr;
 | 
						|
 | 
						|
    if (!convert_mbed_addr_to_lwip(&ip_addr, &addr)) {
 | 
						|
        return NSAPI_ERROR_PARAMETER;
 | 
						|
    }
 | 
						|
 | 
						|
    struct netbuf *buf = netbuf_new();
 | 
						|
    err_t err = netbuf_ref(buf, data, (u16_t)size);
 | 
						|
    if (err != ERR_OK) {
 | 
						|
        netbuf_free(buf);
 | 
						|
        return mbed_lwip_err_remap(err);
 | 
						|
    }
 | 
						|
 | 
						|
    err = netconn_sendto(s->conn, buf, &ip_addr, port);
 | 
						|
    netbuf_delete(buf);
 | 
						|
    if (err != ERR_OK) {
 | 
						|
        return mbed_lwip_err_remap(err);
 | 
						|
    }
 | 
						|
 | 
						|
    return size;
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_size_or_error_t mbed_lwip_socket_recvfrom(nsapi_stack_t *stack, nsapi_socket_t handle, nsapi_addr_t *addr, uint16_t *port, void *data, nsapi_size_t size)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
    struct netbuf *buf;
 | 
						|
 | 
						|
    err_t err = netconn_recv(s->conn, &buf);
 | 
						|
    if (err != ERR_OK) {
 | 
						|
        return mbed_lwip_err_remap(err);
 | 
						|
    }
 | 
						|
 | 
						|
    convert_lwip_addr_to_mbed(addr, netbuf_fromaddr(buf));
 | 
						|
    *port = netbuf_fromport(buf);
 | 
						|
 | 
						|
    u16_t recv = netbuf_copy(buf, data, (u16_t)size);
 | 
						|
    netbuf_delete(buf);
 | 
						|
 | 
						|
    return recv;
 | 
						|
}
 | 
						|
 | 
						|
static int32_t find_multicast_member(const struct lwip_socket *s, const nsapi_ip_mreq_t *imr) {
 | 
						|
    uint32_t count = 0;
 | 
						|
    uint32_t index = 0;
 | 
						|
    // Set upper limit on while loop, should break out when the membership pair is found
 | 
						|
    while (count < s->multicast_memberships_count) {
 | 
						|
        index = next_registered_multicast_member(s, index);
 | 
						|
 | 
						|
        if (memcmp(&s->multicast_memberships[index].imr_multiaddr, &imr->imr_multiaddr, sizeof(nsapi_addr_t)) == 0 &&
 | 
						|
           memcmp(&s->multicast_memberships[index].imr_interface, &imr->imr_interface, sizeof(nsapi_addr_t)) == 0) {
 | 
						|
            return index;
 | 
						|
        }
 | 
						|
        count++;
 | 
						|
        index++;
 | 
						|
    }
 | 
						|
 | 
						|
    return -1;
 | 
						|
}
 | 
						|
 | 
						|
static nsapi_error_t mbed_lwip_setsockopt(nsapi_stack_t *stack, nsapi_socket_t handle, int level, int optname, const void *optval, unsigned optlen)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
 | 
						|
    switch (optname) {
 | 
						|
#if LWIP_TCP
 | 
						|
        case NSAPI_KEEPALIVE:
 | 
						|
            if (optlen != sizeof(int) || s->conn->type != NETCONN_TCP) {
 | 
						|
                return NSAPI_ERROR_UNSUPPORTED;
 | 
						|
            }
 | 
						|
 | 
						|
            s->conn->pcb.tcp->so_options |= SOF_KEEPALIVE;
 | 
						|
            return 0;
 | 
						|
 | 
						|
        case NSAPI_KEEPIDLE:
 | 
						|
            if (optlen != sizeof(int) || s->conn->type != NETCONN_TCP) {
 | 
						|
                return NSAPI_ERROR_UNSUPPORTED;
 | 
						|
            }
 | 
						|
 | 
						|
            s->conn->pcb.tcp->keep_idle = *(int*)optval;
 | 
						|
            return 0;
 | 
						|
 | 
						|
        case NSAPI_KEEPINTVL:
 | 
						|
            if (optlen != sizeof(int) || s->conn->type != NETCONN_TCP) {
 | 
						|
                return NSAPI_ERROR_UNSUPPORTED;
 | 
						|
            }
 | 
						|
 | 
						|
            s->conn->pcb.tcp->keep_intvl = *(int*)optval;
 | 
						|
            return 0;
 | 
						|
#endif
 | 
						|
 | 
						|
        case NSAPI_REUSEADDR:
 | 
						|
            if (optlen != sizeof(int)) {
 | 
						|
                return NSAPI_ERROR_UNSUPPORTED;
 | 
						|
            }
 | 
						|
 | 
						|
            if (*(int *)optval) {
 | 
						|
                ip_set_option(s->conn->pcb.ip, SOF_REUSEADDR);
 | 
						|
            } else {
 | 
						|
                ip_reset_option(s->conn->pcb.ip, SOF_REUSEADDR);
 | 
						|
            }
 | 
						|
            return 0;
 | 
						|
 | 
						|
        case NSAPI_ADD_MEMBERSHIP:
 | 
						|
        case NSAPI_DROP_MEMBERSHIP: {
 | 
						|
            if (optlen != sizeof(nsapi_ip_mreq_t)) {
 | 
						|
                return NSAPI_ERROR_PARAMETER;
 | 
						|
            }
 | 
						|
            err_t igmp_err;
 | 
						|
            const nsapi_ip_mreq_t *imr = optval;
 | 
						|
 | 
						|
            /* Check interface address type matches group, or is unspecified */
 | 
						|
            if (imr->imr_interface.version != NSAPI_UNSPEC && imr->imr_interface.version != imr->imr_multiaddr.version) {
 | 
						|
                return NSAPI_ERROR_PARAMETER;
 | 
						|
            }
 | 
						|
 | 
						|
            ip_addr_t if_addr;
 | 
						|
            ip_addr_t multi_addr;
 | 
						|
 | 
						|
            /* Convert the group address */
 | 
						|
            if (!convert_mbed_addr_to_lwip(&multi_addr, &imr->imr_multiaddr)) {
 | 
						|
                return NSAPI_ERROR_PARAMETER;
 | 
						|
            }
 | 
						|
 | 
						|
            /* Convert the interface address, or make sure it's the correct sort of "any" */
 | 
						|
            if (imr->imr_interface.version != NSAPI_UNSPEC) {
 | 
						|
                if (!convert_mbed_addr_to_lwip(&if_addr, &imr->imr_interface)) {
 | 
						|
                    return NSAPI_ERROR_PARAMETER;
 | 
						|
                }
 | 
						|
            } else {
 | 
						|
                ip_addr_set_any(IP_IS_V6(&if_addr), &if_addr);
 | 
						|
            }
 | 
						|
 | 
						|
            igmp_err = ERR_USE; // Maps to NSAPI_ERROR_UNSUPPORTED
 | 
						|
            int32_t member_pair_index = find_multicast_member(s, imr);
 | 
						|
 | 
						|
            if (optname == NSAPI_ADD_MEMBERSHIP) {
 | 
						|
                if (!s->multicast_memberships) {
 | 
						|
                    // First multicast join on this socket, allocate space for membership tracking
 | 
						|
                    s->multicast_memberships = malloc(sizeof(nsapi_ip_mreq_t) * LWIP_SOCKET_MAX_MEMBERSHIPS);
 | 
						|
                    if (!s->multicast_memberships) {
 | 
						|
                        return NSAPI_ERROR_NO_MEMORY;
 | 
						|
                    }
 | 
						|
                } else if(s->multicast_memberships_count == LWIP_SOCKET_MAX_MEMBERSHIPS) {
 | 
						|
                    return NSAPI_ERROR_NO_MEMORY;
 | 
						|
                }
 | 
						|
 | 
						|
                if (member_pair_index != -1) {
 | 
						|
                    return NSAPI_ERROR_ADDRESS_IN_USE;
 | 
						|
                }
 | 
						|
 | 
						|
                member_pair_index = next_free_multicast_member(s, 0);
 | 
						|
 | 
						|
                sys_prot_t prot = sys_arch_protect();
 | 
						|
 | 
						|
                #if LWIP_IPV4
 | 
						|
                if (IP_IS_V4(&if_addr)) {
 | 
						|
                    igmp_err = igmp_joingroup(ip_2_ip4(&if_addr), ip_2_ip4(&multi_addr));
 | 
						|
                }
 | 
						|
                #endif
 | 
						|
                #if LWIP_IPV6
 | 
						|
                if (IP_IS_V6(&if_addr)) {
 | 
						|
                    igmp_err = mld6_joingroup(ip_2_ip6(&if_addr), ip_2_ip6(&multi_addr));
 | 
						|
                }
 | 
						|
                #endif
 | 
						|
 | 
						|
                sys_arch_unprotect(prot);
 | 
						|
 | 
						|
                if (igmp_err == ERR_OK) {
 | 
						|
                    set_multicast_member_registry_bit(s, member_pair_index);
 | 
						|
                    s->multicast_memberships[member_pair_index] = *imr;
 | 
						|
                    s->multicast_memberships_count++;
 | 
						|
                }
 | 
						|
            } else {
 | 
						|
                if (member_pair_index == -1) {
 | 
						|
                    return NSAPI_ERROR_NO_ADDRESS;
 | 
						|
                }
 | 
						|
 | 
						|
                clear_multicast_member_registry_bit(s, member_pair_index);
 | 
						|
                s->multicast_memberships_count--;
 | 
						|
 | 
						|
                sys_prot_t prot = sys_arch_protect();
 | 
						|
 | 
						|
                #if LWIP_IPV4
 | 
						|
                if (IP_IS_V4(&if_addr)) {
 | 
						|
                    igmp_err = igmp_leavegroup(ip_2_ip4(&if_addr), ip_2_ip4(&multi_addr));
 | 
						|
                }
 | 
						|
                #endif
 | 
						|
                #if LWIP_IPV6
 | 
						|
                if (IP_IS_V6(&if_addr)) {
 | 
						|
                    igmp_err = mld6_leavegroup(ip_2_ip6(&if_addr), ip_2_ip6(&multi_addr));
 | 
						|
                }
 | 
						|
                #endif
 | 
						|
 | 
						|
                sys_arch_unprotect(prot);
 | 
						|
            }
 | 
						|
 | 
						|
            return mbed_lwip_err_remap(igmp_err);
 | 
						|
         }
 | 
						|
 | 
						|
        default:
 | 
						|
            return NSAPI_ERROR_UNSUPPORTED;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static void mbed_lwip_socket_attach(nsapi_stack_t *stack, nsapi_socket_t handle, void (*callback)(void *), void *data)
 | 
						|
{
 | 
						|
    struct lwip_socket *s = (struct lwip_socket *)handle;
 | 
						|
 | 
						|
    s->cb = callback;
 | 
						|
    s->data = data;
 | 
						|
}
 | 
						|
 | 
						|
/* LWIP network stack */
 | 
						|
const nsapi_stack_api_t lwip_stack_api = {
 | 
						|
    .gethostbyname      = mbed_lwip_gethostbyname,
 | 
						|
    .add_dns_server     = mbed_lwip_add_dns_server,
 | 
						|
    .socket_open        = mbed_lwip_socket_open,
 | 
						|
    .socket_close       = mbed_lwip_socket_close,
 | 
						|
    .socket_bind        = mbed_lwip_socket_bind,
 | 
						|
    .socket_listen      = mbed_lwip_socket_listen,
 | 
						|
    .socket_connect     = mbed_lwip_socket_connect,
 | 
						|
    .socket_accept      = mbed_lwip_socket_accept,
 | 
						|
    .socket_send        = mbed_lwip_socket_send,
 | 
						|
    .socket_recv        = mbed_lwip_socket_recv,
 | 
						|
    .socket_sendto      = mbed_lwip_socket_sendto,
 | 
						|
    .socket_recvfrom    = mbed_lwip_socket_recvfrom,
 | 
						|
    .setsockopt         = mbed_lwip_setsockopt,
 | 
						|
    .socket_attach      = mbed_lwip_socket_attach,
 | 
						|
};
 | 
						|
 | 
						|
nsapi_stack_t lwip_stack = {
 | 
						|
    .stack_api = &lwip_stack_api,
 | 
						|
};
 |