fn interpolate_at(traj: &[(i64, &[f32])], t: i64, dim: usize) -> Vec<f32>
Linear interpolation of a trajectory at a specific timestamp.