Check if drone is alredy armed

b47b6b9e · Léo-Paul Géneau · 4c26d4ae · b47b6b9e
Commit b47b6b9e 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
@@ -260,6 +260,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));