Spurerkennung mit Kamera und MATLAB

Aus HSHL Mechatronik
Zur Navigation springen Zur Suche springen

Autor: Prof. Dr.-Ing. Schneider, SDE-Team 2022/23

Neue Seite zum Workshop vom 17.05.2022

Im Workshop 7 Spurerkennung (OSE) mit Kamera wurde in nachfolgenden Schritten vorgegangen, die durch die Zweierteams im Nachgang dokumentiert und geprüft werden.

Aufgaben

  • Dokumentieren Sie den Workshop so, dass der rote Faden sichtbar ist.
  • Die Lösung muss nachvollziehbar sein.
  • Dokumentieren Sie Lösungsweg, Lösung und Ergebnisse.
  • Diskutieren Sie die Ergebnisse wissenschaftlich.
  • Nutzen Sie Unterartikel, falls dies der Übersicht dient.
  • Beachten Sie den Artikel Wiki-Artikel_schreiben.
  • Achten Sie beim Review auf Inhalt, Lesbarkeit, Orthographie und Nachhaltigkeit.
  • Arbeiten sie die Review-Ergebnisse nach Absprache ein.


# Aufgabe Team
1 Kalibrierung der Kamera Dong, Gosedopp
2 Bedeutung der Kalibrierparameter Chen, Grünebaum
3 Test der Transformation (KOS-Trafo + Perspektive) - Welt zu Bild und Bild zu Welt Kühnrich, Hernandez Murga
4 Inverse Perspektiventransformation (IPT) Hoppe, Pu
5 Metrischer Test mit Gliedermaßstab (oder Kacheln) Schonlau, Wei
6 Segmentierung der Spuren aus den Bildern (Edge Linking, oder Linien im ROI) Brinkmann, Xia
7 Parameterschätzung des Spurpolynoms Koch, Bao
8 Review der Artikel 1-4 Müller, Wang
9 Review der Artikel 5-7 Kalamani, Schmidt

Voraussetzungen

Kalibrierung der Kamera

Autoren: Daniel Gosedopp, Zhaolin Dong

Einführung

Die Kamerakalibrierung dient der Ermittlung der extrinsischen und intrinsischen Parameter einer Kamera. Die extrinsischen Parameter sind dabei alle Parameter, welche die Position der Kamera in einem Weltkoordinatensystem beschreiben. Konkret sind das eine Rotationsmatrix, die die Verdrehung des Kamerakoordinatensystems zum Welt-KOS abbildet, sowie ein Translationsvektor, der die translatorische Verschiebung des Kamera-KOS zum Welt-KOS beschreibt. Mit den extrinsischen Parametern lässt sich also eine Koordinatentransformation vom Welt- ins Kamerakoordinatensystem und umgekehrt durchführen. Intrinsische Parameter sind all die Parameter, die den Zusammenhang zwischen dem Kamera-KOS und dem Bild-KOS beschreiben. Dazu zählen radiale Verzerrungsparameter der Linse, die fokale Länge sowie das optische Zentrum in der Bildebene. Mit diesen Parametern lässt sich eine Transformation vom Kamera- ins Bild-KOS und umgekehrt durchführen. Die jeweiligen Transformationen lassen sich auch verknüpfen, sodass ein Punkt im Welt-KOS direkt in das Bild-KOS und umgekehrt transformiert werden kann. Dadurch wird z.B. die kamerabasierte Vermessung von Objekten ermöglicht.

Vorbereitung

Für die Kalibrierung der Kamera in MATLAB kann die Camera Calibrator App verwendet werden. Diese ist auch Teil der Computer Vision Toolbox, welche im Rahmen des Workshops "Spurerkennung (OSE) mit Kamera" benötigt wird. Es empfiehlt sich also, direkt die Toolbox statt nur die App zu installieren. Nach der Installation sollte die Camera Calibrator App in MATLAB sichtbar sein (s. Abb. 1).

