Code: Alles auswählen

...
void initializeMotors() {
  for(uint8_t i=0;i<NUMBER_MOTOR;i++)
    pinMode(PWM_PIN[i],OUTPUT);
  for(int i=0;i<4;i++)    //computeRC will take the average of last four readings, initial value is set to 1500
    computeRC();
  if (MCUSR & 0x01) //Initialize only if "Power-On Reset"
  {
    if(rcData[THROTTLE] > MAXCHECK)
    {
      writeAllMotors(2000);
      delay(300);
      while(rcData[THROTTLE] > MAXCHECK)
        computeRC();
      writeAllMotors(MINCOMMAND);
      delay(300);
    }
  }
  else
  {
    writeAllMotors(MINCOMMAND);
    delay(300);
  } 
  MCUSR &= ~(0x01);
 
}
...

Code: Alles auswählen

...
void setup() {
  boolean Init_done = 0;
  LEDPIN_PINMODE
  POWERPIN_PINMODE
  BUZZERPIN_PINMODE
  POWERPIN_OFF
  configureReceiver();
  delay(200);
  initializeMotors(); 
  Serial.begin(SERIAL_COM_SPEED);
  readEEPROM();
  checkFirstTime();
  POWERPIN_ON
  delay(100);
  i2c_init();
  delay(100);
...