Function get_observations_with_id 

pub fn get_observations_with_id(
    x_true: &Vector3<f64>,
    landmarks: &[(f64, f64)],
) -> Vec<(f64, f64, usize)>

Simulate observations from true robot pose to landmarks (with IDs - known correspondences)