bt-service-adaptation/services/adapter/bt-service-core-adapter-le.c

   1 /*
   2  * Copyright (c) 2016 2017 Samsung Electronics Co., Ltd All Rights Reserved
   3  *
   4  * Contact: Anupam Roy <anupam.r@samsung.com>
   5  *
   6  * Licensed under the Apache License, Version 2.0 (the "License");
   7  * you may not use this file except in compliance with the License.
   8  * You may obtain a copy of the License at
   9  *
  10  *              http://www.apache.org/licenses/LICENSE-2.0
  11  *
  12  * Unless required by applicable law or agreed to in writing, software
  13  * distributed under the License is distributed on an "AS IS" BASIS,
  14  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  15  * See the License for the specific language governing permissions and
  16  * limitations under the License.
  17  *
  18  */
  19
  20 #include <stdio.h>
  21 #include <gio/gio.h>
  22 #include <glib.h>
  23 #include <dlog.h>
  24 #include <string.h>
  25 #include <vconf.h>
  26
  27 #include "bt-internal-types.h"
  28 #include "bt-service-common.h"
  29 #include "bt-service-event.h"
  30 #include "bt-service-core-adapter.h"
  31 #include "bt-service-core-adapter-le.h"
  32 #include "bt-service-event-receiver.h"
  33 #include "bt-service-gatt.h"
  34 #include "bt-service-util.h"
  35 #include "bt-service-core-device.h"
  36
  37 #include <oal-hardware.h>
  38 #include <oal-manager.h>
  39 #include <oal-event.h>
  40 #include <oal-adapter-mgr.h>
  41 #include <oal-device-mgr.h>
  42 #include <oal-gatt.h>
  43
  44 #define BT_UUID_128 16
  45 #define BT_ADV_DEFAULT_TIMEOUT 0
  46 #define BT_ADV_DEFAULT_TX_POWER 4
  47 #define BT_ADV_DEFAULT_CHANNEL_MAP 0
  48
  49 static const char BASE_UUID_CONVERTED[BT_UUID_128] = {
  50         0xfb, 0x34, 0x9b, 0x5f, 0x80, 0x00, 0x00, 0x80,
  51         0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
  52 };
  53
  54 typedef struct {
  55         int adv_inst_max;
  56         int rpa_offloading;
  57         int max_filter;
  58         int le_2m_phy;
  59         int le_coded_phy;
  60 } bt_adapter_le_feature_info_t;
  61
  62 /* Set Default values */
  63 static bt_adapter_le_feature_info_t le_feature_info = {1, 0, 0, 0, 0};
  64
  65 typedef struct {
  66         int adv_handle;
  67         char *sender;
  68         int data_len;
  69         unsigned char data[31];
  70         gboolean is_adv;/* Adv or Scan Response: Only applicable if is_data_set_pending is TRUE */
  71         gboolean is_data_set_pending; /* Data Set pending or Adv enable request at one time */
  72         gboolean is_custom_adv; /* If Adv enable is custom adv enable request */
  73         bluetooth_advertising_params_t params; /* Adv Parameters */
  74 } bt_pending_adv_data_set_t;
  75
  76 static guint timer_id = 0;
  77
  78 static GSList *adv_data_pending_list = NULL;
  79 static bt_le_status_t adapter_le_state = BT_LE_DEACTIVATED;
  80 static bt_le_discovery_state_t adapter_le_discovery_state = LE_DISCOVERY_STOPPED;
  81
  82 /******************************************* LE Scan *********************************************/
  83 #define BT_LE_SCAN_INTERVAL_MIN 2.5
  84 #define BT_LE_SCAN_INTERVAL_MAX 10240
  85 #define BT_LE_SCAN_WINDOW_MIN 2.5
  86 #define BT_LE_SCAN_WINDOW_MAX 10240
  87
  88 #define BT_ADV_INTERVAL_SPLIT 0.625
  89
  90 typedef struct {
  91         char *sender;
  92         GSList *filter_list;
  93         gboolean is_scanning;
  94 } bt_adapter_le_scanner_t;
  95
  96 GSList *scanner_list = NULL;
  97 static gboolean is_le_set_scan_parameter = FALSE;
  98 static gboolean is_le_scanning = FALSE;
  99
 100 static int g_gatt_client_id = 0;
 101
 102 /******************************************* LE Scan *********************************************/
 103
 104 void _bt_adapter_set_le_status(bt_le_status_t status)
 105 {
 106         BT_INFO("adapter_le_state changed [%d] -> [%d]", adapter_le_state, status);
 107         adapter_le_state = status;
 108 }
 109
 110 bt_le_status_t _bt_adapter_get_le_status(void)
 111 {
 112         return adapter_le_state;
 113 }
 114
 115
 116 /* Internal functions of core adapter service */
 117 static void __bt_le_handle_pending_requests(int service_function, void *user_data, unsigned int size)
 118 {
 119         GSList *l;
 120         GArray *out_param;
 121         invocation_info_t *req_info;
 122         BT_INFO("+");
 123
 124         /* Get method invocation context */
 125         for (l = _bt_get_invocation_list(); l != NULL; l = g_slist_next(l)) {
 126                 req_info = l->data;
 127                 if (req_info == NULL || req_info->service_function != service_function)
 128                         continue;
 129
 130                 /* Create out param */
 131                 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
 132
 133                 switch (service_function) {
 134                 case BT_ENABLE_ADAPTER_LE:
 135                 case BT_DISABLE_ADAPTER_LE: {
 136                         gboolean done = TRUE;
 137                         g_array_append_vals(out_param, &done, sizeof(gboolean));
 138                         break;
 139                 }
 140                 default:
 141                         BT_ERR("Unknown service function[%d]", service_function);
 142                 }
 143
 144                 _bt_service_method_return(req_info->context, out_param, req_info->result);
 145                 g_array_free(out_param, TRUE);
 146                 /* Now free invocation info for this request*/
 147                 _bt_free_info_from_invocation_list(req_info);
 148         }
 149 }
 150
 151
 152 /* Request return handlings */
 153 static gboolean __bt_le_post_set_enabled(gpointer user_data)
 154 {
 155         BT_INFO("__bt_adapter_post_set_enabled>>");
 156
 157         /* Add LE enabled post processing codes */
 158
 159         return FALSE;
 160 }
 161
 162
 163 static gboolean __bt_le_post_set_disabled(gpointer user_data)
 164 {
 165         BT_INFO("_bt_adapter_post_set_disabled>>");
 166
 167         /* Add LE disabled post processing codes */
 168
 169         return FALSE;
 170 }
 171
 172 static void __bt_le_update_bt_enabled(void)
 173 {
 174         int result = BLUETOOTH_ERROR_NONE;
 175         BT_ERR("_bt_adapter_update_bt_enabled>>");
 176         /* Update Bluetooth Status to notify other modules */
 177         if (vconf_set_int(VCONFKEY_BT_LE_STATUS, VCONFKEY_BT_LE_STATUS_ON) != 0)
 178                 BT_ERR("Set vconf failed\n");
 179
 180         /* TODO:Add timer function to handle any further post processing */
 181         g_idle_add((GSourceFunc)__bt_le_post_set_enabled, NULL);
 182
 183         /*Return BT_ADAPTER_ENABLE Method invocation context */
 184         __bt_le_handle_pending_requests(BT_ENABLE_ADAPTER_LE, NULL, 0);
 185         /*Send BT Enabled event to application */
 186         _bt_send_event(BT_LE_ADAPTER_EVENT, BLUETOOTH_EVENT_LE_ENABLED,
 187                         g_variant_new("(i)", result));
 188 }
 189
 190 static void __bt_le_update_bt_disabled(void)
 191 {
 192         int result = BLUETOOTH_ERROR_NONE;
 193         BT_INFO("_bt_adapter_update_bt_disabled>>");
 194
 195         int power_off_status = 0;
 196         int ret;
 197
 198         /* Update the vconf LE status in normal Deactivation case only */
 199         ret = vconf_get_int(VCONFKEY_SYSMAN_POWER_OFF_STATUS, &power_off_status);
 200         BT_DBG("ret : %d, power_off_status : %d", ret, power_off_status);
 201
 202         /* Update LE Status to notify other modules */
 203         if (vconf_set_int(VCONFKEY_BT_LE_STATUS, VCONFKEY_BT_LE_STATUS_OFF) != 0)
 204                 BT_ERR("Set vconf failed");
 205
 206         /* TODO:Add timer function to handle any further post processing */
 207         g_idle_add((GSourceFunc)__bt_le_post_set_disabled, NULL);
 208
 209         /* Return BT_ADAPTER_DISABLE Method invocation context */
 210         __bt_le_handle_pending_requests(BT_DISABLE_ADAPTER_LE, NULL, 0);
 211
 212         /* Send BT Disabled event to application */
 213         _bt_send_event(BT_LE_ADAPTER_EVENT, BLUETOOTH_EVENT_LE_DISABLED,
 214                         g_variant_new("(i)", result));
 215 }
 216
 217
 218 static void __bt_set_le_scan_status(gboolean mode)
 219 {
 220         is_le_scanning = mode;
 221 }
 222
 223 gboolean _bt_is_le_scanning(void)
 224 {
 225         return is_le_scanning;
 226 }
 227
 228 bt_adapter_le_scanner_t* __bt_find_scanner_from_list(const char *sender)
 229 {
 230         GSList *l;
 231         bt_adapter_le_scanner_t *scanner;
 232
 233         for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
 234                 scanner = l->data;
 235                 if (g_strcmp0(scanner->sender, sender) == 0)
 236                         return scanner;
 237         }
 238
 239         return NULL;
 240 }
 241
 242 /* Event handlers */
 243 static void __bt_adapter_le_handle_pending_request_info(int result,
 244                 int service_function, void *param, unsigned int size)
 245 {
 246         GSList *l;
 247         GArray *out_param;
 248         invocation_info_t *req_info = NULL;
 249         BT_DBG("+");
 250
 251         for (l = _bt_get_invocation_list(); l != NULL; ) {
 252                 req_info = l->data;
 253                 l = g_slist_next(l);
 254                 if (req_info == NULL || req_info->service_function != service_function)
 255                         continue;
 256
 257                 switch (service_function) {
 258                 case BT_SET_ADVERTISING:
 259                 case BT_SET_CUSTOM_ADVERTISING:
 260                 case BT_SET_ADVERTISING_DATA:
 261                 case BT_SET_SCAN_RESPONSE_DATA: {
 262                         int *saved_handle;
 263                         bt_pending_adv_data_set_t *data;
 264
 265                         BT_DBG("Service function: [%d]", service_function);
 266                         ret_if(param == NULL);
 267
 268                         saved_handle = (int*)req_info->user_data;
 269                         data = (bt_pending_adv_data_set_t*)param;
 270                         BT_DBG("Current Sender [%s] Current Handle [%d]", data->sender, data->adv_handle);
 271
 272                         if (!g_strcmp0(req_info->sender, data->sender) && (*saved_handle == data->adv_handle)) {
 273                                 BT_DBG("Requester found [%s] ADV Handle [%d]", req_info->sender, *saved_handle);
 274                                 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
 275                                 g_array_append_vals(out_param, &data->adv_handle, sizeof(int));
 276                                 _bt_service_method_return(req_info->context, out_param, result);
 277
 278                                 /* Free data */
 279                                 g_free(req_info->user_data);
 280                                 _bt_free_info_from_invocation_list(req_info);
 281                                 g_array_free(out_param, TRUE);
 282                         }
 283                         break;
 284                 }
 285                 case BT_START_LE_DISCOVERY: {
 286                         bt_adapter_le_scanner_t *scanner;
 287
 288                         BT_DBG("Request Sender: [%s]", req_info->sender);
 289                         if (BLUETOOTH_ERROR_NONE != result) {
 290                                 scanner = __bt_find_scanner_from_list(req_info->sender);
 291                                 if (scanner && scanner->is_scanning)
 292                                         scanner->is_scanning = FALSE;
 293                         }
 294
 295                         out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
 296                         _bt_service_method_return(req_info->context, out_param, result);
 297                         _bt_free_info_from_invocation_list(req_info);
 298                         g_array_free(out_param, TRUE);
 299                         break;
 300                 }
 301                 case BT_STOP_LE_DISCOVERY: {
 302                         BT_DBG("Request Sender: [%s]", req_info->sender);
 303                         out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
 304                         _bt_service_method_return(req_info->context, out_param, result);
 305                         _bt_free_info_from_invocation_list(req_info);
 306                         g_array_free(out_param, TRUE);
 307                         break;
 308                 }
 309                 default:
 310                         break;
 311                 }
 312         }
 313         BT_DBG("-");
 314 }
 315
 316 static void __bt_le_handle_server_instance_registered(event_gatts_register_t *data)
 317 {
 318         int adv_handle;
 319         GSList *l;
 320         char uuid_string[BLUETOOTH_UUID_STRING_MAX];
 321         bluetooth_advertising_data_t adv;
 322         bluetooth_scan_resp_data_t scan_rsp;
 323         int result = BLUETOOTH_ERROR_NONE;
 324         bt_pending_adv_data_set_t *info = NULL;
 325
 326         memset(adv.data, 0, sizeof(adv.data));
 327         memset(scan_rsp.data, 0, sizeof(scan_rsp.data));
 328
 329         _bt_uuid_to_string(&(data->server_uuid), uuid_string);
 330         BT_INFO("Instance ID is Intialized [%d] UUID initialized [%s]", data->server_inst, uuid_string);
 331
 332         /* Get sender and adv handle for the server instance */
 333         _bt_get_adv_handle_from_instance(data->server_inst, &adv_handle);
 334
 335                 /* Check if pending Adv Data set or Scan response data set request is pending*/
 336                 for (l = adv_data_pending_list; l != NULL; l = l->next) {
 337                         info = l->data;
 338
 339                         if (info && (adv_handle == info->adv_handle)) {
 340                                 if (info->is_data_set_pending) {
 341                                         BT_INFO("LE Data set request is pending");
 342                                         if (info->is_adv) {
 343                                                 memcpy(&adv.data, info->data, info->data_len);
 344                                                 result = _bt_set_advertising_data(info->sender,
 345                                                         info->adv_handle, &adv, info->data_len, FALSE);
 346                                                 if (result != BLUETOOTH_ERROR_NONE) {
 347                                                         __bt_adapter_le_handle_pending_request_info(result,
 348                                                                 BT_SET_ADVERTISING_DATA,
 349                                                                 (void*)info, sizeof(bt_pending_adv_data_set_t));
 350                                                 }
 351                                                 goto data_free;
 352                                         } else {
 353                                                 memcpy(&scan_rsp.data, info->data, info->data_len);
 354                                                 result = _bt_set_scan_response_data(info->sender,
 355                                                                 info->adv_handle, &scan_rsp, info->data_len, FALSE);
 356                                                 if (result != BLUETOOTH_ERROR_NONE) {
 357                                                         __bt_adapter_le_handle_pending_request_info(result,
 358                                                                 BT_SET_SCAN_RESPONSE_DATA, (void*)info,
 359                                                                 sizeof(bt_pending_adv_data_set_t));
 360                                                 }
 361                                                 goto data_free;
 362                                         }
 363                                 } else {
 364                                         BT_INFO("LE Enable Adv request is pending");
 365                                         if (info->is_custom_adv) {
 366                                                 result = _bt_set_custom_advertising(info->sender, info->adv_handle,
 367                                                                         TRUE, &info->params, FALSE/*Reserved Slot*/);
 368                                                 if (result != BLUETOOTH_ERROR_NONE) {
 369                                                         __bt_adapter_le_handle_pending_request_info(result,
 370                                                                 BT_SET_CUSTOM_ADVERTISING,
 371                                                                 (void*)info, sizeof(bt_pending_adv_data_set_t));
 372                                                 }
 373                                                 goto data_free;
 374                                         } else {
 375                                                 result = _bt_set_advertising(info->sender, info->adv_handle,
 376                                                                 TRUE, FALSE/*Reserved Slot*/);
 377                                                 if (result != BLUETOOTH_ERROR_NONE) {
 378                                                         __bt_adapter_le_handle_pending_request_info(result,
 379                                                                 BT_SET_ADVERTISING,
 380                                                                 (void*)info, sizeof(bt_pending_adv_data_set_t));
 381                                                 }
 382                                                 goto data_free;
 383                                 }
 384                         }
 385                 }
 386         }
 387         BT_DBG("-");
 388         return;
 389
 390 data_free:
 391         adv_data_pending_list = g_slist_remove(adv_data_pending_list, info);
 392         g_free(info->sender);
 393         g_free(info);
 394 }
 395
 396 static void __bt_le_multi_advertising_enabled(event_ble_multiadv_status *event)
 397 {
 398         char *sender;
 399         int adv_handle;
 400         bt_pending_adv_data_set_t *info = NULL;
 401         GVariant *param = NULL;
 402         int result = BLUETOOTH_ERROR_NONE;
 403
 404         sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
 405         if (sender == NULL) {
 406                 BT_ERR("Abnormal!!");
 407         } else {
 408                 if (event->status != OAL_STATUS_SUCCESS)
 409                         result = BLUETOOTH_ERROR_INTERNAL;
 410                 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
 411                 info->sender = sender;
 412                 info->adv_handle = adv_handle;
 413                 __bt_adapter_le_handle_pending_request_info(result,
 414                                 BT_SET_CUSTOM_ADVERTISING,
 415                                 (void*)info, sizeof(bt_pending_adv_data_set_t));
 416                 __bt_adapter_le_handle_pending_request_info(result,
 417                                 BT_SET_ADVERTISING,
 418                                 (void*)info, sizeof(bt_pending_adv_data_set_t));
 419
 420                 /* Send event */
 421                 param = g_variant_new("(ii)", result, info->adv_handle);
 422                 _bt_send_event_to_dest(info->sender, BT_ADAPTER_EVENT, BLUETOOTH_EVENT_ADVERTISING_STARTED, param);
 423
 424                 /* Free data */
 425                 g_free(info->sender);
 426                 g_free(info);
 427         }
 428 }
 429
 430 static void __bt_le_multi_advertising_disabled(event_ble_multiadv_status *event)
 431 {
 432         char *sender;
 433         int adv_handle;
 434         bt_pending_adv_data_set_t *info = NULL;
 435         GVariant *param = NULL;
 436         int result = BLUETOOTH_ERROR_NONE;
 437         sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
 438
 439         if (sender == NULL) {
 440                 BT_INFO("Means application containing the adv info is already freed!!");
 441         } else {
 442                 if (event->status != OAL_STATUS_SUCCESS)
 443                         result = BLUETOOTH_ERROR_INTERNAL;
 444                 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
 445                 info->sender = sender;
 446                 info->adv_handle = adv_handle;
 447                 __bt_adapter_le_handle_pending_request_info(result,
 448                                 BT_SET_CUSTOM_ADVERTISING,
 449                                 (void*)info, sizeof(bt_pending_adv_data_set_t));
 450                 __bt_adapter_le_handle_pending_request_info(result,
 451                                 BT_SET_ADVERTISING,
 452                                 (void*)info, sizeof(bt_pending_adv_data_set_t));
 453                 /* Send event */
 454                 param = g_variant_new("(ii)", result, info->adv_handle);
 455                 _bt_send_event_to_dest(info->sender, BT_ADAPTER_EVENT, BLUETOOTH_EVENT_ADVERTISING_STOPPED, param);
 456
 457                 /* Free allocated slot or server instance from stack to be used for other advertisng */
 458                 result = _bt_unregister_server_instance(sender, adv_handle);
 459
 460                 /* Free data */
 461                 g_free(info->sender);
 462                 g_free(info);
 463         }
 464 }
 465
 466 static void __bt_le_multi_advertising_set_data(event_ble_multiadv_status *event)
 467 {
 468         char *sender = NULL;
 469         int adv_handle;
 470         bt_pending_adv_data_set_t *info = NULL;
 471         int result = BLUETOOTH_ERROR_NONE;
 472         sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
 473
 474         if (sender == NULL) {
 475                 BT_ERR("Abnormal!!");
 476         } else {
 477                 BT_DBG("Sender [%s], adv handle [%d]",  sender, adv_handle);
 478                 if (event->status != OAL_STATUS_SUCCESS)
 479                         result = BLUETOOTH_ERROR_INTERNAL;
 480
 481                 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
 482                 info->sender = sender;
 483                 info->adv_handle = adv_handle;
 484                 BT_DBG("Sender [%s], adv handle [%d]",  info->sender, info->adv_handle);
 485                 __bt_adapter_le_handle_pending_request_info(result,
 486                                 BT_SET_SCAN_RESPONSE_DATA,
 487                                 (void*)info, sizeof(bt_pending_adv_data_set_t));
 488                 __bt_adapter_le_handle_pending_request_info(result,
 489                                 BT_SET_ADVERTISING_DATA,
 490                                 (void*)info, sizeof(bt_pending_adv_data_set_t));
 491                 g_free(info->sender);
 492                 g_free(info);
 493         }
 494 }
 495
 496 static int __get_advertisement_data(unsigned char *dest, unsigned char *src)
 497 {
 498         int length = 0;
 499         int i = 0;
 500
 501         while (i <= 31) {
 502                 int len = src[i];
 503
 504                 if ((len == 0) || (31 < (i + len))) {
 505                         BT_INFO("length: %d", length);
 506                         memcpy(dest, src, length);
 507                         break;
 508                 }
 509
 510                 length += (len + 1);
 511                 i += (len + 1);
 512         }
 513
 514         return length;
 515 }
 516
 517 static void __bt_le_handle_device_found(event_ble_scan_result_info *scan_result)
 518 {
 519         int result = BLUETOOTH_ERROR_NONE;
 520         bt_adapter_le_scanner_t *scanner = NULL;
 521         char address[BT_ADDRESS_STRING_SIZE];
 522         int addr_type = 0x01; /* TODO: Need to get correct address type */
 523         unsigned char adv_ind_data[31];
 524         unsigned char scan_resp_data[31];
 525         int adv_ind_len = 0;
 526         int scan_resp_len = 0;
 527         char *tmp_str = NULL;
 528         GVariant *scan_data_param;
 529         GVariant *adv_data_param;
 530         GVariant *param;
 531         GSList *l;
 532
 533         BT_DBG("+");
 534         ret_if(NULL == scan_result);
 535
 536         _bt_convert_addr_type_to_string(address, scan_result->address.addr);
 537
 538         memset(adv_ind_data, 0x00, sizeof(adv_ind_data));
 539         adv_ind_len = __get_advertisement_data(
 540                         adv_ind_data, &(scan_result->adv_data[0]));
 541
 542         memset(scan_resp_data, 0x00, sizeof(scan_resp_data));
 543         scan_resp_len = __get_advertisement_data(
 544                         scan_resp_data, &(scan_result->adv_data[adv_ind_len]));
 545
 546         BT_INFO("Address: %s, RSSI: %d, adv_ind_len: %d, scan_resp_len: %d",
 547                         address, scan_result->rssi, adv_ind_len, scan_resp_len);
 548
 549         tmp_str = _bt_service_convert_hex_to_string(scan_result->adv_data, 62);
 550         BT_INFO("Complete Data: [%s]", tmp_str);
 551         g_free(tmp_str);
 552         tmp_str = NULL;
 553
 554         tmp_str = _bt_service_convert_hex_to_string(adv_ind_data, adv_ind_len);
 555         BT_INFO("Adv Ind Data: [%s]", tmp_str);
 556         g_free(tmp_str);
 557         tmp_str = NULL;
 558
 559         tmp_str = _bt_service_convert_hex_to_string(scan_resp_data, scan_resp_len);
 560         BT_INFO("Scan resp Data: [%s]", tmp_str);
 561         g_free(tmp_str);
 562         tmp_str = NULL;
 563
 564         for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
 565                 scanner = l->data;
 566                 if (scanner->is_scanning == FALSE)
 567                         continue;
 568
 569                 adv_data_param = g_variant_new_from_data((const GVariantType *)"ay",
 570                                 adv_ind_data, adv_ind_len, TRUE, NULL, NULL);
 571                 scan_data_param = g_variant_new_from_data((const GVariantType *)"ay",
 572                                 scan_resp_data, scan_resp_len, TRUE, NULL, NULL);
 573
 574                 param = g_variant_new("(isnnn@ayn@ay)",
 575                                 result, address,
 576                                 addr_type, scan_result->rssi,
 577                                 adv_ind_len, adv_data_param,
 578                                 scan_resp_len, scan_data_param);
 579
 580                 _bt_send_event_to_dest(scanner->sender, BT_LE_ADAPTER_EVENT,
 581                                 BLUETOOTH_EVENT_REMOTE_LE_DEVICE_FOUND, param);
 582         }
 583
 584         BT_DBG("-");
 585 }
 586
 587 static void __bt_le_state_change_callback(int bt_status)
 588 {
 589         BT_INFO("__bt_le_state_change_callback: status [%d]", bt_status);
 590
 591         switch (bt_status) {
 592         case BT_LE_DEACTIVATED:
 593                 _bt_adapter_set_le_status(bt_status);
 594
 595                 /* Add Adapter disabled post processing codes */
 596                 __bt_le_update_bt_disabled();
 597                 break;
 598         case BT_LE_ACTIVATED:
 599                 _bt_adapter_set_le_status(bt_status);
 600
 601                 /* Add Adapter enabled post processing codes */
 602                 if (timer_id > 0) {
 603                         BT_DBG("g_source is removed");
 604                         g_source_remove(timer_id);
 605                         timer_id = 0;
 606                 }
 607                 __bt_le_update_bt_enabled();
 608                 break;
 609         default:
 610                 BT_ERR("Incorrect Bluetooth adapter state changed status");
 611                 break;
 612
 613         }
 614 }
 615
 616 static void __bt_le_event_handler(int event_type, gpointer event_data)
 617 {
 618         BT_INFO("OAL event = 0x%x, \n", event_type);
 619
 620         switch (event_type) {
 621         case OAL_EVENT_BLE_ENABLED: {
 622                 __bt_le_state_change_callback(BT_LE_ACTIVATED);
 623                 break;
 624         }
 625         case OAL_EVENT_BLE_DISABLED: {
 626                 __bt_le_state_change_callback(BT_LE_DEACTIVATED);
 627                 break;
 628         }
 629         case OAL_EVENT_BLE_SERVER_INSTANCE_INITIALISED: {
 630                 BT_INFO("OAL Event: Server Instance Registered");
 631                 __bt_le_handle_server_instance_registered((event_gatts_register_t *)event_data);
 632                 break;
 633         }
 634         case OAL_EVENT_BLE_ADVERTISING_STARTED: {
 635                 BT_INFO("OAL Event: Legacy Advertising Enabled: Not Supported!!");
 636                 break;
 637         }
 638         case OAL_EVENT_BLE_ADVERTISING_STOPPED: {
 639                 BT_INFO("OAL Event: Legacy Advertising Disabled: Not Supported!!");
 640                 break;
 641         }
 642         case OAL_EVENT_BLE_MULTI_ADVERTISING_ENABLE: {
 643                 BT_INFO("OAL Event: Advertising Enabled");
 644                 __bt_le_multi_advertising_enabled((event_ble_multiadv_status *)event_data);
 645                 break;
 646         }
 647         case OAL_EVENT_BLE_MULTI_ADVERTISING_DISABLE: {
 648                 BT_INFO("OAL Event: Advertising Disabled");
 649                 __bt_le_multi_advertising_disabled((event_ble_multiadv_status *)event_data);
 650                 break;
 651         }
 652         case OAL_EVENT_BLE_MULTI_ADVERTISING_SET_INST_DATA: {
 653                 BT_INFO("OAL Event: Advertising Data set successfully");
 654                 __bt_le_multi_advertising_set_data((event_ble_multiadv_status *)event_data);
 655                 break;
 656         }
 657         case OAL_EVENT_BLE_MULTI_ADVERTISING_UPDATE: {
 658                         BT_INFO("OAL Event: Advertising Params updated");
 659                 break;
 660         }
 661         case OAL_EVENT_BLE_DISCOVERY_STARTED: {
 662                 __bt_set_le_scan_status(TRUE);
 663
 664                 __bt_adapter_le_handle_pending_request_info(
 665                                 BLUETOOTH_ERROR_NONE,
 666                                 BT_START_LE_DISCOVERY, NULL, 0);
 667                 break;
 668         }
 669         case OAL_EVENT_BLE_DISCOVERY_STOPPED: {
 670                 if (!_bt_is_le_scanning()) {
 671                         BT_ERR("LE discovery start failed");
 672                         __bt_adapter_le_handle_pending_request_info(
 673                                         BLUETOOTH_ERROR_INTERNAL,
 674                                         BT_START_LE_DISCOVERY, NULL, 0);
 675                         break;
 676                 }
 677
 678                 __bt_set_le_scan_status(FALSE);
 679                 __bt_adapter_le_handle_pending_request_info(
 680                                 BLUETOOTH_ERROR_NONE,
 681                                 BT_STOP_LE_DISCOVERY, NULL, 0);
 682                 break;
 683         }
 684         case OAL_EVENT_BLE_REMOTE_DEVICE_FOUND: {
 685                 event_ble_scan_result_info *scan_result = event_data;
 686                 BT_INFO("OAL Event: OAL_EVENT_BLE_REMOTE_DEVICE_FOUND");
 687                 __bt_le_handle_device_found(scan_result);
 688                 break;
 689         }
 690         case OAL_EVENT_GATTC_REGISTRATION: {
 691                 event_gattc_register_t *gattc_event = event_data;
 692                 char uuid_str[BLUETOOTH_UUID_STRING_MAX];
 693                 char *default_uuid_string;
 694
 695                 default_uuid_string = _bt_gatt_get_default_gatt_client_uuid();
 696                 _bt_uuid_to_string((service_uuid_t*)&(gattc_event->client_uuid), uuid_str);
 697                 BT_INFO("default UUID [%s] current registered uuid [%s]",
 698                                 default_uuid_string, uuid_str);
 699                 if (g_strcmp0(uuid_str, default_uuid_string)) {
 700                         BT_INFO("This is not the default GATT client that is registered");
 701
 702                         g_free(default_uuid_string);
 703                         break;
 704                 }
 705                 BT_INFO("GATT CLient instance registered is default client: ID [%d]",
 706                                 gattc_event->client_if);
 707                 g_free(default_uuid_string);
 708
 709                 g_gatt_client_id = gattc_event->client_if;
 710                 break;
 711         }
 712         case OAL_EVENT_BLE_LOCAL_FEATURES: {
 713                 event_adapter_le_features_t *le_features = event_data;
 714
 715                 le_feature_info.le_2m_phy = le_features->le_2m_phy_support;
 716                 le_feature_info.le_coded_phy = le_features->le_coded_phy_support;
 717
 718                 BT_INFO("Adapter LE 2M PHY Support [%s]", le_feature_info.le_2m_phy ? "TRUE" : "FALSE");
 719                 BT_INFO("Adapter LE CODED PHY Support [%s]", le_feature_info.le_coded_phy ? "TRUE" : "FALSE");
 720
 721                 break;
 722         }
 723         default:
 724                 break;
 725         }
 726 }
 727
 728 int _bt_le_init(void)
 729 {
 730         BT_DBG("+");
 731         /* Register LE event handler */
 732         _bt_service_register_event_handler_callback(BT_ADAPTER_LE_MODULE, __bt_le_event_handler);
 733         BT_DBG("-");
 734         return BLUETOOTH_ERROR_NONE;
 735 }
 736
 737 void _bt_le_deinit(void)
 738 {
 739         BT_DBG("+");
 740         /* Un-register LE event handler */
 741         _bt_service_unregister_event_handler_callback(BT_ADAPTER_LE_MODULE);
 742         BT_DBG("-");
 743 }
 744
 745 static void __bt_le_update_discovery_status(bt_adapter_discovery_state_t status)
 746 {
 747         BT_INFO("adapter_discovery_status changed [%d] -> [%d]", adapter_le_discovery_state, status);
 748         adapter_le_discovery_state = status;
 749 }
 750
 751 static int __bt_le_state_handle_request(gboolean enable)
 752 {
 753         int result = BLUETOOTH_ERROR_NONE;
 754         BT_DBG("");
 755
 756         switch (_bt_adapter_get_le_status()) {
 757         case BT_LE_ACTIVATING: {
 758                 BT_INFO("LE is currently in activating state, state [%d]",
 759                                 _bt_adapter_get_le_status());
 760                 if (enable) {
 761                         return BLUETOOTH_ERROR_IN_PROGRESS;
 762                 } else {
 763                         if (adapter_le_discovery_state == LE_DISCOVERY_STARTED ||
 764                                         adapter_le_discovery_state == LE_DISCOVERY_STARTING) {
 765                                 /*TODO Stop Discovery*/
 766                                 __bt_le_update_discovery_status(FALSE);
 767                         }
 768                         result = le_disable();  //change
 769                         if (result != OAL_STATUS_SUCCESS) {
 770                                 BT_ERR("LE_enable failed: [%d]", result);
 771                                 result = BLUETOOTH_ERROR_INTERNAL;
 772                                 /*TODO: perform if anything more needs to be done to handle failure */
 773                         } else {
 774                                 /* TODO: To be handled */
 775                                 _bt_adapter_set_le_status(BT_LE_DEACTIVATING);
 776                                 result = BLUETOOTH_ERROR_NONE;
 777                         }
 778                 }
 779                 break;
 780         }
 781         case BT_LE_ACTIVATED: {
 782                 BT_INFO("LE is currently in activated state, state [%d]",
 783                                 _bt_adapter_get_le_status());
 784                 if (enable) {
 785                         return BLUETOOTH_ERROR_DEVICE_ALREADY_ENABLED;
 786                 } else {
 787                         if (adapter_le_discovery_state == LE_DISCOVERY_STARTED ||
 788                                         adapter_le_discovery_state == LE_DISCOVERY_STARTING) {
 789                                 /*TODO Stop Discovery*/
 790                                 __bt_le_update_discovery_status(FALSE);
 791                         }
 792                         result = le_disable();
 793                         if (result != OAL_STATUS_SUCCESS) {
 794                                 BT_ERR("LE_enable failed: [%d]", result);
 795                                 result = BLUETOOTH_ERROR_INTERNAL;
 796                                 /*TODO: perform if anything more needs to be done to handle failure */
 797                         } else {
 798                                 /* TODO: To be handled */
 799                                 _bt_adapter_set_le_status(BT_LE_DEACTIVATING);
 800                                 result = BLUETOOTH_ERROR_NONE;
 801                         }
 802                 }
 803                 break;
 804         }
 805         case BT_LE_DEACTIVATING: {
 806                 BT_INFO("LE is currently in deactivating state, state [%d]",
 807                                 _bt_adapter_get_le_status());
 808                 if (!enable) {
 809                         return BLUETOOTH_ERROR_IN_PROGRESS;
 810
 811                 } else {
 812                         result = le_enable();
 813                         if (result != OAL_STATUS_SUCCESS && result != OAL_STATUS_PENDING) {
 814                                 BT_ERR("LE_enable failed: [%d]", result);
 815                                 le_disable();
 816                                 result = BLUETOOTH_ERROR_INTERNAL;
 817                                 /*TODO: perform if anything more needs to be done to handle failure */
 818                         } else {
 819                                 /* TODO: To be handled */
 820                                 _bt_adapter_set_le_status(BT_LE_ACTIVATING);
 821                                 result = BLUETOOTH_ERROR_NONE;
 822                         }
 823                 }
 824                 break;
 825         }
 826         case BT_LE_DEACTIVATED: {
 827                 BT_INFO("LE is currently in deactivated state, state [%d]",
 828                                 _bt_adapter_get_le_status());
 829                 if (!enable) {
 830                         return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
 831                 } else {
 832                         result = le_enable();
 833                         if (result != OAL_STATUS_SUCCESS && result != OAL_STATUS_PENDING) {
 834                                 BT_ERR("LE_enable failed: [%d]", result);
 835                                 le_disable();
 836                                 result = BLUETOOTH_ERROR_INTERNAL;
 837                                 /*TODO: perform if anything more needs to be done to handle failure */
 838                         } else {
 839                                 /* TODO: To be handled */
 840                                 _bt_adapter_set_le_status(BT_LE_ACTIVATING);
 841                                 result = BLUETOOTH_ERROR_NONE;
 842                         }
 843                 }
 844                 break;
 845         }
 846         default:
 847                 BT_ERR("Unknown state: %d", _bt_adapter_get_le_status);
 848                 break;
 849         }
 850
 851         if (enable && result == BLUETOOTH_ERROR_NONE) {
 852                 /* Adapter enable request is successful, setup event handlers */
 853                 _bt_service_register_event_handler_callback(
 854                                 BT_ADAPTER_LE_MODULE, __bt_le_event_handler);
 855                 _bt_device_state_handle_callback_set_request();
 856         }
 857         return result;
 858 }
 859
 860 int _bt_enable_adapter_le(void)
 861 {
 862         return __bt_le_state_handle_request(TRUE);
 863 }
 864
 865 int _bt_disable_adapter_le(void)
 866 {
 867         return __bt_le_state_handle_request(FALSE);
 868 }
 869
 870
 871 static gboolean __bt_is_factory_test_mode(void)
 872 {
 873         int mode = 0;
 874
 875         if (vconf_get_bool(VCONFKEY_BT_DUT_MODE, &mode)) {
 876                 BT_ERR("Get the DUT Mode fail");
 877                 return TRUE;
 878         }
 879
 880         if (mode != FALSE) {
 881                 BT_INFO("DUT Test Mode !!");
 882                 return TRUE;
 883         }
 884
 885         return FALSE;
 886 }
 887
 888 int _bt_set_advertising(const char *sender, int adv_handle, gboolean enable, gboolean use_reserved_slot)
 889 {
 890         BT_CHECK_PARAMETER(sender, return);
 891         int server_instance;
 892         bt_pending_adv_data_set_t *info = NULL;
 893         int result = OAL_STATUS_SUCCESS;
 894         BT_DBG("+");
 895
 896         if (__bt_is_factory_test_mode()) {
 897                 BT_ERR("Unable to start advertising in factory binary !!");
 898                 return BLUETOOTH_ERROR_NOT_SUPPORT;
 899         }
 900
 901         server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
 902
 903         if (server_instance == -1) {
 904                 BT_DBG("No available slot for the current sender and handle combination");
 905
 906                 if (enable == FALSE) {
 907                         BT_ERR("Advertising not even enabled on adv handle [%d] sender [%s]", adv_handle, sender);
 908                         return BLUETOOTH_ERROR_NOT_IN_OPERATION;
 909                 }
 910
 911                 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
 912
 913                 if (server_instance == -1) {
 914                         /* Internal Logic to register server instance if not initialized, store adv handle for future use */
 915                         if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
 916                                 return BLUETOOTH_ERROR_INTERNAL;
 917                         else {
 918                                 /* Allocate a pending structure and mark Adv data set pending */
 919                                 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
 920                                 info->adv_handle = adv_handle;
 921                                 info->sender = g_strdup(sender);
 922                                 info->is_data_set_pending = FALSE;
 923                                 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
 924                                 return BLUETOOTH_ERROR_NONE;
 925                         }
 926                 }
 927         }
 928
 929         if (enable)
 930                 result = adapter_ble_multi_adv_enable(server_instance);
 931         else
 932                 result = adapter_ble_multi_adv_disable(server_instance);
 933         if (result != OAL_STATUS_SUCCESS) {
 934                 BT_ERR("OAL API adapter_ble_multi_adv_enable Fail %d", result);
 935                 return BLUETOOTH_ERROR_INTERNAL;
 936         }
 937
 938         /* Update adv handle in table */
 939         _bt_update_adv_handle(sender, adv_handle);
 940
 941         return BLUETOOTH_ERROR_NONE;
 942 }
 943
 944 int _bt_set_custom_advertising(const char *sender, int adv_handle,
 945                 gboolean enable, bluetooth_advertising_params_t *params, gboolean use_reserved_slot)
 946 {
 947         BT_CHECK_PARAMETER(sender, return);
 948         int server_instance;
 949         bt_pending_adv_data_set_t *info = NULL;
 950         int result = OAL_STATUS_SUCCESS;
 951         BT_DBG("+");
 952
 953         if (__bt_is_factory_test_mode()) {
 954                 BT_ERR("Unable to start advertising in factory binary !!");
 955                 return BLUETOOTH_ERROR_NOT_SUPPORT;
 956         }
 957
 958         server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
 959
 960         if (server_instance == -1) {
 961                 BT_DBG("No available slot for the current sender and handle combination");
 962
 963                 if (enable == FALSE) {
 964                         BT_ERR("Advertising not even enabled on adv handle [%d] sender [%s]", adv_handle, sender);
 965                         return BLUETOOTH_ERROR_NOT_IN_OPERATION;
 966                 }
 967                 /* Below logic is only valid only when enabling advertising */
 968                 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
 969
 970                 if (server_instance == -1) {
 971                         /* Internal Logic to register server instance if not initialized, store adv handle for future use */
 972                         if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
 973                                 return BLUETOOTH_ERROR_INTERNAL;
 974                         else {
 975                                 /* Allocate a pending structure and mark Adv data set pending */
 976                                 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
 977                                 info->adv_handle = adv_handle;
 978                                 info->sender = g_strdup(sender);
 979                                 info->is_custom_adv = TRUE;
 980                                 info->is_data_set_pending = FALSE;
 981                                 memcpy(&info->params, params, sizeof(bluetooth_advertising_params_t));
 982                                 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
 983                                 return BLUETOOTH_ERROR_NONE;
 984                         }
 985                 }
 986         }
 987
 988         if (enable) {
 989                 /* Set Advertising parameters to Stack */
 990                 result = adapter_ble_multi_adv_update(server_instance, params->interval_min, params->interval_max,
 991                                 params->type, BT_ADV_DEFAULT_CHANNEL_MAP, BT_ADV_DEFAULT_TX_POWER, BT_ADV_DEFAULT_TIMEOUT);
 992                 if (result != OAL_STATUS_SUCCESS) {
 993                         BT_ERR("OAL API adapter_ble_multi_adv_update Fail %d", result);
 994                         return BLUETOOTH_ERROR_INTERNAL;
 995                 }
 996                 /* Start Advertising when Adv update event is received */
 997                 result = adapter_ble_multi_adv_enable(server_instance);
 998                 if (result != OAL_STATUS_SUCCESS) {
 999                         BT_ERR("OAL API adapter_ble_multi_adv_enable Fail %d", result);
1000                         return BLUETOOTH_ERROR_INTERNAL;
1001                 }
1002                 /* Update adv handle in table */
1003                 _bt_update_adv_handle(sender, adv_handle);
1004
1005                 return BLUETOOTH_ERROR_NONE;
1006         } else
1007                 result = adapter_ble_multi_adv_disable(server_instance);
1008
1009         if (result != OAL_STATUS_SUCCESS) {
1010                 BT_ERR("OAL API adapter_ble_multi_adv_disable Fail %d", result);
1011                 return BLUETOOTH_ERROR_INTERNAL;
1012         }
1013         return BLUETOOTH_ERROR_NONE;
1014 }
1015
1016 int _bt_get_advertising_data(char *sender, int adv_handle, bluetooth_advertising_data_t *adv, int *length)
1017 {
1018         BT_CHECK_PARAMETER(adv, return);
1019         BT_CHECK_PARAMETER(length, return);
1020         BT_CHECK_PARAMETER(sender, return);
1021
1022         int server_instance;
1023
1024         server_instance = _bt_get_allocated_server_instance(sender, adv_handle, FALSE);
1025
1026         if (server_instance == -1) {
1027                 BT_DBG("No available slot for the current sender and handle combination");
1028                 return BLUETOOTH_ERROR_INTERNAL;
1029         }
1030
1031         _bt_get_previous_adv_data(adv, length, server_instance);
1032         BT_DBG("ADV Data length [%d] Server Instance [%d] Adv handle [%d]", *length, server_instance, adv_handle);
1033
1034         return BLUETOOTH_ERROR_NONE;
1035 }
1036
1037 int _bt_get_scan_response_data(char *sender, int adv_handle, bluetooth_scan_resp_data_t *response, int *length)
1038 {
1039         BT_CHECK_PARAMETER(response, return);
1040         BT_CHECK_PARAMETER(length, return);
1041         BT_CHECK_PARAMETER(sender, return);
1042
1043         int server_instance;
1044
1045         server_instance = _bt_get_allocated_server_instance(sender, adv_handle, FALSE);
1046
1047         if (server_instance == -1) {
1048                 BT_DBG("No available slot for the current sender and handle combination");
1049                 return BLUETOOTH_ERROR_INTERNAL;
1050         }
1051
1052         _bt_get_previous_scan_rsp_data(response, length, server_instance);
1053         BT_DBG("SCAN RSP Data length [%d] Server Instance [%d] Adv handle [%d]", *length, server_instance, adv_handle);
1054
1055         return BLUETOOTH_ERROR_NONE;
1056 }
1057
1058 static int __bt_set_multi_adv_param(oal_ble_multi_adv_param_setup_t *adv_setup,
1059                 bluetooth_advertising_data_t *adv_data, int length)
1060 {
1061         unsigned char *ptr;
1062         int num_uuids;
1063
1064         BT_INFO("+");
1065         retv_if(NULL == adv_data, BLUETOOTH_ERROR_INVALID_PARAM);
1066         retv_if(NULL == adv_setup, BLUETOOTH_ERROR_INVALID_PARAM);
1067
1068         for (ptr = adv_data->data; NULL != ptr && length > 0;) {
1069                 int len = ptr[0];
1070                 int type = ptr[1];
1071
1072                 BT_INFO("len: %d, type: %x", len, type);
1073
1074                 switch (type) {
1075                 case 0xFF: /* Manufacturer Data */
1076                         adv_setup->manufacturer_data = g_malloc0(sizeof(char) * (len - 1));
1077                         memcpy(adv_setup->manufacturer_data, (ptr + 2), (len - 1));
1078                         adv_setup->manufacturer_data_len = len - 1;
1079                         break;
1080                 case 0x15: /* 128 bit Solicit UUID */
1081                         adv_setup->solicit_uuid = g_malloc0(sizeof(char) * (len - 1));
1082                         memcpy((adv_setup->solicit_uuid), (ptr + 2), (len - 1));
1083                         adv_setup->solicit_uuid_len = len;
1084                         break;
1085                 case 0x06: /* 128 bit Service UUID */
1086                         adv_setup->service_uuid = g_malloc0(sizeof(char) * (len - 1));
1087                         memcpy((adv_setup->service_uuid), (ptr + 2), (len - 1));
1088                         adv_setup->service_uuid_len = len;
1089                         break;
1090                         case 0x14: {  /* 16 bit Solicit UUID */
1091                         int c;
1092                         int k;
1093                         num_uuids = (len -1)/2;
1094                         adv_setup->solicit_uuid = g_malloc0(sizeof(char) * 16 * num_uuids);
1095                         char *tmp = adv_setup->solicit_uuid;
1096                         adv_setup->solicit_uuid_len = 0;
1097
1098                         for (c = 1; c <= num_uuids; c++) {
1099                                 adv_setup->solicit_uuid_len += 16;;
1100                                 memcpy(tmp, BASE_UUID_CONVERTED, BT_UUID_128);
1101                                 memcpy(tmp+12, &ptr[c*2/* Byte Length*/], 2/* Byte Length */);
1102
1103                                 if (c < num_uuids)
1104                                         tmp += 16;
1105                         }
1106                         /* DEBUG: Test*/
1107                         for (k = 0; k < 16 * num_uuids; k++)
1108                                 BT_DBG("%x", adv_setup->solicit_uuid[k]);
1109                         break;
1110                 }
1111                 case 0x02: { /* 16 bit Service UUID */
1112                         int c;
1113                         int k;
1114                         num_uuids = (len -1)/2;
1115                         adv_setup->service_uuid = g_malloc0(sizeof(char) * 16 * num_uuids);
1116                         char *tmp = adv_setup->service_uuid;
1117                         adv_setup->service_uuid_len = 0;
1118
1119                         for (c = 1; c <= num_uuids; c++) {
1120                                 adv_setup->service_uuid_len += 16;;
1121                                 memcpy(tmp, BASE_UUID_CONVERTED, BT_UUID_128);
1122                                 memcpy(tmp+12, &ptr[c*2/* Byte Length */], 2/* Byte Length */);
1123
1124                                 if (c < num_uuids)
1125                                         tmp += 16;
1126                         }
1127                         /* DEBUG: Test*/
1128                         for (k = 0; k < 16 * num_uuids; k++)
1129                                 BT_DBG("%x", adv_setup->service_uuid[k]);
1130                         break;
1131                 }
1132                 case 0x16: { /* Service Data */
1133                         adv_setup->service_data = g_malloc0(sizeof(char) * (len - 1));
1134                         memcpy(adv_setup->service_data, (ptr + 2), (len - 1));
1135                         adv_setup->service_data_len = len - 1;
1136                         break;
1137                 }
1138                 case 0x21: {
1139                         BT_INFO("128 Bit Service Data Not Supported!!");
1140                         break;
1141                 }
1142                 case 0x0A: {
1143                         adv_setup->include_txpower = 1;
1144                         break;
1145                 }
1146                 case 0x09:
1147                 case 0x08: {
1148                         adv_setup->include_name = 1;
1149                         break;
1150                 }
1151                 case 0x19: {
1152                         memcpy(&adv_setup->appearance, (ptr + 2), (len - 1));
1153                         break;
1154                 }
1155                 default:
1156                         BT_ERR("Unknown type: %x", type);
1157                         break;
1158         }
1159
1160                 length -= len + 1;
1161                 ptr += len + 1;
1162         }
1163
1164         BT_INFO("-");
1165         return BLUETOOTH_ERROR_NONE;
1166 }
1167
1168 int _bt_set_advertising_data(const char *sender, int adv_handle,
1169                 bluetooth_advertising_data_t *adv, int length, gboolean use_reserved_slot)
1170 {
1171         BT_CHECK_PARAMETER(adv, return);
1172         BT_CHECK_PARAMETER(sender, return);
1173         bt_pending_adv_data_set_t *info = NULL;
1174         int server_instance;
1175         bluetooth_advertising_data_t adv_old;
1176         int adv_data_len;
1177         char *old_mdata = NULL;
1178         int old_len = 0;
1179         GVariant *ad_data, *param = NULL;
1180         oal_ble_multi_adv_param_setup_t adv_setup;
1181         int result = OAL_STATUS_SUCCESS;
1182         BT_DBG("+");
1183
1184         if (length > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
1185                 return BLUETOOTH_ERROR_INVALID_PARAM;
1186
1187         if (__bt_is_factory_test_mode()) {
1188                 BT_ERR("Unable to set advertising data in factory binary !!");
1189                 return BLUETOOTH_ERROR_NOT_SUPPORT;
1190         }
1191
1192         server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1193
1194         if (server_instance == -1) {
1195                 BT_DBG("No available slot for the current sender and handle combination");
1196
1197                 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
1198
1199                 if (server_instance == -1) {
1200                         /* Internal Logic to register server instance if not initialized, store adv handle for future use */
1201                         if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
1202                                 return BLUETOOTH_ERROR_INTERNAL;
1203                         else {
1204                                 /* Allocate a pending structure and mark Adv data set pending */
1205                                 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
1206                                 info->adv_handle = adv_handle;
1207                                 info->sender = g_strdup(sender);
1208                                 info->data_len = length;
1209                                 info->is_adv = TRUE;
1210                                 info->is_data_set_pending = TRUE;
1211                                 memcpy(&info->data, &(adv->data[0]), length);
1212                                 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
1213                                 return BLUETOOTH_ERROR_NONE;
1214                         }
1215                 }
1216         }
1217
1218         /* Server Instance is already allocated, set Adv data to stack */
1219         /* First check if adv data is already present for slot server_instance*/
1220         memset(&adv_old.data, 0, sizeof(adv_old.data));
1221         _bt_get_previous_adv_data(&adv_old, &adv_data_len, server_instance);
1222
1223         /* Send Data to stack */
1224         memset(&adv_setup, 0, sizeof(oal_ble_multi_adv_param_setup_t));
1225
1226         if (BLUETOOTH_ERROR_NONE !=
1227                         __bt_set_multi_adv_param(&adv_setup, adv, length)) {
1228                 if (adv_setup.manufacturer_data)
1229                         g_free(adv_setup.manufacturer_data);
1230                 if (adv_setup.service_uuid)
1231                         g_free(adv_setup.service_uuid);
1232                 if (adv_setup.service_data)
1233                         g_free(adv_setup.service_data);
1234                 return BLUETOOTH_ERROR_INTERNAL;
1235         }
1236         /* Set Scan response false */
1237         adv_setup.set_scan_rsp = FALSE;
1238
1239         /* Set Server instance */
1240         adv_setup.server_if = server_instance;
1241
1242         /* Set Server instance[Product Requirement] */
1243         adv_setup.tx_power = 4;
1244
1245         BT_DBG("####Service UUID len [%d], service data len [%d] Solicit UUID len [%d]",
1246                                 adv_setup.solicit_uuid_len, adv_setup.service_uuid_len, adv_setup.service_data_len);
1247         result = adapter_ble_multi_adv_set_inst_data(server_instance, &adv_setup);
1248         if (result != OAL_STATUS_SUCCESS) {
1249                 BT_ERR("OAL API adapter_ble_multi_adv_set_inst_data Fail %d", result);
1250                 /* Free the data */
1251                 if (adv_setup.manufacturer_data)
1252                         g_free(adv_setup.manufacturer_data);
1253                 if (adv_setup.service_data)
1254                         g_free(adv_setup.service_data);
1255                 if (adv_setup.service_uuid)
1256                         g_free(adv_setup.service_uuid);
1257                 return BLUETOOTH_ERROR_INTERNAL;
1258         }
1259
1260         /* Data sent to Stack successfully, send manuf data changed event if applicable */
1261         if (adv_setup.manufacturer_data_len != 0) {
1262                 if (adv_data_len > 0) {
1263                         _bt_get_ad_data_by_type((char *)adv_old.data, adv_data_len, 0xff,
1264                                         &old_mdata, &old_len);
1265                 }
1266
1267                 if (old_len != adv_setup.manufacturer_data_len ||
1268                                 (old_mdata && adv_setup.manufacturer_data &&
1269                                  memcmp(old_mdata, adv_setup.manufacturer_data, adv_setup.manufacturer_data_len))) {
1270
1271                         ad_data = g_variant_new_from_data((const GVariantType *)"ay",
1272                                         adv_setup.manufacturer_data, adv_setup.manufacturer_data_len, TRUE, NULL, NULL);
1273                         param = g_variant_new("(@ay)", ad_data);
1274                         _bt_send_event(BT_ADAPTER_EVENT,
1275                                         BLUETOOTH_EVENT_ADVERTISING_MANUFACTURER_DATA_CHANGED,
1276                                         param);
1277                 }
1278
1279                 g_free(old_mdata);
1280         }
1281
1282         /* Time to update new ADV data completely in Table */
1283         _bt_set_new_adv_data(adv, length, server_instance);
1284
1285         /* Free the data */
1286         if (adv_setup.manufacturer_data)
1287                 g_free(adv_setup.manufacturer_data);
1288         if (adv_setup.service_data)
1289                 g_free(adv_setup.service_data);
1290         if (adv_setup.service_uuid)
1291                 g_free(adv_setup.service_uuid);
1292
1293         /* Update adv handle in table */
1294         _bt_update_adv_handle(sender, adv_handle);
1295
1296         return BLUETOOTH_ERROR_NONE;
1297 }
1298
1299 int _bt_set_scan_response_data(const char *sender, int adv_handle,
1300                                 bluetooth_scan_resp_data_t *response, int length, gboolean use_reserved_slot)
1301 {
1302         BT_CHECK_PARAMETER(response, return);
1303         BT_CHECK_PARAMETER(sender, return);
1304         bt_pending_adv_data_set_t *info = NULL;
1305         bluetooth_scan_resp_data_t scan_rsp_old;
1306         int scan_rsp_data_len;
1307         GVariant *ad_data, *param = NULL;
1308         oal_ble_multi_adv_param_setup_t adv_setup;
1309         char *old_mdata = NULL;
1310         int old_len = 0;
1311         int server_instance;
1312         int result = OAL_STATUS_SUCCESS;
1313         BT_DBG("+");
1314
1315         if (length > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
1316                 return BLUETOOTH_ERROR_INVALID_PARAM;
1317
1318         if (__bt_is_factory_test_mode()) {
1319                 BT_ERR("Unable to set Scan Response data in factory binary !!");
1320                 return BLUETOOTH_ERROR_NOT_SUPPORT;
1321         }
1322
1323         server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1324         if (server_instance == -1) {
1325                 BT_DBG("No available slot for the current sender and handle combination");
1326
1327                 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
1328
1329                 if (server_instance == -1) {
1330                         /* Internal Logic to register server instance if not initialized */
1331                         if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
1332                                 return BLUETOOTH_ERROR_INTERNAL;
1333                         else {
1334                                 /* Allocate a pending structure and mark Adv data set pending */
1335                                 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
1336                                 info->adv_handle = adv_handle;
1337                                 info->sender = g_strdup(sender);
1338                                 info->data_len = length;
1339                                 info->is_adv = FALSE;
1340                                 info->is_data_set_pending = TRUE;
1341                                 memcpy(&info->data, &(response->data[0]), length);
1342                                 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
1343                                 return BLUETOOTH_ERROR_NONE;
1344                         }
1345                 }
1346         }
1347
1348         /* Server Instance is already allocated, set Adv data to stack */
1349         /* First check if adv data is already present for slot server_instance*/
1350         memset(&scan_rsp_old.data, 0, sizeof(scan_rsp_old.data));
1351         _bt_get_previous_scan_rsp_data(&scan_rsp_old, &scan_rsp_data_len, server_instance);
1352
1353         /* Send Data to stack */
1354         memset(&adv_setup, 0, sizeof(oal_ble_multi_adv_param_setup_t));
1355
1356         if (BLUETOOTH_ERROR_NONE !=
1357                         __bt_set_multi_adv_param(&adv_setup, (bluetooth_advertising_data_t*)response, length)) {
1358                 if (adv_setup.manufacturer_data)
1359                         g_free(adv_setup.manufacturer_data);
1360                 if (adv_setup.service_uuid)
1361                         g_free(adv_setup.service_uuid);
1362                 if (adv_setup.service_data)
1363                         g_free(adv_setup.service_data);
1364                 return BLUETOOTH_ERROR_INTERNAL;
1365         }
1366
1367         /* Set Scan response to TRUE */
1368         adv_setup.set_scan_rsp = TRUE;
1369
1370         /* Set Server instance */
1371         adv_setup.server_if = server_instance;
1372
1373         /* Set Server instance[Product Requirement] */
1374         adv_setup.tx_power = 4;
1375
1376         result = adapter_ble_multi_adv_set_inst_data(server_instance, &adv_setup);
1377         if (result != OAL_STATUS_SUCCESS) {
1378                 BT_ERR("OAL API adapter_ble_multi_adv_set_inst_data Fail %d", result);
1379                 /* Free the data */
1380                 if (adv_setup.manufacturer_data)
1381                         g_free(adv_setup.manufacturer_data);
1382                 if (adv_setup.service_data)
1383                         g_free(adv_setup.service_data);
1384                 if (adv_setup.service_uuid)
1385                         g_free(adv_setup.service_uuid);
1386                 return BLUETOOTH_ERROR_INTERNAL;
1387         }
1388
1389         /* Data sent to Stack successfully, send manuf data changed event if applicable */
1390         if (adv_setup.manufacturer_data_len != 0) {
1391                 if (scan_rsp_data_len > 0) {
1392                         _bt_get_ad_data_by_type((char *)scan_rsp_old.data, scan_rsp_data_len, 0xff,
1393                                         &old_mdata, &old_len);
1394                 }
1395
1396                 if (old_len != adv_setup.manufacturer_data_len ||
1397                                 (old_mdata && adv_setup.manufacturer_data &&
1398                                  memcmp(old_mdata, adv_setup.manufacturer_data, adv_setup.manufacturer_data_len))) {
1399
1400                         ad_data = g_variant_new_from_data((const GVariantType *)"ay",
1401                                         adv_setup.manufacturer_data, adv_setup.manufacturer_data_len, TRUE, NULL, NULL);
1402                         param = g_variant_new("(@ay)", ad_data);
1403                         _bt_send_event(BT_ADAPTER_EVENT,
1404                                         BLUETOOTH_EVENT_ADVERTISING_MANUFACTURER_DATA_CHANGED,
1405                                         param);
1406                 }
1407
1408                 g_free(old_mdata);
1409         }
1410
1411         /* Time to update new Scan Response data completely in Table */
1412         _bt_set_new_scan_rsp_data(response, length, server_instance);
1413
1414         /* Free the data */
1415         if (adv_setup.manufacturer_data)
1416                 g_free(adv_setup.manufacturer_data);
1417         if (adv_setup.service_data)
1418                 g_free(adv_setup.service_data);
1419         if (adv_setup.service_uuid)
1420                 g_free(adv_setup.service_uuid);
1421
1422         /* Update adv handle in table */
1423         _bt_update_adv_handle(sender, adv_handle);
1424         return BLUETOOTH_ERROR_NONE;
1425 }
1426
1427 /*************************************** LE Scan APIs *********************************************/
1428 int _bt_set_scan_parameters(bluetooth_le_scan_params_t *params)
1429 {
1430         int itv = 0;
1431         int win = 0;
1432         int ret;
1433
1434         BT_CHECK_PARAMETER(params, return);
1435
1436         if (_bt_adapter_get_status() != BT_ACTIVATED &&
1437                         _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
1438                 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1439         }
1440
1441         if (params->interval < BT_LE_SCAN_INTERVAL_MIN ||
1442                         params->interval > BT_LE_SCAN_INTERVAL_MAX)
1443                 return BLUETOOTH_ERROR_INVALID_PARAM;
1444
1445         if (params->window < BT_LE_SCAN_WINDOW_MIN ||
1446                         params->window > BT_LE_SCAN_WINDOW_MAX)
1447                 return BLUETOOTH_ERROR_INVALID_PARAM;
1448
1449         if (params->window > params->interval)
1450                 return BLUETOOTH_ERROR_INVALID_PARAM;
1451
1452         itv = params->interval / BT_ADV_INTERVAL_SPLIT;
1453         win = params->window / BT_ADV_INTERVAL_SPLIT;
1454
1455         ret = gattc_set_le_scan_param(params->type, itv, win);
1456         if (OAL_STATUS_SUCCESS != ret) {
1457                 BT_ERR("gattc_set_le_scan_param failed");
1458                 return BLUETOOTH_ERROR_INTERNAL;
1459         }
1460
1461         is_le_set_scan_parameter = TRUE;
1462         BT_INFO("Set scan parameters");
1463
1464         return BLUETOOTH_ERROR_NONE;
1465 }
1466
1467 gboolean __send_le_scan_reply(gpointer data)
1468 {
1469         int value = (intptr_t)data;
1470
1471         if (0 == value) {
1472                 BT_DBG("Send reply to BT_STOP_LE_DISCOVERY");
1473                 __bt_adapter_le_handle_pending_request_info(
1474                                 BLUETOOTH_ERROR_NONE,
1475                                 BT_STOP_LE_DISCOVERY, NULL, 0);
1476         } else {
1477                 BT_DBG("Send reply to BT_START_LE_DISCOVERY");
1478                 __bt_adapter_le_handle_pending_request_info(
1479                                 BLUETOOTH_ERROR_NONE,
1480                                 BT_START_LE_DISCOVERY, NULL, 0);
1481         }
1482
1483         return FALSE;
1484 }
1485
1486 int _bt_start_le_scan(const char *sender)
1487 {
1488         bt_adapter_le_scanner_t *scanner;
1489         int ret;
1490
1491         scanner = __bt_find_scanner_from_list(sender);
1492         if (!scanner) {
1493                 scanner = g_malloc0(sizeof(bt_adapter_le_scanner_t));
1494                 retv_if(scanner == NULL, BLUETOOTH_ERROR_INTERNAL);
1495
1496                 scanner->sender = g_strdup(sender);
1497                 scanner_list = g_slist_append(scanner_list, scanner);
1498         }
1499
1500         if (scanner->is_scanning) {
1501                 BT_ERR("BT is already in LE scanning");
1502                 return BLUETOOTH_ERROR_IN_PROGRESS;
1503         }
1504
1505         if (_bt_is_le_scanning()) {
1506                 int value = 1;
1507
1508                 BT_INFO("LE Full Scan is already on progress");
1509                 g_idle_add(__send_le_scan_reply, (void *)(intptr_t)value);
1510                 goto done;
1511         }
1512
1513         if (is_le_set_scan_parameter == FALSE) {
1514                 bluetooth_le_scan_params_t scan_params;
1515
1516                 /* Set default scan parameter same with BT_ADAPTER_LE_SCAN_MODE_LOW_ENERGY */
1517                 scan_params.type = 0x01;
1518                 scan_params.interval = 5000;
1519                 scan_params.window = 500;
1520                 _bt_set_scan_parameters(&scan_params);
1521         }
1522
1523         BT_INFO("Start LE Full Scan");
1524         ret = gattc_start_le_discovery(g_gatt_client_id);
1525
1526         if (OAL_STATUS_SUCCESS != ret) {
1527                 BT_ERR("gattc_start_le_discovery failed");
1528                 return BLUETOOTH_ERROR_INTERNAL;
1529         }
1530
1531 done:
1532         scanner->is_scanning = TRUE;
1533         return BLUETOOTH_ERROR_NONE;
1534 }
1535
1536 int _bt_stop_le_scan(const char *sender)
1537 {
1538         bt_adapter_le_scanner_t *scanner;
1539         gboolean next_scanning = FALSE;
1540         GSList *l;
1541         int ret;
1542
1543         scanner = __bt_find_scanner_from_list(sender);
1544         if (scanner == NULL || scanner->is_scanning == FALSE)
1545                 return BLUETOOTH_ERROR_NOT_IN_OPERATION;
1546
1547         scanner->is_scanning = FALSE;
1548
1549         for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
1550                 scanner = l->data;
1551                 if (scanner->is_scanning == TRUE)
1552                         next_scanning = TRUE;
1553         }
1554
1555         if (next_scanning == TRUE) {
1556                 int value = 0;
1557
1558                 g_idle_add(__send_le_scan_reply, (void *)(intptr_t)value);
1559                 return BLUETOOTH_ERROR_NONE;
1560         } else {
1561                 BT_INFO("Just stop LE scan");
1562         }
1563
1564         ret = gattc_stop_le_discovery(g_gatt_client_id);
1565
1566         if (OAL_STATUS_SUCCESS != ret) {
1567                 BT_ERR("gattc_start_le_discovery failed");
1568                 return BLUETOOTH_ERROR_INTERNAL;
1569         }
1570
1571         is_le_set_scan_parameter = FALSE;
1572         return BLUETOOTH_ERROR_NONE;
1573 }
1574
1575 void _bt_check_le_scanner_app_termination(const char *sender)
1576 {
1577         bt_adapter_le_scanner_t *scanner;
1578
1579         scanner = __bt_find_scanner_from_list(sender);
1580         if (!scanner)
1581                 return;
1582
1583         if (scanner->is_scanning)
1584                 _bt_stop_le_scan(sender);
1585
1586         scanner_list = g_slist_remove(scanner_list, scanner);
1587         g_free(scanner->sender);
1588         g_free(scanner);
1589 }
1590
1591 int _bt_service_le_init(void)
1592 {
1593         le_init();
1594
1595         return BLUETOOTH_ERROR_NONE;
1596 }
1597
1598 void _bt_service_le_deinit(void)
1599 {
1600         le_deinit();
1601 }
1602
1603 int _bt_is_advertising(void)
1604 {
1605         int ret = is_advertising();
1606
1607         if (ret == BLUETOOTH_ERROR_NONE)
1608                 return TRUE;
1609         else
1610                 return FALSE;
1611 }
1612
1613 gboolean _bt_is_le_2m_phy_supported(void)
1614 {
1615         if (le_feature_info.le_2m_phy)
1616                 return TRUE;
1617         else
1618                 return FALSE;
1619 }
1620
1621 gboolean _bt_is_le_coded_phy_supported(void)
1622 {
1623         if (le_feature_info.le_coded_phy)
1624                 return TRUE;
1625         else
1626                 return FALSE;
1627 }
1628
1629
1630 /*************************************** LE Scan APIs *********************************************/