AlphaBot: Geregelte Fahrt mit Linienverfolger

Abb. 1: Geregelte Fahrt mit Linienverfolger

Abb. 2: AlphaBot Linienverfolger

Autor: Prof. Dr.-Ing. Schneider
Modul: Praxismodul I
Lehrveranstaltung: Mechatronik, Informatik Praktikum 2, 2. Semester

Inhalt

• Inbetriebnahme des Linienverfolgungssensors
• Kalibrierung des Linienverfolgungssensors
• 2-Punkt-Regler
• PD-Regler
• x-y-Plot der Roboterpose

Lernziele

Nach Durchführung dieser Lektion können Sie

• geregelt einer Linie folgen.
• den Kurswinkel aus differenzieller Odometrie bestimmen und darstellen.
• die Funktion eines PID-Reglers erläutern.
• einen PD-Regler systematisch auslegen.
• die Auslegung systematisch dokumentieren

Vorbereitung/Hausaufgabe

Bereiten Sie diese Aufgabe für den Praktikumstermin vor.

• Planen Sie jede Aufgabe als PAP.
• Nehmen Sie den Linienverfolger anhand der Beispiel E28_IR_Line_Tracking_Sensor_Messung und E28b_IR_Line_Tracking_Sensor in Betrieb.
• Nutzen Sie das Tutorial AlphaBot_Linienverfolgungsssensor zur Einarbeitung.
• Kalibrieren Sie den Sensor.
• Zeigen Sie die Messwerte im Seriellen Monitor an.
• Kapseln Sie die Kalibrierung in der Funktion void KalibriereLinienVerfolger().
• Beantworten Sie die Lernzielkontrollfragen.
• Ohne umfangreiche Vorbereitung werden Sie nicht zum Praktikum zugelassen.

Arbeitsergebnis: void KalibriereLinienVerfolger()

Tipp 1 

void KalibriereLinienVerfolger() {
  Serial.println("Kalibrierung startet für 10s...");
  for (int i = 0; i < 400; i++)                  // Die Kalibrierung kann 10s dauern.
  {
    trs.calibrate();                             // Die Sensoren werden 10x gelesen
  }
  Serial.println("Kalibrierung beendet");      

  /* Ausgabe der Minimalwerte während der Kalibrierung */
  for (int i = 0; i < NUM_SENSORS; i++)
  {
    Serial.print(trs.calibratedMin[i]);
    Serial.print(' ');
  }
  Serial.println();

  /* Ausgabe der Maximalwerte während der Kalibrierung */
  for (int i = 0; i < NUM_SENSORS; i++)
  {
    Serial.print(trs.calibratedMax[i]);
    Serial.print(' ');
  }
  Serial.println();
  delay(1000);                     // 1 Sekunde Pause
}

Lernzielkontrollfragen

Lernzielkontrollfragen:

• Wie funktioniert der Linienverfolgungssensors technisch?
• Arbeitet der Sensor passiv?
• Welche Bauteile kommen in Sender und Empfänger zum Einsatz?
• Welche Wellenlänge hat das ausgesendete Licht? Ist dieses sichtbar?
• Wieso und wie wird der Sensor kalibriert?
• Erläutern Sie wie und wieso ein gewichteter Mittelwert gebildet wird.
• Welchen Messbereich hat das Sensorsystem?
• Welcher Wert dient als Sollwert?

Versuchsdurchführung

Aufgabe 8.1: 2-Punkt-Regler

Programmieren Sie einen 2-Punkt-Regler, damit der AlphaBot der schwarzen Linien folgt. Der 2-Punkt-Regler fährt beispielsweise nach rechts, wenn er hell sieht und nach links, wenn er Schwarz sieht. So "hangelt" er sich zappelig an der Linie entlang.

Arbeitsergebnissse: ZweiPunktRegler.pap, ZweiPunktRegler.ino

Tipp 1 

Abb. 3: Ablaufplan im Loop

Abb. 3: PAP des 2-Punkt-Reglers im void loop()

Aufgabe 8.2: PD-Regler

Abb. 4: Regelkreis für den Linienverfolgungs-Algorithmus

Programmieren Sie einen PD-Regler gemäß Abb. 4, damit der AlphaBot der schwarzen Linien folgt. Planen Sie zuvor das Programm als PAP.

$u(t) = K_P \cdot e(t) + K_D \cdot \frac{d}{dt}e(t)$

