AuF - Antrieb und Fernbedienung
Einleitung
In diesem Artikel werden Arbeiten dokumentiert, welche im Rahmen des SDE Praktikums des Studienganges MTR, durchgeführt wurden. Im Speziellen wird hier auf die Funktion der Fernbedienung eingegangen, durch welche es möglich ist, einen autonomen Ablauf zu unterbrechen und das Fahrzeug manuell zu steuern.
Anforderungen des Lastenheftes
Autoren: Martin Theine und Patrick Schumann
Stand: 12.02.2021
Die folgenden Aufgaben sind ein Ausschnitt aus dem Lastenheft, welches vorgegeben ist, und stellt die Anforderungen dar, welche über das Semester erfüllt werden sollen.
Pflichten/Ziele
Autoren: Martin Theine und Patrick Schumann
Stand: 12.02.2021
Hinweis: Ziele und Pflichten an das jeweilige Semester anpassen. Ziele und Pflichten des voherigen Jahrgangs entfernen!
-> Pflicht einfügen
Ausgangssituation
Autoren: Martin Theine und Patrick Schumann
Stand: 12.02.2021
Vor Beginn des Wintersemseters 2020/21 war das Fahrzeug durch Vorarbeiten früherer Semester in folgendem Zustand:
- Nach Zuschalten der Spannungsversorgung für den Antriebsakku fuhr das Fahrzeug mit maximaler Geschwindigkeit vorwärts
- Steuern des Fahrzeugs mittels Fernbedienung nicht möglich
- Fernbedienungseingriff durch Software dauerhaft erkannt (blaue LED am höchsten Punkt des Fahrzeugs dauerhaft am blinken)
Kalibrierung der Fernbedienung
Autoren: Martin Theine und Patrick Schumann
Stand: 12.02.2021
Die Fernbedienung des Carolo-Cup-Fahrzeugs bietet drei Trimmmöglichkeiten zur Feineinstellung:
(1) Das Potentiometer über dem "Lenkrad" (mit 1 gekennzeichnet) ist für die Einstellung der Lenk-Range zuständig. Normalerweise beträgt der Lenkwinkel 24° in jede Richtung. Ist die Position verstellt worden und es ist nur noch ein Einschlag von bspw. 18° möglich, muss die Radstellung passend eingestellt werden.
(2) Das zweite Potentiometer über dem "Lenkrad" (mit 2 gekennzeichnet) ist für die Abstimmung der Nullposition des Lenkservos zuständig. Ist dieser Punkt verstellt, greift die Fernbedienung willkürlich in Regelprozesse ein, da ein Lenkeingriff erkannt wird, obwohl kein Eingriff stattfindet. Um dies zu vermeiden, sollte die Position so eingestellt werden, dass kein Eingriff erkannt wird (siehe Abschnitt "Kontrolle der Kalibrierung (Fernbedienung)").
(3) Das dritte Trimmrad unter dem "Lenkrad" (mit 3 gekennzeichnet) ist für die Abstimmung der Nullstellung des "Gashebels" zuständig. Ist dieser Punkt verstellt, greift die Fernbedienung willkürlich in Regelprozesse ein, da ein "Gaseingriff" erkannt wird, obwohl kein Eingriff stattfindet. Um dies zu vermeiden, sollte die Position so eingestellt werden, dass kein Eingriff erkannt wird (siehe Abschnitt "Kontrolle der Kalibrierung (Fernbedienung)").
Damit der gleiche Stellweg (Trimmung) in beide Richtungen zur Verfügung steht, wurden die Trimmräder für die Nullstellung des Lenkservos und des "Gashebels" (mit 2 und 3 gekennzeichnet) in Mittelstellung gebracht.
Anleitung der Fernbedienung.
Kalibrierung des Fahrtenreglers
Autoren: Martin Theine und Patrick Schumann
Stand: 12.02.2021
Der Fahrtenregler ("SPX SUPERREVERSE") wurde nach Kalibrierung der Fernbedienung auf die Mittelstellung des Trimmrädchens für das Gaspedal anhand folgender Anleitung kalibriert (Bild links). Die Automatikbremse wurde anschließend mittels "Mode Programming" aktiviert (Stufe 2), damit das Fahrzeug nicht ausrollt, sondern stoppt, sobald der "Gashebel" losgelassen wird (Bild rechts).
Die vollständige Bedienungsanleitung befindet sich in SVN.
Kalibrierung des Lenkwinkels
Autoren: Martin Theine und Patrick Schumann
Stand: 12.02.2021
Während des Wintersemesters 2020/21 wurde der Nullpunkt der Lenkung nicht neu kalibriert, da die Priorität auf der Fehlersuche im Antriebsstrang lag. Auch in Software wurden keine Änderungen an Modulen vorgenommen, welche die Lenkung betreffen ("bib_Sensoren_Aktoren_online.mdl"). Die folgende Anleitung zur Kalibrierung des Lenkwinkels stammt aus dem Wintersemester 2014/15. Diese sollte im Sommersemester 2021 bzw. Wintersemester 2021/22 genutzt werden, um die Nullstellung der Lenkung neu einzustellen:
Stand: Wintersemester 2014/15
Damit die Lenkung in der Bahnplanung und Spurführung, sowie beim Einparken, gezielt eingestellt werden kann, musste zunächst eine Kalibrierung durchgeführt werden. Der erste Schritt bestand darin, die Lenkung, in der Nullstellung der Fernbedienung, so einzustellen, dass das Fahrzeug geradeaus fährt. Da dies zu Beginn der Arbeiten nicht der Fall war, wurde zunächst die Vorderachse eingestellt. Zur Feinkalibrierung verfügt die Fernbedienung über sogenannte Trimmräder. Verstellt man diese, ändert sich der Nullpunkt. Ein Nachteil bei dieser Einstellung ist, dass sich dabei der Lenkwinkel in die eine Richtung verkürzt und zur anderen Seite vergrößert. Da zu beiden Seiten gleichermaßen gelenkt werden soll, muss die Vorderachse neu eingestellt werden Dies geschieht über Spurstangen, welche in der folgenden Abbildung rot markiert sind.
Die Spurstangen lassen sich in der Länge verstellen, sodass die Spur eingestellt werden kann. Die erste (obere) Spurstange befindet sich direkt am Servomotor für die Lenkung. Mit dieser lässt sich einstellen, wie weit nach rechts und links eingelenkt werden kann.
Hat man die Spurstange so eingestellt, dass man zu beiden Seiten gleichermaßen lenken kann, betrachtet man die Position der einzelnen Räder an der Vorderachse.
Laufen diese gerade, ist keine weitere Einstellung nötig.
Ansonsten müssen die Rechte und linke Spurstange eingestellt werden.
Da das Fahrzeug nicht über einen Sensor verfügt, welche den Lenkwinkel misst, wurde eine Vorrichtung gebaut um diesen zu bestimmt. In der folgenden Schemazeichnung wurde der Aufbau skizziert.
An die Räder der Vorderachse wurden Stifte montiert und unter dem Fahrzeug wurde ein Blatt Papier platziert. Lenkt man nun das Fahrzeug manuell mit der Fernbedienung, wird eine Linie erzeugt, welche in der Schemazeichnung grün gekennzeichnet ist. Anhand dieser Linie lässt sich anschließend der Lenkwinkel pro Rad, in die jeweilige Richtung bestimmen.
Der Lenkwinkel beträgt pro Seite 24 °
Damit der Lenkwinkel auch manuell per Software bestimmt werden kann, wurde der Servomotor per Software angeregt. Hierbei wurde gleichzeitig der Lenkwinkel sowie die PWM-Breite dokumentiert. Anschließend wurde das Ergebnis mithilfe einer Lookup Table in die Software implementiert. Es stellte sich dabei heraus, dass das Verhältnis von Lenkwinkel zu PWM-Breite linear ist, und daher eine Umrechnung sehr einfach durchgeführt werden kann.
Zu finden ist dieser Part unter CCF-online==> AKT - Aktoren - online==> AktRtiPwM - PWM4fach-Modul der RTI-Bloecke
Der Lenkwinkel kann nun in Radiant (SI-Einheit) eingegeben werden, dies wird dann durch die Lookup Table in die entsprechende PWM-Breite umgerechnet und dementsprechend eingestellt.
Des Weiteren kann auf der Hauptseite des Control-Desk-Aufbaus(Projekt:Carolo Cup Fahrzeug ==> Inbetriebnahme) der aktuelle Winkel abgelesen (Nr.1), und auch neu definiert werden (Nr.2).
Kontrolle der Kalibrierung (Fernbedienung)
Autoren: Martin Theine und Patrick Schumann
Stand: 12.02.2021
Damit die autonomen Fahrdiziplinen störungsfrei ausgeführt werden können, ist es essentiell, dass die Trimmräder nicht verstellt werden. Sind diese verstellt, so wird ein Fernbedienungseingriff in der Software erkannt, obwohl kein Eingriff stattfindet. Bei der Inbetriebnahme des Carolo-Cup-Fahrzeugs muss folglich jedes Mal überprüft werden, ob die Trimmräder in Mittelstellung sind. Zudem sollten mit Control Desk (Reiter "Fernbedienung") die folgenden drei Bits überprüft werden:
- "SenFernb_FernbAktiv_bit" == 0
- "SenFernb_LwFernbEin_bit" == 0
- "SenFernb_GasFernbEin_bit" == 0
Wird bei eingeschalteter Fernbedienung keine Eingabe (lenken oder Gas geben) getätigt, so müssen die drei Bit den o.g. Zustand haben. Ist dies nicht der Fall, so müssen die Trimmräder für Lenkung und Gaspedal bewegt werden, bis der Zustand (0,0,0) erreicht ist. Die blaue LED am höchsten Punkt des Fahrzeugs darf keinen Fernbedienungseingriff anzeigen.
Wird nun nur das Lenkrad an der Fernbedienung bewegt, so muss folgender Zustand vorliegen:
- "SenFernb_FernbAktiv_bit" == 1
- "SenFernb_LwFernbEin_bit" == 1
- "SenFernb_GasFernbEin_bit" == 0
Wird nun nur der Gashebel an der Fernbedienung bewegt, so muss folgender Zustand vorliegen:
- "SenFernb_FernbAktiv_bit" == 1
- "SenFernb_LwFernbEin_bit" == 0
- "SenFernb_GasFernbEin_bit" == 1
Werden nun beide Eingaben gleichzeitig getätigt, so muss folgender Zustand vorliegen:
- "SenFernb_FernbAktiv_bit" == 1
- "SenFernb_LwFernbEin_bit" == 1
- "SenFernb_GasFernbEin_bit" == 1
Bei allen drei Möglichkeiten des Eingriffs per Fernbedienung muss die blaue LED am höchsten Punkt des Fahrzeugs blinken. Nach Abschluss der o.g. Kontrolle ist das Fahrzeug betriebsbereit.
Filterung der Fernsteuerungssignale
Stand Sommersemester 2014:
Filterung des Signals bei ausgeschalteter Fernbedienung
Da das Abfragen des An/Aus-Schalters durch den Empfänger nicht möglich ist, wurden zunächst die Störsignale bei ausgeschalteter Fernbedienung analysiert. Es wurde festgestellt, dass die Eingangswerte größtenteils in einem Bereich unterhalb von 0.002 liegen. Diese Signale lassen sich durch eine einfache if-Bedingung filtern, in dem man Signale unterhalb von 0.002 gleich Null setzt. Außerdem entstehen teilweise kurze Peaks, die in einem Bereichoberhalb 0.1 liegen und sich somit von dem Signal der üblichen Aktorenansteuerung nicht unterscheidet. Diese Signale lassen sich leider momentan noch nicht ausreichend herausfiltern. Die momentane Filterung funktioniert so, dass das Signal abgetastet wird, und erst durchgeschaltet wird, wenn es eine bestimmte Zeit anliegt. Mit Erhöhung von könnte man eine bessere Filterung erzielen, allerdings würde sich dies negativ auf die Reaktionszeit auswirken.
Stand Wintersemester 2014/15:
Die Filterung des Fernsteuerungssignals wurde nach neuen Erkenntnissen, auf dem Stand des SS2014 belassen. Dies geschah aus folgenden Gründen:
1.) Eine stärkere Filterung hätte Nachteile, welche das Signal beeinflussen. So würde sich beispielsweise eine Verzögerung einstellen, welche zur Folge hätte, dass das Fahrzeug nicht rechtzeitig unter Kontrolle gebracht werden könnte und dadurch ein Schaden entsteht.
2.) Die Störungen bei ausgeschalteter Fernbedienung lassen sich nicht vermeiden, da diese im Arbeitsbereich liegen. Eine Filterung würde die beschriebene Auswirkung der Verzögerung aus Punkt 1 nach sich ziehen.
3.) Werden die folgenden grundlegenden Dinge beachtet, ist das Signal nahezu störungsfrei:
- Achten Sie auf die Ladung der Fernbedienungsbatterien. Diese sollten immer voll sein.
- Achten Sie darauf, dass das Antennenkabel nicht um Motoren oder andere störende Bauteile gewickelt ist.
- Achten Sie darauf, dass das Antennenkabel 2-3 cm aus dem Führungsröhrchen hinaus ragt.
- Achten Sie darauf, dass die Fernbedienung immer Sichtkontakt zum Fahrzeug hat.
- Achten Sie darauf, dass die Trimmräder an der Fernbedienung nicht verstellt sind.
Optimierung der Fernbedienungsfunktionen
Stand Sommersemester 2014:
Implementierung von Test- und Wettbewerbsmodi
Das Fahrzeug soll über die Fernbedienung in 2 Modi gesteuert werden: - Ein Wettbewerbsmodus, in dem das Fahrzeug bei Eingriff der Fernbedienung nur 0,3 m/s in beide Richtungen fahren kann. - Ein Testmodus, in dem das Fahrzeug bei Eingriff der Fernbedienung 1,0 m/s in beide Richtungen fahren kann.
Um das zu ermöglichen, wurde zunächst die Variable PAR_Schelichmodus in der start.m-Datei angelegt. Diese Variable schaltet einen Schalter im Simulinkmodell, der zwischen beiden Modi schalten soll. Für beide Modi wurden dann jeweils Saturation-Blöcke eingefügt, welche das Signal nach oben und unten begrenzen. Da das Fahrzeug bei jeder autonomen Fahrt mit der Fernbedienung gestoppt werden soll, wurde sich darauf geeinigt, dass um die Nullstellung der Fernbedienung ein Bereich freigelegt wird, in dem das Auto zwar durch die Fernbedienung angesprochen wird, aber nicht fährt. So ist es möglich, das Fahrzeug mit der Fernbedienung zum Stehen zu kriegen. Anschließend wurden Lookup-Tables für den Wettbewerbsmodus und den Testmodus eingebaut, damit das Fahrzeug gestoppt werden kann. Hier wurde ein Totbereich erstellt, in dem das Fahrzeug zwar angesprochen wird, sich jedoch nicht bewegt. Somit ist das sicherheitsrelevante Stoppen des Fahrzeugs funktionsfähig.
Erstellung einer geeigneten Diagnoseseite in ControlDesk
Um die Fernbedienungsfunktionen korrekt darzustellen und zu analysieren, wurde eine geeignete Seite in ControlDesk erstellt. Diese Seite beinhaltet die PWM-Breite des Eingangssignales des Antriebs und des Lenkwinkels, sowie die Ausgangssignale an die Aktoren. Somit kann immer nachvollzogen werden, welche Änderung welche Auswirkung auf das Verhalten des Fahrzeugs hat. Außerdem wurden Anzeigen für die Aktivitätsbits der Lenkung, des Antriebs und der Fernbedienung in Allgemeinen erstellt, welche die Diagnose von Fehlern übersichtlich machen. Zudem wurde eine Umstellmöglichkeit vom Wettbewerb- in den Testmodus erstellt:
Fehlerbehebung der Fernbedienungsfunktionen
Autoren: Martin Theine und Patrick Schumann
Stand: 12.02.2021
Nachdem im Zuge der Fehleranalyse 20/21 die Trimmung des "Gashebels" auf Mittelstellung gebracht wurde, mussten die Lookup-Tables für den Testmodus und Wettbewerbsmodus ("bib_Sensoren_Aktoren_online.mdl") neu angelegt werden. Dazu wurde zunächst der PWM Duty Cycle des Fernbedienungssignals des "Gashebels" für:
- Null- /Neutralstellung
- maximal vorwärts
- maximal rückwärts
ermittelt.
Geschwindigkeitseinstellung
Nachdem eine Geschwindigkeitseinstellung nach m/s möglich war, wurde die Höchstgeschwindigkeit in den jeweiligen Modis angepasst. Die Vmax beträgt nun im Testmodus 0,3 m/s und im Wettbewerbsmodus 0,1 m/s. Die Umsetzung erfolgt über Lookup Tables (Matlab) sowie Schaltern (Control Desk). Die Lookuo Tables können unter CCF-online==> AKT - Aktoren - online==> AktRtiPwM - PWM4fach-Modul der RTI-Bloecke, Wettbewerbsmodus - Testmodus, gefunden werden
Um die Sattelpunkte bei 0,09 befindet sich das Fahrzeug in Ruhe. Der Bereich von 0,086 - 0,1 wird durch die Vorgabe, auf ca. 0,09 gesetzt. Dies hat zur Folge, dass das Fahrzeug bei einem Eingriff durch die Fernbedienung, zunächst auch in Ruhe versetzt wird. Dadurch hat man als Bediener eine bessere Kontrolle. Drückt man den Gaszug weiter , fängt das Fahrzeug langsam an zu beschleunigen.
Die Art des Modus kann in der start.m Datei, in Zeile 93 geändert werden, oder in Control-Desk auf dem Reiter "Fernbedienung HB", wie weiter oben in Abschnitt "Erstellung einer geeigneten Diagnoseseite in ControlDesk" gezeigt.
Zusammenfassung
Autoren: Martin Theine und Patrick Schumann
Stand: 12.02.2021
Nach der Fehlerbehebung des dauerhaften Fernbedienungseingriffs und der Neukalibrierung des Fahrtenreglers (und zugehöriger Anpassung der Lookup-Tables) konnte die korrekte Funktion des Fernbedienungseingriffs erfolgreich überprüft werden.
Offene Punkte
- Kalibrierung der Lenkung (Nullstellung) -> siehe Abschnitt "Kalibrierung des Lenkwinkels"
- Sobald die Ist-Geschwindigkeit des Fahrzeugs wieder korrekt erfasst wird:
(1) Ermittlung des PWM Duty Cycles bei 1 m/s (Testmodus)
(2) Ermittlung des PWM Duty Cycles bei 0.3 m/s (Wettkampfmodus)
(3) Anpassen der Geschwindigkeitsbegrenzung mittels Saturation-Blocks in der Bibliothek "bib_Sensoren_Aktoren_online.mdl" -> Die Begrenzung wurde bislang nur schätzungsweise eingestellt
Ausblick
- Fahrzeug soll bei Fernbedienungseingriff die autonome Fahrfunktion beenden/verlassen
- Fahrzeug soll bei Fernbedienungseingriff zunächst anhalten
- Nach Verlassen der autonomen Fahrdisziplin soll sich das Fahrzeug per Fernbedienung steuern lassen
Weiterführende Artikel
→ zurück zum Hauptartikel: Praktikum SDE
→ zum Artikel: Filterung Fernbedienung