mirror of
https://github.com/DarkFlippers/unleashed-firmware
synced 2024-11-27 06:50:21 +00:00
362 lines
11 KiB
C
362 lines
11 KiB
C
#include <furi_hal_bt_hid.h>
|
|
#include <furi_hal_usb_hid.h>
|
|
#include <services/dev_info_service.h>
|
|
#include <services/battery_service.h>
|
|
#include <services/hid_service.h>
|
|
|
|
#include <furi.h>
|
|
#include <usb_hid.h>
|
|
|
|
#define FURI_HAL_BT_INFO_BASE_USB_SPECIFICATION (0x0101)
|
|
#define FURI_HAL_BT_INFO_COUNTRY_CODE (0x00)
|
|
#define FURI_HAL_BT_HID_INFO_FLAG_REMOTE_WAKE_MSK (0x01)
|
|
#define FURI_HAL_BT_HID_INFO_FLAG_NORMALLY_CONNECTABLE_MSK (0x02)
|
|
|
|
#define FURI_HAL_BT_HID_KB_MAX_KEYS 6
|
|
#define FURI_HAL_BT_HID_CONSUMER_MAX_KEYS 1
|
|
|
|
// Report ids cant be 0
|
|
enum HidReportId {
|
|
ReportIdKeyboard = 1,
|
|
ReportIdMouse = 2,
|
|
ReportIdConsumer = 3,
|
|
ReportIdLEDState = 4,
|
|
};
|
|
// Report numbers corresponded to the report id with an offset of 1
|
|
enum HidInputNumber {
|
|
ReportNumberKeyboard = 0,
|
|
ReportNumberMouse = 1,
|
|
ReportNumberConsumer = 2,
|
|
};
|
|
|
|
typedef struct {
|
|
uint8_t mods;
|
|
uint8_t reserved;
|
|
uint8_t key[FURI_HAL_BT_HID_KB_MAX_KEYS];
|
|
} __attribute__((__packed__)) FuriHalBtHidKbReport;
|
|
|
|
typedef struct {
|
|
uint8_t btn;
|
|
int8_t x;
|
|
int8_t y;
|
|
int8_t wheel;
|
|
} __attribute__((__packed__)) FuriHalBtHidMouseReport;
|
|
|
|
typedef struct {
|
|
uint16_t key[FURI_HAL_BT_HID_CONSUMER_MAX_KEYS];
|
|
} __attribute__((__packed__)) FuriHalBtHidConsumerReport;
|
|
|
|
// keyboard+mouse+consumer hid report
|
|
static const uint8_t furi_hal_bt_hid_report_map_data[] = {
|
|
// Keyboard Report
|
|
HID_USAGE_PAGE(HID_PAGE_DESKTOP),
|
|
HID_USAGE(HID_DESKTOP_KEYBOARD),
|
|
HID_COLLECTION(HID_APPLICATION_COLLECTION),
|
|
HID_REPORT_ID(ReportIdKeyboard),
|
|
HID_USAGE_PAGE(HID_DESKTOP_KEYPAD),
|
|
HID_USAGE_MINIMUM(HID_KEYBOARD_L_CTRL),
|
|
HID_USAGE_MAXIMUM(HID_KEYBOARD_R_GUI),
|
|
HID_LOGICAL_MINIMUM(0),
|
|
HID_LOGICAL_MAXIMUM(1),
|
|
HID_REPORT_SIZE(1),
|
|
HID_REPORT_COUNT(8),
|
|
HID_INPUT(HID_IOF_DATA | HID_IOF_VARIABLE | HID_IOF_ABSOLUTE),
|
|
HID_REPORT_COUNT(1),
|
|
HID_REPORT_SIZE(8),
|
|
HID_INPUT(HID_IOF_CONSTANT | HID_IOF_VARIABLE | HID_IOF_ABSOLUTE),
|
|
HID_USAGE_PAGE(HID_PAGE_LED),
|
|
HID_REPORT_COUNT(8),
|
|
HID_REPORT_SIZE(1),
|
|
HID_USAGE_MINIMUM(1),
|
|
HID_USAGE_MAXIMUM(8),
|
|
HID_OUTPUT(HID_IOF_DATA | HID_IOF_VARIABLE | HID_IOF_ABSOLUTE),
|
|
HID_REPORT_COUNT(FURI_HAL_BT_HID_KB_MAX_KEYS),
|
|
HID_REPORT_SIZE(8),
|
|
HID_LOGICAL_MINIMUM(0),
|
|
HID_LOGICAL_MAXIMUM(101),
|
|
HID_USAGE_PAGE(HID_DESKTOP_KEYPAD),
|
|
HID_USAGE_MINIMUM(0),
|
|
HID_USAGE_MAXIMUM(101),
|
|
HID_INPUT(HID_IOF_DATA | HID_IOF_ARRAY | HID_IOF_ABSOLUTE),
|
|
HID_REPORT_ID(ReportIdLEDState),
|
|
HID_USAGE_PAGE(HID_PAGE_LED),
|
|
HID_REPORT_COUNT(8),
|
|
HID_REPORT_SIZE(1),
|
|
HID_USAGE_MINIMUM(1),
|
|
HID_USAGE_MAXIMUM(8),
|
|
HID_OUTPUT(HID_IOF_DATA | HID_IOF_VARIABLE | HID_IOF_ABSOLUTE),
|
|
HID_END_COLLECTION,
|
|
// Mouse Report
|
|
HID_USAGE_PAGE(HID_PAGE_DESKTOP),
|
|
HID_USAGE(HID_DESKTOP_MOUSE),
|
|
HID_COLLECTION(HID_APPLICATION_COLLECTION),
|
|
HID_USAGE(HID_DESKTOP_POINTER),
|
|
HID_COLLECTION(HID_PHYSICAL_COLLECTION),
|
|
HID_REPORT_ID(ReportIdMouse),
|
|
HID_USAGE_PAGE(HID_PAGE_BUTTON),
|
|
HID_USAGE_MINIMUM(1),
|
|
HID_USAGE_MAXIMUM(3),
|
|
HID_LOGICAL_MINIMUM(0),
|
|
HID_LOGICAL_MAXIMUM(1),
|
|
HID_REPORT_COUNT(3),
|
|
HID_REPORT_SIZE(1),
|
|
HID_INPUT(HID_IOF_DATA | HID_IOF_VARIABLE | HID_IOF_ABSOLUTE),
|
|
HID_REPORT_SIZE(1),
|
|
HID_REPORT_COUNT(5),
|
|
HID_INPUT(HID_IOF_CONSTANT | HID_IOF_VARIABLE | HID_IOF_ABSOLUTE),
|
|
HID_USAGE_PAGE(HID_PAGE_DESKTOP),
|
|
HID_USAGE(HID_DESKTOP_X),
|
|
HID_USAGE(HID_DESKTOP_Y),
|
|
HID_USAGE(HID_DESKTOP_WHEEL),
|
|
HID_LOGICAL_MINIMUM(-127),
|
|
HID_LOGICAL_MAXIMUM(127),
|
|
HID_REPORT_SIZE(8),
|
|
HID_REPORT_COUNT(3),
|
|
HID_INPUT(HID_IOF_DATA | HID_IOF_VARIABLE | HID_IOF_RELATIVE),
|
|
HID_END_COLLECTION,
|
|
HID_END_COLLECTION,
|
|
// Consumer Report
|
|
HID_USAGE_PAGE(HID_PAGE_CONSUMER),
|
|
HID_USAGE(HID_CONSUMER_CONTROL),
|
|
HID_COLLECTION(HID_APPLICATION_COLLECTION),
|
|
HID_REPORT_ID(ReportIdConsumer),
|
|
HID_LOGICAL_MINIMUM(0),
|
|
HID_RI_LOGICAL_MAXIMUM(16, 0x3FF),
|
|
HID_USAGE_MINIMUM(0),
|
|
HID_RI_USAGE_MAXIMUM(16, 0x3FF),
|
|
HID_REPORT_COUNT(FURI_HAL_BT_HID_CONSUMER_MAX_KEYS),
|
|
HID_REPORT_SIZE(16),
|
|
HID_INPUT(HID_IOF_DATA | HID_IOF_ARRAY | HID_IOF_ABSOLUTE),
|
|
HID_END_COLLECTION,
|
|
};
|
|
FuriHalBtHidKbReport* kb_report = NULL;
|
|
FuriHalBtHidMouseReport* mouse_report = NULL;
|
|
FuriHalBtHidConsumerReport* consumer_report = NULL;
|
|
|
|
typedef struct {
|
|
// shortcuts
|
|
#define s_undefined data.bits.b_undefined
|
|
#define s_num_lock data.bits.b_num_lock
|
|
#define s_caps_lock data.bits.b_caps_lock
|
|
#define s_scroll_lock data.bits.b_scroll_lock
|
|
#define s_compose data.bits.b_compose
|
|
#define s_kana data.bits.b_kana
|
|
#define s_power data.bits.b_power
|
|
#define s_shift data.bits.b_shift
|
|
#define s_value data.value
|
|
union {
|
|
struct {
|
|
uint8_t b_undefined : 1;
|
|
uint8_t b_num_lock : 1;
|
|
uint8_t b_caps_lock : 1;
|
|
uint8_t b_scroll_lock : 1;
|
|
uint8_t b_compose : 1;
|
|
uint8_t b_kana : 1;
|
|
uint8_t b_power : 1;
|
|
uint8_t b_shift : 1;
|
|
} bits;
|
|
uint8_t value;
|
|
} data;
|
|
} __attribute__((__packed__)) FuriHalBtHidLedState;
|
|
|
|
FuriHalBtHidLedState hid_host_led_state = {.s_value = 0};
|
|
|
|
uint16_t furi_hal_bt_hid_led_state_cb(uint8_t state, void* ctx) {
|
|
FuriHalBtHidLedState* led_state = (FuriHalBtHidLedState*)ctx;
|
|
|
|
//FURI_LOG_D("HalBtHid", "LED state updated !");
|
|
|
|
led_state->s_value = state;
|
|
|
|
return 0;
|
|
}
|
|
|
|
uint8_t furi_hal_bt_hid_get_led_state(void) {
|
|
/*FURI_LOG_D(
|
|
"HalBtHid",
|
|
"LED state: RFU=%d NUMLOCK=%d CAPSLOCK=%d SCROLLLOCK=%d COMPOSE=%d KANA=%d POWER=%d SHIFT=%d",
|
|
hid_host_led_state.s_undefined,
|
|
hid_host_led_state.s_num_lock,
|
|
hid_host_led_state.s_caps_lock,
|
|
hid_host_led_state.s_scroll_lock,
|
|
hid_host_led_state.s_compose,
|
|
hid_host_led_state.s_kana,
|
|
hid_host_led_state.s_power,
|
|
hid_host_led_state.s_shift);
|
|
*/
|
|
|
|
return (hid_host_led_state.s_value >> 1); // bit 0 is undefined (after shift bit location
|
|
// match with HID led state bits defines)
|
|
// see bad_bt_script.c (ducky_numlock_on function)
|
|
}
|
|
|
|
void furi_hal_bt_hid_start() {
|
|
// Start device info
|
|
if(!dev_info_svc_is_started()) {
|
|
dev_info_svc_start();
|
|
}
|
|
// Start battery service
|
|
if(!battery_svc_is_started()) {
|
|
battery_svc_start();
|
|
}
|
|
// Start HID service
|
|
if(!hid_svc_is_started()) {
|
|
hid_svc_start();
|
|
}
|
|
// Configure HID Keyboard
|
|
hid_svc_register_led_state_callback(furi_hal_bt_hid_led_state_cb, &hid_host_led_state);
|
|
|
|
kb_report = malloc(sizeof(FuriHalBtHidKbReport));
|
|
mouse_report = malloc(sizeof(FuriHalBtHidMouseReport));
|
|
consumer_report = malloc(sizeof(FuriHalBtHidConsumerReport));
|
|
// Configure Report Map characteristic
|
|
hid_svc_update_report_map(
|
|
furi_hal_bt_hid_report_map_data, sizeof(furi_hal_bt_hid_report_map_data));
|
|
// Configure HID Information characteristic
|
|
uint8_t hid_info_val[4] = {
|
|
FURI_HAL_BT_INFO_BASE_USB_SPECIFICATION & 0x00ff,
|
|
(FURI_HAL_BT_INFO_BASE_USB_SPECIFICATION & 0xff00) >> 8,
|
|
FURI_HAL_BT_INFO_COUNTRY_CODE,
|
|
FURI_HAL_BT_HID_INFO_FLAG_REMOTE_WAKE_MSK |
|
|
FURI_HAL_BT_HID_INFO_FLAG_NORMALLY_CONNECTABLE_MSK,
|
|
};
|
|
hid_svc_update_info(hid_info_val);
|
|
}
|
|
|
|
void furi_hal_bt_hid_stop() {
|
|
furi_assert(kb_report);
|
|
furi_assert(mouse_report);
|
|
furi_assert(consumer_report);
|
|
|
|
hid_svc_register_led_state_callback(NULL, NULL);
|
|
// Stop all services
|
|
if(dev_info_svc_is_started()) {
|
|
dev_info_svc_stop();
|
|
}
|
|
if(battery_svc_is_started()) {
|
|
battery_svc_stop();
|
|
}
|
|
if(hid_svc_is_started()) {
|
|
hid_svc_stop();
|
|
}
|
|
free(kb_report);
|
|
free(mouse_report);
|
|
free(consumer_report);
|
|
kb_report = NULL;
|
|
mouse_report = NULL;
|
|
consumer_report = NULL;
|
|
}
|
|
|
|
bool furi_hal_bt_hid_kb_press(uint16_t button) {
|
|
furi_assert(kb_report);
|
|
uint8_t i;
|
|
for(i = 0; i < FURI_HAL_BT_HID_KB_MAX_KEYS; i++) {
|
|
if(kb_report->key[i] == 0) {
|
|
kb_report->key[i] = button & 0xFF;
|
|
break;
|
|
}
|
|
}
|
|
if(i == FURI_HAL_BT_HID_KB_MAX_KEYS) {
|
|
return false;
|
|
}
|
|
kb_report->mods |= (button >> 8);
|
|
return hid_svc_update_input_report(
|
|
ReportNumberKeyboard, (uint8_t*)kb_report, sizeof(FuriHalBtHidKbReport));
|
|
}
|
|
|
|
bool furi_hal_bt_hid_kb_release(uint16_t button) {
|
|
furi_assert(kb_report);
|
|
for(uint8_t i = 0; i < FURI_HAL_BT_HID_KB_MAX_KEYS; i++) {
|
|
if(kb_report->key[i] == (button & 0xFF)) {
|
|
kb_report->key[i] = 0;
|
|
break;
|
|
}
|
|
}
|
|
kb_report->mods &= ~(button >> 8);
|
|
return hid_svc_update_input_report(
|
|
ReportNumberKeyboard, (uint8_t*)kb_report, sizeof(FuriHalBtHidKbReport));
|
|
}
|
|
|
|
bool furi_hal_bt_hid_kb_release_all() {
|
|
furi_assert(kb_report);
|
|
for(uint8_t i = 0; i < FURI_HAL_BT_HID_KB_MAX_KEYS; i++) {
|
|
kb_report->key[i] = 0;
|
|
}
|
|
kb_report->mods = 0;
|
|
return hid_svc_update_input_report(
|
|
ReportNumberKeyboard, (uint8_t*)kb_report, sizeof(FuriHalBtHidKbReport));
|
|
}
|
|
|
|
bool furi_hal_bt_hid_consumer_key_press(uint16_t button) {
|
|
furi_assert(consumer_report);
|
|
for(uint8_t i = 0; i < FURI_HAL_BT_HID_CONSUMER_MAX_KEYS; i++) { //-V1008
|
|
if(consumer_report->key[i] == 0) {
|
|
consumer_report->key[i] = button;
|
|
break;
|
|
}
|
|
}
|
|
return hid_svc_update_input_report(
|
|
ReportNumberConsumer, (uint8_t*)consumer_report, sizeof(FuriHalBtHidConsumerReport));
|
|
}
|
|
|
|
bool furi_hal_bt_hid_consumer_key_release(uint16_t button) {
|
|
furi_assert(consumer_report);
|
|
for(uint8_t i = 0; i < FURI_HAL_BT_HID_CONSUMER_MAX_KEYS; i++) { //-V1008
|
|
if(consumer_report->key[i] == button) {
|
|
consumer_report->key[i] = 0;
|
|
break;
|
|
}
|
|
}
|
|
return hid_svc_update_input_report(
|
|
ReportNumberConsumer, (uint8_t*)consumer_report, sizeof(FuriHalBtHidConsumerReport));
|
|
}
|
|
|
|
bool furi_hal_bt_hid_consumer_key_release_all() {
|
|
furi_assert(consumer_report);
|
|
for(uint8_t i = 0; i < FURI_HAL_BT_HID_CONSUMER_MAX_KEYS; i++) { //-V1008
|
|
consumer_report->key[i] = 0;
|
|
}
|
|
return hid_svc_update_input_report(
|
|
ReportNumberConsumer, (uint8_t*)consumer_report, sizeof(FuriHalBtHidConsumerReport));
|
|
}
|
|
|
|
bool furi_hal_bt_hid_mouse_move(int8_t dx, int8_t dy) {
|
|
furi_assert(mouse_report);
|
|
mouse_report->x = dx;
|
|
mouse_report->y = dy;
|
|
bool state = hid_svc_update_input_report(
|
|
ReportNumberMouse, (uint8_t*)mouse_report, sizeof(FuriHalBtHidMouseReport));
|
|
mouse_report->x = 0;
|
|
mouse_report->y = 0;
|
|
return state;
|
|
}
|
|
|
|
bool furi_hal_bt_hid_mouse_press(uint8_t button) {
|
|
furi_assert(mouse_report);
|
|
mouse_report->btn |= button;
|
|
return hid_svc_update_input_report(
|
|
ReportNumberMouse, (uint8_t*)mouse_report, sizeof(FuriHalBtHidMouseReport));
|
|
}
|
|
|
|
bool furi_hal_bt_hid_mouse_release(uint8_t button) {
|
|
furi_assert(mouse_report);
|
|
mouse_report->btn &= ~button;
|
|
return hid_svc_update_input_report(
|
|
ReportNumberMouse, (uint8_t*)mouse_report, sizeof(FuriHalBtHidMouseReport));
|
|
}
|
|
|
|
bool furi_hal_bt_hid_mouse_release_all() {
|
|
furi_assert(mouse_report);
|
|
mouse_report->btn = 0;
|
|
return hid_svc_update_input_report(
|
|
ReportNumberMouse, (uint8_t*)mouse_report, sizeof(FuriHalBtHidMouseReport));
|
|
}
|
|
|
|
bool furi_hal_bt_hid_mouse_scroll(int8_t delta) {
|
|
furi_assert(mouse_report);
|
|
mouse_report->wheel = delta;
|
|
bool state = hid_svc_update_input_report(
|
|
ReportNumberMouse, (uint8_t*)mouse_report, sizeof(FuriHalBtHidMouseReport));
|
|
mouse_report->wheel = 0;
|
|
return state;
|
|
}
|