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