Tabnine Logo
Footstep.getPosition
Code IndexAdd Tabnine to your IDE (free)

How to use
getPosition
method
in
us.ihmc.humanoidRobotics.footstep.Footstep

Best Java code snippets using us.ihmc.humanoidRobotics.footstep.Footstep.getPosition (Showing top 5 results out of 315)

origin: us.ihmc/ihmc-simulation-toolkit-test

private void assertMaxDisplacementStanceToSwing(String message, ArrayList<Footstep> footsteps, double distTest)
{
 if (distTest == Double.POSITIVE_INFINITY)
   return;
 Footstep footstep1;
 Footstep footstep2;
 for (int i = 0; i < footsteps.size() - 1; i++)
 {
   footstep1 = footsteps.get(i);
   footstep2 = footsteps.get(i + 1);
   FramePoint3D position2 = new FramePoint3D();
   footstep2.getPosition(position2);
   FramePoint3D position1 = new FramePoint3D();
   footstep1.getPosition(position1);
   double dis = position2.distance(position1);
   assertTrue(String.format(message + " %.2f<=%.2f? step %d to %d", dis, distTest, i, i + 1), dis < distTest + 1e-14);
 }
}
origin: us.ihmc/ihmc-simulation-toolkit-test

private void assertMaxDisplacementSwingToSwing(String message, ArrayList<Footstep> footsteps, double distTest)
{
 if (distTest == Double.POSITIVE_INFINITY)
   return;
 Footstep footstep1;
 Footstep footstep2;
 for (int i = 0; i < footsteps.size() - 2; i++)
 {
   footstep1 = footsteps.get(i);
   footstep2 = footsteps.get(i + 2);
   FramePoint3D position2 = new FramePoint3D();
   footstep2.getPosition(position2);
   FramePoint3D position1 = new FramePoint3D();
   footstep1.getPosition(position1);
   double dis = position2.distance(position1);
   //       assertTrue(true);
   assertTrue(String.format(message + " %.2f<=%.2f? step %d to %d", dis, distTest, i, i + 2), dis < distTest + 1e-14);
 }
}
origin: us.ihmc/DarpaRoboticsChallenge

public double getSwingHeight(Footstep initialFootstep, Footstep stanceFootstep, Footstep endFootstep, HeightMapWithPoints heightMap)
{
 FramePose startPose = new FramePose();
 initialFootstep.getSolePose(startPose);
 FramePose endPose = new FramePose();
 endFootstep.getSolePose(endPose);
 Point3d position = new Point3d();
 stanceFootstep.getPosition(position);
 return getSwingHeight(startPose, endPose, position.getZ(), heightMap);
}
origin: us.ihmc/ihmc-humanoid-robotics

public static RobotSide getFrontFootRobotSideFromFootsteps(SideDependentList<Footstep> footSteps, FramePoint3D destination)
{
 FramePoint3D destinationInWorld = new FramePoint3D(destination);
 destinationInWorld.changeFrame(worldFrame);
 SideDependentList<Double> distances = new SideDependentList<Double>();
 for (RobotSide side : RobotSide.values)
 {
   FramePoint3D footstepPosition = new FramePoint3D();
   footSteps.get(side).getPosition(footstepPosition);
   footstepPosition.changeFrame(worldFrame);
   distances.set(side, new Double(footstepPosition.distanceSquared(destinationInWorld)));
 }
 RobotSide frontSide = (distances.get(RobotSide.LEFT) <= distances.get(RobotSide.RIGHT)) ? RobotSide.LEFT : RobotSide.RIGHT;
 return frontSide;
}
origin: us.ihmc/ihmc-common-walking-control-modules-test

transferFromFootstep.getPosition(transferFromFootFramePoint);
FrameQuaternion transferFromFootOrientation = new FrameQuaternion();
transferFromFootstep.getOrientation(transferFromFootOrientation);
transferToFootstep.getPosition(transferToFootFramePoint);
FrameQuaternion transferToFootOrientation = new FrameQuaternion();
transferToFootstep.getOrientation(transferToFootOrientation);
us.ihmc.humanoidRobotics.footstepFootstepgetPosition

Popular methods of Footstep

  • getRobotSide
  • <init>
  • getPose
  • getSoleReferenceFrame
  • getPredictedContactPoints
  • getZ
  • getSolePose
  • setSwingHeight
  • setTrajectoryType
  • setZ
  • getFootstepPose
  • getFootstepType
  • getFootstepPose,
  • getFootstepType,
  • getSwingHeight,
  • getTrajectoryType,
  • setPose,
  • getBody,
  • getCustomPositionWaypoints,
  • getOrientation,
  • getOrientationInWorldFrame

Popular in Java

  • Running tasks concurrently on multiple threads
  • findViewById (Activity)
  • getResourceAsStream (ClassLoader)
  • scheduleAtFixedRate (Timer)
  • InetAddress (java.net)
    An Internet Protocol (IP) address. This can be either an IPv4 address or an IPv6 address, and in pra
  • URLConnection (java.net)
    A connection to a URL for reading or writing. For HTTP connections, see HttpURLConnection for docume
  • KeyStore (java.security)
    KeyStore is responsible for maintaining cryptographic keys and their owners. The type of the syste
  • Filter (javax.servlet)
    A filter is an object that performs filtering tasks on either the request to a resource (a servlet o
  • FileUtils (org.apache.commons.io)
    General file manipulation utilities. Facilities are provided in the following areas: * writing to a
  • StringUtils (org.apache.commons.lang)
    Operations on java.lang.String that arenull safe. * IsEmpty/IsBlank - checks if a String contains
  • Top Vim 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