radio/src/trainer_input.cpp

   1 /*
   2  * Copyright (C) OpenTX
   3  *
   4  * Based on code named
   5  *   th9x - http://code.google.com/p/th9x
   6  *   er9x - http://code.google.com/p/er9x
   7  *   gruvin9x - http://code.google.com/p/gruvin9x
   8  *
   9  * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  */
  20
  21 #include "trainer_input.h"
  22
  23 int16_t ppmInput[MAX_TRAINER_CHANNELS];
  24 uint8_t ppmInputValidityTimer;
  25
  26
  27 #if defined(CPUARM)
  28 #include "audio_arm.h"
  29
  30 void checkTrainerSignalWarning()
  31 {
  32   enum PpmInValidState_t {
  33     PPM_IN_IS_NOT_USED=0,
  34     PPM_IN_IS_VALID,
  35     PPM_IN_INVALID
  36   };
  37
  38   static uint8_t ppmInputValidState = PPM_IN_IS_NOT_USED;
  39
  40   if (ppmInputValidityTimer && (ppmInputValidState == PPM_IN_IS_NOT_USED)) {
  41     ppmInputValidState = PPM_IN_IS_VALID;
  42   }
  43   else if (!ppmInputValidityTimer && (ppmInputValidState == PPM_IN_IS_VALID)) {
  44     ppmInputValidState = PPM_IN_INVALID;
  45     AUDIO_TRAINER_LOST();
  46   }
  47   else if (ppmInputValidityTimer && (ppmInputValidState == PPM_IN_INVALID)) {
  48     ppmInputValidState = PPM_IN_IS_VALID;
  49     AUDIO_TRAINER_BACK();
  50   }
  51 }
  52
  53 #endif