AlphaBot: Servo ansteuern

Abb. 1: MATLAB^® als serieller Monitor

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

Aufgabenstatus: In Bearbeitung

Inhalt

• Nutzung von MATLAB^® als seriellen Monitor.
• Ansteuerung des Servomotors
• Auslesen eine Potentiometers
• Ansteuern eines Summers
• Statische und dynamische Messung mit dem Ultraschallsensor
• Anwendung rekursiver Filter auf Echtzeitdaten

Lernziele

Nach Durchführung dieser Lektion können Sie

• Debug-Daten speichern und via MATLAB^® visualisieren.
• direkt MATLAB^® als seriellen Monitor nutzen.
• den AlphaBot sicher in Betrieb nehmen, das Potentiometer auslesen und eine RGB-LED ansteuern.
• Entfernungen mit dem Ultraschall-Sensor messen.
• Messwerte in Echtzeit filtern.

Versuchsdurchführung

Aufgabe 4.1: Servo ansteuern

In dieser Aufgabe soll der Ultraschallkopf mittles Servomotor und Potentiometer geschwenkt werden.

1. Machen Sie sich mit dem Demo E24_Servo_Poti vertraut, so dass Sie jede Zeile erläutern können.
2. Kopieren Sie das Beispiel in Ihren Ordner und erweitern Sie es.
3. Lesen Sie die Stellung des Potentiometers aus.
4. Steuern Sie den Servomotor mit dem Potentiometer an. Nutzen Sie hierzu den map-Befehl.
5. 0% ist ganz links und 100% ganz rechts.
6. Lagern Sie die Ansteuerung in eine Funktion dreheUltraschall(Wert) aus.
7. Nutzen Sie MATLAB^® um die Messdaten direkt (live) darzustellen.

Übertragen Sie folgende Parameter:

• fZeit: Zeit
• fEntfernung: Entfernung in cm
• fWinkel: Winkel des Servo-Motors in deg

Lernzielkontrollfragen:

• An welchen Arduino-Pins ist der Servo angeschlossen?

Arbeitsergebnisse in SVN: dreheServoMotor.ino, zeigeUltraschallMesswerte.m

Demo: SVN: E24_Servo_Poti

---

Aufgabe 4.2: Ultraschall als Umfeldscanner

1. Machen Sie sich mit dem Demo E25_Servo_Sweep vertraut, so dass Sie jede Zeile erläutern können.
2. Kopieren Sie das Beispiel in Ihren Ordner und erweitern Sie es.
3. Steuern Sie den Servo von 0°..180° an und fahren Sie zurück auf 0°.
4. Messen Sie pro 1° die Ultraschallentfernung.
5. Nutzen Sie MATLAB^® um die Messdaten direkt (live) darzustellen.
6. Rechnen Sie die Polarkoordinaten (fWinkel, fEntfernung) in kartesische Koordinaten (x, y) um.
7. Stellen Sie die Messpunkte zyklisch dar (vgl. Abb. 2).

Lernzielkontrollfragen:

• An welchen Arduino-Pins ist der Servo angeschlossen?

Arbeitsergebnisse in SVN: UltraschallScanner.ino, zeigeUltraschallScan.m

---

Aufgabe 4.3: Joystick einlesen

1. Machen Sie sich mit dem Demo E20_Joystick vertraut, so dass Sie jede Zeile erläutern können.
2. Kopieren Sie das Beispiel in Ihren Ordner und erweitern Sie es.
3. Lesen Sie den Joystick ein.
4. Entprellen Sie das Joystick-Signal.
5. Steuert den US-Servo mit dem Joystick im Bereich 0°-180° an.
6. LINKS: Drehung nach Links (180°).
7. RECHTS: Drehung nach Rechts (0°).
8. EINGABE: Grehung auf die Mitte (90°).
9. Geben Sie den Joystick-Status im seriellen Monitor aus.

Lernzielkontrollfragen:

• An welchen Arduino-Pins ist der Joystick angeschlossen?
• Werden diese Pins noch von einem anderen System genutzt?
• Kann der Joystick via Interrupt entprellt werden?

Arbeitsergebnisse in SVN: leseJoystick.ino

Tipp 1  Nutzen Sie das Demo für den Joystick E20 und den Servo E25 und kombinieren Sie beide.

Tipp 2 

• Lies die notwendigen Joystick-Bewegungen aus (L, R, Eingabe).
• Initialisiere einen globale Variable für die Position des Servo ServoPosition_s16.
• Inkrementiere bei Joystick-Eingabe LINKS um 5°.
• Dekrementiere bei Joystick-Eingabe RECHTS um -5°.
• Initialisiere ServoPosition_s16 bei Joystick-Eingabe EINGABE mit 90°.
• Sende ServoPosition_s16 an den Servo (usServo.write(ServoPosition_s16);).

ACHTUNG: Begrenze ServoPosition_s16 auf 0°...180° vor dem Senden.

---

Aufgabe 4.4: Ultraschall zur Objekterkennung

1. Der AlphaBot soll ortsfest seine Umgebung durch die Drehung des Ultraschall-Sensors absuchen.
2. Wenn ein Hindernis im Umkreis von 30 cm detektiert wird, ertönt einen Warnton/eine Melodie.
3. Bei Druck auf den Joystick verstummt der Warnton und dafür leuchtet die LED rot auf.
4. Entfernt sich das Hindernis, verstummt der Alarm.
5. Planen Sie als ersten Schritt das Arduino-Programm als PAP.
6. Nutzen Sie MATLAB^® um die Messdaten direkt (live) darzustellen. Objekte werden als gelbe Punkte und Hindernisse (<30 cm) als rote Punkte dargestellt.

Lernzielkontrollfragen:

• An welchen Arduino-Pins ist der Joystick angeschlossen?

Arbeitsergebnisse in SVN: sucheHindernis.pap, sucheHindernis.ino, zeigeUltraschallScan.m

Hinweise:

• Nutzen Sie die Demos E05, E18b im SVN-Verzeichnis.
• Wenn Sie den Summer verwenden möchten, entfernen Sie den Jumper D1, da der Summer auf dem digitalen Eingang D11 eingelesen wird.

---

Aufgabe 4.5: 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

• Erste Schritte mit dem AlphaBot
• Erste Schritte mit der Arduino IDE
• HSHL-Wiki: Ultraschallsensor HC-SR04
• HSHL-Wiki: Servomotor SG90

Demos

• SVN: DemoDebug2MATLAB
• SVN: E05_Ultraschall_Entfernungsmessung
• SVN: E18b_spieleTon
• SVN: E20_Joystick
• SVN: E23_RGB_LED
• SVN: E24_Servo_Poti
• SVN: E25_Servo_Sweep
• SVN: E34_lesePoti

---

→ Termine 1 2 3 4
→ zurück zum Hauptartikel: Informatik Praktikum 2