@Override protected void setZ(Point3D32 data, float z) { data.setZ(z); }
result.setZ((((float) y / (float) height) * 2f - 1f) * m11); result.setX(1);
@Override public void testSetters() throws Exception { super.testSetters(); Random random = new Random(621541L); Point3D32 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()); } }
vertex.setX(x0 + rxx * vx + rxy * vy + rxz * vz); vertex.setY(y0 + ryx * vx + ryy * vy + ryz * vz); vertex.setZ(z0 + rzx * vx + rzz * vz);
public static Point3D32[] getDecayingWorldScan(PointCloudWorldPacket pointCloudWorldPacket) { int numberOfPoints = pointCloudWorldPacket.getDecayingWorldScan().size() / 3; Point3D32[] points = new Point3D32[numberOfPoints]; for (int i = 0; i < numberOfPoints; i++) { Point3D32 point = new Point3D32(); point.setX(pointCloudWorldPacket.getDecayingWorldScan().get(3 * i)); point.setY(pointCloudWorldPacket.getDecayingWorldScan().get(3 * i + 1)); point.setZ(pointCloudWorldPacket.getDecayingWorldScan().get(3 * i + 2)); points[i] = point; } return points; }
public static Point3D32[] unpackLocalizationPointMap(LocalizationPointMapPacket localizationPointMapPacket) { int numberOfPoints = localizationPointMapPacket.getLocalizationPointMap().size() / 3; Point3D32[] points = new Point3D32[numberOfPoints]; for (int i = 0; i < numberOfPoints; i++) { Point3D32 point = new Point3D32(); point.setX(localizationPointMapPacket.getLocalizationPointMap().get(3 * i)); point.setY(localizationPointMapPacket.getLocalizationPointMap().get(3 * i + 1)); point.setZ(localizationPointMapPacket.getLocalizationPointMap().get(3 * i + 2)); points[i] = point; } return points; }
@Override public void setFromMessage(LidarScanMessage message) { timestamp = message.getRobotTimestamp(); lidarPose.setIncludingFrame(ReferenceFrame.getWorldFrame(), message.getLidarPosition(), message.getLidarOrientation()); int index = 0; TFloatArrayList newPointCloud = message.getScan(); scan.clear(); while (index < newPointCloud.size()) { Point3D32 point = scan.add(); point.setX(newPointCloud.get(index++)); point.setY(newPointCloud.get(index++)); point.setZ(newPointCloud.get(index++)); } }