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