Пример #1
0
int main( void ) {
  main_init();
  while(1) {
    if (sys_time_periodic())
      main_periodic_task();
    main_event_task();
  }
  return 0;
}
Пример #2
0
/********** MAIN *************************************************************/
int main( void ) {
  init_rctx();

  while(1) {
    if (sys_time_periodic())
      periodic_task_rctx();
    event_task_rctx();
  }
  return 0;
}
Пример #3
0
int main( void ) {
    autopilot_main_init();
    while(1) {
        if (sys_time_periodic()) {
            autopilot_main_periodic();
            sys_time_calculate_cpu_usage();
        }
        autopilot_main_event();
    }
    return 0;
}
Пример #4
0
void aerocomm_init( void ) {

aerocomm_confirmation_received=TRUE;
{  uint8_t init_cpt = 30;
  while (init_cpt) {
    if (sys_time_periodic())
      init_cpt--;
  }
}

#ifdef NO_API_INIT
#warning "NO_API_INIT defined"
#else
#warning "NO_API_INIT not defined"
#endif

#ifndef NO_API_INIT
  /** Switching to AT mode (FIXME: busy waiting) */
  AerocommPrintString(AT_COMMAND_SEQUENCE);

  /** Setting my address */
  uint16_t addr = AEROCOMM_MY_ADDR;
  char s[]=AT_SET_MY;
  s[8]=(unsigned int)(addr>> 8);
  s[9]=(unsigned int)(addr & 0xff);
  for (int i=0; i<10; i++)  AerocommTransportPut1Byte(s[i]);
  
  AerocommPrintString(AT_RESET);
  {  uint8_t init_cpt = 30;
     while (init_cpt) {
     if (sys_time_periodic())
        init_cpt--;
     }
   }

  AerocommPrintString(AT_COMMAND_SEQUENCE);
  AerocommPrintString(AT_AP_MODE);
  /** Switching back to normal mode */
  AerocommPrintString(AT_EXIT);
#endif
}
Пример #5
0
int main( void ) {
  Fbw(init);
  Ap(init);
  while (1) {
    if (sys_time_periodic()) {
      Fbw(periodic_task);
      Ap(periodic_task);
    }
    Fbw(event_task);
    Ap(event_task);
  }
  return 0;
}
Пример #6
0
int main(void) {

  hw_init();
  sys_time_init();
  overo_link_init();
  DEBUG_SERVO1_INIT();

  while (1) {
    if (sys_time_periodic())
      main_periodic();
    main_event();
  }

  return 0;
}
Пример #7
0
int main(void) {
  main_init();

  servos[0] = 1;
  servos[1] = 2;
  servos[2] = 3;
  servos[3] = 4;

  while (1) {
    if (sys_time_periodic())
      main_periodic();
    main_event();
  }
  return 0;
}
Пример #8
0
int main (int argc, char** argv) {
  hw_init();
  sys_time_init();
  led_init();
  adc_init();

  adc_buf_channel(ADC_0, &buf_adc[0], ADC_NB_SAMPLES);
  adc_buf_channel(ADC_1, &buf_adc[1], ADC_NB_SAMPLES);
  adc_buf_channel(ADC_2, &buf_adc[2], ADC_NB_SAMPLES);
  adc_buf_channel(ADC_3, &buf_adc[3], ADC_NB_SAMPLES);
  adc_buf_channel(ADC_4, &buf_adc[4], ADC_NB_SAMPLES);
  adc_buf_channel(ADC_5, &buf_adc[5], ADC_NB_SAMPLES);
#ifdef ADC_6
  adc_buf_channel(ADC_6, &buf_adc[6], ADC_NB_SAMPLES);
#endif
#ifdef ADC_7
  adc_buf_channel(ADC_7, &buf_adc[7], ADC_NB_SAMPLES);
#endif

#if NB_ADC != 8
#error "8 ADCs expected !"
#endif

#ifdef USE_UART0
  Uart0Init();
#endif
#ifdef USE_UART1
  Uart1Init();
#endif

  int_enable();

  while(1) {
    if (sys_time_periodic()) {
      LED_TOGGLE(1);
      uint16_t values[NB_ADC];
      uint8_t i;
      for(i = 0; i < NB_ADC; i++)
	values[i] = buf_adc[i].sum / ADC_NB_SAMPLES;

      uint8_t id = 42;
      DOWNLINK_SEND_ADC(&id, NB_ADC, values);
    }
  }
  return 0;
}
Пример #9
0
int main(void) {

  hw_init();
  sys_time_init();


  /* init RCC */
  RCC_APB2PeriphClockCmd(A_PERIPH , ENABLE);
  //  RCC_APB2PeriphClockCmd(B_PERIPH , ENABLE);
  //  GPIO_DeInit(A_RX_PORT);
  /* Init GPIO for rx pins */
  GPIO_InitTypeDef GPIO_InitStructure;
  GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;
  //  GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AIN;
  GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  GPIO_InitStructure.GPIO_Pin = A_RX_PIN;
  GPIO_Init(A_RX_PORT, &GPIO_InitStructure);
  GPIO_InitStructure.GPIO_Pin = B_RX_PIN;
  GPIO_Init(B_RX_PORT, &GPIO_InitStructure);
  /* Init GPIO for tx pins */
  GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
  GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  GPIO_InitStructure.GPIO_Pin = A_TX_PIN;
  GPIO_Init(A_TX_PORT, &GPIO_InitStructure);
  GPIO_InitStructure.GPIO_Pin = B_TX_PIN;
  GPIO_Init(B_TX_PORT, &GPIO_InitStructure);

  A_TX_PORT->BRR  = A_TX_PIN;

  /* */
  while (1) {
    if (sys_time_periodic())
      main_periodic();
    main_event();
 };
  return 0;
}
void aerocomm_init( void ) {

aerocomm_confirmation_received=TRUE;
{  uint8_t init_cpt = 120;
  while (init_cpt) {
    if (sys_time_periodic())
      init_cpt--;
  }
}

#ifdef NO_API_INIT
#warning "NO_API_INIT defined"
#else
#warning "NO_API_INIT not defined"
#endif

#ifndef NO_API_INIT
  /** Switching to AT mode (FIXME: busy waiting) */
  AerocommPrintString(AT_COMMAND_SEQUENCE);
  char c;
  while (!AerocommLink(ChAvailable())) { 
     uint8_t init_cpt = 3;
     while (init_cpt) {
       if (sys_time_periodic())
          init_cpt--;
     }
  }
  int j;
  j=0;
  while (AerocommLink(ChAvailable()) && j<4) 
  {
	c=AerocommLink(Getch()); j++;
  }

  uint16_t addr = AEROCOMM_MY_ADDR;
  char s[]=AT_SET_MY;
  s[4]=(unsigned int)(0x00);
  s[5]=(unsigned int)(0x50);
  s[6]=(unsigned int)(0x67);
  s[7]=(unsigned int)(0x00);
  s[8]=(unsigned int)(addr>> 8);
  s[9]=(unsigned int)(addr & 0xff);
  AerocommPrintString(AT_READ_MY);
  while (!AerocommLink(ChAvailable())) { 
     uint8_t init_cpt = 3;
     while (init_cpt) {
       if (sys_time_periodic())
          init_cpt--;
     }
  }
  j=0;
  while (AerocommLink(ChAvailable()) && j<4) 
  {
	c=AerocommLink(Getch()); j++;
  }

  if (c!=s[9]) for (j=0; j<10; j++)  AerocommTransportPut1Byte(s[j]);

  while (!AerocommLink(ChAvailable())) { 
     uint8_t init_cpt = 3;
     while (init_cpt) {
       if (sys_time_periodic())
          init_cpt--;
     }
  }
  j=0;
  while (AerocommLink(ChAvailable()) && j<3) 
  {
	c=AerocommLink(Getch()); j++;
  }
  AerocommPrintString(AT_RESET);
  {  uint8_t init_cpt = 60;
     while (init_cpt) {
     if (sys_time_periodic())
        init_cpt--;
     }
   }

  AerocommPrintString(AT_COMMAND_SEQUENCE);
  while (!AerocommLink(ChAvailable())) { 
     uint8_t init_cpt = 3;
     while (init_cpt) {
       if (sys_time_periodic())
          init_cpt--;
     }
  }
  j=0;
  while (AerocommLink(ChAvailable()) && j<4) 
  {
	c=AerocommLink(Getch()); j++;
  }
  AerocommPrintString(AT_AP_MODE);
  while (!AerocommLink(ChAvailable())) { 
     uint8_t init_cpt = 3;
     while (init_cpt) {
       if (sys_time_periodic())
          init_cpt--;
     }
  }
  j=0;
  while (AerocommLink(ChAvailable()) && j<2) 
  {
	c=AerocommLink(Getch()); j++;
  }
  char s1[]=AT_DEST_ADDR;
  s1[2]=(unsigned int)(0x00);
  s1[3]=(unsigned int)(0x01);
  s1[4]=(unsigned int)(0x00);
  for (j=0; j<5; j++)  AerocommTransportPut1Byte(s1[j]);
  while (!AerocommLink(ChAvailable())) { 
     uint8_t init_cpt = 3;
     while (init_cpt) {
       if (sys_time_periodic())
          init_cpt--;
     }
  }
  j=0;
  while (AerocommLink(ChAvailable()) && j<4) 
  {
	c=AerocommLink(Getch()); j++;
  }

  AerocommPrintString(AT_EXIT);
  while (!AerocommLink(ChAvailable())) { 
     uint8_t init_cpt = 3;
     while (init_cpt) {
       if (sys_time_periodic())
          init_cpt--;
     }
  }
  j=0;
  while (AerocommLink(ChAvailable()) && j<4) 
  {
	c=AerocommLink(Getch()); j++;
  }

#endif
}