[FL-1796] Disable bluetooth (#703)
* bt: add authentication for all characteristics * bt: app_ble cleanup * bt: add start and stop advertising API * bt: rework application with start and stop advertising API * bt: support f7 target * bt: f7 target remove unused files * bt: stop advertising in bt debug application * bt: fix bt status bar update * bt: change bluetooth On Off order
This commit is contained in:
		
							parent
							
								
									8fd411097e
								
							
						
					
					
						commit
						4768177cf5
					
				| @ -1,4 +1,5 @@ | |||||||
| #include "bt_debug_app.h" | #include "bt_debug_app.h" | ||||||
|  | #include <furi-hal-bt.h> | ||||||
| 
 | 
 | ||||||
| enum BtDebugSubmenuIndex { | enum BtDebugSubmenuIndex { | ||||||
|     BtDebugSubmenuIndexCarrierTest, |     BtDebugSubmenuIndexCarrierTest, | ||||||
| @ -25,6 +26,10 @@ uint32_t bt_debug_start_view(void* context) { | |||||||
| 
 | 
 | ||||||
| BtDebugApp* bt_debug_app_alloc() { | BtDebugApp* bt_debug_app_alloc() { | ||||||
|     BtDebugApp* app = furi_alloc(sizeof(BtDebugApp)); |     BtDebugApp* app = furi_alloc(sizeof(BtDebugApp)); | ||||||
|  | 
 | ||||||
|  |     // Load settings
 | ||||||
|  |     bt_settings_load(&app->settings); | ||||||
|  | 
 | ||||||
|     // Gui
 |     // Gui
 | ||||||
|     app->gui = furi_record_open("gui"); |     app->gui = furi_record_open("gui"); | ||||||
| 
 | 
 | ||||||
| @ -88,7 +93,15 @@ void bt_debug_app_free(BtDebugApp* app) { | |||||||
| 
 | 
 | ||||||
| int32_t bt_debug_app(void* p) { | int32_t bt_debug_app(void* p) { | ||||||
|     BtDebugApp* app = bt_debug_app_alloc(); |     BtDebugApp* app = bt_debug_app_alloc(); | ||||||
|  |     // Stop advertising
 | ||||||
|  |     furi_hal_bt_stop_advertising(); | ||||||
|  | 
 | ||||||
|     view_dispatcher_run(app->view_dispatcher); |     view_dispatcher_run(app->view_dispatcher); | ||||||
|  | 
 | ||||||
|  |     // Restart advertising
 | ||||||
|  |     if(app->settings.enabled) { | ||||||
|  |         furi_hal_bt_start_advertising(); | ||||||
|  |     } | ||||||
|     bt_debug_app_free(app); |     bt_debug_app_free(app); | ||||||
|     return 0; |     return 0; | ||||||
| } | } | ||||||
|  | |||||||
| @ -3,13 +3,6 @@ | |||||||
| 
 | 
 | ||||||
| #define BT_SERVICE_TAG "BT" | #define BT_SERVICE_TAG "BT" | ||||||
| 
 | 
 | ||||||
| // static void bt_update_statusbar(void* arg) {
 |  | ||||||
| //     furi_assert(arg);
 |  | ||||||
| //     Bt* bt = arg;
 |  | ||||||
| //     BtMessage m = {.type = BtMessageTypeUpdateStatusbar};
 |  | ||||||
| //     furi_check(osMessageQueuePut(bt->message_queue, &m, 0, osWaitForever) == osOK);
 |  | ||||||
| // }
 |  | ||||||
| 
 |  | ||||||
| static void bt_draw_statusbar_callback(Canvas* canvas, void* context) { | static void bt_draw_statusbar_callback(Canvas* canvas, void* context) { | ||||||
|     canvas_draw_icon(canvas, 0, 0, &I_Bluetooth_5x8); |     canvas_draw_icon(canvas, 0, 0, &I_Bluetooth_5x8); | ||||||
| } | } | ||||||
| @ -42,10 +35,6 @@ Bt* bt_alloc() { | |||||||
|     // Alloc queue
 |     // Alloc queue
 | ||||||
|     bt->message_queue = osMessageQueueNew(8, sizeof(BtMessage), NULL); |     bt->message_queue = osMessageQueueNew(8, sizeof(BtMessage), NULL); | ||||||
| 
 | 
 | ||||||
|     // doesn't make sense if we waiting for transition on service start
 |  | ||||||
|     // bt->update_status_timer = osTimerNew(bt_update_statusbar, osTimerPeriodic, bt, NULL);
 |  | ||||||
|     // osTimerStart(bt->update_status_timer, 4000);
 |  | ||||||
| 
 |  | ||||||
|     // Setup statusbar view port
 |     // Setup statusbar view port
 | ||||||
|     bt->statusbar_view_port = bt_statusbar_view_port_alloc(); |     bt->statusbar_view_port = bt_statusbar_view_port_alloc(); | ||||||
|     // Gui
 |     // Gui
 | ||||||
| @ -67,15 +56,18 @@ int32_t bt_srv() { | |||||||
|         FURI_LOG_E(BT_SERVICE_TAG, "Core2 startup failed"); |         FURI_LOG_E(BT_SERVICE_TAG, "Core2 startup failed"); | ||||||
|     } else { |     } else { | ||||||
|         view_port_enabled_set(bt->statusbar_view_port, true); |         view_port_enabled_set(bt->statusbar_view_port, true); | ||||||
|  |         if(furi_hal_bt_init_app()) { | ||||||
|  |             FURI_LOG_I(BT_SERVICE_TAG, "BLE stack started"); | ||||||
|             if(bt->bt_settings.enabled) { |             if(bt->bt_settings.enabled) { | ||||||
|             bool bt_app_started = furi_hal_bt_start_app(); |                 furi_hal_bt_start_advertising(); | ||||||
|             if(!bt_app_started) { |                 FURI_LOG_I(BT_SERVICE_TAG, "Start advertising"); | ||||||
|                 FURI_LOG_E(BT_SERVICE_TAG, "BT App start failed"); |             } | ||||||
|         } else { |         } else { | ||||||
|                 FURI_LOG_I(BT_SERVICE_TAG, "BT App started"); |             FURI_LOG_E(BT_SERVICE_TAG, "BT App start failed"); | ||||||
|             } |  | ||||||
|         } |         } | ||||||
|     } |     } | ||||||
|  |     // Update statusbar
 | ||||||
|  |     view_port_enabled_set(bt->statusbar_view_port, furi_hal_bt_is_alive()); | ||||||
| 
 | 
 | ||||||
|     BtMessage message; |     BtMessage message; | ||||||
|     while(1) { |     while(1) { | ||||||
|  | |||||||
| @ -9,6 +9,8 @@ extern "C" { | |||||||
| 
 | 
 | ||||||
| typedef struct Bt Bt; | typedef struct Bt Bt; | ||||||
| 
 | 
 | ||||||
|  | void bt_update_statusbar(Bt* bt); | ||||||
|  | 
 | ||||||
| void bt_update_battery_level(Bt* bt, uint8_t battery_level); | void bt_update_battery_level(Bt* bt, uint8_t battery_level); | ||||||
| 
 | 
 | ||||||
| bool bt_pin_code_show(Bt* bt, uint32_t pin_code); | bool bt_pin_code_show(Bt* bt, uint32_t pin_code); | ||||||
|  | |||||||
| @ -1,6 +1,12 @@ | |||||||
| #include "bt.h" | #include "bt.h" | ||||||
| #include "bt_i.h" | #include "bt_i.h" | ||||||
| 
 | 
 | ||||||
|  | void bt_update_statusbar(Bt* bt) { | ||||||
|  |     furi_assert(bt); | ||||||
|  |     BtMessage message = {.type = BtMessageTypeUpdateStatusbar}; | ||||||
|  |     furi_check(osMessageQueuePut(bt->message_queue, &message, 0, osWaitForever) == osOK); | ||||||
|  | } | ||||||
|  | 
 | ||||||
| void bt_update_battery_level(Bt* bt, uint8_t battery_level) { | void bt_update_battery_level(Bt* bt, uint8_t battery_level) { | ||||||
|     furi_assert(bt); |     furi_assert(bt); | ||||||
|     BtMessage message = { |     BtMessage message = { | ||||||
|  | |||||||
| @ -32,7 +32,6 @@ typedef struct { | |||||||
| struct Bt { | struct Bt { | ||||||
|     BtSettings bt_settings; |     BtSettings bt_settings; | ||||||
|     osMessageQueueId_t message_queue; |     osMessageQueueId_t message_queue; | ||||||
|     osTimerId_t update_status_timer; |  | ||||||
|     Gui* gui; |     Gui* gui; | ||||||
|     ViewPort* statusbar_view_port; |     ViewPort* statusbar_view_port; | ||||||
|     DialogsApp* dialogs; |     DialogsApp* dialogs; | ||||||
|  | |||||||
| @ -31,12 +31,11 @@ BtSettingsApp* bt_settings_app_alloc() { | |||||||
| 
 | 
 | ||||||
|     view_dispatcher_attach_to_gui(app->view_dispatcher, app->gui, ViewDispatcherTypeFullscreen); |     view_dispatcher_attach_to_gui(app->view_dispatcher, app->gui, ViewDispatcherTypeFullscreen); | ||||||
| 
 | 
 | ||||||
|     app->submenu = submenu_alloc(); |     app->var_item_list = variable_item_list_alloc(); | ||||||
|     view_dispatcher_add_view( |     view_dispatcher_add_view( | ||||||
|         app->view_dispatcher, BtSettingsAppViewSubmenu, submenu_get_view(app->submenu)); |         app->view_dispatcher, | ||||||
|     app->dialog_ex = dialog_ex_alloc(); |         BtSettingsAppViewVarItemList, | ||||||
|     view_dispatcher_add_view( |         variable_item_list_get_view(app->var_item_list)); | ||||||
|         app->view_dispatcher, BtSettingsAppViewDialogEx, dialog_ex_get_view(app->dialog_ex)); |  | ||||||
| 
 | 
 | ||||||
|     scene_manager_next_scene(app->scene_manager, BtSettingsAppSceneStart); |     scene_manager_next_scene(app->scene_manager, BtSettingsAppSceneStart); | ||||||
|     return app; |     return app; | ||||||
| @ -44,12 +43,9 @@ BtSettingsApp* bt_settings_app_alloc() { | |||||||
| 
 | 
 | ||||||
| void bt_settings_app_free(BtSettingsApp* app) { | void bt_settings_app_free(BtSettingsApp* app) { | ||||||
|     furi_assert(app); |     furi_assert(app); | ||||||
|     // Submenu
 |     // Variable item list
 | ||||||
|     view_dispatcher_remove_view(app->view_dispatcher, BtSettingsAppViewSubmenu); |     view_dispatcher_remove_view(app->view_dispatcher, BtSettingsAppViewVarItemList); | ||||||
|     submenu_free(app->submenu); |     variable_item_list_free(app->var_item_list); | ||||||
|     // Dialog
 |  | ||||||
|     view_dispatcher_remove_view(app->view_dispatcher, BtSettingsAppViewDialogEx); |  | ||||||
|     dialog_ex_free(app->dialog_ex); |  | ||||||
|     // View dispatcher
 |     // View dispatcher
 | ||||||
|     view_dispatcher_free(app->view_dispatcher); |     view_dispatcher_free(app->view_dispatcher); | ||||||
|     scene_manager_free(app->scene_manager); |     scene_manager_free(app->scene_manager); | ||||||
|  | |||||||
							
								
								
									
										11
									
								
								applications/bt/bt_settings_app/bt_settings_app.h
									
									
									
									
									
										
										
										Normal file → Executable file
									
								
							
							
						
						
									
										11
									
								
								applications/bt/bt_settings_app/bt_settings_app.h
									
									
									
									
									
										
										
										Normal file → Executable file
									
								
							| @ -6,8 +6,7 @@ | |||||||
| #include <gui/view_dispatcher.h> | #include <gui/view_dispatcher.h> | ||||||
| #include <gui/scene_manager.h> | #include <gui/scene_manager.h> | ||||||
| 
 | 
 | ||||||
| #include <gui/modules/submenu.h> | #include <gui/modules/variable-item-list.h> | ||||||
| #include <gui/modules/dialog_ex.h> |  | ||||||
| 
 | 
 | ||||||
| #include "../bt_settings.h" | #include "../bt_settings.h" | ||||||
| #include "scenes/bt_settings_scene.h" | #include "scenes/bt_settings_scene.h" | ||||||
| @ -17,11 +16,7 @@ typedef struct { | |||||||
|     Gui* gui; |     Gui* gui; | ||||||
|     SceneManager* scene_manager; |     SceneManager* scene_manager; | ||||||
|     ViewDispatcher* view_dispatcher; |     ViewDispatcher* view_dispatcher; | ||||||
|     Submenu* submenu; |     VariableItemList* var_item_list; | ||||||
|     DialogEx* dialog_ex; |  | ||||||
| } BtSettingsApp; | } BtSettingsApp; | ||||||
| 
 | 
 | ||||||
| typedef enum { | typedef enum { BtSettingsAppViewVarItemList } BtSettingsAppView; | ||||||
|     BtSettingsAppViewSubmenu, |  | ||||||
|     BtSettingsAppViewDialogEx, |  | ||||||
| } BtSettingsAppView; |  | ||||||
|  | |||||||
| @ -1,2 +1 @@ | |||||||
| ADD_SCENE(bt_settings, start, Start) | ADD_SCENE(bt_settings, start, Start) | ||||||
| ADD_SCENE(bt_settings, disable_dialog, DisableDialog) |  | ||||||
|  | |||||||
| @ -1,44 +0,0 @@ | |||||||
| #include "../bt_settings_app.h" |  | ||||||
| #include <furi-hal-boot.h> |  | ||||||
| #include <furi-hal-power.h> |  | ||||||
| 
 |  | ||||||
| static void bt_setting_disable_dialog_callback(DialogExResult result, void* context) { |  | ||||||
|     BtSettingsApp* app = context; |  | ||||||
|     view_dispatcher_send_custom_event(app->view_dispatcher, result); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| void bt_settings_scene_disable_dialog_on_enter(void* context) { |  | ||||||
|     BtSettingsApp* app = context; |  | ||||||
|     DialogEx* dialog_ex = app->dialog_ex; |  | ||||||
|     dialog_ex_set_text( |  | ||||||
|         dialog_ex, "Reboot device\nto disable Bluetooth", 64, 32, AlignCenter, AlignCenter); |  | ||||||
|     dialog_ex_set_left_button_text(dialog_ex, "Back"); |  | ||||||
|     dialog_ex_set_right_button_text(dialog_ex, "Reboot"); |  | ||||||
|     dialog_ex_set_result_callback(dialog_ex, bt_setting_disable_dialog_callback); |  | ||||||
|     dialog_ex_set_context(dialog_ex, app); |  | ||||||
| 
 |  | ||||||
|     view_dispatcher_switch_to_view(app->view_dispatcher, BtSettingsAppViewDialogEx); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| bool bt_settings_scene_disable_dialog_on_event(void* context, SceneManagerEvent event) { |  | ||||||
|     BtSettingsApp* app = context; |  | ||||||
|     bool consumed = false; |  | ||||||
| 
 |  | ||||||
|     if(event.type == SceneManagerEventTypeCustom) { |  | ||||||
|         if(event.event == DialogExResultLeft) { |  | ||||||
|             scene_manager_previous_scene(app->scene_manager); |  | ||||||
|             consumed = true; |  | ||||||
|         } else if(event.event == DialogExResultRight) { |  | ||||||
|             app->settings.enabled = false; |  | ||||||
|             bt_settings_save(&app->settings); |  | ||||||
|             furi_hal_boot_set_mode(FuriHalBootModeNormal); |  | ||||||
|             furi_hal_power_reset(); |  | ||||||
|         } |  | ||||||
|     } |  | ||||||
|     return consumed; |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| void bt_settings_scene_disable_dialog_on_exit(void* context) { |  | ||||||
|     BtSettingsApp* app = context; |  | ||||||
|     dialog_ex_clean(app->dialog_ex); |  | ||||||
| } |  | ||||||
| @ -1,28 +1,45 @@ | |||||||
| #include "../bt_settings_app.h" | #include "../bt_settings_app.h" | ||||||
| #include "furi-hal-bt.h" | #include "furi-hal-bt.h" | ||||||
| 
 | 
 | ||||||
| enum BtSettingsAppStartSubmenuIndex { | enum BtSetting { | ||||||
|     BtSettingsAppStartSubmenuIndexEnable, |     BtSettingOff, | ||||||
|  |     BtSettingOn, | ||||||
|  |     BtSettingNum, | ||||||
| }; | }; | ||||||
| 
 | 
 | ||||||
| static void bt_settings_scene_start_submenu_callback(void* context, uint32_t index) { | const char* const bt_settings_text[BtSettingNum] = { | ||||||
|     BtSettingsApp* app = context; |     "Off", | ||||||
|  |     "On", | ||||||
|  | }; | ||||||
|  | 
 | ||||||
|  | static void bt_settings_scene_start_var_list_change_callback(VariableItem* item) { | ||||||
|  |     BtSettingsApp* app = variable_item_get_context(item); | ||||||
|  |     uint8_t index = variable_item_get_current_value_index(item); | ||||||
|  | 
 | ||||||
|  |     variable_item_set_current_value_text(item, bt_settings_text[index]); | ||||||
|     view_dispatcher_send_custom_event(app->view_dispatcher, index); |     view_dispatcher_send_custom_event(app->view_dispatcher, index); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| void bt_settings_scene_start_on_enter(void* context) { | void bt_settings_scene_start_on_enter(void* context) { | ||||||
|     BtSettingsApp* app = context; |     BtSettingsApp* app = context; | ||||||
|     Submenu* submenu = app->submenu; |     VariableItemList* var_item_list = app->var_item_list; | ||||||
| 
 | 
 | ||||||
|     const char* submenu_label = app->settings.enabled ? "Disable" : "Enable"; |     VariableItem* item; | ||||||
|     submenu_add_item( |     item = variable_item_list_add( | ||||||
|         submenu, |         var_item_list, | ||||||
|         submenu_label, |         "Bluetooth", | ||||||
|         BtSettingsAppStartSubmenuIndexEnable, |         BtSettingNum, | ||||||
|         bt_settings_scene_start_submenu_callback, |         bt_settings_scene_start_var_list_change_callback, | ||||||
|         app); |         app); | ||||||
|  |     if(app->settings.enabled) { | ||||||
|  |         variable_item_set_current_value_index(item, BtSettingOn); | ||||||
|  |         variable_item_set_current_value_text(item, bt_settings_text[BtSettingOn]); | ||||||
|  |     } else { | ||||||
|  |         variable_item_set_current_value_index(item, BtSettingOff); | ||||||
|  |         variable_item_set_current_value_text(item, bt_settings_text[BtSettingOff]); | ||||||
|  |     } | ||||||
| 
 | 
 | ||||||
|     view_dispatcher_switch_to_view(app->view_dispatcher, BtSettingsAppViewSubmenu); |     view_dispatcher_switch_to_view(app->view_dispatcher, BtSettingsAppViewVarItemList); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| bool bt_settings_scene_start_on_event(void* context, SceneManagerEvent event) { | bool bt_settings_scene_start_on_event(void* context, SceneManagerEvent event) { | ||||||
| @ -30,27 +47,19 @@ bool bt_settings_scene_start_on_event(void* context, SceneManagerEvent event) { | |||||||
|     bool consumed = false; |     bool consumed = false; | ||||||
| 
 | 
 | ||||||
|     if(event.type == SceneManagerEventTypeCustom) { |     if(event.type == SceneManagerEventTypeCustom) { | ||||||
|         if(event.event == BtSettingsAppStartSubmenuIndexEnable) { |         if(event.event == BtSettingOn) { | ||||||
|             if(!app->settings.enabled) { |             furi_hal_bt_start_advertising(); | ||||||
|             app->settings.enabled = true; |             app->settings.enabled = true; | ||||||
|                 furi_hal_bt_start_app(); |         } else if(event.event == BtSettingOff) { | ||||||
|                 submenu_clean(app->submenu); |             app->settings.enabled = false; | ||||||
|                 submenu_add_item( |             furi_hal_bt_stop_advertising(); | ||||||
|                     app->submenu, |  | ||||||
|                     "Disable", |  | ||||||
|                     BtSettingsAppStartSubmenuIndexEnable, |  | ||||||
|                     bt_settings_scene_start_submenu_callback, |  | ||||||
|                     app); |  | ||||||
|             } else { |  | ||||||
|                 scene_manager_next_scene(app->scene_manager, BtSettingsAppSceneDisableDialog); |  | ||||||
|         } |         } | ||||||
|         consumed = true; |         consumed = true; | ||||||
|     } |     } | ||||||
|     } |  | ||||||
|     return consumed; |     return consumed; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| void bt_settings_scene_start_on_exit(void* context) { | void bt_settings_scene_start_on_exit(void* context) { | ||||||
|     BtSettingsApp* app = context; |     BtSettingsApp* app = context; | ||||||
|     submenu_clean(app->submenu); |     variable_item_list_clean(app->var_item_list); | ||||||
| } | } | ||||||
|  | |||||||
| @ -1,140 +0,0 @@ | |||||||
| #include "main.h" |  | ||||||
| 
 |  | ||||||
| #include "app_entry.h" |  | ||||||
| #include "app_common.h" |  | ||||||
| #include "dbg_trace.h" |  | ||||||
| #include "ble.h" |  | ||||||
| #include "tl.h" |  | ||||||
| #include "app_ble.h" |  | ||||||
| #include "shci.h" |  | ||||||
| #include "cmsis_os.h" |  | ||||||
| 
 |  | ||||||
| #include <furi-hal.h> |  | ||||||
| 
 |  | ||||||
| PLACE_IN_SECTION("MB_MEM1") ALIGN(4) static TL_CmdPacket_t BleCmdBuffer; |  | ||||||
| 
 |  | ||||||
| // PLACE_IN_SECTION("TAG_OTA_END") const uint32_t MagicKeywordValue = 0x94448A29 ;
 |  | ||||||
| // PLACE_IN_SECTION("TAG_OTA_START") const uint32_t MagicKeywordAddress = (uint32_t)&MagicKeywordValue;
 |  | ||||||
| 
 |  | ||||||
| osMutexId_t MtxHciId; |  | ||||||
| osSemaphoreId_t SemHciId; |  | ||||||
| osThreadId_t HciUserEvtProcessId; |  | ||||||
| 
 |  | ||||||
| const osThreadAttr_t HciUserEvtProcess_attr = { |  | ||||||
|     .name = CFG_HCI_USER_EVT_PROCESS_NAME, |  | ||||||
|     .attr_bits = CFG_HCI_USER_EVT_PROCESS_ATTR_BITS, |  | ||||||
|     .cb_mem = CFG_HCI_USER_EVT_PROCESS_CB_MEM, |  | ||||||
|     .cb_size = CFG_HCI_USER_EVT_PROCESS_CB_SIZE, |  | ||||||
|     .stack_mem = CFG_HCI_USER_EVT_PROCESS_STACK_MEM, |  | ||||||
|     .priority = CFG_HCI_USER_EVT_PROCESS_PRIORITY, |  | ||||||
|     .stack_size = CFG_HCI_USER_EVT_PROCESS_STACK_SIZE |  | ||||||
| }; |  | ||||||
| 
 |  | ||||||
| /* Private function prototypes -----------------------------------------------*/ |  | ||||||
| static void HciUserEvtProcess(void *argument); |  | ||||||
| static void BLE_UserEvtRx( void * pPayload ); |  | ||||||
| static void BLE_StatusNot( HCI_TL_CmdStatus_t status ); |  | ||||||
| static void Ble_Tl_Init( void ); |  | ||||||
| 
 |  | ||||||
| bool APP_BLE_Init() { |  | ||||||
|   SHCI_C2_Ble_Init_Cmd_Packet_t ble_init_cmd_packet = { |  | ||||||
|     {{0,0,0}},                  /**< Header unused */ |  | ||||||
|     {0,                         /** pBleBufferAddress not used */ |  | ||||||
|     0,                          /** BleBufferSize not used */ |  | ||||||
|     CFG_BLE_NUM_GATT_ATTRIBUTES, |  | ||||||
|     CFG_BLE_NUM_GATT_SERVICES, |  | ||||||
|     CFG_BLE_ATT_VALUE_ARRAY_SIZE, |  | ||||||
|     CFG_BLE_NUM_LINK, |  | ||||||
|     CFG_BLE_DATA_LENGTH_EXTENSION, |  | ||||||
|     CFG_BLE_PREPARE_WRITE_LIST_SIZE, |  | ||||||
|     CFG_BLE_MBLOCK_COUNT, |  | ||||||
|     CFG_BLE_MAX_ATT_MTU, |  | ||||||
|     CFG_BLE_SLAVE_SCA, |  | ||||||
|     CFG_BLE_MASTER_SCA, |  | ||||||
|     CFG_BLE_LSE_SOURCE, |  | ||||||
|     CFG_BLE_MAX_CONN_EVENT_LENGTH, |  | ||||||
|     CFG_BLE_HSE_STARTUP_TIME, |  | ||||||
|     CFG_BLE_VITERBI_MODE, |  | ||||||
|     CFG_BLE_LL_ONLY, |  | ||||||
|     0} |  | ||||||
|   }; |  | ||||||
| 
 |  | ||||||
|   // Initialize Ble Transport Layer
 |  | ||||||
|   Ble_Tl_Init( ); |  | ||||||
|   // Register the hci transport layer to handle BLE User Asynchronous Events
 |  | ||||||
|   HciUserEvtProcessId = osThreadNew(HciUserEvtProcess, NULL, &HciUserEvtProcess_attr); |  | ||||||
|   // Starts the BLE Stack on CPU2
 |  | ||||||
|   return (SHCI_C2_BLE_Init( &ble_init_cmd_packet ) == SHCI_Success); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| static void Ble_Tl_Init( void ) { |  | ||||||
|   HCI_TL_HciInitConf_t Hci_Tl_Init_Conf; |  | ||||||
| 
 |  | ||||||
|   MtxHciId = osMutexNew( NULL ); |  | ||||||
|   SemHciId = osSemaphoreNew( 1, 0, NULL ); /*< Create the semaphore and make it busy at initialization */ |  | ||||||
| 
 |  | ||||||
|   Hci_Tl_Init_Conf.p_cmdbuffer = (uint8_t*)&BleCmdBuffer; |  | ||||||
|   Hci_Tl_Init_Conf.StatusNotCallBack = BLE_StatusNot; |  | ||||||
|   hci_init(BLE_UserEvtRx, (void*) &Hci_Tl_Init_Conf); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| static void HciUserEvtProcess(void *argument) { |  | ||||||
|   UNUSED(argument); |  | ||||||
| 
 |  | ||||||
|   for(;;) |  | ||||||
|   { |  | ||||||
|     osThreadFlagsWait( 1, osFlagsWaitAny, osWaitForever); |  | ||||||
|     hci_user_evt_proc( ); |  | ||||||
|   } |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| /*************************************************************
 |  | ||||||
|  * |  | ||||||
|  * WRAP FUNCTIONS |  | ||||||
|  * |  | ||||||
|  *************************************************************/ |  | ||||||
| void hci_notify_asynch_evt(void* pdata) { |  | ||||||
|   UNUSED(pdata); |  | ||||||
|   osThreadFlagsSet( HciUserEvtProcessId, 1 ); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| void hci_cmd_resp_release(uint32_t flag) { |  | ||||||
|   UNUSED(flag); |  | ||||||
|   osSemaphoreRelease( SemHciId ); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| void hci_cmd_resp_wait(uint32_t timeout) { |  | ||||||
|   UNUSED(timeout); |  | ||||||
|   osSemaphoreAcquire( SemHciId, osWaitForever ); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| static void BLE_UserEvtRx( void * pPayload ) { |  | ||||||
|   SVCCTL_UserEvtFlowStatus_t svctl_return_status; |  | ||||||
|   tHCI_UserEvtRxParam *pParam; |  | ||||||
| 
 |  | ||||||
|   pParam = (tHCI_UserEvtRxParam *)pPayload; |  | ||||||
| 
 |  | ||||||
|   svctl_return_status = SVCCTL_UserEvtRx((void *)&(pParam->pckt->evtserial)); |  | ||||||
|   if (svctl_return_status != SVCCTL_UserEvtFlowDisable) { |  | ||||||
|     pParam->status = HCI_TL_UserEventFlow_Enable; |  | ||||||
|   } else { |  | ||||||
|     pParam->status = HCI_TL_UserEventFlow_Disable; |  | ||||||
|   } |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| static void BLE_StatusNot( HCI_TL_CmdStatus_t status ) { |  | ||||||
|   switch (status) { |  | ||||||
|     case HCI_TL_CmdBusy: |  | ||||||
|       osMutexAcquire( MtxHciId, osWaitForever ); |  | ||||||
|       break; |  | ||||||
|     case HCI_TL_CmdAvailable: |  | ||||||
|       osMutexRelease( MtxHciId ); |  | ||||||
|       break; |  | ||||||
|     default: |  | ||||||
|       break; |  | ||||||
|   } |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| void SVCCTL_ResumeUserEventFlow( void ) { |  | ||||||
|   hci_resume_flow(); |  | ||||||
| } |  | ||||||
| @ -427,9 +427,6 @@ typedef enum | |||||||
| #define DBG_TRACE_MSG_QUEUE_SIZE 4096 | #define DBG_TRACE_MSG_QUEUE_SIZE 4096 | ||||||
| #define MAX_DBG_TRACE_MSG_SIZE 1024 | #define MAX_DBG_TRACE_MSG_SIZE 1024 | ||||||
| 
 | 
 | ||||||
| #define CFG_LED_SUPPORTED         0 |  | ||||||
| #define CFG_BUTTON_SUPPORTED      0 |  | ||||||
| 
 |  | ||||||
| /******************************************************************************
 | /******************************************************************************
 | ||||||
|  * FreeRTOS |  * FreeRTOS | ||||||
|  ******************************************************************************/ |  ******************************************************************************/ | ||||||
| @ -441,34 +438,5 @@ typedef enum | |||||||
| #define CFG_SHCI_USER_EVT_PROCESS_PRIORITY    osPriorityNone | #define CFG_SHCI_USER_EVT_PROCESS_PRIORITY    osPriorityNone | ||||||
| #define CFG_SHCI_USER_EVT_PROCESS_STACK_SIZE  (128 * 7) | #define CFG_SHCI_USER_EVT_PROCESS_STACK_SIZE  (128 * 7) | ||||||
| 
 | 
 | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_NAME         "ble_hci_evt" |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_ATTR_BITS    (0) |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_CB_MEM       (0) |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_CB_SIZE      (0) |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_STACK_MEM    (0) |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_PRIORITY     osPriorityNone |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_STACK_SIZE   (128 * 8) |  | ||||||
| 
 |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_NAME           "ble_adv_upd" |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_ATTR_BITS      (0) |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_CB_MEM         (0) |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_CB_SIZE        (0) |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_STACK_MEM      (0) |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_PRIORITY       osPriorityNone |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_STACK_SIZE     (128 * 6) |  | ||||||
| 
 |  | ||||||
| #define CFG_HRS_PROCESS_NAME                  "hrs" |  | ||||||
| #define CFG_HRS_PROCESS_ATTR_BITS             (0) |  | ||||||
| #define CFG_HRS_PROCESS_CB_MEM                (0) |  | ||||||
| #define CFG_HRS_PROCESS_CB_SIZE               (0) |  | ||||||
| #define CFG_HRS_PROCESS_STACK_MEM             (0) |  | ||||||
| #define CFG_HRS_PROCESS_PRIORITY              osPriorityNone |  | ||||||
| #define CFG_HRS_PROCESS_STACK_SIZE            (128 * 8) |  | ||||||
| 
 |  | ||||||
| typedef enum { |  | ||||||
|     CFG_LPM_APP, |  | ||||||
|     CFG_LPM_APP_BLE, |  | ||||||
| } CFG_LPM_Id_t; |  | ||||||
| 
 |  | ||||||
| #define CFG_OTP_BASE_ADDRESS    OTP_AREA_BASE | #define CFG_OTP_BASE_ADDRESS    OTP_AREA_BASE | ||||||
| #define CFG_OTP_END_ADRESS      OTP_AREA_END_ADDR | #define CFG_OTP_END_ADRESS      OTP_AREA_END_ADDR | ||||||
|  | |||||||
| @ -1,7 +1,7 @@ | |||||||
| #include "app_common.h" | #include "app_common.h" | ||||||
| #include "main.h" | #include "main.h" | ||||||
| #include "app_entry.h" | #include "app_entry.h" | ||||||
| #include "app_ble.h" | #include "ble_app.h" | ||||||
| #include "ble.h" | #include "ble.h" | ||||||
| #include "tl.h" | #include "tl.h" | ||||||
| #include "cmsis_os.h" | #include "cmsis_os.h" | ||||||
| @ -47,8 +47,6 @@ void APPE_Init() { | |||||||
|   ble_glue_status = BleGlueStatusStartup; |   ble_glue_status = BleGlueStatusStartup; | ||||||
|   SystemPower_Config(); /**< Configure the system Power Mode */ |   SystemPower_Config(); /**< Configure the system Power Mode */ | ||||||
| 
 | 
 | ||||||
|   HW_TS_Init(hw_ts_InitMode_Full, &hrtc); /**< Initialize the TimerServer */ |  | ||||||
| 
 |  | ||||||
|   // APPD_Init();
 |   // APPD_Init();
 | ||||||
|   furi_hal_power_insomnia_enter(); |   furi_hal_power_insomnia_enter(); | ||||||
| 
 | 
 | ||||||
| @ -137,7 +135,7 @@ static void APPE_SysUserEvtRx( void * pPayload ) { | |||||||
|   /* Traces channel initialization */ |   /* Traces channel initialization */ | ||||||
|   // APPD_EnableCPU2( );
 |   // APPD_EnableCPU2( );
 | ||||||
|    |    | ||||||
|   if (APP_BLE_Init()) { |   if(ble_app_init()) { | ||||||
|     FURI_LOG_I("Core2", "BLE stack started"); |     FURI_LOG_I("Core2", "BLE stack started"); | ||||||
|     ble_glue_status = BleGlueStatusStarted; |     ble_glue_status = BleGlueStatusStarted; | ||||||
|   } else { |   } else { | ||||||
|  | |||||||
| @ -31,7 +31,7 @@ void battery_svc_start() { | |||||||
|                                 (Char_UUID_t *) &char_battery_level_uuid, |                                 (Char_UUID_t *) &char_battery_level_uuid, | ||||||
|                                 1, |                                 1, | ||||||
|                                 CHAR_PROP_READ | CHAR_PROP_NOTIFY, |                                 CHAR_PROP_READ | CHAR_PROP_NOTIFY, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
|  | |||||||
							
								
								
									
										119
									
								
								firmware/targets/f6/ble-glue/ble_app.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										119
									
								
								firmware/targets/f6/ble-glue/ble_app.c
									
									
									
									
									
										Normal file
									
								
							| @ -0,0 +1,119 @@ | |||||||
|  | #include "ble_app.h" | ||||||
|  | 
 | ||||||
|  | #include "hci_tl.h" | ||||||
|  | #include "ble.h" | ||||||
|  | #include "shci.h" | ||||||
|  | #include "cmsis_os.h" | ||||||
|  | #include "gap.h" | ||||||
|  | 
 | ||||||
|  | #include <furi-hal.h> | ||||||
|  | 
 | ||||||
|  | #define BLE_APP_TAG "ble app" | ||||||
|  | 
 | ||||||
|  | PLACE_IN_SECTION("MB_MEM1") ALIGN(4) static TL_CmdPacket_t ble_app_cmd_buffer; | ||||||
|  | 
 | ||||||
|  | typedef struct { | ||||||
|  |     osMutexId_t hci_mtx; | ||||||
|  |     osSemaphoreId_t hci_sem; | ||||||
|  |     osThreadId_t hci_thread_id; | ||||||
|  |     osThreadAttr_t hci_thread_attr; | ||||||
|  | } BleApp; | ||||||
|  | 
 | ||||||
|  | static BleApp* ble_app; | ||||||
|  | 
 | ||||||
|  | static void ble_app_hci_thread(void *arg); | ||||||
|  | static void ble_app_hci_event_handler(void * pPayload); | ||||||
|  | static void ble_app_hci_status_not_handler(HCI_TL_CmdStatus_t status); | ||||||
|  | 
 | ||||||
|  | bool ble_app_init() { | ||||||
|  |     ble_app = furi_alloc(sizeof(BleApp)); | ||||||
|  | 
 | ||||||
|  |     // Allocate semafore and mutex for ble command buffer access
 | ||||||
|  |     ble_app->hci_mtx = osMutexNew(NULL); | ||||||
|  |     ble_app->hci_sem = osSemaphoreNew(1, 0, NULL); | ||||||
|  |     // HCI transport layer thread to handle user asynch events
 | ||||||
|  |     ble_app->hci_thread_attr.name = "ble hci"; | ||||||
|  |     ble_app->hci_thread_attr.stack_size = 1024; | ||||||
|  |     ble_app->hci_thread_id = osThreadNew(ble_app_hci_thread, NULL, &ble_app->hci_thread_attr); | ||||||
|  | 
 | ||||||
|  |     // Initialize Ble Transport Layer
 | ||||||
|  |     HCI_TL_HciInitConf_t hci_tl_config = { | ||||||
|  |         .p_cmdbuffer = (uint8_t*)&ble_app_cmd_buffer, | ||||||
|  |         .StatusNotCallBack = ble_app_hci_status_not_handler, | ||||||
|  |     }; | ||||||
|  |     hci_init(ble_app_hci_event_handler, (void*)&hci_tl_config); | ||||||
|  | 
 | ||||||
|  |     // Start ble stack on 2nd core
 | ||||||
|  |     SHCI_C2_Ble_Init_Cmd_Packet_t ble_init_cmd_packet = { | ||||||
|  |         .Header = {{0,0,0}}, // Header unused
 | ||||||
|  |         .Param = { | ||||||
|  |             0, // pBleBufferAddress not used
 | ||||||
|  |             0, // BleBufferSize not used
 | ||||||
|  |             CFG_BLE_NUM_GATT_ATTRIBUTES, | ||||||
|  |             CFG_BLE_NUM_GATT_SERVICES, | ||||||
|  |             CFG_BLE_ATT_VALUE_ARRAY_SIZE, | ||||||
|  |             CFG_BLE_NUM_LINK, | ||||||
|  |             CFG_BLE_DATA_LENGTH_EXTENSION, | ||||||
|  |             CFG_BLE_PREPARE_WRITE_LIST_SIZE, | ||||||
|  |             CFG_BLE_MBLOCK_COUNT, | ||||||
|  |             CFG_BLE_MAX_ATT_MTU, | ||||||
|  |             CFG_BLE_SLAVE_SCA, | ||||||
|  |             CFG_BLE_MASTER_SCA, | ||||||
|  |             CFG_BLE_LSE_SOURCE, | ||||||
|  |             CFG_BLE_MAX_CONN_EVENT_LENGTH, | ||||||
|  |             CFG_BLE_HSE_STARTUP_TIME, | ||||||
|  |             CFG_BLE_VITERBI_MODE, | ||||||
|  |             CFG_BLE_LL_ONLY, | ||||||
|  |             0, | ||||||
|  |         } | ||||||
|  |     }; | ||||||
|  |     SHCI_CmdStatus_t status = SHCI_C2_BLE_Init(&ble_init_cmd_packet); | ||||||
|  |     if(status) { | ||||||
|  |         FURI_LOG_E(BLE_APP_TAG, "Failed to start ble stack: %d", status); | ||||||
|  |     } | ||||||
|  |     return status == SHCI_Success; | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | static void ble_app_hci_thread(void *arg) { | ||||||
|  |     while(1) { | ||||||
|  |         osThreadFlagsWait(1, osFlagsWaitAny, osWaitForever); | ||||||
|  |         hci_user_evt_proc(); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | // Called by WPAN lib
 | ||||||
|  | void hci_notify_asynch_evt(void* pdata) { | ||||||
|  |     osThreadFlagsSet(ble_app->hci_thread_id, 1); | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void hci_cmd_resp_release(uint32_t flag) { | ||||||
|  |     osSemaphoreRelease(ble_app->hci_sem); | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void hci_cmd_resp_wait(uint32_t timeout) { | ||||||
|  |     osSemaphoreAcquire(ble_app->hci_sem, osWaitForever); | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | static void ble_app_hci_event_handler( void * pPayload ) { | ||||||
|  |     SVCCTL_UserEvtFlowStatus_t svctl_return_status; | ||||||
|  |     tHCI_UserEvtRxParam *pParam = (tHCI_UserEvtRxParam *)pPayload; | ||||||
|  | 
 | ||||||
|  |     svctl_return_status = SVCCTL_UserEvtRx((void *)&(pParam->pckt->evtserial)); | ||||||
|  |     if (svctl_return_status != SVCCTL_UserEvtFlowDisable) { | ||||||
|  |         pParam->status = HCI_TL_UserEventFlow_Enable; | ||||||
|  |     } else { | ||||||
|  |         pParam->status = HCI_TL_UserEventFlow_Disable; | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | static void ble_app_hci_status_not_handler( HCI_TL_CmdStatus_t status ) { | ||||||
|  |     if(status == HCI_TL_CmdBusy) { | ||||||
|  |         osMutexAcquire(ble_app->hci_mtx, osWaitForever ); | ||||||
|  |     } else if(status == HCI_TL_CmdAvailable) { | ||||||
|  |         osMutexRelease(ble_app->hci_mtx); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void SVCCTL_ResumeUserEventFlow( void ) { | ||||||
|  |     hci_resume_flow(); | ||||||
|  | } | ||||||
| @ -5,9 +5,8 @@ extern "C" { | |||||||
| #endif | #endif | ||||||
| 
 | 
 | ||||||
| #include <stdbool.h> | #include <stdbool.h> | ||||||
| #include "hci_tl.h" |  | ||||||
| 
 | 
 | ||||||
| bool APP_BLE_Init(); | bool ble_app_init(); | ||||||
| 
 | 
 | ||||||
| #ifdef __cplusplus | #ifdef __cplusplus | ||||||
| } | } | ||||||
| @ -39,7 +39,7 @@ void dev_info_svc_start() { | |||||||
|                                 (Char_UUID_t*)&uuid, |                                 (Char_UUID_t*)&uuid, | ||||||
|                                 strlen(dev_info_man_name), |                                 strlen(dev_info_man_name), | ||||||
|                                 CHAR_PROP_READ, |                                 CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
| @ -53,7 +53,7 @@ void dev_info_svc_start() { | |||||||
|                                 (Char_UUID_t*)&uuid, |                                 (Char_UUID_t*)&uuid, | ||||||
|                                 strlen(dev_info_serial_num), |                                 strlen(dev_info_serial_num), | ||||||
|                                 CHAR_PROP_READ, |                                 CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
| @ -67,7 +67,7 @@ void dev_info_svc_start() { | |||||||
|                                 (Char_UUID_t*)&uuid, |                                 (Char_UUID_t*)&uuid, | ||||||
|                                 strlen(dev_info_firmware_rev_num), |                                 strlen(dev_info_firmware_rev_num), | ||||||
|                                 CHAR_PROP_READ, |                                 CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
| @ -81,7 +81,7 @@ void dev_info_svc_start() { | |||||||
|                                 (Char_UUID_t*)&uuid, |                                 (Char_UUID_t*)&uuid, | ||||||
|                                 strlen(dev_info_software_rev_num), |                                 strlen(dev_info_software_rev_num), | ||||||
|                                 CHAR_PROP_READ, |                                 CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
|  | |||||||
| @ -31,13 +31,22 @@ typedef struct { | |||||||
| typedef struct { | typedef struct { | ||||||
|   GapSvc gap_svc; |   GapSvc gap_svc; | ||||||
|   GapState state; |   GapState state; | ||||||
|  |   osMutexId_t state_mutex; | ||||||
|   uint8_t mac_address[BD_ADDR_SIZE_LOCAL]; |   uint8_t mac_address[BD_ADDR_SIZE_LOCAL]; | ||||||
|   Bt* bt; |   Bt* bt; | ||||||
|   osTimerId advertise_timer; |   osTimerId advertise_timer; | ||||||
|   osThreadAttr_t thread_attr; |   osThreadAttr_t thread_attr; | ||||||
|   osThreadId_t thread_id; |   osThreadId_t thread_id; | ||||||
|  |   osMessageQueueId_t command_queue; | ||||||
|  |   bool enable_adv; | ||||||
| } Gap; | } Gap; | ||||||
| 
 | 
 | ||||||
|  | typedef enum { | ||||||
|  |     GapCommandAdvFast, | ||||||
|  |     GapCommandAdvLowPower, | ||||||
|  |     GapCommandAdvStop, | ||||||
|  | } GapCommand; | ||||||
|  | 
 | ||||||
| // Identity root key
 | // Identity root key
 | ||||||
| static const uint8_t gap_irk[16] = {0x12,0x34,0x56,0x78,0x9a,0xbc,0xde,0xf0,0x12,0x34,0x56,0x78,0x9a,0xbc,0xde,0xf0}; | static const uint8_t gap_irk[16] = {0x12,0x34,0x56,0x78,0x9a,0xbc,0xde,0xf0,0x12,0x34,0x56,0x78,0x9a,0xbc,0xde,0xf0}; | ||||||
| // Encryption root key
 | // Encryption root key
 | ||||||
| @ -49,7 +58,7 @@ static const uint8_t gap_default_mac_addr[] = {0x6c, 0x7a, 0xd8, 0xac, 0x57, 0x7 | |||||||
| 
 | 
 | ||||||
| static Gap* gap = NULL; | static Gap* gap = NULL; | ||||||
| 
 | 
 | ||||||
| static void gap_advertise(GapState new_state); | static void gap_advertise_start(GapState new_state); | ||||||
| static void gap_app(void *arg); | static void gap_app(void *arg); | ||||||
| 
 | 
 | ||||||
| SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | ||||||
| @ -64,6 +73,7 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
| 
 | 
 | ||||||
|     event_pckt = (hci_event_pckt*) ((hci_uart_pckt *) pckt)->data; |     event_pckt = (hci_event_pckt*) ((hci_uart_pckt *) pckt)->data; | ||||||
| 
 | 
 | ||||||
|  |     osMutexAcquire(gap->state_mutex, osWaitForever); | ||||||
|     switch (event_pckt->evt) { |     switch (event_pckt->evt) { | ||||||
|         case EVT_DISCONN_COMPLETE: |         case EVT_DISCONN_COMPLETE: | ||||||
|         { |         { | ||||||
| @ -73,10 +83,12 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|                 gap->state = GapStateIdle; |                 gap->state = GapStateIdle; | ||||||
|                 FURI_LOG_I(GAP_TAG, "Disconnect from client"); |                 FURI_LOG_I(GAP_TAG, "Disconnect from client"); | ||||||
|             } |             } | ||||||
|  |             if(gap->enable_adv) { | ||||||
|                 // Restart advertising
 |                 // Restart advertising
 | ||||||
|         gap_advertise(GapStateAdvFast); |                 gap_start_advertising(); | ||||||
|                 furi_hal_power_insomnia_exit(); |                 furi_hal_power_insomnia_exit(); | ||||||
|             } |             } | ||||||
|  |         } | ||||||
|         break; |         break; | ||||||
| 
 | 
 | ||||||
|         case EVT_LE_META_EVENT: |         case EVT_LE_META_EVENT: | ||||||
| @ -97,7 +109,7 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|                 if(ret) { |                 if(ret) { | ||||||
|                     FURI_LOG_E(GAP_TAG, "Read PHY failed, status: %d", ret); |                     FURI_LOG_E(GAP_TAG, "Read PHY failed, status: %d", ret); | ||||||
|                 } else { |                 } else { | ||||||
|                 FURI_LOG_I(GAP_TAG, "PHY Params TX= %d, RX= %d ", tx_phy, rx_phy); |                     FURI_LOG_I(GAP_TAG, "PHY Params TX = %d, RX = %d ", tx_phy, rx_phy); | ||||||
|                 } |                 } | ||||||
|                 break; |                 break; | ||||||
| 
 | 
 | ||||||
| @ -172,8 +184,7 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|                 aci_gap_numeric_comparison_value_confirm_yesno(gap->gap_svc.connection_handle, 1); |                 aci_gap_numeric_comparison_value_confirm_yesno(gap->gap_svc.connection_handle, 1); | ||||||
|                 break; |                 break; | ||||||
| 
 | 
 | ||||||
|         case (EVT_BLUE_GAP_PAIRING_CMPLT): |             case EVT_BLUE_GAP_PAIRING_CMPLT: | ||||||
|         { |  | ||||||
|                 pairing_complete = (aci_gap_pairing_complete_event_rp0*)blue_evt->data; |                 pairing_complete = (aci_gap_pairing_complete_event_rp0*)blue_evt->data; | ||||||
|                 if (pairing_complete->Status) { |                 if (pairing_complete->Status) { | ||||||
|                     FURI_LOG_E(GAP_TAG, "Pairing failed with status: %d. Terminating connection", pairing_complete->Status); |                     FURI_LOG_E(GAP_TAG, "Pairing failed with status: %d. Terminating connection", pairing_complete->Status); | ||||||
| @ -181,7 +192,6 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|                 } else { |                 } else { | ||||||
|                     FURI_LOG_I(GAP_TAG, "Pairing complete"); |                     FURI_LOG_I(GAP_TAG, "Pairing complete"); | ||||||
|                 } |                 } | ||||||
|         } |  | ||||||
|                 break; |                 break; | ||||||
| 
 | 
 | ||||||
|             case EVT_BLUE_GAP_PROCEDURE_COMPLETE: |             case EVT_BLUE_GAP_PROCEDURE_COMPLETE: | ||||||
| @ -191,7 +201,7 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|             default: |             default: | ||||||
|                 break; |                 break; | ||||||
|     } |     } | ||||||
| 
 |     osMutexRelease(gap->state_mutex); | ||||||
|     return SVCCTL_UserEvtFlowEnable; |     return SVCCTL_UserEvtFlowEnable; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| @ -213,7 +223,7 @@ static void set_advertisment_service_uid(uint8_t* uid, uint8_t uid_len) { | |||||||
|     gap->gap_svc.adv_svc_uuid_len += uid_len; |     gap->gap_svc.adv_svc_uuid_len += uid_len; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| GapState gap_get_status() { | GapState gap_get_state() { | ||||||
|     return gap->state; |     return gap->state; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| @ -293,7 +303,7 @@ static void gap_init_svc(Gap* gap) { | |||||||
|     aci_gap_configure_whitelist(); |     aci_gap_configure_whitelist(); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| static void gap_advertise(GapState new_state) | static void gap_advertise_start(GapState new_state) | ||||||
| { | { | ||||||
|     tBleStatus status; |     tBleStatus status; | ||||||
|     uint16_t min_interval; |     uint16_t min_interval; | ||||||
| @ -317,7 +327,6 @@ static void gap_advertise(GapState new_state) | |||||||
|         } |         } | ||||||
|     } |     } | ||||||
|     // Configure advertising
 |     // Configure advertising
 | ||||||
|     gap->state = new_state; |  | ||||||
|     const char* name = furi_hal_version_get_ble_local_device_name_ptr(); |     const char* name = furi_hal_version_get_ble_local_device_name_ptr(); | ||||||
|     status = aci_gap_set_discoverable(ADV_IND, min_interval, max_interval, PUBLIC_ADDR, 0, |     status = aci_gap_set_discoverable(ADV_IND, min_interval, max_interval, PUBLIC_ADDR, 0, | ||||||
|                                         strlen(name), (uint8_t*)name, |                                         strlen(name), (uint8_t*)name, | ||||||
| @ -325,17 +334,40 @@ static void gap_advertise(GapState new_state) | |||||||
|     if(status) { |     if(status) { | ||||||
|         FURI_LOG_E(GAP_TAG, "Set discoverable err: %d", status); |         FURI_LOG_E(GAP_TAG, "Set discoverable err: %d", status); | ||||||
|     } |     } | ||||||
|  |     gap->state = new_state; | ||||||
|  |     bt_update_statusbar(gap->bt); | ||||||
|     osTimerStart(gap->advertise_timer, INITIAL_ADV_TIMEOUT); |     osTimerStart(gap->advertise_timer, INITIAL_ADV_TIMEOUT); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| static void gap_advertise_request(Gap* gap) { | static void gap_advertise_stop() { | ||||||
|     osThreadFlagsSet(gap->thread_id, 1); |     if(gap->state == GapStateConnected) { | ||||||
|  |         // Terminate connection
 | ||||||
|  |         aci_gap_terminate(gap->gap_svc.connection_handle, 0x13); | ||||||
|  |     } | ||||||
|  |     if(gap->state > GapStateIdle) { | ||||||
|  |         // Stop advertising
 | ||||||
|  |         osTimerStop(gap->advertise_timer); | ||||||
|  |         aci_gap_set_non_discoverable(); | ||||||
|  |         gap->state = GapStateIdle; | ||||||
|  |         bt_update_statusbar(gap->bt); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void gap_start_advertising() { | ||||||
|  |     gap->enable_adv = true; | ||||||
|  |     GapCommand command = GapCommandAdvFast; | ||||||
|  |     furi_check(osMessageQueuePut(gap->command_queue, &command, 0, 0) == osOK); | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void gap_stop_advertising() { | ||||||
|  |     gap->enable_adv = false; | ||||||
|  |     GapCommand command = GapCommandAdvStop; | ||||||
|  |     furi_check(osMessageQueuePut(gap->command_queue, &command, 0, 0) == osOK); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| static void gap_advetise_timer_callback(void* context) { | static void gap_advetise_timer_callback(void* context) { | ||||||
|     furi_assert(context); |     GapCommand command = GapCommandAdvLowPower; | ||||||
|     Gap* gap = context; |     furi_check(osMessageQueuePut(gap->command_queue, &command, 0, 0) == osOK); | ||||||
|     gap_advertise_request(gap); |  | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| bool gap_init() { | bool gap_init() { | ||||||
| @ -348,20 +380,25 @@ bool gap_init() { | |||||||
|     // Open Bt record
 |     // Open Bt record
 | ||||||
|     gap->bt = furi_record_open("bt"); |     gap->bt = furi_record_open("bt"); | ||||||
|     // Create advertising timer
 |     // Create advertising timer
 | ||||||
|     gap->advertise_timer = osTimerNew(gap_advetise_timer_callback, osTimerOnce, &gap, NULL); |     gap->advertise_timer = osTimerNew(gap_advetise_timer_callback, osTimerOnce, NULL, NULL); | ||||||
|     // Initialization of HCI & GATT & GAP layer
 |     // Initialization of GATT & GAP layer
 | ||||||
|     gap_init_svc(gap); |     gap_init_svc(gap); | ||||||
|     // Initialization of the BLE Services
 |     // Initialization of the BLE Services
 | ||||||
|     SVCCTL_Init(); |     SVCCTL_Init(); | ||||||
|     // Initialization of the BLE App Context
 |     // Initialization of the GAP state
 | ||||||
|  |     gap->state_mutex = osMutexNew(NULL); | ||||||
|     gap->state = GapStateIdle; |     gap->state = GapStateIdle; | ||||||
|     gap->gap_svc.connection_handle = 0xFFFF; |     gap->gap_svc.connection_handle = 0xFFFF; | ||||||
|  |     gap->enable_adv = true; | ||||||
| 
 | 
 | ||||||
|     // Thread configuration
 |     // Thread configuration
 | ||||||
|     gap->thread_attr.name = "BLE advertising"; |     gap->thread_attr.name = "BLE advertising"; | ||||||
|     gap->thread_attr.stack_size = 512; |     gap->thread_attr.stack_size = 1024; | ||||||
|     gap->thread_id = osThreadNew(gap_app, NULL, &gap->thread_attr); |     gap->thread_id = osThreadNew(gap_app, NULL, &gap->thread_attr); | ||||||
| 
 | 
 | ||||||
|  |     // Command queue allocation
 | ||||||
|  |     gap->command_queue = osMessageQueueNew(8, sizeof(GapCommand), NULL); | ||||||
|  | 
 | ||||||
|     // Start Device Information service
 |     // Start Device Information service
 | ||||||
|     dev_info_svc_start(); |     dev_info_svc_start(); | ||||||
|     // Start Battery service
 |     // Start Battery service
 | ||||||
| @ -374,14 +411,21 @@ bool gap_init() { | |||||||
|     adv_service_uid[1] = 0x30; |     adv_service_uid[1] = 0x30; | ||||||
| 
 | 
 | ||||||
|     set_advertisment_service_uid(adv_service_uid, sizeof(adv_service_uid)); |     set_advertisment_service_uid(adv_service_uid, sizeof(adv_service_uid)); | ||||||
|     gap_advertise(GapStateAdvFast); |  | ||||||
|     return true; |     return true; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| static void gap_app(void *arg) { | static void gap_app(void *arg) { | ||||||
|     // TODO Exit from app, stop service, clean memory
 |     GapCommand command; | ||||||
|     while(1) { |     while(1) { | ||||||
|         osThreadFlagsWait(1, osFlagsWaitAny, osWaitForever); |         furi_check(osMessageQueueGet(gap->command_queue, &command, NULL, osWaitForever) == osOK); | ||||||
|         gap_advertise(GapStateAdvLowPower); |         osMutexAcquire(gap->state_mutex, osWaitForever); | ||||||
|  |         if(command == GapCommandAdvFast) { | ||||||
|  |             gap_advertise_start(GapStateAdvFast); | ||||||
|  |         } else if(command == GapCommandAdvLowPower) { | ||||||
|  |             gap_advertise_start(GapStateAdvLowPower); | ||||||
|  |         } else if(command == GapCommandAdvStop) { | ||||||
|  |             gap_advertise_stop(); | ||||||
|  |         } | ||||||
|  |         osMutexRelease(gap->state_mutex); | ||||||
|     } |     } | ||||||
| } | } | ||||||
|  | |||||||
| @ -15,7 +15,11 @@ typedef enum { | |||||||
| 
 | 
 | ||||||
| bool gap_init(); | bool gap_init(); | ||||||
| 
 | 
 | ||||||
| GapState gap_get_status(); | void gap_start_advertising(); | ||||||
|  | 
 | ||||||
|  | void gap_stop_advertising(); | ||||||
|  | 
 | ||||||
|  | GapState gap_get_state(); | ||||||
| 
 | 
 | ||||||
| #ifdef __cplusplus | #ifdef __cplusplus | ||||||
| } | } | ||||||
|  | |||||||
| @ -61,7 +61,7 @@ void serial_svc_start() { | |||||||
|     status = aci_gatt_add_char(serial_svc->svc_handle, UUID_TYPE_128, (const Char_UUID_t*)char_tx_uuid, |     status = aci_gatt_add_char(serial_svc->svc_handle, UUID_TYPE_128, (const Char_UUID_t*)char_tx_uuid, | ||||||
|                                 SERIAL_SVC_DATA_LEN_MAX, |                                 SERIAL_SVC_DATA_LEN_MAX, | ||||||
|                                 CHAR_PROP_WRITE_WITHOUT_RESP | CHAR_PROP_WRITE | CHAR_PROP_READ, |                                 CHAR_PROP_WRITE_WITHOUT_RESP | CHAR_PROP_WRITE | CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ | ATTR_PERMISSION_AUTHEN_WRITE, | ||||||
|                                 GATT_NOTIFY_ATTRIBUTE_WRITE, |                                 GATT_NOTIFY_ATTRIBUTE_WRITE, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_VARIABLE, |                                 CHAR_VALUE_LEN_VARIABLE, | ||||||
| @ -74,7 +74,7 @@ void serial_svc_start() { | |||||||
|     status = aci_gatt_add_char(serial_svc->svc_handle, UUID_TYPE_128, (const Char_UUID_t*)char_rx_uuid, |     status = aci_gatt_add_char(serial_svc->svc_handle, UUID_TYPE_128, (const Char_UUID_t*)char_rx_uuid, | ||||||
|                                 SERIAL_SVC_DATA_LEN_MAX,                                   |                                 SERIAL_SVC_DATA_LEN_MAX,                                   | ||||||
|                                 CHAR_PROP_READ | CHAR_PROP_INDICATE, |                                 CHAR_PROP_READ | CHAR_PROP_INDICATE, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_VARIABLE, |                                 CHAR_VALUE_LEN_VARIABLE, | ||||||
| @ -108,7 +108,9 @@ void serial_svc_stop() { | |||||||
| 
 | 
 | ||||||
| 
 | 
 | ||||||
| bool serial_svc_update_rx(uint8_t* data, uint8_t data_len) { | bool serial_svc_update_rx(uint8_t* data, uint8_t data_len) { | ||||||
|     furi_assert(data_len < SERIAL_SVC_DATA_LEN_MAX); |     if(data_len > SERIAL_SVC_DATA_LEN_MAX) { | ||||||
|  |         return false; | ||||||
|  |     } | ||||||
| 
 | 
 | ||||||
|     tBleStatus result = aci_gatt_update_char_value(serial_svc->svc_handle, |     tBleStatus result = aci_gatt_update_char_value(serial_svc->svc_handle, | ||||||
|                                         serial_svc->rx_char_handle, |                                         serial_svc->rx_char_handle, | ||||||
|  | |||||||
| @ -4,7 +4,6 @@ | |||||||
| #include <stm32wbxx.h> | #include <stm32wbxx.h> | ||||||
| #include <shci.h> | #include <shci.h> | ||||||
| #include <cmsis_os2.h> | #include <cmsis_os2.h> | ||||||
| #include <app_ble.h> |  | ||||||
| #include <gap.h> | #include <gap.h> | ||||||
| 
 | 
 | ||||||
| void furi_hal_bt_init() { | void furi_hal_bt_init() { | ||||||
| @ -14,10 +13,22 @@ void furi_hal_bt_init() { | |||||||
|     APPE_Init(); |     APPE_Init(); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| bool furi_hal_bt_start_app() { | bool furi_hal_bt_init_app() { | ||||||
|     return gap_init(); |     return gap_init(); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
|  | void furi_hal_bt_start_advertising() { | ||||||
|  |     if(gap_get_state() == GapStateIdle) { | ||||||
|  |         gap_start_advertising(); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void furi_hal_bt_stop_advertising() { | ||||||
|  |     if(furi_hal_bt_is_alive()) { | ||||||
|  |         gap_stop_advertising(); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
| void furi_hal_bt_dump_state(string_t buffer) { | void furi_hal_bt_dump_state(string_t buffer) { | ||||||
|     BleGlueStatus status = APPE_Status(); |     BleGlueStatus status = APPE_Status(); | ||||||
|     if (status == BleGlueStatusStarted) { |     if (status == BleGlueStatusStarted) { | ||||||
| @ -41,7 +52,7 @@ void furi_hal_bt_dump_state(string_t buffer) { | |||||||
| } | } | ||||||
| 
 | 
 | ||||||
| bool furi_hal_bt_is_alive() { | bool furi_hal_bt_is_alive() { | ||||||
|     return APPE_Status() == BleGlueStatusStarted; |     return gap_get_state() > GapStateIdle; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| bool furi_hal_bt_wait_startup() { | bool furi_hal_bt_wait_startup() { | ||||||
|  | |||||||
| @ -1,140 +0,0 @@ | |||||||
| #include "main.h" |  | ||||||
| 
 |  | ||||||
| #include "app_entry.h" |  | ||||||
| #include "app_common.h" |  | ||||||
| #include "dbg_trace.h" |  | ||||||
| #include "ble.h" |  | ||||||
| #include "tl.h" |  | ||||||
| #include "app_ble.h" |  | ||||||
| #include "shci.h" |  | ||||||
| #include "cmsis_os.h" |  | ||||||
| 
 |  | ||||||
| #include <furi-hal.h> |  | ||||||
| 
 |  | ||||||
| PLACE_IN_SECTION("MB_MEM1") ALIGN(4) static TL_CmdPacket_t BleCmdBuffer; |  | ||||||
| 
 |  | ||||||
| // PLACE_IN_SECTION("TAG_OTA_END") const uint32_t MagicKeywordValue = 0x94448A29 ;
 |  | ||||||
| // PLACE_IN_SECTION("TAG_OTA_START") const uint32_t MagicKeywordAddress = (uint32_t)&MagicKeywordValue;
 |  | ||||||
| 
 |  | ||||||
| osMutexId_t MtxHciId; |  | ||||||
| osSemaphoreId_t SemHciId; |  | ||||||
| osThreadId_t HciUserEvtProcessId; |  | ||||||
| 
 |  | ||||||
| const osThreadAttr_t HciUserEvtProcess_attr = { |  | ||||||
|     .name = CFG_HCI_USER_EVT_PROCESS_NAME, |  | ||||||
|     .attr_bits = CFG_HCI_USER_EVT_PROCESS_ATTR_BITS, |  | ||||||
|     .cb_mem = CFG_HCI_USER_EVT_PROCESS_CB_MEM, |  | ||||||
|     .cb_size = CFG_HCI_USER_EVT_PROCESS_CB_SIZE, |  | ||||||
|     .stack_mem = CFG_HCI_USER_EVT_PROCESS_STACK_MEM, |  | ||||||
|     .priority = CFG_HCI_USER_EVT_PROCESS_PRIORITY, |  | ||||||
|     .stack_size = CFG_HCI_USER_EVT_PROCESS_STACK_SIZE |  | ||||||
| }; |  | ||||||
| 
 |  | ||||||
| /* Private function prototypes -----------------------------------------------*/ |  | ||||||
| static void HciUserEvtProcess(void *argument); |  | ||||||
| static void BLE_UserEvtRx( void * pPayload ); |  | ||||||
| static void BLE_StatusNot( HCI_TL_CmdStatus_t status ); |  | ||||||
| static void Ble_Tl_Init( void ); |  | ||||||
| 
 |  | ||||||
| bool APP_BLE_Init() { |  | ||||||
|   SHCI_C2_Ble_Init_Cmd_Packet_t ble_init_cmd_packet = { |  | ||||||
|     {{0,0,0}},                  /**< Header unused */ |  | ||||||
|     {0,                         /** pBleBufferAddress not used */ |  | ||||||
|     0,                          /** BleBufferSize not used */ |  | ||||||
|     CFG_BLE_NUM_GATT_ATTRIBUTES, |  | ||||||
|     CFG_BLE_NUM_GATT_SERVICES, |  | ||||||
|     CFG_BLE_ATT_VALUE_ARRAY_SIZE, |  | ||||||
|     CFG_BLE_NUM_LINK, |  | ||||||
|     CFG_BLE_DATA_LENGTH_EXTENSION, |  | ||||||
|     CFG_BLE_PREPARE_WRITE_LIST_SIZE, |  | ||||||
|     CFG_BLE_MBLOCK_COUNT, |  | ||||||
|     CFG_BLE_MAX_ATT_MTU, |  | ||||||
|     CFG_BLE_SLAVE_SCA, |  | ||||||
|     CFG_BLE_MASTER_SCA, |  | ||||||
|     CFG_BLE_LSE_SOURCE, |  | ||||||
|     CFG_BLE_MAX_CONN_EVENT_LENGTH, |  | ||||||
|     CFG_BLE_HSE_STARTUP_TIME, |  | ||||||
|     CFG_BLE_VITERBI_MODE, |  | ||||||
|     CFG_BLE_LL_ONLY, |  | ||||||
|     0} |  | ||||||
|   }; |  | ||||||
| 
 |  | ||||||
|   // Initialize Ble Transport Layer
 |  | ||||||
|   Ble_Tl_Init( ); |  | ||||||
|   // Register the hci transport layer to handle BLE User Asynchronous Events
 |  | ||||||
|   HciUserEvtProcessId = osThreadNew(HciUserEvtProcess, NULL, &HciUserEvtProcess_attr); |  | ||||||
|   // Starts the BLE Stack on CPU2
 |  | ||||||
|   return (SHCI_C2_BLE_Init( &ble_init_cmd_packet ) == SHCI_Success); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| static void Ble_Tl_Init( void ) { |  | ||||||
|   HCI_TL_HciInitConf_t Hci_Tl_Init_Conf; |  | ||||||
| 
 |  | ||||||
|   MtxHciId = osMutexNew( NULL ); |  | ||||||
|   SemHciId = osSemaphoreNew( 1, 0, NULL ); /*< Create the semaphore and make it busy at initialization */ |  | ||||||
| 
 |  | ||||||
|   Hci_Tl_Init_Conf.p_cmdbuffer = (uint8_t*)&BleCmdBuffer; |  | ||||||
|   Hci_Tl_Init_Conf.StatusNotCallBack = BLE_StatusNot; |  | ||||||
|   hci_init(BLE_UserEvtRx, (void*) &Hci_Tl_Init_Conf); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| static void HciUserEvtProcess(void *argument) { |  | ||||||
|   UNUSED(argument); |  | ||||||
| 
 |  | ||||||
|   for(;;) |  | ||||||
|   { |  | ||||||
|     osThreadFlagsWait( 1, osFlagsWaitAny, osWaitForever); |  | ||||||
|     hci_user_evt_proc( ); |  | ||||||
|   } |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| /*************************************************************
 |  | ||||||
|  * |  | ||||||
|  * WRAP FUNCTIONS |  | ||||||
|  * |  | ||||||
|  *************************************************************/ |  | ||||||
| void hci_notify_asynch_evt(void* pdata) { |  | ||||||
|   UNUSED(pdata); |  | ||||||
|   osThreadFlagsSet( HciUserEvtProcessId, 1 ); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| void hci_cmd_resp_release(uint32_t flag) { |  | ||||||
|   UNUSED(flag); |  | ||||||
|   osSemaphoreRelease( SemHciId ); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| void hci_cmd_resp_wait(uint32_t timeout) { |  | ||||||
|   UNUSED(timeout); |  | ||||||
|   osSemaphoreAcquire( SemHciId, osWaitForever ); |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| static void BLE_UserEvtRx( void * pPayload ) { |  | ||||||
|   SVCCTL_UserEvtFlowStatus_t svctl_return_status; |  | ||||||
|   tHCI_UserEvtRxParam *pParam; |  | ||||||
| 
 |  | ||||||
|   pParam = (tHCI_UserEvtRxParam *)pPayload; |  | ||||||
| 
 |  | ||||||
|   svctl_return_status = SVCCTL_UserEvtRx((void *)&(pParam->pckt->evtserial)); |  | ||||||
|   if (svctl_return_status != SVCCTL_UserEvtFlowDisable) { |  | ||||||
|     pParam->status = HCI_TL_UserEventFlow_Enable; |  | ||||||
|   } else { |  | ||||||
|     pParam->status = HCI_TL_UserEventFlow_Disable; |  | ||||||
|   } |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| static void BLE_StatusNot( HCI_TL_CmdStatus_t status ) { |  | ||||||
|   switch (status) { |  | ||||||
|     case HCI_TL_CmdBusy: |  | ||||||
|       osMutexAcquire( MtxHciId, osWaitForever ); |  | ||||||
|       break; |  | ||||||
|     case HCI_TL_CmdAvailable: |  | ||||||
|       osMutexRelease( MtxHciId ); |  | ||||||
|       break; |  | ||||||
|     default: |  | ||||||
|       break; |  | ||||||
|   } |  | ||||||
| } |  | ||||||
| 
 |  | ||||||
| void SVCCTL_ResumeUserEventFlow( void ) { |  | ||||||
|   hci_resume_flow(); |  | ||||||
| } |  | ||||||
| @ -427,9 +427,6 @@ typedef enum | |||||||
| #define DBG_TRACE_MSG_QUEUE_SIZE 4096 | #define DBG_TRACE_MSG_QUEUE_SIZE 4096 | ||||||
| #define MAX_DBG_TRACE_MSG_SIZE 1024 | #define MAX_DBG_TRACE_MSG_SIZE 1024 | ||||||
| 
 | 
 | ||||||
| #define CFG_LED_SUPPORTED         0 |  | ||||||
| #define CFG_BUTTON_SUPPORTED      0 |  | ||||||
| 
 |  | ||||||
| /******************************************************************************
 | /******************************************************************************
 | ||||||
|  * FreeRTOS |  * FreeRTOS | ||||||
|  ******************************************************************************/ |  ******************************************************************************/ | ||||||
| @ -441,34 +438,5 @@ typedef enum | |||||||
| #define CFG_SHCI_USER_EVT_PROCESS_PRIORITY    osPriorityNone | #define CFG_SHCI_USER_EVT_PROCESS_PRIORITY    osPriorityNone | ||||||
| #define CFG_SHCI_USER_EVT_PROCESS_STACK_SIZE  (128 * 7) | #define CFG_SHCI_USER_EVT_PROCESS_STACK_SIZE  (128 * 7) | ||||||
| 
 | 
 | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_NAME         "ble_hci_evt" |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_ATTR_BITS    (0) |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_CB_MEM       (0) |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_CB_SIZE      (0) |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_STACK_MEM    (0) |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_PRIORITY     osPriorityNone |  | ||||||
| #define CFG_HCI_USER_EVT_PROCESS_STACK_SIZE   (128 * 8) |  | ||||||
| 
 |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_NAME           "ble_adv_upd" |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_ATTR_BITS      (0) |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_CB_MEM         (0) |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_CB_SIZE        (0) |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_STACK_MEM      (0) |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_PRIORITY       osPriorityNone |  | ||||||
| #define CFG_ADV_UPDATE_PROCESS_STACK_SIZE     (128 * 6) |  | ||||||
| 
 |  | ||||||
| #define CFG_HRS_PROCESS_NAME                  "hrs" |  | ||||||
| #define CFG_HRS_PROCESS_ATTR_BITS             (0) |  | ||||||
| #define CFG_HRS_PROCESS_CB_MEM                (0) |  | ||||||
| #define CFG_HRS_PROCESS_CB_SIZE               (0) |  | ||||||
| #define CFG_HRS_PROCESS_STACK_MEM             (0) |  | ||||||
| #define CFG_HRS_PROCESS_PRIORITY              osPriorityNone |  | ||||||
| #define CFG_HRS_PROCESS_STACK_SIZE            (128 * 8) |  | ||||||
| 
 |  | ||||||
| typedef enum { |  | ||||||
|     CFG_LPM_APP, |  | ||||||
|     CFG_LPM_APP_BLE, |  | ||||||
| } CFG_LPM_Id_t; |  | ||||||
| 
 |  | ||||||
| #define CFG_OTP_BASE_ADDRESS    OTP_AREA_BASE | #define CFG_OTP_BASE_ADDRESS    OTP_AREA_BASE | ||||||
| #define CFG_OTP_END_ADRESS      OTP_AREA_END_ADDR | #define CFG_OTP_END_ADRESS      OTP_AREA_END_ADDR | ||||||
|  | |||||||
| @ -1,7 +1,7 @@ | |||||||
| #include "app_common.h" | #include "app_common.h" | ||||||
| #include "main.h" | #include "main.h" | ||||||
| #include "app_entry.h" | #include "app_entry.h" | ||||||
| #include "app_ble.h" | #include "ble_app.h" | ||||||
| #include "ble.h" | #include "ble.h" | ||||||
| #include "tl.h" | #include "tl.h" | ||||||
| #include "cmsis_os.h" | #include "cmsis_os.h" | ||||||
| @ -47,8 +47,6 @@ void APPE_Init() { | |||||||
|   ble_glue_status = BleGlueStatusStartup; |   ble_glue_status = BleGlueStatusStartup; | ||||||
|   SystemPower_Config(); /**< Configure the system Power Mode */ |   SystemPower_Config(); /**< Configure the system Power Mode */ | ||||||
| 
 | 
 | ||||||
|   HW_TS_Init(hw_ts_InitMode_Full, &hrtc); /**< Initialize the TimerServer */ |  | ||||||
| 
 |  | ||||||
|   // APPD_Init();
 |   // APPD_Init();
 | ||||||
|   furi_hal_power_insomnia_enter(); |   furi_hal_power_insomnia_enter(); | ||||||
| 
 | 
 | ||||||
| @ -137,7 +135,7 @@ static void APPE_SysUserEvtRx( void * pPayload ) { | |||||||
|   /* Traces channel initialization */ |   /* Traces channel initialization */ | ||||||
|   // APPD_EnableCPU2( );
 |   // APPD_EnableCPU2( );
 | ||||||
|    |    | ||||||
|   if (APP_BLE_Init()) { |   if(ble_app_init()) { | ||||||
|     FURI_LOG_I("Core2", "BLE stack started"); |     FURI_LOG_I("Core2", "BLE stack started"); | ||||||
|     ble_glue_status = BleGlueStatusStarted; |     ble_glue_status = BleGlueStatusStarted; | ||||||
|   } else { |   } else { | ||||||
|  | |||||||
| @ -31,7 +31,7 @@ void battery_svc_start() { | |||||||
|                                 (Char_UUID_t *) &char_battery_level_uuid, |                                 (Char_UUID_t *) &char_battery_level_uuid, | ||||||
|                                 1, |                                 1, | ||||||
|                                 CHAR_PROP_READ | CHAR_PROP_NOTIFY, |                                 CHAR_PROP_READ | CHAR_PROP_NOTIFY, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
|  | |||||||
							
								
								
									
										119
									
								
								firmware/targets/f7/ble-glue/ble_app.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										119
									
								
								firmware/targets/f7/ble-glue/ble_app.c
									
									
									
									
									
										Normal file
									
								
							| @ -0,0 +1,119 @@ | |||||||
|  | #include "ble_app.h" | ||||||
|  | 
 | ||||||
|  | #include "hci_tl.h" | ||||||
|  | #include "ble.h" | ||||||
|  | #include "shci.h" | ||||||
|  | #include "cmsis_os.h" | ||||||
|  | #include "gap.h" | ||||||
|  | 
 | ||||||
|  | #include <furi-hal.h> | ||||||
|  | 
 | ||||||
|  | #define BLE_APP_TAG "ble app" | ||||||
|  | 
 | ||||||
|  | PLACE_IN_SECTION("MB_MEM1") ALIGN(4) static TL_CmdPacket_t ble_app_cmd_buffer; | ||||||
|  | 
 | ||||||
|  | typedef struct { | ||||||
|  |     osMutexId_t hci_mtx; | ||||||
|  |     osSemaphoreId_t hci_sem; | ||||||
|  |     osThreadId_t hci_thread_id; | ||||||
|  |     osThreadAttr_t hci_thread_attr; | ||||||
|  | } BleApp; | ||||||
|  | 
 | ||||||
|  | static BleApp* ble_app; | ||||||
|  | 
 | ||||||
|  | static void ble_app_hci_thread(void *arg); | ||||||
|  | static void ble_app_hci_event_handler(void * pPayload); | ||||||
|  | static void ble_app_hci_status_not_handler(HCI_TL_CmdStatus_t status); | ||||||
|  | 
 | ||||||
|  | bool ble_app_init() { | ||||||
|  |     ble_app = furi_alloc(sizeof(BleApp)); | ||||||
|  | 
 | ||||||
|  |     // Allocate semafore and mutex for ble command buffer access
 | ||||||
|  |     ble_app->hci_mtx = osMutexNew(NULL); | ||||||
|  |     ble_app->hci_sem = osSemaphoreNew(1, 0, NULL); | ||||||
|  |     // HCI transport layer thread to handle user asynch events
 | ||||||
|  |     ble_app->hci_thread_attr.name = "ble hci"; | ||||||
|  |     ble_app->hci_thread_attr.stack_size = 1024; | ||||||
|  |     ble_app->hci_thread_id = osThreadNew(ble_app_hci_thread, NULL, &ble_app->hci_thread_attr); | ||||||
|  | 
 | ||||||
|  |     // Initialize Ble Transport Layer
 | ||||||
|  |     HCI_TL_HciInitConf_t hci_tl_config = { | ||||||
|  |         .p_cmdbuffer = (uint8_t*)&ble_app_cmd_buffer, | ||||||
|  |         .StatusNotCallBack = ble_app_hci_status_not_handler, | ||||||
|  |     }; | ||||||
|  |     hci_init(ble_app_hci_event_handler, (void*)&hci_tl_config); | ||||||
|  | 
 | ||||||
|  |     // Start ble stack on 2nd core
 | ||||||
|  |     SHCI_C2_Ble_Init_Cmd_Packet_t ble_init_cmd_packet = { | ||||||
|  |         .Header = {{0,0,0}}, // Header unused
 | ||||||
|  |         .Param = { | ||||||
|  |             0, // pBleBufferAddress not used
 | ||||||
|  |             0, // BleBufferSize not used
 | ||||||
|  |             CFG_BLE_NUM_GATT_ATTRIBUTES, | ||||||
|  |             CFG_BLE_NUM_GATT_SERVICES, | ||||||
|  |             CFG_BLE_ATT_VALUE_ARRAY_SIZE, | ||||||
|  |             CFG_BLE_NUM_LINK, | ||||||
|  |             CFG_BLE_DATA_LENGTH_EXTENSION, | ||||||
|  |             CFG_BLE_PREPARE_WRITE_LIST_SIZE, | ||||||
|  |             CFG_BLE_MBLOCK_COUNT, | ||||||
|  |             CFG_BLE_MAX_ATT_MTU, | ||||||
|  |             CFG_BLE_SLAVE_SCA, | ||||||
|  |             CFG_BLE_MASTER_SCA, | ||||||
|  |             CFG_BLE_LSE_SOURCE, | ||||||
|  |             CFG_BLE_MAX_CONN_EVENT_LENGTH, | ||||||
|  |             CFG_BLE_HSE_STARTUP_TIME, | ||||||
|  |             CFG_BLE_VITERBI_MODE, | ||||||
|  |             CFG_BLE_LL_ONLY, | ||||||
|  |             0, | ||||||
|  |         } | ||||||
|  |     }; | ||||||
|  |     SHCI_CmdStatus_t status = SHCI_C2_BLE_Init(&ble_init_cmd_packet); | ||||||
|  |     if(status) { | ||||||
|  |         FURI_LOG_E(BLE_APP_TAG, "Failed to start ble stack: %d", status); | ||||||
|  |     } | ||||||
|  |     return status == SHCI_Success; | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | static void ble_app_hci_thread(void *arg) { | ||||||
|  |     while(1) { | ||||||
|  |         osThreadFlagsWait(1, osFlagsWaitAny, osWaitForever); | ||||||
|  |         hci_user_evt_proc(); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | // Called by WPAN lib
 | ||||||
|  | void hci_notify_asynch_evt(void* pdata) { | ||||||
|  |     osThreadFlagsSet(ble_app->hci_thread_id, 1); | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void hci_cmd_resp_release(uint32_t flag) { | ||||||
|  |     osSemaphoreRelease(ble_app->hci_sem); | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void hci_cmd_resp_wait(uint32_t timeout) { | ||||||
|  |     osSemaphoreAcquire(ble_app->hci_sem, osWaitForever); | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | static void ble_app_hci_event_handler( void * pPayload ) { | ||||||
|  |     SVCCTL_UserEvtFlowStatus_t svctl_return_status; | ||||||
|  |     tHCI_UserEvtRxParam *pParam = (tHCI_UserEvtRxParam *)pPayload; | ||||||
|  | 
 | ||||||
|  |     svctl_return_status = SVCCTL_UserEvtRx((void *)&(pParam->pckt->evtserial)); | ||||||
|  |     if (svctl_return_status != SVCCTL_UserEvtFlowDisable) { | ||||||
|  |         pParam->status = HCI_TL_UserEventFlow_Enable; | ||||||
|  |     } else { | ||||||
|  |         pParam->status = HCI_TL_UserEventFlow_Disable; | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | static void ble_app_hci_status_not_handler( HCI_TL_CmdStatus_t status ) { | ||||||
|  |     if(status == HCI_TL_CmdBusy) { | ||||||
|  |         osMutexAcquire(ble_app->hci_mtx, osWaitForever ); | ||||||
|  |     } else if(status == HCI_TL_CmdAvailable) { | ||||||
|  |         osMutexRelease(ble_app->hci_mtx); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void SVCCTL_ResumeUserEventFlow( void ) { | ||||||
|  |     hci_resume_flow(); | ||||||
|  | } | ||||||
| @ -5,9 +5,8 @@ extern "C" { | |||||||
| #endif | #endif | ||||||
| 
 | 
 | ||||||
| #include <stdbool.h> | #include <stdbool.h> | ||||||
| #include "hci_tl.h" |  | ||||||
| 
 | 
 | ||||||
| bool APP_BLE_Init(); | bool ble_app_init(); | ||||||
| 
 | 
 | ||||||
| #ifdef __cplusplus | #ifdef __cplusplus | ||||||
| } | } | ||||||
| @ -39,7 +39,7 @@ void dev_info_svc_start() { | |||||||
|                                 (Char_UUID_t*)&uuid, |                                 (Char_UUID_t*)&uuid, | ||||||
|                                 strlen(dev_info_man_name), |                                 strlen(dev_info_man_name), | ||||||
|                                 CHAR_PROP_READ, |                                 CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
| @ -53,7 +53,7 @@ void dev_info_svc_start() { | |||||||
|                                 (Char_UUID_t*)&uuid, |                                 (Char_UUID_t*)&uuid, | ||||||
|                                 strlen(dev_info_serial_num), |                                 strlen(dev_info_serial_num), | ||||||
|                                 CHAR_PROP_READ, |                                 CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
| @ -67,7 +67,7 @@ void dev_info_svc_start() { | |||||||
|                                 (Char_UUID_t*)&uuid, |                                 (Char_UUID_t*)&uuid, | ||||||
|                                 strlen(dev_info_firmware_rev_num), |                                 strlen(dev_info_firmware_rev_num), | ||||||
|                                 CHAR_PROP_READ, |                                 CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
| @ -81,7 +81,7 @@ void dev_info_svc_start() { | |||||||
|                                 (Char_UUID_t*)&uuid, |                                 (Char_UUID_t*)&uuid, | ||||||
|                                 strlen(dev_info_software_rev_num), |                                 strlen(dev_info_software_rev_num), | ||||||
|                                 CHAR_PROP_READ, |                                 CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_CONSTANT, |                                 CHAR_VALUE_LEN_CONSTANT, | ||||||
|  | |||||||
| @ -31,13 +31,22 @@ typedef struct { | |||||||
| typedef struct { | typedef struct { | ||||||
|   GapSvc gap_svc; |   GapSvc gap_svc; | ||||||
|   GapState state; |   GapState state; | ||||||
|  |   osMutexId_t state_mutex; | ||||||
|   uint8_t mac_address[BD_ADDR_SIZE_LOCAL]; |   uint8_t mac_address[BD_ADDR_SIZE_LOCAL]; | ||||||
|   Bt* bt; |   Bt* bt; | ||||||
|   osTimerId advertise_timer; |   osTimerId advertise_timer; | ||||||
|   osThreadAttr_t thread_attr; |   osThreadAttr_t thread_attr; | ||||||
|   osThreadId_t thread_id; |   osThreadId_t thread_id; | ||||||
|  |   osMessageQueueId_t command_queue; | ||||||
|  |   bool enable_adv; | ||||||
| } Gap; | } Gap; | ||||||
| 
 | 
 | ||||||
|  | typedef enum { | ||||||
|  |     GapCommandAdvFast, | ||||||
|  |     GapCommandAdvLowPower, | ||||||
|  |     GapCommandAdvStop, | ||||||
|  | } GapCommand; | ||||||
|  | 
 | ||||||
| // Identity root key
 | // Identity root key
 | ||||||
| static const uint8_t gap_irk[16] = {0x12,0x34,0x56,0x78,0x9a,0xbc,0xde,0xf0,0x12,0x34,0x56,0x78,0x9a,0xbc,0xde,0xf0}; | static const uint8_t gap_irk[16] = {0x12,0x34,0x56,0x78,0x9a,0xbc,0xde,0xf0,0x12,0x34,0x56,0x78,0x9a,0xbc,0xde,0xf0}; | ||||||
| // Encryption root key
 | // Encryption root key
 | ||||||
| @ -49,7 +58,7 @@ static const uint8_t gap_default_mac_addr[] = {0x6c, 0x7a, 0xd8, 0xac, 0x57, 0x7 | |||||||
| 
 | 
 | ||||||
| static Gap* gap = NULL; | static Gap* gap = NULL; | ||||||
| 
 | 
 | ||||||
| static void gap_advertise(GapState new_state); | static void gap_advertise_start(GapState new_state); | ||||||
| static void gap_app(void *arg); | static void gap_app(void *arg); | ||||||
| 
 | 
 | ||||||
| SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | ||||||
| @ -64,6 +73,7 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
| 
 | 
 | ||||||
|     event_pckt = (hci_event_pckt*) ((hci_uart_pckt *) pckt)->data; |     event_pckt = (hci_event_pckt*) ((hci_uart_pckt *) pckt)->data; | ||||||
| 
 | 
 | ||||||
|  |     osMutexAcquire(gap->state_mutex, osWaitForever); | ||||||
|     switch (event_pckt->evt) { |     switch (event_pckt->evt) { | ||||||
|         case EVT_DISCONN_COMPLETE: |         case EVT_DISCONN_COMPLETE: | ||||||
|         { |         { | ||||||
| @ -73,10 +83,12 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|                 gap->state = GapStateIdle; |                 gap->state = GapStateIdle; | ||||||
|                 FURI_LOG_I(GAP_TAG, "Disconnect from client"); |                 FURI_LOG_I(GAP_TAG, "Disconnect from client"); | ||||||
|             } |             } | ||||||
|  |             if(gap->enable_adv) { | ||||||
|                 // Restart advertising
 |                 // Restart advertising
 | ||||||
|         gap_advertise(GapStateAdvFast); |                 gap_start_advertising(); | ||||||
|                 furi_hal_power_insomnia_exit(); |                 furi_hal_power_insomnia_exit(); | ||||||
|             } |             } | ||||||
|  |         } | ||||||
|         break; |         break; | ||||||
| 
 | 
 | ||||||
|         case EVT_LE_META_EVENT: |         case EVT_LE_META_EVENT: | ||||||
| @ -97,7 +109,7 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|                 if(ret) { |                 if(ret) { | ||||||
|                     FURI_LOG_E(GAP_TAG, "Read PHY failed, status: %d", ret); |                     FURI_LOG_E(GAP_TAG, "Read PHY failed, status: %d", ret); | ||||||
|                 } else { |                 } else { | ||||||
|                 FURI_LOG_I(GAP_TAG, "PHY Params TX= %d, RX= %d ", tx_phy, rx_phy); |                     FURI_LOG_I(GAP_TAG, "PHY Params TX = %d, RX = %d ", tx_phy, rx_phy); | ||||||
|                 } |                 } | ||||||
|                 break; |                 break; | ||||||
| 
 | 
 | ||||||
| @ -172,8 +184,7 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|                 aci_gap_numeric_comparison_value_confirm_yesno(gap->gap_svc.connection_handle, 1); |                 aci_gap_numeric_comparison_value_confirm_yesno(gap->gap_svc.connection_handle, 1); | ||||||
|                 break; |                 break; | ||||||
| 
 | 
 | ||||||
|         case (EVT_BLUE_GAP_PAIRING_CMPLT): |             case EVT_BLUE_GAP_PAIRING_CMPLT: | ||||||
|         { |  | ||||||
|                 pairing_complete = (aci_gap_pairing_complete_event_rp0*)blue_evt->data; |                 pairing_complete = (aci_gap_pairing_complete_event_rp0*)blue_evt->data; | ||||||
|                 if (pairing_complete->Status) { |                 if (pairing_complete->Status) { | ||||||
|                     FURI_LOG_E(GAP_TAG, "Pairing failed with status: %d. Terminating connection", pairing_complete->Status); |                     FURI_LOG_E(GAP_TAG, "Pairing failed with status: %d. Terminating connection", pairing_complete->Status); | ||||||
| @ -181,7 +192,6 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|                 } else { |                 } else { | ||||||
|                     FURI_LOG_I(GAP_TAG, "Pairing complete"); |                     FURI_LOG_I(GAP_TAG, "Pairing complete"); | ||||||
|                 } |                 } | ||||||
|         } |  | ||||||
|                 break; |                 break; | ||||||
| 
 | 
 | ||||||
|             case EVT_BLUE_GAP_PROCEDURE_COMPLETE: |             case EVT_BLUE_GAP_PROCEDURE_COMPLETE: | ||||||
| @ -191,7 +201,7 @@ SVCCTL_UserEvtFlowStatus_t SVCCTL_App_Notification( void *pckt ) | |||||||
|             default: |             default: | ||||||
|                 break; |                 break; | ||||||
|     } |     } | ||||||
| 
 |     osMutexRelease(gap->state_mutex); | ||||||
|     return SVCCTL_UserEvtFlowEnable; |     return SVCCTL_UserEvtFlowEnable; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| @ -213,7 +223,7 @@ static void set_advertisment_service_uid(uint8_t* uid, uint8_t uid_len) { | |||||||
|     gap->gap_svc.adv_svc_uuid_len += uid_len; |     gap->gap_svc.adv_svc_uuid_len += uid_len; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| GapState gap_get_status() { | GapState gap_get_state() { | ||||||
|     return gap->state; |     return gap->state; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| @ -293,7 +303,7 @@ static void gap_init_svc(Gap* gap) { | |||||||
|     aci_gap_configure_whitelist(); |     aci_gap_configure_whitelist(); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| static void gap_advertise(GapState new_state) | static void gap_advertise_start(GapState new_state) | ||||||
| { | { | ||||||
|     tBleStatus status; |     tBleStatus status; | ||||||
|     uint16_t min_interval; |     uint16_t min_interval; | ||||||
| @ -317,7 +327,6 @@ static void gap_advertise(GapState new_state) | |||||||
|         } |         } | ||||||
|     } |     } | ||||||
|     // Configure advertising
 |     // Configure advertising
 | ||||||
|     gap->state = new_state; |  | ||||||
|     const char* name = furi_hal_version_get_ble_local_device_name_ptr(); |     const char* name = furi_hal_version_get_ble_local_device_name_ptr(); | ||||||
|     status = aci_gap_set_discoverable(ADV_IND, min_interval, max_interval, PUBLIC_ADDR, 0, |     status = aci_gap_set_discoverable(ADV_IND, min_interval, max_interval, PUBLIC_ADDR, 0, | ||||||
|                                         strlen(name), (uint8_t*)name, |                                         strlen(name), (uint8_t*)name, | ||||||
| @ -325,17 +334,40 @@ static void gap_advertise(GapState new_state) | |||||||
|     if(status) { |     if(status) { | ||||||
|         FURI_LOG_E(GAP_TAG, "Set discoverable err: %d", status); |         FURI_LOG_E(GAP_TAG, "Set discoverable err: %d", status); | ||||||
|     } |     } | ||||||
|  |     gap->state = new_state; | ||||||
|  |     bt_update_statusbar(gap->bt); | ||||||
|     osTimerStart(gap->advertise_timer, INITIAL_ADV_TIMEOUT); |     osTimerStart(gap->advertise_timer, INITIAL_ADV_TIMEOUT); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| static void gap_advertise_request(Gap* gap) { | static void gap_advertise_stop() { | ||||||
|     osThreadFlagsSet(gap->thread_id, 1); |     if(gap->state == GapStateConnected) { | ||||||
|  |         // Terminate connection
 | ||||||
|  |         aci_gap_terminate(gap->gap_svc.connection_handle, 0x13); | ||||||
|  |     } | ||||||
|  |     if(gap->state > GapStateIdle) { | ||||||
|  |         // Stop advertising
 | ||||||
|  |         osTimerStop(gap->advertise_timer); | ||||||
|  |         aci_gap_set_non_discoverable(); | ||||||
|  |         gap->state = GapStateIdle; | ||||||
|  |         bt_update_statusbar(gap->bt); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void gap_start_advertising() { | ||||||
|  |     gap->enable_adv = true; | ||||||
|  |     GapCommand command = GapCommandAdvFast; | ||||||
|  |     furi_check(osMessageQueuePut(gap->command_queue, &command, 0, 0) == osOK); | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void gap_stop_advertising() { | ||||||
|  |     gap->enable_adv = false; | ||||||
|  |     GapCommand command = GapCommandAdvStop; | ||||||
|  |     furi_check(osMessageQueuePut(gap->command_queue, &command, 0, 0) == osOK); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| static void gap_advetise_timer_callback(void* context) { | static void gap_advetise_timer_callback(void* context) { | ||||||
|     furi_assert(context); |     GapCommand command = GapCommandAdvLowPower; | ||||||
|     Gap* gap = context; |     furi_check(osMessageQueuePut(gap->command_queue, &command, 0, 0) == osOK); | ||||||
|     gap_advertise_request(gap); |  | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| bool gap_init() { | bool gap_init() { | ||||||
| @ -348,20 +380,25 @@ bool gap_init() { | |||||||
|     // Open Bt record
 |     // Open Bt record
 | ||||||
|     gap->bt = furi_record_open("bt"); |     gap->bt = furi_record_open("bt"); | ||||||
|     // Create advertising timer
 |     // Create advertising timer
 | ||||||
|     gap->advertise_timer = osTimerNew(gap_advetise_timer_callback, osTimerOnce, &gap, NULL); |     gap->advertise_timer = osTimerNew(gap_advetise_timer_callback, osTimerOnce, NULL, NULL); | ||||||
|     // Initialization of HCI & GATT & GAP layer
 |     // Initialization of GATT & GAP layer
 | ||||||
|     gap_init_svc(gap); |     gap_init_svc(gap); | ||||||
|     // Initialization of the BLE Services
 |     // Initialization of the BLE Services
 | ||||||
|     SVCCTL_Init(); |     SVCCTL_Init(); | ||||||
|     // Initialization of the BLE App Context
 |     // Initialization of the GAP state
 | ||||||
|  |     gap->state_mutex = osMutexNew(NULL); | ||||||
|     gap->state = GapStateIdle; |     gap->state = GapStateIdle; | ||||||
|     gap->gap_svc.connection_handle = 0xFFFF; |     gap->gap_svc.connection_handle = 0xFFFF; | ||||||
|  |     gap->enable_adv = true; | ||||||
| 
 | 
 | ||||||
|     // Thread configuration
 |     // Thread configuration
 | ||||||
|     gap->thread_attr.name = "BLE advertising"; |     gap->thread_attr.name = "BLE advertising"; | ||||||
|     gap->thread_attr.stack_size = 512; |     gap->thread_attr.stack_size = 1024; | ||||||
|     gap->thread_id = osThreadNew(gap_app, NULL, &gap->thread_attr); |     gap->thread_id = osThreadNew(gap_app, NULL, &gap->thread_attr); | ||||||
| 
 | 
 | ||||||
|  |     // Command queue allocation
 | ||||||
|  |     gap->command_queue = osMessageQueueNew(8, sizeof(GapCommand), NULL); | ||||||
|  | 
 | ||||||
|     // Start Device Information service
 |     // Start Device Information service
 | ||||||
|     dev_info_svc_start(); |     dev_info_svc_start(); | ||||||
|     // Start Battery service
 |     // Start Battery service
 | ||||||
| @ -374,14 +411,21 @@ bool gap_init() { | |||||||
|     adv_service_uid[1] = 0x30; |     adv_service_uid[1] = 0x30; | ||||||
| 
 | 
 | ||||||
|     set_advertisment_service_uid(adv_service_uid, sizeof(adv_service_uid)); |     set_advertisment_service_uid(adv_service_uid, sizeof(adv_service_uid)); | ||||||
|     gap_advertise(GapStateAdvFast); |  | ||||||
|     return true; |     return true; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| static void gap_app(void *arg) { | static void gap_app(void *arg) { | ||||||
|     // TODO Exit from app, stop service, clean memory
 |     GapCommand command; | ||||||
|     while(1) { |     while(1) { | ||||||
|         osThreadFlagsWait(1, osFlagsWaitAny, osWaitForever); |         furi_check(osMessageQueueGet(gap->command_queue, &command, NULL, osWaitForever) == osOK); | ||||||
|         gap_advertise(GapStateAdvLowPower); |         osMutexAcquire(gap->state_mutex, osWaitForever); | ||||||
|  |         if(command == GapCommandAdvFast) { | ||||||
|  |             gap_advertise_start(GapStateAdvFast); | ||||||
|  |         } else if(command == GapCommandAdvLowPower) { | ||||||
|  |             gap_advertise_start(GapStateAdvLowPower); | ||||||
|  |         } else if(command == GapCommandAdvStop) { | ||||||
|  |             gap_advertise_stop(); | ||||||
|  |         } | ||||||
|  |         osMutexRelease(gap->state_mutex); | ||||||
|     } |     } | ||||||
| } | } | ||||||
|  | |||||||
| @ -15,7 +15,11 @@ typedef enum { | |||||||
| 
 | 
 | ||||||
| bool gap_init(); | bool gap_init(); | ||||||
| 
 | 
 | ||||||
| GapState gap_get_status(); | void gap_start_advertising(); | ||||||
|  | 
 | ||||||
|  | void gap_stop_advertising(); | ||||||
|  | 
 | ||||||
|  | GapState gap_get_state(); | ||||||
| 
 | 
 | ||||||
| #ifdef __cplusplus | #ifdef __cplusplus | ||||||
| } | } | ||||||
|  | |||||||
| @ -61,7 +61,7 @@ void serial_svc_start() { | |||||||
|     status = aci_gatt_add_char(serial_svc->svc_handle, UUID_TYPE_128, (const Char_UUID_t*)char_tx_uuid, |     status = aci_gatt_add_char(serial_svc->svc_handle, UUID_TYPE_128, (const Char_UUID_t*)char_tx_uuid, | ||||||
|                                 SERIAL_SVC_DATA_LEN_MAX, |                                 SERIAL_SVC_DATA_LEN_MAX, | ||||||
|                                 CHAR_PROP_WRITE_WITHOUT_RESP | CHAR_PROP_WRITE | CHAR_PROP_READ, |                                 CHAR_PROP_WRITE_WITHOUT_RESP | CHAR_PROP_WRITE | CHAR_PROP_READ, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ | ATTR_PERMISSION_AUTHEN_WRITE, | ||||||
|                                 GATT_NOTIFY_ATTRIBUTE_WRITE, |                                 GATT_NOTIFY_ATTRIBUTE_WRITE, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_VARIABLE, |                                 CHAR_VALUE_LEN_VARIABLE, | ||||||
| @ -74,7 +74,7 @@ void serial_svc_start() { | |||||||
|     status = aci_gatt_add_char(serial_svc->svc_handle, UUID_TYPE_128, (const Char_UUID_t*)char_rx_uuid, |     status = aci_gatt_add_char(serial_svc->svc_handle, UUID_TYPE_128, (const Char_UUID_t*)char_rx_uuid, | ||||||
|                                 SERIAL_SVC_DATA_LEN_MAX,                                   |                                 SERIAL_SVC_DATA_LEN_MAX,                                   | ||||||
|                                 CHAR_PROP_READ | CHAR_PROP_INDICATE, |                                 CHAR_PROP_READ | CHAR_PROP_INDICATE, | ||||||
|                                 ATTR_PERMISSION_NONE, |                                 ATTR_PERMISSION_AUTHEN_READ, | ||||||
|                                 GATT_DONT_NOTIFY_EVENTS, |                                 GATT_DONT_NOTIFY_EVENTS, | ||||||
|                                 10, |                                 10, | ||||||
|                                 CHAR_VALUE_LEN_VARIABLE, |                                 CHAR_VALUE_LEN_VARIABLE, | ||||||
| @ -108,7 +108,9 @@ void serial_svc_stop() { | |||||||
| 
 | 
 | ||||||
| 
 | 
 | ||||||
| bool serial_svc_update_rx(uint8_t* data, uint8_t data_len) { | bool serial_svc_update_rx(uint8_t* data, uint8_t data_len) { | ||||||
|     furi_assert(data_len < SERIAL_SVC_DATA_LEN_MAX); |     if(data_len > SERIAL_SVC_DATA_LEN_MAX) { | ||||||
|  |         return false; | ||||||
|  |     } | ||||||
| 
 | 
 | ||||||
|     tBleStatus result = aci_gatt_update_char_value(serial_svc->svc_handle, |     tBleStatus result = aci_gatt_update_char_value(serial_svc->svc_handle, | ||||||
|                                         serial_svc->rx_char_handle, |                                         serial_svc->rx_char_handle, | ||||||
|  | |||||||
| @ -4,7 +4,6 @@ | |||||||
| #include <stm32wbxx.h> | #include <stm32wbxx.h> | ||||||
| #include <shci.h> | #include <shci.h> | ||||||
| #include <cmsis_os2.h> | #include <cmsis_os2.h> | ||||||
| #include <app_ble.h> |  | ||||||
| #include <gap.h> | #include <gap.h> | ||||||
| 
 | 
 | ||||||
| void furi_hal_bt_init() { | void furi_hal_bt_init() { | ||||||
| @ -14,10 +13,22 @@ void furi_hal_bt_init() { | |||||||
|     APPE_Init(); |     APPE_Init(); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| bool furi_hal_bt_start_app() { | bool furi_hal_bt_init_app() { | ||||||
|     return gap_init(); |     return gap_init(); | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
|  | void furi_hal_bt_start_advertising() { | ||||||
|  |     if(gap_get_state() == GapStateIdle) { | ||||||
|  |         gap_start_advertising(); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
|  | void furi_hal_bt_stop_advertising() { | ||||||
|  |     if(furi_hal_bt_is_alive()) { | ||||||
|  |         gap_stop_advertising(); | ||||||
|  |     } | ||||||
|  | } | ||||||
|  | 
 | ||||||
| void furi_hal_bt_dump_state(string_t buffer) { | void furi_hal_bt_dump_state(string_t buffer) { | ||||||
|     BleGlueStatus status = APPE_Status(); |     BleGlueStatus status = APPE_Status(); | ||||||
|     if (status == BleGlueStatusStarted) { |     if (status == BleGlueStatusStarted) { | ||||||
| @ -41,7 +52,7 @@ void furi_hal_bt_dump_state(string_t buffer) { | |||||||
| } | } | ||||||
| 
 | 
 | ||||||
| bool furi_hal_bt_is_alive() { | bool furi_hal_bt_is_alive() { | ||||||
|     return APPE_Status() == BleGlueStatusStarted; |     return gap_get_state() > GapStateIdle; | ||||||
| } | } | ||||||
| 
 | 
 | ||||||
| bool furi_hal_bt_wait_startup() { | bool furi_hal_bt_wait_startup() { | ||||||
|  | |||||||
| @ -11,7 +11,13 @@ extern "C" { | |||||||
| void furi_hal_bt_init(); | void furi_hal_bt_init(); | ||||||
| 
 | 
 | ||||||
| /** Start BLE app */ | /** Start BLE app */ | ||||||
| bool furi_hal_bt_start_app(); | bool furi_hal_bt_init_app(); | ||||||
|  | 
 | ||||||
|  | /** Start advertising */ | ||||||
|  | void furi_hal_bt_start_advertising(); | ||||||
|  | 
 | ||||||
|  | /** Stop advertising */ | ||||||
|  | void furi_hal_bt_stop_advertising(); | ||||||
| 
 | 
 | ||||||
| /** Get BT/BLE system component state */ | /** Get BT/BLE system component state */ | ||||||
| void furi_hal_bt_dump_state(string_t buffer); | void furi_hal_bt_dump_state(string_t buffer); | ||||||
|  | |||||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user
	 gornekich
						gornekich