         for(int i = 0; i < SpeedMappingSize; i++)
         {
             Serial.print(i);
-            Serial.println("----------");
-            Serial.println(SpeedMapping_Motor1[i]);
-            Serial.println(SpeedMapping_Motor2[i]);
-            Serial.println(SpeedMapping_Motor3[i]);
+            Serial.print(":   ");
+            Serial.print(SpeedMapping_Motor1[i]);
+            Serial.print(" - ");
+            Serial.print(SpeedMapping_Motor2[i]);
+            Serial.print(" - ");
+            Serial.print(SpeedMapping_Motor3[i]);
+            Serial.print("\n");
         }
     }
 }


        motor1_RPMCount = 0;
        motor2_RPMCount = 0;
        motor3_RPMCount = 0;
    }



        initState = 1;
    }

    uint8_t delta = 250;
    if (initState == 1 && initTimestamp + delta*2 <= time)
    {
        motor1_RPMCount = 0;