Abbildung 1: Symbol der Camera Calibrator App in MATLAB.

Um die Kalibrierung durchzuführen, müssen zunächst Bilder eines Schachbrettmusters mit bekannter Kantenlänge gemacht werden. Das Schachbrettmuster kann durch Eingabe des folgenden Befehls im Command Window direkt von MATLAB geöffnet und ausgedruckt werden:

>> open checkerboardPattern.pdf

Es sind mindestens zwei Bilder notwendig, MATLAB empfiehlt für beste Ergebnisse allerdings 10-20 Bilder. Da die Linsenverzerrung in den Ecken eines Bildes am deutlichsten zum Vorschein kommt, sollten einige Fotos gemacht werden, in denen das Schachbrettmuster entsprechend in den Ecken liegt.

Kalibrierung der Kamera

Ein Klick auf das App-Symbol öffnet diese. Um die Fotos hinzuzufügen ist ein Klick auf den Button "Add Images" notwendig. Es öffnet sich ein neues Fenster, in dem die Bilddateien zur Kalibrierung ausgewählt werden müssen. Durch einen Klick auf "Öffnen" erscheint wieder ein neues Fenster. Hier muss die Kantenlänge der Quadrate des Schachbrettmusters eingegeben werden. Diese ist vorher am ausgedruckten Schachbrettmuster abzumessen. Ein Klick auf "OK" bestätigt die Eingabe. Anschließend werden die Bilder analysiert und der App automatisch hinzugefügt. Dabei werden die Eckpunkte des Musters erkannt. Ist die Analyse der Bilder abgeschlossen, sieht die Oberfläche der App wie folgt aus:

Abbildung 2: Camera Calibrator App nach Einladen der Bilder.

MATLAB nimmt an, dass das ausgedruckte Papier nicht gewellt ist und die Quadrate die angegebene Kantenlänge besitzen. Auf Basis dessen, kann die eigentliche Kalibrierung durchgeführt werden. Dazu muss der Button "Calibrate" angeklickt werden. Die sich ergebene Oberfläche sieht wie in Abb. 3 dargestellt aus. In dieser Ansicht werden für jedes gemachte Bild neben den erkannten Eckpunkten und dem Ursprung des Musters jetzt auch die reprojizierten Punkte als rote Kreuze dargestellt.

Abbildung 2: Camera Calibrator App nach Durchführung der Kalibrierung.

Ergebnis

Bedeutung der Kalibrierparameter

Autor:

Test der Transformation (KOS-Trafo + Perspektive) - Welt zu Bild und Bild zu Welt

Autor:

Inverse Perspektiventransformation (IPT)

Autor: Chuan Pu, Sandra Yvonne Hoppe

In diesem Abschnitt wird die Umwandlung einer Videodatei in die Vogelperspektive erläutert. Für die Transformation eines Videos in die Vogelperspektive wird die Inverse Perspektiventransformation Funktion "birdsEyeView" von Matlab Verwendet.

Eingangsparameter

Videodatei

Intrinsische Kamera Parameter

  • calibrationSession.CameraParameters.FocalLength
  • calibrationSession.CameraParameters.PrincipalPoint
  • calibrationSession.CameraParameters.ImageSize

Positionierung Kamera

  • Höhe der Kamera vom Boden „height=300“
  • Neigungswinkel „pitch = 10“

Blickwinkeleinstellung

  • distAhead = 4000
  • spaceToOneSide = 800
  • bottomOffset = 150

Ausgangsparameter

Die Ausgangsparameter sind die berechneten Werte und die daraus entstandenen Frames. Die Frames werden für die Erstellung des Videos aneinander gehangen und ausgegeben. In der nachfolgenden Datei wird ein gekürztes Video der Inversen Transformation dargestellt.

Video der Vogelperspektive


Im nachfolgenden wird der erstellte Programmcode dargestellt.


