diff --git a/Src/stepper.c b/Src/stepper.c
index c7dcbf7..1198469 100644
--- a/Src/stepper.c
+++ b/Src/stepper.c
@@ -128,7 +128,10 @@ void do_steps(){
         if(steppers[i].homed){
             static uint16_t old_ramp_to_speed;
             old_ramp_to_speed = steppers[i].ramp_to_speed;
-            steppers[i].ramp_to_speed = rxBuffer[i+1] - steppers[i].pos;
+
+            uint16_t *p = (uint16_t*)&rxBuffer[1];
+
+            steppers[i].ramp_to_speed = __builtin_bswap16(*p) - steppers[i].pos;
 
             if(old_ramp_to_speed == 0 && steppers[i].ramp_to_speed != 0)
                 steppers[i].trigger_step = 1;