Objekterkennung mit RP Lidar A1M8

Aus HSHL Mechatronik
Zur Navigation springen Zur Suche springen

Autor: Thomas Miska
Betreuer: Prof. Schneider

Aufgabenstellung

  1. Einarbeitung in die bestehende Software
  2. Softwareentwurf in MATLAB
    1. Meilenstein 1:
      1. Ansteuerung des RP LiDAR A1M8
      2. Koordinatentransformation polar- zu karthesisch
      3. Testdokumentation der KOS-Trafo
      4. Objektbildung (z.B. Sukzessiv Edge Following)
      5. Testdokumentation der Objektbildung
    2. Meilenstein 2:
      1. Objekttracking (mit Kalman-Filter)
      2. Testdokumentation des Objekttrackings
      3. Attribute schätzen: v, a, B, T, Güte (s. Schnittstellendokument)
      4. Testdokumentation der Attribute mit Referenz
      5. Dokumentation im Wiki
  3. Softwareentwurf in C
    1. Meilenstein 3:
      1. Test der Kommunikation Kamera/LiDAR mit DS1104
      2. Testdokumentation
      3. Diagnoseseite in ControlDesk
      4. Darstellung der LiDAR-Objekte als XY-Plot und tabellarisch
      5. ggf. Fertigstellung der Kommunikation
    2. Meilenstein 4:
      1. Plausibilisierung der Messdaten (LiDAR, Kamera)
      2. Referenzmessungen
      3. Abschätzung der Güte der Spurerkennung und des Objekttrackings
      4. Dokumentation im Wiki

Softwareentwurf in MATLAB

Ansteuerung des RP LiDAR A1M8

Die Ansteuerung des RPLiDAR mit MATLAB Erfolgt in Verbindung mit einer SDK welche in C-Code geschrieben ist. Dieser Code ist in GitHub frei zugänglich. Der RPLiDAR liefert uns in diesem Fall folgende Messwerte:

  • Radius
  • Radiant
  • Qualität

Die beiden folgenden Messdaten konnten nicht spezifiziert werden und wurden im weiteren Verlauf auch nicht verwendet. Sie befinden sich jedoch im Algorithmus, da der C-Code diese zurückgibt und diese schlussendlich definiert werden müssen.

  • bNewScan
  • Result

Die Verbindungsart beruht auf eine UART - Schnittstelle, die mithilfe eines Chips ermöglicht wird. Um den COM-Port zu definieren wird ein Textdokument zu Hilfe genommen, in es weitere Einstellungsmöglichkeiten gibt. Die Verwendung eines Textdokument liegt an daran, dass der C-Code ebenfalls darauf zugreift.

Quellcode in MATLAB

% Lade Bibliothek
hardwarex_init;

% Stelle Verbindung mit RPLiDAR her
pRPLIDAR = CreateRPLIDAR();
[result] = ConnectRPLIDAR(pRPLIDAR, 'RPLIDAR0.txt') % Lade die Konfigurationsdatei
disp('Neue Verbindung hergestellt')

[...]

Der Aufruf einer Messung erfolgt über folgenden Befehl:

[result, distance, angle, bNewScan, quality] = GetScanDataResponseRPLIDAR(pRPLIDAR);

Koordinatentransformation polar- zu karthesisch

Polar- und Kartesische Koordinaten

Um die Messwerte darstellen zu können bedarf es einer Umrechnung von Polarkoordinaten (Radius und Radiant) in kartesische Koordinaten (x und y Koordinaten). Das rechte Bild stellt den Zusammenhang zwischen diesen beiden Formen dar. Folglich wird folgende Formel im MATLAB Code verwendet:

Objektbildung

Beispiel der Koordinatentransformation mit Objektbildung

Es gibt mehrere Varianten eine Objektbildung durchzuführen. Für das Projekt jedoch wurde ein Successive Edge Following (SEF) Algorithmus verwendet. Dieser Code vergleich dabei nebeneinanderliegende (durch den Winkel) Radius-Messwerte miteinander und falls diese eine kleine Differenz aufweisen wird ein Segment gebildet.

Links im Bild ist ein Beispiel für die Objektbildung dargestellt. Dabei sind die blauen Punkte Messwerte vom RPLiDAR und die roten Linien sind die gefundenen Objekte (Segmente). Einzelne blaue Punkte werden aufgrund des Nahbereichs oder eines zu großen Abstands zueinander nicht berücksichtigt (gefiltert)

Attribute

Softwareentwurf in C-Code

Test der Kommunikation Kamera/LiDAR mit DS1104

Diagnoseseite in ControlDesk

Plausibilisierung der Messdaten (LiDAR, Kamera)

Abschätzung der Güte der Spurerkennung und des Objekttrackings

Getting started



→ zurück zum Hauptartikel: SDE Praktikum Autonomes Fahren