us.ihmc.robotics.math.trajectories.waypoints.YoFrameSO3TrajectoryPoint.getOrientation()方法的使用及代码示例

x33g5p2x  于2022-02-05 转载在 其他  
字(4.1k)|赞(0)|评价(0)|浏览(119)

本文整理了Java中us.ihmc.robotics.math.trajectories.waypoints.YoFrameSO3TrajectoryPoint.getOrientation()方法的一些代码示例,展示了YoFrameSO3TrajectoryPoint.getOrientation()的具体用法。这些代码示例主要来源于Github/Stackoverflow/Maven等平台,是从一些精选项目中提取出来的代码,具有较强的参考意义,能在一定程度帮忙到你。YoFrameSO3TrajectoryPoint.getOrientation()方法的具体详情如下:
包路径:us.ihmc.robotics.math.trajectories.waypoints.YoFrameSO3TrajectoryPoint
类名称:YoFrameSO3TrajectoryPoint
方法名:getOrientation

YoFrameSO3TrajectoryPoint.getOrientation介绍

[英]Return the original orientation held by this trajectory point.
[中]返回该轨迹点保持的原始方向。

代码示例

代码示例来源:origin: us.ihmc/IHMCRoboticsToolkit

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());
}

代码示例来源:origin: us.ihmc/ihmc-robotics-toolkit-test

assertEquals(expectedNamePrefix, testedYoFrameSO3TrajectoryPoint.getNamePrefix());
assertEquals(expectedNameSuffix, testedYoFrameSO3TrajectoryPoint.getNameSuffix());
assertTrue(expectedOrientation.geometricallyEquals(testedYoFrameSO3TrajectoryPoint.getOrientation(), epsilon));
assertTrue(expectedAngularVelocity.epsilonEquals(testedYoFrameSO3TrajectoryPoint.getAngularVelocity(), epsilon));
Vector3D actualAngularVelocity = new Vector3D();
testedYoFrameSO3TrajectoryPoint.getOrientation(actualOrientation);
testedYoFrameSO3TrajectoryPoint.getAngularVelocity(actualAngularVelocity);
FrameVector3D actualFrameAngularVelocity = new FrameVector3D(expectedFrame);
testedYoFrameSO3TrajectoryPoint.getOrientation(actualFrameOrientation);
testedYoFrameSO3TrajectoryPoint.getAngularVelocity(actualFrameAngularVelocity);

代码示例来源:origin: us.ihmc/ihmc-robotics-toolkit

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());
}

代码示例来源:origin: us.ihmc/ihmc-robotics-toolkit-test

assertTrue(testedYoFrameSO3TrajectoryPoint.getOrientation().containsNaN());
assertTrue(testedYoFrameSO3TrajectoryPoint.getAngularVelocity().containsNaN());
assertTrue(testedYoFrameSO3TrajectoryPoint.getOrientation().containsNaN());
assertTrue(testedYoFrameSO3TrajectoryPoint.getAngularVelocity().containsNaN());

代码示例来源:origin: us.ihmc/ihmc-robotics-toolkit-test

assertFalse(orientation.epsilonEquals(yoFrameSO3TrajectoryPoint.getOrientation(), 1e-10));
assertFalse(angularVelocity.epsilonEquals(yoFrameSO3TrajectoryPoint.getAngularVelocity(), 1e-10));
angularVelocity.changeFrame(poseFrame);
assertTrue(orientation.epsilonEquals(yoFrameSO3TrajectoryPoint.getOrientation(), 1e-10));
assertTrue(angularVelocity.epsilonEquals(yoFrameSO3TrajectoryPoint.getAngularVelocity(), 1e-10));

代码示例来源:origin: us.ihmc/ihmc-robotics-toolkit-test

testedYoFrameSO3TrajectoryPoint.getTime(), testedYoFrameSO3TrajectoryPoint.getOrientation(),
testedYoFrameSO3TrajectoryPoint.getAngularVelocity(), testedYoFrameSO3TrajectoryPoint, epsilon);

代码示例来源:origin: us.ihmc/ihmc-robotics-toolkit-test

YoFrameVector3D angularVelocityForVerification = new YoFrameVector3D("angularVelocityForVerification", worldFrame, registry);
yoFrameSO3TrajectoryPoint.getOrientation(quaternionForVerification);
yoFrameSO3TrajectoryPoint.getAngularVelocity(angularVelocityForVerification);
assertFalse(yoFrameSO3TrajectoryPoint.containsNaN());
yoFrameSO3TrajectoryPoint.getOrientation(orientation);
yoFrameSO3TrajectoryPoint.getAngularVelocity(angularVelocity);
yoFrameSO3TrajectoryPoint.getOrientation(orientation);
yoFrameSO3TrajectoryPoint.getAngularVelocity(angularVelocity);

相关文章