Ejemplo n.º 1
0
void stabilizerInit(void) {
	if (isInit)
		return;

	motorsInit();
	imu6Init();
	sensfusion6Init();
	controllerInit();

	rollRateDesired = 0;
	pitchRateDesired = 0;
	yawRateDesired = 0;

	xTaskCreate(stabilizerTask, (const signed char * const )"STABILIZER",
			2*configMINIMAL_STACK_SIZE, NULL, /*Piority*/2, NULL);

	isInit = TRUE;
}
void stabilizerInit(void)
{
  if(isInit)
    return;

  motorsInit();
  imu6Init();
  sensfusion6Init();
  controllerInit();

  rollRateDesired = 0;
  pitchRateDesired = 0;
  yawRateDesired = 0;

  xTaskCreate(stabilizerTask, (const signed char * const)STABILIZER_TASK_NAME,
              STABILIZER_TASK_STACKSIZE, NULL, STABILIZER_TASK_PRI, NULL);

  isInit = true;
}
Ejemplo n.º 3
0
void stabilizerInit(void)
{
  if(isInit)
    return;

  motorsInit(motorMapDefaultBrushed);
  imu6Init();
  sensfusion6Init();
  controllerInit();

  rollDesired = 0;
  pitchDesired = 0;
  yawDesired = 0;

  xTaskCreate(stabilizerTask, STABILIZER_TASK_NAME,
              STABILIZER_TASK_STACKSIZE, NULL, STABILIZER_TASK_PRI, NULL);

  isInit = true;
}
Ejemplo n.º 4
0
void stabilizerInit(void)
{
  if(isInit)
    return;

  motorsInit(motorMapBrushed);
  imu6Init();
  sensfusion6Init();
  controllerInit();
#if defined(SITAW_ENABLED)
  sitAwInit();
#endif

  rollRateDesired = 0;
  pitchRateDesired = 0;
  yawRateDesired = 0;

  xTaskCreate(stabilizerTask, (const signed char * const)STABILIZER_TASK_NAME,
              STABILIZER_TASK_STACKSIZE, NULL, STABILIZER_TASK_PRI, NULL);

  isInit = true;
}
void sensorsInit(void)
{
 imu6Init();
}