blob: c898e03b5fc11544c6833d4cdfca23ec9d659a6f (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
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)
}
}
|
