Correcting angle reconstitution in message handler
This commit is contained in:
parent
6ba92bf0f1
commit
88f10fc50b
|
@ -7,7 +7,7 @@ void __not_in_flash_func(udp_client_message_handler)(uint8_t *payload, uint16_t
|
||||||
{
|
{
|
||||||
if(len != 16) return;
|
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.x_axis_speed = payload[UDP_PAYLOAD_X_AXIS_SPEED_BYTE];
|
||||||
robot.motion_control_data.y_axis_speed = payload[UDP_PAYLOAD_Y_AXIS_SPEED_BYTE];
|
robot.motion_control_data.y_axis_speed = payload[UDP_PAYLOAD_Y_AXIS_SPEED_BYTE];
|
||||||
|
|
Loading…
Reference in New Issue