resource/csdk/connectivity/src/ip_adapter/caipserver.c

   1 /*****************************************************************j
   2  *
   3  * Copyright 2014 Samsung Electronics All Rights Reserved.
   4  *
   5  *
   6  *
   7  * Licensed under the Apache License, Version 2.0 (the "License");
   8  * you may not use this file except in compliance with the License.
   9  * You may obtain a copy of the License at
  10  *
  11  *      http://www.apache.org/licenses/LICENSE-2.0
  12  *
  13  * Unless required by applicable law or agreed to in writing, software
  14  * distributed under the License is distributed on an "AS IS" BASIS,
  15  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  16  * See the License for the specific language governing permissions and
  17  * limitations under the License.
  18  *
  19  ******************************************************************/
  20
  21 #include "caipinterface.h"
  22
  23 #ifndef __APPLE__
  24 #include <asm/types.h>
  25 #else
  26     #ifndef IPV6_ADD_MEMBERSHIP
  27         #define IPV6_ADD_MEMBERSHIP IPV6_JOIN_GROUP
  28     #endif
  29 #endif
  30 #include <sys/types.h>
  31 #include <sys/socket.h>
  32 #include <stdio.h>
  33 #include <unistd.h>
  34 #include <sys/types.h>
  35 #include <fcntl.h>
  36 #include <sys/select.h>
  37 #include <arpa/inet.h>
  38 #include <netinet/in.h>
  39 #include <net/if.h>
  40 #include <errno.h>
  41 #ifdef __linux__
  42 #include <linux/netlink.h>
  43 #include <linux/rtnetlink.h>
  44 #endif
  45
  46 #include "pdu.h"
  47 #include "caadapterutils.h"
  48 #ifdef __WITH_DTLS__
  49 #include "caadapternetdtls.h"
  50 #endif
  51 #include "camutex.h"
  52 #include "oic_malloc.h"
  53 #include "oic_string.h"
  54
  55 /**
  56  * @def TAG
  57  * @brief Logging tag for module name
  58  */
  59 #define TAG "IP_SERVER"
  60
  61 #define SELECT_TIMEOUT 1     // select() seconds (and termination latency)
  62
  63 #define IPv4_MULTICAST     "224.0.1.187"
  64 static struct in_addr IPv4MulticastAddress = { 0 };
  65
  66 #define IPv6_DOMAINS       16
  67 #define IPv6_MULTICAST_INT "ff01::fd"
  68 static struct in6_addr IPv6MulticastAddressInt;
  69 #define IPv6_MULTICAST_LNK "ff02::fd"
  70 static struct in6_addr IPv6MulticastAddressLnk;
  71 #define IPv6_MULTICAST_RLM "ff03::fd"
  72 static struct in6_addr IPv6MulticastAddressRlm;
  73 #define IPv6_MULTICAST_ADM "ff04::fd"
  74 static struct in6_addr IPv6MulticastAddressAdm;
  75 #define IPv6_MULTICAST_SIT "ff05::fd"
  76 static struct in6_addr IPv6MulticastAddressSit;
  77 #define IPv6_MULTICAST_ORG "ff08::fd"
  78 static struct in6_addr IPv6MulticastAddressOrg;
  79 #define IPv6_MULTICAST_GLB "ff0e::fd"
  80 static struct in6_addr IPv6MulticastAddressGlb;
  81
  82 static char *ipv6mcnames[IPv6_DOMAINS] = {
  83     NULL,
  84     IPv6_MULTICAST_INT,
  85     IPv6_MULTICAST_LNK,
  86     IPv6_MULTICAST_RLM,
  87     IPv6_MULTICAST_ADM,
  88     IPv6_MULTICAST_SIT,
  89     NULL,
  90     NULL,
  91     IPv6_MULTICAST_ORG,
  92     NULL,
  93     NULL,
  94     NULL,
  95     NULL,
  96     NULL,
  97     IPv6_MULTICAST_GLB,
  98     NULL
  99 };
 100
 101 static CAIPExceptionCallback g_exceptionCallback;
 102
 103 static CAIPPacketReceivedCallback g_packetReceivedCallback;
 104
 105 static void CAHandleNetlink();
 106 static void CAApplyInterfaces();
 107 static void CAFindReadyMessage();
 108 static void CASelectReturned(fd_set *readFds, int ret);
 109 static CAResult_t CAReceiveMessage(int fd, CATransportFlags_t flags);
 110
 111 #define SET(TYPE, FDS) \
 112     if (caglobals.ip.TYPE.fd != -1) \
 113     { \
 114         FD_SET(caglobals.ip.TYPE.fd, FDS); \
 115     }
 116
 117 #define ISSET(TYPE, FDS, FLAGS) \
 118     if (caglobals.ip.TYPE.fd != -1 && FD_ISSET(caglobals.ip.TYPE.fd, FDS)) \
 119     { \
 120         fd = caglobals.ip.TYPE.fd; \
 121         flags = FLAGS; \
 122     }
 123
 124 static void CAReceiveHandler(void *data)
 125 {
 126     (void)data;
 127     OIC_LOG(DEBUG, TAG, "IN");
 128
 129     while (!caglobals.ip.terminate)
 130     {
 131         CAFindReadyMessage();
 132     }
 133
 134     OIC_LOG(DEBUG, TAG, "OUT");
 135 }
 136
 137 static void CAFindReadyMessage()
 138 {
 139     fd_set readFds;
 140     struct timeval timeout;
 141
 142     timeout.tv_sec = caglobals.ip.selectTimeout;
 143     timeout.tv_usec = 0;
 144     struct timeval *tv = caglobals.ip.selectTimeout == -1 ? NULL : &timeout;
 145
 146     FD_ZERO(&readFds);
 147     SET(u6,  &readFds)
 148     SET(u6s, &readFds)
 149     SET(u4,  &readFds)
 150     SET(u4s, &readFds)
 151     SET(m6,  &readFds)
 152     SET(m6s, &readFds)
 153     SET(m4,  &readFds)
 154     SET(m4s, &readFds)
 155     if (caglobals.ip.shutdownFds[0] != -1)
 156     {
 157         FD_SET(caglobals.ip.shutdownFds[0], &readFds);
 158     }
 159     if (caglobals.ip.netlinkFd != -1)
 160     {
 161         FD_SET(caglobals.ip.netlinkFd, &readFds);
 162     }
 163
 164     int ret = select(caglobals.ip.maxfd + 1, &readFds, NULL, NULL, tv);
 165
 166     if (caglobals.ip.terminate)
 167     {
 168         OIC_LOG_V(DEBUG, TAG, "Packet receiver Stop request received.");
 169         return;
 170     }
 171     if (ret <= 0)
 172     {
 173         if (ret < 0)
 174         {
 175             OIC_LOG_V(FATAL, TAG, "select error %s", strerror(errno));
 176         }
 177         return;
 178     }
 179
 180     CASelectReturned(&readFds, ret);
 181 }
 182
 183 static void CASelectReturned(fd_set *readFds, int ret)
 184 {
 185     (void)ret;
 186     int fd = -1;
 187     CATransportFlags_t flags = CA_DEFAULT_FLAGS;
 188
 189     while (!caglobals.ip.terminate)
 190     {
 191         ISSET(u6,  readFds, CA_IPV6)
 192         else ISSET(u6s, readFds, CA_IPV6 | CA_SECURE)
 193         else ISSET(u4,  readFds, CA_IPV4)
 194         else ISSET(u4s, readFds, CA_IPV4 | CA_SECURE)
 195         else ISSET(m6,  readFds, CA_MULTICAST | CA_IPV6)
 196         else ISSET(m6s, readFds, CA_MULTICAST | CA_IPV6 | CA_SECURE)
 197         else ISSET(m4,  readFds, CA_MULTICAST | CA_IPV4)
 198         else ISSET(m4s, readFds, CA_MULTICAST | CA_IPV4 | CA_SECURE)
 199         else if (FD_ISSET(caglobals.ip.netlinkFd, readFds))
 200         {
 201             CAHandleNetlink();
 202             break;
 203         }
 204         else
 205         {
 206             break;
 207         }
 208
 209         (void)CAReceiveMessage(fd, flags);
 210         FD_CLR(fd, readFds);
 211     }
 212 }
 213
 214 static CAResult_t CAReceiveMessage(int fd, CATransportFlags_t flags)
 215 {
 216     char recvBuffer[COAP_MAX_PDU_SIZE];
 217
 218     struct sockaddr_storage srcAddr;
 219     socklen_t srcAddrLen = sizeof (srcAddr);
 220
 221     ssize_t recvLen = recvfrom(fd,
 222                                recvBuffer,
 223                                sizeof (recvBuffer),
 224                                0,
 225                                (struct sockaddr *)&srcAddr,
 226                                &srcAddrLen);
 227     if (-1 == recvLen)
 228     {
 229         OIC_LOG_V(ERROR, TAG, "Recvfrom failed %s", strerror(errno));
 230         return CA_STATUS_FAILED;
 231     }
 232
 233     CAEndpoint_t ep = { .adapter = CA_ADAPTER_IP,
 234                         .flags = flags };
 235
 236     if (flags & CA_IPV6)
 237     {
 238         ep.interface = ((struct sockaddr_in6 *)&srcAddr)->sin6_scope_id;
 239         ((struct sockaddr_in6 *)&srcAddr)->sin6_scope_id = 0;
 240     }
 241     CAConvertAddrToName(&srcAddr, ep.addr, &ep.port);
 242
 243     if (flags & CA_SECURE)
 244     {
 245 #ifdef __WITH_DTLS__
 246         int ret = CAAdapterNetDtlsDecrypt(&ep, (uint8_t *)recvBuffer, recvLen);
 247         OIC_LOG_V(DEBUG, TAG, "CAAdapterNetDtlsDecrypt returns [%d]", ret);
 248 #else
 249         OIC_LOG(ERROR, TAG, "Encrypted message but no DTLS");
 250 #endif
 251     }
 252     else
 253     {
 254         if (g_packetReceivedCallback)
 255         {
 256             g_packetReceivedCallback(&ep, recvBuffer, recvLen);
 257         }
 258     }
 259
 260     return CA_STATUS_OK;
 261 }
 262
 263 void CAIPPullData()
 264 {
 265     OIC_LOG(DEBUG, TAG, "IN");
 266     OIC_LOG(DEBUG, TAG, "OUT");
 267 }
 268
 269 static int CACreateSocket(int family, uint16_t *port)
 270 {
 271     int socktype = SOCK_DGRAM;
 272     #ifdef SOCK_CLOEXEC
 273     socktype |= SOCK_CLOEXEC;
 274     #endif
 275     int fd = socket(family, socktype, IPPROTO_UDP);
 276     if (-1 == fd)
 277     {
 278         OIC_LOG_V(ERROR, TAG, "create socket failed: %s", strerror(errno));
 279         return -1;
 280     }
 281
 282     #ifndef SOCK_CLOEXEC
 283     int fl = fcntl(fd, F_GETFD);
 284     if (-1 == fl || -1 == fcntl(fd, F_SETFD, fl|FD_CLOEXEC))
 285     {
 286         OIC_LOG_V(ERROR, TAG, "set FD_CLOEXEC failed: %s", strerror(errno));
 287         close(fd);
 288         return -1;
 289     }
 290     #endif
 291
 292     struct sockaddr_storage sa = { .ss_family = family };
 293     if (family == AF_INET6)
 294     {
 295         int on = 1;
 296         if (-1 == setsockopt(fd, IPPROTO_IPV6, IPV6_V6ONLY, &on, sizeof (on)))
 297         {
 298             OIC_LOG_V(ERROR, TAG, "IPV6_V6ONLY failed: %s", strerror(errno));
 299         }
 300         ((struct sockaddr_in6 *)&sa)->sin6_port = htons(*port);
 301     }
 302     else
 303     {
 304         ((struct sockaddr_in *)&sa)->sin_port = htons(*port);
 305     }
 306
 307     if (*port)  // use the given port
 308     {
 309         int on = 1;
 310         if (setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (char *)&on, sizeof (on)))
 311         {
 312             OIC_LOG_V(ERROR, TAG, "SO_REUSEADDR failed: %s", strerror(errno));
 313             close(fd);
 314             return -1;
 315         }
 316     }
 317
 318     if (-1 == bind(fd, (struct sockaddr *)&sa, sizeof(sa)))
 319     {
 320         OIC_LOG_V(ERROR, TAG, "bind socket failed: %s", strerror(errno));
 321         close(fd);
 322         return -1;
 323     }
 324
 325     if (!*port)  // return the assigned port
 326     {
 327         struct sockaddr_storage sa;
 328         socklen_t socklen = sizeof (sa);
 329         if (-1 == getsockname(fd, (struct sockaddr *)&sa, &socklen))
 330         {
 331             OIC_LOG_V(ERROR, TAG, "getsockname failed: %s", strerror(errno));
 332             close(fd);
 333             return -1;
 334         }
 335         *port = ntohs(family == AF_INET6 ?
 336                       ((struct sockaddr_in6 *)&sa)->sin6_port :
 337                       ((struct sockaddr_in *)&sa)->sin_port);
 338     }
 339
 340     return fd;
 341 }
 342
 343 #define CHECKFD(FD) \
 344     if (FD > caglobals.ip.maxfd) \
 345         caglobals.ip.maxfd = FD;
 346 #define NEWSOCKET(FAMILY, NAME) \
 347     caglobals.ip.NAME.fd = CACreateSocket(FAMILY, &caglobals.ip.NAME.port); \
 348     CHECKFD(caglobals.ip.NAME.fd)
 349
 350 static void CAInitializeNetlink()
 351 {
 352 #ifdef __linux__
 353     // create NETLINK fd for interface change notifications
 354     struct sockaddr_nl sa = { AF_NETLINK, 0, 0, RTMGRP_LINK };
 355
 356     caglobals.ip.netlinkFd = socket(AF_NETLINK, SOCK_RAW|SOCK_CLOEXEC, NETLINK_ROUTE);
 357     if (caglobals.ip.netlinkFd == -1)
 358     {
 359         OIC_LOG_V(ERROR, TAG, "netlink socket failed: %s", strerror(errno));
 360     }
 361     else
 362     {
 363         int r = bind(caglobals.ip.netlinkFd, (struct sockaddr *)&sa, sizeof (sa));
 364         if (r)
 365         {
 366             OIC_LOG_V(ERROR, TAG, "netlink bind failed: %s", strerror(errno));
 367             close(caglobals.ip.netlinkFd);
 368             caglobals.ip.netlinkFd = -1;
 369         }
 370         else
 371         {
 372             CHECKFD(caglobals.ip.netlinkFd);
 373         }
 374     }
 375 #endif
 376 }
 377
 378 static void CAInitializePipe()
 379 {
 380     caglobals.ip.selectTimeout = -1;
 381 #ifdef HAVE_PIPE2
 382     int ret = pipe2(caglobals.ip.shutdownFds, O_CLOEXEC);
 383 #else
 384     int ret = pipe(caglobals.ip.shutdownFds);
 385     if (-1 != ret)
 386     {
 387         ret = fcntl(caglobals.ip.shutdownFds[0], F_GETFD);
 388         if (-1 != ret)
 389         {
 390             ret = fcntl(caglobals.ip.shutdownFds[0], F_SETFD, ret|FD_CLOEXEC);
 391         }
 392         if (-1 != ret)
 393         {
 394             ret = fcntl(caglobals.ip.shutdownFds[1], F_GETFD);
 395         }
 396         if (-1 != ret)
 397         {
 398             ret = fcntl(caglobals.ip.shutdownFds[1], F_SETFD, ret|FD_CLOEXEC);
 399         }
 400         if (-1 == ret)
 401         {
 402             close(caglobals.ip.shutdownFds[1]);
 403             close(caglobals.ip.shutdownFds[0]);
 404             caglobals.ip.shutdownFds[0] = -1;
 405             caglobals.ip.shutdownFds[1] = -1;
 406         }
 407     }
 408 #endif
 409     if (-1 == ret)
 410     {
 411         OIC_LOG_V(ERROR, TAG, "pipe failed: %s", strerror(errno));
 412         caglobals.ip.selectTimeout = SELECT_TIMEOUT; //poll needed for shutdown
 413     }
 414 }
 415
 416 CAResult_t CAIPStartServer(const ca_thread_pool_t threadPool)
 417 {
 418     CAResult_t res = CA_STATUS_OK;
 419
 420     if (caglobals.ip.started)
 421     {
 422         return res;
 423     }
 424
 425     if (!IPv4MulticastAddress.s_addr)
 426     {
 427         (void)inet_aton(IPv4_MULTICAST, &IPv4MulticastAddress);
 428         (void)inet_pton(AF_INET6, IPv6_MULTICAST_INT, &IPv6MulticastAddressInt);
 429         (void)inet_pton(AF_INET6, IPv6_MULTICAST_LNK, &IPv6MulticastAddressLnk);
 430         (void)inet_pton(AF_INET6, IPv6_MULTICAST_RLM, &IPv6MulticastAddressRlm);
 431         (void)inet_pton(AF_INET6, IPv6_MULTICAST_ADM, &IPv6MulticastAddressAdm);
 432         (void)inet_pton(AF_INET6, IPv6_MULTICAST_SIT, &IPv6MulticastAddressSit);
 433         (void)inet_pton(AF_INET6, IPv6_MULTICAST_ORG, &IPv6MulticastAddressOrg);
 434         (void)inet_pton(AF_INET6, IPv6_MULTICAST_GLB, &IPv6MulticastAddressGlb);
 435     }
 436
 437     if (!caglobals.ip.ipv6enabled && !caglobals.ip.ipv4enabled)
 438     {
 439         caglobals.ip.ipv4enabled = true;  // only needed to run CA tests
 440     }
 441
 442     if (caglobals.ip.ipv6enabled)
 443     {
 444         NEWSOCKET(AF_INET6, u6)
 445         NEWSOCKET(AF_INET6, u6s)
 446         NEWSOCKET(AF_INET6, m6)
 447         NEWSOCKET(AF_INET6, m6s)
 448         OIC_LOG_V(INFO, TAG, "IPv6 unicast port: %u", caglobals.ip.u6.port);
 449     }
 450     if (caglobals.ip.ipv4enabled)
 451     {
 452         NEWSOCKET(AF_INET, u4)
 453         NEWSOCKET(AF_INET, u4s)
 454         NEWSOCKET(AF_INET, m4)
 455         NEWSOCKET(AF_INET, m4s)
 456         OIC_LOG_V(INFO, TAG, "IPv4 unicast port: %u", caglobals.ip.u4.port);
 457     }
 458
 459     OIC_LOG_V(DEBUG, TAG,
 460               "socket summary: u6=%d, u6s=%d, u4=%d, u4s=%d, m6=%d, m6s=%d, m4=%d, m4s=%d",
 461                              caglobals.ip.u6.fd, caglobals.ip.u6s.fd,
 462                              caglobals.ip.u4.fd, caglobals.ip.u4s.fd,
 463                              caglobals.ip.m6.fd, caglobals.ip.m6s.fd,
 464                              caglobals.ip.m4.fd, caglobals.ip.m4s.fd);
 465
 466     // create pipe for fast shutdown
 467     CAInitializePipe();
 468     CHECKFD(caglobals.ip.shutdownFds[0]);
 469     CHECKFD(caglobals.ip.shutdownFds[1]);
 470
 471     // create source of network interface change notifications
 472     CAInitializeNetlink();
 473
 474     CAApplyInterfaces();
 475
 476     caglobals.ip.terminate = false;
 477     res = ca_thread_pool_add_task(threadPool, CAReceiveHandler, NULL);
 478     if (CA_STATUS_OK != res)
 479     {
 480         OIC_LOG(ERROR, TAG, "thread_pool_add_task failed");
 481         return res;
 482     }
 483     OIC_LOG(DEBUG, TAG, "CAReceiveHandler thread started successfully.");
 484
 485     caglobals.ip.started = true;
 486     return CA_STATUS_OK;
 487 }
 488
 489 void CAIPStopServer()
 490 {
 491     OIC_LOG(DEBUG, TAG, "IN");
 492
 493     caglobals.ip.terminate = true;
 494
 495     if (caglobals.ip.shutdownFds[1] != -1)
 496     {
 497         close(caglobals.ip.shutdownFds[1]);
 498         // receive thread will stop immediately
 499     }
 500     else
 501     {
 502         // receive thread will stop in SELECT_TIMEOUT seconds.
 503     }
 504
 505     OIC_LOG(DEBUG, TAG, "OUT");
 506 }
 507
 508 static void applyMulticastToInterface4(struct in_addr inaddr)
 509 {
 510     if (!caglobals.ip.ipv4enabled)
 511     {
 512         return;
 513     }
 514
 515     struct ip_mreq mreq = { .imr_multiaddr = IPv4MulticastAddress,
 516                             .imr_interface = inaddr};
 517     if (setsockopt(caglobals.ip.m4.fd, IPPROTO_IP, IP_ADD_MEMBERSHIP, &mreq, sizeof (mreq)))
 518     {
 519         if (EADDRINUSE != errno)
 520         {
 521             OIC_LOG_V(ERROR, TAG, "IPv4 IP_ADD_MEMBERSHIP failed: %s", strerror(errno));
 522         }
 523     }
 524     if (setsockopt(caglobals.ip.m4s.fd, IPPROTO_IP, IP_ADD_MEMBERSHIP, &mreq, sizeof (mreq)))
 525     {
 526         if (EADDRINUSE != errno)
 527         {
 528             OIC_LOG_V(ERROR, TAG, "secure IPv4 IP_ADD_MEMBERSHIP failed: %s", strerror(errno));
 529         }
 530     }
 531 }
 532
 533 static void applyMulticast6(int fd, struct in6_addr *addr, uint32_t interface)
 534 {
 535     struct ipv6_mreq mreq;
 536     mreq.ipv6mr_multiaddr = *addr;
 537     mreq.ipv6mr_interface = interface;
 538     if (setsockopt(fd, IPPROTO_IPV6, IPV6_ADD_MEMBERSHIP, &mreq, sizeof (mreq)))
 539     {
 540         if (EADDRINUSE != errno)
 541         {
 542             OIC_LOG_V(ERROR, TAG, "IPv6 IP_ADD_MEMBERSHIP failed: %s", strerror(errno));
 543         }
 544     }
 545 }
 546
 547 static void applyMulticastToInterface6(uint32_t interface)
 548 {
 549     if (!caglobals.ip.ipv6enabled)
 550     {
 551         return;
 552     }
 553     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressInt, interface);
 554     applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressLnk, interface);
 555     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressRlm, interface);
 556     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressAdm, interface);
 557     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressSit, interface);
 558     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressOrg, interface);
 559     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressGlb, interface);
 560     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressInt, interface);
 561     applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressLnk, interface);
 562     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressRlm, interface);
 563     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressAdm, interface);
 564     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressSit, interface);
 565     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressOrg, interface);
 566     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressGlb, interface);
 567 }
 568
 569 static void CAApplyInterfaces()
 570 {
 571     u_arraylist_t *iflist = CAIPGetInterfaceInformation(0);
 572     if (!iflist)
 573     {
 574         OIC_LOG_V(ERROR, TAG, "get interface info failed: %s", strerror(errno));
 575         return;
 576     }
 577
 578     uint32_t len = u_arraylist_length(iflist);
 579     OIC_LOG_V(DEBUG, TAG, "IP network interfaces found: %d", len);
 580
 581     for (uint32_t i = 0; i < len; i++)
 582     {
 583         CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
 584
 585         if (!ifitem)
 586         {
 587             continue;
 588         }
 589         if ((ifitem->flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
 590         {
 591             continue;
 592         }
 593         if (ifitem->family == AF_INET)
 594         {
 595             struct in_addr inaddr;
 596             inaddr.s_addr = ifitem->ipv4addr;
 597             applyMulticastToInterface4(inaddr);
 598             OIC_LOG_V(DEBUG, TAG, "IPv4 network interface: %s", ifitem->name);
 599         }
 600         if (ifitem->family == AF_INET6)
 601         {
 602             applyMulticastToInterface6(ifitem->index);
 603             OIC_LOG_V(DEBUG, TAG, "IPv6 network interface: %s", ifitem->name);
 604         }
 605     }
 606
 607     u_arraylist_destroy(iflist);
 608 }
 609
 610 static void CAHandleNetlink()
 611 {
 612 #ifdef __linux__
 613 char buf[4096];
 614 struct nlmsghdr *nh;
 615 struct sockaddr_nl sa;
 616 struct iovec iov = { buf, sizeof(buf) };
 617 struct msghdr msg = { (void *)&sa, sizeof(sa), &iov, 1, NULL, 0, 0 };
 618
 619 int len = recvmsg(caglobals.ip.netlinkFd, &msg, 0);
 620 for (nh = (struct nlmsghdr *)buf; NLMSG_OK(nh, len); nh = NLMSG_NEXT(nh, len))
 621 {
 622     if (nh->nlmsg_type == RTM_NEWLINK)
 623     {
 624         struct ifinfomsg *ifi = (struct ifinfomsg *)NLMSG_DATA(nh);
 625         if ((ifi->ifi_flags & IFF_LOOPBACK) || !(ifi->ifi_flags & IFF_RUNNING))
 626         {
 627             continue;
 628         }
 629
 630         int newIndex = ifi->ifi_index;
 631
 632         u_arraylist_t *iflist = CAIPGetInterfaceInformation(newIndex);
 633         if (!iflist)
 634         {
 635             OIC_LOG_V(ERROR, TAG, "get interface info failed: %s", strerror(errno));
 636             return;
 637         }
 638
 639         uint32_t len = u_arraylist_length(iflist);
 640         for (uint32_t i = 0; i < len; i++)
 641         {
 642             CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
 643             if (!ifitem)
 644             {
 645                 continue;
 646             }
 647
 648             if ((int)ifitem->index != newIndex)
 649             {
 650                 continue;
 651             }
 652
 653             applyMulticastToInterface6(newIndex);
 654             struct in_addr inaddr;
 655             inaddr.s_addr = ifitem->ipv4addr;
 656             applyMulticastToInterface4(inaddr);
 657             break;  // we found the one we were looking for
 658         }
 659         u_arraylist_destroy(iflist);
 660     }
 661 }
 662 #endif // __linux__
 663 }
 664
 665 void CAIPSetPacketReceiveCallback(CAIPPacketReceivedCallback callback)
 666 {
 667 OIC_LOG(DEBUG, TAG, "IN");
 668
 669 g_packetReceivedCallback = callback;
 670
 671 OIC_LOG(DEBUG, TAG, "OUT");
 672 }
 673
 674 void CAIPSetExceptionCallback(CAIPExceptionCallback callback)
 675 {
 676 OIC_LOG(DEBUG, TAG, "IN");
 677
 678     g_exceptionCallback = callback;
 679
 680     OIC_LOG(DEBUG, TAG, "OUT");
 681 }
 682
 683 static void sendData(int fd, const CAEndpoint_t *endpoint,
 684                      const void *data, uint32_t dlen,
 685                      const char *cast, const char *fam)
 686 {
 687     OIC_LOG(DEBUG, TAG, "IN");
 688
 689     char *secure = (endpoint->flags & CA_SECURE) ? "secure " : "";
 690     (void)secure;   // eliminates release warning
 691     struct sockaddr_storage sock;
 692     CAConvertNameToAddr(endpoint->addr, endpoint->port, &sock);
 693
 694     if (sock.ss_family == AF_INET6)
 695     {
 696         struct sockaddr_in6 *sock6 = (struct sockaddr_in6 *)&sock;
 697         if (!sock6->sin6_scope_id)
 698         {
 699             sock6->sin6_scope_id = endpoint->interface;
 700         }
 701     }
 702
 703     ssize_t len = sendto(fd, data, dlen, 0, (struct sockaddr *)&sock, sizeof (sock));
 704     if (-1 == len)
 705     {
 706          // If logging is not defined/enabled.
 707         (void)cast;
 708         (void)fam;
 709         OIC_LOG_V(ERROR, TAG, "%s%s %s sendTo failed: %s", secure, cast, fam, strerror(errno));
 710     }
 711     else
 712     {
 713         OIC_LOG_V(INFO, TAG, "%s%s %s sendTo is successful: %d bytes", secure, cast, fam, len);
 714     }
 715 }
 716
 717 static void sendMulticastData6(const u_arraylist_t *iflist,
 718                                CAEndpoint_t *endpoint,
 719                                const void *data, uint32_t datalen)
 720 {
 721     int scope = endpoint->flags & CA_SCOPE_MASK;
 722     char *ipv6mcname = ipv6mcnames[scope];
 723     if (!ipv6mcname)
 724     {
 725         OIC_LOG_V(INFO, TAG, "IPv6 multicast scope invalid: %d", scope);
 726         return;
 727     }
 728     OICStrcpy(endpoint->addr, sizeof(endpoint->addr), ipv6mcname);
 729     int fd = caglobals.ip.u6.fd;
 730
 731     uint32_t len = u_arraylist_length(iflist);
 732     for (uint32_t i = 0; i < len; i++)
 733     {
 734         CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
 735         if (!ifitem)
 736         {
 737             continue;
 738         }
 739         if ((ifitem->flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
 740         {
 741             continue;
 742         }
 743         if (ifitem->family != AF_INET6)
 744         {
 745             continue;
 746         }
 747
 748         int index = ifitem->index;
 749         if (setsockopt(fd, IPPROTO_IPV6, IPV6_MULTICAST_IF, &index, sizeof (index)))
 750         {
 751             OIC_LOG_V(ERROR, TAG, "setsockopt6 failed: %s", strerror(errno));
 752             return;
 753         }
 754         sendData(fd, endpoint, data, datalen, "multicast", "ipv6");
 755     }
 756 }
 757
 758 static void sendMulticastData4(const u_arraylist_t *iflist,
 759                                CAEndpoint_t *endpoint,
 760                                const void *data, uint32_t datalen)
 761 {
 762     struct ip_mreq mreq = { .imr_multiaddr = IPv4MulticastAddress };
 763     OICStrcpy(endpoint->addr, sizeof(endpoint->addr), IPv4_MULTICAST);
 764     int fd = caglobals.ip.u4.fd;
 765
 766     uint32_t len = u_arraylist_length(iflist);
 767     for (uint32_t i = 0; i < len; i++)
 768     {
 769         CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
 770         if (!ifitem)
 771         {
 772             continue;
 773         }
 774         if ((ifitem->flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
 775         {
 776             continue;
 777         }
 778         if (ifitem->family != AF_INET)
 779         {
 780             continue;
 781         }
 782
 783         struct in_addr inaddr;
 784         inaddr.s_addr = ifitem->ipv4addr;
 785         mreq.imr_interface = inaddr;
 786         if (setsockopt(fd, IPPROTO_IP, IP_MULTICAST_IF, &mreq, sizeof (mreq)))
 787         {
 788             OIC_LOG_V(ERROR, TAG, "send IP_MULTICAST_IF failed: %s (using defualt)",
 789                     strerror(errno));
 790         }
 791         sendData(fd, endpoint, data, datalen, "multicast", "ipv4");
 792     }
 793 }
 794
 795 void CAIPSendData(CAEndpoint_t *endpoint, const void *data, uint32_t datalen,
 796                                                             bool isMulticast)
 797 {
 798     VERIFY_NON_NULL_VOID(endpoint, TAG, "endpoint is NULL");
 799     VERIFY_NON_NULL_VOID(data, TAG, "data is NULL");
 800
 801     bool isSecure = (endpoint->flags & CA_SECURE) != 0;
 802
 803     if (isMulticast)
 804     {
 805         endpoint->port = isSecure ? CA_SECURE_COAP : CA_COAP;
 806
 807         u_arraylist_t *iflist = CAIPGetInterfaceInformation(0);
 808         if (!iflist)
 809         {
 810             OIC_LOG_V(ERROR, TAG, "get interface info failed: %s", strerror(errno));
 811             return;
 812         }
 813
 814         if ((endpoint->flags & CA_IPV6) && caglobals.ip.ipv6enabled)
 815         {
 816             sendMulticastData6(iflist, endpoint, data, datalen);
 817         }
 818         if ((endpoint->flags & CA_IPV4) && caglobals.ip.ipv4enabled)
 819         {
 820             sendMulticastData4(iflist, endpoint, data, datalen);
 821         }
 822
 823         u_arraylist_destroy(iflist);
 824     }
 825     else
 826     {
 827         if (!endpoint->port)    // unicast discovery
 828         {
 829             endpoint->port = isSecure ? CA_SECURE_COAP : CA_COAP;
 830         }
 831
 832         int fd;
 833         if (caglobals.ip.ipv6enabled && (endpoint->flags & CA_IPV6))
 834         {
 835             fd = isSecure ? caglobals.ip.u6s.fd : caglobals.ip.u6.fd;
 836             #ifndef __WITH_DTLS__
 837             fd = caglobals.ip.u6.fd;
 838             #endif
 839             sendData(fd, endpoint, data, datalen, "unicast", "ipv6");
 840         }
 841         if (caglobals.ip.ipv4enabled && (endpoint->flags & CA_IPV4))
 842         {
 843             fd = isSecure ? caglobals.ip.u4s.fd : caglobals.ip.u4.fd;
 844             #ifndef __WITH_DTLS__
 845             fd = caglobals.ip.u4.fd;
 846             #endif
 847             sendData(fd, endpoint, data, datalen, "unicast", "ipv4");
 848         }
 849     }
 850 }
 851
 852 CAResult_t CAGetIPInterfaceInformation(CAEndpoint_t **info, uint32_t *size)
 853 {
 854     OIC_LOG(DEBUG, TAG, "IN");
 855
 856     VERIFY_NON_NULL(info, TAG, "info is NULL");
 857     VERIFY_NON_NULL(size, TAG, "size is NULL");
 858
 859     u_arraylist_t *iflist = CAIPGetInterfaceInformation(0);
 860     if (!iflist)
 861     {
 862         OIC_LOG_V(ERROR, TAG, "get interface info failed: %s", strerror(errno));
 863         return CA_STATUS_FAILED;
 864     }
 865
 866     uint32_t len = u_arraylist_length(iflist);
 867
 868     CAEndpoint_t *eps = (CAEndpoint_t *)OICCalloc(len, sizeof (CAEndpoint_t));
 869     if (!eps)
 870     {
 871         OIC_LOG(ERROR, TAG, "Malloc Failed");
 872         u_arraylist_destroy(iflist);
 873         return CA_MEMORY_ALLOC_FAILED;
 874     }
 875
 876     for (uint32_t i = 0, j = 0; i < len; i++)
 877     {
 878         CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
 879         if(!ifitem)
 880         {
 881             continue;
 882         }
 883
 884         OICStrcpy(eps[j].addr, CA_INTERFACE_NAME_SIZE, ifitem->name);
 885         eps[j].flags = ifitem->family == AF_INET6 ? CA_IPV6 : CA_IPV4;
 886         eps[j].adapter = CA_ADAPTER_IP;
 887         eps[j].interface = 0;
 888         eps[j].port = 0;
 889         j++;
 890     }
 891
 892     *info = eps;
 893     *size = len;
 894
 895     u_arraylist_destroy(iflist);
 896
 897     OIC_LOG(DEBUG, TAG, "OUT");
 898     return CA_STATUS_OK;
 899 }
 900