SDE SoSe26: AP 1.4 Querregelung

Abb. 1: Das Bild-Koordinatensystem der Spurerkennung

Autor:	Jonas von Döllen
Modul	Mechatronik, Systementwicklung (Wahlpflichtprofil „Systems Design Engineering“), Sommersemester
Lehrveranstaltung:	Praktikum Systementwicklung
Sprint:	Bildbasierte Spurführung für autonomes Fahren
SVN-URL	https://svn.hshl.de/svn/MTR_SDE_Praktikum/trunk/Software/AlphaBot/

Einleitung

Im Zuge des Systementwicklungspraktikums in dem Schwerpunkt System Design Engineering muss ein Fahrzeug durch eine künstlich erzeugte Fahrstrecke autonohm auf der rechten Fahrspur fahren. Genutzt wird in diesem zweiten Teil des Praktikums ein AlphaBot mit einer Pixy2.1 Kamera oben drauf. Hierfür soll nach dem aktuellen Sprint eine Querregelung optimiert werden. In diesem Artikel wird die Dokumentation dazu aufgeführt.

Planung

Ist Zustand

Bei der Gruppe aus dem vorherigen Jahrgang SoSe2025 wurde die Querregelung ausschließlich über die Kamera realisiert. Die Kamera sendet den Startpunktes des Vektors der Kamera immer aus und regelt nach der Y Koordinate. Der Spartpunkt ist dabei immer der Wert mit der höchsten Y-Koordinate, da bei der Pixi Kamera immer der Vektor auch "flippen" kann. Der Startpunkt und der Endpunkt sind dann vertauscht. Ist der Alphabot zu nah an der rechten Außenlinie, dann ist der Y-Wert des Startpunktes klein und ist der Alphabot etwas weiter weg, dann wird der Y-Wert des Startpunktes größer. Geregelt wird um den Wert 32.

Daraus resultiert jedoch, dass der Alphabot in den Kurven etwas näher zu der Außenlinie bewegt, als er eigentlich auf der geraden Strecke tut.

Soll Zustand

Die Querregelung soll auf der aktuellen aufbauen. Der Abstand wird ebenfalls über die Y-Wert der Kamera gemessen werden. Je nach Krümmung soll der Abstand zur Linie sich ändern, da die Kamera bei einer Kurve den Y-Wert geregelten Wert bei falschen Abstand schon bekommt. Für eine schnellere und kontrollierte Regelung soll auch noch die Gierrate mitberücksichtigt werden und so die Position des Fahrzeugs mit in die Regelung integrieren.

Umsetzungsidee

In Simulink wird der alte Block für die Querregelung übernommen. Jedoch wird am D-Anteil anstelle des Regelabweichung aus der Kamera aus der Spurerkennung Subsystem für den Abstand und dem Sollwert ($e_y$) die Gierrate ($r$) als Messgröße eingefügt. Diese soll den Winkelfehler bei dem Fahrzeug minimieren.
$u=K_P{e}_y+K_I\int e_{y}dt-K_{D}r$
Ist das Fahrzeug mit dem alten Regler etwas weiter weg von der Linie parallel platziert worden, dann würde das Fahrzeug wegen des Abstandsfehlers anfangen zu lenken. Bis der Abstandswert bis die Regelabweichung verschwunden ist. Jetzt ist der Querfehler, der Abstand aus der Sicht der Kamera, zwar aufgehoben, doch das Fahrzeug würde nicht parallel ausgerichtet. Da kommt nun die Gierrate im Spiel. Diese soll den P-Anteil dämpfen und so die gerade Linie besser anfahren.

Hierfür soll der PID-Regler die Krümmung als weitern Parameter bekommen und den D-Anteil von der Regelabweichung trennen. Die Ableitung hinter dem D-Anteil Gain wird gelöscht und geht direkt auf den Summenblock. Dort ist jedoch das Vorzeichen für den D-Anteil von einem + zu einem - gewechselt.

Anforderungen

Tabelle 1: Anforderung an die Längsregelung

Req.	Beschreibung	Priorität
1	Fahrzeug muss bei seiner Fahrtschwingfrei sein. (Schwingung in der Messdaten erkennbar, wenn periodisch der selbe Wert etwa in +/-50% der vorheringen Amplituden entspricht)	1
2	Fahrzeug muss bei seiner Bahnführung mittig fahren (+/- 5cm)	1

Umsetzung

Die Formel aus der Umsetzungsidee wurde hier erfolgreich implementiert. Zu sehen ist einmal der Regler von innen und einmal von außen. Die Bilder wurden in Revision 11195 gemacht.

Abb. 2: PID Regler von außen

Abb. 3: PID Regler von Innen

Tests

---

→ zurück zum Hauptartikel: Bildbasierte Spurführung für autonomes Fahren
→ zurück zum Artikel: SDE-Team 2026/27