diff --git a/libraries/AP_Mount/AP_Mount.cpp b/libraries/AP_Mount/AP_Mount.cpp index 46f0677666..be5d3a87e0 100644 --- a/libraries/AP_Mount/AP_Mount.cpp +++ b/libraries/AP_Mount/AP_Mount.cpp @@ -408,6 +408,9 @@ void AP_Mount::init() return; } + // primary is reset to the first instantiated mount + bool primary_set = false; + // create each instance for (uint8_t instance=0; instanceinit(); + if (!primary_set) { + _primary = instance; + primary_set = true; + } } } }