Added test

usdot-fhwa-OPS · Jun 24, 2024 · ddb2c96 · ddb2c96
1 parent 9563ad9
commit ddb2c96
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/src/v2i-hub/MUSTSensorDriverPlugin/test/TestMUSTSensorDetection.cpp b/src/v2i-hub/MUSTSensorDriverPlugin/test/TestMUSTSensorDetection.cpp
@@ -80,4 +80,10 @@ TEST(TestMUSTSensorDetection, detectionClassificationToString ) {
     EXPECT_STRCASEEQ("TRUCK", detectionClassificationToString(DetectionClassification::TRUCK).c_str());
     EXPECT_THROW(detectionClassificationToString(DetectionClassification::NA).c_str(), std::runtime_error);
 
+}
+
+TEST(TestMUSTSensorDetection, headingSpeedToVelocity ) {
+    auto velocity = headingSpeedToVelocity(30, 5);
+    EXPECT_NEAR(4.33, velocity.Y, 0.001);
+    EXPECT_NEAR(-2.5, velocity.X, 0.001);
 }