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
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
|
package robotrace;
/**
* Represents a 3D vector (immutable).
*/
public class Vector {
// Origin and axis vectors.
public final static Vector O = new Vector(0, 0, 0);
public final static Vector X = new Vector(1, 0, 0);
public final static Vector Y = new Vector(0, 1, 0);
public final static Vector Z = new Vector(0, 0, 1);
// Components.
protected double x, y, z;
/**
* Construct from components.
*/
public Vector(double x, double y, double z) {
this.x = x;
this.y = y;
this.z = z;
}
/**
* Get X component.
*/
public double x() {
return x;
}
/**
* Get Y component.
*/
public double y() {
return y;
}
/**
* Get Z component.
*/
public double z() {
return z;
}
/**
* Euclidian length squared.
*/
public double lengthSqr() {
return x * x + y * y + z * z;
}
/**
* Euclidian length.
*/
public double length() {
return Math.sqrt(x * x + y * y + z * z);
}
/**
* Normalized vector, which is not defined for
* a vector of zero length.
*/
public Vector normalized() {
double length = length();
return new Vector(x / length, y / length, z / length);
}
/**
* Dot product with the given vector.
*/
public double dot(Vector that) {
return this.x * that.x +
this.y * that.y +
this.z * that.z;
}
/**
* Cross product with the given vector.
*/
public Vector cross(Vector that) {
return new Vector(this.y * that.z - this.z * that.y,
this.z * that.x - this.x * that.z,
this.x * that.y - this.y * that.x);
}
/**
* Add with the given vector.
*/
public Vector add(Vector that) {
return new Vector(this.x + that.x,
this.y + that.y,
this.z + that.z);
}
/**
* Subtract by the given vector.
*/
public Vector subtract(Vector that) {
return new Vector(this.x - that.x,
this.y - that.y,
this.z - that.z);
}
/**
* Multiply with the given scalar.
*/
public Vector scale(double scalar) {
return new Vector(scalar * this.x,
scalar * this.y,
scalar * this.z);
}
/**
* String representation.
*/
@Override
public String toString() {
return "(" + x + "," + y + "," + z + ")";
}
}
|