Projekt 02: Lego Mindstorms EV3 Segway

LEGO EV3 Segway

Aufgabenstellung:

• Bauen eines Segways mit dem EV3
• Verwendung eines selbst gewählten Low-Cost-Gyrosensors
• Steuerbar über die LEGO-App

Das Projekt wurde von André Heuken und Carsten Pawliczek im Rahmen des Elektrotechnik Fachpraktikums im WS 2013/14 bearbeitet. Zusätzlich zu diesem Artikel befinden sich weitere Dateien, wie zum Beispiel die Segway-Bauanleitung und vollständiger Programmcode, im SVN.

Auswahl des passenden Reglers für einen Segway

Bei einem Segway handelt es sich um ein inverses Pendel, welches eine instabile Ruhelage besitzt. Mit einem Regler erster Ordnung (PT1) kann eine instabile Ruhelage nicht aufrecht erhalten werden. Es ist ein Regler 2. Ordnung nötig. Nach Recherche haben wir uns für die Umsetzung des Segways mit einem PID-Regler entschieden. Dies ist ein stetiger Regler, dessen Stellwert jeden beliebigen Wert innerhalb eines Stellbereichs annehmen kann. Dieser regelt schnell und lässt keine bleibende Regelabweichung zu. Dabei wirkt der P-Anteil als einfache Verstärkung der Regeldifferenz auf die Stellgröße ein. Der I-Anteil sorgt durch die zeitliche Integration der Regelabweichung dafür, dass die Regelabweichung auf Null kommt. Der D-Anteil reagiert auf die Änderungsgeschwindigkeit der Winkelbeschleunigung und erzeugt dadurch bei kleiner Regeldifferenz große Stellamplituden. Durch das Einstellen von 3 Reglerparametern für den P-, I- und D-Anteil lässt sich somit ein Regeler entwerfen, der die benötigten Anforderungen erfüllt. Quellen: Datei:Regler.pdf sowie die Dokumentation über einen Regler eines inversen Pendels, Seite 10

Umbau eines Beschleunigungssensors für EV3/NXT

Nach unserer Recherche haben wir uns aufgrund der guten Dokumentation auf der Seite von Stefan Frings für den Umbau eines Bosch BMA020 Beschleunigungssensors entschieden. Dieser Sensor ist aufgrund der Referenz Erdanziehungskraft außerdem in der Lage, den Neigungswinkel zu messen. Da die Beschleunigung des Segways im Vergleich zur Erdanziehungskraft relativ klein ist und die Beschleunigung des Segways durch die Raddrehzahl von der Änderung der Beschleunigung des Sensors abgezogen werden kann, ist es möglich, einen Beschleunigungssensor als Neigungswinkelsensor in einem Segway verwenden.

Sensor mit abgelöteten Widerständen und Transistoren

Sensor mit passender LEGO-Buchse

Abweichend vor der Anleitung von Stefan Frings haben wir uns dafür entschieden, den Sensor an eine LEGO-Buchse zu löten, damit dieser frei platzierbar ist und nicht an ein Kabel mit beschränkter Länge gebunden ist.

Ansteuerung des EV3 über MATLAB/Simulink

Vorbereitungen mittels QUT-Toolkit und Kompilierer

Für die Kommunikation haben wir uns an die Anleitung der Queensland University of Technology, kurz QUT, gehalten, welche als Erste eine Kommunikation zwischen dem EV3 und MATLAB herstellen kann [QUT]. Wichtig hierbei ist die Neukompilierung mittels Visual Studio von 32bit auf 64bit der dort hochgeladenen hidapi.dll-Datei für 32bit-Systeme, auch wenn dort steht, dass dies nur bei 32bit-Systemen nötig sei. Die funktionierende dll-Datei liegt in unserem SVN-Ordner. Das Toolkit muss, wie in MATLAB üblich, über Set Path eingebunden werden. Nachfolgend wird über den MATLAB-Befehl mex -setup ein passender Kompilierer ausgewählt, z.B. Visual Studio 2010 oder der frei verfügbare Windows SDK [SDK-Download]. Letzterer wurde von uns verwendet.

