Home
last modified time | relevance | path

Searched refs:deltaPose (Results 1 – 3 of 3) sorted by relevance

/packages/modules/Uwb/service/java/com/android/server/uwb/correction/filtering/
DPositionFilterImpl.java114 Pose deltaPose = Pose.compose(newPose.inverted(), mLastPose); in updatePose() local
115 updatePoseFromDelta(deltaPose, compute(timeMs)); in updatePose()
127 private void updatePoseFromDelta(@NonNull Pose deltaPose, @NonNull SphericalVector estimate) { in updatePoseFromDelta() argument
136 Vector3 vecFromNewCam = deltaPose.transformPoint(vecFromOldCam); in updatePoseFromDelta()
/packages/modules/Uwb/service/java/com/android/server/uwb/correction/primers/
DBackAzimuthPrimer.java183 Pose deltaPose = Pose.compose(newPose.inverted(), mLastPose); in prime() local
187 SphericalVector normalTheory = transformSpherical(mLastInput, deltaPose); in prime()
188 SphericalVector mirrorTheory = transformSpherical(mirrorAzimuth(mLastInput), deltaPose); in prime()
358 private SphericalVector transformSpherical(SphericalVector input, Pose deltaPose) { in transformSpherical() argument
359 return SphericalVector.fromCartesian(deltaPose.transformPoint(input.toCartesian())); in transformSpherical()
/packages/modules/Uwb/service/tests/src/com/android/server/uwb/correction/filtering/
DNullPositionFilter.java73 Pose deltaPose = Pose.compose(newPose.inverted(), mLastPose); in updatePose() local
82 Vector3 vecFromNewCam = deltaPose.transformPoint(vecFromOldCam); in updatePose()