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

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