Fehlertolerante Programmierung der Gleiter-Regelung
(EN google-translate)
(PL google-translate)
gleiter3_leer.sce.zip - Ausgangspunkt für die fehlertolerante Programmierung der Gleiter-Regelung.
Für den Gleiter soll nun beispielhaft eine fehlertolerante Programmierung durchgeführt werden und die Programmteile gemäß den zuvor besprochenen "Patterns for Fault Tolerant Software" (Kapitel 6) geplant bzw. identifiziert werden.
Hauptziel der Fehlertoleranten Programmierung ist die Abschwächung der Wirkung von möglicherweise auftretenden Störungen. Diese sollen nach Möglichkeit nicht gleich zu einem Versagen des Systems führen.
Gleichwohl gibt es Störungen, denen mit selbsttätig durchführbaren Handlungen des Fahrzeugs nicht mehr beizukommen ist. Auch dies sollte vom Fahrzeug erkannt werden und entsprechende Aktionen ausgeführt werden, z.B. stehenbeleiben und Hilfe holen.
Beschränkungen dieser Umsetzung
Aufgrund des hohen Vereinfachungsgrades des Simulationsmodells, können bei weitem nicht alle "Patterns for Fault Tolerant Software" hier sinnvoll eingesetzt werden. Beispielsweise können in diesem Modell der Sensor und die (nicht vorhandene Hardware - z.B. bei partiellem Stromausfall) keine Störungen erfahren und so braucht es keinen Observer, der diese Dinge überwacht, oder einen zweiten redundanten Sensor, der bei Ausfall des ersten verwendet wird. Jedoch ließen sich im weiteren Verlauf durchaus auch weitere Pattern sinnvoll einsetzen, wenn das Simulationsmodell entsprechend erweitert wird. Beispielsweise könnte ein zweiter Sensor eingesetzt werden, der in anderen Situationen gut arbeitet als der erste und beide über zwei Recovery-Blöcke alternativ verwendet werden: Wenn mit dem ersten keine plausiblen Ergebnisse erzielt werden, nimm den zweiten.
Eskalationsstufen
Eine gute Aufteilung der Möglichkeiten zur Abschwächung der Wirkung von Störungen, gibt die Aufteilung der vorausschauend identifizierten möglichen Situationen in Eskalationsstufen.
Innerhalb seiner stark vereinfachten Umgebung können bei dem Gleiter grundsätzlich drei aktuelle Situationen unterschieden werden:
|
In dieser einfachen Umsetzung einer fehlertoleranten Programmierung der Gleiter-Regelung, soll der Gleiter kein Gedächtnis für den Verlauf der Sensorwerte haben.
In Situation 3 (Gleiter außerhalb Bahn) könnte in einer späteren Version noch versucht werden, die Umgebung langsam nach dem Bahnrand abzusuchen. Dies soll in einer ersten Version zunächst noch nicht passieren. Damit bleibt für das Fahrzeug nichts anderes, als stehen zu bleiben. Dies ist die extremste Situation, die auftreten kann. In diesem Fall kann die "Aufgabe" gegen Uhrzeigersinn im Kreis zu fahren nicht mehr erfüllt werden. Bei der Aufteilung in Eskalationsstufen entspricht dies dann der höchsten Eskalationsstufe.
Beim Erreichen des Randes ist ein Eingreifen eines Regelmechanismus erforderlich, um ein Verlassen der Bahn zu vermeiden. Dies ist eine geringere Eskalationsstufe, als die, bei der die Bahn verlassen wurde. Es stellt eine unmittelbare Gefahr dar, wenn die Bahn verlassen wird, weil danach keine Navigation des Fahrzeugs mehr möglich sein wird.
Je nach Güte der Implementierung der eigentlichen Fahrtregelung mag es passieren, dass das Fahrzeug mitten auf dem Weg stehen bleibt, weil keine Antriebskraft mehr vorgegeben wird und es durch die Dämpfung vollständig abgebremst wurde. Da auch der Sensor keine nützliche Information liefert, außer, dass sich das Fahrzeug mitten auf der Fahrbahn befindet, nimmt es aufgrund der normalen Regelung dann wahrscheinlich keine Fahrt mehr auf. Hier könnte ein kleiner Schubs helfen, was dann einer noch niedrigeren Eskalationsstufe entspricht.
Schließlich kann es sein, dass die verlangte Aufgabe nicht richtig erfüllt wird. Beispielsweise könnte das Fahrzeug statt gegen Uhrzeigersinn im Uhrzeigersinn die Bahn entlangfahren, sich auf der Bahn in suboptimaler Weise (Zick-Zack) bewegen, oder nur in einem Abschnitt hin- und herfahren. Dies sind weniger dramatische Situationen, die aber auch vom Fahrzeug selbsttätig erkannt und verbessert werden können sollten.
Somit ergeben sich grob vier deutlich in ihrer Extremheit unterscheidbare Grundsituationen, auf die mit drei unterschiedlichen Eskalationsstufen reagiert werden sollte:
|
Die Umsetzung der Programm-Lösung soll nun in Stufen erfolgen, wobei mit der höchsten Eskalationsstufe begonnen wird und dann nach und nach die davor stehenden und natürlich auch ein Konzept zur Bewältigung der gestellten Aufgabe (gegen Uhrzeigersinn auf der Bahn fahren) ergänzt werden.
Erste Umsetzungsstufe: Eskalationsstufe 4 - Fahrzeug hat die Bahn verlassen
gleiter4_Eskalation4.sce.zip - Realisierung der vierten Eskalationsstufe.
Arbeitsweise: Sobald in der Sensormatrix keine hellen Elemente (Fahrbahn) mehr enthalten sind, wird mittels Fx und Fy eine starke Dämpfungskraft entgegen dem momentanen Geschwindigkeitsvektor aufgebracht:
if ( sensorsumme==0 ) then
Fx = -30*vx; //entgegen Fahrtrichtung Dämpfung stark erhöhen.
Fy = -30*vy;
end
Code 0-1: Codeausschnitt zur Realisierung der 4. Eskalationsstufe.
Zweite Umsetzungsstufe: Eskalationsstufe 3 - Fahrzeug läuft Gefahr, die Bahn zu verlassen und wird daran gehindert
gleiter5_Eskalation3.sce.zip - Ergänzung der dritten Eskalationsstufe zur dritten.
Arbeitsweise: Sobald der Mittelpunkt des Gleiters aus der Fahrbahn herausragt, reagiert das Fahrzeug so, als wäre es über eine Feder mit der Fahrbahn verbunden und würde zurück gezogen werden.
Der Verbindungsvektor der Sensormitte hin zum Schwerpunkt der hellen Felder beim Sensor wird als Richtungsvektor der Federkraft genommen.
if ( sum(sensormatrix)==0 ) then
//4. Eskalationsstufe: stehenbleiben, wenn der Sensor keine Wegstücke mehr anzeigt:
Fx = -30*vx; //entgegen Fahrtrichtung Dämpfung stark erhöhen.
Fy = -30*vy;
elseif( sensormatrix(SENSORRADIUS,SENSORRADIUS)==0 ) then
//3. Eskalationsstufe: Bei Gefahr, die Bahn zu verlassen (Sensormitte nicht mehr auf Fahrbahn)
// wird eine Art Federkraft zwischen Gleiter und Bahn wirksam.
//Richtungsvektor für die Federkraft als Schwerpunkt der hellen Felder im Sensor berechnen:
koordx = [ -3 -2 -1 0 1 2 3
-3 -2 -1 0 1 2 3
-3 -2 -1 0 1 2 3
-3 -2 -1 0 1 2 3
-3 -2 -1 0 1 2 3
-3 -2 -1 0 1 2 3
-3 -2 -1 0 1 2 3];
//ACHTUNG: geometrisch ist ein kleines y unten, in der Matrix ist ein kleiner Indexwert aber oben:
koordy = [ -3 -3 -3 -3 -3 -3 -3
-2 -2 -2 -2 -2 -2 -2
-1 -1 -1 -1 -1 -1 -1
0 0 0 0 0 0 0
1 1 1 1 1 1 1
2 2 2 2 2 2 2
3 3 3 3 3 3 3];
Fx = 400 * ( sum(koordx.*sensormatrix)/sum(sensormatrix) );
Fy = 400 * ( sum(koordy.*sensormatrix)/sum(sensormatrix) );
end
Code 0-2: Code-Teil mit 3. und 4. Eskalationsstufe.
Regelungskonzept, um die eigentliche Aufgabe zu erfüllen
Die Bedingungen, unter denen die Eskalationsstufen erkannt werden, können als Beobachtungsinstanzen aufgefaßt werden, die die Daten, die der Sensor liefert daraufhin untersuchen, ob sie für eine normale Regelung der Fahr geeignet sind.
|
Bei einem realistischeren System, könnten andere Beobachter-Instanzen (Bedingungen / Kontrollstrukturen) beispielsweise auch prüfen, ob die Sensordaten plausibel / verläßlich sind.
Insofern aber nicht erkannt wird, dass die Bedingungen zum Übertritt in eine der Eskalationsstufen gegeben sind, soll das System im Normalbetrieb sein und seine Aufgabe erfüllen.
Arbeitsweise: Immer wenn das Fahrzeug einen der Ränder erreicht, kann es daraus aufgrund der Sensorwerte die richtige notwendige Fahrtrichtung erschließen. In die entsprechede Richtung wird dann ein Kraftstoß gegeben.
Die Methode kann entweder so implementiert werden, dass sie am äußeren oder am Inneren Rand der Fahrbahn funktioniert. Hier wird sie für den äußeren Rand umgesetzt.
Außerdem sollte noch eine Geschwindigkeitsbegrenzung eingebaut werden. Diese kann vermeiden, dass die durch die Eskalationsstufe 3 erzeugten Gegenkräfte nicht mehr ausreichen, um das Fahrzeug auf der Fahrbahn zu halten.
Ergänzen der zweiten Eskalationsstufe: "Schubs" geben, wenn mitten auf der Fahrbahn in Ruhe
gleiter6_fahren.sce.zip - Fahren mit Eskalationsstufe 2.
Fehlerhafte Fahrt erkennen und das Fahrverhalten korrigieren als "Correcting Audit"
Noch offen.
gleiter7_gps.sce.zip - Basisversion mit "GPS".