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

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