1 package org.opentrafficsim.core.math;
2
3 import java.io.Serializable;
4 import java.util.Locale;
5
6 import org.djunits.unit.AccelerationUnit;
7 import org.djunits.unit.DirectionUnit;
8 import org.djunits.value.ValueRuntimeException;
9 import org.djunits.value.storage.StorageType;
10 import org.djunits.value.vdouble.scalar.Acceleration;
11 import org.djunits.value.vdouble.scalar.Direction;
12 import org.djunits.value.vdouble.vector.AccelerationVector;
13 import org.djunits.value.vdouble.vector.base.DoubleVector;
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34 public class Acceleration3D implements Serializable
35 {
36
37 private static final long serialVersionUID = 20150000L;
38
39
40 private final AccelerationVector acceleration;
41
42
43
44
45
46
47 public Acceleration3D(final AccelerationVector acceleration) throws ValueRuntimeException
48 {
49 if (acceleration.size() != 3)
50 {
51 throw new ValueRuntimeException("Size of an RPY-acceleration vector should be exactly 3. Got: " + acceleration);
52 }
53 this.acceleration = acceleration;
54 }
55
56
57
58
59
60
61
62
63 public Acceleration3D(final Acceleration x, final Acceleration y, final Acceleration z) throws ValueRuntimeException
64 {
65 this.acceleration = DoubleVector.instantiate(new Acceleration[] {x, y, z}, AccelerationUnit.SI, StorageType.DENSE);
66 }
67
68
69
70
71
72
73
74
75
76 public Acceleration3D(final double x, final double y, final double z, final AccelerationUnit unit)
77 throws ValueRuntimeException
78 {
79 this.acceleration = DoubleVector.instantiate(new double[] {x, y, z}, unit, StorageType.DENSE);
80 }
81
82
83
84
85
86
87
88
89 public Acceleration3D(final Acceleration acceleration, final Direction theta, final Direction phi)
90 throws ValueRuntimeException
91 {
92 double[] xyz = Scalar3D.polarToCartesian(acceleration.getInUnit(), theta.si, phi.si);
93 this.acceleration = DoubleVector.instantiate(xyz, acceleration.getDisplayUnit(), StorageType.DENSE);
94 }
95
96
97
98
99
100 public final Acceleration getX()
101 {
102 try
103 {
104 return this.acceleration.get(0);
105 }
106 catch (ValueRuntimeException exception)
107 {
108
109 throw new RuntimeException(
110 "getX() gave an exception; apparently vector " + this.acceleration + " was not constructed right",
111 exception);
112 }
113 }
114
115
116
117
118
119 public final Acceleration getY()
120 {
121 try
122 {
123 return this.acceleration.get(1);
124 }
125 catch (ValueRuntimeException exception)
126 {
127
128 throw new RuntimeException(
129 "getY() gave an exception; apparently vector " + this.acceleration + " was not constructed right",
130 exception);
131 }
132 }
133
134
135
136
137
138 public final Acceleration getZ()
139 {
140 try
141 {
142 return this.acceleration.get(2);
143 }
144 catch (ValueRuntimeException exception)
145 {
146
147 throw new RuntimeException(
148 "getZ() gave an exception; apparently vector " + this.acceleration + " was not constructed right",
149 exception);
150 }
151 }
152
153
154
155
156
157 public final Direction getTheta()
158 {
159 return Scalar3D.cartesianToTheta(getX().si, getY().si, getZ().si);
160 }
161
162
163
164
165
166 public final Direction getPhi()
167 {
168 return Scalar3D.cartesianToPhi(getX().si, getY().si);
169 }
170
171
172
173
174
175 public final Acceleration getAcceleration()
176 {
177 return new Acceleration(Scalar3D.cartesianToRadius(getX().si, getY().si, getZ().si), AccelerationUnit.SI);
178 }
179
180
181 @Override
182 public final String toString()
183 {
184 return String.format(Locale.US, "Acceleration3D %s (%s, theta %s, phi %s)", this.acceleration, getAcceleration(),
185 new Direction(getTheta().getInUnit(DirectionUnit.EAST_DEGREE), DirectionUnit.EAST_DEGREE),
186 new Direction(getPhi().getInUnit(DirectionUnit.EAST_DEGREE), DirectionUnit.EAST_DEGREE));
187 }
188
189 }