AlphaBot: Servo ansteuern
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.
- Voreinstellungen am AlphaBot nicht alle Sensoren funktionieren gleichzeitig, da sie den gleichen Arduino Pin benutzen. Entfernen Sie bitte dazu am AlphaBot einzelne gelbe Brücken. Am F-Port die Brücke D10 und das Dual-Mode Bluetooth Modul auf dem Sensor-Shield.
- Aktualisieren Sie die Arduino Bibliothek.
- Machen Sie sich mit dem Demo
E24_Servo_Poti
vertraut, so dass Sie jede Zeile erläutern können. - Kopieren Sie das Beispiel in Ihren Ordner und erweitern Sie es.
- Lesen Sie die Stellung des Potentiometers aus.
- Steuern Sie den Servomotor mit dem Potentiometer an. Nutzen Sie hierzu den
map
-Befehl. - 0% ist ganz links und 100% ganz rechts.
- Lagern Sie die Ansteuerung in eine Funktion
dreheUltraschall(Wert)
aus. - Nutzen Sie MATLAB® um die Messdaten direkt (live) darzustellen.
Übertragen Sie folgende Parameter:
fZeit
: ZeitfEntfernung
: Entfernung in cmfWinkel
: Winkel des Servo-Motors in deg
Lernzielkontrollfragen:
- An welchem Arduino-Pins ist das Poti angeschlossen?
- An welchem Arduino-Pins ist der Servo angeschlossen?
Arbeitsergebnisse in SVN: dreheServoMotor.ino
, zeigeUltraschallMesswerte.m
Tipp 1 |
Nutzen Sie das Demo SVN: E24_Servo_Poti. |
Sie können den Potentiometerwinkel mit read() auslesen.
|
Je nachdem, ob Akkus eingelegt sind oder nicht, hat das Poti leicht andere Werte. |
Die Multisensorerweiterung verursacht gelegentlich Probleme. Nutzen Sie für den Ultraschallsensor ggf. andere Digital-IO (z. B. D7, D8 ).
|
Aufgabe 4.2: Ultraschall als Umfeldscanner
- Voreinstellungen am AlphaBot: Entfernen Sie am AlphaBot am F-Port die Brücke D11 & D12.
- Machen Sie sich mit dem Demo
E25_Servo_Sweep
vertraut, so dass Sie jede Zeile erläutern können. - Kopieren Sie das Beispiel in Ihren Ordner und erweitern Sie es.
- Steuern Sie den Servo von 0°..180° an und fahren Sie zurück auf 0°.
- Messen Sie pro 5 ° die Ultraschallentfernung.
- Nutzen Sie MATLAB® um die Messdaten direkt (live) darzustellen.
- Rechnen Sie die Polarkoordinaten (
fWinkel
,fEntfernung
) in kartesische Koordinaten (x, y
) um. - 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
Tipp 1 |
Nutzen Sie das Demo SVN: E25_Servo_Sweep. |
Tipp 2 |
Umrechnung der Koordinaten polar→kartesisch: |
Aufgabe 4.3: Joystick einlesen
- Voreinstellungen am AlphaBot: Legen Sie keine Akkus ein (Betrieb am USVB-Kabel).
- Machen Sie sich mit dem Demo
E20_Joystick
vertraut, so dass Sie jede Zeile erläutern können. - Kopieren Sie das Beispiel in Ihren Ordner und erweitern Sie es.
- Lesen Sie den Joystick mit der Funktion int
leseJoystickStatus()
ein. - Entprellen Sie darin das Joystick-Signal.
- Steuert den US-Servo mit dem Joystick im Bereich 0°-180° an.
- LINKS: Drehung nach Links (180°).
- RECHTS: Drehung nach Rechts (0°).
- EINGABE: Drehung auf die Mitte (90°).
- Geben Sie den Joystick-Status im seriellen Monitor aus. Nutzen Sie hierzu die
switch..case
-verzweigung.
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 |
|
ACHTUNG: Begrenze ServoPosition_s16 auf 0°...180° vor dem Senden.
|
Aufgabe 4.4: Ultraschall zur Objekterkennung
- Voreinstellungen am AlphaBot, entfernen sie bitte das Dual-Mode Bluetooth Modul,am A-Port A1, A2, A3 & D6, am E-Port A4, A5, am F-Port D10. Zusätzlich müssen Sie ein Kabel stecken, zwischen dem Ultraschall Pin D12 und D10, da D12 schon für die LED benötigt wird.
- Der AlphaBot soll ortsfest seine Umgebung durch die Drehung des Ultraschall-Sensors absuchen.
- Wenn ein Hindernis im Umkreis von 30 cm detektiert wird, ertönt einen Warnton/eine Melodie.
- Bei Druck auf den Joystick verstummt der Warnton und dafür leuchtet die LED rot auf.
- Entfernt sich das Hindernis, verstummt der Alarm.
- Planen Sie als ersten Schritt das Arduino-Programm als PAP.
- Nutzen Sie MATLAB® um die Messdaten direkt (live) darzustellen. Objekte werden als gelbe Punkte und Hindernisse (<30 cm) als rote Punkte dargestellt.
Lernzielkontrollfragen:
- Sollten die Messwerte gefiltert werden?
Arbeitsergebnisse in SVN: sucheHindernis.pap
, sucheHindernis.ino
, zeigeUltraschallScan.m
Tipp 1 |
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
- HSHL-Wiki: Übersicht der AlphaBot Steckbrücken
- HSHL-Wiki: AlphaBot Multisensorerweiterung
- HSHL-Wiki: Übersicht des AlphaBot Uno Plus
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