1 files changed, 12 insertions, 0 deletions
diff --git a/src/stm32/TODO/maths.c b/src/stm32/TODO/maths.c
new file mode 100644
index 0000000..ef3698b
--- /dev/null
+++ b/src/stm32/TODO/maths.c
@@ -0,0 +1,12 @@
+#include "maths.h"
+
+#include <math.h>
+
+float clamp( float x, float min, float max ){
+    if (x > max)
+        return max;
+    else if (x < min)
+        return min;
+    else
+        return x;
+}