         motor1_RPMCount = 0;
         motor2_RPMCount = 0;
         motor3_RPMCount = 0;
+
         return;
     }
     else if (initSpeed <= 0)
     {
         init = 2;
-    }
-}
+        SetWheelsTo(0);
+
+        for(uint8_t i = 0; i < sizeof(SpeedMapping_Motor3); ++i) {
+            Serial.println("----------");
+            Serial.println(SpeedMapping_Motor1[i].value);
+            Serial.println(SpeedMapping_Motor2[i].value);
+            Serial.println(SpeedMapping_Motor3[i].value);
+        }
+    }
+}
+
 
 void SetWheelsTo(int speed)
 {

        motor3_RPMCount = 0;

        initSpeed = 255;

        SetWheelsTo(initSpeed);
        initTimestamp = time;
        init = 1;
        return;
    }

    if (initTimestamp + 250 <= time && initSpeed == 255)
    {

    }

    if (initTimestamp + 250 <= time && initSpeed > 0)
    {
        //motor1_Lookup[motor1_RPMCount] = initSpeed;
        //motor2_Lookup[motor2_RPMCount] = initSpeed;
        //motor3_Lookup[motor3_RPMCount] = initSpeed;


        SpeedMapping_Motor1[initSpeed].RPM = motor1_RPMCount
        SpeedMapping_Motor1[initSpeed]Speed = initSpeed
        SpeedMapping_Motor1[initSpeed]MappedSpeed =

        // 255 - 245 - 235 - 225 - 215 - 205 - 195 - 185 - 175 - 165 - 155 - 145
        if (initSpeed > 150)
        {
            initSpeed -= 10;
        }
        // 140 - 135 - 130 - 125 - 120 - 115 - 110 - 105 - 100 - 95 - 90 - 85 - 80 - 75
        else if(initSpeed > 75)
        {
            initSpeed -= 5;
        }
        // 75 - 0
        else
        {
            initSpeed -= 1;

int motorPin3_speed = 9;
int motorPin3_A = A5;

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

int motor1_RPMCount = 0;
int motor1_State = 0;
