src/main/drivers/timer_common.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 "platform.h"
  22
  23 #include "drivers/io.h"
  24 #include "timer.h"
  25
  26 #ifdef USE_TIMER_MGMT
  27 #include "pg/timerio.h"
  28 #endif
  29
  30 uint8_t timerIndexByTag(ioTag_t ioTag)
  31 {
  32 #ifdef USE_TIMER_MGMT
  33     for (unsigned i = 0; i < MAX_TIMER_PINMAP_COUNT; i++) {
  34         if (timerIOConfig(i)->ioTag == ioTag) {
  35             return timerIOConfig(i)->index;
  36         }
  37     }
  38 #else
  39     UNUSED(ioTag);
  40 #endif
  41     return 0;
  42 }
  43
  44 const timerHardware_t *timerGetByTag(ioTag_t ioTag)
  45 {
  46     if (!ioTag) {
  47         return NULL;
  48     }
  49
  50     uint8_t timerIndex = timerIndexByTag(ioTag);
  51     uint8_t index = 1;
  52
  53     for (int i = 0; i < (int)USABLE_TIMER_CHANNEL_COUNT; i++) {
  54         if (timerHardware[i].tag == ioTag) {
  55             if (index == timerIndex || timerIndex == 0) {
  56                 return &timerHardware[i];
  57             }
  58             index++;
  59         }
  60     }
  61     return NULL;
  62 }
  63
  64 ioTag_t timerioTagGetByUsage(timerUsageFlag_e usageFlag, uint8_t index)
  65 {
  66     uint8_t currentIndex = 0;
  67     for (int i = 0; i < (int)USABLE_TIMER_CHANNEL_COUNT; i++) {
  68         if ((timerHardware[i].usageFlags & usageFlag) == usageFlag) {
  69             if (currentIndex == index) {
  70                 return timerHardware[i].tag;
  71             }
  72             currentIndex++;
  73         }
  74     }
  75     return IO_TAG_NONE;
  76 }