summaryrefslogtreecommitdiffstats
path: root/src/math/line.ts
blob: 98e126bff7039f5f62e2135e3b258c1edf619a0e (plain)
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
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
import { mat2, vec2 } from 'gl-matrix';

const rot90 = mat2.fromRotation(mat2.create(), Math.PI / 2);

export function normal(out: vec2, a: vec2): vec2 {
	return vec2.transformMat2(out, a, rot90);
}

export function crossz(a: vec2, b: vec2): number {
	return a[0] * b[1] - a[1] * b[0];
}

export class Line {
	constructor(
		public readonly p: vec2,
		public readonly v: vec2,
	) {}

	public projectPointDistance(p2: vec2): number {
		const v2 = vec2.sub(vec2.create(), p2, this.p);
		return vec2.dot(this.v, v2);
	}

	public projectPoint(out: vec2, p2: vec2): vec2 {
		const d = this.projectPointDistance(p2);
		return vec2.scaleAndAdd(out, this.p, this.v, d);
	}

	public distancePoint(p2: vec2): number {
		const v2 = vec2.sub(vec2.create(), p2, this.p);
		return crossz(this.v, v2);
	}

	public intersectLine(out: vec2, l2: Line): vec2 {
		const vp = vec2.sub(vec2.create(), l2.p, this.p);
		const d = crossz(vp, this.v);
		const d2 = d / crossz(this.v, l2.v);
		return vec2.scaleAndAdd(out, l2.p, l2.v, d2);
	}

	public equals(l2: Line): boolean {
		return vec2.equals(this.p, l2.p) && vec2.equals(this.v, l2.v);
	}
}

export class LineSegment extends Line {
	public static fromPoints(p1: vec2, p2: vec2): LineSegment {
		const d = vec2.dist(p1, p2);
		const v = vec2.sub(vec2.create(), p2, p1);
		vec2.scale(v, v, 1 / d);

		return new LineSegment(p1, v, d);
	}

	constructor(
		p: vec2,
		v: vec2,
		public readonly l: number,
	) {
		super(p, v);
	}

	public getP2(out: vec2): vec2 {
		return vec2.scaleAndAdd(out, this.p, this.v, this.l);
	}

	public collidesPoint(p2: vec2): boolean {
		const d = this.projectPointDistance(p2);
		return (d >= 0 && d <= this.l);
	}

	public collidesLine(l2: Line): boolean {
		const x = this.intersectLine(vec2.create(), l2);
		return this.collidesPoint(x);
	}

	public collidesLineSegment(l2: LineSegment): boolean {
		const x = this.intersectLine(vec2.create(), l2);
		if (!this.collidesPoint(x))
			return false;
		if (!l2.collidesPoint(x))
			return false;

		return true;
	}

	public collidesMove(move: LineSegment): boolean {
		if (!this.collidesLineSegment(move))
			return false;

		const p2 = move.getP2(vec2.create());
		return this.distancePoint(p2) < 0;
	}

	public equals(l2: LineSegment): boolean {
		return super.equals(l2) && this.l === l2.l;
	}
}