Lines Matching refs:pose1
39 Pose3f pose1({1, 2, 3}, Quaternionf::UnitRandom()); in TEST() local
44 comp.setInput(1000, pose1); in TEST()
48 EXPECT_EQ(comp.getOutput(), pose1.inverse() * pose2); in TEST()
54 comp.setInput(3000, pose1); in TEST()
58 EXPECT_EQ(comp.getOutput(), pose1.inverse() * pose2); in TEST()
62 Pose3f pose1({1, 2, 3}, Quaternionf::UnitRandom()); in TEST() local
66 comp.setInput(1000, pose1); in TEST()
70 EXPECT_EQ(comp.getOutput(), pose1.inverse() * pose2); in TEST()
75 comp.setInput(1000, pose1); in TEST()
79 EXPECT_EQ(comp.getOutput(), pose1.inverse() * pose2); in TEST()
98 Pose3f pose1({1, 2, 3}, Quaternionf::UnitRandom()); in TEST() local
103 comp.setInput(0, pose1); in TEST()
107 EXPECT_EQ(comp.getOutput(), pose1.inverse() * pose2); in TEST()
112 comp.setInput(2, pose1); in TEST()
116 EXPECT_EQ(comp.getOutput(), pose1.inverse() * pose2); in TEST()
120 Pose3f pose1({1, 2, 3}, rotateZ(-M_PI * 3 / 4)); in TEST() local
128 comp.setInput(1000, pose1); in TEST()
129 EXPECT_EQ(comp.getOutput(), pose1); in TEST()
132 comp.setInput(2000, pose1); in TEST()
137 comp.setInput(3000, pose1); in TEST()