Home
last modified time | relevance | path

Searched refs:Quaternion (Results 1 – 16 of 16) sorted by relevance

/packages/modules/Uwb/service/java/com/android/server/uwb/correction/math/
DQuaternion.java56 public final class Quaternion { class
57 public static final Quaternion IDENTITY = new Quaternion(0, 0, 0, 1);
66 public Quaternion(@NonNull float[] v) { in Quaternion() method in Quaternion
80 public Quaternion(float x, float y, float z, float w) { in Quaternion() method in Quaternion
91 public static Quaternion axisAngle(@NonNull Vector3 axis, float radians) { in axisAngle()
96 return new Quaternion(sin * a.x, sin * a.y, sin * a.z, cos); in axisAngle()
111 public static Quaternion yawPitchRoll(float yaw, float pitch, float roll) { in yawPitchRoll()
112 Quaternion qX = axisAngle(new Vector3(0, 1, 0), yaw); in yawPitchRoll()
113 Quaternion qY = axisAngle(new Vector3(1, 0, 0), pitch); in yawPitchRoll()
114 Quaternion qZ = axisAngle(new Vector3(0, 0, 1), roll); in yawPitchRoll()
[all …]
DPose.java32 public static final Pose IDENTITY = new Pose(Vector3.ORIGIN, Quaternion.IDENTITY);
35 public final Quaternion rotation;
38 public Pose(Vector3 translation, Quaternion rotation) { in Pose()
63 this.rotation = new Quaternion(rotation[0], rotation[1], rotation[2], rotation[3]); in Pose()
75 return new Pose(composedTranslation, Quaternion.multiply(lhs.rotation, rhs.rotation)); in compose()
85 Quaternion rotation = Quaternion.fromMatrix(matrix); in fromMatrix()
96 Quaternion outRotation = rotation.inverted(); in inverted()
DMatrix.java171 public void makeRotation(Quaternion q) { in makeRotation()
229 public void makeTrs(Vector3 translation, Quaternion q, Vector3 scale) { in makeTrs()
274 public static Matrix newRotation(Quaternion rotation) { in newRotation()
308 public static Matrix newTrs(Vector3 translation, Quaternion rotation, Vector3 scale) { in newTrs()
/packages/modules/Uwb/service/java/com/android/server/uwb/correction/pose/
DSixDofPoseSource.java29 import com.android.server.uwb.correction.math.Quaternion;
54 private final Quaternion mRotator = Quaternion.yawPitchRoll(0, -F_HALF_PI, 0);
107 Quaternion rotation = new Quaternion( in onSensorChanged()
113 publish(new Pose(position, Quaternion.multiply(mRotator, rotation))); in onSensorChanged()
DRotationPoseSource.java29 import com.android.server.uwb.correction.math.Quaternion;
52 private final Quaternion mRotator = Quaternion.yawPitchRoll(0, -F_HALF_PI, 0);
97 Quaternion base = new Quaternion( in onSensorChanged()
103 publish(new Pose(Vector3.ORIGIN, Quaternion.multiply(mRotator, base))); in onSensorChanged()
DIntegPoseSource.java33 import com.android.server.uwb.correction.math.Quaternion;
76 private final Quaternion mRotator = Quaternion.yawPitchRoll(0, -F_HALF_PI, 0);
156 Quaternion base = new Quaternion( in onSensorChanged()
162 publish(new Pose(mPosition, Quaternion.multiply(mRotator, base))); in onSensorChanged()
DApplicationPoseSource.java22 import com.android.server.uwb.correction.math.Quaternion;
87 new Quaternion(v[3], v[4], v[5], v[6]))); in applyPose()
DGyroPoseSource.java28 import com.android.server.uwb.correction.math.Quaternion;
129 Quaternion.yawPitchRoll(mAbsoluteYaw, mAbsolutePitch, mAbsoluteRoll) in onSensorChanged()
/packages/modules/Uwb/service/tests/src/com/android/server/uwb/correction/math/
DQuaternionTest.java35 Quaternion quaternion = Quaternion.yawPitchRoll(0.5f, 1f, 1.5f); in testYawPitchRoll()
45 quaternion = Quaternion.yawPitchRoll(F_HALF_PI, 0, 0); in testYawPitchRoll()
48 quaternion = Quaternion.yawPitchRoll(0, F_HALF_PI, 0); in testYawPitchRoll()
51 quaternion = Quaternion.yawPitchRoll(0, 0, F_HALF_PI); in testYawPitchRoll()
DRandomTestData.java40 public Quaternion nextRotation() { in nextRotation()
41 return Quaternion.axisAngle(nextVector(), 360 * nextFloat()); in nextRotation()
DMatrixTest.java69 Matrix transform = Matrix.newRotation(Quaternion.axisAngle(new Vector3(0, 1, 0), F_PI)); in transformPoint_rotate180AroundOrthogonalFlipsVector()
123 Quaternion rotation = random.nextRotation(); in newTrs_isEquivalentToMultiplyingTranslationRotationScale()
DPoseTest.java49 Matrix.newRotation(new Quaternion(0, 1, 0, 0)), in testMatrix()
/packages/modules/Uwb/service/tests/src/com/android/server/uwb/correction/primers/
DElevationPrimerTest.java23 import com.android.server.uwb.correction.math.Quaternion;
72 nps.changePose(new Pose(Vector3.ORIGIN, Quaternion.yawPitchRoll(0, rads, 0))); in noElevationTest()
90 nps.changePose(new Pose(Vector3.ORIGIN, Quaternion.yawPitchRoll(0, rads, 0))); in replaceElevationTest()
DFoVPrimerTest.java22 import com.android.server.uwb.correction.math.Quaternion;
39 Quaternion roll10 = Quaternion.yawPitchRoll(0, 0, (float) toRadians(10)); in conversionTest()
DBackAzimuthPrimerTest.java32 import com.android.server.uwb.correction.math.Quaternion;
97 mNps.changePose(new Pose(Vector3.ORIGIN, Quaternion.yawPitchRoll(poseAngle, 0, 0))); in simulateRotation()
/packages/modules/Uwb/service/tests/src/com/android/server/uwb/correction/
DUwbFilterEngineTest.java27 import com.android.server.uwb.correction.math.Quaternion;
107 new Pose(Vector3.ORIGIN, Quaternion.yawPitchRoll(-0.5f, 0, 0)) in poseChanges()
147 new Pose(Vector3.ORIGIN, Quaternion.yawPitchRoll(0, 1, 0)) in primerTest()