Tutorial Separating Axis Theorem: Unterschied zwischen den Versionen

Aus DGL Wiki
Wechseln zu: Navigation, Suche
K (Rechtschreibfehler ausgebessert)
 
(35 dazwischenliegende Versionen von 5 Benutzern werden nicht angezeigt)
Zeile 1: Zeile 1:
 
=Kollisionserkennung=
 
=Kollisionserkennung=
''zweier Polygone mit dem Separating Axis Theorem''
+
''von Polygonen mit dem Separating Axis Theorem''
  
 
== Vorwort ==
 
== Vorwort ==
Zeile 7: Zeile 7:
 
Um den mathematischen Hintergrund zu verstehen, ist es sinnvoll ein wenig Kenntnis in [[Tutorial_Lineare_Algebra|Vektorrechnung]] zu haben.
 
Um den mathematischen Hintergrund zu verstehen, ist es sinnvoll ein wenig Kenntnis in [[Tutorial_Lineare_Algebra|Vektorrechnung]] zu haben.
  
== Die Theorie ==
+
== Kollision zweier Polygone ==
  
[[Bild:SAT_Normale.jpg|right]]
+
=== Die Theorie ===
Das Separating Axis Theorem (kurz: SAT) besagt, dass zwei Polygone sich nicht schneiden, wenn es möglich ist, eine Gerade zu finden, die zwischen den beiden liegt.
+
 
Nun gibt es unendlich viele Geraden die man testen könnte...
+
[[Bild:SAT_Normale.jpg|thumb|right|framed|Normale der Seite des Quadrats]]
 +
Das Separating Axis Theorem (''kurz: SAT'') besagt, dass zwei Polygone sich nicht schneiden, wenn es möglich ist, eine Gerade zu finden, die zwischen den beiden liegt, bzw. die beiden trennt. Der Begriff "Gerade" ist hier allerdings nicht ganz korrekt. Eine Gerade hat eine räumliche Lage, diese ist für unser Vorhaben jedoch nicht von Belangen, deshalb werde ich im Folgenden das Wort ''Achse'' benutzen, daher auch der Name ''Separating Axis'' (Trennungsachse).
 +
Nun gibt es unendlich viele Achsen die man testen könnte...
 
Glücklicherweise kann man sich hier auf eine überschaubare Zahl beschränken, denn man braucht nur die Anzahl der Seiten beider Polygone. Bei einem Viereck wären das vier, bei einem Dreieck drei, etc.
 
Glücklicherweise kann man sich hier auf eine überschaubare Zahl beschränken, denn man braucht nur die Anzahl der Seiten beider Polygone. Bei einem Viereck wären das vier, bei einem Dreieck drei, etc.
 
Hat man die Eckpunkte des Polygons als Vektoren (Ortsvektoren) gegeben, kann man durch Subtraktion zweier Ortsvektoren den Vektor bestimmen der zu der Seite gehört, die von den beiden Vektoren aufgespannt wird.
 
Hat man die Eckpunkte des Polygons als Vektoren (Ortsvektoren) gegeben, kann man durch Subtraktion zweier Ortsvektoren den Vektor bestimmen der zu der Seite gehört, die von den beiden Vektoren aufgespannt wird.
Zeile 20: Zeile 22:
 
[[Bild:SAT_Normale_Formel.jpg]]
 
[[Bild:SAT_Normale_Formel.jpg]]
  
die Koordinaten werden vertauscht und eine von beiden wird negiert.
+
die Koordinaten werden vertauscht und eine von beiden wird negiert, so erhält man einen Vektor der senkrecht zu dem original Vektor ist. Da es zwei Möglichkeiten gibt, spricht man von der linken oder rechten Normale (aus der Sicht des Vektors).
Der Vektor muss dann noch normalisiert werden, sodass er die Länge 1 erhält.
+
Der Vektor muss dann noch normiert werden, sodass er die Länge 1 erhält,.
Jetzt müssen beide Polygone auf diesen Vektor projeziert werden, denn dadurch haben wir ein Eindimensionales Abbild unserer Polygone und können mittels eines einfachen Vergleichs überprüfen, ob sich die beiden 1D-Strecken schneiden. Sollte ein Fall eintreffen bei dem kein Schnitt stattfindet, dann kollidieren die beiden Polygone nicht und die Prozedur kann abgebrochen werden.
+
Jetzt müssen beide Polygone auf diesen Vektor projiziert werden, denn dadurch erhalten wir ein eindimensionales Abbild unserer Polygone und können mittels eines einfachen Vergleichs überprüfen, ob sich die beiden eindimensionalen Strecken schneiden.  
 +
Sollte ein Fall eintreffen bei dem kein Schnitt stattfindet, dann kollidieren die beiden Polygone nicht und die Prozedur kann abgebrochen werden. Dies ist auch  der Grund, warum dieses Verfahren recht schnell ist, da im besten Fall schon im ersten
 +
Durchlauf abgebrochen werden kann.
 +
 
 
Nun zur Projektion:
 
Nun zur Projektion:
  
 
[[Bild:SAT_Kollision.jpg]][[Bild:SAT_Keine_Kollision.jpg]]
 
[[Bild:SAT_Kollision.jpg]][[Bild:SAT_Keine_Kollision.jpg]]
  
