private void updateInitialOrientation() { initialOrientationProvider.getOrientation(tempInitialOrientation); tempInitialOrientation.changeFrame(initialOrientation.getReferenceFrame()); initialOrientation.set(tempInitialOrientation); initialOrientation.checkIfUnitary(); }
private void updateFinalOrientation() { finalOrientationProvider.getOrientation(tempFinalOrientation); tempFinalOrientation.changeFrame(finalOrientation.getReferenceFrame()); finalOrientation.set(tempFinalOrientation); finalOrientation.checkIfUnitary(); }