feat: 增加 vofa 打印到上位机功能

This commit is contained in:
bmy
2024-03-11 20:25:14 +08:00
parent 681b47736c
commit 3bb5383c06
7 changed files with 36 additions and 14 deletions

View File

@@ -9,7 +9,11 @@ void by_vofa_init(by_vofa_t *vofa, uart_index_enum uart_index, uint8_t param_num
void by_vofa_send(by_vofa_t *vofa)
{
const uint8_t tail[4] = {0x00, 0x00, 0x80, 0x7F};
uart_write_buffer(vofa->uart_index, (uint8_t *)vofa->param_ptr, vofa->param_num * 4);
const uint8_t tail[4] = {0x00, 0x00, 0x80, 0x7F};
const uint8_t *param_ptr_u8 = (uint8_t *)vofa->param_ptr;
for (uint16_t i = 0; i < vofa->param_num * 4; i++) {
uart_write_byte(vofa->uart_index, *(param_ptr_u8 + i));
}
uart_write_buffer(vofa->uart_index, tail, 4);
}