Daiki Kato / LWIPBP3595Interface_for_mbed-os

LWIPBP3595Interface library for mbed-os.

Dependents:   LWIPBP3595Interface_STA_for_mbed-os

Fork of LWIPBP3595Interface by Rohm

lwip_wifi_stack.c@3:2ff2514e4fca, 2016-10-27 (annotated)

Committer:
dkato
Date:
Thu Oct 27 09:30:15 2016 +0000
Revision:
3:2ff2514e4fca
Parent:
2:c7e325599570
Child:
5:d03489ec5033
Supports mbed os 5.2.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dkato 2:c7e325599570 1 /* LWIP implementation of NetworkInterfaceAPI
dkato 2:c7e325599570 2 * Copyright (c) 2015 ARM Limited
dkato 2:c7e325599570 3 *
dkato 2:c7e325599570 4 * Licensed under the Apache License, Version 2.0 (the "License");
dkato 2:c7e325599570 5 * you may not use this file except in compliance with the License.
dkato 2:c7e325599570 6 * You may obtain a copy of the License at
dkato 2:c7e325599570 7 *
dkato 2:c7e325599570 8 * http://www.apache.org/licenses/LICENSE-2.0
dkato 2:c7e325599570 9 *
dkato 2:c7e325599570 10 * Unless required by applicable law or agreed to in writing, software
dkato 2:c7e325599570 11 * distributed under the License is distributed on an "AS IS" BASIS,
dkato 2:c7e325599570 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
dkato 2:c7e325599570 13 * See the License for the specific language governing permissions and
dkato 2:c7e325599570 14 * limitations under the License.
dkato 2:c7e325599570 15 */
dkato 2:c7e325599570 16
dkato 2:c7e325599570 17 #include "nsapi.h"
dkato 2:c7e325599570 18 #include "mbed_interface.h"
dkato 2:c7e325599570 19 #include <stdio.h>
dkato 2:c7e325599570 20 #include <stdbool.h>
dkato 2:c7e325599570 21 #include <string.h>
dkato 2:c7e325599570 22
dkato 2:c7e325599570 23 #include "wifi_arch.h"
dkato 2:c7e325599570 24 #include "lwip/opt.h"
dkato 2:c7e325599570 25 #include "lwip/api.h"
dkato 2:c7e325599570 26 #include "lwip/inet.h"
dkato 2:c7e325599570 27 #include "lwip/netif.h"
dkato 2:c7e325599570 28 #include "lwip/dhcp.h"
dkato 2:c7e325599570 29 #include "lwip/tcpip.h"
dkato 2:c7e325599570 30 #include "lwip/tcp.h"
dkato 2:c7e325599570 31 #include "lwip/ip.h"
dkato 3:2ff2514e4fca 32 #include "lwip/mld6.h"
dkato 3:2ff2514e4fca 33 #include "lwip/dns.h"
dkato 3:2ff2514e4fca 34 #include "lwip/udp.h"
dkato 2:c7e325599570 35
dkato 3:2ff2514e4fca 36 #include "emac_api.h"
dkato 3:2ff2514e4fca 37
dkato 3:2ff2514e4fca 38 #if DEVICE_EMAC
dkato 3:2ff2514e4fca 39 #define MBED_NETIF_INIT_FN emac_lwip_if_init
dkato 3:2ff2514e4fca 40 #else
dkato 3:2ff2514e4fca 41 #define MBED_NETIF_INIT_FN wifi_arch_enetif_init
dkato 3:2ff2514e4fca 42 #endif
dkato 3:2ff2514e4fca 43
dkato 3:2ff2514e4fca 44 #define DHCP_TIMEOUT 15000
dkato 2:c7e325599570 45
dkato 2:c7e325599570 46 /* Static arena of sockets */
dkato 2:c7e325599570 47 static struct lwip_socket {
dkato 2:c7e325599570 48 bool in_use;
dkato 2:c7e325599570 49
dkato 2:c7e325599570 50 struct netconn *conn;
dkato 2:c7e325599570 51 struct netbuf *buf;
dkato 2:c7e325599570 52 u16_t offset;
dkato 2:c7e325599570 53
dkato 2:c7e325599570 54 void (*cb)(void *);
dkato 2:c7e325599570 55 void *data;
dkato 2:c7e325599570 56 } lwip_arena[MEMP_NUM_NETCONN];
dkato 2:c7e325599570 57
dkato 3:2ff2514e4fca 58 static bool lwip_connected = false;
dkato 3:2ff2514e4fca 59
dkato 3:2ff2514e4fca 60 static void mbed_lwip_wifi_arena_init(void)
dkato 2:c7e325599570 61 {
dkato 2:c7e325599570 62 memset(lwip_arena, 0, sizeof lwip_arena);
dkato 2:c7e325599570 63 }
dkato 2:c7e325599570 64
dkato 3:2ff2514e4fca 65 static struct lwip_socket *mbed_lwip_wifi_arena_alloc(void)
dkato 2:c7e325599570 66 {
dkato 2:c7e325599570 67 sys_prot_t prot = sys_arch_protect();
dkato 2:c7e325599570 68
dkato 2:c7e325599570 69 for (int i = 0; i < MEMP_NUM_NETCONN; i++) {
dkato 2:c7e325599570 70 if (!lwip_arena[i].in_use) {
dkato 2:c7e325599570 71 struct lwip_socket *s = &lwip_arena[i];
dkato 2:c7e325599570 72 memset(s, 0, sizeof *s);
dkato 2:c7e325599570 73 s->in_use = true;
dkato 2:c7e325599570 74 sys_arch_unprotect(prot);
dkato 2:c7e325599570 75 return s;
dkato 2:c7e325599570 76 }
dkato 2:c7e325599570 77 }
dkato 2:c7e325599570 78
dkato 2:c7e325599570 79 sys_arch_unprotect(prot);
dkato 2:c7e325599570 80 return 0;
dkato 2:c7e325599570 81 }
dkato 2:c7e325599570 82
dkato 3:2ff2514e4fca 83 static void mbed_lwip_wifi_arena_dealloc(struct lwip_socket *s)
dkato 2:c7e325599570 84 {
dkato 2:c7e325599570 85 s->in_use = false;
dkato 2:c7e325599570 86 }
dkato 2:c7e325599570 87
dkato 3:2ff2514e4fca 88 static void mbed_lwip_wifi_socket_callback(struct netconn *nc, enum netconn_evt eh, u16_t len)
dkato 2:c7e325599570 89 {
dkato 2:c7e325599570 90 sys_prot_t prot = sys_arch_protect();
dkato 2:c7e325599570 91
dkato 2:c7e325599570 92 for (int i = 0; i < MEMP_NUM_NETCONN; i++) {
dkato 2:c7e325599570 93 if (lwip_arena[i].in_use
dkato 2:c7e325599570 94 && lwip_arena[i].conn == nc
dkato 2:c7e325599570 95 && lwip_arena[i].cb) {
dkato 2:c7e325599570 96 lwip_arena[i].cb(lwip_arena[i].data);
dkato 2:c7e325599570 97 }
dkato 2:c7e325599570 98 }
dkato 2:c7e325599570 99
dkato 2:c7e325599570 100 sys_arch_unprotect(prot);
dkato 2:c7e325599570 101 }
dkato 2:c7e325599570 102
dkato 2:c7e325599570 103
dkato 2:c7e325599570 104 /* TCP/IP and Network Interface Initialisation */
dkato 2:c7e325599570 105 static struct netif lwip_netif;
dkato 3:2ff2514e4fca 106 static bool lwip_dhcp = false;
dkato 3:2ff2514e4fca 107 static char lwip_mac_address[NSAPI_MAC_SIZE] = "\0";
dkato 2:c7e325599570 108
dkato 3:2ff2514e4fca 109 #if !LWIP_IPV4 || !LWIP_IPV6
dkato 3:2ff2514e4fca 110 static bool all_zeros(const uint8_t *p, int len)
dkato 3:2ff2514e4fca 111 {
dkato 3:2ff2514e4fca 112 for (int i = 0; i < len; i++) {
dkato 3:2ff2514e4fca 113 if (p[i]) {
dkato 3:2ff2514e4fca 114 return false;
dkato 3:2ff2514e4fca 115 }
dkato 3:2ff2514e4fca 116 }
dkato 3:2ff2514e4fca 117
dkato 3:2ff2514e4fca 118 return true;
dkato 3:2ff2514e4fca 119 }
dkato 3:2ff2514e4fca 120 #endif
dkato 3:2ff2514e4fca 121
dkato 3:2ff2514e4fca 122 static bool convert_mbed_addr_to_lwip(ip_addr_t *out, const nsapi_addr_t *in)
dkato 3:2ff2514e4fca 123 {
dkato 3:2ff2514e4fca 124 #if LWIP_IPV6
dkato 3:2ff2514e4fca 125 if (in->version == NSAPI_IPv6) {
dkato 3:2ff2514e4fca 126 IP_SET_TYPE(out, IPADDR_TYPE_V6);
dkato 3:2ff2514e4fca 127 MEMCPY(ip_2_ip6(out), in->bytes, sizeof(ip6_addr_t));
dkato 3:2ff2514e4fca 128 return true;
dkato 3:2ff2514e4fca 129 }
dkato 3:2ff2514e4fca 130 #if !LWIP_IPV4
dkato 3:2ff2514e4fca 131 /* For bind() and other purposes, need to accept "null" of other type */
dkato 3:2ff2514e4fca 132 /* (People use IPv4 0.0.0.0 as a general null) */
dkato 3:2ff2514e4fca 133 if (in->version == NSAPI_IPv4 && all_zeros(in->bytes, 4)) {
dkato 3:2ff2514e4fca 134 ip_addr_set_zero_ip6(out);
dkato 3:2ff2514e4fca 135 return true;
dkato 3:2ff2514e4fca 136 }
dkato 3:2ff2514e4fca 137 #endif
dkato 3:2ff2514e4fca 138 #endif
dkato 3:2ff2514e4fca 139
dkato 3:2ff2514e4fca 140 #if LWIP_IPV4
dkato 3:2ff2514e4fca 141 if (in->version == NSAPI_IPv4) {
dkato 3:2ff2514e4fca 142 IP_SET_TYPE(out, IPADDR_TYPE_V4);
dkato 3:2ff2514e4fca 143 MEMCPY(ip_2_ip4(out), in->bytes, sizeof(ip4_addr_t));
dkato 3:2ff2514e4fca 144 return true;
dkato 3:2ff2514e4fca 145 }
dkato 3:2ff2514e4fca 146 #if !LWIP_IPV6
dkato 3:2ff2514e4fca 147 /* For symmetry with above, accept IPv6 :: as a general null */
dkato 3:2ff2514e4fca 148 if (in->version == NSAPI_IPv6 && all_zeros(in->bytes, 16)) {
dkato 3:2ff2514e4fca 149 ip_addr_set_zero_ip4(out);
dkato 3:2ff2514e4fca 150 return true;
dkato 3:2ff2514e4fca 151 }
dkato 3:2ff2514e4fca 152 #endif
dkato 3:2ff2514e4fca 153 #endif
dkato 3:2ff2514e4fca 154
dkato 3:2ff2514e4fca 155 return false;
dkato 3:2ff2514e4fca 156 }
dkato 3:2ff2514e4fca 157
dkato 3:2ff2514e4fca 158 static bool convert_lwip_addr_to_mbed(nsapi_addr_t *out, const ip_addr_t *in)
dkato 3:2ff2514e4fca 159 {
dkato 3:2ff2514e4fca 160 #if LWIP_IPV6
dkato 3:2ff2514e4fca 161 if (IP_IS_V6(in)) {
dkato 3:2ff2514e4fca 162 out->version = NSAPI_IPv6;
dkato 3:2ff2514e4fca 163 MEMCPY(out->bytes, ip_2_ip6(in), sizeof(ip6_addr_t));
dkato 3:2ff2514e4fca 164 return true;
dkato 3:2ff2514e4fca 165 }
dkato 3:2ff2514e4fca 166 #endif
dkato 3:2ff2514e4fca 167 #if LWIP_IPV4
dkato 3:2ff2514e4fca 168 if (IP_IS_V4(in)) {
dkato 3:2ff2514e4fca 169 out->version = NSAPI_IPv4;
dkato 3:2ff2514e4fca 170 MEMCPY(out->bytes, ip_2_ip4(in), sizeof(ip4_addr_t));
dkato 3:2ff2514e4fca 171 return true;
dkato 3:2ff2514e4fca 172 }
dkato 3:2ff2514e4fca 173 #endif
dkato 3:2ff2514e4fca 174 return false;
dkato 3:2ff2514e4fca 175 }
dkato 3:2ff2514e4fca 176
dkato 3:2ff2514e4fca 177 static const ip_addr_t *mbed_lwip_wifi_get_ipv4_addr(const struct netif *netif)
dkato 3:2ff2514e4fca 178 {
dkato 3:2ff2514e4fca 179 #if LWIP_IPV4
dkato 3:2ff2514e4fca 180 if (!netif_is_up(netif)) {
dkato 3:2ff2514e4fca 181 return NULL;
dkato 3:2ff2514e4fca 182 }
dkato 3:2ff2514e4fca 183
dkato 3:2ff2514e4fca 184 if (!ip4_addr_isany(netif_ip4_addr(netif))) {
dkato 3:2ff2514e4fca 185 return netif_ip_addr4(netif);
dkato 3:2ff2514e4fca 186 }
dkato 3:2ff2514e4fca 187 #endif
dkato 3:2ff2514e4fca 188
dkato 3:2ff2514e4fca 189 return NULL;
dkato 3:2ff2514e4fca 190 }
dkato 3:2ff2514e4fca 191
dkato 3:2ff2514e4fca 192 static const ip_addr_t *mbed_lwip_wifi_get_ipv6_addr(const struct netif *netif)
dkato 3:2ff2514e4fca 193 {
dkato 3:2ff2514e4fca 194 #if LWIP_IPV6
dkato 3:2ff2514e4fca 195 if (!netif_is_up(netif)) {
dkato 3:2ff2514e4fca 196 return NULL;
dkato 3:2ff2514e4fca 197 }
dkato 3:2ff2514e4fca 198
dkato 3:2ff2514e4fca 199 for (int i = 0; i < LWIP_IPV6_NUM_ADDRESSES; i++) {
dkato 3:2ff2514e4fca 200 if (ip6_addr_isvalid(netif_ip6_addr_state(netif, i)) &&
dkato 3:2ff2514e4fca 201 !ip6_addr_islinklocal(netif_ip6_addr(netif, i))) {
dkato 3:2ff2514e4fca 202 return netif_ip_addr6(netif, i);
dkato 3:2ff2514e4fca 203 }
dkato 3:2ff2514e4fca 204 }
dkato 3:2ff2514e4fca 205 #endif
dkato 3:2ff2514e4fca 206
dkato 3:2ff2514e4fca 207 return NULL;
dkato 3:2ff2514e4fca 208
dkato 3:2ff2514e4fca 209 }
dkato 3:2ff2514e4fca 210
dkato 3:2ff2514e4fca 211 const ip_addr_t *mbed_lwip_wifi_get_ip_addr(bool any_addr, const struct netif *netif)
dkato 3:2ff2514e4fca 212 {
dkato 3:2ff2514e4fca 213 const ip_addr_t *pref_ip_addr = 0;
dkato 3:2ff2514e4fca 214 const ip_addr_t *npref_ip_addr = 0;
dkato 3:2ff2514e4fca 215
dkato 3:2ff2514e4fca 216 #if IP_VERSION_PREF == PREF_IPV4
dkato 3:2ff2514e4fca 217 pref_ip_addr = mbed_lwip_wifi_get_ipv4_addr(netif);
dkato 3:2ff2514e4fca 218 npref_ip_addr = mbed_lwip_wifi_get_ipv6_addr(netif);
dkato 3:2ff2514e4fca 219 #else
dkato 3:2ff2514e4fca 220 pref_ip_addr = mbed_lwip_wifi_get_ipv6_addr(netif);
dkato 3:2ff2514e4fca 221 npref_ip_addr = mbed_lwip_wifi_get_ipv4_addr(netif);
dkato 3:2ff2514e4fca 222 #endif
dkato 3:2ff2514e4fca 223
dkato 3:2ff2514e4fca 224 if (pref_ip_addr) {
dkato 3:2ff2514e4fca 225 return pref_ip_addr;
dkato 3:2ff2514e4fca 226 } else if (npref_ip_addr && any_addr) {
dkato 3:2ff2514e4fca 227 return npref_ip_addr;
dkato 3:2ff2514e4fca 228 }
dkato 3:2ff2514e4fca 229
dkato 3:2ff2514e4fca 230 return NULL;
dkato 3:2ff2514e4fca 231 }
dkato 3:2ff2514e4fca 232
dkato 3:2ff2514e4fca 233 #if LWIP_IPV6
dkato 3:2ff2514e4fca 234 void add_dns_addr(struct netif *lwip_netif)
dkato 3:2ff2514e4fca 235 {
dkato 3:2ff2514e4fca 236 const ip_addr_t *ip_addr = mbed_lwip_wifi_get_ip_addr(true, lwip_netif);
dkato 3:2ff2514e4fca 237 if (ip_addr) {
dkato 3:2ff2514e4fca 238 if (IP_IS_V6(ip_addr)) {
dkato 3:2ff2514e4fca 239 const ip_addr_t *dns_ip_addr;
dkato 3:2ff2514e4fca 240 bool dns_addr_exists = false;
dkato 3:2ff2514e4fca 241
dkato 3:2ff2514e4fca 242 for (char numdns = 0; numdns < DNS_MAX_SERVERS; numdns++) {
dkato 3:2ff2514e4fca 243 dns_ip_addr = dns_getserver(numdns);
dkato 3:2ff2514e4fca 244 if (!ip_addr_isany(dns_ip_addr)) {
dkato 3:2ff2514e4fca 245 dns_addr_exists = true;
dkato 3:2ff2514e4fca 246 break;
dkato 3:2ff2514e4fca 247 }
dkato 3:2ff2514e4fca 248 }
dkato 3:2ff2514e4fca 249
dkato 3:2ff2514e4fca 250 if (!dns_addr_exists) {
dkato 3:2ff2514e4fca 251 /* 2001:4860:4860::8888 google */
dkato 3:2ff2514e4fca 252 ip_addr_t ipv6_dns_addr = IPADDR6_INIT(
dkato 3:2ff2514e4fca 253 PP_HTONL(0x20014860UL),
dkato 3:2ff2514e4fca 254 PP_HTONL(0x48600000UL),
dkato 3:2ff2514e4fca 255 PP_HTONL(0x00000000UL),
dkato 3:2ff2514e4fca 256 PP_HTONL(0x00008888UL));
dkato 3:2ff2514e4fca 257 dns_setserver(0, &ipv6_dns_addr);
dkato 3:2ff2514e4fca 258 }
dkato 3:2ff2514e4fca 259 }
dkato 3:2ff2514e4fca 260 }
dkato 3:2ff2514e4fca 261 }
dkato 3:2ff2514e4fca 262 #endif
dkato 2:c7e325599570 263
dkato 2:c7e325599570 264 static sys_sem_t lwip_tcpip_inited;
dkato 3:2ff2514e4fca 265 static void mbed_lwip_wifi_tcpip_init_irq(void *eh)
dkato 2:c7e325599570 266 {
dkato 2:c7e325599570 267 sys_sem_signal(&lwip_tcpip_inited);
dkato 2:c7e325599570 268 }
dkato 2:c7e325599570 269
dkato 2:c7e325599570 270 static sys_sem_t lwip_netif_linked;
dkato 3:2ff2514e4fca 271 static void mbed_lwip_wifi_netif_link_irq(struct netif *lwip_netif)
dkato 2:c7e325599570 272 {
dkato 2:c7e325599570 273 if (netif_is_link_up(lwip_netif)) {
dkato 2:c7e325599570 274 sys_sem_signal(&lwip_netif_linked);
dkato 2:c7e325599570 275 }
dkato 2:c7e325599570 276 }
dkato 2:c7e325599570 277
dkato 3:2ff2514e4fca 278 static sys_sem_t lwip_netif_has_addr;
dkato 3:2ff2514e4fca 279 static void mbed_lwip_wifi_netif_status_irq(struct netif *lwip_netif)
dkato 2:c7e325599570 280 {
dkato 3:2ff2514e4fca 281 static bool any_addr = true;
dkato 3:2ff2514e4fca 282
dkato 3:2ff2514e4fca 283 // Indicates that has address
dkato 3:2ff2514e4fca 284 if (any_addr == true && mbed_lwip_wifi_get_ip_addr(true, lwip_netif)) {
dkato 3:2ff2514e4fca 285 sys_sem_signal(&lwip_netif_has_addr);
dkato 3:2ff2514e4fca 286 any_addr = false;
dkato 3:2ff2514e4fca 287 return;
dkato 3:2ff2514e4fca 288 }
dkato 3:2ff2514e4fca 289
dkato 3:2ff2514e4fca 290 // Indicates that has preferred address
dkato 3:2ff2514e4fca 291 if (mbed_lwip_wifi_get_ip_addr(false, lwip_netif)) {
dkato 3:2ff2514e4fca 292 sys_sem_signal(&lwip_netif_has_addr);
dkato 2:c7e325599570 293 }
dkato 2:c7e325599570 294 }
dkato 2:c7e325599570 295
dkato 3:2ff2514e4fca 296 static void mbed_lwip_wifi_set_mac_address(void)
dkato 2:c7e325599570 297 {
dkato 3:2ff2514e4fca 298 snprintf(lwip_mac_address, 19, "%02x:%02x:%02x:%02x:%02x:%02x", lwip_netif.hwaddr[0], lwip_netif.hwaddr[1],
dkato 2:c7e325599570 299 lwip_netif.hwaddr[2], lwip_netif.hwaddr[3], lwip_netif.hwaddr[4], lwip_netif.hwaddr[5]);
dkato 2:c7e325599570 300 }
dkato 2:c7e325599570 301
dkato 3:2ff2514e4fca 302 /* LWIP interface implementation */
dkato 3:2ff2514e4fca 303 const char *mbed_lwip_wifi_get_mac_address(void)
dkato 3:2ff2514e4fca 304 {
dkato 3:2ff2514e4fca 305 return lwip_mac_address[0] ? lwip_mac_address : 0;
dkato 3:2ff2514e4fca 306 }
dkato 2:c7e325599570 307
dkato 3:2ff2514e4fca 308 char *mbed_lwip_wifi_get_ip_address(char *buf, int buflen)
dkato 2:c7e325599570 309 {
dkato 3:2ff2514e4fca 310 const ip_addr_t *addr = mbed_lwip_wifi_get_ip_addr(true, &lwip_netif);
dkato 3:2ff2514e4fca 311 if (!addr) {
dkato 3:2ff2514e4fca 312 return NULL;
dkato 3:2ff2514e4fca 313 }
dkato 3:2ff2514e4fca 314 #if LWIP_IPV6
dkato 3:2ff2514e4fca 315 if (IP_IS_V6(addr)) {
dkato 3:2ff2514e4fca 316 return ip6addr_ntoa_r(ip_2_ip6(addr), buf, buflen);
dkato 3:2ff2514e4fca 317 }
dkato 3:2ff2514e4fca 318 #endif
dkato 3:2ff2514e4fca 319 #if LWIP_IPV4
dkato 3:2ff2514e4fca 320 if (IP_IS_V4(addr)) {
dkato 3:2ff2514e4fca 321 return ip4addr_ntoa_r(ip_2_ip4(addr), buf, buflen);
dkato 3:2ff2514e4fca 322 }
dkato 3:2ff2514e4fca 323 #endif
dkato 3:2ff2514e4fca 324 return NULL;
dkato 2:c7e325599570 325 }
dkato 2:c7e325599570 326
dkato 3:2ff2514e4fca 327 const char *mbed_lwip_wifi_get_netmask(char *buf, int buflen)
dkato 2:c7e325599570 328 {
dkato 3:2ff2514e4fca 329 #if LWIP_IPV4
dkato 3:2ff2514e4fca 330 const ip4_addr_t *addr = netif_ip4_netmask(&lwip_netif);
dkato 3:2ff2514e4fca 331 if (!ip4_addr_isany(addr)) {
dkato 3:2ff2514e4fca 332 return ip4addr_ntoa_r(addr, buf, buflen);
dkato 3:2ff2514e4fca 333 } else {
dkato 3:2ff2514e4fca 334 return NULL;
dkato 3:2ff2514e4fca 335 }
dkato 3:2ff2514e4fca 336 #else
dkato 3:2ff2514e4fca 337 return NULL;
dkato 3:2ff2514e4fca 338 #endif
dkato 2:c7e325599570 339 }
dkato 2:c7e325599570 340
dkato 3:2ff2514e4fca 341 char *mbed_lwip_wifi_get_gateway(char *buf, int buflen)
dkato 2:c7e325599570 342 {
dkato 3:2ff2514e4fca 343 #if LWIP_IPV4
dkato 3:2ff2514e4fca 344 const ip4_addr_t *addr = netif_ip4_gw(&lwip_netif);
dkato 3:2ff2514e4fca 345 if (!ip4_addr_isany(addr)) {
dkato 3:2ff2514e4fca 346 return ip4addr_ntoa_r(addr, buf, buflen);
dkato 3:2ff2514e4fca 347 } else {
dkato 3:2ff2514e4fca 348 return NULL;
dkato 3:2ff2514e4fca 349 }
dkato 3:2ff2514e4fca 350 #else
dkato 3:2ff2514e4fca 351 return NULL;
dkato 3:2ff2514e4fca 352 #endif
dkato 3:2ff2514e4fca 353 }
dkato 3:2ff2514e4fca 354
dkato 3:2ff2514e4fca 355 int mbed_lwip_wifi_init(emac_interface_t *emac)
dkato 3:2ff2514e4fca 356 {
dkato 3:2ff2514e4fca 357 // Check if we've already brought up lwip
dkato 3:2ff2514e4fca 358 if (!mbed_lwip_wifi_get_mac_address()) {
dkato 2:c7e325599570 359 // Set up network
dkato 2:c7e325599570 360 sys_sem_new(&lwip_tcpip_inited, 0);
dkato 2:c7e325599570 361 sys_sem_new(&lwip_netif_linked, 0);
dkato 3:2ff2514e4fca 362 sys_sem_new(&lwip_netif_has_addr, 0);
dkato 2:c7e325599570 363
dkato 3:2ff2514e4fca 364 tcpip_init(mbed_lwip_wifi_tcpip_init_irq, NULL);
dkato 2:c7e325599570 365 sys_arch_sem_wait(&lwip_tcpip_inited, 0);
dkato 2:c7e325599570 366
dkato 2:c7e325599570 367 memset(&lwip_netif, 0, sizeof lwip_netif);
dkato 3:2ff2514e4fca 368 if (!netif_add(&lwip_netif,
dkato 3:2ff2514e4fca 369 #if LWIP_IPV4
dkato 3:2ff2514e4fca 370 0, 0, 0,
dkato 3:2ff2514e4fca 371 #endif
dkato 3:2ff2514e4fca 372 emac, MBED_NETIF_INIT_FN, tcpip_input)) {
dkato 3:2ff2514e4fca 373 return NSAPI_ERROR_DEVICE_ERROR;
dkato 3:2ff2514e4fca 374 }
dkato 3:2ff2514e4fca 375
dkato 2:c7e325599570 376 netif_set_default(&lwip_netif);
dkato 2:c7e325599570 377
dkato 3:2ff2514e4fca 378 netif_set_link_callback(&lwip_netif, mbed_lwip_wifi_netif_link_irq);
dkato 3:2ff2514e4fca 379 netif_set_status_callback(&lwip_netif, mbed_lwip_wifi_netif_status_irq);
dkato 2:c7e325599570 380
dkato 3:2ff2514e4fca 381 mbed_lwip_wifi_set_mac_address();
dkato 3:2ff2514e4fca 382
dkato 3:2ff2514e4fca 383 #if !DEVICE_EMAC
dkato 2:c7e325599570 384 wifi_arch_enable_interrupts();
dkato 3:2ff2514e4fca 385 #endif
dkato 2:c7e325599570 386 }
dkato 2:c7e325599570 387
dkato 3:2ff2514e4fca 388 return NSAPI_ERROR_OK;
dkato 2:c7e325599570 389 }
dkato 2:c7e325599570 390
dkato 3:2ff2514e4fca 391 int mbed_lwip_wifi_bringup(bool dhcp, const char *ip, const char *netmask, const char *gw)
dkato 2:c7e325599570 392 {
dkato 3:2ff2514e4fca 393 // Check if we've already connected
dkato 3:2ff2514e4fca 394 if (lwip_connected) {
dkato 3:2ff2514e4fca 395 return NSAPI_ERROR_PARAMETER;
dkato 3:2ff2514e4fca 396 }
dkato 3:2ff2514e4fca 397
dkato 3:2ff2514e4fca 398 if(mbed_lwip_wifi_init(NULL) != NSAPI_ERROR_OK) {
dkato 3:2ff2514e4fca 399 return NSAPI_ERROR_DEVICE_ERROR;
dkato 3:2ff2514e4fca 400 }
dkato 3:2ff2514e4fca 401
dkato 2:c7e325599570 402 // Zero out socket set
dkato 3:2ff2514e4fca 403 mbed_lwip_wifi_arena_init();
dkato 3:2ff2514e4fca 404
dkato 3:2ff2514e4fca 405 #if LWIP_IPV6
dkato 3:2ff2514e4fca 406 netif_create_ip6_linklocal_address(&lwip_netif, 1/*from MAC*/);
dkato 3:2ff2514e4fca 407 #if LWIP_IPV6_MLD
dkato 3:2ff2514e4fca 408 /*
dkato 3:2ff2514e4fca 409 * For hardware/netifs that implement MAC filtering.
dkato 3:2ff2514e4fca 410 * All-nodes link-local is handled by default, so we must let the hardware know
dkato 3:2ff2514e4fca 411 * to allow multicast packets in.
dkato 3:2ff2514e4fca 412 * Should set mld_mac_filter previously. */
dkato 3:2ff2514e4fca 413 if (lwip_netif.mld_mac_filter != NULL) {
dkato 3:2ff2514e4fca 414 ip6_addr_t ip6_allnodes_ll;
dkato 3:2ff2514e4fca 415 ip6_addr_set_allnodes_linklocal(&ip6_allnodes_ll);
dkato 3:2ff2514e4fca 416 lwip_netif.mld_mac_filter(&lwip_netif, &ip6_allnodes_ll, MLD6_ADD_MAC_FILTER);
dkato 3:2ff2514e4fca 417 }
dkato 3:2ff2514e4fca 418 #endif /* LWIP_IPV6_MLD */
dkato 3:2ff2514e4fca 419
dkato 3:2ff2514e4fca 420 #if LWIP_IPV6_AUTOCONFIG
dkato 3:2ff2514e4fca 421 /* IPv6 address autoconfiguration not enabled by default */
dkato 3:2ff2514e4fca 422 lwip_netif.ip6_autoconfig_enabled = 1;
dkato 3:2ff2514e4fca 423 #endif /* LWIP_IPV6_AUTOCONFIG */
dkato 3:2ff2514e4fca 424
dkato 3:2ff2514e4fca 425 #endif
dkato 3:2ff2514e4fca 426
dkato 3:2ff2514e4fca 427 u32_t ret;
dkato 2:c7e325599570 428
dkato 3:2ff2514e4fca 429 if (!netif_is_link_up(&lwip_netif)) {
dkato 3:2ff2514e4fca 430 ret = sys_arch_sem_wait(&lwip_netif_linked, 15000);
dkato 3:2ff2514e4fca 431
dkato 3:2ff2514e4fca 432 if (ret == SYS_ARCH_TIMEOUT) {
dkato 3:2ff2514e4fca 433 return NSAPI_ERROR_NO_CONNECTION;
dkato 3:2ff2514e4fca 434 }
dkato 3:2ff2514e4fca 435 }
dkato 3:2ff2514e4fca 436
dkato 3:2ff2514e4fca 437 #if LWIP_IPV4
dkato 3:2ff2514e4fca 438 if (!dhcp) {
dkato 3:2ff2514e4fca 439 ip4_addr_t ip_addr;
dkato 3:2ff2514e4fca 440 ip4_addr_t netmask_addr;
dkato 3:2ff2514e4fca 441 ip4_addr_t gw_addr;
dkato 3:2ff2514e4fca 442
dkato 3:2ff2514e4fca 443 if (!inet_aton(ip, &ip_addr) ||
dkato 3:2ff2514e4fca 444 !inet_aton(netmask, &netmask_addr) ||
dkato 3:2ff2514e4fca 445 !inet_aton(gw, &gw_addr)) {
dkato 3:2ff2514e4fca 446 return NSAPI_ERROR_PARAMETER;
dkato 3:2ff2514e4fca 447 }
dkato 3:2ff2514e4fca 448
dkato 3:2ff2514e4fca 449 netif_set_addr(&lwip_netif, &ip_addr, &netmask_addr, &gw_addr);
dkato 3:2ff2514e4fca 450 }
dkato 3:2ff2514e4fca 451 #endif
dkato 3:2ff2514e4fca 452
dkato 3:2ff2514e4fca 453 netif_set_up(&lwip_netif);
dkato 3:2ff2514e4fca 454
dkato 3:2ff2514e4fca 455 #if LWIP_IPV4
dkato 2:c7e325599570 456 // Connect to the network
dkato 3:2ff2514e4fca 457 lwip_dhcp = dhcp;
dkato 3:2ff2514e4fca 458
dkato 3:2ff2514e4fca 459 if (lwip_dhcp) {
dkato 3:2ff2514e4fca 460 err_t err = dhcp_start(&lwip_netif);
dkato 3:2ff2514e4fca 461 if (err) {
dkato 3:2ff2514e4fca 462 return NSAPI_ERROR_DHCP_FAILURE;
dkato 3:2ff2514e4fca 463 }
dkato 3:2ff2514e4fca 464 }
dkato 3:2ff2514e4fca 465 #endif
dkato 2:c7e325599570 466
dkato 3:2ff2514e4fca 467 // If doesn't have address
dkato 3:2ff2514e4fca 468 if (!mbed_lwip_wifi_get_ip_addr(true, &lwip_netif)) {
dkato 3:2ff2514e4fca 469 ret = sys_arch_sem_wait(&lwip_netif_has_addr, 15000);
dkato 3:2ff2514e4fca 470 if (ret == SYS_ARCH_TIMEOUT) {
dkato 3:2ff2514e4fca 471 return NSAPI_ERROR_DHCP_FAILURE;
dkato 3:2ff2514e4fca 472 }
dkato 3:2ff2514e4fca 473 lwip_connected = true;
dkato 2:c7e325599570 474 }
dkato 2:c7e325599570 475
dkato 3:2ff2514e4fca 476 #if ADDR_TIMEOUT
dkato 3:2ff2514e4fca 477 // If address is not for preferred stack waits a while to see
dkato 3:2ff2514e4fca 478 // if preferred stack address is acquired
dkato 3:2ff2514e4fca 479 if (!mbed_lwip_wifi_get_ip_addr(false, &lwip_netif)) {
dkato 3:2ff2514e4fca 480 ret = sys_arch_sem_wait(&lwip_netif_has_addr, ADDR_TIMEOUT * 1000);
dkato 3:2ff2514e4fca 481 }
dkato 3:2ff2514e4fca 482 #endif
dkato 3:2ff2514e4fca 483
dkato 3:2ff2514e4fca 484 #if LWIP_IPV6
dkato 3:2ff2514e4fca 485 add_dns_addr(&lwip_netif);
dkato 3:2ff2514e4fca 486 #endif
dkato 3:2ff2514e4fca 487
dkato 2:c7e325599570 488 return 0;
dkato 2:c7e325599570 489 }
dkato 2:c7e325599570 490
dkato 3:2ff2514e4fca 491 int mbed_lwip_wifi_bringdown(void)
dkato 2:c7e325599570 492 {
dkato 3:2ff2514e4fca 493 // Check if we've connected
dkato 3:2ff2514e4fca 494 if (!lwip_connected) {
dkato 3:2ff2514e4fca 495 return NSAPI_ERROR_PARAMETER;
dkato 3:2ff2514e4fca 496 }
dkato 3:2ff2514e4fca 497
dkato 3:2ff2514e4fca 498 #if LWIP_IPV4
dkato 2:c7e325599570 499 // Disconnect from the network
dkato 3:2ff2514e4fca 500 if (lwip_dhcp) {
dkato 3:2ff2514e4fca 501 dhcp_release(&lwip_netif);
dkato 3:2ff2514e4fca 502 dhcp_stop(&lwip_netif);
dkato 3:2ff2514e4fca 503 lwip_dhcp = false;
dkato 3:2ff2514e4fca 504 } else {
dkato 3:2ff2514e4fca 505 netif_set_down(&lwip_netif);
dkato 3:2ff2514e4fca 506 }
dkato 3:2ff2514e4fca 507 #endif
dkato 3:2ff2514e4fca 508
dkato 3:2ff2514e4fca 509 lwip_connected = false;
dkato 3:2ff2514e4fca 510 // TO DO - actually remove addresses from stack, and shut down properly
dkato 3:2ff2514e4fca 511 return 0;
dkato 2:c7e325599570 512 }
dkato 2:c7e325599570 513
dkato 2:c7e325599570 514 /* LWIP error remapping */
dkato 3:2ff2514e4fca 515 static int mbed_lwip_wifi_err_remap(err_t err) {
dkato 2:c7e325599570 516 switch (err) {
dkato 2:c7e325599570 517 case ERR_OK:
dkato 3:2ff2514e4fca 518 case ERR_CLSD:
dkato 3:2ff2514e4fca 519 case ERR_RST:
dkato 2:c7e325599570 520 return 0;
dkato 2:c7e325599570 521 case ERR_MEM:
dkato 2:c7e325599570 522 return NSAPI_ERROR_NO_MEMORY;
dkato 2:c7e325599570 523 case ERR_CONN:
dkato 2:c7e325599570 524 return NSAPI_ERROR_NO_CONNECTION;
dkato 2:c7e325599570 525 case ERR_TIMEOUT:
dkato 2:c7e325599570 526 case ERR_RTE:
dkato 2:c7e325599570 527 case ERR_INPROGRESS:
dkato 2:c7e325599570 528 case ERR_WOULDBLOCK:
dkato 2:c7e325599570 529 return NSAPI_ERROR_WOULD_BLOCK;
dkato 2:c7e325599570 530 case ERR_VAL:
dkato 2:c7e325599570 531 case ERR_USE:
dkato 2:c7e325599570 532 case ERR_ISCONN:
dkato 2:c7e325599570 533 case ERR_ARG:
dkato 2:c7e325599570 534 return NSAPI_ERROR_PARAMETER;
dkato 2:c7e325599570 535 default:
dkato 2:c7e325599570 536 return NSAPI_ERROR_DEVICE_ERROR;
dkato 2:c7e325599570 537 }
dkato 2:c7e325599570 538 }
dkato 2:c7e325599570 539
dkato 2:c7e325599570 540 /* LWIP network stack implementation */
dkato 3:2ff2514e4fca 541 static int mbed_lwip_wifi_gethostbyname(nsapi_stack_t *stack, const char *host, nsapi_addr_t *addr, nsapi_version_t version)
dkato 2:c7e325599570 542 {
dkato 3:2ff2514e4fca 543 ip_addr_t lwip_addr;
dkato 2:c7e325599570 544
dkato 3:2ff2514e4fca 545 #if LWIP_IPV4 && LWIP_IPV6
dkato 3:2ff2514e4fca 546 u8_t addr_type;
dkato 3:2ff2514e4fca 547 if (version == NSAPI_UNSPEC) {
dkato 3:2ff2514e4fca 548 const ip_addr_t *ip_addr;
dkato 3:2ff2514e4fca 549 ip_addr = mbed_lwip_wifi_get_ip_addr(true, &lwip_netif);
dkato 3:2ff2514e4fca 550 if (IP_IS_V6(ip_addr)) {
dkato 3:2ff2514e4fca 551 addr_type = NETCONN_DNS_IPV6;
dkato 3:2ff2514e4fca 552 } else {
dkato 3:2ff2514e4fca 553 addr_type = NETCONN_DNS_IPV4;
dkato 3:2ff2514e4fca 554 }
dkato 3:2ff2514e4fca 555 } else if (version == NSAPI_IPv4) {
dkato 3:2ff2514e4fca 556 addr_type = NETCONN_DNS_IPV4;
dkato 3:2ff2514e4fca 557 } else if (version == NSAPI_IPv6) {
dkato 3:2ff2514e4fca 558 addr_type = NETCONN_DNS_IPV6;
dkato 3:2ff2514e4fca 559 }
dkato 3:2ff2514e4fca 560 err_t err = netconn_gethostbyname_addrtype(host, &lwip_addr, addr_type);
dkato 3:2ff2514e4fca 561 #elif LWIP_IPV4
dkato 3:2ff2514e4fca 562 if (version != NSAPI_IPv4 && version != NSAPI_UNSPEC) {
dkato 3:2ff2514e4fca 563 return NSAPI_ERROR_DNS_FAILURE;
dkato 3:2ff2514e4fca 564 }
dkato 3:2ff2514e4fca 565 err_t err = netconn_gethostbyname(host, &lwip_addr);
dkato 3:2ff2514e4fca 566 #elif LWIP_IPV6
dkato 3:2ff2514e4fca 567 if (version != NSAPI_IPv6 && version != NSAPI_UNSPEC) {
dkato 3:2ff2514e4fca 568 return NSAPI_ERROR_DNS_FAILURE;
dkato 3:2ff2514e4fca 569 }
dkato 3:2ff2514e4fca 570 err_t err = netconn_gethostbyname(host, &lwip_addr);
dkato 3:2ff2514e4fca 571 #endif
dkato 2:c7e325599570 572
dkato 2:c7e325599570 573 if (err != ERR_OK) {
dkato 2:c7e325599570 574 return NSAPI_ERROR_DNS_FAILURE;
dkato 2:c7e325599570 575 }
dkato 2:c7e325599570 576
dkato 3:2ff2514e4fca 577 convert_lwip_addr_to_mbed(addr, &lwip_addr);
dkato 3:2ff2514e4fca 578
dkato 2:c7e325599570 579 return 0;
dkato 2:c7e325599570 580 }
dkato 2:c7e325599570 581
dkato 3:2ff2514e4fca 582 static int mbed_lwip_wifi_socket_open(nsapi_stack_t *stack, nsapi_socket_t *handle, nsapi_protocol_t proto)
dkato 2:c7e325599570 583 {
dkato 3:2ff2514e4fca 584 // check if network is connected
dkato 3:2ff2514e4fca 585 if (!lwip_connected) {
dkato 3:2ff2514e4fca 586 return NSAPI_ERROR_NO_CONNECTION;
dkato 3:2ff2514e4fca 587 }
dkato 3:2ff2514e4fca 588
dkato 3:2ff2514e4fca 589 // allocate a socket
dkato 3:2ff2514e4fca 590 struct lwip_socket *s = mbed_lwip_wifi_arena_alloc();
dkato 2:c7e325599570 591 if (!s) {
dkato 2:c7e325599570 592 return NSAPI_ERROR_NO_SOCKET;
dkato 2:c7e325599570 593 }
dkato 2:c7e325599570 594
dkato 3:2ff2514e4fca 595 u8_t lwip_proto = proto == NSAPI_TCP ? NETCONN_TCP : NETCONN_UDP;
dkato 3:2ff2514e4fca 596
dkato 3:2ff2514e4fca 597 #if LWIP_IPV6 && LWIP_IPV4
dkato 3:2ff2514e4fca 598 const ip_addr_t *ip_addr;
dkato 3:2ff2514e4fca 599 ip_addr = mbed_lwip_wifi_get_ip_addr(true, &lwip_netif);
dkato 3:2ff2514e4fca 600
dkato 3:2ff2514e4fca 601 if (IP_IS_V6(ip_addr)) {
dkato 3:2ff2514e4fca 602 // Enable IPv6 (or dual-stack). LWIP dual-stack support is
dkato 3:2ff2514e4fca 603 // currently incomplete as of 2.0.0rc2 - eg we will only be able
dkato 3:2ff2514e4fca 604 // to do a UDP sendto to an address matching the type selected
dkato 3:2ff2514e4fca 605 // here. Matching "get_ip_addr" and DNS logic, use v4 if
dkato 3:2ff2514e4fca 606 // available.
dkato 3:2ff2514e4fca 607 lwip_proto |= NETCONN_TYPE_IPV6;
dkato 3:2ff2514e4fca 608 }
dkato 3:2ff2514e4fca 609 #elif LWIP_IPV6
dkato 3:2ff2514e4fca 610 lwip_proto |= NETCONN_TYPE_IPV6;
dkato 3:2ff2514e4fca 611 #endif
dkato 3:2ff2514e4fca 612
dkato 3:2ff2514e4fca 613 s->conn = netconn_new_with_callback(lwip_proto, mbed_lwip_wifi_socket_callback);
dkato 2:c7e325599570 614
dkato 2:c7e325599570 615 if (!s->conn) {
dkato 3:2ff2514e4fca 616 mbed_lwip_wifi_arena_dealloc(s);
dkato 2:c7e325599570 617 return NSAPI_ERROR_NO_SOCKET;
dkato 2:c7e325599570 618 }
dkato 2:c7e325599570 619
dkato 2:c7e325599570 620 netconn_set_recvtimeout(s->conn, 1);
dkato 2:c7e325599570 621 *(struct lwip_socket **)handle = s;
dkato 2:c7e325599570 622 return 0;
dkato 2:c7e325599570 623 }
dkato 2:c7e325599570 624
dkato 3:2ff2514e4fca 625 static int mbed_lwip_wifi_socket_close(nsapi_stack_t *stack, nsapi_socket_t handle)
dkato 2:c7e325599570 626 {
dkato 2:c7e325599570 627 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 2:c7e325599570 628
dkato 2:c7e325599570 629 err_t err = netconn_delete(s->conn);
dkato 3:2ff2514e4fca 630 mbed_lwip_wifi_arena_dealloc(s);
dkato 3:2ff2514e4fca 631 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 632 }
dkato 2:c7e325599570 633
dkato 3:2ff2514e4fca 634 static int mbed_lwip_wifi_socket_bind(nsapi_stack_t *stack, nsapi_socket_t handle, nsapi_addr_t addr, uint16_t port)
dkato 2:c7e325599570 635 {
dkato 2:c7e325599570 636 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 3:2ff2514e4fca 637 ip_addr_t ip_addr;
dkato 3:2ff2514e4fca 638
dkato 3:2ff2514e4fca 639 if ((s->conn->type == NETCONN_TCP && s->conn->pcb.tcp->local_port != 0) ||
dkato 3:2ff2514e4fca 640 (s->conn->type == NETCONN_UDP && s->conn->pcb.udp->local_port != 0)) {
dkato 2:c7e325599570 641 return NSAPI_ERROR_PARAMETER;
dkato 2:c7e325599570 642 }
dkato 2:c7e325599570 643
dkato 3:2ff2514e4fca 644 if (!convert_mbed_addr_to_lwip(&ip_addr, &addr)) {
dkato 3:2ff2514e4fca 645 return NSAPI_ERROR_PARAMETER;
dkato 3:2ff2514e4fca 646 }
dkato 3:2ff2514e4fca 647
dkato 3:2ff2514e4fca 648 err_t err = netconn_bind(s->conn, &ip_addr, port);
dkato 3:2ff2514e4fca 649 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 650 }
dkato 2:c7e325599570 651
dkato 3:2ff2514e4fca 652 static int mbed_lwip_wifi_socket_listen(nsapi_stack_t *stack, nsapi_socket_t handle, int backlog)
dkato 2:c7e325599570 653 {
dkato 2:c7e325599570 654 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 2:c7e325599570 655
dkato 2:c7e325599570 656 err_t err = netconn_listen_with_backlog(s->conn, backlog);
dkato 3:2ff2514e4fca 657 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 658 }
dkato 2:c7e325599570 659
dkato 3:2ff2514e4fca 660 static int mbed_lwip_wifi_socket_connect(nsapi_stack_t *stack, nsapi_socket_t handle, nsapi_addr_t addr, uint16_t port)
dkato 2:c7e325599570 661 {
dkato 2:c7e325599570 662 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 3:2ff2514e4fca 663 ip_addr_t ip_addr;
dkato 3:2ff2514e4fca 664
dkato 3:2ff2514e4fca 665 if (!convert_mbed_addr_to_lwip(&ip_addr, &addr)) {
dkato 2:c7e325599570 666 return NSAPI_ERROR_PARAMETER;
dkato 2:c7e325599570 667 }
dkato 2:c7e325599570 668
dkato 2:c7e325599570 669 netconn_set_nonblocking(s->conn, false);
dkato 3:2ff2514e4fca 670 err_t err = netconn_connect(s->conn, &ip_addr, port);
dkato 2:c7e325599570 671 netconn_set_nonblocking(s->conn, true);
dkato 2:c7e325599570 672
dkato 3:2ff2514e4fca 673 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 674 }
dkato 2:c7e325599570 675
dkato 3:2ff2514e4fca 676 static int mbed_lwip_wifi_socket_accept(nsapi_stack_t *stack, nsapi_socket_t server, nsapi_socket_t *handle, nsapi_addr_t *addr, uint16_t *port)
dkato 2:c7e325599570 677 {
dkato 2:c7e325599570 678 struct lwip_socket *s = (struct lwip_socket *)server;
dkato 3:2ff2514e4fca 679 struct lwip_socket *ns = mbed_lwip_wifi_arena_alloc();
dkato 3:2ff2514e4fca 680 if (!ns) {
dkato 3:2ff2514e4fca 681 return NSAPI_ERROR_NO_SOCKET;
dkato 3:2ff2514e4fca 682 }
dkato 2:c7e325599570 683
dkato 2:c7e325599570 684 err_t err = netconn_accept(s->conn, &ns->conn);
dkato 2:c7e325599570 685 if (err != ERR_OK) {
dkato 3:2ff2514e4fca 686 mbed_lwip_wifi_arena_dealloc(ns);
dkato 3:2ff2514e4fca 687 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 688 }
dkato 2:c7e325599570 689
dkato 2:c7e325599570 690 netconn_set_recvtimeout(ns->conn, 1);
dkato 2:c7e325599570 691 *(struct lwip_socket **)handle = ns;
dkato 2:c7e325599570 692
dkato 3:2ff2514e4fca 693 ip_addr_t peer_addr;
dkato 3:2ff2514e4fca 694 (void) netconn_peer(ns->conn, &peer_addr, port);
dkato 3:2ff2514e4fca 695 convert_lwip_addr_to_mbed(addr, &peer_addr);
dkato 2:c7e325599570 696
dkato 2:c7e325599570 697 return 0;
dkato 2:c7e325599570 698 }
dkato 2:c7e325599570 699
dkato 3:2ff2514e4fca 700 static int mbed_lwip_wifi_socket_send(nsapi_stack_t *stack, nsapi_socket_t handle, const void *data, unsigned size)
dkato 2:c7e325599570 701 {
dkato 2:c7e325599570 702 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 3:2ff2514e4fca 703 size_t bytes_written = 0;
dkato 2:c7e325599570 704
dkato 3:2ff2514e4fca 705 err_t err = netconn_write_partly(s->conn, data, size, NETCONN_COPY, &bytes_written);
dkato 2:c7e325599570 706 if (err != ERR_OK) {
dkato 3:2ff2514e4fca 707 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 708 }
dkato 2:c7e325599570 709
dkato 3:2ff2514e4fca 710 return (int)bytes_written;
dkato 2:c7e325599570 711 }
dkato 2:c7e325599570 712
dkato 3:2ff2514e4fca 713 static int mbed_lwip_wifi_socket_recv(nsapi_stack_t *stack, nsapi_socket_t handle, void *data, unsigned size)
dkato 2:c7e325599570 714 {
dkato 2:c7e325599570 715 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 2:c7e325599570 716
dkato 2:c7e325599570 717 if (!s->buf) {
dkato 2:c7e325599570 718 err_t err = netconn_recv(s->conn, &s->buf);
dkato 2:c7e325599570 719 s->offset = 0;
dkato 2:c7e325599570 720
dkato 2:c7e325599570 721 if (err != ERR_OK) {
dkato 3:2ff2514e4fca 722 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 723 }
dkato 2:c7e325599570 724 }
dkato 2:c7e325599570 725
dkato 2:c7e325599570 726 u16_t recv = netbuf_copy_partial(s->buf, data, (u16_t)size, s->offset);
dkato 2:c7e325599570 727 s->offset += recv;
dkato 2:c7e325599570 728
dkato 2:c7e325599570 729 if (s->offset >= netbuf_len(s->buf)) {
dkato 2:c7e325599570 730 netbuf_delete(s->buf);
dkato 2:c7e325599570 731 s->buf = 0;
dkato 2:c7e325599570 732 }
dkato 2:c7e325599570 733
dkato 2:c7e325599570 734 return recv;
dkato 2:c7e325599570 735 }
dkato 2:c7e325599570 736
dkato 3:2ff2514e4fca 737 static int mbed_lwip_wifi_socket_sendto(nsapi_stack_t *stack, nsapi_socket_t handle, nsapi_addr_t addr, uint16_t port, const void *data, unsigned size)
dkato 2:c7e325599570 738 {
dkato 2:c7e325599570 739 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 3:2ff2514e4fca 740 ip_addr_t ip_addr;
dkato 3:2ff2514e4fca 741
dkato 3:2ff2514e4fca 742 if (!convert_mbed_addr_to_lwip(&ip_addr, &addr)) {
dkato 2:c7e325599570 743 return NSAPI_ERROR_PARAMETER;
dkato 2:c7e325599570 744 }
dkato 2:c7e325599570 745
dkato 2:c7e325599570 746 struct netbuf *buf = netbuf_new();
dkato 2:c7e325599570 747 err_t err = netbuf_ref(buf, data, (u16_t)size);
dkato 2:c7e325599570 748 if (err != ERR_OK) {
dkato 2:c7e325599570 749 netbuf_free(buf);
dkato 3:2ff2514e4fca 750 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 751 }
dkato 2:c7e325599570 752
dkato 3:2ff2514e4fca 753 err = netconn_sendto(s->conn, buf, &ip_addr, port);
dkato 2:c7e325599570 754 netbuf_delete(buf);
dkato 2:c7e325599570 755 if (err != ERR_OK) {
dkato 3:2ff2514e4fca 756 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 757 }
dkato 2:c7e325599570 758
dkato 2:c7e325599570 759 return size;
dkato 2:c7e325599570 760 }
dkato 2:c7e325599570 761
dkato 3:2ff2514e4fca 762 static int mbed_lwip_wifi_socket_recvfrom(nsapi_stack_t *stack, nsapi_socket_t handle, nsapi_addr_t *addr, uint16_t *port, void *data, unsigned size)
dkato 2:c7e325599570 763 {
dkato 2:c7e325599570 764 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 3:2ff2514e4fca 765 struct netbuf *buf;
dkato 2:c7e325599570 766
dkato 2:c7e325599570 767 err_t err = netconn_recv(s->conn, &buf);
dkato 2:c7e325599570 768 if (err != ERR_OK) {
dkato 3:2ff2514e4fca 769 return mbed_lwip_wifi_err_remap(err);
dkato 2:c7e325599570 770 }
dkato 2:c7e325599570 771
dkato 3:2ff2514e4fca 772 convert_lwip_addr_to_mbed(addr, netbuf_fromaddr(buf));
dkato 2:c7e325599570 773 *port = netbuf_fromport(buf);
dkato 2:c7e325599570 774
dkato 2:c7e325599570 775 u16_t recv = netbuf_copy(buf, data, (u16_t)size);
dkato 2:c7e325599570 776 netbuf_delete(buf);
dkato 2:c7e325599570 777
dkato 2:c7e325599570 778 return recv;
dkato 2:c7e325599570 779 }
dkato 2:c7e325599570 780
dkato 3:2ff2514e4fca 781 static int mbed_lwip_wifi_setsockopt(nsapi_stack_t *stack, nsapi_socket_t handle, int level, int optname, const void *optval, unsigned optlen)
dkato 2:c7e325599570 782 {
dkato 2:c7e325599570 783 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 2:c7e325599570 784
dkato 2:c7e325599570 785 switch (optname) {
dkato 2:c7e325599570 786 case NSAPI_KEEPALIVE:
dkato 2:c7e325599570 787 if (optlen != sizeof(int) || s->conn->type != NETCONN_TCP) {
dkato 2:c7e325599570 788 return NSAPI_ERROR_UNSUPPORTED;
dkato 2:c7e325599570 789 }
dkato 2:c7e325599570 790
dkato 2:c7e325599570 791 s->conn->pcb.tcp->so_options |= SOF_KEEPALIVE;
dkato 2:c7e325599570 792 return 0;
dkato 2:c7e325599570 793
dkato 2:c7e325599570 794 case NSAPI_KEEPIDLE:
dkato 2:c7e325599570 795 if (optlen != sizeof(int) || s->conn->type != NETCONN_TCP) {
dkato 2:c7e325599570 796 return NSAPI_ERROR_UNSUPPORTED;
dkato 2:c7e325599570 797 }
dkato 2:c7e325599570 798
dkato 2:c7e325599570 799 s->conn->pcb.tcp->keep_idle = *(int*)optval;
dkato 2:c7e325599570 800 return 0;
dkato 2:c7e325599570 801
dkato 2:c7e325599570 802 case NSAPI_KEEPINTVL:
dkato 2:c7e325599570 803 if (optlen != sizeof(int) || s->conn->type != NETCONN_TCP) {
dkato 2:c7e325599570 804 return NSAPI_ERROR_UNSUPPORTED;
dkato 2:c7e325599570 805 }
dkato 2:c7e325599570 806
dkato 2:c7e325599570 807 s->conn->pcb.tcp->keep_intvl = *(int*)optval;
dkato 2:c7e325599570 808 return 0;
dkato 2:c7e325599570 809
dkato 2:c7e325599570 810 case NSAPI_REUSEADDR:
dkato 2:c7e325599570 811 if (optlen != sizeof(int)) {
dkato 2:c7e325599570 812 return NSAPI_ERROR_UNSUPPORTED;
dkato 2:c7e325599570 813 }
dkato 2:c7e325599570 814
dkato 2:c7e325599570 815 if (*(int *)optval) {
dkato 2:c7e325599570 816 s->conn->pcb.tcp->so_options |= SOF_REUSEADDR;
dkato 2:c7e325599570 817 } else {
dkato 2:c7e325599570 818 s->conn->pcb.tcp->so_options &= ~SOF_REUSEADDR;
dkato 2:c7e325599570 819 }
dkato 2:c7e325599570 820 return 0;
dkato 2:c7e325599570 821
dkato 2:c7e325599570 822 default:
dkato 2:c7e325599570 823 return NSAPI_ERROR_UNSUPPORTED;
dkato 2:c7e325599570 824 }
dkato 2:c7e325599570 825 }
dkato 2:c7e325599570 826
dkato 3:2ff2514e4fca 827 static void mbed_lwip_wifi_socket_attach(nsapi_stack_t *stack, nsapi_socket_t handle, void (*callback)(void *), void *data)
dkato 2:c7e325599570 828 {
dkato 2:c7e325599570 829 struct lwip_socket *s = (struct lwip_socket *)handle;
dkato 2:c7e325599570 830
dkato 2:c7e325599570 831 s->cb = callback;
dkato 2:c7e325599570 832 s->data = data;
dkato 2:c7e325599570 833 }
dkato 2:c7e325599570 834
dkato 2:c7e325599570 835 /* LWIP network stack */
dkato 2:c7e325599570 836 const nsapi_stack_api_t lwip_wifi_stack_api = {
dkato 3:2ff2514e4fca 837 .gethostbyname = mbed_lwip_wifi_gethostbyname,
dkato 3:2ff2514e4fca 838 .socket_open = mbed_lwip_wifi_socket_open,
dkato 3:2ff2514e4fca 839 .socket_close = mbed_lwip_wifi_socket_close,
dkato 3:2ff2514e4fca 840 .socket_bind = mbed_lwip_wifi_socket_bind,
dkato 3:2ff2514e4fca 841 .socket_listen = mbed_lwip_wifi_socket_listen,
dkato 3:2ff2514e4fca 842 .socket_connect = mbed_lwip_wifi_socket_connect,
dkato 3:2ff2514e4fca 843 .socket_accept = mbed_lwip_wifi_socket_accept,
dkato 3:2ff2514e4fca 844 .socket_send = mbed_lwip_wifi_socket_send,
dkato 3:2ff2514e4fca 845 .socket_recv = mbed_lwip_wifi_socket_recv,
dkato 3:2ff2514e4fca 846 .socket_sendto = mbed_lwip_wifi_socket_sendto,
dkato 3:2ff2514e4fca 847 .socket_recvfrom = mbed_lwip_wifi_socket_recvfrom,
dkato 3:2ff2514e4fca 848 .setsockopt = mbed_lwip_wifi_setsockopt,
dkato 3:2ff2514e4fca 849 .socket_attach = mbed_lwip_wifi_socket_attach,
dkato 2:c7e325599570 850 };
dkato 2:c7e325599570 851
dkato 2:c7e325599570 852 nsapi_stack_t lwip_wifi_stack = {
dkato 2:c7e325599570 853 .stack_api = &lwip_wifi_stack_api,
dkato 2:c7e325599570 854 };