SDE WS25: AP 2.6 Schätzung der Roboterpose: Unterschied zwischen den Versionen

Aus HSHL Mechatronik
Zur Navigation springen Zur Suche springen
← Zum vorherigen Versionsunterschied
Jan.steffens@stud.hshl.de (Diskussion | Beiträge)
wiki-autoren
849 Bearbeitungen
Keine Bearbeitungszusammenfassung
Jan.steffens@stud.hshl.de (Diskussion | Beiträge)
wiki-autoren
849 Bearbeitungen
Keine Bearbeitungszusammenfassung
 
(6 dazwischenliegende Versionen desselben Benutzers werden nicht angezeigt)
Zeile 1: Zeile 1:
[[Datei:Schätzung der Roboterpose.jpeg|thumb|rigth|450px|Abb. 1: Autonome Fahrbahnvermessung im Labor Autonome Systeme]]
[[Datei:Schätzung der Roboterpose.jpeg|thumb|rigth|450px|Abb. 1: AP 2.6 Schätzung der Roboterpose]]


'''Autor:''' [[Benutzer:Jan Steffens]]
'''Autor:''' [[Benutzer:Jan Steffens | Jan Steffens]]


= Einleitung/Funktion =
= Einleitung/Funktion =
Die aus dem vorherigen erhaltenen Prismapositionspunkte im WeltKOS (X;Y;Z) sollen dem KalmanPos.m Modul übergeben und innerhalb dessen geglättet werden. Außerdem werden vX und vY bestimmt. Rückgabewerte sind die geglätteten X und Y Koordinaten im WeltKOS und die X und Y Geschwindigkeiten (X;Y;vX;vY).
Die aus dem vorherigen Modul erhaltenen Prismapositionspunkte im WeltKOS (X;Y;Z) sollen dem pose.m Modul übergeben werden. Durch den letzten und den aktuellen Positionspunkt wird der Verdrehwinkel zur X-Achse berechnet. Anschließend wird dieser zurückgegeben.


= Vorbereitung =
= Vorbereitung =
* Matlab R2024b auf PC starten
* Matlab R2024b oder neuer auf PC starten
* Script [https://svn.hshl.de/svn/MTR_SDE_Praktikum/trunk/_Semesterordner/WS2025/Sprint_1/m-files/testpose.m testpose.m] starten
* Script [https://svn.hshl.de/svn/MTR_SDE_Praktikum/trunk/_Semesterordner/WS2025/Sprint_1/m-files/testpose.m testpose.m] starten
* Script [https://svn.hshl.de/svn/MTR_SDE_Praktikum/trunk/_Semesterordner/WS2025/Sprint_1/m-files/pose.m pose.m] muss sich im selber Ordner befinden
* Script [https://svn.hshl.de/svn/MTR_SDE_Praktikum/trunk/_Semesterordner/WS2025/Sprint_1/m-files/pose.m pose.m] muss sich im selber Ordner befinden
Zeile 26: Zeile 26:
|-
|-
| 2
| 2
| Punkte werden Kalman gefiltert
| Verdrehwinkel wird berechnet
| Kalman Parameter
| PW (XPos; YPos)
| geglättete Punkte
| Verdrehwinkel zur X-Achse (<math>\Psi</math>)
|-
|-
| 3
| 3
| X und Y Geschwindigkeit wird bestimmt
| Resultierender Winkel wird zurückgegeben
| PW (XPos; YPos)
| PW (XPos; YPos)
| vX und vY
| <math>\Psi</math>
|-
| 4
| Geglättete Punkte und Geschwindigkeiten ausgeben
|
| (X;Y;vX;vY)
|-
|-


|}
|}
Zeile 45: Zeile 41:
= Softwareentwurf =
= Softwareentwurf =
<gallery widths="400px" heights="600px" >  
<gallery widths="400px" heights="600px" >  
Datei:AP2.5_KalmanPosPAP.png|Abb. 1: PAP für KalmanPos
Datei:AP2.6_PosePAP.png|Abb. 1: PAP für Pose.m
</gallery>
</gallery>


Aktuelle Version vom 8. Januar 2026, 14:52 Uhr

Abb. 1: AP 2.6 Schätzung der Roboterpose

Autor: Jan Steffens

Einleitung/Funktion

Die aus dem vorherigen Modul erhaltenen Prismapositionspunkte im WeltKOS (X;Y;Z) sollen dem pose.m Modul übergeben werden. Durch den letzten und den aktuellen Positionspunkt wird der Verdrehwinkel zur X-Achse berechnet. Anschließend wird dieser zurückgegeben.

Vorbereitung

  • Matlab R2024b oder neuer auf PC starten
  • Script testpose.m starten
  • Script pose.m muss sich im selber Ordner befinden

Anforderungen

ID Testfallbeschreibung Eingang Erwartetes Ergebnis
Tabelle 2: Anforderungen für den Komponententest
1 Punkte der Alphabotposition werden übergeben PW (XPos; YPos) Punkte werden nacheinander übergeben
2 Verdrehwinkel wird berechnet PW (XPos; YPos) Verdrehwinkel zur X-Achse (Ψ)
3 Resultierender Winkel wird zurückgegeben PW (XPos; YPos) Ψ

Softwareentwurf

  • Abb. 1: PAP für Pose.m
    Abb. 1: PAP für Pose.m

Umsetzung

SVN-Links:

Modultest

Für den Modultest werden die Winkel für die fortlaufenden Positionen bestimmt und gesichtet. Als Test wird der Punkt, an dem der Winkel zur X-Achse 90° beträgt, bestimmt und auf der Karte eingezeichnet.

ID Testfallbeschreibung Eingang Erwartetes Ergebnis Testergebnis Testperson Datum
Tabelle 3: Testbericht für den Komponententest
1 Punkte der Alphabotposition werden übergeben PW (XPos; YPos) Punkte werden nacheinander übergeben Punkte werden eingelesen Jan Steffens 11.11.2025
2 korrekter Winkel zur X-Achse wird berechnet dx, dy passender Winkel zur Position des Alphabots 90° werden erwartet Jan Steffens 11.11.2025
3 Winkel wird zurückgegeben -180° bis 180° 90° wird zurückgegeben Jan Steffens 11.11.2025
  • Abb. 3: Punkt, an dem der Winkel zur X-Achse 90° beträgt
    Abb. 3: Punkt, an dem der Winkel zur X-Achse 90° beträgt
  • Abb. 4: Startpunkt der Mittelliniendaten und 90°-Punkt auf der Strecke
    Abb. 4: Startpunkt der Mittelliniendaten und 90°-Punkt auf der Strecke
  • Abb. 5: Winkelverlauf zur x-Achse der Alphabot Ausrichtung
    Abb. 5: Winkelverlauf zur x-Achse der Alphabot Ausrichtung

→ zurück zum Hauptartikel: Spurverfolgung mit Kamera

Abgerufen von „https://wiki.hshl.de/wiki/index.php?title=SDE_WS25:_AP_2.6_Schätzung_der_Roboterpose&oldid=144781“