Verbindungsaufbau zwischen MATLAB und EV3

Zwischen Dezember 2013 und Januar 2014 war noch keine Kommunikation zwischen Simulink und dem EV3 möglich, da noch keine passende Toolbox vorhanden war. Die Verbindung kann im Anschluss an die Vorbereitungen über b = Brick('ioType','usb') hergestellt werden. Danach sollte im Workspace die Variable b vorhanden sein und die Größe 1x1 Brick haben. Der Verbindungsaufbau hat in unserem 2-Mann-Team allerdings trotz gleicher MATLAB-Version (2013a, 64bit) und selbem Betriebssystem (Windows 7, 64bit) nur auf einem Laptop funktioniert.

Programmierung des Segways

Da wir leider in unserem Projekt für längere Zeit keine Kommunikation mit dem EV3 herstellen konnten (basierend auf oben genannten Schwierigkeiten und Unklarheiten der Dokumentationen der QUT) ist unser Programm beschränkt auf die generelle Kommunikation zum EV3 und ledigliches Prinzipverhalten eines Segways, d.h. Gegensteuern bei Neigung in die eine oder andere Richtung. Aufgrund der Zeitnot durch die Kommunikationsschwierigkeiten stellt unser Programm einen Ansatz dar, der noch weiter ausgebaut werden müsste. Aus selbem Grund beinhaltet unser Ansatz noch keinen I-Anteil, der in einem PID-Regler typischerweise vorhanden sein müsste.

Programmcode

%% Verbindung aufbauen
disp('Connecting ... ')
b = Brick('ioType','usb');
b.beep();
disp('Connected')
%% Variablen initialisieren
t = 0;
kp = 0.5;
kd = 2;
motorPower = 0;
PAnteil = 0;
DAnteil = 0;
%% Motorpower festlegen und starten
b.outputPower(0,Device.MotorA+Device.MotorB,motorPower)
b.outputStart(0,Device.MotorA+Device.MotorB)
pause(0.1);                             % ohne Pause vor der Sensorabfrage entsteht ein NaN-Fehler
reading = b.inputReadSI(0,0,0);         % liest den (LEGO-)Gyrosensor auf Port 1 aus: b.inputReadSI(Ebene, Port, Modus);
pause(0.1);
reading = b.inputReadSI(0,0,0);         % doppelt hält besser, ansonsten entsteht ebenfalls oft ein NaN-Fehler
pause(0.1);
%% Hauptprogramm
while(true)
   PAnteil = b.inputReadSI(0,0,0);     % Absoluter Winkel nach obigem Schema 
   pause(0.1);
   PAnteil = b.inputReadSI(0,0,0);     % Wiederholung da der erste Aufruf NaN-Fehler erzeugt
   pause(0.1);
   DAnteil = b.inputReadSI(0,0,1);     % Winkelgeschwindigkeit in deg/s, immernoch auf Port 1 des EV3
   pause(0.1);
   DAnteil = b.inputReadSI(0,0,1);      
   pause(0.1);    
   if PAnteil < reading   % Wenn der aktuelle Winkel kleiner ist als der beim Initialisieren => Kippgefahr
           motorPower = (kp*PAnteil + kd*DAnteil);            % b.inputReadSI(0,0,0) + 10;
           b.outputPower(0,Device.MotorA+Device.MotorB,motorPower);
           pause(0.0001);
   else PAnteil > reading % Kippgefahr in andere Richtung
           motorPower = -(kp*PAnteil + kd*DAnteil);           % b.inputReadSI(0,0,0) - 10;
           b.outputPower(0,Device.MotorA+Device.MotorB,motorPower);
           pause(0.0001);
   end
end
%% Motoren stoppen, Variablen löschen
b.outputStop(0,Device.MotorA+Device.MotorB,0)
delete(b)

Kleine Sammlung an EV3-Befehlen

