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