Auf dem linken Bild sieht man, wie beide Polygone auf die Gerade projeziert werden, der pinke Bereich zeigt die Schnittmenge an. In diesem Fall ist die Gerade die Normale der linken oder rechten Seite des Quadrats.
+
Auf dem linken Bild sieht man, wie beide Polygone auf die Achse projiziert werden, der pinke Bereich zeigt die Schnittmenge an. In diesem Fall ist die Achse die Normale der linken oder rechten Seite des Quadrats.
Auf dem Bild rechts ist der Fall dargestellt, dass keine Kollision stattfindet, demzufolge gibt es auch keine Schnittmenge auf der Geraden.
+
Auf dem Bild rechts ist der Fall dargestellt, dass keine Kollision stattfindet, demzufolge gibt es auch keine Schnittmenge auf der Achse. Somit gibt es eine Gerade, bzw. eine Trennungsachse senkrecht zur unserer Projektionsachse, welche die beiden Polygone separiert.
Dazu ist allerdings zu sagen, dass die Gerade keine räumliche Position hat. So wie Vektoren auch keine Positionen haben, Vektoren sind lediglich verschiebungsanweisungen und unsere "Gerade" wie ich sie hier nenne, ist auch nur ein Vektor, denn wo sie liegt ist letzten endes egal, da wir ja ein eindimensionales Ergebnis anstreben.
 
  
Für die Projektion eines Vektors auf einen anderen verwenden wir das [[Standard_Skalarprodukt|Skalarprodukt]], bei diesem kommt ein Zahlenwert heraus, der die Position des Eckpunktes auf unserer 1D-Geraden darstellt.
+
Für die Projektion eines Vektors auf einen anderen verwenden wir das [[Standard_Skalarprodukt|Skalarprodukt]], bei diesem kommt ein Zahlenwert heraus, der die Position des Eckpunktes auf unserer eindimensionalen Achse darstellt.
Haben wir sämtliche Punkte projeziert, so müssen wir für die jeweiligen Polygone noch jeweils den kleinsten und größten Wert heraussuchen, damit wir zwei Strecken erhalten.
+
Haben wir sämtliche Punkte projiziert, so müssen wir für die jeweiligen Polygone noch jeweils den kleinsten und größten Wert heraussuchen, damit wir zwei Strecken erhalten.
Diese werden dann auf Schnitt geprüft und das wars.
+
Diese werden dann mit einer einfachen Abfrage auf Schnitt geprüft und das wars.
  
== Zusammenfassung ==
+
=== Zusammenfassung ===
  
*Jedes der beiden Polygone durchgehen und alle nötigen Geraden aus den Normalen der Seitenflächen bestimmen
+
*Jedes der beiden Polygone durchgehen und alle nötigen Achsen aus den Normalen der Seitenflächen bestimmen
**Jeden Eckpunkt jedes Polygons auf diese Geraden Projezieren
+
**Jeden Eckpunkt jedes Polygons auf diese Achsen projizieren
 
**Die kleinsten und größten Werte ermitteln und auf Schnitt prüfen
 
**Die kleinsten und größten Werte ermitteln und auf Schnitt prüfen
 
*Tritt der Fall auf, dass kein Schnitt statt findet, so kann sofort abgebrochen werden, es findet keine Kollision statt.
 
*Tritt der Fall auf, dass kein Schnitt statt findet, so kann sofort abgebrochen werden, es findet keine Kollision statt.
  
== Der Code ==
+
== Kollision eines Kreises und eines Polygons ==
 
 
Um bei so vielen Vektoroperationen nicht völlig durcheinander zu geraten und die Übersicht zu verlieren (was dabei durchaus mal passieren kann), ist es es sinnvoll, sich eine Unit zu schreiben, die einem die Vektorrechnung abnimmt.
 
Im weiteren Verlauf des Tutorials werde ich folgende Unit benutzen:
 
<pascal>
 
// Unit Vectors
 
(**************************************************
 
  
- Enthält: TVector2f
+
=== Theorie ===
  
**************************************************)
+
Das Prinzip für die Kollision zweier Polygone ist denke ich jetzt klar geworden, doch was ist, wenn wir einen Kreis haben, der mit einem Polygon kollidiert?
 
+
Dieser Fall ist leicht abzuhandeln, ein Kreis hat unendlich viele Normalen, die man testen könnte,
unit Vectors;
+
uns reichen aber die, die die Vertices des Polygons schneiden würden, sprich: die Achsen, die den Kreismittelpunkt und die Ecken unseres Polygons verbinden würden.
 
 
interface
 
 
 
type
 
  // 2D Vektor
 
  TVector2f = record
 
    X, Y: Extended;
 
  end;
 
 
 
  // Zwei Singles in einen TVector2f umwandeln
 
  function To_v2f(X, Y: Single): TVector2f;
 
  // Zwei Vektoren addieren
 
  function v2f_Add(V1, V2: TVector2f): TVector2f;
 
  // Einen Vektor von einem anderen subtrahieren
 
  function v2f_Sub(V1, V2: TVector2f): TVector2f;
 
  // Einen Vektor skalieren
 
  function v2f_Scale(V: TVector2f; Scalar: Single): TVector2f;
 
  // Ermittelt die Länge eines Vektors
 
  function v2f_Length(V: TVector2f): Single;
 
  // Normalisiert einen Vektor (sodass v2f_length = 1)
 
  function v2f_Normalize(V: TVector2f): TVector2f;
 
  // Ermittelt ds Skalarprodukt
 
  function v2f_DotProduct(V1, V2: TVector2f): Single;
 
 
 
implementation
 
 
 
function To_v2f(X, Y: Single): TVector2f;
 
