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