diff --git a/Marlin/Marlin.pde b/Marlin/Marlin.pde
index 05924b93a4a4f6780fa6df1beb029de9f84bb92f..538920da2ffbc6243dff9f017dd66a7e0cbd9680 100644
--- a/Marlin/Marlin.pde
+++ b/Marlin/Marlin.pde
@@ -989,7 +989,11 @@ FORCE_INLINE void process_commands()
     case 201: // M201
       for(int8_t i=0; i < NUM_AXIS; i++) 
       {
-        if(code_seen(axis_codes[i])) axis_steps_per_sqr_second[i] = code_value() * axis_steps_per_unit[i];
+        if(code_seen(axis_codes[i]))
+        {
+          max_acceleration_units_per_sq_second[i] = code_value();
+          axis_steps_per_sqr_second[i] = code_value() * axis_steps_per_unit[i];
+        }
       }
       break;
     #if 0 // Not used for Sprinter/grbl gen6