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