diff --git a/src/APP/Aufgabe4/ps7/core0/cfg/imu.h b/src/APP/Aufgabe4/ps7/core0/cfg/imu.h
index 4527fc0..882cbab 100644
--- a/src/APP/Aufgabe4/ps7/core0/cfg/imu.h
+++ b/src/APP/Aufgabe4/ps7/core0/cfg/imu.h
@@ -26,7 +26,11 @@
 int mpu9250_Imu_Init(void *pdata);
 int mpu9250_CalculateAngle(void *pdata);
 
+/* Enforce min <= input <= max */
+#define CONSTRAIN(input, min, max) ((input) > (max) ? (max) : ((input) < (min) ? (min) : input))
 
+/* Map value to region */
+#define MAP(input, in_min, in_max, out_min, out_max) ((((input) - (in_min)) * ((out_max) - (out_min))) / ((in_max) - (in_min)) + (out_min))
 
 #endif /* SRC_APP_AUFGABE7_PS7_CORE0_CFG_IMU_H_ */