diff --git a/libraries/AP_BoardConfig/AP_BoardConfig.cpp b/libraries/AP_BoardConfig/AP_BoardConfig.cpp index 43d9afdbfa..c5917a16bf 100644 --- a/libraries/AP_BoardConfig/AP_BoardConfig.cpp +++ b/libraries/AP_BoardConfig/AP_BoardConfig.cpp @@ -21,7 +21,7 @@ #include #include #include -#include +#include #include #if HAL_WITH_UAVCAN @@ -315,6 +315,12 @@ void AP_BoardConfig::init() printf("SDCard failed to start\n"); } #endif + + // run any the vehicle initialization routines + AP_Vehicle *vehicle = AP::vehicle(); + if (vehicle) { + vehicle->init_vehicle(); + } } // set default value for BRD_SAFETY_MASK