src/main/pg/timerio.c

   1 /*
   2  * This file is part of Cleanflight and Betaflight.
   3  *
   4  * Cleanflight and Betaflight are free software. You can redistribute
   5  * this software and/or modify this software under the terms of the
   6  * GNU General Public License as published by the Free Software
   7  * Foundation, either version 3 of the License, or (at your option)
   8  * any later version.
   9  *
  10  * Cleanflight and Betaflight are distributed in the hope that they
  11  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
  12  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  * See the GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this software.
  17  *
  18  * If not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #include <string.h>
  22
  23 #include "platform.h"
  24
  25 #ifdef USE_TIMER_MGMT
  26
  27 #include "drivers/dma_reqmap.h"
  28 #include "drivers/timer.h"
  29
  30 #include "timerio.h"
  31
  32 PG_REGISTER_ARRAY_WITH_RESET_FN(timerIOConfig_t, MAX_TIMER_PINMAP_COUNT, timerIOConfig, PG_TIMER_IO_CONFIG, 0);
  33
  34 void pgResetFn_timerIOConfig(timerIOConfig_t *config)
  35 {
  36 #if defined(USE_TIMER_MGMT) && USABLE_TIMER_CHANNEL_COUNT > 0
  37     unsigned configIndex = 0;
  38     for (unsigned timerIndex = 0; timerIndex < USABLE_TIMER_CHANNEL_COUNT; timerIndex++) {
  39         const timerHardware_t *configuredTimer = &timerHardware[timerIndex];
  40         unsigned positionIndex = 1;
  41         for (unsigned fullTimerIndex = 0; fullTimerIndex < FULL_TIMER_CHANNEL_COUNT; fullTimerIndex++) {
  42             const timerHardware_t *timer = &fullTimerHardware[fullTimerIndex];
  43             if (timer->tag == configuredTimer->tag) {
  44                 if (timer->tim == configuredTimer->tim && timer->channel == configuredTimer->channel) {
  45                     config[configIndex].ioTag = timer->tag;
  46                     config[configIndex].index = positionIndex;
  47
  48                     config[configIndex].dmaopt = dmaGetOptionByTimer(configuredTimer);
  49
  50                     configIndex++;
  51
  52                     break;
  53                 } else {
  54                     positionIndex++;
  55                 }
  56             }
  57         }
  58     }
  59 #else
  60     UNUSED(config);
  61 #endif
  62 }
  63 #endif