congrats Icon
New! Announcing Tabnine Chat Beta
Learn More
Tabnine Logo
AlphaFilteredYoFrameVector.getFrameTuple
Code IndexAdd Tabnine to your IDE (free)

How to use
getFrameTuple
method
in
us.ihmc.robotics.math.filters.AlphaFilteredYoFrameVector

Best Java code snippets using us.ihmc.robotics.math.filters.AlphaFilteredYoFrameVector.getFrameTuple (Showing top 2 results out of 315)

origin: us.ihmc/IHMCStateEstimation

/**
* Estimates the pelvis position and linear velocity using the leg kinematics
* @param trustedFoot is the foot used to estimates the pelvis state
* @param numberOfTrustedSides is only one or both legs used to estimate the pelvis state
*/
private void updatePelvisWithKinematics(RigidBody trustedFoot, int numberOfTrustedFeet)
{
 double scaleFactor = 1.0 / numberOfTrustedFeet;
 footToRootJointPositions.get(trustedFoot).getFrameTuple(tempPosition);
 tempPosition.scale(scaleFactor);
 rootJointPosition.add(tempPosition);
 footPositionsInWorld.get(trustedFoot).getFrameTuple(tempPosition);
 tempPosition.scale(scaleFactor);
 rootJointPosition.add(tempPosition);
 YoFramePoint rootJointPositionPerFoot = rootJointPositionsPerFoot.get(trustedFoot);
 rootJointPositionPerFoot.set(footPositionsInWorld.get(trustedFoot));
 rootJointPositionPerFoot.add(footToRootJointPositions.get(trustedFoot));
 footVelocitiesInWorld.get(trustedFoot).getFrameTupleIncludingFrame(tempFrameVector);
 tempFrameVector.scale(scaleFactor * alphaRootJointLinearVelocityNewTwist.getDoubleValue());
 rootJointLinearVelocityNewTwist.sub(tempFrameVector);
}
origin: us.ihmc/CommonWalkingControlModules

public void getAdjustedDesiredCapturePoint(FramePoint2d desiredCapturePoint, FramePoint2d adjustedDesiredCapturePoint)
{
 filteredYoAngularMomentum.getFrameTuple(angularMomentum);
 ReferenceFrame comFrame = angularMomentum.getReferenceFrame();
 localDesiredCapturePoint.setIncludingFrame(desiredCapturePoint);
 localDesiredCapturePoint.changeFrameAndProjectToXYPlane(comFrame);
 double scaleFactor = momentumGain.getDoubleValue() * omega0.getDoubleValue() / (totalMass.getDoubleValue() * gravity);
 adjustedDesiredCapturePoint.setIncludingFrame(comFrame, -angularMomentum.getY(), angularMomentum.getX());
 adjustedDesiredCapturePoint.scale(scaleFactor);
 adjustedDesiredCapturePoint.add(localDesiredCapturePoint);
 adjustedDesiredCapturePoint.changeFrameAndProjectToXYPlane(desiredCapturePoint.getReferenceFrame());
}
us.ihmc.robotics.math.filtersAlphaFilteredYoFrameVectorgetFrameTuple

Popular methods of AlphaFilteredYoFrameVector

  • update
  • createAlphaFilteredYoFrameVector
  • <init>
  • checkReferenceFrameMatch
  • getFrameTupleIncludingFrame
  • getX
  • getY
  • getZ
  • get
  • interpolate
  • reset
  • set
  • reset,
  • set,
  • setToZero

Popular in Java

  • Running tasks concurrently on multiple threads
  • getApplicationContext (Context)
  • addToBackStack (FragmentTransaction)
  • getExternalFilesDir (Context)
  • Socket (java.net)
    Provides a client-side TCP socket.
  • Charset (java.nio.charset)
    A charset is a named mapping between Unicode characters and byte sequences. Every Charset can decode
  • TreeMap (java.util)
    Walk the nodes of the tree left-to-right or right-to-left. Note that in descending iterations, next
  • Vector (java.util)
    Vector is an implementation of List, backed by an array and synchronized. All optional operations in
  • CountDownLatch (java.util.concurrent)
    A synchronization aid that allows one or more threads to wait until a set of operations being perfor
  • BoxLayout (javax.swing)
  • Github Copilot alternatives
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