         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");
         }
     }
 }


    if (initState == 2 && initTimestamp + delta <= time && initSpeed > 0)
    {
        //SpeedMapping_Motor1[initSpeed] = 255 * motor1_RPMCount / motor1_MaxRPM;
        //SpeedMapping_Motor2[initSpeed] = 255 * motor2_RPMCount / motor2_MaxRPM;
        //SpeedMapping_Motor3[initSpeed] = 255 * motor3_RPMCount / motor3_MaxRPM;

       if(SpeedMapping_Motor1[255 * motor1_RPMCount / motor1_MaxRPM] == 0)
       {
             SpeedMapping_Motor1[255 * motor1_RPMCount / motor1_MaxRPM] = initSpeed;
       }

       if(SpeedMapping_Motor2[255 * motor2_RPMCount / motor2_MaxRPM] == 0)
       {
             SpeedMapping_Motor2[255 * motor2_RPMCount / motor2_MaxRPM] = initSpeed;
       }

       if(SpeedMapping_Motor3[255 * motor3_RPMCount / motor3_MaxRPM] == 0)
       {
             SpeedMapping_Motor3[255 * motor3_RPMCount / motor3_MaxRPM] = initSpeed;
       }


        // 12:  255 - 245 - 235 - 225 - 215 - 205 - 195 - 185 - 175 - 165 - 155 - 145
        if (initSpeed > 150)
        {
            initSpeed -= 10;
        }

        // 14:  140 - 135 - 130 - 125 - 120 - 115 - 110 - 105 - 100 - 95 - 90 - 85 - 80 - 75
        else if (initSpeed > 75)
        {
            initSpeed -= 5;
        }

        // 76:  75 - 0
        else
        {
            initSpeed -= 1;

// ----------

// TODO: check if only one would be enough
const int SpeedMappingSize = 101;
uint8_t SpeedMapping_Motor1[SpeedMappingSize];
uint8_t SpeedMapping_Motor2[SpeedMappingSize];
uint8_t SpeedMapping_Motor3[SpeedMappingSize];
