diff --git a/main controller code/src/udp_payload.c b/main controller code/src/udp_payload.c index 28cdb33..b4e0ad8 100644 --- a/main controller code/src/udp_payload.c +++ b/main controller code/src/udp_payload.c @@ -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];