You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
32 lines
714 B
32 lines
714 B
/*
|
|
* command_interpreter.c
|
|
*
|
|
* Created on: Jul 10, 2021
|
|
* Author: Andreas Berthoud
|
|
*/
|
|
|
|
#include "usbd_cdc_if.h"
|
|
#include "commands.h"
|
|
|
|
void usb_receive(uint8_t *buf, uint32_t *len) {
|
|
|
|
if (*len < 5) {
|
|
log_error("usb_receive", "received command which cannot be interpreted", 0);
|
|
return;
|
|
}
|
|
uint8_t command_id = buf[0];
|
|
uint16_t length = buf[1] << 8 | buf[2];
|
|
uint8_t * payload_ptr = buf + 4;
|
|
uint8_t stop_byte = 0x1;
|
|
|
|
if (*len >= 4 + length) {
|
|
stop_byte = buf[4+ length];
|
|
}
|
|
|
|
if (stop_byte != 0xFF) {
|
|
log_error("usb_receive", "received command has invalid stop byte: 0x%x", 1, stop_byte);
|
|
} else {
|
|
handle_received_usb_command(command_id, payload_ptr, length);
|
|
}
|
|
|
|
}
|
|
|