|
1 | 1 | #include <furi.h>
|
2 | 2 | #include <furi_hal.h>
|
| 3 | +#include <furi_hal_bt_hid.h> |
| 4 | +#include <bt/bt_service/bt.h> |
3 | 5 | #include <gui/gui.h>
|
4 |
| -#include <dialogs/dialogs.h> |
| 6 | +#include <gui/view_dispatcher.h> |
| 7 | +#include <gui/modules/submenu.h> |
| 8 | +#include <gui/modules/dialog_ex.h> |
5 | 9 | #include "imu_mouse.h"
|
6 |
| -#include "air_mouse_ofw_icons.h" |
| 10 | +#include "views/air_mouse_view.h" |
| 11 | +#include <furi_hal_usb_hid.h> |
| 12 | +#include <storage/storage.h> |
7 | 13 |
|
8 | 14 | #define TAG "SensorModule"
|
9 | 15 |
|
| 16 | +#define AIRMOUSE_BT_KEYS_STORAGE_NAME ".airm_bt_hid.keys" |
| 17 | + |
10 | 18 | typedef struct {
|
11 | 19 | Gui* gui;
|
12 |
| - ViewPort* view_port; |
13 |
| - FuriMessageQueue* input_queue; |
14 |
| - |
| 20 | + ViewDispatcher* view_dispatcher; |
| 21 | + Submenu* start_submenu; |
| 22 | + DialogEx* error_dialog; |
| 23 | + AirMouseView* air_mouse_view; |
15 | 24 | FuriHalSpiBusHandle* icm42688p_device;
|
16 | 25 | ICM42688P* icm42688p;
|
17 |
| - bool icm42688p_valid; |
| 26 | + FuriHalUsbInterface* usb_mode_prev; |
| 27 | + Bt* bt; |
| 28 | +} AirMouseApp; |
| 29 | + |
| 30 | +typedef enum { |
| 31 | + AirMouseViewError, |
| 32 | + AirMouseViewStartSubmenu, |
| 33 | + AirMouseViewMain, |
| 34 | +} AirMouseViews; |
| 35 | + |
| 36 | +enum StertSubmenuIndex { |
| 37 | + StartSubmenuIndexUsb, |
| 38 | + StartSubmenuIndexBle, |
| 39 | + StartSubmenuIndexBleReset, |
| 40 | +}; |
| 41 | + |
| 42 | +static const ImuHidApi hid_api_usb = { |
| 43 | + .mouse_move = furi_hal_hid_mouse_move, |
| 44 | + .mouse_key_press = furi_hal_hid_mouse_press, |
| 45 | + .mouse_key_release = furi_hal_hid_mouse_release, |
| 46 | + .mouse_scroll = furi_hal_hid_mouse_scroll, |
| 47 | + .report_rate_max = 200, |
| 48 | +}; |
| 49 | + |
| 50 | +static const ImuHidApi hid_api_ble = { |
| 51 | + .mouse_move = furi_hal_bt_hid_mouse_move, |
| 52 | + .mouse_key_press = furi_hal_bt_hid_mouse_press, |
| 53 | + .mouse_key_release = furi_hal_bt_hid_mouse_release, |
| 54 | + .mouse_scroll = furi_hal_bt_hid_mouse_scroll, |
| 55 | + .report_rate_max = 30, |
| 56 | +}; |
| 57 | + |
| 58 | +static void ble_hid_remove_pairing(void) { |
| 59 | + Bt* bt = furi_record_open(RECORD_BT); |
| 60 | + bt_disconnect(bt); |
| 61 | + |
| 62 | + // Wait 2nd core to update nvm storage |
| 63 | + furi_delay_ms(200); |
| 64 | + |
| 65 | + bt_keys_storage_set_storage_path(bt, APP_DATA_PATH(AIRMOUSE_BT_KEYS_STORAGE_NAME)); |
| 66 | + bt_forget_bonded_devices(bt); |
| 67 | + |
| 68 | + // Wait 2nd core to update nvm storage |
| 69 | + furi_delay_ms(200); |
| 70 | + bt_keys_storage_set_default_path(bt); |
| 71 | + |
| 72 | + furi_check(bt_set_profile(bt, BtProfileSerial)); |
| 73 | + furi_record_close(RECORD_BT); |
| 74 | +} |
| 75 | + |
| 76 | +static void ble_hid_connection_status_callback(BtStatus status, void* context) { |
| 77 | + furi_assert(context); |
| 78 | + AirMouseApp* app = context; |
| 79 | + bool connected = (status == BtStatusConnected); |
| 80 | + air_mouse_view_set_connected_status(app->air_mouse_view, connected); |
| 81 | +} |
| 82 | + |
| 83 | +static Bt* ble_hid_init(AirMouseApp* app) { |
| 84 | + Bt* bt = furi_record_open(RECORD_BT); |
| 85 | + bt_disconnect(bt); |
18 | 86 |
|
19 |
| - ImuThread* imu_thread; |
20 |
| -} SensorModuleApp; |
| 87 | + // Wait 2nd core to update nvm storage |
| 88 | + furi_delay_ms(200); |
21 | 89 |
|
22 |
| -static void render_callback(Canvas* canvas, void* ctx) { |
23 |
| - UNUSED(ctx); |
24 |
| - canvas_clear(canvas); |
25 |
| - canvas_set_color(canvas, ColorBlack); |
| 90 | + bt_keys_storage_set_storage_path(bt, APP_DATA_PATH(AIRMOUSE_BT_KEYS_STORAGE_NAME)); |
26 | 91 |
|
27 |
| - canvas_draw_icon(canvas, 64 + 14, 8, &I_Circles_47x47); |
28 |
| - canvas_draw_icon(canvas, 83 + 14, 27, &I_Left_mouse_icon_9x9); |
29 |
| - canvas_draw_icon(canvas, 83 + 14, 11, &I_Right_mouse_icon_9x9); |
| 92 | + furi_check(bt_set_profile(bt, BtProfileHidKeyboard)); |
30 | 93 |
|
31 |
| - canvas_set_font(canvas, FontPrimary); |
32 |
| - canvas_draw_str(canvas, 0, 14, "Air Mouse"); |
33 |
| - canvas_set_font(canvas, FontSecondary); |
34 |
| - canvas_draw_str(canvas, 0, 56, "Press Back to exit"); |
| 94 | + furi_hal_bt_start_advertising(); |
| 95 | + bt_set_status_changed_callback(bt, ble_hid_connection_status_callback, app); |
| 96 | + return bt; |
35 | 97 | }
|
36 | 98 |
|
37 |
| -static void input_callback(InputEvent* input_event, void* ctx) { |
38 |
| - SensorModuleApp* app = ctx; |
39 |
| - furi_message_queue_put(app->input_queue, input_event, 0); |
| 99 | +static void ble_hid_deinit(Bt* bt) { |
| 100 | + bt_set_status_changed_callback(bt, NULL, NULL); |
| 101 | + bt_disconnect(bt); |
| 102 | + |
| 103 | + // Wait 2nd core to update nvm storage |
| 104 | + furi_delay_ms(200); |
| 105 | + bt_keys_storage_set_default_path(bt); |
| 106 | + |
| 107 | + furi_check(bt_set_profile(bt, BtProfileSerial)); |
| 108 | + furi_record_close(RECORD_BT); |
40 | 109 | }
|
41 | 110 |
|
42 |
| -static SensorModuleApp* sensor_module_alloc(void) { |
43 |
| - SensorModuleApp* app = malloc(sizeof(SensorModuleApp)); |
| 111 | +static uint32_t air_mouse_exit(void* context) { |
| 112 | + UNUSED(context); |
| 113 | + return VIEW_NONE; |
| 114 | +} |
44 | 115 |
|
45 |
| - app->icm42688p_device = malloc(sizeof(FuriHalSpiBusHandle)); |
46 |
| - memcpy(app->icm42688p_device, &furi_hal_spi_bus_handle_external, sizeof(FuriHalSpiBusHandle)); |
47 |
| - app->icm42688p_device->cs = &gpio_ext_pc3; |
48 |
| - app->icm42688p = icm42688p_alloc(app->icm42688p_device, &gpio_ext_pb2); |
49 |
| - app->icm42688p_valid = icm42688p_init(app->icm42688p); |
| 116 | +static uint32_t air_mouse_return_to_menu(void* context) { |
| 117 | + UNUSED(context); |
| 118 | + return AirMouseViewStartSubmenu; |
| 119 | +} |
| 120 | + |
| 121 | +static void air_mouse_hid_deinit(void* context) { |
| 122 | + furi_assert(context); |
| 123 | + AirMouseApp* app = context; |
| 124 | + |
| 125 | + if(app->bt) { |
| 126 | + ble_hid_deinit(app->bt); |
| 127 | + app->bt = NULL; |
| 128 | + } else if(app->usb_mode_prev) { |
| 129 | + furi_hal_usb_set_config(app->usb_mode_prev, NULL); |
| 130 | + app->usb_mode_prev = NULL; |
| 131 | + } |
| 132 | +} |
50 | 133 |
|
51 |
| - app->input_queue = furi_message_queue_alloc(8, sizeof(InputEvent)); |
| 134 | +static void air_mouse_submenu_callback(void* context, uint32_t index) { |
| 135 | + furi_assert(context); |
| 136 | + AirMouseApp* app = context; |
| 137 | + if(index == StartSubmenuIndexUsb) { |
| 138 | + app->usb_mode_prev = furi_hal_usb_get_config(); |
| 139 | + furi_hal_usb_unlock(); |
| 140 | + furi_hal_usb_set_config(&usb_hid, NULL); |
| 141 | + |
| 142 | + air_mouse_view_set_hid_api(app->air_mouse_view, &hid_api_usb, false); |
| 143 | + view_dispatcher_switch_to_view(app->view_dispatcher, AirMouseViewMain); |
| 144 | + } else if(index == StartSubmenuIndexBle) { |
| 145 | + app->bt = ble_hid_init(app); |
| 146 | + |
| 147 | + air_mouse_view_set_hid_api(app->air_mouse_view, &hid_api_ble, true); |
| 148 | + view_dispatcher_switch_to_view(app->view_dispatcher, AirMouseViewMain); |
| 149 | + } else if(index == StartSubmenuIndexBleReset) { |
| 150 | + ble_hid_remove_pairing(); |
| 151 | + } |
| 152 | +} |
52 | 153 |
|
53 |
| - app->view_port = view_port_alloc(); |
54 |
| - view_port_draw_callback_set(app->view_port, render_callback, app); |
55 |
| - view_port_input_callback_set(app->view_port, input_callback, app); |
| 154 | +static AirMouseApp* air_mouse_alloc(void) { |
| 155 | + AirMouseApp* app = malloc(sizeof(AirMouseApp)); |
56 | 156 |
|
57 | 157 | app->gui = furi_record_open(RECORD_GUI);
|
58 |
| - gui_add_view_port(app->gui, app->view_port, GuiLayerFullscreen); |
| 158 | + app->view_dispatcher = view_dispatcher_alloc(); |
| 159 | + view_dispatcher_enable_queue(app->view_dispatcher); |
| 160 | + view_dispatcher_attach_to_gui(app->view_dispatcher, app->gui, ViewDispatcherTypeFullscreen); |
| 161 | + |
| 162 | + app->air_mouse_view = air_mouse_view_alloc(air_mouse_hid_deinit, app); |
| 163 | + view_set_previous_callback( |
| 164 | + air_mouse_view_get_view(app->air_mouse_view), air_mouse_return_to_menu); |
| 165 | + view_dispatcher_add_view( |
| 166 | + app->view_dispatcher, AirMouseViewMain, air_mouse_view_get_view(app->air_mouse_view)); |
| 167 | + |
| 168 | + app->start_submenu = submenu_alloc(); |
| 169 | + submenu_add_item( |
| 170 | + app->start_submenu, "USB Remote", StartSubmenuIndexUsb, air_mouse_submenu_callback, app); |
| 171 | + submenu_add_item( |
| 172 | + app->start_submenu, |
| 173 | + "Bluetooth Remote", |
| 174 | + StartSubmenuIndexBle, |
| 175 | + air_mouse_submenu_callback, |
| 176 | + app); |
| 177 | + submenu_add_item( |
| 178 | + app->start_submenu, |
| 179 | + "Remove Pairing", |
| 180 | + StartSubmenuIndexBleReset, |
| 181 | + air_mouse_submenu_callback, |
| 182 | + app); |
| 183 | + view_set_previous_callback(submenu_get_view(app->start_submenu), air_mouse_exit); |
| 184 | + view_dispatcher_add_view( |
| 185 | + app->view_dispatcher, AirMouseViewStartSubmenu, submenu_get_view(app->start_submenu)); |
| 186 | + |
| 187 | + app->error_dialog = dialog_ex_alloc(); |
| 188 | + dialog_ex_set_header(app->error_dialog, "Sensor Module error", 63, 0, AlignCenter, AlignTop); |
| 189 | + dialog_ex_set_text(app->error_dialog, "Module not conntected", 63, 30, AlignCenter, AlignTop); |
| 190 | + view_set_previous_callback(dialog_ex_get_view(app->error_dialog), air_mouse_exit); |
| 191 | + view_dispatcher_add_view( |
| 192 | + app->view_dispatcher, AirMouseViewError, dialog_ex_get_view(app->error_dialog)); |
59 | 193 |
|
60 | 194 | return app;
|
61 | 195 | }
|
62 | 196 |
|
63 |
| -static void sensor_module_free(SensorModuleApp* app) { |
64 |
| - gui_remove_view_port(app->gui, app->view_port); |
65 |
| - furi_record_close(RECORD_GUI); |
66 |
| - view_port_free(app->view_port); |
| 197 | +static void air_mouse_free(AirMouseApp* app) { |
| 198 | + view_dispatcher_remove_view(app->view_dispatcher, AirMouseViewStartSubmenu); |
| 199 | + submenu_free(app->start_submenu); |
| 200 | + view_dispatcher_remove_view(app->view_dispatcher, AirMouseViewError); |
| 201 | + dialog_ex_free(app->error_dialog); |
| 202 | + view_dispatcher_remove_view(app->view_dispatcher, AirMouseViewMain); |
| 203 | + air_mouse_view_free(app->air_mouse_view); |
67 | 204 |
|
68 |
| - furi_message_queue_free(app->input_queue); |
| 205 | + view_dispatcher_free(app->view_dispatcher); |
69 | 206 |
|
70 |
| - if(app->imu_thread) { |
71 |
| - imu_stop(app->imu_thread); |
72 |
| - app->imu_thread = NULL; |
73 |
| - } |
74 |
| - |
75 |
| - if(!icm42688p_deinit(app->icm42688p)) { |
76 |
| - FURI_LOG_E(TAG, "Failed to deinitialize ICM42688P"); |
77 |
| - } |
78 |
| - |
79 |
| - icm42688p_free(app->icm42688p); |
80 |
| - free(app->icm42688p_device); |
| 207 | + furi_record_close(RECORD_GUI); |
81 | 208 |
|
82 | 209 | free(app);
|
83 | 210 | }
|
84 | 211 |
|
85 | 212 | int32_t air_mouse_app(void* arg) {
|
86 | 213 | UNUSED(arg);
|
87 |
| - SensorModuleApp* app = sensor_module_alloc(); |
88 |
| - |
89 |
| - if(!app->icm42688p_valid) { |
90 |
| - DialogsApp* dialogs = furi_record_open(RECORD_DIALOGS); |
91 |
| - DialogMessage* message = dialog_message_alloc(); |
92 |
| - dialog_message_set_header(message, "Sensor Module error", 63, 0, AlignCenter, AlignTop); |
| 214 | + AirMouseApp* app = air_mouse_alloc(); |
93 | 215 |
|
94 |
| - dialog_message_set_text(message, "Module not conntected", 63, 30, AlignCenter, AlignTop); |
95 |
| - dialog_message_show(dialogs, message); |
96 |
| - dialog_message_free(message); |
97 |
| - furi_record_close(RECORD_DIALOGS); |
| 216 | + app->icm42688p_device = malloc(sizeof(FuriHalSpiBusHandle)); |
| 217 | + memcpy(app->icm42688p_device, &furi_hal_spi_bus_handle_external, sizeof(FuriHalSpiBusHandle)); |
| 218 | + app->icm42688p_device->cs = &gpio_ext_pc3; |
| 219 | + app->icm42688p = icm42688p_alloc(app->icm42688p_device, &gpio_ext_pb2); |
| 220 | + bool icm42688p_valid = icm42688p_init(app->icm42688p); |
98 | 221 |
|
99 |
| - sensor_module_free(app); |
100 |
| - return 0; |
| 222 | + if(icm42688p_valid) { |
| 223 | + air_mouse_view_set_device(app->air_mouse_view, app->icm42688p); |
| 224 | + view_dispatcher_switch_to_view(app->view_dispatcher, AirMouseViewStartSubmenu); |
| 225 | + } else { |
| 226 | + view_dispatcher_switch_to_view(app->view_dispatcher, AirMouseViewError); |
101 | 227 | }
|
102 | 228 |
|
103 |
| - view_port_update(app->view_port); |
104 |
| - app->imu_thread = imu_start(app->icm42688p); |
105 |
| - |
106 |
| - while(1) { |
107 |
| - InputEvent input; |
108 |
| - if(furi_message_queue_get(app->input_queue, &input, FuriWaitForever) == FuriStatusOk) { |
109 |
| - if((input.key == InputKeyBack) && (input.type == InputTypeShort)) { |
110 |
| - break; |
111 |
| - } else if(input.key == InputKeyOk) { |
112 |
| - if(input.type == InputTypePress) { |
113 |
| - imu_mouse_key_press(app->imu_thread, ImuMouseKeyLeft, true); |
114 |
| - } else if(input.type == InputTypeRelease) { |
115 |
| - imu_mouse_key_press(app->imu_thread, ImuMouseKeyLeft, false); |
116 |
| - } |
117 |
| - } else if(input.key == InputKeyUp) { |
118 |
| - if(input.type == InputTypePress) { |
119 |
| - imu_mouse_key_press(app->imu_thread, ImuMouseKeyRight, true); |
120 |
| - } else if(input.type == InputTypeRelease) { |
121 |
| - imu_mouse_key_press(app->imu_thread, ImuMouseKeyRight, false); |
122 |
| - } |
123 |
| - } |
124 |
| - } |
| 229 | + view_dispatcher_run(app->view_dispatcher); |
| 230 | + |
| 231 | + if(!icm42688p_deinit(app->icm42688p)) { |
| 232 | + FURI_LOG_E(TAG, "Failed to deinitialize ICM42688P"); |
125 | 233 | }
|
126 | 234 |
|
127 |
| - sensor_module_free(app); |
| 235 | + icm42688p_free(app->icm42688p); |
| 236 | + free(app->icm42688p_device); |
| 237 | + |
| 238 | + air_mouse_free(app); |
128 | 239 | return 0;
|
129 | 240 | }
|
0 commit comments