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