Tabnine Logo
Quaternion.setRotationVector
Code IndexAdd Tabnine to your IDE (free)

How to use
setRotationVector
method
in
us.ihmc.euclid.tuple4D.Quaternion

Best Java code snippets using us.ihmc.euclid.tuple4D.Quaternion.setRotationVector (Showing top 10 results out of 315)

origin: us.ihmc/ekf

public void add(QuaternionBasics orientation, Vector3DReadOnly rotationVector)
{
 tempRotation.setRotationVector(rotationVector);
 orientation.preMultiply(tempRotation);
}
origin: us.ihmc/ihmc-robotics-toolkit

private QuaternionReadOnly exp(double alpha, Vector3DReadOnly rotation)
{
 tempLogExpVector3D.setAndScale(alpha, rotation);
 tempLogExpQuaternion.setRotationVector(tempLogExpVector3D);
 return tempLogExpQuaternion;
}
origin: us.ihmc/mecano

/**
* Integrates the given {@code angularVelocity} to estimate the {@code finalOrientation}. The
* given velocity is expected to be expressed in the local frame described by the given
* {@code initialOrientation}.
* <p>
* Pseudo-code:
* 
* <pre>
* finalOrientation = initialOrientation + dt * angularVelocity
* </pre>
* </p>
* 
* @param angularVelocity the angular velocity to integrate. Not modified.
* @param initialOrientation the initial orientation to append the integrated angular velocity
*           to. Not modified.
* @param finalOrientation the estimated orientation after integration. Modified.
*/
public void integrate(Vector3DReadOnly angularVelocity, Orientation3DReadOnly initialOrientation, Orientation3DBasics finalOrientation)
{
 rotationVector.setAndScale(dt, angularVelocity);
 integrated.setRotationVector(rotationVector);
 finalOrientation.set(initialOrientation);
 finalOrientation.append(integrated);
}
origin: us.ihmc/mecano

integrated.setRotationVector(rotationVector);
finalOrientation.set(initialOrientation);
finalOrientation.append(integrated);
origin: us.ihmc/ihmc-robotics-toolkit

angularVelocityTwo.scale(integrationDT);
quaternionFutureOne.setRotationVector(angularVelocityOne);
quaternionFutureTwo.setRotationVector(angularVelocityTwo);
origin: us.ihmc/ihmc-robotics-toolkit

difference.setRotationVector(limitedRotationVector);
multiply(difference);
origin: us.ihmc/ihmc-robotics-toolkit

public void update(Vector3DReadOnly inputAngularVelocity, Vector3DReadOnly inputLinearAcceleration, Vector3DReadOnly inputMagneticVector)
{
 if (!hasBeenInitialized.getValue())
 {
   initialize(inputLinearAcceleration, inputMagneticVector);
   return;
 }
 boolean success = computeOrientationError((QuaternionReadOnly) estimatedOrientation, inputLinearAcceleration, inputMagneticVector, quaternionUpdate);
 if (success)
 {
   quaternionUpdate.getRotationVector(totalError);
   yoErrorTerm.set(totalError);
   integralTerm.scaleAdd(integralGain.getValue() * updateDT, yoErrorTerm, yoIntegralTerm);
   yoIntegralTerm.set(integralTerm);
   angularVelocityTerm.scaleAdd(proportionalGain.getValue(), totalError, inputAngularVelocity);
   angularVelocityTerm.add(integralTerm);
 }
 else
 {
   yoErrorTerm.setToZero();
   angularVelocityTerm.set(inputAngularVelocity);
 }
 rotationUpdate.setAndScale(updateDT, angularVelocityTerm);
 quaternionUpdate.setRotationVector(rotationUpdate);
 estimatedOrientation.multiply(quaternionUpdate);
 if (estimatedAngularVelocity != null)
   estimatedAngularVelocity.add(inputAngularVelocity, integralTerm);
}
origin: us.ihmc/ihmc-robotics-toolkit

difference.setRotationVector(limitedRotationVector);
quaternionFiltered.multiply(difference);
set(quaternionFiltered);
origin: us.ihmc/euclid-test

actualQuaternion.setRotationVector(rotationVector);
EuclidCoreTestTools.assertQuaternionGeometricallyEquals(expectedQuaternion, actualQuaternion, EPS);
origin: us.ihmc/euclid-test

assertEquals(initialFrame, frameQuaternion.getReferenceFrame());
frameQuaternion.setRotationVectorIncludingFrame(newFrame, rotationVector);
quaternion.setRotationVector(rotationVector);
assertEquals(newFrame, frameQuaternion.getReferenceFrame());
EuclidCoreTestTools.assertTuple4DEquals(quaternion, frameQuaternion, EPSILON);
assertEquals(initialFrame, frameQuaternion.getReferenceFrame());
frameQuaternion.setRotationVectorIncludingFrame(rotationVector);
quaternion.setRotationVector(rotationVector);
assertEquals(newFrame, frameQuaternion.getReferenceFrame());
EuclidCoreTestTools.assertTuple4DEquals(quaternion, frameQuaternion, EPSILON);
us.ihmc.euclid.tuple4DQuaternionsetRotationVector

Popular methods of Quaternion

  • <init>
  • set
  • getS
  • getX
  • getY
  • getZ
  • multiply
  • setYawPitchRoll
  • getYaw
  • applyTransform
  • epsilonEquals
  • transform
  • epsilonEquals,
  • transform,
  • appendRollRotation,
  • equals,
  • get,
  • interpolate,
  • multiplyConjugateOther,
  • normalize,
  • appendPitchRotation

Popular in Java

  • Reading from database using SQL prepared statement
  • putExtra (Intent)
  • getApplicationContext (Context)
  • orElseThrow (Optional)
    Return the contained value, if present, otherwise throw an exception to be created by the provided s
  • Rectangle (java.awt)
    A Rectangle specifies an area in a coordinate space that is enclosed by the Rectangle object's top-
  • InputStreamReader (java.io)
    A class for turning a byte stream into a character stream. Data read from the source input stream is
  • Queue (java.util)
    A collection designed for holding elements prior to processing. Besides basic java.util.Collection o
  • JarFile (java.util.jar)
    JarFile is used to read jar entries and their associated data from jar files.
  • ImageIO (javax.imageio)
  • Options (org.apache.commons.cli)
    Main entry-point into the library. Options represents a collection of Option objects, which describ
  • Top PhpStorm plugins
Tabnine Logo
  • Products

    Search for Java codeSearch for JavaScript code
  • IDE Plugins

    IntelliJ IDEAWebStormVisual StudioAndroid StudioEclipseVisual Studio CodePyCharmSublime TextPhpStormVimGoLandRubyMineEmacsJupyter NotebookJupyter LabRiderDataGripAppCode
  • Company

    About UsContact UsCareers
  • Resources

    FAQBlogTabnine AcademyTerms of usePrivacy policyJava Code IndexJavascript Code Index
Get Tabnine for your IDE now