removed warnings about unused return values/fields
git-svn-id: https://svn.apache.org/repos/asf/commons/proper/math/trunk@567422 13f79535-47bb-0310-9956-ffa450edef68
This commit is contained in:
parent
d784ea2eb6
commit
1402a92679
|
@ -557,24 +557,27 @@ public class Rotation implements Serializable {
|
||||||
* a<sub>1</sub>, a<sub>2</sub> and a<sub>3</sub> is the same as
|
* a<sub>1</sub>, a<sub>2</sub> and a<sub>3</sub> is the same as
|
||||||
* the rotation defined by the angles π + a<sub>1</sub>, π
|
* the rotation defined by the angles π + a<sub>1</sub>, π
|
||||||
* - a<sub>2</sub> and π + a<sub>3</sub>. This method implements
|
* - a<sub>2</sub> and π + a<sub>3</sub>. This method implements
|
||||||
* the following arbitrary choices. For Cardan angles, the chosen
|
* the following arbitrary choices:</p>
|
||||||
* set is the one for which the second angle is between -π/2 and
|
* <ul>
|
||||||
* π/2 (i.e its cosine is positive). For Euler angles, the chosen
|
* <li>for Cardan angles, the chosen set is the one for which the
|
||||||
* set is the one for which the second angle is between 0 and π
|
* second angle is between -π/2 and π/2 (i.e its cosine is
|
||||||
* (i.e its sine is positive).</p>
|
* positive),</li>
|
||||||
|
* <li>for Euler angles, the chosen set is the one for which the
|
||||||
|
* second angle is between 0 and π (i.e its sine is positive).</li>
|
||||||
|
* </ul>
|
||||||
|
|
||||||
* <p>Cardan and Euler angle have a very disappointing drawback: all
|
* <p>Cardan and Euler angle have a very disappointing drawback: all
|
||||||
* of them have singularities. This means that if the instance is
|
* of them have singularities. This means that if the instance is
|
||||||
* too close to the singularities corresponding to the given
|
* too close to the singularities corresponding to the given
|
||||||
* rotation order, it will be impossible to retrieve the angles. For
|
* rotation order, it will be impossible to retrieve the angles. For
|
||||||
* Cardan angles, this is often called gimbal lock. There is
|
* Cardan angles, this is often called gimbal lock. There is
|
||||||
* <em>nothing</em> to do to prevent this, it is an intrisic problem
|
* <em>nothing</em> to do to prevent this, it is an intrinsic problem
|
||||||
* with Cardan and Euler representation (but not a problem with the
|
* with Cardan and Euler representation (but not a problem with the
|
||||||
* rotation itself, which is perfectly well defined). For Cardan
|
* rotation itself, which is perfectly well defined). For Cardan
|
||||||
* angles, singularities occur when the second angle is close to
|
* angles, singularities occur when the second angle is close to
|
||||||
* -π/2 or +π/2, for Euler angle singularities occur when the
|
* -π/2 or +π/2, for Euler angle singularities occur when the
|
||||||
* second angle is close to 0 or π, this implies that the identity
|
* second angle is close to 0 or π, this implies that the identity
|
||||||
* rotation is always singular for Euler angles!
|
* rotation is always singular for Euler angles!</p>
|
||||||
|
|
||||||
* @param order rotation order to use
|
* @param order rotation order to use
|
||||||
* @return an array of three angles, in the order specified by the set
|
* @return an array of three angles, in the order specified by the set
|
||||||
|
@ -584,14 +587,6 @@ public class Rotation implements Serializable {
|
||||||
public double[] getAngles(RotationOrder order)
|
public double[] getAngles(RotationOrder order)
|
||||||
throws CardanEulerSingularityException {
|
throws CardanEulerSingularityException {
|
||||||
|
|
||||||
final double small = 1.0e-10;
|
|
||||||
final double maxThreshold = 1.0 - small;
|
|
||||||
final double minThreshold = -maxThreshold;
|
|
||||||
|
|
||||||
double[] angles = new double[3];
|
|
||||||
Vector3D v1 = null;
|
|
||||||
Vector3D v2 = null;
|
|
||||||
|
|
||||||
if (order == RotationOrder.XYZ) {
|
if (order == RotationOrder.XYZ) {
|
||||||
|
|
||||||
// r (Vector3D.plusK) coordinates are :
|
// r (Vector3D.plusK) coordinates are :
|
||||||
|
@ -599,14 +594,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusI) coordinates are :
|
// (-r) (Vector3D.plusI) coordinates are :
|
||||||
// cos (psi) cos (theta), -sin (psi) cos (theta), sin (theta)
|
// cos (psi) cos (theta), -sin (psi) cos (theta), sin (theta)
|
||||||
// and we can choose to have theta in the interval [-PI/2 ; +PI/2]
|
// and we can choose to have theta in the interval [-PI/2 ; +PI/2]
|
||||||
v1 = applyTo(Vector3D.plusK);
|
Vector3D v1 = applyTo(Vector3D.plusK);
|
||||||
v2 = applyInverseTo(Vector3D.plusI);
|
Vector3D v2 = applyInverseTo(Vector3D.plusI);
|
||||||
if ((v2.getZ() < minThreshold) || (v2.getZ() > maxThreshold)) {
|
if ((v2.getZ() < -0.9999999999) || (v2.getZ() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(true);
|
throw new CardanEulerSingularityException(true);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(-(v1.getY()), v1.getZ());
|
return new double[] {
|
||||||
angles[1] = Math.asin(v2.getZ());
|
Math.atan2(-(v1.getY()), v1.getZ()),
|
||||||
angles[2] = Math.atan2(-(v2.getY()), v2.getX());
|
Math.asin(v2.getZ()),
|
||||||
|
Math.atan2(-(v2.getY()), v2.getX())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.XZY) {
|
} else if (order == RotationOrder.XZY) {
|
||||||
|
|
||||||
|
@ -615,14 +612,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusI) coordinates are :
|
// (-r) (Vector3D.plusI) coordinates are :
|
||||||
// cos (theta) cos (psi), -sin (psi), sin (theta) cos (psi)
|
// cos (theta) cos (psi), -sin (psi), sin (theta) cos (psi)
|
||||||
// and we can choose to have psi in the interval [-PI/2 ; +PI/2]
|
// and we can choose to have psi in the interval [-PI/2 ; +PI/2]
|
||||||
v1 = applyTo(Vector3D.plusJ);
|
Vector3D v1 = applyTo(Vector3D.plusJ);
|
||||||
v2 = applyInverseTo(Vector3D.plusI);
|
Vector3D v2 = applyInverseTo(Vector3D.plusI);
|
||||||
if ((v2.getY() < minThreshold) || (v2.getY() > maxThreshold)) {
|
if ((v2.getY() < -0.9999999999) || (v2.getY() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(true);
|
throw new CardanEulerSingularityException(true);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(v1.getZ(), v1.getY());
|
return new double[] {
|
||||||
angles[1] = -Math.asin(v2.getY());
|
Math.atan2(v1.getZ(), v1.getY()),
|
||||||
angles[2] = Math.atan2(v2.getZ(), v2.getX());
|
-Math.asin(v2.getY()),
|
||||||
|
Math.atan2(v2.getZ(), v2.getX())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.YXZ) {
|
} else if (order == RotationOrder.YXZ) {
|
||||||
|
|
||||||
|
@ -631,14 +630,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusJ) coordinates are :
|
// (-r) (Vector3D.plusJ) coordinates are :
|
||||||
// sin (psi) cos (phi), cos (psi) cos (phi), -sin (phi)
|
// sin (psi) cos (phi), cos (psi) cos (phi), -sin (phi)
|
||||||
// and we can choose to have phi in the interval [-PI/2 ; +PI/2]
|
// and we can choose to have phi in the interval [-PI/2 ; +PI/2]
|
||||||
v1 = applyTo(Vector3D.plusK);
|
Vector3D v1 = applyTo(Vector3D.plusK);
|
||||||
v2 = applyInverseTo(Vector3D.plusJ);
|
Vector3D v2 = applyInverseTo(Vector3D.plusJ);
|
||||||
if ((v2.getZ() < minThreshold) || (v2.getZ() > maxThreshold)) {
|
if ((v2.getZ() < -0.9999999999) || (v2.getZ() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(true);
|
throw new CardanEulerSingularityException(true);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(v1.getX(), v1.getZ());
|
return new double[] {
|
||||||
angles[1] = -Math.asin(v2.getZ());
|
Math.atan2(v1.getX(), v1.getZ()),
|
||||||
angles[2] = Math.atan2(v2.getX(), v2.getY());
|
-Math.asin(v2.getZ()),
|
||||||
|
Math.atan2(v2.getX(), v2.getY())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.YZX) {
|
} else if (order == RotationOrder.YZX) {
|
||||||
|
|
||||||
|
@ -647,14 +648,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusJ) coordinates are :
|
// (-r) (Vector3D.plusJ) coordinates are :
|
||||||
// sin (psi), cos (phi) cos (psi), -sin (phi) cos (psi)
|
// sin (psi), cos (phi) cos (psi), -sin (phi) cos (psi)
|
||||||
// and we can choose to have psi in the interval [-PI/2 ; +PI/2]
|
// and we can choose to have psi in the interval [-PI/2 ; +PI/2]
|
||||||
v1 = applyTo(Vector3D.plusI);
|
Vector3D v1 = applyTo(Vector3D.plusI);
|
||||||
v2 = applyInverseTo(Vector3D.plusJ);
|
Vector3D v2 = applyInverseTo(Vector3D.plusJ);
|
||||||
if ((v2.getX() < minThreshold) || (v2.getX() > maxThreshold)) {
|
if ((v2.getX() < -0.9999999999) || (v2.getX() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(true);
|
throw new CardanEulerSingularityException(true);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(-(v1.getZ()), v1.getX());
|
return new double[] {
|
||||||
angles[1] = Math.asin(v2.getX());
|
Math.atan2(-(v1.getZ()), v1.getX()),
|
||||||
angles[2] = Math.atan2(-(v2.getZ()), v2.getY());
|
Math.asin(v2.getX()),
|
||||||
|
Math.atan2(-(v2.getZ()), v2.getY())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.ZXY) {
|
} else if (order == RotationOrder.ZXY) {
|
||||||
|
|
||||||
|
@ -663,14 +666,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusK) coordinates are :
|
// (-r) (Vector3D.plusK) coordinates are :
|
||||||
// -sin (theta) cos (phi), sin (phi), cos (theta) cos (phi)
|
// -sin (theta) cos (phi), sin (phi), cos (theta) cos (phi)
|
||||||
// and we can choose to have phi in the interval [-PI/2 ; +PI/2]
|
// and we can choose to have phi in the interval [-PI/2 ; +PI/2]
|
||||||
v1 = applyTo(Vector3D.plusJ);
|
Vector3D v1 = applyTo(Vector3D.plusJ);
|
||||||
v2 = applyInverseTo(Vector3D.plusK);
|
Vector3D v2 = applyInverseTo(Vector3D.plusK);
|
||||||
if ((v2.getY() < minThreshold) || (v2.getY() > maxThreshold)) {
|
if ((v2.getY() < -0.9999999999) || (v2.getY() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(true);
|
throw new CardanEulerSingularityException(true);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(-(v1.getX()), v1.getY());
|
return new double[] {
|
||||||
angles[1] = Math.asin(v2.getY());
|
Math.atan2(-(v1.getX()), v1.getY()),
|
||||||
angles[2] = Math.atan2(-(v2.getX()), v2.getZ());
|
Math.asin(v2.getY()),
|
||||||
|
Math.atan2(-(v2.getX()), v2.getZ())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.ZYX) {
|
} else if (order == RotationOrder.ZYX) {
|
||||||
|
|
||||||
|
@ -679,14 +684,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusK) coordinates are :
|
// (-r) (Vector3D.plusK) coordinates are :
|
||||||
// -sin (theta), sin (phi) cos (theta), cos (phi) cos (theta)
|
// -sin (theta), sin (phi) cos (theta), cos (phi) cos (theta)
|
||||||
// and we can choose to have theta in the interval [-PI/2 ; +PI/2]
|
// and we can choose to have theta in the interval [-PI/2 ; +PI/2]
|
||||||
v1 = applyTo(Vector3D.plusI);
|
Vector3D v1 = applyTo(Vector3D.plusI);
|
||||||
v2 = applyInverseTo(Vector3D.plusK);
|
Vector3D v2 = applyInverseTo(Vector3D.plusK);
|
||||||
if ((v2.getX() < minThreshold) || (v2.getX() > maxThreshold)) {
|
if ((v2.getX() < -0.9999999999) || (v2.getX() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(true);
|
throw new CardanEulerSingularityException(true);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(v1.getY(), v1.getX());
|
return new double[] {
|
||||||
angles[1] = -Math.asin(v2.getX());
|
Math.atan2(v1.getY(), v1.getX()),
|
||||||
angles[2] = Math.atan2(v2.getY(), v2.getZ());
|
-Math.asin(v2.getX()),
|
||||||
|
Math.atan2(v2.getY(), v2.getZ())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.XYX) {
|
} else if (order == RotationOrder.XYX) {
|
||||||
|
|
||||||
|
@ -695,14 +702,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusI) coordinates are :
|
// (-r) (Vector3D.plusI) coordinates are :
|
||||||
// cos (theta), sin (theta) sin (phi2), sin (theta) cos (phi2)
|
// cos (theta), sin (theta) sin (phi2), sin (theta) cos (phi2)
|
||||||
// and we can choose to have theta in the interval [0 ; PI]
|
// and we can choose to have theta in the interval [0 ; PI]
|
||||||
v1 = applyTo(Vector3D.plusI);
|
Vector3D v1 = applyTo(Vector3D.plusI);
|
||||||
v2 = applyInverseTo(Vector3D.plusI);
|
Vector3D v2 = applyInverseTo(Vector3D.plusI);
|
||||||
if ((v2.getX() < minThreshold) || (v2.getX() > maxThreshold)) {
|
if ((v2.getX() < -0.9999999999) || (v2.getX() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(false);
|
throw new CardanEulerSingularityException(false);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(v1.getY(), -v1.getZ());
|
return new double[] {
|
||||||
angles[1] = Math.acos(v2.getX());
|
Math.atan2(v1.getY(), -v1.getZ()),
|
||||||
angles[2] = Math.atan2(v2.getY(), v2.getZ());
|
Math.acos(v2.getX()),
|
||||||
|
Math.atan2(v2.getY(), v2.getZ())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.XZX) {
|
} else if (order == RotationOrder.XZX) {
|
||||||
|
|
||||||
|
@ -711,14 +720,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusI) coordinates are :
|
// (-r) (Vector3D.plusI) coordinates are :
|
||||||
// cos (psi), -sin (psi) cos (phi2), sin (psi) sin (phi2)
|
// cos (psi), -sin (psi) cos (phi2), sin (psi) sin (phi2)
|
||||||
// and we can choose to have psi in the interval [0 ; PI]
|
// and we can choose to have psi in the interval [0 ; PI]
|
||||||
v1 = applyTo(Vector3D.plusI);
|
Vector3D v1 = applyTo(Vector3D.plusI);
|
||||||
v2 = applyInverseTo(Vector3D.plusI);
|
Vector3D v2 = applyInverseTo(Vector3D.plusI);
|
||||||
if ((v2.getX() < minThreshold) || (v2.getX() > maxThreshold)) {
|
if ((v2.getX() < -0.9999999999) || (v2.getX() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(false);
|
throw new CardanEulerSingularityException(false);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(v1.getZ(), v1.getY());
|
return new double[] {
|
||||||
angles[1] = Math.acos(v2.getX());
|
Math.atan2(v1.getZ(), v1.getY()),
|
||||||
angles[2] = Math.atan2(v2.getZ(), -v2.getY());
|
Math.acos(v2.getX()),
|
||||||
|
Math.atan2(v2.getZ(), -v2.getY())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.YXY) {
|
} else if (order == RotationOrder.YXY) {
|
||||||
|
|
||||||
|
@ -727,14 +738,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusJ) coordinates are :
|
// (-r) (Vector3D.plusJ) coordinates are :
|
||||||
// sin (phi) sin (theta2), cos (phi), -sin (phi) cos (theta2)
|
// sin (phi) sin (theta2), cos (phi), -sin (phi) cos (theta2)
|
||||||
// and we can choose to have phi in the interval [0 ; PI]
|
// and we can choose to have phi in the interval [0 ; PI]
|
||||||
v1 = applyTo(Vector3D.plusJ);
|
Vector3D v1 = applyTo(Vector3D.plusJ);
|
||||||
v2 = applyInverseTo(Vector3D.plusJ);
|
Vector3D v2 = applyInverseTo(Vector3D.plusJ);
|
||||||
if ((v2.getY() < minThreshold) || (v2.getY() > maxThreshold)) {
|
if ((v2.getY() < -0.9999999999) || (v2.getY() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(false);
|
throw new CardanEulerSingularityException(false);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(v1.getX(), v1.getZ());
|
return new double[] {
|
||||||
angles[1] = Math.acos(v2.getY());
|
Math.atan2(v1.getX(), v1.getZ()),
|
||||||
angles[2] = Math.atan2(v2.getX(), -v2.getZ());
|
Math.acos(v2.getY()),
|
||||||
|
Math.atan2(v2.getX(), -v2.getZ())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.YZY) {
|
} else if (order == RotationOrder.YZY) {
|
||||||
|
|
||||||
|
@ -743,14 +756,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusJ) coordinates are :
|
// (-r) (Vector3D.plusJ) coordinates are :
|
||||||
// sin (psi) cos (theta2), cos (psi), sin (psi) sin (theta2)
|
// sin (psi) cos (theta2), cos (psi), sin (psi) sin (theta2)
|
||||||
// and we can choose to have psi in the interval [0 ; PI]
|
// and we can choose to have psi in the interval [0 ; PI]
|
||||||
v1 = applyTo(Vector3D.plusJ);
|
Vector3D v1 = applyTo(Vector3D.plusJ);
|
||||||
v2 = applyInverseTo(Vector3D.plusJ);
|
Vector3D v2 = applyInverseTo(Vector3D.plusJ);
|
||||||
if ((v2.getY() < minThreshold) || (v2.getY() > maxThreshold)) {
|
if ((v2.getY() < -0.9999999999) || (v2.getY() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(false);
|
throw new CardanEulerSingularityException(false);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(v1.getZ(), -v1.getX());
|
return new double[] {
|
||||||
angles[1] = Math.acos(v2.getY());
|
Math.atan2(v1.getZ(), -v1.getX()),
|
||||||
angles[2] = Math.atan2(v2.getZ(), v2.getX());
|
Math.acos(v2.getY()),
|
||||||
|
Math.atan2(v2.getZ(), v2.getX())
|
||||||
|
};
|
||||||
|
|
||||||
} else if (order == RotationOrder.ZXZ) {
|
} else if (order == RotationOrder.ZXZ) {
|
||||||
|
|
||||||
|
@ -759,14 +774,16 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusK) coordinates are :
|
// (-r) (Vector3D.plusK) coordinates are :
|
||||||
// sin (phi) sin (psi2), sin (phi) cos (psi2), cos (phi)
|
// sin (phi) sin (psi2), sin (phi) cos (psi2), cos (phi)
|
||||||
// and we can choose to have phi in the interval [0 ; PI]
|
// and we can choose to have phi in the interval [0 ; PI]
|
||||||
v1 = applyTo(Vector3D.plusK);
|
Vector3D v1 = applyTo(Vector3D.plusK);
|
||||||
v2 = applyInverseTo(Vector3D.plusK);
|
Vector3D v2 = applyInverseTo(Vector3D.plusK);
|
||||||
if ((v2.getZ() < minThreshold) || (v2.getZ() > maxThreshold)) {
|
if ((v2.getZ() < -0.9999999999) || (v2.getZ() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(false);
|
throw new CardanEulerSingularityException(false);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(v1.getX(), -v1.getY());
|
return new double[] {
|
||||||
angles[1] = Math.acos(v2.getZ());
|
Math.atan2(v1.getX(), -v1.getY()),
|
||||||
angles[2] = Math.atan2(v2.getX(), v2.getY());
|
Math.acos(v2.getZ()),
|
||||||
|
Math.atan2(v2.getX(), v2.getY())
|
||||||
|
};
|
||||||
|
|
||||||
} else { // last possibility is ZYZ
|
} else { // last possibility is ZYZ
|
||||||
|
|
||||||
|
@ -775,19 +792,19 @@ public class Rotation implements Serializable {
|
||||||
// (-r) (Vector3D.plusK) coordinates are :
|
// (-r) (Vector3D.plusK) coordinates are :
|
||||||
// -sin (theta) cos (psi2), sin (theta) sin (psi2), cos (theta)
|
// -sin (theta) cos (psi2), sin (theta) sin (psi2), cos (theta)
|
||||||
// and we can choose to have theta in the interval [0 ; PI]
|
// and we can choose to have theta in the interval [0 ; PI]
|
||||||
v1 = applyTo(Vector3D.plusK);
|
Vector3D v1 = applyTo(Vector3D.plusK);
|
||||||
v2 = applyInverseTo(Vector3D.plusK);
|
Vector3D v2 = applyInverseTo(Vector3D.plusK);
|
||||||
if ((v2.getZ() < minThreshold) || (v2.getZ() > maxThreshold)) {
|
if ((v2.getZ() < -0.9999999999) || (v2.getZ() > 0.9999999999)) {
|
||||||
throw new CardanEulerSingularityException(false);
|
throw new CardanEulerSingularityException(false);
|
||||||
}
|
}
|
||||||
angles[0] = Math.atan2(v1.getY(), v1.getX());
|
return new double[] {
|
||||||
angles[1] = Math.acos(v2.getZ());
|
Math.atan2(v1.getY(), v1.getX()),
|
||||||
angles[2] = Math.atan2(v2.getY(), -v2.getX());
|
Math.acos(v2.getZ()),
|
||||||
|
Math.atan2(v2.getY(), -v2.getX())
|
||||||
|
};
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return angles;
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/** Get the 3X3 matrix corresponding to the instance
|
/** Get the 3X3 matrix corresponding to the instance
|
||||||
|
|
|
@ -43,9 +43,9 @@ public class QRDecompositionImplTest extends TestCase {
|
||||||
{ -4, 24, -41, },
|
{ -4, 24, -41, },
|
||||||
{ -5, 34, 7, }, };
|
{ -5, 34, 7, }, };
|
||||||
|
|
||||||
final double entryTolerance = 10e-16;
|
private static final double entryTolerance = 10e-16;
|
||||||
|
|
||||||
final double normTolerance = 10e-14;
|
private static final double normTolerance = 10e-14;
|
||||||
|
|
||||||
public QRDecompositionImplTest(String name) {
|
public QRDecompositionImplTest(String name) {
|
||||||
super(name);
|
super(name);
|
||||||
|
|
|
@ -156,7 +156,7 @@ public class PercentileTest extends UnivariateStatisticAbstractTest{
|
||||||
// expected
|
// expected
|
||||||
}
|
}
|
||||||
try {
|
try {
|
||||||
percentile = new Percentile(0);
|
new Percentile(0);
|
||||||
fail("Expecting IllegalArgumentException");
|
fail("Expecting IllegalArgumentException");
|
||||||
} catch (IllegalArgumentException ex) {
|
} catch (IllegalArgumentException ex) {
|
||||||
// expected
|
// expected
|
||||||
|
|
Loading…
Reference in New Issue