Timer clean up in preparation for configurable timers

src/main/drivers/timer_common.c

@@ -0,0 +1,73 @@
+/*
+ * This file is part of Cleanflight and Betaflight.
+ *
+ * Cleanflight and Betaflight are free software. You can redistribute
+ * this software and/or modify this software under the terms of the
+ * GNU General Public License as published by the Free Software
+ * Foundation, either version 3 of the License, or (at your option)
+ * any later version.
+ *
+ * Cleanflight and Betaflight are distributed in the hope that they
+ * will be useful, but WITHOUT ANY WARRANTY; without even the implied
+ * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
+ * See the GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this software.
+ *
+ * If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include "drivers/io.h"
+#include "timer.h"
+#ifdef USE_TIMER_MGMT
+#include "pg/timerio.h"
+#endif
+
+uint8_t timerIndexByTag(ioTag_t ioTag)
+{
+#ifdef USE_TIMER_MGMT
+    for (unsigned i = 0; i < MAX_TIMER_PINMAP_COUNT; i++) {
+        if (timerIOConfig(i)->ioTag == ioTag) {
+            return timerIOConfig(i)->index;
+        }
+    }
+#else
+    UNUSED(ioTag);
+#endif
+    return 0;
+}
+
+const timerHardware_t *timerGetByTag(ioTag_t ioTag)
+{
+    if (!ioTag) {
+        return NULL;
+    }
+
+    uint8_t timerIndex = timerIndexByTag(ioTag);
+    uint8_t index = 1;
+
+    for (int i = 0; i < (int)USABLE_TIMER_CHANNEL_COUNT; i++) {
+        if (timerHardware[i].tag == ioTag) {
+            if (index == timerIndex || timerIndex == 0) {                
+                return &timerHardware[i];
+            }
+            index++;
+        }
+    }
+    return NULL;
+}
+
+ioTag_t timerioTagGetByUsage(timerUsageFlag_e usageFlag, uint8_t index)
+{
+    uint8_t currentIndex = 1;
+    for (int i = 0; i < (int)USABLE_TIMER_CHANNEL_COUNT; i++) {
+        if ((timerHardware[i].usageFlags & usageFlag) == usageFlag) {
+            if (currentIndex == index || index == 0) {
+                return timerHardware[i].tag;
+            }
+            currentIndex++;
+        }
+    }
+    return IO_TAG_NONE;
+}