begin
 
  Result.X := X;
 
  Result.Y := Y;
 
end;
 
 
 
function v2f_Add(V1, V2: TVector2f): TVector2f;
 
begin
 
  Result.X := V1.X + V2.X;
 
  Result.Y := V1.Y + V2.Y;
 
end;
 
  
function v2f_Sub(V1, V2: TVector2f): TVector2f;
+
[[Bild:SAT_Kreis_Quadrat.jpg|thumb|right|framed|Projektionsachsen eines Kreises]]
begin
 
  Result.X := V1.X - V2.X;
 
  Result.Y := V1.Y - V2.Y;
 
end;
 
  
function v2f_Scale(V: TVector2f; Scalar: Single): TVector2f;
+
Die blauen Linien auf dem Bild sind wieder einmal die Achsen auf die wir projizieren, diese kommen zu den, die wir aus dem Polygon berechnen hinzu.
begin
 
  Result.X := V.X * Scalar;
 
  Result.Y := V.Y * Scalar;
 
end;
 
  
function v2f_Length(V: TVector2f): Single;
+
=== Zusammenfassung ===
begin
 
  Result := sqrt(V.X * V.X + V.Y * V.Y);
 
end;
 
  
function v2f_Normalize(V: TVector2f): TVector2f;
+
*Wir berechnen also den Vektor vom Kreis-Mittelpunkt zum Vertex, dieser wird normiert.
var
+
*Dann projizieren wir das Polygon wie gehabt
  L: Single;
+
*Der Kreis wird projiziert, indem der Vektor, auf den wir projizieren, mit dem Radius des Kreises skaliert (also skalar multipliziert) wird. Mit diesem wird dann genauso weiter verfahren. Dies ist dann der Max-Wert für unseren Kreis, der Min-Wert ist einfach der Max-Wert * -1, also -max.
begin
 
  L := v2f_Length(V);
 
  
  if L = 0 then
+
Hierzu ist zu sagen, dass dies noch dahingehend optimieren kann, dass man feststellt, in welcher Voronoi-Region des Polygons sich der Kreis befindet. Wenn man diese Region hat, reicht es diese eine Achse zu prüfen.
    L := 1;
 
  
  Result := v2f_Scale(V, 1 / L);
+
== Kollision eines Punktes und eines Polygons ==
end;
 
  
function v2f_DotProduct(V1, V2: TVector2f): Single;
+
Ganz am Rande möchte ich noch erwähnen, dass es ebenso möglich ist, zu prüfen, ob sich ein Punkt in einem Polygon befindet. Hierzu wird einfach der Punkt auf die Achsen projiziert und geprüft ob er größer als das Minimum und kleiner als das Maximum des Polygons auf dieser Achse ist.
begin
 
  Result := V1.X * V2.X + V1.Y * V2.Y;
 
end;
 
  
end.
+
== Polygone trennen ==
</pascal>
 
Jedoch schadet es nicht, sich eine eigene zu schreiben, um seine Kenntnisse in Sachen Vektorrechnung ein wenig zu festigen.
 
Jetzt benötigen wir eine Klasse für unsere Polygone.
 
Die einzelnen Eckpunkte der Polygone werden nicht etwa absolut (also in Weltkoordinaten), sondern relativ zu einem Punkt angegeben, so fällt es leichter, das Polygon zu verschieben. Der absolute Wert kann jedoch ganz nützlich sein, um z.B. ein Polygon zu zeichnen.
 
Als erstes definieren wir ein Array von TVector2f, denn jeder Eckpunkt ist ein Vektor und unsere Polygone sollen ja beliebig viele davon besitzen können, also:
 
<pascal>
 
type
 
  TV2fArray = array of TVector2f;
 
</pascal>
 
Dann folgt die Definition unseres Polygons:
 
<pascal>
 
  TPolygon = class
 
  private
 
    fposition: TVector2f;                            // Position
 
    fvertices: TV2fArray;                            // Vertices (Objektkoordinaten)
 
    function GetVertex(n: integer): TVector2f;        // Liefert die Objektkoordinaten
 
    function GetVertexAbs(n: integer): TVector2f;    // Liefert die absoluten Koordinaten
 
    function GetCount: integer;                      // Liefert length(fvertices)
 
  public
 
    procedure AddVertex(v: TVector2f);
 
    procedure RemoveVertex(n: integer);
 
    property position: TVector2f read fposition write fposition;                // Position
 
    property vertices[n: integer]: TVector2f read GetVertex;                    // Vertex Koordinaten
 
    property vertices_abs[n: integer]: TVector2f read GetVertexAbs;
 
    property Count: integer read GetCount;                                      // siehe GetCount
 
  end;</pascal>
 
Unser Polygon hat jetzt eine Position und Eckpunkte, ebenfalls können wir auf absolute, sowie relative Koordinaten zugreifen. Count liefert uns die Anzahl der Ecken. [size=9][i](Eine
 
Ecke bezeichnet man auch als Vertex, der Plural von Vertex ist Vertices.)[/i][/size]
 
Hier sind die entsprechenden Funktionen:
 
<pascal>
 
procedure TPolygon.AddVertex(v: TVector2f);
 
begin
 
  setlength(fvertices, length(fvertices) + 1);
 
  fvertices[high(fvertices)] := v;
 
