diff --git a/ESP-IDF_Robot/main/motor_controls.h b/ESP-IDF_Robot/main/motor_controls.h
index 41b08d612..47984de3b 100644
--- a/ESP-IDF_Robot/main/motor_controls.h
+++ b/ESP-IDF_Robot/main/motor_controls.h
@@ -20,8 +20,8 @@ static int interpolate_raw_val (int raw) {
 static int rescale_raw_val (int raw) {
 
     int s;
-    //s = 4*raw - 8190;
-    s = -(raw*raw) + 4.122*raw - 8190;
+    s = 4*raw - 8190;
+    //s = -(raw*raw) + 4.122*raw - 8190;
     //s = (8190/2048^1)*(raw - 2048)^1;   // Linear rescaling
     //s = (8190/1870^3)*(raw - 1870)^3;   // Cubic rescaling
     return s;