How to use

getZ32

method

in

us.ihmc.euclid.tuple3D.Vector3D32

Assert.assertTrue(0 == vector.getZ32());
Assert.assertTrue(newZ == vector.getZ32());
Assert.assertTrue(randomVector32Array[2] == vectorArray.getZ32());
Assert.assertTrue(vector.getZ32() == vector2.getZ32());

@Override
public void testSetters() throws Exception
{
 super.testSetters();
 Random random = new Random(621541L);
 Vector3D32 tuple1 = createEmptyTuple();
 for (int i = 0; i < ITERATIONS; i++)
 { // Test setX(float x)
   float x = random.nextFloat();
   tuple1.setX(x);
   assertEquals(tuple1.getX32(), x, getEpsilon());
 }
 for (int i = 0; i < ITERATIONS; i++)
 { // Test setY(float y)
   float y = random.nextFloat();
   tuple1.setY(y);
   assertEquals(tuple1.getY32(), y, getEpsilon());
 }
 for (int i = 0; i < ITERATIONS; i++)
 { // Test setZ(float z)
   float z = random.nextFloat();
   tuple1.setZ(z);
   assertEquals(tuple1.getZ32(), z, getEpsilon());
 }
}

dz = origin.getZ32() - p.getZ32();
dot = dx * direction.getX32() + dy * direction.getY32() + dz * direction.getZ32();
dz = dz - dot * direction.getZ32();

dz = origin.getZ32() - p.z;
dot = dx * direction.getX32() + dy * direction.getY32() + dz * direction.getZ32();
dz = dz - dot * direction.getZ32();

dz = origin.getZ32() - p.z;
dot = dx * direction.getX32() + dy * direction.getY32() + dz * direction.getZ32();
dz = dz - dot * direction.getZ32();

float vx = normal.getX32();
float vy = normal.getY32();
float vz = normal.getZ32();
normal.setX(rxx * vx + rxy * vy + rxz * vz);
normal.setY(ryx * vx + ryy * vy + ryz * vz);

public static Transform j3dTransform3DToJMETransform(RigidBodyTransform transform3D)
{
 Quaternion32 quat = new Quaternion32();
 us.ihmc.euclid.tuple3D.Vector3D32 vector = new us.ihmc.euclid.tuple3D.Vector3D32();
 transform3D.get(quat, vector);
 Vector3f jmeVector = new Vector3f(vector.getX32(), vector.getY32(), vector.getZ32());
 Quaternion jmeQuat = new Quaternion(quat.getX32(), quat.getY32(), quat.getZ32(), quat.getS32());
 Transform ret = new Transform(jmeVector, jmeQuat, new Vector3f(1.0f, 1.0f, 1.0f));
 return ret;
}

private static Transform j3dTransform3DToJMETransform(RigidBodyTransform transform3D)
{
 us.ihmc.euclid.tuple4D.Quaternion32 quat = new us.ihmc.euclid.tuple4D.Quaternion32();
 us.ihmc.euclid.tuple3D.Vector3D32 vector = new us.ihmc.euclid.tuple3D.Vector3D32();
 transform3D.get(quat, vector);
 Vector3f jmeVector = new Vector3f(vector.getX32(), vector.getY32(), vector.getZ32());
 Quaternion jmeQuat = new Quaternion(quat.getX32(), quat.getY32(), quat.getZ32(), quat.getS32());
 Transform ret = new Transform(jmeVector, jmeQuat, new Vector3f(1.0f, 1.0f, 1.0f));
 return ret;
}