2 * Copyright (c) 2016 2017 Samsung Electronics Co., Ltd All Rights Reserved
4 * Contact: Anupam Roy <anupam.r@samsung.com>
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
10 * http://www.apache.org/licenses/LICENSE-2.0
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.
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"
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>
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
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
60 } bt_adapter_le_feature_info_t;
62 /* Set Default values */
63 static bt_adapter_le_feature_info_t le_feature_info = {1, 0, 0, 0, 0};
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;
76 static guint timer_id = 0;
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;
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
88 #define BT_ADV_INTERVAL_SPLIT 0.625
94 gboolean stop_pending;
95 } bt_adapter_le_scanner_t;
97 GSList *scanner_list = NULL;
98 static gboolean is_le_set_scan_parameter = FALSE;
99 static gboolean is_le_scanning = FALSE;
101 static int g_gatt_client_id = 0;
103 /******************************************* LE Scan *********************************************/
105 void _bt_adapter_set_le_status(bt_le_status_t status)
107 BT_INFO("adapter_le_state changed [%d] -> [%d]", adapter_le_state, status);
108 adapter_le_state = status;
111 bt_le_status_t _bt_adapter_get_le_status(void)
113 return adapter_le_state;
117 /* Internal functions of core adapter service */
118 static void __bt_le_handle_pending_requests(int service_function, void *user_data, unsigned int size)
122 invocation_info_t *req_info;
125 /* Get method invocation context */
126 for (l = _bt_get_invocation_list(); l != NULL; ) {
129 if (req_info == NULL || req_info->service_function != service_function)
132 /* Create out param */
133 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
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));
143 BT_ERR("Unknown service function[%d]", service_function);
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);
154 /* Request return handlings */
155 static gboolean __bt_le_post_set_enabled(gpointer user_data)
157 BT_INFO("__bt_adapter_post_set_enabled>>");
159 /* Add LE enabled post processing codes */
165 static gboolean __bt_le_post_set_disabled(gpointer user_data)
167 BT_INFO("_bt_adapter_post_set_disabled>>");
169 /* Add LE disabled post processing codes */
174 static void __bt_le_update_bt_enabled(void)
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");
182 /* TODO:Add timer function to handle any further post processing */
183 g_idle_add((GSourceFunc)__bt_le_post_set_enabled, NULL);
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));
192 static void __bt_le_update_bt_disabled(void)
194 int result = BLUETOOTH_ERROR_NONE;
195 BT_INFO("_bt_adapter_update_bt_disabled>>");
197 int power_off_status = 0;
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);
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");
208 /* TODO:Add timer function to handle any further post processing */
209 g_idle_add((GSourceFunc)__bt_le_post_set_disabled, NULL);
211 /* Return BT_ADAPTER_DISABLE Method invocation context */
212 __bt_le_handle_pending_requests(BT_DISABLE_ADAPTER_LE, NULL, 0);
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));
220 static void __bt_set_le_scan_status(gboolean mode)
222 is_le_scanning = mode;
225 gboolean _bt_is_le_scanning(void)
227 return is_le_scanning;
230 bt_adapter_le_scanner_t* __bt_find_scanner_from_list(const char *sender)
233 bt_adapter_le_scanner_t *scanner;
235 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
237 if (g_strcmp0(scanner->sender, sender) == 0)
245 static void __bt_adapter_le_handle_pending_request_info(int result,
246 int service_function, void *param, unsigned int size)
250 invocation_info_t *req_info = NULL;
253 for (l = _bt_get_invocation_list(); l != NULL; ) {
256 if (req_info == NULL || req_info->service_function != service_function)
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: {
265 bt_pending_adv_data_set_t *data;
267 BT_DBG("Service function: [%d]", service_function);
268 ret_if(param == NULL);
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);
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);
281 g_free(req_info->user_data);
282 _bt_free_info_from_invocation_list(req_info);
283 g_array_free(out_param, TRUE);
287 case BT_START_LE_DISCOVERY: {
288 bt_adapter_le_scanner_t *scanner;
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;
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);
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);
318 static void __bt_le_handle_server_instance_registered(event_gatts_register_t *data)
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;
328 memset(adv.data, 0, sizeof(adv.data));
329 memset(scan_rsp.data, 0, sizeof(scan_rsp.data));
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);
334 /* Get sender and adv handle for the server instance */
335 _bt_get_adv_handle_from_instance(data->server_inst, &adv_handle);
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) {
341 if (info && (adv_handle == info->adv_handle)) {
342 if (info->is_data_set_pending) {
343 BT_INFO("LE Data set request is pending");
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));
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));
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));
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,
382 (void*)info, sizeof(bt_pending_adv_data_set_t));
393 adv_data_pending_list = g_slist_remove(adv_data_pending_list, info);
394 g_free(info->sender);
398 static void __bt_le_multi_advertising_enabled(event_ble_multiadv_status *event)
402 bt_pending_adv_data_set_t *info = NULL;
403 GVariant *param = NULL;
404 int result = BLUETOOTH_ERROR_NONE;
406 sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
407 if (sender == NULL) {
408 BT_ERR("Abnormal!!");
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,
420 (void*)info, sizeof(bt_pending_adv_data_set_t));
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);
427 g_free(info->sender);
432 static void __bt_le_multi_advertising_disabled(event_ble_multiadv_status *event)
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);
441 if (sender == NULL) {
442 BT_INFO("Means application containing the adv info is already freed!!");
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,
454 (void*)info, sizeof(bt_pending_adv_data_set_t));
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);
459 /* Free allocated slot or server instance from stack to be used for other advertisng */
460 result = _bt_unregister_server_instance(sender, adv_handle);
463 g_free(info->sender);
468 static void __bt_le_multi_advertising_set_data(event_ble_multiadv_status *event)
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);
476 if (sender == NULL) {
477 BT_ERR("Abnormal!!");
479 BT_DBG("Sender [%s], adv handle [%d]", sender, adv_handle);
480 if (event->status != OAL_STATUS_SUCCESS)
481 result = BLUETOOTH_ERROR_INTERNAL;
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);
498 static int __get_advertisement_data(unsigned char *dest, unsigned char *src)
506 if ((len == 0) || (31 < (i + len))) {
507 BT_INFO("length: %d", length);
508 memcpy(dest, src, length);
519 static void __bt_le_handle_device_found(event_ble_scan_result_info *scan_result)
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];
528 int scan_resp_len = 0;
529 char *tmp_str = NULL;
530 GVariant *scan_data_param;
531 GVariant *adv_data_param;
536 ret_if(NULL == scan_result);
538 _bt_convert_addr_type_to_string(address, scan_result->address.addr);
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]));
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]));
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);
551 tmp_str = _bt_service_convert_hex_to_string(scan_result->adv_data, 62);
552 BT_INFO("Complete Data: [%s]", tmp_str);
556 tmp_str = _bt_service_convert_hex_to_string(adv_ind_data, adv_ind_len);
557 BT_INFO("Adv Ind Data: [%s]", tmp_str);
561 tmp_str = _bt_service_convert_hex_to_string(scan_resp_data, scan_resp_len);
562 BT_INFO("Scan resp Data: [%s]", tmp_str);
566 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
568 if (scanner->is_scanning == FALSE)
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);
576 param = g_variant_new("(isnnn@ayn@ay)",
578 addr_type, scan_result->rssi,
579 adv_ind_len, adv_data_param,
580 scan_resp_len, scan_data_param);
582 _bt_send_event_to_dest(scanner->sender, BT_LE_ADAPTER_EVENT,
583 BLUETOOTH_EVENT_REMOTE_LE_DEVICE_FOUND, param);
589 static void __bt_le_state_change_callback(int bt_status)
591 BT_INFO("__bt_le_state_change_callback: status [%d]", bt_status);
594 case BT_LE_DEACTIVATED:
595 _bt_adapter_set_le_status(bt_status);
597 /* Add Adapter disabled post processing codes */
598 __bt_le_update_bt_disabled();
600 case BT_LE_ACTIVATED:
601 _bt_adapter_set_le_status(bt_status);
603 /* Add Adapter enabled post processing codes */
605 BT_DBG("g_source is removed");
606 g_source_remove(timer_id);
609 __bt_le_update_bt_enabled();
612 BT_ERR("Incorrect Bluetooth adapter state changed status");
618 static void __bt_le_event_handler(int event_type, gpointer event_data)
620 BT_INFO("OAL event = 0x%x, \n", event_type);
622 switch (event_type) {
623 case OAL_EVENT_BLE_ENABLED: {
624 __bt_le_state_change_callback(BT_LE_ACTIVATED);
627 case OAL_EVENT_BLE_DISABLED: {
628 __bt_le_state_change_callback(BT_LE_DEACTIVATED);
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);
636 case OAL_EVENT_BLE_ADVERTISING_STARTED: {
637 BT_INFO("OAL Event: Legacy Advertising Enabled: Not Supported!!");
640 case OAL_EVENT_BLE_ADVERTISING_STOPPED: {
641 BT_INFO("OAL Event: Legacy Advertising Disabled: Not Supported!!");
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);
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);
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);
659 case OAL_EVENT_BLE_MULTI_ADVERTISING_UPDATE: {
660 BT_INFO("OAL Event: Advertising Params updated");
663 case OAL_EVENT_BLE_DISCOVERY_STARTED: {
664 __bt_set_le_scan_status(TRUE);
666 __bt_adapter_le_handle_pending_request_info(
667 BLUETOOTH_ERROR_NONE,
668 BT_START_LE_DISCOVERY, NULL, 0);
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);
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);
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);
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;
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");
704 g_free(default_uuid_string);
707 BT_INFO("GATT CLient instance registered is default client: ID [%d]",
708 gattc_event->client_if);
709 g_free(default_uuid_string);
711 g_gatt_client_id = gattc_event->client_if;
714 case OAL_EVENT_BLE_LOCAL_FEATURES: {
715 event_adapter_le_features_t *le_features = event_data;
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;
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");
730 int _bt_le_init(void)
733 /* Register LE event handler */
734 _bt_service_register_event_handler_callback(BT_ADAPTER_LE_MODULE, __bt_le_event_handler);
736 return BLUETOOTH_ERROR_NONE;
739 void _bt_le_deinit(void)
742 /* Un-register LE event handler */
743 _bt_service_unregister_event_handler_callback(BT_ADAPTER_LE_MODULE);
747 static void __bt_le_update_discovery_status(bt_adapter_discovery_state_t status)
749 BT_INFO("adapter_discovery_status changed [%d] -> [%d]", adapter_le_discovery_state, status);
750 adapter_le_discovery_state = status;
753 static int __bt_le_state_handle_request(gboolean enable)
755 int result = BLUETOOTH_ERROR_NONE;
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());
763 return BLUETOOTH_ERROR_IN_PROGRESS;
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);
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 */
776 /* TODO: To be handled */
777 _bt_adapter_set_le_status(BT_LE_DEACTIVATING);
778 result = BLUETOOTH_ERROR_NONE;
783 case BT_LE_ACTIVATED: {
784 BT_INFO("LE is currently in activated state, state [%d]",
785 _bt_adapter_get_le_status());
787 return BLUETOOTH_ERROR_DEVICE_ALREADY_ENABLED;
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);
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 */
800 /* TODO: To be handled */
801 _bt_adapter_set_le_status(BT_LE_DEACTIVATING);
802 result = BLUETOOTH_ERROR_NONE;
807 case BT_LE_DEACTIVATING: {
808 BT_INFO("LE is currently in deactivating state, state [%d]",
809 _bt_adapter_get_le_status());
811 return BLUETOOTH_ERROR_IN_PROGRESS;
814 result = le_enable();
815 if (result != OAL_STATUS_SUCCESS && result != OAL_STATUS_PENDING) {
816 BT_ERR("LE_enable failed: [%d]", result);
818 result = BLUETOOTH_ERROR_INTERNAL;
819 /*TODO: perform if anything more needs to be done to handle failure */
821 /* TODO: To be handled */
822 _bt_adapter_set_le_status(BT_LE_ACTIVATING);
823 result = BLUETOOTH_ERROR_NONE;
828 case BT_LE_DEACTIVATED: {
829 BT_INFO("LE is currently in deactivated state, state [%d]",
830 _bt_adapter_get_le_status());
832 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
834 result = le_enable();
835 if (result != OAL_STATUS_SUCCESS && result != OAL_STATUS_PENDING) {
836 BT_ERR("LE_enable failed: [%d]", result);
838 result = BLUETOOTH_ERROR_INTERNAL;
839 /*TODO: perform if anything more needs to be done to handle failure */
841 /* TODO: To be handled */
842 _bt_adapter_set_le_status(BT_LE_ACTIVATING);
843 result = BLUETOOTH_ERROR_NONE;
849 BT_ERR("Unknown state: %d", _bt_adapter_get_le_status());
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();
862 int _bt_enable_adapter_le(void)
864 return __bt_le_state_handle_request(TRUE);
867 int _bt_disable_adapter_le(void)
869 return __bt_le_state_handle_request(FALSE);
873 static gboolean __bt_is_factory_test_mode(void)
877 if (vconf_get_bool(VCONFKEY_BT_DUT_MODE, &mode)) {
878 BT_ERR("Get the DUT Mode fail");
883 BT_INFO("DUT Test Mode !!");
890 int _bt_set_advertising(const char *sender, int adv_handle, gboolean enable, gboolean use_reserved_slot)
892 BT_CHECK_PARAMETER(sender, return);
894 bt_pending_adv_data_set_t *info = NULL;
895 int result = OAL_STATUS_SUCCESS;
898 if (__bt_is_factory_test_mode()) {
899 BT_ERR("Unable to start advertising in factory binary !!");
900 return BLUETOOTH_ERROR_NOT_SUPPORT;
903 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
905 if (server_instance == -1) {
906 BT_DBG("No available slot for the current sender and handle combination");
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;
913 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
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;
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;
932 result = adapter_ble_multi_adv_enable(server_instance);
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;
940 /* Update adv handle in table */
941 _bt_update_adv_handle(sender, adv_handle);
943 return BLUETOOTH_ERROR_NONE;
946 int _bt_set_custom_advertising(const char *sender, int adv_handle,
947 gboolean enable, bluetooth_advertising_params_t *params, gboolean use_reserved_slot)
949 BT_CHECK_PARAMETER(sender, return);
951 bt_pending_adv_data_set_t *info = NULL;
952 int result = OAL_STATUS_SUCCESS;
955 if (__bt_is_factory_test_mode()) {
956 BT_ERR("Unable to start advertising in factory binary !!");
957 return BLUETOOTH_ERROR_NOT_SUPPORT;
960 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
962 if (server_instance == -1) {
963 BT_DBG("No available slot for the current sender and handle combination");
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;
969 /* Below logic is only valid only when enabling advertising */
970 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
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;
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;
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;
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;
1004 /* Update adv handle in table */
1005 _bt_update_adv_handle(sender, adv_handle);
1007 return BLUETOOTH_ERROR_NONE;
1009 result = adapter_ble_multi_adv_disable(server_instance);
1011 if (result != OAL_STATUS_SUCCESS) {
1012 BT_ERR("OAL API adapter_ble_multi_adv_disable Fail %d", result);
1013 return BLUETOOTH_ERROR_INTERNAL;
1015 return BLUETOOTH_ERROR_NONE;
1018 int _bt_get_advertising_data(char *sender, int adv_handle, bluetooth_advertising_data_t *adv, int *length)
1020 BT_CHECK_PARAMETER(adv, return);
1021 BT_CHECK_PARAMETER(length, return);
1022 BT_CHECK_PARAMETER(sender, return);
1024 int server_instance;
1026 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, FALSE);
1028 if (server_instance == -1) {
1029 BT_DBG("No available slot for the current sender and handle combination");
1030 return BLUETOOTH_ERROR_INTERNAL;
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);
1036 return BLUETOOTH_ERROR_NONE;
1039 int _bt_get_scan_response_data(char *sender, int adv_handle, bluetooth_scan_resp_data_t *response, int *length)
1041 BT_CHECK_PARAMETER(response, return);
1042 BT_CHECK_PARAMETER(length, return);
1043 BT_CHECK_PARAMETER(sender, return);
1045 int server_instance;
1047 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, FALSE);
1049 if (server_instance == -1) {
1050 BT_DBG("No available slot for the current sender and handle combination");
1051 return BLUETOOTH_ERROR_INTERNAL;
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);
1057 return BLUETOOTH_ERROR_NONE;
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)
1067 retv_if(NULL == adv_data, BLUETOOTH_ERROR_INVALID_PARAM);
1068 retv_if(NULL == adv_setup, BLUETOOTH_ERROR_INVALID_PARAM);
1070 for (ptr = adv_data->data; NULL != ptr && length > 0;) {
1074 BT_INFO("len: %d, type: %x", len, 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;
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;
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;
1092 case 0x14: { /* 16 bit Solicit UUID */
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;
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 */);
1109 for (k = 0; k < 16 * num_uuids; k++)
1110 BT_DBG("%x", adv_setup->solicit_uuid[k]);
1113 case 0x02: { /* 16 bit Service UUID */
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;
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 */);
1130 for (k = 0; k < 16 * num_uuids; k++)
1131 BT_DBG("%x", adv_setup->service_uuid[k]);
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;
1141 BT_INFO("128 Bit Service Data Not Supported!!");
1145 adv_setup->include_txpower = 1;
1150 adv_setup->include_name = 1;
1154 memcpy(&adv_setup->appearance, (ptr + 2), (len - 1));
1158 BT_ERR("Unknown type: %x", type);
1167 return BLUETOOTH_ERROR_NONE;
1170 int _bt_set_advertising_data(const char *sender, int adv_handle,
1171 bluetooth_advertising_data_t *adv, int length, gboolean use_reserved_slot)
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;
1179 char *old_mdata = NULL;
1181 GVariant *ad_data, *param = NULL;
1182 oal_ble_multi_adv_param_setup_t adv_setup;
1183 int result = OAL_STATUS_SUCCESS;
1186 if (length > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
1187 return BLUETOOTH_ERROR_INVALID_PARAM;
1189 if (__bt_is_factory_test_mode()) {
1190 BT_ERR("Unable to set advertising data in factory binary !!");
1191 return BLUETOOTH_ERROR_NOT_SUPPORT;
1194 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1196 if (server_instance == -1) {
1197 BT_DBG("No available slot for the current sender and handle combination");
1199 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
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;
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;
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);
1225 /* Send Data to stack */
1226 memset(&adv_setup, 0, sizeof(oal_ble_multi_adv_param_setup_t));
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;
1238 /* Set Scan response false */
1239 adv_setup.set_scan_rsp = FALSE;
1241 /* Set Server instance */
1242 adv_setup.server_if = server_instance;
1244 /* Set Server instance[Product Requirement] */
1245 adv_setup.tx_power = 4;
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);
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;
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);
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))) {
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,
1284 /* Time to update new ADV data completely in Table */
1285 _bt_set_new_adv_data(adv, length, server_instance);
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);
1295 /* Update adv handle in table */
1296 _bt_update_adv_handle(sender, adv_handle);
1298 return BLUETOOTH_ERROR_NONE;
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)
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;
1313 int server_instance;
1314 int result = OAL_STATUS_SUCCESS;
1317 if (length > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
1318 return BLUETOOTH_ERROR_INVALID_PARAM;
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;
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");
1329 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
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;
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;
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);
1355 /* Send Data to stack */
1356 memset(&adv_setup, 0, sizeof(oal_ble_multi_adv_param_setup_t));
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;
1369 /* Set Scan response to TRUE */
1370 adv_setup.set_scan_rsp = TRUE;
1372 /* Set Server instance */
1373 adv_setup.server_if = server_instance;
1375 /* Set Server instance[Product Requirement] */
1376 adv_setup.tx_power = 4;
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);
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;
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);
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))) {
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,
1413 /* Time to update new Scan Response data completely in Table */
1414 _bt_set_new_scan_rsp_data(response, length, server_instance);
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);
1424 /* Update adv handle in table */
1425 _bt_update_adv_handle(sender, adv_handle);
1426 return BLUETOOTH_ERROR_NONE;
1429 /*************************************** LE Scan APIs *********************************************/
1430 int _bt_set_scan_parameters(bluetooth_le_scan_params_t *params)
1436 BT_CHECK_PARAMETER(params, return);
1438 if (_bt_adapter_get_status() != BT_ACTIVATED &&
1439 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
1440 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1443 if (params->interval < BT_LE_SCAN_INTERVAL_MIN ||
1444 params->interval > BT_LE_SCAN_INTERVAL_MAX)
1445 return BLUETOOTH_ERROR_INVALID_PARAM;
1447 if (params->window < BT_LE_SCAN_WINDOW_MIN ||
1448 params->window > BT_LE_SCAN_WINDOW_MAX)
1449 return BLUETOOTH_ERROR_INVALID_PARAM;
1451 if (params->window > params->interval)
1452 return BLUETOOTH_ERROR_INVALID_PARAM;
1454 itv = params->interval / BT_ADV_INTERVAL_SPLIT;
1455 win = params->window / BT_ADV_INTERVAL_SPLIT;
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;
1463 is_le_set_scan_parameter = TRUE;
1464 BT_INFO("Set scan parameters");
1466 return BLUETOOTH_ERROR_NONE;
1469 gboolean __send_le_scan_reply(gpointer data)
1471 int value = (intptr_t)data;
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);
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);
1488 static gboolean __start_le_scan_timeout(gpointer user_data)
1490 char *sender = (char *)user_data;
1491 _bt_start_le_scan(sender);
1496 int _bt_start_le_scan(const char *sender)
1498 bt_adapter_le_scanner_t *scanner;
1501 scanner = __bt_find_scanner_from_list(sender);
1503 scanner = g_malloc0(sizeof(bt_adapter_le_scanner_t));
1504 retv_if(scanner == NULL, BLUETOOTH_ERROR_INTERNAL);
1506 scanner->sender = g_strdup(sender);
1507 scanner_list = g_slist_append(scanner_list, scanner);
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;
1516 if (scanner->is_scanning) {
1517 BT_ERR("BT is already in LE scanning");
1518 return BLUETOOTH_ERROR_IN_PROGRESS;
1521 if (_bt_is_le_scanning()) {
1524 BT_INFO("LE Full Scan is already on progress");
1525 g_idle_add(__send_le_scan_reply, (void *)(intptr_t)value);
1529 if (is_le_set_scan_parameter == FALSE) {
1530 bluetooth_le_scan_params_t scan_params;
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);
1539 BT_INFO("Start LE Full Scan");
1540 ret = gattc_start_le_discovery(g_gatt_client_id);
1542 if (OAL_STATUS_SUCCESS != ret) {
1543 BT_ERR("gattc_start_le_discovery failed");
1544 return BLUETOOTH_ERROR_INTERNAL;
1548 scanner->is_scanning = TRUE;
1549 return BLUETOOTH_ERROR_NONE;
1552 int _bt_stop_le_scan(const char *sender)
1554 bt_adapter_le_scanner_t *scan_sender;
1555 bt_adapter_le_scanner_t *scanner;
1556 gboolean next_scanning = FALSE;
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;
1564 scan_sender->is_scanning = FALSE;
1565 scan_sender->stop_pending = TRUE;
1567 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
1569 if (scanner->is_scanning == TRUE)
1570 next_scanning = TRUE;
1573 if (next_scanning == TRUE) {
1576 g_idle_add(__send_le_scan_reply, (void *)(intptr_t)value);
1577 return BLUETOOTH_ERROR_NONE;
1579 BT_INFO("Just stop LE scan");
1582 ret = gattc_stop_le_discovery(g_gatt_client_id);
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;
1590 is_le_set_scan_parameter = FALSE;
1591 return BLUETOOTH_ERROR_NONE;
1594 void _bt_disable_all_scanner_status(void)
1597 bt_adapter_le_scanner_t *scanner;
1599 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
1601 scanner->is_scanning = FALSE;
1602 scanner->stop_pending = FALSE;
1606 void _bt_check_le_scanner_app_termination(const char *sender)
1608 bt_adapter_le_scanner_t *scanner;
1610 scanner = __bt_find_scanner_from_list(sender);
1614 if (scanner->is_scanning)
1615 _bt_stop_le_scan(sender);
1617 scanner_list = g_slist_remove(scanner_list, scanner);
1618 g_free(scanner->sender);
1622 int _bt_service_le_init(void)
1626 return BLUETOOTH_ERROR_NONE;
1629 void _bt_service_le_deinit(void)
1634 int _bt_is_advertising(void)
1636 int ret = is_advertising();
1638 if (ret == BLUETOOTH_ERROR_NONE)
1644 gboolean _bt_is_le_2m_phy_supported(void)
1646 if (le_feature_info.le_2m_phy)
1652 gboolean _bt_is_le_coded_phy_supported(void)
1654 if (le_feature_info.le_coded_phy)
1661 /*************************************** LE Scan APIs *********************************************/
1663 int _bt_set_le_static_random_address(gboolean is_enable)
1665 int result = BLUETOOTH_ERROR_NONE;
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;
1672 if (_bt_adapter_get_status() != BT_ACTIVATED &&
1673 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
1674 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
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;
1682 BT_INFO("SetLeStaticRandomAddress as %d", is_enable);
1683 result = BLUETOOTH_ERROR_NONE;