%****************************************************************
%        Hochschule Hamm-Lippstadt                              *
%****************************************************************
% Modul	          : Aufgabe_2_2                                 *
%                                                               *
% Datum           : 17.05.2022                                  *
%                                                               *
% Funktion        : Erstellung der Vogelperspektive der Spur    *
%                                                               *
% Implementation  : MATLAB R2020a                               *
%                                                               *
% Toolbox         : Image Processing Toolbox                    *
%                   Computer Vision Toolbox                     *
%                   Automated Driving Toolbox                   *
%                                                               *
% Author          : Chuan Pu, Sandra Hoppe                      *
%                                                               *
% Bemerkung       : Datei Pfade an die Ordnerstruktur anpassen  *
%                                                               *
% Letzte Änderung : 18.05.2022                                  *
%                                                               *
%***************************************************************/
%% Matlab vorbereiten
close all;
clc;

%% Video laden
addpath('D:\Student\Daten\Vision')
addpath('D:\Student\Kalibrierung_intrinsisch')
video=VideoReader('Rundkurs.mp4');
load('calibrationSession');

%% Parameter der Kamera Laden 
focalLength = calibrationSession.CameraParameters.FocalLength        
principalPoint = calibrationSession.CameraParameters.PrincipalPoint
imageSize = calibrationSession.CameraParameters.ImageSize

%% Fahrzeugparameter
height = 300; % Höhe der Kamera vom Boden aus in mm
pitch = 10;   %Neigungswinkel

%% Blickwinkeleinstellungen
distAhead = 4000;
spaceToOneSide = 800;
bottomOffset = 150;

%% Berechnungen
camIntrinsics = cameraIntrinsics(focalLength,principalPoint,imageSize);
sensor = monoCamera(camIntrinsics,height,'Pitch',pitch);
outView = [bottomOffset,distAhead,-spaceToOneSide,spaceToOneSide];
outImageSize = [NaN,250]; 
birdsEye = birdsEyeView(sensor,outView,outImageSize);
camIntrinsics = cameraIntrinsics(focalLength,principalPoint,imageSize);

I  = readFrame(video);
BEV = transformImage(birdsEye,I);

%% Ausgabe Video
while hasFrame(video)
    frame = im2bw(readFrame(video));
    birdsImage = transformImage(birdsEye, frame);
    imshowpair(frame, birdsImage, 'montage');
end



Metrischer Test mit Gliedermaßstab (oder Kacheln)

Autor:

Segmentierung der Spuren aus den Bildern

Autor: Jiaxiang Xia, Florian Brinkmann
Damit die Fahrbahnmarkierungen korrekt aus dem Bild segmentiert werden können, ist es hilfreich, wenn in dem verwendeten (perspektivtransformierten) Kamerabild keine Bauteile des Fahrzeugs zu sehen sind. Falls noch Elemente des Fahrzeugs im Bild vorhanden sind, sollten diese maskiert und mit schwarz überschrieben werden. Das hier verwendete Beispielvideo aus der Vogelperspektive (Revision 7472) ist bereits so aufbereitet, dass keine Bauteile des Fahrzeugs bei der Segmentierung der Fahrbahnmarkierung stören könnten.

Prinzipiell gibt es verschiedene Möglichkeiten die drei Fahrbahnmarkierungen zu segmentieren. Entweder man "erkennt" alle drei Markierungen aus dem Kamerabild oder es wird nur eine Fahrbahnmarkierung "erkannt". Von dieser Markierung aus können dann bei einer festen Fahrbahnbreite alle anderen Markierungen berechnet werden. Zur Segmentierung der Fahrbahnmarkierungen aus dem perspektivtransformierten Kamerabild gibt es verschiedene Ansätze, die nachfolgend erläutert werden sollen.

Ansatz 1: Spurverfolgung

