Kom - Kommunikation: Unterschied zwischen den Versionen

Aus HSHL Mechatronik
Zur Navigation springen Zur Suche springen
(→‎Tests der Kommunikation: neuer Test für Sprint2 WiSe 22/23)
 
(34 dazwischenliegende Versionen von 5 Benutzern werden nicht angezeigt)
Zeile 1: Zeile 1:
'''Betreuer: '''Prof. Dr.-Ing [[Benutzer:Ulrich Schneider|Ulrich Schneider]] <br>
'''Autor:''' [[Benutzer:Tim-Jannik_Schonlau|Tim Schonlau]] (WiSe 22/23) <br>
= Einleitung =
= Einleitung =
Dieser Artikel wurde im Wintersemester 2022/23 komplett überarbeitet. Über eine genauere Beschreibung der Kommunikation hinaus wurde eine ausführliche Erklärung der Implementierung ergänzt und neu formuliert (für weitere Informationen siehe [https://wiki.hshl.de/wiki/index.php?title=Kom_-_Kommunikation&action=history  Versionshistorie]). <br>
Dieser Artikel wurde im Wintersemester 2022/23 komplett überarbeitet. Über eine genauere Beschreibung der Kommunikation hinaus wurde eine ausführliche Erklärung der Implementierung ergänzt und neu formuliert (für weitere Informationen siehe [https://wiki.hshl.de/wiki/index.php?title=Kom_-_Kommunikation&action=history  Versionshistorie]). <br>
'''Mitwirkende der vergangenen Semester: '''[[Benutzer:Sven Posner|Sven Posner]], [[Benutzer:Jonas Hokamp|Jonas Hokamp]], [[Benutzer:Isaac Mpidi-Bita|Isaac Mpidi Bita]], [[Benutzer: Thomas Miska|Thomas Miska]], [[Benutzer: Alexander Schirrmeister|Alexander Schirrmeister]], [[Benutzer: Hendrik Steffen|Hendrik Steffen]], [[Benutzer: Lukas Honerlage|Lukas Honerlage]], [[Benutzer: Tim-Jannik Schonlau|Tim Schonlau]], [[Benutzer: Changlai Bao|Changlai Bao]]
 
== Aufgabenstellung und Ziele ==
== Anforderungen und Ziele ==
Das Modul Kommunikation realisiert den Datenaustausch der einzelnen Module des Carolo Cup Fahrzeugs (CCF). Das Ziel ist es, mithilfe von C++ Code (Visual Studio 2019) die Variablen aus der [[OSE - Objekt - und Spurerkennung|Objekt- und Spurerkennung]] (z.B. Spurpolynom  <math>Y(X)=aX^2+bX+c</math>) von PC zur x86 PCI-Erweiterungskarte zu übertragen, die sich auf dem CCF befinden. <br>  
Das Modul Kommunikation realisiert den Datenaustausch der einzelnen Module des Carolo Cup Fahrzeugs (CCF). Das Ziel ist es, mithilfe von C++ Code (Visual Studio 2019) die Variablen aus der [[OSE - Objekt - und Spurerkennung|Objekt- und Spurerkennung]] (z.B. Spurpolynom  <math>Y(X)=aX^2+bX+c</math>) von PC zur x86 PCI-Erweiterungskarte zu übertragen. Der PC berechnet dabei die zu Fahrspur und die PCI-Karte DS1104 überträgt die Signale als Echtzeitmicrocontroller an die Aktoren und bildet mit verschiedenen Sensoren z.B. zur Geschwindigkeitsregelung einen Regelkreis. <br>  
Das wird realisiert indem eine serielle  RS-232 Schnittstelle zum Microcontroller, in diesem Fall der Entwicklerkarte DS1104 von dSPCACE, implementiert wird. </br>
Das wird realisiert indem eine serielle  RS-232 Schnittstelle zum Microcontroller, in diesem Fall der Entwicklerkarte DS1104 von dSPCACE, implementiert wird. </br>
Die weitere Verarbeitung der Daten findet in den anderen Modulen statt, die in Simulink (2019b) implementiert und auf der dSPACE-Karte ausgeführt werden. Die Spurparameter werden z.B. in [[BSF - Bahn- und Spurführung]] verarbeitet, um den Lenkwinkel aus der aktuellen Position und dem Spurpolynom zu regeln.
Die weitere Verarbeitung der Daten findet in den anderen Modulen statt, die in Simulink (2019b) implementiert und auf der dSPACE-Karte ausgeführt werden. Die Spurparameter werden z.B. in [[BSF - Bahn- und Spurführung]] verarbeitet, um den Lenkwinkel aus der aktuellen Position und dem Spurpolynom zu regeln.
</div>


== Konzept ==
== Konzept ==
[[Datei:Schema_Konzept_SDE_CCF_Kommunikation.PNG|thumb|right|600px|Schema des Kommunikations-Konzepts nach Schnittstellen Dokumentation (Regelkreis mit dSPACE-Karte stark vereinfacht) ]]
[[Datei:Schema_Konzept_SDE_CCF_Kommunikation.PNG|thumb|right|600px|Abb. 1: Schema des Kommunikations-Konzepts nach Schnittstellen Dokumentation (Regelkreis mit dSPACE-Karte stark vereinfacht) ]]
Die [[OSE Softwareumgebung]] beinhaltet die Bild- und [[Objekterkennung mit Laserscanner]] die Lidar-Verarbeitung, sowie die Implementierung der RS232 Kommunikation. </br>
Die [[OSE Softwareumgebung]] beinhaltet die Bild- und [[Objekterkennung mit Laserscanner]] die Lidar-Verarbeitung, sowie die Implementierung der RS232 Kommunikation. </br>
Die Kamera ist mit Ethernet an die x86-CPU verbunden, diese wiederum ist über einen [https://learn.microsoft.com/en-us/windows-hardware/drivers/serports/configuration-of-com-ports COM Port] über das RS-232 Protokoll mit dem dSPACE CP1104 Connector Panel verbunden. Die x86-CPU führt die "OSE_Draufsicht_Spurpolynom_RS232.exe" (C/C++ Code) aus, die einen Bildverarbeitungsalgorithmus auf das Kamerabild anwendet, um die a-, b-, c-Parameter der Fahrspur zu ermitteln. Die dSPACE Karte wird über MATLAB/Simulink programmiert und empfängt das RS-232 Protokoll über ein [https://de.wikipedia.org/wiki/D-Sub D-Sub Kabel].</br>
Wie in Abbildung 1 zu sehen, ist die Kamera mit Ethernet an die x86-CPU verbunden, diese wiederum ist über einen [https://learn.microsoft.com/en-us/windows-hardware/drivers/serports/configuration-of-com-ports COM Port] über das RS-232 Protokoll mit dem dSPACE CP1104 Connector Panel verbunden. Die x86-CPU führt die "OSE_Draufsicht_Spurpolynom_RS232.exe" (C/C++ Code) aus, die einen Bildverarbeitungsalgorithmus auf das Kamerabild anwendet, um die a-, b-, c-Parameter der Fahrspur zu ermitteln. Die dSPACE Karte wird über MATLAB/Simulink programmiert und empfängt das RS-232 Protokoll über ein [https://de.wikipedia.org/wiki/D-Sub D-Sub Kabel].</br>




Zeile 18: Zeile 17:
Die [[OSE Softwareumgebung]] erkennt aus den Lidar-Daten Objekte, die in Modulen [[AEP - Autonomes Einparken]], [[BSF - Bahn- und Spurführung]] und [[AuF - Antrieb und Fernbedienung]] benötigt werden. Mit diesen Daten kann das CCF Hindernissen auf der Teststrecke reagieren und ausweichen.
Die [[OSE Softwareumgebung]] erkennt aus den Lidar-Daten Objekte, die in Modulen [[AEP - Autonomes Einparken]], [[BSF - Bahn- und Spurführung]] und [[AuF - Antrieb und Fernbedienung]] benötigt werden. Mit diesen Daten kann das CCF Hindernissen auf der Teststrecke reagieren und ausweichen.


=Serielle Schnittstelle: RS-233=
=Serielle Schnittstelle: RS-232=
Einen guten ersten Überblick des Recommended Standart 232 vermittelt die Definition im [https://de.wikipedia.org/wiki/RS-232?wprov=sfla1#Definition Wikipedia Artikel von RS-232]. <br>
Einen guten ersten Überblick des Recommended Standart 232 vermittelt die Definition im [https://de.wikipedia.org/wiki/RS-232?wprov=sfla1#Definition Wikipedia Artikel von RS-232]. <br>
Die Übertragung wird mit 8bit, also einem ''Byte'' langen Wörtern realisiert. Das heißt, dass der COM Port der x86-CPU 8 Bits in den Puffer der dSPACE Karte schreibt. Diese liest pro Zyklusschritt 8bit aus dem Puffer. Um auf diese Weise alle Bytes zu übertragen, müssen die Daten in der gleichen Reihenfolge ausgegeben und wieder eingelesen werden. <br>
Die Übertragung wird mit 8bit, also einem ''Byte'' langen Wörtern realisiert. Das heißt, dass der COM Port der x86-CPU 8 Bits in den Puffer der dSPACE Karte schreibt. Diese liest pro Zyklusschritt 8bit aus dem Puffer. Um auf diese Weise alle Bytes zu übertragen, müssen die Daten in der gleichen Reihenfolge ausgegeben und wieder eingelesen werden. <br>
Ein [https://de.wikipedia.org/wiki/ACK_(Signal) Acknowledgement (ACK)], [https://de.wikipedia.org/wiki/Datenflusssteuerung Handshake], Stoppbyte und ein Parity-Byte würden die Kommunikation noch zuverlässiger machen, sind Stand Sprint2 im WiSe22/23 nicht implementiert.
Ein [https://de.wikipedia.org/wiki/ACK_(Signal) Acknowledgement (ACK)], [https://de.wikipedia.org/wiki/Datenflusssteuerung Handshake], Stoppbyte und ein Parity-Byte würden die Kommunikation noch zuverlässiger machen, sind Stand Sprint2 im WiSe22/23 nicht implementiert. Auch die bidirektionale Kommunikation mit RS232 von dSPACE Karte zum PC ist nicht implementiert!


== Überblick Variablen ==  
== Überblick Variablen ==  
Das gesamte Datenpaket besteht aus mehreren Variablen, die der [https://svn.hshl.de/svn/MTR_SDE_Praktikum/trunk/Anforderungsmanagement/Lastenheft/Schnittstellendokumentation_Anlage_Lastenheft.docx SVN: Schnittstellendokumentation] zu entnehmen sind.
Die zu übertragenden Daten bestehen aus mehreren Variablen, die der [https://svn.hshl.de/svn/MTR_SDE_Praktikum/trunk/Anforderungsmanagement/Lastenheft/Schnittstellendokumentation_Anlage_Lastenheft.docx SVN: Schnittstellendokumentation] zu entnehmen sind.


{| class="wikitable"  
{| class="wikitable"
|-
|+ style = "text-align: left"|Tabelle 1: Daten von DS1104 zu PC
! Signal
! scope="col"| Signalname
! Variablenname
! scope="col"| Datentyp
! Sender
! scope="col"| Beschreibung
! Empfänger
! Datentyp
! KOS
! Bedeutung
|-
|-
| Vx,ego
! scope="row"| V_x_ego
| V_x_ego
| float32 (4 Byte)
| DS1104
| PC
| f32 (4 Byte)
| K
| Ego-Längsgeschwindigkeit des Fahrzeugs
| Ego-Längsgeschwindigkeit des Fahrzeugs
|-
|-
| Lenkwinkel
! scope="row"| alpha
| alpha
| float32 (4 Byte)
| DS1104
| Lenkwinkel: α > 0 Lenkausschlag links, α < 0 Lenkausschlag rechts
| PC
| f32 (4 Byte)
| K
| Lenkwinkel, a > 0 Lenkausschlag links, a < 0 Lenkausschlag rechts
|-
|-
|  
! scope="row" colspan="2"| Gesamtgröße des Datenpakets
|
|
|
| 8 Byte
| 8 Byte
|  
|}
| Gesamtgröße des Datenpakets von dSPACE Karte zum PC
 
 
{| class="wikitable"
|+ style = "text-align: left"|Tabelle 2: Daten von PC zu DS1104
! scope="col"| Signalname
! scope="col"| Datentyp
! scope="col"| Beschreibung
|-
|-
| a, b, c
! scope="row"| SpurA
| a, b, c
| float32 (4 Byte)
| PC
| Fahrspurparameter
| DS1104
| f32 (4 Byte)
| K
| Parameter der Fahrspur
|-
|-
| Spurzuordnung
! scope="row"| SpurB
| lane_assign
| float32 (4 Byte)
| PC
| Fahrspurparameter
| DS1104
|-
! scope="row"| SpurC
| float32 (4 Byte)
| Fahrspurparameter
|-
! scope="row"| Spurzuordnung
| bool (1 Byte)
| bool (1 Byte)
| K
| Spurzuordnung: 1 = rechte Fahrspur, 0 = linke Fahrspur
| 1: rechte Fahrspur / 0: linke Fahrspur
|-
|-
| Stopplinie erkannt
! scope="row"| Stopplinie_erkannt
| stop_insight
| PC
| DS1104
| bool (1 Byte)
| bool (1 Byte)
| K
| 1 = Stopplinie erkannt, 0 = keine Stopplinie erkannt
| 1: Stopplinie erkannt / 0: Stopplinie nicht erkannt
|-
|-
| Abstand Stopplinie
! scope="row"| Stopplinienabstand
| stop_distance
| float32 (4 Byte)
| PC
| DS1104
| f32 (4 Byte)
| K
| Entfernung zur Stopplinie
| Entfernung zur Stopplinie
|-
|-
| nObjekte
! scope="row"| n_Objekte
| n_objekte
| PC
| DS1104
| uint8 (1 Byte)
| uint8 (1 Byte)
| -
| Anzahl relevanter Objekte (maximal 5)
| Gesamtanzahl der relevanten Objekte (max. 5)
|-
|-
| Objekt[n].Nummer
! scope="row"| Objekt_Nummer
| number[n_objekte]
| PC
| DS1104
| uint8 (1 Byte)
| uint8 (1 Byte)
| -
| Objektzähler
| Objektzähler
|-
|-
| Objekt[n].x0
! scope="row"| ObjektX
| x_0[n_objekte]
| float32 (4 Byte)
| PC
| DS1104
| f32 (4 Byte)
| K
| x-Koordinate des Objektmittelpunktes (mitte, vorn)
| x-Koordinate des Objektmittelpunktes (mitte, vorn)
|-
|-
| Objekt[n].y0
! scope="row"| ObjektY
| y_0[n_objekte]
| float32 (4 Byte)
| PC
| DS1104
| f32 (4 Byte)
| K
| y-Koordinate des Objektmittelpunktes (mitte, vorn)
| y-Koordinate des Objektmittelpunktes (mitte, vorn)
|-
|-
| Objekt[n].b
! scope="row"| Objektbreite
| b[n_objekte]
| float32 (4 Byte)
| PC
| DS1104
| f32 (4 Byte)
| K
| Objektbreite
| Objektbreite
|-
|-
| Objekt[n].t
! scope="row"| Objekttiefe
| t[n_objekte]
| float32 (4 Byte)
| PC
| DS1104
| f32 (4 Byte)
| K
| Objekttiefe
| Objekttiefe
|-
|-
| Objekt[n].a
! scope="row"| Objektausrichtung
| alpha[n_objekte]
| float32 (4 Byte)
| PC
| DS1104
| f32 (4 Byte)
| K
| Objektausrichtung
| Objektausrichtung
|-
|-
| Objekt[n].v
! scope="row"| Objektgeschwindigkeit
| v[n_objekte]
| float32 (4 Byte)
| PC
| DS1104
| f32 (4 Byte)
| K
| Betrag des Geschwindigkeitsvektors
| Betrag des Geschwindigkeitsvektors
|-
|-
| Objekt[n].Plausibel
! scope="row"| Objekt_Plausibel
| plausible[n_objekte]
| PC
| DS1104
| uint8 (1 Byte)
| uint8 (1 Byte)
| K
| Vertrauenswert für das Objekt in Prozent ( 0 = minimale Vertrauen, 100 = maximale Vertrauen)
| Vertrauenswert für das Objekt (100: 100% vertrauenswürdig)
|-
|-
|  
! scope="row" colspan="2"| Gesamtgröße des Datenpakets
|
|
|
| 149 Byte
| 149 Byte
|
| Gesamtgröße des Datenpakets von PC zur dSPACE Karte
|}
|}
<br>
Dieses Diagramm veranschaulicht die zu sendenden Daten:
[[Datei:Schema_Konzept_SDE_CCF_Datenpaket.png|900px|center]]
Am Anfang wird das Startbyte mit 10101010(BIN) = 170(DEC) gewählt. Darauf folgt das Spurpolynom mit den drei [https://de.wikipedia.org/wiki/Polynom Polynomkoeffizienten]. Da jeder Koeffizient mit einer Genauigkeit eines ''floats'', also 32bit = 8byte berechnet wird, sind es ingesamt 12Byte für das Fahrspurpolynom. Die Spurerkennung setzt sich zwei binären Werten, die dennoch mit je einem byte übertragen werden zusammen, um die Fahrspur oder :Stopplinie zu erfassen. Darauf folgt wieder ein 4Byte langer Parameter mit der Distanz zur Stopplinie. <br>
Die Anzahl der Lidar-Objekte wird mit einem Byte übertragen, die Eigenschaftsparameter wie Größe, Position, Geschwindigkeit werden ebenfalls jeweils mit 8Byte übertragen, die Objektnummer und der Vertrauenswert wird mit einem Byte gesendet.
So ergibt sich eine gesamte Paketlänge von 150 Byte, die beispielhaft mit 19200 baud (byte pro Sekunde) in einer Sekunde 128 mal übertragen wird.


-----
Dieses Diagramm veranschaulicht die zu sendenden Daten von PC zur dSPACE Karte:
[[Datei:Schema_Konzept_SDE_CCF_Datenpaket.png|thumb|900px|right|Abb. 2: Schema_Konzept_SDE_CCF_Datenpaket]]
In Abbildung 2 ist zu sehen, das zuerst das Startbyte übertragen wird, dieses wird auf 10101010(BIN) = 170(DEC) festgelegt. Darauf folgt das Spurpolynom mit den drei [https://de.wikipedia.org/wiki/Polynom Polynomkoeffizienten]. Da jeder Koeffizient mit einer Genauigkeit eines ''floats'', also 32bit = 4byte berechnet wird, sind es ingesamt 12Byte für das Fahrspurpolynom. Die Stopplinienerkennung setzt sich zwei binären Variablen zusammen, die dennoch mit je einem Byte übertragen werden. Die Stoppliniendistanz wird ebenfalls mit 4byte übertragen.<br>
Die Anzahl der Lidar-Objekte wird mit einem Byte übertragen, die Eigenschaftsparameter wie Größe, Position, Geschwindigkeit werden ebenfalls jeweils mit 4Byte übertragen, die Objektnummer und der Vertrauenswert wird mit einem Byte gesendet.
So ergibt sich eine Datenmange von über 150 Byte, die beispielhaft mit 115200 baud (byte pro Sekunde) in einer Sekunde ~720 mal übertragen wird. Die byte-genaue Größe der zu übertragenen Daten weicht von dieser Darstellung ab, da ''Struct'' Datenstrukturen in C++ immer an eine vierte Speicheraddresse gespeichert werden. Das ''Struct'' mit den 3 Spurparametern, Spurzuordnung und Stopplinie_erkannt, sowie dem Stopplinienabstand besitzt deswegen eine Variable ''filler1'', die als Platzhalter den Zugriff auf diesen ''leeren'' Speicherplatz ermöglicht. Dies kann mit [https://learn.microsoft.com/en-us/cpp/preprocessor/pack?view=msvc-170 ''pack pragma''] umgangen werden, ist aber für diese Implementation nicht zwingend erforderlich!


==Softwarearchitektur für die Kommunikation==
==Softwarearchitektur für die Kommunikation==
Zeile 184: Zeile 126:


{|
{|
|[[Datei:Allgemeine_SH_Kommunikation.png|thumb|600px|center]]
|[[Datei:Allgemeine_SH_Kommunikation.png|thumb|900px|left|Abb. 3: Allgemeine_SH_Kommunikation]]
| [[Datei:Projektmappe Visual Studio OSE Draufsicht Spurpolynom RS232.png]]
[[Datei:Projektmappe Visual Studio OSE Draufsicht Spurpolynom RS232.png|thumb|300px|right|Abb. 4: Projektmappe Visual Studio OSE Draufsicht Spurpolynom RS232]] </div>
|}
|}


Zeile 193: Zeile 135:
#Zweitens die Objekterkennung die aus LIDAR Daten berechnet werden (Noch nicht vollständig im Diagramm! | Stand Sprint1 WS22/23).
#Zweitens die Objekterkennung die aus LIDAR Daten berechnet werden (Noch nicht vollständig im Diagramm! | Stand Sprint1 WS22/23).
#Die Implementierung einer RS-232 Kommunikation mit der rs-232.c-Bibliothek von [https://www.teuniz.net/RS-232/index.html Teunis van Beelen]. <br>
#Die Implementierung einer RS-232 Kommunikation mit der rs-232.c-Bibliothek von [https://www.teuniz.net/RS-232/index.html Teunis van Beelen]. <br>
[[Datei:PAP_Ablauf_Kommunikation.png|300px|right|thumb|Grober Ablauf der Kommunikation auf Senderseite]]
 
Zu Beginn werden in der Hauptklasse der [[OSE Softwareumgebung]] "main.h" die Objekt- und Spurerkennung durchgeführt. So werden alle für das Fahrzeug relevanten Informationen generiert Die gesammelten Daten (Spurparameter, Stopplinie, LiDAR-Objekte, etc.) werden im Anschluss in einem Struct zusammengeführt. Mit diesem Struct wird die Funktion '''RS232_SendDataBigEndianFirst''' aufgerufen, die mit der Funktion '''RS232_SendByte()''' aus "RS232Comm.h" das Datenpaket an die dSPACE-Karte schickt.<br>
Zu Beginn werden in der Hauptklasse der [[OSE Softwareumgebung]] "main.h" die Objekt- und Spurerkennung durchgeführt. So werden alle für das Fahrzeug relevanten Informationen generiert Die gesammelten Daten (Spurparameter, Stopplinie, LiDAR-Objekte, etc.) werden im Anschluss in einem ''Struct'' zusammengeführt. Mit diesem ''Struct'' wird die Funktion '''RS232_SendDataBigEndianFirst''' aufgerufen, die mit der Funktion '''RS232_SendByte()''' aus "RS232Comm.h" das Datenpaket an die dSPACE-Karte schickt.<br>
Vom PC wird jeder Parameter in 4 Byte aufgesplittet. Es werden, inklusive 5 LiDAR Objekte, insgesamt 47 Parameter nacheinander versendet. Als erstes werden die 4 Byte des a-Parameters empfangen, dann wird der b-Parameter, anschließend der c-Parameter und so weiter. Die Daten werden in der gleichen Reihenfolge empfangen, wie sie auch versendet wurden. Um sicher zu stellen, dass der a-Parameter immer als erstes bearbeitet wird, wird einen START_BYTE von PC zu der dSPACE-Karte gesendet. Dieser wird bewusst als 10101010(BIN) = 170(DEC) gewählt. Wichtig zu beachten ist, dass die Daten im PC als [https://de.wikipedia.org/wiki/Byte-Reihenfolge#Little-Endian-Format Little-Endian] und auf der dSPACE-Karte als [https://de.wikipedia.org/wiki/Byte-Reihenfolge#Big-Endian-Format Big-Endian] gespeichert sind.
Vom PC wird jeder Parameter in 4 Byte aufgesplittet. Es werden, inklusive 5 LiDAR Objekte, insgesamt 47 Parameter nacheinander versendet. Als erstes werden die 4 Byte des a-Parameters empfangen, dann wird der b-Parameter, anschließend der c-Parameter und so weiter. Die Daten werden in der gleichen Reihenfolge empfangen, wie sie auch versendet wurden. Um sicher zu stellen, dass der a-Parameter immer als erstes bearbeitet wird, wird einen START_BYTE von PC zu der dSPACE-Karte gesendet. Dieser wird bewusst als 10101010(BIN) = 170(DEC) gewählt. Wichtig zu beachten ist, dass die Daten im PC als [https://de.wikipedia.org/wiki/Byte-Reihenfolge#Little-Endian-Format Little-Endian] und auf der dSPACE-Karte als [https://de.wikipedia.org/wiki/Byte-Reihenfolge#Big-Endian-Format Big-Endian] gespeichert sind.


[[Datei:BitReihenfolge.png|700px|center]]
[[Datei:PAP_Ablauf_Kommunikation.png|500px|right|thumb|Abb. 6: Ablauf der Kommunikation auf Senderseite]]
[[Datei:BitReihenfolge.png|1000px|center|thumb|Abb. 5: BitReihenfolge]]
<br><br>


=== Konfiguration der dSPACE-Karte ===
=== Konfiguration der dSPACE-Karte ===
[[Datei:SEReinstellung.png|right]]
Mit der [https://www.dspace.com/en/inc/home/products/sw/impsw/real-time-interface.cfm RTI Toolbox von dSPACE] wird eine Simulink-Bibliothek für die serielle Schnittstelle bereitgestellt. Hierfür sollte das MATLAB®/Simulink [[Starten der Online-Simulation | ''online Modell'']] des CCF gestartet werden. Nachdem die [https://svn.hshl.de/usvn/project/MTR_SDE_Praktikum/show/trunk/Software/CaroloCupFahrzeug/CCF_online.slx CCF_online.slx] in Simulink geöffnet wurde, kann mit '''Strg + L''' die verlinkte Bibliothek ''CCF_online → SEN - Sensoren - online → SenKam - Kamera'' geöffnet werden. Empfehlenswert ist ein Blick in die Dokumentation/Hilfe von dSPACE, die über das Kontextmenü geöffnet werden kann.
[[Datei:SERSetup.png|right|400px|thumb|RTI Block im Simulink online Modell (CCF_online → SEN - Sensoren - online → SenKam - Kamera)]]
Mit der [https://www.dspace.com/en/inc/home/products/sw/impsw/real-time-interface.cfm RTI Toolbox von dSPACE] wird eine Simulink-Bibliothek für die serielle Schnittstelle bereitgestellt. Hierfür sollte das MATLAB®/Simulink [[Starten der Online-Simulation | ''online Modell'']] des CCF gestartet werden. Nachdem die [https://svn.hshl.de/usvn/project/MTR_SDE_Praktikum/show/trunk/Software/CaroloCupFahrzeug/CCF_online.slx CCF_online.slx] in Simulink geöffnet wurde, kann mit '''Strg + L''' die verlinkte Bibliothek ''CCF_online → SEN - Sensoren - online → SenKam - Kamera'' geöffnet werden.
Die serielle Kommunikation wird mittels des sogenannten '''DS1104SER_SETUP''' -Blocks in Simulink initialisiert, mit einem Doppelklick auf den Block können die Einstellungen des Busses konfiguriert werden: Für die Fahrzeugskommunikation muss auf beiden Seiten eine gleiche Baudrate bestimmt werden. <br>
Die serielle Kommunikation wird mittels des sogenannten '''DS1104SER_SETUP''' -Blocks in Simulink initialisiert, mit einem Doppelklick auf den Block können die Einstellungen des Busses konfiguriert werden: Für die Fahrzeugskommunikation muss auf beiden Seiten eine gleiche Baudrate bestimmt werden. <br>
[[Datei:SEReinstellung.png|400px|right|thumb|Abb. 7: SEReinstellung]]
[[Datei:SERSetup.png|right|700px|thumb|Abb. 8: RTI Block im Simulink online Modell (CCF_online → SEN - Sensoren - online → SenKam - Kamera)]]
<br><br><br><br><br>


Im Simulink [[Starten der Online-Simulation | ''online Modell'']] werden die codierten Datenpakete in einer S-Function dekodiert. Diese können in dSPACE Control Desk visualisiert und getestet werden. Hier ist eine [[Dekodierung RS-232 in Simulink |ausführlichere Beschreibung der S-Function]] im 'online Modell' zu finden.
-----
Im Simulink [[Starten der Online-Simulation | ''online Modell'']] werden die gesendeten Bytes mithilfe einer S-Function aufgeschlüsselt. Diese können in dSPACE Control Desk visualisiert und getestet werden. <br>
Hier ist eine ausführlichere Beschreibung der S-Function im ''online Modell'' zu finden:
=== [[Dekodierung RS-232 in Simulink]] ===


-----
Alte Wiki-Artikel zur Kommunikationsimplementierung: <br>
Alte Wiki-Artikel zur Kommunikationsimplementierung: <br>
[[Übertragen des Spurpolynoms]]
[[Übertragen des Spurpolynoms]]
Zeile 213: Zeile 162:
===[[Fahrzeugkommunikation via RS232| Kommunikation und Diagnoseschnittstelle]] (aktueller Ansatz)===
===[[Fahrzeugkommunikation via RS232| Kommunikation und Diagnoseschnittstelle]] (aktueller Ansatz)===


 
-----
=== Datenverarbeitung ===
Für die Datenverarbeitung wird einen S-Function in Simulink erstellt. Die Funktion hat den Zweck die Daten zu interpretieren und die Spurparameter zu rekonstruieren. Hierfür werden zwei Eingänge benötigt:
* Nutzdata
* Statusbit
und der wesentliche Ausgängen sind:
* a-Parameter
* b-Parameter
* c-Parameter.
 
Empfangt werden 8-Bit-Zeichen und diese müssen zusammengepfügt werden und einer 32-Bit-Zeichen als Ausgabeparameter zurückgeben. Hierfür werden zwei Zähler in der Funktion benötigt:
* zaehler_param
* zaehler_uebertragung
 
Der erste Zähler wird für die Zusammenfügung der Parameter benötig. Diese wird ein wert von 0 bis 3 einnehmen. Um ein 32-Bit-Zeichen wird erst 4 mal 8-Bit-Zeichen empfängt. Der zweite Zähler wird für die Übertragung von alle Spurparameter verwendet. Dieser nimmt den Wert von 1 bis 12 ein.
 
Als erstes werden immer die Daten als 8-Bit-Zeichen empfängt. Die Datenverarbeitung fängt, wenn der Start_Flag gesetzt ist. Dieser wird nur gesetzt wenn:
# der empfängte Byte der Start Byte (170) entspricht
# der Start_Flag und der Parameter Zähler null sind
 
 
Wenn der Flag gesetzt ist, fangen sowohl der Übertragungs- als auch der Parameterzähler hochzuzählen. Der Parameterzähler fasst immer 4-Datenbyte zusammen, dies ergibt einen Spurparameter. Der a-Parameter wird nach 4 Durchläufe komplett zusammengebaut, der b-Parameter nach 8 und der c-Parameter nach 12. Anschließend werden die alle Variablen der Funktion auf null zurückgesetzt.
 
=== Implementierung in Visual Studio ===
=== Implementierung in Visual Studio ===
Die Umsetzung in Visual Studio orientiert sich am oben beschrieben Ablauf.<br>
Die Umsetzung in Visual Studio orientiert sich am oben beschrieben Ablauf.<br>
Zeile 242: Zeile 169:
* '''[[Übertragen des Spurpolynoms]]'''
* '''[[Übertragen des Spurpolynoms]]'''
* '''[[Datenübertragung zwischen PC und dSPACE Karte]]'''
* '''[[Datenübertragung zwischen PC und dSPACE Karte]]'''
(Diese beiden Artikel müssen noch zu einem zusammengefasst werden)


= Anleitung für das ONLINE-Modell =
= Anleitung für das ONLINE-Modell =
[[Datei:KOM_ComTest_Fehlermeldung_MSVCP140D.png|500px|right|thumb|Beim ersten Start fehlen bestimmte Windows Bibliotheken. Das Kompilieren der Datei "ComTest.vcxproj" mit Visual Studio (2019) löst das Problem.]]
[[Datei:KOM_ComTest_Fehlermeldung_MSVCP140D.png|500px|right|thumb|Abb. 9: Beim ersten Start fehlen bestimmte Windows Bibliotheken. Das Kompilieren der Datei "ComTest.vcxproj" mit Visual Studio (2019) löst das Problem.]]
# Nutzen sie bitte MATLAB 2019b
# Nutzen sie bitte MATLAB 2019b
# Achten Sie bitte auf der Solver des Blocks --> '''Fixed Step nicht auf auto'''
# Achten Sie bitte auf der Solver des Blocks --> '''Fixed Step nicht auf auto'''
Zeile 255: Zeile 183:
# Notieren Sie Fehlermeldungen und Warnings
# Notieren Sie Fehlermeldungen und Warnings
# Warnings sind sofort zu beseitigen beim Erstellen einer neuen Bibliothek!
# Warnings sind sofort zu beseitigen beim Erstellen einer neuen Bibliothek!
<br><br><br><br>


= Tests der Kommunikation =


= Tests der Kommunikation =


==Testdokumentation==
{| class="wikitable"
{| class="wikitable"
|+ style = "text-align: left"|Tabelle 5: Links zur Testdokumentation
! style="font-weight: bold;" | Datum
! style="font-weight: bold;" | Datum
! style="font-weight: bold;width: 600px;" | Link
! style="font-weight: bold;width: 600px;" | Link
Zeile 276: Zeile 207:
|-
|-
| style="text-align:right;" | Dezember 2022
| style="text-align:right;" | Dezember 2022
| [[Test der RS232-Kommunikation (Sprint2 WiSe 22/23)]]
| [[Test der RS232-Kommunikation (Abschlusstest WiSe 22/23)]]
|-
| style="text-align:right;" | WiSe 23/24
| [[KOM:_RS232-Kommunikation_DS1104-Karte_mit_PC]]
|}
|}


= Programmierrichtlinien =
= Programmierrichtlinien =
; Schnittstellendokumentation
; Schnittstellendokumentation
→ [https://svn.hshl.de/svn/MTR_SDE_Praktikum/trunk/Anforderungsmanagement/Lastenheft/Schnittstellendokumentation_2018.docx Schnittstellendokumentation]
→ [https://svn.hshl.de/svn/MTR_SDE_Praktikum/trunk/Teams/Kom/Dokumentation/Schnittstelle%20Dokumentation/Schnittstellendokumentation.docx Schnittstellendokumentation]


; Namenskonvetion
; Namenskonvetion

Aktuelle Version vom 21. Januar 2024, 21:43 Uhr

Einleitung

Dieser Artikel wurde im Wintersemester 2022/23 komplett überarbeitet. Über eine genauere Beschreibung der Kommunikation hinaus wurde eine ausführliche Erklärung der Implementierung ergänzt und neu formuliert (für weitere Informationen siehe Versionshistorie).

Anforderungen und Ziele

Das Modul Kommunikation realisiert den Datenaustausch der einzelnen Module des Carolo Cup Fahrzeugs (CCF). Das Ziel ist es, mithilfe von C++ Code (Visual Studio 2019) die Variablen aus der Objekt- und Spurerkennung (z.B. Spurpolynom ) von PC zur x86 PCI-Erweiterungskarte zu übertragen. Der PC berechnet dabei die zu Fahrspur und die PCI-Karte DS1104 überträgt die Signale als Echtzeitmicrocontroller an die Aktoren und bildet mit verschiedenen Sensoren z.B. zur Geschwindigkeitsregelung einen Regelkreis.
Das wird realisiert indem eine serielle RS-232 Schnittstelle zum Microcontroller, in diesem Fall der Entwicklerkarte DS1104 von dSPCACE, implementiert wird.
Die weitere Verarbeitung der Daten findet in den anderen Modulen statt, die in Simulink (2019b) implementiert und auf der dSPACE-Karte ausgeführt werden. Die Spurparameter werden z.B. in BSF - Bahn- und Spurführung verarbeitet, um den Lenkwinkel aus der aktuellen Position und dem Spurpolynom zu regeln.

Konzept

Abb. 1: Schema des Kommunikations-Konzepts nach Schnittstellen Dokumentation (Regelkreis mit dSPACE-Karte stark vereinfacht)

Die OSE Softwareumgebung beinhaltet die Bild- und Objekterkennung mit Laserscanner die Lidar-Verarbeitung, sowie die Implementierung der RS232 Kommunikation.
Wie in Abbildung 1 zu sehen, ist die Kamera mit Ethernet an die x86-CPU verbunden, diese wiederum ist über einen COM Port über das RS-232 Protokoll mit dem dSPACE CP1104 Connector Panel verbunden. Die x86-CPU führt die "OSE_Draufsicht_Spurpolynom_RS232.exe" (C/C++ Code) aus, die einen Bildverarbeitungsalgorithmus auf das Kamerabild anwendet, um die a-, b-, c-Parameter der Fahrspur zu ermitteln. Die dSPACE Karte wird über MATLAB/Simulink programmiert und empfängt das RS-232 Protokoll über ein D-Sub Kabel.


Die OSE Softwareumgebung erkennt aus den Lidar-Daten Objekte, die in Modulen AEP - Autonomes Einparken, BSF - Bahn- und Spurführung und AuF - Antrieb und Fernbedienung benötigt werden. Mit diesen Daten kann das CCF Hindernissen auf der Teststrecke reagieren und ausweichen.

Serielle Schnittstelle: RS-232

Einen guten ersten Überblick des Recommended Standart 232 vermittelt die Definition im Wikipedia Artikel von RS-232.
Die Übertragung wird mit 8bit, also einem Byte langen Wörtern realisiert. Das heißt, dass der COM Port der x86-CPU 8 Bits in den Puffer der dSPACE Karte schreibt. Diese liest pro Zyklusschritt 8bit aus dem Puffer. Um auf diese Weise alle Bytes zu übertragen, müssen die Daten in der gleichen Reihenfolge ausgegeben und wieder eingelesen werden.
Ein Acknowledgement (ACK), Handshake, Stoppbyte und ein Parity-Byte würden die Kommunikation noch zuverlässiger machen, sind Stand Sprint2 im WiSe22/23 nicht implementiert. Auch die bidirektionale Kommunikation mit RS232 von dSPACE Karte zum PC ist nicht implementiert!

Überblick Variablen

Die zu übertragenden Daten bestehen aus mehreren Variablen, die der SVN: Schnittstellendokumentation zu entnehmen sind.

Tabelle 1: Daten von DS1104 zu PC
Signalname Datentyp Beschreibung
V_x_ego float32 (4 Byte) Ego-Längsgeschwindigkeit des Fahrzeugs
alpha float32 (4 Byte) Lenkwinkel: α > 0 Lenkausschlag links, α < 0 Lenkausschlag rechts
Gesamtgröße des Datenpakets 8 Byte


Tabelle 2: Daten von PC zu DS1104
Signalname Datentyp Beschreibung
SpurA float32 (4 Byte) Fahrspurparameter
SpurB float32 (4 Byte) Fahrspurparameter
SpurC float32 (4 Byte) Fahrspurparameter
Spurzuordnung bool (1 Byte) Spurzuordnung: 1 = rechte Fahrspur, 0 = linke Fahrspur
Stopplinie_erkannt bool (1 Byte) 1 = Stopplinie erkannt, 0 = keine Stopplinie erkannt
Stopplinienabstand float32 (4 Byte) Entfernung zur Stopplinie
n_Objekte uint8 (1 Byte) Anzahl relevanter Objekte (maximal 5)
Objekt_Nummer uint8 (1 Byte) Objektzähler
ObjektX float32 (4 Byte) x-Koordinate des Objektmittelpunktes (mitte, vorn)
ObjektY float32 (4 Byte) y-Koordinate des Objektmittelpunktes (mitte, vorn)
Objektbreite float32 (4 Byte) Objektbreite
Objekttiefe float32 (4 Byte) Objekttiefe
Objektausrichtung float32 (4 Byte) Objektausrichtung
Objektgeschwindigkeit float32 (4 Byte) Betrag des Geschwindigkeitsvektors
Objekt_Plausibel uint8 (1 Byte) Vertrauenswert für das Objekt in Prozent ( 0 = minimale Vertrauen, 100 = maximale Vertrauen)
Gesamtgröße des Datenpakets 149 Byte

Dieses Diagramm veranschaulicht die zu sendenden Daten von PC zur dSPACE Karte:

Abb. 2: Schema_Konzept_SDE_CCF_Datenpaket

In Abbildung 2 ist zu sehen, das zuerst das Startbyte übertragen wird, dieses wird auf 10101010(BIN) = 170(DEC) festgelegt. Darauf folgt das Spurpolynom mit den drei Polynomkoeffizienten. Da jeder Koeffizient mit einer Genauigkeit eines floats, also 32bit = 4byte berechnet wird, sind es ingesamt 12Byte für das Fahrspurpolynom. Die Stopplinienerkennung setzt sich zwei binären Variablen zusammen, die dennoch mit je einem Byte übertragen werden. Die Stoppliniendistanz wird ebenfalls mit 4byte übertragen.
Die Anzahl der Lidar-Objekte wird mit einem Byte übertragen, die Eigenschaftsparameter wie Größe, Position, Geschwindigkeit werden ebenfalls jeweils mit 4Byte übertragen, die Objektnummer und der Vertrauenswert wird mit einem Byte gesendet. So ergibt sich eine Datenmange von über 150 Byte, die beispielhaft mit 115200 baud (byte pro Sekunde) in einer Sekunde ~720 mal übertragen wird. Die byte-genaue Größe der zu übertragenen Daten weicht von dieser Darstellung ab, da Struct Datenstrukturen in C++ immer an eine vierte Speicheraddresse gespeichert werden. Das Struct mit den 3 Spurparametern, Spurzuordnung und Stopplinie_erkannt, sowie dem Stopplinienabstand besitzt deswegen eine Variable filler1, die als Platzhalter den Zugriff auf diesen leeren Speicherplatz ermöglicht. Dies kann mit pack pragma umgangen werden, ist aber für diese Implementation nicht zwingend erforderlich!

Softwarearchitektur für die Kommunikation

Die für die OSE Softwareumgebung relevanten Dateien werden im folgendem Diagramm abgebildet.

Abb. 3: Allgemeine_SH_Kommunikation
Abb. 4: Projektmappe Visual Studio OSE Draufsicht Spurpolynom RS232

Beschreibung der Implementierung

Die OSE Softwareumgebung umfasst drei Themenbereiche:

  1. Die Linienerkennung, mit der die Fahrspur berechnet oder die Stopplinie identifiziert wird.
  2. Zweitens die Objekterkennung die aus LIDAR Daten berechnet werden (Noch nicht vollständig im Diagramm! | Stand Sprint1 WS22/23).
  3. Die Implementierung einer RS-232 Kommunikation mit der rs-232.c-Bibliothek von Teunis van Beelen.

Zu Beginn werden in der Hauptklasse der OSE Softwareumgebung "main.h" die Objekt- und Spurerkennung durchgeführt. So werden alle für das Fahrzeug relevanten Informationen generiert Die gesammelten Daten (Spurparameter, Stopplinie, LiDAR-Objekte, etc.) werden im Anschluss in einem Struct zusammengeführt. Mit diesem Struct wird die Funktion RS232_SendDataBigEndianFirst aufgerufen, die mit der Funktion RS232_SendByte() aus "RS232Comm.h" das Datenpaket an die dSPACE-Karte schickt.
Vom PC wird jeder Parameter in 4 Byte aufgesplittet. Es werden, inklusive 5 LiDAR Objekte, insgesamt 47 Parameter nacheinander versendet. Als erstes werden die 4 Byte des a-Parameters empfangen, dann wird der b-Parameter, anschließend der c-Parameter und so weiter. Die Daten werden in der gleichen Reihenfolge empfangen, wie sie auch versendet wurden. Um sicher zu stellen, dass der a-Parameter immer als erstes bearbeitet wird, wird einen START_BYTE von PC zu der dSPACE-Karte gesendet. Dieser wird bewusst als 10101010(BIN) = 170(DEC) gewählt. Wichtig zu beachten ist, dass die Daten im PC als Little-Endian und auf der dSPACE-Karte als Big-Endian gespeichert sind.

Abb. 6: Ablauf der Kommunikation auf Senderseite
Abb. 5: BitReihenfolge



Konfiguration der dSPACE-Karte

Mit der RTI Toolbox von dSPACE wird eine Simulink-Bibliothek für die serielle Schnittstelle bereitgestellt. Hierfür sollte das MATLAB®/Simulink online Modell des CCF gestartet werden. Nachdem die CCF_online.slx in Simulink geöffnet wurde, kann mit Strg + L die verlinkte Bibliothek CCF_online → SEN - Sensoren - online → SenKam - Kamera geöffnet werden. Empfehlenswert ist ein Blick in die Dokumentation/Hilfe von dSPACE, die über das Kontextmenü geöffnet werden kann. Die serielle Kommunikation wird mittels des sogenannten DS1104SER_SETUP -Blocks in Simulink initialisiert, mit einem Doppelklick auf den Block können die Einstellungen des Busses konfiguriert werden: Für die Fahrzeugskommunikation muss auf beiden Seiten eine gleiche Baudrate bestimmt werden.

Abb. 7: SEReinstellung
Abb. 8: RTI Block im Simulink online Modell (CCF_online → SEN - Sensoren - online → SenKam - Kamera)






Im Simulink online Modell werden die gesendeten Bytes mithilfe einer S-Function aufgeschlüsselt. Diese können in dSPACE Control Desk visualisiert und getestet werden.
Hier ist eine ausführlichere Beschreibung der S-Function im online Modell zu finden:

Dekodierung RS-232 in Simulink

Alte Wiki-Artikel zur Kommunikationsimplementierung:
Übertragen des Spurpolynoms Kommunikation zwischen PC und dSpace-Karte (vorheriger Ansatz)

Kommunikation und Diagnoseschnittstelle (aktueller Ansatz)

Implementierung in Visual Studio

Die Umsetzung in Visual Studio orientiert sich am oben beschrieben Ablauf.
Für die konkrete Implementierung der Datenübertragung wurden die folgenden beiden ausführlichen Artikel verfasst:

(Diese beiden Artikel müssen noch zu einem zusammengefasst werden)

Anleitung für das ONLINE-Modell

Abb. 9: Beim ersten Start fehlen bestimmte Windows Bibliotheken. Das Kompilieren der Datei "ComTest.vcxproj" mit Visual Studio (2019) löst das Problem.
  1. Nutzen sie bitte MATLAB 2019b
  2. Achten Sie bitte auf der Solver des Blocks --> Fixed Step nicht auf auto
  3. Lesen Sie die Wiki-Artikeln durch
  4. Notieren Sie Fehlermeldungen und Warnings
  5. Warnings sind sofort zu beseitigen beim Erstellen einer neuen Bibliothek!





Tests der Kommunikation

Testdokumentation

Tabelle 5: Links zur Testdokumentation
Datum Link
Februar 2019 Kommunikation zwischen PC und dSpace-Karte via RS232
Januar 2020 Übertragen des Spurpolynoms
Januar 2022 Kommunikation RS232 zwischen PC und DS1104
Juli 2022 Kom - Kommunikation: Test der Kommunikation zw. PC und DS1104
Dezember 2022 Test der RS232-Kommunikation (Abschlusstest WiSe 22/23)
WiSe 23/24 KOM:_RS232-Kommunikation_DS1104-Karte_mit_PC

Programmierrichtlinien

Schnittstellendokumentation

→ Schnittstellendokumentation

Namenskonvetion

→ Namenskonvention

Alte Wiki Artikel

→ zurück zum Hauptartikel: Praktikum SDE

Abgerufen von „https://wiki.hshl.de/wiki/index.php?title=Kom_-_Kommunikation&oldid=117913“