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
48 #define BT_SCAN_INTERVAL_SPLIT 0.625
50 static const char BASE_UUID_CONVERTED[BT_UUID_128] = {
51 0xfb, 0x34, 0x9b, 0x5f, 0x80, 0x00, 0x00, 0x80,
52 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
61 } bt_adapter_le_feature_info_t;
63 /* Set Default values */
64 static bt_adapter_le_feature_info_t le_feature_info = {1, 0, 0, 0, 0};
70 unsigned char data[31];
71 gboolean is_adv;/* Adv or Scan Response: Only applicable if is_data_set_pending is TRUE */
72 gboolean is_data_set_pending; /* Data Set pending or Adv enable request at one time */
73 gboolean is_custom_adv; /* If Adv enable is custom adv enable request */
74 bluetooth_advertising_params_t params; /* Adv Parameters */
75 } bt_pending_adv_data_set_t;
77 static guint timer_id = 0;
79 static GSList *adv_data_pending_list = NULL;
80 static bt_le_status_t adapter_le_state = BT_LE_DEACTIVATED;
81 static bt_le_discovery_state_t adapter_le_discovery_state = LE_DISCOVERY_STOPPED;
83 /******************************************* LE Scan *********************************************/
84 #define BT_LE_SCAN_INTERVAL_MIN 2.5
85 #define BT_LE_SCAN_INTERVAL_MAX 10240
86 #define BT_LE_SCAN_WINDOW_MIN 2.5
87 #define BT_LE_SCAN_WINDOW_MAX 10240
89 #define BT_ADV_INTERVAL_SPLIT 0.625
95 gboolean stop_pending;
96 } bt_adapter_le_scanner_t;
98 GSList *scanner_list = NULL;
99 static gboolean is_le_set_scan_parameter = FALSE;
100 static gboolean is_le_scanning = FALSE;
102 static bluetooth_le_scan_params_t le_scan_params = { BT_LE_ACTIVE_SCAN, 0, 0 };
104 static int g_gatt_client_id = 0;
105 static void _bt_disable_all_scanner_status(void);
107 /******************************************* LE Scan *********************************************/
109 void _bt_adapter_set_le_status(bt_le_status_t status)
111 BT_INFO("adapter_le_state changed [%d] -> [%d]", adapter_le_state, status);
112 adapter_le_state = status;
115 bt_le_status_t _bt_adapter_get_le_status(void)
117 return adapter_le_state;
121 /* Internal functions of core adapter service */
122 static void __bt_le_handle_pending_requests(int service_function, void *user_data, unsigned int size)
126 invocation_info_t *req_info;
129 /* Get method invocation context */
130 for (l = _bt_get_invocation_list(); l != NULL; ) {
133 if (req_info == NULL || req_info->service_function != service_function)
136 /* Create out param */
137 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
139 switch (service_function) {
140 case BT_ENABLE_ADAPTER_LE:
141 case BT_DISABLE_ADAPTER_LE: {
142 gboolean done = TRUE;
143 g_array_append_vals(out_param, &done, sizeof(gboolean));
147 BT_ERR("Unknown service function[%d]", service_function);
150 _bt_service_method_return(req_info->context, out_param, req_info->result);
151 g_array_free(out_param, TRUE);
152 /* Now free invocation info for this request*/
153 _bt_free_info_from_invocation_list(req_info);
158 /* Request return handlings */
159 static gboolean __bt_le_post_set_enabled(gpointer user_data)
161 BT_INFO("__bt_adapter_post_set_enabled>>");
163 /* Add LE enabled post processing codes */
169 static gboolean __bt_le_post_set_disabled(gpointer user_data)
171 BT_INFO("_bt_adapter_post_set_disabled>>");
173 /* Add LE disabled post processing codes */
178 static void __bt_le_update_bt_enabled(void)
180 int result = BLUETOOTH_ERROR_NONE;
181 BT_ERR("_bt_adapter_update_bt_enabled>>");
182 /* Update Bluetooth Status to notify other modules */
183 if (vconf_set_int(VCONFKEY_BT_LE_STATUS, VCONFKEY_BT_LE_STATUS_ON) != 0)
184 BT_ERR("Set vconf failed\n");
186 /* TODO:Add timer function to handle any further post processing */
187 g_idle_add((GSourceFunc)__bt_le_post_set_enabled, NULL);
189 /*Return BT_ADAPTER_ENABLE Method invocation context */
190 __bt_le_handle_pending_requests(BT_ENABLE_ADAPTER_LE, NULL, 0);
191 /*Send BT Enabled event to application */
192 _bt_send_event(BT_LE_ADAPTER_EVENT, BLUETOOTH_EVENT_LE_ENABLED,
193 g_variant_new("(i)", result));
196 static void __bt_le_update_bt_disabled(void)
198 int result = BLUETOOTH_ERROR_NONE;
199 BT_INFO("_bt_adapter_update_bt_disabled>>");
201 int power_off_status = 0;
204 /* Update the vconf LE status in normal Deactivation case only */
205 ret = vconf_get_int(VCONFKEY_SYSMAN_POWER_OFF_STATUS, &power_off_status);
206 BT_DBG("ret : %d, power_off_status : %d", ret, power_off_status);
208 /* Update LE Status to notify other modules */
209 if (vconf_set_int(VCONFKEY_BT_LE_STATUS, VCONFKEY_BT_LE_STATUS_OFF) != 0)
210 BT_ERR("Set vconf failed");
212 /* TODO:Add timer function to handle any further post processing */
213 g_idle_add((GSourceFunc)__bt_le_post_set_disabled, NULL);
215 /* Return BT_ADAPTER_DISABLE Method invocation context */
216 __bt_le_handle_pending_requests(BT_DISABLE_ADAPTER_LE, NULL, 0);
218 /* Send BT Disabled event to application */
219 _bt_send_event(BT_LE_ADAPTER_EVENT, BLUETOOTH_EVENT_LE_DISABLED,
220 g_variant_new("(i)", result));
223 static void __bt_set_le_scan_status(gboolean mode)
225 BT_DBG("Set scanning status: %s", mode == TRUE ? "TRUE" : "FALSE");
226 is_le_scanning = mode;
229 gboolean _bt_is_le_scanning(void)
231 return is_le_scanning;
234 bt_adapter_le_scanner_t* __bt_find_scanner_from_list(const char *sender)
237 bt_adapter_le_scanner_t *scanner;
239 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
241 if (g_strcmp0(scanner->sender, sender) == 0)
249 static void __bt_adapter_le_handle_pending_request_info(int result,
250 int service_function, void *param, unsigned int size)
254 invocation_info_t *req_info = NULL;
257 for (l = _bt_get_invocation_list(); l != NULL; ) {
260 if (req_info == NULL || req_info->service_function != service_function)
263 switch (service_function) {
264 case BT_SET_ADVERTISING:
265 case BT_SET_CUSTOM_ADVERTISING:
266 case BT_SET_ADVERTISING_DATA:
267 case BT_SET_SCAN_RESPONSE_DATA: {
269 bt_pending_adv_data_set_t *data;
271 BT_DBG("Service function: [%d]", service_function);
272 ret_if(param == NULL);
274 saved_handle = (int*)req_info->user_data;
275 data = (bt_pending_adv_data_set_t*)param;
276 BT_DBG("Current Sender [%s] Current Handle [%d]", data->sender, data->adv_handle);
278 if (!g_strcmp0(req_info->sender, data->sender) && (*saved_handle == data->adv_handle)) {
279 BT_DBG("Requester found [%s] ADV Handle [%d]", req_info->sender, *saved_handle);
280 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
281 g_array_append_vals(out_param, &data->adv_handle, sizeof(int));
282 _bt_service_method_return(req_info->context, out_param, result);
285 g_free(req_info->user_data);
286 _bt_free_info_from_invocation_list(req_info);
287 g_array_free(out_param, TRUE);
291 case BT_START_LE_DISCOVERY: {
292 bt_adapter_le_scanner_t *scanner;
294 BT_DBG("Request Sender: [%s]", req_info->sender);
295 if (BLUETOOTH_ERROR_NONE != result) {
296 scanner = __bt_find_scanner_from_list(req_info->sender);
297 if (scanner && scanner->is_scanning)
298 scanner->is_scanning = FALSE;
301 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
302 _bt_service_method_return(req_info->context, out_param, result);
303 _bt_free_info_from_invocation_list(req_info);
304 g_array_free(out_param, TRUE);
307 case BT_STOP_LE_DISCOVERY: {
308 BT_DBG("Request Sender: [%s]", req_info->sender);
309 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
310 _bt_service_method_return(req_info->context, out_param, result);
311 _bt_free_info_from_invocation_list(req_info);
312 g_array_free(out_param, TRUE);
322 static void __bt_le_handle_server_instance_registered(event_gatts_register_t *data)
326 char uuid_string[BLUETOOTH_UUID_STRING_MAX];
327 bluetooth_advertising_data_t adv;
328 bluetooth_scan_resp_data_t scan_rsp;
329 int result = BLUETOOTH_ERROR_NONE;
330 bt_pending_adv_data_set_t *info = NULL;
332 memset(adv.data, 0, sizeof(adv.data));
333 memset(scan_rsp.data, 0, sizeof(scan_rsp.data));
335 _bt_uuid_to_string(&(data->server_uuid), uuid_string);
336 BT_INFO("Instance ID is Intialized [%d] UUID initialized [%s]", data->server_inst, uuid_string);
338 /* Get sender and adv handle for the server instance */
339 _bt_get_adv_handle_from_instance(data->server_inst, &adv_handle);
341 /* Check if pending Adv Data set or Scan response data set request is pending*/
342 for (l = adv_data_pending_list; l != NULL; l = l->next) {
345 if (info && (adv_handle == info->adv_handle)) {
346 if (info->is_data_set_pending) {
347 BT_INFO("LE Data set request is pending");
349 memcpy(&adv.data, info->data, info->data_len);
350 result = _bt_set_advertising_data(info->sender,
351 info->adv_handle, &adv, info->data_len, FALSE);
352 if (result != BLUETOOTH_ERROR_NONE) {
353 __bt_adapter_le_handle_pending_request_info(result,
354 BT_SET_ADVERTISING_DATA,
355 (void*)info, sizeof(bt_pending_adv_data_set_t));
359 memcpy(&scan_rsp.data, info->data, info->data_len);
360 result = _bt_set_scan_response_data(info->sender,
361 info->adv_handle, &scan_rsp, info->data_len, FALSE);
362 if (result != BLUETOOTH_ERROR_NONE) {
363 __bt_adapter_le_handle_pending_request_info(result,
364 BT_SET_SCAN_RESPONSE_DATA, (void*)info,
365 sizeof(bt_pending_adv_data_set_t));
370 BT_INFO("LE Enable Adv request is pending");
371 if (info->is_custom_adv) {
372 result = _bt_set_custom_advertising(info->sender, info->adv_handle,
373 TRUE, &info->params, FALSE/*Reserved Slot*/);
374 if (result != BLUETOOTH_ERROR_NONE) {
375 __bt_adapter_le_handle_pending_request_info(result,
376 BT_SET_CUSTOM_ADVERTISING,
377 (void*)info, sizeof(bt_pending_adv_data_set_t));
381 result = _bt_set_advertising(info->sender, info->adv_handle,
382 TRUE, FALSE/*Reserved Slot*/);
383 if (result != BLUETOOTH_ERROR_NONE) {
384 __bt_adapter_le_handle_pending_request_info(result,
386 (void*)info, sizeof(bt_pending_adv_data_set_t));
397 adv_data_pending_list = g_slist_remove(adv_data_pending_list, info);
398 g_free(info->sender);
402 static void __bt_le_multi_advertising_enabled(event_ble_multiadv_status *event)
406 bt_pending_adv_data_set_t *info = NULL;
407 GVariant *param = NULL;
408 int result = BLUETOOTH_ERROR_NONE;
410 sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
411 if (sender == NULL) {
412 BT_ERR("Abnormal!!");
414 if (event->status != OAL_STATUS_SUCCESS)
415 result = BLUETOOTH_ERROR_INTERNAL;
416 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
417 info->sender = sender;
418 info->adv_handle = adv_handle;
419 __bt_adapter_le_handle_pending_request_info(result,
420 BT_SET_CUSTOM_ADVERTISING,
421 (void*)info, sizeof(bt_pending_adv_data_set_t));
422 __bt_adapter_le_handle_pending_request_info(result,
424 (void*)info, sizeof(bt_pending_adv_data_set_t));
427 param = g_variant_new("(ii)", result, info->adv_handle);
428 _bt_send_event_to_dest(info->sender, BT_ADAPTER_EVENT, BLUETOOTH_EVENT_ADVERTISING_STARTED, param);
431 g_free(info->sender);
436 static void __bt_le_multi_advertising_disabled(event_ble_multiadv_status *event)
440 bt_pending_adv_data_set_t *info = NULL;
441 GVariant *param = NULL;
442 int result = BLUETOOTH_ERROR_NONE;
443 sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
445 if (sender == NULL) {
446 BT_INFO("Means application containing the adv info is already freed!!");
448 if (event->status != OAL_STATUS_SUCCESS)
449 result = BLUETOOTH_ERROR_INTERNAL;
450 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
451 info->sender = sender;
452 info->adv_handle = adv_handle;
453 __bt_adapter_le_handle_pending_request_info(result,
454 BT_SET_CUSTOM_ADVERTISING,
455 (void*)info, sizeof(bt_pending_adv_data_set_t));
456 __bt_adapter_le_handle_pending_request_info(result,
458 (void*)info, sizeof(bt_pending_adv_data_set_t));
460 param = g_variant_new("(ii)", result, info->adv_handle);
461 _bt_send_event_to_dest(info->sender, BT_ADAPTER_EVENT, BLUETOOTH_EVENT_ADVERTISING_STOPPED, param);
463 /* Free allocated slot or server instance from stack to be used for other advertisng */
464 result = _bt_unregister_server_instance(sender, adv_handle);
467 g_free(info->sender);
472 static void __bt_le_multi_advertising_set_data(event_ble_multiadv_status *event)
476 bt_pending_adv_data_set_t *info = NULL;
477 int result = BLUETOOTH_ERROR_NONE;
478 sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
480 if (sender == NULL) {
481 BT_ERR("Abnormal!!");
483 BT_DBG("Sender [%s], adv handle [%d]", sender, adv_handle);
484 if (event->status != OAL_STATUS_SUCCESS)
485 result = BLUETOOTH_ERROR_INTERNAL;
487 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
488 info->sender = sender;
489 info->adv_handle = adv_handle;
490 BT_DBG("Sender [%s], adv handle [%d]", info->sender, info->adv_handle);
491 __bt_adapter_le_handle_pending_request_info(result,
492 BT_SET_SCAN_RESPONSE_DATA,
493 (void*)info, sizeof(bt_pending_adv_data_set_t));
494 __bt_adapter_le_handle_pending_request_info(result,
495 BT_SET_ADVERTISING_DATA,
496 (void*)info, sizeof(bt_pending_adv_data_set_t));
497 g_free(info->sender);
502 static int __get_advertisement_data(unsigned char *dest, unsigned char *src)
510 if ((len == 0) || (31 < (i + len))) {
511 BT_INFO("length: %d", length);
512 memcpy(dest, src, length);
523 static void __bt_le_handle_device_found(event_ble_scan_result_info *scan_result)
525 int result = BLUETOOTH_ERROR_NONE;
526 bt_adapter_le_scanner_t *scanner = NULL;
527 char address[BT_ADDRESS_STRING_SIZE];
528 int addr_type = 0x01; /* TODO: Need to get correct address type */
529 unsigned char adv_ind_data[31];
530 unsigned char scan_resp_data[31];
532 int scan_resp_len = 0;
533 char *tmp_str = NULL;
534 GVariant *scan_data_param;
535 GVariant *adv_data_param;
540 ret_if(NULL == scan_result);
542 _bt_convert_addr_type_to_string(address, scan_result->address.addr);
544 memset(adv_ind_data, 0x00, sizeof(adv_ind_data));
545 adv_ind_len = __get_advertisement_data(
546 adv_ind_data, &(scan_result->adv_data[0]));
548 memset(scan_resp_data, 0x00, sizeof(scan_resp_data));
549 scan_resp_len = __get_advertisement_data(
550 scan_resp_data, &(scan_result->adv_data[adv_ind_len]));
552 BT_INFO("Address: %s, RSSI: %d, adv_ind_len: %d, scan_resp_len: %d",
553 address, scan_result->rssi, adv_ind_len, scan_resp_len);
555 tmp_str = _bt_service_convert_hex_to_string(scan_result->adv_data, 62);
556 BT_INFO("Complete Data: [%s]", tmp_str);
560 tmp_str = _bt_service_convert_hex_to_string(adv_ind_data, adv_ind_len);
561 BT_INFO("Adv Ind Data: [%s]", tmp_str);
565 tmp_str = _bt_service_convert_hex_to_string(scan_resp_data, scan_resp_len);
566 BT_INFO("Scan resp Data: [%s]", tmp_str);
570 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
572 if (scanner->is_scanning == FALSE)
575 adv_data_param = g_variant_new_from_data((const GVariantType *)"ay",
576 adv_ind_data, adv_ind_len, TRUE, NULL, NULL);
577 scan_data_param = g_variant_new_from_data((const GVariantType *)"ay",
578 scan_resp_data, scan_resp_len, TRUE, NULL, NULL);
580 param = g_variant_new("(isnnn@ayn@ay)",
582 addr_type, scan_result->rssi,
583 adv_ind_len, adv_data_param,
584 scan_resp_len, scan_data_param);
586 _bt_send_event_to_dest(scanner->sender, BT_LE_ADAPTER_EVENT,
587 BLUETOOTH_EVENT_REMOTE_LE_DEVICE_FOUND, param);
593 static void __bt_le_state_change_callback(int bt_status)
595 BT_INFO("__bt_le_state_change_callback: status [%d]", bt_status);
598 case BT_LE_DEACTIVATED:
599 _bt_adapter_set_le_status(bt_status);
601 /* Add Adapter disabled post processing codes */
602 __bt_le_update_bt_disabled();
604 case BT_LE_ACTIVATED:
605 _bt_adapter_set_le_status(bt_status);
607 /* Add Adapter enabled post processing codes */
609 BT_DBG("g_source is removed");
610 g_source_remove(timer_id);
613 __bt_le_update_bt_enabled();
616 BT_ERR("Incorrect Bluetooth adapter state changed status");
622 static void __bt_le_event_handler(int event_type, gpointer event_data)
624 BT_INFO("OAL event = 0x%x, \n", event_type);
626 switch (event_type) {
627 case OAL_EVENT_BLE_ENABLED: {
628 __bt_le_state_change_callback(BT_LE_ACTIVATED);
631 case OAL_EVENT_BLE_DISABLED: {
632 __bt_le_state_change_callback(BT_LE_DEACTIVATED);
635 case OAL_EVENT_BLE_SERVER_INSTANCE_INITIALISED: {
636 BT_INFO("OAL Event: Server Instance Registered");
637 __bt_le_handle_server_instance_registered((event_gatts_register_t *)event_data);
640 case OAL_EVENT_BLE_ADVERTISING_STARTED: {
641 BT_INFO("OAL Event: Legacy Advertising Enabled: Not Supported!!");
644 case OAL_EVENT_BLE_ADVERTISING_STOPPED: {
645 BT_INFO("OAL Event: Legacy Advertising Disabled: Not Supported!!");
648 case OAL_EVENT_BLE_MULTI_ADVERTISING_ENABLE: {
649 BT_INFO("OAL Event: Advertising Enabled");
650 __bt_le_multi_advertising_enabled((event_ble_multiadv_status *)event_data);
653 case OAL_EVENT_BLE_MULTI_ADVERTISING_DISABLE: {
654 BT_INFO("OAL Event: Advertising Disabled");
655 __bt_le_multi_advertising_disabled((event_ble_multiadv_status *)event_data);
658 case OAL_EVENT_BLE_MULTI_ADVERTISING_SET_INST_DATA: {
659 BT_INFO("OAL Event: Advertising Data set successfully");
660 __bt_le_multi_advertising_set_data((event_ble_multiadv_status *)event_data);
663 case OAL_EVENT_BLE_MULTI_ADVERTISING_UPDATE: {
664 BT_INFO("OAL Event: Advertising Params updated");
667 case OAL_EVENT_BLE_DISCOVERY_STARTED: {
668 __bt_set_le_scan_status(TRUE);
669 __bt_adapter_le_handle_pending_request_info(
670 BLUETOOTH_ERROR_NONE,
671 BT_START_LE_DISCOVERY, NULL, 0);
674 case OAL_EVENT_BLE_DISCOVERY_STOPPED: {
675 if (!_bt_is_le_scanning()) {
676 BT_ERR("LE discovery start failed");
677 __bt_adapter_le_handle_pending_request_info(
678 BLUETOOTH_ERROR_INTERNAL,
679 BT_START_LE_DISCOVERY, NULL, 0);
683 __bt_set_le_scan_status(FALSE);
684 _bt_disable_all_scanner_status();
685 __bt_adapter_le_handle_pending_request_info(
686 BLUETOOTH_ERROR_NONE,
687 BT_STOP_LE_DISCOVERY, NULL, 0);
690 case OAL_EVENT_BLE_REMOTE_DEVICE_FOUND: {
691 event_ble_scan_result_info *scan_result = event_data;
692 BT_INFO("OAL Event: OAL_EVENT_BLE_REMOTE_DEVICE_FOUND");
693 __bt_le_handle_device_found(scan_result);
696 case OAL_EVENT_GATTC_REGISTRATION: {
697 event_gattc_register_t *gattc_event = event_data;
698 char uuid_str[BLUETOOTH_UUID_STRING_MAX];
699 char *default_uuid_string;
701 default_uuid_string = _bt_gatt_get_default_gatt_client_uuid();
702 _bt_uuid_to_string((service_uuid_t*)&(gattc_event->client_uuid), uuid_str);
703 BT_INFO("default UUID [%s] current registered uuid [%s]",
704 default_uuid_string, uuid_str);
705 if (g_strcmp0(uuid_str, default_uuid_string)) {
706 BT_INFO("This is not the default GATT client that is registered");
708 g_free(default_uuid_string);
711 BT_INFO("GATT CLient instance registered is default client: ID [%d]",
712 gattc_event->client_if);
713 g_free(default_uuid_string);
715 g_gatt_client_id = gattc_event->client_if;
718 case OAL_EVENT_BLE_LOCAL_FEATURES: {
719 event_adapter_le_features_t *le_features = event_data;
721 le_feature_info.le_2m_phy = le_features->le_2m_phy_support;
722 le_feature_info.le_coded_phy = le_features->le_coded_phy_support;
723 le_feature_info.max_filter = le_features->max_adv_filter;
725 BT_INFO("Adapter LE 2M PHY Support [%s]", le_feature_info.le_2m_phy ? "TRUE" : "FALSE");
726 BT_INFO("Adapter LE CODED PHY Support [%s]", le_feature_info.le_coded_phy ? "TRUE" : "FALSE");
735 int _bt_unregister_scan_filter(const char *sender, int slot_id)
738 bt_adapter_le_scanner_t *scanner = NULL;
739 bluetooth_le_scan_filter_t *scan_filter_data = NULL;
741 gboolean is_slot_id_found = FALSE;
743 scanner = __bt_find_scanner_from_list(sender);
744 if (scanner == NULL) {
745 BT_ERR("There is NO available scanner.");
746 return BLUETOOTH_ERROR_NOT_FOUND;
749 for (l = scanner->filter_list; l != NULL; l = g_slist_next(l)) {
750 scan_filter_data = l->data;
751 if (scan_filter_data->slot_id == slot_id) {
752 is_slot_id_found = TRUE;
756 if (is_slot_id_found == FALSE) {
757 BT_ERR("There is NO registered slot.");
758 return BLUETOOTH_ERROR_NOT_FOUND;
760 ret = gattc_unregister_scan_filter(slot_id);
761 if (OAL_STATUS_SUCCESS != ret) {
762 BT_ERR("gattc_unregister_scan_filter failed");
763 return BLUETOOTH_ERROR_INTERNAL;
765 scanner->filter_list = g_slist_remove(scanner->filter_list, scan_filter_data);
766 g_free(scan_filter_data);
767 return BLUETOOTH_ERROR_NONE;
770 int _bt_unregister_all_scan_filters(const char* sender)
773 bt_adapter_le_scanner_t *scanner = NULL;
774 bluetooth_le_scan_filter_t *filter_data = NULL;
777 scanner = __bt_find_scanner_from_list(sender);
779 if (scanner == NULL) {
780 BT_ERR("There is NO available scanner.");
781 return BLUETOOTH_ERROR_NOT_FOUND;
783 for (l = scanner->filter_list; l != NULL; l = g_slist_next(l)) {
784 filter_data = l->data;
786 ret = gattc_unregister_scan_filter(filter_data->slot_id);
788 if (OAL_STATUS_SUCCESS != ret)
789 BT_ERR("gattc_unregister_scan_filter failed for slot_id = [%d]", filter_data->slot_id);
792 g_slist_free_full(scanner->filter_list, g_free);
793 scanner->filter_list = NULL;
795 return BLUETOOTH_ERROR_NONE;
798 int _bt_le_init(void)
801 /* Register LE event handler */
802 _bt_service_register_event_handler_callback(BT_ADAPTER_LE_MODULE, __bt_le_event_handler);
804 return BLUETOOTH_ERROR_NONE;
807 void _bt_le_deinit(void)
810 /* Un-register LE event handler */
811 _bt_service_unregister_event_handler_callback(BT_ADAPTER_LE_MODULE);
815 static void __bt_le_update_discovery_status(bt_adapter_discovery_state_t status)
817 BT_INFO("adapter_discovery_status changed [%d] -> [%d]", adapter_le_discovery_state, status);
818 adapter_le_discovery_state = status;
821 static int __bt_le_state_handle_request(gboolean enable)
823 int result = BLUETOOTH_ERROR_NONE;
826 switch (_bt_adapter_get_le_status()) {
827 case BT_LE_ACTIVATING: {
828 BT_INFO("LE is currently in activating state, state [%d]",
829 _bt_adapter_get_le_status());
831 return BLUETOOTH_ERROR_IN_PROGRESS;
833 if (adapter_le_discovery_state == LE_DISCOVERY_STARTED ||
834 adapter_le_discovery_state == LE_DISCOVERY_STARTING) {
835 /*TODO Stop Discovery*/
836 __bt_le_update_discovery_status(FALSE);
838 result = le_disable(); //change
839 if (result != OAL_STATUS_SUCCESS) {
840 BT_ERR("LE_enable failed: [%d]", result);
841 result = BLUETOOTH_ERROR_INTERNAL;
842 /*TODO: perform if anything more needs to be done to handle failure */
844 /* TODO: To be handled */
845 _bt_adapter_set_le_status(BT_LE_DEACTIVATING);
846 result = BLUETOOTH_ERROR_NONE;
851 case BT_LE_ACTIVATED: {
852 BT_INFO("LE is currently in activated state, state [%d]",
853 _bt_adapter_get_le_status());
855 return BLUETOOTH_ERROR_DEVICE_ALREADY_ENABLED;
857 if (adapter_le_discovery_state == LE_DISCOVERY_STARTED ||
858 adapter_le_discovery_state == LE_DISCOVERY_STARTING) {
859 /*TODO Stop Discovery*/
860 __bt_le_update_discovery_status(FALSE);
862 result = le_disable();
863 if (result != OAL_STATUS_SUCCESS) {
864 BT_ERR("LE_enable failed: [%d]", result);
865 result = BLUETOOTH_ERROR_INTERNAL;
866 /*TODO: perform if anything more needs to be done to handle failure */
868 /* TODO: To be handled */
869 _bt_adapter_set_le_status(BT_LE_DEACTIVATING);
870 result = BLUETOOTH_ERROR_NONE;
875 case BT_LE_DEACTIVATING: {
876 BT_INFO("LE is currently in deactivating state, state [%d]",
877 _bt_adapter_get_le_status());
879 return BLUETOOTH_ERROR_IN_PROGRESS;
882 result = le_enable();
883 if (result != OAL_STATUS_SUCCESS && result != OAL_STATUS_PENDING) {
884 BT_ERR("LE_enable failed: [%d]", result);
886 result = BLUETOOTH_ERROR_INTERNAL;
887 /*TODO: perform if anything more needs to be done to handle failure */
889 /* TODO: To be handled */
890 _bt_adapter_set_le_status(BT_LE_ACTIVATING);
891 result = BLUETOOTH_ERROR_NONE;
896 case BT_LE_DEACTIVATED: {
897 BT_INFO("LE is currently in deactivated state, state [%d]",
898 _bt_adapter_get_le_status());
900 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
902 result = le_enable();
903 if (result != OAL_STATUS_SUCCESS && result != OAL_STATUS_PENDING) {
904 BT_ERR("LE_enable failed: [%d]", result);
906 result = BLUETOOTH_ERROR_INTERNAL;
907 /*TODO: perform if anything more needs to be done to handle failure */
909 /* TODO: To be handled */
910 _bt_adapter_set_le_status(BT_LE_ACTIVATING);
911 result = BLUETOOTH_ERROR_NONE;
917 BT_ERR("Unknown state: %d", _bt_adapter_get_le_status());
921 if (enable && result == BLUETOOTH_ERROR_NONE) {
922 /* Adapter enable request is successful, setup event handlers */
923 _bt_service_register_event_handler_callback(
924 BT_ADAPTER_LE_MODULE, __bt_le_event_handler);
925 _bt_device_state_handle_callback_set_request();
930 int _bt_enable_adapter_le(void)
932 return __bt_le_state_handle_request(TRUE);
935 int _bt_disable_adapter_le(void)
937 return __bt_le_state_handle_request(FALSE);
941 static gboolean __bt_is_factory_test_mode(void)
945 if (vconf_get_bool(VCONFKEY_BT_DUT_MODE, &mode)) {
946 BT_ERR("Get the DUT Mode fail");
951 BT_INFO("DUT Test Mode !!");
958 int _bt_set_advertising(const char *sender, int adv_handle, gboolean enable, gboolean use_reserved_slot)
960 BT_CHECK_PARAMETER(sender, return);
962 bt_pending_adv_data_set_t *info = NULL;
963 int result = OAL_STATUS_SUCCESS;
966 if (__bt_is_factory_test_mode()) {
967 BT_ERR("Unable to start advertising in factory binary !!");
968 return BLUETOOTH_ERROR_NOT_SUPPORT;
971 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
973 if (server_instance == -1) {
974 BT_DBG("No available slot for the current sender and handle combination");
976 if (enable == FALSE) {
977 BT_ERR("Advertising not even enabled on adv handle [%d] sender [%s]", adv_handle, sender);
978 return BLUETOOTH_ERROR_NOT_IN_OPERATION;
981 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
983 if (server_instance == -1) {
984 /* Internal Logic to register server instance if not initialized, store adv handle for future use */
985 if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
986 return BLUETOOTH_ERROR_INTERNAL;
988 /* Allocate a pending structure and mark Adv data set pending */
989 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
990 info->adv_handle = adv_handle;
991 info->sender = g_strdup(sender);
992 info->is_data_set_pending = FALSE;
993 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
994 return BLUETOOTH_ERROR_NONE;
1000 result = adapter_ble_multi_adv_enable(server_instance);
1002 result = adapter_ble_multi_adv_disable(server_instance);
1003 if (result != OAL_STATUS_SUCCESS) {
1004 BT_ERR("OAL API adapter_ble_multi_adv_enable Fail %d", result);
1005 return BLUETOOTH_ERROR_INTERNAL;
1008 /* Update adv handle in table */
1009 _bt_update_adv_handle(sender, adv_handle);
1011 return BLUETOOTH_ERROR_NONE;
1014 int _bt_set_custom_advertising(const char *sender, int adv_handle,
1015 gboolean enable, bluetooth_advertising_params_t *params, gboolean use_reserved_slot)
1017 BT_CHECK_PARAMETER(sender, return);
1018 int server_instance;
1019 bt_pending_adv_data_set_t *info = NULL;
1020 int result = OAL_STATUS_SUCCESS;
1023 if (__bt_is_factory_test_mode()) {
1024 BT_ERR("Unable to start advertising in factory binary !!");
1025 return BLUETOOTH_ERROR_NOT_SUPPORT;
1028 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1030 if (server_instance == -1) {
1031 BT_DBG("No available slot for the current sender and handle combination");
1033 if (enable == FALSE) {
1034 BT_ERR("Advertising not even enabled on adv handle [%d] sender [%s]", adv_handle, sender);
1035 return BLUETOOTH_ERROR_NOT_IN_OPERATION;
1037 /* Below logic is only valid only when enabling advertising */
1038 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
1040 if (server_instance == -1) {
1041 /* Internal Logic to register server instance if not initialized, store adv handle for future use */
1042 if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
1043 return BLUETOOTH_ERROR_INTERNAL;
1045 /* Allocate a pending structure and mark Adv data set pending */
1046 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
1047 info->adv_handle = adv_handle;
1048 info->sender = g_strdup(sender);
1049 info->is_custom_adv = TRUE;
1050 info->is_data_set_pending = FALSE;
1051 memcpy(&info->params, params, sizeof(bluetooth_advertising_params_t));
1052 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
1053 return BLUETOOTH_ERROR_NONE;
1059 /* Set Advertising parameters to Stack */
1060 result = adapter_ble_multi_adv_update(server_instance, params->interval_min, params->interval_max,
1061 params->type, BT_ADV_DEFAULT_CHANNEL_MAP, params->tx_power_level, BT_ADV_DEFAULT_TIMEOUT);
1062 if (result != OAL_STATUS_SUCCESS) {
1063 BT_ERR("OAL API adapter_ble_multi_adv_update Fail %d", result);
1064 return BLUETOOTH_ERROR_INTERNAL;
1066 /* Start Advertising when Adv update event is received */
1067 result = adapter_ble_multi_adv_enable(server_instance);
1068 if (result != OAL_STATUS_SUCCESS) {
1069 BT_ERR("OAL API adapter_ble_multi_adv_enable Fail %d", result);
1070 return BLUETOOTH_ERROR_INTERNAL;
1072 /* Update adv handle in table */
1073 _bt_update_adv_handle(sender, adv_handle);
1075 return BLUETOOTH_ERROR_NONE;
1077 result = adapter_ble_multi_adv_disable(server_instance);
1079 if (result != OAL_STATUS_SUCCESS) {
1080 BT_ERR("OAL API adapter_ble_multi_adv_disable Fail %d", result);
1081 return BLUETOOTH_ERROR_INTERNAL;
1083 return BLUETOOTH_ERROR_NONE;
1086 int _bt_get_advertising_data(char *sender, int adv_handle, bluetooth_advertising_data_t *adv, int *length)
1088 BT_CHECK_PARAMETER(adv, return);
1089 BT_CHECK_PARAMETER(length, return);
1090 BT_CHECK_PARAMETER(sender, return);
1092 int server_instance;
1094 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, FALSE);
1096 if (server_instance == -1) {
1097 BT_DBG("No available slot for the current sender and handle combination");
1098 return BLUETOOTH_ERROR_INTERNAL;
1101 _bt_get_previous_adv_data(adv, length, server_instance);
1102 BT_DBG("ADV Data length [%d] Server Instance [%d] Adv handle [%d]", *length, server_instance, adv_handle);
1104 return BLUETOOTH_ERROR_NONE;
1107 int _bt_get_scan_response_data(char *sender, int adv_handle, bluetooth_scan_resp_data_t *response, int *length)
1109 BT_CHECK_PARAMETER(response, return);
1110 BT_CHECK_PARAMETER(length, return);
1111 BT_CHECK_PARAMETER(sender, return);
1113 int server_instance;
1115 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, FALSE);
1117 if (server_instance == -1) {
1118 BT_DBG("No available slot for the current sender and handle combination");
1119 return BLUETOOTH_ERROR_INTERNAL;
1122 _bt_get_previous_scan_rsp_data(response, length, server_instance);
1123 BT_DBG("SCAN RSP Data length [%d] Server Instance [%d] Adv handle [%d]", *length, server_instance, adv_handle);
1125 return BLUETOOTH_ERROR_NONE;
1128 static int __bt_set_multi_adv_param(oal_ble_multi_adv_param_setup_t *adv_setup,
1129 bluetooth_advertising_data_t *adv_data, int length)
1135 retv_if(NULL == adv_data, BLUETOOTH_ERROR_INVALID_PARAM);
1136 retv_if(NULL == adv_setup, BLUETOOTH_ERROR_INVALID_PARAM);
1138 for (ptr = adv_data->data; NULL != ptr && length > 0;) {
1142 BT_INFO("len: %d, type: %x", len, type);
1145 case 0xFF: /* Manufacturer Data */
1146 adv_setup->manufacturer_data = g_malloc0(sizeof(char) * (len - 1));
1147 memcpy(adv_setup->manufacturer_data, (ptr + 2), (len - 1));
1148 adv_setup->manufacturer_data_len = len - 1;
1150 case 0x15: /* 128 bit Solicit UUID */
1151 adv_setup->solicit_uuid = g_malloc0(sizeof(char) * (len - 1));
1152 memcpy((adv_setup->solicit_uuid), (ptr + 2), (len - 1));
1153 adv_setup->solicit_uuid_len = len;
1155 case 0x06: /* 128 bit Service UUID */
1156 adv_setup->service_uuid = g_malloc0(sizeof(char) * (len - 1));
1157 memcpy((adv_setup->service_uuid), (ptr + 2), (len - 1));
1158 adv_setup->service_uuid_len = len;
1160 case 0x14: { /* 16 bit Solicit UUID */
1163 num_uuids = (len -1)/2;
1164 adv_setup->solicit_uuid = g_malloc0(sizeof(char) * 16 * num_uuids);
1165 char *tmp = adv_setup->solicit_uuid;
1166 adv_setup->solicit_uuid_len = 0;
1168 for (c = 1; c <= num_uuids; c++) {
1169 adv_setup->solicit_uuid_len += 16;;
1170 memcpy(tmp, BASE_UUID_CONVERTED, BT_UUID_128);
1171 memcpy(tmp+12, &ptr[c*2/* Byte Length*/], 2/* Byte Length */);
1177 for (k = 0; k < 16 * num_uuids; k++)
1178 BT_DBG("%x", adv_setup->solicit_uuid[k]);
1181 case 0x02: { /* 16 bit Service UUID */
1184 num_uuids = (len -1)/2;
1185 adv_setup->service_uuid = g_malloc0(sizeof(char) * 16 * num_uuids);
1186 char *tmp = adv_setup->service_uuid;
1187 adv_setup->service_uuid_len = 0;
1189 for (c = 1; c <= num_uuids; c++) {
1190 adv_setup->service_uuid_len += 16;;
1191 memcpy(tmp, BASE_UUID_CONVERTED, BT_UUID_128);
1192 memcpy(tmp+12, &ptr[c*2/* Byte Length */], 2/* Byte Length */);
1198 for (k = 0; k < 16 * num_uuids; k++)
1199 BT_DBG("%x", adv_setup->service_uuid[k]);
1202 case 0x16: { /* Service Data */
1203 adv_setup->service_data = g_malloc0(sizeof(char) * (len - 1));
1204 memcpy(adv_setup->service_data, (ptr + 2), (len - 1));
1205 adv_setup->service_data_len = len - 1;
1209 BT_INFO("128 Bit Service Data Not Supported!!");
1213 adv_setup->include_txpower = 1;
1218 adv_setup->include_name = 1;
1222 memcpy(&adv_setup->appearance, (ptr + 2), (len - 1));
1226 BT_ERR("Unknown type: %x", type);
1235 return BLUETOOTH_ERROR_NONE;
1238 int _bt_set_advertising_data(const char *sender, int adv_handle,
1239 bluetooth_advertising_data_t *adv, int length, gboolean use_reserved_slot)
1241 BT_CHECK_PARAMETER(adv, return);
1242 BT_CHECK_PARAMETER(sender, return);
1243 bt_pending_adv_data_set_t *info = NULL;
1244 int server_instance;
1245 bluetooth_advertising_data_t adv_old;
1247 char *old_mdata = NULL;
1249 GVariant *ad_data, *param = NULL;
1250 oal_ble_multi_adv_param_setup_t adv_setup;
1251 int result = OAL_STATUS_SUCCESS;
1254 if (length > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
1255 return BLUETOOTH_ERROR_INVALID_PARAM;
1257 if (__bt_is_factory_test_mode()) {
1258 BT_ERR("Unable to set advertising data in factory binary !!");
1259 return BLUETOOTH_ERROR_NOT_SUPPORT;
1262 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1264 if (server_instance == -1) {
1265 BT_DBG("No available slot for the current sender and handle combination");
1267 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
1269 if (server_instance == -1) {
1270 /* Internal Logic to register server instance if not initialized, store adv handle for future use */
1271 if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
1272 return BLUETOOTH_ERROR_INTERNAL;
1274 /* Allocate a pending structure and mark Adv data set pending */
1275 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
1276 info->adv_handle = adv_handle;
1277 info->sender = g_strdup(sender);
1278 info->data_len = length;
1279 info->is_adv = TRUE;
1280 info->is_data_set_pending = TRUE;
1281 memcpy(&info->data, &(adv->data[0]), length);
1282 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
1283 return BLUETOOTH_ERROR_NONE;
1288 /* Server Instance is already allocated, set Adv data to stack */
1289 /* First check if adv data is already present for slot server_instance*/
1290 memset(&adv_old.data, 0, sizeof(adv_old.data));
1291 _bt_get_previous_adv_data(&adv_old, &adv_data_len, server_instance);
1293 /* Send Data to stack */
1294 memset(&adv_setup, 0, sizeof(oal_ble_multi_adv_param_setup_t));
1296 if (BLUETOOTH_ERROR_NONE !=
1297 __bt_set_multi_adv_param(&adv_setup, adv, length)) {
1298 if (adv_setup.manufacturer_data)
1299 g_free(adv_setup.manufacturer_data);
1300 if (adv_setup.service_uuid)
1301 g_free(adv_setup.service_uuid);
1302 if (adv_setup.service_data)
1303 g_free(adv_setup.service_data);
1304 return BLUETOOTH_ERROR_INTERNAL;
1306 /* Set Scan response false */
1307 adv_setup.set_scan_rsp = FALSE;
1309 /* Set Server instance */
1310 adv_setup.server_if = server_instance;
1312 /* Set Server instance[Product Requirement] */
1313 adv_setup.tx_power = 4;
1315 BT_DBG("####Service UUID len [%d], service data len [%d] Solicit UUID len [%d]",
1316 adv_setup.solicit_uuid_len, adv_setup.service_uuid_len, adv_setup.service_data_len);
1317 result = adapter_ble_multi_adv_set_inst_data(server_instance, &adv_setup);
1318 if (result != OAL_STATUS_SUCCESS) {
1319 BT_ERR("OAL API adapter_ble_multi_adv_set_inst_data Fail %d", result);
1321 if (adv_setup.manufacturer_data)
1322 g_free(adv_setup.manufacturer_data);
1323 if (adv_setup.service_data)
1324 g_free(adv_setup.service_data);
1325 if (adv_setup.service_uuid)
1326 g_free(adv_setup.service_uuid);
1327 return BLUETOOTH_ERROR_INTERNAL;
1330 /* Data sent to Stack successfully, send manuf data changed event if applicable */
1331 if (adv_setup.manufacturer_data_len != 0) {
1332 if (adv_data_len > 0) {
1333 _bt_get_ad_data_by_type((char *)adv_old.data, adv_data_len, 0xff,
1334 &old_mdata, &old_len);
1337 if (old_len != adv_setup.manufacturer_data_len ||
1338 (old_mdata && adv_setup.manufacturer_data &&
1339 memcmp(old_mdata, adv_setup.manufacturer_data, adv_setup.manufacturer_data_len))) {
1341 ad_data = g_variant_new_from_data((const GVariantType *)"ay",
1342 adv_setup.manufacturer_data, adv_setup.manufacturer_data_len, TRUE, NULL, NULL);
1343 param = g_variant_new("(@ay)", ad_data);
1344 _bt_send_event(BT_ADAPTER_EVENT,
1345 BLUETOOTH_EVENT_ADVERTISING_MANUFACTURER_DATA_CHANGED,
1352 /* Time to update new ADV data completely in Table */
1353 _bt_set_new_adv_data(adv, length, server_instance);
1356 if (adv_setup.manufacturer_data)
1357 g_free(adv_setup.manufacturer_data);
1358 if (adv_setup.service_data)
1359 g_free(adv_setup.service_data);
1360 if (adv_setup.service_uuid)
1361 g_free(adv_setup.service_uuid);
1363 /* Update adv handle in table */
1364 _bt_update_adv_handle(sender, adv_handle);
1366 return BLUETOOTH_ERROR_NONE;
1369 int _bt_set_scan_response_data(const char *sender, int adv_handle,
1370 bluetooth_scan_resp_data_t *response, int length, gboolean use_reserved_slot)
1372 BT_CHECK_PARAMETER(response, return);
1373 BT_CHECK_PARAMETER(sender, return);
1374 bt_pending_adv_data_set_t *info = NULL;
1375 bluetooth_scan_resp_data_t scan_rsp_old;
1376 int scan_rsp_data_len;
1377 GVariant *ad_data, *param = NULL;
1378 oal_ble_multi_adv_param_setup_t adv_setup;
1379 char *old_mdata = NULL;
1381 int server_instance;
1382 int result = OAL_STATUS_SUCCESS;
1385 if (length > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
1386 return BLUETOOTH_ERROR_INVALID_PARAM;
1388 if (__bt_is_factory_test_mode()) {
1389 BT_ERR("Unable to set Scan Response data in factory binary !!");
1390 return BLUETOOTH_ERROR_NOT_SUPPORT;
1393 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1394 if (server_instance == -1) {
1395 BT_DBG("No available slot for the current sender and handle combination");
1397 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
1399 if (server_instance == -1) {
1400 /* Internal Logic to register server instance if not initialized */
1401 if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
1402 return BLUETOOTH_ERROR_INTERNAL;
1404 /* Allocate a pending structure and mark Adv data set pending */
1405 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
1406 info->adv_handle = adv_handle;
1407 info->sender = g_strdup(sender);
1408 info->data_len = length;
1409 info->is_adv = FALSE;
1410 info->is_data_set_pending = TRUE;
1411 memcpy(&info->data, &(response->data[0]), length);
1412 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
1413 return BLUETOOTH_ERROR_NONE;
1418 /* Server Instance is already allocated, set Adv data to stack */
1419 /* First check if adv data is already present for slot server_instance*/
1420 memset(&scan_rsp_old.data, 0, sizeof(scan_rsp_old.data));
1421 _bt_get_previous_scan_rsp_data(&scan_rsp_old, &scan_rsp_data_len, server_instance);
1423 /* Send Data to stack */
1424 memset(&adv_setup, 0, sizeof(oal_ble_multi_adv_param_setup_t));
1426 if (BLUETOOTH_ERROR_NONE !=
1427 __bt_set_multi_adv_param(&adv_setup, (bluetooth_advertising_data_t*)response, length)) {
1428 if (adv_setup.manufacturer_data)
1429 g_free(adv_setup.manufacturer_data);
1430 if (adv_setup.service_uuid)
1431 g_free(adv_setup.service_uuid);
1432 if (adv_setup.service_data)
1433 g_free(adv_setup.service_data);
1434 return BLUETOOTH_ERROR_INTERNAL;
1437 /* Set Scan response to TRUE */
1438 adv_setup.set_scan_rsp = TRUE;
1440 /* Set Server instance */
1441 adv_setup.server_if = server_instance;
1443 /* Set Server instance[Product Requirement] */
1444 adv_setup.tx_power = 4;
1446 result = adapter_ble_multi_adv_set_inst_data(server_instance, &adv_setup);
1447 if (result != OAL_STATUS_SUCCESS) {
1448 BT_ERR("OAL API adapter_ble_multi_adv_set_inst_data Fail %d", result);
1450 if (adv_setup.manufacturer_data)
1451 g_free(adv_setup.manufacturer_data);
1452 if (adv_setup.service_data)
1453 g_free(adv_setup.service_data);
1454 if (adv_setup.service_uuid)
1455 g_free(adv_setup.service_uuid);
1456 return BLUETOOTH_ERROR_INTERNAL;
1459 /* Data sent to Stack successfully, send manuf data changed event if applicable */
1460 if (adv_setup.manufacturer_data_len != 0) {
1461 if (scan_rsp_data_len > 0) {
1462 _bt_get_ad_data_by_type((char *)scan_rsp_old.data, scan_rsp_data_len, 0xff,
1463 &old_mdata, &old_len);
1466 if (old_len != adv_setup.manufacturer_data_len ||
1467 (old_mdata && adv_setup.manufacturer_data &&
1468 memcmp(old_mdata, adv_setup.manufacturer_data, adv_setup.manufacturer_data_len))) {
1470 ad_data = g_variant_new_from_data((const GVariantType *)"ay",
1471 adv_setup.manufacturer_data, adv_setup.manufacturer_data_len, TRUE, NULL, NULL);
1472 param = g_variant_new("(@ay)", ad_data);
1473 _bt_send_event(BT_ADAPTER_EVENT,
1474 BLUETOOTH_EVENT_ADVERTISING_MANUFACTURER_DATA_CHANGED,
1481 /* Time to update new Scan Response data completely in Table */
1482 _bt_set_new_scan_rsp_data(response, length, server_instance);
1485 if (adv_setup.manufacturer_data)
1486 g_free(adv_setup.manufacturer_data);
1487 if (adv_setup.service_data)
1488 g_free(adv_setup.service_data);
1489 if (adv_setup.service_uuid)
1490 g_free(adv_setup.service_uuid);
1492 /* Update adv handle in table */
1493 _bt_update_adv_handle(sender, adv_handle);
1494 return BLUETOOTH_ERROR_NONE;
1497 /*************************************** LE Scan APIs *********************************************/
1498 int _bt_set_scan_parameters(bluetooth_le_scan_params_t *params)
1504 BT_CHECK_PARAMETER(params, return);
1506 if (_bt_adapter_get_status() != BT_ACTIVATED &&
1507 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
1508 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1511 BT_DBG("inteval %f, win %f, type %d", params->interval, params->window, params->type);
1513 if (params->interval < BT_LE_SCAN_INTERVAL_MIN ||
1514 params->interval > BT_LE_SCAN_INTERVAL_MAX)
1515 return BLUETOOTH_ERROR_INVALID_PARAM;
1517 if (params->window < BT_LE_SCAN_WINDOW_MIN ||
1518 params->window > BT_LE_SCAN_WINDOW_MAX)
1519 return BLUETOOTH_ERROR_INVALID_PARAM;
1521 if (params->window > params->interval)
1522 return BLUETOOTH_ERROR_INVALID_PARAM;
1524 itv = params->interval / BT_SCAN_INTERVAL_SPLIT;
1525 win = params->window / BT_SCAN_INTERVAL_SPLIT;
1527 ret = gattc_set_le_scan_param(params->type, itv, win);
1528 if (OAL_STATUS_SUCCESS != ret) {
1529 BT_ERR("gattc_set_le_scan_param failed");
1530 return BLUETOOTH_ERROR_INTERNAL;
1533 is_le_set_scan_parameter = TRUE;
1535 BT_INFO("Set scan parameters inteval %f, win %f, type %d",
1536 itv * BT_SCAN_INTERVAL_SPLIT, win * BT_SCAN_INTERVAL_SPLIT, params->type);
1538 return BLUETOOTH_ERROR_NONE;
1541 int _bt_prepare_scan_parameters(bluetooth_le_scan_params_t *params, int scan_type)
1543 if (_bt_adapter_get_status() != BT_ACTIVATED &&
1544 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
1545 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1549 BT_DBG("inteval %f, win %f", params->interval, params->window);
1551 BT_DBG("type %d", scan_type);
1554 if (params->interval < BT_LE_SCAN_INTERVAL_MIN || params->interval > BT_LE_SCAN_INTERVAL_MAX)
1555 return BLUETOOTH_ERROR_INVALID_PARAM;
1557 if (params->window < BT_LE_SCAN_WINDOW_MIN || params->window > BT_LE_SCAN_WINDOW_MAX)
1558 return BLUETOOTH_ERROR_INVALID_PARAM;
1560 if (params->window > params->interval)
1561 return BLUETOOTH_ERROR_INVALID_PARAM;
1563 le_scan_params.interval = params->interval;
1564 le_scan_params.window = params->window;
1566 le_scan_params.type = scan_type;
1567 if (le_scan_params.interval == 0) {
1568 /* Set default scan interval same with BT_ADAPTER_LE_SCAN_MODE_LOW_ENERGY */
1569 le_scan_params.interval = 5120;
1570 le_scan_params.window = 512;
1574 is_le_set_scan_parameter = TRUE;
1576 return BLUETOOTH_ERROR_NONE;
1579 gboolean __send_le_scan_reply(gpointer data)
1581 int value = (intptr_t)data;
1584 BT_DBG("Send reply to BT_STOP_LE_DISCOVERY");
1585 __bt_adapter_le_handle_pending_request_info(
1586 BLUETOOTH_ERROR_NONE,
1587 BT_STOP_LE_DISCOVERY, NULL, 0);
1589 BT_DBG("Send reply to BT_START_LE_DISCOVERY");
1590 __bt_adapter_le_handle_pending_request_info(
1591 BLUETOOTH_ERROR_NONE,
1592 BT_START_LE_DISCOVERY, NULL, 0);
1598 static gboolean __start_le_scan_timeout(gpointer user_data)
1600 char *sender = (char *)user_data;
1601 _bt_start_le_scan(sender);
1606 int _bt_start_le_scan(const char *sender)
1608 bt_adapter_le_scanner_t *scanner;
1611 scanner = __bt_find_scanner_from_list(sender);
1613 scanner = g_malloc0(sizeof(bt_adapter_le_scanner_t));
1614 retv_if(scanner == NULL, BLUETOOTH_ERROR_INTERNAL);
1616 scanner->sender = g_strdup(sender);
1617 scanner_list = g_slist_append(scanner_list, scanner);
1620 /* Check scanning is finished or not */
1621 if (scanner->stop_pending == TRUE) {
1622 BT_DBG("Waiting LEDiscoveryFinished");
1623 g_timeout_add(500, (GSourceFunc)__start_le_scan_timeout, scanner->sender);
1624 return BLUETOOTH_ERROR_NONE;
1627 /* Check scanning is in progress or not */
1628 if (scanner->is_scanning) {
1629 BT_ERR("BT is already in LE scanning");
1630 return BLUETOOTH_ERROR_IN_PROGRESS;
1633 /* Check scanning is in progress or not by other users */
1634 if (_bt_is_le_scanning()) {
1637 BT_INFO("LE Full Scan is already on progress");
1638 g_idle_add(__send_le_scan_reply, (void *)(intptr_t)value);
1642 if (is_le_set_scan_parameter == FALSE) {
1643 bluetooth_le_scan_params_t scan_params;
1645 /* Set default scan parameter same with BT_ADAPTER_LE_SCAN_MODE_LOW_ENERGY */
1646 scan_params.type = 0x01;
1647 scan_params.interval = 5120;
1648 scan_params.window = 512;
1649 _bt_set_scan_parameters(&scan_params);
1651 _bt_set_scan_parameters(&le_scan_params);
1654 BT_INFO("Start LE Full Scan");
1655 ret = gattc_start_le_discovery(g_gatt_client_id);
1657 if (OAL_STATUS_SUCCESS != ret) {
1658 BT_ERR("gattc_start_le_discovery failed");
1659 return BLUETOOTH_ERROR_INTERNAL;
1663 scanner->is_scanning = TRUE;
1664 return BLUETOOTH_ERROR_NONE;
1667 int _bt_stop_le_scan(const char *sender)
1669 bt_adapter_le_scanner_t *scan_sender;
1670 bt_adapter_le_scanner_t *scanner;
1671 gboolean next_scanning = FALSE;
1675 /* Check scanning is in progress or not */
1676 scan_sender = __bt_find_scanner_from_list(sender);
1677 if (scan_sender == NULL || scan_sender->is_scanning == FALSE)
1678 return BLUETOOTH_ERROR_NOT_IN_OPERATION;
1680 scan_sender->is_scanning = FALSE;
1681 scan_sender->stop_pending = TRUE;
1683 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
1685 if (scanner->is_scanning == TRUE)
1686 next_scanning = TRUE;
1689 if (next_scanning == TRUE) {
1692 g_idle_add(__send_le_scan_reply, (void *)(intptr_t)value);
1693 return BLUETOOTH_ERROR_NONE;
1695 BT_INFO("Just stop LE scan");
1698 ret = gattc_stop_le_discovery(g_gatt_client_id);
1700 if (OAL_STATUS_SUCCESS != ret) {
1701 BT_ERR("gattc_start_le_discovery failed");
1702 scan_sender->stop_pending = FALSE;
1703 return BLUETOOTH_ERROR_INTERNAL;
1706 is_le_set_scan_parameter = FALSE;
1708 le_scan_params.type = BT_LE_ACTIVE_SCAN;
1709 le_scan_params.interval = 0;
1710 le_scan_params.window = 0;
1712 return BLUETOOTH_ERROR_NONE;
1715 static void _bt_disable_all_scanner_status(void)
1718 bt_adapter_le_scanner_t *scanner;
1720 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
1722 scanner->is_scanning = FALSE;
1723 scanner->stop_pending = FALSE;
1727 static void __bt_free_le_scanner(void)
1730 bt_adapter_le_scanner_t *scanner;
1732 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
1734 g_free(scanner->sender);
1735 g_slist_free_full(scanner->filter_list, g_free);
1739 g_slist_free(scanner_list);
1740 scanner_list = NULL;
1742 is_le_scanning = FALSE;
1743 is_le_set_scan_parameter = FALSE;
1744 le_scan_params.type = BT_LE_ACTIVE_SCAN;
1745 le_scan_params.interval = 0;
1746 le_scan_params.window = 0;
1749 void _bt_check_le_scanner_app_termination(const char *sender)
1751 bt_adapter_le_scanner_t *scanner;
1753 scanner = __bt_find_scanner_from_list(sender);
1757 if (scanner->is_scanning)
1758 _bt_stop_le_scan(sender);
1760 scanner_list = g_slist_remove(scanner_list, scanner);
1761 g_free(scanner->sender);
1765 int __bt_get_available_scan_filter_slot_id(void)
1768 bt_adapter_le_scanner_t *scanner;
1770 bluetooth_le_scan_filter_t *filter_data;
1771 gboolean *slot_check_list = NULL;
1774 if (le_feature_info.max_filter == 0) {
1775 BT_ERR("Scan filter is NOT Supported");
1778 slot_check_list = g_malloc0(sizeof(gboolean) * le_feature_info.max_filter);
1780 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
1782 for (fl = scanner->filter_list; fl != NULL; fl = g_slist_next(fl)) {
1783 filter_data = fl->data;
1784 if (filter_data->slot_id < le_feature_info.max_filter)
1785 slot_check_list[filter_data->slot_id] = TRUE;
1789 for (i = 0; i < le_feature_info.max_filter; i++) {
1790 if (slot_check_list[i] == FALSE) {
1791 g_free(slot_check_list);
1796 BT_ERR("There is NO available slot for scan filter.");
1797 g_free(slot_check_list);
1801 int _bt_register_scan_filter(const char *sender, bluetooth_le_scan_filter_t *filter, int *slot_id)
1803 int ret = BLUETOOTH_ERROR_NONE;
1804 bt_adapter_le_scanner_t *scanner = NULL;
1805 bluetooth_le_scan_filter_t *scan_filter_data = NULL;
1807 *slot_id = __bt_get_available_scan_filter_slot_id();
1810 return BLUETOOTH_ERROR_NO_RESOURCES;
1812 oal_ble_scan_filter_t filter_data = {.slot_id = *slot_id, .device_address = (bt_address_t*)&filter->device_address, .device_name = filter->device_name,
1813 .service_uuid = (oal_uuid_t*)&filter->service_uuid.data, .service_uuid_len = filter->service_uuid.data_len,
1814 .service_uuid_mask = (oal_uuid_t*)&filter->service_uuid_mask.data, .service_uuid_mask_len = filter->service_uuid_mask.data_len,
1815 .service_solicitation_uuid = (oal_uuid_t*)&filter->service_solicitation_uuid.data,
1816 .service_solicitation_uuid_len = filter->service_solicitation_uuid.data_len,
1817 .service_solicitation_uuid_mask = (oal_uuid_t*)&filter->service_solicitation_uuid_mask.data,
1818 .service_solicitation_uuid_mask_len = filter->service_solicitation_uuid_mask.data_len,
1819 .service_data = filter->service_data.data.data, .service_data_len = filter->service_data.data_len,
1820 .service_data_mask = filter->service_data_mask.data.data, .service_data_mask_len = filter->service_data_mask.data_len,
1821 .manufacturer_id = filter->manufacturer_id, .manufacturer_data = filter->manufacturer_data.data.data,
1822 .manufacturer_data_len = filter->manufacturer_data.data_len, .manufacturer_data_mask = filter->manufacturer_data_mask.data.data,
1823 .manufacturer_data_mask_len = filter->manufacturer_data_mask.data_len , .added_features = filter->added_features
1825 ret = gattc_register_scan_filter(&filter_data);
1827 if (OAL_STATUS_SUCCESS != ret) {
1828 BT_ERR("gattc_register_scan_filter failed");
1829 return BLUETOOTH_ERROR_INTERNAL;
1832 scanner = __bt_find_scanner_from_list(sender);
1834 if (scanner == NULL) {
1835 scanner = g_malloc0(sizeof(bt_adapter_le_scanner_t));
1837 if (scanner == NULL)
1838 return BLUETOOTH_ERROR_MEMORY_ALLOCATION;
1840 scanner->sender = g_strdup(sender);
1841 scanner_list = g_slist_append(scanner_list, scanner);
1844 scan_filter_data = g_malloc0(sizeof(bluetooth_le_scan_filter_t));
1846 memcpy(scan_filter_data, filter, sizeof(bluetooth_le_scan_filter_t));
1848 scan_filter_data->slot_id = *slot_id;
1849 scanner->filter_list = g_slist_append(scanner->filter_list, scan_filter_data);
1854 int _bt_service_le_init(void)
1858 return BLUETOOTH_ERROR_NONE;
1861 void _bt_service_le_deinit(void)
1864 __bt_free_le_scanner();
1867 int _bt_is_advertising(void)
1869 int ret = is_advertising();
1871 if (ret == BLUETOOTH_ERROR_NONE)
1877 gboolean _bt_is_le_2m_phy_supported(void)
1879 if (le_feature_info.le_2m_phy)
1885 gboolean _bt_is_le_coded_phy_supported(void)
1887 if (le_feature_info.le_coded_phy)
1893 gboolean _bt_is_scan_filter_supported(void)
1895 if (le_feature_info.max_filter > 0)
1901 int _bt_set_le_privacy(gboolean set_privacy)
1903 int result = BLUETOOTH_ERROR_NONE;
1905 if (__bt_is_factory_test_mode()) {
1906 BT_ERR("Unable to set le privacy in factory binary !!");
1907 return BLUETOOTH_ERROR_NOT_SUPPORT;
1910 if (_bt_adapter_get_status() != BT_ACTIVATED &&
1911 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
1912 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1915 result = adapter_ble_set_privacy(set_privacy);
1916 if (result != OAL_STATUS_SUCCESS) {
1917 BT_ERR("adapter_set_le_privacy failed: %d", result);
1918 result = BLUETOOTH_ERROR_INTERNAL;
1925 int _bt_set_white_list(bluetooth_device_address_t *device_address, int address_type, bool is_add)
1927 int result = BLUETOOTH_ERROR_NONE;
1928 if (__bt_is_factory_test_mode()) {
1930 BT_ERR("Unable to add to white list in factory binary !!");
1932 BT_ERR("Unable to remove white list in factory binary !!");
1933 return BLUETOOTH_ERROR_NOT_SUPPORT;
1936 BT_CHECK_PARAMETER(device_address, return);
1938 if(_bt_adapter_get_status() != BT_ACTIVATED ){
1939 BT_ERR("Bluetooth adapter is disabled");
1940 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1943 result = adapter_set_white_list((bt_address_t*)device_address, address_type, is_add);
1944 if (result != OAL_STATUS_SUCCESS) {
1946 BT_ERR("Add to White List Failed %d", result);
1948 BT_ERR("Remove from white list Failed %d", result);
1949 return BLUETOOTH_ERROR_INTERNAL;
1955 int _bt_set_manufacturer_data(bluetooth_manufacturer_data_t *m_data)
1957 GVariant *manufac_data, *param = NULL;
1958 int result = BLUETOOTH_ERROR_NONE;
1960 BT_CHECK_PARAMETER(m_data, return);
1962 if (_bt_adapter_get_status() != BT_ACTIVATED &&
1963 _bt_adapter_get_le_status() != BT_LE_ACTIVATED)
1964 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1966 result = adapter_set_manufacturer_data((oal_manufacturer_data_t*)m_data);
1967 if (result != OAL_STATUS_SUCCESS) {
1968 BT_ERR("Set manufacturer data Failed %d", result);
1969 return BLUETOOTH_ERROR_INTERNAL;
1971 /*data has been successfully sent to the stack, inititate manufacturer data change event */
1972 manufac_data = g_variant_new_from_data((const GVariantType *)"ay",
1973 m_data->data, m_data->data_len, TRUE, NULL, NULL);
1974 param = g_variant_new("(@ay)", manufac_data);
1975 _bt_send_event(BT_ADAPTER_EVENT,
1976 BLUETOOTH_EVENT_MANUFACTURER_DATA_CHANGED,
1982 /*************************************** LE Scan APIs *********************************************/
1984 int _bt_set_le_static_random_address(gboolean is_enable)
1986 int result = BLUETOOTH_ERROR_NONE;
1988 if (__bt_is_factory_test_mode()) {
1989 BT_ERR("Unable to set le random address in factory binary !!");
1990 return BLUETOOTH_ERROR_NOT_SUPPORT;
1993 if (_bt_adapter_get_status() != BT_ACTIVATED &&
1994 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
1995 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1998 result = adapter_set_le_static_random_address(is_enable);
1999 if (result != OAL_STATUS_SUCCESS) {
2000 BT_ERR("adapter_set_connectable failed: %d", result);
2001 result = BLUETOOTH_ERROR_INTERNAL;
2003 BT_INFO("SetLeStaticRandomAddress as %d", is_enable);
2004 result = BLUETOOTH_ERROR_NONE;