Beim ersten Ansatz wird für jeden Frame eines Videos zunächst der Startpunkt einer Fahrbahnmarkierung am unteren Bildrand gesucht und im Anschluss daran die Fahrbahnmarkierung von diesem Startpunkt aus bis zum Ende mit Hilfe der 8er-Nachbarschaften gesucht. Nachfolgend wird eine beispielhafte Implementierung des Vorgehens gezeigt.

Suche nach dem Startpunkt der Fahrbahnmarkierung

Zunächst muss der Startpunkt der Fahrbahnmarkierung am unteren Bildrand gesucht werden. Dazu wird im unten dargestellten Code der Suchbereich eingegrenzt, sodass die linke Spur nur in einem Bereich links der Mitte und die rechte Fahrbahnmarkierung in einem Bereich rechts der Mitte gesucht wird. Die Mittelspur wird nicht gesucht, da diese später aus den beiden äußeren Fahrbahnmarkierungen berechnet wird. Ist in der untersten Zeile kein weißes Pixel einer Fahrbahnmarkierung vorhanden, sucht der Algorithmus in einer Zeile weiter oben nach dem Startpunkt der Linie.

function [xLinks, xRechts, yLinks, yRechts] = sucheStartwert(aBild)
%SUCHESTARTWERT vom unteren Bildrand aus die Startpositionen der linken und
%der rechten weißen Kurve.
%
% Syntax:
%  [xLinks, xRechts, yLinks, yRechts] = sucheStartwert(aBild)
%
% Beschreibung:
%  Sucht den Anfang der weißen Fahrbahnmarkierungen/Kurven.
%
% Eingangswerte:
%  aBild:       Binärbild mit weißen Kurven
%
% Rückgabewerte:
%  xLinks:      Vektor mit x-Positionen der linken Kurve
%  yLinks:      Vektor mit y-Positionen der linken Kurve
%  xRechts:     Vektor mit x-Positionen der rechten Kurve
%  yRechts:     Vektor mit y-Positionen der rechten Kurve
%
% Beispiel:
% [xLinks, xRechts, yLinks, yRechts] = sucheStartwert(aFrame)

%*************************************************************************\
%
% Modul             : segmentiereFahrbahnmarkierungen.m
%
% Datum             : 13.05.2022
%
% Implementierung   : MATLAB R2019b
%
% Toolbox           : 
%
% Autor             : Brinkmann, Florian
%
% Bemerkung         : 
%
% Letzte Änderung   : 13.05.2022
%
%************************************************************************/

% Bildgröße bestimmen
[M,N] = size(aBild);

% Boolean-Variablen, um bei gefundenem Startpunkt die Suche zu beenden
linksGefunden  = 0;
rechtsGefunden = 0;

% Suchbereich
linkeGrenze  = floor(N/3);
Mitte        = floor(N/2);
rechteGrenze = floor(N*2/3);


% Suche nach linkem Startwerk links der Mitte
for m = M:-1:1
   for n = linkeGrenze:1:Mitte-60
       if (linksGefunden == 0) && aBild(m,n) == 1
           xLinks = n;
           yLinks = m;
           linksGefunden = 1;
       end
       
       % Suche abbrechen, falls Pixel gefunden
       if (linksGefunden == 1)
           break
       end
   end
   
   % Suche abbrechen, falls Pixel gefunden
   if (linksGefunden == 1)
       break
   end
end

% Suche nach rechtem Startwerk rechts der Mitte
for m = M:-1:1
   for n = rechteGrenze:-1:Mitte
       if (rechtsGefunden == 0) && aBild(m,n) == 1
           xRechts = n;
           yRechts = m;
           rechtsGefunden = 1;
       end
       
       % Suche abbrechen, falls Pixel gefunden
       if (rechtsGefunden == 1)
           break
       end
   end
   
   % Suche abbrechen, falls Pixel gefunden
   if (rechtsGefunden == 1)
       break
   end
end
end


Verfolgen der Fahrbahnmarkierung

