Projekt 02: Lego Mindstorms EV3 Segway

Aus HSHL Mechatronik
Zur Navigation springen Zur Suche springen
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. 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. Quellen: Datei:Regler.pdf Regler inverses Pendel, Seite 10

--Ulrich Schneider (Diskussion) 10:14, 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.

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 der Sensor einen konkreten Winkel, so wie es der Sensor von LEGO auch schafft, auslesen kann. 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 vor dem Umbau
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.

--Ulrich Schneider (Diskussion) 10:18, 24. Jan. 2014 (CET) Es ist unklar, wie Sie mit einem Beschleunigungssensor die Lage des Legway regeln wollen. Legen Sie Ihre Ansätze bitte deutlich dar.

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.

--Ulrich Schneider (Diskussion) 10:19, 24. Jan. 2014 (CET) Link auf QUT Homepage und Matlab Central wäre wünscheswert.

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.

--Ulrich Schneider (Diskussion) 10:21, 24. Jan. 2014 (CET) "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.

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)

--Ulrich Schneider (Diskussion) 10:26, 24. Jan. 2014 (CET) 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.

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

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

Lessons learned - ein kleines Fazit

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.