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