test

Test2/Core/Src/math.c

@@ -0,0 +1,33 @@
+/*
+ * math.c
+ *
+ *  Created on: 2 февр. 2026 г.
+ *      Author: v0stap
+ */
+#include "main.h"
+
+uint16_t map16_t(uint16_t x, uint16_t in_min, uint16_t in_max, uint16_t out_min, uint16_t out_max) {
+    // Input validation: avoid division by zero
+    if (in_max == in_min) {
+        fprintf(stderr, "Error: Input range cannot be zero.\n");
+        return out_min;
+    } else {
+    // Perform mapping
+    	return (uint16_t)(out_min + (x - in_min) * (out_max - out_min) / (in_max - in_min));
+    }
+}
+
+uint16_t LPF(unsigned short lpf_c, unsigned short value, unsigned short old_value) {
+	// Averageing filtering
+
+	float tmp;
+
+	tmp = ((float) (value - old_value) * ((float) (lpf_c) / (float) 1000.0)); // filter
+	if (tmp > 0)
+		tmp += (float) 0.5;					// roundup
+	else
+		tmp -= (float) 0.5;
+
+	return (uint16_t)((signed int) old_value + (signed int) tmp);
+
+}