Check if drone is alredy armed

4b5f4edd · Léo-Paul Géneau · aaeac1d4 · 4b5f4edd
Commit 4b5f4edd authored Aug 29, 2023 by Léo-Paul Géneau 👾
Hide whitespace changes
Inline Side-by-side

Showing with 4 additions and 0 deletions

mavsdk_wrapper.cpp mavsdk_wrapper.cpp +4 -0

No files found.
--- a/mavsdk_wrapper.cpp
+++ b/mavsdk_wrapper.cpp
@@ -266,6 +266,10 @@ int arm(void) {
    if(!mavsdk_started)
        return -1;

+    if (telemetry->armed()) {
+      return 0;
+    }
+
    while(!telemetry->health().is_home_position_ok) {
        log("Waiting for home position to be set");
        sleep_for(seconds(1));