22 lines
688 B
C++
22 lines
688 B
C++
#include "pch.h"
|
|
#include "../FalconLibraryCPP/src/FalconLibrary.h"
|
|
|
|
constexpr double kTestEpsilon = 1E-9;
|
|
|
|
TEST(TestRotation2d, TestRotation2d) {
|
|
auto rot = frc5190::Rotation2d();
|
|
EXPECT_EQ(1.0, rot.Cos());
|
|
EXPECT_EQ(0.0, rot.Sin());
|
|
EXPECT_EQ(0.0, rot.Tan());
|
|
EXPECT_EQ(0.0, rot.Radians());
|
|
EXPECT_EQ(0.0, rot.Degrees());
|
|
|
|
rot = frc5190::Rotation2d(1, 1, true);
|
|
EXPECT_NEAR(std::sqrt(2) / 2, rot.Cos(), kTestEpsilon);
|
|
EXPECT_NEAR(std::sqrt(2) / 2, rot.Sin(), kTestEpsilon);
|
|
EXPECT_NEAR(1.0, rot.Tan(), kTestEpsilon);
|
|
EXPECT_NEAR(45.0, rot.Degrees(), kTestEpsilon);
|
|
EXPECT_NEAR(frc5190::kPi / 4, rot.Radians(), kTestEpsilon);
|
|
|
|
auto twist = frc5190::Twist2d();
|
|
} |