diff --git a/src/main.rs b/src/main.rs index 07854d9962e348b126cee9dfbd9424bb3e864dc7..ca5cc2e521988c43d7a61a446d5d186e486936af 100644 --- a/src/main.rs +++ b/src/main.rs @@ -276,7 +276,7 @@ fn tick_to_speed(tick: i32) -> f32 { } fn update_state(pos: &(f32,f32,f32), l_speed: f32, r_speed: f32) { pos.0 += 0.5*(l_speed + r_speed)*((pos.2).to_radians().sin()); - pos.0 += 0.5*(l_speed + r_speed)*((pos.2).to_radians().cos()); + pos.1 += 0.5*(l_speed + r_speed)*((pos.2).to_radians().cos()); pos.2 += (r_speed - l_speed)/AXEL_WIDTH; } fn update_map_with_lidar(lidar_data: [u8; LIDAR_BUF_SIZE], message_len: usize, map: &mut [[u32; ROWS]; COLS]) {