Code: Alles auswählen

    if(ChannelNum == 0 || ChannelNum == ChannelCnt) {   // during sync pulse or in failsafe
      if(DSM2_Sent == 0) {                  // if DSM2 frame is not sent yet
        for (byte i=0; i<DSM2_CHANNELS; i++) { // get receiver data
          pulse = Receiver.getChannelData(ChanIndex[i]) - 1000;
          pulse = constrain(pulse, 0, 0x3FF);
          DSM2_Channel[i*2]   = (byte)(i<<2) | highByte(pulse);
          DSM2_Channel[i*2+1] = lowByte(pulse);
        }
        sendDSM2();                         // send frame        
          delay(2);                        // in case of failsafe
//        DSM2_Sent = 1;                      // frame sent flag
      } else {
        if(Receiver.getState() == FAILSAFE) {
          delay(20);                        // in case of failsafe
          DSM2_Sent = 0;                    // reset flag after delay
        }
      }