Package javax.vecmath

Examples of javax.vecmath.Vector3d.scale()


           
            armForcesKp.set(xArmToYArm);
            armForcesKp.scale(kpArmWeld.getDoubleValue());
           
            armForcesKd.set(xArmToYArmVelocity);
            armForcesKd.scale(kdArmWeld.getDoubleValue());
           
            Vector3d armForces = new Vector3d();
            armForces.add(armForcesKp, armForcesKd);
           
            xArmExternalForcePoint.setForce(armForces);
View Full Code Here


           
            if (!penIsAboveDesk.getBooleanValue())
            {
               Vector3d forceOnPen = new Vector3d();
               forceOnPen.set(penProjectionOntoDeskNormal);
               forceOnPen.scale(-kpPenOnDesk.getDoubleValue());
               double maxPenForce = 5.0;
              
               if (forceOnPen.length() > maxPenForce)
               {
                  forceOnPen.normalize();
View Full Code Here

               double maxPenForce = 5.0;
              
               if (forceOnPen.length() > maxPenForce)
               {
                  forceOnPen.normalize();
                  forceOnPen.scale(maxPenForce);
               }
               penExternalForcePoint.setForce(forceOnPen);
              
               if (getTime() > 10.0) harmonographPaperJPanel.addPoint(penProjectionInDeskFrame);
//               bagOfBalls.setBall(new FramePoint(ReferenceFrame.getWorldFrame(), penPosition));
View Full Code Here

      }
     
      targPos = m_target.getPosition(targPos, upperLimb);
     
      if (offset.doubleValue() != 0) {
        offsetDir.scale(offset.doubleValue());
        targPos.add(offsetDir);
      }
     
      edu.cmu.cs.stage3.math.Vector3 targPos2 = new edu.cmu.cs.stage3.math.Vector3(targPos.x, targPos.y, targPos.z);   
     
View Full Code Here

      }
     
      targPos = m_target.getPosition(targPos, upperLimb);
     
      if (offset.doubleValue() != 0) {
        offsetDir.scale(offset.doubleValue());
        targPos.add(offsetDir);
      }
     
      edu.cmu.cs.stage3.math.Vector3 targPos2 = new edu.cmu.cs.stage3.math.Vector3(targPos.x, targPos.y, targPos.z);   
     
View Full Code Here

        final Transform3D transform3D = Transforms.getTransform(targetTG);
        final Vector3d start = Transforms.getVector3d(transform3D);
        transform3D.mul(Transforms.translation(theMove));
        final Transform3D transform2 = new Transform3D(transform3D);
        final Vector3d theMove2 = new Vector3d(theMove);
        theMove2.scale(5.0);
        transform2.mul(Transforms.translation(theMove2));
        final Vector3d stop = Transforms.getVector3d(transform2);
        pickTool.setShapeSegment(new Point3d(start), new Point3d(stop));
        if (pickTool.pickClosest() == null) {
            targetTG.setTransform(transform3D);
View Full Code Here

TOP
Copyright © 2018 www.massapi.com. All rights reserved.
All source code are property of their respective owners. Java is a trademark of Sun Microsystems, Inc and owned by ORACLE Inc. Contact coftware#gmail.com.