Nachdem die Startpunkte der Fahrbahnmarkierungen gefunden wurden, kann der Verlauf der Markierungen im Bild herausgesucht werden. Wie das nachfolgende Code-Beispiel zeigt, kann dabei mit Hilfe der Nachbarschaftsbeziehungen überprüft werden, ob im Umfeld ein weiters Pixel weiß ist. Damit der Algorithmus am Ende der Fahrbahnmarkierung nicht wieder zum Startpunkt zurück sucht, werden nur die Nachbarn betrachtet, die vor oder seitlich des aktuellen Pixels sind.

function [x, y, aBildSegmentiert] = spurVerfolgen(aBild, xStart, yStart, aBildSegmentiert)
%SPURVERFOLGEN sucht von einem Startpunkt den Verlauf einer weißen Kurve in
%einem Binärbild.
%
% Syntax:
%  [x, y, aBildSegmentiert] = spurVerfolgen(aBild, xStart, yStart)
%  [x, y, aBildSegmentiert] = spurVerfolgen(aBild, xStart, yStart, aBildSegmentiert)
%
% Beschreibung:
%  Verfolgt eine weiße Kurve.
%
% Eingangswerte:
%  aBild:               Binärbild mit weißer Kurve
%  xStart:              x-Position, bei der die weiße Kurve beginnt
%  yStart:              y-Position, bei der die weiße Kurve beginnt
%  aBildSegmentiert:    Bild mit segmentierter Kruve, default: Schwarzbild
%
% Rückgabewerte:
%  x:                   Vektor mit x-Positionen der Kurve
%  y:                   Vektor mit y-Positionen der Kurve
%  aBildSegmentiert:    Bild mit segmentierter Kruve
%
% Beispiel:
% [x, y] = spurVerfolgen(aFrame, 20, 500)

%*************************************************************************\
%
% Modul             : segmentiereFahrbahnmarkierungen.m
%
% Datum             : 13.05.2022
%
% Implementierung   : MATLAB R2019b
%
% Toolbox           : 
%
% Autor             : Brinkmann, Florian
%
% Bemerkung         : 
%
% Letzte Änderung   : 13.05.2022
%
%************************************************************************/

% Bildgröße bestimmen
[M,N] = size(aBild);

% Default-Schwarzbild (Ergebnisbild) erzeugen
if nargin < 4
   aBildSegmentiert = zeros(M,N); 
end

% Startwerte in Egbenisvektor ablegen
x(1) = xStart;
y(1) = yStart;
aBildSegmentiert(y(1), x(1)) = 1;

% Schleife über alle Zeilen des Bildes
for i = 1:M-1
    % Nächstes weißes Pixel suchen
    [a,b] = naechstesPixel(aBild,x(i),y(i),1);
    
    if a == -1 || b == -1           % Kein weißes Pixel gefunden
        break
        disp('Linie zu Ende')
    else                            % weißes Pixel gefunden
        % Koordinaten in Ergebnisvektor ablegen
        x(i+1) = a;
        y(i+1) = b;
        aBildSegmentiert(b,a) = 1;
    end
end
end


%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%


function [x,y] = naechstesPixel(aBild, x0, y0, sollWert)
%NAECHSTESPIXEL sucht von einem Startpunkt das nächste Pixel. Zunächst wird
%in der nächsten Zeile gesucht, wird dort kein weißes Pixel gefunden wird
%auch links und rechts des Startpunkts gesucht.
%
% Syntax:
%  [x,y] = naechstesPixel(aBild, x0, y0)
%  [x,y] = naechstesPixel(aBild, x0, y0, sollWert)
%
% Beschreibung:
%  Es werden weiße Pixel in der Umgebung gesucht.
%
% Eingangswerte:
%  aBild:       Binärbild, in dem sich eine weiße Kurve befindet
%  x0:          Starpunkt für Suche in x-Richtung
%  y0:          Startpunkt für Suche in y-Richtung
%  sollWert:    Wert für weißes Pixel, default: 1
%
% Rückgabewerte:
%  x:           x-Position des nächsten weißen Pixel
%  y:           y-Position des nächsten weißen Pixel
%
% Beispiel:
%  [x,y] = naechstesPixel(aFrame, 20, 500)
%  [x,y] = naechstesPixel(aFrame, 20, 500, 1)

