pub fn get_observations( x_true: &Vector3<f64>, landmarks: &[(f64, f64)], ) -> Vec<(f64, f64)>
Simulate observations from true robot pose to landmarks (without IDs)