Initial import.

1 files changed, 53 insertions, 0 deletions

diff --git a/src/sims/geometry/Ray.scala b/src/sims/geometry/Ray.scala
new file mode 100644
index 0000000..c898e03
--- /dev/null
+++ b/src/sims/geometry/Ray.scala
@@ -0,0 +1,53 @@
+/*
+ * Simple Mechanics Simulator (SiMS)
+ * copyright (c) 2009 Jakob Odersky
+ * made available under the MIT License
+*/
+
+package sims.geometry
+
+import sims.math._
+import Math._
+
+/**Eine Halbgerade wird definiert durch:
+ * @param point ein Aufpunkt
+ * @param direction ein Richtungsvektor*/
+case class Ray(point: Vector2D, direction: Vector2D) {
+  
+  //Ein Nullvektor hat keine Richtung
+  require(direction != Vector2D.Null)
+  
+  /**Ueberprueft ob diese Halbgerade das gegebene Segment ueberschneidet.
+   * @param das auf Ueberschneidung zu uerberpruefende Segment*/
+  def intersects(s: Segment) = {
+    val p1 = point
+    val p2 = point + direction
+    val p3 = s.vertex1
+    val p4 = s.vertex2
+    val d = (p4.y - p3.y) * (p2.x - p1.x) - (p4.x - p3.x) * (p2.y - p1.y)
+    val na = (p4.x - p3.x) * (p1.y - p3.y) - (p4.y - p3.y) * (p1.x - p3.x)
+    val nb = (p2.x - p1.x) * (p1.y - p3.y) - (p2.y - p1.y) * (p1.x - p3.x)
+    if (d == 0 && na == 0 && nb == 0)
+      true //lines are coincident
+    else if (d == 0)
+      false //parallel
+    else {
+      val ua = na / d
+      val ub = nb / d
+      (ub >= 0) && (ub <= 1) && (ua >= 0)
+    }
+  }
+  
+  /**Ueberprueft ob diese Halbgerade den gegebenen Punkt enthaelt.
+   * <br>
+   * Hierzu wird der Vektor von dem Ursprungspunkt zu dem zu ueberpruefenden Punkt gebildet. Dieser wird dann mit dem Richtungsvektor
+   * auf Kolinearitaet geprueft.
+   * @param p Ortsvektor des oben genannten Punkt*/
+  def contains(p: Vector2D) = {
+    val v = p - point
+    p == point ||
+    Matrix22(direction, v).det == 0 &&
+    signum(direction.x) == signum(v.x) &&
+    signum(direction.y) == signum(v.y)
+  }
+}