X-Git-Url: http://review.tizen.org/git/?a=blobdiff_plain;f=resource%2Fcsdk%2Fconnectivity%2Fsrc%2Fbt_le_adapter%2Fcaleadapter.c;h=10fdffd0f89833b1d9f821d1c94d42230233703c;hb=557f1a83fc2108899640a599d9bb5e22bc5bc91b;hp=2a198db25c5c32821359d5d64a7337d3c03d321b;hpb=068b9d878cead4b54ceaba89cb9d9c19b1c5dcb1;p=platform%2Fupstream%2Fiotivity.git diff --git a/resource/csdk/connectivity/src/bt_le_adapter/caleadapter.c b/resource/csdk/connectivity/src/bt_le_adapter/caleadapter.c index 2a198db..10fdffd 100644 --- a/resource/csdk/connectivity/src/bt_le_adapter/caleadapter.c +++ b/resource/csdk/connectivity/src/bt_le_adapter/caleadapter.c @@ -22,47 +22,36 @@ #include #include +#include "cafragmentation.h" + #include "caleinterface.h" #include "cacommon.h" -#include "camutex.h" +#include "octhread.h" #include "caadapterutils.h" +#ifdef __WITH_DTLS__ +#include "ca_adapter_net_ssl.h" +#endif #ifndef SINGLE_THREAD #include "caqueueingthread.h" #endif -#include "cafragmentation.h" +#if defined(__TIZEN__) || defined(__ANDROID__) +#include "caleserver.h" +#include "caleclient.h" +#endif #include "oic_malloc.h" #include "oic_string.h" #include "caremotehandler.h" +#include /** * Logging tag for module name. */ -#define CALEADAPTER_TAG "LAD" - - -/** - * Stores the information of the Data to be sent from the queues. - * - * This structure will be pushed to the sender/receiver queue for - * processing. - */ -typedef struct -{ - /// Remote endpoint contains the information of remote device. - CAEndpoint_t *remoteEndpoint; - - /// Data to be transmitted over LE transport. - uint8_t *data; - - /// Length of the data being transmitted. - uint32_t dataLen; -} CALEData_t; +#define CALEADAPTER_TAG "OIC_CA_LE_ADAP" /** * Stores information of all the senders. * - * This structure will be used to track and defragment all incoming - * data packet. + * This structure will be used to track and defragment all incoming data packet. */ typedef struct { @@ -70,12 +59,37 @@ typedef struct uint32_t totalDataLen; uint8_t *defragData; CAEndpoint_t *remoteEndpoint; - } CABLESenderInfo_t; + uint8_t refCount; +} CABLESenderInfo_t; + +typedef enum +{ + ADAPTER_EMPTY = 1, + ADAPTER_BOTH_CLIENT_SERVER, + ADAPTER_CLIENT, + ADAPTER_SERVER +} CABLEAdapter_t; + +/** + * mtu size to use in fragmentation logic. + * default value is 20 byte. + */ +static uint16_t g_mtuSize = CA_DEFAULT_BLE_MTU_SIZE; /** * Callback to provide the status of the network change to CA layer. */ -static CANetworkChangeCallback g_networkCallback = NULL; +static CAAdapterChangeCallback g_networkCallback = NULL; + +/** + * Callback to provide the status of the connection change to CA layer. + */ +static CAConnectionChangeCallback g_connectionCallback = NULL; + +/** + * Own port value to identify packet owner. Default port value is 1. + */ +static uint8_t g_localBLESourcePort = 1; /** * bleAddress of the local adapter. Value will be initialized to zero, @@ -86,25 +100,23 @@ static char g_localBLEAddress[18] = { 0 }; /** * Variable to differentiate btw GattServer and GattClient. */ -static bool g_isServer = false; +static CABLEAdapter_t g_adapterType = ADAPTER_EMPTY; + +#ifdef __WITH_DTLS__ +static CADataType_t g_dataType = CA_REQUEST_DATA; +#endif /** * Mutex to synchronize the task to be executed on the GattServer * function calls. */ -static ca_mutex g_bleIsServerMutex = NULL; - -/** - * Mutex to synchronize the callback to be called for the network - * changes. - */ -static ca_mutex g_bleNetworkCbMutex = NULL; +static oc_mutex g_bleIsServerMutex = NULL; /** * Mutex to synchronize the updates of the local LE address of the * adapter. */ -static ca_mutex g_bleLocalAddressMutex = NULL; +static oc_mutex g_bleLocalAddressMutex = NULL; /** * Reference to thread pool. @@ -112,31 +124,14 @@ static ca_mutex g_bleLocalAddressMutex = NULL; static ca_thread_pool_t g_bleAdapterThreadPool = NULL; /** - * Mutex to synchronize the task to be pushed to thread pool. - */ -static ca_mutex g_bleAdapterThreadPoolMutex = NULL; - -/** - * Mutex to synchronize the queing of the data from SenderQueue. - */ -static ca_mutex g_bleClientSendDataMutex = NULL; - -/** * Mutex to synchronize the queing of the data from ReceiverQueue. */ -static ca_mutex g_bleReceiveDataMutex = NULL; - - -/** - * Mutex to synchronize the queing of the data from SenderQueue. - */ -static ca_mutex g_bleServerSendDataMutex = NULL; +static oc_mutex g_bleClientReceiveDataMutex = NULL; /** - * Mutex to synchronize the callback to be called for the - * adapterReqResponse. + * Mutex to synchronize the queing of the data from ReceiverQueue. */ -static ca_mutex g_bleAdapterReqRespCbMutex = NULL; +static oc_mutex g_bleServerReceiveDataMutex = NULL; /** * Callback to be called when network packet received from either @@ -149,33 +144,57 @@ static CANetworkPacketReceivedCallback g_networkPacketReceivedCallback = NULL; */ static CAErrorHandleCallback g_errorHandler = NULL; +#ifdef __WITH_DTLS__ +static CAResult_t CALESecureReceiveDataCB(const CASecureEndpoint_t *endpoint, + const void *data, size_t dataLength); + +static ssize_t CALESecureSendDataCB(CAEndpoint_t *endpoint, + const void *data, size_t dataLength); +#endif + +#ifdef SINGLE_THREAD /** - * Storing Adapter state information. + * Pointer to defragment received data from single threaded routine. */ -static CAAdapterState_t g_bleAdapterState = CA_ADAPTER_DISABLED; +static CABLESenderInfo_t *g_singleThreadReceiveData = NULL; /** - * BLE Server Status. + * This function will be associated with the receive for single thread. + * + * This function will defragment the received data from sender + * respectively and will send it up to CA layer. Respective sender's + * header will provide the length of the data sent. * - * This enumeration provides information of LE Adapter Server status. + * @param[in] data Actual data received from the remote + * device. + * @param[in] dataLen Length of the data received from the + * remote device. */ -typedef enum -{ - CA_SERVER_NOTSTARTED = 0, - CA_LISTENING_SERVER, - CA_DISCOVERY_SERVER -} CALeServerStatus; +static void CALEDataReceiverHandlerSingleThread(const uint8_t *data, + uint32_t dataLen); /** - * Structure to maintain the status of the server. + * This function will be associated with the send for single threaded + * GattServer. + * + * This function will fragment the data to the MTU of the transport + * and send the data in fragments to the adapters. The function will + * be blocked until all data is sent out from the adapter. + * + * @param[in] data Data to be transmitted from LE. + * @param[in] dataLen Length of the Data being transmitted. */ -static CALeServerStatus gLeServerStatus = CA_SERVER_NOTSTARTED; +static CAResult_t CALEServerSendDataSingleThread(const uint8_t *data, + uint32_t dataLen); +#endif /** * Register network change notification callback. * - * @param[in] netCallback CANetworkChangeCallback callback which will - * be set for the change in network. + * @param[in] netCallback CAAdapterChangeCallback callback which will + * be set for the change in adapter. + * @param[in] connCallback CAConnectionChangeCallback callback which will + * be set for the change in connection. * * @return 0 on success otherwise a positive error value. * @retval ::CA_STATUS_OK Successful. @@ -183,7 +202,8 @@ static CALeServerStatus gLeServerStatus = CA_SERVER_NOTSTARTED; * @retval ::CA_STATUS_FAILED Operation failed. * */ -static CAResult_t CALERegisterNetworkNotifications(CANetworkChangeCallback netCallback); +static CAResult_t CALERegisterNetworkNotifications(CAAdapterChangeCallback netCallback, + CAConnectionChangeCallback connCallback); /** * Set the thread pool handle which is required for spawning new @@ -196,7 +216,7 @@ static CAResult_t CALERegisterNetworkNotifications(CANetworkChangeCallback netCa static void CASetLEAdapterThreadPoolHandle(ca_thread_pool_t handle); /** - * Call the callback to the upper layer when the device state gets + * Call the callback to the upper layer when the adapter state gets * changed. * * @param[in] adapter_state New state of the adapter to be notified to @@ -205,6 +225,16 @@ static void CASetLEAdapterThreadPoolHandle(ca_thread_pool_t handle); static void CALEDeviceStateChangedCb(CAAdapterState_t adapter_state); /** + * Call the callback to the upper layer when the device connection state gets + * changed. + * + * @param[in] address LE address of the device to be notified to the upper layer. + * @param[in] isConnected whether connection state is connected or not. + */ +static void CALEConnectionStateChangedCb(CATransportAdapter_t adapter, const char* address, + bool isConnected); + +/** * Used to initialize all required mutex variable for LE Adapter * implementation. * @@ -232,24 +262,29 @@ static void CALEErrorHandler(const char *remoteAddress, #ifndef SINGLE_THREAD /** - * Stop condition of recvhandler. + * Stop condition of Server recvhandler. */ -static bool g_dataReceiverHandlerState = false; +static bool g_dataBleServerReceiverHandlerState = false; /** - * Sender information. + * Stop condition of Client recvhandler. */ -static u_arraylist_t *g_senderInfo = NULL; +static bool g_dataBleClientReceiverHandlerState = false; /** - * Queue to process the outgoing packets from GATTClient. + * Sender information of Server. */ -static CAQueueingThread_t *g_bleClientSendQueueHandle = NULL; +static u_arraylist_t *g_bleServerSenderInfo = NULL; + +/** + * Sender information of Client. + */ +static u_arraylist_t *g_bleClientSenderInfo = NULL; /** - * Queue to process the incoming packets to GATT Client. + * Mutex to synchronize access to all senderInfos */ -static CAQueueingThread_t *g_bleReceiverQueue = NULL; +static oc_mutex g_senderInfoMutex = NULL; /** * Queue to process the outgoing packets from GATTServer. @@ -257,6 +292,21 @@ static CAQueueingThread_t *g_bleReceiverQueue = NULL; static CAQueueingThread_t *g_bleServerSendQueueHandle = NULL; /** + * Queue to process the outgoing packets from GATTClient. + */ +static CAQueueingThread_t *g_bleClientSendQueueHandle = NULL; + +/** + * Queue to process the incoming packets from GATTServer. + */ +static CAQueueingThread_t *g_bleServerReceiverQueue = NULL; + +/** + * Queue to process the incoming packets from GATTClient. + */ +static CAQueueingThread_t *g_bleClientReceiverQueue = NULL; + +/** * This function will be associated with the sender queue for * GattServer. * @@ -283,16 +333,39 @@ static void CALEServerSendDataThread(void *threadData); static void CALEClientSendDataThread(void *threadData); /** - * This function will be associated with the receiver queue. - * * This function will defragment the received data from each sender * respectively and will send it up to CA layer. Respective sender's * header will provide the length of the data sent. * + * @param[in] threadData Data pushed to the queue which contains the + * info about RemoteEndpoint and Data. + * @param[in] receiverType Whether receiver is server or client. + */ +static void CALEDataReceiverHandler(void *threadData, CABLEAdapter_t receiverType); + +/** + * This function will be associated with the receiver queue for + * GattServer. + * + * This function will call the function CALEDataReceiverHandler() + * with server type to defragment the received data. + * + * @param[in] threadData Data pushed to the queue which contains the + * info about RemoteEndpoint and Data. + */ +static void CALEServerDataReceiverHandler(void *threadData); + +/** + * This function will be associated with the receiver queue for + * GattClient. + * + * This function will call the function CALEDataReceiverHandler() + * with client type to defragment the received data. + * * @param[in] threadData Data pushed to the queue which contains the * info about RemoteEndpoint and Data. */ -static void CALEDataReceiverHandler(void *threadData); +static void CALEClientDataReceiverHandler(void *threadData); /** * This function will stop all queues created for GattServer and @@ -363,8 +436,22 @@ static CAResult_t CAInitLEClientSenderQueue(); /** * This function will initialize the Receiver queue for - * LEAdapter. This will initialize the queue to process the function - * CABLEDataReceiverHandler() when ever the task is added to this + * GattServer. This will initialize the queue to process the function + * CALEServerDataReceiverHandler() when ever the task is added to this + * queue. + * + * @return ::CA_STATUS_OK or Appropriate error code + * @retval ::CA_STATUS_OK Successful + * @retval ::CA_STATUS_INVALID_PARAM Invalid input arguments + * @retval ::CA_STATUS_FAILED Operation failed + * + */ +static CAResult_t CAInitLEServerReceiverQueue(); + +/** + * This function will initialize the Receiver queue for + * GattClient. This will initialize the queue to process the function + * CALEClientDataReceiverHandler() when ever the task is added to this * queue. * * @return ::CA_STATUS_OK or Appropriate error code @@ -373,7 +460,7 @@ static CAResult_t CAInitLEClientSenderQueue(); * @retval ::CA_STATUS_FAILED Operation failed * */ -static CAResult_t CAInitLEReceiverQueue(); +static CAResult_t CAInitLEClientReceiverQueue(); /** * This function will create the Data required to send it in the @@ -391,7 +478,8 @@ static CAResult_t CAInitLEReceiverQueue(); */ static CALEData_t *CACreateLEData(const CAEndpoint_t *remoteEndpoint, const uint8_t *data, - uint32_t dataLength); + uint32_t dataLength, + u_arraylist_t *senderInfo); /** * Used to free the BLE information stored in the sender/receiver @@ -406,119 +494,231 @@ static void CAFreeLEData(CALEData_t *bleData); */ static void CALEDataDestroyer(void *data, uint32_t size); -static CAResult_t CAInitLEServerQueues() -{ - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); +#ifndef SINGLE_THREAD +/** + * remove request or response data of send queue. + * + * @param[in] queueHandle queue to process the outgoing packets. + * @param[in] mutex mutex related to sender for client / server. + * @param[in] address target address to remove data in queue. + */ +static void CALERemoveSendQueueData(CAQueueingThread_t *queueHandle, + const char* address); + +/** + * remove all received data of data list from receive queue. + * + * @param[in] dataInfoList received data list to remove for client / server. + * @param[in] address target address to remove data in queue. + */ +static void CALERemoveReceiveQueueData(u_arraylist_t *dataInfoList, + const char* address); + +/** + * get received data info and positioned index from the received data list + * for client / server which is matched same leAddress and port. + * CABLESenderInfo_t is reference counted structure, you must call + * CALEFreeSenderInfo on senderInfo to release reference. + * + * @param[in] leAddress target address to get serderInfo. + * @param[in] port target port to get senderInfo. + * @param[in] senderInfoList received data list for client / server. + * @param[out] senderInfo Pointer to contain matched(leAddress and port) + * received data info. + * @param[out] senderIndex Pointer to contain matched(leAddress and port) + * received data info index. + */ +static CAResult_t CALEGetSenderInfo(const char *leAddress, + const uint16_t port, + u_arraylist_t *senderInfoList, + CABLESenderInfo_t **senderInfo, + uint32_t *senderIndex); + +/** + * Add sender info to list. + * + * @param[in] u_arraylist_t Array list to add sender info to. + * @param[in] senderInfo Sender info to be added to list. + * + * @return true on success, otherwise false. + */ +static bool CALEAddSenderInfoToList(u_arraylist_t *senderInfoList, + CABLESenderInfo_t *senderInfo); - ca_mutex_lock(g_bleAdapterThreadPoolMutex); +/** + * Remove desired sender info from list. + * + * @param[in] u_arraylist_t Array list to remove sender info from. + * @param[in] senderInfo Sender info to be removed from list. + * + */ +static void CALERemoveSenderInfoFromList(u_arraylist_t *senderInfoList, + CABLESenderInfo_t *senderInfo); + +/** + * Free sender info. CABLESenderInfo_t is reference counted structure + * and info will be freed only when reference count reaches 0 or negative. + * + * @param[in] senderInfo Sender info to be freed. + * + */ +static CAResult_t CALEFreeSenderInfo(CABLESenderInfo_t *senderInfo); + +/** + * get ports related to remote address. It is need because multi application + * can have more than 2 senderInfo using same BLE address. So before remove + * receive queue data, should get port list from sender Info. + * + * @param[in] leAddress target address to get port in serderInfo. + * @param[in] senderInfoList received data list to remove for client / server. + * @param[out] portList target port list related to leAddress. + */ +static CAResult_t CALEGetPortsFromSenderInfo(const char *leAddress, + u_arraylist_t *senderInfoList, + u_arraylist_t *portList); +#endif +static CAResult_t CAInitLEServerQueues() +{ CAResult_t result = CAInitLEServerSenderQueue(); if (CA_STATUS_OK != result) { OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitBleServerSenderQueue failed"); - ca_mutex_unlock(g_bleAdapterThreadPoolMutex); + return CA_STATUS_FAILED; } - result = CAInitLEReceiverQueue(); + g_bleServerSenderInfo = u_arraylist_create(); + if (!g_bleServerSenderInfo) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "memory allocation failed!"); + return CA_MEMORY_ALLOC_FAILED; + } + + result = CAInitLEServerReceiverQueue(); if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitBleServerReceiverQueue failed"); - ca_mutex_unlock(g_bleAdapterThreadPoolMutex); + OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitLEServerReceiverQueue failed"); + u_arraylist_free(&g_bleServerSenderInfo); return CA_STATUS_FAILED; } - g_dataReceiverHandlerState = true; - - ca_mutex_unlock(g_bleAdapterThreadPoolMutex); - - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + g_dataBleServerReceiverHandlerState = true; return CA_STATUS_OK; } static CAResult_t CAInitLEClientQueues() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); - - ca_mutex_lock(g_bleAdapterThreadPoolMutex); - CAResult_t result = CAInitLEClientSenderQueue(); if (CA_STATUS_OK != result) { OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitBleClientSenderQueue failed"); - ca_mutex_unlock(g_bleAdapterThreadPoolMutex); return CA_STATUS_FAILED; } - result = CAInitLEReceiverQueue(); + g_bleClientSenderInfo = u_arraylist_create(); + if (!g_bleClientSenderInfo) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "memory allocation failed!"); + return CA_MEMORY_ALLOC_FAILED; + } + + result = CAInitLEClientReceiverQueue(); if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitBleClientReceiverQueue failed"); - ca_mutex_unlock(g_bleAdapterThreadPoolMutex); + OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitLEClientReceiverQueue failed"); + u_arraylist_free(&g_bleClientSenderInfo); return CA_STATUS_FAILED; } - g_dataReceiverHandlerState = true; + g_dataBleClientReceiverHandlerState = true; - ca_mutex_unlock(g_bleAdapterThreadPoolMutex); - - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); return CA_STATUS_OK; } -static CAResult_t CAInitLEReceiverQueue() +static CAResult_t CAInitLEServerReceiverQueue() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); // Check if the message queue is already initialized - if (g_bleReceiverQueue) + if (g_bleServerReceiverQueue) { OIC_LOG(DEBUG, CALEADAPTER_TAG, "Already queue is initialized!"); return CA_STATUS_OK; } // Create recv message queue - g_bleReceiverQueue = (CAQueueingThread_t *) OICMalloc(sizeof(CAQueueingThread_t)); - if (!g_bleReceiverQueue) + g_bleServerReceiverQueue = (CAQueueingThread_t *) OICMalloc(sizeof(CAQueueingThread_t)); + if (!g_bleServerReceiverQueue) { OIC_LOG(ERROR, CALEADAPTER_TAG, "Memory allocation failed!"); return CA_MEMORY_ALLOC_FAILED; } - g_senderInfo = u_arraylist_create(); - if (!g_senderInfo) + if (CA_STATUS_OK != CAQueueingThreadInitialize(g_bleServerReceiverQueue, + g_bleAdapterThreadPool, + CALEServerDataReceiverHandler, + CALEDataDestroyer)) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Failed to Initialize server receiver queue thread"); + OICFree(g_bleServerReceiverQueue); + g_bleServerReceiverQueue = NULL; + return CA_STATUS_FAILED; + } + + if (CA_STATUS_OK != CAQueueingThreadStart(g_bleServerReceiverQueue)) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_thread_pool_add_task failed "); + OICFree(g_bleServerReceiverQueue); + g_bleServerReceiverQueue = NULL; + return CA_STATUS_FAILED; + } + + return CA_STATUS_OK; +} + +static CAResult_t CAInitLEClientReceiverQueue() +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + // Check if the message queue is already initialized + if (g_bleClientReceiverQueue) + { + OIC_LOG(DEBUG, CALEADAPTER_TAG, "Already queue is initialized!"); + return CA_STATUS_OK; + } + + // Create recv message queue + g_bleClientReceiverQueue = (CAQueueingThread_t *) OICMalloc(sizeof(CAQueueingThread_t)); + if (!g_bleClientReceiverQueue) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ClientInfo memory allcation failed!"); - OICFree(g_bleReceiverQueue); - g_bleReceiverQueue = NULL; + OIC_LOG(ERROR, CALEADAPTER_TAG, "Memory allocation failed!"); return CA_MEMORY_ALLOC_FAILED; } - if (CA_STATUS_OK != CAQueueingThreadInitialize(g_bleReceiverQueue, g_bleAdapterThreadPool, - CALEDataReceiverHandler, CALEDataDestroyer)) + if (CA_STATUS_OK != CAQueueingThreadInitialize(g_bleClientReceiverQueue, + g_bleAdapterThreadPool, + CALEClientDataReceiverHandler, + CALEDataDestroyer)) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Failed to Initialize send queue thread"); - OICFree(g_bleReceiverQueue); - g_bleReceiverQueue = NULL; - u_arraylist_free(&g_senderInfo); + OIC_LOG(ERROR, CALEADAPTER_TAG, "Failed to Initialize client receiver queue thread"); + OICFree(g_bleClientReceiverQueue); + g_bleClientReceiverQueue = NULL; return CA_STATUS_FAILED; } - if (CA_STATUS_OK != CAQueueingThreadStart(g_bleReceiverQueue)) + if (CA_STATUS_OK != CAQueueingThreadStart(g_bleClientReceiverQueue)) { OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_thread_pool_add_task failed "); - OICFree(g_bleReceiverQueue); - g_bleReceiverQueue = NULL; - u_arraylist_free(&g_senderInfo); + OICFree(g_bleClientReceiverQueue); + g_bleClientReceiverQueue = NULL; return CA_STATUS_FAILED; } - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); return CA_STATUS_OK; } static CAResult_t CAInitLEServerSenderQueue() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); // Check if the message queue is already initialized if (g_bleServerSendQueueHandle) { @@ -536,7 +736,8 @@ static CAResult_t CAInitLEServerSenderQueue() if (CA_STATUS_OK != CAQueueingThreadInitialize(g_bleServerSendQueueHandle, g_bleAdapterThreadPool, - CALEServerSendDataThread, CALEDataDestroyer)) + CALEServerSendDataThread, + CALEDataDestroyer)) { OIC_LOG(ERROR, CALEADAPTER_TAG, "Failed to Initialize send queue thread"); OICFree(g_bleServerSendQueueHandle); @@ -544,43 +745,37 @@ static CAResult_t CAInitLEServerSenderQueue() return CA_STATUS_FAILED; } - if (CA_STATUS_OK != CAQueueingThreadStart(g_bleServerSendQueueHandle)) - { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_thread_pool_add_task failed "); - OICFree(g_bleServerSendQueueHandle); - g_bleServerSendQueueHandle = NULL; - return CA_STATUS_FAILED; - } - - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); return CA_STATUS_OK; } -static void CALEClearSenderInfo() +static void CALEClearSenderInfoImpl(u_arraylist_t **list) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); - - uint32_t listIndex = 0; - uint32_t listLength = u_arraylist_length(g_senderInfo); - for (listIndex = 0; listIndex < listLength; listIndex++) - { - CABLESenderInfo_t *info = (CABLESenderInfo_t *) u_arraylist_get(g_senderInfo, listIndex); - if(!info) - { - continue; - } + oc_mutex_lock(g_senderInfoMutex); + const size_t length = u_arraylist_length(*list); + for (size_t i = 0; i < length; ++i) + { + CABLESenderInfo_t * const info = + (CABLESenderInfo_t *) u_arraylist_get(*list, i); + if (info) + { + OICFree(info->defragData); + CAFreeEndpoint(info->remoteEndpoint); + OICFree(info); + } + } + u_arraylist_free(list); + oc_mutex_unlock(g_senderInfoMutex); +} - OICFree(info->defragData); - CAFreeEndpoint(info->remoteEndpoint); - OICFree(info); - } - u_arraylist_free(&g_senderInfo); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); +static void CALEClearSenderInfo() +{ + CALEClearSenderInfoImpl(&g_bleServerSenderInfo); + CALEClearSenderInfoImpl(&g_bleClientSenderInfo); } static CAResult_t CAInitLEClientSenderQueue() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); if (g_bleClientSendQueueHandle) { @@ -605,51 +800,32 @@ static CAResult_t CAInitLEClientSenderQueue() g_bleClientSendQueueHandle = NULL; return CA_STATUS_FAILED; } - - if (CA_STATUS_OK != CAQueueingThreadStart(g_bleClientSendQueueHandle)) - { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_thread_pool_add_task failed "); - OICFree(g_bleClientSendQueueHandle); - g_bleClientSendQueueHandle = NULL; - return CA_STATUS_FAILED; - } - - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); return CA_STATUS_OK; } static void CAStopLEQueues() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); - - ca_mutex_lock(g_bleClientSendDataMutex); - if (NULL != g_bleClientSendQueueHandle) - { - CAQueueingThreadStop(g_bleClientSendQueueHandle); - } - ca_mutex_unlock(g_bleClientSendDataMutex); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); - ca_mutex_lock(g_bleServerSendDataMutex); - if (NULL != g_bleServerSendQueueHandle) + oc_mutex_lock(g_bleServerReceiveDataMutex); + if (NULL != g_bleServerReceiverQueue) { - CAQueueingThreadStop(g_bleServerSendQueueHandle); + CAQueueingThreadStop(g_bleServerReceiverQueue); } - ca_mutex_unlock(g_bleServerSendDataMutex); + oc_mutex_unlock(g_bleServerReceiveDataMutex); - ca_mutex_lock(g_bleReceiveDataMutex); - if (NULL != g_bleReceiverQueue) + oc_mutex_lock(g_bleClientReceiveDataMutex); + if (NULL != g_bleClientReceiverQueue) { - CAQueueingThreadStop(g_bleReceiverQueue); + CAQueueingThreadStop(g_bleClientReceiverQueue); } - ca_mutex_unlock(g_bleReceiveDataMutex); + oc_mutex_unlock(g_bleClientReceiveDataMutex); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); } static void CATerminateLEQueues() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); - CAQueueingThreadDestroy(g_bleClientSendQueueHandle); OICFree(g_bleClientSendQueueHandle); g_bleClientSendQueueHandle = NULL; @@ -658,16 +834,20 @@ static void CATerminateLEQueues() OICFree(g_bleServerSendQueueHandle); g_bleServerSendQueueHandle = NULL; - CAQueueingThreadDestroy(g_bleReceiverQueue); - OICFree(g_bleReceiverQueue); - g_bleReceiverQueue = NULL; + CAQueueingThreadDestroy(g_bleServerReceiverQueue); + OICFree(g_bleServerReceiverQueue); + g_bleServerReceiverQueue = NULL; - CALEClearSenderInfo(); + CAQueueingThreadDestroy(g_bleClientReceiverQueue); + OICFree(g_bleClientReceiverQueue); + g_bleClientReceiverQueue = NULL; - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + CALEClearSenderInfo(); } static CAResult_t CALEGetSenderInfo(const char *leAddress, + const uint16_t port, + u_arraylist_t *senderInfoList, CABLESenderInfo_t **senderInfo, uint32_t *senderIndex) { @@ -680,242 +860,519 @@ static CAResult_t CALEGetSenderInfo(const char *leAddress, "NULL index argument", CA_STATUS_INVALID_PARAM); - const uint32_t listLength = u_arraylist_length(g_senderInfo); + oc_mutex_lock(g_senderInfoMutex); + const uint32_t listLength = u_arraylist_length(senderInfoList); const uint32_t addrLength = strlen(leAddress); for (uint32_t index = 0; index < listLength; index++) { - CABLESenderInfo_t *info = (CABLESenderInfo_t *) u_arraylist_get(g_senderInfo, index); - if(!info || !(info->remoteEndpoint)) + CABLESenderInfo_t *info = (CABLESenderInfo_t *) u_arraylist_get(senderInfoList, index); + if (!info || !(info->remoteEndpoint)) { continue; } - if(!strncmp(info->remoteEndpoint->addr, leAddress, addrLength)) + if (!strncmp(info->remoteEndpoint->addr, leAddress, addrLength) + && info->remoteEndpoint->port == port) { *senderIndex = index; - if(senderInfo) + if (senderInfo) { *senderInfo = info; + (*senderInfo)->refCount++; } + oc_mutex_unlock(g_senderInfoMutex); return CA_STATUS_OK; } } + oc_mutex_unlock(g_senderInfoMutex); return CA_STATUS_FAILED; } -static void CALEDataReceiverHandler(void *threadData) +static bool CALEAddSenderInfoToList(u_arraylist_t *senderInfoList, CABLESenderInfo_t *senderInfo) +{ + oc_mutex_lock(g_senderInfoMutex); + senderInfo->refCount++; + if (!u_arraylist_add(senderInfoList,(void *)senderInfo)) + { + senderInfo->refCount--; + oc_mutex_unlock(g_senderInfoMutex); + return false; + } + oc_mutex_unlock(g_senderInfoMutex); + return true; +} + +static void CALERemoveSenderInfoFromList(u_arraylist_t *senderInfoList, CABLESenderInfo_t *senderInfo) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + oc_mutex_lock(g_senderInfoMutex); + uint32_t idx; + bool elemFound = u_arraylist_get_index(senderInfoList, (const void*)senderInfo, &idx); + if(elemFound) + { + void *info = u_arraylist_remove(senderInfoList, idx); + if (info != NULL) + { + senderInfo->refCount--; + } + } + oc_mutex_unlock(g_senderInfoMutex); +} - ca_mutex_lock(g_bleReceiveDataMutex); +static CAResult_t CALEFreeSenderInfo(CABLESenderInfo_t *senderInfo) +{ + VERIFY_NON_NULL_RET(senderInfo, + CALEADAPTER_TAG, + "NULL senderInfo to remove argument", + CA_STATUS_INVALID_PARAM); - if (g_dataReceiverHandlerState) + oc_mutex_lock(g_senderInfoMutex); + senderInfo->refCount--; + if(senderInfo->refCount <= 0) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "checking for DE Fragmentation"); + OICFree(senderInfo->defragData); + OICFree(senderInfo->remoteEndpoint); + OICFree(senderInfo); + } + oc_mutex_unlock(g_senderInfoMutex); + return CA_STATUS_OK; +} + +static void CALEDataReceiverHandler(void *threadData, CABLEAdapter_t receiverType) +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + + oc_mutex bleReceiveDataMutex = NULL; + bool dataBleReceiverHandlerState = false; + + switch (receiverType) + { + case ADAPTER_CLIENT: + bleReceiveDataMutex = g_bleClientReceiveDataMutex; + dataBleReceiverHandlerState = g_dataBleClientReceiverHandlerState; + break; + case ADAPTER_SERVER: + bleReceiveDataMutex = g_bleServerReceiveDataMutex; + dataBleReceiverHandlerState = g_dataBleServerReceiverHandlerState; + break; + default: + OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Unsupported receiver type : %d", receiverType); + return; + } + oc_mutex_lock(bleReceiveDataMutex); + + if (dataBleReceiverHandlerState) + { CALEData_t *bleData = (CALEData_t *) threadData; if (!bleData) { OIC_LOG(DEBUG, CALEADAPTER_TAG, "Invalid bleData!"); - ca_mutex_unlock(g_bleReceiveDataMutex); + oc_mutex_unlock(bleReceiveDataMutex); + return; + } + + if (!(bleData->senderInfo)) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "sender info is not available"); + oc_mutex_unlock(bleReceiveDataMutex); return; } - if(!(bleData->remoteEndpoint)) + if (!(bleData->remoteEndpoint)) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Client RemoteEndPoint NULL!!"); - ca_mutex_unlock(g_bleReceiveDataMutex); + OIC_LOG(ERROR, CALEADAPTER_TAG, "RemoteEndPoint NULL!!"); + oc_mutex_unlock(bleReceiveDataMutex); return; } CABLESenderInfo_t *senderInfo = NULL; uint32_t senderIndex = 0; - if(CA_STATUS_OK != CALEGetSenderInfo(bleData->remoteEndpoint->addr, - &senderInfo, &senderIndex)) + //packet parsing + CABLEPacketStart_t startFlag = CA_BLE_PACKET_NOT_START; + CABLEPacketSecure_t secureFlag = CA_BLE_PACKET_NON_SECURE; + uint16_t sourcePort = 0; + uint16_t destPort = 0; + + CAParseHeader(bleData->data, &startFlag, &sourcePort, &secureFlag, &destPort); + OIC_LOG_V(INFO, CALEADAPTER_TAG, + "header info: startFlag[%X] sourcePort[%d] secureFlag[%X] destPort[%d]", + startFlag, sourcePort, secureFlag, destPort); + + if (destPort != g_localBLESourcePort && destPort != CA_BLE_MULTICAST_PORT) { - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "This is a new client [%s]", - bleData->remoteEndpoint->addr); + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "this packet is not valid for this app(port mismatch[mine:%d, packet:%d])", + g_localBLESourcePort, destPort); + oc_mutex_unlock(bleReceiveDataMutex); + return; } - if(!senderInfo) + bleData->remoteEndpoint->port = sourcePort; + + if (CA_STATUS_OK != CALEGetSenderInfo(bleData->remoteEndpoint->addr, + bleData->remoteEndpoint->port, + bleData->senderInfo, + &senderInfo, &senderIndex)) + { + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "This is a new client [%s:%X]", + bleData->remoteEndpoint->addr, bleData->remoteEndpoint->port); + } + else { - CABLESenderInfo_t *newSender = OICMalloc(sizeof(CABLESenderInfo_t)); - if(!newSender) + if (startFlag) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Memory allocation failed for new sender"); - ca_mutex_unlock(g_bleReceiveDataMutex); - return; + OIC_LOG(ERROR, CALEADAPTER_TAG, + "This packet is start packet but exist senderInfo. Remove senderInfo"); + CALERemoveSenderInfoFromList(bleData->senderInfo, senderInfo); + CALEFreeSenderInfo(senderInfo); + senderInfo = NULL; + senderIndex = 0; } - newSender->recvDataLen = 0; - newSender->totalDataLen = 0; - newSender->defragData = NULL; - newSender->remoteEndpoint = NULL; + } - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Parsing the header"); - newSender->totalDataLen = CAParseHeader(bleData->data, - bleData->dataLen); - if(!(newSender->totalDataLen)) + if (!senderInfo) + { + uint32_t totalLength = 0; + if (startFlag) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Total Data Length is parsed as 0!!!"); - OICFree(newSender); - ca_mutex_unlock(g_bleReceiveDataMutex); + CAParseHeaderPayloadLength(bleData->data, CA_BLE_LENGTH_HEADER_SIZE, &totalLength); + } + else + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "This packet is wrong packet! ignore."); + oc_mutex_unlock(bleReceiveDataMutex); return; } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Total data to be accumulated [%u] bytes", - newSender->totalDataLen); - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "data received in the first packet [%u] bytes", - bleData->dataLen); - - newSender->defragData = OICCalloc(newSender->totalDataLen + 1, + CABLESenderInfo_t *newSender = OICCalloc(1, sizeof(CABLESenderInfo_t)); + if (!newSender) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Memory allocation failed for new sender"); + oc_mutex_unlock(bleReceiveDataMutex); + return; + } + + OIC_LOG(DEBUG, CALEADAPTER_TAG, "Parsing the header"); + + newSender->totalDataLen = totalLength; + if (!(newSender->totalDataLen)) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Total Data Length is parsed as 0!!!"); + CALEFreeSenderInfo(newSender); + oc_mutex_unlock(bleReceiveDataMutex); + return; + } + + size_t dataOnlyLen = + bleData->dataLen - (CA_BLE_HEADER_SIZE + CA_BLE_LENGTH_HEADER_SIZE); + OIC_LOG_V(INFO, CALEADAPTER_TAG, "Total data to be accumulated [%u] bytes", + newSender->totalDataLen); + OIC_LOG_V(INFO, CALEADAPTER_TAG, "data received in the first packet [%zu] bytes", + dataOnlyLen); + + newSender->defragData = OICCalloc(newSender->totalDataLen + 1, sizeof(*newSender->defragData)); if (NULL == newSender->defragData) { OIC_LOG(ERROR, CALEADAPTER_TAG, "defragData is NULL!"); - OICFree(newSender); - ca_mutex_unlock(g_bleReceiveDataMutex); + CALEFreeSenderInfo(newSender); + oc_mutex_unlock(bleReceiveDataMutex); return; } + CATransportFlags_t flags = CA_DEFAULT_FLAGS; +#ifdef __WITH_DTLS__ + if (CA_BLE_PACKET_SECURE == secureFlag) + { + flags |= CA_SECURE; + } +#endif const char *remoteAddress = bleData->remoteEndpoint->addr; - newSender->remoteEndpoint = CACreateEndpointObject(CA_DEFAULT_FLAGS, - CA_ADAPTER_GATT_BTLE, remoteAddress, 0); + newSender->remoteEndpoint = CACreateEndpointObject(flags, + CA_ADAPTER_GATT_BTLE, + remoteAddress, + bleData->remoteEndpoint->port); + if (NULL == newSender->remoteEndpoint) { OIC_LOG(ERROR, CALEADAPTER_TAG, "remoteEndpoint is NULL!"); - OICFree(newSender->defragData); - OICFree(newSender); - ca_mutex_unlock(g_bleReceiveDataMutex); + CALEFreeSenderInfo(newSender); + oc_mutex_unlock(bleReceiveDataMutex); + return; + } + + if (newSender->recvDataLen + dataOnlyLen > newSender->totalDataLen) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "buffer is smaller than received data"); + CALEFreeSenderInfo(newSender); + oc_mutex_unlock(bleReceiveDataMutex); return; } - memcpy(newSender->defragData, bleData->data + CA_HEADER_LENGTH, - bleData->dataLen - CA_HEADER_LENGTH); - newSender->recvDataLen += bleData->dataLen - CA_HEADER_LENGTH; - u_arraylist_add(g_senderInfo,(void *)newSender); - - //Getting newSender index position in g_senderInfo array list - if(CA_STATUS_OK != - CALEGetSenderInfo(newSender->remoteEndpoint->addr, NULL, &senderIndex)) + memcpy(newSender->defragData, + bleData->data + (CA_BLE_HEADER_SIZE + CA_BLE_LENGTH_HEADER_SIZE), + dataOnlyLen); + newSender->recvDataLen += dataOnlyLen; + + newSender->refCount = 1; + + if (!CALEAddSenderInfoToList(bleData->senderInfo, newSender)) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Existing sender index not found!!"); - OICFree(newSender->defragData); - CAFreeEndpoint(newSender->remoteEndpoint); - OICFree(newSender); - ca_mutex_unlock(g_bleReceiveDataMutex); + OIC_LOG(ERROR, CALEADAPTER_TAG, "Failed to add sender info!"); + CALEFreeSenderInfo(newSender); + oc_mutex_unlock(bleReceiveDataMutex); return; } + senderInfo = newSender; } else { - if(senderInfo->recvDataLen + bleData->dataLen > senderInfo->totalDataLen) + size_t dataOnlyLen = bleData->dataLen - CA_BLE_HEADER_SIZE; + if (senderInfo->recvDataLen + dataOnlyLen > senderInfo->totalDataLen) { OIC_LOG_V(ERROR, CALEADAPTER_TAG, - "Data Length exceeding error!! Receiving [%d] total length [%d]", - senderInfo->recvDataLen + bleData->dataLen, senderInfo->totalDataLen); - u_arraylist_remove(g_senderInfo, senderIndex); - OICFree(senderInfo->defragData); - OICFree(senderInfo); - ca_mutex_unlock(g_bleReceiveDataMutex); + "Data Length exceeding error!! Receiving [%zu] total length [%u]", + senderInfo->recvDataLen + dataOnlyLen, senderInfo->totalDataLen); + CALERemoveSenderInfoFromList(bleData->senderInfo, senderInfo); + CALEFreeSenderInfo(senderInfo); + oc_mutex_unlock(bleReceiveDataMutex); return; } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Copying the data of length [%d]", bleData->dataLen); - memcpy(senderInfo->defragData + senderInfo->recvDataLen, bleData->data, - bleData->dataLen); - senderInfo->recvDataLen += bleData->dataLen ; - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "totalDatalength [%d] recveived Datalen [%d]", - senderInfo->totalDataLen, senderInfo->recvDataLen); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Copying the data of length [%zu]", + dataOnlyLen); + memcpy(senderInfo->defragData + senderInfo->recvDataLen, + bleData->data + CA_BLE_HEADER_SIZE, + dataOnlyLen); + senderInfo->recvDataLen += dataOnlyLen; + OIC_LOG_V(INFO, CALEADAPTER_TAG, "totalDatalength [%d] received Datalen [%d]", + senderInfo->totalDataLen, senderInfo->recvDataLen); } if (senderInfo->totalDataLen == senderInfo->recvDataLen) { - ca_mutex_lock(g_bleAdapterReqRespCbMutex); if (NULL == g_networkPacketReceivedCallback) { OIC_LOG(ERROR, CALEADAPTER_TAG, "gReqRespCallback is NULL!"); + CALERemoveSenderInfoFromList(bleData->senderInfo, senderInfo); + CALEFreeSenderInfo(senderInfo); + oc_mutex_unlock(bleReceiveDataMutex); + return; + } - u_arraylist_remove(g_senderInfo, senderIndex); + OIC_LOG(DEBUG, CALEADAPTER_TAG, "[CALEDataReceiverHandler] Received data up !"); + + const CASecureEndpoint_t tmp = + { + .endpoint = *senderInfo->remoteEndpoint + }; + + OIC_LOG_V(INFO, CALEADAPTER_TAG, "endpoint flags : %d", tmp.endpoint.flags); +#ifdef __WITH_DTLS__ + if (CA_SECURE & tmp.endpoint.flags) + { + OIC_LOG(DEBUG, CALEADAPTER_TAG, "Secure data received"); + switch (receiverType) + { + case ADAPTER_CLIENT: + g_dataType = CA_REQUEST_DATA; + break; + case ADAPTER_SERVER: + g_dataType = CA_RESPONSE_DATA; + break; + default: + OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Unsupported rcvr type:%d",receiverType); + CALERemoveSenderInfoFromList(bleData->senderInfo, senderInfo); + senderInfo->remoteEndpoint = NULL; + senderInfo->defragData = NULL; + CALEFreeSenderInfo(senderInfo); + oc_mutex_unlock(bleReceiveDataMutex); + return; + } + + if (CA_STATUS_FAILED == CAdecryptSsl(&tmp, + senderInfo->defragData, + senderInfo->recvDataLen)) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "CAdecryptSsl failed"); + } + else + { + OIC_LOG(DEBUG, CALEADAPTER_TAG, "CAdecryptSsl successed"); + } OICFree(senderInfo->defragData); - OICFree(senderInfo); - ca_mutex_unlock(g_bleAdapterReqRespCbMutex); - ca_mutex_unlock(g_bleReceiveDataMutex); - return; } - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Sending data up !"); - g_networkPacketReceivedCallback(senderInfo->remoteEndpoint, - senderInfo->defragData, senderInfo->recvDataLen); - ca_mutex_unlock(g_bleAdapterReqRespCbMutex); - u_arraylist_remove(g_senderInfo, senderIndex); + else + { +#endif + OIC_LOG(INFO, CALEADAPTER_TAG, "Non-Secure data received"); + g_networkPacketReceivedCallback(&tmp, + senderInfo->defragData, + senderInfo->recvDataLen); +#ifdef __WITH_DTLS__ + } +#endif + + CALERemoveSenderInfoFromList(bleData->senderInfo, senderInfo); senderInfo->remoteEndpoint = NULL; senderInfo->defragData = NULL; - OICFree(senderInfo); + CALEFreeSenderInfo(senderInfo); + oc_mutex_unlock(bleReceiveDataMutex); + return; } + CALEFreeSenderInfo(senderInfo); } - ca_mutex_unlock(g_bleReceiveDataMutex); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + oc_mutex_unlock(bleReceiveDataMutex); +} + + +static void CALEServerDataReceiverHandler(void *threadData) +{ + CALEDataReceiverHandler(threadData, ADAPTER_SERVER); +} + +static void CALEClientDataReceiverHandler(void *threadData) +{ + CALEDataReceiverHandler(threadData, ADAPTER_CLIENT); } static void CALEServerSendDataThread(void *threadData) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); CALEData_t * const bleData = (CALEData_t *) threadData; if (!bleData) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Invalid bledata!"); + OIC_LOG(ERROR, CALEADAPTER_TAG, "Invalid bledata!"); + return; + } + + if (!bleData->remoteEndpoint) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Invalid endpoint of bledata!"); return; } - uint8_t * const header = OICCalloc(CA_HEADER_LENGTH, 1); - VERIFY_NON_NULL_VOID(header, CALEADAPTER_TAG, "Malloc failed"); +#if defined(__TIZEN__) || defined(__ANDROID__) + // get MTU size + g_mtuSize = CALEServerGetMtuSize(bleData->remoteEndpoint->addr); +#endif + OIC_LOG_V(INFO, CALEADAPTER_TAG, "MTU size [%d]", g_mtuSize); + + uint32_t midPacketCount = 0; + size_t remainingLen = 0; + size_t totalLength = 0; + CABLEPacketSecure_t secureFlag = CA_BLE_PACKET_NON_SECURE; - const uint32_t totalLength = bleData->dataLen + CA_HEADER_LENGTH; + CAResult_t result = CAGenerateVariableForFragmentation(bleData->dataLen, + &midPacketCount, + &remainingLen, + &totalLength, + g_mtuSize); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateVariableForFragmentation failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; + } + + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, + "Packet info: data size[%d] midPacketCount[%u] remainingLen[%zu] totalLength[%zu]", + bleData->dataLen, midPacketCount, remainingLen, totalLength); OIC_LOG_V(DEBUG, CALEADAPTER_TAG, - "Server total Data length with header is [%u]", + "Server total Data length with header is [%zu]", totalLength); - uint8_t * const dataSegment = OICCalloc(totalLength, 1); + uint8_t dataSegment[CA_SUPPORTED_BLE_MTU_SIZE] = {0}; + uint8_t dataHeader[CA_BLE_HEADER_SIZE] = {0}; - if (NULL == dataSegment) + if (NULL != bleData->remoteEndpoint) //Unicast Data { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Malloc failed"); - OICFree(header); - return; + secureFlag = (bleData->remoteEndpoint->flags & CA_SECURE) ? + CA_BLE_PACKET_SECURE : CA_BLE_PACKET_NON_SECURE; + + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "This Packet is secure? %d", secureFlag); + result = CAGenerateHeader(dataHeader, + CA_BLE_PACKET_START, + g_localBLESourcePort, + secureFlag, + bleData->remoteEndpoint->port); + } + else //Multicast Data + { + result = CAGenerateHeader(dataHeader, + CA_BLE_PACKET_START, + g_localBLESourcePort, + secureFlag, + CA_BLE_MULTICAST_PORT); } + OIC_LOG_V(INFO, CALEADAPTER_TAG, "header info: secureFlag[%X]", secureFlag); - CAResult_t result = CAGenerateHeader(header, - CA_HEADER_LENGTH, - bleData->dataLen); - if (CA_STATUS_OK != result ) + if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Generate header failed"); - OICFree(header); - OICFree(dataSegment); + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateHeader failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } return; } - memcpy(dataSegment, header, CA_HEADER_LENGTH); - OICFree(header); + uint8_t lengthHeader[CA_BLE_LENGTH_HEADER_SIZE] = {0}; + result = CAGenerateHeaderPayloadLength(lengthHeader, + CA_BLE_LENGTH_HEADER_SIZE, + bleData->dataLen); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateHeaderPayloadLength failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; + } uint32_t length = 0; - if (CA_SUPPORTED_BLE_MTU_SIZE > totalLength) + uint32_t dataLen = 0; + if (g_mtuSize > totalLength) { - length = totalLength; - memcpy(dataSegment + CA_HEADER_LENGTH, bleData->data, bleData->dataLen); + length = (uint32_t)totalLength; + dataLen = bleData->dataLen; } else { - length = CA_SUPPORTED_BLE_MTU_SIZE; - memcpy(dataSegment + CA_HEADER_LENGTH, bleData->data, - CA_SUPPORTED_BLE_MTU_SIZE - CA_HEADER_LENGTH); + length = g_mtuSize; + dataLen = g_mtuSize - CA_BLE_HEADER_SIZE - CA_BLE_LENGTH_HEADER_SIZE; + } + + result = CAMakeFirstDataSegment(dataSegment, + bleData->data, dataLen, + dataHeader, lengthHeader); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Making data segment failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; } - uint32_t iter = totalLength / CA_SUPPORTED_BLE_MTU_SIZE; + const uint32_t iter = midPacketCount; uint32_t index = 0; // Send the first segment with the header. @@ -932,180 +1389,293 @@ static void CALEServerSendDataThread(void *threadData) CALEADAPTER_TAG, "Update characteristics failed, result [%d]", result); - - g_errorHandler(bleData->remoteEndpoint, - bleData->data, - bleData->dataLen, - result); - OICFree(dataSegment); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, + bleData->data, + bleData->dataLen, + result); + } return; } OIC_LOG_V(DEBUG, CALEADAPTER_TAG, - "Server Sent data length [%u]", + "Server Sent Unicast First Data - data length [%u]", length); - for (index = 1; index < iter; index++) + + result = CAGenerateHeader(dataHeader, + CA_BLE_PACKET_NOT_START, + g_localBLESourcePort, + secureFlag, + bleData->remoteEndpoint->port); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateHeader failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; + } + + for (index = 0; index < iter; index++) { // Send the remaining header. - OIC_LOG_V(DEBUG, - CALEADAPTER_TAG, - "Sending the chunk number [%u]", - index); + result = CAMakeRemainDataSegment(dataSegment, + g_mtuSize - CA_BLE_HEADER_SIZE, + bleData->data, + bleData->dataLen, + index, + dataHeader, + g_mtuSize); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Making data segment failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; + } result = CAUpdateCharacteristicsToGattClient( bleData->remoteEndpoint->addr, - bleData->data + ((index * CA_SUPPORTED_BLE_MTU_SIZE) - CA_HEADER_LENGTH), - CA_SUPPORTED_BLE_MTU_SIZE); + dataSegment, + g_mtuSize); + if (CA_STATUS_OK != result) { OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Update characteristics failed, result [%d]", result); - g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); - OICFree(dataSegment); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } return; } OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Server Sent data length [%d]", - CA_SUPPORTED_BLE_MTU_SIZE); + g_mtuSize); } - const uint32_t remainingLen = - totalLength % CA_SUPPORTED_BLE_MTU_SIZE; - - if (remainingLen && (totalLength > CA_SUPPORTED_BLE_MTU_SIZE)) + if (remainingLen && (totalLength > g_mtuSize)) { // send the last segment of the data (Ex: 22 bytes of 622 // bytes of data when MTU is 200) - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Sending the last chunk"); + result = CAMakeRemainDataSegment(dataSegment, + remainingLen, + bleData->data, + bleData->dataLen, + index, + dataHeader, + g_mtuSize); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Making data segment failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; + } + result = CAUpdateCharacteristicsToGattClient( bleData->remoteEndpoint->addr, - bleData->data + (index * CA_SUPPORTED_BLE_MTU_SIZE) - CA_HEADER_LENGTH, - remainingLen); + dataSegment, + remainingLen + CA_BLE_HEADER_SIZE); + if (CA_STATUS_OK != result) { OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Update characteristics failed, result [%d]", result); - g_errorHandler(bleData->remoteEndpoint, - bleData->data, - bleData->dataLen, - result); - OICFree(dataSegment); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, + bleData->data, + bleData->dataLen, + result); + } return; } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Server Sent data length [%d]", remainingLen); + OIC_LOG_V(DEBUG, + CALEADAPTER_TAG, + "Server Sent Unicast Last Data - data length [%zu]", + remainingLen + CA_BLE_HEADER_SIZE); } } else { OIC_LOG(DEBUG, CALEADAPTER_TAG, "Server Sending Multicast data"); - result = CAUpdateCharacteristicsToAllGattClients(dataSegment, length); - if (CA_STATUS_OK != result) - { - OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Update characteristics failed, result [%d]", - result); - CALEErrorHandler(NULL, bleData->data, bleData->dataLen, result); - OICFree(dataSegment); - return; - } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Server Sent data length [%d]", length); - for (index = 1; index < iter; index++) + OIC_LOG(DEBUG, CALEADAPTER_TAG, "BLE Multicast is not supported"); + } + + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); +} + +static void CALEClientSendDataThread(void *threadData) +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); + + CALEData_t *bleData = (CALEData_t *) threadData; + if (!bleData) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Invalid bledata!"); + return; + } + + if (!bleData->remoteEndpoint) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Invalid endpoint of bledata!"); + return; + } + +#if defined(__ANDROID__) + // get MTU size + if (false == CALEClientIsConnected(bleData->remoteEndpoint->addr)) + { + // triggering to gatt connect and MTU negotiation + CAResult_t res = CALEClientSendNegotiationMessage( + bleData->remoteEndpoint->addr); + + if (CA_STATUS_OK != res) { - // Send the remaining header. - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Sending the chunk number [%d]", index); - result = CAUpdateCharacteristicsToAllGattClients( - bleData->data + ((index * CA_SUPPORTED_BLE_MTU_SIZE) - CA_HEADER_LENGTH), - CA_SUPPORTED_BLE_MTU_SIZE); - if (CA_STATUS_OK != result) + OIC_LOG_V(ERROR, + CALEADAPTER_TAG, + "CALEClientSendNegotiationMessage has failed, result [%d]", + res); + if (g_errorHandler) { - OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Update characteristics failed, result [%d]", - result); - CALEErrorHandler(NULL, bleData->data, bleData->dataLen, result); - OICFree(dataSegment); - return; + g_errorHandler(bleData->remoteEndpoint, + bleData->data, + bleData->dataLen, + res); } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Server Sent data length [%u]", CA_SUPPORTED_BLE_MTU_SIZE); + return; } + } +#endif +#if defined(__TIZEN__) || defined(__ANDROID__) + g_mtuSize = CALEClientGetMtuSize(bleData->remoteEndpoint->addr); +#endif + OIC_LOG_V(INFO, CALEADAPTER_TAG, "MTU size [%d]", g_mtuSize); + + uint32_t midPacketCount = 0; + size_t remainingLen = 0; + size_t totalLength = 0; + CABLEPacketSecure_t secureFlag = CA_BLE_PACKET_NON_SECURE; + + CAResult_t result = CAGenerateVariableForFragmentation(bleData->dataLen, + &midPacketCount, + &remainingLen, + &totalLength, + g_mtuSize); - const uint32_t remainingLen = totalLength % CA_SUPPORTED_BLE_MTU_SIZE; - if (remainingLen && (totalLength > CA_SUPPORTED_BLE_MTU_SIZE)) + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateVariableForFragmentation failed, result [%d]", result); + if (g_errorHandler) { - // send the last segment of the data (Ex: 22 bytes of 622 bytes of data when MTU is 200) - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Sending the last chunk"); - result = CAUpdateCharacteristicsToAllGattClients( - bleData->data + (index * CA_SUPPORTED_BLE_MTU_SIZE) - CA_HEADER_LENGTH, - remainingLen); - if (CA_STATUS_OK != result) - { - OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Update characteristics failed, result [%d]", - result); - CALEErrorHandler(NULL, bleData->data, bleData->dataLen, result); - OICFree(dataSegment); - return; - } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Server Sent data length [%d]", remainingLen); + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); } + return; } - OICFree(dataSegment); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); -} + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, + "Packet info: data size[%d] midPacketCount[%u] remainingLen[%zu] totalLength[%zu]", + bleData->dataLen, midPacketCount, remainingLen, totalLength); -static void CALEClientSendDataThread(void *threadData) -{ - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + uint8_t dataSegment[CA_SUPPORTED_BLE_MTU_SIZE] = {0}; + uint8_t dataHeader[CA_BLE_HEADER_SIZE] = {0}; - CALEData_t *bleData = (CALEData_t *) threadData; - if (!bleData) + if (NULL != bleData->remoteEndpoint) //Unicast Data { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Invalid bledata!"); - return; + secureFlag = (bleData->remoteEndpoint->flags & CA_SECURE) ? + CA_BLE_PACKET_SECURE : CA_BLE_PACKET_NON_SECURE; + + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "This Packet is secure? %d", secureFlag); + result = CAGenerateHeader(dataHeader, + CA_BLE_PACKET_START, + g_localBLESourcePort, + secureFlag, + bleData->remoteEndpoint->port); + } + else //Multicast Data + { + result = CAGenerateHeader(dataHeader, + CA_BLE_PACKET_START, + g_localBLESourcePort, + secureFlag, + CA_BLE_MULTICAST_PORT); } - uint8_t * const header = OICCalloc(CA_HEADER_LENGTH, 1); - VERIFY_NON_NULL_VOID(header, CALEADAPTER_TAG, "Malloc failed"); + OIC_LOG_V(INFO, CALEADAPTER_TAG, "header info: secureFlag[%X]", secureFlag); - const uint32_t totalLength = bleData->dataLen + CA_HEADER_LENGTH; - uint8_t *dataSegment = OICCalloc(totalLength, 1); - if (NULL == dataSegment) + if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Malloc failed"); - OICFree(header); + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateHeader failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } return; } - CAResult_t result = CAGenerateHeader(header, - CA_HEADER_LENGTH, - bleData->dataLen); - if (CA_STATUS_OK != result ) + uint8_t lengthHeader[CA_BLE_LENGTH_HEADER_SIZE] = {0}; + result = CAGenerateHeaderPayloadLength(lengthHeader, + CA_BLE_LENGTH_HEADER_SIZE, + bleData->dataLen); + + if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Generate header failed"); - OICFree(header); - OICFree(dataSegment); - return ; + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateHeaderPayloadLength failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; } - memcpy(dataSegment, header, CA_HEADER_LENGTH); - OICFree(header); uint32_t length = 0; - if (CA_SUPPORTED_BLE_MTU_SIZE > totalLength) + uint32_t dataLen = 0; + if (g_mtuSize > totalLength) { - length = totalLength; - memcpy(dataSegment + CA_HEADER_LENGTH, - bleData->data, - bleData->dataLen); + length = (uint32_t)totalLength; + dataLen = bleData->dataLen; } else { - length = CA_SUPPORTED_BLE_MTU_SIZE; - memcpy(dataSegment + CA_HEADER_LENGTH, - bleData->data, - CA_SUPPORTED_BLE_MTU_SIZE - CA_HEADER_LENGTH); + length = g_mtuSize; + dataLen = g_mtuSize - CA_BLE_HEADER_SIZE - CA_BLE_LENGTH_HEADER_SIZE; } - const uint32_t iter = totalLength / CA_SUPPORTED_BLE_MTU_SIZE; + result = CAMakeFirstDataSegment(dataSegment, + bleData->data, dataLen, + dataHeader, lengthHeader); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Making data segment failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; + } + + const uint32_t iter = midPacketCount; uint32_t index = 0; if (NULL != bleData->remoteEndpoint) //Sending Unicast Data { @@ -1125,298 +1695,572 @@ static void CALEClientSendDataThread(void *threadData) CALEADAPTER_TAG, "Update characteristics failed, result [%d]", result); - g_errorHandler(bleData->remoteEndpoint, - bleData->data, - bleData->dataLen, - result); - OICFree(dataSegment); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, + bleData->data, + bleData->dataLen, + result); + } return; } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, - "Client Sent Data length is [%u]", + "Client Sent Unicast First Data - data length [%u]", length); - for (index = 1; index < iter; index++) + result = CAGenerateHeader(dataHeader, + CA_BLE_PACKET_NOT_START, + g_localBLESourcePort, + secureFlag, + bleData->remoteEndpoint->port); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateHeader failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; + } + + for (index = 0; index < iter; index++) { + result = CAMakeRemainDataSegment(dataSegment, + g_mtuSize - CA_BLE_HEADER_SIZE, + bleData->data, + bleData->dataLen, + index, + dataHeader, + g_mtuSize); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Making data segment failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; + } + // Send the remaining header. result = CAUpdateCharacteristicsToGattServer( bleData->remoteEndpoint->addr, - bleData->data + (index * CA_SUPPORTED_BLE_MTU_SIZE) - CA_HEADER_LENGTH, - CA_SUPPORTED_BLE_MTU_SIZE, + dataSegment, + g_mtuSize, LE_UNICAST, 0); + if (CA_STATUS_OK != result) { OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Update characteristics failed, result [%d]", result); - g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); - OICFree(dataSegment); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } return; } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Client Sent Data length is [%d]", - CA_SUPPORTED_BLE_MTU_SIZE); + OIC_LOG_V(DEBUG, + CALEADAPTER_TAG, + "Client Sent Unicast %d Data - data(mtu) length [%hu]", + index + 1, + g_mtuSize); } - const uint32_t remainingLen = totalLength % CA_SUPPORTED_BLE_MTU_SIZE; - if (remainingLen && (totalLength > CA_SUPPORTED_BLE_MTU_SIZE)) + if (remainingLen && (totalLength > g_mtuSize)) { // send the last segment of the data (Ex: 22 bytes of 622 // bytes of data when MTU is 200) - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Sending the last chunk"); + result = CAMakeRemainDataSegment(dataSegment, + remainingLen, + bleData->data, + bleData->dataLen, + index, + dataHeader, + g_mtuSize); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Making data segment failed, result [%d]", result); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } + return; + } + result = CAUpdateCharacteristicsToGattServer( bleData->remoteEndpoint->addr, - bleData->data + (index * CA_SUPPORTED_BLE_MTU_SIZE) - CA_HEADER_LENGTH, - remainingLen, + dataSegment, + remainingLen + CA_BLE_HEADER_SIZE, LE_UNICAST, 0); if (CA_STATUS_OK != result) { OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Update characteristics failed, result [%d]", result); - g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); - OICFree(dataSegment); + if (g_errorHandler) + { + g_errorHandler(bleData->remoteEndpoint, bleData->data, bleData->dataLen, result); + } return; } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Client Sent Data length is [%d]", remainingLen); + OIC_LOG_V(DEBUG, + CALEADAPTER_TAG, + "Client Sent Unicast Last Data - data length [%zu]", + remainingLen + CA_BLE_HEADER_SIZE); } } else { //Sending Mulitcast Data - // Send the first segment with the header. - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Sending Multicast Data"); - result = CAUpdateCharacteristicsToAllGattServers(dataSegment, length); - if (CA_STATUS_OK != result) + OIC_LOG(DEBUG, CALEADAPTER_TAG, "Client Sending Multicast Data"); + OIC_LOG(DEBUG, CALEADAPTER_TAG, "BLE Multicast is not supported"); + } + + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); +} + +static CALEData_t *CACreateLEData(const CAEndpoint_t *remoteEndpoint, + const uint8_t *data, + uint32_t dataLength, + u_arraylist_t *senderInfo) +{ + CALEData_t * const bleData = OICMalloc(sizeof(CALEData_t)); + + if (!bleData) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Memory allocation failed!"); + return NULL; + } + + bleData->remoteEndpoint = CACloneEndpoint(remoteEndpoint); + bleData->data = OICCalloc(dataLength + 1, 1); + + if (NULL == bleData->data) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Memory allocation failed!"); + CAFreeLEData(bleData); + return NULL; + } + + memcpy(bleData->data, data, dataLength); + bleData->dataLen = dataLength; + if (senderInfo) + { + bleData->senderInfo = senderInfo; + } + + return bleData; +} + +static void CAFreeLEData(CALEData_t *bleData) +{ + VERIFY_NON_NULL_VOID(bleData, CALEADAPTER_TAG, "Param bleData is NULL"); + + CAFreeEndpoint(bleData->remoteEndpoint); + OICFree(bleData->data); + OICFree(bleData); +} + +static void CALEDataDestroyer(void *data, uint32_t size) +{ + if ((size_t)size < sizeof(CALEData_t *)) + { + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, + "Destroy data too small %p %d", data, size); + } + CALEData_t *ledata = (CALEData_t *) data; + + CAFreeLEData(ledata); +} +#endif + +#ifdef SINGLE_THREAD +static void CALEDataReceiverHandlerSingleThread(const uint8_t *data, + uint32_t dataLen) +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); + + VERIFY_NON_NULL(data, CALEADAPTER_TAG, "Param data is NULL"); + + //packet parsing + CABLEPacketStart_t startFlag = CA_BLE_PACKET_NOT_START; + CABLEPacketSecure_t secureFlag = CA_BLE_PACKET_NON_SECURE; + uint16_t sourcePort = 0; + uint16_t destPort = 0; + + CAParseHeader(data, &startFlag, &sourcePort, &secureFlag, &destPort); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, + "header info: startFlag[%X] sourcePort[%d] secureFlag[%X] destPort[%d]", + startFlag, sourcePort, secureFlag, destPort); + + if (destPort != g_localBLESourcePort && destPort != CA_BLE_MULTICAST_PORT) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "this packet is not valid for this app(port mismatch[mine:%d, packet:%d])", + g_localBLESourcePort, destPort); + return; + } + + if (startFlag) + { + if (g_singleThreadReceiveData) { - OIC_LOG_V(ERROR, CALEADAPTER_TAG, - "Update characteristics (all) failed, result [%d]", result); - CALEErrorHandler(NULL, bleData->data, bleData->dataLen, result); - OICFree(dataSegment); - return ; - } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Client Sent Data length is [%d]", length); - // Send the remaining header. - for (index = 1; index < iter; index++) - { - result = CAUpdateCharacteristicsToAllGattServers( - bleData->data + (index * CA_SUPPORTED_BLE_MTU_SIZE) - CA_HEADER_LENGTH, - CA_SUPPORTED_BLE_MTU_SIZE); - if (CA_STATUS_OK != result) - { - OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Update characteristics (all) failed, result [%d]", - result); - CALEErrorHandler(NULL, bleData->data, bleData->dataLen, result); - OICFree(dataSegment); - return; - } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Client Sent Data length is [%d]", - CA_SUPPORTED_BLE_MTU_SIZE); + OIC_LOG(ERROR, CALEADAPTER_TAG, + "This packet is start packet but exist senderInfo. Remove senderInfo"); + OICFree(g_singleThreadReceiveData->defragData); + OICFree(g_singleThreadReceiveData); + g_singleThreadReceiveData = NULL; } - uint32_t remainingLen = totalLength % CA_SUPPORTED_BLE_MTU_SIZE; - if (remainingLen && (totalLength > CA_SUPPORTED_BLE_MTU_SIZE)) + uint32_t totalLength = 0; + CAParseHeaderPayloadLength(data, CA_BLE_LENGTH_HEADER_SIZE, &totalLength); + + g_singleThreadReceiveData = OICMalloc(sizeof(CABLESenderInfo_t)); + + if (!g_singleThreadReceiveData) { - // send the last segment of the data (Ex: 22 bytes of 622 - // bytes of data when MTU is 200) - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Sending the last chunk"); - result = - CAUpdateCharacteristicsToAllGattServers( - bleData->data + (index * CA_SUPPORTED_BLE_MTU_SIZE) - CA_HEADER_LENGTH, - remainingLen); - if (CA_STATUS_OK != result) - { - OIC_LOG_V(ERROR, CALEADAPTER_TAG, - "Update characteristics (all) failed, result [%d]", result); - CALEErrorHandler(NULL, bleData->data, bleData->dataLen, result); - OICFree(dataSegment); - return; - } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Client Sent Data length is [%d]", remainingLen); + OIC_LOG(ERROR, CALEADAPTER_TAG, "Memory allocation failed for new sender"); + return; } + g_singleThreadReceiveData->recvDataLen = 0; + g_singleThreadReceiveData->totalDataLen = 0; + g_singleThreadReceiveData->defragData = NULL; + g_singleThreadReceiveData->remoteEndpoint = NULL; - } + OIC_LOG(DEBUG, CALEADAPTER_TAG, "Parsing the header"); - OICFree(dataSegment); + g_singleThreadReceiveData->totalDataLen = totalLength; - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT - CABLEClientSendDataThread"); + if (!(g_singleThreadReceiveData->totalDataLen)) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Total Data Length is parsed as 0!!!"); + OICFree(g_singleThreadReceiveData); + return; + } + + size_t dataOnlyLen = dataLen - (CA_BLE_HEADER_SIZE + CA_BLE_LENGTH_HEADER_SIZE); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Total data to be accumulated [%u] bytes", + g_singleThreadReceiveData->totalDataLen); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "data received in the first packet [%u] bytes", + dataOnlyLen); + + g_singleThreadReceiveData->defragData = + OICCalloc(g_singleThreadReceiveData->totalDataLen + 1, + sizeof(*g_singleThreadReceiveData->defragData)); + + if (NULL == g_singleThreadReceiveData->defragData) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "defragData is NULL!"); + OICFree(g_singleThreadReceiveData); + return; + } + + if (g_singleThreadReceiveData->recvDataLen + dataOnlyLen + > g_singleThreadReceiveData->totalDataLen) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "buffer is smaller than received data"); + OICFree(g_singleThreadReceiveData->defragData); + OICFree(g_singleThreadReceiveData); + return; + } + memcpy(g_singleThreadReceiveData->defragData, + data + (CA_BLE_HEADER_SIZE + CA_BLE_LENGTH_HEADER_SIZE), + dataOnlyLen); + g_singleThreadReceiveData->recvDataLen += dataOnlyLen; + } + else + { + size_t dataOnlyLen = dataLen - CA_BLE_HEADER_SIZE; + if (g_singleThreadReceiveData->recvDataLen + dataOnlyLen + > g_singleThreadReceiveData->totalDataLen) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Data Length exceeding error!! Receiving [%d] total length [%d]", + g_singleThreadReceiveData->recvDataLen + dataOnlyLen, + g_singleThreadReceiveData->totalDataLen); + OICFree(g_singleThreadReceiveData->defragData); + OICFree(g_singleThreadReceiveData); + return; + } + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Copying the data of length [%d]", + dataOnlyLen); + memcpy(g_singleThreadReceiveData->defragData + g_singleThreadReceiveData->recvDataLen, + data + CA_BLE_HEADER_SIZE, + dataOnlyLen); + g_singleThreadReceiveData->recvDataLen += dataOnlyLen; + OIC_LOG_V(INFO, CALEADAPTER_TAG, "totalDatalength [%d] received Datalen [%d]", + g_singleThreadReceiveData->totalDataLen, g_singleThreadReceiveData->recvDataLen); + } + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); } -static CALEData_t *CACreateLEData(const CAEndpoint_t *remoteEndpoint, - const uint8_t *data, - uint32_t dataLength) +static CAResult_t CALEServerSendDataSingleThread(const uint8_t *data, + uint32_t dataLen) { - CALEData_t * const bleData = OICMalloc(sizeof(CALEData_t)); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + + VERIFY_NON_NULL(data, CALEADAPTER_TAG, "Param data is NULL"); + + uint32_t midPacketCount = 0; + size_t remainingLen = 0; + size_t totalLength = 0; + CABLEPacketSecure_t secureFlag = CA_BLE_PACKET_NON_SECURE; + + CAResult_t result = CAGenerateVariableForFragmentation(dataLen, + &midPacketCount, + &remainingLen, + &totalLength, + g_mtuSize); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateVariableForFragmentation failed, result [%d]", result); + return result; + } + + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, + "Packet info: data size[%d] midPacketCount[%d] remainingLen[%d] totalLength[%d]", + dataLen, midPacketCount, remainingLen, totalLength); + + OIC_LOG_V(DEBUG, + CALEADAPTER_TAG, + "Server total Data length with header is [%u]", + totalLength); + + uint8_t dataSegment[CA_SUPPORTED_BLE_MTU_SIZE] = {0}; + uint8_t dataHeader[CA_BLE_HEADER_SIZE] = {0}; + + result = CAGenerateHeader(dataHeader, + CA_BLE_PACKET_START, + g_localBLESourcePort, + CA_BLE_PACKET_NON_SECURE, + CA_BLE_MULTICAST_PORT); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateHeader failed, result [%d]", result); + return result; + } + + uint8_t lengthHeader[CA_BLE_LENGTH_HEADER_SIZE] = {0}; + result = CAGenerateHeaderPayloadLength(lengthHeader, + CA_BLE_LENGTH_HEADER_SIZE, + dataLen); + + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "CAGenerateHeaderPayloadLength failed, result [%d]", result); + return result; + } - if (!bleData) + uint32_t length = 0; + uint32_t dataOnlyLen = 0; + if (g_mtuSize > totalLength) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Memory allocation failed!"); - return NULL; + length = totalLength; + dataOnlyLen = dataLen; + } + else + { + length = g_mtuSize; + dataOnlyLen = g_mtuSize - CA_BLE_HEADER_SIZE - CA_BLE_LENGTH_HEADER_SIZE; } - bleData->remoteEndpoint = CACloneEndpoint(remoteEndpoint); - bleData->data = OICCalloc(dataLength + 1, 1); + result = CAMakeFirstDataSegment(dataSegment, + data, dataOnlyLen, + dataHeader, lengthHeader); - if (NULL == bleData->data) + if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Memory allocation failed!"); - CAFreeLEData(bleData); - return NULL; + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Making data segment failed, result [%d]", result); + return result; } - memcpy(bleData->data, data, dataLength); - bleData->dataLen = dataLength; + OIC_LOG(DEBUG, CALEADAPTER_TAG, "Server Sending Multicast data"); + result = CAUpdateCharacteristicsToAllGattClients(dataSegment, length); + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Update characteristics failed, result [%d]", + result); + return result; + } - return bleData; -} + CALEDoEvents(); -static void CAFreeLEData(CALEData_t *bleData) -{ - VERIFY_NON_NULL_VOID(bleData, CALEADAPTER_TAG, "Param bleData is NULL"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Server Sent data length [%d]", length); - CAFreeEndpoint(bleData->remoteEndpoint); - OICFree(bleData->data); - OICFree(bleData); -} + result = CAGenerateHeader(dataHeader, + CA_BLE_PACKET_NOT_START, + g_localBLESourcePort, + CA_BLE_PACKET_NON_SECURE, + CA_BLE_MULTICAST_PORT); -static void CALEDataDestroyer(void *data, uint32_t size) -{ - if ((size_t)size < sizeof(CALEData_t *)) + if (CA_STATUS_OK != result) { OIC_LOG_V(ERROR, CALEADAPTER_TAG, - "Destroy data too small %p %d", data, size); + "CAGenerateHeader failed, result [%d]", result); + return result; } - CALEData_t *ledata = (CALEData_t *) data; - CAFreeLEData(ledata); -} -#endif + const uint32_t dataLimit = midPacketCount; + for (uint32_t iter = 0; iter < dataLimit; iter++) + { + result = CAMakeRemainDataSegment(dataSegment, + g_mtuSize - CA_BLE_HEADER_SIZE, + data, + dataLen, + iter, + dataHeader, + g_mtuSize); -static CAResult_t CAInitLEAdapterMutex() -{ - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Making data segment failed, result [%d]", result); + return result; + } - if (NULL == g_bleIsServerMutex) - { - g_bleIsServerMutex = ca_mutex_new(); - if (NULL == g_bleIsServerMutex) + result = CAUpdateCharacteristicsToAllGattClients( + dataSegment, + g_mtuSize); + + if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_mutex_new failed"); - return CA_STATUS_FAILED; + OIC_LOG(ERROR, CALEADAPTER_TAG, "Update characteristics failed"); + return result; } + + CALEDoEvents(); } - if (NULL == g_bleNetworkCbMutex) + if (remainingLen && (totalLength > g_mtuSize)) { - g_bleNetworkCbMutex = ca_mutex_new(); - if (NULL == g_bleNetworkCbMutex) + // send the last segment of the data + OIC_LOG(DEBUG, CALEADAPTER_TAG, "Sending the last chunk"); + + result = CAMakeRemainDataSegment(dataSegment, + remainingLen, + data, + dataLen, + dataLimit, + dataHeader, + g_mtuSize); + + if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_mutex_new failed"); - CATerminateLEAdapterMutex(); - return CA_STATUS_FAILED; + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Making data segment failed, result [%d]", result); + return result; } - } - if (NULL == g_bleLocalAddressMutex) - { - g_bleLocalAddressMutex = ca_mutex_new(); - if (NULL == g_bleLocalAddressMutex) + result = CAUpdateCharacteristicsToAllGattClients( + dataSegment, + remainingLen + CA_BLE_HEADER_SIZE); + + if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_mutex_new failed"); - CATerminateLEAdapterMutex(); - return CA_STATUS_FAILED; + OIC_LOG(ERROR, CALEADAPTER_TAG, "Update characteristics failed"); + return result; } + CALEDoEvents(); } - if (NULL == g_bleAdapterThreadPoolMutex) + return result; +} +#endif + +static CAResult_t CAInitLEAdapterMutex() +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + + if (NULL == g_bleIsServerMutex) { - g_bleAdapterThreadPoolMutex = ca_mutex_new(); - if (NULL == g_bleAdapterThreadPoolMutex) + g_bleIsServerMutex = oc_mutex_new(); + if (NULL == g_bleIsServerMutex) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_mutex_new failed"); - CATerminateLEAdapterMutex(); + OIC_LOG(ERROR, CALEADAPTER_TAG, "oc_mutex_new failed"); return CA_STATUS_FAILED; } } - if (NULL == g_bleClientSendDataMutex) + if (NULL == g_bleLocalAddressMutex) { - g_bleClientSendDataMutex = ca_mutex_new(); - if (NULL == g_bleClientSendDataMutex) + g_bleLocalAddressMutex = oc_mutex_new(); + if (NULL == g_bleLocalAddressMutex) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_mutex_new failed"); + OIC_LOG(ERROR, CALEADAPTER_TAG, "oc_mutex_new failed"); CATerminateLEAdapterMutex(); return CA_STATUS_FAILED; } } - if (NULL == g_bleServerSendDataMutex) + + + if (NULL == g_bleServerReceiveDataMutex) { - g_bleServerSendDataMutex = ca_mutex_new(); - if (NULL == g_bleServerSendDataMutex) + g_bleServerReceiveDataMutex = oc_mutex_new(); + if (NULL == g_bleServerReceiveDataMutex) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_mutex_new failed"); - CATerminateLEAdapterMutex(); + OIC_LOG(ERROR, CALEADAPTER_TAG, "oc_mutex_new failed"); return CA_STATUS_FAILED; } } - if (NULL == g_bleAdapterReqRespCbMutex) + if (NULL == g_bleClientReceiveDataMutex) { - g_bleAdapterReqRespCbMutex = ca_mutex_new(); - if (NULL == g_bleAdapterReqRespCbMutex) + g_bleClientReceiveDataMutex = oc_mutex_new(); + if (NULL == g_bleClientReceiveDataMutex) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_mutex_new failed"); - CATerminateLEAdapterMutex(); + OIC_LOG(ERROR, CALEADAPTER_TAG, "oc_mutex_new failed"); return CA_STATUS_FAILED; } } - if (NULL == g_bleReceiveDataMutex) + if (NULL == g_senderInfoMutex) { - g_bleReceiveDataMutex = ca_mutex_new(); - if (NULL == g_bleReceiveDataMutex) + g_senderInfoMutex = oc_mutex_new(); + if (NULL == g_senderInfoMutex) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "ca_mutex_new failed"); + OIC_LOG(ERROR, CALEADAPTER_TAG, "oc_mutex_new failed"); return CA_STATUS_FAILED; } } - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); return CA_STATUS_OK; } static void CATerminateLEAdapterMutex() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); - ca_mutex_free(g_bleIsServerMutex); + oc_mutex_free(g_bleIsServerMutex); g_bleIsServerMutex = NULL; - ca_mutex_free(g_bleNetworkCbMutex); - g_bleNetworkCbMutex = NULL; - - ca_mutex_free(g_bleLocalAddressMutex); + + oc_mutex_free(g_bleLocalAddressMutex); g_bleLocalAddressMutex = NULL; - ca_mutex_free(g_bleAdapterThreadPoolMutex); - g_bleAdapterThreadPoolMutex = NULL; - - ca_mutex_free(g_bleClientSendDataMutex); - g_bleClientSendDataMutex = NULL; - - ca_mutex_free(g_bleServerSendDataMutex); - g_bleServerSendDataMutex = NULL; - - ca_mutex_free(g_bleAdapterReqRespCbMutex); - g_bleAdapterReqRespCbMutex = NULL; + oc_mutex_free(g_bleServerReceiveDataMutex); + g_bleServerReceiveDataMutex = NULL; - ca_mutex_free(g_bleReceiveDataMutex); - g_bleReceiveDataMutex = NULL; + oc_mutex_free(g_bleClientReceiveDataMutex); + g_bleClientReceiveDataMutex = NULL; - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + oc_mutex_free(g_senderInfoMutex); + g_senderInfoMutex = NULL; } /** @@ -1439,6 +2283,16 @@ static CAResult_t CAStartLE(); static CAResult_t CAStartLEListeningServer(); /** + * Stops listening server from receiving multicast search requests. + * + * Transport Specific Behavior: + * LE Starts GATT Server with prefixed UUID and Characteristics + * per OIC Specification. + * @return ::CA_STATUS_OK or Appropriate error code. + */ +static CAResult_t CAStopLEListeningServer(); + +/** * Sarting discovery of servers for receiving multicast * advertisements. * @@ -1465,7 +2319,8 @@ static CAResult_t CAStartLEDiscoveryServer(); */ static int32_t CASendLEUnicastData(const CAEndpoint_t *endpoint, const void *data, - uint32_t dataLen); + uint32_t dataLen, + CADataType_t dataType); /** * Send multicast data to the endpoint using the LE connectivity. @@ -1481,7 +2336,8 @@ static int32_t CASendLEUnicastData(const CAEndpoint_t *endpoint, */ static int32_t CASendLEMulticastData(const CAEndpoint_t *endpoint, const void *data, - uint32_t dataLen); + uint32_t dataLen, + CADataType_t dataType); /** * Get LE Connectivity network information. @@ -1523,7 +2379,7 @@ static void CATerminateLE(); * * @param[in] remoteAddress Remote address of the device from where * data is received. - * @param[in] data Actual data recevied from the remote + * @param[in] data Actual data received from the remote * device. * @param[in] dataLength Length of the data received from the * remote device. @@ -1606,18 +2462,222 @@ static CAResult_t CALEAdapterClientSendData(const CAEndpoint_t *remoteEndpoint, const uint8_t *data, uint32_t dataLen); +static CAResult_t CALEAdapterGattServerStart() +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + CAResult_t result = CA_STATUS_FAILED; + + if (caglobals.bleFlags & CA_LE_SERVER_DISABLE) + { + OIC_LOG_V(INFO, CALEADAPTER_TAG, "server flag of configure is disable [%d]", + caglobals.bleFlags); + return CA_STATUS_OK; + } + +#ifndef DISABLE_BLE_SERVER + OIC_LOG_V(INFO, CALEADAPTER_TAG, "Starting LE GATT Server"); + result = CAStartLEGattServer(); +#endif + +#ifndef SINGLE_THREAD + /* + Don't start the server side sending queue thread until the + server itself has actually started. + */ + if (CA_STATUS_OK == result) + { + result = CAQueueingThreadStart(g_bleServerSendQueueHandle); + if (CA_STATUS_OK != result) + { + OIC_LOG_V(ERROR, + CALEADAPTER_TAG, + "Unable to start server queuing thread (%d)", + result); + } + } +#endif + + return result; +} + +static CAResult_t CALEAdapterGattServerStop() +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + + if (caglobals.bleFlags & CA_LE_SERVER_DISABLE) + { + OIC_LOG_V(INFO, CALEADAPTER_TAG, "server flag of configure is disable [%d]", + caglobals.bleFlags); + return CA_STATUS_OK; + } + +#ifndef SINGLE_THREAD + + CAResult_t res = CAQueueingThreadStop(g_bleServerSendQueueHandle); + if (CA_STATUS_OK != res) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "CAQueueingThreadStop has failed"); + } + res = CAStopLEGattServer(); + if (CA_STATUS_OK != res) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "CAStopLEGattServer has failed"); + } + + return res; +#else + return CAStopLEGattServer(); +#endif +} + +static CAResult_t CALEAdapterGattClientStart() +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + + CAResult_t result = CAStartLEGattClient(); + +#ifndef SINGLE_THREAD + /* + Don't start the client side sending queue thread until the + client itself has actually started. + */ + if (CA_STATUS_OK == result) + { + result = CAQueueingThreadStart(g_bleClientSendQueueHandle); + if (CA_STATUS_OK != result) + { + OIC_LOG(ERROR, + CALEADAPTER_TAG, + "Unable to start client queuing thread"); + } + } +#endif + + return result; +} + +static CAResult_t CALEAdapterGattClientStop() +{ +#ifndef SINGLE_THREAD + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + CAStopLEGattClient(); + + CAResult_t result = CAQueueingThreadStop(g_bleClientSendQueueHandle); + + return result; +#else + CAStopLEGattClient(); + + return CA_STATUS_OK; +#endif +} + +#ifdef __WITH_DTLS__ +static ssize_t CALESecureSendDataCB(CAEndpoint_t *endpoint, const void *data, size_t dataLen) +{ + VERIFY_NON_NULL(endpoint, CALEADAPTER_TAG, "endpoint is NULL"); + VERIFY_NON_NULL(data, CALEADAPTER_TAG, "data is NULL"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "encrypted datalen = %zd", dataLen); + + CAResult_t result; + CADataType_t dataType = g_dataType; + ssize_t ret = 0; + + if (ADAPTER_SERVER == g_adapterType || + (ADAPTER_BOTH_CLIENT_SERVER == g_adapterType && CA_RESPONSE_DATA == dataType)) + { + result = CALEAdapterServerSendData(endpoint, data, dataLen); + if (CA_STATUS_OK != result) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Send unicast data for server failed" ); + + if (g_errorHandler) + { + g_errorHandler(endpoint, data, dataLen, result); + } + return ret; + } + ret = (ssize_t)dataLen; + } + else if (ADAPTER_CLIENT == g_adapterType || + (ADAPTER_BOTH_CLIENT_SERVER == g_adapterType && CA_REQUEST_DATA == dataType) || + (ADAPTER_BOTH_CLIENT_SERVER == g_adapterType && CA_RESPONSE_FOR_RES == dataType)) + { + result = CALEAdapterClientSendData(endpoint, data, dataLen); + if (CA_STATUS_OK != result) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Send unicast data for client failed" ); + + if (g_errorHandler) + { + g_errorHandler(endpoint, data, dataLen, result); + } + return ret; + } + ret = (ssize_t)dataLen; + } + else + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, + "Can't Send Message adapterType = %d, dataType = %d", g_adapterType, dataType); + return ret; + } + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); + return ret; +} + +CAResult_t CALESecureReceiveDataCB(const CASecureEndpoint_t *sep, const void *data, + size_t dataLen) +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + + VERIFY_NON_NULL(sep, CALEADAPTER_TAG, "sep is NULL"); + VERIFY_NON_NULL(data, CALEADAPTER_TAG, "data is NULL"); + + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, + "Secure Data Receive - decrypted datalen = %zd", dataLen); + + if (dataLen <= 0) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "incorrect dataLen, derecypt fail !"); + return CA_STATUS_INVALID_PARAM; + } + + OIC_LOG_BUFFER(DEBUG, CALEADAPTER_TAG, data, dataLen); + + CAResult_t res = CA_STATUS_OK; + if (g_networkPacketReceivedCallback) + { + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, + "[CALESecureReceiveDataCB] Secure flags = %d, %x", + sep->endpoint.flags, sep->endpoint.flags); + OIC_LOG(DEBUG, CALEADAPTER_TAG, + "[CALESecureReceiveDataCB] Received data up !"); + res = g_networkPacketReceivedCallback(sep, data, dataLen); + if (CA_STATUS_OK != res) + { + OIC_LOG_V(ERROR, CALEADAPTER_TAG, "Error parsing CoAP data, res = %d", res); + } + } + return res; +} +#endif + CAResult_t CAInitializeLE(CARegisterConnectivityCallback registerCallback, CANetworkPacketReceivedCallback reqRespCallback, - CANetworkChangeCallback netCallback, + CAAdapterChangeCallback netCallback, + CAConnectionChangeCallback connCallback, CAErrorHandleCallback errorCallback, ca_thread_pool_t handle) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); //Input validation VERIFY_NON_NULL(registerCallback, CALEADAPTER_TAG, "RegisterConnectivity callback is null"); VERIFY_NON_NULL(reqRespCallback, CALEADAPTER_TAG, "PacketReceived Callback is null"); VERIFY_NON_NULL(netCallback, CALEADAPTER_TAG, "NetworkChange Callback is null"); + VERIFY_NON_NULL(connCallback, CALEADAPTER_TAG, "ConnectionChange Callback is null"); CAResult_t result = CA_STATUS_OK; result = CAInitLEAdapterMutex(); @@ -1626,195 +2686,273 @@ CAResult_t CAInitializeLE(CARegisterConnectivityCallback registerCallback, OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitBleAdapterMutex failed!"); return CA_STATUS_FAILED; } + result = CAInitializeLENetworkMonitor(); if (CA_STATUS_OK != result) { OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitializeLENetworkMonitor() failed"); return CA_STATUS_FAILED; } - CAInitializeLEAdapter(); + result = CAInitializeLEGattClient(); + if (CA_STATUS_OK != result) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitializeLEGattClient() failed"); + return CA_STATUS_FAILED; + } + CASetLEClientThreadPoolHandle(handle); + CASetLEReqRespClientCallback(CALEAdapterClientReceivedData); CASetLEServerThreadPoolHandle(handle); + result = CAInitializeLEGattServer(); + if (CA_STATUS_OK != result) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitializeLEGattServer() failed"); + return CA_STATUS_FAILED; + } + CASetLEAdapterThreadPoolHandle(handle); CASetLEReqRespServerCallback(CALEAdapterServerReceivedData); CASetLEReqRespAdapterCallback(reqRespCallback); CASetBLEClientErrorHandleCallback(CALEErrorHandler); CASetBLEServerErrorHandleCallback(CALEErrorHandler); - CALERegisterNetworkNotifications(netCallback); + CALERegisterNetworkNotifications(netCallback, connCallback); g_errorHandler = errorCallback; +#ifdef __WITH_DTLS__ + if (CA_STATUS_OK != CAinitSslAdapter()) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Failed to init SSL adapter"); + } + else + { + CAsetSslAdapterCallbacks(CALESecureReceiveDataCB, CALESecureSendDataCB, + CA_ADAPTER_GATT_BTLE); + } +#endif + static const CAConnectivityHandler_t connHandler = { .startAdapter = CAStartLE, .stopAdapter = CAStopLE, .startListenServer = CAStartLEListeningServer, + .stopListenServer = CAStopLEListeningServer, .startDiscoveryServer = CAStartLEDiscoveryServer, .sendData = CASendLEUnicastData, .sendDataToAll = CASendLEMulticastData, .GetnetInfo = CAGetLEInterfaceInformation, .readData = CAReadLEData, - .terminate = CATerminateLE + .terminate = CATerminateLE, + .cType = CA_ADAPTER_GATT_BTLE }; - registerCallback(connHandler, CA_ADAPTER_GATT_BTLE); - - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); - + registerCallback(connHandler); return CA_STATUS_OK; } static CAResult_t CAStartLE() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "CAStartLE"); - return CAStartLEAdapter(); } static CAResult_t CAStopLE() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + #ifndef SINGLE_THREAD CAStopLEQueues(); #endif - ca_mutex_lock(g_bleIsServerMutex); - if (true == g_isServer) - { - CAStopLEGattServer(); - } - else - { - CAStopLEGattClient(); - } - ca_mutex_unlock(g_bleIsServerMutex); - - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); - - return CA_STATUS_OK; + oc_mutex_lock(g_bleIsServerMutex); + switch (g_adapterType) + { + case ADAPTER_SERVER: + CALEAdapterGattServerStop(); + break; + case ADAPTER_CLIENT: + CALEAdapterGattClientStop(); + break; + case ADAPTER_BOTH_CLIENT_SERVER: + CALEAdapterGattServerStop(); + CALEAdapterGattClientStop(); + break; + default: + break; + } + oc_mutex_unlock(g_bleIsServerMutex); + return CAStopLEAdapter(); } static void CATerminateLE() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); CASetLEReqRespServerCallback(NULL); CASetLEReqRespClientCallback(NULL); - CALERegisterNetworkNotifications(NULL); + CALERegisterNetworkNotifications(NULL, NULL); CASetLEReqRespAdapterCallback(NULL); CATerminateLENetworkMonitor(); - ca_mutex_lock(g_bleIsServerMutex); - if (true == g_isServer) - { - CATerminateLEGattServer(); - } - else - { - CATerminateLEGattClient(); - } - ca_mutex_unlock(g_bleIsServerMutex); + oc_mutex_lock(g_bleIsServerMutex); + switch (g_adapterType) + { + case ADAPTER_SERVER: + CATerminateLEGattServer(); + break; + case ADAPTER_CLIENT: + CATerminateLEGattClient(); + break; + case ADAPTER_BOTH_CLIENT_SERVER: + CATerminateLEGattServer(); + CATerminateLEGattClient(); + break; + default: + break; + } + g_adapterType = ADAPTER_EMPTY; + oc_mutex_unlock(g_bleIsServerMutex); #ifndef SINGLE_THREAD CATerminateLEQueues(); #endif - CATerminateLEAdapterMutex(); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); +#ifdef __WITH_DTLS__ + CAsetSslAdapterCallbacks(NULL, NULL, CA_ADAPTER_GATT_BTLE); +#endif + + CATerminateLEAdapterMutex(); } static CAResult_t CAStartLEListeningServer() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); + + if (caglobals.bleFlags & CA_LE_SERVER_DISABLE) + { + OIC_LOG_V(INFO, CALEADAPTER_TAG, "server flag of configure is disable [%d]", + caglobals.bleFlags); + return CA_STATUS_OK; + } + +#ifndef ROUTING_GATEWAY CAResult_t result = CA_STATUS_OK; #ifndef SINGLE_THREAD result = CAInitLEServerQueues(); if (CA_STATUS_OK != result) { OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitLEServerQueues failed"); - return CA_STATUS_FAILED; + return result; + } +#endif + + oc_mutex_lock(g_bleIsServerMutex); + switch (g_adapterType) + { + case ADAPTER_CLIENT: + g_adapterType = ADAPTER_BOTH_CLIENT_SERVER; + break; + case ADAPTER_BOTH_CLIENT_SERVER: + break; + default: + g_adapterType = ADAPTER_SERVER; } -#endif + oc_mutex_unlock(g_bleIsServerMutex); result = CAGetLEAdapterState(); - if (CA_ADAPTER_NOT_ENABLED == result) + if (CA_STATUS_OK != result) { - gLeServerStatus = CA_LISTENING_SERVER; - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Listen Server will be started once BT Adapter is enabled"); - return CA_STATUS_OK; + if (CA_ADAPTER_NOT_ENABLED == result) + { + OIC_LOG(DEBUG, + CALEADAPTER_TAG, + "Listen Server will be started once BT Adapter is enabled"); + result = CA_STATUS_OK; + } } - - if (CA_STATUS_FAILED == result) + else { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Bluetooth get state failed!"); - return CA_STATUS_FAILED; + result = CALEAdapterGattServerStart(); } - CAStartLEGattServer(); - - ca_mutex_lock(g_bleIsServerMutex); - g_isServer = true; - ca_mutex_unlock(g_bleIsServerMutex); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); + return result; +#else + // Routing Gateway only supports BLE client mode. + OIC_LOG(ERROR, CALEADAPTER_TAG, "LE server not supported in Routing Gateway"); + return CA_NOT_SUPPORTED; +#endif +} - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); - return CA_STATUS_OK; +static CAResult_t CAStopLEListeningServer() +{ + OIC_LOG(ERROR, CALEADAPTER_TAG, "Listen server stop not supported."); + return CA_NOT_SUPPORTED; } static CAResult_t CAStartLEDiscoveryServer() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); CAResult_t result = CA_STATUS_OK; #ifndef SINGLE_THREAD result = CAInitLEClientQueues(); if (CA_STATUS_OK != result) { OIC_LOG(ERROR, CALEADAPTER_TAG, "CAInitLEClientQueues failed"); - return CA_STATUS_FAILED; + return result; } #endif - result = CAGetLEAdapterState(); - if (CA_ADAPTER_NOT_ENABLED == result) + + oc_mutex_lock(g_bleIsServerMutex); + switch (g_adapterType) { - gLeServerStatus = CA_DISCOVERY_SERVER; - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Listen Server will be started once BT Adapter is enabled"); - return CA_STATUS_OK; + case ADAPTER_SERVER: + g_adapterType = ADAPTER_BOTH_CLIENT_SERVER; + break; + case ADAPTER_BOTH_CLIENT_SERVER: + break; + default: + g_adapterType = ADAPTER_CLIENT; } + oc_mutex_unlock(g_bleIsServerMutex); - if (CA_STATUS_FAILED == result) + result = CAGetLEAdapterState(); + if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Bluetooth get state failed!"); - return CA_STATUS_FAILED; + if (CA_ADAPTER_NOT_ENABLED == result) + { + OIC_LOG(DEBUG, + CALEADAPTER_TAG, + "Discovery Server will be started once BT Adapter is enabled"); + result = CA_STATUS_OK; + } + } + else + { + result = CALEAdapterGattClientStart(); } - CAStartLEGattClient(); - - ca_mutex_lock(g_bleIsServerMutex); - g_isServer = false; - ca_mutex_unlock(g_bleIsServerMutex); - - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); - return CA_STATUS_OK; + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); + return result; } static CAResult_t CAReadLEData() { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); #ifdef SINGLE_THREAD CACheckLEData(); #endif - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); return CA_STATUS_OK; } static int32_t CASendLEUnicastData(const CAEndpoint_t *endpoint, const void *data, - uint32_t dataLen) + uint32_t dataLen, + CADataType_t dataType) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "type(%d)", dataType); //Input validation VERIFY_NON_NULL_RET(endpoint, CALEADAPTER_TAG, "Remote endpoint is null", -1); @@ -1822,46 +2960,108 @@ static int32_t CASendLEUnicastData(const CAEndpoint_t *endpoint, CAResult_t result = CA_STATUS_FAILED; - ca_mutex_lock(g_bleIsServerMutex); - if (true == g_isServer) + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "g_adapterType: %d", g_adapterType); + if (ADAPTER_EMPTY == g_adapterType) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "g_adapterType is Empty"); + } + + oc_mutex_lock(g_bleIsServerMutex); + if (ADAPTER_SERVER == g_adapterType || + (ADAPTER_BOTH_CLIENT_SERVER == g_adapterType && CA_RESPONSE_DATA == dataType)) { +#ifdef __WITH_DTLS__ + if (endpoint && endpoint->flags & CA_SECURE) + { + OIC_LOG(DEBUG, CALEADAPTER_TAG, + "Response Data or server - secured data send(caadapternetdtlsencrypt) call"); + OIC_LOG_BUFFER(DEBUG, CALEADAPTER_TAG, data, dataLen); + g_dataType = dataType; + oc_mutex_unlock(g_bleIsServerMutex); + + result = CAencryptSsl(endpoint, (void *)data, dataLen); + if (CA_STATUS_OK != result) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "caadapternetdtlsencrypt failed!"); + return -1; + } + return dataLen; + } + else + { + OIC_LOG(DEBUG, CALEADAPTER_TAG, + "server or both - none secured data send(CALEAdapterServerSendData) call"); + result = CALEAdapterServerSendData(endpoint, data, dataLen); + } +#else result = CALEAdapterServerSendData(endpoint, data, dataLen); +#endif if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Send unicast data failed\n"); + oc_mutex_unlock(g_bleIsServerMutex); + OIC_LOG(ERROR, CALEADAPTER_TAG, "Send unicast data for server failed"); if (g_errorHandler) { g_errorHandler(endpoint, data, dataLen, result); } - ca_mutex_unlock(g_bleIsServerMutex); + return -1; } } - else + else if (ADAPTER_CLIENT == g_adapterType || + (ADAPTER_BOTH_CLIENT_SERVER == g_adapterType && CA_REQUEST_DATA == dataType) || + (ADAPTER_BOTH_CLIENT_SERVER == g_adapterType && CA_RESPONSE_FOR_RES == dataType)) { +#ifdef __WITH_DTLS__ + if (endpoint && endpoint->flags & CA_SECURE) + { + OIC_LOG(DEBUG, CALEADAPTER_TAG, + "Request Data or client - secured data send(caadapternetdtlsencrypt) call"); + OIC_LOG_BUFFER(DEBUG, CALEADAPTER_TAG, data, dataLen); + g_dataType = dataType; + oc_mutex_unlock(g_bleIsServerMutex); + + result = CAencryptSsl(endpoint, (void *)data, dataLen); + if (CA_STATUS_OK != result) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "caadapternetdtlsencrypt failed!"); + return -1; + } + return dataLen; + } + else + { + OIC_LOG(DEBUG, CALEADAPTER_TAG, + "client or both - none secured data send(CALEAdapterClientSendData) call"); + result = CALEAdapterClientSendData(endpoint, data, dataLen); + } +#else result = CALEAdapterClientSendData(endpoint, data, dataLen); +#endif if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Send unicast data failed \n"); + oc_mutex_unlock(g_bleIsServerMutex); + OIC_LOG(ERROR, CALEADAPTER_TAG, "Send unicast data for client failed" ); + if (g_errorHandler) { g_errorHandler(endpoint, data, dataLen, result); } - ca_mutex_unlock(g_bleIsServerMutex); return -1; } } - ca_mutex_unlock(g_bleIsServerMutex); + oc_mutex_unlock(g_bleIsServerMutex); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); return dataLen; } static int32_t CASendLEMulticastData(const CAEndpoint_t *endpoint, const void *data, - uint32_t dataLen) + uint32_t dataLen, + CADataType_t dataType) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); //Input validation VERIFY_NON_NULL_RET(data, CALEADAPTER_TAG, "Data is null", -1); @@ -1874,15 +3074,23 @@ static int32_t CASendLEMulticastData(const CAEndpoint_t *endpoint, CAResult_t result = CA_STATUS_FAILED; - ca_mutex_lock(g_bleIsServerMutex); - if (true == g_isServer) + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "g_adapterType: %d", g_adapterType); + if (ADAPTER_EMPTY == g_adapterType) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "g_adapterType is Empty"); + } + + oc_mutex_lock(g_bleIsServerMutex); + if (ADAPTER_SERVER == g_adapterType || + (ADAPTER_BOTH_CLIENT_SERVER == g_adapterType && CA_RESPONSE_DATA == dataType)) { result = CALEAdapterServerSendData(NULL, data, dataLen); if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Send multicast data failed" ); + oc_mutex_unlock(g_bleIsServerMutex); + + OIC_LOG(ERROR, CALEADAPTER_TAG, "Send multicast data for server failed" ); - ca_mutex_unlock(g_bleIsServerMutex); if (g_errorHandler) { g_errorHandler(endpoint, data, dataLen, result); @@ -1890,29 +3098,34 @@ static int32_t CASendLEMulticastData(const CAEndpoint_t *endpoint, return -1; } } - else + + if (ADAPTER_CLIENT == g_adapterType || + (ADAPTER_BOTH_CLIENT_SERVER == g_adapterType && CA_REQUEST_DATA == dataType) || + (ADAPTER_BOTH_CLIENT_SERVER == g_adapterType && CA_RESPONSE_FOR_RES == dataType)) { result = CALEAdapterClientSendData(NULL, data, dataLen); if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Send Multicast data failed" ); + oc_mutex_unlock(g_bleIsServerMutex); + + OIC_LOG(ERROR, CALEADAPTER_TAG, "Send Multicast data for client failed" ); + if (g_errorHandler) { g_errorHandler(endpoint, data, dataLen, result); } - ca_mutex_unlock(g_bleIsServerMutex); return -1; } } - ca_mutex_unlock(g_bleIsServerMutex); + oc_mutex_unlock(g_bleIsServerMutex); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); return dataLen; } static CAResult_t CAGetLEInterfaceInformation(CAEndpoint_t **info, uint32_t *size) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); VERIFY_NON_NULL(info, CALEADAPTER_TAG, "CALocalConnectivity info is null"); @@ -1952,25 +3165,25 @@ static CAResult_t CAGetLEInterfaceInformation(CAEndpoint_t **info, uint32_t *siz } OICStrcpy((*info)->addr, sizeof((*info)->addr), local_address); - ca_mutex_lock(g_bleLocalAddressMutex); + oc_mutex_lock(g_bleLocalAddressMutex); OICStrcpy(g_localBLEAddress, sizeof(g_localBLEAddress), local_address); - ca_mutex_unlock(g_bleLocalAddressMutex); + oc_mutex_unlock(g_bleLocalAddressMutex); (*info)->adapter = CA_ADAPTER_GATT_BTLE; *size = 1; OICFree(local_address); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); return CA_STATUS_OK; } -static CAResult_t CALERegisterNetworkNotifications(CANetworkChangeCallback netCallback) +static CAResult_t CALERegisterNetworkNotifications(CAAdapterChangeCallback netCallback, + CAConnectionChangeCallback connCallback) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); - ca_mutex_lock(g_bleNetworkCbMutex); g_networkCallback = netCallback; - ca_mutex_unlock(g_bleNetworkCbMutex); + g_connectionCallback = connCallback; CAResult_t res = CA_STATUS_OK; if (netCallback) { @@ -1989,83 +3202,226 @@ static CAResult_t CALERegisterNetworkNotifications(CANetworkChangeCallback netCa } } - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + if (g_connectionCallback) + { + res = CASetLENWConnectionStateChangedCb(CALEConnectionStateChangedCb); + if (CA_STATUS_OK != res) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "CASetLENWConnectionStateChangedCb failed!"); + } + } + else + { + res = CAUnSetLENWConnectionStateChangedCb(); + if (CA_STATUS_OK != res) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "CAUnSetLENWConnectionStateChangedCb failed!"); + } + } + + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); return res; } -static void CALEDeviceStateChangedCb(CAAdapterState_t adapter_state) +static void CALEConnectionStateChangedCb(CATransportAdapter_t adapter, const char* address, + bool isConnected) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); + + VERIFY_NON_NULL_VOID(address, CALEADAPTER_TAG, "address"); + (void)adapter; - VERIFY_NON_NULL_VOID(g_localBLEAddress, CALEADAPTER_TAG, "g_localBLEAddress is null"); CAEndpoint_t localEndpoint = { .adapter = CA_ADAPTER_GATT_BTLE }; + OICStrcpy(localEndpoint.addr, sizeof(localEndpoint.addr), address); + +#ifdef __TIZEN__ + oc_mutex_lock(g_bleIsServerMutex); + switch (g_adapterType) + { + case ADAPTER_SERVER: + CALEGattServerConnectionStateChanged(isConnected, address); + break; + case ADAPTER_CLIENT: + CALEGattConnectionStateChanged(isConnected, address); + break; + case ADAPTER_BOTH_CLIENT_SERVER: + CALEGattConnectionStateChanged(isConnected, address); + CALEGattServerConnectionStateChanged(isConnected, address); + break; + default: + break; + } + oc_mutex_unlock(g_bleIsServerMutex); +#endif + + if(!isConnected) + { +#ifndef SINGLE_THREAD + if(g_bleClientSenderInfo) + { + CALERemoveReceiveQueueData(g_bleClientSenderInfo, address); + } + + if(g_bleServerSenderInfo) + { + CALERemoveReceiveQueueData(g_bleServerSenderInfo, address); + } + + // remove data of send queue. + if (g_bleClientSendQueueHandle) + { + CALERemoveSendQueueData(g_bleClientSendQueueHandle, address); + } + + if (g_bleServerSendQueueHandle) + { + CALERemoveSendQueueData(g_bleServerSendQueueHandle, address); + } +#endif + +#ifdef __WITH_DTLS__ +#if defined(__TIZEN__) && !defined(SINGLE_THREAD) + // CAcloseSslConnection returns CAResult_t instead of void*, but the size is the same and crash shouldn't occur + pthread_t ccThread; + pthread_attr_t attr; + int initAttrRes = -1; + int pthreadCreateRes = -1; + int detachStatusRes = -1; + int memoryAllocationRes = -1; + + do + { + initAttrRes = pthread_attr_init(&attr); + if (initAttrRes != 0) + { + break; + } + CAEndpoint_t *localEndpointCpyPtr = OICMalloc(sizeof(CAEndpoint_t)); + + if(NULL == localEndpointCpyPtr) + { + memoryAllocationRes = -1; + break; + } + else + { + memoryAllocationRes = 0; + } + + (*localEndpointCpyPtr) = localEndpoint; + // this piece of code is reached on the main thread + // CAcloseSslConnection might wait for too long (network + mutexes) and watchdog might kill it + // Asynchronous call protects this function from watchdog + pthreadCreateRes = pthread_create(&ccThread, &attr, (void *(*)(void*))&CAcloseSslConnectionFreeEndpoint, (void*)localEndpointCpyPtr); + + if (pthreadCreateRes != 0) + { + break; + } + detachStatusRes = pthread_detach(ccThread); + }while (0); + + // regardless of CAcloseSslConnection result, the function will continue and g_connectionCallback will be called + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "CAcloseSslConnection pthread_init [%d], mem_alloc [%d] pthread_create [%d], pthread_detach [%d]", + initAttrRes, memoryAllocationRes, pthreadCreateRes, detachStatusRes); +#else + CAcloseSslConnection(&localEndpoint); +#endif +#endif + } + + if (g_connectionCallback) + { + g_connectionCallback(&localEndpoint, isConnected); + } - ca_mutex_lock(g_bleLocalAddressMutex); - OICStrcpy(localEndpoint.addr, - sizeof(localEndpoint.addr), - g_localBLEAddress); - ca_mutex_unlock(g_bleLocalAddressMutex); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); +} + +static void CALEDeviceStateChangedCb(CAAdapterState_t adapter_state) +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); - g_bleAdapterState = adapter_state; - // Start a GattServer/Client if gLeServerStatus is SET - if (CA_LISTENING_SERVER == gLeServerStatus) + if (CA_ADAPTER_ENABLED == adapter_state) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Before CAStartLEGattServer"); - CAStartLEGattServer(); + oc_mutex_lock(g_bleIsServerMutex); + switch (g_adapterType) + { + case ADAPTER_SERVER: + CALEAdapterGattServerStart(); + break; + case ADAPTER_CLIENT: + CALEAdapterGattClientStart(); + break; + case ADAPTER_BOTH_CLIENT_SERVER: + CALEAdapterGattServerStart(); + CALEAdapterGattClientStart(); + break; + default: + break; + } + oc_mutex_unlock(g_bleIsServerMutex); } - else if (CA_DISCOVERY_SERVER == gLeServerStatus) + else { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "Before CAStartBleGattClient"); - CAStartLEGattClient(); + oc_mutex_lock(g_bleIsServerMutex); + switch (g_adapterType) + { + case ADAPTER_SERVER: + CALEAdapterGattServerStop(); + break; + case ADAPTER_CLIENT: + CALEAdapterGattClientStop(); + break; + case ADAPTER_BOTH_CLIENT_SERVER: + CALEAdapterGattServerStop(); + CALEAdapterGattClientStop(); + break; + default: + break; + } + oc_mutex_unlock(g_bleIsServerMutex); } - gLeServerStatus = CA_SERVER_NOTSTARTED; - ca_mutex_lock(g_bleNetworkCbMutex); if (NULL != g_networkCallback) { - g_networkCallback(&localEndpoint, adapter_state); + g_networkCallback(CA_ADAPTER_GATT_BTLE, adapter_state); } else { OIC_LOG(ERROR, CALEADAPTER_TAG, "g_networkCallback is NULL"); } - ca_mutex_unlock(g_bleNetworkCbMutex); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); } static CAResult_t CALEAdapterClientSendData(const CAEndpoint_t *remoteEndpoint, const uint8_t *data, uint32_t dataLen) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); - VERIFY_NON_NULL(data, CALEADAPTER_TAG, "Param data is NULL"); #ifndef SINGLE_THREAD VERIFY_NON_NULL_RET(g_bleClientSendQueueHandle, CALEADAPTER_TAG, "g_bleClientSendQueueHandle is NULL", CA_STATUS_FAILED); - VERIFY_NON_NULL_RET(g_bleClientSendDataMutex, CALEADAPTER_TAG, - "g_bleClientSendDataMutex is NULL", - CA_STATUS_FAILED); - - VERIFY_NON_NULL_RET(g_bleClientSendQueueHandle, CALEADAPTER_TAG, "g_bleClientSendQueueHandle", - CA_STATUS_FAILED); - + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Data Sending to LE layer [%u]", dataLen); - CALEData_t *bleData = CACreateLEData(remoteEndpoint, data, dataLen); + CALEData_t *bleData = CACreateLEData(remoteEndpoint, data, dataLen, NULL); if (!bleData) { OIC_LOG(ERROR, CALEADAPTER_TAG, "Failed to create bledata!"); return CA_MEMORY_ALLOC_FAILED; } // Add message to send queue - ca_mutex_lock(g_bleClientSendDataMutex); - CAQueueingThreadAddData(g_bleClientSendQueueHandle, bleData, sizeof(CALEData_t)); - ca_mutex_unlock(g_bleClientSendDataMutex); + + CAResult_t res = CAQueueingThreadAddData(g_bleClientSendQueueHandle, bleData, + sizeof(CALEData_t)); + if (CA_STATUS_OK != res) + { + CALEDataDestroyer(bleData, sizeof(CALEData_t)); + } #endif - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); return CA_STATUS_OK; } @@ -2073,81 +3429,32 @@ static CAResult_t CALEAdapterServerSendData(const CAEndpoint_t *remoteEndpoint, const uint8_t *data, uint32_t dataLen) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); VERIFY_NON_NULL(data, CALEADAPTER_TAG, "Param data is NULL"); #ifdef SINGLE_THREAD - uint8_t header[CA_HEADER_LENGTH] = { 0 }; - - CAResult_t result = - CAGenerateHeader(header, CA_HEADER_LENGTH, dataLen); - - if (CA_STATUS_OK != result) - { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Generate header failed"); - return CA_STATUS_FAILED; - } - if (!CAIsLEConnected()) { OIC_LOG(ERROR, CALEADAPTER_TAG, "le not conn"); return CA_STATUS_FAILED; } - result = CAUpdateCharacteristicsToAllGattClients(header, CA_HEADER_LENGTH); + CAResult_t result = CALEServerSendDataSingleThread(data, dataLen); if (CA_STATUS_OK != result) { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Update characteristics failed"); + OIC_LOG(ERROR, CALEADAPTER_TAG, "CALEServerSendDataSingleThread failed"); return CA_STATUS_FAILED; } - - const uint32_t dataLimit = dataLen / CA_SUPPORTED_BLE_MTU_SIZE; - for (uint32_t iter = 0; iter < dataLimit; iter++) - { - result = - CAUpdateCharacteristicsToAllGattClients( - data + (iter * CA_SUPPORTED_BLE_MTU_SIZE), - CA_SUPPORTED_BLE_MTU_SIZE); - - if (CA_STATUS_OK != result) - { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Update characteristics failed"); - return CA_STATUS_FAILED; - } - - CALEDoEvents(); - } - - const uint32_t remainingLen = dataLen % CA_SUPPORTED_BLE_MTU_SIZE; - if (remainingLen) - { - result = - CAUpdateCharacteristicsToAllGattClients( - data + (dataLimit * CA_SUPPORTED_BLE_MTU_SIZE), - remainingLen); - if (CA_STATUS_OK != result) - { - OIC_LOG(ERROR, CALEADAPTER_TAG, "Update characteristics failed"); - return CA_STATUS_FAILED; - } - CALEDoEvents(); - } #else VERIFY_NON_NULL_RET(g_bleServerSendQueueHandle, CALEADAPTER_TAG, - "BleClientReceiverQueue is NULL", - CA_STATUS_FAILED); - VERIFY_NON_NULL_RET(g_bleServerSendDataMutex, CALEADAPTER_TAG, - "BleClientSendDataMutex is NULL", - CA_STATUS_FAILED); - - VERIFY_NON_NULL_RET(g_bleServerSendQueueHandle, CALEADAPTER_TAG, "sendQueueHandle", + "g_bleServerSendQueueHandle is NULL", CA_STATUS_FAILED); OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Data Sending to LE layer [%d]", dataLen); CALEData_t * const bleData = - CACreateLEData(remoteEndpoint, data, dataLen); + CACreateLEData(remoteEndpoint, data, dataLen, NULL); if (!bleData) { @@ -2156,13 +3463,16 @@ static CAResult_t CALEAdapterServerSendData(const CAEndpoint_t *remoteEndpoint, } // Add message to send queue - ca_mutex_lock(g_bleServerSendDataMutex); - CAQueueingThreadAddData(g_bleServerSendQueueHandle, - bleData, - sizeof(CALEData_t)); - ca_mutex_unlock(g_bleServerSendDataMutex); + + CAResult_t res = CAQueueingThreadAddData(g_bleServerSendQueueHandle, + bleData, + sizeof(CALEData_t)); + if (CA_STATUS_OK != res) + { + CALEDataDestroyer(bleData, sizeof(CALEData_t)); + } #endif - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); return CA_STATUS_OK; } @@ -2171,25 +3481,37 @@ static CAResult_t CALEAdapterServerReceivedData(const char *remoteAddress, uint32_t dataLength, uint32_t *sentLength) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); //Input validation VERIFY_NON_NULL(data, CALEADAPTER_TAG, "Data is null"); VERIFY_NON_NULL(sentLength, CALEADAPTER_TAG, "Sent data length holder is null"); #ifdef SINGLE_THREAD - if(g_networkPacketReceivedCallback) + CALEDataReceiverHandlerSingleThread(data, dataLength); + + if (g_singleThreadReceiveData->totalDataLen == g_singleThreadReceiveData->recvDataLen) { - CAEndpoint_t endPoint = - { .adapter = CA_ADAPTER_GATT_BTLE }; // will be filled by - // upper layer + if(g_networkPacketReceivedCallback) + { + // will be filled by upper layer + const CASecureEndpoint_t endpoint = + { .endpoint = { .adapter = CA_ADAPTER_GATT_BTLE } }; - g_networkPacketReceivedCallback(&endPoint, data, dataLength); + g_networkPacketReceivedCallback(&endpoint, + g_singleThreadReceiveData->defragData, + g_singleThreadReceiveData->recvDataLen); + } + g_singleThreadReceiveData->remoteEndpoint = NULL; + OICFree(g_singleThreadReceiveData->defragData); + g_singleThreadReceiveData->defragData = NULL; + OICFree(g_singleThreadReceiveData); + g_singleThreadReceiveData = NULL; } #else - VERIFY_NON_NULL_RET(g_bleReceiverQueue, + VERIFY_NON_NULL_RET(g_bleServerReceiverQueue, CALEADAPTER_TAG, - "g_bleReceiverQueue", + "g_bleServerReceiverQueue", CA_STATUS_FAILED); //Add message to data queue @@ -2208,11 +3530,11 @@ static CAResult_t CALEAdapterServerReceivedData(const char *remoteAddress, // Create bleData to add to queue OIC_LOG_V(DEBUG, CALEADAPTER_TAG, - "Data received from LE layer [%d]", + "Data received from LE Server layer [%d]", dataLength); CALEData_t * const bleData = - CACreateLEData(remoteEndpoint, data, dataLength); + CACreateLEData(remoteEndpoint, data, dataLength, g_bleServerSenderInfo); if (!bleData) { @@ -2223,11 +3545,11 @@ static CAResult_t CALEAdapterServerReceivedData(const char *remoteAddress, CAFreeEndpoint(remoteEndpoint); // Add message to receiver queue - CAQueueingThreadAddData(g_bleReceiverQueue, bleData, sizeof(CALEData_t)); + CAQueueingThreadAddData(g_bleServerReceiverQueue, bleData, sizeof(CALEData_t)); *sentLength = dataLength; #endif - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); return CA_STATUS_OK; } @@ -2236,13 +3558,12 @@ static CAResult_t CALEAdapterClientReceivedData(const char *remoteAddress, uint32_t dataLength, uint32_t *sentLength) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); - //Input validation VERIFY_NON_NULL(data, CALEADAPTER_TAG, "Data is null"); VERIFY_NON_NULL(sentLength, CALEADAPTER_TAG, "Sent data length holder is null"); #ifndef SINGLE_THREAD - VERIFY_NON_NULL_RET(g_bleReceiverQueue, CALEADAPTER_TAG, "g_bleReceiverQueue", + VERIFY_NON_NULL_RET(g_bleClientReceiverQueue, CALEADAPTER_TAG, + "g_bleClientReceiverQueue", CA_STATUS_FAILED); //Add message to data queue @@ -2255,10 +3576,15 @@ static CAResult_t CALEAdapterClientReceivedData(const char *remoteAddress, return CA_STATUS_FAILED; } - OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "Data received from LE layer [%u]", dataLength); - // Create bleData to add to queue - CALEData_t *bleData = CACreateLEData(remoteEndpoint, data, dataLength); + OIC_LOG_V(DEBUG, + CALEADAPTER_TAG, + "Data received from LE Client layer [%u]", + dataLength); + + CALEData_t * const bleData = + CACreateLEData(remoteEndpoint, data, dataLength, g_bleClientSenderInfo); + if (!bleData) { OIC_LOG(ERROR, CALEADAPTER_TAG, "Failed to create bledata!"); @@ -2268,36 +3594,23 @@ static CAResult_t CALEAdapterClientReceivedData(const char *remoteAddress, CAFreeEndpoint(remoteEndpoint); // Add message to receiver queue - CAQueueingThreadAddData(g_bleReceiverQueue, bleData, sizeof(CALEData_t)); + CAQueueingThreadAddData(g_bleClientReceiverQueue, bleData, sizeof(CALEData_t)); *sentLength = dataLength; #endif - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); return CA_STATUS_OK; } static void CASetLEAdapterThreadPoolHandle(ca_thread_pool_t handle) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); - - ca_mutex_lock(g_bleAdapterThreadPoolMutex); g_bleAdapterThreadPool = handle; - ca_mutex_unlock(g_bleAdapterThreadPoolMutex); - - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); + } static void CASetLEReqRespAdapterCallback(CANetworkPacketReceivedCallback callback) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "IN"); - - ca_mutex_lock(g_bleAdapterReqRespCbMutex); - g_networkPacketReceivedCallback = callback; - ca_mutex_unlock(g_bleAdapterReqRespCbMutex); - - OIC_LOG(DEBUG, CALEADAPTER_TAG, "OUT"); } static void CALEErrorHandler(const char *remoteAddress, @@ -2305,7 +3618,7 @@ static void CALEErrorHandler(const char *remoteAddress, uint32_t dataLen, CAResult_t result) { - OIC_LOG(DEBUG, CALEADAPTER_TAG, "CALEErrorHandler IN"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); VERIFY_NON_NULL_VOID(data, CALEADAPTER_TAG, "Data is null"); @@ -2319,5 +3632,179 @@ static void CALEErrorHandler(const char *remoteAddress, CAFreeEndpoint(rep); - OIC_LOG(DEBUG, CALEADAPTER_TAG, "CALEErrorHandler OUT"); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); +} + +#ifndef SINGLE_THREAD +static bool CALEClearQueueAddressDataContext(void *data, uint32_t size, void *ctx) +{ + if (NULL == data || NULL == ctx) + { + return false; + } + + CALEData_t *caLeData = (CALEData_t *)data; + const char *address = (const char *)ctx; + + if (NULL != caLeData && NULL != caLeData->remoteEndpoint) + { + if (!strcasecmp(caLeData->remoteEndpoint->addr, address)) + { + return true; + } + } + return false; +} + +static void CALERemoveSendQueueData(CAQueueingThread_t *queueHandle, const char* address) +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + + VERIFY_NON_NULL_VOID(queueHandle, CALEADAPTER_TAG, "queueHandle"); + VERIFY_NON_NULL_VOID(address, CALEADAPTER_TAG, "address"); + + CAResult_t res = CAQueueingThreadClearContextData(queueHandle, + CALEClearQueueAddressDataContext, + address); + if (CA_STATUS_OK != res) + { + + OIC_LOG(ERROR, CALEADAPTER_TAG, "Could not clear the send queue"); + } + +} + +static void CALERemoveReceiveQueueData(u_arraylist_t *dataInfoList, const char* address) +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "%s", __func__); + + VERIFY_NON_NULL_VOID(dataInfoList, CALEADAPTER_TAG, "dataInfoList"); + VERIFY_NON_NULL_VOID(address, CALEADAPTER_TAG, "address"); + + CABLESenderInfo_t *senderInfo = NULL; + uint32_t senderIndex = 0; + + u_arraylist_t *portList = u_arraylist_create(); + if (CA_STATUS_OK == CALEGetPortsFromSenderInfo(address, dataInfoList, portList)) + { + uint32_t arrayLength = u_arraylist_length(portList); + for (uint32_t i = 0; i < arrayLength; i++) + { + uint16_t *port = (uint16_t *)u_arraylist_get(portList, i); + if (!port) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "Failed to get port from sender info !"); + u_arraylist_destroy(portList); + return; + } + + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "port : %X", *port); + + if (CA_STATUS_OK == CALEGetSenderInfo(address, *port, + dataInfoList, &senderInfo, + &senderIndex)) + { + OIC_LOG(DEBUG, CALEADAPTER_TAG, + "SenderInfo is removed for disconnection"); + CALERemoveSenderInfoFromList(dataInfoList, senderInfo); + CALEFreeSenderInfo(senderInfo); + } + else + { + OIC_LOG(DEBUG, CALEADAPTER_TAG, "SenderInfo doesn't exist"); + } + } + } + u_arraylist_destroy(portList); +} + +static CAResult_t CALEGetPortsFromSenderInfo(const char *leAddress, + u_arraylist_t *senderInfoList, + u_arraylist_t *portList) +{ + VERIFY_NON_NULL(leAddress, + CALEADAPTER_TAG, + "NULL BLE address argument"); + + const uint32_t listLength = u_arraylist_length(senderInfoList); + const uint32_t addrLength = strlen(leAddress); + + for (uint32_t index = 0; index < listLength; index++) + { + CABLESenderInfo_t *info = (CABLESenderInfo_t *) u_arraylist_get(senderInfoList, index); + if (!info || !(info->remoteEndpoint)) + { + continue; + } + + if (!strncmp(info->remoteEndpoint->addr, leAddress, addrLength)) + { + uint16_t *port = (uint16_t *)OICMalloc(sizeof(uint16_t)); + if (!port) + { + OIC_LOG(ERROR, CALEADAPTER_TAG, "memory allocation failed!"); + return CA_MEMORY_ALLOC_FAILED; + } + *port = info->remoteEndpoint->port; + u_arraylist_add(portList, (void *)port); + } + } + + if (u_arraylist_length(portList) != 0) + { + return CA_STATUS_OK; + } + else + { + return CA_STATUS_FAILED; + } +} +#endif + +void CALEStartGattServer() +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); + + oc_mutex_lock(g_bleIsServerMutex); + switch (g_adapterType) + { + case ADAPTER_SERVER: + CALEAdapterGattServerStart(); + break; + case ADAPTER_CLIENT: + CALEAdapterGattClientStart(); + break; + case ADAPTER_BOTH_CLIENT_SERVER: + CALEAdapterGattServerStart(); + CALEAdapterGattClientStart(); + break; + default: + break; + } + oc_mutex_unlock(g_bleIsServerMutex); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); +} + +void CALEStopGattServer() +{ + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "IN %s", __func__); + + oc_mutex_lock(g_bleIsServerMutex); + switch (g_adapterType) + { + case ADAPTER_SERVER: + CALEAdapterGattServerStop(); + break; + case ADAPTER_CLIENT: + CALEAdapterGattClientStop(); + break; + case ADAPTER_BOTH_CLIENT_SERVER: + CALEAdapterGattServerStop(); + CALEAdapterGattClientStop(); + break; + default: + break; + } + oc_mutex_unlock(g_bleIsServerMutex); + OIC_LOG_V(DEBUG, CALEADAPTER_TAG, "OUT %s", __func__); }