Correcting angle reconstitution in message handler

This commit is contained in:
Ulysse Cura 2025-05-27 22:12:21 +02:00
parent 6ba92bf0f1
commit 88f10fc50b
1 changed files with 1 additions and 1 deletions

View File

@ -7,7 +7,7 @@ void __not_in_flash_func(udp_client_message_handler)(uint8_t *payload, uint16_t
{
if(len != 16) return;
robot.motion_control_data.angle = ((payload[UDP_PAYLOAD_ANGLE_H_BYTE] << 8) | payload[UDP_PAYLOAD_ANGLE_L_BYTE]);
robot.motion_control_data.angle = ((payload[UDP_PAYLOAD_ANGLE_H_BYTE] >> 8) | payload[UDP_PAYLOAD_ANGLE_L_BYTE]);
robot.motion_control_data.x_axis_speed = payload[UDP_PAYLOAD_X_AXIS_SPEED_BYTE];
robot.motion_control_data.y_axis_speed = payload[UDP_PAYLOAD_Y_AXIS_SPEED_BYTE];