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