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