[ARDUINO] Fixed send data failure in IP adapter
[platform/upstream/iotivity.git] / resource / csdk / connectivity / src / ip_adapter / caipadapter.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 #include "caipadapter.h"
21
22 #include <stdio.h>
23 #include <stdlib.h>
24 #include <string.h>
25 #include <stdint.h>
26
27 #include "caipinterface.h"
28 #include "caqueueingthread.h"
29 #include "caadapterutils.h"
30 #ifdef __WITH_DTLS__
31 #include "caadapternetdtls.h"
32 #endif
33 #include "camutex.h"
34 #include "uarraylist.h"
35 #include "caremotehandler.h"
36 #include "logger.h"
37 #include "oic_malloc.h"
38 #include "oic_string.h"
39
40 /**
41  * Logging tag for module name.
42  */
43 #define TAG "IP_ADAP"
44
45 #ifndef SINGLE_THREAD
46 /**
47  * Holds inter thread ip data information.
48  */
49 typedef struct
50 {
51     CAEndpoint_t *remoteEndpoint;
52     void *data;
53     uint32_t dataLen;
54     bool isMulticast;
55 } CAIPData;
56
57 /**
58  * Queue handle for Send Data.
59  */
60 static CAQueueingThread_t *g_sendQueueHandle = NULL;
61 #endif
62
63 /**
64  * Network Packet Received Callback to CA.
65  */
66 static CANetworkPacketReceivedCallback g_networkPacketCallback = NULL;
67
68 /**
69  * Network Changed Callback to CA.
70  */
71 static CANetworkChangeCallback g_networkChangeCallback = NULL;
72
73 /**
74  * error Callback to CA adapter.
75  */
76 static CAErrorHandleCallback g_errorCallback = NULL;
77
78 static void CAIPPacketReceivedCB(const CAEndpoint_t *endpoint,
79                                  const void *data, uint32_t dataLength);
80 #ifdef __WITH_DTLS__
81 static void CAIPPacketSendCB(CAEndpoint_t *endpoint,
82                              const void *data, uint32_t dataLength);
83 #endif
84
85 #ifndef SINGLE_THREAD
86
87 static CAResult_t CAIPInitializeQueueHandles();
88
89 static void CAIPDeinitializeQueueHandles();
90
91 static void CAIPSendDataThread(void *threadData);
92
93 static CAIPData *CACreateIPData(const CAEndpoint_t *remoteEndpoint,
94                                 const void *data, uint32_t dataLength,
95                                 bool isMulticast);
96 void CAFreeIPData(CAIPData *ipData);
97
98 static void CADataDestroyer(void *data, uint32_t size);
99
100 CAResult_t CAIPInitializeQueueHandles()
101 {
102     OIC_LOG(DEBUG, TAG, "IN");
103
104     // Check if the message queue is already initialized
105     if (g_sendQueueHandle)
106     {
107         OIC_LOG(DEBUG, TAG, "send queue handle is already initialized!");
108         return CA_STATUS_OK;
109     }
110
111     // Create send message queue
112     g_sendQueueHandle = OICMalloc(sizeof(CAQueueingThread_t));
113     if (!g_sendQueueHandle)
114     {
115         OIC_LOG(ERROR, TAG, "Memory allocation failed!");
116         return CA_MEMORY_ALLOC_FAILED;
117     }
118
119     if (CA_STATUS_OK != CAQueueingThreadInitialize(g_sendQueueHandle,
120                                 (const ca_thread_pool_t)caglobals.ip.threadpool,
121                                 CAIPSendDataThread, CADataDestroyer))
122     {
123         OIC_LOG(ERROR, TAG, "Failed to Initialize send queue thread");
124         OICFree(g_sendQueueHandle);
125         g_sendQueueHandle = NULL;
126         return CA_STATUS_FAILED;
127     }
128
129     OIC_LOG(DEBUG, TAG, "OUT");
130     return CA_STATUS_OK;
131 }
132
133 void CAIPDeinitializeQueueHandles()
134 {
135     OIC_LOG(DEBUG, TAG, "IN");
136
137     CAQueueingThreadDestroy(g_sendQueueHandle);
138     OICFree(g_sendQueueHandle);
139     g_sendQueueHandle = NULL;
140
141     OIC_LOG(DEBUG, TAG, "OUT");
142 }
143
144 #endif // SINGLE_THREAD
145
146 void CAIPConnectionStateCB(const char *ipAddress, CANetworkStatus_t status)
147 {
148     OIC_LOG(DEBUG, TAG, "IN");
149 }
150
151 #ifdef __WITH_DTLS__
152 static void CAIPPacketSendCB(CAEndpoint_t *endpoint, const void *data, uint32_t dataLength)
153 {
154     OIC_LOG(DEBUG, TAG, "IN");
155
156     VERIFY_NON_NULL_VOID(endpoint, TAG, "endpoint is NULL");
157     VERIFY_NON_NULL_VOID(data, TAG, "data is NULL");
158
159     CAIPSendData(endpoint, data, dataLength, false);
160
161     OIC_LOG(DEBUG, TAG, "OUT");
162 }
163 #endif
164
165 void CAIPPacketReceivedCB(const CAEndpoint_t *endpoint, const void *data,
166                           uint32_t dataLength)
167 {
168     OIC_LOG(DEBUG, TAG, "IN");
169
170     VERIFY_NON_NULL_VOID(endpoint, TAG, "ipAddress is NULL");
171     VERIFY_NON_NULL_VOID(data, TAG, "data is NULL");
172
173     OIC_LOG_V(DEBUG, TAG, "Address: %s, port:%d", endpoint->addr, endpoint->port);
174
175     if (g_networkPacketCallback)
176     {
177         g_networkPacketCallback(endpoint, data, dataLength);
178     }
179     OIC_LOG(DEBUG, TAG, "OUT");
180 }
181
182 void CAIPErrorHandler (const CAEndpoint_t *endpoint, const void *data,
183                        uint32_t dataLength, CAResult_t result)
184 {
185     OIC_LOG(DEBUG, TAG, "IN");
186
187     VERIFY_NON_NULL_VOID(endpoint, TAG, "endpoint is NULL");
188
189     VERIFY_NON_NULL_VOID(data, TAG, "data is NULL");
190
191     void *buf = (void*)OICMalloc(sizeof(char) * dataLength);
192     if (!buf)
193     {
194         OIC_LOG(ERROR, TAG, "Memory Allocation failed!");
195         return;
196     }
197     memcpy(buf, data, dataLength);
198     if (g_errorCallback)
199     {
200         g_errorCallback(endpoint, buf, dataLength, result);
201     }
202     else
203     {
204         OICFree(buf);
205     }
206
207     OIC_LOG(DEBUG, TAG, "OUT");
208 }
209
210 static void CAInitializeIPGlobals()
211 {
212     caglobals.ip.u6.fd  = -1;
213     caglobals.ip.u6s.fd = -1;
214     caglobals.ip.u4.fd  = -1;
215     caglobals.ip.u4s.fd = -1;
216     caglobals.ip.m6.fd  = -1;
217     caglobals.ip.m6s.fd = -1;
218     caglobals.ip.m4.fd  = -1;
219     caglobals.ip.m4s.fd = -1;
220     caglobals.ip.u6.port  = 0;
221     caglobals.ip.u6s.port = 0;
222     caglobals.ip.u4.port  = 0;
223     caglobals.ip.u4s.port = 0;
224     caglobals.ip.m6.port  = CA_COAP;
225     caglobals.ip.m6s.port = CA_SECURE_COAP;
226     caglobals.ip.m4.port  = CA_COAP;
227     caglobals.ip.m4s.port = CA_SECURE_COAP;
228
229     CATransportFlags_t flags = 0;
230     if (caglobals.client)
231     {
232         flags |= caglobals.clientFlags;
233     }
234     if (caglobals.server)
235     {
236         flags |= caglobals.serverFlags;
237     }
238     caglobals.ip.ipv6enabled = flags & CA_IPV6;
239     caglobals.ip.ipv4enabled = flags & CA_IPV4;
240 }
241
242 CAResult_t CAInitializeIP(CARegisterConnectivityCallback registerCallback,
243                           CANetworkPacketReceivedCallback networkPacketCallback,
244                           CANetworkChangeCallback netCallback,
245                           CAErrorHandleCallback errorCallback, ca_thread_pool_t handle)
246 {
247     OIC_LOG(DEBUG, TAG, "IN");
248     VERIFY_NON_NULL(registerCallback, TAG, "registerCallback");
249     VERIFY_NON_NULL(networkPacketCallback, TAG, "networkPacketCallback");
250     VERIFY_NON_NULL(netCallback, TAG, "netCallback");
251 #ifndef SINGLE_THREAD
252     VERIFY_NON_NULL(handle, TAG, "thread pool handle");
253 #endif
254
255     g_networkChangeCallback = netCallback;
256     g_networkPacketCallback = networkPacketCallback;
257     g_errorCallback = errorCallback;
258
259     CAInitializeIPGlobals();
260     caglobals.ip.threadpool = handle;
261
262     CAIPSetPacketReceiveCallback(CAIPPacketReceivedCB);
263 #ifdef __WITH_DTLS__
264     CAAdapterNetDtlsInit();
265
266     CADTLSSetAdapterCallbacks(CAIPPacketReceivedCB, CAIPPacketSendCB, 0);
267 #endif
268
269     CAConnectivityHandler_t ipHandler;
270     ipHandler.startAdapter = CAStartIP;
271     ipHandler.startListenServer = CAStartIPListeningServer;
272     ipHandler.startDiscoveryServer = CAStartIPDiscoveryServer;
273     ipHandler.sendData = CASendIPUnicastData;
274     ipHandler.sendDataToAll = CASendIPMulticastData;
275     ipHandler.GetnetInfo = CAGetIPInterfaceInformation;
276     ipHandler.readData = CAReadIPData;
277     ipHandler.stopAdapter = CAStopIP;
278     ipHandler.terminate = CATerminateIP;
279     registerCallback(ipHandler, CA_ADAPTER_IP);
280
281     OIC_LOG(INFO, TAG, "OUT IntializeIP is Success");
282     return CA_STATUS_OK;
283 }
284
285 CAResult_t CAStartIP()
286 {
287     OIC_LOG(DEBUG, TAG, "IN");
288
289 #ifdef SINGLE_THREAD
290     uint16_t unicastPort = 55555;
291     // Address is hardcoded as we are using Single Interface
292     CAResult_t ret = CAIPStartServer();
293     if (CA_STATUS_OK != ret)
294     {
295         OIC_LOG_V(DEBUG, TAG, "CAIPStartServer failed[%d]", ret);
296         return ret;
297     }
298 #else
299     if (CA_STATUS_OK != CAIPInitializeQueueHandles())
300     {
301         OIC_LOG(ERROR, TAG, "Failed to Initialize Queue Handle");
302         CATerminateIP();
303         return CA_STATUS_FAILED;
304     }
305
306     // Start send queue thread
307     if (CA_STATUS_OK != CAQueueingThreadStart(g_sendQueueHandle))
308     {
309         OIC_LOG(ERROR, TAG, "Failed to Start Send Data Thread");
310         return CA_STATUS_FAILED;
311     }
312
313     CAResult_t ret = CAIPStartServer((const ca_thread_pool_t)caglobals.ip.threadpool);
314     if (CA_STATUS_OK != ret)
315     {
316         OIC_LOG_V(ERROR, TAG, "Failed to start server![%d]", ret);
317         return ret;
318     }
319
320 #endif
321
322     OIC_LOG(DEBUG, TAG, "OUT");
323     return CA_STATUS_OK;
324 }
325
326 CAResult_t CAStartIPListeningServer()
327 {
328     OIC_LOG(DEBUG, TAG, "IN");
329
330     OIC_LOG(DEBUG, TAG, "OUT");
331     return CA_STATUS_OK;
332 }
333
334 CAResult_t CAStartIPDiscoveryServer()
335 {
336     OIC_LOG(DEBUG, TAG, "IN");
337     return CAStartIPListeningServer();
338 }
339
340 static int32_t CAQueueIPData(bool isMulticast, const CAEndpoint_t *endpoint,
341                             const void *data, uint32_t dataLength)
342 {
343     OIC_LOG(DEBUG, TAG, "IN");
344
345     VERIFY_NON_NULL_RET(endpoint, TAG, "remoteEndpoint", -1);
346     VERIFY_NON_NULL_RET(data, TAG, "data", -1);
347
348     if (0 == dataLength)
349     {
350         OIC_LOG(ERROR, TAG, "Invalid Data Length");
351         return -1;
352     }
353
354 #ifdef SINGLE_THREAD
355
356     CAIPSendData(endpoint, data, dataLength, isMulticast);
357     return dataLength;
358
359 #else
360
361     VERIFY_NON_NULL_RET(g_sendQueueHandle, TAG, "sendQueueHandle", -1);
362     // Create IPData to add to queue
363     CAIPData *ipData = CACreateIPData(endpoint, data, dataLength, isMulticast);
364     if (!ipData)
365     {
366         OIC_LOG(ERROR, TAG, "Failed to create ipData!");
367         return -1;
368     }
369     // Add message to send queue
370     CAQueueingThreadAddData(g_sendQueueHandle, ipData, sizeof(CAIPData));
371
372     OIC_LOG(DEBUG, TAG, "OUT");
373     return dataLength;
374
375 #endif // SINGLE_THREAD
376 }
377
378 int32_t CASendIPUnicastData(const CAEndpoint_t *endpoint,
379                             const void *data, uint32_t dataLength)
380 {
381     OIC_LOG(DEBUG, TAG, "IN");
382     return CAQueueIPData(false, endpoint, data, dataLength);
383 }
384
385 int32_t CASendIPMulticastData(const CAEndpoint_t *endpoint, const void *data, uint32_t dataLength)
386 {
387     OIC_LOG(DEBUG, TAG, "IN");
388     return CAQueueIPData(true, endpoint, data, dataLength);
389 }
390
391 CAResult_t CAReadIPData()
392 {
393     OIC_LOG(DEBUG, TAG, "IN");
394     CAIPPullData();
395     OIC_LOG(DEBUG, TAG, "OUT");
396     return CA_STATUS_OK;
397 }
398
399 CAResult_t CAStopIP()
400 {
401     OIC_LOG(DEBUG, TAG, "IN");
402
403 #ifdef __WITH_DTLS__
404     CAAdapterNetDtlsDeInit();
405 #endif
406
407 #ifndef SINGLE_THREAD
408     if (g_sendQueueHandle && g_sendQueueHandle->threadMutex)
409     {
410         CAQueueingThreadStop(g_sendQueueHandle);
411     }
412
413     CAIPDeinitializeQueueHandles();
414 #endif
415
416     CAIPStopServer();
417
418     OIC_LOG(DEBUG, TAG, "OUT");
419     return CA_STATUS_OK;
420 }
421
422 void CATerminateIP()
423 {
424     OIC_LOG(DEBUG, TAG, "IN");
425
426 #ifdef __WITH_DTLS__
427     CADTLSSetAdapterCallbacks(NULL, NULL, 0);
428 #endif
429
430     CAIPSetPacketReceiveCallback(NULL);
431
432 #ifndef SINGLE_THREAD
433     CAIPDeinitializeQueueHandles();
434 #endif
435
436     OIC_LOG(DEBUG, TAG, "OUT");
437 }
438
439 #ifndef SINGLE_THREAD
440
441 void CAIPSendDataThread(void *threadData)
442 {
443     OIC_LOG(DEBUG, TAG, "IN");
444
445     CAIPData *ipData = (CAIPData *) threadData;
446     if (!ipData)
447     {
448         OIC_LOG(DEBUG, TAG, "Invalid ip data!");
449         return;
450     }
451
452     if (ipData->isMulticast)
453     {
454         //Processing for sending multicast
455         OIC_LOG(DEBUG, TAG, "Send Multicast Data is called");
456         CAIPSendData(ipData->remoteEndpoint, ipData->data, ipData->dataLen, true);
457     }
458     else
459     {
460         //Processing for sending unicast
461 #ifdef __WITH_DTLS__
462         if (ipData->remoteEndpoint->flags & CA_SECURE)
463         {
464             OIC_LOG(DEBUG, TAG, "CAAdapterNetDtlsEncrypt called!");
465             CAResult_t result = CAAdapterNetDtlsEncrypt(ipData->remoteEndpoint,
466                                                ipData->data, ipData->dataLen);
467             if (CA_STATUS_OK != result)
468             {
469                 OIC_LOG(ERROR, TAG, "CAAdapterNetDtlsEncrypt failed!");
470             }
471             OIC_LOG_V(DEBUG, TAG,
472                       "CAAdapterNetDtlsEncrypt returned with result[%d]", result);
473         }
474         else
475         {
476             OIC_LOG(DEBUG, TAG, "Send Unicast Data is called");
477             CAIPSendData(ipData->remoteEndpoint, ipData->data, ipData->dataLen, false);
478         }
479 #else
480         CAIPSendData(ipData->remoteEndpoint, ipData->data, ipData->dataLen, false);
481 #endif
482     }
483
484     OIC_LOG(DEBUG, TAG, "OUT");
485 }
486
487 #endif
488
489 #ifndef SINGLE_THREAD
490
491 CAIPData *CACreateIPData(const CAEndpoint_t *remoteEndpoint, const void *data,
492                                      uint32_t dataLength, bool isMulticast)
493 {
494     VERIFY_NON_NULL_RET(data, TAG, "IPData is NULL", NULL);
495
496     CAIPData *ipData = (CAIPData *) OICMalloc(sizeof(CAIPData));
497     if (!ipData)
498     {
499         OIC_LOG(ERROR, TAG, "Memory allocation failed!");
500         return NULL;
501     }
502
503     ipData->remoteEndpoint = CACloneEndpoint(remoteEndpoint);
504     ipData->data = (void *) OICMalloc(dataLength);
505     if (!ipData->data)
506     {
507         OIC_LOG(ERROR, TAG, "Memory allocation failed!");
508         CAFreeIPData(ipData);
509         return NULL;
510     }
511
512     memcpy(ipData->data, data, dataLength);
513     ipData->dataLen = dataLength;
514
515     ipData->isMulticast = isMulticast;
516
517     return ipData;
518 }
519
520 void CAFreeIPData(CAIPData *ipData)
521 {
522     VERIFY_NON_NULL_VOID(ipData, TAG, "ipData is NULL");
523
524     CAFreeEndpoint(ipData->remoteEndpoint);
525     OICFree(ipData->data);
526     OICFree(ipData);
527 }
528
529 void CADataDestroyer(void *data, uint32_t size)
530 {
531     CAIPData *etdata = (CAIPData *) data;
532
533     CAFreeIPData(etdata);
534 }
535
536 #endif // SINGLE_THREAD