Eine Bibliothek über die MATLAB-Befehle für die Kommunikation zum EV3 ist derzeit noch nicht verfügbar, so dass wir uns die Befehle für die Ansteuerung aus den Beispielen der QUT EV3-Seite raussuchen mussten. Nachfolgend ein paar Beispiele, die den Einstieg in die Programmierung des EV3 erleichtern sollten:

• disp ('Text') Zeigt Text auf dem Bildschirm des Bricks an
• b.beep() lässt den Brick ein Geräusch machen, hilfreich z.B. nach dem Verbindungsaufbau im Code
• motorpower = 0 sollte in jedem Programm, in dem Motoren verwendet werden, zu Beginn stehen
• b.outputPower(0,Device.MotorA+Device.MotorB,motorPower) weist den Motoren auf den Kanälen A und B auf layer 0 die zuvor initialisierte motorPower zu, startet diese jedoch noch nicht
• b.outputStart(0,Device.MotorA+Device.MotorB) startet die Motoren auf den Kanälen A und B
• reading = b.inputReadSI(0,0,0) liest Sensoren aus. In der Klammer steht die erste Null für den layer, die Zweite für den Anschluss (beginnt bei 0) und die Dritte für den Modus. Der Gyrosensor hat hier z.B. die Möglichkeit, im Modus 0 den derzeitigen Winkel und im Modus 1 eine Winkelgeschwindigkeit zu liefern.
• pause(0.1) mussten wir überall zwischen den Sensorabfragen einbinden, da wir ansonsten einen NaN-Fehler erhalten haben
• b.outputStop(0,Device.MotorA+Device.MotorB,0); stoppt die zuvor verwendeten Motoren auf den Kanälen A und B

Lessons learned - ein kleines Fazit & ZIP-Datei

In unserem Projekt konnten wir sehr gut unser bisher erlerntes Wissen über die Mess- und Regelungstechnik anwenden. Dies half uns bei der Wahl des passenden Regelkreises sowie bei der Wahl des Sensors, auch wenn wir aufgrund der Probleme mit MATLAB und EV3 nicht mehr zur Implementierung des eigenen Sensors gekommen sind, da die Implementierung das Schreiben eines passenden Treibers erfordert hätte. Aus selbem Grund war die Umsetzung der Ansteuerung per LEGO-App nicht mehr möglich. Wir haben gelernt, in zukünftigen Projekten frühzeitiger bei entstehenden Problemen zu Handeln.

Eine zip-Datei mit allen Projektunterlagen kann hier heruntergeladen werden.

Feedback und Verbesserungsvorschläge zum Artikel

--Ulrich Schneider (Diskussion) 10:28, 24. Jan. 2014 (CET)

• Welche Regelstrecke haben Sie identifiziert? Wie sind Sie dabei vorgegangen? Welche Reglerparameter hat Ihr Regler? Wie haben Sie diese ermittelt? Eine fachliche Herleitung wäre wünschenswert. Wieso muss er Regler "ein PT2-Verhalten aufweisen"? Nennen Sie die Quellen Ihrer Recherche.
• Es ist unklar, wie Sie mit einem Beschleunigungssensor die Lage des Legway regeln wollen. Legen Sie Ihre Ansätze bitte deutlich dar.
• Link auf QUT Homepage und Matlab Central wäre wünscheswert.
• "Zum momentanen Zeitpunkt" ist eine zeitlich inkonkrete Aussage. Publizieren Sie bitte die dll, die funktioniert.
• Fotos sollten besser aufgelöst und besser beleuchtet sein. Schaltplan des Sensors fehlt.
• Der Quelltext ist nicht hilfreich, da Sie Ihre Konfiguration nicht beschrieben haben. Welcher Sensor ist an welchem Port? Wieso gibt der Sensor den P- und D-Anteil des Reglers aus? Sie schreiben oben von einem PID-Regler. Wo wird der I-Anteil berechnet.
• Quellenangaben fehlen
• Die geforderte ZIP Datei fehlt und somit fast sämmtliche für die Projektlösung geforderten Unterlagen.