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 } 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;
100 static gboolean scan_filter_enabled = 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 static void __bt_free_le_scanner(bt_adapter_le_scanner_t *scanner)
111 g_free(scanner->sender);
112 g_slist_free_full(scanner->filter_list, g_free);
116 static void __bt_free_le_scanner_all(void)
118 g_slist_free_full(scanner_list, (GDestroyNotify)__bt_free_le_scanner);
121 is_le_scanning = FALSE;
122 is_le_set_scan_parameter = FALSE;
123 le_scan_params.type = BT_LE_ACTIVE_SCAN;
124 le_scan_params.interval = 0;
125 le_scan_params.window = 0;
128 void _bt_adapter_set_le_status(bt_le_status_t status)
130 BT_INFO("adapter_le_state changed [%d] -> [%d]", adapter_le_state, status);
131 adapter_le_state = status;
134 bt_le_status_t _bt_adapter_get_le_status(void)
136 return adapter_le_state;
140 /* Internal functions of core adapter service */
141 static void __bt_le_handle_pending_requests(int service_function, void *user_data, unsigned int size)
145 invocation_info_t *req_info;
148 /* Get method invocation context */
149 for (l = _bt_get_invocation_list(); l != NULL; ) {
152 if (req_info == NULL || req_info->service_function != service_function)
155 /* Create out param */
156 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
158 switch (service_function) {
159 case BT_ENABLE_ADAPTER_LE:
160 case BT_DISABLE_ADAPTER_LE: {
161 gboolean done = TRUE;
162 g_array_append_vals(out_param, &done, sizeof(gboolean));
166 BT_ERR("Unknown service function[%d]", service_function);
169 _bt_service_method_return(req_info->context, out_param, req_info->result);
170 g_array_free(out_param, TRUE);
171 /* Now free invocation info for this request*/
172 _bt_free_info_from_invocation_list(req_info);
177 /* Request return handlings */
178 static gboolean __bt_le_post_set_enabled(gpointer user_data)
180 BT_INFO("__bt_adapter_post_set_enabled>>");
182 /* Add LE enabled post processing codes */
188 static gboolean __bt_le_post_set_disabled(gpointer user_data)
190 BT_INFO("_bt_adapter_post_set_disabled>>");
192 /* Add LE disabled post processing codes */
197 static void __bt_le_update_bt_enabled(void)
199 int result = BLUETOOTH_ERROR_NONE;
200 BT_ERR("_bt_adapter_update_bt_enabled>>");
201 /* Update Bluetooth Status to notify other modules */
202 if (vconf_set_int(VCONFKEY_BT_LE_STATUS, VCONFKEY_BT_LE_STATUS_ON) != 0)
203 BT_ERR("Set vconf failed\n");
205 /* TODO:Add timer function to handle any further post processing */
206 g_idle_add((GSourceFunc)__bt_le_post_set_enabled, NULL);
208 /*Return BT_ADAPTER_ENABLE Method invocation context */
209 __bt_le_handle_pending_requests(BT_ENABLE_ADAPTER_LE, NULL, 0);
210 /*Send BT Enabled event to application */
211 _bt_send_event(BT_LE_ADAPTER_EVENT, BLUETOOTH_EVENT_LE_ENABLED,
212 g_variant_new("(i)", result));
215 static void __bt_le_update_bt_disabled(void)
217 int result = BLUETOOTH_ERROR_NONE;
218 BT_INFO("_bt_adapter_update_bt_disabled>>");
220 int power_off_status = 0;
223 /* Update the vconf LE status in normal Deactivation case only */
224 ret = vconf_get_int(VCONFKEY_SYSMAN_POWER_OFF_STATUS, &power_off_status);
225 BT_DBG("ret : %d, power_off_status : %d", ret, power_off_status);
227 /* Update LE Status to notify other modules */
228 if (vconf_set_int(VCONFKEY_BT_LE_STATUS, VCONFKEY_BT_LE_STATUS_OFF) != 0)
229 BT_ERR("Set vconf failed");
231 /* TODO:Add timer function to handle any further post processing */
232 g_idle_add((GSourceFunc)__bt_le_post_set_disabled, NULL);
234 /* Return BT_ADAPTER_DISABLE Method invocation context */
235 __bt_le_handle_pending_requests(BT_DISABLE_ADAPTER_LE, NULL, 0);
237 /* Send BT Disabled event to application */
238 _bt_send_event(BT_LE_ADAPTER_EVENT, BLUETOOTH_EVENT_LE_DISABLED,
239 g_variant_new("(i)", result));
242 static void __bt_set_le_scan_status(gboolean mode)
244 BT_DBG("Set scanning status: %s", mode == TRUE ? "TRUE" : "FALSE");
245 is_le_scanning = mode;
248 gboolean _bt_is_le_scanning(void)
250 return is_le_scanning;
253 bt_adapter_le_scanner_t* __bt_find_scanner_from_list(const char *sender)
256 bt_adapter_le_scanner_t *scanner;
258 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
260 if (g_strcmp0(scanner->sender, sender) == 0)
268 static void __bt_adapter_le_handle_pending_request_info(int result,
269 int service_function, void *param, unsigned int size)
273 invocation_info_t *req_info = NULL;
276 for (l = _bt_get_invocation_list(); l != NULL; ) {
279 if (req_info == NULL || req_info->service_function != service_function)
282 switch (service_function) {
283 case BT_SET_ADVERTISING:
284 case BT_SET_CUSTOM_ADVERTISING:
285 case BT_SET_ADVERTISING_DATA:
286 case BT_SET_SCAN_RESPONSE_DATA: {
288 bt_pending_adv_data_set_t *data;
290 BT_DBG("Service function: [%d]", service_function);
291 ret_if(param == NULL);
293 saved_handle = (int*)req_info->user_data;
294 data = (bt_pending_adv_data_set_t*)param;
295 BT_DBG("Current Sender [%s] Current Handle [%d]", data->sender, data->adv_handle);
297 if (!g_strcmp0(req_info->sender, data->sender) && (*saved_handle == data->adv_handle)) {
298 BT_DBG("Requester found [%s] ADV Handle [%d]", req_info->sender, *saved_handle);
299 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
300 g_array_append_vals(out_param, &data->adv_handle, sizeof(int));
301 _bt_service_method_return(req_info->context, out_param, result);
304 g_free(req_info->user_data);
305 _bt_free_info_from_invocation_list(req_info);
306 g_array_free(out_param, TRUE);
310 case BT_START_LE_DISCOVERY: {
311 bt_adapter_le_scanner_t *scanner;
313 BT_DBG("Request Sender: [%s]", req_info->sender);
314 if (BLUETOOTH_ERROR_NONE != result) {
315 scanner = __bt_find_scanner_from_list(req_info->sender);
316 if (scanner && scanner->is_scanning)
317 scanner->is_scanning = FALSE;
320 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
321 _bt_service_method_return(req_info->context, out_param, result);
322 _bt_free_info_from_invocation_list(req_info);
323 g_array_free(out_param, TRUE);
326 case BT_STOP_LE_DISCOVERY: {
327 BT_DBG("Request Sender: [%s]", req_info->sender);
328 out_param = g_array_new(FALSE, FALSE, sizeof(gchar));
329 _bt_service_method_return(req_info->context, out_param, result);
330 _bt_free_info_from_invocation_list(req_info);
331 g_array_free(out_param, TRUE);
341 static void __bt_le_handle_server_instance_registered(event_gatts_register_t *data)
345 char uuid_string[BLUETOOTH_UUID_STRING_MAX];
346 bluetooth_advertising_data_t adv;
347 bluetooth_scan_resp_data_t scan_rsp;
348 int result = BLUETOOTH_ERROR_NONE;
349 bt_pending_adv_data_set_t *info = NULL;
351 memset(adv.data, 0, sizeof(adv.data));
352 memset(scan_rsp.data, 0, sizeof(scan_rsp.data));
354 _bt_uuid_to_string(&(data->server_uuid), uuid_string);
355 BT_INFO("Instance ID is Intialized [%d] UUID initialized [%s]", data->server_inst, uuid_string);
357 /* Get sender and adv handle for the server instance */
358 _bt_get_adv_handle_from_instance(data->server_inst, &adv_handle);
360 /* Check if pending Adv Data set or Scan response data set request is pending*/
361 for (l = adv_data_pending_list; l != NULL; l = l->next) {
364 if (info && (adv_handle == info->adv_handle)) {
365 if (info->is_data_set_pending) {
366 BT_INFO("LE Data set request is pending");
368 memcpy(&adv.data, info->data, info->data_len);
369 result = _bt_set_advertising_data(info->sender,
370 info->adv_handle, &adv, info->data_len, FALSE);
371 if (result != BLUETOOTH_ERROR_NONE) {
372 __bt_adapter_le_handle_pending_request_info(result,
373 BT_SET_ADVERTISING_DATA,
374 (void*)info, sizeof(bt_pending_adv_data_set_t));
378 memcpy(&scan_rsp.data, info->data, info->data_len);
379 result = _bt_set_scan_response_data(info->sender,
380 info->adv_handle, &scan_rsp, info->data_len, FALSE);
381 if (result != BLUETOOTH_ERROR_NONE) {
382 __bt_adapter_le_handle_pending_request_info(result,
383 BT_SET_SCAN_RESPONSE_DATA, (void*)info,
384 sizeof(bt_pending_adv_data_set_t));
389 BT_INFO("LE Enable Adv request is pending");
390 if (info->is_custom_adv) {
391 result = _bt_set_custom_advertising(info->sender, info->adv_handle,
392 TRUE, &info->params, FALSE/*Reserved Slot*/);
393 if (result != BLUETOOTH_ERROR_NONE) {
394 __bt_adapter_le_handle_pending_request_info(result,
395 BT_SET_CUSTOM_ADVERTISING,
396 (void*)info, sizeof(bt_pending_adv_data_set_t));
400 result = _bt_set_advertising(info->sender, info->adv_handle,
401 TRUE, FALSE/*Reserved Slot*/);
402 if (result != BLUETOOTH_ERROR_NONE) {
403 __bt_adapter_le_handle_pending_request_info(result,
405 (void*)info, sizeof(bt_pending_adv_data_set_t));
416 adv_data_pending_list = g_slist_remove(adv_data_pending_list, info);
417 g_free(info->sender);
421 static void __bt_le_multi_advertising_enabled(event_ble_multiadv_status *event)
425 bt_pending_adv_data_set_t *info = NULL;
426 GVariant *param = NULL;
427 int result = BLUETOOTH_ERROR_NONE;
429 sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
430 if (sender == NULL) {
431 BT_ERR("Abnormal!!");
433 if (event->status != OAL_STATUS_SUCCESS)
434 result = BLUETOOTH_ERROR_INTERNAL;
435 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
436 info->sender = sender;
437 info->adv_handle = adv_handle;
438 __bt_adapter_le_handle_pending_request_info(result,
439 BT_SET_CUSTOM_ADVERTISING,
440 (void*)info, sizeof(bt_pending_adv_data_set_t));
441 __bt_adapter_le_handle_pending_request_info(result,
443 (void*)info, sizeof(bt_pending_adv_data_set_t));
446 param = g_variant_new("(ii)", result, info->adv_handle);
447 _bt_send_event_to_dest(info->sender, BT_ADAPTER_EVENT, BLUETOOTH_EVENT_ADVERTISING_STARTED, param);
450 g_free(info->sender);
453 BT_PERMANENT_LOG("Adv started %d", event->server_inst);
457 static void __bt_le_multi_advertising_disabled(event_ble_multiadv_status *event)
461 bt_pending_adv_data_set_t *info = NULL;
462 GVariant *param = NULL;
463 int result = BLUETOOTH_ERROR_NONE;
464 sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
466 if (sender == NULL) {
467 BT_INFO("Means application containing the adv info is already freed!!");
469 if (event->status != OAL_STATUS_SUCCESS)
470 result = BLUETOOTH_ERROR_INTERNAL;
471 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
472 info->sender = sender;
473 info->adv_handle = adv_handle;
474 __bt_adapter_le_handle_pending_request_info(result,
475 BT_SET_CUSTOM_ADVERTISING,
476 (void*)info, sizeof(bt_pending_adv_data_set_t));
477 __bt_adapter_le_handle_pending_request_info(result,
479 (void*)info, sizeof(bt_pending_adv_data_set_t));
481 param = g_variant_new("(ii)", result, info->adv_handle);
482 _bt_send_event_to_dest(info->sender, BT_ADAPTER_EVENT, BLUETOOTH_EVENT_ADVERTISING_STOPPED, param);
484 /* Free allocated slot or server instance from stack to be used for other advertisng */
485 result = _bt_unregister_server_instance(sender, adv_handle);
488 g_free(info->sender);
491 BT_PERMANENT_LOG("Adv stopped %d", event->server_inst);
495 static void __bt_le_multi_advertising_set_data(event_ble_multiadv_status *event)
499 bt_pending_adv_data_set_t *info = NULL;
500 int result = BLUETOOTH_ERROR_NONE;
501 sender = _bt_get_sender_and_handle(event->server_inst, &adv_handle);
503 if (sender == NULL) {
504 BT_ERR("Abnormal!!");
506 BT_DBG("Sender [%s], adv handle [%d]", sender, adv_handle);
507 if (event->status != OAL_STATUS_SUCCESS)
508 result = BLUETOOTH_ERROR_INTERNAL;
510 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
511 info->sender = sender;
512 info->adv_handle = adv_handle;
513 BT_DBG("Sender [%s], adv handle [%d]", info->sender, info->adv_handle);
514 __bt_adapter_le_handle_pending_request_info(result,
515 BT_SET_SCAN_RESPONSE_DATA,
516 (void*)info, sizeof(bt_pending_adv_data_set_t));
517 __bt_adapter_le_handle_pending_request_info(result,
518 BT_SET_ADVERTISING_DATA,
519 (void*)info, sizeof(bt_pending_adv_data_set_t));
520 g_free(info->sender);
525 static int __get_advertisement_data(unsigned char *dest, unsigned char *src)
533 if ((len == 0) || (31 < (i + len))) {
534 BT_INFO("length: %d", length);
535 memcpy(dest, src, length);
546 static int __bt_get_ad_data_by_type(const char *in_data, int in_len,
547 char in_type, char **data, int *data_len)
549 if (in_data == NULL || data == NULL || data_len == NULL)
550 return BLUETOOTH_ERROR_INTERNAL;
553 return BLUETOOTH_ERROR_INTERNAL;
556 unsigned char len = 0;
559 for (i = 0; i < in_len && i < BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX - 1; i++) {
561 if (len <= 0 || i + 1 >= in_len) {
562 BT_ERR("Invalid advertising data");
563 return BLUETOOTH_ERROR_INTERNAL;
566 type = in_data[i + 1];
567 if (type == in_type) {
577 if (i > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX - 1
579 || i + len > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX - 1) {
580 BT_ERR("Invalid advertising data");
581 return BLUETOOTH_ERROR_INTERNAL;
582 } else if (len == 0) {
583 BT_DBG("AD Type 0x%02x data is not set", in_type);
586 return BLUETOOTH_ERROR_NONE;
589 *data = g_memdup(&in_data[i], len);
591 return BLUETOOTH_ERROR_OUT_OF_MEMORY;
594 return BLUETOOTH_ERROR_NONE;
597 static gboolean __bt_check_scan_result_uuid(const char *adv_data,
598 int adv_data_len, const char *svc_uuid, int uuid_len,
599 const char *uuid_mask, char ad_type)
605 __bt_get_ad_data_by_type(adv_data, adv_data_len,
606 ad_type, &data, &data_len);
608 for (i = 0; i < data_len; i += uuid_len) {
609 if (uuid_len > (data_len - i))
612 if (_bt_byte_arr_cmp_with_mask(data + i,
613 svc_uuid, uuid_mask, uuid_len) == 0) {
624 static gboolean __bt_check_scan_result_with_filter(const char *device_address,
625 const char *adv_data, int adv_data_len,
626 const char *scan_data, int scan_data_len,
627 const bt_adapter_le_scanner_t *scanner)
630 bluetooth_le_scan_filter_t *filter_data = NULL;
633 gboolean is_matched = FALSE;
636 if (scanner->filter_list == NULL) {
637 BT_INFO("This scanner is on Full Scan.");
641 for (l = scanner->filter_list; l != NULL; l = g_slist_next(l)) {
642 filter_data = l->data;
644 if (filter_data->added_features &
645 BLUETOOTH_LE_SCAN_FILTER_FEATURE_DEVICE_ADDRESS) {
646 char address[BT_ADDRESS_STRING_SIZE] = { 0 };
648 _bt_convert_addr_type_to_string(address,
649 filter_data->device_address.addr);
650 if (strncmp(address, device_address,
651 BT_ADDRESS_STRING_SIZE) != 0)
655 /* Check service uuid filter */
656 if (filter_data->added_features &
657 BLUETOOTH_LE_SCAN_FILTER_FEATURE_SERVICE_UUID) {
659 const int ad_type_uuids[] = {
660 BT_LE_AD_TYPE_INCOMP_LIST_16_BIT_SERVICE_CLASS_UUIDS,
661 BT_LE_AD_TYPE_COMP_LIST_16_BIT_SERVICE_CLASS_UUIDS,
662 BT_LE_AD_TYPE_INCOMP_LIST_128_BIT_SERVICE_CLASS_UUIDS,
663 BT_LE_AD_TYPE_COMP_LIST_128_BIT_SERVICE_CLASS_UUIDS
666 for (idx = 0; idx < sizeof(ad_type_uuids) / sizeof(bt_le_ad_type_t); idx++) {
667 /* Check service uuid in advertising data */
668 if (__bt_check_scan_result_uuid(adv_data, adv_data_len,
669 (const char *)filter_data->service_uuid.data.data,
670 filter_data->service_uuid.data_len,
671 (const char *)filter_data->service_uuid_mask.data.data,
672 ad_type_uuids[idx]) == TRUE) {
673 BT_INFO("Service UUID is matched in adv data.");
678 /* Check service uuid in scan response data */
679 if (__bt_check_scan_result_uuid(scan_data, scan_data_len,
680 (const char *)filter_data->service_uuid.data.data,
681 filter_data->service_uuid.data_len,
682 (const char *)filter_data->service_uuid_mask.data.data,
683 ad_type_uuids[idx]) == TRUE) {
684 BT_INFO("Service UUID is matched in scan data.");
690 /* Service UUID is NOT matched. Continue to next filter */
691 if (is_matched == FALSE)
695 /* Check solicitation uuid filter */
696 if (filter_data->added_features &
697 BLUETOOTH_LE_SCAN_FILTER_FEATURE_SERVICE_SOLICITATION_UUID) {
699 const int ad_type_solicit_uuids[] = {
700 BT_LE_AD_TYPE_LIST_16_BIT_SERVICE_SOLICITATION_UUIDS,
701 BT_LE_AD_TYPE_LIST_128_BIT_SERVICE_SOLICITATION_UUIDS
704 for (idx = 0; idx < sizeof(ad_type_solicit_uuids) / sizeof(bt_le_ad_type_t); idx++) {
705 /* Check solicit uuid in advertising data */
706 if (__bt_check_scan_result_uuid(adv_data, adv_data_len,
707 (const char *)filter_data->service_solicitation_uuid.data.data,
708 filter_data->service_solicitation_uuid.data_len,
709 (const char *)filter_data->service_solicitation_uuid_mask.data.data,
710 ad_type_solicit_uuids[idx]) == TRUE) {
711 BT_INFO("Service Solicitation UUID is matched in adv data.");
716 /* Check solicit uuid in scan response data */
717 if (__bt_check_scan_result_uuid(scan_data, scan_data_len,
718 (const char *)filter_data->service_solicitation_uuid.data.data,
719 filter_data->service_solicitation_uuid.data_len,
720 (const char *)filter_data->service_solicitation_uuid_mask.data.data,
721 ad_type_solicit_uuids[idx]) == TRUE) {
722 BT_INFO("Service Solicitation UUID is matched in scan data.");
728 /* Service Solicitation UUID is NOT matched. Continue to next filter */
729 if (is_matched == FALSE)
733 /* Check device name filter */
734 if (filter_data->added_features &
735 BLUETOOTH_LE_SCAN_FILTER_FEATURE_DEVICE_NAME) {
736 char name[BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX] = {0, };
741 /* Check device name in advertising data */
742 __bt_get_ad_data_by_type(adv_data, adv_data_len,
743 BT_LE_AD_TYPE_COMPLETE_LOCAL_NAME,
746 if (data_len >= BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
747 data_len = BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX - 1;
748 memcpy(name, data, data_len);
749 name[data_len] = '\0';
752 if (strncmp(filter_data->device_name,
753 name, data_len) == 0) {
754 BT_INFO("Device Name is matched in adv data.");
759 /* Check device name in scan response data */
760 __bt_get_ad_data_by_type(scan_data, scan_data_len,
761 BT_LE_AD_TYPE_COMPLETE_LOCAL_NAME,
764 if (data_len >= BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
765 data_len = BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX - 1;
766 memcpy(name, data, data_len);
767 name[data_len] = '\0';
770 if (strncmp(filter_data->device_name,
771 name, data_len) == 0) {
772 BT_INFO("Device Name is matched in scan data.");
777 /* Device Name is NOT matched. Continue to next filter */
778 if (is_matched == FALSE)
782 /* Check manufacturer data filter */
783 if (filter_data->added_features &
784 BLUETOOTH_LE_SCAN_FILTER_FEATURE_MANUFACTURER_DATA) {
789 /* Check manufacturer data in advertising data */
790 __bt_get_ad_data_by_type(adv_data, adv_data_len,
791 BT_LE_AD_TYPE_MANUFACTURER_SPECIFIC_DATA,
795 manufacturer_id = (data[1] << 8) + data[0];
797 if (filter_data->manufacturer_id == manufacturer_id) {
798 if (filter_data->manufacturer_data.data_len == 0) {
801 if (data_len >= BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
802 data_len = BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX - 1;
803 if (_bt_byte_arr_cmp_with_mask(data + 2,
804 (const char *)filter_data->manufacturer_data.data.data,
805 (const char *)filter_data->manufacturer_data_mask.data.data,
806 data_len - 2) == 0) {
807 BT_INFO("Manufacturer Data is matched in adv data.");
816 /* Check manufacturer data in scan response data */
817 __bt_get_ad_data_by_type(scan_data, scan_data_len,
818 BT_LE_AD_TYPE_MANUFACTURER_SPECIFIC_DATA,
822 manufacturer_id = (data[1] << 8) + data[0];
824 if (filter_data->manufacturer_id == manufacturer_id) {
825 if (filter_data->manufacturer_data.data_len == 0) {
828 if (data_len >= BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
829 data_len = BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX - 1;
830 if (_bt_byte_arr_cmp_with_mask(data + 2,
831 (const char *)filter_data->manufacturer_data.data.data,
832 (const char *)filter_data->manufacturer_data_mask.data.data,
833 data_len - 2) == 0) {
834 BT_INFO("Manufacturer Data is matched in scan data.");
843 /* Manufacturer Data is NOT matched. Continue to next filter */
844 if (is_matched == FALSE)
848 /* Check service data filter */
849 if (filter_data->added_features &
850 BLUETOOTH_LE_SCAN_FILTER_FEATURE_SERVICE_DATA) {
855 /* Check service data in advertising data */
856 __bt_get_ad_data_by_type(adv_data,
858 BT_LE_AD_TYPE_SERVICE_DATA,
861 if (data_len >= BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
862 data_len = BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX - 1;
863 if (_bt_byte_arr_cmp_with_mask(data,
864 (const char *)filter_data->service_data.data.data,
865 (const char *)filter_data->service_data_mask.data.data,
867 BT_INFO("Service Data is matched in adv data.");
874 /* Check service data in scan response data */
875 __bt_get_ad_data_by_type(scan_data,
877 BT_LE_AD_TYPE_SERVICE_DATA,
880 if (data_len >= BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
881 data_len = BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX - 1;
882 if (_bt_byte_arr_cmp_with_mask(data,
883 (const char *)filter_data->service_data.data.data,
884 (const char *)filter_data->service_data_mask.data.data,
886 BT_INFO("Service Data is matched in scan data.");
893 /* Service Data is NOT matched. Continue to next filter */
894 if (is_matched == FALSE)
898 BT_INFO("The scan result is conformable.");
902 BT_INFO("The scan result is NOT conformable.");
906 static void __bt_le_handle_device_found(event_ble_scan_result_info *scan_result)
908 int result = BLUETOOTH_ERROR_NONE;
909 bt_adapter_le_scanner_t *scanner = NULL;
910 char address[BT_ADDRESS_STRING_SIZE];
911 int addr_type = 0x01; /* TODO: Need to get correct address type */
912 unsigned char adv_ind_data[BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX];
913 unsigned char scan_resp_data[BLUETOOTH_SCAN_RESP_DATA_LENGTH_MAX];
915 int scan_resp_len = 0;
916 char *tmp_str = NULL;
917 GVariant *scan_data_param;
918 GVariant *adv_data_param;
923 ret_if(NULL == scan_result);
925 _bt_convert_addr_type_to_string(address, scan_result->address.addr);
927 memset(adv_ind_data, 0x00, sizeof(adv_ind_data));
928 adv_ind_len = __get_advertisement_data(
929 adv_ind_data, &(scan_result->adv_data[0]));
930 if (adv_ind_len > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX) {
931 BT_ERR("Invalid advertising data");
935 memset(scan_resp_data, 0x00, sizeof(scan_resp_data));
936 scan_resp_len = __get_advertisement_data(
937 scan_resp_data, &(scan_result->adv_data[adv_ind_len]));
938 if (scan_resp_len > BLUETOOTH_SCAN_RESP_DATA_LENGTH_MAX) {
939 BT_ERR("Invalid scan response data");
943 BT_INFO("Address: %s, RSSI: %d, adv_ind_len: %d, scan_resp_len: %d",
944 address, scan_result->rssi, adv_ind_len, scan_resp_len);
946 tmp_str = _bt_service_convert_hex_to_string(scan_result->adv_data, 62);
947 BT_INFO("Complete Data: [%s]", tmp_str);
951 tmp_str = _bt_service_convert_hex_to_string(adv_ind_data, adv_ind_len);
952 BT_INFO("Adv Ind Data: [%s]", tmp_str);
956 tmp_str = _bt_service_convert_hex_to_string(scan_resp_data, scan_resp_len);
957 BT_INFO("Scan resp Data: [%s]", tmp_str);
961 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
963 if (scanner->is_scanning == FALSE)
966 if (__bt_check_scan_result_with_filter(address, (const char *)adv_ind_data,
967 adv_ind_len, (const char *)scan_resp_data, scan_resp_len, scanner) == FALSE)
970 adv_data_param = g_variant_new_from_data((const GVariantType *)"ay",
971 adv_ind_data, adv_ind_len, TRUE, NULL, NULL);
972 scan_data_param = g_variant_new_from_data((const GVariantType *)"ay",
973 scan_resp_data, scan_resp_len, TRUE, NULL, NULL);
975 param = g_variant_new("(isnnn@ayn@ay)",
977 addr_type, scan_result->rssi,
978 adv_ind_len, adv_data_param,
979 scan_resp_len, scan_data_param);
981 _bt_send_event_to_dest(scanner->sender, BT_LE_ADAPTER_EVENT,
982 BLUETOOTH_EVENT_REMOTE_LE_DEVICE_FOUND, param);
988 static void __bt_le_state_change_callback(int bt_status)
990 BT_INFO("__bt_le_state_change_callback: status [%d]", bt_status);
993 case BT_LE_DEACTIVATED:
994 _bt_adapter_set_le_status(bt_status);
996 /* Add Adapter disabled post processing codes */
997 __bt_le_update_bt_disabled();
999 case BT_LE_ACTIVATED:
1000 _bt_adapter_set_le_status(bt_status);
1002 /* Add Adapter enabled post processing codes */
1004 BT_DBG("g_source is removed");
1005 g_source_remove(timer_id);
1008 __bt_le_update_bt_enabled();
1011 BT_ERR("Incorrect Bluetooth adapter state changed status");
1017 static void __bt_le_event_handler(int event_type, gpointer event_data)
1019 BT_INFO("OAL event = 0x%x, \n", event_type);
1021 switch (event_type) {
1022 case OAL_EVENT_BLE_ENABLED: {
1023 __bt_le_state_change_callback(BT_LE_ACTIVATED);
1026 case OAL_EVENT_BLE_DISABLED: {
1027 __bt_le_state_change_callback(BT_LE_DEACTIVATED);
1030 case OAL_EVENT_BLE_SERVER_INSTANCE_INITIALISED: {
1031 BT_INFO("OAL Event: Server Instance Registered");
1032 __bt_le_handle_server_instance_registered((event_gatts_register_t *)event_data);
1035 case OAL_EVENT_BLE_ADVERTISING_STARTED: {
1036 BT_INFO("OAL Event: Legacy Advertising Enabled: Not Supported!!");
1039 case OAL_EVENT_BLE_ADVERTISING_STOPPED: {
1040 BT_INFO("OAL Event: Legacy Advertising Disabled: Not Supported!!");
1043 case OAL_EVENT_BLE_MULTI_ADVERTISING_ENABLE: {
1044 BT_INFO("OAL Event: Advertising Enabled");
1045 __bt_le_multi_advertising_enabled((event_ble_multiadv_status *)event_data);
1048 case OAL_EVENT_BLE_MULTI_ADVERTISING_DISABLE: {
1049 BT_INFO("OAL Event: Advertising Disabled");
1050 __bt_le_multi_advertising_disabled((event_ble_multiadv_status *)event_data);
1053 case OAL_EVENT_BLE_MULTI_ADVERTISING_SET_INST_DATA: {
1054 BT_INFO("OAL Event: Advertising Data set successfully");
1055 __bt_le_multi_advertising_set_data((event_ble_multiadv_status *)event_data);
1058 case OAL_EVENT_BLE_MULTI_ADVERTISING_UPDATE: {
1059 BT_INFO("OAL Event: Advertising Params updated");
1062 case OAL_EVENT_BLE_DISCOVERY_STARTED: {
1063 __bt_set_le_scan_status(TRUE);
1064 __bt_adapter_le_handle_pending_request_info(
1065 BLUETOOTH_ERROR_NONE,
1066 BT_START_LE_DISCOVERY, NULL, 0);
1069 case OAL_EVENT_BLE_DISCOVERY_STOPPED: {
1070 if (!_bt_is_le_scanning()) {
1071 BT_ERR("LE discovery start failed");
1072 __bt_adapter_le_handle_pending_request_info(
1073 BLUETOOTH_ERROR_INTERNAL,
1074 BT_START_LE_DISCOVERY, NULL, 0);
1078 __bt_set_le_scan_status(FALSE);
1079 _bt_disable_all_scanner_status();
1080 __bt_adapter_le_handle_pending_request_info(
1081 BLUETOOTH_ERROR_NONE,
1082 BT_STOP_LE_DISCOVERY, NULL, 0);
1085 case OAL_EVENT_BLE_REMOTE_DEVICE_FOUND: {
1086 event_ble_scan_result_info *scan_result = event_data;
1087 BT_INFO("OAL Event: OAL_EVENT_BLE_REMOTE_DEVICE_FOUND");
1088 __bt_le_handle_device_found(scan_result);
1091 case OAL_EVENT_GATTC_REGISTRATION: {
1092 event_gattc_register_t *gattc_event = event_data;
1093 char uuid_str[BLUETOOTH_UUID_STRING_MAX];
1094 char *default_uuid_string;
1096 default_uuid_string = _bt_gatt_get_default_gatt_client_uuid();
1097 _bt_uuid_to_string((service_uuid_t*)&(gattc_event->client_uuid), uuid_str);
1098 BT_INFO("default UUID [%s] current registered uuid [%s]",
1099 default_uuid_string, uuid_str);
1100 if (g_strcmp0(uuid_str, default_uuid_string)) {
1101 BT_INFO("This is not the default GATT client that is registered");
1103 g_free(default_uuid_string);
1106 BT_INFO("GATT CLient instance registered is default client: ID [%d]",
1107 gattc_event->client_if);
1108 g_free(default_uuid_string);
1110 g_gatt_client_id = gattc_event->client_if;
1113 case OAL_EVENT_BLE_LOCAL_FEATURES: {
1114 event_adapter_le_features_t *le_features = event_data;
1116 le_feature_info.le_2m_phy = le_features->le_2m_phy_support;
1117 le_feature_info.le_coded_phy = le_features->le_coded_phy_support;
1118 le_feature_info.max_filter = le_features->max_adv_filter;
1120 BT_INFO("Adapter LE 2M PHY Support [%s]", le_feature_info.le_2m_phy ? "TRUE" : "FALSE");
1121 BT_INFO("Adapter LE CODED PHY Support [%s]", le_feature_info.le_coded_phy ? "TRUE" : "FALSE");
1130 int _bt_le_init(void)
1133 /* Register LE event handler */
1134 _bt_service_register_event_handler_callback(BT_ADAPTER_LE_MODULE, __bt_le_event_handler);
1136 return BLUETOOTH_ERROR_NONE;
1139 void _bt_le_deinit(void)
1142 /* Un-register LE event handler */
1143 _bt_service_unregister_event_handler_callback(BT_ADAPTER_LE_MODULE);
1147 static void __bt_le_update_discovery_status(bt_adapter_discovery_state_t status)
1149 BT_INFO("adapter_discovery_status changed [%d] -> [%d]", adapter_le_discovery_state, status);
1150 adapter_le_discovery_state = status;
1153 static int __bt_le_state_handle_request(gboolean enable)
1155 int result = BLUETOOTH_ERROR_NONE;
1158 switch (_bt_adapter_get_le_status()) {
1159 case BT_LE_ACTIVATING: {
1160 BT_INFO("LE is currently in activating state, state [%d]",
1161 _bt_adapter_get_le_status());
1163 return BLUETOOTH_ERROR_IN_PROGRESS;
1165 if (adapter_le_discovery_state == LE_DISCOVERY_STARTED ||
1166 adapter_le_discovery_state == LE_DISCOVERY_STARTING) {
1167 /*TODO Stop Discovery*/
1168 __bt_le_update_discovery_status(FALSE);
1170 result = le_disable(); //change
1171 if (result != OAL_STATUS_SUCCESS) {
1172 BT_ERR("LE_enable failed: [%d]", result);
1173 result = BLUETOOTH_ERROR_INTERNAL;
1174 /*TODO: perform if anything more needs to be done to handle failure */
1176 /* TODO: To be handled */
1177 _bt_adapter_set_le_status(BT_LE_DEACTIVATING);
1178 result = BLUETOOTH_ERROR_NONE;
1183 case BT_LE_ACTIVATED: {
1184 BT_INFO("LE is currently in activated state, state [%d]",
1185 _bt_adapter_get_le_status());
1187 return BLUETOOTH_ERROR_DEVICE_ALREADY_ENABLED;
1189 if (adapter_le_discovery_state == LE_DISCOVERY_STARTED ||
1190 adapter_le_discovery_state == LE_DISCOVERY_STARTING) {
1191 /*TODO Stop Discovery*/
1192 __bt_le_update_discovery_status(FALSE);
1194 result = le_disable();
1195 if (result != OAL_STATUS_SUCCESS) {
1196 BT_ERR("LE_enable failed: [%d]", result);
1197 result = BLUETOOTH_ERROR_INTERNAL;
1198 /*TODO: perform if anything more needs to be done to handle failure */
1200 /* TODO: To be handled */
1201 _bt_adapter_set_le_status(BT_LE_DEACTIVATING);
1202 result = BLUETOOTH_ERROR_NONE;
1207 case BT_LE_DEACTIVATING: {
1208 BT_INFO("LE is currently in deactivating state, state [%d]",
1209 _bt_adapter_get_le_status());
1211 return BLUETOOTH_ERROR_IN_PROGRESS;
1214 result = le_enable();
1215 if (result != OAL_STATUS_SUCCESS && result != OAL_STATUS_PENDING) {
1216 BT_ERR("LE_enable failed: [%d]", result);
1218 result = BLUETOOTH_ERROR_INTERNAL;
1219 /*TODO: perform if anything more needs to be done to handle failure */
1221 /* TODO: To be handled */
1222 _bt_adapter_set_le_status(BT_LE_ACTIVATING);
1223 result = BLUETOOTH_ERROR_NONE;
1228 case BT_LE_DEACTIVATED: {
1229 BT_INFO("LE is currently in deactivated state, state [%d]",
1230 _bt_adapter_get_le_status());
1232 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1234 result = le_enable();
1235 if (result != OAL_STATUS_SUCCESS && result != OAL_STATUS_PENDING) {
1236 BT_ERR("LE_enable failed: [%d]", result);
1238 result = BLUETOOTH_ERROR_INTERNAL;
1239 /*TODO: perform if anything more needs to be done to handle failure */
1241 /* TODO: To be handled */
1242 _bt_adapter_set_le_status(BT_LE_ACTIVATING);
1243 result = BLUETOOTH_ERROR_NONE;
1249 BT_ERR("Unknown state: %d", _bt_adapter_get_le_status());
1253 if (enable && result == BLUETOOTH_ERROR_NONE) {
1254 /* Adapter enable request is successful, setup event handlers */
1255 _bt_service_register_event_handler_callback(
1256 BT_ADAPTER_LE_MODULE, __bt_le_event_handler);
1257 _bt_device_state_handle_callback_set_request();
1262 int _bt_enable_adapter_le(void)
1264 return __bt_le_state_handle_request(TRUE);
1267 int _bt_disable_adapter_le(void)
1269 return __bt_le_state_handle_request(FALSE);
1273 static gboolean __bt_is_factory_test_mode(void)
1277 if (vconf_get_bool(VCONFKEY_BT_DUT_MODE, &mode)) {
1278 BT_ERR("Get the DUT Mode fail");
1282 if (mode != FALSE) {
1283 BT_INFO("DUT Test Mode !!");
1290 int _bt_set_advertising(const char *sender, int adv_handle, gboolean enable, gboolean use_reserved_slot)
1292 BT_CHECK_PARAMETER(sender, return);
1293 int server_instance;
1294 bt_pending_adv_data_set_t *info = NULL;
1295 int result = OAL_STATUS_SUCCESS;
1298 if (__bt_is_factory_test_mode()) {
1299 BT_ERR("Unable to start advertising in factory binary !!");
1300 return BLUETOOTH_ERROR_NOT_SUPPORT;
1303 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1305 if (server_instance == -1) {
1306 BT_DBG("No available slot for the current sender and handle combination");
1308 if (enable == FALSE) {
1309 BT_ERR("Advertising not even enabled on adv handle [%d] sender [%s]", adv_handle, sender);
1310 return BLUETOOTH_ERROR_NOT_IN_OPERATION;
1313 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
1315 if (server_instance == -1) {
1316 /* Internal Logic to register server instance if not initialized, store adv handle for future use */
1317 if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
1318 return BLUETOOTH_ERROR_INTERNAL;
1320 /* Allocate a pending structure and mark Adv data set pending */
1321 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
1322 info->adv_handle = adv_handle;
1323 info->sender = g_strdup(sender);
1324 info->is_data_set_pending = FALSE;
1325 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
1326 return BLUETOOTH_ERROR_NONE;
1332 result = adapter_ble_multi_adv_enable(server_instance);
1334 result = adapter_ble_multi_adv_disable(server_instance);
1335 if (result != OAL_STATUS_SUCCESS) {
1336 BT_ERR("OAL API adapter_ble_multi_adv_enable Fail %d", result);
1337 return BLUETOOTH_ERROR_INTERNAL;
1340 /* Update adv handle in table */
1341 _bt_update_adv_handle(sender, adv_handle);
1343 return BLUETOOTH_ERROR_NONE;
1346 int _bt_set_custom_advertising(const char *sender, int adv_handle,
1347 gboolean enable, bluetooth_advertising_params_t *params, gboolean use_reserved_slot)
1349 BT_CHECK_PARAMETER(sender, return);
1350 int server_instance;
1351 bt_pending_adv_data_set_t *info = NULL;
1352 int result = OAL_STATUS_SUCCESS;
1355 if (__bt_is_factory_test_mode()) {
1356 BT_ERR("Unable to start advertising in factory binary !!");
1357 return BLUETOOTH_ERROR_NOT_SUPPORT;
1360 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1362 if (server_instance == -1) {
1363 BT_DBG("No available slot for the current sender and handle combination");
1365 if (enable == FALSE) {
1366 BT_ERR("Advertising not even enabled on adv handle [%d] sender [%s]", adv_handle, sender);
1367 return BLUETOOTH_ERROR_NOT_IN_OPERATION;
1369 /* Below logic is only valid only when enabling advertising */
1370 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
1372 if (server_instance == -1) {
1373 /* Internal Logic to register server instance if not initialized, store adv handle for future use */
1374 if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
1375 return BLUETOOTH_ERROR_INTERNAL;
1377 /* Allocate a pending structure and mark Adv data set pending */
1378 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
1379 info->adv_handle = adv_handle;
1380 info->sender = g_strdup(sender);
1381 info->is_custom_adv = TRUE;
1382 info->is_data_set_pending = FALSE;
1383 memcpy(&info->params, params, sizeof(bluetooth_advertising_params_t));
1384 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
1385 return BLUETOOTH_ERROR_NONE;
1391 /* Set the Advertising filter policy Parameter in HAL */
1392 result = adapter_ble_set_filter_policy(params->filter_policy);
1394 if (result != OAL_STATUS_SUCCESS){
1395 BT_ERR("OAL API adapter_ble_set_filter_policy Fail %d", result);
1396 return BLUETOOTH_ERROR_INTERNAL;
1398 /* Set Advertising parameters to Stack */
1399 result = adapter_ble_multi_adv_update(server_instance, params->interval_min, params->interval_max,
1400 params->type, BT_ADV_DEFAULT_CHANNEL_MAP, params->tx_power_level, BT_ADV_DEFAULT_TIMEOUT);
1401 if (result != OAL_STATUS_SUCCESS) {
1402 BT_ERR("OAL API adapter_ble_multi_adv_update Fail %d", result);
1403 return BLUETOOTH_ERROR_INTERNAL;
1405 /* Start Advertising when Adv update event is received */
1406 result = adapter_ble_multi_adv_enable(server_instance);
1407 if (result != OAL_STATUS_SUCCESS) {
1408 BT_ERR("OAL API adapter_ble_multi_adv_enable Fail %d", result);
1409 return BLUETOOTH_ERROR_INTERNAL;
1411 /* Update adv handle in table */
1412 _bt_update_adv_handle(sender, adv_handle);
1414 return BLUETOOTH_ERROR_NONE;
1416 result = adapter_ble_multi_adv_disable(server_instance);
1418 if (result != OAL_STATUS_SUCCESS) {
1419 BT_ERR("OAL API adapter_ble_multi_adv_disable Fail %d", result);
1420 return BLUETOOTH_ERROR_INTERNAL;
1422 return BLUETOOTH_ERROR_NONE;
1425 int _bt_get_advertising_data(char *sender, int adv_handle, bluetooth_advertising_data_t *adv, int *length)
1427 BT_CHECK_PARAMETER(adv, return);
1428 BT_CHECK_PARAMETER(length, return);
1429 BT_CHECK_PARAMETER(sender, return);
1431 int server_instance;
1433 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, FALSE);
1435 if (server_instance == -1) {
1436 BT_DBG("No available slot for the current sender and handle combination");
1437 return BLUETOOTH_ERROR_INTERNAL;
1440 _bt_get_previous_adv_data(adv, length, server_instance);
1441 BT_DBG("ADV Data length [%d] Server Instance [%d] Adv handle [%d]", *length, server_instance, adv_handle);
1443 return BLUETOOTH_ERROR_NONE;
1446 int _bt_get_scan_response_data(char *sender, int adv_handle, bluetooth_scan_resp_data_t *response, int *length)
1448 BT_CHECK_PARAMETER(response, return);
1449 BT_CHECK_PARAMETER(length, return);
1450 BT_CHECK_PARAMETER(sender, return);
1452 int server_instance;
1454 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, FALSE);
1456 if (server_instance == -1) {
1457 BT_DBG("No available slot for the current sender and handle combination");
1458 return BLUETOOTH_ERROR_INTERNAL;
1461 _bt_get_previous_scan_rsp_data(response, length, server_instance);
1462 BT_DBG("SCAN RSP Data length [%d] Server Instance [%d] Adv handle [%d]", *length, server_instance, adv_handle);
1464 return BLUETOOTH_ERROR_NONE;
1467 static int __bt_set_multi_adv_param(oal_ble_multi_adv_param_setup_t *adv_setup,
1468 bluetooth_advertising_data_t *adv_data, int length)
1474 retv_if(NULL == adv_data, BLUETOOTH_ERROR_INVALID_PARAM);
1475 retv_if(NULL == adv_setup, BLUETOOTH_ERROR_INVALID_PARAM);
1477 for (ptr = adv_data->data; NULL != ptr && length > 0;) {
1481 BT_INFO("len: %d, type: %x", len, type);
1484 case 0xFF: /* Manufacturer Data */
1485 adv_setup->manufacturer_data = g_malloc0(sizeof(char) * (len - 1));
1486 memcpy(adv_setup->manufacturer_data, (ptr + 2), (len - 1));
1487 adv_setup->manufacturer_data_len = len - 1;
1489 case 0x15: /* 128 bit Solicit UUID */
1490 adv_setup->solicit_uuid = g_malloc0(sizeof(char) * (len - 1));
1491 memcpy((adv_setup->solicit_uuid), (ptr + 2), (len - 1));
1492 adv_setup->solicit_uuid_len = len;
1494 case 0x06: /* 128 bit Service UUID */
1495 adv_setup->service_uuid = g_malloc0(sizeof(char) * (len - 1));
1496 memcpy((adv_setup->service_uuid), (ptr + 2), (len - 1));
1497 adv_setup->service_uuid_len = len;
1499 case 0x14: { /* 16 bit Solicit UUID */
1502 num_uuids = (len -1)/2;
1503 adv_setup->solicit_uuid = g_malloc0(sizeof(char) * 16 * num_uuids);
1504 char *tmp = adv_setup->solicit_uuid;
1505 adv_setup->solicit_uuid_len = 0;
1507 for (c = 1; c <= num_uuids; c++) {
1508 adv_setup->solicit_uuid_len += 16;;
1509 memcpy(tmp, BASE_UUID_CONVERTED, BT_UUID_128);
1510 memcpy(tmp+12, &ptr[c*2/* Byte Length*/], 2/* Byte Length */);
1516 for (k = 0; k < 16 * num_uuids; k++)
1517 BT_DBG("%x", adv_setup->solicit_uuid[k]);
1520 case 0x02: { /* 16 bit Service UUID */
1523 num_uuids = (len -1)/2;
1524 adv_setup->service_uuid = g_malloc0(sizeof(char) * 16 * num_uuids);
1525 char *tmp = adv_setup->service_uuid;
1526 adv_setup->service_uuid_len = 0;
1528 for (c = 1; c <= num_uuids; c++) {
1529 adv_setup->service_uuid_len += 16;;
1530 memcpy(tmp, BASE_UUID_CONVERTED, BT_UUID_128);
1531 memcpy(tmp+12, &ptr[c*2/* Byte Length */], 2/* Byte Length */);
1537 for (k = 0; k < 16 * num_uuids; k++)
1538 BT_DBG("%x", adv_setup->service_uuid[k]);
1541 case 0x16: { /* Service Data */
1542 adv_setup->service_data = g_malloc0(sizeof(char) * (len - 1));
1543 memcpy(adv_setup->service_data, (ptr + 2), (len - 1));
1544 adv_setup->service_data_len = len - 1;
1548 BT_INFO("128 Bit Service Data Not Supported!!");
1552 adv_setup->include_txpower = 1;
1557 adv_setup->include_name = 1;
1561 memcpy(&adv_setup->appearance, (ptr + 2), (len - 1));
1565 BT_ERR("Unknown type: %x", type);
1574 return BLUETOOTH_ERROR_NONE;
1577 int _bt_set_advertising_data(const char *sender, int adv_handle,
1578 bluetooth_advertising_data_t *adv, int length, gboolean use_reserved_slot)
1580 BT_CHECK_PARAMETER(adv, return);
1581 BT_CHECK_PARAMETER(sender, return);
1582 bt_pending_adv_data_set_t *info = NULL;
1583 int server_instance;
1584 bluetooth_advertising_data_t adv_old;
1586 char *old_mdata = NULL;
1588 GVariant *ad_data, *param = NULL;
1589 oal_ble_multi_adv_param_setup_t adv_setup;
1590 int result = OAL_STATUS_SUCCESS;
1593 if (length > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
1594 return BLUETOOTH_ERROR_INVALID_PARAM;
1596 if (__bt_is_factory_test_mode()) {
1597 BT_ERR("Unable to set advertising data in factory binary !!");
1598 return BLUETOOTH_ERROR_NOT_SUPPORT;
1601 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1603 if (server_instance == -1) {
1604 BT_DBG("No available slot for the current sender and handle combination");
1606 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
1608 if (server_instance == -1) {
1609 /* Internal Logic to register server instance if not initialized, store adv handle for future use */
1610 if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
1611 return BLUETOOTH_ERROR_INTERNAL;
1613 /* Allocate a pending structure and mark Adv data set pending */
1614 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
1615 info->adv_handle = adv_handle;
1616 info->sender = g_strdup(sender);
1617 info->data_len = length;
1618 info->is_adv = TRUE;
1619 info->is_data_set_pending = TRUE;
1620 memcpy(&info->data, &(adv->data[0]), length);
1621 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
1622 return BLUETOOTH_ERROR_NONE;
1627 /* Server Instance is already allocated, set Adv data to stack */
1628 /* First check if adv data is already present for slot server_instance*/
1629 memset(&adv_old.data, 0, sizeof(adv_old.data));
1630 _bt_get_previous_adv_data(&adv_old, &adv_data_len, server_instance);
1632 /* Send Data to stack */
1633 memset(&adv_setup, 0, sizeof(oal_ble_multi_adv_param_setup_t));
1635 if (BLUETOOTH_ERROR_NONE !=
1636 __bt_set_multi_adv_param(&adv_setup, adv, length)) {
1637 if (adv_setup.manufacturer_data)
1638 g_free(adv_setup.manufacturer_data);
1639 if (adv_setup.service_uuid)
1640 g_free(adv_setup.service_uuid);
1641 if (adv_setup.service_data)
1642 g_free(adv_setup.service_data);
1643 return BLUETOOTH_ERROR_INTERNAL;
1645 /* Set Scan response false */
1646 adv_setup.set_scan_rsp = FALSE;
1648 /* Set Server instance */
1649 adv_setup.server_if = server_instance;
1651 /* Set Server instance[Product Requirement] */
1652 adv_setup.tx_power = 4;
1654 BT_DBG("####Service UUID len [%d], service data len [%d] Solicit UUID len [%d]",
1655 adv_setup.solicit_uuid_len, adv_setup.service_uuid_len, adv_setup.service_data_len);
1656 result = adapter_ble_multi_adv_set_inst_data(server_instance, &adv_setup);
1657 if (result != OAL_STATUS_SUCCESS) {
1658 BT_ERR("OAL API adapter_ble_multi_adv_set_inst_data Fail %d", result);
1660 if (adv_setup.manufacturer_data)
1661 g_free(adv_setup.manufacturer_data);
1662 if (adv_setup.service_data)
1663 g_free(adv_setup.service_data);
1664 if (adv_setup.service_uuid)
1665 g_free(adv_setup.service_uuid);
1666 return BLUETOOTH_ERROR_INTERNAL;
1669 /* Data sent to Stack successfully, send manuf data changed event if applicable */
1670 if (adv_setup.manufacturer_data_len != 0) {
1671 if (adv_data_len > 0) {
1672 _bt_get_ad_data_by_type((char *)adv_old.data, adv_data_len, 0xff,
1673 &old_mdata, &old_len);
1676 if (old_len != adv_setup.manufacturer_data_len ||
1677 (old_mdata && adv_setup.manufacturer_data &&
1678 memcmp(old_mdata, adv_setup.manufacturer_data, adv_setup.manufacturer_data_len))) {
1680 ad_data = g_variant_new_from_data((const GVariantType *)"ay",
1681 adv_setup.manufacturer_data, adv_setup.manufacturer_data_len, TRUE, NULL, NULL);
1682 param = g_variant_new("(@ay)", ad_data);
1683 _bt_send_event(BT_ADAPTER_EVENT,
1684 BLUETOOTH_EVENT_ADVERTISING_MANUFACTURER_DATA_CHANGED,
1691 /* Time to update new ADV data completely in Table */
1692 _bt_set_new_adv_data(adv, length, server_instance);
1695 if (adv_setup.manufacturer_data)
1696 g_free(adv_setup.manufacturer_data);
1697 if (adv_setup.service_data)
1698 g_free(adv_setup.service_data);
1699 if (adv_setup.service_uuid)
1700 g_free(adv_setup.service_uuid);
1702 /* Update adv handle in table */
1703 _bt_update_adv_handle(sender, adv_handle);
1705 return BLUETOOTH_ERROR_NONE;
1708 int _bt_set_scan_response_data(const char *sender, int adv_handle,
1709 bluetooth_scan_resp_data_t *response, int length, gboolean use_reserved_slot)
1711 BT_CHECK_PARAMETER(response, return);
1712 BT_CHECK_PARAMETER(sender, return);
1713 bt_pending_adv_data_set_t *info = NULL;
1714 bluetooth_scan_resp_data_t scan_rsp_old;
1715 int scan_rsp_data_len;
1716 GVariant *ad_data, *param = NULL;
1717 oal_ble_multi_adv_param_setup_t adv_setup;
1718 char *old_mdata = NULL;
1720 int server_instance;
1721 int result = OAL_STATUS_SUCCESS;
1724 if (length > BLUETOOTH_ADVERTISING_DATA_LENGTH_MAX)
1725 return BLUETOOTH_ERROR_INVALID_PARAM;
1727 if (__bt_is_factory_test_mode()) {
1728 BT_ERR("Unable to set Scan Response data in factory binary !!");
1729 return BLUETOOTH_ERROR_NOT_SUPPORT;
1732 server_instance = _bt_get_allocated_server_instance(sender, adv_handle, use_reserved_slot);
1733 if (server_instance == -1) {
1734 BT_DBG("No available slot for the current sender and handle combination");
1736 server_instance = _bt_is_sender_gatt_server_with_no_adv(sender, adv_handle);
1738 if (server_instance == -1) {
1739 /* Internal Logic to register server instance if not initialized */
1740 if (_bt_register_server_instance(sender, adv_handle) != BLUETOOTH_ERROR_NONE)
1741 return BLUETOOTH_ERROR_INTERNAL;
1743 /* Allocate a pending structure and mark Adv data set pending */
1744 info = g_malloc0(sizeof(bt_pending_adv_data_set_t));
1745 info->adv_handle = adv_handle;
1746 info->sender = g_strdup(sender);
1747 info->data_len = length;
1748 info->is_adv = FALSE;
1749 info->is_data_set_pending = TRUE;
1750 memcpy(&info->data, &(response->data[0]), length);
1751 adv_data_pending_list = g_slist_append(adv_data_pending_list, info);
1752 return BLUETOOTH_ERROR_NONE;
1757 /* Server Instance is already allocated, set Adv data to stack */
1758 /* First check if adv data is already present for slot server_instance*/
1759 memset(&scan_rsp_old.data, 0, sizeof(scan_rsp_old.data));
1760 _bt_get_previous_scan_rsp_data(&scan_rsp_old, &scan_rsp_data_len, server_instance);
1762 /* Send Data to stack */
1763 memset(&adv_setup, 0, sizeof(oal_ble_multi_adv_param_setup_t));
1765 if (BLUETOOTH_ERROR_NONE !=
1766 __bt_set_multi_adv_param(&adv_setup, (bluetooth_advertising_data_t*)response, length)) {
1767 if (adv_setup.manufacturer_data)
1768 g_free(adv_setup.manufacturer_data);
1769 if (adv_setup.service_uuid)
1770 g_free(adv_setup.service_uuid);
1771 if (adv_setup.service_data)
1772 g_free(adv_setup.service_data);
1773 return BLUETOOTH_ERROR_INTERNAL;
1776 /* Set Scan response to TRUE */
1777 adv_setup.set_scan_rsp = TRUE;
1779 /* Set Server instance */
1780 adv_setup.server_if = server_instance;
1782 /* Set Server instance[Product Requirement] */
1783 adv_setup.tx_power = 4;
1785 result = adapter_ble_multi_adv_set_inst_data(server_instance, &adv_setup);
1786 if (result != OAL_STATUS_SUCCESS) {
1787 BT_ERR("OAL API adapter_ble_multi_adv_set_inst_data Fail %d", result);
1789 if (adv_setup.manufacturer_data)
1790 g_free(adv_setup.manufacturer_data);
1791 if (adv_setup.service_data)
1792 g_free(adv_setup.service_data);
1793 if (adv_setup.service_uuid)
1794 g_free(adv_setup.service_uuid);
1795 return BLUETOOTH_ERROR_INTERNAL;
1798 /* Data sent to Stack successfully, send manuf data changed event if applicable */
1799 if (adv_setup.manufacturer_data_len != 0) {
1800 if (scan_rsp_data_len > 0) {
1801 _bt_get_ad_data_by_type((char *)scan_rsp_old.data, scan_rsp_data_len, 0xff,
1802 &old_mdata, &old_len);
1805 if (old_len != adv_setup.manufacturer_data_len ||
1806 (old_mdata && adv_setup.manufacturer_data &&
1807 memcmp(old_mdata, adv_setup.manufacturer_data, adv_setup.manufacturer_data_len))) {
1809 ad_data = g_variant_new_from_data((const GVariantType *)"ay",
1810 adv_setup.manufacturer_data, adv_setup.manufacturer_data_len, TRUE, NULL, NULL);
1811 param = g_variant_new("(@ay)", ad_data);
1812 _bt_send_event(BT_ADAPTER_EVENT,
1813 BLUETOOTH_EVENT_ADVERTISING_MANUFACTURER_DATA_CHANGED,
1820 /* Time to update new Scan Response data completely in Table */
1821 _bt_set_new_scan_rsp_data(response, length, server_instance);
1824 if (adv_setup.manufacturer_data)
1825 g_free(adv_setup.manufacturer_data);
1826 if (adv_setup.service_data)
1827 g_free(adv_setup.service_data);
1828 if (adv_setup.service_uuid)
1829 g_free(adv_setup.service_uuid);
1831 /* Update adv handle in table */
1832 _bt_update_adv_handle(sender, adv_handle);
1833 return BLUETOOTH_ERROR_NONE;
1836 /*************************************** LE Scan APIs *********************************************/
1837 int _bt_set_scan_parameters(bluetooth_le_scan_params_t *params)
1843 BT_CHECK_PARAMETER(params, return);
1845 if (_bt_adapter_get_status() != BT_ACTIVATED &&
1846 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
1847 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1850 BT_DBG("inteval %f, win %f, type %d", params->interval, params->window, params->type);
1852 if (params->interval < BT_LE_SCAN_INTERVAL_MIN ||
1853 params->interval > BT_LE_SCAN_INTERVAL_MAX)
1854 return BLUETOOTH_ERROR_INVALID_PARAM;
1856 if (params->window < BT_LE_SCAN_WINDOW_MIN ||
1857 params->window > BT_LE_SCAN_WINDOW_MAX)
1858 return BLUETOOTH_ERROR_INVALID_PARAM;
1860 if (params->window > params->interval)
1861 return BLUETOOTH_ERROR_INVALID_PARAM;
1863 itv = params->interval / BT_SCAN_INTERVAL_SPLIT;
1864 win = params->window / BT_SCAN_INTERVAL_SPLIT;
1866 ret = gattc_set_le_scan_param(params->type, itv, win);
1867 if (OAL_STATUS_SUCCESS != ret) {
1868 BT_ERR("gattc_set_le_scan_param failed");
1869 return BLUETOOTH_ERROR_INTERNAL;
1872 is_le_set_scan_parameter = TRUE;
1874 BT_INFO("Set scan parameters inteval %f, win %f, type %d",
1875 itv * BT_SCAN_INTERVAL_SPLIT, win * BT_SCAN_INTERVAL_SPLIT, params->type);
1877 return BLUETOOTH_ERROR_NONE;
1880 int _bt_prepare_scan_parameters(bluetooth_le_scan_params_t *params, int scan_type)
1882 if (_bt_adapter_get_status() != BT_ACTIVATED &&
1883 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
1884 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
1888 BT_DBG("inteval %f, win %f", params->interval, params->window);
1890 BT_DBG("type %d", scan_type);
1893 if (params->interval < BT_LE_SCAN_INTERVAL_MIN || params->interval > BT_LE_SCAN_INTERVAL_MAX)
1894 return BLUETOOTH_ERROR_INVALID_PARAM;
1896 if (params->window < BT_LE_SCAN_WINDOW_MIN || params->window > BT_LE_SCAN_WINDOW_MAX)
1897 return BLUETOOTH_ERROR_INVALID_PARAM;
1899 if (params->window > params->interval)
1900 return BLUETOOTH_ERROR_INVALID_PARAM;
1902 le_scan_params.interval = params->interval;
1903 le_scan_params.window = params->window;
1905 le_scan_params.type = scan_type;
1906 if (le_scan_params.interval == 0) {
1907 /* Set default scan interval same with BT_ADAPTER_LE_SCAN_MODE_LOW_ENERGY */
1908 le_scan_params.interval = 5120;
1909 le_scan_params.window = 512;
1913 is_le_set_scan_parameter = TRUE;
1915 return BLUETOOTH_ERROR_NONE;
1918 gboolean __send_le_scan_reply(gpointer data)
1920 int value = (intptr_t)data;
1923 BT_DBG("Send reply to BT_STOP_LE_DISCOVERY");
1924 __bt_adapter_le_handle_pending_request_info(
1925 BLUETOOTH_ERROR_NONE,
1926 BT_STOP_LE_DISCOVERY, NULL, 0);
1928 BT_DBG("Send reply to BT_START_LE_DISCOVERY");
1929 __bt_adapter_le_handle_pending_request_info(
1930 BLUETOOTH_ERROR_NONE,
1931 BT_START_LE_DISCOVERY, NULL, 0);
1937 static int __bt_get_available_scan_filter_slot_id(void)
1940 bt_adapter_le_scanner_t *scanner;
1942 bluetooth_le_scan_filter_t *filter_data;
1943 gboolean *slot_check_list = NULL;
1946 if (le_feature_info.max_filter == 0) {
1947 BT_ERR("Scan filter is NOT Supported");
1950 slot_check_list = g_malloc0(sizeof(gboolean) * le_feature_info.max_filter);
1952 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
1954 for (fl = scanner->filter_list; fl != NULL; fl = g_slist_next(fl)) {
1955 filter_data = fl->data;
1956 if (filter_data->slot_id < le_feature_info.max_filter)
1957 slot_check_list[filter_data->slot_id] = TRUE;
1961 for (i = 0; i < le_feature_info.max_filter; i++) {
1962 if (slot_check_list[i] == FALSE) {
1963 g_free(slot_check_list);
1968 BT_ERR("There is NO available slot for scan filter.");
1969 g_free(slot_check_list);
1973 int _bt_register_scan_filter(const char *sender, bluetooth_le_scan_filter_t *filter)
1975 int ret = BLUETOOTH_ERROR_NONE;
1976 bt_adapter_le_scanner_t *scanner = NULL;
1977 bluetooth_le_scan_filter_t *scan_filter_data = NULL;
1980 slot_id = __bt_get_available_scan_filter_slot_id();
1982 return BLUETOOTH_ERROR_NO_RESOURCES;
1984 oal_ble_scan_filter_t filter_data = {.slot_id = slot_id, .device_address = (bt_address_t*)&filter->device_address, .device_name = filter->device_name,
1985 .service_uuid = (oal_uuid_t*)&filter->service_uuid.data, .service_uuid_len = filter->service_uuid.data_len,
1986 .service_uuid_mask = (oal_uuid_t*)&filter->service_uuid_mask.data, .service_uuid_mask_len = filter->service_uuid_mask.data_len,
1987 .service_solicitation_uuid = (oal_uuid_t*)&filter->service_solicitation_uuid.data,
1988 .service_solicitation_uuid_len = filter->service_solicitation_uuid.data_len,
1989 .service_solicitation_uuid_mask = (oal_uuid_t*)&filter->service_solicitation_uuid_mask.data,
1990 .service_solicitation_uuid_mask_len = filter->service_solicitation_uuid_mask.data_len,
1991 .service_data = filter->service_data.data.data, .service_data_len = filter->service_data.data_len,
1992 .service_data_mask = filter->service_data_mask.data.data, .service_data_mask_len = filter->service_data_mask.data_len,
1993 .manufacturer_id = filter->manufacturer_id, .manufacturer_data = filter->manufacturer_data.data.data,
1994 .manufacturer_data_len = filter->manufacturer_data.data_len, .manufacturer_data_mask = filter->manufacturer_data_mask.data.data,
1995 .manufacturer_data_mask_len = filter->manufacturer_data_mask.data_len , .added_features = filter->added_features
1997 ret = gattc_register_scan_filter(&filter_data);
1999 if (OAL_STATUS_SUCCESS != ret) {
2000 BT_ERR("gattc_register_scan_filter failed");
2001 return BLUETOOTH_ERROR_INTERNAL;
2004 scanner = __bt_find_scanner_from_list(sender);
2006 if (scanner == NULL) {
2007 scanner = g_malloc0(sizeof(bt_adapter_le_scanner_t));
2009 if (scanner == NULL)
2010 return BLUETOOTH_ERROR_MEMORY_ALLOCATION;
2012 scanner->sender = g_strdup(sender);
2013 scanner_list = g_slist_append(scanner_list, scanner);
2016 scan_filter_data = g_malloc0(sizeof(bluetooth_le_scan_filter_t));
2018 memcpy(scan_filter_data, filter, sizeof(bluetooth_le_scan_filter_t));
2020 scan_filter_data->slot_id = slot_id;
2021 scanner->filter_list = g_slist_append(scanner->filter_list, scan_filter_data);
2026 int _bt_unregister_all_scan_filters(const char* sender)
2029 bt_adapter_le_scanner_t *scanner = NULL;
2030 bluetooth_le_scan_filter_t *filter_data = NULL;
2033 scanner = __bt_find_scanner_from_list(sender);
2035 if (scanner == NULL) {
2036 BT_ERR("There is NO available scanner.");
2037 return BLUETOOTH_ERROR_NOT_FOUND;
2039 for (l = scanner->filter_list; l != NULL; l = g_slist_next(l)) {
2040 filter_data = l->data;
2042 ret = gattc_unregister_scan_filter(filter_data->slot_id);
2044 if (OAL_STATUS_SUCCESS != ret)
2045 BT_ERR("gattc_unregister_scan_filter failed for slot_id = [%d]", filter_data->slot_id);
2048 g_slist_free_full(scanner->filter_list, g_free);
2049 scanner->filter_list = NULL;
2051 return BLUETOOTH_ERROR_NONE;
2054 int _bt_start_le_scan(const char *sender)
2056 bt_adapter_le_scanner_t *scanner;
2059 scanner = __bt_find_scanner_from_list(sender);
2061 scanner = g_malloc0(sizeof(bt_adapter_le_scanner_t));
2062 retv_if(scanner == NULL, BLUETOOTH_ERROR_INTERNAL);
2064 scanner->sender = g_strdup(sender);
2065 scanner_list = g_slist_append(scanner_list, scanner);
2068 /* Check scanning is in progress or not */
2069 if (scanner->is_scanning) {
2070 BT_ERR("BT is already in LE scanning");
2071 return BLUETOOTH_ERROR_IN_PROGRESS;
2074 scanner->is_scanning = TRUE;
2076 /* Check scanning is in progress or not by other users */
2077 if (_bt_is_le_scanning()) {
2079 BT_INFO("LE Full Scan is already on progress");
2080 g_idle_add(__send_le_scan_reply, (void *)(intptr_t)value);
2082 /* Disable scan filter if filter is NULL */
2083 if (scan_filter_enabled == TRUE) {
2084 if (scanner->filter_list == NULL) {
2085 BT_INFO("Disable LE Scan Filter");
2086 ret = gattc_disable_scan_filter(0);
2087 if (ret != OAL_STATUS_SUCCESS)
2088 BT_ERR("gattc_disable_scan_filter failed");
2089 scan_filter_enabled = FALSE;
2091 BT_INFO("LE Filter Scan is continue");
2094 BT_INFO("LE Full Scan is already on progress");
2096 return BLUETOOTH_ERROR_NONE;
2098 if (is_le_set_scan_parameter == FALSE) {
2099 /* Set default scan parameter same with BT_ADAPTER_LE_SCAN_MODE_LOW_ENERGY */
2100 bluetooth_le_scan_params_t scan_params;
2101 scan_params.type = BT_LE_ACTIVE_SCAN;
2102 scan_params.interval = 5120;
2103 scan_params.window = 512;
2104 _bt_set_scan_parameters(&scan_params);
2106 _bt_set_scan_parameters(&le_scan_params);
2108 /* Enable scan filter if filter is exisiting */
2109 if (scanner->filter_list == NULL) {
2110 scan_filter_enabled = FALSE;
2112 BT_INFO("Enable LE Scan Filter");
2113 ret = gattc_enable_scan_filter(0);
2114 if (ret != OAL_STATUS_SUCCESS)
2115 BT_ERR("gattc_enable_scan_filter failed");
2116 scan_filter_enabled = TRUE;
2120 BT_INFO("Start LE Full Scan");
2121 ret = gattc_start_le_discovery(g_gatt_client_id);
2123 if (OAL_STATUS_SUCCESS != ret) {
2124 BT_ERR("gattc_start_le_discovery failed");
2125 return BLUETOOTH_ERROR_INTERNAL;
2128 return BLUETOOTH_ERROR_NONE;
2131 int _bt_stop_le_scan(const char *sender)
2133 int result = BLUETOOTH_ERROR_NONE;
2134 bt_adapter_le_scanner_t *scanner;
2135 gboolean next_scanning = FALSE;
2139 /* Check scanning is in progress or not */
2140 scanner = __bt_find_scanner_from_list(sender);
2141 if (scanner == NULL || scanner->is_scanning == FALSE)
2142 return BLUETOOTH_ERROR_NOT_IN_OPERATION;
2144 scanner->is_scanning = FALSE;
2146 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
2148 if (scanner->is_scanning == TRUE)
2149 next_scanning = TRUE;
2152 if (next_scanning == TRUE) {
2155 g_idle_add(__send_le_scan_reply, (void *)(intptr_t)value);
2156 result = BLUETOOTH_ERROR_NONE;
2158 BT_INFO("Just stop LE scan");
2159 ret = gattc_stop_le_discovery(g_gatt_client_id);
2161 if (OAL_STATUS_SUCCESS != ret) {
2162 BT_ERR("gattc_start_le_discovery failed");
2163 result = BLUETOOTH_ERROR_INTERNAL;
2166 // TODO: Disable scan filter
2167 is_le_set_scan_parameter = FALSE;
2169 le_scan_params.type = BT_LE_ACTIVE_SCAN;
2170 le_scan_params.interval = 0;
2171 le_scan_params.window = 0;
2174 _bt_unregister_all_scan_filters(sender);
2176 scanner = __bt_find_scanner_from_list(sender);
2177 scanner_list = g_slist_remove(scanner_list, scanner);
2178 __bt_free_le_scanner(scanner);
2183 static void _bt_disable_all_scanner_status(void)
2186 bt_adapter_le_scanner_t *scanner;
2188 for (l = scanner_list; l != NULL; l = g_slist_next(l)) {
2190 scanner->is_scanning = FALSE;
2194 void _bt_check_le_scanner_app_termination(const char *sender)
2196 bt_adapter_le_scanner_t *scanner;
2198 scanner = __bt_find_scanner_from_list(sender);
2202 if (scanner->is_scanning)
2203 _bt_stop_le_scan(sender);
2205 scanner_list = g_slist_remove(scanner_list, scanner);
2206 g_free(scanner->sender);
2210 int _bt_service_le_init(void)
2214 return BLUETOOTH_ERROR_NONE;
2217 void _bt_service_le_deinit(void)
2220 __bt_free_le_scanner_all();
2223 int _bt_is_advertising(void)
2225 int ret = is_advertising();
2227 if (ret == BLUETOOTH_ERROR_NONE)
2233 gboolean _bt_is_le_2m_phy_supported(void)
2235 if (le_feature_info.le_2m_phy)
2241 gboolean _bt_is_le_coded_phy_supported(void)
2243 if (le_feature_info.le_coded_phy)
2249 gboolean _bt_is_scan_filter_supported(void)
2251 if (le_feature_info.max_filter > 0)
2257 int _bt_set_le_privacy(gboolean set_privacy)
2259 int result = BLUETOOTH_ERROR_NONE;
2261 if (__bt_is_factory_test_mode()) {
2262 BT_ERR("Unable to set le privacy in factory binary !!");
2263 return BLUETOOTH_ERROR_NOT_SUPPORT;
2266 if (_bt_adapter_get_status() != BT_ACTIVATED &&
2267 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
2268 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
2271 result = adapter_ble_set_privacy(set_privacy);
2272 if (result != OAL_STATUS_SUCCESS) {
2273 BT_ERR("adapter_set_le_privacy failed: %d", result);
2274 result = BLUETOOTH_ERROR_INTERNAL;
2281 int _bt_set_white_list(bluetooth_device_address_t *device_address, int address_type, bool is_add)
2283 int result = BLUETOOTH_ERROR_NONE;
2284 if (__bt_is_factory_test_mode()) {
2286 BT_ERR("Unable to add to white list in factory binary !!");
2288 BT_ERR("Unable to remove white list in factory binary !!");
2289 return BLUETOOTH_ERROR_NOT_SUPPORT;
2292 BT_CHECK_PARAMETER(device_address, return);
2294 if(_bt_adapter_get_status() != BT_ACTIVATED ){
2295 BT_ERR("Bluetooth adapter is disabled");
2296 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
2299 result = adapter_set_white_list((bt_address_t*)device_address, address_type, is_add);
2300 if (result != OAL_STATUS_SUCCESS) {
2302 BT_ERR("Add to White List Failed %d", result);
2304 BT_ERR("Remove from white list Failed %d", result);
2305 return BLUETOOTH_ERROR_INTERNAL;
2311 int _bt_set_manufacturer_data(bluetooth_manufacturer_data_t *m_data)
2313 GVariant *manufac_data, *param = NULL;
2314 int result = BLUETOOTH_ERROR_NONE;
2316 BT_CHECK_PARAMETER(m_data, return);
2318 if (_bt_adapter_get_status() != BT_ACTIVATED &&
2319 _bt_adapter_get_le_status() != BT_LE_ACTIVATED)
2320 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
2322 result = adapter_set_manufacturer_data((oal_manufacturer_data_t*)m_data);
2323 if (result != OAL_STATUS_SUCCESS) {
2324 BT_ERR("Set manufacturer data Failed %d", result);
2325 return BLUETOOTH_ERROR_INTERNAL;
2327 /*data has been successfully sent to the stack, inititate manufacturer data change event */
2328 manufac_data = g_variant_new_from_data((const GVariantType *)"ay",
2329 m_data->data, m_data->data_len, TRUE, NULL, NULL);
2330 param = g_variant_new("(@ay)", manufac_data);
2331 _bt_send_event(BT_ADAPTER_EVENT,
2332 BLUETOOTH_EVENT_MANUFACTURER_DATA_CHANGED,
2338 /*************************************** LE Scan APIs *********************************************/
2340 int _bt_set_le_static_random_address(gboolean is_enable)
2342 int result = BLUETOOTH_ERROR_NONE;
2344 if (__bt_is_factory_test_mode()) {
2345 BT_ERR("Unable to set le random address in factory binary !!");
2346 return BLUETOOTH_ERROR_NOT_SUPPORT;
2349 if (_bt_adapter_get_status() != BT_ACTIVATED &&
2350 _bt_adapter_get_le_status() != BT_LE_ACTIVATED) {
2351 return BLUETOOTH_ERROR_DEVICE_NOT_ENABLED;
2354 result = adapter_set_le_static_random_address(is_enable);
2355 if (result != OAL_STATUS_SUCCESS) {
2356 BT_ERR("adapter_set_connectable failed: %d", result);
2357 result = BLUETOOTH_ERROR_INTERNAL;
2359 BT_INFO("SetLeStaticRandomAddress as %d", is_enable);
2360 result = BLUETOOTH_ERROR_NONE;