Tabnine Logo
FrameConvexPolygon2d.getFrameVertex
Code IndexAdd Tabnine to your IDE (free)

How to use
getFrameVertex
method
in
us.ihmc.robotics.geometry.FrameConvexPolygon2d

Best Java code snippets using us.ihmc.robotics.geometry.FrameConvexPolygon2d.getFrameVertex (Showing top 13 results out of 315)

origin: us.ihmc/IHMCRoboticsToolkit

public FramePoint2d getFrameVertexCopy(int vertexIndex)
{
 FramePoint2d frameVertexCopy = new FramePoint2d();
 getFrameVertex(vertexIndex, frameVertexCopy);
 return frameVertexCopy;
}
origin: us.ihmc/IHMCRoboticsToolkit

public void getPreviousFrameVertex(int vertexIndex, FramePoint2d vertexToPack)
{
 getFrameVertex(convexPolygon.getPreviousVertexIndex(vertexIndex), vertexToPack);
}
origin: us.ihmc/IHMCRoboticsToolkit

public void getNextFrameVertex(int vertexIndex, FramePoint2d vertexToPack)
{
 getFrameVertex(convexPolygon.getNextVertexIndex(vertexIndex), vertexToPack);
}
origin: us.ihmc/IHMCRoboticsToolkit

@Override
public String toString()
{
 FramePoint2d vertex = new FramePoint2d();
 String ret = "";
 for (int i = 0; i < getNumberOfVertices(); i++)
 {
   this.getFrameVertex(i, vertex);
   ret = ret + vertex.toString() + "\n";
 }
 return ret;
}
origin: us.ihmc/CommonWalkingControlModules

public void updateCMPConstraintForSingleSupport(RobotSide supportSide, ICPOptimizationSolver solver)
{
 FrameConvexPolygon2d supportPolygon = bipedSupportPolygons.getFootPolygonInSoleFrame(supportSide);
 solver.setNumberOfCMPVertices(supportPolygon.getNumberOfVertices());
 for (int i = 0; i < supportPolygon.getNumberOfVertices(); i++)
 {
   supportPolygon.getFrameVertex(i, tempVertex);
   solver.setSupportPolygonVertex(i, tempVertex, supportPolygon.getReferenceFrame(), maxCMPSingleSupportExitForward.getDoubleValue(),
      maxCMPSingleSupportExitSideways.getDoubleValue());
 }
}
origin: us.ihmc/IHMCAvatarInterfaces

for (int contactPointIndex = 0; contactPointIndex < footSupportPolygon.getNumberOfVertices(); contactPointIndex++)
  footSupportPolygon.getFrameVertex(contactPointIndex, contactPoint2d);
  findProjectionOntoPlaneFrame(soleFrame, contactPoint2d, contactPoints.add());
origin: us.ihmc/IHMCHumanoidBehaviors

private void sequenceShiftWeight()
{
 FramePoint2d center = new FramePoint2d(midFeetZUpFrame);
 FrameConvexPolygon2d supportPolygon = new FrameConvexPolygon2d(yoSupportPolygon.getFrameConvexPolygon2d());
 supportPolygon.changeFrameAndProjectToXYPlane(midFeetZUpFrame);
 FrameVector2d desiredPelvisOffset = new FrameVector2d(midFeetZUpFrame);
 for (int i = 0; i < supportPolygon.getNumberOfVertices(); i++)
 {
   supportPolygon.getFrameVertex(i, desiredPelvisOffset);
   desiredPelvisOffset.sub(center);
   submitDesiredPelvisPositionOffset(false, pelvisShiftScaleFactor.getX() * desiredPelvisOffset.getX(),
      pelvisShiftScaleFactor.getY() * desiredPelvisOffset.getY(), 0.0);
 }
 // Get back to the first vertex again
 supportPolygon.getFrameVertex(0, desiredPelvisOffset);
 desiredPelvisOffset.sub(center);
 submitDesiredPelvisPositionOffset(false, pelvisShiftScaleFactor.getX() * desiredPelvisOffset.getX(),
    pelvisShiftScaleFactor.getY() * desiredPelvisOffset.getY(), 0.0);
 submitPelvisHomeCommand(false);
}
origin: us.ihmc/CommonWalkingControlModules

public void updateCMPConstraintForDoubleSupport(ICPOptimizationSolver solver)
{
 int numberOfVertices = 0;
 for (RobotSide robotSide : RobotSide.values)
   numberOfVertices += bipedSupportPolygons.getFootPolygonInMidFeetZUp(robotSide).getNumberOfVertices();
 solver.setNumberOfCMPVertices(numberOfVertices);
 numberOfVertices = 0;
 for (RobotSide robotSide : RobotSide.values)
 {
   FrameConvexPolygon2d supportPolygon = bipedSupportPolygons.getFootPolygonInMidFeetZUp(robotSide);
   for (int i = 0; i < supportPolygon.getNumberOfVertices(); i++)
   {
    supportPolygon.getFrameVertex(i, tempVertex);
    solver.setSupportPolygonVertex(numberOfVertices + i, tempVertex, supportPolygon.getReferenceFrame(), maxCMPDoubleSupportExitForward.getDoubleValue(),
       maxCMPDoubleSupportExitSideways.getDoubleValue());
   }
   numberOfVertices += supportPolygon.getNumberOfVertices();
 }
}
origin: us.ihmc/IHMCHumanoidBehaviors

