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

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