Kenji Arai / mbed-os_TYBLE16

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependents:   TYBLE16_simple_data_logger TYBLE16_MP3_Air

features/lwipstack/lwip_tools.cpp@1:9db0e321a9f4, 2019-12-31 (annotated)

Committer:
kenjiArai
Date:
Tue Dec 31 06:02:27 2019 +0000
Revision:
1:9db0e321a9f4
Parent:
0:5b88d5760320 
updated based on mbed-os5.15.0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kenjiArai 0:5b88d5760320 1 /* LWIP common helpers
kenjiArai 0:5b88d5760320 2 * Copyright (c) 2017 ARM Limited
kenjiArai 0:5b88d5760320 3 *
kenjiArai 0:5b88d5760320 4 * Licensed under the Apache License, Version 2.0 (the "License");
kenjiArai 0:5b88d5760320 5 * you may not use this file except in compliance with the License.
kenjiArai 0:5b88d5760320 6 * You may obtain a copy of the License at
kenjiArai 0:5b88d5760320 7 *
kenjiArai 0:5b88d5760320 8 * http://www.apache.org/licenses/LICENSE-2.0
kenjiArai 0:5b88d5760320 9 *
kenjiArai 0:5b88d5760320 10 * Unless required by applicable law or agreed to in writing, software
kenjiArai 0:5b88d5760320 11 * distributed under the License is distributed on an "AS IS" BASIS,
kenjiArai 0:5b88d5760320 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kenjiArai 0:5b88d5760320 13 * See the License for the specific language governing permissions and
kenjiArai 0:5b88d5760320 14 * limitations under the License.
kenjiArai 0:5b88d5760320 15 */
kenjiArai 0:5b88d5760320 16
kenjiArai 0:5b88d5760320 17 #include <stdbool.h>
kenjiArai 0:5b88d5760320 18 #include <string.h>
kenjiArai 0:5b88d5760320 19
kenjiArai 0:5b88d5760320 20 #include "lwip/opt.h"
kenjiArai 0:5b88d5760320 21 #include "lwip/netif.h"
kenjiArai 0:5b88d5760320 22 #include "lwip/ip.h"
kenjiArai 0:5b88d5760320 23 #include "lwip/api.h"
kenjiArai 0:5b88d5760320 24
kenjiArai 0:5b88d5760320 25 #include "LWIPStack.h"
kenjiArai 1:9db0e321a9f4 26 #include "lwip_tools.h"
kenjiArai 0:5b88d5760320 27
kenjiArai 0:5b88d5760320 28 #include "netsocket/nsapi_types.h"
kenjiArai 0:5b88d5760320 29
kenjiArai 1:9db0e321a9f4 30 #if !LWIP_IPV4 || !LWIP_IPV6
kenjiArai 1:9db0e321a9f4 31 static bool all_zeros(const uint8_t *p, int len);
kenjiArai 1:9db0e321a9f4 32 #endif
kenjiArai 1:9db0e321a9f4 33
kenjiArai 0:5b88d5760320 34 /* LWIP error remapping */
kenjiArai 0:5b88d5760320 35 nsapi_error_t LWIP::err_remap(err_t err)
kenjiArai 0:5b88d5760320 36 {
kenjiArai 0:5b88d5760320 37 switch (err) {
kenjiArai 0:5b88d5760320 38 case ERR_OK:
kenjiArai 0:5b88d5760320 39 case ERR_CLSD:
kenjiArai 0:5b88d5760320 40 return 0;
kenjiArai 0:5b88d5760320 41 case ERR_MEM:
kenjiArai 0:5b88d5760320 42 case ERR_BUF:
kenjiArai 0:5b88d5760320 43 return NSAPI_ERROR_NO_MEMORY;
kenjiArai 0:5b88d5760320 44 case ERR_CONN:
kenjiArai 0:5b88d5760320 45 case ERR_RST:
kenjiArai 0:5b88d5760320 46 case ERR_ABRT:
kenjiArai 0:5b88d5760320 47 return NSAPI_ERROR_NO_CONNECTION;
kenjiArai 0:5b88d5760320 48 case ERR_TIMEOUT:
kenjiArai 0:5b88d5760320 49 case ERR_RTE:
kenjiArai 0:5b88d5760320 50 case ERR_WOULDBLOCK:
kenjiArai 0:5b88d5760320 51 return NSAPI_ERROR_WOULD_BLOCK;
kenjiArai 0:5b88d5760320 52 case ERR_VAL:
kenjiArai 0:5b88d5760320 53 case ERR_USE:
kenjiArai 0:5b88d5760320 54 case ERR_ARG:
kenjiArai 0:5b88d5760320 55 return NSAPI_ERROR_PARAMETER;
kenjiArai 0:5b88d5760320 56 case ERR_INPROGRESS:
kenjiArai 0:5b88d5760320 57 return NSAPI_ERROR_IN_PROGRESS;
kenjiArai 0:5b88d5760320 58 case ERR_ALREADY:
kenjiArai 0:5b88d5760320 59 return NSAPI_ERROR_ALREADY;
kenjiArai 0:5b88d5760320 60 case ERR_ISCONN:
kenjiArai 0:5b88d5760320 61 return NSAPI_ERROR_IS_CONNECTED;
kenjiArai 0:5b88d5760320 62 default:
kenjiArai 0:5b88d5760320 63 return NSAPI_ERROR_DEVICE_ERROR;
kenjiArai 0:5b88d5760320 64 }
kenjiArai 0:5b88d5760320 65 }
kenjiArai 0:5b88d5760320 66
kenjiArai 0:5b88d5760320 67
kenjiArai 0:5b88d5760320 68 const ip_addr_t *LWIP::get_ipv4_addr(const struct netif *netif)
kenjiArai 0:5b88d5760320 69 {
kenjiArai 0:5b88d5760320 70 #if LWIP_IPV4
kenjiArai 0:5b88d5760320 71 if (!netif_is_up(netif)) {
kenjiArai 0:5b88d5760320 72 return NULL;
kenjiArai 0:5b88d5760320 73 }
kenjiArai 0:5b88d5760320 74
kenjiArai 0:5b88d5760320 75 if (!ip4_addr_isany(netif_ip4_addr(netif))) {
kenjiArai 0:5b88d5760320 76 return netif_ip_addr4(netif);
kenjiArai 0:5b88d5760320 77 }
kenjiArai 0:5b88d5760320 78 #endif
kenjiArai 0:5b88d5760320 79 return NULL;
kenjiArai 0:5b88d5760320 80 }
kenjiArai 0:5b88d5760320 81
kenjiArai 1:9db0e321a9f4 82 const ip_addr_t *LWIP::get_ipv6_link_local_addr(const struct netif *netif)
kenjiArai 1:9db0e321a9f4 83 {
kenjiArai 1:9db0e321a9f4 84 #if LWIP_IPV6
kenjiArai 1:9db0e321a9f4 85 if (!netif_is_up(netif)) {
kenjiArai 1:9db0e321a9f4 86 return NULL;
kenjiArai 1:9db0e321a9f4 87 }
kenjiArai 1:9db0e321a9f4 88
kenjiArai 1:9db0e321a9f4 89 for (int i = 0; i < LWIP_IPV6_NUM_ADDRESSES; i++) {
kenjiArai 1:9db0e321a9f4 90 if (ip6_addr_isvalid(netif_ip6_addr_state(netif, i)) &&
kenjiArai 1:9db0e321a9f4 91 ip6_addr_islinklocal(netif_ip6_addr(netif, i))) {
kenjiArai 1:9db0e321a9f4 92 return netif_ip_addr6(netif, i);
kenjiArai 1:9db0e321a9f4 93 }
kenjiArai 1:9db0e321a9f4 94 }
kenjiArai 1:9db0e321a9f4 95 #endif
kenjiArai 1:9db0e321a9f4 96 return NULL;
kenjiArai 1:9db0e321a9f4 97 }
kenjiArai 1:9db0e321a9f4 98
kenjiArai 0:5b88d5760320 99 const ip_addr_t *LWIP::get_ipv6_addr(const struct netif *netif)
kenjiArai 0:5b88d5760320 100 {
kenjiArai 0:5b88d5760320 101 #if LWIP_IPV6
kenjiArai 0:5b88d5760320 102 if (!netif_is_up(netif)) {
kenjiArai 0:5b88d5760320 103 return NULL;
kenjiArai 0:5b88d5760320 104 }
kenjiArai 0:5b88d5760320 105
kenjiArai 0:5b88d5760320 106 for (int i = 0; i < LWIP_IPV6_NUM_ADDRESSES; i++) {
kenjiArai 0:5b88d5760320 107 if (ip6_addr_isvalid(netif_ip6_addr_state(netif, i)) &&
kenjiArai 0:5b88d5760320 108 !ip6_addr_islinklocal(netif_ip6_addr(netif, i))) {
kenjiArai 0:5b88d5760320 109 return netif_ip_addr6(netif, i);
kenjiArai 0:5b88d5760320 110 }
kenjiArai 0:5b88d5760320 111 }
kenjiArai 1:9db0e321a9f4 112
kenjiArai 1:9db0e321a9f4 113 for (int i = 0; i < LWIP_IPV6_NUM_ADDRESSES; i++) {
kenjiArai 1:9db0e321a9f4 114 if (ip6_addr_isvalid(netif_ip6_addr_state(netif, i))) {
kenjiArai 1:9db0e321a9f4 115 return netif_ip_addr6(netif, i);
kenjiArai 1:9db0e321a9f4 116 }
kenjiArai 1:9db0e321a9f4 117 }
kenjiArai 0:5b88d5760320 118 #endif
kenjiArai 0:5b88d5760320 119 return NULL;
kenjiArai 0:5b88d5760320 120 }
kenjiArai 0:5b88d5760320 121
kenjiArai 0:5b88d5760320 122 bool LWIP::is_local_addr(const ip_addr_t *ip_addr)
kenjiArai 0:5b88d5760320 123 {
kenjiArai 0:5b88d5760320 124 struct netif *netif;
kenjiArai 0:5b88d5760320 125
kenjiArai 0:5b88d5760320 126 for (netif = netif_list; netif != NULL; netif = netif->next) {
kenjiArai 0:5b88d5760320 127 if (!netif_is_up(netif)) {
kenjiArai 0:5b88d5760320 128 continue;
kenjiArai 0:5b88d5760320 129 }
kenjiArai 0:5b88d5760320 130 #if LWIP_IPV6
kenjiArai 0:5b88d5760320 131 if (IP_IS_V6(ip_addr)) {
kenjiArai 0:5b88d5760320 132 for (int i = 0; i < LWIP_IPV6_NUM_ADDRESSES; i++) {
kenjiArai 0:5b88d5760320 133 if (ip6_addr_isvalid(netif_ip6_addr_state(netif, i)) &&
kenjiArai 0:5b88d5760320 134 ip6_addr_cmp(netif_ip6_addr(netif, i), ip_2_ip6(ip_addr))) {
kenjiArai 0:5b88d5760320 135 return true;
kenjiArai 0:5b88d5760320 136 }
kenjiArai 0:5b88d5760320 137 }
kenjiArai 0:5b88d5760320 138 }
kenjiArai 0:5b88d5760320 139 #endif
kenjiArai 0:5b88d5760320 140
kenjiArai 0:5b88d5760320 141 #if LWIP_IPV4
kenjiArai 0:5b88d5760320 142 if (IP_IS_V4(ip_addr)) {
kenjiArai 0:5b88d5760320 143 if (!ip4_addr_isany(netif_ip4_addr(netif)) &&
kenjiArai 0:5b88d5760320 144 ip4_addr_cmp(netif_ip4_addr(netif), ip_2_ip4(ip_addr))) {
kenjiArai 0:5b88d5760320 145 return true;
kenjiArai 0:5b88d5760320 146 }
kenjiArai 0:5b88d5760320 147 }
kenjiArai 0:5b88d5760320 148 #endif
kenjiArai 0:5b88d5760320 149 }
kenjiArai 0:5b88d5760320 150 return false;
kenjiArai 0:5b88d5760320 151 }
kenjiArai 0:5b88d5760320 152
kenjiArai 0:5b88d5760320 153 const ip_addr_t *LWIP::get_ip_addr(bool any_addr, const struct netif *netif)
kenjiArai 0:5b88d5760320 154 {
kenjiArai 0:5b88d5760320 155 const ip_addr_t *pref_ip_addr = 0;
kenjiArai 0:5b88d5760320 156 const ip_addr_t *npref_ip_addr = 0;
kenjiArai 0:5b88d5760320 157
kenjiArai 0:5b88d5760320 158 #if LWIP_IPV4 && LWIP_IPV6
kenjiArai 0:5b88d5760320 159 #if IP_VERSION_PREF == PREF_IPV4
kenjiArai 0:5b88d5760320 160 pref_ip_addr = get_ipv4_addr(netif);
kenjiArai 0:5b88d5760320 161 npref_ip_addr = get_ipv6_addr(netif);
kenjiArai 0:5b88d5760320 162 #else
kenjiArai 0:5b88d5760320 163 pref_ip_addr = get_ipv6_addr(netif);
kenjiArai 0:5b88d5760320 164 npref_ip_addr = get_ipv4_addr(netif);
kenjiArai 0:5b88d5760320 165 #endif
kenjiArai 0:5b88d5760320 166 #elif LWIP_IPV6
kenjiArai 0:5b88d5760320 167 pref_ip_addr = get_ipv6_addr(netif);
kenjiArai 0:5b88d5760320 168 #elif LWIP_IPV4
kenjiArai 0:5b88d5760320 169 pref_ip_addr = get_ipv4_addr(netif);
kenjiArai 0:5b88d5760320 170 #endif
kenjiArai 0:5b88d5760320 171
kenjiArai 0:5b88d5760320 172 if (pref_ip_addr) {
kenjiArai 0:5b88d5760320 173 return pref_ip_addr;
kenjiArai 0:5b88d5760320 174 } else if (npref_ip_addr && any_addr) {
kenjiArai 0:5b88d5760320 175 return npref_ip_addr;
kenjiArai 0:5b88d5760320 176 }
kenjiArai 0:5b88d5760320 177
kenjiArai 0:5b88d5760320 178 return NULL;
kenjiArai 0:5b88d5760320 179 }
kenjiArai 0:5b88d5760320 180
kenjiArai 0:5b88d5760320 181 void LWIP::arena_init(void)
kenjiArai 0:5b88d5760320 182 {
kenjiArai 0:5b88d5760320 183 memset(arena, 0, sizeof(arena));
kenjiArai 0:5b88d5760320 184 }
kenjiArai 0:5b88d5760320 185
kenjiArai 0:5b88d5760320 186 struct LWIP::mbed_lwip_socket *LWIP::arena_alloc()
kenjiArai 0:5b88d5760320 187 {
kenjiArai 0:5b88d5760320 188 LWIP &lwip = LWIP::get_instance();
kenjiArai 0:5b88d5760320 189
kenjiArai 0:5b88d5760320 190 lwip.adaptation.lock();
kenjiArai 0:5b88d5760320 191
kenjiArai 0:5b88d5760320 192 for (int i = 0; i < MEMP_NUM_NETCONN; i++) {
kenjiArai 0:5b88d5760320 193 if (!arena[i].in_use) {
kenjiArai 0:5b88d5760320 194 struct mbed_lwip_socket *s = &arena[i];
kenjiArai 0:5b88d5760320 195 memset(s, 0, sizeof(*s));
kenjiArai 0:5b88d5760320 196 s->in_use = true;
kenjiArai 0:5b88d5760320 197 lwip.adaptation.unlock();
kenjiArai 0:5b88d5760320 198 return s;
kenjiArai 0:5b88d5760320 199 }
kenjiArai 0:5b88d5760320 200 }
kenjiArai 0:5b88d5760320 201
kenjiArai 0:5b88d5760320 202 lwip.adaptation.unlock();
kenjiArai 0:5b88d5760320 203
kenjiArai 0:5b88d5760320 204 return 0;
kenjiArai 0:5b88d5760320 205 }
kenjiArai 0:5b88d5760320 206
kenjiArai 0:5b88d5760320 207 void LWIP::arena_dealloc(struct mbed_lwip_socket *s)
kenjiArai 0:5b88d5760320 208 {
kenjiArai 0:5b88d5760320 209 s->in_use = false;
kenjiArai 0:5b88d5760320 210
kenjiArai 0:5b88d5760320 211 while (s->multicast_memberships_count > 0) {
kenjiArai 0:5b88d5760320 212 uint32_t index = 0;
kenjiArai 0:5b88d5760320 213 index = next_registered_multicast_member(s, index);
kenjiArai 0:5b88d5760320 214
kenjiArai 0:5b88d5760320 215 setsockopt(s, NSAPI_SOCKET, NSAPI_DROP_MEMBERSHIP, &s->multicast_memberships[index],
kenjiArai 0:5b88d5760320 216 sizeof(s->multicast_memberships[index]));
kenjiArai 0:5b88d5760320 217 index++;
kenjiArai 0:5b88d5760320 218 }
kenjiArai 0:5b88d5760320 219
kenjiArai 0:5b88d5760320 220 free(s->multicast_memberships);
kenjiArai 0:5b88d5760320 221 s->multicast_memberships = NULL;
kenjiArai 0:5b88d5760320 222 }
kenjiArai 1:9db0e321a9f4 223
kenjiArai 1:9db0e321a9f4 224 bool convert_lwip_addr_to_mbed(nsapi_addr_t *out, const ip_addr_t *in)
kenjiArai 1:9db0e321a9f4 225 {
kenjiArai 1:9db0e321a9f4 226 #if LWIP_IPV6
kenjiArai 1:9db0e321a9f4 227 if (IP_IS_V6(in)) {
kenjiArai 1:9db0e321a9f4 228 out->version = NSAPI_IPv6;
kenjiArai 1:9db0e321a9f4 229 SMEMCPY(out->bytes, ip_2_ip6(in), sizeof(ip6_addr_t));
kenjiArai 1:9db0e321a9f4 230 return true;
kenjiArai 1:9db0e321a9f4 231 }
kenjiArai 1:9db0e321a9f4 232 #endif
kenjiArai 1:9db0e321a9f4 233 #if LWIP_IPV4
kenjiArai 1:9db0e321a9f4 234 if (IP_IS_V4(in)) {
kenjiArai 1:9db0e321a9f4 235 out->version = NSAPI_IPv4;
kenjiArai 1:9db0e321a9f4 236 SMEMCPY(out->bytes, ip_2_ip4(in), sizeof(ip4_addr_t));
kenjiArai 1:9db0e321a9f4 237 return true;
kenjiArai 1:9db0e321a9f4 238 }
kenjiArai 1:9db0e321a9f4 239 #endif
kenjiArai 1:9db0e321a9f4 240 #if LWIP_IPV6 && LWIP_IPV4
kenjiArai 1:9db0e321a9f4 241 return false;
kenjiArai 1:9db0e321a9f4 242 #endif
kenjiArai 1:9db0e321a9f4 243 }
kenjiArai 1:9db0e321a9f4 244
kenjiArai 1:9db0e321a9f4 245 bool convert_mbed_addr_to_lwip(ip_addr_t *out, const nsapi_addr_t *in)
kenjiArai 1:9db0e321a9f4 246 {
kenjiArai 1:9db0e321a9f4 247 #if LWIP_IPV6
kenjiArai 1:9db0e321a9f4 248 if (in->version == NSAPI_IPv6) {
kenjiArai 1:9db0e321a9f4 249 IP_SET_TYPE(out, IPADDR_TYPE_V6);
kenjiArai 1:9db0e321a9f4 250 SMEMCPY(ip_2_ip6(out), in->bytes, sizeof(ip6_addr_t));
kenjiArai 1:9db0e321a9f4 251 return true;
kenjiArai 1:9db0e321a9f4 252 }
kenjiArai 1:9db0e321a9f4 253 #if !LWIP_IPV4
kenjiArai 1:9db0e321a9f4 254 /* For bind() and other purposes, need to accept "null" of other type */
kenjiArai 1:9db0e321a9f4 255 /* (People use IPv4 0.0.0.0 as a general null) */
kenjiArai 1:9db0e321a9f4 256 if (in->version == NSAPI_UNSPEC ||
kenjiArai 1:9db0e321a9f4 257 (in->version == NSAPI_IPv4 && all_zeros(in->bytes, 4))) {
kenjiArai 1:9db0e321a9f4 258 ip_addr_set_zero_ip6(out);
kenjiArai 1:9db0e321a9f4 259 return true;
kenjiArai 1:9db0e321a9f4 260 }
kenjiArai 1:9db0e321a9f4 261 #endif
kenjiArai 1:9db0e321a9f4 262 #endif
kenjiArai 1:9db0e321a9f4 263
kenjiArai 1:9db0e321a9f4 264 #if LWIP_IPV4
kenjiArai 1:9db0e321a9f4 265 if (in->version == NSAPI_IPv4) {
kenjiArai 1:9db0e321a9f4 266 IP_SET_TYPE(out, IPADDR_TYPE_V4);
kenjiArai 1:9db0e321a9f4 267 SMEMCPY(ip_2_ip4(out), in->bytes, sizeof(ip4_addr_t));
kenjiArai 1:9db0e321a9f4 268 return true;
kenjiArai 1:9db0e321a9f4 269 }
kenjiArai 1:9db0e321a9f4 270 #if !LWIP_IPV6
kenjiArai 1:9db0e321a9f4 271 /* For symmetry with above, accept IPv6 :: as a general null */
kenjiArai 1:9db0e321a9f4 272 if (in->version == NSAPI_UNSPEC ||
kenjiArai 1:9db0e321a9f4 273 (in->version == NSAPI_IPv6 && all_zeros(in->bytes, 16))) {
kenjiArai 1:9db0e321a9f4 274 ip_addr_set_zero_ip4(out);
kenjiArai 1:9db0e321a9f4 275 return true;
kenjiArai 1:9db0e321a9f4 276 }
kenjiArai 1:9db0e321a9f4 277 #endif
kenjiArai 1:9db0e321a9f4 278 #endif
kenjiArai 1:9db0e321a9f4 279
kenjiArai 1:9db0e321a9f4 280 #if LWIP_IPV4 && LWIP_IPV6
kenjiArai 1:9db0e321a9f4 281 if (in->version == NSAPI_UNSPEC) {
kenjiArai 1:9db0e321a9f4 282 ip6_addr_set_zero(ip_2_ip6(out));
kenjiArai 1:9db0e321a9f4 283 IP_SET_TYPE(out, IPADDR_TYPE_ANY);
kenjiArai 1:9db0e321a9f4 284 return true;
kenjiArai 1:9db0e321a9f4 285 }
kenjiArai 1:9db0e321a9f4 286 #endif
kenjiArai 1:9db0e321a9f4 287
kenjiArai 1:9db0e321a9f4 288 return false;
kenjiArai 1:9db0e321a9f4 289 }
kenjiArai 1:9db0e321a9f4 290
kenjiArai 1:9db0e321a9f4 291 #if !LWIP_IPV4 || !LWIP_IPV6
kenjiArai 1:9db0e321a9f4 292 static bool all_zeros(const uint8_t *p, int len)
kenjiArai 1:9db0e321a9f4 293 {
kenjiArai 1:9db0e321a9f4 294 for (int i = 0; i < len; i++) {
kenjiArai 1:9db0e321a9f4 295 if (p[i]) {
kenjiArai 1:9db0e321a9f4 296 return false;
kenjiArai 1:9db0e321a9f4 297 }
kenjiArai 1:9db0e321a9f4 298 }
kenjiArai 1:9db0e321a9f4 299
kenjiArai 1:9db0e321a9f4 300 return true;
kenjiArai 1:9db0e321a9f4 301 }
kenjiArai 1:9db0e321a9f4 302 #endif