本文整理汇总了C++中Orientation::headingError方法的典型用法代码示例。如果您正苦于以下问题:C++ Orientation::headingError方法的具体用法?C++ Orientation::headingError怎么用?C++ Orientation::headingError使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Orientation
的用法示例。
在下文中一共展示了Orientation::headingError方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1:
TEST (Orientation, HeadingError) {
VLOG(1) << "===Orientation Heading Error Test===";
Orientation x { 20.0, -15.0, 10.0 };
VLOG(2) << "Orientation x " << x.pack();
VLOG(2) << "Heading error between x & 350 deg: " << x.headingError(350.0);
EXPECT_TRUE(toleranceEquals(x.headingError(350.0), -20.0, TOL));
VLOG(2) << "Heading error between x & 30 deg: " << x.headingError(30.0);
EXPECT_TRUE(toleranceEquals(x.headingError(30.0), 20.0, TOL));
VLOG(2) << "Heading error between x & 180 deg: " << x.headingError(180.0);
EXPECT_TRUE(toleranceEquals(x.headingError(180.0), 170.0, TOL));
VLOG(2) << "Heading error between x & 370 deg: " << x.headingError(370.0);
EXPECT_TRUE(toleranceEquals(x.headingError(370.0), 0.0, TOL));
VLOG(2) << "Heading error between x & -20 deg: " << x.headingError(-20.0);
EXPECT_TRUE(toleranceEquals(x.headingError(-10.0), -20.0, TOL));
Orientation y { 20.0, -15.0, 180.0 };
VLOG(2) << "Orientation y " << y.pack();
EXPECT_TRUE(toleranceEquals(y.headingError(181.0), 1.0, TOL));
}