end;
 
  
procedure TPolygon.RemoveVertex(n: integer);
+
Damit unsere Kollisionserkennung praxistauglich wird, müssen die Polygone, wenn sie kollidieren auch wieder getrennt werden können. Hierzu benötigen wir einen Vektor, der unsere beiden Polygone wieder auseinander "schiebt". Selbstverständlich könnte man einen beliebigen Vektor nehmen, aber das Ergebnis wäre eher realtitätsfern, deshalb brauchen wir den Vektor, der den kürzesten Weg beschreibt, um die beiden Polygone zu trennen. Dieser Vektor wird auch die Normale der Kollision oder '''MTD'''-Vektor genannt (für '''M'''inimum '''T'''ranslation '''D'''istance). Hier kommt ein weiterer Vorteil des Separating Axis Theorems zum tragen, denn den Vektor den wir suchen, haben wir schon so gut wie berechnet.
var
+
Wir multiplizieren alle unsere Projektionsachsen mit den Differenzen, die wir bei den eindimensionalen Kollisionen herausbekommen haben, somit erhalten wir Vektoren, die für das Außeinander-Schieben unserer Polygonein in Frage kommen. Nun müssen wir nur noch den kürzesten davon finden, dies ist unser MTD. Allerdings sollte man vor der Verwendung sicherstellen, dass dieser Vektor vom Polygon wegzeigt. Hierzu können wir ebenfalls das Skalarprodukt nutzen.
  i: integer;
 
begin
 
  for i := n to high(fvertices) - 1 do
 
    fvertices[i] := fvertices[i + 1];
 
  setlength(fvertices, length(fvertices) - 1); 
 
end;
 
  
function TPolygon.GetVertex(n: integer): TVector2f;
+
== Rotation ==
begin
 
  result := fvertices[n];
 
end;
 
  
function TPolygon.GetVertexAbs(n: integer): TVector2f;
+
Um Polygone behandeln zu können, die rotieren, sind lediglich einige Änderungen an der Polygonklasse erforderlich.
begin
+
Hierbei gibt es mehrere Optionen, zum einen können wir unsere Vertices in jedem Schritt drehen und speichern, allerdings kann dies auf Dauer zu Ungenauigkeiten führen. Eine zweite Möglichkeit wäre, bei jedem Zugriff auf die Vertices, einen gedrehten Vektor auszugeben. Dies erhöht zwar
  result := v2f_add(fvertices[n], fposition);
+
die benötigte Rechenleistung, ist aber deutlich genauer. Das Seperation Axis Theorem kann dann mit den gedrehten Vertices weiter verfahren.
end;
 
  
function TPolygon.GetCount: integer;
+
== Das Beispielprojekt ==
begin
 
  result := length(fvertices);
 
end;
 
</pascal>
 
Mit AddVertex können wir unsere Vertices hinzufügen, aber dazu später mehr.
 
Nun folgt die Kollisionserkennung an sich:
 
<pascal>
 
function PolyPolyIntersect(A, B: TPolygon): boolean;
 
var
 
  i, j, l: integer;
 
  tmp, proj, voffset: TVector2f;
 
  dp, amin, amax, bmin, bmax, d1, d2, foffset: extended;
 
begin
 
  // Offset berechnen
 
  voffset := v2f_sub(A.position, B.position);
 
// A - alle Projektionsgeraden ermitteln und projezieren
 
  for i := 0 to (a.count - 1) do
 
  begin
 
    l := i + 1;
 
    if l > (a.count - 1) then
 
      l := 0;
 
    // Berechnung der Seitenfläche
 
    tmp := v2f_sub(a.vertices[l], a.vertices[i]);
 
    // Berechnet die Normale der Seitenfläche
 
    proj := v2f_normalize(to_v2f(-tmp.y, tmp.x));
 
    // Projeziert den ersten Wert
 
    amin := v2f_dotproduct(a.vertices[0], proj);
 
    amax := amin;
 
    // Findet den kleinsten und größten projezierten Wert für die Gerade für A
 
    for j := 1 to (a.count - 1) do
 
    begin
 
      // projezieren
 
      dp := v2f_dotproduct(a.vertices[j], proj);
 
      if dp < amin then
 
        amin := dp;
 
      if dp > amax then
 
        amax := dp;
 
    end;
 
    // s.o.
 
    bmin := v2f_dotproduct(b.vertices[0], proj);
 
    bmax := bmin;
 
    // B
 
    for j := 1 to (b.count - 1) do
 
    begin
 
      dp := v2f_dotproduct(b.vertices[j], proj);
 
      if dp < bmin then
 
        bmin := dp;
 
      if dp > bmax then
 
        bmax := dp;
 
    end;
 
    // 1D Kollision
 
    foffset := v2f_dotproduct(voffset, proj);
 
    amin := amin + foffset;
 
    amax := amax + foffset;
 
    d1 := amin - bmax;
 
    d2 := bmin - amax;
 
    // Wenn es keine Überschneidung gibt, abbrechen -> keine Kollision
 
    if (d1 > 0) or (d2 > 0) then
 
    begin
 
      result := false;
 
      exit;
 
    end;
 
  end;
 
