Dieser Abschnitt zeigt, wie der mBot kalibriert werden kann. Grundsätzlich können alle Motoren oder Sensoren kalibriert werden. Ich stelle zwei Varianten vor, wie der mBot kalibriert werden kann (er besitzt keine Encoder), um 90-Grad-Drehungen durchzuführen.

Voraussetzungen:

• Der Abschnitt Hello mBot Blockierung sollte bekannt sein
• Der Abschnitt Hello mBot Programmorganisation sollte bekannt sein.

• Der mBot führt eine Drehbewegung für die Dauer von turn_time aus.
• Nach Ablauf der Zeit stoppt die Bewegung um dann alle 5 Sekunden wiederholt zu werden.
• Die Drehzeit bestimmt, wie weit sich der mBot dreht.

• Falls sich der mBot zu weit dreht → turn_time verringern.
• Falls sich der mBot zu wenig dreht → turn_time erhöhen.
• Der optimale Wert muss durch Tests experimentell ermittelt werden.

#include <MeMCore.h>

MeDCMotor motor1(M1);
MeDCMotor motor2(M2);

void setup() {
    Serial.begin(9600);
}

void loop() {
    turn90Degrees(400); // Hier die Drehzeit anpassen
    delay(5000); // Wartezeit zwischen Drehungen
}

void turn90Degrees(int turn_time) {
    int speed = 100;  // Geschwindigkeit

    motor1.run(speed);  
    motor2.run(speed);  
    delay(turn_time);

    motor1.run(0);
    motor2.run(0);
}

Code noch nicht fertig!

    #include "MeMCore.h"
     
    MeRGBLed led(0, 2);   // must be fixed!
    MeDCMotor motor1(M1); 
    MeDCMotor motor2(M2);  
    int PIN_BUTTON = 7;   // must be fixed!
    int threshold  = 500; // Analoger Schwellenwert!
    int buttonCount;
    unsigned long time90degree;     
     
    enum State {
      STATE_OFF,
      STATE_CALIBRATION,
      STATE_TEST     
    };
    State state = STATE_OFF;
     
    void setup() {
      led.setpin(13);
      pinMode(PIN_BUTTON, INPUT);
      buttonCount = 0;
    }
     
    void loop() {
      // step: command
      int cmd = read();     
      // step: state 
      state  = decode(cmd);     
      // step: action
      switch (state) {
        case STATE_CALIBRATION:
          actionCalibration();
          break;
        case STATE_TEST:
          actionTest();
          break;
        case STATE_OFF:
          actionOff();
          break;
      }
    }
     
     
    /*
     *   Funktionen
     */
    bool turn90Degree(bool left){
      // TODO (nicht-blockierende methode)
      return true;
    }
     
    bool isButtonPressed() {
      static bool buttonPressed = false;
      int value = analogRead(PIN_BUTTON);
     
      if (value < threshold) {
        if (!buttonPressed) {
          buttonPressed = true;
          return true;
        }
      } else {
        buttonPressed = false; // Button wurde losgelassen
      }
      return false;
     
    }
     
    int read() {
      if ( isButtonPressed() )
        buttonCount += 1;
     
      if (buttonCount > 2)
        buttonCount = 0;
     
      return buttonCount;
    }
     
     
    State decode(int cmd) {
      switch (cmd) {
        case 1: return STATE_CALIBRATION;
        case 2: return STATE_TEST;
      }
      return STATE_OFF;
    }
     
    void actionCalibration() {
      led.setColorAt(1, 255, 0, 0);
      led.setColorAt(0, 255, 0, 0);
      led.show();
      // TODO calibrate 90degree here!
      
    }
  void actionTest() {
  led.setColorAt(1, 0, 255, 0);  // Setze LED-Farbe auf grün
  led.setColorAt(0, 0, 255, 0);
  led.show();

  static bool doneLeft = false;  // Zeigt an, ob die linke Drehung abgeschlossen ist
  static bool doneRight = false;  // Zeigt an, ob die rechte Drehung abgeschlossen ist

  // Wenn die linke Drehung noch nicht abgeschlossen ist
  if (!doneLeft) {
    doneLeft = turn90Degree(true);  // Drehung nach links
  } 
  // Wenn die linke Drehung abgeschlossen ist und die rechte Drehung noch nicht
  else if (doneLeft && !doneRight) {
    doneRight = turn90Degree(false);  // Drehung nach rechts
  }
  // Wenn beide Drehungen abgeschlossen sind, gehe in den "OFF"-Zustand
  else if (doneLeft && doneRight) {
    state = STATE_OFF;  // Wechsel zu "OFF", wenn Test abgeschlossen ist
  }
}
   
 
     
    void actionOff() {
      led.setColorAt(1, 0, 0, 0);
      led.setColorAt(0, 0, 0, 0);
      led.show();
      motor1.stop();    
      motor2.stop();    
    }