diff --git a/Firmware/Configuration_prusa.h b/Firmware/Configuration_prusa.h
index bd1f50e17..a7579d063 100644
--- a/Firmware/Configuration_prusa.h
+++ b/Firmware/Configuration_prusa.h
@@ -21,6 +21,7 @@ GENERAL SETTINGS
 // Prusa Single extruder multiple material suport
 //#define SNMM
 #define MK3
+#define EINSY_HIGH_SAMPLE_RATE
 
 // Uncomment the below for the E3D PT100 temperature sensor (with or without PT100 Amplifier)
 //#define E3D_PT100_EXTRUDER_WITH_AMP
@@ -38,7 +39,11 @@ AXIS SETTINGS
 	#define DEFAULT_AXIS_STEPS_PER_UNIT   {100,100,3200/8,140}
 #else
 	#ifdef MK3
-		#define DEFAULT_AXIS_STEPS_PER_UNIT   {100,100,3200/8,133}
+		#ifdef EINSY_HIGH_SAMPLE_RATE
+			#define DEFAULT_AXIS_STEPS_PER_UNIT   {200,200,3200/4,133*4}
+		#else 
+			#define DEFAULT_AXIS_STEPS_PER_UNIT   {100,100,3200/8,133}
+		#endif
 	#else
 		#define DEFAULT_AXIS_STEPS_PER_UNIT   {100,100,3200/8,161.3}
 	#endif
diff --git a/Firmware/tmc2130.h b/Firmware/tmc2130.h
index 6c8920a7a..9f599e06c 100644
--- a/Firmware/tmc2130.h
+++ b/Firmware/tmc2130.h
@@ -1,6 +1,7 @@
 #ifndef TMC2130_H
 #define TMC2130_H
 
+#include "Configuration_prusa.h"
 
 /*------------------------------------
  TMC2130 default settings
@@ -8,13 +9,15 @@
 
 #define TMC2130_FCLK 12000000       // fclk = 12MHz
 
-#define TMC2130_USTEPS_XY   16        // microstep resolution for XY axes
-#define TMC2130_USTEPS_Z    16        // microstep resolution for Z axis
-//#define TMC2130_USTEPS_E    32        // microstep resolution for E axis
-#define TMC2130_USTEPS_E    16        // microstep resolution for E axis
-#define TMC2130_INTPOL_XY   1         // extrapolate 256 for XY axes
-#define TMC2130_INTPOL_Z    1         // extrapolate 256 for Z axis
-#define TMC2130_INTPOL_E    1         // extrapolate 256 for E axis
+#ifdef EINSY_HIGH_SAMPLE_RATE
+	#define TMC2130_USTEPS_XY   32        // microstep resolution for XY axes
+	#define TMC2130_USTEPS_Z    32        // microstep resolution for Z axis
+	#define TMC2130_USTEPS_E    64        // microstep resolution for E axis
+#else
+	#define TMC2130_USTEPS_XY   16        // microstep resolution for XY axes
+	#define TMC2130_USTEPS_Z    16        // microstep resolution for Z axis
+	#define TMC2130_USTEPS_E    16        // microstep resolution for E axis
+#endif
 
 #define TMC2130_PWM_GRAD_X  2         // PWMCONF
 #define TMC2130_PWM_AMPL_X  230       // PWMCONF