diff --git a/lib/Romi32U4Motors/src/Romi32U4MotorTemplate.h b/lib/Romi32U4Motors/src/Romi32U4MotorTemplate.h
index c347b63..9e72bc3 100644
--- a/lib/Romi32U4Motors/src/Romi32U4MotorTemplate.h
+++ b/lib/Romi32U4Motors/src/Romi32U4MotorTemplate.h
@@ -25,10 +25,10 @@ protected:
     enum CTRL_MODE : uint8_t {CTRL_DIRECT, CTRL_SPEED};
     volatile CTRL_MODE ctrlMode = CTRL_DIRECT;
 
-    float Kp = 2.50; // proportional to error
-    float Ki = 0.03;
+    float Kp = 6.00; // proportional to error
+    float Ki = 0.05;
     float Kd = 0;
-    float Kf = 3.00; // proportional to setpoint
+    float Kf = 4.50; // proportional to setpoint
     int16_t C = 22; // constant added to effort
 
     // Used to keep track of the target speed, in counts / interval.