public void update(FrameVector3DReadOnly inputAngularVelocity, FrameVector3DReadOnly inputLinearAcceleration, FrameVector3DReadOnly inputMagneticVector) { inputAngularVelocity.checkReferenceFrameMatch(sensorFrame); inputLinearAcceleration.checkReferenceFrameMatch(sensorFrame); if (inputMagneticVector != null) inputMagneticVector.checkReferenceFrameMatch(sensorFrame); update((Vector3DReadOnly) inputAngularVelocity, (Vector3DReadOnly) inputLinearAcceleration, (Vector3DReadOnly) inputMagneticVector); }
public void setCubicUsingFinalAccelerationButNotFinalPosition(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FrameVector3DReadOnly zdFinal, FrameVector3DReadOnly zddFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); zddFinal.checkReferenceFrameMatch(referenceFrame); super.setCubicUsingFinalAccelerationButNotFinalPosition(t0, tFinal, z0, zd0, zdFinal, zddFinal); }
public void setQuintic(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FrameVector3DReadOnly zdd0, FramePoint3DReadOnly zf, FrameVector3DReadOnly zdf, FrameVector3DReadOnly zddf) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zdd0.checkReferenceFrameMatch(referenceFrame); zf.checkReferenceFrameMatch(referenceFrame); zdf.checkReferenceFrameMatch(referenceFrame); zddf.checkReferenceFrameMatch(referenceFrame); super.setQuintic(t0, tFinal, z0, zd0, zdd0, zf, zdf, zddf); }
public void setQuartic(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FrameVector3DReadOnly zdd0, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zdd0.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); super.setQuartic(t0, tFinal, z0, zd0, zdd0, zFinal, zdFinal); }
public void setQuarticUsingFinalAcceleration(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdFinal, FrameVector3DReadOnly zddFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); zddFinal.checkReferenceFrameMatch(referenceFrame); super.setQuarticUsingFinalAcceleration(t0, tFinal, z0, zd0, zFinal, zdFinal, zddFinal); }
public void setQuarticUsingIntermediateVelocity(double t0, double tIntermediate, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FrameVector3DReadOnly zdIntermediate, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zdIntermediate.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); super.setQuarticUsingIntermediateVelocity(t0, tIntermediate, tFinal, z0, zd0, zdIntermediate, zFinal, zdFinal); }
public void setQuadraticUsingInitialAcceleration(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FrameVector3DReadOnly zdd0) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zdd0.checkReferenceFrameMatch(referenceFrame); super.setQuadraticUsingInitialAcceleration(t0, tFinal, z0, zd0, zdd0); }
@Override public ReferenceFrame getReferenceFrame() { angularPart.checkReferenceFrameMatch(linearPart); return angularPart.getReferenceFrame(); }
public void setQuinticUsingWayPoint(double t0, double tIntermediate, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FrameVector3DReadOnly zdd0, FramePoint3DReadOnly zIntermediate, FramePoint3DReadOnly zf, FrameVector3DReadOnly zdf) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zdd0.checkReferenceFrameMatch(referenceFrame); zIntermediate.checkReferenceFrameMatch(referenceFrame); zf.checkReferenceFrameMatch(referenceFrame); zdf.checkReferenceFrameMatch(referenceFrame); super.setQuinticUsingWayPoint(t0, tIntermediate, tFinal, z0, zd0, zdd0, zIntermediate, zf, zdf); }
public void setQuinticUsingWayPoint2(double t0, double tIntermediate, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FrameVector3DReadOnly zdd0, FramePoint3DReadOnly zIntermediate, FrameVector3DReadOnly zdIntermediate, FramePoint3DReadOnly zf) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zdd0.checkReferenceFrameMatch(referenceFrame); zIntermediate.checkReferenceFrameMatch(referenceFrame); zdIntermediate.checkReferenceFrameMatch(referenceFrame); zf.checkReferenceFrameMatch(referenceFrame); super.setQuinticUsingWayPoint2(t0, tIntermediate, tFinal, z0, zd0, zdd0, zIntermediate, zdIntermediate, zf); }
public void setInitialPositionVelocityZeroFinalHighOrderDerivatives(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); super.setInitialPositionVelocityZeroFinalHighOrderDerivatives(t0, tFinal, z0, zd0, zFinal, zdFinal); }
public void setCubic(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); super.setCubic(t0, tFinal, z0, zd0, zFinal, zdFinal); }
public void setQuinticWithZeroTerminalAcceleration(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); super.setQuinticWithZeroTerminalAcceleration(t0, tFinal, z0, zd0, zFinal, zdFinal); }
public void setQuarticUsingWayPoint(double t0, double tIntermediate, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FramePoint3DReadOnly zIntermediate, FramePoint3DReadOnly zf, FrameVector3DReadOnly zdf) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zIntermediate.checkReferenceFrameMatch(referenceFrame); zf.checkReferenceFrameMatch(referenceFrame); zdf.checkReferenceFrameMatch(referenceFrame); super.setQuarticUsingWayPoint(t0, tIntermediate, tFinal, z0, zd0, zIntermediate, zf, zdf); }
public void setQuarticUsingMidPoint(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FramePoint3DReadOnly zMid, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zMid.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); super.setQuarticUsingMidPoint(t0, tFinal, z0, zd0, zMid, zFinal, zdFinal); }
public void setQuadratic(double t0, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FramePoint3DReadOnly zFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); super.setQuadratic(t0, tFinal, z0, zd0, zFinal); }
public void setQuadraticWithFinalVelocityConstraint(double t0, double tFinal, FramePoint3DReadOnly z0, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdFinal) { z0.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); super.setQuadraticWithFinalVelocityConstraint(t0, tFinal, z0, zFinal, zdFinal); }
public void setCubicWithIntermediatePositionAndInitialVelocityConstraint(double t0, double tIntermediate, double tFinal, FramePoint3DReadOnly z0, FrameVector3DReadOnly zd0, FramePoint3DReadOnly zIntermediate, FramePoint3DReadOnly zFinal) { z0.checkReferenceFrameMatch(referenceFrame); zd0.checkReferenceFrameMatch(referenceFrame); zIntermediate.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); super.setCubicWithIntermediatePositionAndInitialVelocityConstraint(t0, tIntermediate, tFinal, z0, zd0, zIntermediate, zFinal); }
public void setCubicWithIntermediatePositionAndFinalVelocityConstraint(double t0, double tIntermediate, double tFinal, FramePoint3DReadOnly z0, FramePoint3DReadOnly zIntermediate, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdFinal) { z0.checkReferenceFrameMatch(referenceFrame); zIntermediate.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdFinal.checkReferenceFrameMatch(referenceFrame); super.setCubicWithIntermediatePositionAndFinalVelocityConstraint(t0, tIntermediate, tFinal, z0, zIntermediate, zFinal, zdFinal); }
public void setQuarticUsingOneIntermediateVelocity(double t0, double tIntermediate0, double tIntermediate1, double tFinal, FramePoint3DReadOnly z0, FramePoint3DReadOnly zIntermediate0, FramePoint3DReadOnly zIntermediate1, FramePoint3DReadOnly zFinal, FrameVector3DReadOnly zdIntermediate1) { z0.checkReferenceFrameMatch(referenceFrame); zIntermediate0.checkReferenceFrameMatch(referenceFrame); zIntermediate1.checkReferenceFrameMatch(referenceFrame); zFinal.checkReferenceFrameMatch(referenceFrame); zdIntermediate1.checkReferenceFrameMatch(referenceFrame); super.setQuarticUsingOneIntermediateVelocity(t0, tIntermediate0, tIntermediate1, tFinal, z0, zIntermediate0, zIntermediate1, zFinal, zdIntermediate1); }