Added sending angle

This commit is contained in:
Ulysse Cura 2025-05-27 22:23:17 +02:00
parent b0db954831
commit ea5deeccdf
1 changed files with 3 additions and 1 deletions

View File

@ -93,8 +93,10 @@ void udp_server_send(void)
for(uint i = 0; i < 16; i++) data[i] = 0;
data[UDP_PAYLOAD_ANGLE_L_BYTE] = controller.inputs_buffer.robot_angle & 0xff;
data[UDP_PAYLOAD_ANGLE_H_BYTE] = (controller.inputs_buffer.robot_angle >> 8) & 0xff;
data[UDP_PAYLOAD_X_AXIS_SPEED_BYTE] = *(uint8_t *)&controller.inputs_buffer.x_axis_speed;
data[UDP_PAYLOAD_Y_AXIS_SPEED_BYTE] = *(uint8_t *)&controller.inputs_buffer.x_axis_speed;
data[UDP_PAYLOAD_Y_AXIS_SPEED_BYTE] = *(uint8_t *)&controller.inputs_buffer.y_axis_speed;
udp_server_send_data(data, UDP_SERVER_BUFFER_SIZE);
}