// B - alle Projektionsgeraden ermitteln und projezieren (s.o.)
 
  for i := 0 to (b.count - 1) do
 
  begin
 
    l := i + 1;
 
    if l > (b.count - 1) then
 
      l := 0;
 
    tmp := v2f_sub(b.vertices[l], b.vertices[i]);
 
    proj := v2f_normalize(to_v2f(-tmp.y, tmp.x));
 
    amin := v2f_dotproduct(a.vertices[0], proj);
 
    amax := amin;
 
    for j := 1 to (a.count - 1) do
 
    begin
 
      dp := v2f_dotproduct(a.vertices[j], proj);
 
      if dp < amin then
 
        amin := dp;
 
      if dp > amax then
 
        amax := dp;
 
    end;
 
    bmin := v2f_dotproduct(b.vertices[0], proj);
 
    bmax := bmin;
 
    for j := 1 to (b.count - 1) do
 
    begin
 
      dp := v2f_dotproduct(b.vertices[j], proj);
 
      if dp < bmin then
 
        bmin := dp;
 
      if dp > bmax then
 
        bmax := dp;
 
    end;
 
    foffset := v2f_dotproduct(voffset, proj);
 
    amin := amin + foffset;
 
    amax := amax + foffset;
 
    d1 := amin - bmax;
 
    d2 := bmin - amax;
 
    if (d1 > 0) or (d2 > 0) then
 
    begin
 
      result := false;
 
      exit;
 
    end;
 
  end;
 
  // Kollision
 
  result := true;
 
end;
 
</pascal>
 
Wie man sieht, ist der zweite Teil des Codes, mit dem ersten sogut wie identisch, der einzige Unterschied besteht darin, dass dort die Geraden aus den Vertices von B berechnet werden. Nehmen wir den Code mal auseinander:
 
<pascal>
 
    tmp := v2f_sub(a.vertices[l], a.vertices[i]);
 
    proj := v2f_normalize(to_v2f(-tmp.y, tmp.x));
 
</pascal>
 
Hier wird zunächst der Vektor berechnet, der für die Seitenfläche steht, durch die Schleife wird dies für alle Seitenflächen gemacht. Danach wird die Normale berechnet.
 
proj ist dann der Vektor auf den wir unsere Vertices projezieren.
 
<pascal>
 
    amin := v2f_dotproduct(a.vertices[0], proj);
 
    amax := amin;
 
</pascal>
 
Hier projezieren wir das erste Vertex von A und haben somit den ersten Punkt unserer Strecke.
 
<pascal>
 
    for j := 1 to (a.count - 1) do
 
    begin
 
      dp := v2f_dotproduct(a.vertices[j], proj);
 
      if dp < amin then
 
        amin := dp;
 
      if dp > amax then
 
        amax := dp;
 
    end;
 
</pascal>
 
Hier werden alle weiteren Vertices projeziert und der kleinste, sowie größte Wert gespeichert.
 
Das gleiche wird für B wiederholt.
 
<pascal>
 
    foffset := v2f_dotproduct(voffset, proj);
 
    amin := amin + foffset;
 
    amax := amax + foffset;
 
    d1 := amin - bmax;
 
    d2 := bmin - amax;
 
</pascal>
 
Da es sich bei unseren Vertexkoordinaten um Objektkoordinaten handelt, müssen die projezierten Vertices nun um die Differenz beider Polygonpositionen verschoben werden.
 
Dies klingt zunächst einmal kompliziert, macht aber sinn. Die Alternative wäre, jeden Punkt in Weltkoordinaten (also absolute Koordinaten) umzuwandeln. Dadurch, dass wir am Anfang den Vektor zwischen den beiden Polygonen berechnen:
 
<pascal>
 
voffset := v2f_sub(A.position, B.position);
 
</pascal>
 
und ihn danach Projezieren, können wir diese Verschiebung auf unserer Geraden nachträglich vornehmen und haben somit alles in einem Abwasch erledigt. 
 
<pascal>
 
    if (d1 > 0) or (d2 > 0) then
 
    begin
 
      result := false;
 
      exit;
 
    end;
 
</pascal>
 
Ohne einen Vergleich kommt auch diese Kollisionsabfrage nicht aus, hier jedoch nur auf eindimensionaler Ebene. Gibt es keine Überschneidung der beiden 1D-Strecken, so kann die Prozedur abgebrochen werden, denn es gibt keine Kollision. Ist die komplette Prozedur durchgelaufen ohne abzubrechen, so wird result auf true gesetzt und eine Kollision ist bestätigt.
 
  
==Das Beispielprojekt ==
+
=== Beispiel 1 - Polygon <> Polygon ===
  
 
Was wäre ein Tutorial doch ohne Beispiel ;)
 
Was wäre ein Tutorial doch ohne Beispiel ;)
Ich werde hier nur kurz die Verwendung des Codes erläutern und ein kleines
+
Ich werde hier nur kurz die Verwendung des Codes erläutern und ein kleines Beispielprogramm anhängen.
Beispielprogramm anhängen.
 
 
Ein Polygon muss natürlich erst einmal erzeugt werden:
 
Ein Polygon muss natürlich erst einmal erzeugt werden:
<pascal>
+
<source lang="pascal">
 
A := TPolygon.Create;
 
A := TPolygon.Create;
</pascal>
+
</source>
 
Die einfachste Möglichkeit es zu gestalten funktioniert so:
 
Die einfachste Möglichkeit es zu gestalten funktioniert so:
<pascal>
+
<source lang="pascal">
 
   with A do
 
   with A do
 
   begin
 
   begin
Zeile 355: Zeile 101:
 
     AddVertex(to_v2f(-50, -50));
 
     AddVertex(to_v2f(-50, -50));
 
   end;
 
   end;
</pascal>
+
</source>
 
Dies liefert ein Quadrat mit den Maßen 100*100 an der Position (200|200).
 
