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