@@ -168,29 +168,29 @@ inline void runTest(ContinuousContactManager& checker)
168168 result.flattenMoveResults (result_vector);
169169
170170 EXPECT_TRUE (!result_vector.empty ());
171- EXPECT_NEAR (result_vector[0 ].distance , -0.2475 , 0.001 );
172- EXPECT_NEAR (result_vector[0 ].cc_time [0 ], -1.0 , 0.001 );
173- EXPECT_NEAR (result_vector[0 ].cc_time [1 ], 0.25 , 0.001 );
174- EXPECT_TRUE (result_vector[0 ].cc_type [0 ] == ContinuousCollisionType::CCType_None);
175- EXPECT_TRUE (result_vector[0 ].cc_type [1 ] == ContinuousCollisionType::CCType_Between);
176-
177- EXPECT_NEAR (result_vector[0 ].nearest_points [0 ][0 ], -0.5 , 0.001 );
178- EXPECT_NEAR (result_vector[0 ].nearest_points [0 ][1 ], 0.5 , 0.001 );
179- EXPECT_NEAR (result_vector[0 ].nearest_points [0 ][2 ], 0.0 , 0.001 );
180-
181- EXPECT_NEAR (result_vector[0 ].nearest_points [1 ][0 ], -0.325 , 0.001 );
182- EXPECT_NEAR (result_vector[0 ].nearest_points [1 ][1 ], 0.325 , 0.001 );
183- EXPECT_NEAR (result_vector[0 ].nearest_points [1 ][2 ], 0.0 , 0.001 );
184-
185- Eigen::Vector3d p0 = result_vector[0 ].transform [1 ] * result_vector[0 ].nearest_points_local [1 ];
186- EXPECT_NEAR (p0[0 ], -1.275 , 0.001 );
187- EXPECT_NEAR (p0[1 ], -0.625 , 0.001 );
188- EXPECT_NEAR (p0[2 ], 0.0 , 0.001 );
189-
190- Eigen::Vector3d p1 = result_vector[0 ].cc_transform [1 ] * result_vector[0 ].nearest_points_local [1 ];
191- EXPECT_NEAR (p1[0 ], 2.525 , 0.001 );
192- EXPECT_NEAR (p1[1 ], 3.175 , 0.001 );
193- EXPECT_NEAR (p1[2 ], 0.0 , 0.001 );
171+ EXPECT_NEAR (result_vector[0 ].distance , -0.2475 , 0.001 );
172+ EXPECT_NEAR (result_vector[0 ].cc_time [0 ], -1.0 , 0.001 );
173+ EXPECT_NEAR (result_vector[0 ].cc_time [1 ], 0.25 , 0.001 );
174+ EXPECT_TRUE (result_vector[0 ].cc_type [0 ] == ContinuousCollisionType::CCType_None);
175+ EXPECT_TRUE (result_vector[0 ].cc_type [1 ] == ContinuousCollisionType::CCType_Between);
176+
177+ EXPECT_NEAR (result_vector[0 ].nearest_points [0 ][0 ], -0.5 , 0.001 );
178+ EXPECT_NEAR (result_vector[0 ].nearest_points [0 ][1 ], 0.5 , 0.001 );
179+ EXPECT_NEAR (result_vector[0 ].nearest_points [0 ][2 ], 0.0 , 0.001 );
180+
181+ EXPECT_NEAR (result_vector[0 ].nearest_points [1 ][0 ], -0.325 , 0.001 );
182+ EXPECT_NEAR (result_vector[0 ].nearest_points [1 ][1 ], 0.325 , 0.001 );
183+ EXPECT_NEAR (result_vector[0 ].nearest_points [1 ][2 ], 0.0 , 0.001 );
184+
185+ Eigen::Vector3d p0 = result_vector[0 ].transform [1 ] * result_vector[0 ].nearest_points_local [1 ];
186+ EXPECT_NEAR (p0[0 ], -1.275 , 0.001 );
187+ EXPECT_NEAR (p0[1 ], -0.625 , 0.001 );
188+ EXPECT_NEAR (p0[2 ], 0.0 , 0.001 );
189+
190+ Eigen::Vector3d p1 = result_vector[0 ].cc_transform [1 ] * result_vector[0 ].nearest_points_local [1 ];
191+ EXPECT_NEAR (p1[0 ], 2.525 , 0.001 );
192+ EXPECT_NEAR (p1[1 ], 3.175 , 0.001 );
193+ EXPECT_NEAR (p1[2 ], 0.0 , 0.001 );
194194 }
195195}
196196} // namespace tesseract_collision::test_suite
0 commit comments