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