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

alpha version

Browse Source
This commit is contained in:
yelvlab
2025-01-08 13:47:24 +08:00
parent c9c1e00d6a
commit b4901f5f37
6 changed files with 19 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files

18
src/rs485_protocol.c
View File

@@ -122,22 +122,20 @@ void gd60914_tempture_report(void) {
// }
void ultrasonic_distance_report(void) {
static uint32_t distance_uint32 = 0;
static uint8_t package_header[3] = {0xB5, 0xF0, 0x04};
static uint16_t distance_uint16 = 0;
static uint8_t package_header[3] = {0xB5, 0xF0, 0x02};
static uint8_t package_data[4] = {0};
distance_uint32 = ultrasonic_calc_distance();
distance_uint16 = ultrasonic_calc_distance();
package_data[0] = (distance_uint32 >> 24) & 0xFF;
package_data[1] = (distance_uint32 >> 16) & 0xFF;
package_data[2] = (distance_uint32 >> 8) & 0xFF;
package_data[3] = distance_uint32 & 0xFF;
package_data[0] = (distance_uint16 >> 8) & 0xFF;
package_data[1] = distance_uint16 & 0xFF;
uint8_t combined_data[7];
memcpy(combined_data, package_header, 3);
memcpy(combined_data + 3, package_data, 4);
memcpy(combined_data + 3, package_data, 2);
printf("%c%c%c", package_header[0], package_header[1], package_header[2]);
printf("%c%c%c%c", package_data[0], package_data[1], package_data[2], package_data[3]);
printf("%c", calculate_crc(combined_data, 8));
printf("%c%c", package_data[0], package_data[1]);
printf("%c", calculate_crc(combined_data, 6));
}