public void setRotation(Matrix3d jointRotation) { RotationTools.convertMatrixToQuaternion(jointRotation, this.jointRotation); // DON'T USE THIS: the method in Quat4d is flawed and doesn't work for some rotation matrices! // this.jointRotation.set(jointRotation); this.afterJointFrame.setRotation(this.jointRotation); }
public void setRotation(double yaw, double pitch, double roll) { RotationTools.convertYawPitchRollToQuaternion(yaw, pitch, roll, jointRotation); this.afterJointFrame.setRotation(jointRotation); }
public void setRotation(Quat4d jointRotation) { this.jointRotation.set(jointRotation); this.afterJointFrame.setRotation(jointRotation); }
public void setRotation(Matrix3d jointRotation) { RotationTools.convertMatrixToQuaternion(jointRotation, this.jointRotation); // DON'T USE THIS: the method in Quat4d is flawed and doesn't work for some rotation matrices! // this.jointRotation.set(jointRotation); this.afterJointFrame.setRotation(this.jointRotation); }
public void setRotation(double yaw, double pitch, double roll) { RotationTools.convertYawPitchRollToQuaternion(0.0, pitch, 0.0, jointRotation); afterJointFrame.setRotation(this.jointRotation); }
public void setRotation(double yaw, double pitch, double roll) { RotationTools.convertYawPitchRollToQuaternion(yaw, pitch, roll, jointRotation); this.afterJointFrame.setRotation(jointRotation); }
@Override public void setConfiguration(DenseMatrix64F matrix, int rowStart) { MatrixTools.extractQuat4dFromEJMLVector(jointRotation, matrix, rowStart); this.afterJointFrame.setRotation(jointRotation); }
public void setRotation(Quat4d jointRotation) { this.jointRotation.set(jointRotation); this.afterJointFrame.setRotation(jointRotation); } public void setRotation(double x, double y, double z, double w)
public void setRotation(double x, double y, double z, double w) { this.jointRotation.set(x, y, z, w); this.afterJointFrame.setRotation(this.jointRotation); }
public void setRotation(double x, double y, double z, double w) { RotationTools.convertQuaternionToYawPitchRoll(x, y, z, w, yawPitchRoll); RotationTools.convertYawPitchRollToQuaternion(0.0, yawPitchRoll[1], 0.0, jointRotation); this.afterJointFrame.setRotation(this.jointRotation); }
public void setRotation(Quat4d jointRotation) { RotationTools.convertQuaternionToYawPitchRoll(jointRotation, yawPitchRoll); RotationTools.convertYawPitchRollToQuaternion(0.0, yawPitchRoll[1], 0.0, this.jointRotation); this.afterJointFrame.setRotation(this.jointRotation); }
public void setRotation(Matrix3d jointRotation) { RotationTools.convertMatrixToYawPitchRoll(jointRotation, yawPitchRoll); RotationTools.convertYawPitchRollToQuaternion(0.0, yawPitchRoll[1], 0.0, this.jointRotation); // DON'T USE THIS: the method in Quat4d is flawed and doesn't work for some rotation matrices! // this.jointRotation.set(jointRotation); this.afterJointFrame.setRotation(this.jointRotation); }
public void setPositionAndRotation(RigidBodyTransform transform) { RotationTools.convertTransformToQuaternion(transform, jointRotation); if (!RotationTools.isQuaternionNormalized(jointRotation)) { throw new AssertionError("quaternion is not normalized. " + jointRotation); } transform.getTranslation(jointTranslation); this.afterJointFrame.setRotation(jointRotation); this.afterJointFrame.setTranslation(jointTranslation); }
public void setPositionAndRotation(RigidBodyTransform transform) { RotationTools.convertTransformToYawPitchRoll(transform, yawPitchRoll); RotationTools.convertYawPitchRollToQuaternion(0.0, yawPitchRoll[1], 0.0, jointRotation); if (!RotationTools.isQuaternionNormalized(jointRotation)) { throw new AssertionError("quaternion is not normalized. " + jointRotation); } transform.getTranslation(jointTranslation); jointTranslation.setY(0.0); this.afterJointFrame.setRotation(jointRotation); this.afterJointFrame.setTranslation(jointTranslation); }
@Override public void setConfiguration(DenseMatrix64F matrix, int rowStart) { int index = rowStart; double qRot = matrix.get(index++, 0); double x = matrix.get(index++, 0); double z = matrix.get(index++, 0); RotationTools.convertYawPitchRollToQuaternion(0.0, qRot, 0.0, jointRotation); jointTranslation.set(x, 0.0, z); afterJointFrame.setRotation(jointRotation); afterJointFrame.setTranslation(jointTranslation); }
@Override public void setConfiguration(DenseMatrix64F matrix, int rowStart) { int index = rowStart; MatrixTools.extractQuat4dFromEJMLVector(jointRotation, matrix, rowStart); RotationTools.checkQuaternionNormalized(jointRotation); index += RotationTools.QUATERNION_SIZE; jointTranslation.setX(matrix.get(index++, 0)); jointTranslation.setY(matrix.get(index++, 0)); jointTranslation.setZ(matrix.get(index++, 0)); this.afterJointFrame.setRotation(jointRotation); this.afterJointFrame.setTranslation(jointTranslation); }