@Override public void setOrientation(QuaternionReadOnly orientation) { this.orientation.set(orientation); }
@Override public void setOrientation(QuaternionReadOnly orientation) { this.orientation.set(orientation); }
public void set(double time, YoFrameQuaternion orientation, YoFrameVector3D angularVelocity) { this.time.set(time); this.orientation.set(orientation); this.angularVelocity.set(angularVelocity); }
public void set(double time, QuaternionReadOnly orientation, Vector3DReadOnly angularVelocity) { this.time.set(time); this.orientation.set(orientation); this.angularVelocity.set(angularVelocity); }
public void setOrientation(FrameQuaternionReadOnly orientation) { if (isUsingYawPitchRoll()) yoFrameYawPitchRoll.set(orientation); else yoFrameQuaternion.set(orientation); }
public void setOrientation(QuaternionReadOnly orientation) { if (isUsingYawPitchRoll()) yawPitchRoll.set(orientation); else quaternion.set(orientation); }
public void set(double time, FrameQuaternion orientation, FrameVector3D angularVelocity) { this.time.set(time); this.orientation.set(orientation); this.angularVelocity.set(angularVelocity); }
public void setOrientation(FrameQuaternionReadOnly orientation) { if (isUsingYawPitchRoll()) yawPitchRoll.set(orientation); else quaternion.set(orientation); }
private void doRandomUpdates(AlphaFilteredYoFrameQuaternion q, Random random, int nUpdates) { for (int i = 0; i < nUpdates; i++) { // set measurement randomly and updated filtered version Quaternion qMeasured = RandomGeometry.nextQuaternion(random); q.getUnfilteredQuaternion().set(qMeasured); q.update(); } }
public static void extractYoFrameQuaternionFromEJMLVector(YoFrameQuaternion yoFrameQuaternion, DenseMatrix64F matrix, int rowStart) { int index = rowStart; double x = matrix.get(index++, 0); double y = matrix.get(index++, 0); double z = matrix.get(index++, 0); double w = matrix.get(index++, 0); yoFrameQuaternion.set(x, y, z, w); }
public void set(double time, FramePoint3D position, FrameQuaternion orientation, FrameVector3D linearVelocity, FrameVector3D angularVelocity) { this.time.set(time); this.position.set(position); this.orientation.set(orientation); this.linearVelocity.set(linearVelocity); this.angularVelocity.set(angularVelocity); }
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(); }
public void set(double time, Point3DReadOnly position, QuaternionReadOnly orientation, Vector3DReadOnly linearVelocity, Vector3DReadOnly angularVelocity) { this.time.set(time); this.position.set(position); this.orientation.set(orientation); this.linearVelocity.set(linearVelocity); this.angularVelocity.set(angularVelocity); }
@Override protected void getYoValuesFromFrameWaypoint() { SO3Waypoint simpleWaypoint = frameWaypoint.getGeometryObject(); orientation.set(simpleWaypoint.getOrientation()); angularVelocity.set(simpleWaypoint.getAngularVelocity()); } }
public void setTrajectoryParameters(YoFrameSO3TrajectoryPoint initialYoFrameSO3Waypoint, YoFrameSO3TrajectoryPoint finalYoFrameSO3Waypoint) { setTrajectoryTime(finalYoFrameSO3Waypoint.getTime() - initialYoFrameSO3Waypoint.getTime()); initialOrientation.set(initialYoFrameSO3Waypoint.getOrientation()); initialAngularVelocity.set(initialYoFrameSO3Waypoint.getAngularVelocity()); finalOrientation.set(finalYoFrameSO3Waypoint.getOrientation()); finalAngularVelocity.set(finalYoFrameSO3Waypoint.getAngularVelocity()); }
public void setTransformToWorld(RigidBodyTransform transformToWorld) { position.set(transformToWorld.getTranslationVector()); if (isUsingYawPitchRoll()) yawPitchRoll.set(transformToWorld.getRotationMatrix()); else quaternion.set(transformToWorld.getRotationMatrix()); }
public void initialize() { time.set(0.0); FrameQuaternion orientationToPack = new FrameQuaternion(ReferenceFrame.getWorldFrame()); orientationProvider.getOrientation(orientationToPack); orientationToPack.changeFrame(orientation.getReferenceFrame()); orientation.set(orientationToPack); }
@Override protected void getYoValuesFromFrameWaypoint() { SimpleSO3TrajectoryPoint simpleTrajectoryPoint = frameWaypoint.getGeometryObject(); SO3Waypoint so3Waypoint = simpleTrajectoryPoint.getSO3Waypoint(); time.set(simpleTrajectoryPoint.getTime()); orientation.set(so3Waypoint.getOrientation()); angularVelocity.set(so3Waypoint.getAngularVelocity()); }
public void setPose(FramePose3D framePose) { yoFramePoint.checkReferenceFrameMatch(framePose.getReferenceFrame()); yoFramePoint.set(framePose.getPosition()); if (isUsingYawPitchRoll()) yoFrameYawPitchRoll.set(framePose.getOrientation()); else yoFrameQuaternion.set(framePose.getOrientation()); }