/packages/modules/Uwb/service/tests/src/com/android/server/uwb/correction/math/ |
D | SphericalVectorTest.java | 35 SphericalVector vec = SphericalVector.fromDegrees(185, 10, 10); in testCtorNormalization() 41 vec = SphericalVector.fromRadians((float) toRadians(5), (float) toRadians(110), 10); in testCtorNormalization() 50 SphericalVector sv = SphericalVector.fromDegrees(0, 18, 10); in testToAoAVector() 58 sv = SphericalVector.fromDegrees(-12, 0, 10); in testToAoAVector() 65 SphericalVector in testToAoAVector() 71 SphericalVector svec = SphericalVector.fromDegrees(15, 25, 6); in testToAoAVector() 75 svec = SphericalVector.fromDegrees(95, 25, 6); in testToAoAVector() 80 svec = SphericalVector.fromDegrees(-15, 35, 6); in testToAoAVector() 85 svec = SphericalVector.fromDegrees(-15, 35, 6); in testToAoAVector() 93 assertThat(SphericalVector.fromCartesian(0, 0, 0).distance).isEqualTo(0); in cartesian() [all …]
|
D | AoaVectorTest.java | 65 SphericalVector sv = AoaVector.fromRadians(0, 1.4373895f, 1) in testRoundingRegression() 77 SphericalVector sv = aoav.toSphericalVector(); in testToSphericalVector() 91 SphericalVector in testToSphericalVector() 98 SphericalVector svec = avec.toSphericalVector(); in testToSphericalVector()
|
/packages/modules/Uwb/service/tests/src/com/android/server/uwb/correction/primers/ |
D | FoVPrimerTest.java | 23 import com.android.server.uwb.correction.math.SphericalVector; 24 import com.android.server.uwb.correction.math.SphericalVector.Annotated; 34 SphericalVector prediction = SphericalVector.fromDegrees(0, 0, 0); in conversionTest() 40 Vector3 within = SphericalVector.fromDegrees(44, 0, 10).toCartesian(); in conversionTest() 41 Vector3 outside = SphericalVector.fromDegrees(46, 0, 10).toCartesian(); in conversionTest() 44 input = SphericalVector.fromCartesian(within).toAnnotated(); in conversionTest() 51 input = SphericalVector.fromCartesian(outside).toAnnotated(); in conversionTest() 63 SphericalVector prediction = SphericalVector.fromDegrees(0, 0, 0); in edgeCases() 66 input = SphericalVector.fromDegrees(35 + 180, 1, 10).toAnnotated(); in edgeCases() 72 input = SphericalVector.fromDegrees(45 + 180, 1, 10).toAnnotated(); in edgeCases() [all …]
|
D | ElevationPrimerTest.java | 24 import com.android.server.uwb.correction.math.SphericalVector; 25 import com.android.server.uwb.correction.math.SphericalVector.Annotated; 41 Annotated input = SphericalVector.fromDegrees(35, 0, 10).toAnnotated(); in hasElevationTest() 54 Annotated input = SphericalVector.fromDegrees(35, 0, 10) in noPoseTest() 74 Annotated input = SphericalVector.fromDegrees(35, 0, 10) in noElevationTest() 76 SphericalVector prediction = SphericalVector.fromDegrees(5, 6, 7); in noElevationTest() 94 Annotated input = SphericalVector.fromDegrees(35, 0, 10) in replaceElevationTest() 96 SphericalVector prediction = SphericalVector.fromDegrees(5, 6, 7); in replaceElevationTest()
|
D | AoaPrimerTest.java | 21 import com.android.server.uwb.correction.math.SphericalVector; 22 import com.android.server.uwb.correction.math.SphericalVector.Annotated; 32 Annotated sv = SphericalVector.fromDegrees(35, 0, 10) in conversionTest() 41 sv = SphericalVector.fromDegrees(45, 45, 10) in conversionTest() 53 SphericalVector sv = SphericalVector.fromDegrees(2, 3, 4); in missingDataTest()
|
D | NullPrimer.java | 21 import com.android.server.uwb.correction.math.SphericalVector; 22 import com.android.server.uwb.correction.math.SphericalVector.Annotated; 38 public Annotated prime(@NonNull Annotated input, @Nullable SphericalVector prediction, in prime() 54 return new Annotated(SphericalVector.fromRadians(Math.abs(azimuth), elevation, distance)); in prime()
|
D | BackAzimuthPrimerTest.java | 33 import com.android.server.uwb.correction.math.SphericalVector; 86 SphericalVector reading; in simulateRotation() 89 reading = SphericalVector.fromRadians(azimuth, 0, 1); in simulateRotation() 91 reading = SphericalVector.fromRadians( in simulateRotation() 100 SphericalVector result = engine.compute(mNow); in simulateRotation()
|
/packages/modules/Uwb/service/java/com/android/server/uwb/correction/primers/ |
D | BackAzimuthPrimer.java | 38 import com.android.server.uwb.correction.math.SphericalVector; 39 import com.android.server.uwb.correction.math.SphericalVector.Annotated; 81 private SphericalVector mLastInput; 136 public SphericalVector.Annotated prime( in prime() 137 @NonNull SphericalVector.Annotated input, in prime() 138 @Nullable SphericalVector prediction, in prime() 169 SphericalVector normalInput = forceAzimuth(input, false); in prime() 170 SphericalVector mirrorInput = forceAzimuth(input, true); in prime() 187 SphericalVector normalTheory = transformSpherical(mLastInput, deltaPose); in prime() 188 SphericalVector mirrorTheory = transformSpherical(mirrorAzimuth(mLastInput), deltaPose); in prime() [all …]
|
D | ElevationPrimer.java | 22 import com.android.server.uwb.correction.math.SphericalVector; 51 public SphericalVector.Annotated prime( in prime() 52 @NonNull SphericalVector.Annotated input, in prime() 53 @Nullable SphericalVector prediction, in prime() 56 SphericalVector.Annotated position = input; in prime() 66 position = new SphericalVector.Annotated( in prime() 67 SphericalVector.fromRadians( in prime()
|
D | FovPrimer.java | 26 import com.android.server.uwb.correction.math.SphericalVector; 27 import com.android.server.uwb.correction.math.SphericalVector.Annotated; 65 public SphericalVector.Annotated prime( in prime() 66 @NonNull SphericalVector.Annotated input, in prime() 67 @Nullable SphericalVector prediction, in prime() 83 Annotated result = new Annotated(SphericalVector.fromRadians( in prime()
|
D | AoaPrimer.java | 22 import com.android.server.uwb.correction.math.SphericalVector; 23 import com.android.server.uwb.correction.math.SphericalVector.Annotated; 45 public SphericalVector.Annotated prime( in prime() 46 @NonNull SphericalVector.Annotated input, in prime() 47 @Nullable SphericalVector prediction, in prime()
|
D | IPrimer.java | 21 import com.android.server.uwb.correction.math.SphericalVector; 43 SphericalVector.Annotated prime( in prime() 44 @NonNull SphericalVector.Annotated input, in prime() 45 @Nullable SphericalVector prediction, in prime()
|
/packages/modules/Uwb/service/java/com/android/server/uwb/correction/math/ |
D | SphericalVector.java | 49 public class SphericalVector { class 65 private SphericalVector(float azimuth, float elevation, float distance) { in SphericalVector() method in SphericalVector 96 public static SphericalVector fromRadians(float azimuth, float elevation, float distance) { in fromRadians() 97 return new SphericalVector(azimuth, elevation, distance); in fromRadians() 109 public static SphericalVector fromDegrees(float azimuth, float elevation, float distance) { in fromDegrees() 110 return new SphericalVector( in fromDegrees() 124 public static SphericalVector fromCartesian(@NonNull Vector3 position) { in fromCartesian() 139 public static SphericalVector fromCartesian(float x, float y, float z) { in fromCartesian() 142 return new SphericalVector(0, 0, 0); in fromCartesian() 146 return new SphericalVector(azimuth, elevation, d); in fromCartesian() [all …]
|
D | AoaVector.java | 130 public SphericalVector toSphericalVector() { in toSphericalVector() 131 return SphericalVector.fromAoAVector(this); in toSphericalVector() 205 public static AoaVector fromSphericalVector(SphericalVector vec) { in fromSphericalVector()
|
/packages/modules/Uwb/service/tests/src/com/android/server/uwb/correction/ |
D | UwbFilterEngineTest.java | 28 import com.android.server.uwb.correction.math.SphericalVector; 29 import com.android.server.uwb.correction.math.SphericalVector.Annotated; 42 engine.add(SphericalVector.fromRadians(1, 1.2f, 1.3f).toAnnotated(), 0); in basic() 43 SphericalVector currentVector = engine.compute(0); in basic() 53 Annotated annotated = SphericalVector.fromRadians(0, 0, 0) in testBadReading() 66 engine.add(SphericalVector.fromRadians(1, 1.2f, 1.3f).toAnnotated(), 0); in testIntermittentReading() 68 Annotated annotated = SphericalVector.fromRadians(0, 0, 0) in testIntermittentReading() 97 engine.add(SphericalVector.fromRadians(0.7f, 1.2f, 1.3f).toAnnotated(), 0); in poseChanges() 100 SphericalVector currentVector = engine.compute(0); in poseChanges() 135 engine.add(SphericalVector.fromRadians(-0.7f, 0, 1.3f).toAnnotated(), 0); in primerTest() [all …]
|
D | TestHelpers.java | 22 import com.android.server.uwb.correction.math.SphericalVector; 35 public static void assertClose(SphericalVector v, SphericalVector c) {
|
/packages/modules/Uwb/service/java/com/android/server/uwb/correction/filtering/ |
D | PositionFilterImpl.java | 22 import com.android.server.uwb.correction.math.SphericalVector; 23 import com.android.server.uwb.correction.math.SphericalVector.Annotated; 62 public void add(@NonNull SphericalVector.Annotated value, long timeMs) { in add() 81 public SphericalVector.Annotated compute(long timeMs) { in compute() 89 Annotated result = SphericalVector.fromRadians( in compute() 127 private void updatePoseFromDelta(@NonNull Pose deltaPose, @NonNull SphericalVector estimate) { in updatePoseFromDelta() 139 SphericalVector newEstimate = SphericalVector.fromCartesian(vecFromNewCam); in updatePoseFromDelta()
|
D | IPositionFilter.java | 18 import static com.android.server.uwb.correction.math.SphericalVector.Annotated;
|
/packages/modules/Uwb/service/tests/src/com/android/server/uwb/correction/filtering/ |
D | NullPositionFilter.java | 22 import com.android.server.uwb.correction.math.SphericalVector; 33 private SphericalVector.Annotated mValue; 44 public void add(@NonNull SphericalVector.Annotated value, long timeMs) { in add() 57 public SphericalVector.Annotated compute(long timeMs) { in compute() 85 mValue = SphericalVector.fromCartesian(vecFromNewCam).toAnnotated() in updatePose()
|
/packages/modules/Uwb/service/java/com/android/server/uwb/correction/ |
D | UwbFilterEngine.java | 26 import com.android.server.uwb.correction.math.SphericalVector; 56 @Nullable private SphericalVector.Annotated mLastInputState; 78 public void add(@NonNull SphericalVector.Annotated position, long timeMs) { in add() 82 SphericalVector prediction = compute(timeMs); in add() 104 mLastInputState = SphericalVector.fromRadians( in add() 129 public SphericalVector.Annotated compute(long timeMs) { in compute()
|
/packages/modules/Uwb/service/java/com/android/server/uwb/ |
D | UwbControlee.java | 28 import com.android.server.uwb.correction.math.SphericalVector; 134 SphericalVector.Annotated sv = SphericalVector.fromRadians(azimuth, elevation, distance) in filterMeasurement() 144 SphericalVector.Annotated engineResult = mEngine.compute(nowMs); in filterMeasurement() 169 SphericalVector.Annotated replacement) { in updateBuilder()
|