generated from hulk/gd32e23x_template
@@ -5,24 +5,11 @@
|
||||
#include "rs485_protocol.h"
|
||||
|
||||
extern uint8_t g_temperature_uint8[2];
|
||||
static int buffer_index_r = 0;
|
||||
static int buffer_index_w = 0;
|
||||
static int buffer_length = 0;
|
||||
static char cmd_buffer[BUF_SIZE][MAX_CMD_SIZE];
|
||||
|
||||
static uint8_t buffer_length = 0;
|
||||
static int serial_count = 0;
|
||||
static uint8_t serial_char = 0x00;
|
||||
static packet_state_t packet_state = PS_NULL;
|
||||
static char *strchr_pointer = NULL;
|
||||
|
||||
bool code_seen(char code) {
|
||||
strchr_pointer = strchr(cmd_buffer[buffer_index_r], code);
|
||||
return (strchr_pointer != NULL); //Return True if a character was found
|
||||
}
|
||||
|
||||
float code_value(void)
|
||||
{
|
||||
return (strtod(&cmd_buffer[buffer_index_r][strchr_pointer - cmd_buffer[buffer_index_r] + 1], NULL));
|
||||
}
|
||||
static packet_state state = PS_NULL;
|
||||
|
||||
// void process_command(uint8_t *cmd, size_t length) {
|
||||
// char combined_str[3];
|
||||
@@ -147,91 +134,19 @@ void process_printer(void) {
|
||||
}
|
||||
if(buffer_length) {
|
||||
process_command();
|
||||
buffer_length = (buffer_length -1);
|
||||
buffer_index_r = (buffer_index_r + 1) % BUF_SIZE;
|
||||
}
|
||||
}
|
||||
|
||||
void get_command (void) {
|
||||
static uint8_t testchar=0;
|
||||
static uint8_t check_sum = 0;
|
||||
static uint8_t packet_len ;
|
||||
static uint8_t packet_type;
|
||||
packet_state = PS_NULL;
|
||||
state = PS_NULL;
|
||||
serial_count = 0;
|
||||
serial_char=0;
|
||||
|
||||
if(uart_available() > 0)
|
||||
delay_ms(5);
|
||||
while(uart_available() > 0 && buffer_length < BUF_SIZE) {
|
||||
delay_us(100);
|
||||
serial_char = uart_read();
|
||||
|
||||
switch (packet_state) {
|
||||
case PS_NULL:
|
||||
if (serial_char == PACKET_START_BYTE) {
|
||||
serial_count = 0;
|
||||
check_sum = 0;
|
||||
packet_state = PS_TYPE;
|
||||
} else
|
||||
{
|
||||
serial_count = 0;
|
||||
}
|
||||
break;
|
||||
case PS_TYPE:
|
||||
packet_type = serial_char;
|
||||
check_sum += serial_char;
|
||||
packet_state = PS_LEN;
|
||||
break;
|
||||
case PS_LEN:
|
||||
packet_len = serial_char;
|
||||
check_sum += serial_char;
|
||||
packet_state = PS_PAYLOAD;
|
||||
break;
|
||||
case PS_PAYLOAD:
|
||||
check_sum += serial_char;
|
||||
cmd_buffer[buffer_index_w][serial_count++] = serial_char;
|
||||
if (serial_count == packet_len)
|
||||
packet_state = PS_CRC;
|
||||
break;
|
||||
case PS_CRC:
|
||||
packet_state = PS_NULL;
|
||||
if (!serial_count || check_sum != serial_char)
|
||||
{
|
||||
serial_count = 0;
|
||||
return;
|
||||
}
|
||||
cmd_buffer[buffer_index_w][serial_count] = 0; // 终止字符串
|
||||
buffer_index_w = (buffer_index_w + 1) % BUF_SIZE;
|
||||
buffer_length += 1;
|
||||
serial_count = 0;
|
||||
break;
|
||||
default:
|
||||
packet_state = PS_NULL;
|
||||
serial_count = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void process_command(void) {
|
||||
if (code_seen('M')) {
|
||||
switch ((int) code_value()) {
|
||||
case 1:
|
||||
// ultrasonic_distance_report();
|
||||
printf("%c%c%c%c%c%c", 0xB5, 0xF1, 0x02, 0x6F, 0x6B, 0xF1);
|
||||
break;
|
||||
case 2:
|
||||
// gd60914_tempture_report();
|
||||
printf("%c%c%c%c%c%c", 0xB5, 0xF1, 0x02, 0x6F, 0x6B, 0xF2);
|
||||
break;
|
||||
case 3:
|
||||
printf("%c%c%c%c%c%c", 0xB5, 0xF1, 0x02, 0x6F, 0x6B, 0xCC);
|
||||
fwdgt_reset_mcu();
|
||||
break;
|
||||
default:
|
||||
printf("%c%c%c%c%c%c%c", 0xB5, 0xF0, 0x03, 0x65, 0x72, 0x72, 0x3C);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
Reference in New Issue
Block a user