btl143/QD4C-firmware
4
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

feat: 增加 vofa justfloat 发送

Browse Source
This commit is contained in:
bmy
2024-03-11 19:32:44 +08:00
parent 6c0cfe1248
commit 6a6be1469b
4 changed files with 44 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
app/by_frame.c
View File

@@ -49,7 +49,7 @@ void by_frame_parse(uint8_t data_num, uint32_t *data_array)
uint16_t crc_cal = 0;
uint32_t read_length = 50;
if (fifo_used(&frame_fifo)) {
if (fifo_used(&frame_fifo) >= 12) {
fifo_read_buffer(&frame_fifo, frame_buffer_parse, &read_length, FIFO_READ_AND_CLEAN);
while (1) {
if (cnt_ptr < 50) {
@@ -88,9 +88,17 @@ void by_frame_parse(uint8_t data_num, uint32_t *data_array)
if (!cnt_crc) {
if (crc_cal == crc16_check(data_array_temp, 2 + data_num * sizeof(uint32_t))) {
memcpy(data_array, data_array_temp + 2, data_num * sizeof(uint32_t));
// lwrb_reset(&lwrb_struct); // 处理完直接清空缓冲区，避免堆积产生处理阻塞
memset(data_array_temp, 0, sizeof(data_array_temp));
// printf("parsed done!\r\n");
for (uint8_t i = 0; i < data_num; i++) {
for (uint8_t j = 0; j < 4; j++) {
uart_write_byte(DEBUG_UART_INDEX, data_array[i] >> (j * 8));
}
}
uart_write_byte(DEBUG_UART_INDEX, 0x00);
uart_write_byte(DEBUG_UART_INDEX, 0x00);
uart_write_byte(DEBUG_UART_INDEX, 0x80);
uart_write_byte(DEBUG_UART_INDEX, 0x7F);
}
break;