Cleanup project structure. Update unit test Makefile to place object

files in obj/test

src/main/telemetry/telemetry.c

@@ -0,0 +1,171 @@
+#include <stdbool.h>
+#include <stdint.h>
+#include <stdlib.h>
+
+#include "platform.h"
+
+#include "drivers/gpio.h"
+#include "drivers/timer.h"
+#include "drivers/serial.h"
+#include "drivers/serial_softserial.h"
+#include "io/serial.h"
+
+#include "config/runtime_config.h"
+#include "config/config.h"
+
+#include "telemetry/telemetry.h"
+#include "telemetry/frsky.h"
+#include "telemetry/hott.h"
+#include "telemetry/msp.h"
+
+
+static bool isTelemetryConfigurationValid = false; // flag used to avoid repeated configuration checks
+static bool telemetryEnabled = false;
+static bool telemetryPortIsShared;
+
+static telemetryConfig_t *telemetryConfig;
+
+void useTelemetryConfig(telemetryConfig_t *telemetryConfigToUse)
+{
+    telemetryConfig = telemetryConfigToUse;
+}
+
+bool isTelemetryProviderFrSky(void)
+{
+    return telemetryConfig->telemetry_provider == TELEMETRY_PROVIDER_FRSKY;
+}
+
+bool isTelemetryProviderHoTT(void)
+{
+    return telemetryConfig->telemetry_provider == TELEMETRY_PROVIDER_HOTT;
+}
+
+bool isTelemetryProviderMSP(void)
+{
+    return telemetryConfig->telemetry_provider == TELEMETRY_PROVIDER_MSP;
+}
+
+bool canUseTelemetryWithCurrentConfiguration(void)
+{
+    if (!feature(FEATURE_TELEMETRY)) {
+        return false;
+    }
+
+    if (!canOpenSerialPort(FUNCTION_TELEMETRY)) {
+        return false;
+    }
+
+    return true;
+}
+
+void initTelemetry()
+{
+    telemetryPortIsShared = isSerialPortFunctionShared(FUNCTION_TELEMETRY, FUNCTION_MSP);
+    isTelemetryConfigurationValid = canUseTelemetryWithCurrentConfiguration();
+
+    if (isTelemetryProviderFrSky()) {
+        initFrSkyTelemetry(telemetryConfig);
+    }
+
+    if (isTelemetryProviderHoTT()) {
+        initHoTTTelemetry(telemetryConfig);
+    }
+
+    if (isTelemetryProviderMSP()) {
+        initMSPTelemetry(telemetryConfig);
+    }
+
+    checkTelemetryState();
+}
+
+bool determineNewTelemetryEnabledState(void)
+{
+    bool enabled = true;
+
+    if (telemetryPortIsShared) {
+        if (telemetryConfig->telemetry_switch)
+            enabled = rcOptions[BOXTELEMETRY];
+        else
+            enabled = f.ARMED;
+    }
+
+    return enabled;
+}
+
+bool shouldChangeTelemetryStateNow(bool newState)
+{
+    return newState != telemetryEnabled;
+}
+
+uint32_t getTelemetryProviderBaudRate(void)
+{
+    if (isTelemetryProviderFrSky()) {
+        return getFrSkyTelemetryProviderBaudRate();
+    }
+
+    if (isTelemetryProviderHoTT()) {
+        return getHoTTTelemetryProviderBaudRate();
+    }
+    return 0;
+}
+
+static void configureTelemetryPort(void)
+{
+    if (isTelemetryProviderFrSky()) {
+        configureFrSkyTelemetryPort();
+    }
+
+    if (isTelemetryProviderHoTT()) {
+        configureHoTTTelemetryPort();
+    }
+}
+
+
+void freeTelemetryPort(void)
+{
+    if (isTelemetryProviderFrSky()) {
+        freeFrSkyTelemetryPort();
+    }
+
+    if (isTelemetryProviderHoTT()) {
+        freeHoTTTelemetryPort();
+    }
+}
+
+void checkTelemetryState(void)
+{
+    if (!isTelemetryConfigurationValid) {
+        return;
+    }
+
+    bool newEnabledState = determineNewTelemetryEnabledState();
+
+    if (!shouldChangeTelemetryStateNow(newEnabledState)) {
+        return;
+    }
+
+    if (newEnabledState)
+        configureTelemetryPort();
+    else
+        freeTelemetryPort();
+
+    telemetryEnabled = newEnabledState;
+}
+
+void handleTelemetry(void)
+{
+    if (!isTelemetryConfigurationValid || !determineNewTelemetryEnabledState())
+        return;
+
+    if (isTelemetryProviderFrSky()) {
+        handleFrSkyTelemetry();
+    }
+
+    if (isTelemetryProviderHoTT()) {
+        handleHoTTTelemetry();
+    }
+
+    if (isTelemetryProviderMSP()) {
+        handleMSPTelemetry();
+    }
+}