예제 #1
0
/**
 * @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;
}
예제 #2
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;
}