%*************************************************************************\
%
% Modul             : segmentiereFahrbahnmarkierungen.m
%
% Datum             : 13.05.2022
%
% Implementierung   : MATLAB R2019b
%
% Toolbox           : 
%
% Autor             : Brinkmann, Florian
%
% Bemerkung         : 
%
% Letzte Änderung   : 13.05.2022
%
%************************************************************************/

% Default-Werte
if nargin <4
    sollWert = 1;
end

% Abfang, falls Ränder erreicht
if y0 == 1 || x0 == 1
    x = -1;
    y = -1;
    return
end

% Suche nach weißem Pixel in der Umgebung
if aBild(y0-1, x0) == sollWert          % Pixel oben
    x = x0;
    y = y0-1;
elseif aBild(y0-1, x0-1) == sollWert    % Pixel oben links
    x = x0-1;
    y = y0-1;
elseif aBild(y0-1, x0+1) == sollWert    % Pixel oben rechts
    x = x0+1;
    y = y0-1;
elseif aBild(y0, x0-1) == sollWert      % Pixel links
    x = x0-1;
    y = y0;
elseif aBild(y0, x0+1) == sollWert      % Pixel rechts
    x = x0+1;
    y = y0;
% Nach unten, also zurück muss nicht gesucht werden
% elseif aBild(y0+1, x0) == sollWert      % Pixel unten
%     x = x0;
%     y = y0+1;
% elseif aBild(y0+1, x0-1) == sollWert    % Pixel unten links
%     x = x0-1;
%     y = y0+1;
% elseif aBild(y0+1, x0+1) == sollWert    % Pixel unten rechts
%     x = x0+1;
%     y = y0+1;
else % Falls kein weißes Pixel gefunden wurde
    x = -1;
    y = -1;
end

end


Ansatz 2: Kantenerkennung

Neben der Spurverfolgung gibt es auch die Möglichkeit mittels Kantenerkennung die Fahrbahnmarkierungen in einem Frame des Videos zu segmentieren. Dazu wird zunächst der Sobel-Operator genutzt, um ein Bild zu erzeugen, indem nur die Kanten sichtbar sind. Hierzu kann die MATLAB Funktion edge[1] verwendet werden. Für jede Fahrbahnmarkierungen erhält man durch die Kantenerkennung zwei Kanten, einmal den Übergang von schwarz zu weiß und einmal den Übergang von weiß zu schwarz. Um die doppelten Kanten zu entfernen muss dass Bild zeilenweise durchlaufen werden. Hierbei überprüft man den Abstand zwischen zwei Kanten. Ist dieser Abstand kleiner als 6 Pixel kann davon ausgegangen werden, dass die beiden Kanten zu einer Fahrbahnmarkierung gehören. Entweder löscht man dann beide Kanten und erzeugt eine neue Kante in der Mitte oder man löscht eine Kante und nutzt die verbleibende Kante als Position der Fahrbahnmarkierung.

Ansatz 3: MATLAB Automated Driving Toolbox

Eine weitere Möglichkeit zur Spurerkennung ist die Verwendung von MATLAB-Funktionen aus der MATLAB Automated Driving Toolbox. Eine schöne Einführung in die Thematik bietet die Dokumentation der Funktion segmentLaneMarkerRidge[2].

Hinweis: Die Dokumentation verwendet den Befehl im2gray. Dieser ist allerdings erst ab der MATLAB R2020b verfügbar. In vorherigen Versionen kann ein RGB-Bild mit der Funktion rgb2gray in ein Grauwertbild umgewandelt werden.

Parameterschätzung des Spurpolynoms

Autor:

Literatur