/** * @brief Module initialization * @return 0 */ static int32_t BrushlessGimbalInitialize() { // Listen for ActuatorDesired updates (Primary input to this module) ActuatorDesiredInitialize(); queue = PIOS_Queue_Create(MAX_QUEUE_SIZE, sizeof(UAVObjEvent)); ActuatorDesiredConnectQueue(queue); BrushlessGimbalSettingsInitialize(); return 0; }
/** * Initialise the UAVORelay module * \return -1 if initialisation failed * \return 0 on success */ int32_t GimbalControlInitialize(void) { #ifdef MODULE_GimbalControl_BUILTIN module_enabled = true; #else module_enabled = false; #endif if (!module_enabled) return -1; // Create object queues queue = PIOS_CAN_RegisterMessageQueue(pios_can_id, PIOS_CAN_GIMBAL); BrushlessGimbalSettingsInitialize(); CameraDesiredInitialize(); return 0; }