hulk/xlsw_3dp_LDC1612
1
0
Fork 0
generated from hulk/gd32e23x_template
Code Issues Pull Requests Actions Packages Projects Releases 1 Wiki Activity

format code

Browse Source
This commit is contained in:
yelvlab 2024-12-25 13:03:22 +08:00
parent fca25e1981
commit eca38a53b8
1 changed files with 46 additions and 74 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

120
src/rs485.c
View File

@ -10,8 +10,7 @@ extern uint32_t g_eddy_current_value_uint32;
uint8_t package_header[3] = {0xB5, 0xF0, 0x04};
uint8_t package_data[4] = {0};
void rs485_config(void)
{
void rs485_config(void) {
rcu_periph_clock_enable(RS485_GPIO_RCU);
rcu_periph_clock_enable(RS485_RCU);
@ -39,8 +38,7 @@ void rs485_config(void)
usart_interrupt_enable(RS485_PHY, USART_INT_IDLE);
}
void process_command(uint8_t* cmd, size_t length)
{
void process_command(uint8_t *cmd, size_t length) {
char combined_str[3];
validation_result_t validate = VALIDATION_SUCCESS;
@ -49,104 +47,79 @@ void process_command(uint8_t* cmd, size_t length)
validate_data_length(cmd) |
validate_package_crc(cmd, length));
switch (validate)
{
case VALIDATION_SUCCESS:
// printf("%d", length);
sprintf(combined_str, "%c%c", cmd[3], cmd[4]);
if (strcmp(combined_str, "M1") == 0)
{
eddy_current_value_report();
}
else if (strcmp(combined_str, "M2") == 0)
{
tempture_value_report();
}
else
{
printf("%c%c%c%c%c%c%c", 0xB5, 0xF0, 0x03, 0x65, 0x72, 0x72, 0x3C);
return;
}
break;
case VALIDATION_CRC_ERROR:
printf("%c%c%c%c%c%c%c", 0xB5, 0xF0, 0x03, 0x65, 0x72, 0x72, 0x3F);
break;
case VALIDATION_HEADER_ERROR:
printf("%c%c%c%c%c%c%c", 0xB5, 0xF3, 0x03, 0x65, 0x72, 0x72, 0x3F);
break;
case VALIDATION_TYPE_ERROR:
printf("%c%c%c%c%c%c%c", 0xB5, 0xF4, 0x03, 0x65, 0x72, 0x72, 0x3F);
break;
case VALIDATION_LENGTH_ERROR:
printf("%c%c%c%c%c%c%c", 0xB5, 0xF2, 0x03, 0x65, 0x72, 0x72, 0x3F);
break;
default:
break;
switch (validate) {
case VALIDATION_SUCCESS:
// printf("%d", length);
sprintf(combined_str, "%c%c", cmd[3], cmd[4]);
if (strcmp(combined_str, "M1") == 0) {
eddy_current_value_report();
} else if (strcmp(combined_str, "M2") == 0) {
tempture_value_report();
} else {
printf("%c%c%c%c%c%c%c", 0xB5, 0xF0, 0x03, 0x65, 0x72, 0x72, 0x3C);
return;
}
break;
case VALIDATION_CRC_ERROR:
printf("%c%c%c%c%c%c%c", 0xB5, 0xF0, 0x03, 0x65, 0x72, 0x72, 0x3F);
break;
case VALIDATION_HEADER_ERROR:
printf("%c%c%c%c%c%c%c", 0xB5, 0xF3, 0x03, 0x65, 0x72, 0x72, 0x3F);
break;
case VALIDATION_TYPE_ERROR:
printf("%c%c%c%c%c%c%c", 0xB5, 0xF4, 0x03, 0x65, 0x72, 0x72, 0x3F);
break;
case VALIDATION_LENGTH_ERROR:
printf("%c%c%c%c%c%c%c", 0xB5, 0xF2, 0x03, 0x65, 0x72, 0x72, 0x3F);
break;
default:
break;
}
}
uint8_t calculate_crc(uint8_t data[], uint8_t data_length)
{
uint8_t calculate_crc(uint8_t data[], uint8_t data_length) {
uint8_t crc = 0;
for (uint8_t i = 1; i < data_length - 1; i++)
{
for (uint8_t i = 1; i < data_length - 1; i++) {
crc += data[i];
}
return (uint8_t)(crc & 0xFF);
return (uint8_t) (crc & 0xFF);
}
validation_result_t validate_package_crc(uint8_t* data, uint8_t data_length)
{
if (data[data_length - 1] == calculate_crc(data, data_length) && data_length == 3 + data[2] + 1)
{
validation_result_t validate_package_crc(uint8_t *data, uint8_t data_length) {
if (data[data_length - 1] == calculate_crc(data, data_length) && data_length == 3 + data[2] + 1) {
return VALIDATION_SUCCESS;
}
else
{
} else {
return VALIDATION_CRC_ERROR;
}
}
validation_result_t validate_package_header(uint8_t* data)
{
if (data[0] == LDC1612_PACKAGE_HEADER)
{
validation_result_t validate_package_header(uint8_t *data) {
if (data[0] == LDC1612_PACKAGE_HEADER) {
return VALIDATION_SUCCESS;
}
else
{
} else {
return VALIDATION_HEADER_ERROR;
}
}
validation_result_t validate_package_type(uint8_t* data)
{
if (data[1] == LDC1612_BOARD_TYPE)
{
validation_result_t validate_package_type(uint8_t *data) {
if (data[1] == LDC1612_BOARD_TYPE) {
return VALIDATION_SUCCESS;
}
else
{
} else {
return VALIDATION_TYPE_ERROR;
}
}
validation_result_t validate_data_length(uint8_t* data)
{
if (data[2] == LDC1612_PACKAGE_LENGTH)
{
validation_result_t validate_data_length(uint8_t *data) {
if (data[2] == LDC1612_PACKAGE_LENGTH) {
return VALIDATION_SUCCESS;
}
else
{
} else {
return VALIDATION_LENGTH_ERROR;
}
}
void eddy_current_value_report(void)
{
void eddy_current_value_report(void) {
package_data[0] = (g_eddy_current_value_uint32 >> 24) & 0xFF;
package_data[1] = (g_eddy_current_value_uint32 >> 16) & 0xFF;
package_data[2] = (g_eddy_current_value_uint32 >> 8) & 0xFF;
@ -161,8 +134,7 @@ void eddy_current_value_report(void)
printf("%c", calculate_crc(combined_data, 7));
}
void tempture_value_report(void)
{
void tempture_value_report(void) {
package_data[0] = (g_temperature_uint32 >> 24) & 0xFF;
package_data[1] = (g_temperature_uint32 >> 16) & 0xFF;
package_data[2] = (g_temperature_uint32 >> 8) & 0xFF;