Dies liefert ein Quadrat mit den Maßen 100*100 an der Position (200|200).
 +
Die Koordinaten der Vertices werden absolut zur Position und ''entgegen'' des Uhrzeigersinns angegeben.
 +
 +
'''Und hier das Beispielprojekt:'''
 +
* {{ArchivLink|file=tut_SAT_exe|text=Windows-Binary}}
 +
* {{ArchivLink|file=tut_SAT_src|text=Delphi-Quelltext}}
 +
 +
=== Beispiel 2 - Kreis <> Polygon ===
 +
 +
Für den Kreis ist die Verwendung im Prinzip die selbe, mit:
 +
<source lang="pascal">
 +
  C := TCircle.Create;
 +
</source>
 +
wird zunächst ein Kreis erzeugt und mit Position und Padius bekommt er seine Werte zugewiesen.
 +
 +
'''Und hier das Beispielprojekt für die Kollision Kreis <> Polygon:'''
 +
* {{ArchivLink|file=tut_SAT_Kreis_exe|text=Windows-Binary}}
 +
* {{ArchivLink|file=tut_SAT_Kreis_src|text=Delphi-Quelltext}}
 +
 +
=== Beispiel 3 - Trennung von Polygonen ===
 +
 +
In diesem Beispiel wird ein Polygon mittels:
 +
<source lang="pascal">
 +
  B.position := v2f_sub(B.position, MTD);
 +
</source>
 +
verschoben, sodass die beiden Polygone sich nicht schneiden.
 +
Es ließen sich auch beide um die Hälfte des Vektors verschieben, dies hängt von der Anwendung ab.
 +
 +
'''Hier gibt es die Exe und den Code für die Trennung von Polygonen:'''
 +
* {{ArchivLink|file=tut_SAT_Trennung_exe|text=Windows-Binary}}
 +
* {{ArchivLink|file=tut_SAT_Trennung_src|text=Delphi-Quelltext}}
 +
 +
=== Beispiel 4 - Rotation ===
  
Zeichnen kann man das Polygon ganz einfach so:
+
Die Rotation des Polygons erfolgt beim Auslesen der Vertex Koordinaten mittels einer Rotationsmatrix:
<pascal>
+
<source lang="pascal">
procedure TMainForm.DrawPolygon(A: TPolygon);
+
function TPolygon.GetVertex(n: integer): TVector2f;
 
var
 
var
   i, l: integer;
+
   acos, asin: extended;
 
begin
 
begin
   for i := 0 to A.Count - 1 do
+
   sincos(degtorad(fangle),asin,acos);
   begin
+
   result.x := fvertices[n].x * acos + fvertices[n].y * -asin;
    l := i + 1;
+
  result.y := fvertices[n].x * asin + fvertices[n].y * acos;
    if l > (A.Count - 1) then
+
end;  
      l := 0;
+
</source>
    Image1.Canvas.MoveTo(round(A.vertices_abs[l].x), round(A.vertices_abs[l].y));
+
 
    Image1.Canvas.LineTo(round(A.vertices_abs[i].x), round(A.vertices_abs[i].y));
+
'''Hier gibt es den Code für die Behandlung von Rotation:'''
  end;
+
* {{ArchivLink|file=tut_SAT_Rotation_src|text=Delphi-Quelltext}}
end;
 
</pascal>
 
  
'''Und hier das Beispielprojekt:'''
+
== Links ==
  
