Function assert_pose_eq 

pub fn assert_pose_eq(
    ta: &Isometry3<f64>,
    tb: &Isometry3<f64>,
    distance_tolerance: f64,
    angular_tolerance: f64,
) -> bool