kopia lustrzana https://github.com/micropython/micropython
103 wiersze
2.7 KiB
C
103 wiersze
2.7 KiB
C
#include <string.h>
|
|
|
|
#include "usb_core.h"
|
|
#include "usbd_core.h"
|
|
#include "usbd_cdc_core.h"
|
|
#include "usbd_pyb_core.h"
|
|
#include "usbd_usr.h"
|
|
#include "usbd_desc.h"
|
|
|
|
#include "misc.h"
|
|
#include "usb.h"
|
|
|
|
extern CDC_IF_Prop_TypeDef VCP_fops;
|
|
|
|
USB_OTG_CORE_HANDLE USB_OTG_dev;
|
|
|
|
static int is_enabled = 0;
|
|
static char rx_buf[64];
|
|
static int rx_buf_in;
|
|
static int rx_buf_out;
|
|
|
|
void usb_init() {
|
|
if (!is_enabled) {
|
|
// only init USB once in the device's power-lifetime
|
|
USBD_Init(&USB_OTG_dev, USB_OTG_FS_CORE_ID, &USR_desc, &USBD_PYB_cb, &USR_cb);
|
|
}
|
|
rx_buf_in = 0;
|
|
rx_buf_out = 0;
|
|
is_enabled = 1;
|
|
}
|
|
|
|
bool usb_vcp_is_enabled() {
|
|
return is_enabled;
|
|
}
|
|
|
|
void usb_vcp_receive(const char *buf, uint32_t len) {
|
|
if (is_enabled) {
|
|
for (int i = 0; i < len; i++) {
|
|
rx_buf[rx_buf_in++] = buf[i];
|
|
if (rx_buf_in >= sizeof(rx_buf)) {
|
|
rx_buf_in = 0;
|
|
}
|
|
if (rx_buf_in == rx_buf_out) {
|
|
rx_buf_out = rx_buf_in + 1;
|
|
if (rx_buf_out >= sizeof(rx_buf)) {
|
|
rx_buf_out = 0;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
int usb_vcp_rx_any() {
|
|
if (rx_buf_in >= rx_buf_out) {
|
|
return rx_buf_in - rx_buf_out;
|
|
} else {
|
|
return rx_buf_in + sizeof(rx_buf) - rx_buf_out;
|
|
}
|
|
}
|
|
|
|
char usb_vcp_rx_get() {
|
|
while (rx_buf_out == rx_buf_in) {
|
|
}
|
|
char c = rx_buf[rx_buf_out];
|
|
rx_buf_out += 1;
|
|
if (rx_buf_out >= sizeof(rx_buf)) {
|
|
rx_buf_out = 0;
|
|
}
|
|
return c;
|
|
}
|
|
|
|
void usb_vcp_send_str(const char *str) {
|
|
usb_vcp_send_strn(str, strlen(str));
|
|
}
|
|
|
|
void usb_vcp_send_strn(const char *str, int len) {
|
|
if (is_enabled) {
|
|
VCP_fops.pIf_DataTx((const uint8_t*)str, len);
|
|
}
|
|
}
|
|
|
|
#include "lib/usbd_conf.h"
|
|
|
|
/* These are external variables imported from CDC core to be used for IN
|
|
transfer management. */
|
|
extern uint8_t APP_Rx_Buffer []; /* Write CDC received data in this buffer.
|
|
These data will be sent over USB IN endpoint
|
|
in the CDC core functions. */
|
|
extern uint32_t APP_Rx_ptr_in; /* Increment this pointer or roll it back to
|
|
start address when writing received data
|
|
in the buffer APP_Rx_Buffer. */
|
|
|
|
void usb_vcp_send_strn_cooked(const char *str, int len) {
|
|
for (const char *top = str + len; str < top; str++) {
|
|
if (*str == '\n') {
|
|
APP_Rx_Buffer[APP_Rx_ptr_in] = '\r';
|
|
APP_Rx_ptr_in = (APP_Rx_ptr_in + 1) & (APP_RX_DATA_SIZE - 1);
|
|
}
|
|
APP_Rx_Buffer[APP_Rx_ptr_in] = *str;
|
|
APP_Rx_ptr_in = (APP_Rx_ptr_in + 1) & (APP_RX_DATA_SIZE - 1);
|
|
}
|
|
}
|