AlphaBot: Motoren und Inkrementalgeber

Aus HSHL Mechatronik
Zur Navigation springen Zur Suche springen
Abb. 1: Lichtschrankenzustände CNTL/CNTR

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

Inhalt

  • Ansteurung der Motoren
  • Auslesen der Lichtschranken via Interrupt
  • Berechnung der gefahrenen Strecke
  • Fahrt einer definierten Strecke und Figur.
  • Berechnung des Kurswinkels aus diffenentieller Odometrie

Lernziele

Nach Durchführung dieser Lektion können Sie

  • die Fahrstrecke des linken und rechten Rades aus den Lichtschrankensignale berechnen.
  • eine definierte Strecke und Figur fahren.
  • die Position und Lage eines mobilen Roboters mittels diffenentieller Odometrie schätzen.

Versuchsdurchführung

Aufgabe 5.1: Lichtschranke

  1. Bitte aktualisieren Sie ihre Arduino / librarie.
  2. Machen Sie sich mit dem Demo E13_Lichtschranke vertraut, so dass Sie jede Zeile erläutern können.
  3. Kopieren Sie das Beispiel in Ihren Ordner und erweitern Sie es.
  4. Lassen Sie als Test beide Motoren langsam vorwärts drehen.
  5. Flankenwechsel von CNTL/CNTR sollen einen Interrupt auslösen.
  6. Stellen Sie beide Lichtschrankenzustände CNTL/CNTR über der Zeit in MATLAB® dar (vgl. Abb. 2).

Lernzielkontrollfragen:

  • Wie funktioniert eine Lichtschranke?
  • Wo befinden sich die Lichtschranken?
  • Wo ist rechts und wo links?
  • An welchen Ports sind die linke und rechte Lichtschranke angeschlossen?
  • Welche IO-Pins sind beim Arduino Uno interruptfähig?
  • Wie entscheidet die Lichtschranke zwischen Vorwärts- oder Rückwärtsdrehung?
  • Wieviele Flanken erhalten Sie für eine Radumdrehung?

Arbeitsergebnisse: testeLichtschranke.ino, testeLichtschranke.m, leseArduinoDaten.m


Aufgabe 5.2: RadInkrementalgeber

  1. Machen Sie sich mit E15_RadInkrementalgeberFahrt vertraut, so dass Sie jede Zeile erläutern können.
  2. Kopieren Sie das Beispiel in Ihren Ordner und erweitern Sie es.
  3. Rechnen Sie die Radumdrehungen in gefahrene Strecke um.
  4. Stellen Sie die gefahrene Strecke über der Zeit in MATLAB® dar (vgl. Abb. 3).

Lernzielkontrollfragen:

  • Was ist ein Interrupt und wozu dient er?
  • Wozu dient die Funktion attachInterrupt()?
  • Wie lässt sich die die gefahrene Strecke berechnen?

Arbeitsergebnis: testeRadInkrementalgeber.ino, zeigeRadInkrementalgeber.m, leseArduinoDaten.m


Aufgabe 5.3: 1 m Fahrt

  1. Machen Sie sich mit dem Demo E15_RadInkrementalgeberFahrt vertraut, so dass Sie jede Zeile erläutern können.
  2. Fahren Sie mit Ihrem Fahrzeug genau 1 m geradeaus vorwärts.
  3. Fahren Sie wieder zum Startpunkt zurück. Wenden Sie das Fahrzeug nicht!
  4. Der AlphaBot inkrementiert die Strecke bei Vorwärtsfahrt und dekrementiert bei Rückwärtsfahrt.
  5. Stellen Sie die gefahrene Strecke im seriellen Monitor dar.


Lernzielkontrollfragen:

  • Wie kann die Fahrtrichtung bei der Streckenbestimmung berücksichtigt werden?
  • Wurde 1 m gefahren? Steht der AlphaBot wieder am Startpunkt? Begründen Sie ggf. die Abweichung.

Arbeitsergebnis: fahreVorZurueck.ino


Aufgabe 5.4: Differentielle Odometrie

Odometrie bezeichnet eine Methode der Schätzung von Position und Orientierung (Lageschätzung) eines mobilen Roboters anhand der Daten seines Vortriebsystems. Durch Räder angetriebene Systeme benutzen dafür die Anzahl der Radumdrehungen, während laufende Systeme (z. B. Roboter) die Anzahl ihrer Schritte verwenden. Ein Gerät, das die Odometrie zur Lageschätzung verwendet, ist ein Odometer. Die Odometrie ist im Zusammenspiel mit der Koppelnavigation ein grundlegendes Navigationsverfahren für bodengebundene Fahrzeuge aller Art (Kraftfahrzeuge, Roboter), allerdings wird es auf Grund seiner Fehlereigenschaften selten als alleiniges Verfahren eingesetzt. In dieser Aufgabe werden die Raddrehzahlen der beiden Räder zur Lageschätzung verwendet.

  1. Erweitern Sie Ihr bisheriges Programm, um die Seiten eines Quadrates im Uhrzeigersinn abzufahren (vgl. Abb. 4).
  2. Die Seitenlänge a ist eine Variable und soll 30 cm betragen.
  3. Führen Sie eine Schleife 4x aus, die aus Geradeausfahrt und Drehung besteht.
Abb. 4: Fahren Sie im Uhrzeigersinn die Seiten eines Quadrates ab

Lernzielkontrollfragen:

  • Kommen Sie wieder am Startpunkt an?
  • Begründen Sie ggf. eine Abweichung.

Arbeitsergebnis: fahreQuadrat.ino


Aufgabe 5.5: Nachhaltige Doku

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

Arbeitsergebnis in SVN: SVN Log

Tutorials

Demos

Literatur


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