public double getYDisp() { return disp.getY(); }
private void toggleNextLayer() { WorldSceneRenderer renderer = getCurrentRenderer(); int height = (int) renderer.getSize().getY(); if(++this.layerIndex > height) { //if current layer index is more than max height, reset it //to display all layers this.layerIndex = -1; } this.nextLayerButton.displayString = "L:" + (layerIndex == -1 ? "A" : Integer.toString(layerIndex + 1)); }
return new float[] { vec.getX(), vec.getY(), vec.getZ() };
public static void setScale(javax.vecmath.Vector3f vec, javax.vecmath.Matrix4f src, javax.vecmath.Matrix4f dest) { if (dest == null) { dest = new javax.vecmath.Matrix4f(); } dest.m00 = src.m00 * vec.getX(); dest.m01 = src.m01 * vec.getX(); dest.m02 = src.m02 * vec.getX(); dest.m03 = src.m03 * vec.getX(); dest.m10 = src.m10 * vec.getY(); dest.m11 = src.m11 * vec.getY(); dest.m12 = src.m12 * vec.getY(); dest.m13 = src.m13 * vec.getY(); dest.m20 = src.m20 * vec.getZ(); dest.m21 = src.m21 * vec.getZ(); dest.m22 = src.m22 * vec.getZ(); dest.m23 = src.m23 * vec.getZ(); }
public void setScale(Vector3f scales) { setScale(scales.getX(), scales.getY(), scales.getZ()); }
/** * Transform vector by multiplying it by this transform and put result back * into vector. * * @param vector */ public final void transform(Vector3f vector) { double x = mat00 * vector.getX() + mat01 * vector.getY() + mat02 * vector.getZ(); double y = mat10 * vector.getX() + mat11 * vector.getY() + mat12 * vector.getZ(); vector.setZ((float) (mat20 * vector.getX() + mat21 * vector.getY() + mat22 * vector.getZ())); vector.setX((float) x); vector.setY((float) y); }
public static void assertVector3fEquals(String message, Vector3f expected, Vector3f actual, double delta) { assertEquals(message + " [X component]",expected.getX(), actual.getX(),delta); assertEquals(message + " [Y component]",expected.getY(), actual.getY(),delta); assertEquals(message + " [Z component]", expected.getZ(), actual.getZ(), delta); }
/** * Sets this transform to have rotation described by axisAngle and * translation described by the Vector3f vector. * * @param axisAngle */ public final void set(AxisAngle4f axisAngle, Vector3f vector) { setRotation(axisAngle); setTranslation(vector.getX(), vector.getY(), vector.getZ()); }
/** * Transform vector by multiplying it by this transform and put result back * into vector. * * @param vector */ public final void transform(Vector3f vectorIn, Vector3f vectorOut) { if (vectorIn != vectorOut) { vectorOut.setX((float) (mat00 * vectorIn.getX() + mat01 * vectorIn.getY() + mat02 * vectorIn.getZ())); vectorOut.setY((float) (mat10 * vectorIn.getX() + mat11 * vectorIn.getY() + mat12 * vectorIn.getZ())); vectorOut.setZ((float) (mat20 * vectorIn.getX() + mat21 * vectorIn.getY() + mat22 * vectorIn.getZ())); } else { transform(vectorIn); } }
@Override public boolean setBlockState(BlockPos pos, IBlockState newState, int flags) { if(newState.getBlock() == Blocks.AIR) { renderedBlocks.remove(pos); } else { renderedBlocks.add(pos); } minPos.setX(Math.min(minPos.getX(), pos.getX())); minPos.setY(Math.min(minPos.getY(), pos.getY())); minPos.setZ(Math.min(minPos.getZ(), pos.getZ())); maxPos.setX(Math.max(maxPos.getX(), pos.getX())); maxPos.setY(Math.max(maxPos.getY(), pos.getY())); maxPos.setZ(Math.max(maxPos.getZ(), pos.getZ())); return super.setBlockState(pos, newState, flags); }
public static void packVector3fToGeometry_msgsVector3(Vector3f vector, Vector3 rosVectorToPack) { rosVectorToPack.setX(vector.getX()); rosVectorToPack.setY(vector.getY()); rosVectorToPack.setZ(vector.getZ()); }
private boolean shouldDisplayBlock(BlockPos pos) { if(getLayerIndex() == -1) return true; WorldSceneRenderer renderer = getCurrentRenderer(); int minHeight = (int) renderer.world.getMinPos().getY(); int relativeHeight = pos.getY() - minHeight; return relativeHeight == getLayerIndex(); }
void addVertexWithUV(Vector4d vec, float u, float v, Vector3f normal) { Tessellator.getInstance().getBuffer().pos(vec.x, vec.y, vec.z).tex(u, v).normal(normal.getX(), normal.getY(), normal.getZ()).endVertex(); } }
public void updateFullRobotModel(KinematicsToolboxOutputStatus solution) { if (jointsHashCode != solution.jointNameHash) throw new RuntimeException("Hashes are different."); for (int i = 0; i < oneDoFJoints.length; i++) { float q = solution.getJointAngles()[i]; OneDoFJoint joint = oneDoFJoints[i]; joint.setQ(q); } Vector3f translation = solution.getPelvisTranslation(); rootJoint.setPosition(translation.getX(), translation.getY(), translation.getZ()); Quat4f orientation = solution.getPelvisOrientation(); rootJoint.setRotation(orientation.getX(), orientation.getY(), orientation.getZ(), orientation.getW()); fullRobotModelToUseForConversion.updateFrames(); }
/** * Multiply a 3x3 matrix by a 3x1 vector. Since result is stored in vector, the matrix must be 3x3. * @param matrix * @param vector */ public static void mult(DenseMatrix64F matrix, Vector3f vector) { if (matrix.numCols != 3 || matrix.numRows != 3) { throw new RuntimeException("Improperly sized matrices."); } float x = vector.getX(); float y = vector.getY(); float z = vector.getZ(); vector.setX((float) (matrix.get(0, 0) * x + matrix.get(0, 1) * y + matrix.get(0, 2) * z)); vector.setY((float) (matrix.get(1, 0) * x + matrix.get(1, 1) * y + matrix.get(1, 2) * z)); vector.setZ((float) (matrix.get(2, 0) * x + matrix.get(2, 1) * y + matrix.get(2, 2) * z)); }
/** * Set this transform to have zero translation and a rotation equal to the * Matrix3f matrix. * * @param matrix */ public final void set(Matrix3f matrix, Vector3f vector, double scalex, double scaley, double scalez) { mat00 = scalex * matrix.getM00(); mat01 = scaley * matrix.getM01(); mat02 = scalez * matrix.getM02(); mat10 = scalex * matrix.getM10(); mat11 = scaley * matrix.getM11(); mat12 = scalez * matrix.getM12(); mat20 = scalex * matrix.getM20(); mat21 = scaley * matrix.getM21(); mat22 = scalez * matrix.getM22(); mat03 = vector.getX(); mat13 = vector.getY(); mat23 = vector.getZ(); }
public static Transform j3dTransform3DToJMETransform(RigidBodyTransform transform3D) { Quat4f quat = new Quat4f(); javax.vecmath.Vector3f vector = new javax.vecmath.Vector3f(); transform3D.get(quat, vector); Vector3f jmeVector = new Vector3f(vector.getX(), vector.getY(), vector.getZ()); Quaternion jmeQuat = new Quaternion(quat.getX(), quat.getY(), quat.getZ(), quat.getW()); Transform ret = new Transform(jmeVector, jmeQuat, new Vector3f(1.0f, 1.0f, 1.0f)); return ret; }
private static Transform j3dTransform3DToJMETransform(RigidBodyTransform transform3D) { javax.vecmath.Quat4f quat = new javax.vecmath.Quat4f(); javax.vecmath.Vector3f vector = new javax.vecmath.Vector3f(); transform3D.get(quat, vector); Vector3f jmeVector = new Vector3f(vector.getX(), vector.getY(), vector.getZ()); Quaternion jmeQuat = new Quaternion(quat.getX(), quat.getY(), quat.getZ(), quat.getW()); Transform ret = new Transform(jmeVector, jmeQuat, new Vector3f(1.0f, 1.0f, 1.0f)); return ret; }