1. Wählen Sie den Sollwert als Konstante.
2. In welchem Bereich bewegt sich der Istwert?
3. Setzen Sie die Motorsteuerung mit dem Befehl MotorRun(L,R) um, wobei gilt $L,R \in [-250; 250]$.
4. Experimentieren Sie, welche Parameter Kp, Kd die besten Ergebnisse liefern.
5. Dokumentieren Sie Ihre Ergebnisse systematisch tabellarisch.

Arbeitsergebnisse: PDRegler.pap, PDRegler.ino, PD_Parametervariation.xslx

Tipp 1  Nützliche Links:

• info8uniwue: Einführung PID Regler
• Loviscach, J.: P- und PI-Regler; Einstellung nach Ziegler-Nichols
• Studyfix: Regelkreis
• AlphaBot - Linienverfolgungssensor

Tipp 2 

Abb. 6: Ablaufplan im Loop

Abb. 6: PAP des PID-Reglers im void loop()

Tipp 3  Studieren Sie das Beispiel [E08b_Infrared_Line_Tracking_PD]. Achten Sie darauf, dass Sie in einer Gleichung dieselben Dateitypen verrechnen. Möchten Sie beispielsweise eine Fließkommazahl berechnen müssen Sie alle Variable mit float() umwandeln. Lassen Sie einen Motor (R) mit konstanter Leistung (z. B. 80) fahren und verändern sie relativ dazu den anderen Motor (z. B. $L= 80 \pm 20$). Legen Sie den Regler für eine sanfte Geradenfahrt aus.

1. Legen Sie mit Kd = 0 zuerst Kp aus.
2. Gehen Sie wissenschaftlich vor. Schreiben Sie alle Beobachtungen in eine Tabelle. Sind Sie zufrieden, ändern Sie den Kp-Wert nicht mehr (z. B. Kp = -0.01).
3. Variieren Sie nun Kd, um die Schwingung des P-Reglers zu dämpfen. Bei mir ist Kd = 0.5* Kp.
4. Manche Gruppen haben mit einem reinen P-Regler bereits zufriedenstellende Ergebnisse erziehlt.

Aufgabe 8.3: Geradeausfahrt mit Linienverfolger

Nun wollen wir gleichzeitig den Ultraschall und Linienverfolger nutzen.

1. Bereiten Sie sich vor, indem Sie die Funktion des Linienverfolgungssensors in der gängigen Fachliteratur (z. B. AlphaBot - Linienverfolgungssensor) recherchieren und erläutern können.
2. Nutzen Sie schwarzes Klebeband auf einem hellen Untergrund (z. B. weißes Blatt Papier), um eine gerade Fahrstrecke von 2 m zu markieren.
3. Drehen Sie den Ultraschall-Sensor auf 180° (Blick auf die Wand).
4. Messen Sie während der Fahrt die gefahrene Strecke (x) mit der Odometrie.
5. Messen Sie während der Fahrt den Abstand zur Wand (y) mit dem Ultraschall Sensor.
6. Folgen Sie der schwarzen Linie möglichst geradlinig.
7. Experimentieren Sie, welche Parameter Kp, Kd die besten Ergebnisse liefern.
8. Dokumentieren Sie Ihre Ergebnisse systematisch tabellarisch.
9. Zeichnen Sie die Roboterpose (x,y,ψ) in MATLAB^®.

Arbeitsergebnisse: PDReglerUltraschall.pap, PDReglerUltraschall.ino, zeigeRoboterpose.m

Aufgabe 8.4: Nachhaltige Doku

Sichern Sie alle Ergebnisse mit beschreibendem Text (message) in SVN.

• Halten Sie die Regeln für den Umgang mit SVN ein.
• Halten Sie die Programmierrichtlinie für C und die Programmierrichtlinien für MATLAB^® ein.
• Versehen Sie jedes Programm mit einem Header (Header Beispiel für MATLAB, Header Beispiel für C).
• Kommentiere Sie den Quelltext umfangreich.

Arbeitsergebnis in SVN: SVN Log

Tutorials

• AlphaBot_Linienverfolgungsssensor
• info8uniwue: Einführung PID Regler
• Loviscach, J.: P- und PI-Regler; Einstellung nach Ziegler-Nichols
• Studyfix: Regelkreis

Demos

• E28_IR_Line_Tracking_Sensor_Messung
• E28b_IR_Line_Tracking_Sensor
• E08_Infrared_Line_Tracking
• E08b_Infrared_Line_Tracking_PD

Literatur

---

→ Termine 1 2 3 4 5 6 7 8 9
→ zurück zum Hauptartikel: Informatik Praktikum 2