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