replace : iotivity -> iotivity-sec
[platform/upstream/iotivity.git] / resource / csdk / connectivity / src / ip_adapter / caipserver.c
1 /* ****************************************************************
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 #ifndef __APPLE_USE_RFC_3542
22 #define __APPLE_USE_RFC_3542 // for PKTINFO
23 #endif
24 #ifndef _GNU_SOURCE
25 #define _GNU_SOURCE // for in6_pktinfo
26 #endif
27
28 #ifdef __TIZENRT__
29 #include <tinyara/config.h>
30 #include <uio.h>
31 #endif
32
33 #include "iotivity_config.h"
34 #include <sys/types.h>
35 #if !defined(_WIN32)
36 #include <sys/socket.h>
37 #endif
38
39 #if defined(_WIN32)
40 #include <assert.h>
41 #include <winsock2.h>
42 #include <ws2def.h>
43 #include <mswsock.h>
44 #include <ws2tcpip.h>
45 #endif
46
47 #include <stdio.h>
48 #include <string.h>
49 #if !defined(_MSC_VER)
50 #include <unistd.h>
51 #endif //!defined(_MSC_VER)
52 #include <sys/types.h>
53 #include <fcntl.h>
54 #if !defined(_WIN32)
55 #include <sys/select.h>
56 #include <arpa/inet.h>
57 #include <netinet/in.h>
58 #include <net/if.h>
59 #endif
60 #include <errno.h>
61 #ifdef __linux__
62 #include <linux/netlink.h>
63 #include <linux/rtnetlink.h>
64 #endif
65
66 #ifdef __TIZENRT__
67 #include <uio.h>
68 #include <mqueue.h>
69 #endif
70
71 #include <coap/pdu.h>
72 #include "caipinterface.h"
73 #include "caipnwmonitor.h"
74 #include "caadapterutils.h"
75 #if defined(__WITH_DTLS__) || defined(__WITH_TLS__)
76 #include "ca_adapter_net_ssl.h"
77 #endif
78 #include "octhread.h"
79 #include "oic_malloc.h"
80 #include "oic_string.h"
81
82 #define USE_IP_MREQN
83 #if defined(_WIN32)
84 #undef USE_IP_MREQN
85 #endif
86
87 #ifdef __TIZEN__
88 #include <pthread.h>
89 #endif
90
91 /*
92  * Logging tag for module name
93  */
94 //#define TAG "OIC_CA_IP_SERVER"
95 #define TAG IP_SERVER_TAG
96
97 #ifdef __TIZENRT__
98 mqd_t g_nwevent_mqfd;
99 #ifdef CONFIG_NET_LWIP
100 #define SOCK_CLOEXEC 0
101 #else
102 #define SOCK_CLOEXEC 1
103 #endif
104 #endif
105 #define SELECT_TIMEOUT 1     // select() seconds (and termination latency)
106
107 #define IPv4_MULTICAST     "224.0.1.187"
108 static struct in_addr IPv4MulticastAddress = { 0 };
109
110 #define IPv6_DOMAINS       16
111 #define MOBILE_INTERFACES  2
112 #define IPv6_MULTICAST_INT "ff01::158"
113 static struct in6_addr IPv6MulticastAddressInt;
114 #define IPv6_MULTICAST_LNK "ff02::158"
115 static struct in6_addr IPv6MulticastAddressLnk;
116 #define IPv6_MULTICAST_RLM "ff03::158"
117 static struct in6_addr IPv6MulticastAddressRlm;
118 #define IPv6_MULTICAST_ADM "ff04::158"
119 static struct in6_addr IPv6MulticastAddressAdm;
120 #define IPv6_MULTICAST_SIT "ff05::158"
121 static struct in6_addr IPv6MulticastAddressSit;
122 #define IPv6_MULTICAST_ORG "ff08::158"
123 static struct in6_addr IPv6MulticastAddressOrg;
124 #define IPv6_MULTICAST_GLB "ff0e::158"
125 static struct in6_addr IPv6MulticastAddressGlb;
126
127 static char *ipv6mcnames[IPv6_DOMAINS] = {
128     NULL,
129     IPv6_MULTICAST_INT,
130     IPv6_MULTICAST_LNK,
131     IPv6_MULTICAST_RLM,
132     IPv6_MULTICAST_ADM,
133     IPv6_MULTICAST_SIT,
134     NULL,
135     NULL,
136     IPv6_MULTICAST_ORG,
137     NULL,
138     NULL,
139     NULL,
140     NULL,
141     NULL,
142     IPv6_MULTICAST_GLB,
143     NULL
144 };
145
146 // Samsung Mobile
147 static char *mobileinferfaces[MOBILE_INTERFACES] = {
148     "rmnet", "pdp"
149 };
150
151 #ifdef __TIZENRT__
152 struct in6_pktinfo {
153         struct in6_addr ipi6_addr;
154         int             ipi6_ifindex;
155 };
156
157 struct in_pktinfo
158 {
159   unsigned int   ipi_ifindex;  /* Interface index */
160   struct in_addr ipi_spec_dst; /* Local address */
161   struct in_addr ipi_addr;     /* Header Destination
162                                     address */
163 };
164
165
166 #define RTMGRP_LINK 1
167 #define IP_PKTINFO         8
168 #define IPV6_PKTINFO            50
169 #define IPV6_MULTICAST_IF 9
170 #define IPV6_V6ONLY 27
171 #define IPV6_RECVPKTINFO       50
172 #define IPV6_JOIN_GROUP 12
173 #endif
174
175 /**
176  * By default, IP multicast datagrams are sent with a time-to-live (TTL) of 1.
177  * An application can choose an initial TTL.
178  */
179 static size_t multicastTTL = 1;
180
181 #if defined (_WIN32)
182 #define IFF_UP_RUNNING_FLAGS  (IFF_UP)
183
184     char* caips_get_error(){
185         static char buffer[32];
186         snprintf(buffer, 32, "%i", WSAGetLastError());
187         return buffer;
188     }
189 #define CAIPS_GET_ERROR \
190     caips_get_error()
191 #else
192 #define IFF_UP_RUNNING_FLAGS  (IFF_UP|IFF_RUNNING)
193
194 #define CAIPS_GET_ERROR \
195     strerror(errno)
196 #endif
197 static CAIPErrorHandleCallback g_ipErrorHandler = NULL;
198
199 static CAIPPacketReceivedCallback g_packetReceivedCallback = NULL;
200
201 static void CAFindReadyMessage();
202 #if !defined(WSA_WAIT_EVENT_0)
203 static void CASelectReturned(fd_set *readFds, int ret);
204 #else
205 static void CAEventReturned(CASocketFd_t socket);
206 #endif
207
208 static CAResult_t CAReceiveMessage(CASocketFd_t fd, CATransportFlags_t flags);
209
210 #ifdef __TIZEN__
211 static int cleanup_pop_arg = 1;
212
213 static void CAIPCleanupHandler(void *arg)
214 {
215     OIC_LOG(DEBUG, TAG, "Called clean-up handler");
216
217     if (caglobals.ip.shutdownFds[0] != OC_INVALID_SOCKET)
218     {
219         close(caglobals.ip.shutdownFds[0]);
220         caglobals.ip.shutdownFds[0] = OC_INVALID_SOCKET;
221     }
222 }
223
224 static void CAReceiveHandler(void *data)
225 {
226     (void)data;
227     OIC_LOG(DEBUG, TAG, "IN - CAReceiveHandler");
228
229     pthread_cleanup_push(CAIPCleanupHandler, NULL);
230
231     while (!caglobals.ip.terminate)
232     {
233         CAFindReadyMessage();
234     }
235
236     pthread_cleanup_pop(cleanup_pop_arg);
237
238     OIC_LOG(DEBUG, TAG, "OUT - CAReceiveHandler");
239 }
240 #else
241 static void CAReceiveHandler(void *data)
242 {
243     (void)data;
244     OIC_LOG(DEBUG, TAG, "IN - CAReceiveHandler");
245
246     while (!caglobals.ip.terminate)
247     {
248         CAFindReadyMessage();
249     }
250 #ifndef __TIZENRT__
251     if (caglobals.ip.shutdownFds[0] != OC_INVALID_SOCKET)
252     {
253         close(caglobals.ip.shutdownFds[0]);
254         caglobals.ip.shutdownFds[0] = OC_INVALID_SOCKET;
255     }
256 #endif
257     OIC_LOG(DEBUG, TAG, "OUT - CAReceiveHandler");
258 }
259 #endif
260
261 #if !defined(WSA_WAIT_EVENT_0)
262
263 #define CLOSE_SOCKET(TYPE) \
264     if (caglobals.ip.TYPE.fd != OC_INVALID_SOCKET) \
265     { \
266         close(caglobals.ip.TYPE.fd); \
267         caglobals.ip.TYPE.fd = OC_INVALID_SOCKET; \
268     }
269
270 #define SET(TYPE, FDS) \
271     if (caglobals.ip.TYPE.fd != OC_INVALID_SOCKET) \
272     { \
273         FD_SET(caglobals.ip.TYPE.fd, FDS); \
274     }
275
276 #define ISSET(TYPE, FDS, FLAGS) \
277     if (caglobals.ip.TYPE.fd != OC_INVALID_SOCKET && FD_ISSET(caglobals.ip.TYPE.fd, FDS)) \
278     { \
279         fd = caglobals.ip.TYPE.fd; \
280         flags = FLAGS; \
281     }
282
283
284 static void CAFindReadyMessage()
285 {
286     fd_set readFds;
287     struct timeval timeout;
288
289     timeout.tv_sec = caglobals.ip.selectTimeout;
290     timeout.tv_usec = 0;
291     struct timeval *tv = caglobals.ip.selectTimeout == -1 ? NULL : &timeout;
292
293     FD_ZERO(&readFds);
294     SET(u6,  &readFds)
295     SET(u6s, &readFds)
296     SET(u4,  &readFds)
297     SET(u4s, &readFds)
298     SET(m6,  &readFds)
299     SET(m6s, &readFds)
300     SET(m4,  &readFds)
301     SET(m4s, &readFds)
302 #ifndef __TIZENRT__
303     if (caglobals.ip.shutdownFds[0] != -1)
304     {
305         FD_SET(caglobals.ip.shutdownFds[0], &readFds);
306     }
307 #endif
308     if (caglobals.ip.netlinkFd != OC_INVALID_SOCKET)
309     {
310         FD_SET(caglobals.ip.netlinkFd, &readFds);
311     }
312
313     int ret = select(caglobals.ip.maxfd + 1, &readFds, NULL, NULL, tv);
314
315     if (caglobals.ip.terminate)
316     {
317         OIC_LOG_V(INFO, TAG, "Packet receiver Stop request received.");
318         return;
319     }
320 #ifdef __TIZENRT__
321     u_arraylist_t *iflist = CAFindInterfaceChange();
322     if (iflist)
323     {
324         uint32_t listLength = u_arraylist_length(iflist);
325         for (uint32_t i = 0; i < listLength; i++)
326         {
327             CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
328             if (ifitem)
329             {
330                 CAProcessNewInterface(ifitem);
331             }
332         }
333         u_arraylist_destroy(iflist);
334     }
335 #endif
336     if (0 < ret)
337     {
338         CASelectReturned(&readFds, ret);
339     }
340     else if (0 > ret)
341     {
342         OIC_LOG_V(FATAL, TAG, "select error %s", CAIPS_GET_ERROR);
343     }
344 }
345
346 static void CASelectReturned(fd_set *readFds, int ret)
347 {
348     (void)ret;
349     CASocketFd_t fd = OC_INVALID_SOCKET;
350     CATransportFlags_t flags = CA_DEFAULT_FLAGS;
351
352     while (!caglobals.ip.terminate)
353     {
354         ISSET(u6,  readFds, CA_IPV6)
355         else ISSET(u6s, readFds, CA_IPV6 | CA_SECURE)
356         else ISSET(u4,  readFds, CA_IPV4)
357         else ISSET(u4s, readFds, CA_IPV4 | CA_SECURE)
358         else ISSET(m6,  readFds, CA_MULTICAST | CA_IPV6)
359         else ISSET(m6s, readFds, CA_MULTICAST | CA_IPV6 | CA_SECURE)
360         else ISSET(m4,  readFds, CA_MULTICAST | CA_IPV4)
361         else ISSET(m4s, readFds, CA_MULTICAST | CA_IPV4 | CA_SECURE)
362         else if ((caglobals.ip.netlinkFd != OC_INVALID_SOCKET) && FD_ISSET(caglobals.ip.netlinkFd, readFds))
363         {
364 #ifndef __TIZENRT__
365             u_arraylist_t *iflist = CAFindInterfaceChange();
366             if (iflist)
367             {
368                 uint32_t listLength = u_arraylist_length(iflist);
369                 for (uint32_t i = 0; i < listLength; i++)
370                 {
371                     CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
372                     if (ifitem)
373                     {
374                         CAProcessNewInterface(ifitem);
375                     }
376                 }
377                 u_arraylist_destroy(iflist);
378             }
379             break;
380 #endif
381         }
382 #ifndef __TIZENRT__
383         else if (FD_ISSET(caglobals.ip.shutdownFds[0], readFds))
384         {
385             char buf[10] = {0};
386             ssize_t len = read(caglobals.ip.shutdownFds[0], buf, sizeof (buf));
387             if (-1 == len)
388             {
389                 continue;
390             }
391             break;
392         }
393 #endif
394         else
395         {
396             break;
397         }
398         (void)CAReceiveMessage(fd, flags);
399         FD_CLR(fd, readFds);
400     }
401 }
402
403 #else // if defined(WSA_WAIT_EVENT_0)
404
405 #define CLOSE_SOCKET(TYPE) \
406     if (caglobals.ip.TYPE.fd != OC_INVALID_SOCKET) \
407     { \
408         closesocket(caglobals.ip.TYPE.fd); \
409         caglobals.ip.TYPE.fd = OC_INVALID_SOCKET; \
410     }
411
412 #define PUSH_HANDLE(HANDLE, ARRAY, INDEX) \
413 { \
414     ARRAY[INDEX] = HANDLE; \
415     INDEX++; \
416 }
417
418 // Turn handle into WSAEvent and push to ARRAY
419 #define PUSH_SOCKET(SOCKET, ARRAY, INDEX) \
420     if (SOCKET != OC_INVALID_SOCKET) \
421     { \
422         WSAEVENT NewEvent; \
423         NewEvent = WSACreateEvent(); \
424         if (WSA_INVALID_EVENT != NewEvent) \
425         { \
426             if (0 != WSAEventSelect(SOCKET, NewEvent, FD_READ)) \
427             { \
428                 OIC_LOG_V(ERROR, TAG, "WSAEventSelect failed 0x%08x ", WSAGetLastError()); \
429                 if (!WSACloseEvent(NewEvent)) \
430                 { \
431                     OIC_LOG_V(ERROR, TAG, "WSACloseEvent(NewEvent) failed 0x%08x", WSAGetLastError()); \
432                 } \
433             } \
434             else \
435             { \
436                 PUSH_HANDLE(NewEvent, ARRAY, INDEX); \
437             } \
438         } \
439         else \
440         { \
441             OIC_LOG_V(ERROR, TAG, "WSACreateEvent(NewEvent) failed 0x%08x", WSAGetLastError()); \
442         }\
443     }
444
445 #define INSERT_SOCKET(FD, ARRAY, INDEX) \
446     { \
447         if (OC_INVALID_SOCKET != FD) \
448         { \
449             ARRAY[INDEX] = FD; \
450         } \
451     }
452
453
454 // Inserts the socket into the SOCKET_ARRAY and pushes the socket event into EVENT_ARRAY
455 #define PUSH_IP_SOCKET(TYPE, EVENT_ARRAY, SOCKET_ARRAY, INDEX) \
456     { \
457         if (OC_INVALID_SOCKET != caglobals.ip.TYPE.fd) \
458         { \
459             INSERT_SOCKET(caglobals.ip.TYPE.fd, SOCKET_ARRAY, INDEX); \
460             PUSH_SOCKET(caglobals.ip.TYPE.fd, EVENT_ARRAY, INDEX); \
461         } \
462     }
463
464 #define IS_MATCHING_IP_SOCKET(TYPE, SOCKET, FLAGS) \
465     if ((caglobals.ip.TYPE.fd != OC_INVALID_SOCKET) && (caglobals.ip.TYPE.fd == SOCKET)) \
466     { \
467         fd = caglobals.ip.TYPE.fd; \
468         flags = FLAGS; \
469     }
470
471 #define EVENT_ARRAY_SIZE  10
472
473 static void CAFindReadyMessage()
474 {
475     CASocketFd_t socketArray[EVENT_ARRAY_SIZE];
476     HANDLE eventArray[EVENT_ARRAY_SIZE];
477     int arraySize = 0;
478     int eventIndex;
479
480     // socketArray and eventArray should have same number of elements
481     OC_STATIC_ASSERT(_countof(socketArray) == _countof(eventArray), "Arrays should have same number of elements");
482
483     PUSH_IP_SOCKET(u6,  eventArray, socketArray, arraySize);
484     PUSH_IP_SOCKET(u6s, eventArray, socketArray, arraySize);
485     PUSH_IP_SOCKET(u4,  eventArray, socketArray, arraySize);
486     PUSH_IP_SOCKET(u4s, eventArray, socketArray, arraySize);
487     PUSH_IP_SOCKET(m6,  eventArray, socketArray, arraySize);
488     PUSH_IP_SOCKET(m6s, eventArray, socketArray, arraySize);
489     PUSH_IP_SOCKET(m4,  eventArray, socketArray, arraySize);
490     PUSH_IP_SOCKET(m4s, eventArray, socketArray, arraySize);
491
492     if (WSA_INVALID_EVENT != caglobals.ip.shutdownEvent)
493     {
494         INSERT_SOCKET(OC_INVALID_SOCKET, socketArray, arraySize);
495         PUSH_HANDLE(caglobals.ip.shutdownEvent, eventArray, arraySize);
496     }
497
498     /** @todo Support netlink events */
499
500     // Should not have overflowed buffer
501     assert(arraySize <= (_countof(socketArray)));
502
503     // Timeout is unnecessary on Windows
504     assert(-1 == caglobals.ip.selectTimeout);
505
506     while (!caglobals.ip.terminate)
507     {
508         int ret = WSAWaitForMultipleEvents(arraySize, eventArray, FALSE, WSA_INFINITE, FALSE);
509
510         switch (ret)
511         {
512             case WSA_WAIT_FAILED:
513                 OIC_LOG_V(ERROR, TAG, "WSAWaitForMultipleEvents returned WSA_WAIT_FAILED 0x%08x", WSAGetLastError());
514                 break;
515             case WSA_WAIT_IO_COMPLETION:
516                 OIC_LOG_V(ERROR, TAG, "WSAWaitForMultipleEvents returned WSA_WAIT_IO_COMPLETION 0x%08x", WSAGetLastError());
517                 break;
518             case WSA_WAIT_TIMEOUT:
519                 OIC_LOG_V(ERROR, TAG, "WSAWaitForMultipleEvents returned WSA_WAIT_TIMEOUT 0x%08x", WSAGetLastError());
520                 break;
521             default:
522                 eventIndex = ret - WSA_WAIT_EVENT_0;
523                 if ((eventIndex >= 0) && (eventIndex < arraySize))
524                 {
525                     if (false == WSAResetEvent(eventArray[eventIndex]))
526                     {
527                         OIC_LOG_V(ERROR, TAG, "WSAResetEvent failed 0x%08x", WSAGetLastError());
528                     }
529
530                     // Break out if shutdownEvent is triggered.
531                     if ((caglobals.ip.shutdownEvent != WSA_INVALID_EVENT) &&
532                         (caglobals.ip.shutdownEvent == eventArray[eventIndex]))
533                     {
534                         break;
535                     }
536                     CAEventReturned(socketArray[eventIndex]);
537                 }
538                 else
539                 {
540                     OIC_LOG_V(ERROR, TAG, "WSAWaitForMultipleEvents failed 0x%08x", WSAGetLastError());
541                 }
542                 break;
543         }
544
545     }
546
547     while (arraySize > 0)
548     {
549         arraySize--;
550         if (!WSACloseEvent(eventArray[arraySize]))
551         {
552             OIC_LOG_V(ERROR, TAG, "WSACloseEvent (Index %i) failed 0x%08x", arraySize, WSAGetLastError());
553         }
554     }
555
556     if (caglobals.ip.terminate)
557     {
558         caglobals.ip.shutdownEvent = WSA_INVALID_EVENT;
559         WSACleanup();
560     }
561 }
562
563 static void CAEventReturned(CASocketFd_t socket)
564 {
565     CASocketFd_t fd = OC_INVALID_SOCKET;
566     CATransportFlags_t flags = CA_DEFAULT_FLAGS;
567
568     while (!caglobals.ip.terminate)
569     {
570         IS_MATCHING_IP_SOCKET(u6,  socket, CA_IPV6)
571         else IS_MATCHING_IP_SOCKET(u6s, socket, CA_IPV6 | CA_SECURE)
572         else IS_MATCHING_IP_SOCKET(u4,  socket, CA_IPV4)
573         else IS_MATCHING_IP_SOCKET(u4s, socket, CA_IPV4 | CA_SECURE)
574         else IS_MATCHING_IP_SOCKET(m6,  socket, CA_MULTICAST | CA_IPV6)
575         else IS_MATCHING_IP_SOCKET(m6s, socket, CA_MULTICAST | CA_IPV6 | CA_SECURE)
576         else IS_MATCHING_IP_SOCKET(m4,  socket, CA_MULTICAST | CA_IPV4)
577         else IS_MATCHING_IP_SOCKET(m4s, socket, CA_MULTICAST | CA_IPV4 | CA_SECURE)
578         else
579         {
580             break;
581         }
582         (void)CAReceiveMessage(socket, flags);
583         // We will never get more than one match per socket, so always break.
584         break;
585     }
586 }
587
588 #endif
589
590 void CADeInitializeIPGlobals()
591 {
592     CloseMulticastSocket();
593
594     if (caglobals.ip.netlinkFd != OC_INVALID_SOCKET)
595     {
596 #ifdef _WIN32
597         closesocket(caglobals.ip.netlinkFd);
598 #else
599         close(caglobals.ip.netlinkFd);
600 #endif
601         caglobals.ip.netlinkFd = OC_INVALID_SOCKET;
602     }
603 }
604
605 static CAResult_t CAReceiveMessage(CASocketFd_t fd, CATransportFlags_t flags)
606 {
607     OIC_LOG(DEBUG, TAG, "IN - CAReceiveMessage");
608     char recvBuffer[COAP_MAX_PDU_SIZE] = {0};
609
610     size_t len = 0;
611     int level = 0;
612     int type = 0;
613     int namelen = 0;
614     struct sockaddr_storage srcAddr = { .ss_family = 0 };
615     unsigned char *pktinfo = NULL;
616 #if !defined(WSA_CMSG_DATA)
617     struct cmsghdr *cmp = NULL;
618     struct iovec iov = { .iov_base = recvBuffer, .iov_len = sizeof (recvBuffer) };
619     union control
620     {
621         struct cmsghdr cmsg;
622         unsigned char data[CMSG_SPACE(sizeof (struct in6_pktinfo))];
623     } cmsg;
624
625     if (flags & CA_IPV6)
626     {
627         namelen = sizeof (struct sockaddr_in6);
628         level = IPPROTO_IPV6;
629         type = IPV6_PKTINFO;
630         len = sizeof (struct in6_pktinfo);
631     }
632     else
633     {
634         namelen = sizeof (struct sockaddr_in);
635         level = IPPROTO_IP;
636         type = IP_PKTINFO;
637         len = sizeof (struct in6_pktinfo);
638     }
639
640     struct msghdr msg = { .msg_name = &srcAddr,
641                           .msg_namelen = namelen,
642                           .msg_iov = &iov,
643                           .msg_iovlen = 1,
644                           .msg_control = &cmsg,
645                           .msg_controllen = CMSG_SPACE(len) };
646
647     ssize_t recvLen = recvmsg(fd, &msg, flags);
648     if (OC_SOCKET_ERROR == recvLen)
649     {
650         OIC_LOG_V(ERROR, TAG, "Recvfrom failed %s", strerror(errno));
651         return CA_STATUS_FAILED;
652     }
653     OIC_LOG_V(DEBUG, TAG, "recvd %u bytes from recvmsg", recvLen);
654
655     if (flags & CA_MULTICAST)
656     {
657         for (cmp = CMSG_FIRSTHDR(&msg); cmp != NULL; cmp = CMSG_NXTHDR(&msg, cmp))
658         {
659             if (cmp->cmsg_level == level && cmp->cmsg_type == type)
660             {
661                 pktinfo = CMSG_DATA(cmp);
662             }
663         }
664     }
665 #else // if defined(WSA_CMSG_DATA)
666     union control
667     {
668         WSACMSGHDR cmsg;
669         uint8_t data[WSA_CMSG_SPACE(sizeof (IN6_PKTINFO))];
670     } cmsg;
671     memset(&cmsg, 0, sizeof(cmsg));
672
673     if (flags & CA_IPV6)
674     {
675         namelen  = sizeof (struct sockaddr_in6);
676         level = IPPROTO_IPV6;
677         type = IPV6_PKTINFO;
678     }
679     else
680     {
681         namelen = sizeof (struct sockaddr_in);
682         level = IPPROTO_IP;
683         type = IP_PKTINFO;
684     }
685
686     WSABUF iov = {.len = sizeof (recvBuffer), .buf = recvBuffer};
687     WSAMSG msg = {.name = (PSOCKADDR)&srcAddr,
688                   .namelen = namelen,
689                   .lpBuffers = &iov,
690                   .dwBufferCount = 1,
691                   .Control = {.buf = cmsg.data, .len = sizeof (cmsg)}
692                  };
693
694     uint32_t recvLen = 0;
695     uint32_t ret = caglobals.ip.wsaRecvMsg(fd, &msg, &recvLen, 0,0);
696     OIC_LOG_V(DEBUG, TAG, "WSARecvMsg recvd %u bytes", recvLen);
697     if (OC_SOCKET_ERROR == ret)
698     {
699         OIC_LOG_V(ERROR, TAG, "WSARecvMsg failed %i", WSAGetLastError());
700     }
701
702     if (flags & CA_MULTICAST)
703     {
704         for (WSACMSGHDR *cmp = WSA_CMSG_FIRSTHDR(&msg); cmp != NULL;
705              cmp = WSA_CMSG_NXTHDR(&msg, cmp))
706         {
707             if (cmp->cmsg_level == level && cmp->cmsg_type == type)
708             {
709                 pktinfo = WSA_CMSG_DATA(cmp);
710             }
711         }
712     }
713 #endif // !defined(WSA_CMSG_DATA)
714     CASecureEndpoint_t sep = {.endpoint = {.adapter = CA_ADAPTER_IP, .flags = flags}};
715
716 #ifndef __TIZENRT__
717     if (flags & CA_IPV6)
718     {
719         /** @todo figure out correct usage for ifindex, and sin6_scope_id.*/
720         if ((flags & CA_MULTICAST) && pktinfo)
721         {
722             struct in6_addr *addr = &(((struct in6_pktinfo *)pktinfo)->ipi6_addr);
723             unsigned char topbits = ((unsigned char *)addr)[0];
724             if (topbits != 0xff)
725             {
726                 sep.endpoint.flags &= ~CA_MULTICAST;
727             }
728         }
729     }
730     else
731 #endif
732     {
733         if ((flags & CA_MULTICAST) && pktinfo)
734         {
735             struct in_addr *addr = &((struct in_pktinfo *)pktinfo)->ipi_addr;
736             uint32_t host = ntohl(addr->s_addr);
737             unsigned char topbits = ((unsigned char *)&host)[3];
738             if (topbits < 224 || topbits > 239)
739             {
740                 sep.endpoint.flags &= ~CA_MULTICAST;
741             }
742         }
743     }
744
745     CAConvertAddrToName(&srcAddr, namelen, sep.endpoint.addr, &sep.endpoint.port);
746
747     if (flags & CA_SECURE)
748     {
749 #ifdef __WITH_DTLS__
750         int ret = CAdecryptSsl(&sep, (uint8_t *)recvBuffer, recvLen);
751         OIC_LOG_V(INFO, TAG, "CAdecryptSsl returns [%d]", ret);
752 #else
753         OIC_LOG(ERROR, TAG, "Encrypted message but no DTLS");
754 #endif
755     }
756     else
757     {
758         if (g_packetReceivedCallback)
759         {
760             OIC_LOG(DEBUG, TAG, "call receivedCB");
761             g_packetReceivedCallback(&sep, recvBuffer, recvLen);
762         }
763     }
764
765     OIC_LOG(DEBUG, TAG, "OUT - CAReceiveMessage");
766     return CA_STATUS_OK;
767
768 }
769
770 void CAIPPullData()
771 {
772     OIC_LOG(DEBUG, TAG, "IN");
773     OIC_LOG(DEBUG, TAG, "OUT");
774 }
775
776 static CASocketFd_t CACreateSocket(int family, uint16_t *port, bool isMulticast)
777 {
778     int socktype = SOCK_DGRAM;
779 #ifdef SOCK_CLOEXEC
780     socktype |= SOCK_CLOEXEC;
781 #endif
782     CASocketFd_t fd = socket(family, socktype, IPPROTO_UDP);
783     if (OC_INVALID_SOCKET == fd)
784     {
785         OIC_LOG_V(ERROR, TAG, "create socket failed: %s", CAIPS_GET_ERROR);
786         return OC_INVALID_SOCKET;
787     }
788
789 #if !defined(SOCK_CLOEXEC) && defined(FD_CLOEXEC)
790     int fl = fcntl(fd, F_GETFD);
791     if (-1 == fl || -1 == fcntl(fd, F_SETFD, fl|FD_CLOEXEC))
792     {
793         OIC_LOG_V(ERROR, TAG, "set FD_CLOEXEC failed: %s", strerror(errno));
794         close(fd);
795         return OC_INVALID_SOCKET;
796     }
797 #endif
798     struct sockaddr_storage sa = { .ss_family = family };
799     socklen_t socklen = 0;
800
801     if (family == AF_INET6)
802     {
803         int on = 1;
804
805         if (OC_SOCKET_ERROR == setsockopt(fd, IPPROTO_IPV6, IPV6_V6ONLY, OPTVAL_T(&on), sizeof (on)))
806         {
807             OIC_LOG_V(ERROR, TAG, "IPV6_V6ONLY failed: %s", CAIPS_GET_ERROR);
808         }
809
810         if (isMulticast && *port) // only do this for multicast ports
811         {
812 #if defined(IPV6_RECVPKTINFO)
813             if (OC_SOCKET_ERROR == setsockopt(fd, IPPROTO_IPV6, IPV6_RECVPKTINFO, &on, sizeof (on)))
814 #else
815             if (OC_SOCKET_ERROR == setsockopt(fd, IPPROTO_IPV6, IPV6_PKTINFO, OPTVAL_T(&on), sizeof (on)))
816 #endif
817             {
818                 OIC_LOG_V(ERROR, TAG, "IPV6_RECVPKTINFO failed: %s",CAIPS_GET_ERROR);
819             }
820         }
821
822         ((struct sockaddr_in6 *)&sa)->sin6_port = htons(*port);
823         socklen = sizeof (struct sockaddr_in6);
824     }
825     else
826     {
827         if (isMulticast && *port) // only do this for multicast ports
828         {
829             int on = 1;
830             if (OC_SOCKET_ERROR == setsockopt(fd, IPPROTO_IP, IP_PKTINFO, OPTVAL_T(&on), sizeof (on)))
831             {
832                 OIC_LOG_V(ERROR, TAG, "IP_PKTINFO failed: %s", CAIPS_GET_ERROR);
833             }
834         }
835
836         ((struct sockaddr_in *)&sa)->sin_port = htons(*port);
837         socklen = sizeof (struct sockaddr_in);
838     }
839
840     if (isMulticast && *port) // use the given port
841     {
842         int on = 1;
843         if (setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, OPTVAL_T(&on), sizeof (on)))
844         {
845             OIC_LOG_V(ERROR, TAG, "SO_REUSEADDR failed: %s", CAIPS_GET_ERROR);
846 #ifdef _WIN32
847             closesocket(fd);
848 #else
849             close(fd);
850 #endif
851             return OC_INVALID_SOCKET;
852         }
853     }
854
855     if (OC_SOCKET_ERROR == bind(fd, (struct sockaddr *)&sa, socklen))
856     {
857         OIC_LOG_V(ERROR, TAG, "bind socket failed: %s", CAIPS_GET_ERROR);
858 #ifdef _WIN32
859         closesocket(fd);
860 #else
861         close(fd);
862 #endif
863         return OC_INVALID_SOCKET;
864     }
865
866     if (!*port) // return the assigned port
867     {
868         if (OC_SOCKET_ERROR == getsockname(fd, (struct sockaddr *)&sa, &socklen))
869         {
870             OIC_LOG_V(ERROR, TAG, "getsockname failed: %s", CAIPS_GET_ERROR);
871 #ifdef _WIN32
872             closesocket(fd);
873 #else
874             close(fd);
875 #endif
876             return OC_INVALID_SOCKET;
877         }
878         *port = ntohs(family == AF_INET6 ?
879                       ((struct sockaddr_in6 *)&sa)->sin6_port :
880                       ((struct sockaddr_in *)&sa)->sin_port);
881     }
882
883     return fd;
884 }
885
886 #define CHECKFD(FD) \
887     if (FD > caglobals.ip.maxfd) \
888         caglobals.ip.maxfd = FD;
889 #define NEWSOCKET(FAMILY, NAME, MULTICAST) \
890     if (caglobals.ip.NAME.fd == OC_INVALID_SOCKET) \
891     {   \
892         caglobals.ip.NAME.fd = CACreateSocket(FAMILY, &caglobals.ip.NAME.port, MULTICAST); \
893         if (caglobals.ip.NAME.fd == OC_INVALID_SOCKET) \
894         {   \
895             caglobals.ip.NAME.port = 0; \
896             caglobals.ip.NAME.fd = CACreateSocket(FAMILY, &caglobals.ip.NAME.port, MULTICAST); \
897         }   \
898         CHECKFD(caglobals.ip.NAME.fd)   \
899     }   \
900
901 void CreateMulticastSocket()
902 {
903     OIC_LOG_V(INFO, TAG, "In %s", __func__);
904
905     if (caglobals.ip.ipv6enabled)
906     {
907         NEWSOCKET(AF_INET6, u6, false)
908         NEWSOCKET(AF_INET6, u6s, false)
909         NEWSOCKET(AF_INET6, m6, true)
910         NEWSOCKET(AF_INET6, m6s, true)
911         OIC_LOG_V(INFO, TAG, "IPv6 unicast port: %u", caglobals.ip.u6.port);
912     }
913     if (caglobals.ip.ipv4enabled)
914     {
915         NEWSOCKET(AF_INET, u4, false)
916         NEWSOCKET(AF_INET, u4s, false)
917         NEWSOCKET(AF_INET, m4, true)
918         NEWSOCKET(AF_INET, m4s, true)
919         OIC_LOG_V(INFO, TAG, "IPv4 unicast port: %u", caglobals.ip.u4.port);
920     }
921
922     OIC_LOG_V(INFO, TAG, "Out %s", __func__);
923 }
924
925 void CloseMulticastSocket()
926 {
927     OIC_LOG_V(INFO, TAG, "In %s", __func__);
928
929     CLOSE_SOCKET(u6);
930     CLOSE_SOCKET(u6s);
931     CLOSE_SOCKET(u4);
932     CLOSE_SOCKET(u4s);
933     CLOSE_SOCKET(m6);
934     CLOSE_SOCKET(m6s);
935     CLOSE_SOCKET(m4);
936     CLOSE_SOCKET(m4s);
937
938     OIC_LOG_V(INFO, TAG, "Out %s", __func__);
939 }
940
941 static void CAInitializeNetlink()
942 {
943     caglobals.ip.netlinkFd = OC_INVALID_SOCKET;
944 #ifdef __linux__
945     // create NETLINK fd for interface change notifications
946     struct sockaddr_nl sa = { AF_NETLINK, 0, 0,
947                               RTMGRP_LINK | RTMGRP_IPV4_IFADDR | RTMGRP_IPV6_IFADDR };
948
949     caglobals.ip.netlinkFd = socket(AF_NETLINK, SOCK_RAW|SOCK_CLOEXEC, NETLINK_ROUTE);
950     if (caglobals.ip.netlinkFd == OC_INVALID_SOCKET)
951     {
952         OIC_LOG_V(ERROR, TAG, "netlink socket failed: %s", strerror(errno));
953     }
954     else
955     {
956         int r = bind(caglobals.ip.netlinkFd, (struct sockaddr *)&sa, sizeof (sa));
957         if (r)
958         {
959             OIC_LOG_V(ERROR, TAG, "netlink bind failed: %s", strerror(errno));
960             close(caglobals.ip.netlinkFd);
961             caglobals.ip.netlinkFd = OC_INVALID_SOCKET;
962         }
963         else
964         {
965             CHECKFD(caglobals.ip.netlinkFd);
966         }
967     }
968 #elif defined (__TIZENRT__) // pkmsgq
969         struct mq_attr lq_attr;
970         lq_attr.mq_maxmsg = 10;
971         lq_attr.mq_msgsize = 4;
972         lq_attr.mq_flags = 0;
973         g_nwevent_mqfd = mq_open("netlink_evtq", O_RDWR | O_NONBLOCK | O_CREAT, 0666, &lq_attr);
974         if (g_nwevent_mqfd == (mqd_t) - 1)
975         {
976                 OIC_LOG_V(ERROR, TAG,"RECV mq_open failed\n");
977                 return ;
978         }
979 #endif
980 }
981
982 static void CAInitializeFastShutdownMechanism()
983 {
984     caglobals.ip.selectTimeout = -1; // don't poll for shutdown
985     int ret = -1;
986 #if defined(WSA_WAIT_EVENT_0)
987     caglobals.ip.shutdownEvent = WSACreateEvent();
988     if (WSA_INVALID_EVENT != caglobals.ip.shutdownEvent)
989     {
990         ret = 0;
991     }
992 #elif defined(HAVE_PIPE2)
993 #ifndef __TIZENRT__
994     ret = pipe2(caglobals.ip.shutdownFds, O_CLOEXEC);
995     CHECKFD(caglobals.ip.shutdownFds[0]);
996     CHECKFD(caglobals.ip.shutdownFds[1]);
997 #endif
998 #else
999 #ifndef __TIZENRT__
1000     ret = pipe(caglobals.ip.shutdownFds);
1001     if (-1 != ret)
1002     {
1003         ret = fcntl(caglobals.ip.shutdownFds[0], F_GETFD);
1004         if (-1 != ret)
1005         {
1006             ret = fcntl(caglobals.ip.shutdownFds[0], F_SETFD, ret|FD_CLOEXEC);
1007         }
1008         if (-1 != ret)
1009         {
1010             ret = fcntl(caglobals.ip.shutdownFds[1], F_GETFD);
1011         }
1012         if (-1 != ret)
1013         {
1014             ret = fcntl(caglobals.ip.shutdownFds[1], F_SETFD, ret|FD_CLOEXEC);
1015         }
1016         if (-1 == ret)
1017         {
1018             close(caglobals.ip.shutdownFds[1]);
1019             close(caglobals.ip.shutdownFds[0]);
1020             caglobals.ip.shutdownFds[0] = -1;
1021             caglobals.ip.shutdownFds[1] = -1;
1022         }
1023     }
1024     CHECKFD(caglobals.ip.shutdownFds[0]);
1025     CHECKFD(caglobals.ip.shutdownFds[1]);
1026 #endif
1027 #endif
1028     if (-1 == ret)
1029     {
1030         OIC_LOG_V(ERROR, TAG, "fast shutdown mechanism init failed: %s", CAIPS_GET_ERROR);
1031         caglobals.ip.selectTimeout = SELECT_TIMEOUT; //poll needed for shutdown
1032     }
1033 }
1034
1035 CAResult_t CAIPStartServer(const ca_thread_pool_t threadPool)
1036 {
1037     CAResult_t res = CA_STATUS_OK;
1038
1039     if (caglobals.ip.started)
1040     {
1041         return res;
1042     }
1043 #if defined (_WIN32)
1044     WORD wVersionRequested = MAKEWORD(2, 2);
1045     WSADATA wsaData ={.wVersion = 0};
1046     int err = WSAStartup(wVersionRequested, &wsaData);
1047     if (err != 0)
1048     {
1049         OIC_LOG_V(ERROR, TAG, "WSAStartup failed: %i", err);
1050         return CA_STATUS_FAILED;
1051     }
1052     OIC_LOG(DEBUG, TAG, "WSAStartup Succeeded");
1053 #endif
1054     if (!IPv4MulticastAddress.s_addr)
1055     {
1056         (void)inet_pton(AF_INET, IPv4_MULTICAST, &IPv4MulticastAddress);
1057         (void)inet_pton(AF_INET6, IPv6_MULTICAST_INT, &IPv6MulticastAddressInt);
1058         (void)inet_pton(AF_INET6, IPv6_MULTICAST_LNK, &IPv6MulticastAddressLnk);
1059         (void)inet_pton(AF_INET6, IPv6_MULTICAST_RLM, &IPv6MulticastAddressRlm);
1060         (void)inet_pton(AF_INET6, IPv6_MULTICAST_ADM, &IPv6MulticastAddressAdm);
1061         (void)inet_pton(AF_INET6, IPv6_MULTICAST_SIT, &IPv6MulticastAddressSit);
1062         (void)inet_pton(AF_INET6, IPv6_MULTICAST_ORG, &IPv6MulticastAddressOrg);
1063         (void)inet_pton(AF_INET6, IPv6_MULTICAST_GLB, &IPv6MulticastAddressGlb);
1064     }
1065
1066     if (!caglobals.ip.ipv6enabled && !caglobals.ip.ipv4enabled)
1067     {
1068         caglobals.ip.ipv4enabled = true;  // only needed to run CA tests
1069     }
1070
1071     CreateMulticastSocket();
1072
1073     OIC_LOG_V(INFO, TAG,
1074               "socket summary: u6=%d, u6s=%d, u4=%d, u4s=%d, m6=%d, m6s=%d, m4=%d, m4s=%d",
1075               caglobals.ip.u6.fd, caglobals.ip.u6s.fd, caglobals.ip.u4.fd, caglobals.ip.u4s.fd,
1076               caglobals.ip.m6.fd, caglobals.ip.m6s.fd, caglobals.ip.m4.fd, caglobals.ip.m4s.fd);
1077
1078     OIC_LOG_V(INFO, TAG,
1079               "port summary: u6 port=%d, u6s port=%d, u4 port=%d, u4s port=%d, m6 port=%d,"
1080               "m6s port=%d, m4 port=%d, m4s port=%d",
1081               caglobals.ip.u6.port, caglobals.ip.u6s.port, caglobals.ip.u4.port,
1082               caglobals.ip.u4s.port, caglobals.ip.m6.port, caglobals.ip.m6s.port,
1083               caglobals.ip.m4.port, caglobals.ip.m4s.port);
1084 #if defined (SIO_GET_EXTENSION_FUNCTION_POINTER)
1085     caglobals.ip.wsaRecvMsg = NULL;
1086     GUID GuidWSARecvMsg = WSAID_WSARECVMSG;
1087     DWORD copied = 0;
1088     err = WSAIoctl(caglobals.ip.u4.fd, SIO_GET_EXTENSION_FUNCTION_POINTER, &GuidWSARecvMsg, sizeof(GuidWSARecvMsg), &(caglobals.ip.wsaRecvMsg), sizeof(caglobals.ip.wsaRecvMsg), &copied, 0, 0);
1089     if (0 != err)
1090     {
1091         OIC_LOG_V(ERROR, TAG, "WSAIoctl failed %i", WSAGetLastError());
1092         return CA_STATUS_FAILED;
1093     }
1094 #endif
1095     // set up appropriate FD mechanism for fast shutdown
1096     CAInitializeFastShutdownMechanism();
1097
1098     // create source of network interface change notifications
1099     CAInitializeNetlink();
1100
1101     caglobals.ip.selectTimeout = CAGetPollingInterval(caglobals.ip.selectTimeout);
1102
1103     res = CAIPStartListenServer();
1104     if (CA_STATUS_OK != res)
1105     {
1106         OIC_LOG_V(ERROR, TAG, "Failed to start listening server![%d]", res);
1107         return res;
1108     }
1109
1110     caglobals.ip.terminate = false;
1111 #ifndef __TIZENRT__
1112     res = ca_thread_pool_add_task(threadPool, CAReceiveHandler, NULL, NULL);
1113 #else
1114     res = ca_thread_pool_add_task(threadPool, CAReceiveHandler, NULL, NULL, "IoT_ReceiveHandler",
1115                                   CONFIG_IOTIVITY_RECEIVEHANDLER_PTHREAD_STACKSIZE);
1116 #endif
1117     if (CA_STATUS_OK != res)
1118     {
1119         OIC_LOG(ERROR, TAG, "thread_pool_add_task failed");
1120         CAIPStopServer();
1121         return res;
1122     }
1123     OIC_LOG(INFO, TAG, "CAReceiveHandler thread started successfully.");
1124
1125     caglobals.ip.started = true;
1126     return CA_STATUS_OK;
1127 }
1128
1129 void CAIPStopServer()
1130 {
1131     caglobals.ip.started = false;
1132     caglobals.ip.terminate = true;
1133
1134     CADeInitializeIPGlobals();
1135
1136 #if !defined(WSA_WAIT_EVENT_0)
1137 #ifndef __TIZENRT__
1138     if (caglobals.ip.shutdownFds[1] != -1)
1139     {
1140         close(caglobals.ip.shutdownFds[1]);
1141         // receive thread will stop immediately
1142     }
1143     else
1144     {
1145         // receive thread will stop in SELECT_TIMEOUT seconds.
1146     }
1147 #endif
1148 #else
1149     // receive thread will stop immediately.
1150     if (!WSASetEvent(caglobals.ip.shutdownEvent))
1151     {
1152         OIC_LOG_V(DEBUG, TAG, "set shutdown event failed: %#08X", GetLastError());
1153     }
1154 #endif
1155
1156     OIC_LOG(INFO, TAG, "Adapter terminated successfully");
1157 }
1158
1159 static void applyMulticastToInterface4(uint32_t ifindex)
1160 {
1161     if (!caglobals.ip.ipv4enabled)
1162     {
1163         return;
1164     }
1165
1166 #if defined(USE_IP_MREQN)
1167     struct ip_mreqn mreq = { .imr_multiaddr = IPv4MulticastAddress,
1168                              .imr_address.s_addr = htonl(INADDR_ANY),
1169                              .imr_ifindex = ifindex };
1170 #else
1171     struct ip_mreq mreq  = { .imr_multiaddr.s_addr = IPv4MulticastAddress.s_addr,
1172                              .imr_interface.s_addr = htonl(ifindex) };
1173 #endif
1174
1175     int ret = setsockopt(caglobals.ip.m4.fd, IPPROTO_IP, IP_ADD_MEMBERSHIP, OPTVAL_T(&mreq), sizeof (mreq));
1176     if (OC_SOCKET_ERROR == ret)
1177     {
1178 #if !defined(WSAEINVAL)
1179         if (EADDRINUSE != errno)
1180 #else
1181         if (WSAEINVAL != WSAGetLastError()) // Joining multicast group more than once (IPv4 Flavor)
1182 #endif
1183         {
1184             OIC_LOG_V(ERROR, TAG, "       IPv4 IP_ADD_MEMBERSHIP failed: %s", CAIPS_GET_ERROR);
1185         }
1186     }
1187     ret = setsockopt(caglobals.ip.m4s.fd, IPPROTO_IP, IP_ADD_MEMBERSHIP, OPTVAL_T(&mreq), sizeof (mreq));
1188     if (OC_SOCKET_ERROR == ret)
1189     {
1190 #if !defined(WSAEINVAL)
1191         if (EADDRINUSE != errno)
1192 #else
1193         if (WSAEINVAL != WSAGetLastError()) // Joining multicast group more than once (IPv4 Flavor)
1194 #endif
1195         {
1196             OIC_LOG_V(ERROR, TAG, "SECURE IPv4 IP_ADD_MEMBERSHIP failed: %s", CAIPS_GET_ERROR);
1197         }
1198     }
1199 }
1200
1201 static void applyMulticast6(int fd, struct in6_addr *addr, uint32_t ifindex)
1202 {
1203 #ifndef __TIZENRT__
1204     struct ipv6_mreq mreq = {.ipv6mr_multiaddr = {{{0}}},
1205                              .ipv6mr_interface = ifindex };
1206
1207     // VS2013 has problems with struct copies inside struct initializers, so copy separately.
1208     mreq.ipv6mr_multiaddr = *addr;
1209
1210     int ret = setsockopt(fd, IPPROTO_IPV6, IPV6_JOIN_GROUP, OPTVAL_T(&mreq), sizeof (mreq));
1211     if (OC_SOCKET_ERROR == ret)
1212     {
1213 #if !defined(_WIN32)
1214                 if (EADDRINUSE != errno)
1215 #else
1216                 if (WSAEINVAL != WSAGetLastError()) // Joining multicast group more than once (IPv6 Flavor)
1217 #endif
1218         {
1219             OIC_LOG_V(ERROR, TAG, "IPv6 IPV6_JOIN_GROUP failed: %s", CAIPS_GET_ERROR);
1220         }
1221     }
1222 #endif
1223 }
1224
1225 static void applyMulticastToInterface6(uint32_t ifindex)
1226 {
1227     if (!caglobals.ip.ipv6enabled)
1228     {
1229         return;
1230     }
1231     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressInt, ifindex);
1232     applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressLnk, ifindex);
1233     applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressRlm, ifindex);
1234     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressAdm, ifindex);
1235     applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressSit, ifindex);
1236     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressOrg, ifindex);
1237     //applyMulticast6(caglobals.ip.m6.fd, &IPv6MulticastAddressGlb, ifindex);
1238
1239     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressInt, ifindex);
1240     applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressLnk, ifindex);
1241     applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressRlm, ifindex);
1242     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressAdm, ifindex);
1243     applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressSit, ifindex);
1244     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressOrg, ifindex);
1245     //applyMulticast6(caglobals.ip.m6s.fd, &IPv6MulticastAddressGlb, ifindex);
1246 }
1247
1248 CAResult_t CAIPStartListenServer()
1249 {
1250     u_arraylist_t *iflist = CAIPGetInterfaceInformation(0);
1251     if (!iflist)
1252     {
1253         OIC_LOG_V(ERROR, TAG, "CAIPGetInterfaceInformation() failed: %s", strerror(errno));
1254         return CA_STATUS_FAILED;
1255     }
1256
1257     uint32_t len = u_arraylist_length(iflist);
1258     OIC_LOG_V(DEBUG, TAG, "IP network interfaces found: %d", len);
1259
1260     for (uint32_t i = 0; i < len; i++)
1261     {
1262         CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
1263
1264         if (!ifitem)
1265         {
1266             continue;
1267         }
1268         if ((ifitem->flags & IFF_UP_RUNNING_FLAGS) != IFF_UP_RUNNING_FLAGS)
1269         {
1270             continue;
1271         }
1272         if (ifitem->family == AF_INET)
1273         {
1274             OIC_LOG_V(DEBUG, TAG, "Adding IPv4 interface(%d) to multicast group", ifitem->index);
1275             applyMulticastToInterface4(ifitem->index);
1276         }
1277         if (ifitem->family == AF_INET6)
1278         {
1279             OIC_LOG_V(DEBUG, TAG, "Adding IPv6 interface(%d) to multicast group", ifitem->index);
1280             applyMulticastToInterface6(ifitem->index);
1281         }
1282     }
1283
1284     u_arraylist_destroy(iflist);
1285     return CA_STATUS_OK;
1286 }
1287
1288 CAResult_t CAIPStopListenServer()
1289 {
1290     u_arraylist_t *iflist = CAIPGetInterfaceInformation(0);
1291     if (!iflist)
1292     {
1293         OIC_LOG_V(ERROR, TAG, "Get interface info failed: %s", strerror(errno));
1294         return CA_STATUS_FAILED;
1295     }
1296
1297     uint32_t len = u_arraylist_length(iflist);
1298     OIC_LOG_V(DEBUG, TAG, "IP network interfaces found: %d", len);
1299
1300     for (uint32_t i = 0; i < len; i++)
1301     {
1302         CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
1303
1304         if (!ifitem)
1305         {
1306             continue;
1307         }
1308         if ((ifitem->flags & IFF_UP_RUNNING_FLAGS) != IFF_UP_RUNNING_FLAGS)
1309         {
1310             continue;
1311         }
1312         if (ifitem->family == AF_INET)
1313         {
1314             CLOSE_SOCKET(m4);
1315             CLOSE_SOCKET(m4s);
1316             OIC_LOG_V(DEBUG, TAG, "IPv4 network interface: %s cloed", ifitem->name);
1317         }
1318         if (ifitem->family == AF_INET6)
1319         {
1320             CLOSE_SOCKET(m6);
1321             CLOSE_SOCKET(m6s);
1322             OIC_LOG_V(DEBUG, TAG, "IPv6 network interface: %s", ifitem->name);
1323         }
1324     }
1325     u_arraylist_destroy(iflist);
1326     return CA_STATUS_OK;
1327 }
1328
1329 void CAProcessNewInterface(CAInterface_t *ifitem)
1330 {
1331     if (!ifitem)
1332     {
1333         OIC_LOG(DEBUG, TAG, "ifitem is null");
1334         return;
1335     }
1336
1337     if (ifitem->family == AF_INET6)
1338     {
1339         OIC_LOG_V(DEBUG, TAG, "Adding a new IPv6 interface(%d) to multicast group", ifitem->index);
1340         applyMulticastToInterface6(ifitem->index);
1341     }
1342     if (ifitem->family == AF_INET)
1343     {
1344         OIC_LOG_V(DEBUG, TAG, "Adding a new IPv4 interface(%d) to multicast group", ifitem->index);
1345         applyMulticastToInterface4(ifitem->index);
1346     }
1347 }
1348
1349 void CAIPSetPacketReceiveCallback(CAIPPacketReceivedCallback callback)
1350 {
1351     g_packetReceivedCallback = callback;
1352 }
1353
1354 static void sendData(int fd, const CAEndpoint_t *endpoint,
1355                      const void *data, uint32_t dlen,
1356                      const char *cast, const char *fam)
1357 {
1358     OIC_LOG(DEBUG, TAG, "IN");
1359
1360     if (!endpoint)
1361     {
1362         OIC_LOG(DEBUG, TAG, "endpoint is null");
1363         if (g_ipErrorHandler)
1364         {
1365             g_ipErrorHandler(endpoint, data, dlen, CA_STATUS_INVALID_PARAM);
1366         }
1367         return;
1368     }
1369
1370     (void)cast;  // eliminates release warning
1371     (void)fam;
1372
1373     struct sockaddr_storage sock = { .ss_family = 0 };
1374     CAConvertNameToAddr(endpoint->addr, endpoint->port, &sock);
1375
1376     socklen_t socklen = 0;
1377     if (sock.ss_family == AF_INET6)
1378     {
1379         /** @todo figure out correct usage for ifindex, and sin6_scope_id */
1380         socklen = sizeof(struct sockaddr_in6);
1381     }
1382     else
1383     {
1384         socklen = sizeof(struct sockaddr_in);
1385     }
1386
1387 #ifdef TB_LOG
1388     const char *secure = (endpoint->flags & CA_SECURE) ? "secure " : "";
1389 #endif
1390 #if !defined(_WIN32)
1391     ssize_t len = sendto(fd, data, dlen, 0, (struct sockaddr *)&sock, socklen);
1392     if (OC_SOCKET_ERROR == len)
1393     {
1394          // If logging is not defined/enabled.
1395         if (g_ipErrorHandler)
1396         {
1397             g_ipErrorHandler(endpoint, data, dlen, CA_SEND_FAILED);
1398         }
1399         OIC_LOG_V(ERROR, TAG, "%s%s %s sendTo failed: %s", secure, cast, fam, strerror(errno));
1400         CALogSendStateInfo(endpoint->adapter, endpoint->addr, endpoint->port,
1401                            len, false, strerror(errno));
1402     }
1403     else
1404     {
1405         OIC_LOG_V(INFO, TAG, "%s%s %s sendTo is successful: %zd bytes", secure, cast, fam, len);
1406         CALogSendStateInfo(endpoint->adapter, endpoint->addr, endpoint->port,
1407                            len, true, NULL);
1408     }
1409 #else
1410     int err = 0;
1411     int len = 0;
1412     int sent = 0;
1413     do {
1414         len = sendto(fd, ((char*)data) + sent, dlen - sent, 0, (struct sockaddr *)&sock, socklen);
1415         if (OC_SOCKET_ERROR == len)
1416         {
1417             err = WSAGetLastError();
1418             if ((WSAEWOULDBLOCK != err) && (WSAENOBUFS != err))
1419             {
1420                  // If logging is not defined/enabled.
1421                 if (g_ipErrorHandler)
1422                 {
1423                     g_ipErrorHandler(endpoint, data, dlen, CA_SEND_FAILED);
1424                 }
1425
1426                 OIC_LOG_V(ERROR, TAG, "%s%s %s sendTo failed: %i", secure, cast, fam, err);
1427             }
1428         }
1429         else
1430         {
1431             sent += len;
1432             if (sent != len)
1433             {
1434                 OIC_LOG_V(INFO, TAG, "%s%s %s sendTo (Partial Send) is successful: "
1435                           "currently sent: %ld bytes, "
1436                           "total sent: %ld bytes, "
1437                           "remaining: %ld bytes",
1438                           secure, cast, fam, len, sent, dlen-sent);
1439             }
1440             else
1441             {
1442                 OIC_LOG_V(INFO, TAG, "%s%s %s sendTo is successful: %ld bytes",
1443                                      secure, cast, fam, len);
1444             }
1445         }
1446     } while ((OC_SOCKET_ERROR == len) && ((WSAEWOULDBLOCK == err) || (WSAENOBUFS == err)) || (sent < dlen));
1447 #endif
1448 }
1449
1450 static void sendMulticastData6(const u_arraylist_t *iflist,
1451                                CAEndpoint_t *endpoint,
1452                                const void *data, uint32_t datalen)
1453 {
1454     if (!endpoint)
1455     {
1456         OIC_LOG(DEBUG, TAG, "endpoint is null");
1457         return;
1458     }
1459
1460     int scope = endpoint->flags & CA_SCOPE_MASK;
1461     char *ipv6mcname = ipv6mcnames[scope];
1462     if (!ipv6mcname)
1463     {
1464         OIC_LOG_V(INFO, TAG, "IPv6 multicast scope invalid: %d", scope);
1465         return;
1466     }
1467     OICStrcpy(endpoint->addr, sizeof(endpoint->addr), ipv6mcname);
1468     int fd = caglobals.ip.u6.fd;
1469
1470     uint32_t len = u_arraylist_length(iflist);
1471     for (uint32_t i = 0; i < len; i++)
1472     {
1473         CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
1474         if (!ifitem)
1475         {
1476             continue;
1477         }
1478         if ((ifitem->flags & IFF_UP_RUNNING_FLAGS) != IFF_UP_RUNNING_FLAGS)
1479         {
1480             continue;
1481         }
1482         if (ifitem->family != AF_INET6)
1483         {
1484             continue;
1485         }
1486
1487         bool isMobile = false;
1488         for (uint32_t j = 0; j < MOBILE_INTERFACES; j++)
1489         {
1490             if (strstr(ifitem->name, mobileinferfaces[j]))
1491             {
1492                 isMobile = true;
1493                 break;
1494             }
1495         }
1496         if (isMobile)
1497         {
1498             continue;
1499         }
1500
1501         int index = ifitem->index;
1502         if (setsockopt(fd, IPPROTO_IPV6, IPV6_MULTICAST_IF, OPTVAL_T(&index), sizeof (index)))
1503         {
1504             OIC_LOG_V(ERROR, TAG, "setsockopt6 failed: %s", CAIPS_GET_ERROR);
1505             return;
1506         }
1507
1508 #ifndef __TIZENRT__
1509         // Set multicast packet TTL; default TTL is 1
1510         if (setsockopt(fd, IPPROTO_IPV6, IPV6_MULTICAST_HOPS, &multicastTTL, sizeof(multicastTTL)))
1511         {
1512             OIC_LOG_V(ERROR, TAG, "IPV6_MULTICAST_HOPS failed: %s", CAIPS_GET_ERROR);
1513         }
1514 #endif
1515         sendData(fd, endpoint, data, datalen, "multicast", "ipv6");
1516     }
1517 }
1518
1519 static void sendMulticastData4(const u_arraylist_t *iflist,
1520                                CAEndpoint_t *endpoint,
1521                                const void *data, uint32_t datalen)
1522 {
1523     VERIFY_NON_NULL_VOID(endpoint, TAG, "endpoint is NULL");
1524
1525 #if defined(USE_IP_MREQN)
1526     struct ip_mreqn mreq = { .imr_multiaddr = IPv4MulticastAddress,
1527                              .imr_address.s_addr = htonl(INADDR_ANY),
1528                              .imr_ifindex = 0};
1529 #else
1530     struct ip_mreq mreq  = { .imr_multiaddr.s_addr = IPv4MulticastAddress.s_addr,
1531                              .imr_interface = {0}};
1532 #endif
1533
1534     OICStrcpy(endpoint->addr, sizeof(endpoint->addr), IPv4_MULTICAST);
1535     int fd = caglobals.ip.u4.fd;
1536
1537     uint32_t len = u_arraylist_length(iflist);
1538     for (uint32_t i = 0; i < len; i++)
1539     {
1540         CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
1541         if (!ifitem)
1542         {
1543             continue;
1544         }
1545         if ((ifitem->flags & IFF_UP_RUNNING_FLAGS) != IFF_UP_RUNNING_FLAGS)
1546         {
1547             continue;
1548         }
1549         if (ifitem->family != AF_INET)
1550         {
1551             continue;
1552         }
1553
1554         bool isMobile = false;
1555         for (uint32_t j = 0; j < MOBILE_INTERFACES; j++)
1556         {
1557             if (strstr(ifitem->name, mobileinferfaces[j]))
1558             {
1559                 isMobile = true;
1560                 break;
1561             }
1562         }
1563         if (isMobile)
1564         {
1565             continue;
1566         }
1567
1568 #if defined(USE_IP_MREQN)
1569         mreq.imr_ifindex = ifitem->index;
1570 #else
1571         mreq.imr_interface.s_addr = htonl(ifitem->index);
1572 #endif
1573         if (setsockopt(fd, IPPROTO_IP, IP_MULTICAST_IF, OPTVAL_T(&mreq), sizeof (mreq)))
1574         {
1575             OIC_LOG_V(ERROR, TAG, "send IP_MULTICAST_IF failed: %s (using defualt)",
1576                     CAIPS_GET_ERROR);
1577         }
1578
1579         // Set multicast packet TTL; default TTL is 1
1580         if (setsockopt(fd, IPPROTO_IP, IP_MULTICAST_TTL, &multicastTTL, sizeof(multicastTTL)))
1581         {
1582             OIC_LOG_V(ERROR, TAG, "IP_MULTICAST_TTL failed: %s", CAIPS_GET_ERROR);
1583         }
1584         sendData(fd, endpoint, data, datalen, "multicast", "ipv4");
1585     }
1586 }
1587
1588 void CAIPSendData(CAEndpoint_t *endpoint, const void *data, uint32_t datalen,
1589                   bool isMulticast)
1590 {
1591     VERIFY_NON_NULL_VOID(endpoint, TAG, "endpoint is NULL");
1592     VERIFY_NON_NULL_VOID(data, TAG, "data is NULL");
1593
1594     bool isSecure = (endpoint->flags & CA_SECURE) != 0;
1595
1596     if (isMulticast)
1597     {
1598         endpoint->port = isSecure ? CA_SECURE_COAP : CA_COAP;
1599
1600         u_arraylist_t *iflist = CAIPGetInterfaceInformation(0);
1601         if (!iflist)
1602         {
1603             OIC_LOG_V(ERROR, TAG, "get interface info failed: %s", strerror(errno));
1604             return;
1605         }
1606
1607         if ((endpoint->flags & CA_IPV6) && caglobals.ip.ipv6enabled)
1608         {
1609             sendMulticastData6(iflist, endpoint, data, datalen);
1610         }
1611         if ((endpoint->flags & CA_IPV4) && caglobals.ip.ipv4enabled)
1612         {
1613             sendMulticastData4(iflist, endpoint, data, datalen);
1614         }
1615
1616         u_arraylist_destroy(iflist);
1617     }
1618     else
1619     {
1620         if (!endpoint->port)    // unicast discovery
1621         {
1622             endpoint->port = isSecure ? CA_SECURE_COAP : CA_COAP;
1623         }
1624
1625         CASocketFd_t fd;
1626         if (caglobals.ip.ipv6enabled && (endpoint->flags & CA_IPV6))
1627         {
1628             fd = isSecure ? caglobals.ip.u6s.fd : caglobals.ip.u6.fd;
1629 #ifndef __WITH_DTLS__
1630             fd = caglobals.ip.u6.fd;
1631 #endif
1632             sendData(fd, endpoint, data, datalen, "unicast", "ipv6");
1633         }
1634         if (caglobals.ip.ipv4enabled && (endpoint->flags & CA_IPV4))
1635         {
1636             fd = isSecure ? caglobals.ip.u4s.fd : caglobals.ip.u4.fd;
1637 #ifndef __WITH_DTLS__
1638             fd = caglobals.ip.u4.fd;
1639 #endif
1640             sendData(fd, endpoint, data, datalen, "unicast", "ipv4");
1641         }
1642     }
1643 }
1644
1645 CAResult_t CAGetIPInterfaceInformation(CAEndpoint_t **info, uint32_t *size)
1646 {
1647     VERIFY_NON_NULL(info, TAG, "info is NULL");
1648     VERIFY_NON_NULL(size, TAG, "size is NULL");
1649
1650     u_arraylist_t *iflist = CAIPGetInterfaceInformation(0);
1651     if (!iflist)
1652     {
1653         OIC_LOG_V(ERROR, TAG, "get interface info failed: %s", strerror(errno));
1654         return CA_STATUS_FAILED;
1655     }
1656
1657     uint32_t len = u_arraylist_length(iflist);
1658     uint32_t length = len;
1659
1660 #ifdef __WITH_DTLS__
1661     //If DTLS is supported, each interface can support secure port as well
1662     length = len * 2;
1663 #endif
1664
1665     CAEndpoint_t *eps = (CAEndpoint_t *)OICCalloc(length, sizeof (CAEndpoint_t));
1666     if (!eps)
1667     {
1668         OIC_LOG(ERROR, TAG, "Malloc Failed");
1669         u_arraylist_destroy(iflist);
1670         return CA_MEMORY_ALLOC_FAILED;
1671     }
1672
1673     for (uint32_t i = 0, j = 0; i < len; i++)
1674     {
1675         CAInterface_t *ifitem = (CAInterface_t *)u_arraylist_get(iflist, i);
1676         if(!ifitem)
1677         {
1678             continue;
1679         }
1680
1681         eps[j].adapter = CA_ADAPTER_IP;
1682         eps[j].ifindex = 0;
1683
1684         if (ifitem->family == AF_INET6)
1685         {
1686             eps[j].flags = CA_IPV6;
1687             eps[j].port = caglobals.ip.u6.port;
1688         }
1689         else
1690         {
1691             eps[j].flags = CA_IPV4;
1692             eps[j].port = caglobals.ip.u4.port;
1693         }
1694         OICStrcpy(eps[j].addr, sizeof(eps[j].addr), ifitem->addr);
1695
1696 #ifdef __WITH_DTLS__
1697         j++;
1698
1699         eps[j].adapter = CA_ADAPTER_IP;
1700         eps[j].ifindex = 0;
1701
1702         if (ifitem->family == AF_INET6)
1703         {
1704             eps[j].flags = CA_IPV6 | CA_SECURE;
1705             eps[j].port = caglobals.ip.u6s.port;
1706         }
1707         else
1708         {
1709             eps[j].flags = CA_IPV4 | CA_SECURE;
1710             eps[j].port = caglobals.ip.u4s.port;
1711         }
1712         OICStrcpy(eps[j].addr, sizeof(eps[j].addr), ifitem->addr);
1713 #endif
1714         j++;
1715     }
1716
1717     *info = eps;
1718     *size = length;
1719
1720     u_arraylist_destroy(iflist);
1721
1722     return CA_STATUS_OK;
1723 }
1724
1725 void CAIPSetErrorHandler(CAIPErrorHandleCallback errorHandleCallback)
1726 {
1727     g_ipErrorHandler = errorHandleCallback;
1728 }
1729
1730 CAResult_t CAIPSetMulticastTTL(size_t ttl)
1731 {
1732     multicastTTL = ttl;
1733     return CA_STATUS_OK;
1734 }
1735
1736 CAResult_t CAIPGetMulticastTTL(size_t *ttl)
1737 {
1738     VERIFY_NON_NULL(ttl, TAG, "ttl is NULL");
1739
1740     *ttl = multicastTTL;
1741     return CA_STATUS_OK;
1742 }