         return;
     }
 
+    int time = millis();
+
     if(initState == 0)
     {
         initSpeed = 255;


    if (initState == 1 && initTimestamp + delta <= time && initSpeed > 0)
    {
                SpeedMapping_Motor1[initSpeed].RPM = motor1_RPMCount;
                               SpeedMapping_Motor1[initSpeed].Speed = initSpeed;
                               SpeedMapping_Motor1[initSpeed].MappedSpeed = 255 / motor1_MaxRPM * motor1_RPMCount;
                               SpeedMapping_Motor1[initSpeed].Set = true;

        SpeedMapping_Motor2[initSpeed].RPM = motor2_RPMCount;
        SpeedMapping_Motor2[initSpeed].Speed = initSpeed;
        SpeedMapping_Motor2[initSpeed].MappedSpeed = 255 / motor2_MaxRPM * motor2_RPMCount;
                               SpeedMapping_Motor3[initSpeed].Set = true;

        SpeedMapping_Motor3[initSpeed].RPM = motor3_RPMCount;
        SpeedMapping_Motor3[initSpeed].Speed = initSpeed;
        SpeedMapping_Motor3[initSpeed].MappedSpeed = 255 / motor3_MaxRPM * motor3_RPMCount;
                               SpeedMapping_Motor3[initSpeed].Set = true;

        // 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
        {


void loop()
{
    UpdateRPM();

    Calibration();

}
