mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-09 22:08:56 +08:00
geofence utils test: simplify and extend
Signed-off-by: RomanBapst <bapstroman@gmail.com>
This commit is contained in:
@@ -104,16 +104,12 @@ TEST(GeofenceUtilsTest, SymmetricPairIndex)
|
||||
|
||||
std::srand(42);
|
||||
|
||||
for (size_t i = 0; i < N; ++i) {
|
||||
for (size_t j = 0; j < N; ++j) {
|
||||
matrix[i][j] = static_cast<float>(std::rand()) / static_cast<float>(RAND_MAX);
|
||||
}
|
||||
}
|
||||
|
||||
int idx = 0;
|
||||
|
||||
for (size_t i = 0; i < N; ++i) {
|
||||
for (size_t j = i + 1; j < N; ++j) {
|
||||
matrix[i][j] = static_cast<float>(std::rand()) / static_cast<float>(RAND_MAX);
|
||||
matrix[j][i] = matrix[i][j]; // symmetric
|
||||
packed[idx++] = matrix[i][j];
|
||||
}
|
||||
}
|
||||
@@ -124,6 +120,7 @@ TEST(GeofenceUtilsTest, SymmetricPairIndex)
|
||||
for (size_t j = i + 1; j < N; ++j) {
|
||||
counter++;
|
||||
EXPECT_FLOAT_EQ(matrix[i][j], packed[geofence_utils::symmetricPairIndex(i, j, N)]);
|
||||
EXPECT_FLOAT_EQ(matrix[i][j], packed[geofence_utils::symmetricPairIndex(j, i, N)]);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user