diff --git a/UAV-ControlSystem/src/drivers/motors.c b/UAV-ControlSystem/src/drivers/motors.c
index 37387fa..8ec92bb 100644
--- a/UAV-ControlSystem/src/drivers/motors.c
+++ b/UAV-ControlSystem/src/drivers/motors.c
@@ -13,8 +13,8 @@
 #include "drivers/pwm.h"
 #include "drivers/motors.h"
 
-int MotorPWMPeriode = 2000; //Micro seconds
-int MotorPWMInitPulse =	1000;
+const int MotorPWMPeriode = 2000; //Micro seconds
+const int MotorPWMInitPulse = 1000;
 
 /* A struct of a pwm motor profile */
 typedef struct
@@ -126,16 +126,13 @@ uint32_t setMotorOutput(motorOutput motorOutput)
 	switch(motorOutput)
 	{
 	case PWM:
-		MotorPWMPeriode = 2000;
 		prescaler = 88;
 		break;
 	case Oneshot125:
-		MotorPWMPeriode = 16000;
 		prescaler = 11;
 		break;
 	default:
-		MotorPWMPeriode = 2000;
-		prescaler = 88;
+		prescaler = 11;
 		break;
 	}