private void sequenceMediumWarmup()
{
 FramePoint2d center = new FramePoint2d(midFeetZUpFrame);
 FrameVector2d shiftScaleVector = new FrameVector2d(midFeetZUpFrame, 0.1, 0.7);
 FrameConvexPolygon2d supportPolygon = new FrameConvexPolygon2d(yoSupportPolygon.getFrameConvexPolygon2d());
 supportPolygon.changeFrameAndProjectToXYPlane(midFeetZUpFrame);
 FrameVector2d desiredPelvisOffset = new FrameVector2d(midFeetZUpFrame);
 for (int i = 0; i < supportPolygon.getNumberOfVertices(); i++)
 {
   supportPolygon.getFrameVertex(i, desiredPelvisOffset);
   desiredPelvisOffset.sub(center);
   submitDesiredPelvisPositionOffset(false, shiftScaleVector.getX() * desiredPelvisOffset.getX(), shiftScaleVector.getY() * desiredPelvisOffset.getY(),
      0.0);
   sequenceSquats();
   sequenceChestRotations(0.55); //TODO increase/decrease limit?
   sequencePelvisRotations(0.3); //TODO increase/decrease limit?
 }
 // Get back to the first vertex again
 supportPolygon.getFrameVertex(0, desiredPelvisOffset);
 desiredPelvisOffset.sub(center);
 submitDesiredPelvisPositionOffset(false, pelvisShiftScaleFactor.getX() * desiredPelvisOffset.getX(),
    pelvisShiftScaleFactor.getY() * desiredPelvisOffset.getY(), 0.0);
 submitChestHomeCommand(false);
 submitPelvisHomeCommand(false);
}
origin: us.ihmc/CommonWalkingControlModules

private void computeToePoints(RobotSide supportSide)
{
 FrameConvexPolygon2d footDefaultPolygon = footDefaultPolygons.get(supportSide);
 toePoints[0].setIncludingFrame(footDefaultPolygon.getReferenceFrame(), Double.NEGATIVE_INFINITY, 0.0, 0.0);
 toePoints[1].setIncludingFrame(footDefaultPolygon.getReferenceFrame(), Double.NEGATIVE_INFINITY, 0.0, 0.0);
 for (int i = 0; i < footDefaultPolygon.getNumberOfVertices(); i++)
 {
   footDefaultPolygon.getFrameVertex(i, footPoint);
   if (footPoint.getX() > toePoints[0].getX())
   {
    toePoints[1].set(toePoints[0]);
    toePoints[0].setXY(footPoint);
   }
   else if (footPoint.getX() > toePoints[1].getX())
   {
    toePoints[1].setXY(footPoint);
   }
 }
 middleToePoint.setToZero(footDefaultPolygon.getReferenceFrame());
 middleToePoint.interpolate(toePoints[0], toePoints[1], 0.5);
}
origin: us.ihmc/CommonWalkingControlModules

yoCurrentCorner.set(corner);
supportPolygon.getFrameVertex(corner, currentCorner);
FramePoint2d centroid = supportPolygon.getCentroid();
origin: us.ihmc/IHMCHumanoidBehaviors

supportPolygon.getFrameVertex(i, frameVertexBefore);
supportPolygon.getFrameVertex((i + 1) % numberOfVertices, frameVertexCurrentlyChecked);
supportPolygon.getFrameVertex((i + 2) % numberOfVertices, frameVertexAfter);
origin: us.ihmc/CommonWalkingControlModules

yoCurrentCorner.set(currentCornerIdx);
supportPolygon.getFrameVertex(currentCornerIdx, currentCorner);
FramePoint2d centroid = supportPolygon.getCentroid();
us.ihmc.robotics.geometryFrameConvexPolygon2dgetFrameVertex

Popular methods of FrameConvexPolygon2d

  • <init>
    Creates an empty convex polygon attached to a reference frame, adds N new vertices using an array of
  • getNumberOfVertices
  • changeFrameAndProjectToXYPlane
  • isPointInside
    isPointInside Determines whether a point is inside the convex polygon (point in polygon test). Uses
  • getConvexPolygon2d
  • getVertex
  • intersectionWith
  • setIncludingFrameAndUpdate
    This method does: 1- clear(referenceFrame); 2- addVertices(vertices); 3- update().
  • addVertex
    Add a vertex to this polygon. Note that this method recycles memory.
  • addVertexByProjectionOntoXYPlane
    Add a vertex to this polygon after doing newVertex2d.changeFrameAndProjectToXYPlane(this.referenceFr
  • addVertices
  • clear
    After calling this method, the polygon has no vertex, area, or centroid, and is attached to a new re
  • addVertices,
  • clear,
  • getCentroid,
  • getReferenceFrame,
  • isEmpty,
  • orthogonalProjection,
  • scale,
  • update,
  • addVertexAndChangeFrame

Popular in Java

  • Start an intent from android
  • scheduleAtFixedRate (Timer)
  • getApplicationContext (Context)
  • runOnUiThread (Activity)
  • Pointer (com.sun.jna)
    An abstraction for a native pointer data type. A Pointer instance represents, on the Java side, a na
  • Container (java.awt)
    A generic Abstract Window Toolkit(AWT) container object is a component that can contain other AWT co
  • IOException (java.io)
    Signals a general, I/O-related error. Error details may be specified when calling the constructor, a
  • Vector (java.util)
    Vector is an implementation of List, backed by an array and synchronized. All optional operations in
  • Filter (javax.servlet)
    A filter is an object that performs filtering tasks on either the request to a resource (a servlet o
  • HttpServlet (javax.servlet.http)
    Provides an abstract class to be subclassed to create an HTTP servlet suitable for a Web site. A sub
  • Best IntelliJ 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