''Exe:'' http://www.exec-dev.de/SAT_Tutorial/SAT_exe.zip
+
SAT-Tutorial(Eng) [http://www.metanetsoftware.com/technique/tutorialA.html]
  
''Source:'' http://www.exec-dev.de/SAT_Tutorial/SAT_src.zip
+
SAT-Tutorial(Eng / VB) [http://gpwiki.org/index.php/VB:Tutorials:Building_A_Physics_Engine:Basic_Intersection_Detection]
  
== Links ==
+
== Nachwort ==
  
=== Separating Axis Theorem ===
+
Ich hoffe das Tutorial war nicht zu trocken und hat vielleicht auch ein wenig Spaß gemacht und weitergeholfen. Für Fragen, Vorschläge, Ergänzungen, etc. bin ich selbstverständlich offen.
  
''SAT-Tutorial(Eng):''
+
mfg
http://www.harveycartel.org/metanet/tutorials/tutorialA.html
 
  
''SAT-Tutorial(Eng / VB)''
+
[[Benutzer:Seth|Seth]]
http://gpwiki.org/index.php/VB:Tutorials:Building_A_Physics_Engine:Basic_Intersection_Detection
 
  
== Nachwort ==
 
  
Ich hoffe das Tutorial war nicht zu trocken und hat vielleicht auch ein wenig Spass gemacht und weitergeholfen. Für Fragen, Vorschläge, Ergänzungen, etc. bin ich selbstverständlich offen.
+
{{TUTORIAL_NAVIGATION| [[Tutorial Objekt immer um eigene Achse drehen]] | [[Tutorial Kollision1]] }}
  
mfg
+
[[Kategorie:Tutorial|Separating Axis Theorem]]

Aktuelle Version vom 25. September 2013, 15:32 Uhr

Kollisionserkennung

von Polygonen mit dem Separating Axis Theorem

Vorwort

In diesem Tutorial möchte ich eine schnelle Variante zur Kollision zweier konvexer Polygone erläutern. Diese kann nachträglich für konkave Polygone und andere Objekte wie Kreise und abgerundete Objekte verwendet werden. Um den mathematischen Hintergrund zu verstehen, ist es sinnvoll ein wenig Kenntnis in Vektorrechnung zu haben.

Kollision zweier Polygone

Die Theorie

Normale der Seite des Quadrats

Das Separating Axis Theorem (kurz: SAT) besagt, dass zwei Polygone sich nicht schneiden, wenn es möglich ist, eine Gerade zu finden, die zwischen den beiden liegt, bzw. die beiden trennt. Der Begriff "Gerade" ist hier allerdings nicht ganz korrekt. Eine Gerade hat eine räumliche Lage, diese ist für unser Vorhaben jedoch nicht von Belangen, deshalb werde ich im Folgenden das Wort Achse benutzen, daher auch der Name Separating Axis (Trennungsachse). Nun gibt es unendlich viele Achsen die man testen könnte... Glücklicherweise kann man sich hier auf eine überschaubare Zahl beschränken, denn man braucht nur die Anzahl der Seiten beider Polygone. Bei einem Viereck wären das vier, bei einem Dreieck drei, etc. Hat man die Eckpunkte des Polygons als Vektoren (Ortsvektoren) gegeben, kann man durch Subtraktion zweier Ortsvektoren den Vektor bestimmen der zu der Seite gehört, die von den beiden Vektoren aufgespannt wird.

Auf dem Bild rechts ist ein Beispiel zu sehen. Dort ist ein Quadrat, die grünen Striche bezeichnen die Ortsvektoren der Eckpunkte, der rote Strich ist die berechnete Seite. Was wir aber brauchen ist der blaue Strich, das ist die Normale der Seite. Die Normale berechnet sich folgendermaßen:

SAT Normale Formel.jpg

die Koordinaten werden vertauscht und eine von beiden wird negiert, so erhält man einen Vektor der senkrecht zu dem original Vektor ist. Da es zwei Möglichkeiten gibt, spricht man von der linken oder rechten Normale (aus der Sicht des Vektors). Der Vektor muss dann noch normiert werden, sodass er die Länge 1 erhält,. Jetzt müssen beide Polygone auf diesen Vektor projiziert werden, denn dadurch erhalten wir ein eindimensionales Abbild unserer Polygone und können mittels eines einfachen Vergleichs überprüfen, ob sich die beiden eindimensionalen Strecken schneiden. Sollte ein Fall eintreffen bei dem kein Schnitt stattfindet, dann kollidieren die beiden Polygone nicht und die Prozedur kann abgebrochen werden. Dies ist auch der Grund, warum dieses Verfahren recht schnell ist, da im besten Fall schon im ersten Durchlauf abgebrochen werden kann.

Nun zur Projektion:

SAT Kollision.jpgSAT Keine Kollision.jpg

Auf dem linken Bild sieht man, wie beide Polygone auf die Achse projiziert werden, der pinke Bereich zeigt die Schnittmenge an. In diesem Fall ist die Achse die Normale der linken oder rechten Seite des Quadrats. Auf dem Bild rechts ist der Fall dargestellt, dass keine Kollision stattfindet, demzufolge gibt es auch keine Schnittmenge auf der Achse. Somit gibt es eine Gerade, bzw. eine Trennungsachse senkrecht zur unserer Projektionsachse, welche die beiden Polygone separiert.

Für die Projektion eines Vektors auf einen anderen verwenden wir das Skalarprodukt, bei diesem kommt ein Zahlenwert heraus, der die Position des Eckpunktes auf unserer eindimensionalen Achse darstellt. Haben wir sämtliche Punkte projiziert, so müssen wir für die jeweiligen Polygone noch jeweils den kleinsten und größten Wert heraussuchen, damit wir zwei Strecken erhalten. Diese werden dann mit einer einfachen Abfrage auf Schnitt geprüft und das wars.

Zusammenfassung

  • Jedes der beiden Polygone durchgehen und alle nötigen Achsen aus den Normalen der Seitenflächen bestimmen
    • Jeden Eckpunkt jedes Polygons auf diese Achsen projizieren
    • Die kleinsten und größten Werte ermitteln und auf Schnitt prüfen
  • Tritt der Fall auf, dass kein Schnitt statt findet, so kann sofort abgebrochen werden, es findet keine Kollision statt.

Kollision eines Kreises und eines Polygons

Theorie

Das Prinzip für die Kollision zweier Polygone ist denke ich jetzt klar geworden, doch was ist, wenn wir einen Kreis haben, der mit einem Polygon kollidiert? Dieser Fall ist leicht abzuhandeln, ein Kreis hat unendlich viele Normalen, die man testen könnte, uns reichen aber die, die die Vertices des Polygons schneiden würden, sprich: die Achsen, die den Kreismittelpunkt und die Ecken unseres Polygons verbinden würden.

Projektionsachsen eines Kreises

Die blauen Linien auf dem Bild sind wieder einmal die Achsen auf die wir projizieren, diese kommen zu den, die wir aus dem Polygon berechnen hinzu.

Zusammenfassung

  • Wir berechnen also den Vektor vom Kreis-Mittelpunkt zum Vertex, dieser wird normiert.
  • Dann projizieren wir das Polygon wie gehabt
  • Der Kreis wird projiziert, indem der Vektor, auf den wir projizieren, mit dem Radius des Kreises skaliert (also skalar multipliziert) wird. Mit diesem wird dann genauso weiter verfahren. Dies ist dann der Max-Wert für unseren Kreis, der Min-Wert ist einfach der Max-Wert * -1, also -max.

Hierzu ist zu sagen, dass dies noch dahingehend optimieren kann, dass man feststellt, in welcher Voronoi-Region des Polygons sich der Kreis befindet. Wenn man diese Region hat, reicht es diese eine Achse zu prüfen.

Kollision eines Punktes und eines Polygons

Ganz am Rande möchte ich noch erwähnen, dass es ebenso möglich ist, zu prüfen, ob sich ein Punkt in einem Polygon befindet. Hierzu wird einfach der Punkt auf die Achsen projiziert und geprüft ob er größer als das Minimum und kleiner als das Maximum des Polygons auf dieser Achse ist.

Polygone trennen

Damit unsere Kollisionserkennung praxistauglich wird, müssen die Polygone, wenn sie kollidieren auch wieder getrennt werden können. Hierzu benötigen wir einen Vektor, der unsere beiden Polygone wieder auseinander "schiebt". Selbstverständlich könnte man einen beliebigen Vektor nehmen, aber das Ergebnis wäre eher realtitätsfern, deshalb brauchen wir den Vektor, der den kürzesten Weg beschreibt, um die beiden Polygone zu trennen. Dieser Vektor wird auch die Normale der Kollision oder MTD-Vektor genannt (für Minimum Translation Distance). Hier kommt ein weiterer Vorteil des Separating Axis Theorems zum tragen, denn den Vektor den wir suchen, haben wir schon so gut wie berechnet. Wir multiplizieren alle unsere Projektionsachsen mit den Differenzen, die wir bei den eindimensionalen Kollisionen herausbekommen haben, somit erhalten wir Vektoren, die für das Außeinander-Schieben unserer Polygonein in Frage kommen. Nun müssen wir nur noch den kürzesten davon finden, dies ist unser MTD. Allerdings sollte man vor der Verwendung sicherstellen, dass dieser Vektor vom Polygon wegzeigt. Hierzu können wir ebenfalls das Skalarprodukt nutzen.

Rotation

Um Polygone behandeln zu können, die rotieren, sind lediglich einige Änderungen an der Polygonklasse erforderlich. Hierbei gibt es mehrere Optionen, zum einen können wir unsere Vertices in jedem Schritt drehen und speichern, allerdings kann dies auf Dauer zu Ungenauigkeiten führen. Eine zweite Möglichkeit wäre, bei jedem Zugriff auf die Vertices, einen gedrehten Vektor auszugeben. Dies erhöht zwar die benötigte Rechenleistung, ist aber deutlich genauer. Das Seperation Axis Theorem kann dann mit den gedrehten Vertices weiter verfahren.

Das Beispielprojekt

Beispiel 1 - Polygon <> Polygon

Was wäre ein Tutorial doch ohne Beispiel ;) Ich werde hier nur kurz die Verwendung des Codes erläutern und ein kleines Beispielprogramm anhängen. Ein Polygon muss natürlich erst einmal erzeugt werden:

A := TPolygon.Create;

Die einfachste Möglichkeit es zu gestalten funktioniert so:

  with A do
  begin
    position := to_v2f(200, 200);
    AddVertex(to_v2f(50, -50));
    AddVertex(to_v2f(50, 50));
    AddVertex(to_v2f(-50, 50));
    AddVertex(to_v2f(-50, -50));
  end;

Dies liefert ein Quadrat mit den Maßen 100*100 an der Position (200|200). Die Koordinaten der Vertices werden absolut zur Position und entgegen des Uhrzeigersinns angegeben.

Und hier das Beispielprojekt:

Beispiel 2 - Kreis <> Polygon

Für den Kreis ist die Verwendung im Prinzip die selbe, mit:

  C := TCircle.Create;

wird zunächst ein Kreis erzeugt und mit Position und Padius bekommt er seine Werte zugewiesen.

Und hier das Beispielprojekt für die Kollision Kreis <> Polygon:

Beispiel 3 - Trennung von Polygonen

In diesem Beispiel wird ein Polygon mittels:

  B.position := v2f_sub(B.position, MTD);

verschoben, sodass die beiden Polygone sich nicht schneiden. Es ließen sich auch beide um die Hälfte des Vektors verschieben, dies hängt von der Anwendung ab.

Hier gibt es die Exe und den Code für die Trennung von Polygonen:

Beispiel 4 - Rotation

Die Rotation des Polygons erfolgt beim Auslesen der Vertex Koordinaten mittels einer Rotationsmatrix:

function TPolygon.GetVertex(n: integer): TVector2f;
var
  acos, asin: extended;
begin
  sincos(degtorad(fangle),asin,acos);
  result.x := fvertices[n].x * acos + fvertices[n].y * -asin;
  result.y := fvertices[n].x * asin + fvertices[n].y * acos;
end;

Hier gibt es den Code für die Behandlung von Rotation:

Links

SAT-Tutorial(Eng) [1]

SAT-Tutorial(Eng / VB) [2]

Nachwort

Ich hoffe das Tutorial war nicht zu trocken und hat vielleicht auch ein wenig Spaß gemacht und weitergeholfen. Für Fragen, Vorschläge, Ergänzungen, etc. bin ich selbstverständlich offen.

mfg

Seth



Nächstes Tutorial:
Tutorial Kollision1

Schreibt was ihr zu diesem Tutorial denkt ins Feedbackforum von DelphiGL.com.
Lob, Verbesserungsvorschläge, Hinweise und Tutorialwünsche sind stets willkommen.