@Override public void setAngularVelocity(Vector3DReadOnly angularVelocity) { this.angularVelocity.set(angularVelocity); }
public void setAngularVelocity(FrameVector3D angularVelocity) { this.angularVelocity.set(angularVelocity); } public void set(SO3TrajectoryPointInterface<?> so3TrajectoryPoint)
@Override public void setLinearVelocity(Vector3DReadOnly linearVelocity) { this.linearVelocity.set(linearVelocity); }
public void setTranslationRangeToSlipNextStep(double[] slipXYZMin, double[] slipXYZMax) { assertValidLimits(slipXYZMin, slipXYZMax); this.minTranslationToSlipNextStep.set(slipXYZMin[0], slipXYZMin[1], slipXYZMin[2]); this.maxTranslationToSlipNextStep.set(slipXYZMax[0], slipXYZMax[1], slipXYZMax[2]); }
public void setInitialConditions(YoFramePoint3D initialPosition, YoFrameVector3D initialVelocity) { this.initialPosition.set(initialPosition); this.initialVelocity.set(initialVelocity); }
public void set(double baseX, double baseY, double baseZ, double x, double y, double z) { base.set(baseX, baseY, baseZ); vector.set(x, y, z); }
public void setTrajectoryParameters(double duration, Point3D initialPosition, Vector3D initialVelocity, Point3D finalPosition, Vector3D finalVelocity) { trajectoryTime.set(duration); this.initialPosition.set(initialPosition); this.initialVelocity.set(initialVelocity); this.finalPosition.set(finalPosition); this.finalVelocity.set(finalVelocity); }
public void set(double time, FramePoint3D position, FrameQuaternion orientation, FrameVector3D linearVelocity, FrameVector3D angularVelocity) { this.time.set(time); this.position.set(position); this.orientation.set(orientation); this.linearVelocity.set(linearVelocity); this.angularVelocity.set(angularVelocity); }
public void setTrajectoryParameters(double duration, FramePoint3D initialPosition, FrameVector3D initialVelocity, FramePoint3D finalPosition, FrameVector3D finalVelocity) { trajectoryTime.set(duration); this.initialPosition.set(initialPosition); this.initialVelocity.set(initialVelocity); this.finalPosition.set(finalPosition); this.finalVelocity.set(finalVelocity); }
public void set(double time, YoFramePoint3D position, YoFrameQuaternion orientation, YoFrameVector3D linearVelocity, YoFrameVector3D angularVelocity) { this.time.set(time); this.position.set(position); this.orientation.set(orientation); this.linearVelocity.set(linearVelocity); this.angularVelocity.set(angularVelocity); }
public void set(double time, Point3DReadOnly position, Vector3DReadOnly linearVelocity) { this.time.set(time); this.position.set(position); this.linearVelocity.set(linearVelocity); }
public void set(double time, FramePoint3DReadOnly position, FrameVector3DReadOnly linearVelocity) { this.time.set(time); this.position.set(position); this.linearVelocity.set(linearVelocity); }
private void setVectorFromPoseToPose(YoFrameVector3D frameVectorToPack, FramePose3D fromPose, FramePose3D toPose) { frameVectorToPack.set(toPose.getPosition()); FrameVector3D frameTuple = new FrameVector3D(frameVectorToPack); frameTuple.sub(fromPose.getPosition()); frameVectorToPack.set(frameTuple); }
public void set(double time, YoFrameQuaternion orientation, YoFrameVector3D angularVelocity) { this.time.set(time); this.orientation.set(orientation); this.angularVelocity.set(angularVelocity); }
@Test// timeout=300000 public void testGetYoVelocity() { YoFrameVector3D yoVelocity = kinematicPoint.getYoVelocity(); String frameName = yoVelocity.getReferenceFrame().getName(); assertEquals("( 0.000, 0.000, 0.000 )-" + frameName, yoVelocity.toString()); yoVelocity.set(new Vector3D(5.0, 5.1, 5.2)); assertEquals("( 5.000, 5.100, 5.200 )-" + frameName, yoVelocity.toString()); }
public void setTrajectoryParameters(double duration, FramePoint3DReadOnly initialPosition, double intermediateZPosition, FramePoint3DReadOnly finalPosition, FrameVector3DReadOnly finalVelocity) { trajectoryTime.set(duration); this.initialPosition.set(initialPosition); this.intermediateZPosition.set(intermediateZPosition); this.finalPosition.set(finalPosition); this.finalVelocity.set(finalVelocity); }
@Override protected void getYoValuesFromFrameWaypoint() { SE3Waypoint simpleWaypoint = frameWaypoint.getGeometryObject(); EuclideanWaypoint euclideanWaypoint = simpleWaypoint.getEuclideanWaypoint(); SO3Waypoint so3Waypoint = simpleWaypoint.getSO3Waypoint(); position.set(euclideanWaypoint.getPosition()); orientation.set(so3Waypoint.getOrientation()); linearVelocity.set(euclideanWaypoint.getLinearVelocity()); angularVelocity.set(so3Waypoint.getAngularVelocity()); } }
public void setTrajectoryParameters(double duration, FramePoint3DReadOnly initialPosition, YoDouble intermediateZPosition, FramePoint3DReadOnly finalPosition, FrameVector3DReadOnly finalVelocity) { trajectoryTime.set(duration); this.initialPosition.set(initialPosition); this.intermediateZPosition.set(intermediateZPosition.getDoubleValue()); this.finalPosition.set(finalPosition); this.finalVelocity.set(finalVelocity); }
@Override protected void getYoValuesFromFrameWaypoint() { SimpleSE3TrajectoryPoint simpleTrajectoryPoint = frameWaypoint.getGeometryObject(); EuclideanWaypoint euclideanWaypoint = simpleTrajectoryPoint.getEuclideanWaypoint(); SO3Waypoint so3Waypoint = simpleTrajectoryPoint.getSO3Waypoint(); time.set(simpleTrajectoryPoint.getTime()); position.set(euclideanWaypoint.getPosition()); orientation.set(so3Waypoint.getOrientation()); linearVelocity.set(euclideanWaypoint.getLinearVelocity()); angularVelocity.set(so3Waypoint.getAngularVelocity()); }