@@ -313,18 +313,12 @@ TEST_F(TestWrenchTransformer, NonIdentityTransform)
313313 // Force: (1.0, 2.0, 3.0) -> x'=-2.0, y'=1.0, z'=3.0 -> (-2.0, 1.0, 3.0)
314314 // Torque: (0.1, 0.2, 0.3) -> x'=-0.2, y'=0.1, z'=0.3 -> (-0.2, 0.1, 0.3)
315315 // Use 1e-4 tolerance to account for floating-point precision in quaternion/transform calculations
316- EXPECT_NEAR (received_msg->wrench .force .x , -2.0 , 1e-4 );
317- EXPECT_NEAR (received_msg->wrench .force .y , 1.0 , 1e-4 );
318- EXPECT_NEAR (received_msg->wrench .force .z , 3.0 , 1e-4 );
319- EXPECT_NEAR (received_msg->wrench .torque .x , -0.2 , 1e-4 );
320- EXPECT_NEAR (received_msg->wrench .torque .y , 0.1 , 1e-4 );
321- EXPECT_NEAR (received_msg->wrench .torque .z , 0.3 , 1e-4 );
322-
323- // Verify values are different from input (non-identity transform applied)
324- EXPECT_NE (received_msg->wrench .force .x , test_msg.wrench .force .x );
325- EXPECT_NE (received_msg->wrench .force .y , test_msg.wrench .force .y );
326- EXPECT_NE (received_msg->wrench .torque .x , test_msg.wrench .torque .x );
327- EXPECT_NE (received_msg->wrench .torque .y , test_msg.wrench .torque .y );
316+ EXPECT_NEAR (received_msg->wrench .force .x , -test_msg.wrench .force .y , 1e-4 );
317+ EXPECT_NEAR (received_msg->wrench .force .y , test_msg.wrench .force .x , 1e-4 );
318+ EXPECT_NEAR (received_msg->wrench .force .z , test_msg.wrench .force .z , 1e-4 );
319+ EXPECT_NEAR (received_msg->wrench .torque .x , -test_msg.wrench .torque .y , 1e-4 );
320+ EXPECT_NEAR (received_msg->wrench .torque .y , test_msg.wrench .torque .x , 1e-4 );
321+ EXPECT_NEAR (received_msg->wrench .torque .z , test_msg.wrench .torque .z , 1e-4 );
328322}
329323
330324TEST_F (TestWrenchTransformer, PublishSubscribeMultipleFrames)
0 commit comments