Add PX4 SITL integration test for geofence upload/download round-trip

Uploads a geofence (4-vertex inclusion polygon + exclusion circle),
downloads it back, and verifies all data matches:
- Polygon vertex count, fence type, coordinates (1e-5 deg precision)
- Circle center, radius, fence type
- Clears geofence after test

Author: PavelGuzenfeld

cpp/src/system_tests/CMakeLists.txt

@@ -15,6 +15,7 @@ add_executable(system_tests_runner
     param_get_all.cpp
     mission_raw_upload.cpp
     telemetry_subscription.cpp
+    geofence_download_sitl.cpp
     fs_helpers.cpp
     ftp_download_file.cpp
     ftp_download_file_burst.cpp

cpp/src/system_tests/geofence_download_sitl.cpp

@@ -0,0 +1,81 @@
+#include "log.h"
+#include "mavsdk.h"
+#include "plugins/geofence/geofence.h"
+#include <chrono>
+#include <thread>
+#include <gtest/gtest.h>
+
+using namespace mavsdk;
+
+// Integration test against PX4 SITL.
+// Requires PX4 SITL running on udp://:14540
+// Run with: --gtest_filter='SitlTest.*'
+TEST(SitlTest, GeofenceUploadDownloadRoundTrip)
+{
+    Mavsdk mavsdk{Mavsdk::Configuration{ComponentType::GroundStation}};
+
+    auto result = mavsdk.add_any_connection("udp://:14540");
+    if (result != ConnectionResult::Success) {
+        GTEST_SKIP() << "No PX4 SITL on udp://:14540, skipping";
+    }
+
+    auto system = mavsdk.first_autopilot(10.0);
+    if (!system) {
+        GTEST_SKIP() << "No autopilot discovered within 10s, skipping";
+    }
+
+    auto geofence = Geofence{system.value()};
+
+    // Build test geofence data: 1 inclusion polygon + 1 exclusion circle
+    Geofence::GeofenceData upload_data;
+
+    Geofence::Polygon polygon;
+    polygon.fence_type = Geofence::FenceType::Inclusion;
+    polygon.points.push_back({47.3977, 8.5456});
+    polygon.points.push_back({47.3980, 8.5460});
+    polygon.points.push_back({47.3975, 8.5465});
+    polygon.points.push_back({47.3972, 8.5458});
+    upload_data.polygons.push_back(polygon);
+
+    Geofence::Circle circle;
+    circle.fence_type = Geofence::FenceType::Exclusion;
+    circle.point = {47.3978, 8.5459};
+    circle.radius = 50.0f;
+    upload_data.circles.push_back(circle);
+
+    // Upload
+    LogInfo() << "Uploading geofence...";
+    auto upload_result = geofence.upload_geofence(upload_data);
+    LogInfo() << "Upload result: " << upload_result;
+    ASSERT_EQ(upload_result, Geofence::Result::Success);
+
+    // Small delay
+    std::this_thread::sleep_for(std::chrono::milliseconds(500));
+
+    // Download
+    LogInfo() << "Downloading geofence...";
+    auto [download_result, download_data] = geofence.download_geofence();
+    LogInfo() << "Download result: " << download_result;
+    ASSERT_EQ(download_result, Geofence::Result::Success);
+
+    // Verify polygon
+    ASSERT_EQ(download_data.polygons.size(), 1u);
+    EXPECT_EQ(download_data.polygons[0].fence_type, Geofence::FenceType::Inclusion);
+    ASSERT_EQ(download_data.polygons[0].points.size(), 4u);
+    EXPECT_NEAR(download_data.polygons[0].points[0].latitude_deg, 47.3977, 1e-5);
+    EXPECT_NEAR(download_data.polygons[0].points[0].longitude_deg, 8.5456, 1e-5);
+    EXPECT_NEAR(download_data.polygons[0].points[3].latitude_deg, 47.3972, 1e-5);
+    EXPECT_NEAR(download_data.polygons[0].points[3].longitude_deg, 8.5458, 1e-5);
+
+    // Verify circle
+    ASSERT_EQ(download_data.circles.size(), 1u);
+    EXPECT_EQ(download_data.circles[0].fence_type, Geofence::FenceType::Exclusion);
+    EXPECT_NEAR(download_data.circles[0].point.latitude_deg, 47.3978, 1e-5);
+    EXPECT_NEAR(download_data.circles[0].point.longitude_deg, 8.5459, 1e-5);
+    EXPECT_FLOAT_EQ(download_data.circles[0].radius, 50.0f);
+
+    // Clean up
+    auto clear_result = geofence.clear_geofence();
+    LogInfo() << "Clear result: " << clear_result;
+    EXPECT_EQ(clear_result, Geofence::Result::Success);
+}