Skip to content

Commit

Permalink
fix must sensor
Browse files Browse the repository at this point in the history
  • Loading branch information
dan-du-car committed Aug 12, 2024
1 parent 36e19e5 commit 3e7c0d3
Show file tree
Hide file tree
Showing 2 changed files with 18 additions and 18 deletions.
16 changes: 8 additions & 8 deletions src/v2i-hub/MUSTSensorDriverPlugin/src/MUSTSensorDetection.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -31,15 +31,15 @@ namespace MUSTSensorDriverPlugin {

tmx::messages::SensorDetectedObject mustDetectionToSensorDetectedObject(const MUSTSensorDetection &detection, std::string_view sensorId, std::string_view projString) {
tmx::messages::SensorDetectedObject detectedObject;
detectedObject.set_ObjectId(detection.trackID);
detectedObject.set_objectId(detection.trackID);
tmx::messages::Position pos(detection.position_x, detection.position_y, 0);
detectedObject.set_Position(pos);
detectedObject.set_Confidence(detection.confidence);
detectedObject.set_Timestamp(static_cast<long>(detection.timestamp*1000)); // convert decimal seconds to int milliseconds.
detectedObject.set_Velocity(headingSpeedToVelocity(detection.heading, detection.speed));
detectedObject.set_Type(detectionClassificationToSensorDetectedObjectType(detection.cl));
detectedObject.set_SensorId(std::string(sensorId));
detectedObject.set_ProjString(std::string(projString));
detectedObject.set_position(pos);
detectedObject.set_confidence(detection.confidence);
detectedObject.set_timestamp(static_cast<long>(detection.timestamp*1000)); // convert decimal seconds to int milliseconds.
detectedObject.set_velocity(headingSpeedToVelocity(detection.heading, detection.speed));
detectedObject.set_type(detectionClassificationToSensorDetectedObjectType(detection.cl));
detectedObject.set_sensorId(std::string(sensorId));
detectedObject.set_projString(std::string(projString));
return detectedObject;
}
DetectionClassification fromStringToDetectionClassification(const std::string &str) noexcept {
Expand Down
20 changes: 10 additions & 10 deletions src/v2i-hub/MUSTSensorDriverPlugin/test/TestMUSTSensorDetection.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -62,16 +62,16 @@ TEST(TestMUSTSensorDetection, mustDetectionToSensorDetectedObject ) {

auto sensorDetectedObject = mustDetectionToSensorDetectedObject(detection, "MUSTSensor1", "PROJ String");

EXPECT_EQ(detection.trackID, sensorDetectedObject.get_ObjectId());
EXPECT_DOUBLE_EQ(detection.confidence, sensorDetectedObject.get_Confidence());
EXPECT_DOUBLE_EQ(detection.position_x, sensorDetectedObject.get_Position().x);
EXPECT_DOUBLE_EQ(detection.position_y, sensorDetectedObject.get_Position().y);
EXPECT_NEAR(4.33, sensorDetectedObject.get_Velocity().y, 0.001);
EXPECT_NEAR(2.5, sensorDetectedObject.get_Velocity().x, 0.001);
EXPECT_STRCASEEQ("SEDAN", sensorDetectedObject.get_Type().c_str());
EXPECT_EQ(1719506355400, sensorDetectedObject.get_Timestamp());
EXPECT_EQ("MUSTSensor1", sensorDetectedObject.get_SensorId());
EXPECT_EQ("PROJ String", sensorDetectedObject.get_ProjString());
EXPECT_EQ(detection.trackID, sensorDetectedObject.get_objectId());
EXPECT_DOUBLE_EQ(detection.confidence, sensorDetectedObject.get_confidence());
EXPECT_DOUBLE_EQ(detection.position_x, sensorDetectedObject.get_position().x);
EXPECT_DOUBLE_EQ(detection.position_y, sensorDetectedObject.get_position().y);
EXPECT_NEAR(4.33, sensorDetectedObject.get_velocity().y, 0.001);
EXPECT_NEAR(2.5, sensorDetectedObject.get_velocity().x, 0.001);
EXPECT_STRCASEEQ("SEDAN", sensorDetectedObject.get_type().c_str());
EXPECT_EQ(1719506355400, sensorDetectedObject.get_timestamp());
EXPECT_EQ("MUSTSensor1", sensorDetectedObject.get_sensorId());
EXPECT_EQ("PROJ String", sensorDetectedObject.get_projString());
}

TEST(TestMUSTSensorDetection, detectionClassificationToSensorDetectedObjectType ) {
Expand Down

0 comments on commit 3e7c0d3

Please sign in to comment.