[Converter] implemented simple convertion function from NED to angles

CMakeLists.txt

@@ -104,3 +104,6 @@ add_executable(nokia-groundstation-entry
 )
 target_include_directories(nokia-groundstation-entry PRIVATE ${OBSW_INCLUDE_DIRS})
 sbs_target(nokia-groundstation-entry stm32f429zi_skyward_groundstation_v2)
+
+add_executable(automated-antennas-entry src/entrypoints/Groundstation/automated-antennas-entry.cpp)
+sbs_target(automated-antennas-entry stm32f407vg_stm32f4discovery)

src/entrypoints/Groundstation/AutomatedAntennas/Converter.h

+#pragma once
+
+#include <cmath>
+
+struct NEDCoords
+{
+    float n = 0;
+    float e = 0;
+    float d = 0;
+};
+
+struct AntennaAngles
+{
+    float theta1 = 0;
+    float theta2 = 0;
+};
+
+AntennaAngles rocketPositionToAntennaAngles(const NEDCoords& ned)
+{
+    AntennaAngles angles;
+    angles.theta1 = std::atan2(ned.n, ned.e);
+    angles.theta2 = std::atan2(-ned.d, ned.n);
+    return angles;
+}
\ No newline at end of file

src/entrypoints/Groundstation/automated-antennas-entry.cpp

+#include <drivers/timer/TimestampTimer.h>
+#include <miosix.h>
+
+#include "AutomatedAntennas/Converter.h"
+
+using namespace miosix;
+using namespace Boardcore;
+
+inline float randf() { return (std::rand() % 200 - 100) / 100.f; }
+
+int main()
+{
+    constexpr int N = 10000;
+
+    printf("Starting test\n");
+    uint64_t start = TimestampTimer::getTimestamp();
+
+    for (int i = 0; i < N; i++)
+    {
+        NEDCoords coords     = {randf(), randf(), randf()};
+        AntennaAngles angles = rocketPositionToAntennaAngles(coords);
+        printf("NED: %.2f ; %.2f ; %.2f -> Angles %.2f ; %.2f\n", coords.n,
+               coords.e, coords.d, angles.theta1, angles.theta2);
+    }
+
+    uint64_t end = TimestampTimer::getTimestamp();
+    printf("Took %lld millis for %d calls.\n", (end - start) / 1000ull, N);
+
+    return 0;
+}