public void translate(Vector3d translationVector) { transformGenerator.translate(translationVector); }
generator.translate(1.0, 0.0, 0.0); RigidBodyTransform expectedTransform = new RigidBodyTransform(); expectedTransform.setTranslation(1.0, 0.0, 0.0); generator.translate(2.0, 0.0, 0.0); expectedTransform = new RigidBodyTransform(); expectedTransform.setRotationEulerAndZeroTranslation(0.0, -Math.PI / 2.0, 0.0); generator.translate(3.0, 0.0, 0.0); expectedTransform = new RigidBodyTransform(); expectedTransform.setRotationEulerAndZeroTranslation(-Math.PI / 2.0, 0.0, Math.PI / 2.0);
public void translate(double x, double y, double z) { transformGenerator.translate(x, y, z); }
public void translate(double x, double y, double z) { transformGenerator.translate(x, y, z); }
public void translate(Tuple3DReadOnly translationVector) { transformGenerator.translate(translationVector); }
public void addCubeReferencedAtCenter(double lengthX, double widthY, double heightZ) { RigidBodyTransformGenerator transformGeneratorTwo = new RigidBodyTransformGenerator(transformGenerator); transformGeneratorTwo.set(transformGenerator); transformGeneratorTwo.translate(0.0, 0.0, heightZ / 2.0); addRectangle(transformGeneratorTwo, lengthX, widthY); transformGeneratorTwo.translate(0.0, 0.0, -heightZ); addRectangle(transformGeneratorTwo, lengthX, widthY); transformGeneratorTwo.set(transformGenerator); transformGeneratorTwo.rotate(Math.PI / 2.0, Axis.Y); transformGeneratorTwo.translate(0.0, 0.0, lengthX / 2.0); addRectangle(transformGeneratorTwo, heightZ, widthY); transformGeneratorTwo.translate(0.0, 0.0, -lengthX); addRectangle(transformGeneratorTwo, heightZ, widthY); transformGeneratorTwo.set(transformGenerator); transformGeneratorTwo.rotate(Math.PI / 2.0, Axis.X); transformGeneratorTwo.translate(0.0, 0.0, widthY / 2.0); addRectangle(transformGeneratorTwo, lengthX, heightZ); transformGeneratorTwo.translate(0.0, 0.0, -widthY); addRectangle(transformGeneratorTwo, lengthX, heightZ); }
public void addCubeReferencedAtCenter(double lengthX, double widthY, double heightZ) { RigidBodyTransformGenerator transformGeneratorTwo = new RigidBodyTransformGenerator(transformGenerator); transformGeneratorTwo.set(transformGenerator); transformGeneratorTwo.translate(0.0, 0.0, heightZ / 2.0); addRectangle(transformGeneratorTwo, lengthX, widthY); transformGeneratorTwo.translate(0.0, 0.0, -heightZ); transformGeneratorTwo.rotate(Math.PI, Axis.Y); addRectangle(transformGeneratorTwo, lengthX, widthY); transformGeneratorTwo.rotate(Math.PI, Axis.Y); transformGeneratorTwo.set(transformGenerator); transformGeneratorTwo.rotate(Math.PI / 2.0, Axis.Y); transformGeneratorTwo.translate(0.0, 0.0, lengthX / 2.0); addRectangle(transformGeneratorTwo, heightZ, widthY); transformGeneratorTwo.translate(0.0, 0.0, -lengthX); transformGeneratorTwo.rotate(Math.PI, Axis.Y); addRectangle(transformGeneratorTwo, heightZ, widthY); transformGeneratorTwo.rotate(Math.PI, Axis.Y); transformGeneratorTwo.set(transformGenerator); transformGeneratorTwo.rotate(Math.PI / 2.0, Axis.X); transformGeneratorTwo.translate(0.0, 0.0, widthY / 2.0); addRectangle(transformGeneratorTwo, lengthX, heightZ); transformGeneratorTwo.translate(0.0, 0.0, -widthY); transformGeneratorTwo.rotate(Math.PI, Axis.X); addRectangle(transformGeneratorTwo, lengthX, heightZ); transformGeneratorTwo.rotate(Math.PI, Axis.X); }
public void addRampReferencedAtBottomMiddle(double lengthX, double widthY, double heightZ) { RigidBodyTransformGenerator transformGeneratorTwo = new RigidBodyTransformGenerator(transformGenerator); double slope = Math.atan2(heightZ, lengthX); transformGeneratorTwo.set(transformGenerator); transformGeneratorTwo.translate(lengthX / 2.0, 0.0, heightZ / 2.0); transformGeneratorTwo.rotate(-slope, Axis.Y); addRectangle(transformGeneratorTwo, EuclidGeometryTools.pythagorasGetHypotenuse(lengthX, heightZ), widthY); ConvexPolygon2D leftSide = new ConvexPolygon2D(); leftSide.addVertex(0.0, 0.0); leftSide.addVertex(- lengthX, 0.0); leftSide.addVertex(- lengthX, heightZ); leftSide.update(); ConvexPolygon2D rightSide = new ConvexPolygon2D(); rightSide.addVertex(0.0, 0.0); rightSide.addVertex(lengthX, 0.0); rightSide.addVertex(lengthX, heightZ); rightSide.update(); transformGeneratorTwo.set(transformGenerator); transformGeneratorTwo.translate(0.0, 0.5 * widthY, 0.0); transformGeneratorTwo.rotate(0.5 * Math.PI, Axis.X); transformGeneratorTwo.rotate(Math.PI, Axis.Y); addPolygon(transformGeneratorTwo, leftSide); transformGeneratorTwo.set(transformGenerator); transformGeneratorTwo.translate(0.0, -0.5 * widthY, 0.0); transformGeneratorTwo.rotate(0.5 * Math.PI, Axis.X); addPolygon(transformGeneratorTwo, rightSide); }
@ContinuousIntegrationTest(estimatedDuration = 0.0) @Test(timeout = 30000) public void testTranslateThenRotateTransformGeneration() { RigidBodyTransformGenerator generator = new RigidBodyTransformGenerator(); generator.translate(3.3, 4.4, 5.5); generator.rotateEuler(new Vector3D(0.67, 0.89, 0.34)); RigidBodyTransform expectedTransform = new RigidBodyTransform(); expectedTransform.setRotationEulerAndZeroTranslation(0.67, 0.89, 0.34); expectedTransform.setTranslation(3.3, 4.4, 5.5); RigidBodyTransform transform = generator.getRigidBodyTransformCopy(); assertTrue(transform.epsilonEquals(expectedTransform, 1e-10)); }
assertTrue(transform.epsilonEquals(identity, 1e-10)); generator.translate(1.0, 2.0, 3.0); RigidBodyTransform expectedTransform = new RigidBodyTransform(); expectedTransform.setTranslation(1.0, 2.0, 3.0); assertTrue(transform.epsilonEquals(expectedTransform, 1e-10)); generator.translate(4.0, 5.0, 6.0); expectedTransform = new RigidBodyTransform(); expectedTransform.setTranslation(5.0, 7.0, 9.0); generator.translate(new Vector3D(-3.0, 9.0, 11.0)); expectedTransform = new RigidBodyTransform(); expectedTransform.setTranslation(-3.0, 9.0, 11.0);