AP_Mount: initialize backends after all mounts were added

Icatme · Sep 1, 2021 · af634f0 · af634f0
1 parent 88f2f7c
commit af634f0
Showing 1 changed file with 7 additions and 1 deletion.
diff --git a/libraries/AP_Mount/AP_Mount.cpp b/libraries/AP_Mount/AP_Mount.cpp
@@ -470,13 +470,19 @@ void AP_Mount::init()
 
         // init new instance
         if (_backends[instance] != nullptr) {
-            _backends[instance]->init();
             if (!primary_set) {
                 _primary = instance;
                 primary_set = true;
             }
         }
     }
+
+    // init each instance, do it after all instances were created, so that they all know things
+    for (uint8_t instance=0; instance<AP_MOUNT_MAX_INSTANCES; instance++) {
+        if (_backends[instance] != nullptr) {
+            _backends[instance]->init();
+        }
+    }
 }
 
 // update - give mount opportunity to update servos.  should be called at 10hz or higher