[FL-2010] furi-hal-vcp rework (#812)

* [FL-2010] furi-hal-vcp rework
* Fix connect state change on vcp enable
* New thread naming scheme and stack size adjustment.
* Applications: rename worker threads to match new naming scheme.

Co-authored-by: Aleksandr Kutuzov <alleteam@gmail.com>
This commit is contained in:
Nikolay Minaylov 2021-11-11 19:17:50 +03:00 committed by GitHub
parent ac8b1457f2
commit b564e8eb38
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
22 changed files with 364 additions and 263 deletions

View File

@ -65,55 +65,55 @@ extern int32_t power_settings_app(void* p);
const FlipperApplication FLIPPER_SERVICES[] = { const FlipperApplication FLIPPER_SERVICES[] = {
/* Services */ /* Services */
#ifdef SRV_RPC #ifdef SRV_RPC
{.app = rpc_srv, .name = "RPC", .stack_size = 1024 * 4, .icon = NULL}, {.app = rpc_srv, .name = "RpcSrv", .stack_size = 1024 * 4, .icon = NULL},
#endif #endif
#ifdef SRV_BT #ifdef SRV_BT
{.app = bt_srv, .name = "BT", .stack_size = 1024, .icon = NULL}, {.app = bt_srv, .name = "BtSrv", .stack_size = 1024, .icon = NULL},
#endif #endif
#ifdef SRV_CLI #ifdef SRV_CLI
{.app = cli_srv, .name = "Cli", .stack_size = 4096, .icon = NULL}, {.app = cli_srv, .name = "CliSrv", .stack_size = 4096, .icon = NULL},
#endif #endif
#ifdef SRV_DIALOGS #ifdef SRV_DIALOGS
{.app = dialogs_srv, .name = "Dialogs", .stack_size = 1024, .icon = NULL}, {.app = dialogs_srv, .name = "DialogsSrv", .stack_size = 1024, .icon = NULL},
#endif #endif
#ifdef SRV_DOLPHIN #ifdef SRV_DOLPHIN
{.app = dolphin_srv, .name = "Dolphin", .stack_size = 1024, .icon = NULL}, {.app = dolphin_srv, .name = "DolphinSrv", .stack_size = 1024, .icon = NULL},
#endif #endif
#ifdef SRV_DESKTOP #ifdef SRV_DESKTOP
{.app = desktop_srv, .name = "Desktop", .stack_size = 1024, .icon = NULL}, {.app = desktop_srv, .name = "DesktopSrv", .stack_size = 2048, .icon = NULL},
#endif #endif
#ifdef SRV_GUI #ifdef SRV_GUI
{.app = gui_srv, .name = "Gui", .stack_size = 8192, .icon = NULL}, {.app = gui_srv, .name = "GuiSrv", .stack_size = 2048, .icon = NULL},
#endif #endif
#ifdef SRV_INPUT #ifdef SRV_INPUT
{.app = input_srv, .name = "Input", .stack_size = 1024, .icon = NULL}, {.app = input_srv, .name = "InputSrv", .stack_size = 1024, .icon = NULL},
#endif #endif
#ifdef SRV_LOADER #ifdef SRV_LOADER
{.app = loader_srv, .name = "Loader", .stack_size = 1024, .icon = NULL}, {.app = loader_srv, .name = "LoaderSrv", .stack_size = 1024, .icon = NULL},
#endif #endif
#ifdef SRV_NOTIFICATION #ifdef SRV_NOTIFICATION
{.app = notification_srv, .name = "Notification", .stack_size = 1024, .icon = NULL}, {.app = notification_srv, .name = "NotificationSrv", .stack_size = 1536, .icon = NULL},
#endif #endif
#ifdef SRV_POWER #ifdef SRV_POWER
{.app = power_srv, .name = "Power", .stack_size = 1024, .icon = NULL}, {.app = power_srv, .name = "PowerSrv", .stack_size = 1024, .icon = NULL},
#endif #endif
#ifdef SRV_POWER_OBSERVER #ifdef SRV_POWER_OBSERVER
{.app = power_observer_srv, .name = "PowerObserver", .stack_size = 1024, .icon = NULL}, {.app = power_observer_srv, .name = "PowerAuditSrv", .stack_size = 1024, .icon = NULL},
#endif #endif
#ifdef SRV_STORAGE #ifdef SRV_STORAGE
{.app = storage_srv, .name = "Storage", .stack_size = 4096, .icon = NULL}, {.app = storage_srv, .name = "StorageSrv", .stack_size = 3072, .icon = NULL},
#endif #endif
}; };

View File

@ -8,11 +8,12 @@
#define USB_UART_RX_BUF_SIZE (USB_CDC_PKT_LEN * 5) #define USB_UART_RX_BUF_SIZE (USB_CDC_PKT_LEN * 5)
typedef enum { typedef enum {
WorkerEvtStop = (1 << 0), WorkerEvtReserved = (1 << 0), // Reserved for StreamBuffer internal event
WorkerEvtRxDone = (1 << 1), WorkerEvtStop = (1 << 1),
WorkerEvtRxDone = (1 << 2),
WorkerEvtTxStop = (1 << 2), WorkerEvtTxStop = (1 << 3),
WorkerEvtCdcRx = (1 << 3), WorkerEvtCdcRx = (1 << 4),
} WorkerEvtFlags; } WorkerEvtFlags;
#define WORKER_ALL_RX_EVENTS (WorkerEvtStop | WorkerEvtRxDone) #define WORKER_ALL_RX_EVENTS (WorkerEvtStop | WorkerEvtRxDone)
@ -75,7 +76,7 @@ static int32_t usb_uart_worker(void* context) {
usb_uart->usb_mutex = osMutexNew(NULL); usb_uart->usb_mutex = osMutexNew(NULL);
usb_uart->tx_thread = furi_thread_alloc(); usb_uart->tx_thread = furi_thread_alloc();
furi_thread_set_name(usb_uart->tx_thread, "usb_uart_tx"); furi_thread_set_name(usb_uart->tx_thread, "UsbUartTxWorker");
furi_thread_set_stack_size(usb_uart->tx_thread, 512); furi_thread_set_stack_size(usb_uart->tx_thread, 512);
furi_thread_set_context(usb_uart->tx_thread, NULL); furi_thread_set_context(usb_uart->tx_thread, NULL);
furi_thread_set_callback(usb_uart->tx_thread, usb_uart_tx_thread); furi_thread_set_callback(usb_uart->tx_thread, usb_uart_tx_thread);
@ -191,7 +192,7 @@ void usb_uart_enable(UsbUartConfig* cfg) {
usb_uart = furi_alloc(sizeof(UsbUartParams)); usb_uart = furi_alloc(sizeof(UsbUartParams));
usb_uart->thread = furi_thread_alloc(); usb_uart->thread = furi_thread_alloc();
furi_thread_set_name(usb_uart->thread, "usb_uart"); furi_thread_set_name(usb_uart->thread, "UsbUartWorker");
furi_thread_set_stack_size(usb_uart->thread, 1024); furi_thread_set_stack_size(usb_uart->thread, 1024);
furi_thread_set_context(usb_uart->thread, cfg); furi_thread_set_context(usb_uart->thread, cfg);
furi_thread_set_callback(usb_uart->thread, usb_uart_worker); furi_thread_set_callback(usb_uart->thread, usb_uart_worker);

View File

@ -10,7 +10,7 @@
NfcWorker* nfc_worker_alloc() { NfcWorker* nfc_worker_alloc() {
NfcWorker* nfc_worker = furi_alloc(sizeof(NfcWorker)); NfcWorker* nfc_worker = furi_alloc(sizeof(NfcWorker));
// Worker thread attributes // Worker thread attributes
nfc_worker->thread_attr.name = "nfc_worker"; nfc_worker->thread_attr.name = "NfcWorker";
nfc_worker->thread_attr.stack_size = 8192; nfc_worker->thread_attr.stack_size = 8192;
nfc_worker->callback = NULL; nfc_worker->callback = NULL;
nfc_worker->context = NULL; nfc_worker->context = NULL;

View File

@ -145,7 +145,7 @@ SubGhzFrequencyAnalyzerWorker* subghz_frequency_analyzer_worker_alloc() {
SubGhzFrequencyAnalyzerWorker* instance = furi_alloc(sizeof(SubGhzFrequencyAnalyzerWorker)); SubGhzFrequencyAnalyzerWorker* instance = furi_alloc(sizeof(SubGhzFrequencyAnalyzerWorker));
instance->thread = furi_thread_alloc(); instance->thread = furi_thread_alloc();
furi_thread_set_name(instance->thread, "subghz_frequency_analyzer_worker"); furi_thread_set_name(instance->thread, "SubghzFAWorker");
furi_thread_set_stack_size(instance->thread, 2048); furi_thread_set_stack_size(instance->thread, 2048);
furi_thread_set_context(instance->thread, instance); furi_thread_set_context(instance->thread, instance);
furi_thread_set_callback(instance->thread, subghz_frequency_analyzer_worker_thread); furi_thread_set_callback(instance->thread, subghz_frequency_analyzer_worker_thread);

View File

@ -101,6 +101,9 @@
#define configTIMER_TASK_PRIORITY ( 2 ) #define configTIMER_TASK_PRIORITY ( 2 )
#define configTIMER_QUEUE_LENGTH 32 #define configTIMER_QUEUE_LENGTH 32
#define configTIMER_TASK_STACK_DEPTH 256 #define configTIMER_TASK_STACK_DEPTH 256
#define configTIMER_SERVICE_TASK_NAME "TimersSrv"
#define configIDLE_TASK_NAME "(-_-)"
/* Set the following definitions to 1 to include the API function, or zero /* Set the following definitions to 1 to include the API function, or zero
to exclude the API function. */ to exclude the API function. */

View File

@ -33,7 +33,7 @@ bool ble_app_init() {
ble_app->hci_mtx = osMutexNew(NULL); ble_app->hci_mtx = osMutexNew(NULL);
ble_app->hci_sem = osSemaphoreNew(1, 0, NULL); ble_app->hci_sem = osSemaphoreNew(1, 0, NULL);
// HCI transport layer thread to handle user asynch events // HCI transport layer thread to handle user asynch events
ble_app->hci_thread_attr.name = "ble hci"; ble_app->hci_thread_attr.name = "BleHciWorker";
ble_app->hci_thread_attr.stack_size = 1024; ble_app->hci_thread_attr.stack_size = 1024;
ble_app->hci_thread_id = osThreadNew(ble_app_hci_thread, NULL, &ble_app->hci_thread_attr); ble_app->hci_thread_id = osThreadNew(ble_app_hci_thread, NULL, &ble_app->hci_thread_attr);

View File

@ -50,7 +50,7 @@ void ble_glue_set_key_storage_changed_callback(BleGlueKeyStorageChangedCallback
void ble_glue_init() { void ble_glue_init() {
ble_glue = furi_alloc(sizeof(BleGlue)); ble_glue = furi_alloc(sizeof(BleGlue));
ble_glue->status = BleGlueStatusStartup; ble_glue->status = BleGlueStatusStartup;
ble_glue->shci_user_event_thread_attr.name = "ble_shci_evt"; ble_glue->shci_user_event_thread_attr.name = "BleShciWorker";
ble_glue->shci_user_event_thread_attr.stack_size = 1024; ble_glue->shci_user_event_thread_attr.stack_size = 1024;
// Configure the system Power Mode // Configure the system Power Mode

View File

@ -393,7 +393,7 @@ bool gap_init(BleEventCallback on_event_cb, void* context) {
gap->enable_adv = true; gap->enable_adv = true;
// Thread configuration // Thread configuration
gap->thread_attr.name = "BLE advertising"; gap->thread_attr.name = "BleGapWorker";
gap->thread_attr.stack_size = 1024; 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);

View File

@ -345,6 +345,7 @@ static const struct CdcConfigDescriptorDual cdc_cfg_desc_dual = {
}; };
static struct usb_cdc_line_coding cdc_config[IF_NUM_MAX] = {}; static struct usb_cdc_line_coding cdc_config[IF_NUM_MAX] = {};
static uint8_t cdc_ctrl_line_state[IF_NUM_MAX];
static void cdc_init(usbd_device* dev, struct UsbInterface* intf); static void cdc_init(usbd_device* dev, struct UsbInterface* intf);
static void cdc_deinit(usbd_device *dev); static void cdc_deinit(usbd_device *dev);
@ -438,6 +439,12 @@ struct usb_cdc_line_coding* furi_hal_cdc_get_port_settings(uint8_t if_num) {
return NULL; return NULL;
} }
uint8_t furi_hal_cdc_get_ctrl_line_state(uint8_t if_num) {
if (if_num < 2)
return cdc_ctrl_line_state[if_num];
return 0;
}
void furi_hal_cdc_send(uint8_t if_num, uint8_t* buf, uint16_t len) { void furi_hal_cdc_send(uint8_t if_num, uint8_t* buf, uint16_t len) {
if (if_num == 0) if (if_num == 0)
usbd_ep_write(usb_dev, CDC0_TXD_EP, buf, len); usbd_ep_write(usb_dev, CDC0_TXD_EP, buf, len);
@ -465,6 +472,7 @@ static void cdc_on_wakeup(usbd_device *dev) {
static void cdc_on_suspend(usbd_device *dev) { static void cdc_on_suspend(usbd_device *dev) {
for (uint8_t i = 0; i < IF_NUM_MAX; i++) { for (uint8_t i = 0; i < IF_NUM_MAX; i++) {
cdc_ctrl_line_state[i] = 0;
if (callbacks[i] != NULL) { if (callbacks[i] != NULL) {
if (callbacks[i]->state_callback != NULL) if (callbacks[i]->state_callback != NULL)
callbacks[i]->state_callback(0); callbacks[i]->state_callback(0);
@ -580,8 +588,9 @@ static usbd_respond cdc_control(usbd_device* dev, usbd_ctlreq* req, usbd_rqc_cal
switch(req->bRequest) { switch(req->bRequest) {
case USB_CDC_SET_CONTROL_LINE_STATE: case USB_CDC_SET_CONTROL_LINE_STATE:
if (callbacks[if_num] != NULL) { if (callbacks[if_num] != NULL) {
cdc_ctrl_line_state[if_num] = req->wValue;
if (callbacks[if_num]->ctrl_line_callback != NULL) if (callbacks[if_num]->ctrl_line_callback != NULL)
callbacks[if_num]->ctrl_line_callback(req->wValue); callbacks[if_num]->ctrl_line_callback(cdc_ctrl_line_state[if_num]);
} }
return usbd_ack; return usbd_ack;
case USB_CDC_SET_LINE_CODING: case USB_CDC_SET_LINE_CODING:

View File

@ -17,6 +17,8 @@ void furi_hal_cdc_set_callbacks(uint8_t if_num, CdcCallbacks* cb);
struct usb_cdc_line_coding* furi_hal_cdc_get_port_settings(uint8_t if_num); struct usb_cdc_line_coding* furi_hal_cdc_get_port_settings(uint8_t if_num);
uint8_t furi_hal_cdc_get_ctrl_line_state(uint8_t if_num);
void furi_hal_cdc_send(uint8_t if_num, uint8_t* buf, uint16_t len); void furi_hal_cdc_send(uint8_t if_num, uint8_t* buf, uint16_t len);
int32_t furi_hal_cdc_receive(uint8_t if_num, uint8_t* buf, uint16_t max_len); int32_t furi_hal_cdc_receive(uint8_t if_num, uint8_t* buf, uint16_t max_len);

View File

@ -4,29 +4,37 @@
#include <stream_buffer.h> #include <stream_buffer.h>
#define USB_CDC_PKT_LEN CDC_DATA_SZ #define USB_CDC_PKT_LEN CDC_DATA_SZ
#define VCP_RX_BUF_SIZE (USB_CDC_PKT_LEN * 3)
#define VCP_TX_BUF_SIZE (USB_CDC_PKT_LEN * 3)
#define VCP_IF_NUM 0 #define VCP_IF_NUM 0
typedef enum { typedef enum {
VcpConnect, VcpEvtReserved = (1 << 0), // Reserved for StreamBuffer internal event
VcpDisconnect, VcpEvtConnect = (1 << 1),
} VcpEvent; VcpEvtDisconnect = (1 << 2),
VcpEvtEnable = (1 << 3),
VcpEvtDisable = (1 << 4),
VcpEvtRx = (1 << 5),
VcpEvtTx = (1 << 6),
VcpEvtRxDone = (1 << 7),
VcpEvtTxDone = (1 << 8),
} WorkerEvtFlags;
#define VCP_THREAD_FLAG_ALL (VcpEvtConnect | VcpEvtDisconnect | VcpEvtEnable | VcpEvtDisable | VcpEvtRx | VcpEvtTx | VcpEvtRxDone | VcpEvtTxDone)
typedef struct { typedef struct {
FuriThread* thread;
StreamBufferHandle_t tx_stream;
StreamBufferHandle_t rx_stream;
volatile bool connected; volatile bool connected;
uint8_t rx_buf[USB_CDC_PKT_LEN]; uint8_t data_buffer[USB_CDC_PKT_LEN];
uint8_t rx_buf_start;
uint8_t rx_buf_len;
osMessageQueueId_t event_queue;
osMutexId_t usb_mutex;
osSemaphoreId_t tx_sem;
osSemaphoreId_t rx_sem;
} FuriHalVcp; } FuriHalVcp;
static int32_t vcp_worker(void* context);
static void vcp_on_cdc_tx_complete(); static void vcp_on_cdc_tx_complete();
static void vcp_on_cdc_rx(); static void vcp_on_cdc_rx();
static void vcp_state_callback(uint8_t state); static void vcp_state_callback(uint8_t state);
@ -49,34 +57,117 @@ void furi_hal_vcp_init() {
vcp = furi_alloc(sizeof(FuriHalVcp)); vcp = furi_alloc(sizeof(FuriHalVcp));
vcp->connected = false; vcp->connected = false;
vcp->usb_mutex = osMutexNew(NULL); vcp->tx_stream = xStreamBufferCreate(VCP_TX_BUF_SIZE, 1);
vcp->rx_stream = xStreamBufferCreate(VCP_RX_BUF_SIZE, 1);
vcp->tx_sem = osSemaphoreNew(1, 1, NULL); vcp->thread = furi_thread_alloc();
vcp->rx_sem = osSemaphoreNew(1, 0, NULL); furi_thread_set_name(vcp->thread, "VcpWorker");
furi_thread_set_stack_size(vcp->thread, 512);
vcp->event_queue = osMessageQueueNew(8, sizeof(VcpEvent), NULL); furi_thread_set_callback(vcp->thread, vcp_worker);
furi_thread_start(vcp->thread);
furi_hal_cdc_set_callbacks(VCP_IF_NUM, &cdc_cb);
FURI_LOG_I("FuriHalVcp", "Init OK"); FURI_LOG_I("FuriHalVcp", "Init OK");
} }
void furi_hal_vcp_enable() { static int32_t vcp_worker(void* context) {
bool enabled = true;
bool tx_idle = false;
bool rx_pending = false;
furi_hal_cdc_set_callbacks(VCP_IF_NUM, &cdc_cb); furi_hal_cdc_set_callbacks(VCP_IF_NUM, &cdc_cb);
VcpEvent evt = VcpConnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0); while (1) {
uint32_t flags = osThreadFlagsWait(VCP_THREAD_FLAG_ALL, osFlagsWaitAny, osWaitForever);
furi_assert((flags & osFlagsError) == 0);
// New data received
if((flags & VcpEvtRxDone) && enabled) {
if (xStreamBufferSpacesAvailable(vcp->rx_stream) >= USB_CDC_PKT_LEN) {
size_t len = furi_hal_cdc_receive(VCP_IF_NUM, vcp->data_buffer, USB_CDC_PKT_LEN);
if (len > 0)
xStreamBufferSend(vcp->rx_stream, vcp->data_buffer, len, osWaitForever);
else
rx_pending = false;
} else
rx_pending = true; // Buffer is full, retry later
}
// Rx buffer was read, maybe there is enough space for new data?
if((flags & VcpEvtRx) && rx_pending) {
if (xStreamBufferSpacesAvailable(vcp->rx_stream) >= USB_CDC_PKT_LEN) {
size_t len = furi_hal_cdc_receive(VCP_IF_NUM, vcp->data_buffer, USB_CDC_PKT_LEN);
if (len > 0)
xStreamBufferSend(vcp->rx_stream, vcp->data_buffer, len, osWaitForever);
else
rx_pending = false;
}
}
// New data in Tx buffer
if((flags & VcpEvtTx) && enabled) {
if (tx_idle) {
size_t len = xStreamBufferReceive(vcp->tx_stream, vcp->data_buffer, USB_CDC_PKT_LEN, 0);
if (len > 0) {
tx_idle = false;
furi_hal_cdc_send(VCP_IF_NUM, vcp->data_buffer, len);
}
}
}
// CDC write transfer done
if((flags & VcpEvtTxDone) && enabled) {
size_t len = xStreamBufferReceive(vcp->tx_stream, vcp->data_buffer, USB_CDC_PKT_LEN, 0);
if (len > 0) { // Some data left in Tx buffer. Sending it now
tx_idle = false;
furi_hal_cdc_send(VCP_IF_NUM, vcp->data_buffer, len);
} else { // There is nothing to send. Set flag to start next transfer instantly
tx_idle = true;
}
}
// VCP session opened
if((flags & VcpEvtConnect) && enabled) {
if (vcp->connected == false) {
vcp->connected = true; vcp->connected = true;
osSemaphoreRelease(vcp->tx_sem); xStreamBufferSend(vcp->rx_stream, &ascii_soh, 1, osWaitForever);
osSemaphoreRelease(vcp->rx_sem); }
}
// VCP session closed
if((flags & VcpEvtDisconnect) && enabled) {
if (vcp->connected == true) {
vcp->connected = false;
xStreamBufferSend(vcp->rx_stream, &ascii_eot, 1, osWaitForever);
}
}
// VCP enabled
if((flags & VcpEvtEnable) && !enabled){
furi_hal_cdc_set_callbacks(VCP_IF_NUM, &cdc_cb);
enabled = true;
furi_hal_cdc_receive(VCP_IF_NUM, vcp->data_buffer, USB_CDC_PKT_LEN); // flush Rx buffer
if (furi_hal_cdc_get_ctrl_line_state(VCP_IF_NUM) & (1 << 0)) {
vcp->connected = true;
xStreamBufferSend(vcp->rx_stream, &ascii_soh, 1, osWaitForever);
}
}
// VCP disabled
if((flags & VcpEvtDisable) && enabled) {
enabled = false;
vcp->connected = false;
xStreamBufferSend(vcp->rx_stream, &ascii_eot, 1, osWaitForever);
}
}
return 0;
}
void furi_hal_vcp_enable() {
osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtEnable);
} }
void furi_hal_vcp_disable() { void furi_hal_vcp_disable() {
furi_hal_cdc_set_callbacks(VCP_IF_NUM, NULL); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtDisable);
VcpEvent evt = VcpDisconnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0);
vcp->connected = false;
osSemaphoreRelease(vcp->tx_sem);
osSemaphoreRelease(vcp->rx_sem);
} }
size_t furi_hal_vcp_rx_with_timeout(uint8_t* buffer, size_t size, uint32_t timeout) { size_t furi_hal_vcp_rx_with_timeout(uint8_t* buffer, size_t size, uint32_t timeout) {
@ -85,47 +176,17 @@ size_t furi_hal_vcp_rx_with_timeout(uint8_t* buffer, size_t size, uint32_t timeo
size_t rx_cnt = 0; size_t rx_cnt = 0;
VcpEvent evt = VcpDisconnect; while (size > 0) {
size_t batch_size = size;
if (batch_size > VCP_RX_BUF_SIZE)
batch_size = VCP_RX_BUF_SIZE;
if (vcp->rx_buf_len > 0) { size_t len = xStreamBufferReceive(vcp->rx_stream, buffer, batch_size, timeout);
size_t len = (vcp->rx_buf_len > size) ? (size) : (vcp->rx_buf_len); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtRx);
memcpy(&buffer[rx_cnt], &vcp->rx_buf[vcp->rx_buf_start], len); if (len == 0)
vcp->rx_buf_len -= len; break;
vcp->rx_buf_start += len; size -= len;
rx_cnt += len; buffer += len;
}
while (rx_cnt < size) {
if (osMessageQueueGet(vcp->event_queue, &evt, NULL, 0) == osOK) {
if (evt == VcpConnect)
buffer[rx_cnt] = ascii_soh;
else {
buffer[rx_cnt] = ascii_eot;
vcp->rx_buf_len = 0;
}
rx_cnt++;
return rx_cnt;
}
if (osSemaphoreAcquire(vcp->rx_sem, timeout) == osErrorTimeout)
return rx_cnt;
furi_check(osMutexAcquire(vcp->usb_mutex, osWaitForever) == osOK);
size_t len = furi_hal_cdc_receive(VCP_IF_NUM, vcp->rx_buf, USB_CDC_PKT_LEN);
furi_check(osMutexRelease(vcp->usb_mutex) == osOK);
vcp->rx_buf_len = len;
vcp->rx_buf_start = 0;
if (vcp->rx_buf_len > (size - rx_cnt)) {
len = size - rx_cnt;
memcpy(&buffer[rx_cnt], vcp->rx_buf, len);
vcp->rx_buf_len -= len;
vcp->rx_buf_start += len;
} else {
memcpy(&buffer[rx_cnt], vcp->rx_buf, vcp->rx_buf_len);
vcp->rx_buf_len = 0;
}
rx_cnt += len; rx_cnt += len;
} }
return rx_cnt; return rx_cnt;
@ -133,26 +194,20 @@ size_t furi_hal_vcp_rx_with_timeout(uint8_t* buffer, size_t size, uint32_t timeo
size_t furi_hal_vcp_rx(uint8_t* buffer, size_t size) { size_t furi_hal_vcp_rx(uint8_t* buffer, size_t size) {
furi_assert(vcp); furi_assert(vcp);
return furi_hal_vcp_rx_with_timeout(buffer, size, osWaitForever);
return furi_hal_vcp_rx_with_timeout(buffer, size, portMAX_DELAY);
} }
void furi_hal_vcp_tx(const uint8_t* buffer, size_t size) { void furi_hal_vcp_tx(const uint8_t* buffer, size_t size) {
furi_assert(vcp); furi_assert(vcp);
furi_assert(buffer);
while (size > 0 && vcp->connected) { while (size > 0) {
furi_check(osSemaphoreAcquire(vcp->tx_sem, osWaitForever) == osOK);
if (!vcp->connected)
break;
size_t batch_size = size; size_t batch_size = size;
if (batch_size > USB_CDC_PKT_LEN) { if (batch_size > VCP_TX_BUF_SIZE)
batch_size = USB_CDC_PKT_LEN; batch_size = VCP_TX_BUF_SIZE;
}
furi_check(osMutexAcquire(vcp->usb_mutex, osWaitForever) == osOK); xStreamBufferSend(vcp->tx_stream, buffer, batch_size, osWaitForever);
furi_hal_cdc_send(VCP_IF_NUM, (uint8_t*)buffer, batch_size); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtTx);
furi_check(osMutexRelease(vcp->usb_mutex) == osOK);
size -= batch_size; size -= batch_size;
buffer += batch_size; buffer += batch_size;
@ -160,52 +215,33 @@ void furi_hal_vcp_tx(const uint8_t* buffer, size_t size) {
} }
static void vcp_state_callback(uint8_t state) { static void vcp_state_callback(uint8_t state) {
if (state == 1) { if (state == 0) {
osSemaphoreRelease(vcp->rx_sem); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtDisconnect);
//osSemaphoreRelease(vcp->tx_sem);
}
else if (vcp->connected) {
vcp->connected = false;
osSemaphoreRelease(vcp->rx_sem);
VcpEvent evt = VcpDisconnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0);
//osSemaphoreRelease(vcp->tx_sem);
} }
} }
static void vcp_on_cdc_control_line(uint8_t state) { static void vcp_on_cdc_control_line(uint8_t state) {
// bit 0: DTR state, bit 1: RTS state // bit 0: DTR state, bit 1: RTS state
bool dtr = state & 0b1; bool dtr = state & (1 << 0);
if (dtr) { if (dtr == true) {
if (!vcp->connected) { osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtConnect);
vcp->connected = true;
VcpEvent evt = VcpConnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0);
}
} else { } else {
if (vcp->connected) { osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtDisconnect);
VcpEvent evt = VcpDisconnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0);
vcp->connected = false;
} }
}
osSemaphoreRelease(vcp->tx_sem);
osSemaphoreRelease(vcp->rx_sem);
} }
static void vcp_on_cdc_rx() { static void vcp_on_cdc_rx() {
if (vcp->connected == false) uint32_t ret = osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtRxDone);
return; furi_assert((ret & osFlagsError) == 0);
osSemaphoreRelease(vcp->rx_sem);
} }
static void vcp_on_cdc_tx_complete() { static void vcp_on_cdc_tx_complete() {
osSemaphoreRelease(vcp->tx_sem); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtTxDone);
} }
bool furi_hal_vcp_is_connected(void) { bool furi_hal_vcp_is_connected(void) {
furi_assert(vcp);
return vcp->connected; return vcp->connected;
} }

View File

@ -101,6 +101,9 @@
#define configTIMER_TASK_PRIORITY ( 2 ) #define configTIMER_TASK_PRIORITY ( 2 )
#define configTIMER_QUEUE_LENGTH 32 #define configTIMER_QUEUE_LENGTH 32
#define configTIMER_TASK_STACK_DEPTH 256 #define configTIMER_TASK_STACK_DEPTH 256
#define configTIMER_SERVICE_TASK_NAME "TimersSrv"
#define configIDLE_TASK_NAME "(-_-)"
/* Set the following definitions to 1 to include the API function, or zero /* Set the following definitions to 1 to include the API function, or zero
to exclude the API function. */ to exclude the API function. */

View File

@ -33,7 +33,7 @@ bool ble_app_init() {
ble_app->hci_mtx = osMutexNew(NULL); ble_app->hci_mtx = osMutexNew(NULL);
ble_app->hci_sem = osSemaphoreNew(1, 0, NULL); ble_app->hci_sem = osSemaphoreNew(1, 0, NULL);
// HCI transport layer thread to handle user asynch events // HCI transport layer thread to handle user asynch events
ble_app->hci_thread_attr.name = "ble hci"; ble_app->hci_thread_attr.name = "BleHciWorker";
ble_app->hci_thread_attr.stack_size = 1024; ble_app->hci_thread_attr.stack_size = 1024;
ble_app->hci_thread_id = osThreadNew(ble_app_hci_thread, NULL, &ble_app->hci_thread_attr); ble_app->hci_thread_id = osThreadNew(ble_app_hci_thread, NULL, &ble_app->hci_thread_attr);

View File

@ -50,7 +50,7 @@ void ble_glue_set_key_storage_changed_callback(BleGlueKeyStorageChangedCallback
void ble_glue_init() { void ble_glue_init() {
ble_glue = furi_alloc(sizeof(BleGlue)); ble_glue = furi_alloc(sizeof(BleGlue));
ble_glue->status = BleGlueStatusStartup; ble_glue->status = BleGlueStatusStartup;
ble_glue->shci_user_event_thread_attr.name = "ble_shci_evt"; ble_glue->shci_user_event_thread_attr.name = "BleShciWorker";
ble_glue->shci_user_event_thread_attr.stack_size = 1024; ble_glue->shci_user_event_thread_attr.stack_size = 1024;
// Configure the system Power Mode // Configure the system Power Mode

View File

@ -393,7 +393,7 @@ bool gap_init(BleEventCallback on_event_cb, void* context) {
gap->enable_adv = true; gap->enable_adv = true;
// Thread configuration // Thread configuration
gap->thread_attr.name = "BLE advertising"; gap->thread_attr.name = "BleGapWorker";
gap->thread_attr.stack_size = 1024; 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);

View File

@ -345,6 +345,7 @@ static const struct CdcConfigDescriptorDual cdc_cfg_desc_dual = {
}; };
static struct usb_cdc_line_coding cdc_config[IF_NUM_MAX] = {}; static struct usb_cdc_line_coding cdc_config[IF_NUM_MAX] = {};
static uint8_t cdc_ctrl_line_state[IF_NUM_MAX];
static void cdc_init(usbd_device* dev, struct UsbInterface* intf); static void cdc_init(usbd_device* dev, struct UsbInterface* intf);
static void cdc_deinit(usbd_device *dev); static void cdc_deinit(usbd_device *dev);
@ -438,6 +439,12 @@ struct usb_cdc_line_coding* furi_hal_cdc_get_port_settings(uint8_t if_num) {
return NULL; return NULL;
} }
uint8_t furi_hal_cdc_get_ctrl_line_state(uint8_t if_num) {
if (if_num < 2)
return cdc_ctrl_line_state[if_num];
return 0;
}
void furi_hal_cdc_send(uint8_t if_num, uint8_t* buf, uint16_t len) { void furi_hal_cdc_send(uint8_t if_num, uint8_t* buf, uint16_t len) {
if (if_num == 0) if (if_num == 0)
usbd_ep_write(usb_dev, CDC0_TXD_EP, buf, len); usbd_ep_write(usb_dev, CDC0_TXD_EP, buf, len);
@ -465,6 +472,7 @@ static void cdc_on_wakeup(usbd_device *dev) {
static void cdc_on_suspend(usbd_device *dev) { static void cdc_on_suspend(usbd_device *dev) {
for (uint8_t i = 0; i < IF_NUM_MAX; i++) { for (uint8_t i = 0; i < IF_NUM_MAX; i++) {
cdc_ctrl_line_state[i] = 0;
if (callbacks[i] != NULL) { if (callbacks[i] != NULL) {
if (callbacks[i]->state_callback != NULL) if (callbacks[i]->state_callback != NULL)
callbacks[i]->state_callback(0); callbacks[i]->state_callback(0);
@ -580,8 +588,9 @@ static usbd_respond cdc_control(usbd_device* dev, usbd_ctlreq* req, usbd_rqc_cal
switch(req->bRequest) { switch(req->bRequest) {
case USB_CDC_SET_CONTROL_LINE_STATE: case USB_CDC_SET_CONTROL_LINE_STATE:
if (callbacks[if_num] != NULL) { if (callbacks[if_num] != NULL) {
cdc_ctrl_line_state[if_num] = req->wValue;
if (callbacks[if_num]->ctrl_line_callback != NULL) if (callbacks[if_num]->ctrl_line_callback != NULL)
callbacks[if_num]->ctrl_line_callback(req->wValue); callbacks[if_num]->ctrl_line_callback(cdc_ctrl_line_state[if_num]);
} }
return usbd_ack; return usbd_ack;
case USB_CDC_SET_LINE_CODING: case USB_CDC_SET_LINE_CODING:

View File

@ -17,6 +17,8 @@ void furi_hal_cdc_set_callbacks(uint8_t if_num, CdcCallbacks* cb);
struct usb_cdc_line_coding* furi_hal_cdc_get_port_settings(uint8_t if_num); struct usb_cdc_line_coding* furi_hal_cdc_get_port_settings(uint8_t if_num);
uint8_t furi_hal_cdc_get_ctrl_line_state(uint8_t if_num);
void furi_hal_cdc_send(uint8_t if_num, uint8_t* buf, uint16_t len); void furi_hal_cdc_send(uint8_t if_num, uint8_t* buf, uint16_t len);
int32_t furi_hal_cdc_receive(uint8_t if_num, uint8_t* buf, uint16_t max_len); int32_t furi_hal_cdc_receive(uint8_t if_num, uint8_t* buf, uint16_t max_len);

View File

@ -4,29 +4,37 @@
#include <stream_buffer.h> #include <stream_buffer.h>
#define USB_CDC_PKT_LEN CDC_DATA_SZ #define USB_CDC_PKT_LEN CDC_DATA_SZ
#define VCP_RX_BUF_SIZE (USB_CDC_PKT_LEN * 3)
#define VCP_TX_BUF_SIZE (USB_CDC_PKT_LEN * 3)
#define VCP_IF_NUM 0 #define VCP_IF_NUM 0
typedef enum { typedef enum {
VcpConnect, VcpEvtReserved = (1 << 0), // Reserved for StreamBuffer internal event
VcpDisconnect, VcpEvtConnect = (1 << 1),
} VcpEvent; VcpEvtDisconnect = (1 << 2),
VcpEvtEnable = (1 << 3),
VcpEvtDisable = (1 << 4),
VcpEvtRx = (1 << 5),
VcpEvtTx = (1 << 6),
VcpEvtRxDone = (1 << 7),
VcpEvtTxDone = (1 << 8),
} WorkerEvtFlags;
#define VCP_THREAD_FLAG_ALL (VcpEvtConnect | VcpEvtDisconnect | VcpEvtEnable | VcpEvtDisable | VcpEvtRx | VcpEvtTx | VcpEvtRxDone | VcpEvtTxDone)
typedef struct { typedef struct {
FuriThread* thread;
StreamBufferHandle_t tx_stream;
StreamBufferHandle_t rx_stream;
volatile bool connected; volatile bool connected;
uint8_t rx_buf[USB_CDC_PKT_LEN]; uint8_t data_buffer[USB_CDC_PKT_LEN];
uint8_t rx_buf_start;
uint8_t rx_buf_len;
osMessageQueueId_t event_queue;
osMutexId_t usb_mutex;
osSemaphoreId_t tx_sem;
osSemaphoreId_t rx_sem;
} FuriHalVcp; } FuriHalVcp;
static int32_t vcp_worker(void* context);
static void vcp_on_cdc_tx_complete(); static void vcp_on_cdc_tx_complete();
static void vcp_on_cdc_rx(); static void vcp_on_cdc_rx();
static void vcp_state_callback(uint8_t state); static void vcp_state_callback(uint8_t state);
@ -49,34 +57,117 @@ void furi_hal_vcp_init() {
vcp = furi_alloc(sizeof(FuriHalVcp)); vcp = furi_alloc(sizeof(FuriHalVcp));
vcp->connected = false; vcp->connected = false;
vcp->usb_mutex = osMutexNew(NULL); vcp->tx_stream = xStreamBufferCreate(VCP_TX_BUF_SIZE, 1);
vcp->rx_stream = xStreamBufferCreate(VCP_RX_BUF_SIZE, 1);
vcp->tx_sem = osSemaphoreNew(1, 1, NULL); vcp->thread = furi_thread_alloc();
vcp->rx_sem = osSemaphoreNew(1, 0, NULL); furi_thread_set_name(vcp->thread, "VcpWorker");
furi_thread_set_stack_size(vcp->thread, 512);
vcp->event_queue = osMessageQueueNew(8, sizeof(VcpEvent), NULL); furi_thread_set_callback(vcp->thread, vcp_worker);
furi_thread_start(vcp->thread);
furi_hal_cdc_set_callbacks(VCP_IF_NUM, &cdc_cb);
FURI_LOG_I("FuriHalVcp", "Init OK"); FURI_LOG_I("FuriHalVcp", "Init OK");
} }
void furi_hal_vcp_enable() { static int32_t vcp_worker(void* context) {
bool enabled = true;
bool tx_idle = false;
bool rx_pending = false;
furi_hal_cdc_set_callbacks(VCP_IF_NUM, &cdc_cb); furi_hal_cdc_set_callbacks(VCP_IF_NUM, &cdc_cb);
VcpEvent evt = VcpConnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0); while (1) {
uint32_t flags = osThreadFlagsWait(VCP_THREAD_FLAG_ALL, osFlagsWaitAny, osWaitForever);
furi_assert((flags & osFlagsError) == 0);
// New data received
if((flags & VcpEvtRxDone) && enabled) {
if (xStreamBufferSpacesAvailable(vcp->rx_stream) >= USB_CDC_PKT_LEN) {
size_t len = furi_hal_cdc_receive(VCP_IF_NUM, vcp->data_buffer, USB_CDC_PKT_LEN);
if (len > 0)
xStreamBufferSend(vcp->rx_stream, vcp->data_buffer, len, osWaitForever);
else
rx_pending = false;
} else
rx_pending = true; // Buffer is full, retry later
}
// Rx buffer was read, maybe there is enough space for new data?
if((flags & VcpEvtRx) && rx_pending) {
if (xStreamBufferSpacesAvailable(vcp->rx_stream) >= USB_CDC_PKT_LEN) {
size_t len = furi_hal_cdc_receive(VCP_IF_NUM, vcp->data_buffer, USB_CDC_PKT_LEN);
if (len > 0)
xStreamBufferSend(vcp->rx_stream, vcp->data_buffer, len, osWaitForever);
else
rx_pending = false;
}
}
// New data in Tx buffer
if((flags & VcpEvtTx) && enabled) {
if (tx_idle) {
size_t len = xStreamBufferReceive(vcp->tx_stream, vcp->data_buffer, USB_CDC_PKT_LEN, 0);
if (len > 0) {
tx_idle = false;
furi_hal_cdc_send(VCP_IF_NUM, vcp->data_buffer, len);
}
}
}
// CDC write transfer done
if((flags & VcpEvtTxDone) && enabled) {
size_t len = xStreamBufferReceive(vcp->tx_stream, vcp->data_buffer, USB_CDC_PKT_LEN, 0);
if (len > 0) { // Some data left in Tx buffer. Sending it now
tx_idle = false;
furi_hal_cdc_send(VCP_IF_NUM, vcp->data_buffer, len);
} else { // There is nothing to send. Set flag to start next transfer instantly
tx_idle = true;
}
}
// VCP session opened
if((flags & VcpEvtConnect) && enabled) {
if (vcp->connected == false) {
vcp->connected = true; vcp->connected = true;
osSemaphoreRelease(vcp->tx_sem); xStreamBufferSend(vcp->rx_stream, &ascii_soh, 1, osWaitForever);
osSemaphoreRelease(vcp->rx_sem); }
}
// VCP session closed
if((flags & VcpEvtDisconnect) && enabled) {
if (vcp->connected == true) {
vcp->connected = false;
xStreamBufferSend(vcp->rx_stream, &ascii_eot, 1, osWaitForever);
}
}
// VCP enabled
if((flags & VcpEvtEnable) && !enabled){
furi_hal_cdc_set_callbacks(VCP_IF_NUM, &cdc_cb);
enabled = true;
furi_hal_cdc_receive(VCP_IF_NUM, vcp->data_buffer, USB_CDC_PKT_LEN); // flush Rx buffer
if (furi_hal_cdc_get_ctrl_line_state(VCP_IF_NUM) & (1 << 0)) {
vcp->connected = true;
xStreamBufferSend(vcp->rx_stream, &ascii_soh, 1, osWaitForever);
}
}
// VCP disabled
if((flags & VcpEvtDisable) && enabled) {
enabled = false;
vcp->connected = false;
xStreamBufferSend(vcp->rx_stream, &ascii_eot, 1, osWaitForever);
}
}
return 0;
}
void furi_hal_vcp_enable() {
osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtEnable);
} }
void furi_hal_vcp_disable() { void furi_hal_vcp_disable() {
furi_hal_cdc_set_callbacks(VCP_IF_NUM, NULL); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtDisable);
VcpEvent evt = VcpDisconnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0);
vcp->connected = false;
osSemaphoreRelease(vcp->tx_sem);
osSemaphoreRelease(vcp->rx_sem);
} }
size_t furi_hal_vcp_rx_with_timeout(uint8_t* buffer, size_t size, uint32_t timeout) { size_t furi_hal_vcp_rx_with_timeout(uint8_t* buffer, size_t size, uint32_t timeout) {
@ -85,47 +176,17 @@ size_t furi_hal_vcp_rx_with_timeout(uint8_t* buffer, size_t size, uint32_t timeo
size_t rx_cnt = 0; size_t rx_cnt = 0;
VcpEvent evt = VcpDisconnect; while (size > 0) {
size_t batch_size = size;
if (batch_size > VCP_RX_BUF_SIZE)
batch_size = VCP_RX_BUF_SIZE;
if (vcp->rx_buf_len > 0) { size_t len = xStreamBufferReceive(vcp->rx_stream, buffer, batch_size, timeout);
size_t len = (vcp->rx_buf_len > size) ? (size) : (vcp->rx_buf_len); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtRx);
memcpy(&buffer[rx_cnt], &vcp->rx_buf[vcp->rx_buf_start], len); if (len == 0)
vcp->rx_buf_len -= len; break;
vcp->rx_buf_start += len; size -= len;
rx_cnt += len; buffer += len;
}
while (rx_cnt < size) {
if (osMessageQueueGet(vcp->event_queue, &evt, NULL, 0) == osOK) {
if (evt == VcpConnect)
buffer[rx_cnt] = ascii_soh;
else {
buffer[rx_cnt] = ascii_eot;
vcp->rx_buf_len = 0;
}
rx_cnt++;
return rx_cnt;
}
if (osSemaphoreAcquire(vcp->rx_sem, timeout) == osErrorTimeout)
return rx_cnt;
furi_check(osMutexAcquire(vcp->usb_mutex, osWaitForever) == osOK);
size_t len = furi_hal_cdc_receive(VCP_IF_NUM, vcp->rx_buf, USB_CDC_PKT_LEN);
furi_check(osMutexRelease(vcp->usb_mutex) == osOK);
vcp->rx_buf_len = len;
vcp->rx_buf_start = 0;
if (vcp->rx_buf_len > (size - rx_cnt)) {
len = size - rx_cnt;
memcpy(&buffer[rx_cnt], vcp->rx_buf, len);
vcp->rx_buf_len -= len;
vcp->rx_buf_start += len;
} else {
memcpy(&buffer[rx_cnt], vcp->rx_buf, vcp->rx_buf_len);
vcp->rx_buf_len = 0;
}
rx_cnt += len; rx_cnt += len;
} }
return rx_cnt; return rx_cnt;
@ -133,26 +194,20 @@ size_t furi_hal_vcp_rx_with_timeout(uint8_t* buffer, size_t size, uint32_t timeo
size_t furi_hal_vcp_rx(uint8_t* buffer, size_t size) { size_t furi_hal_vcp_rx(uint8_t* buffer, size_t size) {
furi_assert(vcp); furi_assert(vcp);
return furi_hal_vcp_rx_with_timeout(buffer, size, osWaitForever);
return furi_hal_vcp_rx_with_timeout(buffer, size, portMAX_DELAY);
} }
void furi_hal_vcp_tx(const uint8_t* buffer, size_t size) { void furi_hal_vcp_tx(const uint8_t* buffer, size_t size) {
furi_assert(vcp); furi_assert(vcp);
furi_assert(buffer);
while (size > 0 && vcp->connected) { while (size > 0) {
furi_check(osSemaphoreAcquire(vcp->tx_sem, osWaitForever) == osOK);
if (!vcp->connected)
break;
size_t batch_size = size; size_t batch_size = size;
if (batch_size > USB_CDC_PKT_LEN) { if (batch_size > VCP_TX_BUF_SIZE)
batch_size = USB_CDC_PKT_LEN; batch_size = VCP_TX_BUF_SIZE;
}
furi_check(osMutexAcquire(vcp->usb_mutex, osWaitForever) == osOK); xStreamBufferSend(vcp->tx_stream, buffer, batch_size, osWaitForever);
furi_hal_cdc_send(VCP_IF_NUM, (uint8_t*)buffer, batch_size); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtTx);
furi_check(osMutexRelease(vcp->usb_mutex) == osOK);
size -= batch_size; size -= batch_size;
buffer += batch_size; buffer += batch_size;
@ -160,52 +215,33 @@ void furi_hal_vcp_tx(const uint8_t* buffer, size_t size) {
} }
static void vcp_state_callback(uint8_t state) { static void vcp_state_callback(uint8_t state) {
if (state == 1) { if (state == 0) {
osSemaphoreRelease(vcp->rx_sem); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtDisconnect);
//osSemaphoreRelease(vcp->tx_sem);
}
else if (vcp->connected) {
vcp->connected = false;
osSemaphoreRelease(vcp->rx_sem);
VcpEvent evt = VcpDisconnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0);
//osSemaphoreRelease(vcp->tx_sem);
} }
} }
static void vcp_on_cdc_control_line(uint8_t state) { static void vcp_on_cdc_control_line(uint8_t state) {
// bit 0: DTR state, bit 1: RTS state // bit 0: DTR state, bit 1: RTS state
bool dtr = state & 0b1; bool dtr = state & (1 << 0);
if (dtr) { if (dtr == true) {
if (!vcp->connected) { osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtConnect);
vcp->connected = true;
VcpEvent evt = VcpConnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0);
}
} else { } else {
if (vcp->connected) { osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtDisconnect);
VcpEvent evt = VcpDisconnect;
osMessageQueuePut(vcp->event_queue, &evt, 0, 0);
vcp->connected = false;
} }
}
osSemaphoreRelease(vcp->tx_sem);
osSemaphoreRelease(vcp->rx_sem);
} }
static void vcp_on_cdc_rx() { static void vcp_on_cdc_rx() {
if (vcp->connected == false) uint32_t ret = osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtRxDone);
return; furi_assert((ret & osFlagsError) == 0);
osSemaphoreRelease(vcp->rx_sem);
} }
static void vcp_on_cdc_tx_complete() { static void vcp_on_cdc_tx_complete() {
osSemaphoreRelease(vcp->tx_sem); osThreadFlagsSet(furi_thread_get_thread_id(vcp->thread), VcpEvtTxDone);
} }
bool furi_hal_vcp_is_connected(void) { bool furi_hal_vcp_is_connected(void) {
furi_assert(vcp);
return vcp->connected; return vcp->connected;
} }

View File

@ -38,7 +38,7 @@ void platformDisableIrqCallback() {
void platformSetIrqCallback(PlatformIrqCallback callback) { void platformSetIrqCallback(PlatformIrqCallback callback) {
platform_irq_callback = callback; platform_irq_callback = callback;
platform_irq_thread_attr.name = "rfal_irq_worker"; platform_irq_thread_attr.name = "RfalIrqWorker";
platform_irq_thread_attr.stack_size = 1024; platform_irq_thread_attr.stack_size = 1024;
platform_irq_thread_attr.priority = osPriorityISR; platform_irq_thread_attr.priority = osPriorityISR;
platform_irq_thread_id = osThreadNew(platformIrqWorker, NULL, &platform_irq_thread_attr); platform_irq_thread_id = osThreadNew(platformIrqWorker, NULL, &platform_irq_thread_attr);

View File

@ -216,7 +216,7 @@ IrdaWorker* irda_worker_alloc() {
IrdaWorker* instance = furi_alloc(sizeof(IrdaWorker)); IrdaWorker* instance = furi_alloc(sizeof(IrdaWorker));
instance->thread = furi_thread_alloc(); instance->thread = furi_thread_alloc();
furi_thread_set_name(instance->thread, "irda_worker"); furi_thread_set_name(instance->thread, "IrdaWorker");
furi_thread_set_stack_size(instance->thread, 2048); furi_thread_set_stack_size(instance->thread, 2048);
furi_thread_set_context(instance->thread, instance); furi_thread_set_context(instance->thread, instance);

View File

@ -163,7 +163,7 @@ SubGhzFileEncoderWorker* subghz_file_encoder_worker_alloc() {
SubGhzFileEncoderWorker* instance = furi_alloc(sizeof(SubGhzFileEncoderWorker)); SubGhzFileEncoderWorker* instance = furi_alloc(sizeof(SubGhzFileEncoderWorker));
instance->thread = furi_thread_alloc(); instance->thread = furi_thread_alloc();
furi_thread_set_name(instance->thread, "subghz_file_encoder_worker"); furi_thread_set_name(instance->thread, "SubghzFEWorker");
furi_thread_set_stack_size(instance->thread, 2048); furi_thread_set_stack_size(instance->thread, 2048);
furi_thread_set_context(instance->thread, instance); furi_thread_set_context(instance->thread, instance);
furi_thread_set_callback(instance->thread, subghz_file_encoder_worker_thread); furi_thread_set_callback(instance->thread, subghz_file_encoder_worker_thread);

View File

@ -90,7 +90,7 @@ SubGhzWorker* subghz_worker_alloc() {
SubGhzWorker* instance = furi_alloc(sizeof(SubGhzWorker)); SubGhzWorker* instance = furi_alloc(sizeof(SubGhzWorker));
instance->thread = furi_thread_alloc(); instance->thread = furi_thread_alloc();
furi_thread_set_name(instance->thread, "subghz_worker"); furi_thread_set_name(instance->thread, "SubghzWorker");
furi_thread_set_stack_size(instance->thread, 2048); furi_thread_set_stack_size(instance->thread, 2048);
furi_thread_set_context(instance->thread, instance); furi_thread_set_context(instance->thread, instance);
furi_thread_set_callback(instance->thread, subghz_worker_thread_callback); furi_thread_set_callback(instance->thread, subghz_worker_thread_callback);